1149 lines · 34.2 KB · C
RawDownload
/* * Copyright 2016 Advanced Micro Devices, Inc. * * Permission is hereby granted, free of charge, to any person obtaining a * copy of this software and associated documentation files (the "Software"), * to deal in the Software without restriction, including without limitation * the rights to use, copy, modify, merge, publish, distribute, sublicense, * and/or sell copies of the Software, and to permit persons to whom the * Software is furnished to do so, subject to the following conditions: * * The above copyright notice and this permission notice shall be included in * all copies or substantial portions of the Software. * * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT.  IN NO EVENT SHALL * THE COPYRIGHT HOLDER(S) OR AUTHOR(S) BE LIABLE FOR ANY CLAIM, DAMAGES OR * OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, * ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR * OTHER DEALINGS IN THE SOFTWARE. * * Authors: AMD * */ #include "dm_services.h"#include "dc.h"#include "mod_freesync.h"#include "core_types.h" #define MOD_FREESYNC_MAX_CONCURRENT_STREAMS  32 #define MIN_REFRESH_RANGE_IN_US 10000000/* Refresh rate ramp at a fixed rate of 65 Hz/second */#define STATIC_SCREEN_RAMP_DELTA_REFRESH_RATE_PER_FRAME ((1000 / 60) * 65)/* Number of elements in the render times cache array */#define RENDER_TIMES_MAX_COUNT 10/* Threshold to exit BTR (to avoid frequent enter-exits at the lower limit) */#define BTR_EXIT_MARGIN 2000/*Threshold to exit fixed refresh rate*/#define FIXED_REFRESH_EXIT_MARGIN_IN_HZ 4/* Number of consecutive frames to check before entering/exiting fixed refresh*/#define FIXED_REFRESH_ENTER_FRAME_COUNT 5#define FIXED_REFRESH_EXIT_FRAME_COUNT 5 struct core_freesync {	struct mod_freesync public;	struct dc *dc;}; #define MOD_FREESYNC_TO_CORE(mod_freesync)\		container_of(mod_freesync, struct core_freesync, public) struct mod_freesync *mod_freesync_create(struct dc *dc){	struct core_freesync *core_freesync =			kzalloc(sizeof(struct core_freesync), GFP_KERNEL); 	if (core_freesync == NULL)		goto fail_alloc_context; 	if (dc == NULL)		goto fail_construct; 	core_freesync->dc = dc;	return &core_freesync->public; fail_construct:	kfree(core_freesync); fail_alloc_context:	return NULL;} void mod_freesync_destroy(struct mod_freesync *mod_freesync){	struct core_freesync *core_freesync = NULL;	if (mod_freesync == NULL)		return;	core_freesync = MOD_FREESYNC_TO_CORE(mod_freesync);	kfree(core_freesync);} #if 0 /* unused currently */static unsigned int calc_refresh_in_uhz_from_duration(		unsigned int duration_in_ns){	unsigned int refresh_in_uhz =			((unsigned int)(div64_u64((1000000000ULL * 1000000),					duration_in_ns)));	return refresh_in_uhz;}#endif static unsigned int calc_duration_in_us_from_refresh_in_uhz(		unsigned int refresh_in_uhz){	unsigned int duration_in_us =			((unsigned int)(div64_u64((1000000000ULL * 1000),					refresh_in_uhz)));	return duration_in_us;} static unsigned int calc_duration_in_us_from_v_total(		const struct dc_stream_state *stream,		const struct mod_vrr_params *in_vrr,		unsigned int v_total){	unsigned int duration_in_us =			(unsigned int)(div64_u64(((unsigned long long)(v_total)				* 10000) * stream->timing.h_total,					stream->timing.pix_clk_100hz)); 	return duration_in_us;} static unsigned int calc_v_total_from_refresh(		const struct dc_stream_state *stream,		unsigned int refresh_in_uhz){	unsigned int v_total = stream->timing.v_total;	unsigned int frame_duration_in_ns; 	frame_duration_in_ns =			((unsigned int)(div64_u64((1000000000ULL * 1000000),					refresh_in_uhz))); 	v_total = div64_u64(div64_u64(((unsigned long long)(			frame_duration_in_ns) * (stream->timing.pix_clk_100hz / 10)),			stream->timing.h_total), 1000000); 	/* v_total cannot be less than nominal */	if (v_total < stream->timing.v_total) {		ASSERT(v_total < stream->timing.v_total);		v_total = stream->timing.v_total;	} 	return v_total;} static unsigned int calc_v_total_from_duration(		const struct dc_stream_state *stream,		const struct mod_vrr_params *vrr,		unsigned int duration_in_us){	unsigned int v_total = 0; 	if (duration_in_us < vrr->min_duration_in_us)		duration_in_us = vrr->min_duration_in_us; 	if (duration_in_us > vrr->max_duration_in_us)		duration_in_us = vrr->max_duration_in_us; 	v_total = div64_u64(div64_u64(((unsigned long long)(				duration_in_us) * (stream->timing.pix_clk_100hz / 10)),				stream->timing.h_total), 1000); 	/* v_total cannot be less than nominal */	if (v_total < stream->timing.v_total) {		ASSERT(v_total < stream->timing.v_total);		v_total = stream->timing.v_total;	} 	return v_total;} static void update_v_total_for_static_ramp(		struct core_freesync *core_freesync,		const struct dc_stream_state *stream,		struct mod_vrr_params *in_out_vrr){	unsigned int v_total = 0;	unsigned int current_duration_in_us =			calc_duration_in_us_from_v_total(				stream, in_out_vrr,				in_out_vrr->adjust.v_total_max);	unsigned int target_duration_in_us =			calc_duration_in_us_from_refresh_in_uhz(				in_out_vrr->fixed.target_refresh_in_uhz);	bool ramp_direction_is_up = (current_duration_in_us >				target_duration_in_us) ? true : false; 	/* Calc ratio between new and current frame duration with 3 digit */	unsigned int frame_duration_ratio = div64_u64(1000000,		(1000 +  div64_u64(((unsigned long long)(		STATIC_SCREEN_RAMP_DELTA_REFRESH_RATE_PER_FRAME) *		current_duration_in_us),		1000000))); 	/* Calculate delta between new and current frame duration in us */	unsigned int frame_duration_delta = div64_u64(((unsigned long long)(		current_duration_in_us) *		(1000 - frame_duration_ratio)), 1000); 	/* Adjust frame duration delta based on ratio between current and	 * standard frame duration (frame duration at 60 Hz refresh rate).	 */	unsigned int ramp_rate_interpolated = div64_u64(((unsigned long long)(		frame_duration_delta) * current_duration_in_us), 16666); 	/* Going to a higher refresh rate (lower frame duration) */	if (ramp_direction_is_up) {		/* reduce frame duration */		current_duration_in_us -= ramp_rate_interpolated; 		/* adjust for frame duration below min */		if (current_duration_in_us <= target_duration_in_us) {			in_out_vrr->fixed.ramping_active = false;			in_out_vrr->fixed.ramping_done = true;			current_duration_in_us =				calc_duration_in_us_from_refresh_in_uhz(				in_out_vrr->fixed.target_refresh_in_uhz);		}	/* Going to a lower refresh rate (larger frame duration) */	} else {		/* increase frame duration */		current_duration_in_us += ramp_rate_interpolated; 		/* adjust for frame duration above max */		if (current_duration_in_us >= target_duration_in_us) {			in_out_vrr->fixed.ramping_active = false;			in_out_vrr->fixed.ramping_done = true;			current_duration_in_us =				calc_duration_in_us_from_refresh_in_uhz(				in_out_vrr->fixed.target_refresh_in_uhz);		}	} 	v_total = div64_u64(div64_u64(((unsigned long long)(			current_duration_in_us) * (stream->timing.pix_clk_100hz / 10)),				stream->timing.h_total), 1000); 	in_out_vrr->adjust.v_total_min = v_total;	in_out_vrr->adjust.v_total_max = v_total;} static void 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){	unsigned int inserted_frame_duration_in_us = 0;	unsigned int mid_point_frames_ceil = 0;	unsigned int mid_point_frames_floor = 0;	unsigned int frame_time_in_us = 0;	unsigned int delta_from_mid_point_in_us_1 = 0xFFFFFFFF;	unsigned int delta_from_mid_point_in_us_2 = 0xFFFFFFFF;	unsigned int frames_to_insert = 0;	unsigned int min_frame_duration_in_ns = 0;	unsigned int max_render_time_in_us = in_out_vrr->max_duration_in_us; 	min_frame_duration_in_ns = ((unsigned int) (div64_u64(		(1000000000ULL * 1000000),		in_out_vrr->max_refresh_in_uhz))); 	/* Program BTR */	if (last_render_time_in_us + BTR_EXIT_MARGIN < max_render_time_in_us) {		/* Exit Below the Range */		if (in_out_vrr->btr.btr_active) {			in_out_vrr->btr.frame_counter = 0;			in_out_vrr->btr.btr_active = false;		}	} else if (last_render_time_in_us > max_render_time_in_us) {		/* Enter Below the Range */		in_out_vrr->btr.btr_active = true;	} 	/* BTR set to "not active" so disengage */	if (!in_out_vrr->btr.btr_active) {		in_out_vrr->btr.inserted_duration_in_us = 0;		in_out_vrr->btr.frames_to_insert = 0;		in_out_vrr->btr.frame_counter = 0; 		/* Restore FreeSync */		in_out_vrr->adjust.v_total_min =			calc_v_total_from_refresh(stream,				in_out_vrr->max_refresh_in_uhz);		in_out_vrr->adjust.v_total_max =			calc_v_total_from_refresh(stream,				in_out_vrr->min_refresh_in_uhz);	/* BTR set to "active" so engage */	} else { 		/* Calculate number of midPoint frames that could fit within		 * the render time interval- take ceil of this value		 */		mid_point_frames_ceil = (last_render_time_in_us +				in_out_vrr->btr.mid_point_in_us - 1) /					in_out_vrr->btr.mid_point_in_us; 		if (mid_point_frames_ceil > 0) {			frame_time_in_us = last_render_time_in_us /				mid_point_frames_ceil;			delta_from_mid_point_in_us_1 =				(in_out_vrr->btr.mid_point_in_us >				frame_time_in_us) ?				(in_out_vrr->btr.mid_point_in_us - frame_time_in_us) :				(frame_time_in_us - in_out_vrr->btr.mid_point_in_us);		} 		/* Calculate number of midPoint frames that could fit within		 * the render time interval- take floor of this value		 */		mid_point_frames_floor = last_render_time_in_us /				in_out_vrr->btr.mid_point_in_us; 		if (mid_point_frames_floor > 0) { 			frame_time_in_us = last_render_time_in_us /				mid_point_frames_floor;			delta_from_mid_point_in_us_2 =				(in_out_vrr->btr.mid_point_in_us >				frame_time_in_us) ?				(in_out_vrr->btr.mid_point_in_us - frame_time_in_us) :				(frame_time_in_us - in_out_vrr->btr.mid_point_in_us);		} 		/* Choose number of frames to insert based on how close it		 * can get to the mid point of the variable range.		 */		if (delta_from_mid_point_in_us_1 < delta_from_mid_point_in_us_2)			frames_to_insert = mid_point_frames_ceil;		else			frames_to_insert = mid_point_frames_floor; 		/* Either we've calculated the number of frames to insert,		 * or we need to insert min duration frames		 */		if (frames_to_insert > 0)			inserted_frame_duration_in_us = last_render_time_in_us /							frames_to_insert; 		if (inserted_frame_duration_in_us <			(1000000 / in_out_vrr->max_refresh_in_uhz))			inserted_frame_duration_in_us =				(1000000 / in_out_vrr->max_refresh_in_uhz); 		/* Cache the calculated variables */		in_out_vrr->btr.inserted_duration_in_us =			inserted_frame_duration_in_us;		in_out_vrr->btr.frames_to_insert = frames_to_insert;		in_out_vrr->btr.frame_counter = frames_to_insert;	}} static void 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){	bool update = false;	unsigned int max_render_time_in_us = in_out_vrr->max_duration_in_us; 	//Compute the exit refresh rate and exit frame duration	unsigned int exit_refresh_rate_in_milli_hz = ((1000000000/max_render_time_in_us)			+ (1000*FIXED_REFRESH_EXIT_MARGIN_IN_HZ));	unsigned int exit_frame_duration_in_us = 1000000000/exit_refresh_rate_in_milli_hz; 	if (last_render_time_in_us < exit_frame_duration_in_us) {		/* Exit Fixed Refresh mode */		if (in_out_vrr->fixed.fixed_active) {			in_out_vrr->fixed.frame_counter++; 			if (in_out_vrr->fixed.frame_counter >					FIXED_REFRESH_EXIT_FRAME_COUNT) {				in_out_vrr->fixed.frame_counter = 0;				in_out_vrr->fixed.fixed_active = false;				in_out_vrr->fixed.target_refresh_in_uhz = 0;				update = true;			}		}	} else if (last_render_time_in_us > max_render_time_in_us) {		/* Enter Fixed Refresh mode */		if (!in_out_vrr->fixed.fixed_active) {			in_out_vrr->fixed.frame_counter++; 			if (in_out_vrr->fixed.frame_counter >					FIXED_REFRESH_ENTER_FRAME_COUNT) {				in_out_vrr->fixed.frame_counter = 0;				in_out_vrr->fixed.fixed_active = true;				in_out_vrr->fixed.target_refresh_in_uhz =						in_out_vrr->max_refresh_in_uhz;				update = true;			}		}	} 	if (update) {		if (in_out_vrr->fixed.fixed_active) {			in_out_vrr->adjust.v_total_min =				calc_v_total_from_refresh(				stream, in_out_vrr->max_refresh_in_uhz);			in_out_vrr->adjust.v_total_max =					in_out_vrr->adjust.v_total_min;		} else {			in_out_vrr->adjust.v_total_min =				calc_v_total_from_refresh(stream,					in_out_vrr->max_refresh_in_uhz);			in_out_vrr->adjust.v_total_max =				calc_v_total_from_refresh(stream,					in_out_vrr->min_refresh_in_uhz);		}	}} static bool 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){	if (in_vrr->state != in_config->state) {		return true;	} else if (in_vrr->state == VRR_STATE_ACTIVE_FIXED &&			in_vrr->fixed.target_refresh_in_uhz !=					in_config->min_refresh_in_uhz) {		return true;	} else if (in_vrr->min_refresh_in_uhz != min_refresh_in_uhz) {		return true;	} else if (in_vrr->max_refresh_in_uhz != max_refresh_in_uhz) {		return true;	} 	return false;} bool mod_freesync_get_vmin_vmax(struct mod_freesync *mod_freesync,		const struct dc_stream_state *stream,		unsigned int *vmin,		unsigned int *vmax){	*vmin = stream->adjust.v_total_min;	*vmax = stream->adjust.v_total_max; 	return true;} bool mod_freesync_get_v_position(struct mod_freesync *mod_freesync,		struct dc_stream_state *stream,		unsigned int *nom_v_pos,		unsigned int *v_pos){	struct core_freesync *core_freesync = NULL;	struct crtc_position position; 	if (mod_freesync == NULL)		return false; 	core_freesync = MOD_FREESYNC_TO_CORE(mod_freesync); 	if (dc_stream_get_crtc_position(core_freesync->dc, &stream, 1,					&position.vertical_count,					&position.nominal_vcount)) { 		*nom_v_pos = position.nominal_vcount;		*v_pos = position.vertical_count; 		return true;	} 	return false;} static void build_vrr_infopacket_header_vtem(enum signal_type signal,		struct dc_info_packet *infopacket){	// HEADER 	// HB0, HB1, HB2 indicates PacketType VTEMPacket	infopacket->hb0 = 0x7F;	infopacket->hb1 = 0xC0;	infopacket->hb2 = 0x00;	/* HB3 Bit Fields	 * Reserved :1 = 0	 * Sync     :1 = 0	 * VFR      :1 = 1	 * Ds_Type  :2 = 0	 * End      :1 = 0	 * New      :1 = 0	 */	infopacket->hb3 = 0x20;} static void build_vrr_infopacket_header_v1(enum signal_type signal,		struct dc_info_packet *infopacket,		unsigned int *payload_size){	if (dc_is_hdmi_signal(signal)) { 		/* HEADER */ 		/* HB0  = Packet Type = 0x83 (Source Product		 *	  Descriptor InfoFrame)		 */		infopacket->hb0 = DC_HDMI_INFOFRAME_TYPE_SPD; 		/* HB1  = Version = 0x01 */		infopacket->hb1 = 0x01; 		/* HB2  = [Bits 7:5 = 0] [Bits 4:0 = Length = 0x08] */

Lines 1–500 of 1149.