Quelle  link_factory.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 creation/destruction of link structure.
 */
#include "link_factory.h"
#include "link_detection.h"
#include "link_resource.h"
#include "link_validation.h"
#include "link_dpms.h"
#include "accessories/link_dp_cts.h"
#include "accessories/link_dp_trace.h"
#include "protocols/link_ddc.h"
#include "protocols/link_dp_capability.h"
#include "protocols/link_dp_dpia_bw.h"
#include "protocols/link_dp_dpia.h"
#include "protocols/link_dp_irq_handler.h"
#include "protocols/link_dp_phy.h"
#include "protocols/link_dp_training.h"
#include "protocols/link_edp_panel_control.h"
#include "protocols/link_hpd.h"
#include "gpio_service_interface.h"
#include "atomfirmware.h"

#define DC_LOGGER \
 dc_ctx->logger
#define DC_LOGGER_INIT(logger)

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

/* link factory owns the creation/destruction of link structures. */
static void construct_link_service_factory(struct link_service *link_srv)
{

 link_srv->create_link = link_create;
 link_srv->destroy_link = link_destroy;
}

/* link_detection manages link detection states and receiver states by using
 * various link protocols. It also provides helper functions to interpret
 * certain capabilities or status based on the states it manages or retrieve
 * them directly from connected receivers.
 */
static void construct_link_service_detection(struct link_service *link_srv)
{
 link_srv->detect_link = link_detect;
 link_srv->detect_connection_type = link_detect_connection_type;
 link_srv->add_remote_sink = link_add_remote_sink;
 link_srv->remove_remote_sink = link_remove_remote_sink;
 link_srv->get_hpd_state = link_get_hpd_state;
 link_srv->get_hpd_gpio = link_get_hpd_gpio;
 link_srv->enable_hpd = link_enable_hpd;
 link_srv->disable_hpd = link_disable_hpd;
 link_srv->enable_hpd_filter = link_enable_hpd_filter;
 link_srv->reset_cur_dp_mst_topology = link_reset_cur_dp_mst_topology;
 link_srv->get_status = link_get_status;
 link_srv->is_hdcp1x_supported = link_is_hdcp14;
 link_srv->is_hdcp2x_supported = link_is_hdcp22;
 link_srv->clear_dprx_states = link_clear_dprx_states;
}

/* link resource implements accessors to link resource. */
static void construct_link_service_resource(struct link_service *link_srv)
{
 link_srv->get_cur_res_map = link_get_cur_res_map;
 link_srv->restore_res_map = link_restore_res_map;
 link_srv->get_cur_link_res = link_get_cur_link_res;
}

/* link validation owns timing validation against various link limitations. (ex.
 * link bandwidth, receiver capability or our hardware capability) It also
 * provides helper functions exposing bandwidth formulas used in validation.
 */
static void construct_link_service_validation(struct link_service *link_srv)
{
 link_srv->validate_mode_timing = link_validate_mode_timing;
 link_srv->dp_link_bandwidth_kbps = dp_link_bandwidth_kbps;
 link_srv->validate_dp_tunnel_bandwidth = link_validate_dp_tunnel_bandwidth;
 link_srv->dp_required_hblank_size_bytes = dp_required_hblank_size_bytes;
}

/* link dpms 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.
 */
static void construct_link_service_dpms(struct link_service *link_srv)
{
 link_srv->set_dpms_on = link_set_dpms_on;
 link_srv->set_dpms_off = link_set_dpms_off;
 link_srv->resume = link_resume;
 link_srv->blank_all_dp_displays = link_blank_all_dp_displays;
 link_srv->blank_all_edp_displays = link_blank_all_edp_displays;
 link_srv->blank_dp_stream = link_blank_dp_stream;
 link_srv->increase_mst_payload = link_increase_mst_payload;
 link_srv->reduce_mst_payload = link_reduce_mst_payload;
 link_srv->set_dsc_on_stream = link_set_dsc_on_stream;
 link_srv->set_dsc_enable = link_set_dsc_enable;
 link_srv->update_dsc_config = link_update_dsc_config;
}

/* link ddc implements generic display communication protocols such as i2c, aux
 * and scdc. It should not contain any specific applications of these
 * protocols such as display capability query, detection, or handshaking such as
 * link training.
 */
static void construct_link_service_ddc(struct link_service *link_srv)
{
 link_srv->create_ddc_service = link_create_ddc_service;
 link_srv->destroy_ddc_service = link_destroy_ddc_service;
 link_srv->query_ddc_data = link_query_ddc_data;
 link_srv->aux_transfer_raw = link_aux_transfer_raw;
 link_srv->configure_fixed_vs_pe_retimer = link_configure_fixed_vs_pe_retimer;
 link_srv->aux_transfer_with_retries_no_mutex =
   link_aux_transfer_with_retries_no_mutex;
 link_srv->is_in_aux_transaction_mode = link_is_in_aux_transaction_mode;
 link_srv->get_aux_defer_delay = link_get_aux_defer_delay;
}

/* link dp capability implements dp specific link capability retrieval sequence.
 * It is responsible for retrieving, parsing, overriding, deciding capability
 * obtained from dp link. Link capability consists of encoders, DPRXs, cables,
 * retimers, usb and all other possible backend capabilities.
 */
static void construct_link_service_dp_capability(struct link_service *link_srv)
{
 link_srv->dp_is_sink_present = dp_is_sink_present;
 link_srv->dp_is_fec_supported = dp_is_fec_supported;
 link_srv->dp_is_128b_132b_signal = dp_is_128b_132b_signal;
 link_srv->dp_get_max_link_enc_cap = dp_get_max_link_enc_cap;
 link_srv->dp_get_verified_link_cap = dp_get_verified_link_cap;
 link_srv->dp_get_encoding_format = link_dp_get_encoding_format;
 link_srv->dp_should_enable_fec = dp_should_enable_fec;
 link_srv->dp_decide_link_settings = link_decide_link_settings;
 link_srv->dp_decide_tunnel_settings = link_decide_dp_tunnel_settings;
 link_srv->mst_decide_link_encoding_format =
   mst_decide_link_encoding_format;
 link_srv->edp_decide_link_settings = edp_decide_link_settings;
 link_srv->bw_kbps_from_raw_frl_link_rate_data =
   link_bw_kbps_from_raw_frl_link_rate_data;
 link_srv->dp_overwrite_extended_receiver_cap =
   dp_overwrite_extended_receiver_cap;
 link_srv->dp_decide_lttpr_mode = dp_decide_lttpr_mode;
}

/* link dp phy/dpia implements basic dp phy/dpia functionality such as
 * enable/disable output and set lane/drive settings. It is responsible for
 * maintaining and update software state representing current phy/dpia status
 * such as current link settings.
 */
static void construct_link_service_dp_phy_or_dpia(struct link_service *link_srv)
{
 link_srv->dpia_handle_usb4_bandwidth_allocation_for_link =
   dpia_handle_usb4_bandwidth_allocation_for_link;
 link_srv->dp_set_drive_settings = dp_set_drive_settings;
 link_srv->dpcd_write_rx_power_ctrl = dpcd_write_rx_power_ctrl;
}

/* link dp irq handler implements DP HPD short pulse handling sequence according
 * to DP specifications
 */
static void construct_link_service_dp_irq_handler(struct link_service *link_srv)
{
 link_srv->dp_parse_link_loss_status = dp_parse_link_loss_status;
 link_srv->dp_should_allow_hpd_rx_irq = dp_should_allow_hpd_rx_irq;
 link_srv->dp_handle_link_loss = dp_handle_link_loss;
 link_srv->dp_read_hpd_rx_irq_data = dp_read_hpd_rx_irq_data;
 link_srv->dp_handle_hpd_rx_irq = dp_handle_hpd_rx_irq;
}

/* link edp panel control implements retrieval and configuration of eDP panel
 * features such as PSR and ABM and it also manages specs defined eDP panel
 * power sequences.
 */
static void construct_link_service_edp_panel_control(struct link_service *link_srv)
{
 link_srv->edp_panel_backlight_power_on = edp_panel_backlight_power_on;
 link_srv->edp_get_backlight_level = edp_get_backlight_level;
 link_srv->edp_get_backlight_level_nits = edp_get_backlight_level_nits;
 link_srv->edp_set_backlight_level = edp_set_backlight_level;
 link_srv->edp_set_backlight_level_nits = edp_set_backlight_level_nits;
 link_srv->edp_get_target_backlight_pwm = edp_get_target_backlight_pwm;
 link_srv->edp_get_psr_state = edp_get_psr_state;
 link_srv->edp_set_psr_allow_active = edp_set_psr_allow_active;
 link_srv->edp_setup_psr = edp_setup_psr;
 link_srv->edp_set_sink_vtotal_in_psr_active =
   edp_set_sink_vtotal_in_psr_active;
 link_srv->edp_get_psr_residency = edp_get_psr_residency;

 link_srv->edp_get_replay_state = edp_get_replay_state;
 link_srv->edp_set_replay_allow_active = edp_set_replay_allow_active;
 link_srv->edp_setup_replay = edp_setup_replay;
 link_srv->edp_send_replay_cmd = edp_send_replay_cmd;
 link_srv->edp_set_coasting_vtotal = edp_set_coasting_vtotal;
 link_srv->edp_replay_residency = edp_replay_residency;
 link_srv->edp_set_replay_power_opt_and_coasting_vtotal = edp_set_replay_power_opt_and_coasting_vtotal;

 link_srv->edp_wait_for_t12 = edp_wait_for_t12;
 link_srv->edp_is_ilr_optimization_required =
   edp_is_ilr_optimization_required;
 link_srv->edp_backlight_enable_aux = edp_backlight_enable_aux;
 link_srv->edp_add_delay_for_T9 = edp_add_delay_for_T9;
 link_srv->edp_receiver_ready_T9 = edp_receiver_ready_T9;
 link_srv->edp_receiver_ready_T7 = edp_receiver_ready_T7;
 link_srv->edp_power_alpm_dpcd_enable = edp_power_alpm_dpcd_enable;
 link_srv->edp_set_panel_power = edp_set_panel_power;
}

/* link dp cts implements dp compliance test automation protocols and manual
 * testing interfaces for debugging and certification purpose.
 */
static void construct_link_service_dp_cts(struct link_service *link_srv)
{
 link_srv->dp_handle_automated_test = dp_handle_automated_test;
 link_srv->dp_set_test_pattern = dp_set_test_pattern;
 link_srv->dp_set_preferred_link_settings =
   dp_set_preferred_link_settings;
 link_srv->dp_set_preferred_training_settings =
   dp_set_preferred_training_settings;
}

/* link dp trace implements tracing interfaces for tracking major dp sequences
 * including execution status and timestamps
 */
static void construct_link_service_dp_trace(struct link_service *link_srv)
{
 link_srv->dp_trace_is_initialized = dp_trace_is_initialized;
 link_srv->dp_trace_set_is_logged_flag = dp_trace_set_is_logged_flag;
 link_srv->dp_trace_is_logged = dp_trace_is_logged;
 link_srv->dp_trace_get_lt_end_timestamp = dp_trace_get_lt_end_timestamp;
 link_srv->dp_trace_get_lt_counts = dp_trace_get_lt_counts;
 link_srv->dp_trace_get_link_loss_count = dp_trace_get_link_loss_count;
 link_srv->dp_trace_set_edp_power_timestamp =
   dp_trace_set_edp_power_timestamp;
 link_srv->dp_trace_get_edp_poweron_timestamp =
   dp_trace_get_edp_poweron_timestamp;
 link_srv->dp_trace_get_edp_poweroff_timestamp =
   dp_trace_get_edp_poweroff_timestamp;
 link_srv->dp_trace_source_sequence = dp_trace_source_sequence;
}

static void construct_link_service(struct link_service *link_srv)
{
 /* All link service functions should fall under some sub categories.
 * If a new function doesn't perfectly fall under an existing sub
 * category, it must be that you are either adding a whole new aspect of
 * responsibility to link service or something doesn't belong to link
 * service. In that case please contact the arch owner to arrange a
 * design review meeting.
 */
 construct_link_service_factory(link_srv);
 construct_link_service_detection(link_srv);
 construct_link_service_resource(link_srv);
 construct_link_service_validation(link_srv);
 construct_link_service_dpms(link_srv);
 construct_link_service_ddc(link_srv);
 construct_link_service_dp_capability(link_srv);
 construct_link_service_dp_phy_or_dpia(link_srv);
 construct_link_service_dp_irq_handler(link_srv);
 construct_link_service_edp_panel_control(link_srv);
 construct_link_service_dp_cts(link_srv);
 construct_link_service_dp_trace(link_srv);
}

struct link_service *link_create_link_service(void)
{
 struct link_service *link_srv = kzalloc(sizeof(*link_srv), GFP_KERNEL);

 if (link_srv == NULL)
  goto fail;

 construct_link_service(link_srv);

 return link_srv;
fail:
 return NULL;
}

void link_destroy_link_service(struct link_service **link_srv)
{
 kfree(*link_srv);
 *link_srv = NULL;
}

static enum transmitter translate_encoder_to_transmitter(
  struct graphics_object_id encoder)
{
 switch (encoder.id) {
 case ENCODER_ID_INTERNAL_UNIPHY:
  switch (encoder.enum_id) {
  case ENUM_ID_1:
   return TRANSMITTER_UNIPHY_A;
  case ENUM_ID_2:
   return TRANSMITTER_UNIPHY_B;
  default:
   return TRANSMITTER_UNKNOWN;
  }
 break;
 case ENCODER_ID_INTERNAL_UNIPHY1:
  switch (encoder.enum_id) {
  case ENUM_ID_1:
   return TRANSMITTER_UNIPHY_C;
  case ENUM_ID_2:
   return TRANSMITTER_UNIPHY_D;
  default:
   return TRANSMITTER_UNKNOWN;
  }
 break;
 case ENCODER_ID_INTERNAL_UNIPHY2:
  switch (encoder.enum_id) {
  case ENUM_ID_1:
   return TRANSMITTER_UNIPHY_E;
  case ENUM_ID_2:
   return TRANSMITTER_UNIPHY_F;
  default:
   return TRANSMITTER_UNKNOWN;
  }
 break;
 case ENCODER_ID_INTERNAL_UNIPHY3:
  switch (encoder.enum_id) {
  case ENUM_ID_1:
   return TRANSMITTER_UNIPHY_G;
  default:
   return TRANSMITTER_UNKNOWN;
  }
 break;
 case ENCODER_ID_EXTERNAL_NUTMEG:
  switch (encoder.enum_id) {
  case ENUM_ID_1:
   return TRANSMITTER_NUTMEG_CRT;
  default:
   return TRANSMITTER_UNKNOWN;
  }
 break;
 case ENCODER_ID_EXTERNAL_TRAVIS:
  switch (encoder.enum_id) {
  case ENUM_ID_1:
   return TRANSMITTER_TRAVIS_CRT;
  case ENUM_ID_2:
   return TRANSMITTER_TRAVIS_LCD;
  default:
   return TRANSMITTER_UNKNOWN;
  }
 break;
 default:
  return TRANSMITTER_UNKNOWN;
 }
}

static void link_destruct(struct dc_link *link)
{
 int i;

 if (link->hpd_gpio) {
  dal_gpio_destroy_irq(&link->hpd_gpio);
  link->hpd_gpio = NULL;
 }

 if (link->ddc)
  link_destroy_ddc_service(&link->ddc);

 if (link->panel_cntl)
  link->panel_cntl->funcs->destroy(&link->panel_cntl);

 if (link->link_enc && !link->is_dig_mapping_flexible) {
  /* Update link encoder resource tracking variables. These are used for
 * the dynamic assignment of link encoders to streams. Virtual links
 * are not assigned encoder resources on creation.
 */
  if (link->link_id.id != CONNECTOR_ID_VIRTUAL && link->eng_id != ENGINE_ID_UNKNOWN) {
   link->dc->res_pool->link_encoders[link->eng_id - ENGINE_ID_DIGA] = NULL;
   link->dc->res_pool->dig_link_enc_count--;
  }
  link->link_enc->funcs->destroy(&link->link_enc);
 }

 if (link->local_sink)
  dc_sink_release(link->local_sink);

 for (i = 0; i < link->sink_count; ++i)
  dc_sink_release(link->remote_sinks[i]);
}

static enum channel_id get_ddc_line(struct dc_link *link)
{
 struct ddc *ddc;
 enum channel_id channel;

 channel = CHANNEL_ID_UNKNOWN;

 ddc = get_ddc_pin(link->ddc);

 if (ddc) {
  switch (dal_ddc_get_line(ddc)) {
  case GPIO_DDC_LINE_DDC1:
   channel = CHANNEL_ID_DDC1;
   break;
  case GPIO_DDC_LINE_DDC2:
   channel = CHANNEL_ID_DDC2;
   break;
  case GPIO_DDC_LINE_DDC3:
   channel = CHANNEL_ID_DDC3;
   break;
  case GPIO_DDC_LINE_DDC4:
   channel = CHANNEL_ID_DDC4;
   break;
  case GPIO_DDC_LINE_DDC5:
   channel = CHANNEL_ID_DDC5;
   break;
  case GPIO_DDC_LINE_DDC6:
   channel = CHANNEL_ID_DDC6;
   break;
  case GPIO_DDC_LINE_DDC_VGA:
   channel = CHANNEL_ID_DDC_VGA;
   break;
  case GPIO_DDC_LINE_I2C_PAD:
   channel = CHANNEL_ID_I2C_PAD;
   break;
  default:
   BREAK_TO_DEBUGGER();
   break;
  }
 }

 return channel;
}

static bool construct_phy(struct dc_link *link,
         const struct link_init_data *init_params)
{
 uint8_t i;
 struct ddc_service_init_data ddc_service_init_data = { 0 };
 struct dc_context *dc_ctx = init_params->ctx;
 struct encoder_init_data enc_init_data = { 0 };
 struct panel_cntl_init_data panel_cntl_init_data = { 0 };
 struct dc_bios *bios = init_params->dc->ctx->dc_bios;
 const struct dc_vbios_funcs *bp_funcs = bios->funcs;
 struct bp_disp_connector_caps_info disp_connect_caps_info = { 0 };

 DC_LOGGER_INIT(dc_ctx->logger);

 link->irq_source_hpd = DC_IRQ_SOURCE_INVALID;
 link->irq_source_hpd_rx = DC_IRQ_SOURCE_INVALID;
 link->irq_source_read_request = DC_IRQ_SOURCE_INVALID;
 link->link_status.dpcd_caps = &link->dpcd_caps;

 link->dc = init_params->dc;
 link->ctx = dc_ctx;
 link->link_index = init_params->link_index;

 memset(&link->preferred_training_settings, 0,
        sizeof(struct dc_link_training_overrides));
 memset(&link->preferred_link_setting, 0,
        sizeof(struct dc_link_settings));

 link->link_id =
  bios->funcs->get_connector_id(bios, init_params->connector_index);

 link->ep_type = DISPLAY_ENDPOINT_PHY;

 DC_LOG_DC("BIOS object table - link_id: %d", link->link_id.id);

 if (bios->funcs->get_disp_connector_caps_info) {
  bios->funcs->get_disp_connector_caps_info(bios, link->link_id, &disp_connect_caps_info);
  link->is_internal_display = disp_connect_caps_info.INTERNAL_DISPLAY;
  DC_LOG_DC("BIOS object table - is_internal_display: %d", link->is_internal_display);
 }

 if (link->link_id.type != OBJECT_TYPE_CONNECTOR) {
  dm_output_to_console("%s: Invalid Connector ObjectID from Adapter Service for connector index:%d! type %d expected %d\n",
         __func__, init_params->connector_index,
         link->link_id.type, OBJECT_TYPE_CONNECTOR);
  goto create_fail;
 }

 if (link->dc->res_pool->funcs->link_init)
  link->dc->res_pool->funcs->link_init(link);

 link->hpd_gpio = link_get_hpd_gpio(link->ctx->dc_bios, link->link_id,
          link->ctx->gpio_service);

 if (link->hpd_gpio) {
  dal_gpio_open(link->hpd_gpio, GPIO_MODE_INTERRUPT);
  dal_gpio_unlock_pin(link->hpd_gpio);
  link->irq_source_hpd = dal_irq_get_source(link->hpd_gpio);

  DC_LOG_DC("BIOS object table - hpd_gpio id: %d", link->hpd_gpio->id);
  DC_LOG_DC("BIOS object table - hpd_gpio en: %d", link->hpd_gpio->en);
 }

 switch (link->link_id.id) {
 case CONNECTOR_ID_HDMI_TYPE_A:
  link->connector_signal = SIGNAL_TYPE_HDMI_TYPE_A;

  if (link->hpd_gpio)
   link->irq_source_read_request =
     dal_irq_get_read_request(link->hpd_gpio);
  break;
 case CONNECTOR_ID_SINGLE_LINK_DVID:
 case CONNECTOR_ID_SINGLE_LINK_DVII:
  link->connector_signal = SIGNAL_TYPE_DVI_SINGLE_LINK;
  break;
 case CONNECTOR_ID_DUAL_LINK_DVID:
 case CONNECTOR_ID_DUAL_LINK_DVII:
  link->connector_signal = SIGNAL_TYPE_DVI_DUAL_LINK;
  break;
 case CONNECTOR_ID_DISPLAY_PORT:
 case CONNECTOR_ID_MXM:
 case CONNECTOR_ID_USBC:
  link->connector_signal = SIGNAL_TYPE_DISPLAY_PORT;

  if (link->hpd_gpio)
   link->irq_source_hpd_rx =
     dal_irq_get_rx_source(link->hpd_gpio);

  break;
 case CONNECTOR_ID_EDP:
  // If smartmux is supported, only create the link on the primary eDP.
  // Dual eDP is not supported with smartmux.
  if (!(!link->dc->config.smart_mux_version || dc_ctx->dc_edp_id_count == 0))
   goto create_fail;

  link->connector_signal = SIGNAL_TYPE_EDP;

  if (link->hpd_gpio) {
   if (!link->dc->config.allow_edp_hotplug_detection
    && !is_smartmux_suported(link))
    link->irq_source_hpd = DC_IRQ_SOURCE_INVALID;

   switch (link->dc->config.allow_edp_hotplug_detection) {
   case HPD_EN_FOR_ALL_EDP:
    link->irq_source_hpd_rx =
      dal_irq_get_rx_source(link->hpd_gpio);
    break;
   case HPD_EN_FOR_PRIMARY_EDP_ONLY:
    if (link->link_index == 0)
     link->irq_source_hpd_rx =
      dal_irq_get_rx_source(link->hpd_gpio);
    else
     link->irq_source_hpd = DC_IRQ_SOURCE_INVALID;
    break;
   case HPD_EN_FOR_SECONDARY_EDP_ONLY:
    if (link->link_index == 1)
     link->irq_source_hpd_rx =
      dal_irq_get_rx_source(link->hpd_gpio);
    else
     link->irq_source_hpd = DC_IRQ_SOURCE_INVALID;
    break;
   default:
    link->irq_source_hpd = DC_IRQ_SOURCE_INVALID;
    break;
   }
  }

  break;
 case CONNECTOR_ID_LVDS:
  link->connector_signal = SIGNAL_TYPE_LVDS;
  break;
 default:
  DC_LOG_WARNING("Unsupported Connector type:%d!\n",
          link->link_id.id);
  goto create_fail;
 }

 LINK_INFO("Connector[%d] description: signal: %s\n",
    init_params->connector_index,
    signal_type_to_string(link->connector_signal));

 ddc_service_init_data.ctx = link->ctx;
 ddc_service_init_data.id = link->link_id;
 ddc_service_init_data.link = link;
 link->ddc = link_create_ddc_service(&ddc_service_init_data);

 if (!link->ddc) {
  DC_ERROR("Failed to create ddc_service!\n");
  goto ddc_create_fail;
 }

 if (!link->ddc->ddc_pin) {
  DC_ERROR("Failed to get I2C info for connector!\n");
  goto ddc_create_fail;
 }

 link->ddc_hw_inst =
  dal_ddc_get_line(get_ddc_pin(link->ddc));

 enc_init_data.ctx = dc_ctx;
 bp_funcs->get_src_obj(dc_ctx->dc_bios, link->link_id, 0,
         &enc_init_data.encoder);
 enc_init_data.connector = link->link_id;
 enc_init_data.channel = get_ddc_line(link);
 enc_init_data.hpd_source = get_hpd_line(link);

 link->hpd_src = enc_init_data.hpd_source;

 enc_init_data.transmitter =
  translate_encoder_to_transmitter(enc_init_data.encoder);
 link->link_enc =
  link->dc->res_pool->funcs->link_enc_create(dc_ctx, &enc_init_data);

 if (!link->link_enc) {
  DC_ERROR("Failed to create link encoder!\n");
  goto link_enc_create_fail;
 }

 DC_LOG_DC("BIOS object table - DP_IS_USB_C: %d", link->link_enc->features.flags.bits.DP_IS_USB_C);
 DC_LOG_DC("BIOS object table - IS_DP2_CAPABLE: %d", link->link_enc->features.flags.bits.IS_DP2_CAPABLE);

 /* Update link encoder tracking variables. These are used for the dynamic
 * assignment of link encoders to streams.
 */
 link->eng_id = link->link_enc->preferred_engine;
 link->dc->res_pool->link_encoders[link->eng_id - ENGINE_ID_DIGA] = link->link_enc;
 link->dc->res_pool->dig_link_enc_count++;

 link->link_enc_hw_inst = link->link_enc->transmitter;

 if (link->dc->res_pool->funcs->panel_cntl_create &&
  (link->link_id.id == CONNECTOR_ID_EDP ||
   link->link_id.id == CONNECTOR_ID_LVDS)) {
  panel_cntl_init_data.ctx = dc_ctx;
  panel_cntl_init_data.inst = panel_cntl_init_data.ctx->dc_edp_id_count;
  panel_cntl_init_data.eng_id = link->eng_id;
  link->panel_cntl =
   link->dc->res_pool->funcs->panel_cntl_create(
        &panel_cntl_init_data);
  panel_cntl_init_data.ctx->dc_edp_id_count++;

  if (link->panel_cntl == NULL) {
   DC_ERROR("Failed to create link panel_cntl!\n");
   goto panel_cntl_create_fail;
  }
 }
 for (i = 0; i < 4; i++) {
  if (bp_funcs->get_device_tag(dc_ctx->dc_bios,
          link->link_id, i,
          &link->device_tag) != BP_RESULT_OK) {
   DC_ERROR("Failed to find device tag!\n");
   goto device_tag_fail;
  }

  /* Look for device tag that matches connector signal,
 * CRT for rgb, LCD for other supported signal types
 */
  if (!bp_funcs->is_device_id_supported(dc_ctx->dc_bios,
            link->device_tag.dev_id))
   continue;
  if (link->device_tag.dev_id.device_type == DEVICE_TYPE_CRT &&
      link->connector_signal != SIGNAL_TYPE_RGB)
   continue;
  if (link->device_tag.dev_id.device_type == DEVICE_TYPE_LCD &&
      link->connector_signal == SIGNAL_TYPE_RGB)
   continue;

  DC_LOG_DC("BIOS object table - device_tag.acpi_device: %d", link->device_tag.acpi_device);
  DC_LOG_DC("BIOS object table - device_tag.dev_id.device_type: %d", link->device_tag.dev_id.device_type);
  DC_LOG_DC("BIOS object table - device_tag.dev_id.enum_id: %d", link->device_tag.dev_id.enum_id);
  break;
 }

 if (bios->integrated_info) {
  /* Look for channel mapping corresponding to connector and device tag */
  for (i = 0; i < MAX_NUMBER_OF_EXT_DISPLAY_PATH; i++) {
   struct external_display_path *path =
    &bios->integrated_info->ext_disp_conn_info.path[i];

   if (path->device_connector_id.enum_id == link->link_id.enum_id &&
       path->device_connector_id.id == link->link_id.id &&
       path->device_connector_id.type == link->link_id.type) {
    if (link->device_tag.acpi_device != 0 &&
        path->device_acpi_enum == link->device_tag.acpi_device) {
     link->ddi_channel_mapping = path->channel_mapping;
     link->chip_caps = path->caps;
     DC_LOG_DC("BIOS object table - ddi_channel_mapping: 0x%04X",
        link->ddi_channel_mapping.raw);
     DC_LOG_DC("BIOS object table - chip_caps: %d",
        link->chip_caps);
    } else if (path->device_tag ==
        link->device_tag.dev_id.raw_device_tag) {
     link->ddi_channel_mapping = path->channel_mapping;
     link->chip_caps = path->caps;
     DC_LOG_DC("BIOS object table - ddi_channel_mapping: 0x%04X",
        link->ddi_channel_mapping.raw);
     DC_LOG_DC("BIOS object table - chip_caps: %d",
        link->chip_caps);
    }

    if ((link->chip_caps & AMD_EXT_DISPLAY_PATH_CAPS__EXT_CHIP_MASK) == AMD_EXT_DISPLAY_PATH_CAPS__DP_FIXED_VS_EN) {
     link->bios_forced_drive_settings.VOLTAGE_SWING =
      (bios->integrated_info->ext_disp_conn_info.fixdpvoltageswing & 0x3);
     link->bios_forced_drive_settings.PRE_EMPHASIS =
      ((bios->integrated_info->ext_disp_conn_info.fixdpvoltageswing >> 2) & 0x3);
    }

    break;
   }
  }
 }
 if (bios->funcs->get_atom_dc_golden_table)
  bios->funcs->get_atom_dc_golden_table(bios);

 /*
 * TODO check if GPIO programmed correctly
 *
 * If GPIO isn't programmed correctly HPD might not rise or drain
 * fast enough, leading to bounces.
 */
 program_hpd_filter(link);

 link->psr_settings.psr_vtotal_control_support = false;
 link->psr_settings.psr_version = DC_PSR_VERSION_UNSUPPORTED;

 DC_LOG_DC("BIOS object table - %s finished successfully.\n", __func__);
 return true;
device_tag_fail:
 link->link_enc->funcs->destroy(&link->link_enc);
link_enc_create_fail:
 if (link->panel_cntl != NULL)
  link->panel_cntl->funcs->destroy(&link->panel_cntl);
panel_cntl_create_fail:
 link_destroy_ddc_service(&link->ddc);
ddc_create_fail:
create_fail:

 if (link->hpd_gpio) {
  dal_gpio_destroy_irq(&link->hpd_gpio);
  link->hpd_gpio = NULL;
 }

 DC_LOG_DC("BIOS object table - %s failed.\n", __func__);
 return false;
}

static bool construct_dpia(struct dc_link *link,
         const struct link_init_data *init_params)
{
 struct ddc_service_init_data ddc_service_init_data = { 0 };
 struct dc_context *dc_ctx = init_params->ctx;

 DC_LOGGER_INIT(dc_ctx->logger);

 /* Initialized irq source for hpd and hpd rx */
 link->irq_source_hpd = DC_IRQ_SOURCE_INVALID;
 link->irq_source_hpd_rx = DC_IRQ_SOURCE_INVALID;
 link->link_status.dpcd_caps = &link->dpcd_caps;

 link->dc = init_params->dc;
 link->ctx = dc_ctx;
 link->link_index = init_params->link_index;

 memset(&link->preferred_training_settings, 0,
        sizeof(struct dc_link_training_overrides));
 memset(&link->preferred_link_setting, 0,
        sizeof(struct dc_link_settings));

 /* Dummy Init for linkid */
 link->link_id.type = OBJECT_TYPE_CONNECTOR;
 link->link_id.id = CONNECTOR_ID_DISPLAY_PORT;
 link->link_id.enum_id = ENUM_ID_1 + init_params->connector_index;
 link->is_internal_display = false;
 link->connector_signal = SIGNAL_TYPE_DISPLAY_PORT;
 LINK_INFO("Connector[%d] description:signal %d\n",
    init_params->connector_index,
    link->connector_signal);

 link->ep_type = DISPLAY_ENDPOINT_USB4_DPIA;
 link->is_dig_mapping_flexible = true;

 /* TODO: Initialize link : funcs->link_init */

 ddc_service_init_data.ctx = link->ctx;
 ddc_service_init_data.id = link->link_id;
 ddc_service_init_data.link = link;
 /* Set indicator for dpia link so that ddc wont be created */
 ddc_service_init_data.is_dpia_link = true;

 link->ddc = link_create_ddc_service(&ddc_service_init_data);
 if (!link->ddc) {
  DC_ERROR("Failed to create ddc_service!\n");
  goto ddc_create_fail;
 }

 /* Set dpia port index : 0 to number of dpia ports */
 link->ddc_hw_inst = init_params->connector_index;

 // Assign Dpia preferred eng_id
 if (link->dc->res_pool->funcs->get_preferred_eng_id_dpia)
  link->dpia_preferred_eng_id = link->dc->res_pool->funcs->get_preferred_eng_id_dpia(link->ddc_hw_inst);

 /* TODO: Create link encoder */

 link->psr_settings.psr_version = DC_PSR_VERSION_UNSUPPORTED;

 /* Some docks seem to NAK I2C writes to segment pointer with mot=0. */
 link->wa_flags.dp_mot_reset_segment = true;

 return true;

ddc_create_fail:
 return false;
}

static bool link_construct(struct dc_link *link,
         const struct link_init_data *init_params)
{
 /* Handle dpia case */
 if (init_params->is_dpia_link == true)
  return construct_dpia(link, init_params);
 else
  return construct_phy(link, init_params);
}

struct dc_link *link_create(const struct link_init_data *init_params)
{
 struct dc_link *link =
   kzalloc(sizeof(*link), GFP_KERNEL);

 if (NULL == link)
  goto alloc_fail;

 if (false == link_construct(link, init_params))
  goto construct_fail;

 return link;

construct_fail:
 kfree(link);

alloc_fail:
 return NULL;
}

void link_destroy(struct dc_link **link)
{
 link_destruct(*link);
 kfree(*link);
 *link = NULL;
}