Quelle  link_dpms.c   Sprache: C

/*
 * Copyright 2023 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
 *
 */

/* FILE POLICY AND INTENDED USAGE:
 * This file owns the programming sequence of stream's dpms state associated
 * with the link and link's enable/disable sequences as result of the stream's
 * dpms state change.
 *
 * TODO - The reason link owns stream's dpms programming sequence is
 * because dpms programming sequence is highly dependent on underlying signal
 * specific link protocols. This unfortunately causes link to own a portion of
 * stream state programming sequence. This creates a gray area where the
 * boundary between link and stream is not clearly defined.
 */

#include "link_dpms.h"
#include "link_hwss.h"
#include "link_validation.h"
#include "accessories/link_dp_trace.h"
#include "protocols/link_dpcd.h"
#include "protocols/link_ddc.h"
#include "protocols/link_hpd.h"
#include "protocols/link_dp_phy.h"
#include "protocols/link_dp_capability.h"
#include "protocols/link_dp_training.h"
#include "protocols/link_edp_panel_control.h"
#include "protocols/link_dp_dpia_bw.h"

#include "dm_helpers.h"
#include "link_enc_cfg.h"
#include "resource.h"
#include "dsc.h"
#include "dccg.h"
#include "clk_mgr.h"
#include "atomfirmware.h"
#include "vpg.h"

#define DC_LOGGER \
 dc_logger
#define DC_LOGGER_INIT(logger) \
 struct dal_logger *dc_logger = logger

#define LINK_INFO(...) \
 DC_LOG_HW_HOTPLUG(  \
  __VA_ARGS__)

#define RETIMER_REDRIVER_INFO(...) \
 DC_LOG_RETIMER_REDRIVER(  \
  __VA_ARGS__)

#define MAX_MTP_SLOT_COUNT 64
#define LINK_TRAINING_ATTEMPTS 4
#define PEAK_FACTOR_X1000 1006

void link_blank_all_dp_displays(struct dc *dc)
{
 unsigned int i;
 uint8_t dpcd_power_state = '\0';
 enum dc_status status = DC_ERROR_UNEXPECTED;

 for (i = 0; i < dc->link_count; i++) {
  if ((dc->links[i]->connector_signal != SIGNAL_TYPE_DISPLAY_PORT) ||
   (dc->links[i]->priv == NULL) || (dc->links[i]->local_sink == NULL))
   continue;

  /* DP 2.0 spec requires that we read LTTPR caps first */
  dp_retrieve_lttpr_cap(dc->links[i]);
  /* if any of the displays are lit up turn them off */
  status = core_link_read_dpcd(dc->links[i], DP_SET_POWER,
       &dpcd_power_state, sizeof(dpcd_power_state));

  if (status == DC_OK && dpcd_power_state == DP_POWER_STATE_D0)
   link_blank_dp_stream(dc->links[i], true);
 }

}

void link_blank_all_edp_displays(struct dc *dc)
{
 unsigned int i;
 uint8_t dpcd_power_state = '\0';
 enum dc_status status = DC_ERROR_UNEXPECTED;

 for (i = 0; i < dc->link_count; i++) {
  if ((dc->links[i]->connector_signal != SIGNAL_TYPE_EDP) ||
   (!dc->links[i]->edp_sink_present))
   continue;

  /* if any of the displays are lit up turn them off */
  status = core_link_read_dpcd(dc->links[i], DP_SET_POWER,
       &dpcd_power_state, sizeof(dpcd_power_state));

  if (status == DC_OK && dpcd_power_state == DP_POWER_STATE_D0)
   link_blank_dp_stream(dc->links[i], true);
 }
}

void link_blank_dp_stream(struct dc_link *link, bool hw_init)
{
 unsigned int j;
 struct dc  *dc = link->ctx->dc;
 enum signal_type signal = link->connector_signal;

 if ((signal == SIGNAL_TYPE_EDP) ||
  (signal == SIGNAL_TYPE_DISPLAY_PORT)) {
  if (link->ep_type == DISPLAY_ENDPOINT_PHY &&
   link->link_enc->funcs->get_dig_frontend &&
   link->link_enc->funcs->is_dig_enabled(link->link_enc)) {
   int fe = link->link_enc->funcs->get_dig_frontend(link->link_enc);

   if (fe != ENGINE_ID_UNKNOWN)
    for (j = 0; j < dc->res_pool->stream_enc_count; j++) {
     if (fe == dc->res_pool->stream_enc[j]->id) {
      dc->res_pool->stream_enc[j]->funcs->dp_blank(link,
         dc->res_pool->stream_enc[j]);
      break;
     }
    }
  }

  if (((!dc->is_switch_in_progress_dest) && ((!link->wa_flags.dp_keep_receiver_powered) || hw_init)) &&
   (link->type != dc_connection_none))
   dpcd_write_rx_power_ctrl(link, false);
 }
}

void link_set_all_streams_dpms_off_for_link(struct dc_link *link)
{
 struct pipe_ctx *pipes[MAX_PIPES];
 struct dc_stream_state *streams[MAX_PIPES];
 struct dc_state *state = link->dc->current_state;
 uint8_t count;
 int i;
 struct dc_stream_update stream_update;
 bool dpms_off = true;
 struct link_resource link_res = {0};

 memset(&stream_update, 0, sizeof(stream_update));
 stream_update.dpms_off = &dpms_off;

 link_get_master_pipes_with_dpms_on(link, state, &count, pipes);

 /* The subsequent call to dc_commit_updates_for_stream for a full update
 * will release the current state and swap to a new state. Releasing the
 * current state results in the stream pointers in the pipe_ctx structs
 * to be zero'd. Hence, cache all streams prior to dc_commit_updates_for_stream.
 */
 for (i = 0; i < count; i++)
  streams[i] = pipes[i]->stream;

 for (i = 0; i < count; i++) {
  stream_update.stream = streams[i];
  dc_commit_updates_for_stream(link->ctx->dc, NULL, 0,
    streams[i], &stream_update,
    state);
 }

 /* link can be also enabled by vbios. In this case it is not recorded
 * in pipe_ctx. Disable link phy here to make sure it is completely off
 */
 dp_disable_link_phy(link, &link_res, link->connector_signal);
}

void link_resume(struct dc_link *link)
{
 if (link->connector_signal != SIGNAL_TYPE_VIRTUAL)
  program_hpd_filter(link);
}

/* This function returns true if the pipe is used to feed video signal directly
 * to the link.
 */
static bool is_master_pipe_for_link(const struct dc_link *link,
  const struct pipe_ctx *pipe)
{
 return resource_is_pipe_type(pipe, OTG_MASTER) &&
   pipe->stream->link == link;
}

/*
 * This function finds all master pipes feeding to a given link with dpms set to
 * on in given dc state.
 */
void link_get_master_pipes_with_dpms_on(const struct dc_link *link,
  struct dc_state *state,
  uint8_t *count,
  struct pipe_ctx *pipes[MAX_PIPES])
{
 int i;
 struct pipe_ctx *pipe = NULL;

 *count = 0;
 for (i = 0; i < MAX_PIPES; i++) {
  pipe = &state->res_ctx.pipe_ctx[i];

  if (is_master_pipe_for_link(link, pipe) &&
    pipe->stream->dpms_off == false) {
   pipes[(*count)++] = pipe;
  }
 }
}

static bool get_ext_hdmi_settings(struct pipe_ctx *pipe_ctx,
  enum engine_id eng_id,
  struct ext_hdmi_settings *settings)
{
 bool result = false;
 int i = 0;
 struct integrated_info *integrated_info =
   pipe_ctx->stream->ctx->dc_bios->integrated_info;

 if (integrated_info == NULL)
  return false;

 /*
 * Get retimer settings from sbios for passing SI eye test for DCE11
 * The setting values are varied based on board revision and port id
 * Therefore the setting values of each ports is passed by sbios.
 */

 // Check if current bios contains ext Hdmi settings
 if (integrated_info->gpu_cap_info & 0x20) {
  switch (eng_id) {
  case ENGINE_ID_DIGA:
   settings->slv_addr = integrated_info->dp0_ext_hdmi_slv_addr;
   settings->reg_num = integrated_info->dp0_ext_hdmi_6g_reg_num;
   settings->reg_num_6g = integrated_info->dp0_ext_hdmi_6g_reg_num;
   memmove(settings->reg_settings,
     integrated_info->dp0_ext_hdmi_reg_settings,
     sizeof(integrated_info->dp0_ext_hdmi_reg_settings));
   memmove(settings->reg_settings_6g,
     integrated_info->dp0_ext_hdmi_6g_reg_settings,
     sizeof(integrated_info->dp0_ext_hdmi_6g_reg_settings));
   result = true;
   break;
  case ENGINE_ID_DIGB:
   settings->slv_addr = integrated_info->dp1_ext_hdmi_slv_addr;
   settings->reg_num = integrated_info->dp1_ext_hdmi_6g_reg_num;
   settings->reg_num_6g = integrated_info->dp1_ext_hdmi_6g_reg_num;
   memmove(settings->reg_settings,
     integrated_info->dp1_ext_hdmi_reg_settings,
     sizeof(integrated_info->dp1_ext_hdmi_reg_settings));
   memmove(settings->reg_settings_6g,
     integrated_info->dp1_ext_hdmi_6g_reg_settings,
     sizeof(integrated_info->dp1_ext_hdmi_6g_reg_settings));
   result = true;
   break;
  case ENGINE_ID_DIGC:
   settings->slv_addr = integrated_info->dp2_ext_hdmi_slv_addr;
   settings->reg_num = integrated_info->dp2_ext_hdmi_6g_reg_num;
   settings->reg_num_6g = integrated_info->dp2_ext_hdmi_6g_reg_num;
   memmove(settings->reg_settings,
     integrated_info->dp2_ext_hdmi_reg_settings,
     sizeof(integrated_info->dp2_ext_hdmi_reg_settings));
   memmove(settings->reg_settings_6g,
     integrated_info->dp2_ext_hdmi_6g_reg_settings,
     sizeof(integrated_info->dp2_ext_hdmi_6g_reg_settings));
   result = true;
   break;
  case ENGINE_ID_DIGD:
   settings->slv_addr = integrated_info->dp3_ext_hdmi_slv_addr;
   settings->reg_num = integrated_info->dp3_ext_hdmi_6g_reg_num;
   settings->reg_num_6g = integrated_info->dp3_ext_hdmi_6g_reg_num;
   memmove(settings->reg_settings,
     integrated_info->dp3_ext_hdmi_reg_settings,
     sizeof(integrated_info->dp3_ext_hdmi_reg_settings));
   memmove(settings->reg_settings_6g,
     integrated_info->dp3_ext_hdmi_6g_reg_settings,
     sizeof(integrated_info->dp3_ext_hdmi_6g_reg_settings));
   result = true;
   break;
  default:
   break;
  }

  if (result == true) {
   // Validate settings from bios integrated info table
   if (settings->slv_addr == 0)
    return false;
   if (settings->reg_num > 9)
    return false;
   if (settings->reg_num_6g > 3)
    return false;

   for (i = 0; i < settings->reg_num; i++) {
    if (settings->reg_settings[i].i2c_reg_index > 0x20)
     return false;
   }

   for (i = 0; i < settings->reg_num_6g; i++) {
    if (settings->reg_settings_6g[i].i2c_reg_index > 0x20)
     return false;
   }
  }
 }

 return result;
}

static bool write_i2c(struct pipe_ctx *pipe_ctx,
  uint8_t address, uint8_t *buffer, uint32_t length)
{
 struct i2c_command cmd = {0};
 struct i2c_payload payload = {0};

 memset(&payload, 0, sizeof(payload));
 memset(&cmd, 0, sizeof(cmd));

 cmd.number_of_payloads = 1;
 cmd.engine = I2C_COMMAND_ENGINE_DEFAULT;
 cmd.speed = pipe_ctx->stream->ctx->dc->caps.i2c_speed_in_khz;

 payload.address = address;
 payload.data = buffer;
 payload.length = length;
 payload.write = true;
 cmd.payloads = &payload;

 if (dm_helpers_submit_i2c(pipe_ctx->stream->ctx,
   pipe_ctx->stream->link, &cmd))
  return true;

 return false;
}

static void write_i2c_retimer_setting(
  struct pipe_ctx *pipe_ctx,
  bool is_vga_mode,
  bool is_over_340mhz,
  struct ext_hdmi_settings *settings)
{
 uint8_t slave_address = (settings->slv_addr >> 1);
 uint8_t buffer[2];
 const uint8_t apply_rx_tx_change = 0x4;
 uint8_t offset = 0xA;
 uint8_t value = 0;
 int i = 0;
 bool i2c_success = false;
 DC_LOGGER_INIT(pipe_ctx->stream->ctx->logger);

 memset(&buffer, 0, sizeof(buffer));

 /* Start Ext-Hdmi programming*/

 for (i = 0; i < settings->reg_num; i++) {
  /* Apply 3G settings */
  if (settings->reg_settings[i].i2c_reg_index <= 0x20) {

   buffer[0] = settings->reg_settings[i].i2c_reg_index;
   buffer[1] = settings->reg_settings[i].i2c_reg_val;
   i2c_success = write_i2c(pipe_ctx, slave_address,
      buffer, sizeof(buffer));
   RETIMER_REDRIVER_INFO("retimer write to slave_address = 0x%x,\
    offset = 0x%x, reg_val= 0x%x, i2c_success = %d\n",
    slave_address, buffer[0], buffer[1], i2c_success?1:0);

   if (!i2c_success)
    goto i2c_write_fail;

   /* Based on DP159 specs, APPLY_RX_TX_CHANGE bit in 0x0A
 * needs to be set to 1 on every 0xA-0xC write.
 */
   if (settings->reg_settings[i].i2c_reg_index == 0xA ||
    settings->reg_settings[i].i2c_reg_index == 0xB ||
    settings->reg_settings[i].i2c_reg_index == 0xC) {

    /* Query current value from offset 0xA */
    if (settings->reg_settings[i].i2c_reg_index == 0xA)
     value = settings->reg_settings[i].i2c_reg_val;
    else {
     i2c_success =
      link_query_ddc_data(
      pipe_ctx->stream->link->ddc,
      slave_address, &offset, 1, &value, 1);
     if (!i2c_success)
      goto i2c_write_fail;
    }

    buffer[0] = offset;
    /* Set APPLY_RX_TX_CHANGE bit to 1 */
    buffer[1] = value | apply_rx_tx_change;
    i2c_success = write_i2c(pipe_ctx, slave_address,
      buffer, sizeof(buffer));
    RETIMER_REDRIVER_INFO("retimer write to slave_address = 0x%x,\
     offset = 0x%x, reg_val = 0x%x, i2c_success = %d\n",
     slave_address, buffer[0], buffer[1], i2c_success?1:0);
    if (!i2c_success)
     goto i2c_write_fail;
   }
  }
 }

 /* Apply 3G settings */
 if (is_over_340mhz) {
  for (i = 0; i < settings->reg_num_6g; i++) {
   /* Apply 3G settings */
   if (settings->reg_settings[i].i2c_reg_index <= 0x20) {

    buffer[0] = settings->reg_settings_6g[i].i2c_reg_index;
    buffer[1] = settings->reg_settings_6g[i].i2c_reg_val;
    i2c_success = write_i2c(pipe_ctx, slave_address,
       buffer, sizeof(buffer));
    RETIMER_REDRIVER_INFO("above 340Mhz: retimer write to slave_address = 0x%x,\
     offset = 0x%x, reg_val = 0x%x, i2c_success = %d\n",
     slave_address, buffer[0], buffer[1], i2c_success?1:0);

    if (!i2c_success)
     goto i2c_write_fail;

    /* Based on DP159 specs, APPLY_RX_TX_CHANGE bit in 0x0A
 * needs to be set to 1 on every 0xA-0xC write.
 */
    if (settings->reg_settings_6g[i].i2c_reg_index == 0xA ||
     settings->reg_settings_6g[i].i2c_reg_index == 0xB ||
     settings->reg_settings_6g[i].i2c_reg_index == 0xC) {

     /* Query current value from offset 0xA */
     if (settings->reg_settings_6g[i].i2c_reg_index == 0xA)
      value = settings->reg_settings_6g[i].i2c_reg_val;
     else {
      i2c_success =
        link_query_ddc_data(
        pipe_ctx->stream->link->ddc,
        slave_address, &offset, 1, &value, 1);
      if (!i2c_success)
       goto i2c_write_fail;
     }

     buffer[0] = offset;
     /* Set APPLY_RX_TX_CHANGE bit to 1 */
     buffer[1] = value | apply_rx_tx_change;
     i2c_success = write_i2c(pipe_ctx, slave_address,
       buffer, sizeof(buffer));
     RETIMER_REDRIVER_INFO("retimer write to slave_address = 0x%x,\
      offset = 0x%x, reg_val = 0x%x, i2c_success = %d\n",
      slave_address, buffer[0], buffer[1], i2c_success?1:0);
     if (!i2c_success)
      goto i2c_write_fail;
    }
   }
  }
 }

 if (is_vga_mode) {
  /* Program additional settings if using 640x480 resolution */

  /* Write offset 0xFF to 0x01 */
  buffer[0] = 0xff;
  buffer[1] = 0x01;
  i2c_success = write_i2c(pipe_ctx, slave_address,
    buffer, sizeof(buffer));
  RETIMER_REDRIVER_INFO("retimer write to slave_address = 0x%x,\
    offset = 0x%x, reg_val = 0x%x, i2c_success = %d\n",
    slave_address, buffer[0], buffer[1], i2c_success?1:0);
  if (!i2c_success)
   goto i2c_write_fail;

  /* Write offset 0x00 to 0x23 */
  buffer[0] = 0x00;
  buffer[1] = 0x23;
  i2c_success = write_i2c(pipe_ctx, slave_address,
    buffer, sizeof(buffer));
  RETIMER_REDRIVER_INFO("retimer write to slave_address = 0x%x,\
   offset = 0x%x, reg_val = 0x%x, i2c_success = %d\n",
   slave_address, buffer[0], buffer[1], i2c_success?1:0);
  if (!i2c_success)
   goto i2c_write_fail;

  /* Write offset 0xff to 0x00 */
  buffer[0] = 0xff;
  buffer[1] = 0x00;
  i2c_success = write_i2c(pipe_ctx, slave_address,
    buffer, sizeof(buffer));
  RETIMER_REDRIVER_INFO("retimer write to slave_address = 0x%x,\
   offset = 0x%x, reg_val = 0x%x, i2c_success = %d\n",
   slave_address, buffer[0], buffer[1], i2c_success?1:0);
  if (!i2c_success)
   goto i2c_write_fail;

 }

 return;

i2c_write_fail:
 DC_LOG_DEBUG("Set retimer failed");
}

static void write_i2c_default_retimer_setting(
  struct pipe_ctx *pipe_ctx,
  bool is_vga_mode,
  bool is_over_340mhz)
{
 uint8_t slave_address = (0xBA >> 1);
 uint8_t buffer[2];
 bool i2c_success = false;
 DC_LOGGER_INIT(pipe_ctx->stream->ctx->logger);

 memset(&buffer, 0, sizeof(buffer));

 /* Program Slave Address for tuning single integrity */
 /* Write offset 0x0A to 0x13 */
 buffer[0] = 0x0A;
 buffer[1] = 0x13;
 i2c_success = write_i2c(pipe_ctx, slave_address,
   buffer, sizeof(buffer));
 RETIMER_REDRIVER_INFO("retimer writes default setting to slave_address = 0x%x,\
  offset = 0x%x, reg_val = 0x%x, i2c_success = %d\n",
  slave_address, buffer[0], buffer[1], i2c_success?1:0);
 if (!i2c_success)
  goto i2c_write_fail;

 /* Write offset 0x0A to 0x17 */
 buffer[0] = 0x0A;
 buffer[1] = 0x17;
 i2c_success = write_i2c(pipe_ctx, slave_address,
   buffer, sizeof(buffer));
 RETIMER_REDRIVER_INFO("retimer write to slave_addr = 0x%x,\
  offset = 0x%x, reg_val = 0x%x, i2c_success = %d\n",
  slave_address, buffer[0], buffer[1], i2c_success?1:0);
 if (!i2c_success)
  goto i2c_write_fail;

 /* Write offset 0x0B to 0xDA or 0xD8 */
 buffer[0] = 0x0B;
 buffer[1] = is_over_340mhz ? 0xDA : 0xD8;
 i2c_success = write_i2c(pipe_ctx, slave_address,
   buffer, sizeof(buffer));
 RETIMER_REDRIVER_INFO("retimer write to slave_addr = 0x%x,\
  offset = 0x%x, reg_val = 0x%x, i2c_success = %d\n",
  slave_address, buffer[0], buffer[1], i2c_success?1:0);
 if (!i2c_success)
  goto i2c_write_fail;

 /* Write offset 0x0A to 0x17 */
 buffer[0] = 0x0A;
 buffer[1] = 0x17;
 i2c_success = write_i2c(pipe_ctx, slave_address,
   buffer, sizeof(buffer));
 RETIMER_REDRIVER_INFO("retimer write to slave_addr = 0x%x,\
  offset = 0x%x, reg_val= 0x%x, i2c_success = %d\n",
  slave_address, buffer[0], buffer[1], i2c_success?1:0);
 if (!i2c_success)
  goto i2c_write_fail;

 /* Write offset 0x0C to 0x1D or 0x91 */
 buffer[0] = 0x0C;
 buffer[1] = is_over_340mhz ? 0x1D : 0x91;
 i2c_success = write_i2c(pipe_ctx, slave_address,
   buffer, sizeof(buffer));
 RETIMER_REDRIVER_INFO("retimer write to slave_addr = 0x%x,\
  offset = 0x%x, reg_val = 0x%x, i2c_success = %d\n",
  slave_address, buffer[0], buffer[1], i2c_success?1:0);
 if (!i2c_success)
  goto i2c_write_fail;

 /* Write offset 0x0A to 0x17 */
 buffer[0] = 0x0A;
 buffer[1] = 0x17;
 i2c_success = write_i2c(pipe_ctx, slave_address,
   buffer, sizeof(buffer));
 RETIMER_REDRIVER_INFO("retimer write to slave_addr = 0x%x,\
  offset = 0x%x, reg_val = 0x%x, i2c_success = %d\n",
  slave_address, buffer[0], buffer[1], i2c_success?1:0);
 if (!i2c_success)
  goto i2c_write_fail;


 if (is_vga_mode) {
  /* Program additional settings if using 640x480 resolution */

  /* Write offset 0xFF to 0x01 */
  buffer[0] = 0xff;
  buffer[1] = 0x01;
  i2c_success = write_i2c(pipe_ctx, slave_address,
    buffer, sizeof(buffer));
  RETIMER_REDRIVER_INFO("retimer write to slave_addr = 0x%x,\
   offset = 0x%x, reg_val = 0x%x, i2c_success = %d\n",
   slave_address, buffer[0], buffer[1], i2c_success?1:0);
  if (!i2c_success)
   goto i2c_write_fail;

  /* Write offset 0x00 to 0x23 */
  buffer[0] = 0x00;
  buffer[1] = 0x23;
  i2c_success = write_i2c(pipe_ctx, slave_address,
    buffer, sizeof(buffer));
  RETIMER_REDRIVER_INFO("retimer write to slave_addr = 0x%x,\
   offset = 0x%x, reg_val= 0x%x, i2c_success = %d\n",
   slave_address, buffer[0], buffer[1], i2c_success?1:0);
  if (!i2c_success)
   goto i2c_write_fail;

  /* Write offset 0xff to 0x00 */
  buffer[0] = 0xff;
  buffer[1] = 0x00;
  i2c_success = write_i2c(pipe_ctx, slave_address,
    buffer, sizeof(buffer));
  RETIMER_REDRIVER_INFO("retimer write default setting to slave_addr = 0x%x,\
   offset = 0x%x, reg_val= 0x%x, i2c_success = %d end here\n",
   slave_address, buffer[0], buffer[1], i2c_success?1:0);
  if (!i2c_success)
   goto i2c_write_fail;
 }

 return;

i2c_write_fail:
 DC_LOG_DEBUG("Set default retimer failed");
}

static void write_i2c_redriver_setting(
  struct pipe_ctx *pipe_ctx,
  bool is_over_340mhz)
{
 uint8_t slave_address = (0xF0 >> 1);
 uint8_t buffer[16];
 bool i2c_success = false;
 DC_LOGGER_INIT(pipe_ctx->stream->ctx->logger);

 memset(&buffer, 0, sizeof(buffer));

 // Program Slave Address for tuning single integrity
 buffer[3] = 0x4E;
 buffer[4] = 0x4E;
 buffer[5] = 0x4E;
 buffer[6] = is_over_340mhz ? 0x4E : 0x4A;

 i2c_success = write_i2c(pipe_ctx, slave_address,
     buffer, sizeof(buffer));
 RETIMER_REDRIVER_INFO("redriver write 0 to all 16 reg offset expect following:\n\
  \t slave_addr = 0x%x, offset[3] = 0x%x, offset[4] = 0x%x,\
  offset[5] = 0x%x,offset[6] is_over_340mhz = 0x%x,\
  i2c_success = %d\n",
  slave_address, buffer[3], buffer[4], buffer[5], buffer[6], i2c_success?1:0);

 if (!i2c_success)
  DC_LOG_DEBUG("Set redriver failed");
}

static void update_psp_stream_config(struct pipe_ctx *pipe_ctx, bool dpms_off)
{
 struct cp_psp *cp_psp = &pipe_ctx->stream->ctx->cp_psp;
 struct link_encoder *link_enc = pipe_ctx->link_res.dio_link_enc;
 struct cp_psp_stream_config config = {0};
 enum dp_panel_mode panel_mode =
   dp_get_panel_mode(pipe_ctx->stream->link);

 if (cp_psp == NULL || cp_psp->funcs.update_stream_config == NULL)
  return;
 if (!pipe_ctx->stream->ctx->dc->config.unify_link_enc_assignment)
  link_enc = link_enc_cfg_get_link_enc(pipe_ctx->stream->link);
 ASSERT(link_enc);
 if (link_enc == NULL)
  return;

 /* otg instance */
 config.otg_inst = (uint8_t) pipe_ctx->stream_res.tg->inst;

 /* dig front end */
 config.dig_fe = (uint8_t) pipe_ctx->stream_res.stream_enc->stream_enc_inst;

 /* stream encoder index */
 config.stream_enc_idx = pipe_ctx->stream_res.stream_enc->id - ENGINE_ID_DIGA;
 if (dp_is_128b_132b_signal(pipe_ctx))
  config.stream_enc_idx =
    pipe_ctx->stream_res.hpo_dp_stream_enc->id - ENGINE_ID_HPO_DP_0;

 /* dig back end */
 config.dig_be = pipe_ctx->stream->link->link_enc_hw_inst;

 /* link encoder index */
 config.link_enc_idx = link_enc->transmitter - TRANSMITTER_UNIPHY_A;
 if (dp_is_128b_132b_signal(pipe_ctx))
  config.link_enc_idx = pipe_ctx->link_res.hpo_dp_link_enc->inst;

 /* dio output index is dpia index for DPIA endpoint & dcio index by default */
 if (pipe_ctx->stream->link->ep_type == DISPLAY_ENDPOINT_USB4_DPIA)
  config.dio_output_idx = pipe_ctx->stream->link->link_id.enum_id - ENUM_ID_1;
 else
  config.dio_output_idx = link_enc->transmitter - TRANSMITTER_UNIPHY_A;


 /* phy index */
 config.phy_idx = resource_transmitter_to_phy_idx(
   pipe_ctx->stream->link->dc, link_enc->transmitter);
 if (pipe_ctx->stream->link->ep_type == DISPLAY_ENDPOINT_USB4_DPIA)
  /* USB4 DPIA doesn't use PHY in our soc, initialize it to 0 */
  config.phy_idx = 0;

 /* stream properties */
 config.assr_enabled = (panel_mode == DP_PANEL_MODE_EDP) ? 1 : 0;
 config.mst_enabled = (pipe_ctx->stream->signal ==
   SIGNAL_TYPE_DISPLAY_PORT_MST) ? 1 : 0;
 config.dp2_enabled = dp_is_128b_132b_signal(pipe_ctx) ? 1 : 0;
 config.usb4_enabled = (pipe_ctx->stream->link->ep_type == DISPLAY_ENDPOINT_USB4_DPIA) ?
   1 : 0;
 config.dpms_off = dpms_off;

 /* dm stream context */
 config.dm_stream_ctx = pipe_ctx->stream->dm_stream_context;

 cp_psp->funcs.update_stream_config(cp_psp->handle, &config);
}

static void set_avmute(struct pipe_ctx *pipe_ctx, bool enable)
{
 struct dc  *dc = pipe_ctx->stream->ctx->dc;

 if (!dc_is_hdmi_signal(pipe_ctx->stream->signal))
  return;

 dc->hwss.set_avmute(pipe_ctx, enable);
}

static void enable_mst_on_sink(struct dc_link *link, bool enable)
{
 unsigned char mstmCntl = 0;

 core_link_read_dpcd(link, DP_MSTM_CTRL, &mstmCntl, 1);
 if (enable)
  mstmCntl |= DP_MST_EN;
 else
  mstmCntl &= (~DP_MST_EN);

 core_link_write_dpcd(link, DP_MSTM_CTRL, &mstmCntl, 1);
}

static void dsc_optc_config_log(struct display_stream_compressor *dsc,
  struct dsc_optc_config *config)
{
 uint32_t precision = 1 << 28;
 uint32_t bytes_per_pixel_int = config->bytes_per_pixel / precision;
 uint32_t bytes_per_pixel_mod = config->bytes_per_pixel % precision;
 uint64_t ll_bytes_per_pix_fraq = bytes_per_pixel_mod;
 DC_LOGGER_INIT(dsc->ctx->logger);

 /* 7 fractional digits decimal precision for bytes per pixel is enough because DSC
 * bits per pixel precision is 1/16th of a pixel, which means bytes per pixel precision is
 * 1/16/8 = 1/128 of a byte, or 0.0078125 decimal
 */
 ll_bytes_per_pix_fraq *= 10000000;
 ll_bytes_per_pix_fraq /= precision;

 DC_LOG_DSC("\tbytes_per_pixel 0x%08x (%d.%07d)",
   config->bytes_per_pixel, bytes_per_pixel_int, (uint32_t)ll_bytes_per_pix_fraq);
 DC_LOG_DSC("\tis_pixel_format_444 %d", config->is_pixel_format_444);
 DC_LOG_DSC("\tslice_width %d", config->slice_width);
}

static bool dp_set_dsc_on_rx(struct pipe_ctx *pipe_ctx, bool enable)
{
 struct dc *dc = pipe_ctx->stream->ctx->dc;
 struct dc_stream_state *stream = pipe_ctx->stream;
 bool result = false;

 if (dc_is_virtual_signal(stream->signal))
  result = true;
 else
  result = dm_helpers_dp_write_dsc_enable(dc->ctx, stream, enable);
 return result;
}

static bool dp_set_hblank_reduction_on_rx(struct pipe_ctx *pipe_ctx)
{
 struct dc *dc = pipe_ctx->stream->ctx->dc;
 struct dc_stream_state *stream = pipe_ctx->stream;
 bool result = false;

 if (dc_is_virtual_signal(stream->signal))
  result = true;
 else
  result = dm_helpers_dp_write_hblank_reduction(dc->ctx, stream);
 return result;
}


/* The stream with these settings can be sent (unblanked) only after DSC was enabled on RX first,
 * i.e. after dp_enable_dsc_on_rx() had been called
 */
void link_set_dsc_on_stream(struct pipe_ctx *pipe_ctx, bool enable)
{
 /* TODO: Move this to HWSS as this is hardware programming sequence not a
 * link layer sequence
 */
 struct display_stream_compressor *dsc = pipe_ctx->stream_res.dsc;
 struct dc *dc = pipe_ctx->stream->ctx->dc;
 struct dc_stream_state *stream = pipe_ctx->stream;
 struct pipe_ctx *odm_pipe;
 int opp_cnt = 1;
 struct dccg *dccg = dc->res_pool->dccg;
 /* It has been found that when DSCCLK is lower than 16Mhz, we will get DCN
 * register access hung. When DSCCLk is based on refclk, DSCCLk is always a
 * fixed value higher than 16Mhz so the issue doesn't occur. When DSCCLK is
 * generated by DTO, DSCCLK would be based on 1/3 dispclk. For small timings
 * with DSC such as 480p60Hz, the dispclk could be low enough to trigger
 * this problem. We are implementing a workaround here to keep using dscclk
 * based on fixed value refclk when timing is smaller than 3x16Mhz (i.e
 * 48Mhz) pixel clock to avoid hitting this problem.
 */
 bool should_use_dto_dscclk = (dccg->funcs->set_dto_dscclk != NULL) &&
   stream->timing.pix_clk_100hz > 480000;
 DC_LOGGER_INIT(dsc->ctx->logger);

 for (odm_pipe = pipe_ctx->next_odm_pipe; odm_pipe; odm_pipe = odm_pipe->next_odm_pipe)
  opp_cnt++;

 if (enable) {
  struct dsc_config dsc_cfg;
  struct dsc_optc_config dsc_optc_cfg = {0};
  enum optc_dsc_mode optc_dsc_mode;

  /* Enable DSC hw block */
  dsc_cfg.pic_width = (stream->timing.h_addressable + pipe_ctx->hblank_borrow +
    stream->timing.h_border_left + stream->timing.h_border_right) / opp_cnt;
  dsc_cfg.pic_height = stream->timing.v_addressable + stream->timing.v_border_top + stream->timing.v_border_bottom;
  dsc_cfg.pixel_encoding = stream->timing.pixel_encoding;
  dsc_cfg.color_depth = stream->timing.display_color_depth;
  dsc_cfg.is_odm = pipe_ctx->next_odm_pipe ? true : false;
  dsc_cfg.dc_dsc_cfg = stream->timing.dsc_cfg;
  ASSERT(dsc_cfg.dc_dsc_cfg.num_slices_h % opp_cnt == 0);
  dsc_cfg.dc_dsc_cfg.num_slices_h /= opp_cnt;

  if (should_use_dto_dscclk)
   dccg->funcs->set_dto_dscclk(dccg, dsc->inst, dsc_cfg.dc_dsc_cfg.num_slices_h);
  dsc->funcs->dsc_set_config(dsc, &dsc_cfg, &dsc_optc_cfg);
  dsc->funcs->dsc_enable(dsc, pipe_ctx->stream_res.opp->inst);
  for (odm_pipe = pipe_ctx->next_odm_pipe; odm_pipe; odm_pipe = odm_pipe->next_odm_pipe) {
   struct display_stream_compressor *odm_dsc = odm_pipe->stream_res.dsc;

   if (should_use_dto_dscclk)
    dccg->funcs->set_dto_dscclk(dccg, odm_dsc->inst, dsc_cfg.dc_dsc_cfg.num_slices_h);
   odm_dsc->funcs->dsc_set_config(odm_dsc, &dsc_cfg, &dsc_optc_cfg);
   odm_dsc->funcs->dsc_enable(odm_dsc, odm_pipe->stream_res.opp->inst);
  }
  dsc_cfg.dc_dsc_cfg.num_slices_h *= opp_cnt;
  dsc_cfg.pic_width *= opp_cnt;

  optc_dsc_mode = dsc_optc_cfg.is_pixel_format_444 ? OPTC_DSC_ENABLED_444 : OPTC_DSC_ENABLED_NATIVE_SUBSAMPLED;

  /* Enable DSC in encoder */
  if (dc_is_dp_signal(stream->signal) && !dp_is_128b_132b_signal(pipe_ctx)) {
   DC_LOG_DSC("Setting stream encoder DSC config for engine %d:", (int)pipe_ctx->stream_res.stream_enc->id);
   dsc_optc_config_log(dsc, &dsc_optc_cfg);
   if (pipe_ctx->stream_res.stream_enc->funcs->dp_set_dsc_config)
    pipe_ctx->stream_res.stream_enc->funcs->dp_set_dsc_config(pipe_ctx->stream_res.stream_enc,
          optc_dsc_mode,
          dsc_optc_cfg.bytes_per_pixel,
          dsc_optc_cfg.slice_width);

   /* PPS SDP is set elsewhere because it has to be done after DIG FE is connected to DIG BE */
  }

  /* Enable DSC in OPTC */
  DC_LOG_DSC("Setting optc DSC config for tg instance %d:", pipe_ctx->stream_res.tg->inst);
  dsc_optc_config_log(dsc, &dsc_optc_cfg);
  pipe_ctx->stream_res.tg->funcs->set_dsc_config(pipe_ctx->stream_res.tg,
       optc_dsc_mode,
       dsc_optc_cfg.bytes_per_pixel,
       dsc_optc_cfg.slice_width);
 } else {
  /* disable DSC in OPTC */
  pipe_ctx->stream_res.tg->funcs->set_dsc_config(
    pipe_ctx->stream_res.tg,
    OPTC_DSC_DISABLED, 0, 0);

  /* disable DSC in stream encoder */
  if (dc_is_dp_signal(stream->signal)) {
   if (dp_is_128b_132b_signal(pipe_ctx))
    pipe_ctx->stream_res.hpo_dp_stream_enc->funcs->dp_set_dsc_pps_info_packet(
          pipe_ctx->stream_res.hpo_dp_stream_enc,
          false,
          NULL,
          true);
   else {
    if (pipe_ctx->stream_res.stream_enc->funcs->dp_set_dsc_config)
     pipe_ctx->stream_res.stream_enc->funcs->dp_set_dsc_config(
       pipe_ctx->stream_res.stream_enc,
       OPTC_DSC_DISABLED, 0, 0);
    pipe_ctx->stream_res.stream_enc->funcs->dp_set_dsc_pps_info_packet(
       pipe_ctx->stream_res.stream_enc, false, NULL, true);
   }
  }

  /* disable DSC block */
  for (odm_pipe = pipe_ctx; odm_pipe; odm_pipe = odm_pipe->next_odm_pipe) {
   odm_pipe->stream_res.dsc->funcs->dsc_disconnect(odm_pipe->stream_res.dsc);
   /*
 * TODO - dsc_disconnect is a double buffered register.
 * by the time we call dsc_disable, dsc may still remain
 * connected to OPP. In this case OPTC will no longer
 * get correct pixel data because DSCC is off. However
 * we also can't wait for the  disconnect pending
 * complete, because this function can be called
 * with/without OTG master lock acquired. When the lock
 * is acquired we will never get pending complete until
 * we release the lock later. So there is no easy way to
 * solve this problem especially when the lock is
 * acquired. DSC is a front end hw block it should be
 * programmed as part of front end sequence, where the
 * commit sequence without lock and update sequence
 * with lock are completely separated. However because
 * we are programming dsc as part of back end link
 * programming sequence, we don't know if front end OPTC
 * master lock is acquired. The back end should be
 * agnostic to front end lock. DSC programming shouldn't
 * belong to this sequence.
 */
   odm_pipe->stream_res.dsc->funcs->dsc_disable(odm_pipe->stream_res.dsc);
   if (dccg->funcs->set_ref_dscclk)
    dccg->funcs->set_ref_dscclk(dccg, odm_pipe->stream_res.dsc->inst);
  }
 }
}

/*
 * For dynamic bpp change case, dsc is programmed with MASTER_UPDATE_LOCK enabled;
 * hence PPS info packet update need to use frame update instead of immediate update.
 * Added parameter immediate_update for this purpose.
 * The decision to use frame update is hard-coded in function dp_update_dsc_config(),
 * which is the only place where a "false" would be passed in for param immediate_update.
 *
 * immediate_update is only applicable when DSC is enabled.
 */
bool link_set_dsc_pps_packet(struct pipe_ctx *pipe_ctx, bool enable, bool immediate_update)
{
 struct display_stream_compressor *dsc = pipe_ctx->stream_res.dsc;
 struct dc_stream_state *stream = pipe_ctx->stream;

 if (!pipe_ctx->stream->timing.flags.DSC)
  return false;

 if (!dsc)
  return false;

 DC_LOGGER_INIT(dsc->ctx->logger);

 if (enable) {
  struct dsc_config dsc_cfg;
  uint8_t dsc_packed_pps[128];

  memset(&dsc_cfg, 0, sizeof(dsc_cfg));
  memset(dsc_packed_pps, 0, 128);

  /* Enable DSC hw block */
  dsc_cfg.pic_width = stream->timing.h_addressable + stream->timing.h_border_left + stream->timing.h_border_right;
  dsc_cfg.pic_height = stream->timing.v_addressable + stream->timing.v_border_top + stream->timing.v_border_bottom;
  dsc_cfg.pixel_encoding = stream->timing.pixel_encoding;
  dsc_cfg.color_depth = stream->timing.display_color_depth;
  dsc_cfg.is_odm = pipe_ctx->next_odm_pipe ? true : false;
  dsc_cfg.dc_dsc_cfg = stream->timing.dsc_cfg;

  dsc->funcs->dsc_get_packed_pps(dsc, &dsc_cfg, &dsc_packed_pps[0]);
  memcpy(&stream->dsc_packed_pps[0], &dsc_packed_pps[0], sizeof(stream->dsc_packed_pps));
  if (dc_is_dp_signal(stream->signal)) {
   DC_LOG_DSC("Setting stream encoder DSC PPS SDP for engine %d\n", (int)pipe_ctx->stream_res.stream_enc->id);
   if (dp_is_128b_132b_signal(pipe_ctx))
    pipe_ctx->stream_res.hpo_dp_stream_enc->funcs->dp_set_dsc_pps_info_packet(
          pipe_ctx->stream_res.hpo_dp_stream_enc,
          true,
          &dsc_packed_pps[0],
          immediate_update);
   else
    pipe_ctx->stream_res.stream_enc->funcs->dp_set_dsc_pps_info_packet(
      pipe_ctx->stream_res.stream_enc,
      true,
      &dsc_packed_pps[0],
      immediate_update);
  }
 } else {
  /* disable DSC PPS in stream encoder */
  memset(&stream->dsc_packed_pps[0], 0, sizeof(stream->dsc_packed_pps));
  if (dc_is_dp_signal(stream->signal)) {
   if (dp_is_128b_132b_signal(pipe_ctx))
    pipe_ctx->stream_res.hpo_dp_stream_enc->funcs->dp_set_dsc_pps_info_packet(
          pipe_ctx->stream_res.hpo_dp_stream_enc,
          false,
          NULL,
          true);
   else
    pipe_ctx->stream_res.stream_enc->funcs->dp_set_dsc_pps_info_packet(
      pipe_ctx->stream_res.stream_enc, false, NULL, true);
  }
 }

 return true;
}

bool link_set_dsc_enable(struct pipe_ctx *pipe_ctx, bool enable)
{
 struct display_stream_compressor *dsc = pipe_ctx->stream_res.dsc;
 bool result = false;

 if (!pipe_ctx->stream->timing.flags.DSC)
  goto out;
 if (!dsc)
  goto out;

 if (enable) {
  {
   link_set_dsc_on_stream(pipe_ctx, true);
   result = true;
  }
 } else {
  dp_set_dsc_on_rx(pipe_ctx, false);
  link_set_dsc_on_stream(pipe_ctx, false);
  result = true;
 }
out:
 return result;
}

bool link_update_dsc_config(struct pipe_ctx *pipe_ctx)
{
 struct display_stream_compressor *dsc = pipe_ctx->stream_res.dsc;

 if (!pipe_ctx->stream->timing.flags.DSC)
  return false;
 if (!dsc)
  return false;

 link_set_dsc_on_stream(pipe_ctx, true);
 link_set_dsc_pps_packet(pipe_ctx, true, false);
 return true;
}

static void enable_stream_features(struct pipe_ctx *pipe_ctx)
{
 struct dc_stream_state *stream = pipe_ctx->stream;

 if (pipe_ctx->stream->signal != SIGNAL_TYPE_DISPLAY_PORT_MST) {
  struct dc_link *link = stream->link;
  union down_spread_ctrl old_downspread;
  union down_spread_ctrl new_downspread;

  memset(&old_downspread, 0, sizeof(old_downspread));

  core_link_read_dpcd(link, DP_DOWNSPREAD_CTRL,
    &old_downspread.raw, sizeof(old_downspread));

  new_downspread.raw = old_downspread.raw;

  new_downspread.bits.IGNORE_MSA_TIMING_PARAM =
    (stream->ignore_msa_timing_param) ? 1 : 0;

  if (new_downspread.raw != old_downspread.raw) {
   core_link_write_dpcd(link, DP_DOWNSPREAD_CTRL,
    &new_downspread.raw, sizeof(new_downspread));
  }

 } else {
  dm_helpers_mst_enable_stream_features(stream);
 }
}

static void log_vcp_x_y(const struct dc_link *link, struct fixed31_32 avg_time_slots_per_mtp)
{
 const uint32_t VCP_Y_PRECISION = 1000;
 uint64_t vcp_x, vcp_y;
 DC_LOGGER_INIT(link->ctx->logger);

 // Add 0.5*(1/VCP_Y_PRECISION) to round up to decimal precision
 avg_time_slots_per_mtp = dc_fixpt_add(
   avg_time_slots_per_mtp,
   dc_fixpt_from_fraction(
    1,
    2*VCP_Y_PRECISION));

 vcp_x = dc_fixpt_floor(
   avg_time_slots_per_mtp);
 vcp_y = dc_fixpt_floor(
   dc_fixpt_mul_int(
    dc_fixpt_sub_int(
     avg_time_slots_per_mtp,
     dc_fixpt_floor(
       avg_time_slots_per_mtp)),
    VCP_Y_PRECISION));


 if (link->type == dc_connection_mst_branch)
  DC_LOG_DP2("MST Update Payload: set_throttled_vcp_size slot X.Y for MST stream "
    "X: %llu "
    "Y: %llu/%d",
    vcp_x,
    vcp_y,
    VCP_Y_PRECISION);
 else
  DC_LOG_DP2("SST Update Payload: set_throttled_vcp_size slot X.Y for SST stream "
    "X: %llu "
    "Y: %llu/%d",
    vcp_x,
    vcp_y,
    VCP_Y_PRECISION);
}

static struct fixed31_32 get_pbn_per_slot(struct dc_stream_state *stream)
{
 struct fixed31_32 mbytes_per_sec;
 uint32_t link_rate_in_mbytes_per_sec = dp_link_bandwidth_kbps(stream->link,
   &stream->link->cur_link_settings);
 link_rate_in_mbytes_per_sec /= 8000; /* Kbits to MBytes */

 mbytes_per_sec = dc_fixpt_from_int(link_rate_in_mbytes_per_sec);

 return dc_fixpt_div_int(mbytes_per_sec, 54);
}

static struct fixed31_32 get_pbn_from_bw_in_kbps(uint64_t kbps)
{
 struct fixed31_32 peak_kbps;
 uint32_t numerator = 0;
 uint32_t denominator = 1;

 /*
 * The 1.006 factor (margin 5300ppm + 300ppm ~ 0.6% as per spec) is not
 * required when determining PBN/time slot utilization on the link between
 * us and the branch, since that overhead is already accounted for in
 * the get_pbn_per_slot function.
 *
 * The unit of 54/64Mbytes/sec is an arbitrary unit chosen based on
 * common multiplier to render an integer PBN for all link rate/lane
 * counts combinations
 * calculate
 * peak_kbps *= (64/54)
 * peak_kbps /= (8 * 1000) convert to bytes
 */

 numerator = 64;
 denominator = 54 * 8 * 1000;
 kbps *= numerator;
 peak_kbps = dc_fixpt_from_fraction(kbps, denominator);

 return peak_kbps;
}

static struct fixed31_32 get_pbn_from_timing(struct pipe_ctx *pipe_ctx)
{
 uint64_t kbps;
 enum dc_link_encoding_format link_encoding;

 if (dp_is_128b_132b_signal(pipe_ctx))
  link_encoding = DC_LINK_ENCODING_DP_128b_132b;
 else
  link_encoding = DC_LINK_ENCODING_DP_8b_10b;

 kbps = dc_bandwidth_in_kbps_from_timing(&pipe_ctx->stream->timing, link_encoding);
 return get_pbn_from_bw_in_kbps(kbps);
}


// TODO - DP2.0 Link: Fix get_lane_status to handle LTTPR offset (SST and MST)
static void get_lane_status(
 struct dc_link *link,
 uint32_t lane_count,
 union lane_status *status,
 union lane_align_status_updated *status_updated)
{
 unsigned int lane;
 uint8_t dpcd_buf[3] = {0};

 if (status == NULL || status_updated == NULL) {
  return;
 }

 core_link_read_dpcd(
   link,
   DP_LANE0_1_STATUS,
   dpcd_buf,
   sizeof(dpcd_buf));

 for (lane = 0; lane < lane_count; lane++) {
  status[lane].raw = dp_get_nibble_at_index(&dpcd_buf[0], lane);
 }

 status_updated->raw = dpcd_buf[2];
}

static bool poll_for_allocation_change_trigger(struct dc_link *link)
{
 /*
 * wait for ACT handled
 */
 int i;
 const int act_retries = 30;
 enum act_return_status result = ACT_FAILED;
 enum dc_connection_type display_connected = (link->type != dc_connection_none);
 union payload_table_update_status update_status = {0};
 union lane_status dpcd_lane_status[LANE_COUNT_DP_MAX];
 union lane_align_status_updated lane_status_updated;
 DC_LOGGER_INIT(link->ctx->logger);

 if (!display_connected || link->aux_access_disabled)
  return true;
 for (i = 0; i < act_retries; i++) {
  get_lane_status(link, link->cur_link_settings.lane_count, dpcd_lane_status, &lane_status_updated);

  if (!dp_is_cr_done(link->cur_link_settings.lane_count, dpcd_lane_status) ||
    !dp_is_ch_eq_done(link->cur_link_settings.lane_count, dpcd_lane_status) ||
    !dp_is_symbol_locked(link->cur_link_settings.lane_count, dpcd_lane_status) ||
    !dp_is_interlane_aligned(lane_status_updated)) {
   DC_LOG_ERROR("SST Update Payload: Link loss occurred while "
     "polling for ACT handled.");
   result = ACT_LINK_LOST;
   break;
  }
  core_link_read_dpcd(
    link,
    DP_PAYLOAD_TABLE_UPDATE_STATUS,
    &update_status.raw,
    1);

  if (update_status.bits.ACT_HANDLED == 1) {
   DC_LOG_DP2("SST Update Payload: ACT handled by downstream.");
   result = ACT_SUCCESS;
   break;
  }

  fsleep(5000);
 }

 if (result == ACT_FAILED) {
  DC_LOG_ERROR("SST Update Payload: ACT still not handled after retries, "
    "continue on. Something is wrong with the branch.");
 }

 return (result == ACT_SUCCESS);
}

static void update_mst_stream_alloc_table(
 struct dc_link *link,
 struct stream_encoder *stream_enc,
 struct hpo_dp_stream_encoder *hpo_dp_stream_enc, // TODO: Rename stream_enc to dio_stream_enc?
 const struct dc_dp_mst_stream_allocation_table *proposed_table)
{
 struct link_mst_stream_allocation work_table[MAX_CONTROLLER_NUM] = { 0 };
 struct link_mst_stream_allocation *dc_alloc;

 int i;
 int j;

 /* if DRM proposed_table has more than one new payload */
 ASSERT(proposed_table->stream_count -
   link->mst_stream_alloc_table.stream_count < 2);

 /* copy proposed_table to link, add stream encoder */
 for (i = 0; i < proposed_table->stream_count; i++) {

  for (j = 0; j < link->mst_stream_alloc_table.stream_count; j++) {
   dc_alloc =
   &link->mst_stream_alloc_table.stream_allocations[j];

   if (dc_alloc->vcp_id ==
    proposed_table->stream_allocations[i].vcp_id) {

    work_table[i] = *dc_alloc;
    work_table[i].slot_count = proposed_table->stream_allocations[i].slot_count;
    break; /* exit j loop */
   }
  }

  /* new vcp_id */
  if (j == link->mst_stream_alloc_table.stream_count) {
   work_table[i].vcp_id =
    proposed_table->stream_allocations[i].vcp_id;
   work_table[i].slot_count =
    proposed_table->stream_allocations[i].slot_count;
   work_table[i].stream_enc = stream_enc;
   work_table[i].hpo_dp_stream_enc = hpo_dp_stream_enc;
  }
 }

 /* update link->mst_stream_alloc_table with work_table */
 link->mst_stream_alloc_table.stream_count =
   proposed_table->stream_count;
 for (i = 0; i < MAX_CONTROLLER_NUM; i++)
  link->mst_stream_alloc_table.stream_allocations[i] =
    work_table[i];
}

static void remove_stream_from_alloc_table(
  struct dc_link *link,
  struct stream_encoder *dio_stream_enc,
  struct hpo_dp_stream_encoder *hpo_dp_stream_enc)
{
 int i = 0;
 struct link_mst_stream_allocation_table *table =
   &link->mst_stream_alloc_table;

 if (hpo_dp_stream_enc) {
  for (; i < table->stream_count; i++)
   if (hpo_dp_stream_enc == table->stream_allocations[i].hpo_dp_stream_enc)
    break;
 } else {
  for (; i < table->stream_count; i++)
   if (dio_stream_enc == table->stream_allocations[i].stream_enc)
    break;
 }

 if (i < table->stream_count) {
  i++;
  for (; i < table->stream_count; i++)
   table->stream_allocations[i-1] = table->stream_allocations[i];
  memset(&table->stream_allocations[table->stream_count-1], 0,
    sizeof(struct link_mst_stream_allocation));
  table->stream_count--;
 }
}

static enum dc_status deallocate_mst_payload(struct pipe_ctx *pipe_ctx)
{
 struct dc_stream_state *stream = pipe_ctx->stream;
 struct dc_link *link = stream->link;
 struct dc_dp_mst_stream_allocation_table proposed_table = {0};
 struct fixed31_32 avg_time_slots_per_mtp = dc_fixpt_from_int(0);
 int i;
 bool mst_mode = (link->type == dc_connection_mst_branch);
 const struct link_hwss *link_hwss = get_link_hwss(link, &pipe_ctx->link_res);
 const struct dc_link_settings empty_link_settings = {0};
 DC_LOGGER_INIT(link->ctx->logger);

 /* deallocate_mst_payload is called before disable link. When mode or
 * disable/enable monitor, new stream is created which is not in link
 * stream[] yet. For this, payload is not allocated yet, so de-alloc
 * should not done. For new mode set, map_resources will get engine
 * for new stream, so stream_enc->id should be validated until here.
 */

 /* slot X.Y */
 if (link_hwss->ext.set_throttled_vcp_size)
  link_hwss->ext.set_throttled_vcp_size(pipe_ctx, avg_time_slots_per_mtp);
 if (link_hwss->ext.set_hblank_min_symbol_width)
  link_hwss->ext.set_hblank_min_symbol_width(pipe_ctx,
    &empty_link_settings,
    avg_time_slots_per_mtp);

 if (mst_mode) {
  /* when link is in mst mode, reply on mst manager to remove
 * payload
 */
  if (dm_helpers_dp_mst_write_payload_allocation_table(
    stream->ctx,
    stream,
    &proposed_table,
    false))
   update_mst_stream_alloc_table(
     link,
     pipe_ctx->stream_res.stream_enc,
     pipe_ctx->stream_res.hpo_dp_stream_enc,
     &proposed_table);
  else
   DC_LOG_WARNING("Failed to update"
     "MST allocation table for"
     "pipe idx:%d\n",
     pipe_ctx->pipe_idx);
 } else {
  /* when link is no longer in mst mode (mst hub unplugged),
 * remove payload with default dc logic
 */
  remove_stream_from_alloc_table(link, pipe_ctx->stream_res.stream_enc,
    pipe_ctx->stream_res.hpo_dp_stream_enc);
 }

 DC_LOG_MST("%s"
   "stream_count: %d: ",
   __func__,
   link->mst_stream_alloc_table.stream_count);

 for (i = 0; i < MAX_CONTROLLER_NUM; i++) {
  DC_LOG_MST("stream_enc[%d]: %p "
  "stream[%d].hpo_dp_stream_enc: %p "
  "stream[%d].vcp_id: %d "
  "stream[%d].slot_count: %d\n",
  i,
  (void *) link->mst_stream_alloc_table.stream_allocations[i].stream_enc,
  i,
  (void *) link->mst_stream_alloc_table.stream_allocations[i].hpo_dp_stream_enc,
  i,
  link->mst_stream_alloc_table.stream_allocations[i].vcp_id,
  i,
  link->mst_stream_alloc_table.stream_allocations[i].slot_count);
 }

 /* update mst stream allocation table hardware state */
 if (link_hwss->ext.update_stream_allocation_table == NULL ||
   link_dp_get_encoding_format(&link->cur_link_settings) == DP_UNKNOWN_ENCODING) {
  DC_LOG_DEBUG("Unknown encoding format\n");
  return DC_ERROR_UNEXPECTED;
 }

 link_hwss->ext.update_stream_allocation_table(link, &pipe_ctx->link_res,
   &link->mst_stream_alloc_table);

 if (mst_mode)
  dm_helpers_dp_mst_poll_for_allocation_change_trigger(
   stream->ctx,
   stream);

 dm_helpers_dp_mst_update_mst_mgr_for_deallocation(
   stream->ctx,
   stream);

 return DC_OK;
}

/* convert link_mst_stream_alloc_table to dm dp_mst_stream_alloc_table
 * because stream_encoder is not exposed to dm
 */
static enum dc_status allocate_mst_payload(struct pipe_ctx *pipe_ctx)
{
 struct dc_stream_state *stream = pipe_ctx->stream;
 struct dc_link *link = stream->link;
 struct dc_dp_mst_stream_allocation_table proposed_table = {0};
 struct fixed31_32 avg_time_slots_per_mtp;
 struct fixed31_32 pbn;
 struct fixed31_32 pbn_per_slot;
 int i;
 enum act_return_status ret;
 const struct link_hwss *link_hwss = get_link_hwss(link, &pipe_ctx->link_res);
 DC_LOGGER_INIT(link->ctx->logger);

 /* enable_link_dp_mst already check link->enabled_stream_count
 * and stream is in link->stream[]. This is called during set mode,
 * stream_enc is available.
 */

 /* get calculate VC payload for stream: stream_alloc */
 if (dm_helpers_dp_mst_write_payload_allocation_table(
  stream->ctx,
  stream,
  &proposed_table,
  true))
  update_mst_stream_alloc_table(
     link,
     pipe_ctx->stream_res.stream_enc,
     pipe_ctx->stream_res.hpo_dp_stream_enc,
     &proposed_table);
 else
  DC_LOG_WARNING("Failed to update"
    "MST allocation table for"
    "pipe idx:%d\n",
    pipe_ctx->pipe_idx);

 DC_LOG_MST("%s "
   "stream_count: %d: \n ",
   __func__,
   link->mst_stream_alloc_table.stream_count);

 for (i = 0; i < MAX_CONTROLLER_NUM; i++) {
  DC_LOG_MST("stream_enc[%d]: %p "
  "stream[%d].hpo_dp_stream_enc: %p "
  "stream[%d].vcp_id: %d "
  "stream[%d].slot_count: %d\n",
  i,
  (void *) link->mst_stream_alloc_table.stream_allocations[i].stream_enc,
  i,
  (void *) link->mst_stream_alloc_table.stream_allocations[i].hpo_dp_stream_enc,
  i,
  link->mst_stream_alloc_table.stream_allocations[i].vcp_id,
  i,
  link->mst_stream_alloc_table.stream_allocations[i].slot_count);
 }

 ASSERT(proposed_table.stream_count > 0);

 /* program DP source TX for payload */
 if (link_hwss->ext.update_stream_allocation_table == NULL ||
   link_dp_get_encoding_format(&link->cur_link_settings) == DP_UNKNOWN_ENCODING) {
  DC_LOG_ERROR("Failure: unknown encoding format\n");
  return DC_ERROR_UNEXPECTED;
 }

 link_hwss->ext.update_stream_allocation_table(link,
   &pipe_ctx->link_res,
   &link->mst_stream_alloc_table);

 /* send down message */
 ret = dm_helpers_dp_mst_poll_for_allocation_change_trigger(
   stream->ctx,
   stream);

 if (ret != ACT_LINK_LOST)
  dm_helpers_dp_mst_send_payload_allocation(
    stream->ctx,
    stream);

 /* slot X.Y for only current stream */
 pbn_per_slot = get_pbn_per_slot(stream);
 if (pbn_per_slot.value == 0) {
  DC_LOG_ERROR("Failure: pbn_per_slot==0 not allowed. Cannot continue, returning DC_UNSUPPORTED_VALUE.\n");
  return DC_UNSUPPORTED_VALUE;
 }
 pbn = get_pbn_from_timing(pipe_ctx);
 avg_time_slots_per_mtp = dc_fixpt_div(pbn, pbn_per_slot);

 log_vcp_x_y(link, avg_time_slots_per_mtp);

 if (link_hwss->ext.set_throttled_vcp_size)
  link_hwss->ext.set_throttled_vcp_size(pipe_ctx, avg_time_slots_per_mtp);
 if (link_hwss->ext.set_hblank_min_symbol_width)
  link_hwss->ext.set_hblank_min_symbol_width(pipe_ctx,
    &link->cur_link_settings,
    avg_time_slots_per_mtp);

 return DC_OK;
}

struct fixed31_32 link_calculate_sst_avg_time_slots_per_mtp(
  const struct dc_stream_state *stream,
  const struct dc_link *link)
{
 struct fixed31_32 link_bw_effective =
   dc_fixpt_from_int(
     dp_link_bandwidth_kbps(link, &link->cur_link_settings));
 struct fixed31_32 timeslot_bw_effective =
   dc_fixpt_div_int(link_bw_effective, MAX_MTP_SLOT_COUNT);
 struct fixed31_32 timing_bw =
   dc_fixpt_from_int(
     dc_bandwidth_in_kbps_from_timing(&stream->timing,
       dc_link_get_highest_encoding_format(link)));
 struct fixed31_32 avg_time_slots_per_mtp =
   dc_fixpt_div(timing_bw, timeslot_bw_effective);

 return avg_time_slots_per_mtp;
}


static bool write_128b_132b_sst_payload_allocation_table(
  const struct dc_stream_state *stream,
  struct dc_link *link,
  struct link_mst_stream_allocation_table *proposed_table,
  bool allocate)
{
 const uint8_t vc_id = 1; /// VC ID always 1 for SST
 const uint8_t start_time_slot = 0; /// Always start at time slot 0 for SST
 bool result = false;
 uint8_t req_slot_count = 0;
 struct fixed31_32 avg_time_slots_per_mtp = { 0 };
 union payload_table_update_status update_status = { 0 };
 const uint32_t max_retries = 30;
 uint32_t retries = 0;
 enum dc_connection_type display_connected = (link->type != dc_connection_none);
 DC_LOGGER_INIT(link->ctx->logger);

 if (allocate) {
  avg_time_slots_per_mtp = link_calculate_sst_avg_time_slots_per_mtp(stream, link);
  req_slot_count = dc_fixpt_ceil(avg_time_slots_per_mtp);
  /// Validation should filter out modes that exceed link BW
  ASSERT(req_slot_count <= MAX_MTP_SLOT_COUNT);
  if (req_slot_count > MAX_MTP_SLOT_COUNT)
   return false;
 } else {
  /// Leave req_slot_count = 0 if allocate is false.
 }

 proposed_table->stream_count = 1; /// Always 1 stream for SST
 proposed_table->stream_allocations[0].slot_count = req_slot_count;
 proposed_table->stream_allocations[0].vcp_id = vc_id;

 if (!display_connected || link->aux_access_disabled)
  return true;

 /// Write DPCD 2C0 = 1 to start updating
 update_status.bits.VC_PAYLOAD_TABLE_UPDATED = 1;
 core_link_write_dpcd(
   link,
   DP_PAYLOAD_TABLE_UPDATE_STATUS,
   &update_status.raw,
   1);

 /// Program the changes in DPCD 1C0 - 1C2
 ASSERT(vc_id == 1);
 core_link_write_dpcd(
   link,
   DP_PAYLOAD_ALLOCATE_SET,
   &vc_id,
   1);

 ASSERT(start_time_slot == 0);
 core_link_write_dpcd(
   link,
   DP_PAYLOAD_ALLOCATE_START_TIME_SLOT,
   &start_time_slot,
   1);

 core_link_write_dpcd(
   link,
   DP_PAYLOAD_ALLOCATE_TIME_SLOT_COUNT,
   &req_slot_count,
   1);

 /// Poll till DPCD 2C0 read 1
 /// Try for at least 150ms (30 retries, with 5ms delay after each attempt)

 while (retries < max_retries) {
  if (core_link_read_dpcd(
    link,
    DP_PAYLOAD_TABLE_UPDATE_STATUS,
    &update_status.raw,
    1) == DC_OK) {
   if (update_status.bits.VC_PAYLOAD_TABLE_UPDATED == 1) {
    DC_LOG_DP2("SST Update Payload: downstream payload table updated.");
    result = true;
    break;
   }
  } else {
   union dpcd_rev dpcdRev = {0};

   if (core_link_read_dpcd(
     link,
     DP_DPCD_REV,
     &dpcdRev.raw,
     1) != DC_OK) {
    DC_LOG_ERROR("SST Update Payload: Unable to read DPCD revision "
      "of sink while polling payload table "
      "updated status bit.");
    break;
   }
  }
  retries++;
  fsleep(5000);
 }

 if (!result && retries == max_retries) {
  DC_LOG_ERROR("SST Update Payload: Payload table not updated after retries, "
    "continue on. Something is wrong with the branch.");
  // TODO - DP2.0 Payload: Read and log the payload table from downstream branch
 }

 return result;
}

/*
 * Payload allocation/deallocation for SST introduced in DP2.0
 */
static enum dc_status update_sst_payload(struct pipe_ctx *pipe_ctx,
       bool allocate)
{
 struct dc_stream_state *stream = pipe_ctx->stream;
 struct dc_link *link = stream->link;
 struct link_mst_stream_allocation_table proposed_table = {0};
 struct fixed31_32 avg_time_slots_per_mtp;
 const struct dc_link_settings empty_link_settings = {0};
 const struct link_hwss *link_hwss = get_link_hwss(link, &pipe_ctx->link_res);
 DC_LOGGER_INIT(link->ctx->logger);

 /* slot X.Y for SST payload deallocate */
 if (!allocate) {
  avg_time_slots_per_mtp = dc_fixpt_from_int(0);

  log_vcp_x_y(link, avg_time_slots_per_mtp);

  if (link_hwss->ext.set_throttled_vcp_size)
   link_hwss->ext.set_throttled_vcp_size(pipe_ctx,
     avg_time_slots_per_mtp);
  if (link_hwss->ext.set_hblank_min_symbol_width)
   link_hwss->ext.set_hblank_min_symbol_width(pipe_ctx,
     &empty_link_settings,
     avg_time_slots_per_mtp);
 }

 /* calculate VC payload and update branch with new payload allocation table*/
 if (!write_128b_132b_sst_payload_allocation_table(
   stream,
   link,
   &proposed_table,
   allocate)) {
  DC_LOG_ERROR("SST Update Payload: Failed to update "
      "allocation table for "
      "pipe idx: %d\n",
      pipe_ctx->pipe_idx);
  return DC_FAIL_DP_PAYLOAD_ALLOCATION;
 }

 proposed_table.stream_allocations[0].hpo_dp_stream_enc = pipe_ctx->stream_res.hpo_dp_stream_enc;

 ASSERT(proposed_table.stream_count == 1);

 //TODO - DP2.0 Logging: Instead of hpo_dp_stream_enc pointer, log instance id
 DC_LOG_DP2("SST Update Payload: hpo_dp_stream_enc: %p "
  "vcp_id: %d "
  "slot_count: %d\n",
  (void *) proposed_table.stream_allocations[0].hpo_dp_stream_enc,
  proposed_table.stream_allocations[0].vcp_id,
  proposed_table.stream_allocations[0].slot_count);

 /* program DP source TX for payload */
 link_hwss->ext.update_stream_allocation_table(link, &pipe_ctx->link_res,
   &proposed_table);

 /* poll for ACT handled */
 if (!poll_for_allocation_change_trigger(link)) {
  // Failures will result in blackscreen and errors logged
  BREAK_TO_DEBUGGER();
 }

 /* slot X.Y for SST payload allocate */
 if (allocate && link_dp_get_encoding_format(&link->cur_link_settings) ==
   DP_128b_132b_ENCODING) {
  avg_time_slots_per_mtp = link_calculate_sst_avg_time_slots_per_mtp(stream, link);

  log_vcp_x_y(link, avg_time_slots_per_mtp);

  if (link_hwss->ext.set_throttled_vcp_size)
   link_hwss->ext.set_throttled_vcp_size(pipe_ctx,
     avg_time_slots_per_mtp);
  if (link_hwss->ext.set_hblank_min_symbol_width)
   link_hwss->ext.set_hblank_min_symbol_width(pipe_ctx,
     &link->cur_link_settings,
     avg_time_slots_per_mtp);
 }

 /* Always return DC_OK.
 * If part of sequence fails, log failure(s) and show blackscreen
 */
 return DC_OK;
}

enum dc_status link_reduce_mst_payload(struct pipe_ctx *pipe_ctx, uint32_t bw_in_kbps)
{
 struct dc_stream_state *stream = pipe_ctx->stream;
 struct dc_link *link = stream->link;
 struct fixed31_32 avg_time_slots_per_mtp;
 struct fixed31_32 pbn;
 struct fixed31_32 pbn_per_slot;
 struct dc_dp_mst_stream_allocation_table proposed_table = {0};
 uint8_t i;
 const struct link_hwss *link_hwss = get_link_hwss(link, &pipe_ctx->link_res);
 DC_LOGGER_INIT(link->ctx->logger);

 /* decrease throttled vcp size */
 pbn_per_slot = get_pbn_per_slot(stream);
 pbn = get_pbn_from_bw_in_kbps(bw_in_kbps);
 avg_time_slots_per_mtp = dc_fixpt_div(pbn, pbn_per_slot);

 if (link_hwss->ext.set_throttled_vcp_size)
  link_hwss->ext.set_throttled_vcp_size(pipe_ctx, avg_time_slots_per_mtp);
 if (link_hwss->ext.set_hblank_min_symbol_width)
  link_hwss->ext.set_hblank_min_symbol_width(pipe_ctx,
    &link->cur_link_settings,
    avg_time_slots_per_mtp);

 /* send ALLOCATE_PAYLOAD sideband message with updated pbn */
 dm_helpers_dp_mst_send_payload_allocation(
   stream->ctx,
   stream);

 /* notify immediate branch device table update */
 if (dm_helpers_dp_mst_write_payload_allocation_table(
   stream->ctx,
   stream,
   &proposed_table,
   true)) {
  /* update mst stream allocation table software state */
  update_mst_stream_alloc_table(
    link,
    pipe_ctx->stream_res.stream_enc,
    pipe_ctx->stream_res.hpo_dp_stream_enc,
    &proposed_table);
 } else {
  DC_LOG_WARNING("Failed to update"
    "MST allocation table for"
    "pipe idx:%d\n",
    pipe_ctx->pipe_idx);
 }

 DC_LOG_MST("%s "
   "stream_count: %d: \n ",
   __func__,
   link->mst_stream_alloc_table.stream_count);

 for (i = 0; i < MAX_CONTROLLER_NUM; i++) {
  DC_LOG_MST("stream_enc[%d]: %p "
  "stream[%d].hpo_dp_stream_enc: %p "
  "stream[%d].vcp_id: %d "
  "stream[%d].slot_count: %d\n",
  i,
  (void *) link->mst_stream_alloc_table.stream_allocations[i].stream_enc,
  i,
  (void *) link->mst_stream_alloc_table.stream_allocations[i].hpo_dp_stream_enc,
  i,
  link->mst_stream_alloc_table.stream_allocations[i].vcp_id,
  i,
  link->mst_stream_alloc_table.stream_allocations[i].slot_count);
 }

 ASSERT(proposed_table.stream_count > 0);

 /* update mst stream allocation table hardware state */
 if (link_hwss->ext.update_stream_allocation_table == NULL ||
   link_dp_get_encoding_format(&link->cur_link_settings) == DP_UNKNOWN_ENCODING) {
  DC_LOG_ERROR("Failure: unknown encoding format\n");
  return DC_ERROR_UNEXPECTED;
 }

 link_hwss->ext.update_stream_allocation_table(link, &pipe_ctx->link_res,
   &link->mst_stream_alloc_table);

 /* poll for immediate branch device ACT handled */
 dm_helpers_dp_mst_poll_for_allocation_change_trigger(
   stream->ctx,
   stream);

 return DC_OK;
}

enum dc_status link_increase_mst_payload(struct pipe_ctx *pipe_ctx, uint32_t bw_in_kbps)
{
 struct dc_stream_state *stream = pipe_ctx->stream;
 struct dc_link *link = stream->link;
 struct fixed31_32 avg_time_slots_per_mtp;
 struct fixed31_32 pbn;
 struct fixed31_32 pbn_per_slot;
 struct dc_dp_mst_stream_allocation_table proposed_table = {0};
 uint8_t i;
 enum act_return_status ret;
 const struct link_hwss *link_hwss = get_link_hwss(link, &pipe_ctx->link_res);
 DC_LOGGER_INIT(link->ctx->logger);

 /* notify immediate branch device table update */
 if (dm_helpers_dp_mst_write_payload_allocation_table(
    stream->ctx,
    stream,
    &proposed_table,
    true)) {
  /* update mst stream allocation table software state */
  update_mst_stream_alloc_table(
    link,
    pipe_ctx->stream_res.stream_enc,
    pipe_ctx->stream_res.hpo_dp_stream_enc,
    &proposed_table);
 }

 DC_LOG_MST("%s "
   "stream_count: %d: \n ",
   __func__,
   link->mst_stream_alloc_table.stream_count);

 for (i = 0; i < MAX_CONTROLLER_NUM; i++) {
  DC_LOG_MST("stream_enc[%d]: %p "
  "stream[%d].hpo_dp_stream_enc: %p "
  "stream[%d].vcp_id: %d "
  "stream[%d].slot_count: %d\n",
  i,
  (void *) link->mst_stream_alloc_table.stream_allocations[i].stream_enc,
  i,
  (void *) link->mst_stream_alloc_table.stream_allocations[i].hpo_dp_stream_enc,
  i,
  link->mst_stream_alloc_table.stream_allocations[i].vcp_id,
  i,
  link->mst_stream_alloc_table.stream_allocations[i].slot_count);
 }

 ASSERT(proposed_table.stream_count > 0);

 /* update mst stream allocation table hardware state */
 if (link_hwss->ext.update_stream_allocation_table == NULL ||
   link_dp_get_encoding_format(&link->cur_link_settings) == DP_UNKNOWN_ENCODING) {
  DC_LOG_ERROR("Failure: unknown encoding format\n");
  return DC_ERROR_UNEXPECTED;
 }

 link_hwss->ext.update_stream_allocation_table(link, &pipe_ctx->link_res,
   &link->mst_stream_alloc_table);

 /* poll for immediate branch device ACT handled */
 ret = dm_helpers_dp_mst_poll_for_allocation_change_trigger(
   stream->ctx,
   stream);

 if (ret != ACT_LINK_LOST) {
  /* send ALLOCATE_PAYLOAD sideband message with updated pbn */
  dm_helpers_dp_mst_send_payload_allocation(
    stream->ctx,
    stream);
 }

 /* increase throttled vcp size */
 pbn = get_pbn_from_bw_in_kbps(bw_in_kbps);
 pbn_per_slot = get_pbn_per_slot(stream);
 avg_time_slots_per_mtp = dc_fixpt_div(pbn, pbn_per_slot);

 if (link_hwss->ext.set_throttled_vcp_size)
  link_hwss->ext.set_throttled_vcp_size(pipe_ctx, avg_time_slots_per_mtp);
 if (link_hwss->ext.set_hblank_min_symbol_width)
  link_hwss->ext.set_hblank_min_symbol_width(pipe_ctx,
    &link->cur_link_settings,
    avg_time_slots_per_mtp);

 return DC_OK;
}

static void disable_link_dp(struct dc_link *link,
  const struct link_resource *link_res,
  enum signal_type signal)
{
 struct dc_link_settings link_settings = link->cur_link_settings;

 if (signal == SIGNAL_TYPE_DISPLAY_PORT_MST &&
   link->mst_stream_alloc_table.stream_count > 0)
  /* disable MST link only when last vc payload is deallocated */
  return;

 dp_disable_link_phy(link, link_res, signal);

 if (link->connector_signal == SIGNAL_TYPE_EDP) {
  if (!link->skip_implict_edp_power_control)
   link->dc->hwss.edp_power_control(link, false);
 }

 if (signal == SIGNAL_TYPE_DISPLAY_PORT_MST)
  /* set the sink to SST mode after disabling the link */
  enable_mst_on_sink(link, false);

 if (link_dp_get_encoding_format(&link_settings) ==
   DP_8b_10b_ENCODING) {
  dp_set_fec_enable(link, link_res, false);
  dp_set_fec_ready(link, link_res, false);
 }
}

static void disable_link(struct dc_link *link,
  const struct link_resource *link_res,
  enum signal_type signal)
{
 if (dc_is_dp_signal(signal)) {
  disable_link_dp(link, link_res, signal);
 } else if (signal == SIGNAL_TYPE_VIRTUAL) {
  link->dc->hwss.disable_link_output(link, link_res, SIGNAL_TYPE_DISPLAY_PORT);
 } else {
  link->dc->hwss.disable_link_output(link, link_res, signal);
 }

 if (signal == SIGNAL_TYPE_DISPLAY_PORT_MST) {
  /* MST disable link only when no stream use the link */
  if (link->mst_stream_alloc_table.stream_count <= 0)
   link->link_status.link_active = false;
 } else {
  link->link_status.link_active = false;
 }
}

static void enable_link_hdmi(struct pipe_ctx *pipe_ctx)
{
 struct dc_stream_state *stream = pipe_ctx->stream;
 struct dc_link *link = stream->link;
 enum dc_color_depth display_color_depth;
 enum engine_id eng_id;
 struct ext_hdmi_settings settings = {0};
 bool is_over_340mhz = false;
 bool is_vga_mode = (stream->timing.h_addressable == 640)
   && (stream->timing.v_addressable == 480);
 struct dc *dc = pipe_ctx->stream->ctx->dc;
 const struct link_hwss *link_hwss = get_link_hwss(link, &pipe_ctx->link_res);

 if (stream->phy_pix_clk == 0)
  stream->phy_pix_clk = stream->timing.pix_clk_100hz / 10;
 if (stream->phy_pix_clk > 340000)
  is_over_340mhz = true;
 if (dc_is_tmds_signal(stream->signal) && stream->phy_pix_clk > 6000000UL) {
  ASSERT(false);
  return;
 }

 if (dc_is_hdmi_signal(pipe_ctx->stream->signal)) {
  unsigned short masked_chip_caps = pipe_ctx->stream->link->chip_caps &
    AMD_EXT_DISPLAY_PATH_CAPS__EXT_CHIP_MASK;
  if (masked_chip_caps == AMD_EXT_DISPLAY_PATH_CAPS__HDMI20_TISN65DP159RSBT) {
   /* DP159, Retimer settings */
   eng_id = pipe_ctx->stream_res.stream_enc->id;

   if (get_ext_hdmi_settings(pipe_ctx, eng_id, &settings)) {
    write_i2c_retimer_setting(pipe_ctx,
      is_vga_mode, is_over_340mhz, &settings);
   } else {
    write_i2c_default_retimer_setting(pipe_ctx,
      is_vga_mode, is_over_340mhz);
   }
  } else if (masked_chip_caps == AMD_EXT_DISPLAY_PATH_CAPS__HDMI20_PI3EQX1204) {
   /* PI3EQX1204, Redriver settings */
   write_i2c_redriver_setting(pipe_ctx, is_over_340mhz);
  }
 }

 if (dc_is_hdmi_signal(pipe_ctx->stream->signal))
  write_scdc_data(
   stream->link->ddc,
   stream->phy_pix_clk,
   stream->timing.flags.LTE_340MCSC_SCRAMBLE);

 memset(&stream->link->cur_link_settings, 0,
   sizeof(struct dc_link_settings));

 display_color_depth = stream->timing.display_color_depth;
 if (stream->timing.pixel_encoding == PIXEL_ENCODING_YCBCR422)
  display_color_depth = COLOR_DEPTH_888;

 /* We need to enable stream encoder for TMDS first to apply 1/4 TMDS
 * character clock in case that beyond 340MHz.
 */
 if (dc_is_hdmi_tmds_signal(pipe_ctx->stream->signal) || dc_is_dvi_signal(pipe_ctx->stream->signal))
  link_hwss->setup_stream_encoder(pipe_ctx);

 dc->hwss.enable_tmds_link_output(
   link,
   &pipe_ctx->link_res,
   pipe_ctx->stream->signal,
   pipe_ctx->clock_source->id,
   display_color_depth,
   stream->phy_pix_clk);

 if (dc_is_hdmi_signal(pipe_ctx->stream->signal))
  read_scdc_data(link->ddc);
}

static enum dc_status enable_link_dp(struct dc_state *state,
         struct pipe_ctx *pipe_ctx)
{
--> --------------------

--> maximum size reached

--> --------------------