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 
27 #include "dm_services.h"
28 #include "dm_helpers.h"
29 #include "core_types.h"
30 #include "resource.h"
31 #include "dcn30_hwseq.h"
32 #include "dccg.h"
33 #include "dce/dce_hwseq.h"
34 #include "dcn30_mpc.h"
35 #include "dcn30_dpp.h"
36 #include "dcn10/dcn10_cm_common.h"
37 #include "dcn30_cm_common.h"
38 #include "reg_helper.h"
39 #include "abm.h"
40 #include "clk_mgr.h"
41 #include "hubp.h"
42 #include "dchubbub.h"
43 #include "timing_generator.h"
44 #include "opp.h"
45 #include "ipp.h"
46 #include "mpc.h"
47 #include "mcif_wb.h"
48 #include "dc_dmub_srv.h"
49 #include "link_hwss.h"
50 #include "dpcd_defs.h"
51 
52 
53 
54 
55 #define DC_LOGGER_INIT(logger)
56 
57 #define CTX \
58 	hws->ctx
59 #define REG(reg)\
60 	hws->regs->reg
61 #define DC_LOGGER \
62 		dc->ctx->logger
63 
64 
65 #undef FN
66 #define FN(reg_name, field_name) \
67 	hws->shifts->field_name, hws->masks->field_name
68 
69 bool dcn30_set_blend_lut(
70 	struct pipe_ctx *pipe_ctx, const struct dc_plane_state *plane_state)
71 {
72 	struct dpp *dpp_base = pipe_ctx->plane_res.dpp;
73 	bool result = true;
74 	struct pwl_params *blend_lut = NULL;
75 
76 	if (plane_state->blend_tf) {
77 		if (plane_state->blend_tf->type == TF_TYPE_HWPWL)
78 			blend_lut = &plane_state->blend_tf->pwl;
79 		else if (plane_state->blend_tf->type == TF_TYPE_DISTRIBUTED_POINTS) {
80 			cm3_helper_translate_curve_to_hw_format(
81 					plane_state->blend_tf, &dpp_base->regamma_params, false);
82 			blend_lut = &dpp_base->regamma_params;
83 		}
84 	}
85 	result = dpp_base->funcs->dpp_program_blnd_lut(dpp_base, blend_lut);
86 
87 	return result;
88 }
89 
90 static bool dcn30_set_mpc_shaper_3dlut(
91 	struct pipe_ctx *pipe_ctx, const struct dc_stream_state *stream)
92 {
93 	struct dpp *dpp_base = pipe_ctx->plane_res.dpp;
94 	int mpcc_id = pipe_ctx->plane_res.hubp->inst;
95 	struct mpc *mpc = pipe_ctx->stream_res.opp->ctx->dc->res_pool->mpc;
96 	bool result = false;
97 	int acquired_rmu = 0;
98 	int mpcc_id_projected = 0;
99 
100 	const struct pwl_params *shaper_lut = NULL;
101 	//get the shaper lut params
102 	if (stream->func_shaper) {
103 		if (stream->func_shaper->type == TF_TYPE_HWPWL)
104 			shaper_lut = &stream->func_shaper->pwl;
105 		else if (stream->func_shaper->type == TF_TYPE_DISTRIBUTED_POINTS) {
106 			cm_helper_translate_curve_to_hw_format(
107 					stream->func_shaper,
108 					&dpp_base->shaper_params, true);
109 			shaper_lut = &dpp_base->shaper_params;
110 		}
111 	}
112 
113 	if (stream->lut3d_func &&
114 		stream->lut3d_func->state.bits.initialized == 1 &&
115 		stream->lut3d_func->state.bits.rmu_idx_valid == 1) {
116 		if (stream->lut3d_func->state.bits.rmu_mux_num == 0)
117 			mpcc_id_projected = stream->lut3d_func->state.bits.mpc_rmu0_mux;
118 		else if (stream->lut3d_func->state.bits.rmu_mux_num == 1)
119 			mpcc_id_projected = stream->lut3d_func->state.bits.mpc_rmu1_mux;
120 		else if (stream->lut3d_func->state.bits.rmu_mux_num == 2)
121 			mpcc_id_projected = stream->lut3d_func->state.bits.mpc_rmu2_mux;
122 		if (mpcc_id_projected != mpcc_id)
123 			BREAK_TO_DEBUGGER();
124 		/*find the reason why logical layer assigned a differant mpcc_id into acquire_post_bldn_3dlut*/
125 		acquired_rmu = mpc->funcs->acquire_rmu(mpc, mpcc_id,
126 				stream->lut3d_func->state.bits.rmu_mux_num);
127 		if (acquired_rmu != stream->lut3d_func->state.bits.rmu_mux_num)
128 			BREAK_TO_DEBUGGER();
129 		result = mpc->funcs->program_3dlut(mpc,
130 								&stream->lut3d_func->lut_3d,
131 								stream->lut3d_func->state.bits.rmu_mux_num);
132 		result = mpc->funcs->program_shaper(mpc, shaper_lut,
133 				stream->lut3d_func->state.bits.rmu_mux_num);
134 	} else
135 		/*loop through the available mux and release the requested mpcc_id*/
136 		mpc->funcs->release_rmu(mpc, mpcc_id);
137 
138 
139 	return result;
140 }
141 
142 bool dcn30_set_input_transfer_func(struct dc *dc,
143 				struct pipe_ctx *pipe_ctx,
144 				const struct dc_plane_state *plane_state)
145 {
146 	struct dce_hwseq *hws = dc->hwseq;
147 	struct dpp *dpp_base = pipe_ctx->plane_res.dpp;
148 	enum dc_transfer_func_predefined tf;
149 	bool result = true;
150 	struct pwl_params *params = NULL;
151 
152 	if (dpp_base == NULL || plane_state == NULL)
153 		return false;
154 
155 	tf = TRANSFER_FUNCTION_UNITY;
156 
157 	if (plane_state->in_transfer_func &&
158 		plane_state->in_transfer_func->type == TF_TYPE_PREDEFINED)
159 		tf = plane_state->in_transfer_func->tf;
160 
161 	dpp_base->funcs->dpp_set_pre_degam(dpp_base, tf);
162 
163 	if (plane_state->in_transfer_func) {
164 		if (plane_state->in_transfer_func->type == TF_TYPE_HWPWL)
165 			params = &plane_state->in_transfer_func->pwl;
166 		else if (plane_state->in_transfer_func->type == TF_TYPE_DISTRIBUTED_POINTS &&
167 			cm3_helper_translate_curve_to_hw_format(plane_state->in_transfer_func,
168 					&dpp_base->degamma_params, false))
169 			params = &dpp_base->degamma_params;
170 	}
171 
172 	result = dpp_base->funcs->dpp_program_gamcor_lut(dpp_base, params);
173 
174 	if (pipe_ctx->stream_res.opp && pipe_ctx->stream_res.opp->ctx) {
175 		if (dpp_base->funcs->dpp_program_blnd_lut)
176 			hws->funcs.set_blend_lut(pipe_ctx, plane_state);
177 		if (dpp_base->funcs->dpp_program_shaper_lut &&
178 				dpp_base->funcs->dpp_program_3dlut)
179 			hws->funcs.set_shaper_3dlut(pipe_ctx, plane_state);
180 	}
181 
182 	return result;
183 }
184 
185 bool dcn30_set_output_transfer_func(struct dc *dc,
186 				struct pipe_ctx *pipe_ctx,
187 				const struct dc_stream_state *stream)
188 {
189 	int mpcc_id = pipe_ctx->plane_res.hubp->inst;
190 	struct mpc *mpc = pipe_ctx->stream_res.opp->ctx->dc->res_pool->mpc;
191 	struct pwl_params *params = NULL;
192 	bool ret = false;
193 
194 	/* program OGAM or 3DLUT only for the top pipe*/
195 	if (pipe_ctx->top_pipe == NULL) {
196 		/*program rmu shaper and 3dlut in MPC*/
197 		ret = dcn30_set_mpc_shaper_3dlut(pipe_ctx, stream);
198 		if (ret == false && mpc->funcs->set_output_gamma && stream->out_transfer_func) {
199 			if (stream->out_transfer_func->type == TF_TYPE_HWPWL)
200 				params = &stream->out_transfer_func->pwl;
201 			else if (pipe_ctx->stream->out_transfer_func->type ==
202 					TF_TYPE_DISTRIBUTED_POINTS &&
203 					cm3_helper_translate_curve_to_hw_format(
204 					stream->out_transfer_func,
205 					&mpc->blender_params, false))
206 				params = &mpc->blender_params;
207 			 /* there are no ROM LUTs in OUTGAM */
208 			if (stream->out_transfer_func->type == TF_TYPE_PREDEFINED)
209 				BREAK_TO_DEBUGGER();
210 		}
211 	}
212 
213 	mpc->funcs->set_output_gamma(mpc, mpcc_id, params);
214 	return ret;
215 }
216 
217 static void dcn30_set_writeback(
218 		struct dc *dc,
219 		struct dc_writeback_info *wb_info,
220 		struct dc_state *context)
221 {
222 	struct mcif_wb *mcif_wb;
223 	struct mcif_buf_params *mcif_buf_params;
224 
225 	ASSERT(wb_info->dwb_pipe_inst < MAX_DWB_PIPES);
226 	ASSERT(wb_info->wb_enabled);
227 	ASSERT(wb_info->mpcc_inst >= 0);
228 	ASSERT(wb_info->mpcc_inst < dc->res_pool->mpcc_count);
229 	mcif_wb = dc->res_pool->mcif_wb[wb_info->dwb_pipe_inst];
230 	mcif_buf_params = &wb_info->mcif_buf_params;
231 
232 	/* set DWB MPC mux */
233 	dc->res_pool->mpc->funcs->set_dwb_mux(dc->res_pool->mpc,
234 			wb_info->dwb_pipe_inst, wb_info->mpcc_inst);
235 	/* set MCIF_WB buffer and arbitration configuration */
236 	mcif_wb->funcs->config_mcif_buf(mcif_wb, mcif_buf_params, wb_info->dwb_params.dest_height);
237 	mcif_wb->funcs->config_mcif_arb(mcif_wb, &context->bw_ctx.bw.dcn.bw_writeback.mcif_wb_arb[wb_info->dwb_pipe_inst]);
238 }
239 
240 void dcn30_update_writeback(
241 		struct dc *dc,
242 		struct dc_writeback_info *wb_info,
243 		struct dc_state *context)
244 {
245 	struct dwbc *dwb;
246 	dwb = dc->res_pool->dwbc[wb_info->dwb_pipe_inst];
247 	DC_LOG_DWB("%s dwb_pipe_inst = %d, mpcc_inst = %d",\
248 		__func__, wb_info->dwb_pipe_inst,\
249 		wb_info->mpcc_inst);
250 
251 	dcn30_set_writeback(dc, wb_info, context);
252 
253 	/* update DWB */
254 	dwb->funcs->update(dwb, &wb_info->dwb_params);
255 }
256 
257 bool dcn30_mmhubbub_warmup(
258 	struct dc *dc,
259 	unsigned int num_dwb,
260 	struct dc_writeback_info *wb_info)
261 {
262 	struct dwbc *dwb;
263 	struct mcif_wb *mcif_wb;
264 	struct mcif_warmup_params warmup_params = {0};
265 	unsigned int  i, i_buf;
266 	/*make sure there is no active DWB eanbled */
267 	for (i = 0; i < num_dwb; i++) {
268 		dwb = dc->res_pool->dwbc[wb_info[i].dwb_pipe_inst];
269 		if (dwb->dwb_is_efc_transition || dwb->dwb_is_drc) {
270 			/*can not do warmup while any dwb enabled*/
271 			return false;
272 		}
273 	}
274 
275 	if (wb_info->mcif_warmup_params.p_vmid == 0)
276 		return false;
277 
278 	/*check whether this is new interface: warmup big buffer once*/
279 	if (wb_info->mcif_warmup_params.start_address.quad_part != 0 &&
280 		wb_info->mcif_warmup_params.region_size != 0) {
281 		/*mmhubbub is shared, so it does not matter which MCIF*/
282 		mcif_wb = dc->res_pool->mcif_wb[0];
283 		/*warmup a big chunk of VM buffer at once*/
284 		warmup_params.start_address.quad_part = wb_info->mcif_warmup_params.start_address.quad_part;
285 		warmup_params.address_increment =  wb_info->mcif_warmup_params.region_size;
286 		warmup_params.region_size = wb_info->mcif_warmup_params.region_size;
287 		warmup_params.p_vmid = wb_info->mcif_warmup_params.p_vmid;
288 
289 		if (warmup_params.address_increment == 0)
290 			warmup_params.address_increment = dc->dml.soc.vmm_page_size_bytes;
291 
292 		mcif_wb->funcs->warmup_mcif(mcif_wb, &warmup_params);
293 		return true;
294 	}
295 	/*following is the original: warmup each DWB's mcif buffer*/
296 	for (i = 0; i < num_dwb; i++) {
297 		dwb = dc->res_pool->dwbc[wb_info[i].dwb_pipe_inst];
298 		mcif_wb = dc->res_pool->mcif_wb[wb_info[i].dwb_pipe_inst];
299 		/*warmup is for VM mode only*/
300 		if (wb_info[i].mcif_buf_params.p_vmid == 0)
301 			return false;
302 
303 		/* Warmup MCIF_WB */
304 		for (i_buf = 0; i_buf < MCIF_BUF_COUNT; i_buf++) {
305 			warmup_params.start_address.quad_part = wb_info[i].mcif_buf_params.luma_address[i_buf];
306 			warmup_params.address_increment = dc->dml.soc.vmm_page_size_bytes;
307 			warmup_params.region_size = wb_info[i].mcif_buf_params.luma_pitch * wb_info[i].dwb_params.dest_height;
308 			warmup_params.p_vmid = wb_info[i].mcif_buf_params.p_vmid;
309 			mcif_wb->funcs->warmup_mcif(mcif_wb, &warmup_params);
310 		}
311 	}
312 	return true;
313 }
314 
315 void dcn30_enable_writeback(
316 		struct dc *dc,
317 		struct dc_writeback_info *wb_info,
318 		struct dc_state *context)
319 {
320 	struct dwbc *dwb;
321 	struct mcif_wb *mcif_wb;
322 	struct timing_generator *optc;
323 
324 	dwb = dc->res_pool->dwbc[wb_info->dwb_pipe_inst];
325 	mcif_wb = dc->res_pool->mcif_wb[wb_info->dwb_pipe_inst];
326 
327 	/* set the OPTC source mux */
328 	optc = dc->res_pool->timing_generators[dwb->otg_inst];
329 	DC_LOG_DWB("%s dwb_pipe_inst = %d, mpcc_inst = %d",\
330 		__func__, wb_info->dwb_pipe_inst,\
331 		wb_info->mpcc_inst);
332 	if (IS_DIAG_DC(dc->ctx->dce_environment)) {
333 		/*till diags switch to warmup interface*/
334 		dcn30_mmhubbub_warmup(dc, 1, wb_info);
335 	}
336 	/* Update writeback pipe */
337 	dcn30_set_writeback(dc, wb_info, context);
338 
339 	/* Enable MCIF_WB */
340 	mcif_wb->funcs->enable_mcif(mcif_wb);
341 	/* Enable DWB */
342 	dwb->funcs->enable(dwb, &wb_info->dwb_params);
343 }
344 
345 void dcn30_disable_writeback(
346 		struct dc *dc,
347 		unsigned int dwb_pipe_inst)
348 {
349 	struct dwbc *dwb;
350 	struct mcif_wb *mcif_wb;
351 
352 	ASSERT(dwb_pipe_inst < MAX_DWB_PIPES);
353 	dwb = dc->res_pool->dwbc[dwb_pipe_inst];
354 	mcif_wb = dc->res_pool->mcif_wb[dwb_pipe_inst];
355 	DC_LOG_DWB("%s dwb_pipe_inst = %d",\
356 		__func__, dwb_pipe_inst);
357 
358 	/* disable DWB */
359 	dwb->funcs->disable(dwb);
360 	/* disable MCIF */
361 	mcif_wb->funcs->disable_mcif(mcif_wb);
362 	/* disable MPC DWB mux */
363 	dc->res_pool->mpc->funcs->disable_dwb_mux(dc->res_pool->mpc, dwb_pipe_inst);
364 }
365 
366 void dcn30_program_all_writeback_pipes_in_tree(
367 		struct dc *dc,
368 		const struct dc_stream_state *stream,
369 		struct dc_state *context)
370 {
371 	struct dc_writeback_info wb_info;
372 	struct dwbc *dwb;
373 	struct dc_stream_status *stream_status = NULL;
374 	int i_wb, i_pipe, i_stream;
375 	DC_LOG_DWB("%s", __func__);
376 
377 	ASSERT(stream);
378 	for (i_stream = 0; i_stream < context->stream_count; i_stream++) {
379 		if (context->streams[i_stream] == stream) {
380 			stream_status = &context->stream_status[i_stream];
381 			break;
382 		}
383 	}
384 	ASSERT(stream_status);
385 
386 	ASSERT(stream->num_wb_info <= dc->res_pool->res_cap->num_dwb);
387 	/* For each writeback pipe */
388 	for (i_wb = 0; i_wb < stream->num_wb_info; i_wb++) {
389 
390 		/* copy writeback info to local non-const so mpcc_inst can be set */
391 		wb_info = stream->writeback_info[i_wb];
392 		if (wb_info.wb_enabled) {
393 
394 			/* get the MPCC instance for writeback_source_plane */
395 			wb_info.mpcc_inst = -1;
396 			for (i_pipe = 0; i_pipe < dc->res_pool->pipe_count; i_pipe++) {
397 				struct pipe_ctx *pipe_ctx = &context->res_ctx.pipe_ctx[i_pipe];
398 
399 				if (pipe_ctx->plane_state == wb_info.writeback_source_plane) {
400 					wb_info.mpcc_inst = pipe_ctx->plane_res.mpcc_inst;
401 					break;
402 				}
403 			}
404 			ASSERT(wb_info.mpcc_inst != -1);
405 
406 			ASSERT(wb_info.dwb_pipe_inst < dc->res_pool->res_cap->num_dwb);
407 			dwb = dc->res_pool->dwbc[wb_info.dwb_pipe_inst];
408 			if (dwb->funcs->is_enabled(dwb)) {
409 				/* writeback pipe already enabled, only need to update */
410 				dc->hwss.update_writeback(dc, &wb_info, context);
411 			} else {
412 				/* Enable writeback pipe and connect to MPCC */
413 				dc->hwss.enable_writeback(dc, &wb_info, context);
414 			}
415 		} else {
416 			/* Disable writeback pipe and disconnect from MPCC */
417 			dc->hwss.disable_writeback(dc, wb_info.dwb_pipe_inst);
418 		}
419 	}
420 }
421 
422 void dcn30_init_hw(struct dc *dc)
423 {
424 	int i, j;
425 	struct abm **abms = dc->res_pool->multiple_abms;
426 	struct dce_hwseq *hws = dc->hwseq;
427 	struct dc_bios *dcb = dc->ctx->dc_bios;
428 	struct resource_pool *res_pool = dc->res_pool;
429 	uint32_t backlight = MAX_BACKLIGHT_LEVEL;
430 
431 	if (dc->clk_mgr && dc->clk_mgr->funcs->init_clocks)
432 		dc->clk_mgr->funcs->init_clocks(dc->clk_mgr);
433 
434 	// Initialize the dccg
435 	if (res_pool->dccg->funcs->dccg_init)
436 		res_pool->dccg->funcs->dccg_init(res_pool->dccg);
437 
438 	if (IS_FPGA_MAXIMUS_DC(dc->ctx->dce_environment)) {
439 
440 		REG_WRITE(REFCLK_CNTL, 0);
441 		REG_UPDATE(DCHUBBUB_GLOBAL_TIMER_CNTL, DCHUBBUB_GLOBAL_TIMER_ENABLE, 1);
442 		REG_WRITE(DIO_MEM_PWR_CTRL, 0);
443 
444 		if (!dc->debug.disable_clock_gate) {
445 			/* enable all DCN clock gating */
446 			REG_WRITE(DCCG_GATE_DISABLE_CNTL, 0);
447 
448 			REG_WRITE(DCCG_GATE_DISABLE_CNTL2, 0);
449 
450 			REG_UPDATE(DCFCLK_CNTL, DCFCLK_GATE_DIS, 0);
451 		}
452 
453 		//Enable ability to power gate / don't force power on permanently
454 		if (hws->funcs.enable_power_gating_plane)
455 			hws->funcs.enable_power_gating_plane(hws, true);
456 
457 		return;
458 	}
459 
460 	if (!dcb->funcs->is_accelerated_mode(dcb)) {
461 		hws->funcs.bios_golden_init(dc);
462 		hws->funcs.disable_vga(dc->hwseq);
463 	}
464 
465 	if (dc->debug.enable_mem_low_power.bits.dmcu) {
466 		// Force ERAM to shutdown if DMCU is not enabled
467 		if (dc->debug.disable_dmcu || dc->config.disable_dmcu) {
468 			REG_UPDATE(DMU_MEM_PWR_CNTL, DMCU_ERAM_MEM_PWR_FORCE, 3);
469 		}
470 	}
471 
472 	// Set default OPTC memory power states
473 	if (dc->debug.enable_mem_low_power.bits.optc) {
474 		// Shutdown when unassigned and light sleep in VBLANK
475 		REG_SET_2(ODM_MEM_PWR_CTRL3, 0, ODM_MEM_UNASSIGNED_PWR_MODE, 3, ODM_MEM_VBLANK_PWR_MODE, 1);
476 	}
477 
478 	if (dc->ctx->dc_bios->fw_info_valid) {
479 		res_pool->ref_clocks.xtalin_clock_inKhz =
480 				dc->ctx->dc_bios->fw_info.pll_info.crystal_frequency;
481 
482 		if (!IS_FPGA_MAXIMUS_DC(dc->ctx->dce_environment)) {
483 			if (res_pool->dccg && res_pool->hubbub) {
484 
485 				(res_pool->dccg->funcs->get_dccg_ref_freq)(res_pool->dccg,
486 						dc->ctx->dc_bios->fw_info.pll_info.crystal_frequency,
487 						&res_pool->ref_clocks.dccg_ref_clock_inKhz);
488 
489 				(res_pool->hubbub->funcs->get_dchub_ref_freq)(res_pool->hubbub,
490 						res_pool->ref_clocks.dccg_ref_clock_inKhz,
491 						&res_pool->ref_clocks.dchub_ref_clock_inKhz);
492 			} else {
493 				// Not all ASICs have DCCG sw component
494 				res_pool->ref_clocks.dccg_ref_clock_inKhz =
495 						res_pool->ref_clocks.xtalin_clock_inKhz;
496 				res_pool->ref_clocks.dchub_ref_clock_inKhz =
497 						res_pool->ref_clocks.xtalin_clock_inKhz;
498 			}
499 		}
500 	} else
501 		ASSERT_CRITICAL(false);
502 
503 	for (i = 0; i < dc->link_count; i++) {
504 		/* Power up AND update implementation according to the
505 		 * required signal (which may be different from the
506 		 * default signal on connector).
507 		 */
508 		struct dc_link *link = dc->links[i];
509 
510 		link->link_enc->funcs->hw_init(link->link_enc);
511 
512 		/* Check for enabled DIG to identify enabled display */
513 		if (link->link_enc->funcs->is_dig_enabled &&
514 			link->link_enc->funcs->is_dig_enabled(link->link_enc))
515 			link->link_status.link_active = true;
516 	}
517 
518 	/* Power gate DSCs */
519 	for (i = 0; i < res_pool->res_cap->num_dsc; i++)
520 		if (hws->funcs.dsc_pg_control != NULL)
521 			hws->funcs.dsc_pg_control(hws, res_pool->dscs[i]->inst, false);
522 
523 	/* we want to turn off all dp displays before doing detection */
524 	if (dc->config.power_down_display_on_boot) {
525 		uint8_t dpcd_power_state = '\0';
526 		enum dc_status status = DC_ERROR_UNEXPECTED;
527 
528 		for (i = 0; i < dc->link_count; i++) {
529 			if (dc->links[i]->connector_signal != SIGNAL_TYPE_DISPLAY_PORT)
530 				continue;
531 
532 			/* if any of the displays are lit up turn them off */
533 			status = core_link_read_dpcd(dc->links[i], DP_SET_POWER,
534 						     &dpcd_power_state, sizeof(dpcd_power_state));
535 			if (status == DC_OK && dpcd_power_state == DP_POWER_STATE_D0) {
536 				/* blank dp stream before power off receiver*/
537 				if (dc->links[i]->link_enc->funcs->get_dig_frontend) {
538 					unsigned int fe;
539 
540 					fe = dc->links[i]->link_enc->funcs->get_dig_frontend(
541 										dc->links[i]->link_enc);
542 
543 					for (j = 0; j < dc->res_pool->stream_enc_count; j++) {
544 						if (fe == dc->res_pool->stream_enc[j]->id) {
545 							dc->res_pool->stream_enc[j]->funcs->dp_blank(
546 										dc->res_pool->stream_enc[j]);
547 							break;
548 						}
549 					}
550 				}
551 				dp_receiver_power_ctrl(dc->links[i], false);
552 			}
553 		}
554 	}
555 
556 	/* If taking control over from VBIOS, we may want to optimize our first
557 	 * mode set, so we need to skip powering down pipes until we know which
558 	 * pipes we want to use.
559 	 * Otherwise, if taking control is not possible, we need to power
560 	 * everything down.
561 	 */
562 	if (dcb->funcs->is_accelerated_mode(dcb) || dc->config.power_down_display_on_boot) {
563 		hws->funcs.init_pipes(dc, dc->current_state);
564 		if (dc->res_pool->hubbub->funcs->allow_self_refresh_control)
565 			dc->res_pool->hubbub->funcs->allow_self_refresh_control(dc->res_pool->hubbub,
566 					!dc->res_pool->hubbub->ctx->dc->debug.disable_stutter);
567 	}
568 
569 	/* In headless boot cases, DIG may be turned
570 	 * on which causes HW/SW discrepancies.
571 	 * To avoid this, power down hardware on boot
572 	 * if DIG is turned on and seamless boot not enabled
573 	 */
574 	if (dc->config.power_down_display_on_boot) {
575 		struct dc_link *edp_link = get_edp_link(dc);
576 
577 		if (edp_link &&
578 				edp_link->link_enc->funcs->is_dig_enabled &&
579 				edp_link->link_enc->funcs->is_dig_enabled(edp_link->link_enc) &&
580 				dc->hwss.edp_backlight_control &&
581 				dc->hwss.power_down &&
582 				dc->hwss.edp_power_control) {
583 			dc->hwss.edp_backlight_control(edp_link, false);
584 			dc->hwss.power_down(dc);
585 			dc->hwss.edp_power_control(edp_link, false);
586 		} else {
587 			for (i = 0; i < dc->link_count; i++) {
588 				struct dc_link *link = dc->links[i];
589 
590 				if (link->link_enc->funcs->is_dig_enabled &&
591 						link->link_enc->funcs->is_dig_enabled(link->link_enc) &&
592 						dc->hwss.power_down) {
593 					dc->hwss.power_down(dc);
594 					break;
595 				}
596 
597 			}
598 		}
599 	}
600 
601 	for (i = 0; i < res_pool->audio_count; i++) {
602 		struct audio *audio = res_pool->audios[i];
603 
604 		audio->funcs->hw_init(audio);
605 	}
606 
607 	for (i = 0; i < dc->link_count; i++) {
608 		struct dc_link *link = dc->links[i];
609 
610 		if (link->panel_cntl)
611 			backlight = link->panel_cntl->funcs->hw_init(link->panel_cntl);
612 	}
613 
614 	for (i = 0; i < dc->res_pool->pipe_count; i++) {
615 		if (abms[i] != NULL)
616 			abms[i]->funcs->abm_init(abms[i], backlight);
617 	}
618 
619 	/* power AFMT HDMI memory TODO: may move to dis/en output save power*/
620 	REG_WRITE(DIO_MEM_PWR_CTRL, 0);
621 
622 	if (!dc->debug.disable_clock_gate) {
623 		/* enable all DCN clock gating */
624 		REG_WRITE(DCCG_GATE_DISABLE_CNTL, 0);
625 
626 		REG_WRITE(DCCG_GATE_DISABLE_CNTL2, 0);
627 
628 		REG_UPDATE(DCFCLK_CNTL, DCFCLK_GATE_DIS, 0);
629 	}
630 	if (hws->funcs.enable_power_gating_plane)
631 		hws->funcs.enable_power_gating_plane(dc->hwseq, true);
632 
633 	if (!dcb->funcs->is_accelerated_mode(dcb) && dc->res_pool->hubbub->funcs->init_watermarks)
634 		dc->res_pool->hubbub->funcs->init_watermarks(dc->res_pool->hubbub);
635 
636 	if (dc->clk_mgr->funcs->notify_wm_ranges)
637 		dc->clk_mgr->funcs->notify_wm_ranges(dc->clk_mgr);
638 
639 	if (dc->clk_mgr->funcs->set_hard_max_memclk)
640 		dc->clk_mgr->funcs->set_hard_max_memclk(dc->clk_mgr);
641 
642 	if (dc->res_pool->hubbub->funcs->force_pstate_change_control)
643 		dc->res_pool->hubbub->funcs->force_pstate_change_control(
644 				dc->res_pool->hubbub, false, false);
645 }
646 
647 void dcn30_set_avmute(struct pipe_ctx *pipe_ctx, bool enable)
648 {
649 	if (pipe_ctx == NULL)
650 		return;
651 
652 	if (dc_is_hdmi_tmds_signal(pipe_ctx->stream->signal) && pipe_ctx->stream_res.stream_enc != NULL)
653 		pipe_ctx->stream_res.stream_enc->funcs->set_avmute(
654 				pipe_ctx->stream_res.stream_enc,
655 				enable);
656 }
657 
658 void dcn30_update_info_frame(struct pipe_ctx *pipe_ctx)
659 {
660 	bool is_hdmi_tmds;
661 	bool is_dp;
662 
663 	ASSERT(pipe_ctx->stream);
664 
665 	if (pipe_ctx->stream_res.stream_enc == NULL)
666 		return;  /* this is not root pipe */
667 
668 	is_hdmi_tmds = dc_is_hdmi_tmds_signal(pipe_ctx->stream->signal);
669 	is_dp = dc_is_dp_signal(pipe_ctx->stream->signal);
670 
671 	if (!is_hdmi_tmds)
672 		return;
673 
674 	if (is_hdmi_tmds)
675 		pipe_ctx->stream_res.stream_enc->funcs->update_hdmi_info_packets(
676 			pipe_ctx->stream_res.stream_enc,
677 			&pipe_ctx->stream_res.encoder_info_frame);
678 	else
679 		pipe_ctx->stream_res.stream_enc->funcs->update_dp_info_packets(
680 			pipe_ctx->stream_res.stream_enc,
681 			&pipe_ctx->stream_res.encoder_info_frame);
682 }
683 
684 void dcn30_program_dmdata_engine(struct pipe_ctx *pipe_ctx)
685 {
686 	struct dc_stream_state    *stream     = pipe_ctx->stream;
687 	struct hubp               *hubp       = pipe_ctx->plane_res.hubp;
688 	bool                       enable     = false;
689 	struct stream_encoder     *stream_enc = pipe_ctx->stream_res.stream_enc;
690 	enum dynamic_metadata_mode mode       = dc_is_dp_signal(stream->signal)
691 							? dmdata_dp
692 							: dmdata_hdmi;
693 
694 	/* if using dynamic meta, don't set up generic infopackets */
695 	if (pipe_ctx->stream->dmdata_address.quad_part != 0) {
696 		pipe_ctx->stream_res.encoder_info_frame.hdrsmd.valid = false;
697 		enable = true;
698 	}
699 
700 	if (!hubp)
701 		return;
702 
703 	if (!stream_enc || !stream_enc->funcs->set_dynamic_metadata)
704 		return;
705 
706 	stream_enc->funcs->set_dynamic_metadata(stream_enc, enable,
707 							hubp->inst, mode);
708 }
709 
710 bool dcn30_apply_idle_power_optimizations(struct dc *dc, bool enable)
711 {
712 	union dmub_rb_cmd cmd;
713 	unsigned int surface_size, refresh_hz, denom;
714 	uint32_t tmr_delay = 0, tmr_scale = 0;
715 
716 	if (!dc->ctx->dmub_srv)
717 		return false;
718 
719 	if (enable) {
720 		if (dc->current_state) {
721 			int i;
722 
723 			/* First, check no-memory-requests case */
724 			for (i = 0; i < dc->current_state->stream_count; i++) {
725 				if (dc->current_state->stream_status[i]
726 					    .plane_count)
727 					/* Fail eligibility on a visible stream */
728 					break;
729 			}
730 
731 			if (dc->current_state->stream_count == 1 // single display only
732 			    && dc->current_state->stream_status[0].plane_count == 1 // single surface only
733 			    && dc->current_state->stream_status[0].plane_states[0]->address.page_table_base.quad_part == 0 // no VM
734 			    // Only 8 and 16 bit formats
735 			    && dc->current_state->stream_status[0].plane_states[0]->format <= SURFACE_PIXEL_FORMAT_GRPH_ABGR16161616F
736 			    && dc->current_state->stream_status[0].plane_states[0]->format >= SURFACE_PIXEL_FORMAT_GRPH_ARGB8888) {
737 				surface_size = dc->current_state->stream_status[0].plane_states[0]->plane_size.surface_pitch *
738 					dc->current_state->stream_status[0].plane_states[0]->plane_size.surface_size.height *
739 					(dc->current_state->stream_status[0].plane_states[0]->format >= SURFACE_PIXEL_FORMAT_GRPH_ARGB16161616 ?
740 					 8 : 4);
741 			} else {
742 				// TODO: remove hard code size
743 				surface_size = 128 * 1024 * 1024;
744 			}
745 
746 			// TODO: remove hard code size
747 			if (surface_size < 128 * 1024 * 1024) {
748 				refresh_hz = div_u64((unsigned long long) dc->current_state->streams[0]->timing.pix_clk_100hz *
749 						     100LL,
750 						     (dc->current_state->streams[0]->timing.v_total *
751 						      dc->current_state->streams[0]->timing.h_total));
752 
753 				/*
754 				 * Delay_Us = 65.28 * (64 + MallFrameCacheTmrDly) * 2^MallFrameCacheTmrScale
755 				 * Delay_Us / 65.28 = (64 + MallFrameCacheTmrDly) * 2^MallFrameCacheTmrScale
756 				 * (Delay_Us / 65.28) / 2^MallFrameCacheTmrScale = 64 + MallFrameCacheTmrDly
757 				 * MallFrameCacheTmrDly = ((Delay_Us / 65.28) / 2^MallFrameCacheTmrScale) - 64
758 				 *                      = (1000000 / refresh) / 65.28 / 2^MallFrameCacheTmrScale - 64
759 				 *                      = 1000000 / (refresh * 65.28 * 2^MallFrameCacheTmrScale) - 64
760 				 *                      = (1000000 * 100) / (refresh * 6528 * 2^MallFrameCacheTmrScale) - 64
761 				 *
762 				 * need to round up the result of the division before the subtraction
763 				 */
764 				denom = refresh_hz * 6528;
765 				tmr_delay = div_u64((100000000LL + denom - 1), denom) - 64LL;
766 
767 				/* scale should be increased until it fits into 6 bits */
768 				while (tmr_delay & ~0x3F) {
769 					tmr_scale++;
770 
771 					if (tmr_scale > 3) {
772 						/* The delay exceeds the range of the hystersis timer */
773 						ASSERT(false);
774 						return false;
775 					}
776 
777 					denom *= 2;
778 					tmr_delay = div_u64((100000000LL + denom - 1), denom) - 64LL;
779 				}
780 
781 				/* Enable MALL */
782 				memset(&cmd, 0, sizeof(cmd));
783 				cmd.mall.header.type = DMUB_CMD__MALL;
784 				cmd.mall.header.sub_type =
785 					DMUB_CMD__MALL_ACTION_ALLOW;
786 				cmd.mall.header.payload_bytes =
787 					sizeof(cmd.mall) -
788 					sizeof(cmd.mall.header);
789 				cmd.mall.tmr_delay = tmr_delay;
790 				cmd.mall.tmr_scale = tmr_scale;
791 
792 				dc_dmub_srv_cmd_queue(dc->ctx->dmub_srv, &cmd);
793 				dc_dmub_srv_cmd_execute(dc->ctx->dmub_srv);
794 
795 				return true;
796 			}
797 		}
798 
799 		/* No applicable optimizations */
800 		return false;
801 	}
802 
803 	/* Disable MALL */
804 	memset(&cmd, 0, sizeof(cmd));
805 	cmd.mall.header.type = DMUB_CMD__MALL;
806 	cmd.mall.header.sub_type = DMUB_CMD__MALL_ACTION_DISALLOW;
807 	cmd.mall.header.payload_bytes =
808 		sizeof(cmd.mall) - sizeof(cmd.mall.header);
809 
810 	dc_dmub_srv_cmd_queue(dc->ctx->dmub_srv, &cmd);
811 	dc_dmub_srv_cmd_execute(dc->ctx->dmub_srv);
812 	dc_dmub_srv_wait_idle(dc->ctx->dmub_srv);
813 
814 	return true;
815 }
816 
817 void dcn30_hardware_release(struct dc *dc)
818 {
819 	/* if pstate unsupported, force it supported */
820 	if (!dc->clk_mgr->clks.p_state_change_support &&
821 			dc->res_pool->hubbub->funcs->force_pstate_change_control)
822 		dc->res_pool->hubbub->funcs->force_pstate_change_control(
823 				dc->res_pool->hubbub, true, true);
824 }
825 
826 void dcn30_set_disp_pattern_generator(const struct dc *dc,
827 		struct pipe_ctx *pipe_ctx,
828 		enum controller_dp_test_pattern test_pattern,
829 		enum controller_dp_color_space color_space,
830 		enum dc_color_depth color_depth,
831 		const struct tg_color *solid_color,
832 		int width, int height, int offset)
833 {
834 	pipe_ctx->stream_res.opp->funcs->opp_set_disp_pattern_generator(pipe_ctx->stream_res.opp, test_pattern,
835 			color_space, color_depth, solid_color, width, height, offset);
836 }
837