| /* SPDX-License-Identifier: GPL-2.0-only */ |
| |
| /* |
| * drivers/video/tegra/dc/dp.c |
| */ |
| |
| #include <console/console.h> |
| #include <delay.h> |
| #include <device/device.h> |
| #include <device/i2c_simple.h> |
| #include <edid.h> |
| #include <soc/addressmap.h> |
| #include <soc/nvidia/tegra/i2c.h> |
| #include <soc/nvidia/tegra/dc.h> |
| #include <soc/nvidia/tegra/displayport.h> |
| #include <soc/sor.h> |
| #include <string.h> |
| #include <types.h> |
| |
| #include "chip.h" |
| |
| enum { |
| DP_LT_SUCCESS = 0, |
| DP_LT_FAILED = -1, |
| }; |
| |
| struct tegra_dc_dp_data dp_data; |
| |
| static inline u32 tegra_dpaux_readl(struct tegra_dc_dp_data *dp, u32 reg) |
| { |
| void *addr = dp->aux_base + (u32)(reg << 2); |
| u32 reg_val = READL(addr); |
| return reg_val; |
| } |
| |
| static inline void tegra_dpaux_writel(struct tegra_dc_dp_data *dp, |
| u32 reg, u32 val) |
| { |
| void *addr = dp->aux_base + (u32)(reg << 2); |
| WRITEL(val, addr); |
| } |
| |
| static inline u32 tegra_dc_dpaux_poll_register(struct tegra_dc_dp_data *dp, |
| u32 reg, u32 mask, u32 exp_val, |
| u32 poll_interval_us, |
| u32 timeout_us) |
| { |
| u32 reg_val = 0; |
| u32 temp = timeout_us; |
| |
| do { |
| udelay(poll_interval_us); |
| reg_val = tegra_dpaux_readl(dp, reg); |
| if (timeout_us > poll_interval_us) |
| timeout_us -= poll_interval_us; |
| else |
| break; |
| } while ((reg_val & mask) != exp_val); |
| |
| if ((reg_val & mask) == exp_val) |
| return 0; /* success */ |
| printk(BIOS_ERR, |
| "dpaux_poll_register 0x%x: timeout: " |
| "(reg_val)0x%08x & (mask)0x%08x != (exp_val)0x%08x\n", |
| reg, reg_val, mask, exp_val); |
| return temp; |
| } |
| |
| static inline int tegra_dpaux_wait_transaction(struct tegra_dc_dp_data *dp) |
| { |
| /* According to DP spec, each aux transaction needs to finish |
| within 40ms. */ |
| if (tegra_dc_dpaux_poll_register(dp, DPAUX_DP_AUXCTL, |
| DPAUX_DP_AUXCTL_TRANSACTREQ_MASK, |
| DPAUX_DP_AUXCTL_TRANSACTREQ_DONE, |
| 100, DP_AUX_TIMEOUT_MS * 1000) != 0) { |
| printk(BIOS_INFO, "dp: DPAUX transaction timeout\n"); |
| return -1; |
| } |
| return 0; |
| } |
| |
| static int tegra_dc_dpaux_write_chunk(struct tegra_dc_dp_data *dp, u32 cmd, |
| u32 addr, u8 *data, u32 *size, |
| u32 *aux_stat) |
| { |
| int i; |
| u32 reg_val; |
| u32 timeout_retries = DP_AUX_TIMEOUT_MAX_TRIES; |
| u32 defer_retries = DP_AUX_DEFER_MAX_TRIES; |
| u32 temp_data; |
| |
| if (*size > DP_AUX_MAX_BYTES) |
| return -1; /* only write one chunk of data */ |
| |
| /* Make sure the command is write command */ |
| switch (cmd) { |
| case DPAUX_DP_AUXCTL_CMD_I2CWR: |
| case DPAUX_DP_AUXCTL_CMD_MOTWR: |
| case DPAUX_DP_AUXCTL_CMD_AUXWR: |
| break; |
| default: |
| printk(BIOS_ERR, "dp: aux write cmd 0x%x is invalid\n", |
| cmd); |
| return -1; |
| } |
| |
| tegra_dpaux_writel(dp, DPAUX_DP_AUXADDR, addr); |
| for (i = 0; i < DP_AUX_MAX_BYTES / 4; ++i) { |
| memcpy(&temp_data, data, 4); |
| tegra_dpaux_writel(dp, DPAUX_DP_AUXDATA_WRITE_W(i), temp_data); |
| data += 4; |
| } |
| |
| reg_val = tegra_dpaux_readl(dp, DPAUX_DP_AUXCTL); |
| reg_val &= ~DPAUX_DP_AUXCTL_CMD_MASK; |
| reg_val |= cmd; |
| reg_val &= ~DPAUX_DP_AUXCTL_CMDLEN_FIELD; |
| reg_val |= ((*size - 1) << DPAUX_DP_AUXCTL_CMDLEN_SHIFT); |
| |
| while ((timeout_retries > 0) && (defer_retries > 0)) { |
| if ((timeout_retries != DP_AUX_TIMEOUT_MAX_TRIES) || |
| (defer_retries != DP_AUX_DEFER_MAX_TRIES)) |
| udelay(1); |
| |
| reg_val |= DPAUX_DP_AUXCTL_TRANSACTREQ_PENDING; |
| tegra_dpaux_writel(dp, DPAUX_DP_AUXCTL, reg_val); |
| |
| if (tegra_dpaux_wait_transaction(dp)) |
| printk(BIOS_ERR, "dp: aux write transaction timeout\n"); |
| |
| *aux_stat = tegra_dpaux_readl(dp, DPAUX_DP_AUXSTAT); |
| |
| if ((*aux_stat & DPAUX_DP_AUXSTAT_TIMEOUT_ERROR_PENDING) || |
| (*aux_stat & DPAUX_DP_AUXSTAT_RX_ERROR_PENDING) || |
| (*aux_stat & DPAUX_DP_AUXSTAT_SINKSTAT_ERROR_PENDING) || |
| (*aux_stat & DPAUX_DP_AUXSTAT_NO_STOP_ERROR_PENDING)) { |
| if (timeout_retries-- > 0) { |
| printk(BIOS_INFO, "dp: aux write retry (0x%x) -- %d\n", |
| *aux_stat, timeout_retries); |
| /* clear the error bits */ |
| tegra_dpaux_writel(dp, DPAUX_DP_AUXSTAT, *aux_stat); |
| continue; |
| } else { |
| printk(BIOS_ERR, "dp: aux write got error (0x%x)\n", |
| *aux_stat); |
| return -1; |
| } |
| } |
| |
| if ((*aux_stat & DPAUX_DP_AUXSTAT_REPLYTYPE_I2CDEFER) || |
| (*aux_stat & DPAUX_DP_AUXSTAT_REPLYTYPE_DEFER)) { |
| if (defer_retries-- > 0) { |
| printk(BIOS_INFO, "dp: aux write defer (0x%x) -- %d\n", |
| *aux_stat, defer_retries); |
| /* clear the error bits */ |
| tegra_dpaux_writel(dp, DPAUX_DP_AUXSTAT, *aux_stat); |
| continue; |
| } else { |
| printk(BIOS_ERR, "dp: aux write defer exceeds max retries " |
| "(0x%x)\n", *aux_stat); |
| return -1; |
| } |
| } |
| |
| if ((*aux_stat & DPAUX_DP_AUXSTAT_REPLYTYPE_MASK) == |
| DPAUX_DP_AUXSTAT_REPLYTYPE_ACK) { |
| *size = ((*aux_stat) & DPAUX_DP_AUXSTAT_REPLY_M_MASK); |
| return 0; |
| } else { |
| printk(BIOS_ERR, "dp: aux write failed (0x%x)\n", |
| *aux_stat); |
| return -1; |
| } |
| } |
| /* Should never come to here */ |
| return -1; |
| } |
| |
| static int tegra_dc_dpaux_read_chunk(struct tegra_dc_dp_data *dp, u32 cmd, |
| u32 addr, u8 *data, u32 *size, |
| u32 *aux_stat) |
| { |
| u32 reg_val; |
| u32 timeout_retries = DP_AUX_TIMEOUT_MAX_TRIES; |
| u32 defer_retries = DP_AUX_DEFER_MAX_TRIES; |
| |
| if (*size > DP_AUX_MAX_BYTES) |
| return -1; /* only read one chunk */ |
| |
| /* Check to make sure the command is read command */ |
| switch (cmd) { |
| case DPAUX_DP_AUXCTL_CMD_I2CRD: |
| case DPAUX_DP_AUXCTL_CMD_I2CREQWSTAT: |
| case DPAUX_DP_AUXCTL_CMD_MOTRD: |
| case DPAUX_DP_AUXCTL_CMD_AUXRD: |
| break; |
| default: |
| printk(BIOS_ERR, "dp: aux read cmd 0x%x is invalid\n", |
| cmd); |
| return -1; |
| } |
| |
| *aux_stat = tegra_dpaux_readl(dp, DPAUX_DP_AUXSTAT); |
| if (!(*aux_stat & DPAUX_DP_AUXSTAT_HPD_STATUS_PLUGGED)) { |
| printk(BIOS_SPEW, "dp: HPD is not detected\n"); |
| return -1; |
| } |
| |
| tegra_dpaux_writel(dp, DPAUX_DP_AUXADDR, addr); |
| |
| reg_val = tegra_dpaux_readl(dp, DPAUX_DP_AUXCTL); |
| reg_val &= ~DPAUX_DP_AUXCTL_CMD_MASK; |
| reg_val |= cmd; |
| reg_val &= ~DPAUX_DP_AUXCTL_CMDLEN_FIELD; |
| reg_val |= ((*size - 1) << DPAUX_DP_AUXCTL_CMDLEN_SHIFT); |
| while ((timeout_retries > 0) && (defer_retries > 0)) { |
| if ((timeout_retries != DP_AUX_TIMEOUT_MAX_TRIES) || |
| (defer_retries != DP_AUX_DEFER_MAX_TRIES)) |
| udelay(DP_DPCP_RETRY_SLEEP_NS * 2); |
| |
| reg_val |= DPAUX_DP_AUXCTL_TRANSACTREQ_PENDING; |
| tegra_dpaux_writel(dp, DPAUX_DP_AUXCTL, reg_val); |
| |
| if (tegra_dpaux_wait_transaction(dp)) |
| printk(BIOS_INFO, "dp: aux read transaction timeout\n"); |
| |
| *aux_stat = tegra_dpaux_readl(dp, DPAUX_DP_AUXSTAT); |
| |
| if ((*aux_stat & DPAUX_DP_AUXSTAT_TIMEOUT_ERROR_PENDING) || |
| (*aux_stat & DPAUX_DP_AUXSTAT_RX_ERROR_PENDING) || |
| (*aux_stat & DPAUX_DP_AUXSTAT_SINKSTAT_ERROR_PENDING) || |
| (*aux_stat & DPAUX_DP_AUXSTAT_NO_STOP_ERROR_PENDING)) { |
| if (timeout_retries-- > 0) { |
| printk(BIOS_INFO, "dp: aux read retry (0x%x)" |
| " -- %d\n", *aux_stat, |
| timeout_retries); |
| /* clear the error bits */ |
| tegra_dpaux_writel(dp, DPAUX_DP_AUXSTAT, |
| *aux_stat); |
| continue; /* retry */ |
| } else { |
| printk(BIOS_ERR, "dp: aux read got error" |
| " (0x%x)\n", *aux_stat); |
| return -1; |
| } |
| } |
| |
| if ((*aux_stat & DPAUX_DP_AUXSTAT_REPLYTYPE_I2CDEFER) || |
| (*aux_stat & DPAUX_DP_AUXSTAT_REPLYTYPE_DEFER)) { |
| if (defer_retries-- > 0) { |
| printk(BIOS_INFO, "dp: aux read defer (0x%x) -- %d\n", |
| *aux_stat, defer_retries); |
| /* clear the error bits */ |
| tegra_dpaux_writel(dp, DPAUX_DP_AUXSTAT, *aux_stat); |
| continue; |
| } else { |
| printk(BIOS_INFO, "dp: aux read defer exceeds max retries " |
| "(0x%x)\n", *aux_stat); |
| return -1; |
| } |
| } |
| |
| if ((*aux_stat & DPAUX_DP_AUXSTAT_REPLYTYPE_MASK) == |
| DPAUX_DP_AUXSTAT_REPLYTYPE_ACK) { |
| int i; |
| u32 temp_data[4]; |
| |
| for (i = 0; i < DP_AUX_MAX_BYTES / 4; ++i) |
| temp_data[i] = tegra_dpaux_readl(dp, |
| DPAUX_DP_AUXDATA_READ_W(i)); |
| |
| *size = ((*aux_stat) & DPAUX_DP_AUXSTAT_REPLY_M_MASK); |
| memcpy(data, temp_data, *size); |
| |
| return 0; |
| } else { |
| printk(BIOS_ERR, "dp: aux read failed (0x%x\n", |
| *aux_stat); |
| return -1; |
| } |
| } |
| /* Should never come to here */ |
| printk(BIOS_ERR, "%s: can't\n", __func__); |
| return -1; |
| } |
| |
| static int tegra_dc_dpaux_read(struct tegra_dc_dp_data *dp, u32 cmd, u32 addr, |
| u8 *data, u32 *size, u32 *aux_stat) |
| { |
| u32 finished = 0; |
| u32 cur_size; |
| int ret = 0; |
| |
| do { |
| cur_size = *size - finished; |
| if (cur_size > DP_AUX_MAX_BYTES) |
| cur_size = DP_AUX_MAX_BYTES; |
| |
| ret = tegra_dc_dpaux_read_chunk(dp, cmd, addr, |
| data, &cur_size, aux_stat); |
| if (ret) |
| break; |
| |
| /* cur_size should be the real size returned */ |
| addr += cur_size; |
| data += cur_size; |
| finished += cur_size; |
| |
| } while (*size > finished); |
| |
| *size = finished; |
| return ret; |
| } |
| |
| static int tegra_dc_dp_dpcd_read(struct tegra_dc_dp_data *dp, u32 cmd, |
| u8 *data_ptr) |
| { |
| u32 size = 1; |
| u32 status = 0; |
| int ret; |
| |
| ret = tegra_dc_dpaux_read_chunk(dp, DPAUX_DP_AUXCTL_CMD_AUXRD, |
| cmd, data_ptr, &size, &status); |
| if (ret) |
| printk(BIOS_ERR, |
| "dp: Failed to read DPCD data. CMD 0x%x, Status 0x%x\n", |
| cmd, status); |
| |
| return ret; |
| } |
| |
| static int tegra_dc_dp_dpcd_write(struct tegra_dc_dp_data *dp, u32 cmd, |
| u8 data) |
| { |
| u32 size = 1; |
| u32 status = 0; |
| int ret; |
| |
| ret = tegra_dc_dpaux_write_chunk(dp, DPAUX_DP_AUXCTL_CMD_AUXWR, |
| cmd, &data, &size, &status); |
| if (ret) |
| printk(BIOS_ERR, |
| "dp: Failed to write DPCD data. CMD 0x%x, Status 0x%x\n", |
| cmd, status); |
| return ret; |
| } |
| |
| static int tegra_dc_i2c_aux_read(struct tegra_dc_dp_data *dp, u32 i2c_addr, |
| u8 addr, u8 *data, u32 *size, u32 *aux_stat) |
| { |
| u32 finished = 0; |
| int ret = 0; |
| |
| do { |
| u32 cur_size = MIN(DP_AUX_MAX_BYTES, *size - finished); |
| |
| u32 len = 1; |
| ret = tegra_dc_dpaux_write_chunk( |
| dp, DPAUX_DP_AUXCTL_CMD_MOTWR, i2c_addr, |
| &addr, &len, aux_stat); |
| if (ret) { |
| printk(BIOS_ERR, "%s: error sending address to read.\n", |
| __func__); |
| break; |
| } |
| |
| ret = tegra_dc_dpaux_read_chunk( |
| dp, DPAUX_DP_AUXCTL_CMD_I2CRD, i2c_addr, |
| data, &cur_size, aux_stat); |
| if (ret) { |
| printk(BIOS_ERR, "%s: error reading data.\n", __func__); |
| break; |
| } |
| |
| /* cur_size should be the real size returned */ |
| addr += cur_size; |
| data += cur_size; |
| finished += cur_size; |
| } while (*size > finished); |
| |
| *size = finished; |
| return ret; |
| } |
| |
| static void tegra_dc_dpaux_enable(struct tegra_dc_dp_data *dp) |
| { |
| /* clear interrupt */ |
| tegra_dpaux_writel(dp, DPAUX_INTR_AUX, 0xffffffff); |
| /* do not enable interrupt for now. Enable them when Isr in place */ |
| tegra_dpaux_writel(dp, DPAUX_INTR_EN_AUX, 0x0); |
| |
| tegra_dpaux_writel(dp, DPAUX_HYBRID_PADCTL, |
| DPAUX_HYBRID_PADCTL_AUX_DRVZ_OHM_50 | |
| DPAUX_HYBRID_PADCTL_AUX_CMH_V0_70 | |
| 0x18 << DPAUX_HYBRID_PADCTL_AUX_DRVI_SHIFT | |
| DPAUX_HYBRID_PADCTL_AUX_INPUT_RCV_ENABLE); |
| |
| tegra_dpaux_writel(dp, DPAUX_HYBRID_SPARE, |
| DPAUX_HYBRID_SPARE_PAD_PWR_POWERUP); |
| } |
| |
| static void tegra_dc_dp_dump_link_cfg(struct tegra_dc_dp_data *dp, |
| const struct tegra_dc_dp_link_config *link_cfg) |
| { |
| printk(BIOS_INFO, "DP config: cfg_name " |
| "cfg_value\n"); |
| printk(BIOS_INFO, " Lane Count %d\n", |
| link_cfg->max_lane_count); |
| printk(BIOS_INFO, " SupportEnhancedFraming %s\n", |
| link_cfg->support_enhanced_framing ? "Y" : "N"); |
| printk(BIOS_INFO, " Bandwidth %d\n", |
| link_cfg->max_link_bw); |
| printk(BIOS_INFO, " bpp %d\n", |
| link_cfg->bits_per_pixel); |
| printk(BIOS_INFO, " EnhancedFraming %s\n", |
| link_cfg->enhanced_framing ? "Y" : "N"); |
| printk(BIOS_INFO, " Scramble_enabled %s\n", |
| link_cfg->scramble_ena ? "Y" : "N"); |
| printk(BIOS_INFO, " LinkBW %d\n", |
| link_cfg->link_bw); |
| printk(BIOS_INFO, " lane_count %d\n", |
| link_cfg->lane_count); |
| printk(BIOS_INFO, " activespolarity %d\n", |
| link_cfg->activepolarity); |
| printk(BIOS_INFO, " active_count %d\n", |
| link_cfg->active_count); |
| printk(BIOS_INFO, " tu_size %d\n", |
| link_cfg->tu_size); |
| printk(BIOS_INFO, " active_frac %d\n", |
| link_cfg->active_frac); |
| printk(BIOS_INFO, " watermark %d\n", |
| link_cfg->watermark); |
| printk(BIOS_INFO, " hblank_sym %d\n", |
| link_cfg->hblank_sym); |
| printk(BIOS_INFO, " vblank_sym %d\n", |
| link_cfg->vblank_sym); |
| } |
| |
| static int _tegra_dp_lower_link_config(struct tegra_dc_dp_data *dp, |
| struct tegra_dc_dp_link_config *cfg) |
| { |
| |
| switch (cfg->link_bw){ |
| case SOR_LINK_SPEED_G1_62: |
| if (cfg->max_link_bw > SOR_LINK_SPEED_G1_62) |
| cfg->link_bw = SOR_LINK_SPEED_G2_7; |
| cfg->lane_count /= 2; |
| break; |
| case SOR_LINK_SPEED_G2_7: |
| cfg->link_bw = SOR_LINK_SPEED_G1_62; |
| break; |
| case SOR_LINK_SPEED_G5_4: |
| if (cfg->lane_count == 1) { |
| cfg->link_bw = SOR_LINK_SPEED_G2_7; |
| cfg->lane_count = cfg->max_lane_count; |
| } else |
| cfg->lane_count /= 2; |
| break; |
| default: |
| printk(BIOS_ERR,"dp: Error link rate %d\n", cfg->link_bw); |
| return DP_LT_FAILED; |
| } |
| |
| return (cfg->lane_count > 0) ? DP_LT_SUCCESS : DP_LT_FAILED; |
| } |
| |
| /* Calculate if given cfg can meet the mode request. */ |
| /* Return true if mode is possible, false otherwise. */ |
| static int tegra_dc_dp_calc_config(struct tegra_dc_dp_data *dp, |
| const struct soc_nvidia_tegra124_config *config, |
| struct tegra_dc_dp_link_config *link_cfg) |
| { |
| const u32 link_rate = 27 * link_cfg->link_bw * 1000 * 1000; |
| const u64 f = 100000; /* precision factor */ |
| |
| u32 num_linkclk_line; /* Number of link clocks per line */ |
| u64 ratio_f; /* Ratio of incoming to outgoing data rate */ |
| |
| u64 frac_f; |
| u64 activesym_f; /* Activesym per TU */ |
| u64 activecount_f; |
| u32 activecount; |
| u32 activepolarity; |
| u64 approx_value_f; |
| u32 activefrac = 0; |
| u64 accumulated_error_f = 0; |
| u32 lowest_neg_activecount = 0; |
| u32 lowest_neg_activepolarity = 0; |
| u32 lowest_neg_tusize = 64; |
| u32 num_symbols_per_line; |
| u64 lowest_neg_activefrac = 0; |
| u64 lowest_neg_error_f = 64 * f; |
| u64 watermark_f; |
| |
| int i; |
| int neg; |
| |
| if (!link_rate || !link_cfg->lane_count || !config->pixel_clock || |
| !link_cfg->bits_per_pixel) |
| return -1; |
| |
| if ((u64)config->pixel_clock * link_cfg->bits_per_pixel >= |
| (u64)link_rate * 8 * link_cfg->lane_count) |
| return -1; |
| |
| num_linkclk_line = (u32)((u64)link_rate * (u64)config->xres / config->pixel_clock); |
| |
| ratio_f = (u64)config->pixel_clock * link_cfg->bits_per_pixel * f; |
| ratio_f /= 8; |
| ratio_f = (u64)(ratio_f / (link_rate * link_cfg->lane_count)); |
| |
| for (i = 64; i >= 32; --i) { |
| activesym_f = ratio_f * i; |
| activecount_f = (u64)(activesym_f / (u32)f) * f; |
| frac_f = activesym_f - activecount_f; |
| activecount = (u32)((u64)(activecount_f / (u32)f)); |
| |
| if (frac_f < (f / 2)) /* fraction < 0.5 */ |
| activepolarity = 0; |
| else { |
| activepolarity = 1; |
| frac_f = f - frac_f; |
| } |
| |
| if (frac_f != 0) { |
| frac_f = (u64)((f * f) / frac_f); /* 1/fraction */ |
| if (frac_f > (15 * f)) |
| activefrac = activepolarity ? 1 : 15; |
| else |
| activefrac = activepolarity ? |
| (u32)((u64)(frac_f / (u32)f)) + 1 : |
| (u32)((u64)(frac_f / (u32)f)); |
| } |
| |
| if (activefrac == 1) |
| activepolarity = 0; |
| |
| if (activepolarity == 1) |
| approx_value_f = activefrac ? (u64)( |
| (activecount_f + (activefrac * f - f) * f) / |
| (activefrac * f)) : |
| activecount_f + f; |
| else |
| approx_value_f = activefrac ? |
| activecount_f + (u64)(f / activefrac) : |
| activecount_f; |
| |
| if (activesym_f < approx_value_f) { |
| accumulated_error_f = num_linkclk_line * |
| (u64)((approx_value_f - activesym_f) / i); |
| neg = 1; |
| } else { |
| accumulated_error_f = num_linkclk_line * |
| (u64)((activesym_f - approx_value_f) / i); |
| neg = 0; |
| } |
| |
| if ((neg && (lowest_neg_error_f > accumulated_error_f)) || |
| (accumulated_error_f == 0)) { |
| lowest_neg_error_f = accumulated_error_f; |
| lowest_neg_tusize = i; |
| lowest_neg_activecount = activecount; |
| lowest_neg_activepolarity = activepolarity; |
| lowest_neg_activefrac = activefrac; |
| |
| if (accumulated_error_f == 0) |
| break; |
| } |
| } |
| |
| if (lowest_neg_activefrac == 0) { |
| link_cfg->activepolarity = 0; |
| link_cfg->active_count = lowest_neg_activepolarity ? |
| lowest_neg_activecount : lowest_neg_activecount - 1; |
| link_cfg->tu_size = lowest_neg_tusize; |
| link_cfg->active_frac = 1; |
| } else { |
| link_cfg->activepolarity = lowest_neg_activepolarity; |
| link_cfg->active_count = (u32)lowest_neg_activecount; |
| link_cfg->tu_size = lowest_neg_tusize; |
| link_cfg->active_frac = (u32)lowest_neg_activefrac; |
| } |
| |
| watermark_f = (u64)((ratio_f * link_cfg->tu_size * (f - ratio_f)) / f); |
| link_cfg->watermark = (u32)((u64)((watermark_f + lowest_neg_error_f) / |
| f)) + link_cfg->bits_per_pixel / 4 - 1; |
| num_symbols_per_line = (config->xres * link_cfg->bits_per_pixel) / |
| (8 * link_cfg->lane_count); |
| |
| if (link_cfg->watermark > 30) { |
| printk(BIOS_INFO, |
| "dp: sor setting: unable to get a good tusize, " |
| "force watermark to 30.\n"); |
| link_cfg->watermark = 30; |
| return -1; |
| } else if (link_cfg->watermark > num_symbols_per_line) { |
| printk(BIOS_INFO, |
| "dp: sor setting: force watermark to the number " |
| "of symbols in the line.\n"); |
| link_cfg->watermark = num_symbols_per_line; |
| return -1; |
| } |
| |
| /* Refer to dev_disp.ref for more information. */ |
| /* # symbols/hblank = ((SetRasterBlankEnd.X + SetRasterSize.Width - */ |
| /* SetRasterBlankStart.X - 7) * link_clk / pclk) */ |
| /* - 3 * enhanced_framing - Y */ |
| /* where Y = (# lanes == 4) 3 : (# lanes == 2) ? 6 : 12 */ |
| link_cfg->hblank_sym = (int)((u64)(((u64)(config->hback_porch + |
| config->hfront_porch + config->hsync_width - 7) * |
| link_rate) / config->pixel_clock)) - |
| 3 * link_cfg->enhanced_framing - |
| (12 / link_cfg->lane_count); |
| |
| if (link_cfg->hblank_sym < 0) |
| link_cfg->hblank_sym = 0; |
| |
| /* Refer to dev_disp.ref for more information. */ |
| /* # symbols/vblank = ((SetRasterBlankStart.X - */ |
| /* SetRasterBlankEen.X - 25) * link_clk / pclk) */ |
| /* - Y - 1; */ |
| /* where Y = (# lanes == 4) 12 : (# lanes == 2) ? 21 : 39 */ |
| link_cfg->vblank_sym = (int)((u64)((u64)(config->xres - 25) |
| * link_rate / config->pixel_clock)) - (36 / |
| link_cfg->lane_count) - 4; |
| |
| if (link_cfg->vblank_sym < 0) |
| link_cfg->vblank_sym = 0; |
| |
| link_cfg->is_valid = 1; |
| tegra_dc_dp_dump_link_cfg(dp, link_cfg); |
| |
| return 0; |
| } |
| |
| static int tegra_dc_dp_init_max_link_cfg( |
| struct soc_nvidia_tegra124_config *config, |
| struct tegra_dc_dp_data *dp, |
| struct tegra_dc_dp_link_config *link_cfg) |
| { |
| u8 dpcd_data; |
| int ret; |
| |
| CHECK_RET(tegra_dc_dp_dpcd_read(dp, NV_DPCD_MAX_LANE_COUNT, |
| &dpcd_data)); |
| link_cfg->max_lane_count = dpcd_data & NV_DPCD_MAX_LANE_COUNT_MASK; |
| link_cfg->tps3_supported = (dpcd_data & |
| NV_DPCD_MAX_LANE_COUNT_TPS3_SUPPORTED_YES) ? 1 : 0; |
| |
| link_cfg->support_enhanced_framing = |
| (dpcd_data & NV_DPCD_MAX_LANE_COUNT_ENHANCED_FRAMING_YES) ? |
| 1 : 0; |
| |
| CHECK_RET(tegra_dc_dp_dpcd_read(dp, NV_DPCD_MAX_DOWNSPREAD, |
| &dpcd_data)); |
| link_cfg->downspread = (dpcd_data & NV_DPCD_MAX_DOWNSPREAD_VAL_0_5_PCT)? |
| 1 : 0; |
| |
| CHECK_RET(tegra_dc_dp_dpcd_read(dp, NV_DPCD_TRAINING_AUX_RD_INTERVAL, |
| &link_cfg->aux_rd_interval)); |
| |
| CHECK_RET(tegra_dc_dp_dpcd_read(dp, NV_DPCD_MAX_LINK_BANDWIDTH, |
| &link_cfg->max_link_bw)); |
| |
| link_cfg->bits_per_pixel = config->panel_bits_per_pixel; |
| |
| /* |
| * Set to a high value for link training and attach. |
| * Will be re-programmed when dp is enabled. |
| */ |
| link_cfg->drive_current = config->drive_current; |
| link_cfg->preemphasis = config->preemphasis; |
| link_cfg->postcursor = config->postcursor; |
| |
| CHECK_RET(tegra_dc_dp_dpcd_read(dp, NV_DPCD_EDP_CONFIG_CAP, |
| &dpcd_data)); |
| link_cfg->alt_scramber_reset_cap = |
| (dpcd_data & NV_DPCD_EDP_CONFIG_CAP_ASC_RESET_YES) ? |
| 1 : 0; |
| link_cfg->only_enhanced_framing = |
| (dpcd_data & NV_DPCD_EDP_CONFIG_CAP_FRAMING_CHANGE_YES) ? |
| 1 : 0; |
| |
| link_cfg->lane_count = link_cfg->max_lane_count; |
| link_cfg->link_bw = link_cfg->max_link_bw; |
| link_cfg->enhanced_framing = link_cfg->support_enhanced_framing; |
| |
| tegra_dc_dp_calc_config(dp, config, link_cfg); |
| return 0; |
| } |
| |
| static int tegra_dc_dp_set_assr(struct tegra_dc_dp_data *dp, int ena) |
| { |
| int ret; |
| |
| u8 dpcd_data = ena ? |
| NV_DPCD_EDP_CONFIG_SET_ASC_RESET_ENABLE : |
| NV_DPCD_EDP_CONFIG_SET_ASC_RESET_DISABLE; |
| |
| CHECK_RET(tegra_dc_dp_dpcd_write(dp, NV_DPCD_EDP_CONFIG_SET, |
| dpcd_data)); |
| |
| /* Also reset the scrambler to 0xfffe */ |
| tegra_dc_sor_set_internal_panel(&dp->sor, ena); |
| return 0; |
| } |
| |
| static int tegra_dp_set_link_bandwidth(struct tegra_dc_dp_data *dp, u8 link_bw) |
| { |
| tegra_dc_sor_set_link_bandwidth(&dp->sor, link_bw); |
| |
| /* Sink side */ |
| return tegra_dc_dp_dpcd_write(dp, NV_DPCD_LINK_BANDWIDTH_SET, link_bw); |
| } |
| |
| static int tegra_dp_set_lane_count(struct tegra_dc_dp_data *dp, |
| const struct tegra_dc_dp_link_config *link_cfg) |
| { |
| u8 dpcd_data; |
| int ret; |
| |
| /* check if panel support enhanched_framing */ |
| dpcd_data = link_cfg->lane_count; |
| if (link_cfg->enhanced_framing) |
| dpcd_data |= NV_DPCD_LANE_COUNT_SET_ENHANCEDFRAMING_T; |
| CHECK_RET(tegra_dc_dp_dpcd_write(dp, NV_DPCD_LANE_COUNT_SET, |
| dpcd_data)); |
| |
| tegra_dc_sor_set_lane_count(&dp->sor, link_cfg->lane_count); |
| |
| /* Also power down lanes that will not be used */ |
| return 0; |
| } |
| |
| static int tegra_dc_dp_link_trained(struct tegra_dc_dp_data *dp, |
| const struct tegra_dc_dp_link_config *cfg) |
| { |
| u32 lane; |
| u8 mask; |
| u8 data; |
| int ret; |
| |
| for (lane = 0; lane < cfg->lane_count; ++lane) { |
| CHECK_RET(tegra_dc_dp_dpcd_read(dp, (lane/2) ? |
| NV_DPCD_LANE2_3_STATUS : NV_DPCD_LANE0_1_STATUS, |
| &data)); |
| mask = (lane & 1) ? |
| NV_DPCD_STATUS_LANEXPLUS1_CR_DONE_YES | |
| NV_DPCD_STATUS_LANEXPLUS1_CHN_EQ_DONE_YES | |
| NV_DPCD_STATUS_LANEXPLUS1_SYMBOL_LOCKED_YES : |
| NV_DPCD_STATUS_LANEX_CR_DONE_YES | |
| NV_DPCD_STATUS_LANEX_CHN_EQ_DONE_YES | |
| NV_DPCD_STATUS_LANEX_SYMBOL_LOCKED_YES; |
| if ((data & mask) != mask) |
| return -1; |
| } |
| return 0; |
| } |
| |
| static int tegra_dp_channel_eq_status(struct tegra_dc_dp_data *dp) |
| { |
| u32 cnt; |
| u32 n_lanes = dp->link_cfg.lane_count; |
| u8 data; |
| u8 ce_done = 1; |
| |
| for (cnt = 0; cnt < n_lanes / 2; cnt++) { |
| tegra_dc_dp_dpcd_read(dp, (NV_DPCD_LANE0_1_STATUS + cnt), &data); |
| |
| if (n_lanes == 1) { |
| ce_done = (data & |
| (0x1 << NV_DPCD_STATUS_LANEX_CHN_EQ_DONE_SHIFT)) && |
| (data & (0x1 << NV_DPCD_STATUS_LANEX_SYMBOL_LOCKED_SHFIT)); |
| break; |
| } else if (!(data & (0x1 << NV_DPCD_STATUS_LANEX_CHN_EQ_DONE_SHIFT)) || |
| !(data & (0x1 << NV_DPCD_STATUS_LANEX_SYMBOL_LOCKED_SHFIT)) || |
| !(data & (0x1 << NV_DPCD_STATUS_LANEXPLUS1_CHN_EQ_DONE_SHIFT)) || |
| !(data & (0x1 << NV_DPCD_STATUS_LANEXPLUS1_SYMBOL_LOCKED_SHIFT))) |
| return 0; |
| } |
| |
| if (ce_done) { |
| tegra_dc_dp_dpcd_read(dp, NV_DPCD_LANE_ALIGN_STATUS_UPDATED, &data); |
| if (!(data & NV_DPCD_LANE_ALIGN_STATUS_UPDATED_DONE_YES)) |
| ce_done = 0; |
| } |
| |
| return ce_done; |
| } |
| |
| static u8 tegra_dp_clock_recovery_status(struct tegra_dc_dp_data *dp) |
| { |
| u32 cnt; |
| u32 n_lanes = dp->link_cfg.lane_count; |
| u8 data_ptr; |
| |
| for (cnt = 0; cnt < n_lanes / 2; cnt++) { |
| tegra_dc_dp_dpcd_read(dp, |
| (NV_DPCD_LANE0_1_STATUS + cnt), &data_ptr); |
| |
| if (n_lanes == 1) |
| return (data_ptr & NV_DPCD_STATUS_LANEX_CR_DONE_YES) ? 1 : 0; |
| else if (!(data_ptr & NV_DPCD_STATUS_LANEX_CR_DONE_YES) || |
| !(data_ptr & |
| (NV_DPCD_STATUS_LANEXPLUS1_CR_DONE_YES))) |
| return 0; |
| } |
| |
| return 1; |
| } |
| |
| static void tegra_dp_lt_adjust(struct tegra_dc_dp_data *dp, |
| u32 pe[4], u32 vs[4], u32 pc[4], |
| u8 pc_supported) |
| { |
| size_t cnt; |
| u8 data_ptr; |
| u32 n_lanes = dp->link_cfg.lane_count; |
| |
| for (cnt = 0; cnt < n_lanes / 2; cnt++) { |
| tegra_dc_dp_dpcd_read(dp, |
| (NV_DPCD_LANE0_1_ADJUST_REQ + cnt), &data_ptr); |
| pe[2 * cnt] = (data_ptr & NV_DPCD_ADJUST_REQ_LANEX_PE_MASK) >> |
| NV_DPCD_ADJUST_REQ_LANEX_PE_SHIFT; |
| vs[2 * cnt] = (data_ptr & NV_DPCD_ADJUST_REQ_LANEX_DC_MASK) >> |
| NV_DPCD_ADJUST_REQ_LANEX_DC_SHIFT; |
| pe[1 + 2 * cnt] = |
| (data_ptr & NV_DPCD_ADJUST_REQ_LANEXPLUS1_PE_MASK) >> |
| NV_DPCD_ADJUST_REQ_LANEXPLUS1_PE_SHIFT; |
| vs[1 + 2 * cnt] = |
| (data_ptr & NV_DPCD_ADJUST_REQ_LANEXPLUS1_DC_MASK) >> |
| NV_DPCD_ADJUST_REQ_LANEXPLUS1_DC_SHIFT; |
| } |
| if (pc_supported) { |
| tegra_dc_dp_dpcd_read(dp, |
| NV_DPCD_ADJUST_REQ_POST_CURSOR2, &data_ptr); |
| for (cnt = 0; cnt < n_lanes; cnt++) { |
| pc[cnt] = (data_ptr >> |
| NV_DPCD_ADJUST_REQ_POST_CURSOR2_LANE_SHIFT(cnt)) & |
| NV_DPCD_ADJUST_REQ_POST_CURSOR2_LANE_MASK; |
| } |
| } |
| } |
| |
| static inline u32 tegra_dp_wait_aux_training(struct tegra_dc_dp_data *dp, |
| u8 is_clk_recovery) |
| { |
| if (!dp->link_cfg.aux_rd_interval) |
| is_clk_recovery ? udelay(200) : |
| udelay(500); |
| else |
| mdelay(dp->link_cfg.aux_rd_interval * 4); |
| |
| return dp->link_cfg.aux_rd_interval; |
| } |
| |
| static void tegra_dp_tpg(struct tegra_dc_dp_data *dp, u32 tp, u32 n_lanes) |
| { |
| u8 data = (tp == training_pattern_disabled) |
| ? (tp | NV_DPCD_TRAINING_PATTERN_SET_SC_DISABLED_F) |
| : (tp | NV_DPCD_TRAINING_PATTERN_SET_SC_DISABLED_T); |
| |
| tegra_dc_sor_set_dp_linkctl(&dp->sor, 1, tp, &dp->link_cfg); |
| tegra_dc_dp_dpcd_write(dp, NV_DPCD_TRAINING_PATTERN_SET, data); |
| } |
| |
| static int tegra_dp_link_config(struct tegra_dc_dp_data *dp, |
| const struct tegra_dc_dp_link_config *link_cfg) |
| { |
| u8 dpcd_data; |
| u32 retry; |
| |
| if (link_cfg->lane_count == 0) { |
| printk(BIOS_ERR, "dp: error: lane count is 0. " |
| "Can not set link config.\n"); |
| return DP_LT_FAILED; |
| } |
| |
| /* Set power state if it is not in normal level */ |
| if (tegra_dc_dp_dpcd_read(dp, NV_DPCD_SET_POWER, &dpcd_data)) |
| return DP_LT_FAILED; |
| |
| if (dpcd_data == NV_DPCD_SET_POWER_VAL_D3_PWRDWN) { |
| dpcd_data = NV_DPCD_SET_POWER_VAL_D0_NORMAL; |
| |
| /* DP spec requires 3 retries */ |
| for (retry = 3; retry > 0; --retry){ |
| if (tegra_dc_dp_dpcd_write(dp, NV_DPCD_SET_POWER, dpcd_data)) |
| break; |
| if (retry == 1){ |
| printk(BIOS_ERR, "dp: Failed to set DP panel power\n"); |
| return DP_LT_FAILED; |
| } |
| } |
| } |
| |
| /* Enable ASSR if possible */ |
| if (link_cfg->alt_scramber_reset_cap) |
| if (tegra_dc_dp_set_assr(dp, 1)) |
| return DP_LT_FAILED; |
| |
| if (tegra_dp_set_link_bandwidth(dp, link_cfg->link_bw)) { |
| printk(BIOS_ERR, "dp: Failed to set link bandwidth\n"); |
| return DP_LT_FAILED; |
| } |
| if (tegra_dp_set_lane_count(dp, link_cfg)) { |
| printk(BIOS_ERR, "dp: Failed to set lane count\n"); |
| return DP_LT_FAILED; |
| } |
| tegra_dc_sor_set_dp_linkctl(&dp->sor, 1, training_pattern_none, |
| link_cfg); |
| return DP_LT_SUCCESS; |
| } |
| |
| static int tegra_dp_lower_link_config(struct tegra_dc_dp_data *dp, |
| struct tegra_dc_dp_link_config *cfg) |
| { |
| struct tegra_dc_dp_link_config tmp_cfg; |
| |
| tmp_cfg = dp->link_cfg; |
| cfg->is_valid = 0; |
| |
| if (_tegra_dp_lower_link_config(dp, cfg)) |
| goto fail; |
| |
| if (tegra_dc_dp_calc_config(dp, dp->dc->config, cfg)) |
| goto fail; |
| tegra_dp_link_config(dp, cfg); |
| |
| return DP_LT_SUCCESS; |
| fail: |
| dp->link_cfg = tmp_cfg; |
| tegra_dp_link_config(dp, &tmp_cfg); |
| return DP_LT_FAILED; |
| } |
| |
| static void tegra_dp_lt_config(struct tegra_dc_dp_data *dp, |
| u32 pe[4], u32 vs[4], u32 pc[4]) |
| { |
| struct tegra_dc_sor_data *sor = &dp->sor; |
| u32 n_lanes = dp->link_cfg.lane_count; |
| u8 pc_supported = dp->link_cfg.tps3_supported; |
| u32 cnt; |
| u32 val; |
| |
| for (cnt = 0; cnt < n_lanes; cnt++) { |
| u32 mask = 0; |
| u32 pe_reg, vs_reg, pc_reg; |
| u32 shift = 0; |
| |
| switch (cnt) { |
| case 0: |
| mask = NV_SOR_PR_LANE2_DP_LANE0_MASK; |
| shift = NV_SOR_PR_LANE2_DP_LANE0_SHIFT; |
| break; |
| case 1: |
| mask = NV_SOR_PR_LANE1_DP_LANE1_MASK; |
| shift = NV_SOR_PR_LANE1_DP_LANE1_SHIFT; |
| break; |
| case 2: |
| mask = NV_SOR_PR_LANE0_DP_LANE2_MASK; |
| shift = NV_SOR_PR_LANE0_DP_LANE2_SHIFT; |
| break; |
| case 3: |
| mask = NV_SOR_PR_LANE3_DP_LANE3_MASK; |
| shift = NV_SOR_PR_LANE3_DP_LANE3_SHIFT; |
| break; |
| default: |
| printk(BIOS_ERR, |
| "dp: incorrect lane cnt\n"); |
| } |
| |
| pe_reg = tegra_dp_pe_regs[pc[cnt]][vs[cnt]][pe[cnt]]; |
| vs_reg = tegra_dp_vs_regs[pc[cnt]][vs[cnt]][pe[cnt]]; |
| pc_reg = tegra_dp_pc_regs[pc[cnt]][vs[cnt]][pe[cnt]]; |
| |
| tegra_dp_set_pe_vs_pc(sor, mask, pe_reg << shift, |
| vs_reg << shift, pc_reg << shift, pc_supported); |
| } |
| |
| tegra_dp_disable_tx_pu(&dp->sor); |
| udelay(20); |
| |
| for (cnt = 0; cnt < n_lanes; cnt++) { |
| u32 max_vs_flag = tegra_dp_is_max_vs(pe[cnt], vs[cnt]); |
| u32 max_pe_flag = tegra_dp_is_max_pe(pe[cnt], vs[cnt]); |
| |
| val = (vs[cnt] << NV_DPCD_TRAINING_LANEX_SET_DC_SHIFT) | |
| (max_vs_flag ? |
| NV_DPCD_TRAINING_LANEX_SET_DC_MAX_REACHED_T : |
| NV_DPCD_TRAINING_LANEX_SET_DC_MAX_REACHED_F) | |
| (pe[cnt] << NV_DPCD_TRAINING_LANEX_SET_PE_SHIFT) | |
| (max_pe_flag ? |
| NV_DPCD_TRAINING_LANEX_SET_PE_MAX_REACHED_T : |
| NV_DPCD_TRAINING_LANEX_SET_PE_MAX_REACHED_F); |
| tegra_dc_dp_dpcd_write(dp, |
| (NV_DPCD_TRAINING_LANE0_SET + cnt), val); |
| } |
| |
| if (pc_supported) { |
| for (cnt = 0; cnt < n_lanes / 2; cnt++) { |
| u32 max_pc_flag0 = tegra_dp_is_max_pc(pc[cnt]); |
| u32 max_pc_flag1 = tegra_dp_is_max_pc(pc[cnt + 1]); |
| val = (pc[cnt] << NV_DPCD_LANEX_SET2_PC2_SHIFT) | |
| (max_pc_flag0 ? |
| NV_DPCD_LANEX_SET2_PC2_MAX_REACHED_T : |
| NV_DPCD_LANEX_SET2_PC2_MAX_REACHED_F) | |
| (pc[cnt + 1] << |
| NV_DPCD_LANEXPLUS1_SET2_PC2_SHIFT) | |
| (max_pc_flag1 ? |
| NV_DPCD_LANEXPLUS1_SET2_PC2_MAX_REACHED_T : |
| NV_DPCD_LANEXPLUS1_SET2_PC2_MAX_REACHED_F); |
| tegra_dc_dp_dpcd_write(dp, |
| (NV_DPCD_TRAINING_LANE0_1_SET2 + cnt), val); |
| } |
| } |
| } |
| |
| static int _tegra_dp_channel_eq(struct tegra_dc_dp_data *dp, u32 pe[4], |
| u32 vs[4], u32 pc[4], u8 pc_supported, |
| u32 n_lanes) |
| { |
| u32 retry_cnt; |
| |
| for (retry_cnt = 0; retry_cnt < 4; retry_cnt++) { |
| if (retry_cnt){ |
| tegra_dp_lt_adjust(dp, pe, vs, pc, pc_supported); |
| tegra_dp_lt_config(dp, pe, vs, pc); |
| } |
| |
| tegra_dp_wait_aux_training(dp, 0); |
| |
| if (!tegra_dp_clock_recovery_status(dp)) { |
| printk(BIOS_ERR,"dp: CR failed in channel EQ sequence!\n"); |
| break; |
| } |
| |
| if (tegra_dp_channel_eq_status(dp)) |
| return DP_LT_SUCCESS; |
| } |
| |
| return DP_LT_FAILED; |
| } |
| |
| static int tegra_dp_channel_eq(struct tegra_dc_dp_data *dp, |
| u32 pe[4], u32 vs[4], u32 pc[4]) |
| { |
| u32 n_lanes = dp->link_cfg.lane_count; |
| u8 pc_supported = dp->link_cfg.tps3_supported; |
| int err; |
| u32 tp_src = training_pattern_2; |
| |
| if (pc_supported) |
| tp_src = training_pattern_3; |
| |
| tegra_dp_tpg(dp, tp_src, n_lanes); |
| |
| err = _tegra_dp_channel_eq(dp, pe, vs, pc, pc_supported, n_lanes); |
| |
| tegra_dp_tpg(dp, training_pattern_disabled, n_lanes); |
| |
| return err; |
| } |
| |
| static int _tegra_dp_clk_recovery(struct tegra_dc_dp_data *dp, u32 pe[4], |
| u32 vs[4], u32 pc[4], u8 pc_supported, |
| u32 n_lanes) |
| { |
| u32 vs_temp[4]; |
| u32 retry_cnt = 0; |
| |
| do { |
| tegra_dp_lt_config(dp, pe, vs, pc); |
| tegra_dp_wait_aux_training(dp, 1); |
| |
| if (tegra_dp_clock_recovery_status(dp)) |
| return DP_LT_SUCCESS; |
| |
| memcpy(vs_temp, vs, sizeof(vs_temp)); |
| tegra_dp_lt_adjust(dp, pe, vs, pc, pc_supported); |
| |
| if (memcmp(vs_temp, vs, sizeof(vs_temp))) |
| retry_cnt = 0; |
| else |
| ++retry_cnt; |
| } while (retry_cnt < 5); |
| |
| return DP_LT_FAILED; |
| } |
| |
| static int tegra_dp_clk_recovery(struct tegra_dc_dp_data *dp, |
| u32 pe[4], u32 vs[4], u32 pc[4]) |
| { |
| u32 n_lanes = dp->link_cfg.lane_count; |
| u8 pc_supported = dp->link_cfg.tps3_supported; |
| int err; |
| |
| tegra_dp_tpg(dp, training_pattern_1, n_lanes); |
| |
| err = _tegra_dp_clk_recovery(dp, pe, vs, pc, pc_supported, n_lanes); |
| if (err < 0) |
| tegra_dp_tpg(dp, training_pattern_disabled, n_lanes); |
| |
| return err; |
| } |
| |
| static int tegra_dc_dp_full_link_training(struct tegra_dc_dp_data *dp) |
| { |
| struct tegra_dc_sor_data *sor = &dp->sor; |
| int err; |
| u32 pe[4], vs[4], pc[4]; |
| |
| tegra_sor_precharge_lanes(sor); |
| |
| retry_cr: |
| memset(pe, preEmphasis_Disabled, sizeof(pe)); |
| memset(vs, driveCurrent_Level0, sizeof(vs)); |
| memset(pc, postCursor2_Level0, sizeof(pc)); |
| |
| err = tegra_dp_clk_recovery(dp, pe, vs, pc); |
| if (err != DP_LT_SUCCESS) { |
| if (!tegra_dp_lower_link_config(dp, &dp->link_cfg)) |
| goto retry_cr; |
| |
| printk(BIOS_ERR, "dp: clk recovery failed\n"); |
| goto fail; |
| } |
| |
| err = tegra_dp_channel_eq(dp, pe, vs, pc); |
| if (err != DP_LT_SUCCESS) { |
| if (!tegra_dp_lower_link_config(dp, &dp->link_cfg)) |
| goto retry_cr; |
| |
| printk(BIOS_ERR, |
| "dp: channel equalization failed\n"); |
| goto fail; |
| } |
| |
| tegra_dc_dp_dump_link_cfg(dp, &dp->link_cfg); |
| |
| return 0; |
| |
| fail: |
| return err; |
| } |
| /* |
| * All link training functions are ported from kernel dc driver. |
| * See more details at drivers/video/tegra/dc/dp.c |
| */ |
| static int tegra_dc_dp_fast_link_training(struct tegra_dc_dp_data *dp, |
| const struct tegra_dc_dp_link_config *link_cfg) |
| { |
| struct tegra_dc_sor_data *sor = &dp->sor; |
| u8 link_bw; |
| u8 lane_count; |
| u16 data16; |
| u32 data32; |
| u32 size; |
| u32 status; |
| int j; |
| u32 mask = 0xffff >> ((4 - link_cfg->lane_count) * 4); |
| |
| tegra_dc_sor_set_lane_parm(sor, link_cfg); |
| tegra_dc_dp_dpcd_write(dp, NV_DPCD_MAIN_LINK_CHANNEL_CODING_SET, |
| NV_DPCD_MAIN_LINK_CHANNEL_CODING_SET_ANSI_8B10B); |
| |
| /* Send TP1 */ |
| tegra_dc_sor_set_dp_linkctl(sor, 1, training_pattern_1, link_cfg); |
| tegra_dc_dp_dpcd_write(dp, NV_DPCD_TRAINING_PATTERN_SET, |
| NV_DPCD_TRAINING_PATTERN_SET_TPS_TP1); |
| |
| for (j = 0; j < link_cfg->lane_count; ++j) |
| tegra_dc_dp_dpcd_write(dp, NV_DPCD_TRAINING_LANE0_SET + j, |
| 0x24); |
| udelay(520); |
| |
| size = sizeof(data16); |
| tegra_dc_dpaux_read(dp, DPAUX_DP_AUXCTL_CMD_AUXRD, |
| NV_DPCD_LANE0_1_STATUS, (u8 *)&data16, &size, &status); |
| status = mask & 0x1111; |
| if ((data16 & status) != status) { |
| printk(BIOS_ERR, |
| "dp: Link training error for TP1 (%#x)\n", data16); |
| return -EFAULT; |
| } |
| |
| /* enable ASSR */ |
| tegra_dc_dp_set_assr(dp, link_cfg->scramble_ena); |
| tegra_dc_sor_set_dp_linkctl(sor, 1, training_pattern_3, link_cfg); |
| |
| tegra_dc_dp_dpcd_write(dp, NV_DPCD_TRAINING_PATTERN_SET, |
| link_cfg->link_bw == 20 ? 0x23 : 0x22); |
| for (j = 0; j < link_cfg->lane_count; ++j) |
| tegra_dc_dp_dpcd_write(dp, NV_DPCD_TRAINING_LANE0_SET + j, |
| 0x24); |
| udelay(520); |
| |
| size = sizeof(data32); |
| tegra_dc_dpaux_read(dp, DPAUX_DP_AUXCTL_CMD_AUXRD, |
| NV_DPCD_LANE0_1_STATUS, (u8 *)&data32, &size, &status); |
| if ((data32 & mask) != (0x7777 & mask)) { |
| printk(BIOS_ERR, |
| "dp: Link training error for TP2/3 (0x%x)\n", data32); |
| return -EFAULT; |
| } |
| |
| tegra_dc_sor_set_dp_linkctl(sor, 1, training_pattern_disabled, |
| link_cfg); |
| tegra_dc_dp_dpcd_write(dp, NV_DPCD_TRAINING_PATTERN_SET, 0); |
| |
| if (tegra_dc_dp_link_trained(dp, link_cfg)) { |
| tegra_dc_sor_read_link_config(&dp->sor, &link_bw, |
| &lane_count); |
| printk(BIOS_ERR, |
| "Fast link trainging failed, link bw %d, lane # %d\n", |
| link_bw, lane_count); |
| return -EFAULT; |
| } |
| |
| printk(BIOS_INFO, |
| "Fast link trainging succeeded, link bw %d, lane %d\n", |
| link_cfg->link_bw, link_cfg->lane_count); |
| |
| return 0; |
| } |
| |
| static int tegra_dp_do_link_training(struct tegra_dc_dp_data *dp, |
| const struct tegra_dc_dp_link_config *link_cfg) |
| { |
| u8 link_bw; |
| u8 lane_count; |
| int ret; |
| |
| /* Now do the fast link training for eDP */ |
| ret = tegra_dc_dp_fast_link_training(dp, link_cfg); |
| if (ret) { |
| printk(BIOS_ERR, "dp: fast link training failed\n"); |
| |
| /* Try full link training then */ |
| if (tegra_dc_dp_full_link_training(dp)){ |
| printk(BIOS_ERR, "dp: full link training failed\n"); |
| return ret; |
| } |
| } else { |
| /* set to a known-good drive setting if fast link succeeded */ |
| tegra_dc_sor_set_voltage_swing(&dp->sor); |
| } |
| |
| /* Everything goes well, double check the link config */ |
| /* TODO: record edc/c2 data for debugging */ |
| tegra_dc_sor_read_link_config(&dp->sor, &link_bw, &lane_count); |
| |
| if ((link_cfg->link_bw == link_bw) && |
| (link_cfg->lane_count == lane_count)) |
| return 0; |
| else |
| return -EFAULT; |
| } |
| |
| static int tegra_dc_dp_explore_link_cfg(struct tegra_dc_dp_data *dp, |
| struct tegra_dc_dp_link_config *link_cfg, |
| const struct soc_nvidia_tegra124_config *config) |
| { |
| struct tegra_dc_dp_link_config temp_cfg; |
| |
| if (!config->pixel_clock || !config->xres || !config->yres) { |
| printk(BIOS_ERR, |
| "dp: error mode configuration"); |
| return -EINVAL; |
| } |
| if (!link_cfg->max_link_bw || !link_cfg->max_lane_count) { |
| printk(BIOS_ERR, |
| "dp: error link configuration"); |
| return -EINVAL; |
| } |
| |
| link_cfg->is_valid = 0; |
| |
| memcpy(&temp_cfg, link_cfg, sizeof(temp_cfg)); |
| |
| temp_cfg.link_bw = temp_cfg.max_link_bw; |
| temp_cfg.lane_count = temp_cfg.max_lane_count; |
| |
| /* |
| * set to max link config |
| */ |
| if ((!tegra_dc_dp_calc_config(dp, config, &temp_cfg)) && |
| (!tegra_dp_link_config(dp, &temp_cfg)) && |
| (!tegra_dp_do_link_training(dp, &temp_cfg))) |
| /* the max link cfg is doable */ |
| memcpy(link_cfg, &temp_cfg, sizeof(temp_cfg)); |
| |
| return link_cfg->is_valid ? 0 : -EFAULT; |
| } |
| |
| static void tegra_dp_update_config(struct tegra_dc_dp_data *dp, |
| struct soc_nvidia_tegra124_config *config) |
| { |
| struct edid edid; |
| u8 buf[128] = {0}; |
| u32 size = sizeof(buf), aux_stat = 0; |
| |
| tegra_dc_dpaux_enable(dp); |
| if (tegra_dc_i2c_aux_read(dp, TEGRA_EDID_I2C_ADDRESS, 0, buf, &size, |
| &aux_stat)) { |
| printk(BIOS_ERR, "%s: Failed to read EDID. Use defaults.\n", |
| __func__); |
| return; |
| } |
| |
| if (decode_edid(buf, sizeof(buf), &edid) != EDID_CONFORMANT) { |
| printk(BIOS_ERR, "%s: Failed to decode EDID. Use defaults.\n", |
| __func__); |
| return; |
| } |
| |
| config->xres = edid.mode.ha; |
| config->yres = edid.mode.va; |
| config->pixel_clock = edid.mode.pixel_clock * 1000; |
| |
| config->hfront_porch = edid.mode.hso; |
| config->hsync_width = edid.mode.hspw; |
| config->hback_porch = edid.mode.hbl - edid.mode.hso - edid.mode.hspw; |
| |
| config->vfront_porch = edid.mode.vso; |
| config->vsync_width = edid.mode.vspw; |
| config->vback_porch = edid.mode.vbl - edid.mode.vso - edid.mode.vspw; |
| |
| /** |
| * Note edid->framebuffer_bits_per_pixel is currently hard-coded as 32, |
| * so we should keep the default value in device config. |
| * |
| * EDID v1.3 panels may not have color depth info, so we need to check |
| * if these values are zero before updating config. |
| */ |
| if (edid.panel_bits_per_pixel) |
| config->panel_bits_per_pixel = edid.panel_bits_per_pixel; |
| if (edid.panel_bits_per_color) |
| config->color_depth = edid.panel_bits_per_color; |
| printk(BIOS_SPEW, "%s: configuration updated by EDID.\n", __func__); |
| } |
| |
| void dp_init(void *_config) |
| { |
| struct soc_nvidia_tegra124_config *config = (void *)_config; |
| struct tegra_dc *dc = config->dc_data; |
| struct tegra_dc_dp_data *dp = &dp_data; |
| |
| // set up links among config, dc, dp and sor |
| dp->dc = dc; |
| dc->out = dp; |
| dp->sor.dc = dc; |
| |
| dp->sor.power_is_up = 0; |
| dp->sor.base = (void *)TEGRA_ARM_SOR; |
| dp->sor.pmc_base = (void *)TEGRA_PMC_BASE; |
| dp->sor.portnum = 0; |
| dp->sor.link_cfg = &dp->link_cfg; |
| dp->aux_base = (void *)TEGRA_ARM_DPAUX; |
| dp->link_cfg.is_valid = 0; |
| dp->enabled = 0; |
| |
| tegra_dp_update_config(dp, config); |
| } |
| |
| static void tegra_dp_hpd_config(struct tegra_dc_dp_data *dp, |
| struct soc_nvidia_tegra124_config *config) |
| { |
| u32 val; |
| |
| val = config->hpd_plug_min_us | |
| (config->hpd_unplug_min_us << |
| DPAUX_HPD_CONFIG_UNPLUG_MIN_TIME_SHIFT); |
| tegra_dpaux_writel(dp, DPAUX_HPD_CONFIG, val); |
| |
| tegra_dpaux_writel(dp, DPAUX_HPD_IRQ_CONFIG, config->hpd_irq_min_us); |
| } |
| |
| static int tegra_dp_hpd_plug(struct tegra_dc_dp_data *dp, int timeout_ms) |
| { |
| u32 val; |
| u32 timeout = timeout_ms * 1000; |
| do { |
| val = tegra_dpaux_readl(dp, DPAUX_DP_AUXSTAT); |
| if (val & DPAUX_DP_AUXSTAT_HPD_STATUS_PLUGGED) |
| return 0; |
| udelay(100); |
| timeout -= 100; |
| } while (timeout > 0); |
| return -1; |
| } |
| |
| void dp_enable(void *_dp) |
| { |
| struct tegra_dc_dp_data *dp = _dp; |
| struct tegra_dc *dc = dp->dc; |
| struct soc_nvidia_tegra124_config *config = dc->config; |
| |
| u8 data; |
| u32 retry; |
| int ret; |
| |
| tegra_dc_dpaux_enable(dp); |
| |
| tegra_dp_hpd_config(dp, config); |
| if (tegra_dp_hpd_plug(dp, config->vdd_to_hpd_delay_ms) < 0) { |
| printk(BIOS_ERR, "dp: hpd plug failed\n"); |
| goto error_enable; |
| } |
| |
| if (tegra_dc_dp_init_max_link_cfg(config, dp, &dp->link_cfg)) { |
| printk(BIOS_ERR, "dp: failed to init link configuration\n"); |
| goto error_enable; |
| } |
| |
| tegra_dc_sor_enable_dp(&dp->sor); |
| |
| tegra_dc_sor_set_panel_power(&dp->sor, 1); |
| |
| /* Write power on to DPCD */ |
| data = NV_DPCD_SET_POWER_VAL_D0_NORMAL; |
| retry = 0; |
| do { |
| ret = tegra_dc_dp_dpcd_write(dp, |
| NV_DPCD_SET_POWER, data); |
| } while ((retry++ < DP_POWER_ON_MAX_TRIES) && ret); |
| |
| if (ret || retry >= DP_POWER_ON_MAX_TRIES) { |
| printk(BIOS_ERR, |
| "dp: failed to power on panel (0x%x)\n", ret); |
| goto error_enable; |
| } |
| |
| /* Confirm DP is plugging status */ |
| if (!(tegra_dpaux_readl(dp, DPAUX_DP_AUXSTAT) & |
| DPAUX_DP_AUXSTAT_HPD_STATUS_PLUGGED)) { |
| printk(BIOS_ERR, "dp: could not detect HPD\n"); |
| goto error_enable; |
| } |
| |
| /* Check DP version */ |
| if (tegra_dc_dp_dpcd_read(dp, NV_DPCD_REV, &dp->revision)) |
| printk(BIOS_ERR, |
| "dp: failed to read the revision number from sink\n"); |
| |
| if (tegra_dc_dp_explore_link_cfg(dp, &dp->link_cfg, config)) { |
| printk(BIOS_ERR, "dp: error to configure link\n"); |
| goto error_enable; |
| } |
| |
| tegra_dc_sor_set_power_state(&dp->sor, 1); |
| tegra_dc_sor_attach(&dp->sor); |
| |
| /* |
| * Power down the unused lanes to save power |
| * (about hundreds milli-watts, varies from boards). |
| */ |
| tegra_dc_sor_power_down_unused_lanes(&dp->sor); |
| |
| dp->enabled = 1; |
| error_enable: |
| return; |
| } |