• Home
  • Line#
  • Scopes#
  • Navigate#
  • Raw
  • Download
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 10
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 
mod_freesync_create(struct dc * dc)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 
mod_freesync_destroy(struct mod_freesync * mod_freesync)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 
calc_duration_in_us_from_refresh_in_uhz(unsigned int refresh_in_uhz)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 
calc_duration_in_us_from_v_total(const struct dc_stream_state * stream,const struct mod_vrr_params * in_vrr,unsigned int v_total)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 
calc_v_total_from_refresh(const struct dc_stream_state * stream,unsigned int refresh_in_uhz)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 
calc_v_total_from_duration(const struct dc_stream_state * stream,const struct mod_vrr_params * vrr,unsigned int duration_in_us)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 
update_v_total_for_static_ramp(struct core_freesync * core_freesync,const struct dc_stream_state * stream,struct mod_vrr_params * in_out_vrr)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 
apply_below_the_range(struct core_freesync * core_freesync,const struct dc_stream_state * stream,unsigned int last_render_time_in_us,struct mod_vrr_params * in_out_vrr)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 		 *  - Delta for CEIL: delta_from_mid_point_in_us_1
328 		 *  - Delta for FLOOR: delta_from_mid_point_in_us_2
329 		 */
330 		if (mid_point_frames_ceil &&
331 		    (last_render_time_in_us / mid_point_frames_ceil) <
332 		    in_out_vrr->min_duration_in_us) {
333 			/* Check for out of range.
334 			 * If using CEIL produces a value that is out of range,
335 			 * then we are forced to use FLOOR.
336 			 */
337 			frames_to_insert = mid_point_frames_floor;
338 		} else if (mid_point_frames_floor < 2) {
339 			/* Check if FLOOR would result in non-LFC. In this case
340 			 * choose to use CEIL
341 			 */
342 			frames_to_insert = mid_point_frames_ceil;
343 		} else if (delta_from_mid_point_in_us_1 < delta_from_mid_point_in_us_2) {
344 			/* If choosing CEIL results in a frame duration that is
345 			 * closer to the mid point of the range.
346 			 * Choose CEIL
347 			 */
348 			frames_to_insert = mid_point_frames_ceil;
349 		} else {
350 			/* If choosing FLOOR results in a frame duration that is
351 			 * closer to the mid point of the range.
352 			 * Choose FLOOR
353 			 */
354 			frames_to_insert = mid_point_frames_floor;
355 		}
356 
357 		/* Prefer current frame multiplier when BTR is enabled unless it drifts
358 		 * too far from the midpoint
359 		 */
360 		if (delta_from_mid_point_in_us_1 < delta_from_mid_point_in_us_2) {
361 			delta_from_mid_point_delta_in_us = delta_from_mid_point_in_us_2 -
362 					delta_from_mid_point_in_us_1;
363 		} else {
364 			delta_from_mid_point_delta_in_us = delta_from_mid_point_in_us_1 -
365 					delta_from_mid_point_in_us_2;
366 		}
367 		if (in_out_vrr->btr.frames_to_insert != 0 &&
368 				delta_from_mid_point_delta_in_us < BTR_DRIFT_MARGIN) {
369 			if (((last_render_time_in_us / in_out_vrr->btr.frames_to_insert) <
370 					max_render_time_in_us) &&
371 				((last_render_time_in_us / in_out_vrr->btr.frames_to_insert) >
372 					in_out_vrr->min_duration_in_us))
373 				frames_to_insert = in_out_vrr->btr.frames_to_insert;
374 		}
375 
376 		/* Either we've calculated the number of frames to insert,
377 		 * or we need to insert min duration frames
378 		 */
379 		if (frames_to_insert &&
380 		    (last_render_time_in_us / frames_to_insert) <
381 		    in_out_vrr->min_duration_in_us){
382 			frames_to_insert -= (frames_to_insert > 1) ?
383 					1 : 0;
384 		}
385 
386 		if (frames_to_insert > 0)
387 			inserted_frame_duration_in_us = last_render_time_in_us /
388 							frames_to_insert;
389 
390 		if (inserted_frame_duration_in_us < in_out_vrr->min_duration_in_us)
391 			inserted_frame_duration_in_us = in_out_vrr->min_duration_in_us;
392 
393 		/* Cache the calculated variables */
394 		in_out_vrr->btr.inserted_duration_in_us =
395 			inserted_frame_duration_in_us;
396 		in_out_vrr->btr.frames_to_insert = frames_to_insert;
397 		in_out_vrr->btr.frame_counter = frames_to_insert;
398 	}
399 }
400 
apply_fixed_refresh(struct core_freesync * core_freesync,const struct dc_stream_state * stream,unsigned int last_render_time_in_us,struct mod_vrr_params * in_out_vrr)401 static void apply_fixed_refresh(struct core_freesync *core_freesync,
402 		const struct dc_stream_state *stream,
403 		unsigned int last_render_time_in_us,
404 		struct mod_vrr_params *in_out_vrr)
405 {
406 	bool update = false;
407 	unsigned int max_render_time_in_us = in_out_vrr->max_duration_in_us;
408 
409 	/* Compute the exit refresh rate and exit frame duration */
410 	unsigned int exit_refresh_rate_in_milli_hz = ((1000000000/max_render_time_in_us)
411 			+ (1000*FIXED_REFRESH_EXIT_MARGIN_IN_HZ));
412 	unsigned int exit_frame_duration_in_us = 1000000000/exit_refresh_rate_in_milli_hz;
413 
414 	if (last_render_time_in_us < exit_frame_duration_in_us) {
415 		/* Exit Fixed Refresh mode */
416 		if (in_out_vrr->fixed.fixed_active) {
417 			in_out_vrr->fixed.frame_counter++;
418 
419 			if (in_out_vrr->fixed.frame_counter >
420 					FIXED_REFRESH_EXIT_FRAME_COUNT) {
421 				in_out_vrr->fixed.frame_counter = 0;
422 				in_out_vrr->fixed.fixed_active = false;
423 				in_out_vrr->fixed.target_refresh_in_uhz = 0;
424 				update = true;
425 			}
426 		}
427 	} else if (last_render_time_in_us > max_render_time_in_us) {
428 		/* Enter Fixed Refresh mode */
429 		if (!in_out_vrr->fixed.fixed_active) {
430 			in_out_vrr->fixed.frame_counter++;
431 
432 			if (in_out_vrr->fixed.frame_counter >
433 					FIXED_REFRESH_ENTER_FRAME_COUNT) {
434 				in_out_vrr->fixed.frame_counter = 0;
435 				in_out_vrr->fixed.fixed_active = true;
436 				in_out_vrr->fixed.target_refresh_in_uhz =
437 						in_out_vrr->max_refresh_in_uhz;
438 				update = true;
439 			}
440 		}
441 	}
442 
443 	if (update) {
444 		if (in_out_vrr->fixed.fixed_active) {
445 			in_out_vrr->adjust.v_total_min =
446 				calc_v_total_from_refresh(
447 				stream, in_out_vrr->max_refresh_in_uhz);
448 			in_out_vrr->adjust.v_total_max =
449 					in_out_vrr->adjust.v_total_min;
450 		} else {
451 			in_out_vrr->adjust.v_total_min =
452 				calc_v_total_from_refresh(stream,
453 					in_out_vrr->max_refresh_in_uhz);
454 			in_out_vrr->adjust.v_total_max =
455 				calc_v_total_from_refresh(stream,
456 					in_out_vrr->min_refresh_in_uhz);
457 		}
458 	}
459 }
460 
vrr_settings_require_update(struct core_freesync * core_freesync,struct mod_freesync_config * in_config,unsigned int min_refresh_in_uhz,unsigned int max_refresh_in_uhz,struct mod_vrr_params * in_vrr)461 static bool vrr_settings_require_update(struct core_freesync *core_freesync,
462 		struct mod_freesync_config *in_config,
463 		unsigned int min_refresh_in_uhz,
464 		unsigned int max_refresh_in_uhz,
465 		struct mod_vrr_params *in_vrr)
466 {
467 	if (in_vrr->state != in_config->state) {
468 		return true;
469 	} else if (in_vrr->state == VRR_STATE_ACTIVE_FIXED &&
470 			in_vrr->fixed.target_refresh_in_uhz !=
471 					in_config->fixed_refresh_in_uhz) {
472 		return true;
473 	} else if (in_vrr->min_refresh_in_uhz != min_refresh_in_uhz) {
474 		return true;
475 	} else if (in_vrr->max_refresh_in_uhz != max_refresh_in_uhz) {
476 		return true;
477 	}
478 
479 	return false;
480 }
481 
mod_freesync_get_vmin_vmax(struct mod_freesync * mod_freesync,const struct dc_stream_state * stream,unsigned int * vmin,unsigned int * vmax)482 bool mod_freesync_get_vmin_vmax(struct mod_freesync *mod_freesync,
483 		const struct dc_stream_state *stream,
484 		unsigned int *vmin,
485 		unsigned int *vmax)
486 {
487 	*vmin = stream->adjust.v_total_min;
488 	*vmax = stream->adjust.v_total_max;
489 
490 	return true;
491 }
492 
mod_freesync_get_v_position(struct mod_freesync * mod_freesync,struct dc_stream_state * stream,unsigned int * nom_v_pos,unsigned int * v_pos)493 bool mod_freesync_get_v_position(struct mod_freesync *mod_freesync,
494 		struct dc_stream_state *stream,
495 		unsigned int *nom_v_pos,
496 		unsigned int *v_pos)
497 {
498 	struct core_freesync *core_freesync = NULL;
499 	struct crtc_position position;
500 
501 	if (mod_freesync == NULL)
502 		return false;
503 
504 	core_freesync = MOD_FREESYNC_TO_CORE(mod_freesync);
505 
506 	if (dc_stream_get_crtc_position(core_freesync->dc, &stream, 1,
507 					&position.vertical_count,
508 					&position.nominal_vcount)) {
509 
510 		*nom_v_pos = position.nominal_vcount;
511 		*v_pos = position.vertical_count;
512 
513 		return true;
514 	}
515 
516 	return false;
517 }
518 
build_vrr_infopacket_data_v1(const struct mod_vrr_params * vrr,struct dc_info_packet * infopacket)519 static void build_vrr_infopacket_data_v1(const struct mod_vrr_params *vrr,
520 		struct dc_info_packet *infopacket)
521 {
522 	/* PB1 = 0x1A (24bit AMD IEEE OUI (0x00001A) - Byte 0) */
523 	infopacket->sb[1] = 0x1A;
524 
525 	/* PB2 = 0x00 (24bit AMD IEEE OUI (0x00001A) - Byte 1) */
526 	infopacket->sb[2] = 0x00;
527 
528 	/* PB3 = 0x00 (24bit AMD IEEE OUI (0x00001A) - Byte 2) */
529 	infopacket->sb[3] = 0x00;
530 
531 	/* PB4 = Reserved */
532 
533 	/* PB5 = Reserved */
534 
535 	/* PB6 = [Bits 7:3 = Reserved] */
536 
537 	/* PB6 = [Bit 0 = FreeSync Supported] */
538 	if (vrr->state != VRR_STATE_UNSUPPORTED)
539 		infopacket->sb[6] |= 0x01;
540 
541 	/* PB6 = [Bit 1 = FreeSync Enabled] */
542 	if (vrr->state != VRR_STATE_DISABLED &&
543 			vrr->state != VRR_STATE_UNSUPPORTED)
544 		infopacket->sb[6] |= 0x02;
545 
546 	/* PB6 = [Bit 2 = FreeSync Active] */
547 	if (vrr->state == VRR_STATE_ACTIVE_VARIABLE ||
548 			vrr->state == VRR_STATE_ACTIVE_FIXED)
549 		infopacket->sb[6] |= 0x04;
550 
551 	// For v1 & 2 infoframes program nominal if non-fs mode, otherwise full range
552 	/* PB7 = FreeSync Minimum refresh rate (Hz) */
553 	if (vrr->state == VRR_STATE_ACTIVE_VARIABLE ||
554 			vrr->state == VRR_STATE_ACTIVE_FIXED) {
555 		infopacket->sb[7] = (unsigned char)((vrr->min_refresh_in_uhz + 500000) / 1000000);
556 	} else {
557 		infopacket->sb[7] = (unsigned char)((vrr->max_refresh_in_uhz + 500000) / 1000000);
558 	}
559 
560 	/* PB8 = FreeSync Maximum refresh rate (Hz)
561 	 * Note: We should never go above the field rate of the mode timing set.
562 	 */
563 	infopacket->sb[8] = (unsigned char)((vrr->max_refresh_in_uhz + 500000) / 1000000);
564 
565 	//FreeSync HDR
566 	infopacket->sb[9] = 0;
567 	infopacket->sb[10] = 0;
568 }
569 
build_vrr_infopacket_data_v3(const struct mod_vrr_params * vrr,struct dc_info_packet * infopacket)570 static void build_vrr_infopacket_data_v3(const struct mod_vrr_params *vrr,
571 		struct dc_info_packet *infopacket)
572 {
573 	/* PB1 = 0x1A (24bit AMD IEEE OUI (0x00001A) - Byte 0) */
574 	infopacket->sb[1] = 0x1A;
575 
576 	/* PB2 = 0x00 (24bit AMD IEEE OUI (0x00001A) - Byte 1) */
577 	infopacket->sb[2] = 0x00;
578 
579 	/* PB3 = 0x00 (24bit AMD IEEE OUI (0x00001A) - Byte 2) */
580 	infopacket->sb[3] = 0x00;
581 
582 	/* PB4 = Reserved */
583 
584 	/* PB5 = Reserved */
585 
586 	/* PB6 = [Bits 7:3 = Reserved] */
587 
588 	/* PB6 = [Bit 0 = FreeSync Supported] */
589 	if (vrr->state != VRR_STATE_UNSUPPORTED)
590 		infopacket->sb[6] |= 0x01;
591 
592 	/* PB6 = [Bit 1 = FreeSync Enabled] */
593 	if (vrr->state != VRR_STATE_DISABLED &&
594 			vrr->state != VRR_STATE_UNSUPPORTED)
595 		infopacket->sb[6] |= 0x02;
596 
597 	/* PB6 = [Bit 2 = FreeSync Active] */
598 	if (vrr->state == VRR_STATE_ACTIVE_VARIABLE ||
599 			vrr->state == VRR_STATE_ACTIVE_FIXED)
600 		infopacket->sb[6] |= 0x04;
601 
602 	if (vrr->state == VRR_STATE_ACTIVE_FIXED) {
603 		/* PB7 = FreeSync Minimum refresh rate (Hz) */
604 		infopacket->sb[7] = (unsigned char)((vrr->fixed_refresh_in_uhz + 500000) / 1000000);
605 		/* PB8 = FreeSync Maximum refresh rate (Hz) */
606 		infopacket->sb[8] = (unsigned char)((vrr->fixed_refresh_in_uhz + 500000) / 1000000);
607 	} else if (vrr->state == VRR_STATE_ACTIVE_VARIABLE) {
608 		/* PB7 = FreeSync Minimum refresh rate (Hz) */
609 		infopacket->sb[7] = (unsigned char)((vrr->min_refresh_in_uhz + 500000) / 1000000);
610 		/* PB8 = FreeSync Maximum refresh rate (Hz) */
611 		infopacket->sb[8] = (unsigned char)((vrr->max_refresh_in_uhz + 500000) / 1000000);
612 	} else {
613 		// Non-fs case, program nominal range
614 		/* PB7 = FreeSync Minimum refresh rate (Hz) */
615 		infopacket->sb[7] = (unsigned char)((vrr->max_refresh_in_uhz + 500000) / 1000000);
616 		/* PB8 = FreeSync Maximum refresh rate (Hz) */
617 		infopacket->sb[8] = (unsigned char)((vrr->max_refresh_in_uhz + 500000) / 1000000);
618 	}
619 
620 	//FreeSync HDR
621 	infopacket->sb[9] = 0;
622 	infopacket->sb[10] = 0;
623 }
624 
build_vrr_infopacket_fs2_data(enum color_transfer_func app_tf,struct dc_info_packet * infopacket)625 static void build_vrr_infopacket_fs2_data(enum color_transfer_func app_tf,
626 		struct dc_info_packet *infopacket)
627 {
628 	if (app_tf != TRANSFER_FUNC_UNKNOWN) {
629 		infopacket->valid = true;
630 
631 		infopacket->sb[6] |= 0x08;  // PB6 = [Bit 3 = Native Color Active]
632 
633 		if (app_tf == TRANSFER_FUNC_GAMMA_22) {
634 			infopacket->sb[9] |= 0x04;  // PB6 = [Bit 2 = Gamma 2.2 EOTF Active]
635 		}
636 	}
637 }
638 
build_vrr_infopacket_header_v1(enum signal_type signal,struct dc_info_packet * infopacket,unsigned int * payload_size)639 static void build_vrr_infopacket_header_v1(enum signal_type signal,
640 		struct dc_info_packet *infopacket,
641 		unsigned int *payload_size)
642 {
643 	if (dc_is_hdmi_signal(signal)) {
644 
645 		/* HEADER */
646 
647 		/* HB0  = Packet Type = 0x83 (Source Product
648 		 *	  Descriptor InfoFrame)
649 		 */
650 		infopacket->hb0 = DC_HDMI_INFOFRAME_TYPE_SPD;
651 
652 		/* HB1  = Version = 0x01 */
653 		infopacket->hb1 = 0x01;
654 
655 		/* HB2  = [Bits 7:5 = 0] [Bits 4:0 = Length = 0x08] */
656 		infopacket->hb2 = 0x08;
657 
658 		*payload_size = 0x08;
659 
660 	} else if (dc_is_dp_signal(signal)) {
661 
662 		/* HEADER */
663 
664 		/* HB0  = Secondary-data Packet ID = 0 - Only non-zero
665 		 *	  when used to associate audio related info packets
666 		 */
667 		infopacket->hb0 = 0x00;
668 
669 		/* HB1  = Packet Type = 0x83 (Source Product
670 		 *	  Descriptor InfoFrame)
671 		 */
672 		infopacket->hb1 = DC_HDMI_INFOFRAME_TYPE_SPD;
673 
674 		/* HB2  = [Bits 7:0 = Least significant eight bits -
675 		 *	  For INFOFRAME, the value must be 1Bh]
676 		 */
677 		infopacket->hb2 = 0x1B;
678 
679 		/* HB3  = [Bits 7:2 = INFOFRAME SDP Version Number = 0x1]
680 		 *	  [Bits 1:0 = Most significant two bits = 0x00]
681 		 */
682 		infopacket->hb3 = 0x04;
683 
684 		*payload_size = 0x1B;
685 	}
686 }
687 
build_vrr_infopacket_header_v2(enum signal_type signal,struct dc_info_packet * infopacket,unsigned int * payload_size)688 static void build_vrr_infopacket_header_v2(enum signal_type signal,
689 		struct dc_info_packet *infopacket,
690 		unsigned int *payload_size)
691 {
692 	if (dc_is_hdmi_signal(signal)) {
693 
694 		/* HEADER */
695 
696 		/* HB0  = Packet Type = 0x83 (Source Product
697 		 *	  Descriptor InfoFrame)
698 		 */
699 		infopacket->hb0 = DC_HDMI_INFOFRAME_TYPE_SPD;
700 
701 		/* HB1  = Version = 0x02 */
702 		infopacket->hb1 = 0x02;
703 
704 		/* HB2  = [Bits 7:5 = 0] [Bits 4:0 = Length = 0x09] */
705 		infopacket->hb2 = 0x09;
706 
707 		*payload_size = 0x0A;
708 
709 	} else if (dc_is_dp_signal(signal)) {
710 
711 		/* HEADER */
712 
713 		/* HB0  = Secondary-data Packet ID = 0 - Only non-zero
714 		 *	  when used to associate audio related info packets
715 		 */
716 		infopacket->hb0 = 0x00;
717 
718 		/* HB1  = Packet Type = 0x83 (Source Product
719 		 *	  Descriptor InfoFrame)
720 		 */
721 		infopacket->hb1 = DC_HDMI_INFOFRAME_TYPE_SPD;
722 
723 		/* HB2  = [Bits 7:0 = Least significant eight bits -
724 		 *	  For INFOFRAME, the value must be 1Bh]
725 		 */
726 		infopacket->hb2 = 0x1B;
727 
728 		/* HB3  = [Bits 7:2 = INFOFRAME SDP Version Number = 0x2]
729 		 *	  [Bits 1:0 = Most significant two bits = 0x00]
730 		 */
731 		infopacket->hb3 = 0x08;
732 
733 		*payload_size = 0x1B;
734 	}
735 }
736 
build_vrr_infopacket_checksum(unsigned int * payload_size,struct dc_info_packet * infopacket)737 static void build_vrr_infopacket_checksum(unsigned int *payload_size,
738 		struct dc_info_packet *infopacket)
739 {
740 	/* Calculate checksum */
741 	unsigned int idx = 0;
742 	unsigned char checksum = 0;
743 
744 	checksum += infopacket->hb0;
745 	checksum += infopacket->hb1;
746 	checksum += infopacket->hb2;
747 	checksum += infopacket->hb3;
748 
749 	for (idx = 1; idx <= *payload_size; idx++)
750 		checksum += infopacket->sb[idx];
751 
752 	/* PB0 = Checksum (one byte complement) */
753 	infopacket->sb[0] = (unsigned char)(0x100 - checksum);
754 
755 	infopacket->valid = true;
756 }
757 
build_vrr_infopacket_v1(enum signal_type signal,const struct mod_vrr_params * vrr,struct dc_info_packet * infopacket)758 static void build_vrr_infopacket_v1(enum signal_type signal,
759 		const struct mod_vrr_params *vrr,
760 		struct dc_info_packet *infopacket)
761 {
762 	/* SPD info packet for FreeSync */
763 	unsigned int payload_size = 0;
764 
765 	build_vrr_infopacket_header_v1(signal, infopacket, &payload_size);
766 	build_vrr_infopacket_data_v1(vrr, infopacket);
767 	build_vrr_infopacket_checksum(&payload_size, infopacket);
768 
769 	infopacket->valid = true;
770 }
771 
build_vrr_infopacket_v2(enum signal_type signal,const struct mod_vrr_params * vrr,enum color_transfer_func app_tf,struct dc_info_packet * infopacket)772 static void build_vrr_infopacket_v2(enum signal_type signal,
773 		const struct mod_vrr_params *vrr,
774 		enum color_transfer_func app_tf,
775 		struct dc_info_packet *infopacket)
776 {
777 	unsigned int payload_size = 0;
778 
779 	build_vrr_infopacket_header_v2(signal, infopacket, &payload_size);
780 	build_vrr_infopacket_data_v1(vrr, infopacket);
781 
782 	build_vrr_infopacket_fs2_data(app_tf, infopacket);
783 
784 	build_vrr_infopacket_checksum(&payload_size, infopacket);
785 
786 	infopacket->valid = true;
787 }
788 #ifndef TRIM_FSFT
build_vrr_infopacket_fast_transport_data(bool ftActive,unsigned int ftOutputRate,struct dc_info_packet * infopacket)789 static void build_vrr_infopacket_fast_transport_data(
790 	bool ftActive,
791 	unsigned int ftOutputRate,
792 	struct dc_info_packet *infopacket)
793 {
794 	/* PB9 : bit7 - fast transport Active*/
795 	unsigned char activeBit = (ftActive) ? 1 << 7 : 0;
796 
797 	infopacket->sb[1] &= ~activeBit;  //clear bit
798 	infopacket->sb[1] |=  activeBit;  //set bit
799 
800 	/* PB13 : Target Output Pixel Rate [kHz] - bits 7:0  */
801 	infopacket->sb[13] = ftOutputRate & 0xFF;
802 
803 	/* PB14 : Target Output Pixel Rate [kHz] - bits 15:8  */
804 	infopacket->sb[14] = (ftOutputRate >> 8) & 0xFF;
805 
806 	/* PB15 : Target Output Pixel Rate [kHz] - bits 23:16  */
807 	infopacket->sb[15] = (ftOutputRate >> 16) & 0xFF;
808 
809 }
810 #endif
811 
build_vrr_infopacket_v3(enum signal_type signal,const struct mod_vrr_params * vrr,bool ftActive,unsigned int ftOutputRate,enum color_transfer_func app_tf,struct dc_info_packet * infopacket)812 static void build_vrr_infopacket_v3(enum signal_type signal,
813 		const struct mod_vrr_params *vrr,
814 #ifndef TRIM_FSFT
815 		bool ftActive, unsigned int ftOutputRate,
816 #endif
817 		enum color_transfer_func app_tf,
818 		struct dc_info_packet *infopacket)
819 {
820 	unsigned int payload_size = 0;
821 
822 	build_vrr_infopacket_header_v2(signal, infopacket, &payload_size);
823 	build_vrr_infopacket_data_v3(vrr, infopacket);
824 
825 	build_vrr_infopacket_fs2_data(app_tf, infopacket);
826 
827 #ifndef TRIM_FSFT
828 	build_vrr_infopacket_fast_transport_data(
829 			ftActive,
830 			ftOutputRate,
831 			infopacket);
832 #endif
833 
834 	build_vrr_infopacket_checksum(&payload_size, infopacket);
835 
836 	infopacket->valid = true;
837 }
838 
mod_freesync_build_vrr_infopacket(struct mod_freesync * mod_freesync,const struct dc_stream_state * stream,const struct mod_vrr_params * vrr,enum vrr_packet_type packet_type,enum color_transfer_func app_tf,struct dc_info_packet * infopacket)839 void mod_freesync_build_vrr_infopacket(struct mod_freesync *mod_freesync,
840 		const struct dc_stream_state *stream,
841 		const struct mod_vrr_params *vrr,
842 		enum vrr_packet_type packet_type,
843 		enum color_transfer_func app_tf,
844 		struct dc_info_packet *infopacket)
845 {
846 	/* SPD info packet for FreeSync
847 	 * VTEM info packet for HdmiVRR
848 	 * Check if Freesync is supported. Return if false. If true,
849 	 * set the corresponding bit in the info packet
850 	 */
851 	if (!vrr->send_info_frame)
852 		return;
853 
854 	switch (packet_type) {
855 	case PACKET_TYPE_FS_V3:
856 #ifndef TRIM_FSFT
857 		// always populate with pixel rate.
858 		build_vrr_infopacket_v3(
859 				stream->signal, vrr,
860 				stream->timing.flags.FAST_TRANSPORT,
861 				(stream->timing.flags.FAST_TRANSPORT) ?
862 						stream->timing.fast_transport_output_rate_100hz :
863 						stream->timing.pix_clk_100hz,
864 				app_tf, infopacket);
865 #else
866 		build_vrr_infopacket_v3(stream->signal, vrr, app_tf, infopacket);
867 #endif
868 		break;
869 	case PACKET_TYPE_FS_V2:
870 		build_vrr_infopacket_v2(stream->signal, vrr, app_tf, infopacket);
871 		break;
872 	case PACKET_TYPE_VRR:
873 	case PACKET_TYPE_FS_V1:
874 	default:
875 		build_vrr_infopacket_v1(stream->signal, vrr, infopacket);
876 	}
877 }
878 
mod_freesync_build_vrr_params(struct mod_freesync * mod_freesync,const struct dc_stream_state * stream,struct mod_freesync_config * in_config,struct mod_vrr_params * in_out_vrr)879 void mod_freesync_build_vrr_params(struct mod_freesync *mod_freesync,
880 		const struct dc_stream_state *stream,
881 		struct mod_freesync_config *in_config,
882 		struct mod_vrr_params *in_out_vrr)
883 {
884 	struct core_freesync *core_freesync = NULL;
885 	unsigned long long nominal_field_rate_in_uhz = 0;
886 	unsigned long long rounded_nominal_in_uhz = 0;
887 	unsigned int refresh_range = 0;
888 	unsigned long long min_refresh_in_uhz = 0;
889 	unsigned long long max_refresh_in_uhz = 0;
890 
891 	if (mod_freesync == NULL)
892 		return;
893 
894 	core_freesync = MOD_FREESYNC_TO_CORE(mod_freesync);
895 
896 	/* Calculate nominal field rate for stream */
897 	nominal_field_rate_in_uhz =
898 			mod_freesync_calc_nominal_field_rate(stream);
899 
900 	min_refresh_in_uhz = in_config->min_refresh_in_uhz;
901 	max_refresh_in_uhz = in_config->max_refresh_in_uhz;
902 
903 	// Full range may be larger than current video timing, so cap at nominal
904 	if (max_refresh_in_uhz > nominal_field_rate_in_uhz)
905 		max_refresh_in_uhz = nominal_field_rate_in_uhz;
906 
907 	// Full range may be larger than current video timing, so cap at nominal
908 	if (min_refresh_in_uhz > max_refresh_in_uhz)
909 		min_refresh_in_uhz = max_refresh_in_uhz;
910 
911 	// If a monitor reports exactly max refresh of 2x of min, enforce it on nominal
912 	rounded_nominal_in_uhz =
913 			div_u64(nominal_field_rate_in_uhz + 50000, 100000) * 100000;
914 	if (in_config->max_refresh_in_uhz == (2 * in_config->min_refresh_in_uhz) &&
915 		in_config->max_refresh_in_uhz == rounded_nominal_in_uhz)
916 		min_refresh_in_uhz = div_u64(nominal_field_rate_in_uhz, 2);
917 
918 	if (!vrr_settings_require_update(core_freesync,
919 			in_config, (unsigned int)min_refresh_in_uhz, (unsigned int)max_refresh_in_uhz,
920 			in_out_vrr))
921 		return;
922 
923 	in_out_vrr->state = in_config->state;
924 	in_out_vrr->send_info_frame = in_config->vsif_supported;
925 
926 	if (in_config->state == VRR_STATE_UNSUPPORTED) {
927 		in_out_vrr->state = VRR_STATE_UNSUPPORTED;
928 		in_out_vrr->supported = false;
929 		in_out_vrr->adjust.v_total_min = stream->timing.v_total;
930 		in_out_vrr->adjust.v_total_max = stream->timing.v_total;
931 
932 		return;
933 
934 	} else {
935 		in_out_vrr->min_refresh_in_uhz = (unsigned int)min_refresh_in_uhz;
936 		in_out_vrr->max_duration_in_us =
937 				calc_duration_in_us_from_refresh_in_uhz(
938 						(unsigned int)min_refresh_in_uhz);
939 
940 		in_out_vrr->max_refresh_in_uhz = (unsigned int)max_refresh_in_uhz;
941 		in_out_vrr->min_duration_in_us =
942 				calc_duration_in_us_from_refresh_in_uhz(
943 						(unsigned int)max_refresh_in_uhz);
944 
945 		if (in_config->state == VRR_STATE_ACTIVE_FIXED)
946 			in_out_vrr->fixed_refresh_in_uhz = in_config->fixed_refresh_in_uhz;
947 		else
948 			in_out_vrr->fixed_refresh_in_uhz = 0;
949 
950 		refresh_range = div_u64(in_out_vrr->max_refresh_in_uhz + 500000, 1000000) -
951 +				div_u64(in_out_vrr->min_refresh_in_uhz + 500000, 1000000);
952 
953 		in_out_vrr->supported = true;
954 	}
955 
956 	in_out_vrr->fixed.ramping_active = in_config->ramping;
957 
958 	in_out_vrr->btr.btr_enabled = in_config->btr;
959 
960 	if (in_out_vrr->max_refresh_in_uhz < (2 * in_out_vrr->min_refresh_in_uhz))
961 		in_out_vrr->btr.btr_enabled = false;
962 	else {
963 		in_out_vrr->btr.margin_in_us = in_out_vrr->max_duration_in_us -
964 				2 * in_out_vrr->min_duration_in_us;
965 		if (in_out_vrr->btr.margin_in_us > BTR_MAX_MARGIN)
966 			in_out_vrr->btr.margin_in_us = BTR_MAX_MARGIN;
967 	}
968 
969 	in_out_vrr->btr.btr_active = false;
970 	in_out_vrr->btr.inserted_duration_in_us = 0;
971 	in_out_vrr->btr.frames_to_insert = 0;
972 	in_out_vrr->btr.frame_counter = 0;
973 	in_out_vrr->fixed.fixed_active = false;
974 	in_out_vrr->fixed.target_refresh_in_uhz = 0;
975 
976 	in_out_vrr->btr.mid_point_in_us =
977 				(in_out_vrr->min_duration_in_us +
978 				 in_out_vrr->max_duration_in_us) / 2;
979 
980 	if (in_out_vrr->state == VRR_STATE_UNSUPPORTED) {
981 		in_out_vrr->adjust.v_total_min = stream->timing.v_total;
982 		in_out_vrr->adjust.v_total_max = stream->timing.v_total;
983 	} else if (in_out_vrr->state == VRR_STATE_DISABLED) {
984 		in_out_vrr->adjust.v_total_min = stream->timing.v_total;
985 		in_out_vrr->adjust.v_total_max = stream->timing.v_total;
986 	} else if (in_out_vrr->state == VRR_STATE_INACTIVE) {
987 		in_out_vrr->adjust.v_total_min = stream->timing.v_total;
988 		in_out_vrr->adjust.v_total_max = stream->timing.v_total;
989 	} else if (in_out_vrr->state == VRR_STATE_ACTIVE_VARIABLE &&
990 			refresh_range >= MIN_REFRESH_RANGE) {
991 
992 		in_out_vrr->adjust.v_total_min =
993 			calc_v_total_from_refresh(stream,
994 				in_out_vrr->max_refresh_in_uhz);
995 		in_out_vrr->adjust.v_total_max =
996 			calc_v_total_from_refresh(stream,
997 				in_out_vrr->min_refresh_in_uhz);
998 	} else if (in_out_vrr->state == VRR_STATE_ACTIVE_FIXED) {
999 		in_out_vrr->fixed.target_refresh_in_uhz =
1000 				in_out_vrr->fixed_refresh_in_uhz;
1001 		if (in_out_vrr->fixed.ramping_active &&
1002 				in_out_vrr->fixed.fixed_active) {
1003 			/* Do not update vtotals if ramping is already active
1004 			 * in order to continue ramp from current refresh.
1005 			 */
1006 			in_out_vrr->fixed.fixed_active = true;
1007 		} else {
1008 			in_out_vrr->fixed.fixed_active = true;
1009 			in_out_vrr->adjust.v_total_min =
1010 				calc_v_total_from_refresh(stream,
1011 					in_out_vrr->fixed.target_refresh_in_uhz);
1012 			in_out_vrr->adjust.v_total_max =
1013 				in_out_vrr->adjust.v_total_min;
1014 		}
1015 	} else {
1016 		in_out_vrr->state = VRR_STATE_INACTIVE;
1017 		in_out_vrr->adjust.v_total_min = stream->timing.v_total;
1018 		in_out_vrr->adjust.v_total_max = stream->timing.v_total;
1019 	}
1020 }
1021 
mod_freesync_handle_preflip(struct mod_freesync * mod_freesync,const struct dc_plane_state * plane,const struct dc_stream_state * stream,unsigned int curr_time_stamp_in_us,struct mod_vrr_params * in_out_vrr)1022 void mod_freesync_handle_preflip(struct mod_freesync *mod_freesync,
1023 		const struct dc_plane_state *plane,
1024 		const struct dc_stream_state *stream,
1025 		unsigned int curr_time_stamp_in_us,
1026 		struct mod_vrr_params *in_out_vrr)
1027 {
1028 	struct core_freesync *core_freesync = NULL;
1029 	unsigned int last_render_time_in_us = 0;
1030 	unsigned int average_render_time_in_us = 0;
1031 
1032 	if (mod_freesync == NULL)
1033 		return;
1034 
1035 	core_freesync = MOD_FREESYNC_TO_CORE(mod_freesync);
1036 
1037 	if (in_out_vrr->supported &&
1038 			in_out_vrr->state == VRR_STATE_ACTIVE_VARIABLE) {
1039 		unsigned int i = 0;
1040 		unsigned int oldest_index = plane->time.index + 1;
1041 
1042 		if (oldest_index >= DC_PLANE_UPDATE_TIMES_MAX)
1043 			oldest_index = 0;
1044 
1045 		last_render_time_in_us = curr_time_stamp_in_us -
1046 				plane->time.prev_update_time_in_us;
1047 
1048 		// Sum off all entries except oldest one
1049 		for (i = 0; i < DC_PLANE_UPDATE_TIMES_MAX; i++) {
1050 			average_render_time_in_us +=
1051 					plane->time.time_elapsed_in_us[i];
1052 		}
1053 		average_render_time_in_us -=
1054 				plane->time.time_elapsed_in_us[oldest_index];
1055 
1056 		// Add render time for current flip
1057 		average_render_time_in_us += last_render_time_in_us;
1058 		average_render_time_in_us /= DC_PLANE_UPDATE_TIMES_MAX;
1059 
1060 		if (in_out_vrr->btr.btr_enabled) {
1061 			apply_below_the_range(core_freesync,
1062 					stream,
1063 					last_render_time_in_us,
1064 					in_out_vrr);
1065 		} else {
1066 			apply_fixed_refresh(core_freesync,
1067 				stream,
1068 				last_render_time_in_us,
1069 				in_out_vrr);
1070 		}
1071 
1072 	}
1073 }
1074 
mod_freesync_handle_v_update(struct mod_freesync * mod_freesync,const struct dc_stream_state * stream,struct mod_vrr_params * in_out_vrr)1075 void mod_freesync_handle_v_update(struct mod_freesync *mod_freesync,
1076 		const struct dc_stream_state *stream,
1077 		struct mod_vrr_params *in_out_vrr)
1078 {
1079 	struct core_freesync *core_freesync = NULL;
1080 
1081 	if ((mod_freesync == NULL) || (stream == NULL) || (in_out_vrr == NULL))
1082 		return;
1083 
1084 	core_freesync = MOD_FREESYNC_TO_CORE(mod_freesync);
1085 
1086 	if (in_out_vrr->supported == false)
1087 		return;
1088 
1089 	/* Below the Range Logic */
1090 
1091 	/* Only execute if in fullscreen mode */
1092 	if (in_out_vrr->state == VRR_STATE_ACTIVE_VARIABLE &&
1093 					in_out_vrr->btr.btr_active) {
1094 		/* TODO: pass in flag for Pre-DCE12 ASIC
1095 		 * in order for frame variable duration to take affect,
1096 		 * it needs to be done one VSYNC early, which is at
1097 		 * frameCounter == 1.
1098 		 * For DCE12 and newer updates to V_TOTAL_MIN/MAX
1099 		 * will take affect on current frame
1100 		 */
1101 		if (in_out_vrr->btr.frames_to_insert ==
1102 				in_out_vrr->btr.frame_counter) {
1103 			in_out_vrr->adjust.v_total_min =
1104 				calc_v_total_from_duration(stream,
1105 				in_out_vrr,
1106 				in_out_vrr->btr.inserted_duration_in_us);
1107 			in_out_vrr->adjust.v_total_max =
1108 				in_out_vrr->adjust.v_total_min;
1109 		}
1110 
1111 		if (in_out_vrr->btr.frame_counter > 0)
1112 			in_out_vrr->btr.frame_counter--;
1113 
1114 		/* Restore FreeSync */
1115 		if (in_out_vrr->btr.frame_counter == 0) {
1116 			in_out_vrr->adjust.v_total_min =
1117 				calc_v_total_from_refresh(stream,
1118 				in_out_vrr->max_refresh_in_uhz);
1119 			in_out_vrr->adjust.v_total_max =
1120 				calc_v_total_from_refresh(stream,
1121 				in_out_vrr->min_refresh_in_uhz);
1122 		}
1123 	}
1124 
1125 	/* If in fullscreen freesync mode or in video, do not program
1126 	 * static screen ramp values
1127 	 */
1128 	if (in_out_vrr->state == VRR_STATE_ACTIVE_VARIABLE)
1129 		in_out_vrr->fixed.ramping_active = false;
1130 
1131 	/* Gradual Static Screen Ramping Logic */
1132 	/* Execute if ramp is active and user enabled freesync static screen*/
1133 	if (in_out_vrr->state == VRR_STATE_ACTIVE_FIXED &&
1134 				in_out_vrr->fixed.ramping_active) {
1135 		update_v_total_for_static_ramp(
1136 				core_freesync, stream, in_out_vrr);
1137 	}
1138 }
1139 
mod_freesync_get_settings(struct mod_freesync * mod_freesync,const struct mod_vrr_params * vrr,unsigned int * v_total_min,unsigned int * v_total_max,unsigned int * event_triggers,unsigned int * window_min,unsigned int * window_max,unsigned int * lfc_mid_point_in_us,unsigned int * inserted_frames,unsigned int * inserted_duration_in_us)1140 void mod_freesync_get_settings(struct mod_freesync *mod_freesync,
1141 		const struct mod_vrr_params *vrr,
1142 		unsigned int *v_total_min, unsigned int *v_total_max,
1143 		unsigned int *event_triggers,
1144 		unsigned int *window_min, unsigned int *window_max,
1145 		unsigned int *lfc_mid_point_in_us,
1146 		unsigned int *inserted_frames,
1147 		unsigned int *inserted_duration_in_us)
1148 {
1149 	if (mod_freesync == NULL)
1150 		return;
1151 
1152 	if (vrr->supported) {
1153 		*v_total_min = vrr->adjust.v_total_min;
1154 		*v_total_max = vrr->adjust.v_total_max;
1155 		*event_triggers = 0;
1156 		*lfc_mid_point_in_us = vrr->btr.mid_point_in_us;
1157 		*inserted_frames = vrr->btr.frames_to_insert;
1158 		*inserted_duration_in_us = vrr->btr.inserted_duration_in_us;
1159 	}
1160 }
1161 
mod_freesync_calc_nominal_field_rate(const struct dc_stream_state * stream)1162 unsigned long long mod_freesync_calc_nominal_field_rate(
1163 			const struct dc_stream_state *stream)
1164 {
1165 	unsigned long long nominal_field_rate_in_uhz = 0;
1166 	unsigned int total = stream->timing.h_total * stream->timing.v_total;
1167 
1168 	/* Calculate nominal field rate for stream, rounded up to nearest integer */
1169 	nominal_field_rate_in_uhz = stream->timing.pix_clk_100hz;
1170 	nominal_field_rate_in_uhz *= 100000000ULL;
1171 
1172 	nominal_field_rate_in_uhz =	div_u64(nominal_field_rate_in_uhz, total);
1173 
1174 	return nominal_field_rate_in_uhz;
1175 }
1176 
mod_freesync_is_valid_range(uint32_t min_refresh_cap_in_uhz,uint32_t max_refresh_cap_in_uhz,uint32_t nominal_field_rate_in_uhz)1177 bool mod_freesync_is_valid_range(uint32_t min_refresh_cap_in_uhz,
1178 		uint32_t max_refresh_cap_in_uhz,
1179 		uint32_t nominal_field_rate_in_uhz)
1180 {
1181 
1182 	/* Typically nominal refresh calculated can have some fractional part.
1183 	 * Allow for some rounding error of actual video timing by taking floor
1184 	 * of caps and request. Round the nominal refresh rate.
1185 	 *
1186 	 * Dividing will convert everything to units in Hz although input
1187 	 * variable name is in uHz!
1188 	 *
1189 	 * Also note, this takes care of rounding error on the nominal refresh
1190 	 * so by rounding error we only expect it to be off by a small amount,
1191 	 * such as < 0.1 Hz. i.e. 143.9xxx or 144.1xxx.
1192 	 *
1193 	 * Example 1. Caps    Min = 40 Hz, Max = 144 Hz
1194 	 *            Request Min = 40 Hz, Max = 144 Hz
1195 	 *                    Nominal = 143.5x Hz rounded to 144 Hz
1196 	 *            This function should allow this as valid request
1197 	 *
1198 	 * Example 2. Caps    Min = 40 Hz, Max = 144 Hz
1199 	 *            Request Min = 40 Hz, Max = 144 Hz
1200 	 *                    Nominal = 144.4x Hz rounded to 144 Hz
1201 	 *            This function should allow this as valid request
1202 	 *
1203 	 * Example 3. Caps    Min = 40 Hz, Max = 144 Hz
1204 	 *            Request Min = 40 Hz, Max = 144 Hz
1205 	 *                    Nominal = 120.xx Hz rounded to 120 Hz
1206 	 *            This function should return NOT valid since the requested
1207 	 *            max is greater than current timing's nominal
1208 	 *
1209 	 * Example 4. Caps    Min = 40 Hz, Max = 120 Hz
1210 	 *            Request Min = 40 Hz, Max = 120 Hz
1211 	 *                    Nominal = 144.xx Hz rounded to 144 Hz
1212 	 *            This function should return NOT valid since the nominal
1213 	 *            is greater than the capability's max refresh
1214 	 */
1215 	nominal_field_rate_in_uhz =
1216 			div_u64(nominal_field_rate_in_uhz + 500000, 1000000);
1217 	min_refresh_cap_in_uhz /= 1000000;
1218 	max_refresh_cap_in_uhz /= 1000000;
1219 
1220 	// Check nominal is within range
1221 	if (nominal_field_rate_in_uhz > max_refresh_cap_in_uhz ||
1222 		nominal_field_rate_in_uhz < min_refresh_cap_in_uhz)
1223 		return false;
1224 
1225 	// If nominal is less than max, limit the max allowed refresh rate
1226 	if (nominal_field_rate_in_uhz < max_refresh_cap_in_uhz)
1227 		max_refresh_cap_in_uhz = nominal_field_rate_in_uhz;
1228 
1229 	// Check min is within range
1230 	if (min_refresh_cap_in_uhz > max_refresh_cap_in_uhz)
1231 		return false;
1232 
1233 	// For variable range, check for at least 10 Hz range
1234 	if (nominal_field_rate_in_uhz - min_refresh_cap_in_uhz < 10)
1235 		return false;
1236 
1237 	return true;
1238 }
1239 
1240