1 /*
2  * Copyright 2020 Advanced Micro Devices, Inc.
3  *
4  * Permission is hereby granted, free of charge, to any person obtaining a
5  * copy of this software and associated documentation files (the "Software"),
6  * to deal in the Software without restriction, including without limitation
7  * the rights to use, copy, modify, merge, publish, distribute, sublicense,
8  * and/or sell copies of the Software, and to permit persons to whom the
9  * Software is furnished to do so, subject to the following conditions:
10  *
11  * The above copyright notice and this permission notice shall be included in
12  * all copies or substantial portions of the Software.
13  *
14  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
15  * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
16  * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT.  IN NO EVENT SHALL
17  * THE COPYRIGHT HOLDER(S) OR AUTHOR(S) BE LIABLE FOR ANY CLAIM, DAMAGES OR
18  * OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE,
19  * ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR
20  * OTHER DEALINGS IN THE SOFTWARE.
21  *
22  * Authors: AMD
23  *
24  */
25 
26 #include "reg_helper.h"
27 #include "dcn30_mpc.h"
28 #include "dcn30_cm_common.h"
29 #include "basics/conversion.h"
30 #include "dcn10/dcn10_cm_common.h"
31 #include "dc.h"
32 
33 #define REG(reg)\
34 	mpc30->mpc_regs->reg
35 
36 #define CTX \
37 	mpc30->base.ctx
38 
39 #undef FN
40 #define FN(reg_name, field_name) \
41 	mpc30->mpc_shift->field_name, mpc30->mpc_mask->field_name
42 
43 
44 #define NUM_ELEMENTS(a) (sizeof(a) / sizeof((a)[0]))
45 
46 
mpc3_is_dwb_idle(struct mpc * mpc,int dwb_id)47 bool mpc3_is_dwb_idle(
48 	struct mpc *mpc,
49 	int dwb_id)
50 {
51 	struct dcn30_mpc *mpc30 = TO_DCN30_MPC(mpc);
52 	unsigned int status;
53 
54 	REG_GET(DWB_MUX[dwb_id], MPC_DWB0_MUX_STATUS, &status);
55 
56 	if (status == 0xf)
57 		return true;
58 	else
59 		return false;
60 }
61 
mpc3_set_dwb_mux(struct mpc * mpc,int dwb_id,int mpcc_id)62 void mpc3_set_dwb_mux(
63 	struct mpc *mpc,
64 	int dwb_id,
65 	int mpcc_id)
66 {
67 	struct dcn30_mpc *mpc30 = TO_DCN30_MPC(mpc);
68 
69 	REG_SET(DWB_MUX[dwb_id], 0,
70 		MPC_DWB0_MUX, mpcc_id);
71 }
72 
mpc3_disable_dwb_mux(struct mpc * mpc,int dwb_id)73 void mpc3_disable_dwb_mux(
74 	struct mpc *mpc,
75 	int dwb_id)
76 {
77 	struct dcn30_mpc *mpc30 = TO_DCN30_MPC(mpc);
78 
79 	REG_SET(DWB_MUX[dwb_id], 0,
80 		MPC_DWB0_MUX, 0xf);
81 }
82 
mpc3_set_out_rate_control(struct mpc * mpc,int opp_id,bool enable,bool rate_2x_mode,struct mpc_dwb_flow_control * flow_control)83 void mpc3_set_out_rate_control(
84 	struct mpc *mpc,
85 	int opp_id,
86 	bool enable,
87 	bool rate_2x_mode,
88 	struct mpc_dwb_flow_control *flow_control)
89 {
90 	struct dcn30_mpc *mpc30 = TO_DCN30_MPC(mpc);
91 
92 	REG_UPDATE_2(MUX[opp_id],
93 			MPC_OUT_RATE_CONTROL_DISABLE, !enable,
94 			MPC_OUT_RATE_CONTROL, rate_2x_mode);
95 
96 	if (flow_control)
97 		REG_UPDATE_2(MUX[opp_id],
98 			MPC_OUT_FLOW_CONTROL_MODE, flow_control->flow_ctrl_mode,
99 			MPC_OUT_FLOW_CONTROL_COUNT, flow_control->flow_ctrl_cnt1);
100 }
101 
mpc3_get_ogam_current(struct mpc * mpc,int mpcc_id)102 enum dc_lut_mode mpc3_get_ogam_current(struct mpc *mpc, int mpcc_id)
103 {
104 	/*Contrary to DCN2 and DCN1 wherein a single status register field holds this info;
105 	 *in DCN3/3AG, we need to read two separate fields to retrieve the same info
106 	 */
107 	enum dc_lut_mode mode;
108 	uint32_t state_mode;
109 	uint32_t state_ram_lut_in_use;
110 	struct dcn30_mpc *mpc30 = TO_DCN30_MPC(mpc);
111 
112 	REG_GET_2(MPCC_OGAM_CONTROL[mpcc_id], MPCC_OGAM_MODE_CURRENT, &state_mode,
113 		  MPCC_OGAM_SELECT_CURRENT, &state_ram_lut_in_use);
114 
115 	switch (state_mode) {
116 	case 0:
117 		mode = LUT_BYPASS;
118 		break;
119 	case 2:
120 		switch (state_ram_lut_in_use) {
121 		case 0:
122 			mode = LUT_RAM_A;
123 			break;
124 		case 1:
125 			mode = LUT_RAM_B;
126 			break;
127 		default:
128 			mode = LUT_BYPASS;
129 			break;
130 		}
131 		break;
132 	default:
133 		mode = LUT_BYPASS;
134 		break;
135 	}
136 
137 	return mode;
138 }
139 
mpc3_power_on_ogam_lut(struct mpc * mpc,int mpcc_id,bool power_on)140 void mpc3_power_on_ogam_lut(
141 		struct mpc *mpc, int mpcc_id,
142 		bool power_on)
143 {
144 	struct dcn30_mpc *mpc30 = TO_DCN30_MPC(mpc);
145 
146 	/*
147 	 * Powering on: force memory active so the LUT can be updated.
148 	 * Powering off: allow entering memory low power mode
149 	 *
150 	 * Memory low power mode is controlled during MPC OGAM LUT init.
151 	 */
152 	REG_UPDATE(MPCC_MEM_PWR_CTRL[mpcc_id],
153 		   MPCC_OGAM_MEM_PWR_DIS, power_on != 0);
154 
155 	/* Wait for memory to be powered on - we won't be able to write to it otherwise. */
156 	if (power_on)
157 		REG_WAIT(MPCC_MEM_PWR_CTRL[mpcc_id], MPCC_OGAM_MEM_PWR_STATE, 0, 10, 10);
158 }
159 
mpc3_configure_ogam_lut(struct mpc * mpc,int mpcc_id,bool is_ram_a)160 static void mpc3_configure_ogam_lut(
161 		struct mpc *mpc, int mpcc_id,
162 		bool is_ram_a)
163 {
164 	struct dcn30_mpc *mpc30 = TO_DCN30_MPC(mpc);
165 
166 	REG_UPDATE_2(MPCC_OGAM_LUT_CONTROL[mpcc_id],
167 			MPCC_OGAM_LUT_WRITE_COLOR_MASK, 7,
168 			MPCC_OGAM_LUT_HOST_SEL, is_ram_a == true ? 0:1);
169 
170 	REG_SET(MPCC_OGAM_LUT_INDEX[mpcc_id], 0, MPCC_OGAM_LUT_INDEX, 0);
171 }
172 
mpc3_ogam_get_reg_field(struct mpc * mpc,struct dcn3_xfer_func_reg * reg)173 static void mpc3_ogam_get_reg_field(
174 		struct mpc *mpc,
175 		struct dcn3_xfer_func_reg *reg)
176 {
177 	struct dcn30_mpc *mpc30 = TO_DCN30_MPC(mpc);
178 
179 	reg->shifts.field_region_start_base = mpc30->mpc_shift->MPCC_OGAM_RAMA_EXP_REGION_START_BASE_B;
180 	reg->masks.field_region_start_base = mpc30->mpc_mask->MPCC_OGAM_RAMA_EXP_REGION_START_BASE_B;
181 	reg->shifts.field_offset = mpc30->mpc_shift->MPCC_OGAM_RAMA_OFFSET_B;
182 	reg->masks.field_offset = mpc30->mpc_mask->MPCC_OGAM_RAMA_OFFSET_B;
183 
184 	reg->shifts.exp_region0_lut_offset = mpc30->mpc_shift->MPCC_OGAM_RAMA_EXP_REGION0_LUT_OFFSET;
185 	reg->masks.exp_region0_lut_offset = mpc30->mpc_mask->MPCC_OGAM_RAMA_EXP_REGION0_LUT_OFFSET;
186 	reg->shifts.exp_region0_num_segments = mpc30->mpc_shift->MPCC_OGAM_RAMA_EXP_REGION0_NUM_SEGMENTS;
187 	reg->masks.exp_region0_num_segments = mpc30->mpc_mask->MPCC_OGAM_RAMA_EXP_REGION0_NUM_SEGMENTS;
188 	reg->shifts.exp_region1_lut_offset = mpc30->mpc_shift->MPCC_OGAM_RAMA_EXP_REGION1_LUT_OFFSET;
189 	reg->masks.exp_region1_lut_offset = mpc30->mpc_mask->MPCC_OGAM_RAMA_EXP_REGION1_LUT_OFFSET;
190 	reg->shifts.exp_region1_num_segments = mpc30->mpc_shift->MPCC_OGAM_RAMA_EXP_REGION1_NUM_SEGMENTS;
191 	reg->masks.exp_region1_num_segments = mpc30->mpc_mask->MPCC_OGAM_RAMA_EXP_REGION1_NUM_SEGMENTS;
192 
193 	reg->shifts.field_region_end = mpc30->mpc_shift->MPCC_OGAM_RAMA_EXP_REGION_END_B;
194 	reg->masks.field_region_end = mpc30->mpc_mask->MPCC_OGAM_RAMA_EXP_REGION_END_B;
195 	reg->shifts.field_region_end_slope = mpc30->mpc_shift->MPCC_OGAM_RAMA_EXP_REGION_END_SLOPE_B;
196 	reg->masks.field_region_end_slope = mpc30->mpc_mask->MPCC_OGAM_RAMA_EXP_REGION_END_SLOPE_B;
197 	reg->shifts.field_region_end_base = mpc30->mpc_shift->MPCC_OGAM_RAMA_EXP_REGION_END_BASE_B;
198 	reg->masks.field_region_end_base = mpc30->mpc_mask->MPCC_OGAM_RAMA_EXP_REGION_END_BASE_B;
199 	reg->shifts.field_region_linear_slope = mpc30->mpc_shift->MPCC_OGAM_RAMA_EXP_REGION_START_SLOPE_B;
200 	reg->masks.field_region_linear_slope = mpc30->mpc_mask->MPCC_OGAM_RAMA_EXP_REGION_START_SLOPE_B;
201 	reg->shifts.exp_region_start = mpc30->mpc_shift->MPCC_OGAM_RAMA_EXP_REGION_START_B;
202 	reg->masks.exp_region_start = mpc30->mpc_mask->MPCC_OGAM_RAMA_EXP_REGION_START_B;
203 	reg->shifts.exp_resion_start_segment = mpc30->mpc_shift->MPCC_OGAM_RAMA_EXP_REGION_START_SEGMENT_B;
204 	reg->masks.exp_resion_start_segment = mpc30->mpc_mask->MPCC_OGAM_RAMA_EXP_REGION_START_SEGMENT_B;
205 }
206 
mpc3_program_luta(struct mpc * mpc,int mpcc_id,const struct pwl_params * params)207 static void mpc3_program_luta(struct mpc *mpc, int mpcc_id,
208 		const struct pwl_params *params)
209 {
210 	struct dcn30_mpc *mpc30 = TO_DCN30_MPC(mpc);
211 	struct dcn3_xfer_func_reg gam_regs;
212 
213 	mpc3_ogam_get_reg_field(mpc, &gam_regs);
214 
215 	gam_regs.start_cntl_b = REG(MPCC_OGAM_RAMA_START_CNTL_B[mpcc_id]);
216 	gam_regs.start_cntl_g = REG(MPCC_OGAM_RAMA_START_CNTL_G[mpcc_id]);
217 	gam_regs.start_cntl_r = REG(MPCC_OGAM_RAMA_START_CNTL_R[mpcc_id]);
218 	gam_regs.start_slope_cntl_b = REG(MPCC_OGAM_RAMA_START_SLOPE_CNTL_B[mpcc_id]);
219 	gam_regs.start_slope_cntl_g = REG(MPCC_OGAM_RAMA_START_SLOPE_CNTL_G[mpcc_id]);
220 	gam_regs.start_slope_cntl_r = REG(MPCC_OGAM_RAMA_START_SLOPE_CNTL_R[mpcc_id]);
221 	gam_regs.start_end_cntl1_b = REG(MPCC_OGAM_RAMA_END_CNTL1_B[mpcc_id]);
222 	gam_regs.start_end_cntl2_b = REG(MPCC_OGAM_RAMA_END_CNTL2_B[mpcc_id]);
223 	gam_regs.start_end_cntl1_g = REG(MPCC_OGAM_RAMA_END_CNTL1_G[mpcc_id]);
224 	gam_regs.start_end_cntl2_g = REG(MPCC_OGAM_RAMA_END_CNTL2_G[mpcc_id]);
225 	gam_regs.start_end_cntl1_r = REG(MPCC_OGAM_RAMA_END_CNTL1_R[mpcc_id]);
226 	gam_regs.start_end_cntl2_r = REG(MPCC_OGAM_RAMA_END_CNTL2_R[mpcc_id]);
227 	gam_regs.region_start = REG(MPCC_OGAM_RAMA_REGION_0_1[mpcc_id]);
228 	gam_regs.region_end = REG(MPCC_OGAM_RAMA_REGION_32_33[mpcc_id]);
229 	//New registers in DCN3AG/DCN OGAM block
230 	gam_regs.offset_b =  REG(MPCC_OGAM_RAMA_OFFSET_B[mpcc_id]);
231 	gam_regs.offset_g =  REG(MPCC_OGAM_RAMA_OFFSET_G[mpcc_id]);
232 	gam_regs.offset_r =  REG(MPCC_OGAM_RAMA_OFFSET_R[mpcc_id]);
233 	gam_regs.start_base_cntl_b = REG(MPCC_OGAM_RAMA_START_BASE_CNTL_B[mpcc_id]);
234 	gam_regs.start_base_cntl_g = REG(MPCC_OGAM_RAMA_START_BASE_CNTL_G[mpcc_id]);
235 	gam_regs.start_base_cntl_r = REG(MPCC_OGAM_RAMA_START_BASE_CNTL_R[mpcc_id]);
236 
237 	cm_helper_program_gamcor_xfer_func(mpc30->base.ctx, params, &gam_regs);
238 }
239 
mpc3_program_lutb(struct mpc * mpc,int mpcc_id,const struct pwl_params * params)240 static void mpc3_program_lutb(struct mpc *mpc, int mpcc_id,
241 		const struct pwl_params *params)
242 {
243 	struct dcn30_mpc *mpc30 = TO_DCN30_MPC(mpc);
244 	struct dcn3_xfer_func_reg gam_regs;
245 
246 	mpc3_ogam_get_reg_field(mpc, &gam_regs);
247 
248 	gam_regs.start_cntl_b = REG(MPCC_OGAM_RAMB_START_CNTL_B[mpcc_id]);
249 	gam_regs.start_cntl_g = REG(MPCC_OGAM_RAMB_START_CNTL_G[mpcc_id]);
250 	gam_regs.start_cntl_r = REG(MPCC_OGAM_RAMB_START_CNTL_R[mpcc_id]);
251 	gam_regs.start_slope_cntl_b = REG(MPCC_OGAM_RAMB_START_SLOPE_CNTL_B[mpcc_id]);
252 	gam_regs.start_slope_cntl_g = REG(MPCC_OGAM_RAMB_START_SLOPE_CNTL_G[mpcc_id]);
253 	gam_regs.start_slope_cntl_r = REG(MPCC_OGAM_RAMB_START_SLOPE_CNTL_R[mpcc_id]);
254 	gam_regs.start_end_cntl1_b = REG(MPCC_OGAM_RAMB_END_CNTL1_B[mpcc_id]);
255 	gam_regs.start_end_cntl2_b = REG(MPCC_OGAM_RAMB_END_CNTL2_B[mpcc_id]);
256 	gam_regs.start_end_cntl1_g = REG(MPCC_OGAM_RAMB_END_CNTL1_G[mpcc_id]);
257 	gam_regs.start_end_cntl2_g = REG(MPCC_OGAM_RAMB_END_CNTL2_G[mpcc_id]);
258 	gam_regs.start_end_cntl1_r = REG(MPCC_OGAM_RAMB_END_CNTL1_R[mpcc_id]);
259 	gam_regs.start_end_cntl2_r = REG(MPCC_OGAM_RAMB_END_CNTL2_R[mpcc_id]);
260 	gam_regs.region_start = REG(MPCC_OGAM_RAMB_REGION_0_1[mpcc_id]);
261 	gam_regs.region_end = REG(MPCC_OGAM_RAMB_REGION_32_33[mpcc_id]);
262 	//New registers in DCN3AG/DCN OGAM block
263 	gam_regs.offset_b =  REG(MPCC_OGAM_RAMB_OFFSET_B[mpcc_id]);
264 	gam_regs.offset_g =  REG(MPCC_OGAM_RAMB_OFFSET_G[mpcc_id]);
265 	gam_regs.offset_r =  REG(MPCC_OGAM_RAMB_OFFSET_R[mpcc_id]);
266 	gam_regs.start_base_cntl_b = REG(MPCC_OGAM_RAMB_START_BASE_CNTL_B[mpcc_id]);
267 	gam_regs.start_base_cntl_g = REG(MPCC_OGAM_RAMB_START_BASE_CNTL_G[mpcc_id]);
268 	gam_regs.start_base_cntl_r = REG(MPCC_OGAM_RAMB_START_BASE_CNTL_R[mpcc_id]);
269 
270 	cm_helper_program_gamcor_xfer_func(mpc30->base.ctx, params, &gam_regs);
271 }
272 
273 
mpc3_program_ogam_pwl(struct mpc * mpc,int mpcc_id,const struct pwl_result_data * rgb,uint32_t num)274 static void mpc3_program_ogam_pwl(
275 		struct mpc *mpc, int mpcc_id,
276 		const struct pwl_result_data *rgb,
277 		uint32_t num)
278 {
279 	uint32_t i;
280 	struct dcn30_mpc *mpc30 = TO_DCN30_MPC(mpc);
281 	uint32_t last_base_value_red = rgb[num-1].red_reg + rgb[num-1].delta_red_reg;
282 	uint32_t last_base_value_green = rgb[num-1].green_reg + rgb[num-1].delta_green_reg;
283 	uint32_t last_base_value_blue = rgb[num-1].blue_reg + rgb[num-1].delta_blue_reg;
284 
285 	/*the entries of DCN3AG gamma LUTs take 18bit base values as opposed to
286 	 *38 base+delta values per entry in earlier DCN architectures
287 	 *last base value for our lut is compute by adding the last base value
288 	 *in our data + last delta
289 	 */
290 
291 	if (is_rgb_equal(rgb,  num)) {
292 		for (i = 0 ; i < num; i++)
293 			REG_SET(MPCC_OGAM_LUT_DATA[mpcc_id], 0, MPCC_OGAM_LUT_DATA, rgb[i].red_reg);
294 
295 		REG_SET(MPCC_OGAM_LUT_DATA[mpcc_id], 0, MPCC_OGAM_LUT_DATA, last_base_value_red);
296 
297 	} else {
298 
299 		REG_UPDATE(MPCC_OGAM_LUT_CONTROL[mpcc_id],
300 				MPCC_OGAM_LUT_WRITE_COLOR_MASK, 4);
301 
302 		for (i = 0 ; i < num; i++)
303 			REG_SET(MPCC_OGAM_LUT_DATA[mpcc_id], 0, MPCC_OGAM_LUT_DATA, rgb[i].red_reg);
304 
305 		REG_SET(MPCC_OGAM_LUT_DATA[mpcc_id], 0, MPCC_OGAM_LUT_DATA, last_base_value_red);
306 
307 		REG_SET(MPCC_OGAM_LUT_INDEX[mpcc_id], 0, MPCC_OGAM_LUT_INDEX, 0);
308 
309 		REG_UPDATE(MPCC_OGAM_LUT_CONTROL[mpcc_id],
310 				MPCC_OGAM_LUT_WRITE_COLOR_MASK, 2);
311 
312 		for (i = 0 ; i < num; i++)
313 			REG_SET(MPCC_OGAM_LUT_DATA[mpcc_id], 0, MPCC_OGAM_LUT_DATA, rgb[i].green_reg);
314 
315 		REG_SET(MPCC_OGAM_LUT_DATA[mpcc_id], 0, MPCC_OGAM_LUT_DATA, last_base_value_green);
316 
317 		REG_SET(MPCC_OGAM_LUT_INDEX[mpcc_id], 0, MPCC_OGAM_LUT_INDEX, 0);
318 
319 		REG_UPDATE(MPCC_OGAM_LUT_CONTROL[mpcc_id],
320 				MPCC_OGAM_LUT_WRITE_COLOR_MASK, 1);
321 
322 		for (i = 0 ; i < num; i++)
323 			REG_SET(MPCC_OGAM_LUT_DATA[mpcc_id], 0, MPCC_OGAM_LUT_DATA, rgb[i].blue_reg);
324 
325 		REG_SET(MPCC_OGAM_LUT_DATA[mpcc_id], 0, MPCC_OGAM_LUT_DATA, last_base_value_blue);
326 	}
327 
328 }
329 
mpc3_set_output_gamma(struct mpc * mpc,int mpcc_id,const struct pwl_params * params)330 void mpc3_set_output_gamma(
331 		struct mpc *mpc,
332 		int mpcc_id,
333 		const struct pwl_params *params)
334 {
335 	enum dc_lut_mode current_mode;
336 	enum dc_lut_mode next_mode;
337 	struct dcn30_mpc *mpc30 = TO_DCN30_MPC(mpc);
338 
339 	if (mpc->ctx->dc->debug.cm_in_bypass) {
340 		REG_SET(MPCC_OGAM_MODE[mpcc_id], 0, MPCC_OGAM_MODE, 0);
341 		return;
342 	}
343 
344 	if (params == NULL) { //disable OGAM
345 		REG_SET(MPCC_OGAM_CONTROL[mpcc_id], 0, MPCC_OGAM_MODE, 0);
346 		return;
347 	}
348 	//enable OGAM
349 	REG_SET(MPCC_OGAM_CONTROL[mpcc_id], 0, MPCC_OGAM_MODE, 2);
350 
351 	current_mode = mpc3_get_ogam_current(mpc, mpcc_id);
352 	if (current_mode == LUT_BYPASS)
353 		next_mode = LUT_RAM_A;
354 	else if (current_mode == LUT_RAM_A)
355 		next_mode = LUT_RAM_B;
356 	else
357 		next_mode = LUT_RAM_A;
358 
359 	mpc3_power_on_ogam_lut(mpc, mpcc_id, true);
360 	mpc3_configure_ogam_lut(mpc, mpcc_id, next_mode == LUT_RAM_A);
361 
362 	if (next_mode == LUT_RAM_A)
363 		mpc3_program_luta(mpc, mpcc_id, params);
364 	else
365 		mpc3_program_lutb(mpc, mpcc_id, params);
366 
367 	mpc3_program_ogam_pwl(
368 			mpc, mpcc_id, params->rgb_resulted, params->hw_points_num);
369 
370 	/*we need to program 2 fields here as apposed to 1*/
371 	REG_UPDATE(MPCC_OGAM_CONTROL[mpcc_id],
372 			MPCC_OGAM_SELECT, next_mode == LUT_RAM_A ? 0:1);
373 
374 	if (mpc->ctx->dc->debug.enable_mem_low_power.bits.mpc)
375 		mpc3_power_on_ogam_lut(mpc, mpcc_id, false);
376 }
377 
mpc3_set_denorm(struct mpc * mpc,int opp_id,enum dc_color_depth output_depth)378 void mpc3_set_denorm(
379 		struct mpc *mpc,
380 		int opp_id,
381 		enum dc_color_depth output_depth)
382 {
383 	struct dcn30_mpc *mpc30 = TO_DCN30_MPC(mpc);
384 	/* De-normalize Fixed U1.13 color data to different target bit depths. 0 is bypass*/
385 	int denorm_mode = 0;
386 
387 	switch (output_depth) {
388 	case COLOR_DEPTH_666:
389 		denorm_mode = 1;
390 		break;
391 	case COLOR_DEPTH_888:
392 		denorm_mode = 2;
393 		break;
394 	case COLOR_DEPTH_999:
395 		denorm_mode = 3;
396 		break;
397 	case COLOR_DEPTH_101010:
398 		denorm_mode = 4;
399 		break;
400 	case COLOR_DEPTH_111111:
401 		denorm_mode = 5;
402 		break;
403 	case COLOR_DEPTH_121212:
404 		denorm_mode = 6;
405 		break;
406 	case COLOR_DEPTH_141414:
407 	case COLOR_DEPTH_161616:
408 	default:
409 		/* not valid used case! */
410 		break;
411 	}
412 
413 	REG_UPDATE(DENORM_CONTROL[opp_id],
414 			MPC_OUT_DENORM_MODE, denorm_mode);
415 }
416 
mpc3_set_denorm_clamp(struct mpc * mpc,int opp_id,struct mpc_denorm_clamp denorm_clamp)417 void mpc3_set_denorm_clamp(
418 		struct mpc *mpc,
419 		int opp_id,
420 		struct mpc_denorm_clamp denorm_clamp)
421 {
422 	struct dcn30_mpc *mpc30 = TO_DCN30_MPC(mpc);
423 
424 	/*program min and max clamp values for the pixel components*/
425 	REG_UPDATE_2(DENORM_CONTROL[opp_id],
426 			MPC_OUT_DENORM_CLAMP_MAX_R_CR, denorm_clamp.clamp_max_r_cr,
427 			MPC_OUT_DENORM_CLAMP_MIN_R_CR, denorm_clamp.clamp_min_r_cr);
428 	REG_UPDATE_2(DENORM_CLAMP_G_Y[opp_id],
429 			MPC_OUT_DENORM_CLAMP_MAX_G_Y, denorm_clamp.clamp_max_g_y,
430 			MPC_OUT_DENORM_CLAMP_MIN_G_Y, denorm_clamp.clamp_min_g_y);
431 	REG_UPDATE_2(DENORM_CLAMP_B_CB[opp_id],
432 			MPC_OUT_DENORM_CLAMP_MAX_B_CB, denorm_clamp.clamp_max_b_cb,
433 			MPC_OUT_DENORM_CLAMP_MIN_B_CB, denorm_clamp.clamp_min_b_cb);
434 }
435 
mpc3_get_shaper_current(struct mpc * mpc,uint32_t rmu_idx)436 static enum dc_lut_mode mpc3_get_shaper_current(struct mpc *mpc, uint32_t rmu_idx)
437 {
438 	enum dc_lut_mode mode;
439 	uint32_t state_mode;
440 	struct dcn30_mpc *mpc30 = TO_DCN30_MPC(mpc);
441 
442 	REG_GET(SHAPER_CONTROL[rmu_idx], MPC_RMU_SHAPER_LUT_MODE_CURRENT, &state_mode);
443 
444 	switch (state_mode) {
445 	case 0:
446 		mode = LUT_BYPASS;
447 		break;
448 	case 1:
449 		mode = LUT_RAM_A;
450 		break;
451 	case 2:
452 		mode = LUT_RAM_B;
453 		break;
454 	default:
455 		mode = LUT_BYPASS;
456 		break;
457 	}
458 
459 	return mode;
460 }
461 
mpc3_configure_shaper_lut(struct mpc * mpc,bool is_ram_a,uint32_t rmu_idx)462 static void mpc3_configure_shaper_lut(
463 		struct mpc *mpc,
464 		bool is_ram_a,
465 		uint32_t rmu_idx)
466 {
467 	struct dcn30_mpc *mpc30 = TO_DCN30_MPC(mpc);
468 
469 	REG_UPDATE(SHAPER_LUT_WRITE_EN_MASK[rmu_idx],
470 			MPC_RMU_SHAPER_LUT_WRITE_EN_MASK, 7);
471 	REG_UPDATE(SHAPER_LUT_WRITE_EN_MASK[rmu_idx],
472 			MPC_RMU_SHAPER_LUT_WRITE_SEL, is_ram_a == true ? 0:1);
473 	REG_SET(SHAPER_LUT_INDEX[rmu_idx], 0, MPC_RMU_SHAPER_LUT_INDEX, 0);
474 }
475 
mpc3_program_shaper_luta_settings(struct mpc * mpc,const struct pwl_params * params,uint32_t rmu_idx)476 static void mpc3_program_shaper_luta_settings(
477 		struct mpc *mpc,
478 		const struct pwl_params *params,
479 		uint32_t rmu_idx)
480 {
481 	const struct gamma_curve *curve;
482 	struct dcn30_mpc *mpc30 = TO_DCN30_MPC(mpc);
483 
484 	REG_SET_2(SHAPER_RAMA_START_CNTL_B[rmu_idx], 0,
485 		MPC_RMU_SHAPER_RAMA_EXP_REGION_START_B, params->corner_points[0].blue.custom_float_x,
486 		MPC_RMU_SHAPER_RAMA_EXP_REGION_START_SEGMENT_B, 0);
487 	REG_SET_2(SHAPER_RAMA_START_CNTL_G[rmu_idx], 0,
488 			MPC_RMU_SHAPER_RAMA_EXP_REGION_START_B, params->corner_points[0].green.custom_float_x,
489 			MPC_RMU_SHAPER_RAMA_EXP_REGION_START_SEGMENT_B, 0);
490 	REG_SET_2(SHAPER_RAMA_START_CNTL_R[rmu_idx], 0,
491 			MPC_RMU_SHAPER_RAMA_EXP_REGION_START_B, params->corner_points[0].red.custom_float_x,
492 			MPC_RMU_SHAPER_RAMA_EXP_REGION_START_SEGMENT_B, 0);
493 
494 	REG_SET_2(SHAPER_RAMA_END_CNTL_B[rmu_idx], 0,
495 			MPC_RMU_SHAPER_RAMA_EXP_REGION_END_B, params->corner_points[1].blue.custom_float_x,
496 			MPC_RMU_SHAPER_RAMA_EXP_REGION_END_BASE_B, params->corner_points[1].blue.custom_float_y);
497 	REG_SET_2(SHAPER_RAMA_END_CNTL_G[rmu_idx], 0,
498 			MPC_RMU_SHAPER_RAMA_EXP_REGION_END_B, params->corner_points[1].green.custom_float_x,
499 			MPC_RMU_SHAPER_RAMA_EXP_REGION_END_BASE_B, params->corner_points[1].green.custom_float_y);
500 	REG_SET_2(SHAPER_RAMA_END_CNTL_R[rmu_idx], 0,
501 			MPC_RMU_SHAPER_RAMA_EXP_REGION_END_B, params->corner_points[1].red.custom_float_x,
502 			MPC_RMU_SHAPER_RAMA_EXP_REGION_END_BASE_B, params->corner_points[1].red.custom_float_y);
503 
504 	curve = params->arr_curve_points;
505 	REG_SET_4(SHAPER_RAMA_REGION_0_1[rmu_idx], 0,
506 		MPC_RMU_SHAPER_RAMA_EXP_REGION0_LUT_OFFSET, curve[0].offset,
507 		MPC_RMU_SHAPER_RAMA_EXP_REGION0_NUM_SEGMENTS, curve[0].segments_num,
508 		MPC_RMU_SHAPER_RAMA_EXP_REGION1_LUT_OFFSET, curve[1].offset,
509 		MPC_RMU_SHAPER_RAMA_EXP_REGION1_NUM_SEGMENTS, curve[1].segments_num);
510 
511 	curve += 2;
512 	REG_SET_4(SHAPER_RAMA_REGION_2_3[rmu_idx], 0,
513 		MPC_RMU_SHAPER_RAMA_EXP_REGION0_LUT_OFFSET, curve[0].offset,
514 		MPC_RMU_SHAPER_RAMA_EXP_REGION0_NUM_SEGMENTS, curve[0].segments_num,
515 		MPC_RMU_SHAPER_RAMA_EXP_REGION1_LUT_OFFSET, curve[1].offset,
516 		MPC_RMU_SHAPER_RAMA_EXP_REGION1_NUM_SEGMENTS, curve[1].segments_num);
517 
518 	curve += 2;
519 	REG_SET_4(SHAPER_RAMA_REGION_4_5[rmu_idx], 0,
520 		MPC_RMU_SHAPER_RAMA_EXP_REGION0_LUT_OFFSET, curve[0].offset,
521 		MPC_RMU_SHAPER_RAMA_EXP_REGION0_NUM_SEGMENTS, curve[0].segments_num,
522 		MPC_RMU_SHAPER_RAMA_EXP_REGION1_LUT_OFFSET, curve[1].offset,
523 		MPC_RMU_SHAPER_RAMA_EXP_REGION1_NUM_SEGMENTS, curve[1].segments_num);
524 
525 	curve += 2;
526 	REG_SET_4(SHAPER_RAMA_REGION_6_7[rmu_idx], 0,
527 		MPC_RMU_SHAPER_RAMA_EXP_REGION0_LUT_OFFSET, curve[0].offset,
528 		MPC_RMU_SHAPER_RAMA_EXP_REGION0_NUM_SEGMENTS, curve[0].segments_num,
529 		MPC_RMU_SHAPER_RAMA_EXP_REGION1_LUT_OFFSET, curve[1].offset,
530 		MPC_RMU_SHAPER_RAMA_EXP_REGION1_NUM_SEGMENTS, curve[1].segments_num);
531 
532 	curve += 2;
533 	REG_SET_4(SHAPER_RAMA_REGION_8_9[rmu_idx], 0,
534 		MPC_RMU_SHAPER_RAMA_EXP_REGION0_LUT_OFFSET, curve[0].offset,
535 		MPC_RMU_SHAPER_RAMA_EXP_REGION0_NUM_SEGMENTS, curve[0].segments_num,
536 		MPC_RMU_SHAPER_RAMA_EXP_REGION1_LUT_OFFSET, curve[1].offset,
537 		MPC_RMU_SHAPER_RAMA_EXP_REGION1_NUM_SEGMENTS, curve[1].segments_num);
538 
539 	curve += 2;
540 	REG_SET_4(SHAPER_RAMA_REGION_10_11[rmu_idx], 0,
541 		MPC_RMU_SHAPER_RAMA_EXP_REGION0_LUT_OFFSET, curve[0].offset,
542 		MPC_RMU_SHAPER_RAMA_EXP_REGION0_NUM_SEGMENTS, curve[0].segments_num,
543 		MPC_RMU_SHAPER_RAMA_EXP_REGION1_LUT_OFFSET, curve[1].offset,
544 		MPC_RMU_SHAPER_RAMA_EXP_REGION1_NUM_SEGMENTS, curve[1].segments_num);
545 
546 	curve += 2;
547 	REG_SET_4(SHAPER_RAMA_REGION_12_13[rmu_idx], 0,
548 		MPC_RMU_SHAPER_RAMA_EXP_REGION0_LUT_OFFSET, curve[0].offset,
549 		MPC_RMU_SHAPER_RAMA_EXP_REGION0_NUM_SEGMENTS, curve[0].segments_num,
550 		MPC_RMU_SHAPER_RAMA_EXP_REGION1_LUT_OFFSET, curve[1].offset,
551 		MPC_RMU_SHAPER_RAMA_EXP_REGION1_NUM_SEGMENTS, curve[1].segments_num);
552 
553 	curve += 2;
554 	REG_SET_4(SHAPER_RAMA_REGION_14_15[rmu_idx], 0,
555 		MPC_RMU_SHAPER_RAMA_EXP_REGION0_LUT_OFFSET, curve[0].offset,
556 		MPC_RMU_SHAPER_RAMA_EXP_REGION0_NUM_SEGMENTS, curve[0].segments_num,
557 		MPC_RMU_SHAPER_RAMA_EXP_REGION1_LUT_OFFSET, curve[1].offset,
558 		MPC_RMU_SHAPER_RAMA_EXP_REGION1_NUM_SEGMENTS, curve[1].segments_num);
559 
560 
561 	curve += 2;
562 	REG_SET_4(SHAPER_RAMA_REGION_16_17[rmu_idx], 0,
563 		MPC_RMU_SHAPER_RAMA_EXP_REGION0_LUT_OFFSET, curve[0].offset,
564 		MPC_RMU_SHAPER_RAMA_EXP_REGION0_NUM_SEGMENTS, curve[0].segments_num,
565 		MPC_RMU_SHAPER_RAMA_EXP_REGION1_LUT_OFFSET, curve[1].offset,
566 		MPC_RMU_SHAPER_RAMA_EXP_REGION1_NUM_SEGMENTS, curve[1].segments_num);
567 
568 	curve += 2;
569 	REG_SET_4(SHAPER_RAMA_REGION_18_19[rmu_idx], 0,
570 		MPC_RMU_SHAPER_RAMA_EXP_REGION0_LUT_OFFSET, curve[0].offset,
571 		MPC_RMU_SHAPER_RAMA_EXP_REGION0_NUM_SEGMENTS, curve[0].segments_num,
572 		MPC_RMU_SHAPER_RAMA_EXP_REGION1_LUT_OFFSET, curve[1].offset,
573 		MPC_RMU_SHAPER_RAMA_EXP_REGION1_NUM_SEGMENTS, curve[1].segments_num);
574 
575 	curve += 2;
576 	REG_SET_4(SHAPER_RAMA_REGION_20_21[rmu_idx], 0,
577 		MPC_RMU_SHAPER_RAMA_EXP_REGION0_LUT_OFFSET, curve[0].offset,
578 		MPC_RMU_SHAPER_RAMA_EXP_REGION0_NUM_SEGMENTS, curve[0].segments_num,
579 		MPC_RMU_SHAPER_RAMA_EXP_REGION1_LUT_OFFSET, curve[1].offset,
580 		MPC_RMU_SHAPER_RAMA_EXP_REGION1_NUM_SEGMENTS, curve[1].segments_num);
581 
582 	curve += 2;
583 	REG_SET_4(SHAPER_RAMA_REGION_22_23[rmu_idx], 0,
584 		MPC_RMU_SHAPER_RAMA_EXP_REGION0_LUT_OFFSET, curve[0].offset,
585 		MPC_RMU_SHAPER_RAMA_EXP_REGION0_NUM_SEGMENTS, curve[0].segments_num,
586 		MPC_RMU_SHAPER_RAMA_EXP_REGION1_LUT_OFFSET, curve[1].offset,
587 		MPC_RMU_SHAPER_RAMA_EXP_REGION1_NUM_SEGMENTS, curve[1].segments_num);
588 
589 	curve += 2;
590 	REG_SET_4(SHAPER_RAMA_REGION_24_25[rmu_idx], 0,
591 		MPC_RMU_SHAPER_RAMA_EXP_REGION0_LUT_OFFSET, curve[0].offset,
592 		MPC_RMU_SHAPER_RAMA_EXP_REGION0_NUM_SEGMENTS, curve[0].segments_num,
593 		MPC_RMU_SHAPER_RAMA_EXP_REGION1_LUT_OFFSET, curve[1].offset,
594 		MPC_RMU_SHAPER_RAMA_EXP_REGION1_NUM_SEGMENTS, curve[1].segments_num);
595 
596 	curve += 2;
597 	REG_SET_4(SHAPER_RAMA_REGION_26_27[rmu_idx], 0,
598 			MPC_RMU_SHAPER_RAMA_EXP_REGION0_LUT_OFFSET, curve[0].offset,
599 			MPC_RMU_SHAPER_RAMA_EXP_REGION0_NUM_SEGMENTS, curve[0].segments_num,
600 			MPC_RMU_SHAPER_RAMA_EXP_REGION1_LUT_OFFSET, curve[1].offset,
601 			MPC_RMU_SHAPER_RAMA_EXP_REGION1_NUM_SEGMENTS, curve[1].segments_num);
602 
603 	curve += 2;
604 	REG_SET_4(SHAPER_RAMA_REGION_28_29[rmu_idx], 0,
605 		MPC_RMU_SHAPER_RAMA_EXP_REGION0_LUT_OFFSET, curve[0].offset,
606 		MPC_RMU_SHAPER_RAMA_EXP_REGION0_NUM_SEGMENTS, curve[0].segments_num,
607 		MPC_RMU_SHAPER_RAMA_EXP_REGION1_LUT_OFFSET, curve[1].offset,
608 		MPC_RMU_SHAPER_RAMA_EXP_REGION1_NUM_SEGMENTS, curve[1].segments_num);
609 
610 	curve += 2;
611 	REG_SET_4(SHAPER_RAMA_REGION_30_31[rmu_idx], 0,
612 		MPC_RMU_SHAPER_RAMA_EXP_REGION0_LUT_OFFSET, curve[0].offset,
613 		MPC_RMU_SHAPER_RAMA_EXP_REGION0_NUM_SEGMENTS, curve[0].segments_num,
614 		MPC_RMU_SHAPER_RAMA_EXP_REGION1_LUT_OFFSET, curve[1].offset,
615 		MPC_RMU_SHAPER_RAMA_EXP_REGION1_NUM_SEGMENTS, curve[1].segments_num);
616 
617 	curve += 2;
618 	REG_SET_4(SHAPER_RAMA_REGION_32_33[rmu_idx], 0,
619 		MPC_RMU_SHAPER_RAMA_EXP_REGION0_LUT_OFFSET, curve[0].offset,
620 		MPC_RMU_SHAPER_RAMA_EXP_REGION0_NUM_SEGMENTS, curve[0].segments_num,
621 		MPC_RMU_SHAPER_RAMA_EXP_REGION1_LUT_OFFSET, curve[1].offset,
622 		MPC_RMU_SHAPER_RAMA_EXP_REGION1_NUM_SEGMENTS, curve[1].segments_num);
623 }
624 
mpc3_program_shaper_lutb_settings(struct mpc * mpc,const struct pwl_params * params,uint32_t rmu_idx)625 static void mpc3_program_shaper_lutb_settings(
626 		struct mpc *mpc,
627 		const struct pwl_params *params,
628 		uint32_t rmu_idx)
629 {
630 	const struct gamma_curve *curve;
631 	struct dcn30_mpc *mpc30 = TO_DCN30_MPC(mpc);
632 
633 	REG_SET_2(SHAPER_RAMB_START_CNTL_B[rmu_idx], 0,
634 		MPC_RMU_SHAPER_RAMA_EXP_REGION_START_B, params->corner_points[0].blue.custom_float_x,
635 		MPC_RMU_SHAPER_RAMA_EXP_REGION_START_SEGMENT_B, 0);
636 	REG_SET_2(SHAPER_RAMB_START_CNTL_G[rmu_idx], 0,
637 			MPC_RMU_SHAPER_RAMA_EXP_REGION_START_B, params->corner_points[0].green.custom_float_x,
638 			MPC_RMU_SHAPER_RAMA_EXP_REGION_START_SEGMENT_B, 0);
639 	REG_SET_2(SHAPER_RAMB_START_CNTL_R[rmu_idx], 0,
640 			MPC_RMU_SHAPER_RAMA_EXP_REGION_START_B, params->corner_points[0].red.custom_float_x,
641 			MPC_RMU_SHAPER_RAMA_EXP_REGION_START_SEGMENT_B, 0);
642 
643 	REG_SET_2(SHAPER_RAMB_END_CNTL_B[rmu_idx], 0,
644 			MPC_RMU_SHAPER_RAMA_EXP_REGION_END_B, params->corner_points[1].blue.custom_float_x,
645 			MPC_RMU_SHAPER_RAMA_EXP_REGION_END_BASE_B, params->corner_points[1].blue.custom_float_y);
646 	REG_SET_2(SHAPER_RAMB_END_CNTL_G[rmu_idx], 0,
647 			MPC_RMU_SHAPER_RAMA_EXP_REGION_END_B, params->corner_points[1].green.custom_float_x,
648 			MPC_RMU_SHAPER_RAMA_EXP_REGION_END_BASE_B, params->corner_points[1].green.custom_float_y);
649 	REG_SET_2(SHAPER_RAMB_END_CNTL_R[rmu_idx], 0,
650 			MPC_RMU_SHAPER_RAMA_EXP_REGION_END_B, params->corner_points[1].red.custom_float_x,
651 			MPC_RMU_SHAPER_RAMA_EXP_REGION_END_BASE_B, params->corner_points[1].red.custom_float_y);
652 
653 	curve = params->arr_curve_points;
654 	REG_SET_4(SHAPER_RAMB_REGION_0_1[rmu_idx], 0,
655 		MPC_RMU_SHAPER_RAMA_EXP_REGION0_LUT_OFFSET, curve[0].offset,
656 		MPC_RMU_SHAPER_RAMA_EXP_REGION0_NUM_SEGMENTS, curve[0].segments_num,
657 		MPC_RMU_SHAPER_RAMA_EXP_REGION1_LUT_OFFSET, curve[1].offset,
658 		MPC_RMU_SHAPER_RAMA_EXP_REGION1_NUM_SEGMENTS, curve[1].segments_num);
659 
660 	curve += 2;
661 	REG_SET_4(SHAPER_RAMB_REGION_2_3[rmu_idx], 0,
662 			MPC_RMU_SHAPER_RAMA_EXP_REGION0_LUT_OFFSET, curve[0].offset,
663 			MPC_RMU_SHAPER_RAMA_EXP_REGION0_NUM_SEGMENTS, curve[0].segments_num,
664 			MPC_RMU_SHAPER_RAMA_EXP_REGION1_LUT_OFFSET, curve[1].offset,
665 			MPC_RMU_SHAPER_RAMA_EXP_REGION1_NUM_SEGMENTS, curve[1].segments_num);
666 
667 
668 	curve += 2;
669 	REG_SET_4(SHAPER_RAMB_REGION_4_5[rmu_idx], 0,
670 			MPC_RMU_SHAPER_RAMA_EXP_REGION0_LUT_OFFSET, curve[0].offset,
671 			MPC_RMU_SHAPER_RAMA_EXP_REGION0_NUM_SEGMENTS, curve[0].segments_num,
672 			MPC_RMU_SHAPER_RAMA_EXP_REGION1_LUT_OFFSET, curve[1].offset,
673 			MPC_RMU_SHAPER_RAMA_EXP_REGION1_NUM_SEGMENTS, curve[1].segments_num);
674 
675 	curve += 2;
676 	REG_SET_4(SHAPER_RAMB_REGION_6_7[rmu_idx], 0,
677 			MPC_RMU_SHAPER_RAMA_EXP_REGION0_LUT_OFFSET, curve[0].offset,
678 			MPC_RMU_SHAPER_RAMA_EXP_REGION0_NUM_SEGMENTS, curve[0].segments_num,
679 			MPC_RMU_SHAPER_RAMA_EXP_REGION1_LUT_OFFSET, curve[1].offset,
680 			MPC_RMU_SHAPER_RAMA_EXP_REGION1_NUM_SEGMENTS, curve[1].segments_num);
681 
682 	curve += 2;
683 	REG_SET_4(SHAPER_RAMB_REGION_8_9[rmu_idx], 0,
684 		MPC_RMU_SHAPER_RAMA_EXP_REGION0_LUT_OFFSET, curve[0].offset,
685 		MPC_RMU_SHAPER_RAMA_EXP_REGION0_NUM_SEGMENTS, curve[0].segments_num,
686 		MPC_RMU_SHAPER_RAMA_EXP_REGION1_LUT_OFFSET, curve[1].offset,
687 		MPC_RMU_SHAPER_RAMA_EXP_REGION1_NUM_SEGMENTS, curve[1].segments_num);
688 
689 	curve += 2;
690 	REG_SET_4(SHAPER_RAMB_REGION_10_11[rmu_idx], 0,
691 			MPC_RMU_SHAPER_RAMA_EXP_REGION0_LUT_OFFSET, curve[0].offset,
692 			MPC_RMU_SHAPER_RAMA_EXP_REGION0_NUM_SEGMENTS, curve[0].segments_num,
693 			MPC_RMU_SHAPER_RAMA_EXP_REGION1_LUT_OFFSET, curve[1].offset,
694 			MPC_RMU_SHAPER_RAMA_EXP_REGION1_NUM_SEGMENTS, curve[1].segments_num);
695 
696 	curve += 2;
697 	REG_SET_4(SHAPER_RAMB_REGION_12_13[rmu_idx], 0,
698 			MPC_RMU_SHAPER_RAMA_EXP_REGION0_LUT_OFFSET, curve[0].offset,
699 			MPC_RMU_SHAPER_RAMA_EXP_REGION0_NUM_SEGMENTS, curve[0].segments_num,
700 			MPC_RMU_SHAPER_RAMA_EXP_REGION1_LUT_OFFSET, curve[1].offset,
701 			MPC_RMU_SHAPER_RAMA_EXP_REGION1_NUM_SEGMENTS, curve[1].segments_num);
702 
703 	curve += 2;
704 	REG_SET_4(SHAPER_RAMB_REGION_14_15[rmu_idx], 0,
705 			MPC_RMU_SHAPER_RAMA_EXP_REGION0_LUT_OFFSET, curve[0].offset,
706 			MPC_RMU_SHAPER_RAMA_EXP_REGION0_NUM_SEGMENTS, curve[0].segments_num,
707 			MPC_RMU_SHAPER_RAMA_EXP_REGION1_LUT_OFFSET, curve[1].offset,
708 			MPC_RMU_SHAPER_RAMA_EXP_REGION1_NUM_SEGMENTS, curve[1].segments_num);
709 
710 
711 	curve += 2;
712 	REG_SET_4(SHAPER_RAMB_REGION_16_17[rmu_idx], 0,
713 			MPC_RMU_SHAPER_RAMA_EXP_REGION0_LUT_OFFSET, curve[0].offset,
714 			MPC_RMU_SHAPER_RAMA_EXP_REGION0_NUM_SEGMENTS, curve[0].segments_num,
715 			MPC_RMU_SHAPER_RAMA_EXP_REGION1_LUT_OFFSET, curve[1].offset,
716 			MPC_RMU_SHAPER_RAMA_EXP_REGION1_NUM_SEGMENTS, curve[1].segments_num);
717 
718 	curve += 2;
719 	REG_SET_4(SHAPER_RAMB_REGION_18_19[rmu_idx], 0,
720 			MPC_RMU_SHAPER_RAMA_EXP_REGION0_LUT_OFFSET, curve[0].offset,
721 			MPC_RMU_SHAPER_RAMA_EXP_REGION0_NUM_SEGMENTS, curve[0].segments_num,
722 			MPC_RMU_SHAPER_RAMA_EXP_REGION1_LUT_OFFSET, curve[1].offset,
723 			MPC_RMU_SHAPER_RAMA_EXP_REGION1_NUM_SEGMENTS, curve[1].segments_num);
724 
725 	curve += 2;
726 	REG_SET_4(SHAPER_RAMB_REGION_20_21[rmu_idx], 0,
727 			MPC_RMU_SHAPER_RAMA_EXP_REGION0_LUT_OFFSET, curve[0].offset,
728 			MPC_RMU_SHAPER_RAMA_EXP_REGION0_NUM_SEGMENTS, curve[0].segments_num,
729 			MPC_RMU_SHAPER_RAMA_EXP_REGION1_LUT_OFFSET, curve[1].offset,
730 			MPC_RMU_SHAPER_RAMA_EXP_REGION1_NUM_SEGMENTS, curve[1].segments_num);
731 
732 	curve += 2;
733 	REG_SET_4(SHAPER_RAMB_REGION_22_23[rmu_idx], 0,
734 			MPC_RMU_SHAPER_RAMA_EXP_REGION0_LUT_OFFSET, curve[0].offset,
735 			MPC_RMU_SHAPER_RAMA_EXP_REGION0_NUM_SEGMENTS, curve[0].segments_num,
736 			MPC_RMU_SHAPER_RAMA_EXP_REGION1_LUT_OFFSET, curve[1].offset,
737 			MPC_RMU_SHAPER_RAMA_EXP_REGION1_NUM_SEGMENTS, curve[1].segments_num);
738 
739 	curve += 2;
740 	REG_SET_4(SHAPER_RAMB_REGION_24_25[rmu_idx], 0,
741 			MPC_RMU_SHAPER_RAMA_EXP_REGION0_LUT_OFFSET, curve[0].offset,
742 			MPC_RMU_SHAPER_RAMA_EXP_REGION0_NUM_SEGMENTS, curve[0].segments_num,
743 			MPC_RMU_SHAPER_RAMA_EXP_REGION1_LUT_OFFSET, curve[1].offset,
744 			MPC_RMU_SHAPER_RAMA_EXP_REGION1_NUM_SEGMENTS, curve[1].segments_num);
745 
746 	curve += 2;
747 	REG_SET_4(SHAPER_RAMB_REGION_26_27[rmu_idx], 0,
748 			MPC_RMU_SHAPER_RAMA_EXP_REGION0_LUT_OFFSET, curve[0].offset,
749 			MPC_RMU_SHAPER_RAMA_EXP_REGION0_NUM_SEGMENTS, curve[0].segments_num,
750 			MPC_RMU_SHAPER_RAMA_EXP_REGION1_LUT_OFFSET, curve[1].offset,
751 			MPC_RMU_SHAPER_RAMA_EXP_REGION1_NUM_SEGMENTS, curve[1].segments_num);
752 
753 	curve += 2;
754 	REG_SET_4(SHAPER_RAMB_REGION_28_29[rmu_idx], 0,
755 			MPC_RMU_SHAPER_RAMA_EXP_REGION0_LUT_OFFSET, curve[0].offset,
756 			MPC_RMU_SHAPER_RAMA_EXP_REGION0_NUM_SEGMENTS, curve[0].segments_num,
757 			MPC_RMU_SHAPER_RAMA_EXP_REGION1_LUT_OFFSET, curve[1].offset,
758 			MPC_RMU_SHAPER_RAMA_EXP_REGION1_NUM_SEGMENTS, curve[1].segments_num);
759 
760 	curve += 2;
761 	REG_SET_4(SHAPER_RAMB_REGION_30_31[rmu_idx], 0,
762 			MPC_RMU_SHAPER_RAMA_EXP_REGION0_LUT_OFFSET, curve[0].offset,
763 			MPC_RMU_SHAPER_RAMA_EXP_REGION0_NUM_SEGMENTS, curve[0].segments_num,
764 			MPC_RMU_SHAPER_RAMA_EXP_REGION1_LUT_OFFSET, curve[1].offset,
765 			MPC_RMU_SHAPER_RAMA_EXP_REGION1_NUM_SEGMENTS, curve[1].segments_num);
766 
767 	curve += 2;
768 	REG_SET_4(SHAPER_RAMB_REGION_32_33[rmu_idx], 0,
769 			MPC_RMU_SHAPER_RAMA_EXP_REGION0_LUT_OFFSET, curve[0].offset,
770 			MPC_RMU_SHAPER_RAMA_EXP_REGION0_NUM_SEGMENTS, curve[0].segments_num,
771 			MPC_RMU_SHAPER_RAMA_EXP_REGION1_LUT_OFFSET, curve[1].offset,
772 			MPC_RMU_SHAPER_RAMA_EXP_REGION1_NUM_SEGMENTS, curve[1].segments_num);
773 }
774 
775 
mpc3_program_shaper_lut(struct mpc * mpc,const struct pwl_result_data * rgb,uint32_t num,uint32_t rmu_idx)776 static void mpc3_program_shaper_lut(
777 		struct mpc *mpc,
778 		const struct pwl_result_data *rgb,
779 		uint32_t num,
780 		uint32_t rmu_idx)
781 {
782 	uint32_t i, red, green, blue;
783 	uint32_t  red_delta, green_delta, blue_delta;
784 	uint32_t  red_value, green_value, blue_value;
785 
786 	struct dcn30_mpc *mpc30 = TO_DCN30_MPC(mpc);
787 
788 	for (i = 0 ; i < num; i++) {
789 
790 		red   = rgb[i].red_reg;
791 		green = rgb[i].green_reg;
792 		blue  = rgb[i].blue_reg;
793 
794 		red_delta   = rgb[i].delta_red_reg;
795 		green_delta = rgb[i].delta_green_reg;
796 		blue_delta  = rgb[i].delta_blue_reg;
797 
798 		red_value   = ((red_delta   & 0x3ff) << 14) | (red   & 0x3fff);
799 		green_value = ((green_delta & 0x3ff) << 14) | (green & 0x3fff);
800 		blue_value  = ((blue_delta  & 0x3ff) << 14) | (blue  & 0x3fff);
801 
802 		REG_SET(SHAPER_LUT_DATA[rmu_idx], 0, MPC_RMU_SHAPER_LUT_DATA, red_value);
803 		REG_SET(SHAPER_LUT_DATA[rmu_idx], 0, MPC_RMU_SHAPER_LUT_DATA, green_value);
804 		REG_SET(SHAPER_LUT_DATA[rmu_idx], 0, MPC_RMU_SHAPER_LUT_DATA, blue_value);
805 	}
806 
807 }
808 
mpc3_power_on_shaper_3dlut(struct mpc * mpc,uint32_t rmu_idx,bool power_on)809 static void mpc3_power_on_shaper_3dlut(
810 		struct mpc *mpc,
811 		uint32_t rmu_idx,
812 	bool power_on)
813 {
814 	uint32_t power_status_shaper = 2;
815 	uint32_t power_status_3dlut  = 2;
816 	struct dcn30_mpc *mpc30 = TO_DCN30_MPC(mpc);
817 	int max_retries = 10;
818 
819 	if (rmu_idx == 0) {
820 		REG_SET(MPC_RMU_MEM_PWR_CTRL, 0,
821 			MPC_RMU0_MEM_PWR_DIS, power_on == true ? 1:0);
822 		/* wait for memory to fully power up */
823 		if (power_on && mpc->ctx->dc->debug.enable_mem_low_power.bits.mpc) {
824 			REG_WAIT(MPC_RMU_MEM_PWR_CTRL, MPC_RMU0_SHAPER_MEM_PWR_STATE, 0, 1, max_retries);
825 			REG_WAIT(MPC_RMU_MEM_PWR_CTRL, MPC_RMU0_3DLUT_MEM_PWR_STATE, 0, 1, max_retries);
826 		}
827 
828 		/*read status is not mandatory, it is just for debugging*/
829 		REG_GET(MPC_RMU_MEM_PWR_CTRL, MPC_RMU0_SHAPER_MEM_PWR_STATE, &power_status_shaper);
830 		REG_GET(MPC_RMU_MEM_PWR_CTRL, MPC_RMU0_3DLUT_MEM_PWR_STATE, &power_status_3dlut);
831 	} else if (rmu_idx == 1) {
832 		REG_SET(MPC_RMU_MEM_PWR_CTRL, 0,
833 			MPC_RMU1_MEM_PWR_DIS, power_on == true ? 1:0);
834 		if (power_on && mpc->ctx->dc->debug.enable_mem_low_power.bits.mpc) {
835 			REG_WAIT(MPC_RMU_MEM_PWR_CTRL, MPC_RMU1_SHAPER_MEM_PWR_STATE, 0, 1, max_retries);
836 			REG_WAIT(MPC_RMU_MEM_PWR_CTRL, MPC_RMU1_3DLUT_MEM_PWR_STATE, 0, 1, max_retries);
837 		}
838 
839 		REG_GET(MPC_RMU_MEM_PWR_CTRL, MPC_RMU1_SHAPER_MEM_PWR_STATE, &power_status_shaper);
840 		REG_GET(MPC_RMU_MEM_PWR_CTRL, MPC_RMU1_3DLUT_MEM_PWR_STATE, &power_status_3dlut);
841 	}
842 	/*TODO Add rmu_idx == 2 for SIENNA_CICHLID */
843 	if (power_status_shaper != 0 && power_on == true)
844 		BREAK_TO_DEBUGGER();
845 
846 	if (power_status_3dlut != 0 && power_on == true)
847 		BREAK_TO_DEBUGGER();
848 }
849 
850 
851 
mpc3_program_shaper(struct mpc * mpc,const struct pwl_params * params,uint32_t rmu_idx)852 bool mpc3_program_shaper(
853 		struct mpc *mpc,
854 		const struct pwl_params *params,
855 		uint32_t rmu_idx)
856 {
857 	enum dc_lut_mode current_mode;
858 	enum dc_lut_mode next_mode;
859 
860 	struct dcn30_mpc *mpc30 = TO_DCN30_MPC(mpc);
861 
862 	if (params == NULL) {
863 		REG_SET(SHAPER_CONTROL[rmu_idx], 0, MPC_RMU_SHAPER_LUT_MODE, 0);
864 		return false;
865 	}
866 
867 	if (mpc->ctx->dc->debug.enable_mem_low_power.bits.mpc)
868 		mpc3_power_on_shaper_3dlut(mpc, rmu_idx, true);
869 
870 	current_mode = mpc3_get_shaper_current(mpc, rmu_idx);
871 
872 	if (current_mode == LUT_BYPASS || current_mode == LUT_RAM_A)
873 		next_mode = LUT_RAM_B;
874 	else
875 		next_mode = LUT_RAM_A;
876 
877 	mpc3_configure_shaper_lut(mpc, next_mode == LUT_RAM_A, rmu_idx);
878 
879 	if (next_mode == LUT_RAM_A)
880 		mpc3_program_shaper_luta_settings(mpc, params, rmu_idx);
881 	else
882 		mpc3_program_shaper_lutb_settings(mpc, params, rmu_idx);
883 
884 	mpc3_program_shaper_lut(
885 			mpc, params->rgb_resulted, params->hw_points_num, rmu_idx);
886 
887 	REG_SET(SHAPER_CONTROL[rmu_idx], 0, MPC_RMU_SHAPER_LUT_MODE, next_mode == LUT_RAM_A ? 1:2);
888 	mpc3_power_on_shaper_3dlut(mpc, rmu_idx, false);
889 
890 	return true;
891 }
892 
mpc3_set_3dlut_mode(struct mpc * mpc,enum dc_lut_mode mode,bool is_color_channel_12bits,bool is_lut_size17x17x17,uint32_t rmu_idx)893 static void mpc3_set_3dlut_mode(
894 		struct mpc *mpc,
895 		enum dc_lut_mode mode,
896 		bool is_color_channel_12bits,
897 		bool is_lut_size17x17x17,
898 		uint32_t rmu_idx)
899 {
900 	uint32_t lut_mode;
901 	struct dcn30_mpc *mpc30 = TO_DCN30_MPC(mpc);
902 
903 	if (mode == LUT_BYPASS)
904 		lut_mode = 0;
905 	else if (mode == LUT_RAM_A)
906 		lut_mode = 1;
907 	else
908 		lut_mode = 2;
909 
910 	REG_UPDATE_2(RMU_3DLUT_MODE[rmu_idx],
911 			MPC_RMU_3DLUT_MODE, lut_mode,
912 			MPC_RMU_3DLUT_SIZE, is_lut_size17x17x17 == true ? 0 : 1);
913 }
914 
get3dlut_config(struct mpc * mpc,bool * is_17x17x17,bool * is_12bits_color_channel,int rmu_idx)915 static enum dc_lut_mode get3dlut_config(
916 			struct mpc *mpc,
917 			bool *is_17x17x17,
918 			bool *is_12bits_color_channel,
919 			int rmu_idx)
920 {
921 	uint32_t i_mode, i_enable_10bits, lut_size;
922 	enum dc_lut_mode mode;
923 	struct dcn30_mpc *mpc30 = TO_DCN30_MPC(mpc);
924 
925 	REG_GET(RMU_3DLUT_MODE[rmu_idx],
926 			MPC_RMU_3DLUT_MODE_CURRENT,  &i_mode);
927 
928 	REG_GET(RMU_3DLUT_READ_WRITE_CONTROL[rmu_idx],
929 			MPC_RMU_3DLUT_30BIT_EN, &i_enable_10bits);
930 
931 	switch (i_mode) {
932 	case 0:
933 		mode = LUT_BYPASS;
934 		break;
935 	case 1:
936 		mode = LUT_RAM_A;
937 		break;
938 	case 2:
939 		mode = LUT_RAM_B;
940 		break;
941 	default:
942 		mode = LUT_BYPASS;
943 		break;
944 	}
945 	if (i_enable_10bits > 0)
946 		*is_12bits_color_channel = false;
947 	else
948 		*is_12bits_color_channel = true;
949 
950 	REG_GET(RMU_3DLUT_MODE[rmu_idx], MPC_RMU_3DLUT_SIZE, &lut_size);
951 
952 	if (lut_size == 0)
953 		*is_17x17x17 = true;
954 	else
955 		*is_17x17x17 = false;
956 
957 	return mode;
958 }
959 
mpc3_select_3dlut_ram(struct mpc * mpc,enum dc_lut_mode mode,bool is_color_channel_12bits,uint32_t rmu_idx)960 static void mpc3_select_3dlut_ram(
961 		struct mpc *mpc,
962 		enum dc_lut_mode mode,
963 		bool is_color_channel_12bits,
964 		uint32_t rmu_idx)
965 {
966 	struct dcn30_mpc *mpc30 = TO_DCN30_MPC(mpc);
967 
968 	REG_UPDATE_2(RMU_3DLUT_READ_WRITE_CONTROL[rmu_idx],
969 		MPC_RMU_3DLUT_RAM_SEL, mode == LUT_RAM_A ? 0 : 1,
970 		MPC_RMU_3DLUT_30BIT_EN, is_color_channel_12bits == true ? 0:1);
971 }
972 
mpc3_select_3dlut_ram_mask(struct mpc * mpc,uint32_t ram_selection_mask,uint32_t rmu_idx)973 static void mpc3_select_3dlut_ram_mask(
974 		struct mpc *mpc,
975 		uint32_t ram_selection_mask,
976 		uint32_t rmu_idx)
977 {
978 	struct dcn30_mpc *mpc30 = TO_DCN30_MPC(mpc);
979 
980 	REG_UPDATE(RMU_3DLUT_READ_WRITE_CONTROL[rmu_idx], MPC_RMU_3DLUT_WRITE_EN_MASK,
981 			ram_selection_mask);
982 	REG_SET(RMU_3DLUT_INDEX[rmu_idx], 0, MPC_RMU_3DLUT_INDEX, 0);
983 }
984 
mpc3_set3dlut_ram12(struct mpc * mpc,const struct dc_rgb * lut,uint32_t entries,uint32_t rmu_idx)985 static void mpc3_set3dlut_ram12(
986 		struct mpc *mpc,
987 		const struct dc_rgb *lut,
988 		uint32_t entries,
989 		uint32_t rmu_idx)
990 {
991 	uint32_t i, red, green, blue, red1, green1, blue1;
992 	struct dcn30_mpc *mpc30 = TO_DCN30_MPC(mpc);
993 
994 	for (i = 0 ; i < entries; i += 2) {
995 		red   = lut[i].red<<4;
996 		green = lut[i].green<<4;
997 		blue  = lut[i].blue<<4;
998 		red1   = lut[i+1].red<<4;
999 		green1 = lut[i+1].green<<4;
1000 		blue1  = lut[i+1].blue<<4;
1001 
1002 		REG_SET_2(RMU_3DLUT_DATA[rmu_idx], 0,
1003 				MPC_RMU_3DLUT_DATA0, red,
1004 				MPC_RMU_3DLUT_DATA1, red1);
1005 
1006 		REG_SET_2(RMU_3DLUT_DATA[rmu_idx], 0,
1007 				MPC_RMU_3DLUT_DATA0, green,
1008 				MPC_RMU_3DLUT_DATA1, green1);
1009 
1010 		REG_SET_2(RMU_3DLUT_DATA[rmu_idx], 0,
1011 				MPC_RMU_3DLUT_DATA0, blue,
1012 				MPC_RMU_3DLUT_DATA1, blue1);
1013 	}
1014 }
1015 
mpc3_set3dlut_ram10(struct mpc * mpc,const struct dc_rgb * lut,uint32_t entries,uint32_t rmu_idx)1016 static void mpc3_set3dlut_ram10(
1017 		struct mpc *mpc,
1018 		const struct dc_rgb *lut,
1019 		uint32_t entries,
1020 		uint32_t rmu_idx)
1021 {
1022 	uint32_t i, red, green, blue, value;
1023 	struct dcn30_mpc *mpc30 = TO_DCN30_MPC(mpc);
1024 
1025 	for (i = 0; i < entries; i++) {
1026 		red   = lut[i].red;
1027 		green = lut[i].green;
1028 		blue  = lut[i].blue;
1029 		//should we shift red 22bit and green 12? ask Nvenko
1030 		value = (red<<20) | (green<<10) | blue;
1031 
1032 		REG_SET(RMU_3DLUT_DATA_30BIT[rmu_idx], 0, MPC_RMU_3DLUT_DATA_30BIT, value);
1033 	}
1034 
1035 }
1036 
1037 
mpc3_init_mpcc(struct mpcc * mpcc,int mpcc_inst)1038 void mpc3_init_mpcc(struct mpcc *mpcc, int mpcc_inst)
1039 {
1040 	mpcc->mpcc_id = mpcc_inst;
1041 	mpcc->dpp_id = 0xf;
1042 	mpcc->mpcc_bot = NULL;
1043 	mpcc->blnd_cfg.overlap_only = false;
1044 	mpcc->blnd_cfg.global_alpha = 0xff;
1045 	mpcc->blnd_cfg.global_gain = 0xff;
1046 	mpcc->blnd_cfg.background_color_bpc = 4;
1047 	mpcc->blnd_cfg.bottom_gain_mode = 0;
1048 	mpcc->blnd_cfg.top_gain = 0x1f000;
1049 	mpcc->blnd_cfg.bottom_inside_gain = 0x1f000;
1050 	mpcc->blnd_cfg.bottom_outside_gain = 0x1f000;
1051 	mpcc->sm_cfg.enable = false;
1052 	mpcc->shared_bottom = false;
1053 }
1054 
program_gamut_remap(struct dcn30_mpc * mpc30,int mpcc_id,const uint16_t * regval,int select)1055 static void program_gamut_remap(
1056 		struct dcn30_mpc *mpc30,
1057 		int mpcc_id,
1058 		const uint16_t *regval,
1059 		int select)
1060 {
1061 	uint16_t selection = 0;
1062 	struct color_matrices_reg gam_regs;
1063 
1064 	if (regval == NULL || select == GAMUT_REMAP_BYPASS) {
1065 		REG_SET(MPCC_GAMUT_REMAP_MODE[mpcc_id], 0,
1066 				MPCC_GAMUT_REMAP_MODE, GAMUT_REMAP_BYPASS);
1067 		return;
1068 	}
1069 	switch (select) {
1070 	case GAMUT_REMAP_COEFF:
1071 		selection = 1;
1072 		break;
1073 		/*this corresponds to GAMUT_REMAP coefficients set B
1074 		 * we don't have common coefficient sets in dcn3ag/dcn3
1075 		 */
1076 	case GAMUT_REMAP_COMA_COEFF:
1077 		selection = 2;
1078 		break;
1079 	default:
1080 		break;
1081 	}
1082 
1083 	gam_regs.shifts.csc_c11 = mpc30->mpc_shift->MPCC_GAMUT_REMAP_C11_A;
1084 	gam_regs.masks.csc_c11  = mpc30->mpc_mask->MPCC_GAMUT_REMAP_C11_A;
1085 	gam_regs.shifts.csc_c12 = mpc30->mpc_shift->MPCC_GAMUT_REMAP_C12_A;
1086 	gam_regs.masks.csc_c12 = mpc30->mpc_mask->MPCC_GAMUT_REMAP_C12_A;
1087 
1088 
1089 	if (select == GAMUT_REMAP_COEFF) {
1090 		gam_regs.csc_c11_c12 = REG(MPC_GAMUT_REMAP_C11_C12_A[mpcc_id]);
1091 		gam_regs.csc_c33_c34 = REG(MPC_GAMUT_REMAP_C33_C34_A[mpcc_id]);
1092 
1093 		cm_helper_program_color_matrices(
1094 				mpc30->base.ctx,
1095 				regval,
1096 				&gam_regs);
1097 
1098 	} else  if (select == GAMUT_REMAP_COMA_COEFF) {
1099 
1100 		gam_regs.csc_c11_c12 = REG(MPC_GAMUT_REMAP_C11_C12_B[mpcc_id]);
1101 		gam_regs.csc_c33_c34 = REG(MPC_GAMUT_REMAP_C33_C34_B[mpcc_id]);
1102 
1103 		cm_helper_program_color_matrices(
1104 				mpc30->base.ctx,
1105 				regval,
1106 				&gam_regs);
1107 
1108 	}
1109 	//select coefficient set to use
1110 	REG_SET(MPCC_GAMUT_REMAP_MODE[mpcc_id], 0,
1111 					MPCC_GAMUT_REMAP_MODE, selection);
1112 }
1113 
mpc3_set_gamut_remap(struct mpc * mpc,int mpcc_id,const struct mpc_grph_gamut_adjustment * adjust)1114 void mpc3_set_gamut_remap(
1115 		struct mpc *mpc,
1116 		int mpcc_id,
1117 		const struct mpc_grph_gamut_adjustment *adjust)
1118 {
1119 	struct dcn30_mpc *mpc30 = TO_DCN30_MPC(mpc);
1120 	int i = 0;
1121 	int gamut_mode;
1122 
1123 	if (adjust->gamut_adjust_type != GRAPHICS_GAMUT_ADJUST_TYPE_SW)
1124 		program_gamut_remap(mpc30, mpcc_id, NULL, GAMUT_REMAP_BYPASS);
1125 	else {
1126 		struct fixed31_32 arr_matrix[12];
1127 		uint16_t arr_reg_val[12];
1128 
1129 		for (i = 0; i < 12; i++)
1130 			arr_matrix[i] = adjust->temperature_matrix[i];
1131 
1132 		convert_float_matrix(
1133 			arr_reg_val, arr_matrix, 12);
1134 
1135 		//current coefficient set in use
1136 		REG_GET(MPCC_GAMUT_REMAP_MODE[mpcc_id], MPCC_GAMUT_REMAP_MODE_CURRENT, &gamut_mode);
1137 
1138 		if (gamut_mode == 0)
1139 			gamut_mode = 1; //use coefficient set A
1140 		else if (gamut_mode == 1)
1141 			gamut_mode = 2;
1142 		else
1143 			gamut_mode = 1;
1144 
1145 		program_gamut_remap(mpc30, mpcc_id, arr_reg_val, gamut_mode);
1146 	}
1147 }
1148 
mpc3_program_3dlut(struct mpc * mpc,const struct tetrahedral_params * params,int rmu_idx)1149 bool mpc3_program_3dlut(
1150 		struct mpc *mpc,
1151 		const struct tetrahedral_params *params,
1152 		int rmu_idx)
1153 {
1154 	enum dc_lut_mode mode;
1155 	bool is_17x17x17;
1156 	bool is_12bits_color_channel;
1157 	const struct dc_rgb *lut0;
1158 	const struct dc_rgb *lut1;
1159 	const struct dc_rgb *lut2;
1160 	const struct dc_rgb *lut3;
1161 	int lut_size0;
1162 	int lut_size;
1163 
1164 	if (params == NULL) {
1165 		mpc3_set_3dlut_mode(mpc, LUT_BYPASS, false, false, rmu_idx);
1166 		return false;
1167 	}
1168 	mpc3_power_on_shaper_3dlut(mpc, rmu_idx, true);
1169 
1170 	mode = get3dlut_config(mpc, &is_17x17x17, &is_12bits_color_channel, rmu_idx);
1171 
1172 	if (mode == LUT_BYPASS || mode == LUT_RAM_B)
1173 		mode = LUT_RAM_A;
1174 	else
1175 		mode = LUT_RAM_B;
1176 
1177 	is_17x17x17 = !params->use_tetrahedral_9;
1178 	is_12bits_color_channel = params->use_12bits;
1179 	if (is_17x17x17) {
1180 		lut0 = params->tetrahedral_17.lut0;
1181 		lut1 = params->tetrahedral_17.lut1;
1182 		lut2 = params->tetrahedral_17.lut2;
1183 		lut3 = params->tetrahedral_17.lut3;
1184 		lut_size0 = sizeof(params->tetrahedral_17.lut0)/
1185 					sizeof(params->tetrahedral_17.lut0[0]);
1186 		lut_size  = sizeof(params->tetrahedral_17.lut1)/
1187 					sizeof(params->tetrahedral_17.lut1[0]);
1188 	} else {
1189 		lut0 = params->tetrahedral_9.lut0;
1190 		lut1 = params->tetrahedral_9.lut1;
1191 		lut2 = params->tetrahedral_9.lut2;
1192 		lut3 = params->tetrahedral_9.lut3;
1193 		lut_size0 = sizeof(params->tetrahedral_9.lut0)/
1194 				sizeof(params->tetrahedral_9.lut0[0]);
1195 		lut_size  = sizeof(params->tetrahedral_9.lut1)/
1196 				sizeof(params->tetrahedral_9.lut1[0]);
1197 		}
1198 
1199 	mpc3_select_3dlut_ram(mpc, mode,
1200 				is_12bits_color_channel, rmu_idx);
1201 	mpc3_select_3dlut_ram_mask(mpc, 0x1, rmu_idx);
1202 	if (is_12bits_color_channel)
1203 		mpc3_set3dlut_ram12(mpc, lut0, lut_size0, rmu_idx);
1204 	else
1205 		mpc3_set3dlut_ram10(mpc, lut0, lut_size0, rmu_idx);
1206 
1207 	mpc3_select_3dlut_ram_mask(mpc, 0x2, rmu_idx);
1208 	if (is_12bits_color_channel)
1209 		mpc3_set3dlut_ram12(mpc, lut1, lut_size, rmu_idx);
1210 	else
1211 		mpc3_set3dlut_ram10(mpc, lut1, lut_size, rmu_idx);
1212 
1213 	mpc3_select_3dlut_ram_mask(mpc, 0x4, rmu_idx);
1214 	if (is_12bits_color_channel)
1215 		mpc3_set3dlut_ram12(mpc, lut2, lut_size, rmu_idx);
1216 	else
1217 		mpc3_set3dlut_ram10(mpc, lut2, lut_size, rmu_idx);
1218 
1219 	mpc3_select_3dlut_ram_mask(mpc, 0x8, rmu_idx);
1220 	if (is_12bits_color_channel)
1221 		mpc3_set3dlut_ram12(mpc, lut3, lut_size, rmu_idx);
1222 	else
1223 		mpc3_set3dlut_ram10(mpc, lut3, lut_size, rmu_idx);
1224 
1225 	mpc3_set_3dlut_mode(mpc, mode, is_12bits_color_channel,
1226 					is_17x17x17, rmu_idx);
1227 
1228 	if (mpc->ctx->dc->debug.enable_mem_low_power.bits.mpc)
1229 		mpc3_power_on_shaper_3dlut(mpc, rmu_idx, false);
1230 
1231 	return true;
1232 }
1233 
mpc3_set_output_csc(struct mpc * mpc,int opp_id,const uint16_t * regval,enum mpc_output_csc_mode ocsc_mode)1234 void mpc3_set_output_csc(
1235 		struct mpc *mpc,
1236 		int opp_id,
1237 		const uint16_t *regval,
1238 		enum mpc_output_csc_mode ocsc_mode)
1239 {
1240 	struct dcn30_mpc *mpc30 = TO_DCN30_MPC(mpc);
1241 	struct color_matrices_reg ocsc_regs;
1242 
1243 	REG_WRITE(MPC_OUT_CSC_COEF_FORMAT, 0);
1244 
1245 	REG_SET(CSC_MODE[opp_id], 0, MPC_OCSC_MODE, ocsc_mode);
1246 
1247 	if (ocsc_mode == MPC_OUTPUT_CSC_DISABLE)
1248 		return;
1249 
1250 	if (regval == NULL) {
1251 		BREAK_TO_DEBUGGER();
1252 		return;
1253 	}
1254 
1255 	ocsc_regs.shifts.csc_c11 = mpc30->mpc_shift->MPC_OCSC_C11_A;
1256 	ocsc_regs.masks.csc_c11  = mpc30->mpc_mask->MPC_OCSC_C11_A;
1257 	ocsc_regs.shifts.csc_c12 = mpc30->mpc_shift->MPC_OCSC_C12_A;
1258 	ocsc_regs.masks.csc_c12 = mpc30->mpc_mask->MPC_OCSC_C12_A;
1259 
1260 	if (ocsc_mode == MPC_OUTPUT_CSC_COEF_A) {
1261 		ocsc_regs.csc_c11_c12 = REG(CSC_C11_C12_A[opp_id]);
1262 		ocsc_regs.csc_c33_c34 = REG(CSC_C33_C34_A[opp_id]);
1263 	} else {
1264 		ocsc_regs.csc_c11_c12 = REG(CSC_C11_C12_B[opp_id]);
1265 		ocsc_regs.csc_c33_c34 = REG(CSC_C33_C34_B[opp_id]);
1266 	}
1267 	cm_helper_program_color_matrices(
1268 			mpc30->base.ctx,
1269 			regval,
1270 			&ocsc_regs);
1271 }
1272 
mpc3_set_ocsc_default(struct mpc * mpc,int opp_id,enum dc_color_space color_space,enum mpc_output_csc_mode ocsc_mode)1273 void mpc3_set_ocsc_default(
1274 		struct mpc *mpc,
1275 		int opp_id,
1276 		enum dc_color_space color_space,
1277 		enum mpc_output_csc_mode ocsc_mode)
1278 {
1279 	struct dcn30_mpc *mpc30 = TO_DCN30_MPC(mpc);
1280 	uint32_t arr_size;
1281 	struct color_matrices_reg ocsc_regs;
1282 	const uint16_t *regval = NULL;
1283 
1284 	REG_WRITE(MPC_OUT_CSC_COEF_FORMAT, 0);
1285 
1286 	REG_SET(CSC_MODE[opp_id], 0, MPC_OCSC_MODE, ocsc_mode);
1287 	if (ocsc_mode == MPC_OUTPUT_CSC_DISABLE)
1288 		return;
1289 
1290 	regval = find_color_matrix(color_space, &arr_size);
1291 
1292 	if (regval == NULL) {
1293 		BREAK_TO_DEBUGGER();
1294 		return;
1295 	}
1296 
1297 	ocsc_regs.shifts.csc_c11 = mpc30->mpc_shift->MPC_OCSC_C11_A;
1298 	ocsc_regs.masks.csc_c11  = mpc30->mpc_mask->MPC_OCSC_C11_A;
1299 	ocsc_regs.shifts.csc_c12 = mpc30->mpc_shift->MPC_OCSC_C12_A;
1300 	ocsc_regs.masks.csc_c12 = mpc30->mpc_mask->MPC_OCSC_C12_A;
1301 
1302 
1303 	if (ocsc_mode == MPC_OUTPUT_CSC_COEF_A) {
1304 		ocsc_regs.csc_c11_c12 = REG(CSC_C11_C12_A[opp_id]);
1305 		ocsc_regs.csc_c33_c34 = REG(CSC_C33_C34_A[opp_id]);
1306 	} else {
1307 		ocsc_regs.csc_c11_c12 = REG(CSC_C11_C12_B[opp_id]);
1308 		ocsc_regs.csc_c33_c34 = REG(CSC_C33_C34_B[opp_id]);
1309 	}
1310 
1311 	cm_helper_program_color_matrices(
1312 			mpc30->base.ctx,
1313 			regval,
1314 			&ocsc_regs);
1315 }
1316 
mpc3_set_rmu_mux(struct mpc * mpc,int rmu_idx,int value)1317 void mpc3_set_rmu_mux(
1318 	struct mpc *mpc,
1319 	int rmu_idx,
1320 	int value)
1321 {
1322 	struct dcn30_mpc *mpc30 = TO_DCN30_MPC(mpc);
1323 
1324 	if (rmu_idx == 0)
1325 		REG_UPDATE(MPC_RMU_CONTROL, MPC_RMU0_MUX, value);
1326 	else if (rmu_idx == 1)
1327 		REG_UPDATE(MPC_RMU_CONTROL, MPC_RMU1_MUX, value);
1328 
1329 }
1330 
mpc3_get_rmu_mux_status(struct mpc * mpc,int rmu_idx)1331 uint32_t mpc3_get_rmu_mux_status(
1332 	struct mpc *mpc,
1333 	int rmu_idx)
1334 {
1335 	uint32_t status = 0xf;
1336 	struct dcn30_mpc *mpc30 = TO_DCN30_MPC(mpc);
1337 
1338 	if (rmu_idx == 0)
1339 		REG_GET(MPC_RMU_CONTROL, MPC_RMU0_MUX_STATUS, &status);
1340 	else if (rmu_idx == 1)
1341 		REG_GET(MPC_RMU_CONTROL, MPC_RMU1_MUX_STATUS, &status);
1342 
1343 	return status;
1344 }
1345 
mpcc3_acquire_rmu(struct mpc * mpc,int mpcc_id,int rmu_idx)1346 uint32_t mpcc3_acquire_rmu(struct mpc *mpc, int mpcc_id, int rmu_idx)
1347 {
1348 	uint32_t rmu_status;
1349 
1350 	//determine if this mpcc is already multiplexed to an RMU unit
1351 	rmu_status = mpc3_get_rmu_mux_status(mpc, rmu_idx);
1352 	if (rmu_status == mpcc_id)
1353 		//return rmu_idx of pre_acquired rmu unit
1354 		return rmu_idx;
1355 
1356 	if (rmu_status == 0xf) {//rmu unit is disabled
1357 		mpc3_set_rmu_mux(mpc, rmu_idx, mpcc_id);
1358 		return rmu_idx;
1359 	}
1360 
1361 	//no vacant RMU units or invalid parameters acquire_post_bldn_3dlut
1362 	return -1;
1363 }
1364 
mpcc3_release_rmu(struct mpc * mpc,int mpcc_id)1365 static int mpcc3_release_rmu(struct mpc *mpc, int mpcc_id)
1366 {
1367 	struct dcn30_mpc *mpc30 = TO_DCN30_MPC(mpc);
1368 	int rmu_idx;
1369 	uint32_t rmu_status;
1370 	int released_rmu = -1;
1371 
1372 	for (rmu_idx = 0; rmu_idx < mpc30->num_rmu; rmu_idx++) {
1373 		rmu_status = mpc3_get_rmu_mux_status(mpc, rmu_idx);
1374 		if (rmu_status == mpcc_id) {
1375 			mpc3_set_rmu_mux(mpc, rmu_idx, 0xf);
1376 			released_rmu = rmu_idx;
1377 			break;
1378 		}
1379 	}
1380 	return released_rmu;
1381 
1382 }
1383 
mpc3_set_mpc_mem_lp_mode(struct mpc * mpc)1384 static void mpc3_set_mpc_mem_lp_mode(struct mpc *mpc)
1385 {
1386 	struct dcn30_mpc *mpc30 = TO_DCN30_MPC(mpc);
1387 	int mpcc_id;
1388 
1389 	if (mpc->ctx->dc->debug.enable_mem_low_power.bits.mpc) {
1390 		if (mpc30->mpc_mask->MPC_RMU0_MEM_LOW_PWR_MODE && mpc30->mpc_mask->MPC_RMU1_MEM_LOW_PWR_MODE) {
1391 			REG_UPDATE(MPC_RMU_MEM_PWR_CTRL, MPC_RMU0_MEM_LOW_PWR_MODE, 3);
1392 			REG_UPDATE(MPC_RMU_MEM_PWR_CTRL, MPC_RMU1_MEM_LOW_PWR_MODE, 3);
1393 		}
1394 
1395 		if (mpc30->mpc_mask->MPCC_OGAM_MEM_LOW_PWR_MODE) {
1396 			for (mpcc_id = 0; mpcc_id < mpc30->num_mpcc; mpcc_id++)
1397 				REG_UPDATE(MPCC_MEM_PWR_CTRL[mpcc_id], MPCC_OGAM_MEM_LOW_PWR_MODE, 3);
1398 		}
1399 	}
1400 }
1401 
1402 static const struct mpc_funcs dcn30_mpc_funcs = {
1403 	.read_mpcc_state = mpc1_read_mpcc_state,
1404 	.insert_plane = mpc1_insert_plane,
1405 	.remove_mpcc = mpc1_remove_mpcc,
1406 	.mpc_init = mpc1_mpc_init,
1407 	.mpc_init_single_inst = mpc1_mpc_init_single_inst,
1408 	.update_blending = mpc2_update_blending,
1409 	.cursor_lock = mpc1_cursor_lock,
1410 	.get_mpcc_for_dpp = mpc1_get_mpcc_for_dpp,
1411 	.wait_for_idle = mpc2_assert_idle_mpcc,
1412 	.assert_mpcc_idle_before_connect = mpc2_assert_mpcc_idle_before_connect,
1413 	.init_mpcc_list_from_hw = mpc1_init_mpcc_list_from_hw,
1414 	.set_denorm =  mpc3_set_denorm,
1415 	.set_denorm_clamp = mpc3_set_denorm_clamp,
1416 	.set_output_csc = mpc3_set_output_csc,
1417 	.set_ocsc_default = mpc3_set_ocsc_default,
1418 	.set_output_gamma = mpc3_set_output_gamma,
1419 	.insert_plane_to_secondary = NULL,
1420 	.remove_mpcc_from_secondary =  NULL,
1421 	.set_dwb_mux = mpc3_set_dwb_mux,
1422 	.disable_dwb_mux = mpc3_disable_dwb_mux,
1423 	.is_dwb_idle = mpc3_is_dwb_idle,
1424 	.set_out_rate_control = mpc3_set_out_rate_control,
1425 	.set_gamut_remap = mpc3_set_gamut_remap,
1426 	.program_shaper = mpc3_program_shaper,
1427 	.acquire_rmu = mpcc3_acquire_rmu,
1428 	.program_3dlut = mpc3_program_3dlut,
1429 	.release_rmu = mpcc3_release_rmu,
1430 	.power_on_mpc_mem_pwr = mpc3_power_on_ogam_lut,
1431 	.get_mpc_out_mux = mpc1_get_mpc_out_mux,
1432 	.set_bg_color = mpc1_set_bg_color,
1433 	.set_mpc_mem_lp_mode = mpc3_set_mpc_mem_lp_mode,
1434 };
1435 
dcn30_mpc_construct(struct dcn30_mpc * mpc30,struct dc_context * ctx,const struct dcn30_mpc_registers * mpc_regs,const struct dcn30_mpc_shift * mpc_shift,const struct dcn30_mpc_mask * mpc_mask,int num_mpcc,int num_rmu)1436 void dcn30_mpc_construct(struct dcn30_mpc *mpc30,
1437 	struct dc_context *ctx,
1438 	const struct dcn30_mpc_registers *mpc_regs,
1439 	const struct dcn30_mpc_shift *mpc_shift,
1440 	const struct dcn30_mpc_mask *mpc_mask,
1441 	int num_mpcc,
1442 	int num_rmu)
1443 {
1444 	int i;
1445 
1446 	mpc30->base.ctx = ctx;
1447 
1448 	mpc30->base.funcs = &dcn30_mpc_funcs;
1449 
1450 	mpc30->mpc_regs = mpc_regs;
1451 	mpc30->mpc_shift = mpc_shift;
1452 	mpc30->mpc_mask = mpc_mask;
1453 
1454 	mpc30->mpcc_in_use_mask = 0;
1455 	mpc30->num_mpcc = num_mpcc;
1456 	mpc30->num_rmu = num_rmu;
1457 
1458 	for (i = 0; i < MAX_MPCC; i++)
1459 		mpc3_init_mpcc(&mpc30->base.mpcc_array[i], i);
1460 }
1461 
1462