1 /*
2 * Copyright 2012-15 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 "dm_services.h"
27
28
29 #include "dc_types.h"
30 #include "core_types.h"
31
32 #include "include/grph_object_id.h"
33 #include "include/logger_interface.h"
34
35 #include "dce_clock_source.h"
36 #include "clk_mgr.h"
37 #include "dccg.h"
38
39 #include "reg_helper.h"
40
41 #define REG(reg)\
42 (clk_src->regs->reg)
43
44 #define CTX \
45 clk_src->base.ctx
46
47 #define DC_LOGGER \
48 calc_pll_cs->ctx->logger
49 #define DC_LOGGER_INIT() \
50 struct calc_pll_clock_source *calc_pll_cs = &clk_src->calc_pll
51
52 #undef FN
53 #define FN(reg_name, field_name) \
54 clk_src->cs_shift->field_name, clk_src->cs_mask->field_name
55
56 #define FRACT_FB_DIVIDER_DEC_POINTS_MAX_NUM 6
57 #define CALC_PLL_CLK_SRC_ERR_TOLERANCE 1
58 #define MAX_PLL_CALC_ERROR 0xFFFFFFFF
59
60 #define NUM_ELEMENTS(a) (sizeof(a) / sizeof((a)[0]))
61
get_ss_data_entry(struct dce110_clk_src * clk_src,enum signal_type signal,uint32_t pix_clk_khz)62 static const struct spread_spectrum_data *get_ss_data_entry(
63 struct dce110_clk_src *clk_src,
64 enum signal_type signal,
65 uint32_t pix_clk_khz)
66 {
67
68 uint32_t entrys_num;
69 uint32_t i;
70 struct spread_spectrum_data *ss_parm = NULL;
71 struct spread_spectrum_data *ret = NULL;
72
73 switch (signal) {
74 case SIGNAL_TYPE_DVI_SINGLE_LINK:
75 case SIGNAL_TYPE_DVI_DUAL_LINK:
76 ss_parm = clk_src->dvi_ss_params;
77 entrys_num = clk_src->dvi_ss_params_cnt;
78 break;
79
80 case SIGNAL_TYPE_HDMI_TYPE_A:
81 ss_parm = clk_src->hdmi_ss_params;
82 entrys_num = clk_src->hdmi_ss_params_cnt;
83 break;
84
85 case SIGNAL_TYPE_LVDS:
86 ss_parm = clk_src->lvds_ss_params;
87 entrys_num = clk_src->lvds_ss_params_cnt;
88 break;
89
90 case SIGNAL_TYPE_DISPLAY_PORT:
91 case SIGNAL_TYPE_DISPLAY_PORT_MST:
92 case SIGNAL_TYPE_EDP:
93 case SIGNAL_TYPE_VIRTUAL:
94 ss_parm = clk_src->dp_ss_params;
95 entrys_num = clk_src->dp_ss_params_cnt;
96 break;
97
98 default:
99 ss_parm = NULL;
100 entrys_num = 0;
101 break;
102 }
103
104 if (ss_parm == NULL)
105 return ret;
106
107 for (i = 0; i < entrys_num; ++i, ++ss_parm) {
108 if (ss_parm->freq_range_khz >= pix_clk_khz) {
109 ret = ss_parm;
110 break;
111 }
112 }
113
114 return ret;
115 }
116
117 /**
118 * calculate_fb_and_fractional_fb_divider - Calculates feedback and fractional
119 * feedback dividers values
120 *
121 * @calc_pll_cs: Pointer to clock source information
122 * @target_pix_clk_100hz: Desired frequency in 100 Hz
123 * @ref_divider: Reference divider (already known)
124 * @post_divider: Post Divider (already known)
125 * @feedback_divider_param: Pointer where to store
126 * calculated feedback divider value
127 * @fract_feedback_divider_param: Pointer where to store
128 * calculated fract feedback divider value
129 *
130 * return:
131 * It fills the locations pointed by feedback_divider_param
132 * and fract_feedback_divider_param
133 * It returns - true if feedback divider not 0
134 * - false should never happen)
135 */
calculate_fb_and_fractional_fb_divider(struct calc_pll_clock_source * calc_pll_cs,uint32_t target_pix_clk_100hz,uint32_t ref_divider,uint32_t post_divider,uint32_t * feedback_divider_param,uint32_t * fract_feedback_divider_param)136 static bool calculate_fb_and_fractional_fb_divider(
137 struct calc_pll_clock_source *calc_pll_cs,
138 uint32_t target_pix_clk_100hz,
139 uint32_t ref_divider,
140 uint32_t post_divider,
141 uint32_t *feedback_divider_param,
142 uint32_t *fract_feedback_divider_param)
143 {
144 uint64_t feedback_divider;
145
146 feedback_divider =
147 (uint64_t)target_pix_clk_100hz * ref_divider * post_divider;
148 feedback_divider *= 10;
149 /* additional factor, since we divide by 10 afterwards */
150 feedback_divider *= (uint64_t)(calc_pll_cs->fract_fb_divider_factor);
151 feedback_divider = div_u64(feedback_divider, calc_pll_cs->ref_freq_khz * 10ull);
152
153 /*Round to the number of precision
154 * The following code replace the old code (ullfeedbackDivider + 5)/10
155 * for example if the difference between the number
156 * of fractional feedback decimal point and the fractional FB Divider precision
157 * is 2 then the equation becomes (ullfeedbackDivider + 5*100) / (10*100))*/
158
159 feedback_divider += 5ULL *
160 calc_pll_cs->fract_fb_divider_precision_factor;
161 feedback_divider =
162 div_u64(feedback_divider,
163 calc_pll_cs->fract_fb_divider_precision_factor * 10);
164 feedback_divider *= (uint64_t)
165 (calc_pll_cs->fract_fb_divider_precision_factor);
166
167 *feedback_divider_param =
168 div_u64_rem(
169 feedback_divider,
170 calc_pll_cs->fract_fb_divider_factor,
171 fract_feedback_divider_param);
172
173 if (*feedback_divider_param != 0)
174 return true;
175 return false;
176 }
177
178 /**
179 * calc_fb_divider_checking_tolerance - Calculates Feedback and
180 * Fractional Feedback divider values
181 * for passed Reference and Post divider,
182 * checking for tolerance.
183 * @calc_pll_cs: Pointer to clock source information
184 * @pll_settings: Pointer to PLL settings
185 * @ref_divider: Reference divider (already known)
186 * @post_divider: Post Divider (already known)
187 * @tolerance: Tolerance for Calculated Pixel Clock to be within
188 *
189 * return:
190 * It fills the PLLSettings structure with PLL Dividers values
191 * if calculated values are within required tolerance
192 * It returns - true if error is within tolerance
193 * - false if error is not within tolerance
194 */
calc_fb_divider_checking_tolerance(struct calc_pll_clock_source * calc_pll_cs,struct pll_settings * pll_settings,uint32_t ref_divider,uint32_t post_divider,uint32_t tolerance)195 static bool calc_fb_divider_checking_tolerance(
196 struct calc_pll_clock_source *calc_pll_cs,
197 struct pll_settings *pll_settings,
198 uint32_t ref_divider,
199 uint32_t post_divider,
200 uint32_t tolerance)
201 {
202 uint32_t feedback_divider;
203 uint32_t fract_feedback_divider;
204 uint32_t actual_calculated_clock_100hz;
205 uint32_t abs_err;
206 uint64_t actual_calc_clk_100hz;
207
208 calculate_fb_and_fractional_fb_divider(
209 calc_pll_cs,
210 pll_settings->adjusted_pix_clk_100hz,
211 ref_divider,
212 post_divider,
213 &feedback_divider,
214 &fract_feedback_divider);
215
216 /*Actual calculated value*/
217 actual_calc_clk_100hz = (uint64_t)feedback_divider *
218 calc_pll_cs->fract_fb_divider_factor +
219 fract_feedback_divider;
220 actual_calc_clk_100hz *= (uint64_t)calc_pll_cs->ref_freq_khz * 10;
221 actual_calc_clk_100hz =
222 div_u64(actual_calc_clk_100hz,
223 ref_divider * post_divider *
224 calc_pll_cs->fract_fb_divider_factor);
225
226 actual_calculated_clock_100hz = (uint32_t)(actual_calc_clk_100hz);
227
228 abs_err = (actual_calculated_clock_100hz >
229 pll_settings->adjusted_pix_clk_100hz)
230 ? actual_calculated_clock_100hz -
231 pll_settings->adjusted_pix_clk_100hz
232 : pll_settings->adjusted_pix_clk_100hz -
233 actual_calculated_clock_100hz;
234
235 if (abs_err <= tolerance) {
236 /*found good values*/
237 pll_settings->reference_freq = calc_pll_cs->ref_freq_khz;
238 pll_settings->reference_divider = ref_divider;
239 pll_settings->feedback_divider = feedback_divider;
240 pll_settings->fract_feedback_divider = fract_feedback_divider;
241 pll_settings->pix_clk_post_divider = post_divider;
242 pll_settings->calculated_pix_clk_100hz =
243 actual_calculated_clock_100hz;
244 pll_settings->vco_freq =
245 div_u64((u64)actual_calculated_clock_100hz * post_divider, 10);
246 return true;
247 }
248 return false;
249 }
250
calc_pll_dividers_in_range(struct calc_pll_clock_source * calc_pll_cs,struct pll_settings * pll_settings,uint32_t min_ref_divider,uint32_t max_ref_divider,uint32_t min_post_divider,uint32_t max_post_divider,uint32_t err_tolerance)251 static bool calc_pll_dividers_in_range(
252 struct calc_pll_clock_source *calc_pll_cs,
253 struct pll_settings *pll_settings,
254 uint32_t min_ref_divider,
255 uint32_t max_ref_divider,
256 uint32_t min_post_divider,
257 uint32_t max_post_divider,
258 uint32_t err_tolerance)
259 {
260 uint32_t ref_divider;
261 uint32_t post_divider;
262 uint32_t tolerance;
263
264 /* This is err_tolerance / 10000 = 0.0025 - acceptable error of 0.25%
265 * This is errorTolerance / 10000 = 0.0001 - acceptable error of 0.01%*/
266 tolerance = (pll_settings->adjusted_pix_clk_100hz * err_tolerance) /
267 100000;
268 if (tolerance < CALC_PLL_CLK_SRC_ERR_TOLERANCE)
269 tolerance = CALC_PLL_CLK_SRC_ERR_TOLERANCE;
270
271 for (
272 post_divider = max_post_divider;
273 post_divider >= min_post_divider;
274 --post_divider) {
275 for (
276 ref_divider = min_ref_divider;
277 ref_divider <= max_ref_divider;
278 ++ref_divider) {
279 if (calc_fb_divider_checking_tolerance(
280 calc_pll_cs,
281 pll_settings,
282 ref_divider,
283 post_divider,
284 tolerance)) {
285 return true;
286 }
287 }
288 }
289
290 return false;
291 }
292
calculate_pixel_clock_pll_dividers(struct calc_pll_clock_source * calc_pll_cs,struct pll_settings * pll_settings)293 static uint32_t calculate_pixel_clock_pll_dividers(
294 struct calc_pll_clock_source *calc_pll_cs,
295 struct pll_settings *pll_settings)
296 {
297 uint32_t err_tolerance;
298 uint32_t min_post_divider;
299 uint32_t max_post_divider;
300 uint32_t min_ref_divider;
301 uint32_t max_ref_divider;
302
303 if (pll_settings->adjusted_pix_clk_100hz == 0) {
304 DC_LOG_ERROR(
305 "%s Bad requested pixel clock", __func__);
306 return MAX_PLL_CALC_ERROR;
307 }
308
309 /* 1) Find Post divider ranges */
310 if (pll_settings->pix_clk_post_divider) {
311 min_post_divider = pll_settings->pix_clk_post_divider;
312 max_post_divider = pll_settings->pix_clk_post_divider;
313 } else {
314 min_post_divider = calc_pll_cs->min_pix_clock_pll_post_divider;
315 if (min_post_divider * pll_settings->adjusted_pix_clk_100hz <
316 calc_pll_cs->min_vco_khz * 10) {
317 min_post_divider = calc_pll_cs->min_vco_khz * 10 /
318 pll_settings->adjusted_pix_clk_100hz;
319 if ((min_post_divider *
320 pll_settings->adjusted_pix_clk_100hz) <
321 calc_pll_cs->min_vco_khz * 10)
322 min_post_divider++;
323 }
324
325 max_post_divider = calc_pll_cs->max_pix_clock_pll_post_divider;
326 if (max_post_divider * pll_settings->adjusted_pix_clk_100hz
327 > calc_pll_cs->max_vco_khz * 10)
328 max_post_divider = calc_pll_cs->max_vco_khz * 10 /
329 pll_settings->adjusted_pix_clk_100hz;
330 }
331
332 /* 2) Find Reference divider ranges
333 * When SS is enabled, or for Display Port even without SS,
334 * pll_settings->referenceDivider is not zero.
335 * So calculate PPLL FB and fractional FB divider
336 * using the passed reference divider*/
337
338 if (pll_settings->reference_divider) {
339 min_ref_divider = pll_settings->reference_divider;
340 max_ref_divider = pll_settings->reference_divider;
341 } else {
342 min_ref_divider = ((calc_pll_cs->ref_freq_khz
343 / calc_pll_cs->max_pll_input_freq_khz)
344 > calc_pll_cs->min_pll_ref_divider)
345 ? calc_pll_cs->ref_freq_khz
346 / calc_pll_cs->max_pll_input_freq_khz
347 : calc_pll_cs->min_pll_ref_divider;
348
349 max_ref_divider = ((calc_pll_cs->ref_freq_khz
350 / calc_pll_cs->min_pll_input_freq_khz)
351 < calc_pll_cs->max_pll_ref_divider)
352 ? calc_pll_cs->ref_freq_khz /
353 calc_pll_cs->min_pll_input_freq_khz
354 : calc_pll_cs->max_pll_ref_divider;
355 }
356
357 /* If some parameters are invalid we could have scenario when "min">"max"
358 * which produced endless loop later.
359 * We should investigate why we get the wrong parameters.
360 * But to follow the similar logic when "adjustedPixelClock" is set to be 0
361 * it is better to return here than cause system hang/watchdog timeout later.
362 * ## SVS Wed 15 Jul 2009 */
363
364 if (min_post_divider > max_post_divider) {
365 DC_LOG_ERROR(
366 "%s Post divider range is invalid", __func__);
367 return MAX_PLL_CALC_ERROR;
368 }
369
370 if (min_ref_divider > max_ref_divider) {
371 DC_LOG_ERROR(
372 "%s Reference divider range is invalid", __func__);
373 return MAX_PLL_CALC_ERROR;
374 }
375
376 /* 3) Try to find PLL dividers given ranges
377 * starting with minimal error tolerance.
378 * Increase error tolerance until PLL dividers found*/
379 err_tolerance = MAX_PLL_CALC_ERROR;
380
381 while (!calc_pll_dividers_in_range(
382 calc_pll_cs,
383 pll_settings,
384 min_ref_divider,
385 max_ref_divider,
386 min_post_divider,
387 max_post_divider,
388 err_tolerance))
389 err_tolerance += (err_tolerance > 10)
390 ? (err_tolerance / 10)
391 : 1;
392
393 return err_tolerance;
394 }
395
pll_adjust_pix_clk(struct dce110_clk_src * clk_src,struct pixel_clk_params * pix_clk_params,struct pll_settings * pll_settings)396 static bool pll_adjust_pix_clk(
397 struct dce110_clk_src *clk_src,
398 struct pixel_clk_params *pix_clk_params,
399 struct pll_settings *pll_settings)
400 {
401 uint32_t actual_pix_clk_100hz = 0;
402 uint32_t requested_clk_100hz = 0;
403 struct bp_adjust_pixel_clock_parameters bp_adjust_pixel_clock_params = {
404 0 };
405 enum bp_result bp_result;
406 switch (pix_clk_params->signal_type) {
407 case SIGNAL_TYPE_HDMI_TYPE_A: {
408 requested_clk_100hz = pix_clk_params->requested_pix_clk_100hz;
409 if (pix_clk_params->pixel_encoding != PIXEL_ENCODING_YCBCR422) {
410 switch (pix_clk_params->color_depth) {
411 case COLOR_DEPTH_101010:
412 requested_clk_100hz = (requested_clk_100hz * 5) >> 2;
413 break; /* x1.25*/
414 case COLOR_DEPTH_121212:
415 requested_clk_100hz = (requested_clk_100hz * 6) >> 2;
416 break; /* x1.5*/
417 case COLOR_DEPTH_161616:
418 requested_clk_100hz = requested_clk_100hz * 2;
419 break; /* x2.0*/
420 default:
421 break;
422 }
423 }
424 actual_pix_clk_100hz = requested_clk_100hz;
425 }
426 break;
427
428 case SIGNAL_TYPE_DISPLAY_PORT:
429 case SIGNAL_TYPE_DISPLAY_PORT_MST:
430 case SIGNAL_TYPE_EDP:
431 requested_clk_100hz = pix_clk_params->requested_sym_clk * 10;
432 actual_pix_clk_100hz = pix_clk_params->requested_pix_clk_100hz;
433 break;
434
435 default:
436 requested_clk_100hz = pix_clk_params->requested_pix_clk_100hz;
437 actual_pix_clk_100hz = pix_clk_params->requested_pix_clk_100hz;
438 break;
439 }
440
441 bp_adjust_pixel_clock_params.pixel_clock = requested_clk_100hz / 10;
442 bp_adjust_pixel_clock_params.
443 encoder_object_id = pix_clk_params->encoder_object_id;
444 bp_adjust_pixel_clock_params.signal_type = pix_clk_params->signal_type;
445 bp_adjust_pixel_clock_params.
446 ss_enable = pix_clk_params->flags.ENABLE_SS;
447 bp_result = clk_src->bios->funcs->adjust_pixel_clock(
448 clk_src->bios, &bp_adjust_pixel_clock_params);
449 if (bp_result == BP_RESULT_OK) {
450 pll_settings->actual_pix_clk_100hz = actual_pix_clk_100hz;
451 pll_settings->adjusted_pix_clk_100hz =
452 bp_adjust_pixel_clock_params.adjusted_pixel_clock * 10;
453 pll_settings->reference_divider =
454 bp_adjust_pixel_clock_params.reference_divider;
455 pll_settings->pix_clk_post_divider =
456 bp_adjust_pixel_clock_params.pixel_clock_post_divider;
457
458 return true;
459 }
460
461 return false;
462 }
463
464 /*
465 * Calculate PLL Dividers for given Clock Value.
466 * First will call VBIOS Adjust Exec table to check if requested Pixel clock
467 * will be Adjusted based on usage.
468 * Then it will calculate PLL Dividers for this Adjusted clock using preferred
469 * method (Maximum VCO frequency).
470 *
471 * \return
472 * Calculation error in units of 0.01%
473 */
474
dce110_get_pix_clk_dividers_helper(struct dce110_clk_src * clk_src,struct pll_settings * pll_settings,struct pixel_clk_params * pix_clk_params)475 static uint32_t dce110_get_pix_clk_dividers_helper (
476 struct dce110_clk_src *clk_src,
477 struct pll_settings *pll_settings,
478 struct pixel_clk_params *pix_clk_params)
479 {
480 uint32_t field = 0;
481 uint32_t pll_calc_error = MAX_PLL_CALC_ERROR;
482 DC_LOGGER_INIT();
483 /* Check if reference clock is external (not pcie/xtalin)
484 * HW Dce80 spec:
485 * 00 - PCIE_REFCLK, 01 - XTALIN, 02 - GENERICA, 03 - GENERICB
486 * 04 - HSYNCA, 05 - GENLK_CLK, 06 - PCIE_REFCLK, 07 - DVOCLK0 */
487 REG_GET(PLL_CNTL, PLL_REF_DIV_SRC, &field);
488 pll_settings->use_external_clk = (field > 1);
489
490 /* VBIOS by default enables DP SS (spread on IDCLK) for DCE 8.0 always
491 * (we do not care any more from SI for some older DP Sink which
492 * does not report SS support, no known issues) */
493 if ((pix_clk_params->flags.ENABLE_SS) ||
494 (dc_is_dp_signal(pix_clk_params->signal_type))) {
495
496 const struct spread_spectrum_data *ss_data = get_ss_data_entry(
497 clk_src,
498 pix_clk_params->signal_type,
499 pll_settings->adjusted_pix_clk_100hz / 10);
500
501 if (NULL != ss_data)
502 pll_settings->ss_percentage = ss_data->percentage;
503 }
504
505 /* Check VBIOS AdjustPixelClock Exec table */
506 if (!pll_adjust_pix_clk(clk_src, pix_clk_params, pll_settings)) {
507 /* Should never happen, ASSERT and fill up values to be able
508 * to continue. */
509 DC_LOG_ERROR(
510 "%s: Failed to adjust pixel clock!!", __func__);
511 pll_settings->actual_pix_clk_100hz =
512 pix_clk_params->requested_pix_clk_100hz;
513 pll_settings->adjusted_pix_clk_100hz =
514 pix_clk_params->requested_pix_clk_100hz;
515
516 if (dc_is_dp_signal(pix_clk_params->signal_type))
517 pll_settings->adjusted_pix_clk_100hz = 1000000;
518 }
519
520 /* Calculate Dividers */
521 if (pix_clk_params->signal_type == SIGNAL_TYPE_HDMI_TYPE_A)
522 /*Calculate Dividers by HDMI object, no SS case or SS case */
523 pll_calc_error =
524 calculate_pixel_clock_pll_dividers(
525 &clk_src->calc_pll_hdmi,
526 pll_settings);
527 else
528 /*Calculate Dividers by default object, no SS case or SS case */
529 pll_calc_error =
530 calculate_pixel_clock_pll_dividers(
531 &clk_src->calc_pll,
532 pll_settings);
533
534 return pll_calc_error;
535 }
536
dce112_get_pix_clk_dividers_helper(struct dce110_clk_src * clk_src,struct pll_settings * pll_settings,struct pixel_clk_params * pix_clk_params)537 static void dce112_get_pix_clk_dividers_helper (
538 struct dce110_clk_src *clk_src,
539 struct pll_settings *pll_settings,
540 struct pixel_clk_params *pix_clk_params)
541 {
542 uint32_t actual_pixel_clock_100hz;
543
544 actual_pixel_clock_100hz = pix_clk_params->requested_pix_clk_100hz;
545 /* Calculate Dividers */
546 if (pix_clk_params->signal_type == SIGNAL_TYPE_HDMI_TYPE_A) {
547 switch (pix_clk_params->color_depth) {
548 case COLOR_DEPTH_101010:
549 actual_pixel_clock_100hz = (actual_pixel_clock_100hz * 5) >> 2;
550 actual_pixel_clock_100hz -= actual_pixel_clock_100hz % 10;
551 break;
552 case COLOR_DEPTH_121212:
553 actual_pixel_clock_100hz = (actual_pixel_clock_100hz * 6) >> 2;
554 actual_pixel_clock_100hz -= actual_pixel_clock_100hz % 10;
555 break;
556 case COLOR_DEPTH_161616:
557 actual_pixel_clock_100hz = actual_pixel_clock_100hz * 2;
558 break;
559 default:
560 break;
561 }
562 }
563 pll_settings->actual_pix_clk_100hz = actual_pixel_clock_100hz;
564 pll_settings->adjusted_pix_clk_100hz = actual_pixel_clock_100hz;
565 pll_settings->calculated_pix_clk_100hz = pix_clk_params->requested_pix_clk_100hz;
566 }
567
dce110_get_pix_clk_dividers(struct clock_source * cs,struct pixel_clk_params * pix_clk_params,struct pll_settings * pll_settings)568 static uint32_t dce110_get_pix_clk_dividers(
569 struct clock_source *cs,
570 struct pixel_clk_params *pix_clk_params,
571 struct pll_settings *pll_settings)
572 {
573 struct dce110_clk_src *clk_src = TO_DCE110_CLK_SRC(cs);
574 uint32_t pll_calc_error = MAX_PLL_CALC_ERROR;
575 DC_LOGGER_INIT();
576
577 if (pix_clk_params == NULL || pll_settings == NULL
578 || pix_clk_params->requested_pix_clk_100hz == 0) {
579 DC_LOG_ERROR(
580 "%s: Invalid parameters!!\n", __func__);
581 return pll_calc_error;
582 }
583
584 memset(pll_settings, 0, sizeof(*pll_settings));
585
586 if (cs->id == CLOCK_SOURCE_ID_DP_DTO ||
587 cs->id == CLOCK_SOURCE_ID_EXTERNAL) {
588 pll_settings->adjusted_pix_clk_100hz = clk_src->ext_clk_khz * 10;
589 pll_settings->calculated_pix_clk_100hz = clk_src->ext_clk_khz * 10;
590 pll_settings->actual_pix_clk_100hz =
591 pix_clk_params->requested_pix_clk_100hz;
592 return 0;
593 }
594
595 pll_calc_error = dce110_get_pix_clk_dividers_helper(clk_src,
596 pll_settings, pix_clk_params);
597
598 return pll_calc_error;
599 }
600
dce112_get_pix_clk_dividers(struct clock_source * cs,struct pixel_clk_params * pix_clk_params,struct pll_settings * pll_settings)601 static uint32_t dce112_get_pix_clk_dividers(
602 struct clock_source *cs,
603 struct pixel_clk_params *pix_clk_params,
604 struct pll_settings *pll_settings)
605 {
606 struct dce110_clk_src *clk_src = TO_DCE110_CLK_SRC(cs);
607 DC_LOGGER_INIT();
608
609 if (pix_clk_params == NULL || pll_settings == NULL
610 || pix_clk_params->requested_pix_clk_100hz == 0) {
611 DC_LOG_ERROR(
612 "%s: Invalid parameters!!\n", __func__);
613 return -1;
614 }
615
616 memset(pll_settings, 0, sizeof(*pll_settings));
617
618 if (cs->id == CLOCK_SOURCE_ID_DP_DTO ||
619 cs->id == CLOCK_SOURCE_ID_EXTERNAL) {
620 pll_settings->adjusted_pix_clk_100hz = clk_src->ext_clk_khz * 10;
621 pll_settings->calculated_pix_clk_100hz = clk_src->ext_clk_khz * 10;
622 pll_settings->actual_pix_clk_100hz =
623 pix_clk_params->requested_pix_clk_100hz;
624 return -1;
625 }
626
627 dce112_get_pix_clk_dividers_helper(clk_src,
628 pll_settings, pix_clk_params);
629
630 return 0;
631 }
632
disable_spread_spectrum(struct dce110_clk_src * clk_src)633 static bool disable_spread_spectrum(struct dce110_clk_src *clk_src)
634 {
635 enum bp_result result;
636 struct bp_spread_spectrum_parameters bp_ss_params = {0};
637
638 bp_ss_params.pll_id = clk_src->base.id;
639
640 /*Call ASICControl to process ATOMBIOS Exec table*/
641 result = clk_src->bios->funcs->enable_spread_spectrum_on_ppll(
642 clk_src->bios,
643 &bp_ss_params,
644 false);
645
646 return result == BP_RESULT_OK;
647 }
648
calculate_ss(const struct pll_settings * pll_settings,const struct spread_spectrum_data * ss_data,struct delta_sigma_data * ds_data)649 static bool calculate_ss(
650 const struct pll_settings *pll_settings,
651 const struct spread_spectrum_data *ss_data,
652 struct delta_sigma_data *ds_data)
653 {
654 struct fixed31_32 fb_div;
655 struct fixed31_32 ss_amount;
656 struct fixed31_32 ss_nslip_amount;
657 struct fixed31_32 ss_ds_frac_amount;
658 struct fixed31_32 ss_step_size;
659 struct fixed31_32 modulation_time;
660
661 if (ds_data == NULL)
662 return false;
663 if (ss_data == NULL)
664 return false;
665 if (ss_data->percentage == 0)
666 return false;
667 if (pll_settings == NULL)
668 return false;
669
670 memset(ds_data, 0, sizeof(struct delta_sigma_data));
671
672 /* compute SS_AMOUNT_FBDIV & SS_AMOUNT_NFRAC_SLIP & SS_AMOUNT_DSFRAC*/
673 /* 6 decimal point support in fractional feedback divider */
674 fb_div = dc_fixpt_from_fraction(
675 pll_settings->fract_feedback_divider, 1000000);
676 fb_div = dc_fixpt_add_int(fb_div, pll_settings->feedback_divider);
677
678 ds_data->ds_frac_amount = 0;
679 /*spreadSpectrumPercentage is in the unit of .01%,
680 * so have to divided by 100 * 100*/
681 ss_amount = dc_fixpt_mul(
682 fb_div, dc_fixpt_from_fraction(ss_data->percentage,
683 100 * (long long)ss_data->percentage_divider));
684 ds_data->feedback_amount = dc_fixpt_floor(ss_amount);
685
686 ss_nslip_amount = dc_fixpt_sub(ss_amount,
687 dc_fixpt_from_int(ds_data->feedback_amount));
688 ss_nslip_amount = dc_fixpt_mul_int(ss_nslip_amount, 10);
689 ds_data->nfrac_amount = dc_fixpt_floor(ss_nslip_amount);
690
691 ss_ds_frac_amount = dc_fixpt_sub(ss_nslip_amount,
692 dc_fixpt_from_int(ds_data->nfrac_amount));
693 ss_ds_frac_amount = dc_fixpt_mul_int(ss_ds_frac_amount, 65536);
694 ds_data->ds_frac_amount = dc_fixpt_floor(ss_ds_frac_amount);
695
696 /* compute SS_STEP_SIZE_DSFRAC */
697 modulation_time = dc_fixpt_from_fraction(
698 pll_settings->reference_freq * (uint64_t)1000,
699 pll_settings->reference_divider * (uint64_t)ss_data->modulation_freq_hz);
700
701 if (ss_data->flags.CENTER_SPREAD)
702 modulation_time = dc_fixpt_div_int(modulation_time, 4);
703 else
704 modulation_time = dc_fixpt_div_int(modulation_time, 2);
705
706 ss_step_size = dc_fixpt_div(ss_amount, modulation_time);
707 /* SS_STEP_SIZE_DSFRAC_DEC = Int(SS_STEP_SIZE * 2 ^ 16 * 10)*/
708 ss_step_size = dc_fixpt_mul_int(ss_step_size, 65536 * 10);
709 ds_data->ds_frac_size = dc_fixpt_floor(ss_step_size);
710
711 return true;
712 }
713
enable_spread_spectrum(struct dce110_clk_src * clk_src,enum signal_type signal,struct pll_settings * pll_settings)714 static bool enable_spread_spectrum(
715 struct dce110_clk_src *clk_src,
716 enum signal_type signal, struct pll_settings *pll_settings)
717 {
718 struct bp_spread_spectrum_parameters bp_params = {0};
719 struct delta_sigma_data d_s_data;
720 const struct spread_spectrum_data *ss_data = NULL;
721
722 ss_data = get_ss_data_entry(
723 clk_src,
724 signal,
725 pll_settings->calculated_pix_clk_100hz / 10);
726
727 /* Pixel clock PLL has been programmed to generate desired pixel clock,
728 * now enable SS on pixel clock */
729 /* TODO is it OK to return true not doing anything ??*/
730 if (ss_data != NULL && pll_settings->ss_percentage != 0) {
731 if (calculate_ss(pll_settings, ss_data, &d_s_data)) {
732 bp_params.ds.feedback_amount =
733 d_s_data.feedback_amount;
734 bp_params.ds.nfrac_amount =
735 d_s_data.nfrac_amount;
736 bp_params.ds.ds_frac_size = d_s_data.ds_frac_size;
737 bp_params.ds_frac_amount =
738 d_s_data.ds_frac_amount;
739 bp_params.flags.DS_TYPE = 1;
740 bp_params.pll_id = clk_src->base.id;
741 bp_params.percentage = ss_data->percentage;
742 if (ss_data->flags.CENTER_SPREAD)
743 bp_params.flags.CENTER_SPREAD = 1;
744 if (ss_data->flags.EXTERNAL_SS)
745 bp_params.flags.EXTERNAL_SS = 1;
746
747 if (BP_RESULT_OK !=
748 clk_src->bios->funcs->
749 enable_spread_spectrum_on_ppll(
750 clk_src->bios,
751 &bp_params,
752 true))
753 return false;
754 } else
755 return false;
756 }
757 return true;
758 }
759
dce110_program_pixel_clk_resync(struct dce110_clk_src * clk_src,enum signal_type signal_type,enum dc_color_depth colordepth)760 static void dce110_program_pixel_clk_resync(
761 struct dce110_clk_src *clk_src,
762 enum signal_type signal_type,
763 enum dc_color_depth colordepth)
764 {
765 REG_UPDATE(RESYNC_CNTL,
766 DCCG_DEEP_COLOR_CNTL1, 0);
767 /*
768 24 bit mode: TMDS clock = 1.0 x pixel clock (1:1)
769 30 bit mode: TMDS clock = 1.25 x pixel clock (5:4)
770 36 bit mode: TMDS clock = 1.5 x pixel clock (3:2)
771 48 bit mode: TMDS clock = 2 x pixel clock (2:1)
772 */
773 if (signal_type != SIGNAL_TYPE_HDMI_TYPE_A)
774 return;
775
776 switch (colordepth) {
777 case COLOR_DEPTH_888:
778 REG_UPDATE(RESYNC_CNTL,
779 DCCG_DEEP_COLOR_CNTL1, 0);
780 break;
781 case COLOR_DEPTH_101010:
782 REG_UPDATE(RESYNC_CNTL,
783 DCCG_DEEP_COLOR_CNTL1, 1);
784 break;
785 case COLOR_DEPTH_121212:
786 REG_UPDATE(RESYNC_CNTL,
787 DCCG_DEEP_COLOR_CNTL1, 2);
788 break;
789 case COLOR_DEPTH_161616:
790 REG_UPDATE(RESYNC_CNTL,
791 DCCG_DEEP_COLOR_CNTL1, 3);
792 break;
793 default:
794 break;
795 }
796 }
797
dce112_program_pixel_clk_resync(struct dce110_clk_src * clk_src,enum signal_type signal_type,enum dc_color_depth colordepth,bool enable_ycbcr420)798 static void dce112_program_pixel_clk_resync(
799 struct dce110_clk_src *clk_src,
800 enum signal_type signal_type,
801 enum dc_color_depth colordepth,
802 bool enable_ycbcr420)
803 {
804 uint32_t deep_color_cntl = 0;
805 uint32_t double_rate_enable = 0;
806
807 /*
808 24 bit mode: TMDS clock = 1.0 x pixel clock (1:1)
809 30 bit mode: TMDS clock = 1.25 x pixel clock (5:4)
810 36 bit mode: TMDS clock = 1.5 x pixel clock (3:2)
811 48 bit mode: TMDS clock = 2 x pixel clock (2:1)
812 */
813 if (signal_type == SIGNAL_TYPE_HDMI_TYPE_A) {
814 double_rate_enable = enable_ycbcr420 ? 1 : 0;
815
816 switch (colordepth) {
817 case COLOR_DEPTH_888:
818 deep_color_cntl = 0;
819 break;
820 case COLOR_DEPTH_101010:
821 deep_color_cntl = 1;
822 break;
823 case COLOR_DEPTH_121212:
824 deep_color_cntl = 2;
825 break;
826 case COLOR_DEPTH_161616:
827 deep_color_cntl = 3;
828 break;
829 default:
830 break;
831 }
832 }
833
834 if (clk_src->cs_mask->PHYPLLA_PIXCLK_DOUBLE_RATE_ENABLE)
835 REG_UPDATE_2(PIXCLK_RESYNC_CNTL,
836 PHYPLLA_DCCG_DEEP_COLOR_CNTL, deep_color_cntl,
837 PHYPLLA_PIXCLK_DOUBLE_RATE_ENABLE, double_rate_enable);
838 else
839 REG_UPDATE(PIXCLK_RESYNC_CNTL,
840 PHYPLLA_DCCG_DEEP_COLOR_CNTL, deep_color_cntl);
841
842 }
843
dce110_program_pix_clk(struct clock_source * clock_source,struct pixel_clk_params * pix_clk_params,enum dp_link_encoding encoding,struct pll_settings * pll_settings)844 static bool dce110_program_pix_clk(
845 struct clock_source *clock_source,
846 struct pixel_clk_params *pix_clk_params,
847 enum dp_link_encoding encoding,
848 struct pll_settings *pll_settings)
849 {
850 struct dce110_clk_src *clk_src = TO_DCE110_CLK_SRC(clock_source);
851 struct bp_pixel_clock_parameters bp_pc_params = {0};
852
853 /* First disable SS
854 * ATOMBIOS will enable by default SS on PLL for DP,
855 * do not disable it here
856 */
857 if (clock_source->id != CLOCK_SOURCE_ID_EXTERNAL &&
858 !dc_is_dp_signal(pix_clk_params->signal_type) &&
859 clock_source->ctx->dce_version <= DCE_VERSION_11_0)
860 disable_spread_spectrum(clk_src);
861
862 /*ATOMBIOS expects pixel rate adjusted by deep color ratio)*/
863 bp_pc_params.controller_id = pix_clk_params->controller_id;
864 bp_pc_params.pll_id = clock_source->id;
865 bp_pc_params.target_pixel_clock_100hz = pll_settings->actual_pix_clk_100hz;
866 bp_pc_params.encoder_object_id = pix_clk_params->encoder_object_id;
867 bp_pc_params.signal_type = pix_clk_params->signal_type;
868
869 bp_pc_params.reference_divider = pll_settings->reference_divider;
870 bp_pc_params.feedback_divider = pll_settings->feedback_divider;
871 bp_pc_params.fractional_feedback_divider =
872 pll_settings->fract_feedback_divider;
873 bp_pc_params.pixel_clock_post_divider =
874 pll_settings->pix_clk_post_divider;
875 bp_pc_params.flags.SET_EXTERNAL_REF_DIV_SRC =
876 pll_settings->use_external_clk;
877
878 switch (pix_clk_params->color_depth) {
879 case COLOR_DEPTH_101010:
880 bp_pc_params.color_depth = TRANSMITTER_COLOR_DEPTH_30;
881 break;
882 case COLOR_DEPTH_121212:
883 bp_pc_params.color_depth = TRANSMITTER_COLOR_DEPTH_36;
884 break;
885 case COLOR_DEPTH_161616:
886 bp_pc_params.color_depth = TRANSMITTER_COLOR_DEPTH_48;
887 break;
888 default:
889 break;
890 }
891
892 if (clk_src->bios->funcs->set_pixel_clock(
893 clk_src->bios, &bp_pc_params) != BP_RESULT_OK)
894 return false;
895 /* Enable SS
896 * ATOMBIOS will enable by default SS for DP on PLL ( DP ID clock),
897 * based on HW display PLL team, SS control settings should be programmed
898 * during PLL Reset, but they do not have effect
899 * until SS_EN is asserted.*/
900 if (clock_source->id != CLOCK_SOURCE_ID_EXTERNAL
901 && !dc_is_dp_signal(pix_clk_params->signal_type)) {
902
903 if (pix_clk_params->flags.ENABLE_SS)
904 if (!enable_spread_spectrum(clk_src,
905 pix_clk_params->signal_type,
906 pll_settings))
907 return false;
908
909 /* Resync deep color DTO */
910 dce110_program_pixel_clk_resync(clk_src,
911 pix_clk_params->signal_type,
912 pix_clk_params->color_depth);
913 }
914
915 return true;
916 }
917
dce112_program_pix_clk(struct clock_source * clock_source,struct pixel_clk_params * pix_clk_params,enum dp_link_encoding encoding,struct pll_settings * pll_settings)918 static bool dce112_program_pix_clk(
919 struct clock_source *clock_source,
920 struct pixel_clk_params *pix_clk_params,
921 enum dp_link_encoding encoding,
922 struct pll_settings *pll_settings)
923 {
924 struct dce110_clk_src *clk_src = TO_DCE110_CLK_SRC(clock_source);
925 struct bp_pixel_clock_parameters bp_pc_params = {0};
926
927 /* First disable SS
928 * ATOMBIOS will enable by default SS on PLL for DP,
929 * do not disable it here
930 */
931 if (clock_source->id != CLOCK_SOURCE_ID_EXTERNAL &&
932 !dc_is_dp_signal(pix_clk_params->signal_type) &&
933 clock_source->ctx->dce_version <= DCE_VERSION_11_0)
934 disable_spread_spectrum(clk_src);
935
936 /*ATOMBIOS expects pixel rate adjusted by deep color ratio)*/
937 bp_pc_params.controller_id = pix_clk_params->controller_id;
938 bp_pc_params.pll_id = clock_source->id;
939 bp_pc_params.target_pixel_clock_100hz = pll_settings->actual_pix_clk_100hz;
940 bp_pc_params.encoder_object_id = pix_clk_params->encoder_object_id;
941 bp_pc_params.signal_type = pix_clk_params->signal_type;
942
943 if (clock_source->id != CLOCK_SOURCE_ID_DP_DTO) {
944 bp_pc_params.flags.SET_GENLOCK_REF_DIV_SRC =
945 pll_settings->use_external_clk;
946 bp_pc_params.flags.SET_XTALIN_REF_SRC =
947 !pll_settings->use_external_clk;
948 if (pix_clk_params->flags.SUPPORT_YCBCR420) {
949 bp_pc_params.flags.SUPPORT_YUV_420 = 1;
950 }
951 }
952 if (clk_src->bios->funcs->set_pixel_clock(
953 clk_src->bios, &bp_pc_params) != BP_RESULT_OK)
954 return false;
955 /* Resync deep color DTO */
956 if (clock_source->id != CLOCK_SOURCE_ID_DP_DTO)
957 dce112_program_pixel_clk_resync(clk_src,
958 pix_clk_params->signal_type,
959 pix_clk_params->color_depth,
960 pix_clk_params->flags.SUPPORT_YCBCR420);
961
962 return true;
963 }
964
dcn31_program_pix_clk(struct clock_source * clock_source,struct pixel_clk_params * pix_clk_params,enum dp_link_encoding encoding,struct pll_settings * pll_settings)965 static bool dcn31_program_pix_clk(
966 struct clock_source *clock_source,
967 struct pixel_clk_params *pix_clk_params,
968 enum dp_link_encoding encoding,
969 struct pll_settings *pll_settings)
970 {
971 struct dce110_clk_src *clk_src = TO_DCE110_CLK_SRC(clock_source);
972 unsigned int inst = pix_clk_params->controller_id - CONTROLLER_ID_D0;
973 unsigned int dp_dto_ref_khz = clock_source->ctx->dc->clk_mgr->dprefclk_khz;
974 const struct pixel_rate_range_table_entry *e =
975 look_up_in_video_optimized_rate_tlb(pix_clk_params->requested_pix_clk_100hz / 10);
976 struct bp_pixel_clock_parameters bp_pc_params = {0};
977 enum transmitter_color_depth bp_pc_colour_depth = TRANSMITTER_COLOR_DEPTH_24;
978
979 // Apply ssed(spread spectrum) dpref clock for edp and dp
980 if (clock_source->ctx->dc->clk_mgr->dp_dto_source_clock_in_khz != 0 &&
981 dc_is_dp_signal(pix_clk_params->signal_type) &&
982 encoding == DP_8b_10b_ENCODING)
983 dp_dto_ref_khz = clock_source->ctx->dc->clk_mgr->dp_dto_source_clock_in_khz;
984
985 // For these signal types Driver to program DP_DTO without calling VBIOS Command table
986 if (dc_is_dp_signal(pix_clk_params->signal_type) || dc_is_virtual_signal(pix_clk_params->signal_type)) {
987 if (e) {
988 /* Set DTO values: phase = target clock, modulo = reference clock*/
989 REG_WRITE(PHASE[inst], e->target_pixel_rate_khz * e->mult_factor);
990 REG_WRITE(MODULO[inst], dp_dto_ref_khz * e->div_factor);
991 } else {
992 /* Set DTO values: phase = target clock, modulo = reference clock*/
993 REG_WRITE(PHASE[inst], pll_settings->actual_pix_clk_100hz * 100);
994 REG_WRITE(MODULO[inst], dp_dto_ref_khz * 1000);
995 }
996 /* Enable DTO */
997 if (clk_src->cs_mask->PIPE0_DTO_SRC_SEL)
998 if (encoding == DP_128b_132b_ENCODING)
999 REG_UPDATE_2(PIXEL_RATE_CNTL[inst],
1000 DP_DTO0_ENABLE, 1,
1001 PIPE0_DTO_SRC_SEL, 2);
1002 else
1003 REG_UPDATE_2(PIXEL_RATE_CNTL[inst],
1004 DP_DTO0_ENABLE, 1,
1005 PIPE0_DTO_SRC_SEL, 1);
1006 else
1007 REG_UPDATE(PIXEL_RATE_CNTL[inst],
1008 DP_DTO0_ENABLE, 1);
1009 } else {
1010
1011 if (clk_src->cs_mask->PIPE0_DTO_SRC_SEL)
1012 REG_UPDATE(PIXEL_RATE_CNTL[inst],
1013 PIPE0_DTO_SRC_SEL, 0);
1014
1015 /*ATOMBIOS expects pixel rate adjusted by deep color ratio)*/
1016 bp_pc_params.controller_id = pix_clk_params->controller_id;
1017 bp_pc_params.pll_id = clock_source->id;
1018 bp_pc_params.target_pixel_clock_100hz = pll_settings->actual_pix_clk_100hz;
1019 bp_pc_params.encoder_object_id = pix_clk_params->encoder_object_id;
1020 bp_pc_params.signal_type = pix_clk_params->signal_type;
1021
1022 // Make sure we send the correct color depth to DMUB for HDMI
1023 if (pix_clk_params->signal_type == SIGNAL_TYPE_HDMI_TYPE_A) {
1024 switch (pix_clk_params->color_depth) {
1025 case COLOR_DEPTH_888:
1026 bp_pc_colour_depth = TRANSMITTER_COLOR_DEPTH_24;
1027 break;
1028 case COLOR_DEPTH_101010:
1029 bp_pc_colour_depth = TRANSMITTER_COLOR_DEPTH_30;
1030 break;
1031 case COLOR_DEPTH_121212:
1032 bp_pc_colour_depth = TRANSMITTER_COLOR_DEPTH_36;
1033 break;
1034 case COLOR_DEPTH_161616:
1035 bp_pc_colour_depth = TRANSMITTER_COLOR_DEPTH_48;
1036 break;
1037 default:
1038 bp_pc_colour_depth = TRANSMITTER_COLOR_DEPTH_24;
1039 break;
1040 }
1041 bp_pc_params.color_depth = bp_pc_colour_depth;
1042 }
1043
1044 if (clock_source->id != CLOCK_SOURCE_ID_DP_DTO) {
1045 bp_pc_params.flags.SET_GENLOCK_REF_DIV_SRC =
1046 pll_settings->use_external_clk;
1047 bp_pc_params.flags.SET_XTALIN_REF_SRC =
1048 !pll_settings->use_external_clk;
1049 if (pix_clk_params->flags.SUPPORT_YCBCR420) {
1050 bp_pc_params.flags.SUPPORT_YUV_420 = 1;
1051 }
1052 }
1053 if (clk_src->bios->funcs->set_pixel_clock(
1054 clk_src->bios, &bp_pc_params) != BP_RESULT_OK)
1055 return false;
1056 /* Resync deep color DTO */
1057 if (clock_source->id != CLOCK_SOURCE_ID_DP_DTO)
1058 dce112_program_pixel_clk_resync(clk_src,
1059 pix_clk_params->signal_type,
1060 pix_clk_params->color_depth,
1061 pix_clk_params->flags.SUPPORT_YCBCR420);
1062 }
1063
1064 return true;
1065 }
1066
dcn401_program_pix_clk(struct clock_source * clock_source,struct pixel_clk_params * pix_clk_params,enum dp_link_encoding encoding,struct pll_settings * pll_settings)1067 static bool dcn401_program_pix_clk(
1068 struct clock_source *clock_source,
1069 struct pixel_clk_params *pix_clk_params,
1070 enum dp_link_encoding encoding,
1071 struct pll_settings *pll_settings)
1072 {
1073 struct dce110_clk_src *clk_src = TO_DCE110_CLK_SRC(clock_source);
1074 unsigned int inst = pix_clk_params->controller_id - CONTROLLER_ID_D0;
1075 const struct pixel_rate_range_table_entry *e =
1076 look_up_in_video_optimized_rate_tlb(pix_clk_params->requested_pix_clk_100hz / 10);
1077 struct bp_pixel_clock_parameters bp_pc_params = {0};
1078 enum transmitter_color_depth bp_pc_colour_depth = TRANSMITTER_COLOR_DEPTH_24;
1079 struct dp_dto_params dto_params = { 0 };
1080
1081 dto_params.otg_inst = inst;
1082 dto_params.signal = pix_clk_params->signal_type;
1083
1084 // all but TMDS gets Driver to program DP_DTO without calling VBIOS Command table
1085 if (!dc_is_tmds_signal(pix_clk_params->signal_type)) {
1086 long long dtbclk_p_src_clk_khz;
1087
1088 dtbclk_p_src_clk_khz = clock_source->ctx->dc->clk_mgr->dprefclk_khz;
1089 dto_params.clk_src = DPREFCLK;
1090
1091 if (e) {
1092 dto_params.pixclk_hz = e->target_pixel_rate_khz;
1093 dto_params.pixclk_hz *= e->mult_factor;
1094 dto_params.refclk_hz = dtbclk_p_src_clk_khz;
1095 dto_params.refclk_hz *= e->div_factor;
1096 } else {
1097 dto_params.pixclk_hz = pix_clk_params->requested_pix_clk_100hz;
1098 dto_params.pixclk_hz *= 100;
1099 dto_params.refclk_hz = dtbclk_p_src_clk_khz;
1100 dto_params.refclk_hz *= 1000;
1101 }
1102
1103 /* enable DP DTO */
1104 clock_source->ctx->dc->res_pool->dccg->funcs->set_dp_dto(
1105 clock_source->ctx->dc->res_pool->dccg,
1106 &dto_params);
1107
1108 } else {
1109 if (pll_settings->actual_pix_clk_100hz > 6000000UL)
1110 return false;
1111
1112 /* disables DP DTO when provided with TMDS signal type */
1113 clock_source->ctx->dc->res_pool->dccg->funcs->set_dp_dto(
1114 clock_source->ctx->dc->res_pool->dccg,
1115 &dto_params);
1116
1117 /*ATOMBIOS expects pixel rate adjusted by deep color ratio)*/
1118 bp_pc_params.controller_id = pix_clk_params->controller_id;
1119 bp_pc_params.pll_id = clock_source->id;
1120 bp_pc_params.target_pixel_clock_100hz = pll_settings->actual_pix_clk_100hz;
1121 bp_pc_params.encoder_object_id = pix_clk_params->encoder_object_id;
1122 bp_pc_params.signal_type = pix_clk_params->signal_type;
1123
1124 // Make sure we send the correct color depth to DMUB for HDMI
1125 if (pix_clk_params->signal_type == SIGNAL_TYPE_HDMI_TYPE_A) {
1126 switch (pix_clk_params->color_depth) {
1127 case COLOR_DEPTH_888:
1128 bp_pc_colour_depth = TRANSMITTER_COLOR_DEPTH_24;
1129 break;
1130 case COLOR_DEPTH_101010:
1131 bp_pc_colour_depth = TRANSMITTER_COLOR_DEPTH_30;
1132 break;
1133 case COLOR_DEPTH_121212:
1134 bp_pc_colour_depth = TRANSMITTER_COLOR_DEPTH_36;
1135 break;
1136 case COLOR_DEPTH_161616:
1137 bp_pc_colour_depth = TRANSMITTER_COLOR_DEPTH_48;
1138 break;
1139 default:
1140 bp_pc_colour_depth = TRANSMITTER_COLOR_DEPTH_24;
1141 break;
1142 }
1143 bp_pc_params.color_depth = bp_pc_colour_depth;
1144 }
1145
1146 if (clock_source->id != CLOCK_SOURCE_ID_DP_DTO) {
1147 bp_pc_params.flags.SET_GENLOCK_REF_DIV_SRC =
1148 pll_settings->use_external_clk;
1149 bp_pc_params.flags.SET_XTALIN_REF_SRC =
1150 !pll_settings->use_external_clk;
1151 if (pix_clk_params->flags.SUPPORT_YCBCR420) {
1152 bp_pc_params.flags.SUPPORT_YUV_420 = 1;
1153 }
1154 }
1155 if (clk_src->bios->funcs->set_pixel_clock(
1156 clk_src->bios, &bp_pc_params) != BP_RESULT_OK)
1157 return false;
1158 /* Resync deep color DTO */
1159 if (clock_source->id != CLOCK_SOURCE_ID_DP_DTO)
1160 dce112_program_pixel_clk_resync(clk_src,
1161 pix_clk_params->signal_type,
1162 pix_clk_params->color_depth,
1163 pix_clk_params->flags.SUPPORT_YCBCR420);
1164 }
1165
1166 return true;
1167 }
1168
dce110_clock_source_power_down(struct clock_source * clk_src)1169 static bool dce110_clock_source_power_down(
1170 struct clock_source *clk_src)
1171 {
1172 struct dce110_clk_src *dce110_clk_src = TO_DCE110_CLK_SRC(clk_src);
1173 enum bp_result bp_result;
1174 struct bp_pixel_clock_parameters bp_pixel_clock_params = {0};
1175
1176 if (clk_src->dp_clk_src)
1177 return true;
1178
1179 /* If Pixel Clock is 0 it means Power Down Pll*/
1180 bp_pixel_clock_params.controller_id = CONTROLLER_ID_UNDEFINED;
1181 bp_pixel_clock_params.pll_id = clk_src->id;
1182 bp_pixel_clock_params.flags.FORCE_PROGRAMMING_OF_PLL = 1;
1183
1184 /*Call ASICControl to process ATOMBIOS Exec table*/
1185 bp_result = dce110_clk_src->bios->funcs->set_pixel_clock(
1186 dce110_clk_src->bios,
1187 &bp_pixel_clock_params);
1188
1189 return bp_result == BP_RESULT_OK;
1190 }
1191
get_pixel_clk_frequency_100hz(const struct clock_source * clock_source,unsigned int inst,unsigned int * pixel_clk_khz)1192 static bool get_pixel_clk_frequency_100hz(
1193 const struct clock_source *clock_source,
1194 unsigned int inst,
1195 unsigned int *pixel_clk_khz)
1196 {
1197 struct dce110_clk_src *clk_src = TO_DCE110_CLK_SRC(clock_source);
1198 unsigned int clock_hz = 0;
1199 unsigned int modulo_hz = 0;
1200 unsigned int dp_dto_ref_khz = clock_source->ctx->dc->clk_mgr->dprefclk_khz;
1201
1202 if (clock_source->id == CLOCK_SOURCE_ID_DP_DTO) {
1203 clock_hz = REG_READ(PHASE[inst]);
1204
1205 if (clock_source->ctx->dc->hwss.enable_vblanks_synchronization &&
1206 clock_source->ctx->dc->config.vblank_alignment_max_frame_time_diff > 0) {
1207 /* NOTE: In case VBLANK syncronization is enabled, MODULO may
1208 * not be programmed equal to DPREFCLK
1209 */
1210 modulo_hz = REG_READ(MODULO[inst]);
1211 if (modulo_hz)
1212 *pixel_clk_khz = div_u64((uint64_t)clock_hz*
1213 dp_dto_ref_khz*10,
1214 modulo_hz);
1215 else
1216 *pixel_clk_khz = 0;
1217 } else {
1218 /* NOTE: There is agreement with VBIOS here that MODULO is
1219 * programmed equal to DPREFCLK, in which case PHASE will be
1220 * equivalent to pixel clock.
1221 */
1222 *pixel_clk_khz = clock_hz / 100;
1223 }
1224 return true;
1225 }
1226
1227 return false;
1228 }
1229
1230 /* this table is use to find *1.001 and /1.001 pixel rates from non-precise pixel rate */
1231 const struct pixel_rate_range_table_entry video_optimized_pixel_rates[] = {
1232 // /1.001 rates
1233 {25170, 25180, 25200, 1000, 1001}, //25.2MHz -> 25.17
1234 {59340, 59350, 59400, 1000, 1001}, //59.4Mhz -> 59.340
1235 {74170, 74180, 74250, 1000, 1001}, //74.25Mhz -> 74.1758
1236 {89910, 90000, 90000, 1000, 1001}, //90Mhz -> 89.91
1237 {125870, 125880, 126000, 1000, 1001}, //126Mhz -> 125.87
1238 {148350, 148360, 148500, 1000, 1001}, //148.5Mhz -> 148.3516
1239 {167830, 167840, 168000, 1000, 1001}, //168Mhz -> 167.83
1240 {222520, 222530, 222750, 1000, 1001}, //222.75Mhz -> 222.527
1241 {257140, 257150, 257400, 1000, 1001}, //257.4Mhz -> 257.1429
1242 {296700, 296710, 297000, 1000, 1001}, //297Mhz -> 296.7033
1243 {342850, 342860, 343200, 1000, 1001}, //343.2Mhz -> 342.857
1244 {395600, 395610, 396000, 1000, 1001}, //396Mhz -> 395.6
1245 {409090, 409100, 409500, 1000, 1001}, //409.5Mhz -> 409.091
1246 {445050, 445060, 445500, 1000, 1001}, //445.5Mhz -> 445.055
1247 {467530, 467540, 468000, 1000, 1001}, //468Mhz -> 467.5325
1248 {519230, 519240, 519750, 1000, 1001}, //519.75Mhz -> 519.231
1249 {525970, 525980, 526500, 1000, 1001}, //526.5Mhz -> 525.974
1250 {545450, 545460, 546000, 1000, 1001}, //546Mhz -> 545.455
1251 {593400, 593410, 594000, 1000, 1001}, //594Mhz -> 593.4066
1252 {623370, 623380, 624000, 1000, 1001}, //624Mhz -> 623.377
1253 {692300, 692310, 693000, 1000, 1001}, //693Mhz -> 692.308
1254 {701290, 701300, 702000, 1000, 1001}, //702Mhz -> 701.2987
1255 {791200, 791210, 792000, 1000, 1001}, //792Mhz -> 791.209
1256 {890100, 890110, 891000, 1000, 1001}, //891Mhz -> 890.1099
1257 {1186810, 1186820, 1188000, 1000, 1001},//1188Mhz -> 1186.8131
1258
1259 // *1.001 rates
1260 {27020, 27030, 27000, 1001, 1000}, //27Mhz
1261 {54050, 54060, 54000, 1001, 1000}, //54Mhz
1262 {108100, 108110, 108000, 1001, 1000},//108Mhz
1263 };
1264
look_up_in_video_optimized_rate_tlb(unsigned int pixel_rate_khz)1265 const struct pixel_rate_range_table_entry *look_up_in_video_optimized_rate_tlb(
1266 unsigned int pixel_rate_khz)
1267 {
1268 int i;
1269
1270 for (i = 0; i < NUM_ELEMENTS(video_optimized_pixel_rates); i++) {
1271 const struct pixel_rate_range_table_entry *e = &video_optimized_pixel_rates[i];
1272
1273 if (e->range_min_khz <= pixel_rate_khz && pixel_rate_khz <= e->range_max_khz) {
1274 return e;
1275 }
1276 }
1277
1278 return NULL;
1279 }
1280
dcn20_program_pix_clk(struct clock_source * clock_source,struct pixel_clk_params * pix_clk_params,enum dp_link_encoding encoding,struct pll_settings * pll_settings)1281 static bool dcn20_program_pix_clk(
1282 struct clock_source *clock_source,
1283 struct pixel_clk_params *pix_clk_params,
1284 enum dp_link_encoding encoding,
1285 struct pll_settings *pll_settings)
1286 {
1287 struct dce110_clk_src *clk_src = TO_DCE110_CLK_SRC(clock_source);
1288 unsigned int inst = pix_clk_params->controller_id - CONTROLLER_ID_D0;
1289
1290 dce112_program_pix_clk(clock_source, pix_clk_params, encoding, pll_settings);
1291
1292 if (clock_source->ctx->dc->hwss.enable_vblanks_synchronization &&
1293 clock_source->ctx->dc->config.vblank_alignment_max_frame_time_diff > 0) {
1294 /* NOTE: In case VBLANK syncronization is enabled,
1295 * we need to set modulo to default DPREFCLK first
1296 * dce112_program_pix_clk does not set default DPREFCLK
1297 */
1298 REG_WRITE(MODULO[inst],
1299 clock_source->ctx->dc->clk_mgr->dprefclk_khz*1000);
1300 }
1301 return true;
1302 }
1303
dcn20_override_dp_pix_clk(struct clock_source * clock_source,unsigned int inst,unsigned int pixel_clk,unsigned int ref_clk)1304 static bool dcn20_override_dp_pix_clk(
1305 struct clock_source *clock_source,
1306 unsigned int inst,
1307 unsigned int pixel_clk,
1308 unsigned int ref_clk)
1309 {
1310 struct dce110_clk_src *clk_src = TO_DCE110_CLK_SRC(clock_source);
1311
1312 REG_UPDATE(PIXEL_RATE_CNTL[inst], DP_DTO0_ENABLE, 0);
1313 REG_WRITE(PHASE[inst], pixel_clk);
1314 REG_WRITE(MODULO[inst], ref_clk);
1315 REG_UPDATE(PIXEL_RATE_CNTL[inst], DP_DTO0_ENABLE, 1);
1316 return true;
1317 }
1318
1319 static const struct clock_source_funcs dcn20_clk_src_funcs = {
1320 .cs_power_down = dce110_clock_source_power_down,
1321 .program_pix_clk = dcn20_program_pix_clk,
1322 .get_pix_clk_dividers = dce112_get_pix_clk_dividers,
1323 .get_pixel_clk_frequency_100hz = get_pixel_clk_frequency_100hz,
1324 .override_dp_pix_clk = dcn20_override_dp_pix_clk
1325 };
1326
dcn3_program_pix_clk(struct clock_source * clock_source,struct pixel_clk_params * pix_clk_params,enum dp_link_encoding encoding,struct pll_settings * pll_settings)1327 static bool dcn3_program_pix_clk(
1328 struct clock_source *clock_source,
1329 struct pixel_clk_params *pix_clk_params,
1330 enum dp_link_encoding encoding,
1331 struct pll_settings *pll_settings)
1332 {
1333 struct dce110_clk_src *clk_src = TO_DCE110_CLK_SRC(clock_source);
1334 unsigned int inst = pix_clk_params->controller_id - CONTROLLER_ID_D0;
1335 unsigned int dp_dto_ref_khz = clock_source->ctx->dc->clk_mgr->dprefclk_khz;
1336 const struct pixel_rate_range_table_entry *e =
1337 look_up_in_video_optimized_rate_tlb(pix_clk_params->requested_pix_clk_100hz / 10);
1338
1339 // For these signal types Driver to program DP_DTO without calling VBIOS Command table
1340 if (dc_is_dp_signal(pix_clk_params->signal_type)) {
1341 if (e) {
1342 /* Set DTO values: phase = target clock, modulo = reference clock*/
1343 REG_WRITE(PHASE[inst], e->target_pixel_rate_khz * e->mult_factor);
1344 REG_WRITE(MODULO[inst], dp_dto_ref_khz * e->div_factor);
1345 } else {
1346 /* Set DTO values: phase = target clock, modulo = reference clock*/
1347 REG_WRITE(PHASE[inst], pll_settings->actual_pix_clk_100hz * 100);
1348 REG_WRITE(MODULO[inst], dp_dto_ref_khz * 1000);
1349 }
1350 /* Enable DTO */
1351 if (clk_src->cs_mask->PIPE0_DTO_SRC_SEL)
1352 REG_UPDATE_2(PIXEL_RATE_CNTL[inst],
1353 DP_DTO0_ENABLE, 1,
1354 PIPE0_DTO_SRC_SEL, 1);
1355 else
1356 REG_UPDATE(PIXEL_RATE_CNTL[inst],
1357 DP_DTO0_ENABLE, 1);
1358 } else
1359 // For other signal types(HDMI_TYPE_A, DVI) Driver still to call VBIOS Command table
1360 dce112_program_pix_clk(clock_source, pix_clk_params, encoding, pll_settings);
1361
1362 return true;
1363 }
1364
dcn3_get_pix_clk_dividers(struct clock_source * cs,struct pixel_clk_params * pix_clk_params,struct pll_settings * pll_settings)1365 static uint32_t dcn3_get_pix_clk_dividers(
1366 struct clock_source *cs,
1367 struct pixel_clk_params *pix_clk_params,
1368 struct pll_settings *pll_settings)
1369 {
1370 unsigned long long actual_pix_clk_100Hz = pix_clk_params ? pix_clk_params->requested_pix_clk_100hz : 0;
1371 struct dce110_clk_src *clk_src = TO_DCE110_CLK_SRC(cs);
1372
1373 DC_LOGGER_INIT();
1374
1375 if (pix_clk_params == NULL || pll_settings == NULL
1376 || pix_clk_params->requested_pix_clk_100hz == 0) {
1377 DC_LOG_ERROR(
1378 "%s: Invalid parameters!!\n", __func__);
1379 return -1;
1380 }
1381
1382 memset(pll_settings, 0, sizeof(*pll_settings));
1383 /* Adjust for HDMI Type A deep color */
1384 if (pix_clk_params->signal_type == SIGNAL_TYPE_HDMI_TYPE_A) {
1385 switch (pix_clk_params->color_depth) {
1386 case COLOR_DEPTH_101010:
1387 actual_pix_clk_100Hz = (actual_pix_clk_100Hz * 5) >> 2;
1388 break;
1389 case COLOR_DEPTH_121212:
1390 actual_pix_clk_100Hz = (actual_pix_clk_100Hz * 6) >> 2;
1391 break;
1392 case COLOR_DEPTH_161616:
1393 actual_pix_clk_100Hz = actual_pix_clk_100Hz * 2;
1394 break;
1395 default:
1396 break;
1397 }
1398 }
1399 pll_settings->actual_pix_clk_100hz = (unsigned int) actual_pix_clk_100Hz;
1400 pll_settings->adjusted_pix_clk_100hz = (unsigned int) actual_pix_clk_100Hz;
1401 pll_settings->calculated_pix_clk_100hz = (unsigned int) actual_pix_clk_100Hz;
1402
1403 return 0;
1404 }
1405
1406 static const struct clock_source_funcs dcn3_clk_src_funcs = {
1407 .cs_power_down = dce110_clock_source_power_down,
1408 .program_pix_clk = dcn3_program_pix_clk,
1409 .get_pix_clk_dividers = dcn3_get_pix_clk_dividers,
1410 .get_pixel_clk_frequency_100hz = get_pixel_clk_frequency_100hz
1411 };
1412
1413 static const struct clock_source_funcs dcn31_clk_src_funcs = {
1414 .cs_power_down = dce110_clock_source_power_down,
1415 .program_pix_clk = dcn31_program_pix_clk,
1416 .get_pix_clk_dividers = dcn3_get_pix_clk_dividers,
1417 .get_pixel_clk_frequency_100hz = get_pixel_clk_frequency_100hz
1418 };
1419
1420 static const struct clock_source_funcs dcn401_clk_src_funcs = {
1421 .cs_power_down = dce110_clock_source_power_down,
1422 .program_pix_clk = dcn401_program_pix_clk,
1423 .get_pix_clk_dividers = dcn3_get_pix_clk_dividers,
1424 .get_pixel_clk_frequency_100hz = get_pixel_clk_frequency_100hz
1425 };
1426
1427 /*****************************************/
1428 /* Constructor */
1429 /*****************************************/
1430
1431 static const struct clock_source_funcs dce112_clk_src_funcs = {
1432 .cs_power_down = dce110_clock_source_power_down,
1433 .program_pix_clk = dce112_program_pix_clk,
1434 .get_pix_clk_dividers = dce112_get_pix_clk_dividers,
1435 .get_pixel_clk_frequency_100hz = get_pixel_clk_frequency_100hz
1436 };
1437 static const struct clock_source_funcs dce110_clk_src_funcs = {
1438 .cs_power_down = dce110_clock_source_power_down,
1439 .program_pix_clk = dce110_program_pix_clk,
1440 .get_pix_clk_dividers = dce110_get_pix_clk_dividers,
1441 .get_pixel_clk_frequency_100hz = get_pixel_clk_frequency_100hz
1442 };
1443
1444
get_ss_info_from_atombios(struct dce110_clk_src * clk_src,enum as_signal_type as_signal,struct spread_spectrum_data * spread_spectrum_data[],uint32_t * ss_entries_num)1445 static void get_ss_info_from_atombios(
1446 struct dce110_clk_src *clk_src,
1447 enum as_signal_type as_signal,
1448 struct spread_spectrum_data *spread_spectrum_data[],
1449 uint32_t *ss_entries_num)
1450 {
1451 enum bp_result bp_result = BP_RESULT_FAILURE;
1452 struct spread_spectrum_info *ss_info;
1453 struct spread_spectrum_data *ss_data;
1454 struct spread_spectrum_info *ss_info_cur;
1455 struct spread_spectrum_data *ss_data_cur;
1456 uint32_t i;
1457 DC_LOGGER_INIT();
1458 if (ss_entries_num == NULL) {
1459 DC_LOG_SYNC(
1460 "Invalid entry !!!\n");
1461 return;
1462 }
1463 if (spread_spectrum_data == NULL) {
1464 DC_LOG_SYNC(
1465 "Invalid array pointer!!!\n");
1466 return;
1467 }
1468
1469 spread_spectrum_data[0] = NULL;
1470 *ss_entries_num = 0;
1471
1472 *ss_entries_num = clk_src->bios->funcs->get_ss_entry_number(
1473 clk_src->bios,
1474 as_signal);
1475
1476 if (*ss_entries_num == 0)
1477 return;
1478
1479 ss_info = kcalloc(*ss_entries_num,
1480 sizeof(struct spread_spectrum_info),
1481 GFP_KERNEL);
1482 ss_info_cur = ss_info;
1483 if (ss_info == NULL)
1484 return;
1485
1486 ss_data = kcalloc(*ss_entries_num,
1487 sizeof(struct spread_spectrum_data),
1488 GFP_KERNEL);
1489 if (ss_data == NULL)
1490 goto out_free_info;
1491
1492 for (i = 0, ss_info_cur = ss_info;
1493 i < (*ss_entries_num);
1494 ++i, ++ss_info_cur) {
1495
1496 bp_result = clk_src->bios->funcs->get_spread_spectrum_info(
1497 clk_src->bios,
1498 as_signal,
1499 i,
1500 ss_info_cur);
1501
1502 if (bp_result != BP_RESULT_OK)
1503 goto out_free_data;
1504 }
1505
1506 for (i = 0, ss_info_cur = ss_info, ss_data_cur = ss_data;
1507 i < (*ss_entries_num);
1508 ++i, ++ss_info_cur, ++ss_data_cur) {
1509
1510 if (ss_info_cur->type.STEP_AND_DELAY_INFO != false) {
1511 DC_LOG_SYNC(
1512 "Invalid ATOMBIOS SS Table!!!\n");
1513 goto out_free_data;
1514 }
1515
1516 /* for HDMI check SS percentage,
1517 * if it is > 6 (0.06%), the ATOMBIOS table info is invalid*/
1518 if (as_signal == AS_SIGNAL_TYPE_HDMI
1519 && ss_info_cur->spread_spectrum_percentage > 6){
1520 /* invalid input, do nothing */
1521 DC_LOG_SYNC(
1522 "Invalid SS percentage ");
1523 DC_LOG_SYNC(
1524 "for HDMI in ATOMBIOS info Table!!!\n");
1525 continue;
1526 }
1527 if (ss_info_cur->spread_percentage_divider == 1000) {
1528 /* Keep previous precision from ATOMBIOS for these
1529 * in case new precision set by ATOMBIOS for these
1530 * (otherwise all code in DCE specific classes
1531 * for all previous ASICs would need
1532 * to be updated for SS calculations,
1533 * Audio SS compensation and DP DTO SS compensation
1534 * which assumes fixed SS percentage Divider = 100)*/
1535 ss_info_cur->spread_spectrum_percentage /= 10;
1536 ss_info_cur->spread_percentage_divider = 100;
1537 }
1538
1539 ss_data_cur->freq_range_khz = ss_info_cur->target_clock_range;
1540 ss_data_cur->percentage =
1541 ss_info_cur->spread_spectrum_percentage;
1542 ss_data_cur->percentage_divider =
1543 ss_info_cur->spread_percentage_divider;
1544 ss_data_cur->modulation_freq_hz =
1545 ss_info_cur->spread_spectrum_range;
1546
1547 if (ss_info_cur->type.CENTER_MODE)
1548 ss_data_cur->flags.CENTER_SPREAD = 1;
1549
1550 if (ss_info_cur->type.EXTERNAL)
1551 ss_data_cur->flags.EXTERNAL_SS = 1;
1552
1553 }
1554
1555 *spread_spectrum_data = ss_data;
1556 kfree(ss_info);
1557 return;
1558
1559 out_free_data:
1560 kfree(ss_data);
1561 *ss_entries_num = 0;
1562 out_free_info:
1563 kfree(ss_info);
1564 }
1565
ss_info_from_atombios_create(struct dce110_clk_src * clk_src)1566 static void ss_info_from_atombios_create(
1567 struct dce110_clk_src *clk_src)
1568 {
1569 get_ss_info_from_atombios(
1570 clk_src,
1571 AS_SIGNAL_TYPE_DISPLAY_PORT,
1572 &clk_src->dp_ss_params,
1573 &clk_src->dp_ss_params_cnt);
1574 get_ss_info_from_atombios(
1575 clk_src,
1576 AS_SIGNAL_TYPE_HDMI,
1577 &clk_src->hdmi_ss_params,
1578 &clk_src->hdmi_ss_params_cnt);
1579 get_ss_info_from_atombios(
1580 clk_src,
1581 AS_SIGNAL_TYPE_DVI,
1582 &clk_src->dvi_ss_params,
1583 &clk_src->dvi_ss_params_cnt);
1584 get_ss_info_from_atombios(
1585 clk_src,
1586 AS_SIGNAL_TYPE_LVDS,
1587 &clk_src->lvds_ss_params,
1588 &clk_src->lvds_ss_params_cnt);
1589 }
1590
calc_pll_max_vco_construct(struct calc_pll_clock_source * calc_pll_cs,struct calc_pll_clock_source_init_data * init_data)1591 static bool calc_pll_max_vco_construct(
1592 struct calc_pll_clock_source *calc_pll_cs,
1593 struct calc_pll_clock_source_init_data *init_data)
1594 {
1595 uint32_t i;
1596 struct dc_firmware_info *fw_info;
1597 if (calc_pll_cs == NULL ||
1598 init_data == NULL ||
1599 init_data->bp == NULL)
1600 return false;
1601
1602 if (!init_data->bp->fw_info_valid)
1603 return false;
1604
1605 fw_info = &init_data->bp->fw_info;
1606 calc_pll_cs->ctx = init_data->ctx;
1607 calc_pll_cs->ref_freq_khz = fw_info->pll_info.crystal_frequency;
1608 calc_pll_cs->min_vco_khz =
1609 fw_info->pll_info.min_output_pxl_clk_pll_frequency;
1610 calc_pll_cs->max_vco_khz =
1611 fw_info->pll_info.max_output_pxl_clk_pll_frequency;
1612
1613 if (init_data->max_override_input_pxl_clk_pll_freq_khz != 0)
1614 calc_pll_cs->max_pll_input_freq_khz =
1615 init_data->max_override_input_pxl_clk_pll_freq_khz;
1616 else
1617 calc_pll_cs->max_pll_input_freq_khz =
1618 fw_info->pll_info.max_input_pxl_clk_pll_frequency;
1619
1620 if (init_data->min_override_input_pxl_clk_pll_freq_khz != 0)
1621 calc_pll_cs->min_pll_input_freq_khz =
1622 init_data->min_override_input_pxl_clk_pll_freq_khz;
1623 else
1624 calc_pll_cs->min_pll_input_freq_khz =
1625 fw_info->pll_info.min_input_pxl_clk_pll_frequency;
1626
1627 calc_pll_cs->min_pix_clock_pll_post_divider =
1628 init_data->min_pix_clk_pll_post_divider;
1629 calc_pll_cs->max_pix_clock_pll_post_divider =
1630 init_data->max_pix_clk_pll_post_divider;
1631 calc_pll_cs->min_pll_ref_divider =
1632 init_data->min_pll_ref_divider;
1633 calc_pll_cs->max_pll_ref_divider =
1634 init_data->max_pll_ref_divider;
1635
1636 if (init_data->num_fract_fb_divider_decimal_point == 0 ||
1637 init_data->num_fract_fb_divider_decimal_point_precision >
1638 init_data->num_fract_fb_divider_decimal_point) {
1639 DC_LOG_ERROR(
1640 "The dec point num or precision is incorrect!");
1641 return false;
1642 }
1643 if (init_data->num_fract_fb_divider_decimal_point_precision == 0) {
1644 DC_LOG_ERROR(
1645 "Incorrect fract feedback divider precision num!");
1646 return false;
1647 }
1648
1649 calc_pll_cs->fract_fb_divider_decimal_points_num =
1650 init_data->num_fract_fb_divider_decimal_point;
1651 calc_pll_cs->fract_fb_divider_precision =
1652 init_data->num_fract_fb_divider_decimal_point_precision;
1653 calc_pll_cs->fract_fb_divider_factor = 1;
1654 for (i = 0; i < calc_pll_cs->fract_fb_divider_decimal_points_num; ++i)
1655 calc_pll_cs->fract_fb_divider_factor *= 10;
1656
1657 calc_pll_cs->fract_fb_divider_precision_factor = 1;
1658 for (
1659 i = 0;
1660 i < (calc_pll_cs->fract_fb_divider_decimal_points_num -
1661 calc_pll_cs->fract_fb_divider_precision);
1662 ++i)
1663 calc_pll_cs->fract_fb_divider_precision_factor *= 10;
1664
1665 return true;
1666 }
1667
dce110_clk_src_construct(struct dce110_clk_src * clk_src,struct dc_context * ctx,struct dc_bios * bios,enum clock_source_id id,const struct dce110_clk_src_regs * regs,const struct dce110_clk_src_shift * cs_shift,const struct dce110_clk_src_mask * cs_mask)1668 bool dce110_clk_src_construct(
1669 struct dce110_clk_src *clk_src,
1670 struct dc_context *ctx,
1671 struct dc_bios *bios,
1672 enum clock_source_id id,
1673 const struct dce110_clk_src_regs *regs,
1674 const struct dce110_clk_src_shift *cs_shift,
1675 const struct dce110_clk_src_mask *cs_mask)
1676 {
1677 struct calc_pll_clock_source_init_data calc_pll_cs_init_data_hdmi;
1678 struct calc_pll_clock_source_init_data calc_pll_cs_init_data;
1679
1680 clk_src->base.ctx = ctx;
1681 clk_src->bios = bios;
1682 clk_src->base.id = id;
1683 clk_src->base.funcs = &dce110_clk_src_funcs;
1684
1685 clk_src->regs = regs;
1686 clk_src->cs_shift = cs_shift;
1687 clk_src->cs_mask = cs_mask;
1688
1689 if (!clk_src->bios->fw_info_valid) {
1690 ASSERT_CRITICAL(false);
1691 goto unexpected_failure;
1692 }
1693
1694 clk_src->ext_clk_khz = clk_src->bios->fw_info.external_clock_source_frequency_for_dp;
1695
1696 /* structure normally used with PLL ranges from ATOMBIOS; DS on by default */
1697 calc_pll_cs_init_data.bp = bios;
1698 calc_pll_cs_init_data.min_pix_clk_pll_post_divider = 1;
1699 calc_pll_cs_init_data.max_pix_clk_pll_post_divider =
1700 clk_src->cs_mask->PLL_POST_DIV_PIXCLK;
1701 calc_pll_cs_init_data.min_pll_ref_divider = 1;
1702 calc_pll_cs_init_data.max_pll_ref_divider = clk_src->cs_mask->PLL_REF_DIV;
1703 /* when 0 use minInputPxlClkPLLFrequencyInKHz from firmwareInfo*/
1704 calc_pll_cs_init_data.min_override_input_pxl_clk_pll_freq_khz = 0;
1705 /* when 0 use maxInputPxlClkPLLFrequencyInKHz from firmwareInfo*/
1706 calc_pll_cs_init_data.max_override_input_pxl_clk_pll_freq_khz = 0;
1707 /*numberOfFractFBDividerDecimalPoints*/
1708 calc_pll_cs_init_data.num_fract_fb_divider_decimal_point =
1709 FRACT_FB_DIVIDER_DEC_POINTS_MAX_NUM;
1710 /*number of decimal point to round off for fractional feedback divider value*/
1711 calc_pll_cs_init_data.num_fract_fb_divider_decimal_point_precision =
1712 FRACT_FB_DIVIDER_DEC_POINTS_MAX_NUM;
1713 calc_pll_cs_init_data.ctx = ctx;
1714
1715 /*structure for HDMI, no SS or SS% <= 0.06% for 27 MHz Ref clock */
1716 calc_pll_cs_init_data_hdmi.bp = bios;
1717 calc_pll_cs_init_data_hdmi.min_pix_clk_pll_post_divider = 1;
1718 calc_pll_cs_init_data_hdmi.max_pix_clk_pll_post_divider =
1719 clk_src->cs_mask->PLL_POST_DIV_PIXCLK;
1720 calc_pll_cs_init_data_hdmi.min_pll_ref_divider = 1;
1721 calc_pll_cs_init_data_hdmi.max_pll_ref_divider = clk_src->cs_mask->PLL_REF_DIV;
1722 /* when 0 use minInputPxlClkPLLFrequencyInKHz from firmwareInfo*/
1723 calc_pll_cs_init_data_hdmi.min_override_input_pxl_clk_pll_freq_khz = 13500;
1724 /* when 0 use maxInputPxlClkPLLFrequencyInKHz from firmwareInfo*/
1725 calc_pll_cs_init_data_hdmi.max_override_input_pxl_clk_pll_freq_khz = 27000;
1726 /*numberOfFractFBDividerDecimalPoints*/
1727 calc_pll_cs_init_data_hdmi.num_fract_fb_divider_decimal_point =
1728 FRACT_FB_DIVIDER_DEC_POINTS_MAX_NUM;
1729 /*number of decimal point to round off for fractional feedback divider value*/
1730 calc_pll_cs_init_data_hdmi.num_fract_fb_divider_decimal_point_precision =
1731 FRACT_FB_DIVIDER_DEC_POINTS_MAX_NUM;
1732 calc_pll_cs_init_data_hdmi.ctx = ctx;
1733
1734 clk_src->ref_freq_khz = clk_src->bios->fw_info.pll_info.crystal_frequency;
1735
1736 if (clk_src->base.id == CLOCK_SOURCE_ID_EXTERNAL)
1737 return true;
1738
1739 /* PLL only from here on */
1740 ss_info_from_atombios_create(clk_src);
1741
1742 if (!calc_pll_max_vco_construct(
1743 &clk_src->calc_pll,
1744 &calc_pll_cs_init_data)) {
1745 ASSERT_CRITICAL(false);
1746 goto unexpected_failure;
1747 }
1748
1749
1750 calc_pll_cs_init_data_hdmi.
1751 min_override_input_pxl_clk_pll_freq_khz = clk_src->ref_freq_khz/2;
1752 calc_pll_cs_init_data_hdmi.
1753 max_override_input_pxl_clk_pll_freq_khz = clk_src->ref_freq_khz;
1754
1755
1756 if (!calc_pll_max_vco_construct(
1757 &clk_src->calc_pll_hdmi, &calc_pll_cs_init_data_hdmi)) {
1758 ASSERT_CRITICAL(false);
1759 goto unexpected_failure;
1760 }
1761
1762 return true;
1763
1764 unexpected_failure:
1765 return false;
1766 }
1767
dce112_clk_src_construct(struct dce110_clk_src * clk_src,struct dc_context * ctx,struct dc_bios * bios,enum clock_source_id id,const struct dce110_clk_src_regs * regs,const struct dce110_clk_src_shift * cs_shift,const struct dce110_clk_src_mask * cs_mask)1768 bool dce112_clk_src_construct(
1769 struct dce110_clk_src *clk_src,
1770 struct dc_context *ctx,
1771 struct dc_bios *bios,
1772 enum clock_source_id id,
1773 const struct dce110_clk_src_regs *regs,
1774 const struct dce110_clk_src_shift *cs_shift,
1775 const struct dce110_clk_src_mask *cs_mask)
1776 {
1777 clk_src->base.ctx = ctx;
1778 clk_src->bios = bios;
1779 clk_src->base.id = id;
1780 clk_src->base.funcs = &dce112_clk_src_funcs;
1781
1782 clk_src->regs = regs;
1783 clk_src->cs_shift = cs_shift;
1784 clk_src->cs_mask = cs_mask;
1785
1786 if (!clk_src->bios->fw_info_valid) {
1787 ASSERT_CRITICAL(false);
1788 return false;
1789 }
1790
1791 clk_src->ext_clk_khz = clk_src->bios->fw_info.external_clock_source_frequency_for_dp;
1792
1793 return true;
1794 }
1795
dcn20_clk_src_construct(struct dce110_clk_src * clk_src,struct dc_context * ctx,struct dc_bios * bios,enum clock_source_id id,const struct dce110_clk_src_regs * regs,const struct dce110_clk_src_shift * cs_shift,const struct dce110_clk_src_mask * cs_mask)1796 bool dcn20_clk_src_construct(
1797 struct dce110_clk_src *clk_src,
1798 struct dc_context *ctx,
1799 struct dc_bios *bios,
1800 enum clock_source_id id,
1801 const struct dce110_clk_src_regs *regs,
1802 const struct dce110_clk_src_shift *cs_shift,
1803 const struct dce110_clk_src_mask *cs_mask)
1804 {
1805 bool ret = dce112_clk_src_construct(clk_src, ctx, bios, id, regs, cs_shift, cs_mask);
1806
1807 clk_src->base.funcs = &dcn20_clk_src_funcs;
1808
1809 return ret;
1810 }
1811
dcn3_clk_src_construct(struct dce110_clk_src * clk_src,struct dc_context * ctx,struct dc_bios * bios,enum clock_source_id id,const struct dce110_clk_src_regs * regs,const struct dce110_clk_src_shift * cs_shift,const struct dce110_clk_src_mask * cs_mask)1812 bool dcn3_clk_src_construct(
1813 struct dce110_clk_src *clk_src,
1814 struct dc_context *ctx,
1815 struct dc_bios *bios,
1816 enum clock_source_id id,
1817 const struct dce110_clk_src_regs *regs,
1818 const struct dce110_clk_src_shift *cs_shift,
1819 const struct dce110_clk_src_mask *cs_mask)
1820 {
1821 bool ret = dce112_clk_src_construct(clk_src, ctx, bios, id, regs, cs_shift, cs_mask);
1822
1823 clk_src->base.funcs = &dcn3_clk_src_funcs;
1824
1825 return ret;
1826 }
1827
dcn31_clk_src_construct(struct dce110_clk_src * clk_src,struct dc_context * ctx,struct dc_bios * bios,enum clock_source_id id,const struct dce110_clk_src_regs * regs,const struct dce110_clk_src_shift * cs_shift,const struct dce110_clk_src_mask * cs_mask)1828 bool dcn31_clk_src_construct(
1829 struct dce110_clk_src *clk_src,
1830 struct dc_context *ctx,
1831 struct dc_bios *bios,
1832 enum clock_source_id id,
1833 const struct dce110_clk_src_regs *regs,
1834 const struct dce110_clk_src_shift *cs_shift,
1835 const struct dce110_clk_src_mask *cs_mask)
1836 {
1837 bool ret = dce112_clk_src_construct(clk_src, ctx, bios, id, regs, cs_shift, cs_mask);
1838
1839 clk_src->base.funcs = &dcn31_clk_src_funcs;
1840
1841 return ret;
1842 }
1843
dcn401_clk_src_construct(struct dce110_clk_src * clk_src,struct dc_context * ctx,struct dc_bios * bios,enum clock_source_id id,const struct dce110_clk_src_regs * regs,const struct dce110_clk_src_shift * cs_shift,const struct dce110_clk_src_mask * cs_mask)1844 bool dcn401_clk_src_construct(
1845 struct dce110_clk_src *clk_src,
1846 struct dc_context *ctx,
1847 struct dc_bios *bios,
1848 enum clock_source_id id,
1849 const struct dce110_clk_src_regs *regs,
1850 const struct dce110_clk_src_shift *cs_shift,
1851 const struct dce110_clk_src_mask *cs_mask)
1852 {
1853 bool ret = dce112_clk_src_construct(clk_src, ctx, bios, id, regs, cs_shift, cs_mask);
1854
1855 clk_src->base.funcs = &dcn401_clk_src_funcs;
1856
1857 return ret;
1858 }
dcn301_clk_src_construct(struct dce110_clk_src * clk_src,struct dc_context * ctx,struct dc_bios * bios,enum clock_source_id id,const struct dce110_clk_src_regs * regs,const struct dce110_clk_src_shift * cs_shift,const struct dce110_clk_src_mask * cs_mask)1859 bool dcn301_clk_src_construct(
1860 struct dce110_clk_src *clk_src,
1861 struct dc_context *ctx,
1862 struct dc_bios *bios,
1863 enum clock_source_id id,
1864 const struct dce110_clk_src_regs *regs,
1865 const struct dce110_clk_src_shift *cs_shift,
1866 const struct dce110_clk_src_mask *cs_mask)
1867 {
1868 bool ret = dce112_clk_src_construct(clk_src, ctx, bios, id, regs, cs_shift, cs_mask);
1869
1870 clk_src->base.funcs = &dcn3_clk_src_funcs;
1871
1872 return ret;
1873 }
1874