899 lines
24 KiB
C
899 lines
24 KiB
C
|
// SPDX-License-Identifier: GPL-2.0
|
||
|
/*
|
||
|
* Copyright 2024 NXP
|
||
|
*/
|
||
|
|
||
|
#include <linux/bitfield.h>
|
||
|
#include <linux/bits.h>
|
||
|
#include <linux/delay.h>
|
||
|
#include <linux/gpio/consumer.h>
|
||
|
#include <linux/hdmi.h>
|
||
|
#include <linux/i2c.h>
|
||
|
#include <linux/media-bus-format.h>
|
||
|
#include <linux/module.h>
|
||
|
#include <linux/of.h>
|
||
|
#include <linux/regmap.h>
|
||
|
#include <linux/regulator/consumer.h>
|
||
|
|
||
|
#include <drm/display/drm_hdmi_helper.h>
|
||
|
#include <drm/display/drm_hdmi_state_helper.h>
|
||
|
#include <drm/drm_atomic.h>
|
||
|
#include <drm/drm_atomic_helper.h>
|
||
|
#include <drm/drm_atomic_state_helper.h>
|
||
|
#include <drm/drm_bridge.h>
|
||
|
#include <drm/drm_bridge_connector.h>
|
||
|
#include <drm/drm_connector.h>
|
||
|
#include <drm/drm_crtc.h>
|
||
|
#include <drm/drm_edid.h>
|
||
|
#include <drm/drm_of.h>
|
||
|
#include <drm/drm_probe_helper.h>
|
||
|
|
||
|
/* -----------------------------------------------------------------------------
|
||
|
* LVDS registers
|
||
|
*/
|
||
|
|
||
|
/* LVDS software reset registers */
|
||
|
#define LVDS_REG_05 0x05
|
||
|
#define REG_SOFT_P_RST BIT(1)
|
||
|
|
||
|
/* LVDS system configuration registers */
|
||
|
/* 0x0b */
|
||
|
#define LVDS_REG_0B 0x0b
|
||
|
#define REG_SSC_PCLK_RF BIT(0)
|
||
|
#define REG_LVDS_IN_SWAP BIT(1)
|
||
|
|
||
|
/* LVDS test pattern gen control registers */
|
||
|
/* 0x2c */
|
||
|
#define LVDS_REG_2C 0x2c
|
||
|
#define REG_COL_DEP GENMASK(1, 0)
|
||
|
#define BIT8 FIELD_PREP(REG_COL_DEP, 1)
|
||
|
#define OUT_MAP BIT(4)
|
||
|
#define JEIDA 0
|
||
|
#define REG_DESSC_ENB BIT(6)
|
||
|
#define DMODE BIT(7)
|
||
|
#define DISO BIT(7)
|
||
|
#define SISO 0
|
||
|
|
||
|
#define LVDS_REG_3C 0x3c
|
||
|
#define LVDS_REG_3F 0x3f
|
||
|
#define LVDS_REG_47 0x47
|
||
|
#define LVDS_REG_48 0x48
|
||
|
#define LVDS_REG_4F 0x4f
|
||
|
#define LVDS_REG_52 0x52
|
||
|
|
||
|
/* -----------------------------------------------------------------------------
|
||
|
* HDMI registers are separated into three banks:
|
||
|
* 1) HDMI register common bank: 0x00 ~ 0x2f
|
||
|
*/
|
||
|
|
||
|
/* HDMI genernal registers */
|
||
|
#define HDMI_REG_SW_RST 0x04
|
||
|
#define SOFTREF_RST BIT(5)
|
||
|
#define SOFTA_RST BIT(4)
|
||
|
#define SOFTV_RST BIT(3)
|
||
|
#define AUD_RST BIT(2)
|
||
|
#define HDCP_RST BIT(0)
|
||
|
#define HDMI_RST_ALL (SOFTREF_RST | SOFTA_RST | SOFTV_RST | \
|
||
|
AUD_RST | HDCP_RST)
|
||
|
|
||
|
#define HDMI_REG_SYS_STATUS 0x0e
|
||
|
#define HPDETECT BIT(6)
|
||
|
#define TXVIDSTABLE BIT(4)
|
||
|
|
||
|
#define HDMI_REG_BANK_CTRL 0x0f
|
||
|
#define REG_BANK_SEL BIT(0)
|
||
|
|
||
|
/* HDMI System DDC control registers */
|
||
|
#define HDMI_REG_DDC_MASTER_CTRL 0x10
|
||
|
#define MASTER_SEL_HOST BIT(0)
|
||
|
|
||
|
#define HDMI_REG_DDC_HEADER 0x11
|
||
|
|
||
|
#define HDMI_REG_DDC_REQOFF 0x12
|
||
|
#define HDMI_REG_DDC_REQCOUNT 0x13
|
||
|
#define HDMI_REG_DDC_EDIDSEG 0x14
|
||
|
|
||
|
#define HDMI_REG_DDC_CMD 0x15
|
||
|
#define DDC_CMD_EDID_READ 0x3
|
||
|
#define DDC_CMD_FIFO_CLR 0x9
|
||
|
|
||
|
#define HDMI_REG_DDC_STATUS 0x16
|
||
|
#define DDC_DONE BIT(7)
|
||
|
#define DDC_NOACK BIT(5)
|
||
|
#define DDC_WAITBUS BIT(4)
|
||
|
#define DDC_ARBILOSE BIT(3)
|
||
|
#define DDC_ERROR (DDC_NOACK | DDC_WAITBUS | DDC_ARBILOSE)
|
||
|
|
||
|
#define HDMI_DDC_FIFO_BYTES 32
|
||
|
#define HDMI_REG_DDC_READFIFO 0x17
|
||
|
#define HDMI_REG_LVDS_PORT 0x1d /* LVDS input control I2C addr */
|
||
|
#define HDMI_REG_LVDS_PORT_EN 0x1e
|
||
|
#define LVDS_INPUT_CTRL_I2C_ADDR 0x33
|
||
|
|
||
|
/* -----------------------------------------------------------------------------
|
||
|
* 2) HDMI register bank0: 0x30 ~ 0xff
|
||
|
*/
|
||
|
|
||
|
/* HDMI AFE registers */
|
||
|
#define HDMI_REG_AFE_DRV_CTRL 0x61
|
||
|
#define AFE_DRV_PWD BIT(5)
|
||
|
#define AFE_DRV_RST BIT(4)
|
||
|
|
||
|
#define HDMI_REG_AFE_XP_CTRL 0x62
|
||
|
#define AFE_XP_GAINBIT BIT(7)
|
||
|
#define AFE_XP_ER0 BIT(4)
|
||
|
#define AFE_XP_RESETB BIT(3)
|
||
|
|
||
|
#define HDMI_REG_AFE_ISW_CTRL 0x63
|
||
|
|
||
|
#define HDMI_REG_AFE_IP_CTRL 0x64
|
||
|
#define AFE_IP_GAINBIT BIT(7)
|
||
|
#define AFE_IP_ER0 BIT(3)
|
||
|
#define AFE_IP_RESETB BIT(2)
|
||
|
|
||
|
/* HDMI input data format registers */
|
||
|
#define HDMI_REG_INPUT_MODE 0x70
|
||
|
#define IN_RGB 0x00
|
||
|
|
||
|
/* HDMI general control registers */
|
||
|
#define HDMI_REG_HDMI_MODE 0xc0
|
||
|
#define TX_HDMI_MODE BIT(0)
|
||
|
|
||
|
#define HDMI_REG_GCP 0xc1
|
||
|
#define AVMUTE BIT(0)
|
||
|
#define HDMI_COLOR_DEPTH GENMASK(6, 4)
|
||
|
#define HDMI_COLOR_DEPTH_24 FIELD_PREP(HDMI_COLOR_DEPTH, 4)
|
||
|
|
||
|
#define HDMI_REG_PKT_GENERAL_CTRL 0xc6
|
||
|
#define HDMI_REG_AVI_INFOFRM_CTRL 0xcd
|
||
|
#define ENABLE_PKT BIT(0)
|
||
|
#define REPEAT_PKT BIT(1)
|
||
|
|
||
|
/* -----------------------------------------------------------------------------
|
||
|
* 3) HDMI register bank1: 0x130 ~ 0x1ff (HDMI packet registers)
|
||
|
*/
|
||
|
|
||
|
/* AVI packet registers */
|
||
|
#define HDMI_REG_AVI_DB1 0x158
|
||
|
#define HDMI_REG_AVI_DB2 0x159
|
||
|
#define HDMI_REG_AVI_DB3 0x15a
|
||
|
#define HDMI_REG_AVI_DB4 0x15b
|
||
|
#define HDMI_REG_AVI_DB5 0x15c
|
||
|
#define HDMI_REG_AVI_CSUM 0x15d
|
||
|
#define HDMI_REG_AVI_DB6 0x15e
|
||
|
#define HDMI_REG_AVI_DB7 0x15f
|
||
|
#define HDMI_REG_AVI_DB8 0x160
|
||
|
#define HDMI_REG_AVI_DB9 0x161
|
||
|
#define HDMI_REG_AVI_DB10 0x162
|
||
|
#define HDMI_REG_AVI_DB11 0x163
|
||
|
#define HDMI_REG_AVI_DB12 0x164
|
||
|
#define HDMI_REG_AVI_DB13 0x165
|
||
|
|
||
|
#define HDMI_AVI_DB_CHUNK1_SIZE (HDMI_REG_AVI_DB5 - HDMI_REG_AVI_DB1 + 1)
|
||
|
#define HDMI_AVI_DB_CHUNK2_SIZE (HDMI_REG_AVI_DB13 - HDMI_REG_AVI_DB6 + 1)
|
||
|
|
||
|
/* IT6263 data sheet Rev0.8: LVDS RX supports input clock rate up to 150MHz. */
|
||
|
#define MAX_PIXEL_CLOCK_KHZ 150000
|
||
|
|
||
|
/* IT6263 programming guide Ver0.90: PCLK_HIGH for TMDS clock over 80MHz. */
|
||
|
#define HIGH_PIXEL_CLOCK_KHZ 80000
|
||
|
|
||
|
/*
|
||
|
* IT6263 data sheet Rev0.8: HDMI TX supports link speeds of up to 2.25Gbps
|
||
|
* (link clock rate of 225MHz).
|
||
|
*/
|
||
|
#define MAX_HDMI_TMDS_CHAR_RATE_HZ 225000000
|
||
|
|
||
|
struct it6263 {
|
||
|
struct device *dev;
|
||
|
struct i2c_client *hdmi_i2c;
|
||
|
struct i2c_client *lvds_i2c;
|
||
|
struct regmap *hdmi_regmap;
|
||
|
struct regmap *lvds_regmap;
|
||
|
struct drm_bridge bridge;
|
||
|
struct drm_bridge *next_bridge;
|
||
|
int lvds_data_mapping;
|
||
|
bool lvds_dual_link;
|
||
|
bool lvds_link12_swap;
|
||
|
};
|
||
|
|
||
|
static inline struct it6263 *bridge_to_it6263(struct drm_bridge *bridge)
|
||
|
{
|
||
|
return container_of(bridge, struct it6263, bridge);
|
||
|
}
|
||
|
|
||
|
static bool it6263_hdmi_writeable_reg(struct device *dev, unsigned int reg)
|
||
|
{
|
||
|
switch (reg) {
|
||
|
case HDMI_REG_SW_RST:
|
||
|
case HDMI_REG_BANK_CTRL:
|
||
|
case HDMI_REG_DDC_MASTER_CTRL:
|
||
|
case HDMI_REG_DDC_HEADER:
|
||
|
case HDMI_REG_DDC_REQOFF:
|
||
|
case HDMI_REG_DDC_REQCOUNT:
|
||
|
case HDMI_REG_DDC_EDIDSEG:
|
||
|
case HDMI_REG_DDC_CMD:
|
||
|
case HDMI_REG_LVDS_PORT:
|
||
|
case HDMI_REG_LVDS_PORT_EN:
|
||
|
case HDMI_REG_AFE_DRV_CTRL:
|
||
|
case HDMI_REG_AFE_XP_CTRL:
|
||
|
case HDMI_REG_AFE_ISW_CTRL:
|
||
|
case HDMI_REG_AFE_IP_CTRL:
|
||
|
case HDMI_REG_INPUT_MODE:
|
||
|
case HDMI_REG_HDMI_MODE:
|
||
|
case HDMI_REG_GCP:
|
||
|
case HDMI_REG_PKT_GENERAL_CTRL:
|
||
|
case HDMI_REG_AVI_INFOFRM_CTRL:
|
||
|
case HDMI_REG_AVI_DB1:
|
||
|
case HDMI_REG_AVI_DB2:
|
||
|
case HDMI_REG_AVI_DB3:
|
||
|
case HDMI_REG_AVI_DB4:
|
||
|
case HDMI_REG_AVI_DB5:
|
||
|
case HDMI_REG_AVI_CSUM:
|
||
|
case HDMI_REG_AVI_DB6:
|
||
|
case HDMI_REG_AVI_DB7:
|
||
|
case HDMI_REG_AVI_DB8:
|
||
|
case HDMI_REG_AVI_DB9:
|
||
|
case HDMI_REG_AVI_DB10:
|
||
|
case HDMI_REG_AVI_DB11:
|
||
|
case HDMI_REG_AVI_DB12:
|
||
|
case HDMI_REG_AVI_DB13:
|
||
|
return true;
|
||
|
default:
|
||
|
return false;
|
||
|
}
|
||
|
}
|
||
|
|
||
|
static bool it6263_hdmi_readable_reg(struct device *dev, unsigned int reg)
|
||
|
{
|
||
|
if (it6263_hdmi_writeable_reg(dev, reg))
|
||
|
return true;
|
||
|
|
||
|
switch (reg) {
|
||
|
case HDMI_REG_SYS_STATUS:
|
||
|
case HDMI_REG_DDC_STATUS:
|
||
|
case HDMI_REG_DDC_READFIFO:
|
||
|
return true;
|
||
|
default:
|
||
|
return false;
|
||
|
}
|
||
|
}
|
||
|
|
||
|
static bool it6263_hdmi_volatile_reg(struct device *dev, unsigned int reg)
|
||
|
{
|
||
|
switch (reg) {
|
||
|
case HDMI_REG_SW_RST:
|
||
|
case HDMI_REG_SYS_STATUS:
|
||
|
case HDMI_REG_DDC_STATUS:
|
||
|
case HDMI_REG_DDC_READFIFO:
|
||
|
return true;
|
||
|
default:
|
||
|
return false;
|
||
|
}
|
||
|
}
|
||
|
|
||
|
static const struct regmap_range_cfg it6263_hdmi_range_cfg = {
|
||
|
.range_min = 0x00,
|
||
|
.range_max = HDMI_REG_AVI_DB13,
|
||
|
.selector_reg = HDMI_REG_BANK_CTRL,
|
||
|
.selector_mask = REG_BANK_SEL,
|
||
|
.selector_shift = 0,
|
||
|
.window_start = 0x00,
|
||
|
.window_len = 0x100,
|
||
|
};
|
||
|
|
||
|
static const struct regmap_config it6263_hdmi_regmap_config = {
|
||
|
.name = "it6263-hdmi",
|
||
|
.reg_bits = 8,
|
||
|
.val_bits = 8,
|
||
|
.writeable_reg = it6263_hdmi_writeable_reg,
|
||
|
.readable_reg = it6263_hdmi_readable_reg,
|
||
|
.volatile_reg = it6263_hdmi_volatile_reg,
|
||
|
.max_register = HDMI_REG_AVI_DB13,
|
||
|
.ranges = &it6263_hdmi_range_cfg,
|
||
|
.num_ranges = 1,
|
||
|
.cache_type = REGCACHE_MAPLE,
|
||
|
};
|
||
|
|
||
|
static bool it6263_lvds_writeable_reg(struct device *dev, unsigned int reg)
|
||
|
{
|
||
|
switch (reg) {
|
||
|
case LVDS_REG_05:
|
||
|
case LVDS_REG_0B:
|
||
|
case LVDS_REG_2C:
|
||
|
case LVDS_REG_3C:
|
||
|
case LVDS_REG_3F:
|
||
|
case LVDS_REG_47:
|
||
|
case LVDS_REG_48:
|
||
|
case LVDS_REG_4F:
|
||
|
case LVDS_REG_52:
|
||
|
return true;
|
||
|
default:
|
||
|
return false;
|
||
|
}
|
||
|
}
|
||
|
|
||
|
static bool it6263_lvds_readable_reg(struct device *dev, unsigned int reg)
|
||
|
{
|
||
|
return it6263_lvds_writeable_reg(dev, reg);
|
||
|
}
|
||
|
|
||
|
static bool it6263_lvds_volatile_reg(struct device *dev, unsigned int reg)
|
||
|
{
|
||
|
return reg == LVDS_REG_05;
|
||
|
}
|
||
|
|
||
|
static const struct regmap_config it6263_lvds_regmap_config = {
|
||
|
.name = "it6263-lvds",
|
||
|
.reg_bits = 8,
|
||
|
.val_bits = 8,
|
||
|
.writeable_reg = it6263_lvds_writeable_reg,
|
||
|
.readable_reg = it6263_lvds_readable_reg,
|
||
|
.volatile_reg = it6263_lvds_volatile_reg,
|
||
|
.max_register = LVDS_REG_52,
|
||
|
.cache_type = REGCACHE_MAPLE,
|
||
|
};
|
||
|
|
||
|
static const char * const it6263_supplies[] = {
|
||
|
"ivdd", "ovdd", "txavcc18", "txavcc33", "pvcc1", "pvcc2",
|
||
|
"avcc", "anvdd", "apvdd"
|
||
|
};
|
||
|
|
||
|
static int it6263_parse_dt(struct it6263 *it)
|
||
|
{
|
||
|
struct device *dev = it->dev;
|
||
|
struct device_node *port0, *port1;
|
||
|
int ret = 0;
|
||
|
|
||
|
it->lvds_data_mapping = drm_of_lvds_get_data_mapping(dev->of_node);
|
||
|
if (it->lvds_data_mapping < 0) {
|
||
|
dev_err(dev, "%pOF: invalid or missing %s DT property: %d\n",
|
||
|
dev->of_node, "data-mapping", it->lvds_data_mapping);
|
||
|
return it->lvds_data_mapping;
|
||
|
}
|
||
|
|
||
|
it->next_bridge = devm_drm_of_get_bridge(dev, dev->of_node, 2, 0);
|
||
|
if (IS_ERR(it->next_bridge))
|
||
|
return dev_err_probe(dev, PTR_ERR(it->next_bridge),
|
||
|
"failed to get next bridge\n");
|
||
|
|
||
|
port0 = of_graph_get_port_by_id(dev->of_node, 0);
|
||
|
port1 = of_graph_get_port_by_id(dev->of_node, 1);
|
||
|
if (port0 && port1) {
|
||
|
int order;
|
||
|
|
||
|
it->lvds_dual_link = true;
|
||
|
order = drm_of_lvds_get_dual_link_pixel_order_sink(port0, port1);
|
||
|
if (order < 0) {
|
||
|
dev_err(dev,
|
||
|
"failed to get dual link pixel order: %d\n",
|
||
|
order);
|
||
|
ret = order;
|
||
|
} else if (order == DRM_LVDS_DUAL_LINK_EVEN_ODD_PIXELS) {
|
||
|
it->lvds_link12_swap = true;
|
||
|
}
|
||
|
} else if (port1) {
|
||
|
ret = -EINVAL;
|
||
|
dev_err(dev, "single input LVDS port1 is not supported\n");
|
||
|
} else if (!port0) {
|
||
|
ret = -EINVAL;
|
||
|
dev_err(dev, "no input LVDS port\n");
|
||
|
}
|
||
|
|
||
|
of_node_put(port0);
|
||
|
of_node_put(port1);
|
||
|
|
||
|
return ret;
|
||
|
}
|
||
|
|
||
|
static inline void it6263_hw_reset(struct gpio_desc *reset_gpio)
|
||
|
{
|
||
|
if (!reset_gpio)
|
||
|
return;
|
||
|
|
||
|
gpiod_set_value_cansleep(reset_gpio, 0);
|
||
|
fsleep(1000);
|
||
|
gpiod_set_value_cansleep(reset_gpio, 1);
|
||
|
/* The chip maker says the low pulse should be at least 40ms. */
|
||
|
fsleep(40000);
|
||
|
gpiod_set_value_cansleep(reset_gpio, 0);
|
||
|
/* addtional time to wait the high voltage to be stable */
|
||
|
fsleep(5000);
|
||
|
}
|
||
|
|
||
|
static inline int it6263_lvds_set_i2c_addr(struct it6263 *it)
|
||
|
{
|
||
|
int ret;
|
||
|
|
||
|
ret = regmap_write(it->hdmi_regmap, HDMI_REG_LVDS_PORT,
|
||
|
LVDS_INPUT_CTRL_I2C_ADDR << 1);
|
||
|
if (ret)
|
||
|
return ret;
|
||
|
|
||
|
return regmap_write(it->hdmi_regmap, HDMI_REG_LVDS_PORT_EN, BIT(0));
|
||
|
}
|
||
|
|
||
|
static inline void it6263_lvds_reset(struct it6263 *it)
|
||
|
{
|
||
|
/* AFE PLL reset */
|
||
|
regmap_write_bits(it->lvds_regmap, LVDS_REG_3C, BIT(0), 0x0);
|
||
|
fsleep(1000);
|
||
|
regmap_write_bits(it->lvds_regmap, LVDS_REG_3C, BIT(0), BIT(0));
|
||
|
|
||
|
/* software pixel clock domain reset */
|
||
|
regmap_write_bits(it->lvds_regmap, LVDS_REG_05, REG_SOFT_P_RST,
|
||
|
REG_SOFT_P_RST);
|
||
|
fsleep(1000);
|
||
|
regmap_write_bits(it->lvds_regmap, LVDS_REG_05, REG_SOFT_P_RST, 0x0);
|
||
|
fsleep(10000);
|
||
|
}
|
||
|
|
||
|
static inline void it6263_lvds_set_interface(struct it6263 *it)
|
||
|
{
|
||
|
/* color depth */
|
||
|
regmap_write_bits(it->lvds_regmap, LVDS_REG_2C, REG_COL_DEP, BIT8);
|
||
|
/* output mapping */
|
||
|
regmap_write_bits(it->lvds_regmap, LVDS_REG_2C, OUT_MAP, JEIDA);
|
||
|
|
||
|
if (it->lvds_dual_link) {
|
||
|
regmap_write_bits(it->lvds_regmap, LVDS_REG_2C, DMODE, DISO);
|
||
|
regmap_write_bits(it->lvds_regmap, LVDS_REG_52, BIT(1), BIT(1));
|
||
|
} else {
|
||
|
regmap_write_bits(it->lvds_regmap, LVDS_REG_2C, DMODE, SISO);
|
||
|
regmap_write_bits(it->lvds_regmap, LVDS_REG_52, BIT(1), 0);
|
||
|
}
|
||
|
}
|
||
|
|
||
|
static inline void it6263_lvds_set_afe(struct it6263 *it)
|
||
|
{
|
||
|
regmap_write(it->lvds_regmap, LVDS_REG_3C, 0xaa);
|
||
|
regmap_write(it->lvds_regmap, LVDS_REG_3F, 0x02);
|
||
|
regmap_write(it->lvds_regmap, LVDS_REG_47, 0xaa);
|
||
|
regmap_write(it->lvds_regmap, LVDS_REG_48, 0x02);
|
||
|
regmap_write(it->lvds_regmap, LVDS_REG_4F, 0x11);
|
||
|
|
||
|
regmap_write_bits(it->lvds_regmap, LVDS_REG_0B, REG_SSC_PCLK_RF,
|
||
|
REG_SSC_PCLK_RF);
|
||
|
regmap_write_bits(it->lvds_regmap, LVDS_REG_3C, 0x07, 0);
|
||
|
regmap_write_bits(it->lvds_regmap, LVDS_REG_2C, REG_DESSC_ENB,
|
||
|
REG_DESSC_ENB);
|
||
|
}
|
||
|
|
||
|
static inline void it6263_lvds_sys_cfg(struct it6263 *it)
|
||
|
{
|
||
|
regmap_write_bits(it->lvds_regmap, LVDS_REG_0B, REG_LVDS_IN_SWAP,
|
||
|
it->lvds_link12_swap ? REG_LVDS_IN_SWAP : 0);
|
||
|
}
|
||
|
|
||
|
static inline void it6263_lvds_config(struct it6263 *it)
|
||
|
{
|
||
|
it6263_lvds_reset(it);
|
||
|
it6263_lvds_set_interface(it);
|
||
|
it6263_lvds_set_afe(it);
|
||
|
it6263_lvds_sys_cfg(it);
|
||
|
}
|
||
|
|
||
|
static inline void it6263_hdmi_config(struct it6263 *it)
|
||
|
{
|
||
|
regmap_write(it->hdmi_regmap, HDMI_REG_SW_RST, HDMI_RST_ALL);
|
||
|
regmap_write(it->hdmi_regmap, HDMI_REG_INPUT_MODE, IN_RGB);
|
||
|
regmap_write_bits(it->hdmi_regmap, HDMI_REG_GCP, HDMI_COLOR_DEPTH,
|
||
|
HDMI_COLOR_DEPTH_24);
|
||
|
}
|
||
|
|
||
|
static enum drm_connector_status it6263_detect(struct it6263 *it)
|
||
|
{
|
||
|
unsigned int val;
|
||
|
|
||
|
regmap_read(it->hdmi_regmap, HDMI_REG_SYS_STATUS, &val);
|
||
|
if (val & HPDETECT)
|
||
|
return connector_status_connected;
|
||
|
else
|
||
|
return connector_status_disconnected;
|
||
|
}
|
||
|
|
||
|
static int it6263_read_edid(void *data, u8 *buf, unsigned int block, size_t len)
|
||
|
{
|
||
|
struct it6263 *it = data;
|
||
|
struct regmap *regmap = it->hdmi_regmap;
|
||
|
unsigned int start = (block % 2) * EDID_LENGTH;
|
||
|
unsigned int segment = block >> 1;
|
||
|
unsigned int count, val;
|
||
|
int ret;
|
||
|
|
||
|
regmap_write(regmap, HDMI_REG_DDC_MASTER_CTRL, MASTER_SEL_HOST);
|
||
|
regmap_write(regmap, HDMI_REG_DDC_HEADER, DDC_ADDR << 1);
|
||
|
regmap_write(regmap, HDMI_REG_DDC_EDIDSEG, segment);
|
||
|
|
||
|
while (len) {
|
||
|
/* clear DDC FIFO */
|
||
|
regmap_write(regmap, HDMI_REG_DDC_CMD, DDC_CMD_FIFO_CLR);
|
||
|
|
||
|
ret = regmap_read_poll_timeout(regmap, HDMI_REG_DDC_STATUS,
|
||
|
val, val & DDC_DONE,
|
||
|
2000, 10000);
|
||
|
if (ret) {
|
||
|
dev_err(it->dev, "failed to clear DDC FIFO:%d\n", ret);
|
||
|
return ret;
|
||
|
}
|
||
|
|
||
|
count = len > HDMI_DDC_FIFO_BYTES ? HDMI_DDC_FIFO_BYTES : len;
|
||
|
|
||
|
/* fire the read command */
|
||
|
regmap_write(regmap, HDMI_REG_DDC_REQOFF, start);
|
||
|
regmap_write(regmap, HDMI_REG_DDC_REQCOUNT, count);
|
||
|
regmap_write(regmap, HDMI_REG_DDC_CMD, DDC_CMD_EDID_READ);
|
||
|
|
||
|
start += count;
|
||
|
len -= count;
|
||
|
|
||
|
ret = regmap_read_poll_timeout(regmap, HDMI_REG_DDC_STATUS, val,
|
||
|
val & (DDC_DONE | DDC_ERROR),
|
||
|
20000, 250000);
|
||
|
if (ret && !(val & DDC_ERROR)) {
|
||
|
dev_err(it->dev, "failed to read EDID:%d\n", ret);
|
||
|
return ret;
|
||
|
}
|
||
|
|
||
|
if (val & DDC_ERROR) {
|
||
|
dev_err(it->dev, "DDC error\n");
|
||
|
return -EIO;
|
||
|
}
|
||
|
|
||
|
/* cache to buffer */
|
||
|
for (; count > 0; count--) {
|
||
|
regmap_read(regmap, HDMI_REG_DDC_READFIFO, &val);
|
||
|
*(buf++) = val;
|
||
|
}
|
||
|
}
|
||
|
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
static int it6263_bridge_atomic_check(struct drm_bridge *bridge,
|
||
|
struct drm_bridge_state *bridge_state,
|
||
|
struct drm_crtc_state *crtc_state,
|
||
|
struct drm_connector_state *conn_state)
|
||
|
{
|
||
|
return drm_atomic_helper_connector_hdmi_check(conn_state->connector,
|
||
|
conn_state->state);
|
||
|
}
|
||
|
|
||
|
static void
|
||
|
it6263_bridge_atomic_disable(struct drm_bridge *bridge,
|
||
|
struct drm_bridge_state *old_bridge_state)
|
||
|
{
|
||
|
struct it6263 *it = bridge_to_it6263(bridge);
|
||
|
|
||
|
regmap_write_bits(it->hdmi_regmap, HDMI_REG_GCP, AVMUTE, AVMUTE);
|
||
|
regmap_write(it->hdmi_regmap, HDMI_REG_PKT_GENERAL_CTRL, 0);
|
||
|
regmap_write(it->hdmi_regmap, HDMI_REG_AFE_DRV_CTRL,
|
||
|
AFE_DRV_RST | AFE_DRV_PWD);
|
||
|
}
|
||
|
|
||
|
static void
|
||
|
it6263_bridge_atomic_enable(struct drm_bridge *bridge,
|
||
|
struct drm_bridge_state *old_bridge_state)
|
||
|
{
|
||
|
struct drm_atomic_state *state = old_bridge_state->base.state;
|
||
|
struct it6263 *it = bridge_to_it6263(bridge);
|
||
|
const struct drm_crtc_state *crtc_state;
|
||
|
struct regmap *regmap = it->hdmi_regmap;
|
||
|
const struct drm_display_mode *mode;
|
||
|
struct drm_connector *connector;
|
||
|
bool is_stable = false;
|
||
|
struct drm_crtc *crtc;
|
||
|
unsigned int val;
|
||
|
bool pclk_high;
|
||
|
int i, ret;
|
||
|
|
||
|
connector = drm_atomic_get_new_connector_for_encoder(state,
|
||
|
bridge->encoder);
|
||
|
crtc = drm_atomic_get_new_connector_state(state, connector)->crtc;
|
||
|
crtc_state = drm_atomic_get_new_crtc_state(state, crtc);
|
||
|
mode = &crtc_state->adjusted_mode;
|
||
|
|
||
|
regmap_write(regmap, HDMI_REG_HDMI_MODE, TX_HDMI_MODE);
|
||
|
|
||
|
drm_atomic_helper_connector_hdmi_update_infoframes(connector, state);
|
||
|
|
||
|
/* HDMI AFE setup */
|
||
|
pclk_high = mode->clock > HIGH_PIXEL_CLOCK_KHZ;
|
||
|
regmap_write(regmap, HDMI_REG_AFE_DRV_CTRL, AFE_DRV_RST);
|
||
|
if (pclk_high)
|
||
|
regmap_write(regmap, HDMI_REG_AFE_XP_CTRL,
|
||
|
AFE_XP_GAINBIT | AFE_XP_RESETB);
|
||
|
else
|
||
|
regmap_write(regmap, HDMI_REG_AFE_XP_CTRL,
|
||
|
AFE_XP_ER0 | AFE_XP_RESETB);
|
||
|
regmap_write(regmap, HDMI_REG_AFE_ISW_CTRL, 0x10);
|
||
|
if (pclk_high)
|
||
|
regmap_write(regmap, HDMI_REG_AFE_IP_CTRL,
|
||
|
AFE_IP_GAINBIT | AFE_IP_RESETB);
|
||
|
else
|
||
|
regmap_write(regmap, HDMI_REG_AFE_IP_CTRL,
|
||
|
AFE_IP_ER0 | AFE_IP_RESETB);
|
||
|
|
||
|
/* HDMI software video reset */
|
||
|
regmap_write_bits(regmap, HDMI_REG_SW_RST, SOFTV_RST, SOFTV_RST);
|
||
|
fsleep(1000);
|
||
|
regmap_write_bits(regmap, HDMI_REG_SW_RST, SOFTV_RST, 0);
|
||
|
|
||
|
/* reconfigure LVDS and retry several times in case video is instable */
|
||
|
for (i = 0; i < 3; i++) {
|
||
|
ret = regmap_read_poll_timeout(regmap, HDMI_REG_SYS_STATUS, val,
|
||
|
val & TXVIDSTABLE,
|
||
|
20000, 500000);
|
||
|
if (!ret) {
|
||
|
is_stable = true;
|
||
|
break;
|
||
|
}
|
||
|
|
||
|
it6263_lvds_config(it);
|
||
|
}
|
||
|
|
||
|
if (!is_stable)
|
||
|
dev_warn(it->dev, "failed to wait for video stable\n");
|
||
|
|
||
|
/* HDMI AFE reset release and power up */
|
||
|
regmap_write(regmap, HDMI_REG_AFE_DRV_CTRL, 0);
|
||
|
|
||
|
regmap_write_bits(regmap, HDMI_REG_GCP, AVMUTE, 0);
|
||
|
|
||
|
regmap_write(regmap, HDMI_REG_PKT_GENERAL_CTRL, ENABLE_PKT | REPEAT_PKT);
|
||
|
}
|
||
|
|
||
|
static enum drm_mode_status
|
||
|
it6263_bridge_mode_valid(struct drm_bridge *bridge,
|
||
|
const struct drm_display_info *info,
|
||
|
const struct drm_display_mode *mode)
|
||
|
{
|
||
|
unsigned long long rate;
|
||
|
|
||
|
rate = drm_hdmi_compute_mode_clock(mode, 8, HDMI_COLORSPACE_RGB);
|
||
|
if (rate == 0)
|
||
|
return MODE_NOCLOCK;
|
||
|
|
||
|
return bridge->funcs->hdmi_tmds_char_rate_valid(bridge, mode, rate);
|
||
|
}
|
||
|
|
||
|
static int it6263_bridge_attach(struct drm_bridge *bridge,
|
||
|
enum drm_bridge_attach_flags flags)
|
||
|
{
|
||
|
struct it6263 *it = bridge_to_it6263(bridge);
|
||
|
struct drm_connector *connector;
|
||
|
int ret;
|
||
|
|
||
|
ret = drm_bridge_attach(bridge->encoder, it->next_bridge, bridge,
|
||
|
flags | DRM_BRIDGE_ATTACH_NO_CONNECTOR);
|
||
|
if (ret < 0)
|
||
|
return ret;
|
||
|
|
||
|
if (flags & DRM_BRIDGE_ATTACH_NO_CONNECTOR)
|
||
|
return 0;
|
||
|
|
||
|
connector = drm_bridge_connector_init(bridge->dev, bridge->encoder);
|
||
|
if (IS_ERR(connector)) {
|
||
|
ret = PTR_ERR(connector);
|
||
|
dev_err(it->dev, "failed to initialize bridge connector: %d\n",
|
||
|
ret);
|
||
|
return ret;
|
||
|
}
|
||
|
|
||
|
drm_connector_attach_encoder(connector, bridge->encoder);
|
||
|
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
static enum drm_connector_status it6263_bridge_detect(struct drm_bridge *bridge)
|
||
|
{
|
||
|
struct it6263 *it = bridge_to_it6263(bridge);
|
||
|
|
||
|
return it6263_detect(it);
|
||
|
}
|
||
|
|
||
|
static const struct drm_edid *
|
||
|
it6263_bridge_edid_read(struct drm_bridge *bridge,
|
||
|
struct drm_connector *connector)
|
||
|
{
|
||
|
struct it6263 *it = bridge_to_it6263(bridge);
|
||
|
|
||
|
return drm_edid_read_custom(connector, it6263_read_edid, it);
|
||
|
}
|
||
|
|
||
|
static u32 *
|
||
|
it6263_bridge_atomic_get_input_bus_fmts(struct drm_bridge *bridge,
|
||
|
struct drm_bridge_state *bridge_state,
|
||
|
struct drm_crtc_state *crtc_state,
|
||
|
struct drm_connector_state *conn_state,
|
||
|
u32 output_fmt,
|
||
|
unsigned int *num_input_fmts)
|
||
|
{
|
||
|
struct it6263 *it = bridge_to_it6263(bridge);
|
||
|
u32 *input_fmts;
|
||
|
|
||
|
*num_input_fmts = 0;
|
||
|
|
||
|
if (it->lvds_data_mapping != MEDIA_BUS_FMT_RGB888_1X7X4_JEIDA)
|
||
|
return NULL;
|
||
|
|
||
|
input_fmts = kmalloc(sizeof(*input_fmts), GFP_KERNEL);
|
||
|
if (!input_fmts)
|
||
|
return NULL;
|
||
|
|
||
|
input_fmts[0] = MEDIA_BUS_FMT_RGB888_1X7X4_JEIDA;
|
||
|
*num_input_fmts = 1;
|
||
|
|
||
|
return input_fmts;
|
||
|
}
|
||
|
|
||
|
static enum drm_mode_status
|
||
|
it6263_hdmi_tmds_char_rate_valid(const struct drm_bridge *bridge,
|
||
|
const struct drm_display_mode *mode,
|
||
|
unsigned long long tmds_rate)
|
||
|
{
|
||
|
if (mode->clock > MAX_PIXEL_CLOCK_KHZ)
|
||
|
return MODE_CLOCK_HIGH;
|
||
|
|
||
|
if (tmds_rate > MAX_HDMI_TMDS_CHAR_RATE_HZ)
|
||
|
return MODE_CLOCK_HIGH;
|
||
|
|
||
|
return MODE_OK;
|
||
|
}
|
||
|
|
||
|
static int it6263_hdmi_clear_infoframe(struct drm_bridge *bridge,
|
||
|
enum hdmi_infoframe_type type)
|
||
|
{
|
||
|
struct it6263 *it = bridge_to_it6263(bridge);
|
||
|
|
||
|
if (type == HDMI_INFOFRAME_TYPE_AVI)
|
||
|
regmap_write(it->hdmi_regmap, HDMI_REG_AVI_INFOFRM_CTRL, 0);
|
||
|
else
|
||
|
dev_dbg(it->dev, "unsupported HDMI infoframe 0x%x\n", type);
|
||
|
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
static int it6263_hdmi_write_infoframe(struct drm_bridge *bridge,
|
||
|
enum hdmi_infoframe_type type,
|
||
|
const u8 *buffer, size_t len)
|
||
|
{
|
||
|
struct it6263 *it = bridge_to_it6263(bridge);
|
||
|
struct regmap *regmap = it->hdmi_regmap;
|
||
|
|
||
|
if (type != HDMI_INFOFRAME_TYPE_AVI) {
|
||
|
dev_dbg(it->dev, "unsupported HDMI infoframe 0x%x\n", type);
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
/* write the first AVI infoframe data byte chunk(DB1-DB5) */
|
||
|
regmap_bulk_write(regmap, HDMI_REG_AVI_DB1,
|
||
|
&buffer[HDMI_INFOFRAME_HEADER_SIZE],
|
||
|
HDMI_AVI_DB_CHUNK1_SIZE);
|
||
|
|
||
|
/* write the second AVI infoframe data byte chunk(DB6-DB13) */
|
||
|
regmap_bulk_write(regmap, HDMI_REG_AVI_DB6,
|
||
|
&buffer[HDMI_INFOFRAME_HEADER_SIZE +
|
||
|
HDMI_AVI_DB_CHUNK1_SIZE],
|
||
|
HDMI_AVI_DB_CHUNK2_SIZE);
|
||
|
|
||
|
/* write checksum */
|
||
|
regmap_write(regmap, HDMI_REG_AVI_CSUM, buffer[3]);
|
||
|
|
||
|
regmap_write(regmap, HDMI_REG_AVI_INFOFRM_CTRL, ENABLE_PKT | REPEAT_PKT);
|
||
|
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
static const struct drm_bridge_funcs it6263_bridge_funcs = {
|
||
|
.atomic_duplicate_state = drm_atomic_helper_bridge_duplicate_state,
|
||
|
.atomic_destroy_state = drm_atomic_helper_bridge_destroy_state,
|
||
|
.atomic_reset = drm_atomic_helper_bridge_reset,
|
||
|
.attach = it6263_bridge_attach,
|
||
|
.mode_valid = it6263_bridge_mode_valid,
|
||
|
.atomic_disable = it6263_bridge_atomic_disable,
|
||
|
.atomic_enable = it6263_bridge_atomic_enable,
|
||
|
.atomic_check = it6263_bridge_atomic_check,
|
||
|
.detect = it6263_bridge_detect,
|
||
|
.edid_read = it6263_bridge_edid_read,
|
||
|
.atomic_get_input_bus_fmts = it6263_bridge_atomic_get_input_bus_fmts,
|
||
|
.hdmi_tmds_char_rate_valid = it6263_hdmi_tmds_char_rate_valid,
|
||
|
.hdmi_clear_infoframe = it6263_hdmi_clear_infoframe,
|
||
|
.hdmi_write_infoframe = it6263_hdmi_write_infoframe,
|
||
|
};
|
||
|
|
||
|
static int it6263_probe(struct i2c_client *client)
|
||
|
{
|
||
|
struct device *dev = &client->dev;
|
||
|
struct gpio_desc *reset_gpio;
|
||
|
struct it6263 *it;
|
||
|
int ret;
|
||
|
|
||
|
it = devm_kzalloc(dev, sizeof(*it), GFP_KERNEL);
|
||
|
if (!it)
|
||
|
return -ENOMEM;
|
||
|
|
||
|
it->dev = dev;
|
||
|
it->hdmi_i2c = client;
|
||
|
|
||
|
it->hdmi_regmap = devm_regmap_init_i2c(client,
|
||
|
&it6263_hdmi_regmap_config);
|
||
|
if (IS_ERR(it->hdmi_regmap))
|
||
|
return dev_err_probe(dev, PTR_ERR(it->hdmi_regmap),
|
||
|
"failed to init I2C regmap for HDMI\n");
|
||
|
|
||
|
reset_gpio = devm_gpiod_get_optional(dev, "reset", GPIOD_OUT_LOW);
|
||
|
if (IS_ERR(reset_gpio))
|
||
|
return dev_err_probe(dev, PTR_ERR(reset_gpio),
|
||
|
"failed to get reset gpio\n");
|
||
|
|
||
|
ret = devm_regulator_bulk_get_enable(dev, ARRAY_SIZE(it6263_supplies),
|
||
|
it6263_supplies);
|
||
|
if (ret)
|
||
|
return dev_err_probe(dev, ret, "failed to get power supplies\n");
|
||
|
|
||
|
ret = it6263_parse_dt(it);
|
||
|
if (ret)
|
||
|
return ret;
|
||
|
|
||
|
it6263_hw_reset(reset_gpio);
|
||
|
|
||
|
ret = it6263_lvds_set_i2c_addr(it);
|
||
|
if (ret)
|
||
|
return dev_err_probe(dev, ret, "failed to set I2C addr\n");
|
||
|
|
||
|
it->lvds_i2c = devm_i2c_new_dummy_device(dev, client->adapter,
|
||
|
LVDS_INPUT_CTRL_I2C_ADDR);
|
||
|
if (IS_ERR(it->lvds_i2c))
|
||
|
return dev_err_probe(it->dev, PTR_ERR(it->lvds_i2c),
|
||
|
"failed to allocate I2C device for LVDS\n");
|
||
|
|
||
|
it->lvds_regmap = devm_regmap_init_i2c(it->lvds_i2c,
|
||
|
&it6263_lvds_regmap_config);
|
||
|
if (IS_ERR(it->lvds_regmap))
|
||
|
return dev_err_probe(dev, PTR_ERR(it->lvds_regmap),
|
||
|
"failed to init I2C regmap for LVDS\n");
|
||
|
|
||
|
it6263_lvds_config(it);
|
||
|
it6263_hdmi_config(it);
|
||
|
|
||
|
i2c_set_clientdata(client, it);
|
||
|
|
||
|
it->bridge.funcs = &it6263_bridge_funcs;
|
||
|
it->bridge.of_node = dev->of_node;
|
||
|
/* IT6263 chip doesn't support HPD interrupt. */
|
||
|
it->bridge.ops = DRM_BRIDGE_OP_DETECT | DRM_BRIDGE_OP_EDID |
|
||
|
DRM_BRIDGE_OP_HDMI;
|
||
|
it->bridge.type = DRM_MODE_CONNECTOR_HDMIA;
|
||
|
it->bridge.vendor = "ITE";
|
||
|
it->bridge.product = "IT6263";
|
||
|
|
||
|
return devm_drm_bridge_add(dev, &it->bridge);
|
||
|
}
|
||
|
|
||
|
static const struct of_device_id it6263_of_match[] = {
|
||
|
{ .compatible = "ite,it6263", },
|
||
|
{ }
|
||
|
};
|
||
|
MODULE_DEVICE_TABLE(of, it6263_of_match);
|
||
|
|
||
|
static const struct i2c_device_id it6263_i2c_ids[] = {
|
||
|
{ "it6263", 0 },
|
||
|
{ }
|
||
|
};
|
||
|
MODULE_DEVICE_TABLE(i2c, it6263_i2c_ids);
|
||
|
|
||
|
static struct i2c_driver it6263_driver = {
|
||
|
.probe = it6263_probe,
|
||
|
.driver = {
|
||
|
.name = "it6263",
|
||
|
.of_match_table = it6263_of_match,
|
||
|
},
|
||
|
.id_table = it6263_i2c_ids,
|
||
|
};
|
||
|
module_i2c_driver(it6263_driver);
|
||
|
|
||
|
MODULE_DESCRIPTION("ITE Tech. Inc. IT6263 LVDS/HDMI bridge");
|
||
|
MODULE_AUTHOR("Liu Ying <victor.liu@nxp.com>");
|
||
|
MODULE_LICENSE("GPL");
|