328 строки
9.9 KiB
C
328 строки
9.9 KiB
C
/*
|
|
* Copyright © 2018 Intel Corporation
|
|
*
|
|
* 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 (including the next
|
|
* paragraph) 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 AUTHORS OR COPYRIGHT HOLDERS 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:
|
|
* Madhav Chauhan <madhav.chauhan@intel.com>
|
|
* Jani Nikula <jani.nikula@intel.com>
|
|
*/
|
|
|
|
#include "intel_dsi.h"
|
|
|
|
static void dsi_program_swing_and_deemphasis(struct intel_encoder *encoder)
|
|
{
|
|
struct drm_i915_private *dev_priv = to_i915(encoder->base.dev);
|
|
struct intel_dsi *intel_dsi = enc_to_intel_dsi(&encoder->base);
|
|
enum port port;
|
|
u32 tmp;
|
|
int lane;
|
|
|
|
for_each_dsi_port(port, intel_dsi->ports) {
|
|
|
|
/*
|
|
* Program voltage swing and pre-emphasis level values as per
|
|
* table in BSPEC under DDI buffer programing
|
|
*/
|
|
tmp = I915_READ(ICL_PORT_TX_DW5_LN0(port));
|
|
tmp &= ~(SCALING_MODE_SEL_MASK | RTERM_SELECT_MASK);
|
|
tmp |= SCALING_MODE_SEL(0x2);
|
|
tmp |= TAP2_DISABLE | TAP3_DISABLE;
|
|
tmp |= RTERM_SELECT(0x6);
|
|
I915_WRITE(ICL_PORT_TX_DW5_GRP(port), tmp);
|
|
|
|
tmp = I915_READ(ICL_PORT_TX_DW5_AUX(port));
|
|
tmp &= ~(SCALING_MODE_SEL_MASK | RTERM_SELECT_MASK);
|
|
tmp |= SCALING_MODE_SEL(0x2);
|
|
tmp |= TAP2_DISABLE | TAP3_DISABLE;
|
|
tmp |= RTERM_SELECT(0x6);
|
|
I915_WRITE(ICL_PORT_TX_DW5_AUX(port), tmp);
|
|
|
|
tmp = I915_READ(ICL_PORT_TX_DW2_LN0(port));
|
|
tmp &= ~(SWING_SEL_LOWER_MASK | SWING_SEL_UPPER_MASK |
|
|
RCOMP_SCALAR_MASK);
|
|
tmp |= SWING_SEL_UPPER(0x2);
|
|
tmp |= SWING_SEL_LOWER(0x2);
|
|
tmp |= RCOMP_SCALAR(0x98);
|
|
I915_WRITE(ICL_PORT_TX_DW2_GRP(port), tmp);
|
|
|
|
tmp = I915_READ(ICL_PORT_TX_DW2_AUX(port));
|
|
tmp &= ~(SWING_SEL_LOWER_MASK | SWING_SEL_UPPER_MASK |
|
|
RCOMP_SCALAR_MASK);
|
|
tmp |= SWING_SEL_UPPER(0x2);
|
|
tmp |= SWING_SEL_LOWER(0x2);
|
|
tmp |= RCOMP_SCALAR(0x98);
|
|
I915_WRITE(ICL_PORT_TX_DW2_AUX(port), tmp);
|
|
|
|
tmp = I915_READ(ICL_PORT_TX_DW4_AUX(port));
|
|
tmp &= ~(POST_CURSOR_1_MASK | POST_CURSOR_2_MASK |
|
|
CURSOR_COEFF_MASK);
|
|
tmp |= POST_CURSOR_1(0x0);
|
|
tmp |= POST_CURSOR_2(0x0);
|
|
tmp |= CURSOR_COEFF(0x3f);
|
|
I915_WRITE(ICL_PORT_TX_DW4_AUX(port), tmp);
|
|
|
|
for (lane = 0; lane <= 3; lane++) {
|
|
/* Bspec: must not use GRP register for write */
|
|
tmp = I915_READ(ICL_PORT_TX_DW4_LN(port, lane));
|
|
tmp &= ~(POST_CURSOR_1_MASK | POST_CURSOR_2_MASK |
|
|
CURSOR_COEFF_MASK);
|
|
tmp |= POST_CURSOR_1(0x0);
|
|
tmp |= POST_CURSOR_2(0x0);
|
|
tmp |= CURSOR_COEFF(0x3f);
|
|
I915_WRITE(ICL_PORT_TX_DW4_LN(port, lane), tmp);
|
|
}
|
|
}
|
|
}
|
|
|
|
static void gen11_dsi_program_esc_clk_div(struct intel_encoder *encoder)
|
|
{
|
|
struct drm_i915_private *dev_priv = to_i915(encoder->base.dev);
|
|
struct intel_dsi *intel_dsi = enc_to_intel_dsi(&encoder->base);
|
|
enum port port;
|
|
u32 bpp = mipi_dsi_pixel_format_to_bpp(intel_dsi->pixel_format);
|
|
u32 afe_clk_khz; /* 8X Clock */
|
|
u32 esc_clk_div_m;
|
|
|
|
afe_clk_khz = DIV_ROUND_CLOSEST(intel_dsi->pclk * bpp,
|
|
intel_dsi->lane_count);
|
|
|
|
esc_clk_div_m = DIV_ROUND_UP(afe_clk_khz, DSI_MAX_ESC_CLK);
|
|
|
|
for_each_dsi_port(port, intel_dsi->ports) {
|
|
I915_WRITE(ICL_DSI_ESC_CLK_DIV(port),
|
|
esc_clk_div_m & ICL_ESC_CLK_DIV_MASK);
|
|
POSTING_READ(ICL_DSI_ESC_CLK_DIV(port));
|
|
}
|
|
|
|
for_each_dsi_port(port, intel_dsi->ports) {
|
|
I915_WRITE(ICL_DPHY_ESC_CLK_DIV(port),
|
|
esc_clk_div_m & ICL_ESC_CLK_DIV_MASK);
|
|
POSTING_READ(ICL_DPHY_ESC_CLK_DIV(port));
|
|
}
|
|
}
|
|
|
|
static void gen11_dsi_enable_io_power(struct intel_encoder *encoder)
|
|
{
|
|
struct drm_i915_private *dev_priv = to_i915(encoder->base.dev);
|
|
struct intel_dsi *intel_dsi = enc_to_intel_dsi(&encoder->base);
|
|
enum port port;
|
|
u32 tmp;
|
|
|
|
for_each_dsi_port(port, intel_dsi->ports) {
|
|
tmp = I915_READ(ICL_DSI_IO_MODECTL(port));
|
|
tmp |= COMBO_PHY_MODE_DSI;
|
|
I915_WRITE(ICL_DSI_IO_MODECTL(port), tmp);
|
|
}
|
|
|
|
for_each_dsi_port(port, intel_dsi->ports) {
|
|
intel_display_power_get(dev_priv, port == PORT_A ?
|
|
POWER_DOMAIN_PORT_DDI_A_IO :
|
|
POWER_DOMAIN_PORT_DDI_B_IO);
|
|
}
|
|
}
|
|
|
|
static void gen11_dsi_power_up_lanes(struct intel_encoder *encoder)
|
|
{
|
|
struct drm_i915_private *dev_priv = to_i915(encoder->base.dev);
|
|
struct intel_dsi *intel_dsi = enc_to_intel_dsi(&encoder->base);
|
|
enum port port;
|
|
u32 tmp;
|
|
u32 lane_mask;
|
|
|
|
switch (intel_dsi->lane_count) {
|
|
case 1:
|
|
lane_mask = PWR_DOWN_LN_3_1_0;
|
|
break;
|
|
case 2:
|
|
lane_mask = PWR_DOWN_LN_3_1;
|
|
break;
|
|
case 3:
|
|
lane_mask = PWR_DOWN_LN_3;
|
|
break;
|
|
case 4:
|
|
default:
|
|
lane_mask = PWR_UP_ALL_LANES;
|
|
break;
|
|
}
|
|
|
|
for_each_dsi_port(port, intel_dsi->ports) {
|
|
tmp = I915_READ(ICL_PORT_CL_DW10(port));
|
|
tmp &= ~PWR_DOWN_LN_MASK;
|
|
I915_WRITE(ICL_PORT_CL_DW10(port), tmp | lane_mask);
|
|
}
|
|
}
|
|
|
|
static void gen11_dsi_config_phy_lanes_sequence(struct intel_encoder *encoder)
|
|
{
|
|
struct drm_i915_private *dev_priv = to_i915(encoder->base.dev);
|
|
struct intel_dsi *intel_dsi = enc_to_intel_dsi(&encoder->base);
|
|
enum port port;
|
|
u32 tmp;
|
|
int lane;
|
|
|
|
/* Step 4b(i) set loadgen select for transmit and aux lanes */
|
|
for_each_dsi_port(port, intel_dsi->ports) {
|
|
tmp = I915_READ(ICL_PORT_TX_DW4_AUX(port));
|
|
tmp &= ~LOADGEN_SELECT;
|
|
I915_WRITE(ICL_PORT_TX_DW4_AUX(port), tmp);
|
|
for (lane = 0; lane <= 3; lane++) {
|
|
tmp = I915_READ(ICL_PORT_TX_DW4_LN(port, lane));
|
|
tmp &= ~LOADGEN_SELECT;
|
|
if (lane != 2)
|
|
tmp |= LOADGEN_SELECT;
|
|
I915_WRITE(ICL_PORT_TX_DW4_LN(port, lane), tmp);
|
|
}
|
|
}
|
|
|
|
/* Step 4b(ii) set latency optimization for transmit and aux lanes */
|
|
for_each_dsi_port(port, intel_dsi->ports) {
|
|
tmp = I915_READ(ICL_PORT_TX_DW2_AUX(port));
|
|
tmp &= ~FRC_LATENCY_OPTIM_MASK;
|
|
tmp |= FRC_LATENCY_OPTIM_VAL(0x5);
|
|
I915_WRITE(ICL_PORT_TX_DW2_AUX(port), tmp);
|
|
tmp = I915_READ(ICL_PORT_TX_DW2_LN0(port));
|
|
tmp &= ~FRC_LATENCY_OPTIM_MASK;
|
|
tmp |= FRC_LATENCY_OPTIM_VAL(0x5);
|
|
I915_WRITE(ICL_PORT_TX_DW2_GRP(port), tmp);
|
|
}
|
|
|
|
}
|
|
|
|
static void gen11_dsi_voltage_swing_program_seq(struct intel_encoder *encoder)
|
|
{
|
|
struct drm_i915_private *dev_priv = to_i915(encoder->base.dev);
|
|
struct intel_dsi *intel_dsi = enc_to_intel_dsi(&encoder->base);
|
|
u32 tmp;
|
|
enum port port;
|
|
|
|
/* clear common keeper enable bit */
|
|
for_each_dsi_port(port, intel_dsi->ports) {
|
|
tmp = I915_READ(ICL_PORT_PCS_DW1_LN0(port));
|
|
tmp &= ~COMMON_KEEPER_EN;
|
|
I915_WRITE(ICL_PORT_PCS_DW1_GRP(port), tmp);
|
|
tmp = I915_READ(ICL_PORT_PCS_DW1_AUX(port));
|
|
tmp &= ~COMMON_KEEPER_EN;
|
|
I915_WRITE(ICL_PORT_PCS_DW1_AUX(port), tmp);
|
|
}
|
|
|
|
/*
|
|
* Set SUS Clock Config bitfield to 11b
|
|
* Note: loadgen select program is done
|
|
* as part of lane phy sequence configuration
|
|
*/
|
|
for_each_dsi_port(port, intel_dsi->ports) {
|
|
tmp = I915_READ(ICL_PORT_CL_DW5(port));
|
|
tmp |= SUS_CLOCK_CONFIG;
|
|
I915_WRITE(ICL_PORT_CL_DW5(port), tmp);
|
|
}
|
|
|
|
/* Clear training enable to change swing values */
|
|
for_each_dsi_port(port, intel_dsi->ports) {
|
|
tmp = I915_READ(ICL_PORT_TX_DW5_LN0(port));
|
|
tmp &= ~TX_TRAINING_EN;
|
|
I915_WRITE(ICL_PORT_TX_DW5_GRP(port), tmp);
|
|
tmp = I915_READ(ICL_PORT_TX_DW5_AUX(port));
|
|
tmp &= ~TX_TRAINING_EN;
|
|
I915_WRITE(ICL_PORT_TX_DW5_AUX(port), tmp);
|
|
}
|
|
|
|
/* Program swing and de-emphasis */
|
|
dsi_program_swing_and_deemphasis(encoder);
|
|
|
|
/* Set training enable to trigger update */
|
|
for_each_dsi_port(port, intel_dsi->ports) {
|
|
tmp = I915_READ(ICL_PORT_TX_DW5_LN0(port));
|
|
tmp |= TX_TRAINING_EN;
|
|
I915_WRITE(ICL_PORT_TX_DW5_GRP(port), tmp);
|
|
tmp = I915_READ(ICL_PORT_TX_DW5_AUX(port));
|
|
tmp |= TX_TRAINING_EN;
|
|
I915_WRITE(ICL_PORT_TX_DW5_AUX(port), tmp);
|
|
}
|
|
}
|
|
|
|
static void gen11_dsi_enable_ddi_buffer(struct intel_encoder *encoder)
|
|
{
|
|
struct drm_i915_private *dev_priv = to_i915(encoder->base.dev);
|
|
struct intel_dsi *intel_dsi = enc_to_intel_dsi(&encoder->base);
|
|
u32 tmp;
|
|
enum port port;
|
|
|
|
for_each_dsi_port(port, intel_dsi->ports) {
|
|
tmp = I915_READ(DDI_BUF_CTL(port));
|
|
tmp |= DDI_BUF_CTL_ENABLE;
|
|
I915_WRITE(DDI_BUF_CTL(port), tmp);
|
|
|
|
if (wait_for_us(!(I915_READ(DDI_BUF_CTL(port)) &
|
|
DDI_BUF_IS_IDLE),
|
|
500))
|
|
DRM_ERROR("DDI port:%c buffer idle\n", port_name(port));
|
|
}
|
|
}
|
|
|
|
static void gen11_dsi_setup_dphy_timings(struct intel_encoder *encoder)
|
|
{
|
|
struct drm_i915_private *dev_priv = to_i915(encoder->base.dev);
|
|
struct intel_dsi *intel_dsi = enc_to_intel_dsi(&encoder->base);
|
|
u32 tmp;
|
|
enum port port;
|
|
|
|
/* Program T-INIT master registers */
|
|
for_each_dsi_port(port, intel_dsi->ports) {
|
|
tmp = I915_READ(ICL_DSI_T_INIT_MASTER(port));
|
|
tmp &= ~MASTER_INIT_TIMER_MASK;
|
|
tmp |= intel_dsi->init_count;
|
|
I915_WRITE(ICL_DSI_T_INIT_MASTER(port), tmp);
|
|
}
|
|
}
|
|
|
|
static void gen11_dsi_enable_port_and_phy(struct intel_encoder *encoder)
|
|
{
|
|
/* step 4a: power up all lanes of the DDI used by DSI */
|
|
gen11_dsi_power_up_lanes(encoder);
|
|
|
|
/* step 4b: configure lane sequencing of the Combo-PHY transmitters */
|
|
gen11_dsi_config_phy_lanes_sequence(encoder);
|
|
|
|
/* step 4c: configure voltage swing and skew */
|
|
gen11_dsi_voltage_swing_program_seq(encoder);
|
|
|
|
/* enable DDI buffer */
|
|
gen11_dsi_enable_ddi_buffer(encoder);
|
|
|
|
/* setup D-PHY timings */
|
|
gen11_dsi_setup_dphy_timings(encoder);
|
|
}
|
|
|
|
static void __attribute__((unused))
|
|
gen11_dsi_pre_enable(struct intel_encoder *encoder,
|
|
const struct intel_crtc_state *pipe_config,
|
|
const struct drm_connector_state *conn_state)
|
|
{
|
|
/* step2: enable IO power */
|
|
gen11_dsi_enable_io_power(encoder);
|
|
|
|
/* step3: enable DSI PLL */
|
|
gen11_dsi_program_esc_clk_div(encoder);
|
|
|
|
/* step4: enable DSI port and DPHY */
|
|
gen11_dsi_enable_port_and_phy(encoder);
|
|
}
|