?  search:
summary | log | graphiclog1 | graphiclog2 | commit | commitdiff | tree | refs | edit | fork
blame | history | raw | HEAD
treewide: remove redundant IS_ERR() before error code check
[linux/fpc-iii.git] / drivers / gpu / drm / amd / display / modules / freesync / freesync.c
blob6e5ecefe7d9d5a7989b519f0ff950437feccce79
1 /*
2 * Copyright 2016 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 <linux/slab.h>
27
28 #include "dm_services.h"
29 #include "dc.h"
30 #include "mod_freesync.h"
31 #include "core_types.h"
32
33 #define MOD_FREESYNC_MAX_CONCURRENT_STREAMS 32
34
35 #define MIN_REFRESH_RANGE_IN_US 10000000
36 /* Refresh rate ramp at a fixed rate of 65 Hz/second */
37 #define STATIC_SCREEN_RAMP_DELTA_REFRESH_RATE_PER_FRAME ((1000 / 60) * 65)
38 /* Number of elements in the render times cache array */
39 #define RENDER_TIMES_MAX_COUNT 10
40 /* Threshold to exit/exit BTR (to avoid frequent enter-exits at the lower limit) */
41 #define BTR_MAX_MARGIN 2500
42 /* Threshold to change BTR multiplier (to avoid frequent changes) */
43 #define BTR_DRIFT_MARGIN 2000
44 /*Threshold to exit fixed refresh rate*/
45 #define FIXED_REFRESH_EXIT_MARGIN_IN_HZ 4
46 /* Number of consecutive frames to check before entering/exiting fixed refresh*/
47 #define FIXED_REFRESH_ENTER_FRAME_COUNT 5
48 #define FIXED_REFRESH_EXIT_FRAME_COUNT 5
49
50 struct core_freesync {
51 struct mod_freesync public;
52 struct dc *dc;
53 };
54
55 #define MOD_FREESYNC_TO_CORE(mod_freesync)\
56 container_of(mod_freesync, struct core_freesync, public)
57
58 struct mod_freesync *mod_freesync_create(struct dc *dc)
59 {
60 struct core_freesync *core_freesync =
61 kzalloc(sizeof(struct core_freesync), GFP_KERNEL);
62
63 if (core_freesync == NULL)
64 goto fail_alloc_context;
65
66 if (dc == NULL)
67 goto fail_construct;
68
69 core_freesync->dc = dc;
70 return &core_freesync->public;
71
72 fail_construct:
73 kfree(core_freesync);
74
75 fail_alloc_context:
76 return NULL;
77 }
78
79 void mod_freesync_destroy(struct mod_freesync *mod_freesync)
80 {
81 struct core_freesync *core_freesync = NULL;
82 if (mod_freesync == NULL)
83 return;
84 core_freesync = MOD_FREESYNC_TO_CORE(mod_freesync);
85 kfree(core_freesync);
86 }
87
88 #if 0 /* unused currently */
89 static unsigned int calc_refresh_in_uhz_from_duration(
90 unsigned int duration_in_ns)
91 {
92 unsigned int refresh_in_uhz =
93 ((unsigned int)(div64_u64((1000000000ULL * 1000000),
94 duration_in_ns)));
95 return refresh_in_uhz;
96 }
97 #endif
98
99 static unsigned int calc_duration_in_us_from_refresh_in_uhz(
100 unsigned int refresh_in_uhz)
101 {
102 unsigned int duration_in_us =
103 ((unsigned int)(div64_u64((1000000000ULL * 1000),
104 refresh_in_uhz)));
105 return duration_in_us;
106 }
107
108 static unsigned int calc_duration_in_us_from_v_total(
109 const struct dc_stream_state *stream,
110 const struct mod_vrr_params *in_vrr,
111 unsigned int v_total)
112 {
113 unsigned int duration_in_us =
114 (unsigned int)(div64_u64(((unsigned long long)(v_total)
115 * 10000) * stream->timing.h_total,
116 stream->timing.pix_clk_100hz));
117
118 return duration_in_us;
119 }
120
121 static unsigned int calc_v_total_from_refresh(
122 const struct dc_stream_state *stream,
123 unsigned int refresh_in_uhz)
124 {
125 unsigned int v_total;
126 unsigned int frame_duration_in_ns;
127
128 frame_duration_in_ns =
129 ((unsigned int)(div64_u64((1000000000ULL * 1000000),
130 refresh_in_uhz)));
131
132 v_total = div64_u64(div64_u64(((unsigned long long)(
133 frame_duration_in_ns) * (stream->timing.pix_clk_100hz / 10)),
134 stream->timing.h_total), 1000000);
135
136 /* v_total cannot be less than nominal */
137 if (v_total < stream->timing.v_total) {
138 ASSERT(v_total < stream->timing.v_total);
139 v_total = stream->timing.v_total;
140 }
141
142 return v_total;
143 }
144
145 static unsigned int calc_v_total_from_duration(
146 const struct dc_stream_state *stream,
147 const struct mod_vrr_params *vrr,
148 unsigned int duration_in_us)
149 {
150 unsigned int v_total = 0;
151
152 if (duration_in_us < vrr->min_duration_in_us)
153 duration_in_us = vrr->min_duration_in_us;
154
155 if (duration_in_us > vrr->max_duration_in_us)
156 duration_in_us = vrr->max_duration_in_us;
157
158 v_total = div64_u64(div64_u64(((unsigned long long)(
159 duration_in_us) * (stream->timing.pix_clk_100hz / 10)),
160 stream->timing.h_total), 1000);
161
162 /* v_total cannot be less than nominal */
163 if (v_total < stream->timing.v_total) {
164 ASSERT(v_total < stream->timing.v_total);
165 v_total = stream->timing.v_total;
166 }
167
168 return v_total;
169 }
170
171 static void update_v_total_for_static_ramp(
172 struct core_freesync *core_freesync,
173 const struct dc_stream_state *stream,
174 struct mod_vrr_params *in_out_vrr)
175 {
176 unsigned int v_total = 0;
177 unsigned int current_duration_in_us =
178 calc_duration_in_us_from_v_total(
179 stream, in_out_vrr,
180 in_out_vrr->adjust.v_total_max);
181 unsigned int target_duration_in_us =
182 calc_duration_in_us_from_refresh_in_uhz(
183 in_out_vrr->fixed.target_refresh_in_uhz);
184 bool ramp_direction_is_up = (current_duration_in_us >
185 target_duration_in_us) ? true : false;
186
187 /* Calc ratio between new and current frame duration with 3 digit */
188 unsigned int frame_duration_ratio = div64_u64(1000000,
189 (1000 + div64_u64(((unsigned long long)(
190 STATIC_SCREEN_RAMP_DELTA_REFRESH_RATE_PER_FRAME) *
191 current_duration_in_us),
192 1000000)));
193
194 /* Calculate delta between new and current frame duration in us */
195 unsigned int frame_duration_delta = div64_u64(((unsigned long long)(
196 current_duration_in_us) *
197 (1000 - frame_duration_ratio)), 1000);
198
199 /* Adjust frame duration delta based on ratio between current and
200 * standard frame duration (frame duration at 60 Hz refresh rate).
201 */
202 unsigned int ramp_rate_interpolated = div64_u64(((unsigned long long)(
203 frame_duration_delta) * current_duration_in_us), 16666);
204
205 /* Going to a higher refresh rate (lower frame duration) */
206 if (ramp_direction_is_up) {
207 /* reduce frame duration */
208 current_duration_in_us -= ramp_rate_interpolated;
209
210 /* adjust for frame duration below min */
211 if (current_duration_in_us <= target_duration_in_us) {
212 in_out_vrr->fixed.ramping_active = false;
213 in_out_vrr->fixed.ramping_done = true;
214 current_duration_in_us =
215 calc_duration_in_us_from_refresh_in_uhz(
216 in_out_vrr->fixed.target_refresh_in_uhz);
217 }
218 /* Going to a lower refresh rate (larger frame duration) */
219 } else {
220 /* increase frame duration */
221 current_duration_in_us += ramp_rate_interpolated;
222
223 /* adjust for frame duration above max */
224 if (current_duration_in_us >= target_duration_in_us) {
225 in_out_vrr->fixed.ramping_active = false;
226 in_out_vrr->fixed.ramping_done = true;
227 current_duration_in_us =
228 calc_duration_in_us_from_refresh_in_uhz(
229 in_out_vrr->fixed.target_refresh_in_uhz);
230 }
231 }
232
233 v_total = div64_u64(div64_u64(((unsigned long long)(
234 current_duration_in_us) * (stream->timing.pix_clk_100hz / 10)),
235 stream->timing.h_total), 1000);
236
237 /* v_total cannot be less than nominal */
238 if (v_total < stream->timing.v_total)
239 v_total = stream->timing.v_total;
240
241 in_out_vrr->adjust.v_total_min = v_total;
242 in_out_vrr->adjust.v_total_max = v_total;
243 }
244
245 static void apply_below_the_range(struct core_freesync *core_freesync,
246 const struct dc_stream_state *stream,
247 unsigned int last_render_time_in_us,
248 struct mod_vrr_params *in_out_vrr)
249 {
250 unsigned int inserted_frame_duration_in_us = 0;
251 unsigned int mid_point_frames_ceil = 0;
252 unsigned int mid_point_frames_floor = 0;
253 unsigned int frame_time_in_us = 0;
254 unsigned int delta_from_mid_point_in_us_1 = 0xFFFFFFFF;
255 unsigned int delta_from_mid_point_in_us_2 = 0xFFFFFFFF;
256 unsigned int frames_to_insert = 0;
257 unsigned int delta_from_mid_point_delta_in_us;
258 unsigned int max_render_time_in_us =
259 in_out_vrr->max_duration_in_us - in_out_vrr->btr.margin_in_us;
260
261 /* Program BTR */
262 if ((last_render_time_in_us + in_out_vrr->btr.margin_in_us / 2) < max_render_time_in_us) {
263 /* Exit Below the Range */
264 if (in_out_vrr->btr.btr_active) {
265 in_out_vrr->btr.frame_counter = 0;
266 in_out_vrr->btr.btr_active = false;
267 }
268 } else if (last_render_time_in_us > (max_render_time_in_us + in_out_vrr->btr.margin_in_us / 2)) {
269 /* Enter Below the Range */
270 if (!in_out_vrr->btr.btr_active) {
271 in_out_vrr->btr.btr_active = true;
272 }
273 }
274
275 /* BTR set to "not active" so disengage */
276 if (!in_out_vrr->btr.btr_active) {
277 in_out_vrr->btr.inserted_duration_in_us = 0;
278 in_out_vrr->btr.frames_to_insert = 0;
279 in_out_vrr->btr.frame_counter = 0;
280
281 /* Restore FreeSync */
282 in_out_vrr->adjust.v_total_min =
283 calc_v_total_from_refresh(stream,
284 in_out_vrr->max_refresh_in_uhz);
285 in_out_vrr->adjust.v_total_max =
286 calc_v_total_from_refresh(stream,
287 in_out_vrr->min_refresh_in_uhz);
288 /* BTR set to "active" so engage */
289 } else {
290
291 /* Calculate number of midPoint frames that could fit within
292 * the render time interval- take ceil of this value
293 */
294 mid_point_frames_ceil = (last_render_time_in_us +
295 in_out_vrr->btr.mid_point_in_us - 1) /
296 in_out_vrr->btr.mid_point_in_us;
297
298 if (mid_point_frames_ceil > 0) {
299 frame_time_in_us = last_render_time_in_us /
300 mid_point_frames_ceil;
301 delta_from_mid_point_in_us_1 =
302 (in_out_vrr->btr.mid_point_in_us >
303 frame_time_in_us) ?
304 (in_out_vrr->btr.mid_point_in_us - frame_time_in_us) :
305 (frame_time_in_us - in_out_vrr->btr.mid_point_in_us);
306 }
307
308 /* Calculate number of midPoint frames that could fit within
309 * the render time interval- take floor of this value
310 */
311 mid_point_frames_floor = last_render_time_in_us /
312 in_out_vrr->btr.mid_point_in_us;
313
314 if (mid_point_frames_floor > 0) {
315
316 frame_time_in_us = last_render_time_in_us /
317 mid_point_frames_floor;
318 delta_from_mid_point_in_us_2 =
319 (in_out_vrr->btr.mid_point_in_us >
320 frame_time_in_us) ?
321 (in_out_vrr->btr.mid_point_in_us - frame_time_in_us) :
322 (frame_time_in_us - in_out_vrr->btr.mid_point_in_us);
323 }
324
325 /* Choose number of frames to insert based on how close it
326 * can get to the mid point of the variable range.
327 */
328 if ((frame_time_in_us / mid_point_frames_ceil) > in_out_vrr->min_duration_in_us &&
329 (delta_from_mid_point_in_us_1 < delta_from_mid_point_in_us_2 ||
330 mid_point_frames_floor < 2)) {
331 frames_to_insert = mid_point_frames_ceil;
332 delta_from_mid_point_delta_in_us = delta_from_mid_point_in_us_2 -
333 delta_from_mid_point_in_us_1;
334 } else {
335 frames_to_insert = mid_point_frames_floor;
336 delta_from_mid_point_delta_in_us = delta_from_mid_point_in_us_1 -
337 delta_from_mid_point_in_us_2;
338 }
339
340 /* Prefer current frame multiplier when BTR is enabled unless it drifts
341 * too far from the midpoint
342 */
343 if (in_out_vrr->btr.frames_to_insert != 0 &&
344 delta_from_mid_point_delta_in_us < BTR_DRIFT_MARGIN) {
345 if (((last_render_time_in_us / in_out_vrr->btr.frames_to_insert) <
346 max_render_time_in_us) &&
347 ((last_render_time_in_us / in_out_vrr->btr.frames_to_insert) >
348 in_out_vrr->min_duration_in_us))
349 frames_to_insert = in_out_vrr->btr.frames_to_insert;
350 }
351
352 /* Either we've calculated the number of frames to insert,
353 * or we need to insert min duration frames
354 */
355 if (last_render_time_in_us / frames_to_insert <
356 in_out_vrr->min_duration_in_us){
357 frames_to_insert -= (frames_to_insert > 1) ?
358 1 : 0;
359 }
360
361 if (frames_to_insert > 0)
362 inserted_frame_duration_in_us = last_render_time_in_us /
363 frames_to_insert;
364
365 if (inserted_frame_duration_in_us < in_out_vrr->min_duration_in_us)
366 inserted_frame_duration_in_us = in_out_vrr->min_duration_in_us;
367
368 /* Cache the calculated variables */
369 in_out_vrr->btr.inserted_duration_in_us =
370 inserted_frame_duration_in_us;
371 in_out_vrr->btr.frames_to_insert = frames_to_insert;
372 in_out_vrr->btr.frame_counter = frames_to_insert;
373 }
374 }
375
376 static void apply_fixed_refresh(struct core_freesync *core_freesync,
377 const struct dc_stream_state *stream,
378 unsigned int last_render_time_in_us,
379 struct mod_vrr_params *in_out_vrr)
380 {
381 bool update = false;
382 unsigned int max_render_time_in_us = in_out_vrr->max_duration_in_us;
383
384 //Compute the exit refresh rate and exit frame duration
385 unsigned int exit_refresh_rate_in_milli_hz = ((1000000000/max_render_time_in_us)
386 + (1000*FIXED_REFRESH_EXIT_MARGIN_IN_HZ));
387 unsigned int exit_frame_duration_in_us = 1000000000/exit_refresh_rate_in_milli_hz;
388
389 if (last_render_time_in_us < exit_frame_duration_in_us) {
390 /* Exit Fixed Refresh mode */
391 if (in_out_vrr->fixed.fixed_active) {
392 in_out_vrr->fixed.frame_counter++;
393
394 if (in_out_vrr->fixed.frame_counter >
395 FIXED_REFRESH_EXIT_FRAME_COUNT) {
396 in_out_vrr->fixed.frame_counter = 0;
397 in_out_vrr->fixed.fixed_active = false;
398 in_out_vrr->fixed.target_refresh_in_uhz = 0;
399 update = true;
400 }
401 }
402 } else if (last_render_time_in_us > max_render_time_in_us) {
403 /* Enter Fixed Refresh mode */
404 if (!in_out_vrr->fixed.fixed_active) {
405 in_out_vrr->fixed.frame_counter++;
406
407 if (in_out_vrr->fixed.frame_counter >
408 FIXED_REFRESH_ENTER_FRAME_COUNT) {
409 in_out_vrr->fixed.frame_counter = 0;
410 in_out_vrr->fixed.fixed_active = true;
411 in_out_vrr->fixed.target_refresh_in_uhz =
412 in_out_vrr->max_refresh_in_uhz;
413 update = true;
414 }
415 }
416 }
417
418 if (update) {
419 if (in_out_vrr->fixed.fixed_active) {
420 in_out_vrr->adjust.v_total_min =
421 calc_v_total_from_refresh(
422 stream, in_out_vrr->max_refresh_in_uhz);
423 in_out_vrr->adjust.v_total_max =
424 in_out_vrr->adjust.v_total_min;
425 } else {
426 in_out_vrr->adjust.v_total_min =
427 calc_v_total_from_refresh(stream,
428 in_out_vrr->max_refresh_in_uhz);
429 in_out_vrr->adjust.v_total_max =
430 calc_v_total_from_refresh(stream,
431 in_out_vrr->min_refresh_in_uhz);
432 }
433 }
434 }
435
436 static bool vrr_settings_require_update(struct core_freesync *core_freesync,
437 struct mod_freesync_config *in_config,
438 unsigned int min_refresh_in_uhz,
439 unsigned int max_refresh_in_uhz,
440 struct mod_vrr_params *in_vrr)
441 {
442 if (in_vrr->state != in_config->state) {
443 return true;
444 } else if (in_vrr->state == VRR_STATE_ACTIVE_FIXED &&
445 in_vrr->fixed.target_refresh_in_uhz !=
446 in_config->min_refresh_in_uhz) {
447 return true;
448 } else if (in_vrr->min_refresh_in_uhz != min_refresh_in_uhz) {
449 return true;
450 } else if (in_vrr->max_refresh_in_uhz != max_refresh_in_uhz) {
451 return true;
452 }
453
454 return false;
455 }
456
457 bool mod_freesync_get_vmin_vmax(struct mod_freesync *mod_freesync,
458 const struct dc_stream_state *stream,
459 unsigned int *vmin,
460 unsigned int *vmax)
461 {
462 *vmin = stream->adjust.v_total_min;
463 *vmax = stream->adjust.v_total_max;
464
465 return true;
466 }
467
468 bool mod_freesync_get_v_position(struct mod_freesync *mod_freesync,
469 struct dc_stream_state *stream,
470 unsigned int *nom_v_pos,
471 unsigned int *v_pos)
472 {
473 struct core_freesync *core_freesync = NULL;
474 struct crtc_position position;
475
476 if (mod_freesync == NULL)
477 return false;
478
479 core_freesync = MOD_FREESYNC_TO_CORE(mod_freesync);
480
481 if (dc_stream_get_crtc_position(core_freesync->dc, &stream, 1,
482 &position.vertical_count,
483 &position.nominal_vcount)) {
484
485 *nom_v_pos = position.nominal_vcount;
486 *v_pos = position.vertical_count;
487
488 return true;
489 }
490
491 return false;
492 }
493
494 static void build_vrr_infopacket_data(const struct mod_vrr_params *vrr,
495 struct dc_info_packet *infopacket)
496 {
497 /* PB1 = 0x1A (24bit AMD IEEE OUI (0x00001A) - Byte 0) */
498 infopacket->sb[1] = 0x1A;
499
500 /* PB2 = 0x00 (24bit AMD IEEE OUI (0x00001A) - Byte 1) */
501 infopacket->sb[2] = 0x00;
502
503 /* PB3 = 0x00 (24bit AMD IEEE OUI (0x00001A) - Byte 2) */
504 infopacket->sb[3] = 0x00;
505
506 /* PB4 = Reserved */
507
508 /* PB5 = Reserved */
509
510 /* PB6 = [Bits 7:3 = Reserved] */
511
512 /* PB6 = [Bit 0 = FreeSync Supported] */
513 if (vrr->state != VRR_STATE_UNSUPPORTED)
514 infopacket->sb[6] |= 0x01;
515
516 /* PB6 = [Bit 1 = FreeSync Enabled] */
517 if (vrr->state != VRR_STATE_DISABLED &&
518 vrr->state != VRR_STATE_UNSUPPORTED)
519 infopacket->sb[6] |= 0x02;
520
521 /* PB6 = [Bit 2 = FreeSync Active] */
522 if (vrr->state == VRR_STATE_ACTIVE_VARIABLE ||
523 vrr->state == VRR_STATE_ACTIVE_FIXED)
524 infopacket->sb[6] |= 0x04;
525
526 /* PB7 = FreeSync Minimum refresh rate (Hz) */
527 infopacket->sb[7] = (unsigned char)(vrr->min_refresh_in_uhz / 1000000);
528
529 /* PB8 = FreeSync Maximum refresh rate (Hz)
530 * Note: We should never go above the field rate of the mode timing set.
531 */
532 infopacket->sb[8] = (unsigned char)(vrr->max_refresh_in_uhz / 1000000);
533
534
535 //FreeSync HDR
536 infopacket->sb[9] = 0;
537 infopacket->sb[10] = 0;
538 }
539
540 static void build_vrr_infopacket_fs2_data(enum color_transfer_func app_tf,
541 struct dc_info_packet *infopacket)
542 {
543 if (app_tf != TRANSFER_FUNC_UNKNOWN) {
544 infopacket->valid = true;
545
546 infopacket->sb[6] |= 0x08; // PB6 = [Bit 3 = Native Color Active]
547
548 if (app_tf == TRANSFER_FUNC_GAMMA_22) {
549 infopacket->sb[9] |= 0x04; // PB6 = [Bit 2 = Gamma 2.2 EOTF Active]
550 }
551 }
552 }
553
554 static void build_vrr_infopacket_header_v1(enum signal_type signal,
555 struct dc_info_packet *infopacket,
556 unsigned int *payload_size)
557 {
558 if (dc_is_hdmi_signal(signal)) {
559
560 /* HEADER */
561
562 /* HB0 = Packet Type = 0x83 (Source Product
563 * Descriptor InfoFrame)
564 */
565 infopacket->hb0 = DC_HDMI_INFOFRAME_TYPE_SPD;
566
567 /* HB1 = Version = 0x01 */
568 infopacket->hb1 = 0x01;
569
570 /* HB2 = [Bits 7:5 = 0] [Bits 4:0 = Length = 0x08] */
571 infopacket->hb2 = 0x08;
572
573 *payload_size = 0x08;
574
575 } else if (dc_is_dp_signal(signal)) {
576
577 /* HEADER */
578
579 /* HB0 = Secondary-data Packet ID = 0 - Only non-zero
580 * when used to associate audio related info packets
581 */
582 infopacket->hb0 = 0x00;
583
584 /* HB1 = Packet Type = 0x83 (Source Product
585 * Descriptor InfoFrame)
586 */
587 infopacket->hb1 = DC_HDMI_INFOFRAME_TYPE_SPD;
588
589 /* HB2 = [Bits 7:0 = Least significant eight bits -
590 * For INFOFRAME, the value must be 1Bh]
591 */
592 infopacket->hb2 = 0x1B;
593
594 /* HB3 = [Bits 7:2 = INFOFRAME SDP Version Number = 0x1]
595 * [Bits 1:0 = Most significant two bits = 0x00]
596 */
597 infopacket->hb3 = 0x04;
598
599 *payload_size = 0x1B;
600 }
601 }
602
603 static void build_vrr_infopacket_header_v2(enum signal_type signal,
604 struct dc_info_packet *infopacket,
605 unsigned int *payload_size)
606 {
607 if (dc_is_hdmi_signal(signal)) {
608
609 /* HEADER */
610
611 /* HB0 = Packet Type = 0x83 (Source Product
612 * Descriptor InfoFrame)
613 */
614 infopacket->hb0 = DC_HDMI_INFOFRAME_TYPE_SPD;
615
616 /* HB1 = Version = 0x02 */
617 infopacket->hb1 = 0x02;
618
619 /* HB2 = [Bits 7:5 = 0] [Bits 4:0 = Length = 0x09] */
620 infopacket->hb2 = 0x09;
621
622 *payload_size = 0x0A;
623
624 } else if (dc_is_dp_signal(signal)) {
625
626 /* HEADER */
627
628 /* HB0 = Secondary-data Packet ID = 0 - Only non-zero
629 * when used to associate audio related info packets
630 */
631 infopacket->hb0 = 0x00;
632
633 /* HB1 = Packet Type = 0x83 (Source Product
634 * Descriptor InfoFrame)
635 */
636 infopacket->hb1 = DC_HDMI_INFOFRAME_TYPE_SPD;
637
638 /* HB2 = [Bits 7:0 = Least significant eight bits -
639 * For INFOFRAME, the value must be 1Bh]
640 */
641 infopacket->hb2 = 0x1B;
642
643 /* HB3 = [Bits 7:2 = INFOFRAME SDP Version Number = 0x2]
644 * [Bits 1:0 = Most significant two bits = 0x00]
645 */
646 infopacket->hb3 = 0x08;
647
648 *payload_size = 0x1B;
649 }
650 }
651
652 static void build_vrr_infopacket_checksum(unsigned int *payload_size,
653 struct dc_info_packet *infopacket)
654 {
655 /* Calculate checksum */
656 unsigned int idx = 0;
657 unsigned char checksum = 0;
658
659 checksum += infopacket->hb0;
660 checksum += infopacket->hb1;
661 checksum += infopacket->hb2;
662 checksum += infopacket->hb3;
663
664 for (idx = 1; idx <= *payload_size; idx++)
665 checksum += infopacket->sb[idx];
666
667 /* PB0 = Checksum (one byte complement) */
668 infopacket->sb[0] = (unsigned char)(0x100 - checksum);
669
670 infopacket->valid = true;
671 }
672
673 static void build_vrr_infopacket_v1(enum signal_type signal,
674 const struct mod_vrr_params *vrr,
675 struct dc_info_packet *infopacket)
676 {
677 /* SPD info packet for FreeSync */
678 unsigned int payload_size = 0;
679
680 build_vrr_infopacket_header_v1(signal, infopacket, &payload_size);
681 build_vrr_infopacket_data(vrr, infopacket);
682 build_vrr_infopacket_checksum(&payload_size, infopacket);
683
684 infopacket->valid = true;
685 }
686
687 static void build_vrr_infopacket_v2(enum signal_type signal,
688 const struct mod_vrr_params *vrr,
689 enum color_transfer_func app_tf,
690 struct dc_info_packet *infopacket)
691 {
692 unsigned int payload_size = 0;
693
694 build_vrr_infopacket_header_v2(signal, infopacket, &payload_size);
695 build_vrr_infopacket_data(vrr, infopacket);
696
697 build_vrr_infopacket_fs2_data(app_tf, infopacket);
698
699 build_vrr_infopacket_checksum(&payload_size, infopacket);
700
701 infopacket->valid = true;
702 }
703
704 void mod_freesync_build_vrr_infopacket(struct mod_freesync *mod_freesync,
705 const struct dc_stream_state *stream,
706 const struct mod_vrr_params *vrr,
707 enum vrr_packet_type packet_type,
708 enum color_transfer_func app_tf,
709 struct dc_info_packet *infopacket)
710 {
711 /* SPD info packet for FreeSync
712 * VTEM info packet for HdmiVRR
713 * Check if Freesync is supported. Return if false. If true,
714 * set the corresponding bit in the info packet
715 */
716 if (!vrr->supported || (!vrr->send_info_frame))
717 return;
718
719 switch (packet_type) {
720 case PACKET_TYPE_FS2:
721 build_vrr_infopacket_v2(stream->signal, vrr, app_tf, infopacket);
722 break;
723 case PACKET_TYPE_VRR:
724 case PACKET_TYPE_FS1:
725 default:
726 build_vrr_infopacket_v1(stream->signal, vrr, infopacket);
727 }
728 }
729
730 void mod_freesync_build_vrr_params(struct mod_freesync *mod_freesync,
731 const struct dc_stream_state *stream,
732 struct mod_freesync_config *in_config,
733 struct mod_vrr_params *in_out_vrr)
734 {
735 struct core_freesync *core_freesync = NULL;
736 unsigned long long nominal_field_rate_in_uhz = 0;
737 unsigned int refresh_range = 0;
738 unsigned long long min_refresh_in_uhz = 0;
739 unsigned long long max_refresh_in_uhz = 0;
740
741 if (mod_freesync == NULL)
742 return;
743
744 core_freesync = MOD_FREESYNC_TO_CORE(mod_freesync);
745
746 /* Calculate nominal field rate for stream */
747 nominal_field_rate_in_uhz =
748 mod_freesync_calc_nominal_field_rate(stream);
749
750 /* Rounded to the nearest Hz */
751 nominal_field_rate_in_uhz = 1000000ULL *
752 div_u64(nominal_field_rate_in_uhz + 500000, 1000000);
753
754 min_refresh_in_uhz = in_config->min_refresh_in_uhz;
755 max_refresh_in_uhz = in_config->max_refresh_in_uhz;
756
757 // Don't allow min > max
758 if (min_refresh_in_uhz > max_refresh_in_uhz)
759 min_refresh_in_uhz = max_refresh_in_uhz;
760
761 // Full range may be larger than current video timing, so cap at nominal
762 if (max_refresh_in_uhz > nominal_field_rate_in_uhz)
763 max_refresh_in_uhz = nominal_field_rate_in_uhz;
764
765 // Full range may be larger than current video timing, so cap at nominal
766 if (min_refresh_in_uhz > nominal_field_rate_in_uhz)
767 min_refresh_in_uhz = nominal_field_rate_in_uhz;
768
769 if (!vrr_settings_require_update(core_freesync,
770 in_config, (unsigned int)min_refresh_in_uhz, (unsigned int)max_refresh_in_uhz,
771 in_out_vrr))
772 return;
773
774 in_out_vrr->state = in_config->state;
775 in_out_vrr->send_info_frame = in_config->vsif_supported;
776
777 if (in_config->state == VRR_STATE_UNSUPPORTED) {
778 in_out_vrr->state = VRR_STATE_UNSUPPORTED;
779 in_out_vrr->supported = false;
780 in_out_vrr->adjust.v_total_min = stream->timing.v_total;
781 in_out_vrr->adjust.v_total_max = stream->timing.v_total;
782
783 return;
784
785 } else {
786 in_out_vrr->min_refresh_in_uhz = (unsigned int)min_refresh_in_uhz;
787 in_out_vrr->max_duration_in_us =
788 calc_duration_in_us_from_refresh_in_uhz(
789 (unsigned int)min_refresh_in_uhz);
790
791 in_out_vrr->max_refresh_in_uhz = (unsigned int)max_refresh_in_uhz;
792 in_out_vrr->min_duration_in_us =
793 calc_duration_in_us_from_refresh_in_uhz(
794 (unsigned int)max_refresh_in_uhz);
795
796 refresh_range = in_out_vrr->max_refresh_in_uhz -
797 in_out_vrr->min_refresh_in_uhz;
798
799 in_out_vrr->btr.margin_in_us = in_out_vrr->max_duration_in_us -
800 2 * in_out_vrr->min_duration_in_us;
801 if (in_out_vrr->btr.margin_in_us > BTR_MAX_MARGIN)
802 in_out_vrr->btr.margin_in_us = BTR_MAX_MARGIN;
803
804 in_out_vrr->supported = true;
805 }
806
807 in_out_vrr->fixed.ramping_active = in_config->ramping;
808
809 in_out_vrr->btr.btr_enabled = in_config->btr;
810
811 if (in_out_vrr->max_refresh_in_uhz <
812 2 * in_out_vrr->min_refresh_in_uhz)
813 in_out_vrr->btr.btr_enabled = false;
814
815 in_out_vrr->btr.btr_active = false;
816 in_out_vrr->btr.inserted_duration_in_us = 0;
817 in_out_vrr->btr.frames_to_insert = 0;
818 in_out_vrr->btr.frame_counter = 0;
819 in_out_vrr->fixed.fixed_active = false;
820 in_out_vrr->fixed.target_refresh_in_uhz = 0;
821
822 in_out_vrr->btr.mid_point_in_us =
823 (in_out_vrr->min_duration_in_us +
824 in_out_vrr->max_duration_in_us) / 2;
825
826 if (in_out_vrr->state == VRR_STATE_UNSUPPORTED) {
827 in_out_vrr->adjust.v_total_min = stream->timing.v_total;
828 in_out_vrr->adjust.v_total_max = stream->timing.v_total;
829 } else if (in_out_vrr->state == VRR_STATE_DISABLED) {
830 in_out_vrr->adjust.v_total_min = stream->timing.v_total;
831 in_out_vrr->adjust.v_total_max = stream->timing.v_total;
832 } else if (in_out_vrr->state == VRR_STATE_INACTIVE) {
833 in_out_vrr->adjust.v_total_min = stream->timing.v_total;
834 in_out_vrr->adjust.v_total_max = stream->timing.v_total;
835 } else if (in_out_vrr->state == VRR_STATE_ACTIVE_VARIABLE &&
836 refresh_range >= MIN_REFRESH_RANGE_IN_US) {
837
838 in_out_vrr->adjust.v_total_min =
839 calc_v_total_from_refresh(stream,
840 in_out_vrr->max_refresh_in_uhz);
841 in_out_vrr->adjust.v_total_max =
842 calc_v_total_from_refresh(stream,
843 in_out_vrr->min_refresh_in_uhz);
844 } else if (in_out_vrr->state == VRR_STATE_ACTIVE_FIXED) {
845 in_out_vrr->fixed.target_refresh_in_uhz =
846 in_out_vrr->min_refresh_in_uhz;
847 if (in_out_vrr->fixed.ramping_active &&
848 in_out_vrr->fixed.fixed_active) {
849 /* Do not update vtotals if ramping is already active
850 * in order to continue ramp from current refresh.
851 */
852 in_out_vrr->fixed.fixed_active = true;
853 } else {
854 in_out_vrr->fixed.fixed_active = true;
855 in_out_vrr->adjust.v_total_min =
856 calc_v_total_from_refresh(stream,
857 in_out_vrr->fixed.target_refresh_in_uhz);
858 in_out_vrr->adjust.v_total_max =
859 in_out_vrr->adjust.v_total_min;
860 }
861 } else {
862 in_out_vrr->state = VRR_STATE_INACTIVE;
863 in_out_vrr->adjust.v_total_min = stream->timing.v_total;
864 in_out_vrr->adjust.v_total_max = stream->timing.v_total;
865 }
866 }
867
868 void mod_freesync_handle_preflip(struct mod_freesync *mod_freesync,
869 const struct dc_plane_state *plane,
870 const struct dc_stream_state *stream,
871 unsigned int curr_time_stamp_in_us,
872 struct mod_vrr_params *in_out_vrr)
873 {
874 struct core_freesync *core_freesync = NULL;
875 unsigned int last_render_time_in_us = 0;
876 unsigned int average_render_time_in_us = 0;
877
878 if (mod_freesync == NULL)
879 return;
880
881 core_freesync = MOD_FREESYNC_TO_CORE(mod_freesync);
882
883 if (in_out_vrr->supported &&
884 in_out_vrr->state == VRR_STATE_ACTIVE_VARIABLE) {
885 unsigned int i = 0;
886 unsigned int oldest_index = plane->time.index + 1;
887
888 if (oldest_index >= DC_PLANE_UPDATE_TIMES_MAX)
889 oldest_index = 0;
890
891 last_render_time_in_us = curr_time_stamp_in_us -
892 plane->time.prev_update_time_in_us;
893
894 // Sum off all entries except oldest one
895 for (i = 0; i < DC_PLANE_UPDATE_TIMES_MAX; i++) {
896 average_render_time_in_us +=
897 plane->time.time_elapsed_in_us[i];
898 }
899 average_render_time_in_us -=
900 plane->time.time_elapsed_in_us[oldest_index];
901
902 // Add render time for current flip
903 average_render_time_in_us += last_render_time_in_us;
904 average_render_time_in_us /= DC_PLANE_UPDATE_TIMES_MAX;
905
906 if (in_out_vrr->btr.btr_enabled) {
907 apply_below_the_range(core_freesync,
908 stream,
909 last_render_time_in_us,
910 in_out_vrr);
911 } else {
912 apply_fixed_refresh(core_freesync,
913 stream,
914 last_render_time_in_us,
915 in_out_vrr);
916 }
917
918 }
919 }
920
921 void mod_freesync_handle_v_update(struct mod_freesync *mod_freesync,
922 const struct dc_stream_state *stream,
923 struct mod_vrr_params *in_out_vrr)
924 {
925 struct core_freesync *core_freesync = NULL;
926
927 if ((mod_freesync == NULL) || (stream == NULL) || (in_out_vrr == NULL))
928 return;
929
930 core_freesync = MOD_FREESYNC_TO_CORE(mod_freesync);
931
932 if (in_out_vrr->supported == false)
933 return;
934
935 /* Below the Range Logic */
936
937 /* Only execute if in fullscreen mode */
938 if (in_out_vrr->state == VRR_STATE_ACTIVE_VARIABLE &&
939 in_out_vrr->btr.btr_active) {
940 /* TODO: pass in flag for Pre-DCE12 ASIC
941 * in order for frame variable duration to take affect,
942 * it needs to be done one VSYNC early, which is at
943 * frameCounter == 1.
944 * For DCE12 and newer updates to V_TOTAL_MIN/MAX
945 * will take affect on current frame
946 */
947 if (in_out_vrr->btr.frames_to_insert ==
948 in_out_vrr->btr.frame_counter) {
949 in_out_vrr->adjust.v_total_min =
950 calc_v_total_from_duration(stream,
951 in_out_vrr,
952 in_out_vrr->btr.inserted_duration_in_us);
953 in_out_vrr->adjust.v_total_max =
954 in_out_vrr->adjust.v_total_min;
955 }
956
957 if (in_out_vrr->btr.frame_counter > 0)
958 in_out_vrr->btr.frame_counter--;
959
960 /* Restore FreeSync */
961 if (in_out_vrr->btr.frame_counter == 0) {
962 in_out_vrr->adjust.v_total_min =
963 calc_v_total_from_refresh(stream,
964 in_out_vrr->max_refresh_in_uhz);
965 in_out_vrr->adjust.v_total_max =
966 calc_v_total_from_refresh(stream,
967 in_out_vrr->min_refresh_in_uhz);
968 }
969 }
970
971 /* If in fullscreen freesync mode or in video, do not program
972 * static screen ramp values
973 */
974 if (in_out_vrr->state == VRR_STATE_ACTIVE_VARIABLE)
975 in_out_vrr->fixed.ramping_active = false;
976
977 /* Gradual Static Screen Ramping Logic */
978 /* Execute if ramp is active and user enabled freesync static screen*/
979 if (in_out_vrr->state == VRR_STATE_ACTIVE_FIXED &&
980 in_out_vrr->fixed.ramping_active) {
981 update_v_total_for_static_ramp(
982 core_freesync, stream, in_out_vrr);
983 }
984 }
985
986 void mod_freesync_get_settings(struct mod_freesync *mod_freesync,
987 const struct mod_vrr_params *vrr,
988 unsigned int *v_total_min, unsigned int *v_total_max,
989 unsigned int *event_triggers,
990 unsigned int *window_min, unsigned int *window_max,
991 unsigned int *lfc_mid_point_in_us,
992 unsigned int *inserted_frames,
993 unsigned int *inserted_duration_in_us)
994 {
995 if (mod_freesync == NULL)
996 return;
997
998 if (vrr->supported) {
999 *v_total_min = vrr->adjust.v_total_min;
1000 *v_total_max = vrr->adjust.v_total_max;
1001 *event_triggers = 0;
1002 *lfc_mid_point_in_us = vrr->btr.mid_point_in_us;
1003 *inserted_frames = vrr->btr.frames_to_insert;
1004 *inserted_duration_in_us = vrr->btr.inserted_duration_in_us;
1005 }
1006 }
1007
1008 unsigned long long mod_freesync_calc_nominal_field_rate(
1009 const struct dc_stream_state *stream)
1010 {
1011 unsigned long long nominal_field_rate_in_uhz = 0;
1012 unsigned int total = stream->timing.h_total * stream->timing.v_total;
1013
1014 /* Calculate nominal field rate for stream, rounded up to nearest integer */
1015 nominal_field_rate_in_uhz = stream->timing.pix_clk_100hz / 10;
1016 nominal_field_rate_in_uhz *= 1000ULL * 1000ULL * 1000ULL;
1017
1018 nominal_field_rate_in_uhz = div_u64(nominal_field_rate_in_uhz, total);
1019
1020 return nominal_field_rate_in_uhz;
1021 }
1022
1023 bool mod_freesync_is_valid_range(struct mod_freesync *mod_freesync,
1024 const struct dc_stream_state *stream,
1025 uint32_t min_refresh_cap_in_uhz,
1026 uint32_t max_refresh_cap_in_uhz,
1027 uint32_t min_refresh_request_in_uhz,
1028 uint32_t max_refresh_request_in_uhz)
1029 {
1030 /* Calculate nominal field rate for stream */
1031 unsigned long long nominal_field_rate_in_uhz =
1032 mod_freesync_calc_nominal_field_rate(stream);
1033
1034 /* Typically nominal refresh calculated can have some fractional part.
1035 * Allow for some rounding error of actual video timing by taking floor
1036 * of caps and request. Round the nominal refresh rate.
1037 *
1038 * Dividing will convert everything to units in Hz although input
1039 * variable name is in uHz!
1040 *
1041 * Also note, this takes care of rounding error on the nominal refresh
1042 * so by rounding error we only expect it to be off by a small amount,
1043 * such as < 0.1 Hz. i.e. 143.9xxx or 144.1xxx.
1044 *
1045 * Example 1. Caps Min = 40 Hz, Max = 144 Hz
1046 * Request Min = 40 Hz, Max = 144 Hz
1047 * Nominal = 143.5x Hz rounded to 144 Hz
1048 * This function should allow this as valid request
1049 *
1050 * Example 2. Caps Min = 40 Hz, Max = 144 Hz
1051 * Request Min = 40 Hz, Max = 144 Hz
1052 * Nominal = 144.4x Hz rounded to 144 Hz
1053 * This function should allow this as valid request
1054 *
1055 * Example 3. Caps Min = 40 Hz, Max = 144 Hz
1056 * Request Min = 40 Hz, Max = 144 Hz
1057 * Nominal = 120.xx Hz rounded to 120 Hz
1058 * This function should return NOT valid since the requested
1059 * max is greater than current timing's nominal
1060 *
1061 * Example 4. Caps Min = 40 Hz, Max = 120 Hz
1062 * Request Min = 40 Hz, Max = 120 Hz
1063 * Nominal = 144.xx Hz rounded to 144 Hz
1064 * This function should return NOT valid since the nominal
1065 * is greater than the capability's max refresh
1066 */
1067 nominal_field_rate_in_uhz =
1068 div_u64(nominal_field_rate_in_uhz + 500000, 1000000);
1069 min_refresh_cap_in_uhz /= 1000000;
1070 max_refresh_cap_in_uhz /= 1000000;
1071 min_refresh_request_in_uhz /= 1000000;
1072 max_refresh_request_in_uhz /= 1000000;
1073
1074 // Check nominal is within range
1075 if (nominal_field_rate_in_uhz > max_refresh_cap_in_uhz ||
1076 nominal_field_rate_in_uhz < min_refresh_cap_in_uhz)
1077 return false;
1078
1079 // If nominal is less than max, limit the max allowed refresh rate
1080 if (nominal_field_rate_in_uhz < max_refresh_cap_in_uhz)
1081 max_refresh_cap_in_uhz = nominal_field_rate_in_uhz;
1082
1083 // Don't allow min > max
1084 if (min_refresh_request_in_uhz > max_refresh_request_in_uhz)
1085 return false;
1086
1087 // Check min is within range
1088 if (min_refresh_request_in_uhz > max_refresh_cap_in_uhz ||
1089 min_refresh_request_in_uhz < min_refresh_cap_in_uhz)
1090 return false;
1091
1092 // Check max is within range
1093 if (max_refresh_request_in_uhz > max_refresh_cap_in_uhz ||
1094 max_refresh_request_in_uhz < min_refresh_cap_in_uhz)
1095 return false;
1096
1097 // For variable range, check for at least 10 Hz range
1098 if ((max_refresh_request_in_uhz != min_refresh_request_in_uhz) &&
1099 (max_refresh_request_in_uhz - min_refresh_request_in_uhz < 10))
1100 return false;
1101
1102 return true;
1103 }
1104
Linux with added FPC-III support