/*
 * 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 <linux/slab.h>

#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 change BTR multiplier (to avoid frequent changes) */
#define BTR_DRIFT_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;
};

void setFieldWithMask(unsigned char *dest, unsigned int mask, unsigned int value)
{
        unsigned int shift = 0;

        if (!mask || !dest)
                return;

        while (!((mask >> shift) & 1))
                shift++;

        //reset
        *dest = *dest & ~mask;
        //set
        //dont let value span past mask
        value = value & (mask >> shift);
        //insert value
        *dest = *dest | (value << shift);
}

// VTEM Byte Offset
#define VRR_VTEM_PB0            0
#define VRR_VTEM_PB1            1
#define VRR_VTEM_PB2            2
#define VRR_VTEM_PB3            3
#define VRR_VTEM_PB4            4
#define VRR_VTEM_PB5            5
#define VRR_VTEM_PB6            6

#define VRR_VTEM_MD0            7
#define VRR_VTEM_MD1            8
#define VRR_VTEM_MD2            9
#define VRR_VTEM_MD3            10


// VTEM Byte Masks
//PB0
#define MASK__VRR_VTEM_PB0__RESERVED0  0x01
#define MASK__VRR_VTEM_PB0__SYNC       0x02
#define MASK__VRR_VTEM_PB0__VFR        0x04
#define MASK__VRR_VTEM_PB0__AFR        0x08
#define MASK__VRR_VTEM_PB0__DS_TYPE    0x30
        //0: Periodic pseudo-static EM Data Set
        //1: Periodic dynamic EM Data Set
        //2: Unique EM Data Set
        //3: Reserved
#define MASK__VRR_VTEM_PB0__END        0x40
#define MASK__VRR_VTEM_PB0__NEW        0x80

//PB1
#define MASK__VRR_VTEM_PB1__RESERVED1 0xFF

//PB2
#define MASK__VRR_VTEM_PB2__ORGANIZATION_ID 0xFF
        //0: This is a Vendor Specific EM Data Set
        //1: This EM Data Set is defined by This Specification (HDMI 2.1 r102.clean)
        //2: This EM Data Set is defined by CTA-861-G
        //3: This EM Data Set is defined by VESA
//PB3
#define MASK__VRR_VTEM_PB3__DATA_SET_TAG_MSB    0xFF
//PB4
#define MASK__VRR_VTEM_PB4__DATA_SET_TAG_LSB    0xFF
//PB5
#define MASK__VRR_VTEM_PB5__DATA_SET_LENGTH_MSB 0xFF
//PB6
#define MASK__VRR_VTEM_PB6__DATA_SET_LENGTH_LSB 0xFF



//PB7-27 (20 bytes):
//PB7 = MD0
#define MASK__VRR_VTEM_MD0__VRR_EN         0x01
#define MASK__VRR_VTEM_MD0__M_CONST        0x02
#define MASK__VRR_VTEM_MD0__RESERVED2      0x0C
#define MASK__VRR_VTEM_MD0__FVA_FACTOR_M1  0xF0

//MD1
#define MASK__VRR_VTEM_MD1__BASE_VFRONT    0xFF

//MD2
#define MASK__VRR_VTEM_MD2__BASE_REFRESH_RATE_98  0x03
#define MASK__VRR_VTEM_MD2__RB                    0x04
#define MASK__VRR_VTEM_MD2__RESERVED3             0xF8

//MD3
#define MASK__VRR_VTEM_MD3__BASE_REFRESH_RATE_07  0xFF


#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;
        unsigned int delta_from_mid_point_delta_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;
                        delta_from_mid_point_delta_in_us = delta_from_mid_point_in_us_2 -
                                        delta_from_mid_point_in_us_1;
                } else {
                        frames_to_insert = mid_point_frames_floor;
                        delta_from_mid_point_delta_in_us = delta_from_mid_point_in_us_1 -
                                        delta_from_mid_point_in_us_2;
                }

                /* Prefer current frame multiplier when BTR is enabled unless it drifts
                 * too far from the midpoint
                 */
                if (in_out_vrr->btr.frames_to_insert != 0 &&
                                delta_from_mid_point_delta_in_us < BTR_DRIFT_MARGIN) {
                        if (((last_render_time_in_us / in_out_vrr->btr.frames_to_insert) <
                                        in_out_vrr->max_duration_in_us) &&
                                ((last_render_time_in_us / in_out_vrr->btr.frames_to_insert) >
                                        in_out_vrr->min_duration_in_us))
                                frames_to_insert = in_out_vrr->btr.frames_to_insert;
                }

                /* 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 < in_out_vrr->min_duration_in_us)
                        inserted_frame_duration_in_us = in_out_vrr->min_duration_in_us;

                /* 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; //sequence_index

        setFieldWithMask(&infopacket->sb[VRR_VTEM_PB0], MASK__VRR_VTEM_PB0__VFR, 1);
        setFieldWithMask(&infopacket->sb[VRR_VTEM_PB2], MASK__VRR_VTEM_PB2__ORGANIZATION_ID, 1);
        setFieldWithMask(&infopacket->sb[VRR_VTEM_PB3], MASK__VRR_VTEM_PB3__DATA_SET_TAG_MSB, 0);
        setFieldWithMask(&infopacket->sb[VRR_VTEM_PB4], MASK__VRR_VTEM_PB4__DATA_SET_TAG_LSB, 1);
        setFieldWithMask(&infopacket->sb[VRR_VTEM_PB5], MASK__VRR_VTEM_PB5__DATA_SET_LENGTH_MSB, 0);
        setFieldWithMask(&infopacket->sb[VRR_VTEM_PB6], MASK__VRR_VTEM_PB6__DATA_SET_LENGTH_LSB, 4);
}

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] */
                infopacket->hb2 = 0x08;

                *payload_size = 0x08;

        } else if (dc_is_dp_signal(signal)) {

                /* HEADER */

                /* HB0  = Secondary-data Packet ID = 0 - Only non-zero
                 *        when used to associate audio related info packets
                 */
                infopacket->hb0 = 0x00;

                /* HB1  = Packet Type = 0x83 (Source Product
                 *        Descriptor InfoFrame)
                 */
                infopacket->hb1 = DC_HDMI_INFOFRAME_TYPE_SPD;

                /* HB2  = [Bits 7:0 = Least significant eight bits -
                 *        For INFOFRAME, the value must be 1Bh]
                 */
                infopacket->hb2 = 0x1B;

                /* HB3  = [Bits 7:2 = INFOFRAME SDP Version Number = 0x1]
                 *        [Bits 1:0 = Most significant two bits = 0x00]
                 */
                infopacket->hb3 = 0x04;

                *payload_size = 0x1B;
        }
}

static void build_vrr_infopacket_header_v2(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 = 0x02 */
                infopacket->hb1 = 0x02;

                /* HB2  = [Bits 7:5 = 0] [Bits 4:0 = Length = 0x09] */
                infopacket->hb2 = 0x09;

                *payload_size = 0x0A;

        } else if (dc_is_dp_signal(signal)) {

                /* HEADER */

                /* HB0  = Secondary-data Packet ID = 0 - Only non-zero
                 *        when used to associate audio related info packets
                 */
                infopacket->hb0 = 0x00;

                /* HB1  = Packet Type = 0x83 (Source Product
                 *        Descriptor InfoFrame)
                 */
                infopacket->hb1 = DC_HDMI_INFOFRAME_TYPE_SPD;

                /* HB2  = [Bits 7:0 = Least significant eight bits -
                 *        For INFOFRAME, the value must be 1Bh]
                 */
                infopacket->hb2 = 0x1B;

                /* HB3  = [Bits 7:2 = INFOFRAME SDP Version Number = 0x2]
                 *        [Bits 1:0 = Most significant two bits = 0x00]
                 */
                infopacket->hb3 = 0x08;

                *payload_size = 0x1B;
        }
}

static void build_vrr_vtem_infopacket_data(const struct dc_stream_state *stream,
                const struct mod_vrr_params *vrr,
                struct dc_info_packet *infopacket)
{
        unsigned int fieldRateInHz;

        if (vrr->state == VRR_STATE_ACTIVE_VARIABLE ||
                                vrr->state == VRR_STATE_ACTIVE_FIXED) {
                setFieldWithMask(&infopacket->sb[VRR_VTEM_MD0], MASK__VRR_VTEM_MD0__VRR_EN, 1);
        } else {
                setFieldWithMask(&infopacket->sb[VRR_VTEM_MD0], MASK__VRR_VTEM_MD0__VRR_EN, 0);
        }

        if (!stream->timing.vic) {
                setFieldWithMask(&infopacket->sb[VRR_VTEM_MD1], MASK__VRR_VTEM_MD1__BASE_VFRONT,
                                stream->timing.v_front_porch);


                /* TODO: In dal2, we check mode flags for a reduced blanking timing.
                 * Need a way to relay that information to this function.
                 * if("ReducedBlanking")
                 * {
                 *   setFieldWithMask(&infopacket->sb[VRR_VTEM_MD2], MASK__VRR_VTEM_MD2__RB, 1;
                 * }
                 */

                //TODO: DAL2 does FixPoint and rounding. Here we might need to account for that
                fieldRateInHz = (stream->timing.pix_clk_100hz * 100)/
                        (stream->timing.h_total * stream->timing.v_total);

                setFieldWithMask(&infopacket->sb[VRR_VTEM_MD2],  MASK__VRR_VTEM_MD2__BASE_REFRESH_RATE_98,
                                fieldRateInHz >> 8);
                setFieldWithMask(&infopacket->sb[VRR_VTEM_MD3], MASK__VRR_VTEM_MD3__BASE_REFRESH_RATE_07,
                                fieldRateInHz);

        }
        infopacket->valid = true;
}

static void build_vrr_infopacket_data(const struct mod_vrr_params *vrr,
                struct dc_info_packet *infopacket)
{
        /* PB1 = 0x1A (24bit AMD IEEE OUI (0x00001A) - Byte 0) */
        infopacket->sb[1] = 0x1A;

        /* PB2 = 0x00 (24bit AMD IEEE OUI (0x00001A) - Byte 1) */
        infopacket->sb[2] = 0x00;

        /* PB3 = 0x00 (24bit AMD IEEE OUI (0x00001A) - Byte 2) */
        infopacket->sb[3] = 0x00;

        /* PB4 = Reserved */

        /* PB5 = Reserved */

        /* PB6 = [Bits 7:3 = Reserved] */

        /* PB6 = [Bit 0 = FreeSync Supported] */
        if (vrr->state != VRR_STATE_UNSUPPORTED)
                infopacket->sb[6] |= 0x01;

        /* PB6 = [Bit 1 = FreeSync Enabled] */
        if (vrr->state != VRR_STATE_DISABLED &&
                        vrr->state != VRR_STATE_UNSUPPORTED)
                infopacket->sb[6] |= 0x02;

        /* PB6 = [Bit 2 = FreeSync Active] */
        if (vrr->state == VRR_STATE_ACTIVE_VARIABLE ||
                        vrr->state == VRR_STATE_ACTIVE_FIXED)
                infopacket->sb[6] |= 0x04;

        /* PB7 = FreeSync Minimum refresh rate (Hz) */
        infopacket->sb[7] = (unsigned char)(vrr->min_refresh_in_uhz / 1000000);

        /* PB8 = FreeSync Maximum refresh rate (Hz)
         * Note: We should never go above the field rate of the mode timing set.
         */
        infopacket->sb[8] = (unsigned char)(vrr->max_refresh_in_uhz / 1000000);


        //FreeSync HDR
        infopacket->sb[9] = 0;
        infopacket->sb[10] = 0;
}

static void build_vrr_infopacket_fs2_data(enum color_transfer_func app_tf,
                struct dc_info_packet *infopacket)
{
        if (app_tf != TRANSFER_FUNC_UNKNOWN) {
                infopacket->valid = true;

                infopacket->sb[6] |= 0x08;  // PB6 = [Bit 3 = Native Color Active]

                if (app_tf == TRANSFER_FUNC_GAMMA_22) {
                        infopacket->sb[9] |= 0x04;  // PB6 = [Bit 2 = Gamma 2.2 EOTF Active]
                }
        }
}

static void build_vrr_infopacket_checksum(unsigned int *payload_size,
                struct dc_info_packet *infopacket)
{
        /* Calculate checksum */
        unsigned int idx = 0;
        unsigned char checksum = 0;

        checksum += infopacket->hb0;
        checksum += infopacket->hb1;
        checksum += infopacket->hb2;
        checksum += infopacket->hb3;

        for (idx = 1; idx <= *payload_size; idx++)
                checksum += infopacket->sb[idx];

        /* PB0 = Checksum (one byte complement) */
        infopacket->sb[0] = (unsigned char)(0x100 - checksum);

        infopacket->valid = true;
}

static void build_vrr_infopacket_v1(enum signal_type signal,
                const struct mod_vrr_params *vrr,
                struct dc_info_packet *infopacket)
{
        /* SPD info packet for FreeSync */
        unsigned int payload_size = 0;

        build_vrr_infopacket_header_v1(signal, infopacket, &payload_size);
        build_vrr_infopacket_data(vrr, infopacket);
        build_vrr_infopacket_checksum(&payload_size, infopacket);

        infopacket->valid = true;
}

static void 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)
{
        unsigned int payload_size = 0;

        build_vrr_infopacket_header_v2(signal, infopacket, &payload_size);
        build_vrr_infopacket_data(vrr, infopacket);

        build_vrr_infopacket_fs2_data(app_tf, infopacket);

        build_vrr_infopacket_checksum(&payload_size, infopacket);

        infopacket->valid = true;
}

static void build_vrr_infopacket_vtem(const struct dc_stream_state *stream,
                const struct mod_vrr_params *vrr,
                struct dc_info_packet *infopacket)
{
        //VTEM info packet for HdmiVrr

        memset(infopacket, 0, sizeof(struct dc_info_packet));

        //VTEM Packet is structured differently
        build_vrr_infopacket_header_vtem(stream->signal, infopacket);
        build_vrr_vtem_infopacket_data(stream, vrr, infopacket);

        infopacket->valid = true;
}

void 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)
{
        /* SPD info packet for FreeSync
         * VTEM info packet for HdmiVRR
         * Check if Freesync is supported. Return if false. If true,
         * set the corresponding bit in the info packet
         */
        if (!vrr->supported || (!vrr->send_info_frame && packet_type != PACKET_TYPE_VTEM))
                return;

        switch (packet_type) {
        case PACKET_TYPE_FS2:
                build_vrr_infopacket_v2(stream->signal, vrr, app_tf, infopacket);
                break;
        case PACKET_TYPE_VTEM:
                build_vrr_infopacket_vtem(stream, vrr, infopacket);
                break;
        case PACKET_TYPE_VRR:
        case PACKET_TYPE_FS1:
        default:
                build_vrr_infopacket_v1(stream->signal, vrr, infopacket);
        }
}

void 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)
{
        struct core_freesync *core_freesync = NULL;
        unsigned long long nominal_field_rate_in_uhz = 0;
        unsigned int refresh_range = 0;
        unsigned int min_refresh_in_uhz = 0;
        unsigned int max_refresh_in_uhz = 0;

        if (mod_freesync == NULL)
                return;

        core_freesync = MOD_FREESYNC_TO_CORE(mod_freesync);

        /* Calculate nominal field rate for stream */
        nominal_field_rate_in_uhz =
                        mod_freesync_calc_nominal_field_rate(stream);

        min_refresh_in_uhz = in_config->min_refresh_in_uhz;
        max_refresh_in_uhz = in_config->max_refresh_in_uhz;

        // Don't allow min > max
        if (min_refresh_in_uhz > max_refresh_in_uhz)
                min_refresh_in_uhz = max_refresh_in_uhz;

        // Full range may be larger than current video timing, so cap at nominal
        if (max_refresh_in_uhz > nominal_field_rate_in_uhz)
                max_refresh_in_uhz = nominal_field_rate_in_uhz;

        // Full range may be larger than current video timing, so cap at nominal
        if (min_refresh_in_uhz > nominal_field_rate_in_uhz)
                min_refresh_in_uhz = nominal_field_rate_in_uhz;

        if (!vrr_settings_require_update(core_freesync,
                        in_config, min_refresh_in_uhz, max_refresh_in_uhz,
                        in_out_vrr))
                return;

        in_out_vrr->state = in_config->state;
        in_out_vrr->send_info_frame = in_config->vsif_supported;

        if (in_config->state == VRR_STATE_UNSUPPORTED) {
                in_out_vrr->state = VRR_STATE_UNSUPPORTED;
                in_out_vrr->supported = false;
                in_out_vrr->adjust.v_total_min = stream->timing.v_total;
                in_out_vrr->adjust.v_total_max = stream->timing.v_total;

                return;

        } else {
                in_out_vrr->min_refresh_in_uhz = min_refresh_in_uhz;
                in_out_vrr->max_duration_in_us =
                                calc_duration_in_us_from_refresh_in_uhz(
                                                min_refresh_in_uhz);

                in_out_vrr->max_refresh_in_uhz = max_refresh_in_uhz;
                in_out_vrr->min_duration_in_us =
                                calc_duration_in_us_from_refresh_in_uhz(
                                                max_refresh_in_uhz);

                refresh_range = in_out_vrr->max_refresh_in_uhz -
                                in_out_vrr->min_refresh_in_uhz;

                in_out_vrr->supported = true;
        }

        in_out_vrr->fixed.ramping_active = in_config->ramping;

        in_out_vrr->btr.btr_enabled = in_config->btr;
        if (in_out_vrr->max_refresh_in_uhz <
                        2 * in_out_vrr->min_refresh_in_uhz)
                in_out_vrr->btr.btr_enabled = false;
        in_out_vrr->btr.btr_active = false;
        in_out_vrr->btr.inserted_duration_in_us = 0;
        in_out_vrr->btr.frames_to_insert = 0;
        in_out_vrr->btr.frame_counter = 0;
        in_out_vrr->btr.mid_point_in_us =
                        in_out_vrr->min_duration_in_us +
                                (in_out_vrr->max_duration_in_us -
                                in_out_vrr->min_duration_in_us) / 2;

        if (in_out_vrr->state == VRR_STATE_UNSUPPORTED) {
                in_out_vrr->adjust.v_total_min = stream->timing.v_total;
                in_out_vrr->adjust.v_total_max = stream->timing.v_total;
        } else if (in_out_vrr->state == VRR_STATE_DISABLED) {
                in_out_vrr->adjust.v_total_min = stream->timing.v_total;
                in_out_vrr->adjust.v_total_max = stream->timing.v_total;
        } else if (in_out_vrr->state == VRR_STATE_INACTIVE) {
                in_out_vrr->adjust.v_total_min = stream->timing.v_total;
                in_out_vrr->adjust.v_total_max = stream->timing.v_total;
        } else if (in_out_vrr->state == VRR_STATE_ACTIVE_VARIABLE &&
                        refresh_range >= MIN_REFRESH_RANGE_IN_US) {
                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);
        } else if (in_out_vrr->state == VRR_STATE_ACTIVE_FIXED) {
                in_out_vrr->fixed.target_refresh_in_uhz =
                                in_out_vrr->min_refresh_in_uhz;
                if (in_out_vrr->fixed.ramping_active &&
                                in_out_vrr->fixed.fixed_active) {
                        /* Do not update vtotals if ramping is already active
                         * in order to continue ramp from current refresh.
                         */
                        in_out_vrr->fixed.fixed_active = true;
                } else {
                        in_out_vrr->fixed.fixed_active = true;
                        in_out_vrr->adjust.v_total_min =
                                calc_v_total_from_refresh(stream,
                                        in_out_vrr->fixed.target_refresh_in_uhz);
                        in_out_vrr->adjust.v_total_max =
                                in_out_vrr->adjust.v_total_min;
                }
        } else {
                in_out_vrr->state = VRR_STATE_INACTIVE;

                in_out_vrr->adjust.v_total_min = stream->timing.v_total;
                in_out_vrr->adjust.v_total_max = stream->timing.v_total;
        }
}

void 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)
{
        struct core_freesync *core_freesync = NULL;
        unsigned int last_render_time_in_us = 0;
        unsigned int average_render_time_in_us = 0;

        if (mod_freesync == NULL)
                return;

        core_freesync = MOD_FREESYNC_TO_CORE(mod_freesync);

        if (in_out_vrr->supported &&
                        in_out_vrr->state == VRR_STATE_ACTIVE_VARIABLE) {
                unsigned int i = 0;
                unsigned int oldest_index = plane->time.index + 1;

                if (oldest_index >= DC_PLANE_UPDATE_TIMES_MAX)
                        oldest_index = 0;

                last_render_time_in_us = curr_time_stamp_in_us -
                                plane->time.prev_update_time_in_us;

                // Sum off all entries except oldest one
                for (i = 0; i < DC_PLANE_UPDATE_TIMES_MAX; i++) {
                        average_render_time_in_us +=
                                        plane->time.time_elapsed_in_us[i];
                }
                average_render_time_in_us -=
                                plane->time.time_elapsed_in_us[oldest_index];

                // Add render time for current flip
                average_render_time_in_us += last_render_time_in_us;
                average_render_time_in_us /= DC_PLANE_UPDATE_TIMES_MAX;

                if (in_out_vrr->btr.btr_enabled) {
                        apply_below_the_range(core_freesync,
                                        stream,
                                        last_render_time_in_us,
                                        in_out_vrr);
                } else {
                        apply_fixed_refresh(core_freesync,
                                stream,
                                last_render_time_in_us,
                                in_out_vrr);
                }

        }
}

void mod_freesync_handle_v_update(struct mod_freesync *mod_freesync,
                const struct dc_stream_state *stream,
                struct mod_vrr_params *in_out_vrr)
{
        struct core_freesync *core_freesync = NULL;

        if ((mod_freesync == NULL) || (stream == NULL) || (in_out_vrr == NULL))
                return;

        core_freesync = MOD_FREESYNC_TO_CORE(mod_freesync);

        if (in_out_vrr->supported == false)
                return;

        /* Below the Range Logic */

        /* Only execute if in fullscreen mode */
        if (in_out_vrr->state == VRR_STATE_ACTIVE_VARIABLE &&
                                        in_out_vrr->btr.btr_active) {
                /* TODO: pass in flag for Pre-DCE12 ASIC
                 * in order for frame variable duration to take affect,
                 * it needs to be done one VSYNC early, which is at
                 * frameCounter == 1.
                 * For DCE12 and newer updates to V_TOTAL_MIN/MAX
                 * will take affect on current frame
                 */
                if (in_out_vrr->btr.frames_to_insert ==
                                in_out_vrr->btr.frame_counter) {
                        in_out_vrr->adjust.v_total_min =
                                calc_v_total_from_duration(stream,
                                in_out_vrr,
                                in_out_vrr->btr.inserted_duration_in_us);
                        in_out_vrr->adjust.v_total_max =
                                in_out_vrr->adjust.v_total_min;
                }

                if (in_out_vrr->btr.frame_counter > 0)
                        in_out_vrr->btr.frame_counter--;

                /* Restore FreeSync */
                if (in_out_vrr->btr.frame_counter == 0) {
                        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);
                }
        }

        /* If in fullscreen freesync mode or in video, do not program
         * static screen ramp values
         */
        if (in_out_vrr->state == VRR_STATE_ACTIVE_VARIABLE)
                in_out_vrr->fixed.ramping_active = false;

        /* Gradual Static Screen Ramping Logic */
        /* Execute if ramp is active and user enabled freesync static screen*/
        if (in_out_vrr->state == VRR_STATE_ACTIVE_FIXED &&
                                in_out_vrr->fixed.ramping_active) {
                update_v_total_for_static_ramp(
                                core_freesync, stream, in_out_vrr);
        }
}

void 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)
{
        struct core_freesync *core_freesync = NULL;

        if (mod_freesync == NULL)
                return;

        core_freesync = MOD_FREESYNC_TO_CORE(mod_freesync);

        if (vrr->supported) {
                *v_total_min = vrr->adjust.v_total_min;
                *v_total_max = vrr->adjust.v_total_max;
                *event_triggers = 0;
                *lfc_mid_point_in_us = vrr->btr.mid_point_in_us;
                *inserted_frames = vrr->btr.frames_to_insert;
                *inserted_duration_in_us = vrr->btr.inserted_duration_in_us;
        }
}

unsigned long long mod_freesync_calc_nominal_field_rate(
                        const struct dc_stream_state *stream)
{
        unsigned long long nominal_field_rate_in_uhz = 0;

        /* Calculate nominal field rate for stream */
        nominal_field_rate_in_uhz = stream->timing.pix_clk_100hz / 10;
        nominal_field_rate_in_uhz *= 1000ULL * 1000ULL * 1000ULL;
        nominal_field_rate_in_uhz = div_u64(nominal_field_rate_in_uhz,
                                                stream->timing.h_total);
        nominal_field_rate_in_uhz = div_u64(nominal_field_rate_in_uhz,
                                                stream->timing.v_total);

        return nominal_field_rate_in_uhz;
}

bool mod_freesync_is_valid_range(struct mod_freesync *mod_freesync,
                const struct dc_stream_state *stream,
                uint32_t min_refresh_cap_in_uhz,
                uint32_t max_refresh_cap_in_uhz,
                uint32_t min_refresh_request_in_uhz,
                uint32_t max_refresh_request_in_uhz)
{
        /* Calculate nominal field rate for stream */
        unsigned long long nominal_field_rate_in_uhz =
                        mod_freesync_calc_nominal_field_rate(stream);

        /* Typically nominal refresh calculated can have some fractional part.
         * Allow for some rounding error of actual video timing by taking floor
         * of caps and request. Round the nominal refresh rate.
         *
         * Dividing will convert everything to units in Hz although input
         * variable name is in uHz!
         *
         * Also note, this takes care of rounding error on the nominal refresh
         * so by rounding error we only expect it to be off by a small amount,
         * such as < 0.1 Hz. i.e. 143.9xxx or 144.1xxx.
         *
         * Example 1. Caps    Min = 40 Hz, Max = 144 Hz
         *            Request Min = 40 Hz, Max = 144 Hz
         *                    Nominal = 143.5x Hz rounded to 144 Hz
         *            This function should allow this as valid request
         *
         * Example 2. Caps    Min = 40 Hz, Max = 144 Hz
         *            Request Min = 40 Hz, Max = 144 Hz
         *                    Nominal = 144.4x Hz rounded to 144 Hz
         *            This function should allow this as valid request
         *
         * Example 3. Caps    Min = 40 Hz, Max = 144 Hz
         *            Request Min = 40 Hz, Max = 144 Hz
         *                    Nominal = 120.xx Hz rounded to 120 Hz
         *            This function should return NOT valid since the requested
         *            max is greater than current timing's nominal
         *
         * Example 4. Caps    Min = 40 Hz, Max = 120 Hz
         *            Request Min = 40 Hz, Max = 120 Hz
         *                    Nominal = 144.xx Hz rounded to 144 Hz
         *            This function should return NOT valid since the nominal
         *            is greater than the capability's max refresh
         */
        nominal_field_rate_in_uhz =
                        div_u64(nominal_field_rate_in_uhz + 500000, 1000000);
        min_refresh_cap_in_uhz /= 1000000;
        max_refresh_cap_in_uhz /= 1000000;
        min_refresh_request_in_uhz /= 1000000;
        max_refresh_request_in_uhz /= 1000000;

        // Check nominal is within range
        if (nominal_field_rate_in_uhz > max_refresh_cap_in_uhz ||
                nominal_field_rate_in_uhz < min_refresh_cap_in_uhz)
                return false;

        // If nominal is less than max, limit the max allowed refresh rate
        if (nominal_field_rate_in_uhz < max_refresh_cap_in_uhz)
                max_refresh_cap_in_uhz = nominal_field_rate_in_uhz;

        // Don't allow min > max
        if (min_refresh_request_in_uhz > max_refresh_request_in_uhz)
                return false;

        // Check min is within range
        if (min_refresh_request_in_uhz > max_refresh_cap_in_uhz ||
                min_refresh_request_in_uhz < min_refresh_cap_in_uhz)
                return false;

        // Check max is within range
        if (max_refresh_request_in_uhz > max_refresh_cap_in_uhz ||
                max_refresh_request_in_uhz < min_refresh_cap_in_uhz)
                return false;

        // For variable range, check for at least 10 Hz range
        if ((max_refresh_request_in_uhz != min_refresh_request_in_uhz) &&
                (max_refresh_request_in_uhz - min_refresh_request_in_uhz < 10))
                return false;

        return true;
}