linux-stable/drivers/gpu/drm/bridge/lontium-lt9611.c
Dmitry Baryshkov 5e83f359d9 drm/bridge: lt9611: properly program the dual host mode
If the bridge is connected using both DSI ports, the driver should use
both of them all the time. Correct programming sequence to always use
dual-port mode if both dsi0 and dsi1 are connected.

Reviewed-by: Neil Armstrong <neil.armstrong@linaro.org>
Signed-off-by: Dmitry Baryshkov <dmitry.baryshkov@linaro.org>
Signed-off-by: Neil Armstrong <neil.armstrong@linaro.org>
Link: https://patchwork.freedesktop.org/patch/msgid/20230118081658.2198520-14-dmitry.baryshkov@linaro.org
2023-01-18 15:27:10 +01:00

1199 lines
28 KiB
C

// SPDX-License-Identifier: GPL-2.0
/*
* Copyright (c) 2018, The Linux Foundation. All rights reserved.
* Copyright (c) 2019-2020. Linaro Limited.
*/
#include <linux/gpio/consumer.h>
#include <linux/i2c.h>
#include <linux/interrupt.h>
#include <linux/media-bus-format.h>
#include <linux/module.h>
#include <linux/of_graph.h>
#include <linux/platform_device.h>
#include <linux/regmap.h>
#include <linux/regulator/consumer.h>
#include <sound/hdmi-codec.h>
#include <drm/drm_atomic_helper.h>
#include <drm/drm_bridge.h>
#include <drm/drm_mipi_dsi.h>
#include <drm/drm_of.h>
#include <drm/drm_print.h>
#include <drm/drm_probe_helper.h>
#define EDID_SEG_SIZE 256
#define EDID_LEN 32
#define EDID_LOOP 8
#define KEY_DDC_ACCS_DONE 0x02
#define DDC_NO_ACK 0x50
#define LT9611_4LANES 0
struct lt9611 {
struct device *dev;
struct drm_bridge bridge;
struct drm_bridge *next_bridge;
struct regmap *regmap;
struct device_node *dsi0_node;
struct device_node *dsi1_node;
struct mipi_dsi_device *dsi0;
struct mipi_dsi_device *dsi1;
struct platform_device *audio_pdev;
bool ac_mode;
struct gpio_desc *reset_gpio;
struct gpio_desc *enable_gpio;
bool power_on;
bool sleep;
struct regulator_bulk_data supplies[2];
struct i2c_client *client;
enum drm_connector_status status;
u8 edid_buf[EDID_SEG_SIZE];
};
#define LT9611_PAGE_CONTROL 0xff
static const struct regmap_range_cfg lt9611_ranges[] = {
{
.name = "register_range",
.range_min = 0,
.range_max = 0x85ff,
.selector_reg = LT9611_PAGE_CONTROL,
.selector_mask = 0xff,
.selector_shift = 0,
.window_start = 0,
.window_len = 0x100,
},
};
static const struct regmap_config lt9611_regmap_config = {
.reg_bits = 8,
.val_bits = 8,
.max_register = 0xffff,
.ranges = lt9611_ranges,
.num_ranges = ARRAY_SIZE(lt9611_ranges),
};
static struct lt9611 *bridge_to_lt9611(struct drm_bridge *bridge)
{
return container_of(bridge, struct lt9611, bridge);
}
static int lt9611_mipi_input_analog(struct lt9611 *lt9611)
{
const struct reg_sequence reg_cfg[] = {
{ 0x8106, 0x40 }, /* port A rx current */
{ 0x810a, 0xfe }, /* port A ldo voltage set */
{ 0x810b, 0xbf }, /* enable port A lprx */
{ 0x8111, 0x40 }, /* port B rx current */
{ 0x8115, 0xfe }, /* port B ldo voltage set */
{ 0x8116, 0xbf }, /* enable port B lprx */
{ 0x811c, 0x03 }, /* PortA clk lane no-LP mode */
{ 0x8120, 0x03 }, /* PortB clk lane with-LP mode */
};
return regmap_multi_reg_write(lt9611->regmap, reg_cfg, ARRAY_SIZE(reg_cfg));
}
static int lt9611_mipi_input_digital(struct lt9611 *lt9611,
const struct drm_display_mode *mode)
{
struct reg_sequence reg_cfg[] = {
{ 0x8300, LT9611_4LANES },
{ 0x830a, 0x00 },
{ 0x824f, 0x80 },
{ 0x8250, 0x10 },
{ 0x8302, 0x0a },
{ 0x8306, 0x0a },
};
if (lt9611->dsi1_node)
reg_cfg[1].def = 0x03;
return regmap_multi_reg_write(lt9611->regmap, reg_cfg, ARRAY_SIZE(reg_cfg));
}
static void lt9611_mipi_video_setup(struct lt9611 *lt9611,
const struct drm_display_mode *mode)
{
u32 h_total, hactive, hsync_len, hfront_porch, hsync_porch;
u32 v_total, vactive, vsync_len, vfront_porch, vsync_porch;
h_total = mode->htotal;
v_total = mode->vtotal;
hactive = mode->hdisplay;
hsync_len = mode->hsync_end - mode->hsync_start;
hfront_porch = mode->hsync_start - mode->hdisplay;
hsync_porch = mode->htotal - mode->hsync_start;
vactive = mode->vdisplay;
vsync_len = mode->vsync_end - mode->vsync_start;
vfront_porch = mode->vsync_start - mode->vdisplay;
vsync_porch = mode->vtotal - mode->vsync_start;
regmap_write(lt9611->regmap, 0x830d, (u8)(v_total / 256));
regmap_write(lt9611->regmap, 0x830e, (u8)(v_total % 256));
regmap_write(lt9611->regmap, 0x830f, (u8)(vactive / 256));
regmap_write(lt9611->regmap, 0x8310, (u8)(vactive % 256));
regmap_write(lt9611->regmap, 0x8311, (u8)(h_total / 256));
regmap_write(lt9611->regmap, 0x8312, (u8)(h_total % 256));
regmap_write(lt9611->regmap, 0x8313, (u8)(hactive / 256));
regmap_write(lt9611->regmap, 0x8314, (u8)(hactive % 256));
regmap_write(lt9611->regmap, 0x8315, (u8)(vsync_len % 256));
regmap_write(lt9611->regmap, 0x8316, (u8)(hsync_len % 256));
regmap_write(lt9611->regmap, 0x8317, (u8)(vfront_porch % 256));
regmap_write(lt9611->regmap, 0x8318, (u8)(vsync_porch % 256));
regmap_write(lt9611->regmap, 0x8319, (u8)(hfront_porch % 256));
regmap_write(lt9611->regmap, 0x831a, (u8)(hsync_porch / 256) |
((hfront_porch / 256) << 4));
regmap_write(lt9611->regmap, 0x831b, (u8)(hsync_porch % 256));
}
static void lt9611_pcr_setup(struct lt9611 *lt9611, const struct drm_display_mode *mode, unsigned int postdiv)
{
unsigned int pcr_m = mode->clock * 5 * postdiv / 27000;
const struct reg_sequence reg_cfg[] = {
{ 0x830b, 0x01 },
{ 0x830c, 0x10 },
{ 0x8348, 0x00 },
{ 0x8349, 0x81 },
/* stage 1 */
{ 0x8321, 0x4a },
{ 0x8324, 0x71 },
{ 0x8325, 0x30 },
{ 0x832a, 0x01 },
/* stage 2 */
{ 0x834a, 0x40 },
/* MK limit */
{ 0x832d, 0x38 },
{ 0x8331, 0x08 },
};
u8 pol = 0x10;
if (mode->flags & DRM_MODE_FLAG_NHSYNC)
pol |= 0x2;
if (mode->flags & DRM_MODE_FLAG_NVSYNC)
pol |= 0x1;
regmap_write(lt9611->regmap, 0x831d, pol);
regmap_multi_reg_write(lt9611->regmap, reg_cfg, ARRAY_SIZE(reg_cfg));
if (lt9611->dsi1_node) {
unsigned int hact = mode->hdisplay;
hact >>= 2;
hact += 0x50;
hact = min(hact, 0x3e0U);
regmap_write(lt9611->regmap, 0x830b, hact / 256);
regmap_write(lt9611->regmap, 0x830c, hact % 256);
regmap_write(lt9611->regmap, 0x8348, hact / 256);
regmap_write(lt9611->regmap, 0x8349, hact % 256);
}
regmap_write(lt9611->regmap, 0x8326, pcr_m);
/* pcr rst */
regmap_write(lt9611->regmap, 0x8011, 0x5a);
regmap_write(lt9611->regmap, 0x8011, 0xfa);
}
static int lt9611_pll_setup(struct lt9611 *lt9611, const struct drm_display_mode *mode, unsigned int *postdiv)
{
unsigned int pclk = mode->clock;
const struct reg_sequence reg_cfg[] = {
/* txpll init */
{ 0x8123, 0x40 },
{ 0x8124, 0x64 },
{ 0x8125, 0x80 },
{ 0x8126, 0x55 },
{ 0x812c, 0x37 },
{ 0x812f, 0x01 },
{ 0x8126, 0x55 },
{ 0x8127, 0x66 },
{ 0x8128, 0x88 },
{ 0x812a, 0x20 },
};
regmap_multi_reg_write(lt9611->regmap, reg_cfg, ARRAY_SIZE(reg_cfg));
if (pclk > 150000) {
regmap_write(lt9611->regmap, 0x812d, 0x88);
*postdiv = 1;
} else if (pclk > 70000) {
regmap_write(lt9611->regmap, 0x812d, 0x99);
*postdiv = 2;
} else {
regmap_write(lt9611->regmap, 0x812d, 0xaa);
*postdiv = 4;
}
/*
* first divide pclk by 2 first
* - write divide by 64k to 19:16 bits which means shift by 17
* - write divide by 256 to 15:8 bits which means shift by 9
* - write remainder to 7:0 bits, which means shift by 1
*/
regmap_write(lt9611->regmap, 0x82e3, pclk >> 17); /* pclk[19:16] */
regmap_write(lt9611->regmap, 0x82e4, pclk >> 9); /* pclk[15:8] */
regmap_write(lt9611->regmap, 0x82e5, pclk >> 1); /* pclk[7:0] */
regmap_write(lt9611->regmap, 0x82de, 0x20);
regmap_write(lt9611->regmap, 0x82de, 0xe0);
regmap_write(lt9611->regmap, 0x8016, 0xf1);
regmap_write(lt9611->regmap, 0x8016, 0xf3);
return 0;
}
static int lt9611_read_video_check(struct lt9611 *lt9611, unsigned int reg)
{
unsigned int temp, temp2;
int ret;
ret = regmap_read(lt9611->regmap, reg, &temp);
if (ret)
return ret;
temp <<= 8;
ret = regmap_read(lt9611->regmap, reg + 1, &temp2);
if (ret)
return ret;
return (temp + temp2);
}
static int lt9611_video_check(struct lt9611 *lt9611)
{
u32 v_total, vactive, hactive_a, hactive_b, h_total_sysclk;
int temp;
/* top module video check */
/* vactive */
temp = lt9611_read_video_check(lt9611, 0x8282);
if (temp < 0)
goto end;
vactive = temp;
/* v_total */
temp = lt9611_read_video_check(lt9611, 0x826c);
if (temp < 0)
goto end;
v_total = temp;
/* h_total_sysclk */
temp = lt9611_read_video_check(lt9611, 0x8286);
if (temp < 0)
goto end;
h_total_sysclk = temp;
/* hactive_a */
temp = lt9611_read_video_check(lt9611, 0x8382);
if (temp < 0)
goto end;
hactive_a = temp / 3;
/* hactive_b */
temp = lt9611_read_video_check(lt9611, 0x8386);
if (temp < 0)
goto end;
hactive_b = temp / 3;
dev_info(lt9611->dev,
"video check: hactive_a=%d, hactive_b=%d, vactive=%d, v_total=%d, h_total_sysclk=%d\n",
hactive_a, hactive_b, vactive, v_total, h_total_sysclk);
return 0;
end:
dev_err(lt9611->dev, "read video check error\n");
return temp;
}
static void lt9611_hdmi_set_infoframes(struct lt9611 *lt9611,
struct drm_connector *connector,
struct drm_display_mode *mode)
{
union hdmi_infoframe infoframe;
ssize_t len;
u8 iframes = 0x0a; /* UD1 infoframe */
u8 buf[32];
int ret;
int i;
ret = drm_hdmi_avi_infoframe_from_display_mode(&infoframe.avi,
connector,
mode);
if (ret < 0)
goto out;
len = hdmi_infoframe_pack(&infoframe, buf, sizeof(buf));
if (len < 0)
goto out;
for (i = 0; i < len; i++)
regmap_write(lt9611->regmap, 0x8440 + i, buf[i]);
ret = drm_hdmi_vendor_infoframe_from_display_mode(&infoframe.vendor.hdmi,
connector,
mode);
if (ret < 0)
goto out;
len = hdmi_infoframe_pack(&infoframe, buf, sizeof(buf));
if (len < 0)
goto out;
for (i = 0; i < len; i++)
regmap_write(lt9611->regmap, 0x8474 + i, buf[i]);
iframes |= 0x20;
out:
regmap_write(lt9611->regmap, 0x843d, iframes); /* UD1 infoframe */
}
static void lt9611_hdmi_tx_digital(struct lt9611 *lt9611, bool is_hdmi)
{
if (is_hdmi)
regmap_write(lt9611->regmap, 0x82d6, 0x8c);
else
regmap_write(lt9611->regmap, 0x82d6, 0x0c);
regmap_write(lt9611->regmap, 0x82d7, 0x04);
}
static void lt9611_hdmi_tx_phy(struct lt9611 *lt9611)
{
struct reg_sequence reg_cfg[] = {
{ 0x8130, 0x6a },
{ 0x8131, 0x44 }, /* HDMI DC mode */
{ 0x8132, 0x4a },
{ 0x8133, 0x0b },
{ 0x8134, 0x00 },
{ 0x8135, 0x00 },
{ 0x8136, 0x00 },
{ 0x8137, 0x44 },
{ 0x813f, 0x0f },
{ 0x8140, 0xa0 },
{ 0x8141, 0xa0 },
{ 0x8142, 0xa0 },
{ 0x8143, 0xa0 },
{ 0x8144, 0x0a },
};
/* HDMI AC mode */
if (lt9611->ac_mode)
reg_cfg[2].def = 0x73;
regmap_multi_reg_write(lt9611->regmap, reg_cfg, ARRAY_SIZE(reg_cfg));
}
static irqreturn_t lt9611_irq_thread_handler(int irq, void *dev_id)
{
struct lt9611 *lt9611 = dev_id;
unsigned int irq_flag0 = 0;
unsigned int irq_flag3 = 0;
regmap_read(lt9611->regmap, 0x820f, &irq_flag3);
regmap_read(lt9611->regmap, 0x820c, &irq_flag0);
/* hpd changed low */
if (irq_flag3 & 0x80) {
dev_info(lt9611->dev, "hdmi cable disconnected\n");
regmap_write(lt9611->regmap, 0x8207, 0xbf);
regmap_write(lt9611->regmap, 0x8207, 0x3f);
}
/* hpd changed high */
if (irq_flag3 & 0x40) {
dev_info(lt9611->dev, "hdmi cable connected\n");
regmap_write(lt9611->regmap, 0x8207, 0x7f);
regmap_write(lt9611->regmap, 0x8207, 0x3f);
}
if (irq_flag3 & 0xc0 && lt9611->bridge.dev)
drm_kms_helper_hotplug_event(lt9611->bridge.dev);
/* video input changed */
if (irq_flag0 & 0x01) {
dev_info(lt9611->dev, "video input changed\n");
regmap_write(lt9611->regmap, 0x829e, 0xff);
regmap_write(lt9611->regmap, 0x829e, 0xf7);
regmap_write(lt9611->regmap, 0x8204, 0xff);
regmap_write(lt9611->regmap, 0x8204, 0xfe);
}
return IRQ_HANDLED;
}
static void lt9611_enable_hpd_interrupts(struct lt9611 *lt9611)
{
unsigned int val;
regmap_read(lt9611->regmap, 0x8203, &val);
val &= ~0xc0;
regmap_write(lt9611->regmap, 0x8203, val);
regmap_write(lt9611->regmap, 0x8207, 0xff); /* clear */
regmap_write(lt9611->regmap, 0x8207, 0x3f);
}
static void lt9611_sleep_setup(struct lt9611 *lt9611)
{
const struct reg_sequence sleep_setup[] = {
{ 0x8024, 0x76 },
{ 0x8023, 0x01 },
{ 0x8157, 0x03 }, /* set addr pin as output */
{ 0x8149, 0x0b },
{ 0x8102, 0x48 }, /* MIPI Rx power down */
{ 0x8123, 0x80 },
{ 0x8130, 0x00 },
{ 0x8011, 0x0a },
};
regmap_multi_reg_write(lt9611->regmap,
sleep_setup, ARRAY_SIZE(sleep_setup));
lt9611->sleep = true;
}
static int lt9611_power_on(struct lt9611 *lt9611)
{
int ret;
const struct reg_sequence seq[] = {
/* LT9611_System_Init */
{ 0x8101, 0x18 }, /* sel xtal clock */
/* timer for frequency meter */
{ 0x821b, 0x69 }, /* timer 2 */
{ 0x821c, 0x78 },
{ 0x82cb, 0x69 }, /* timer 1 */
{ 0x82cc, 0x78 },
/* irq init */
{ 0x8251, 0x01 },
{ 0x8258, 0x0a }, /* hpd irq */
{ 0x8259, 0x80 }, /* hpd debounce width */
{ 0x829e, 0xf7 }, /* video check irq */
/* power consumption for work */
{ 0x8004, 0xf0 },
{ 0x8006, 0xf0 },
{ 0x800a, 0x80 },
{ 0x800b, 0x40 },
{ 0x800d, 0xef },
{ 0x8011, 0xfa },
};
if (lt9611->power_on)
return 0;
ret = regmap_multi_reg_write(lt9611->regmap, seq, ARRAY_SIZE(seq));
if (!ret)
lt9611->power_on = true;
return ret;
}
static int lt9611_power_off(struct lt9611 *lt9611)
{
int ret;
ret = regmap_write(lt9611->regmap, 0x8130, 0x6a);
if (!ret)
lt9611->power_on = false;
return ret;
}
static void lt9611_reset(struct lt9611 *lt9611)
{
gpiod_set_value_cansleep(lt9611->reset_gpio, 1);
msleep(20);
gpiod_set_value_cansleep(lt9611->reset_gpio, 0);
msleep(20);
gpiod_set_value_cansleep(lt9611->reset_gpio, 1);
msleep(100);
}
static void lt9611_assert_5v(struct lt9611 *lt9611)
{
if (!lt9611->enable_gpio)
return;
gpiod_set_value_cansleep(lt9611->enable_gpio, 1);
msleep(20);
}
static int lt9611_regulator_init(struct lt9611 *lt9611)
{
int ret;
lt9611->supplies[0].supply = "vdd";
lt9611->supplies[1].supply = "vcc";
ret = devm_regulator_bulk_get(lt9611->dev, 2, lt9611->supplies);
if (ret < 0)
return ret;
return regulator_set_load(lt9611->supplies[0].consumer, 300000);
}
static int lt9611_regulator_enable(struct lt9611 *lt9611)
{
int ret;
ret = regulator_enable(lt9611->supplies[0].consumer);
if (ret < 0)
return ret;
usleep_range(1000, 10000);
ret = regulator_enable(lt9611->supplies[1].consumer);
if (ret < 0) {
regulator_disable(lt9611->supplies[0].consumer);
return ret;
}
return 0;
}
static enum drm_connector_status lt9611_bridge_detect(struct drm_bridge *bridge)
{
struct lt9611 *lt9611 = bridge_to_lt9611(bridge);
unsigned int reg_val = 0;
int connected = 0;
regmap_read(lt9611->regmap, 0x825e, &reg_val);
connected = (reg_val & (BIT(2) | BIT(0)));
lt9611->status = connected ? connector_status_connected :
connector_status_disconnected;
return lt9611->status;
}
static int lt9611_read_edid(struct lt9611 *lt9611)
{
unsigned int temp;
int ret = 0;
int i, j;
/* memset to clear old buffer, if any */
memset(lt9611->edid_buf, 0, sizeof(lt9611->edid_buf));
regmap_write(lt9611->regmap, 0x8503, 0xc9);
/* 0xA0 is EDID device address */
regmap_write(lt9611->regmap, 0x8504, 0xa0);
/* 0x00 is EDID offset address */
regmap_write(lt9611->regmap, 0x8505, 0x00);
/* length for read */
regmap_write(lt9611->regmap, 0x8506, EDID_LEN);
regmap_write(lt9611->regmap, 0x8514, 0x7f);
for (i = 0; i < EDID_LOOP; i++) {
/* offset address */
regmap_write(lt9611->regmap, 0x8505, i * EDID_LEN);
regmap_write(lt9611->regmap, 0x8507, 0x36);
regmap_write(lt9611->regmap, 0x8507, 0x31);
regmap_write(lt9611->regmap, 0x8507, 0x37);
usleep_range(5000, 10000);
regmap_read(lt9611->regmap, 0x8540, &temp);
if (temp & KEY_DDC_ACCS_DONE) {
for (j = 0; j < EDID_LEN; j++) {
regmap_read(lt9611->regmap, 0x8583, &temp);
lt9611->edid_buf[i * EDID_LEN + j] = temp;
}
} else if (temp & DDC_NO_ACK) { /* DDC No Ack or Abitration lost */
dev_err(lt9611->dev, "read edid failed: no ack\n");
ret = -EIO;
goto end;
} else {
dev_err(lt9611->dev, "read edid failed: access not done\n");
ret = -EIO;
goto end;
}
}
end:
regmap_write(lt9611->regmap, 0x8507, 0x1f);
return ret;
}
static int
lt9611_get_edid_block(void *data, u8 *buf, unsigned int block, size_t len)
{
struct lt9611 *lt9611 = data;
int ret;
if (len > 128)
return -EINVAL;
/* supports up to 1 extension block */
/* TODO: add support for more extension blocks */
if (block > 1)
return -EINVAL;
if (block == 0) {
ret = lt9611_read_edid(lt9611);
if (ret) {
dev_err(lt9611->dev, "edid read failed\n");
return ret;
}
}
block %= 2;
memcpy(buf, lt9611->edid_buf + (block * 128), len);
return 0;
}
/* bridge funcs */
static void
lt9611_bridge_atomic_enable(struct drm_bridge *bridge,
struct drm_bridge_state *old_bridge_state)
{
struct lt9611 *lt9611 = bridge_to_lt9611(bridge);
struct drm_atomic_state *state = old_bridge_state->base.state;
struct drm_connector *connector;
struct drm_connector_state *conn_state;
struct drm_crtc_state *crtc_state;
struct drm_display_mode *mode;
unsigned int postdiv;
connector = drm_atomic_get_new_connector_for_encoder(state, bridge->encoder);
if (WARN_ON(!connector))
return;
conn_state = drm_atomic_get_new_connector_state(state, connector);
if (WARN_ON(!conn_state))
return;
crtc_state = drm_atomic_get_new_crtc_state(state, conn_state->crtc);
if (WARN_ON(!crtc_state))
return;
mode = &crtc_state->adjusted_mode;
lt9611_mipi_input_digital(lt9611, mode);
lt9611_pll_setup(lt9611, mode, &postdiv);
lt9611_mipi_video_setup(lt9611, mode);
lt9611_pcr_setup(lt9611, mode, postdiv);
if (lt9611_power_on(lt9611)) {
dev_err(lt9611->dev, "power on failed\n");
return;
}
lt9611_mipi_input_analog(lt9611);
lt9611_hdmi_set_infoframes(lt9611, connector, mode);
lt9611_hdmi_tx_digital(lt9611, connector->display_info.is_hdmi);
lt9611_hdmi_tx_phy(lt9611);
msleep(500);
lt9611_video_check(lt9611);
/* Enable HDMI output */
regmap_write(lt9611->regmap, 0x8130, 0xea);
}
static void
lt9611_bridge_atomic_disable(struct drm_bridge *bridge,
struct drm_bridge_state *old_bridge_state)
{
struct lt9611 *lt9611 = bridge_to_lt9611(bridge);
int ret;
/* Disable HDMI output */
ret = regmap_write(lt9611->regmap, 0x8130, 0x6a);
if (ret) {
dev_err(lt9611->dev, "video on failed\n");
return;
}
if (lt9611_power_off(lt9611)) {
dev_err(lt9611->dev, "power on failed\n");
return;
}
}
static struct mipi_dsi_device *lt9611_attach_dsi(struct lt9611 *lt9611,
struct device_node *dsi_node)
{
const struct mipi_dsi_device_info info = { "lt9611", 0, lt9611->dev->of_node};
struct mipi_dsi_device *dsi;
struct mipi_dsi_host *host;
struct device *dev = lt9611->dev;
int ret;
host = of_find_mipi_dsi_host_by_node(dsi_node);
if (!host) {
dev_err(lt9611->dev, "failed to find dsi host\n");
return ERR_PTR(-EPROBE_DEFER);
}
dsi = devm_mipi_dsi_device_register_full(dev, host, &info);
if (IS_ERR(dsi)) {
dev_err(lt9611->dev, "failed to create dsi device\n");
return dsi;
}
dsi->lanes = 4;
dsi->format = MIPI_DSI_FMT_RGB888;
dsi->mode_flags = MIPI_DSI_MODE_VIDEO | MIPI_DSI_MODE_VIDEO_SYNC_PULSE |
MIPI_DSI_MODE_VIDEO_HSE;
ret = devm_mipi_dsi_attach(dev, dsi);
if (ret < 0) {
dev_err(dev, "failed to attach dsi to host\n");
return ERR_PTR(ret);
}
return dsi;
}
static int lt9611_bridge_attach(struct drm_bridge *bridge,
enum drm_bridge_attach_flags flags)
{
struct lt9611 *lt9611 = bridge_to_lt9611(bridge);
return drm_bridge_attach(bridge->encoder, lt9611->next_bridge,
bridge, flags);
}
static enum drm_mode_status lt9611_bridge_mode_valid(struct drm_bridge *bridge,
const struct drm_display_info *info,
const struct drm_display_mode *mode)
{
struct lt9611 *lt9611 = bridge_to_lt9611(bridge);
if (mode->hdisplay > 3840)
return MODE_BAD_HVALUE;
if (mode->vdisplay > 2160)
return MODE_BAD_VVALUE;
if (mode->hdisplay == 3840 &&
mode->vdisplay == 2160 &&
drm_mode_vrefresh(mode) > 30)
return MODE_CLOCK_HIGH;
if (mode->hdisplay > 2000 && !lt9611->dsi1_node)
return MODE_PANEL;
else
return MODE_OK;
}
static void lt9611_bridge_atomic_pre_enable(struct drm_bridge *bridge,
struct drm_bridge_state *old_bridge_state)
{
struct lt9611 *lt9611 = bridge_to_lt9611(bridge);
static const struct reg_sequence reg_cfg[] = {
{ 0x8102, 0x12 },
{ 0x8123, 0x40 },
{ 0x8130, 0xea },
{ 0x8011, 0xfa },
};
if (!lt9611->sleep)
return;
regmap_multi_reg_write(lt9611->regmap,
reg_cfg, ARRAY_SIZE(reg_cfg));
lt9611->sleep = false;
}
static void
lt9611_bridge_atomic_post_disable(struct drm_bridge *bridge,
struct drm_bridge_state *old_bridge_state)
{
struct lt9611 *lt9611 = bridge_to_lt9611(bridge);
lt9611_sleep_setup(lt9611);
}
static struct edid *lt9611_bridge_get_edid(struct drm_bridge *bridge,
struct drm_connector *connector)
{
struct lt9611 *lt9611 = bridge_to_lt9611(bridge);
lt9611_power_on(lt9611);
return drm_do_get_edid(connector, lt9611_get_edid_block, lt9611);
}
static void lt9611_bridge_hpd_enable(struct drm_bridge *bridge)
{
struct lt9611 *lt9611 = bridge_to_lt9611(bridge);
lt9611_enable_hpd_interrupts(lt9611);
}
#define MAX_INPUT_SEL_FORMATS 1
static u32 *
lt9611_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)
{
u32 *input_fmts;
*num_input_fmts = 0;
input_fmts = kcalloc(MAX_INPUT_SEL_FORMATS, sizeof(*input_fmts),
GFP_KERNEL);
if (!input_fmts)
return NULL;
/* This is the DSI-end bus format */
input_fmts[0] = MEDIA_BUS_FMT_RGB888_1X24;
*num_input_fmts = 1;
return input_fmts;
}
static const struct drm_bridge_funcs lt9611_bridge_funcs = {
.attach = lt9611_bridge_attach,
.mode_valid = lt9611_bridge_mode_valid,
.detect = lt9611_bridge_detect,
.get_edid = lt9611_bridge_get_edid,
.hpd_enable = lt9611_bridge_hpd_enable,
.atomic_pre_enable = lt9611_bridge_atomic_pre_enable,
.atomic_enable = lt9611_bridge_atomic_enable,
.atomic_disable = lt9611_bridge_atomic_disable,
.atomic_post_disable = lt9611_bridge_atomic_post_disable,
.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,
.atomic_get_input_bus_fmts = lt9611_atomic_get_input_bus_fmts,
};
static int lt9611_parse_dt(struct device *dev,
struct lt9611 *lt9611)
{
lt9611->dsi0_node = of_graph_get_remote_node(dev->of_node, 0, -1);
if (!lt9611->dsi0_node) {
dev_err(lt9611->dev, "failed to get remote node for primary dsi\n");
return -ENODEV;
}
lt9611->dsi1_node = of_graph_get_remote_node(dev->of_node, 1, -1);
lt9611->ac_mode = of_property_read_bool(dev->of_node, "lt,ac-mode");
return drm_of_find_panel_or_bridge(dev->of_node, 2, -1, NULL, &lt9611->next_bridge);
}
static int lt9611_gpio_init(struct lt9611 *lt9611)
{
struct device *dev = lt9611->dev;
lt9611->reset_gpio = devm_gpiod_get(dev, "reset", GPIOD_OUT_HIGH);
if (IS_ERR(lt9611->reset_gpio)) {
dev_err(dev, "failed to acquire reset gpio\n");
return PTR_ERR(lt9611->reset_gpio);
}
lt9611->enable_gpio = devm_gpiod_get_optional(dev, "enable",
GPIOD_OUT_LOW);
if (IS_ERR(lt9611->enable_gpio)) {
dev_err(dev, "failed to acquire enable gpio\n");
return PTR_ERR(lt9611->enable_gpio);
}
return 0;
}
static int lt9611_read_device_rev(struct lt9611 *lt9611)
{
unsigned int rev;
int ret;
regmap_write(lt9611->regmap, 0x80ee, 0x01);
ret = regmap_read(lt9611->regmap, 0x8002, &rev);
if (ret)
dev_err(lt9611->dev, "failed to read revision: %d\n", ret);
else
dev_info(lt9611->dev, "LT9611 revision: 0x%x\n", rev);
return ret;
}
static int lt9611_hdmi_hw_params(struct device *dev, void *data,
struct hdmi_codec_daifmt *fmt,
struct hdmi_codec_params *hparms)
{
struct lt9611 *lt9611 = data;
if (hparms->sample_rate == 48000)
regmap_write(lt9611->regmap, 0x840f, 0x2b);
else if (hparms->sample_rate == 96000)
regmap_write(lt9611->regmap, 0x840f, 0xab);
else
return -EINVAL;
regmap_write(lt9611->regmap, 0x8435, 0x00);
regmap_write(lt9611->regmap, 0x8436, 0x18);
regmap_write(lt9611->regmap, 0x8437, 0x00);
return 0;
}
static int lt9611_audio_startup(struct device *dev, void *data)
{
struct lt9611 *lt9611 = data;
regmap_write(lt9611->regmap, 0x82d6, 0x8c);
regmap_write(lt9611->regmap, 0x82d7, 0x04);
regmap_write(lt9611->regmap, 0x8406, 0x08);
regmap_write(lt9611->regmap, 0x8407, 0x10);
regmap_write(lt9611->regmap, 0x8434, 0xd5);
return 0;
}
static void lt9611_audio_shutdown(struct device *dev, void *data)
{
struct lt9611 *lt9611 = data;
regmap_write(lt9611->regmap, 0x8406, 0x00);
regmap_write(lt9611->regmap, 0x8407, 0x00);
}
static int lt9611_hdmi_i2s_get_dai_id(struct snd_soc_component *component,
struct device_node *endpoint)
{
struct of_endpoint of_ep;
int ret;
ret = of_graph_parse_endpoint(endpoint, &of_ep);
if (ret < 0)
return ret;
/*
* HDMI sound should be located as reg = <2>
* Then, it is sound port 0
*/
if (of_ep.port == 2)
return 0;
return -EINVAL;
}
static const struct hdmi_codec_ops lt9611_codec_ops = {
.hw_params = lt9611_hdmi_hw_params,
.audio_shutdown = lt9611_audio_shutdown,
.audio_startup = lt9611_audio_startup,
.get_dai_id = lt9611_hdmi_i2s_get_dai_id,
};
static struct hdmi_codec_pdata codec_data = {
.ops = &lt9611_codec_ops,
.max_i2s_channels = 8,
.i2s = 1,
};
static int lt9611_audio_init(struct device *dev, struct lt9611 *lt9611)
{
codec_data.data = lt9611;
lt9611->audio_pdev =
platform_device_register_data(dev, HDMI_CODEC_DRV_NAME,
PLATFORM_DEVID_AUTO,
&codec_data, sizeof(codec_data));
return PTR_ERR_OR_ZERO(lt9611->audio_pdev);
}
static void lt9611_audio_exit(struct lt9611 *lt9611)
{
if (lt9611->audio_pdev) {
platform_device_unregister(lt9611->audio_pdev);
lt9611->audio_pdev = NULL;
}
}
static int lt9611_probe(struct i2c_client *client)
{
struct lt9611 *lt9611;
struct device *dev = &client->dev;
int ret;
if (!i2c_check_functionality(client->adapter, I2C_FUNC_I2C)) {
dev_err(dev, "device doesn't support I2C\n");
return -ENODEV;
}
lt9611 = devm_kzalloc(dev, sizeof(*lt9611), GFP_KERNEL);
if (!lt9611)
return -ENOMEM;
lt9611->dev = dev;
lt9611->client = client;
lt9611->sleep = false;
lt9611->regmap = devm_regmap_init_i2c(client, &lt9611_regmap_config);
if (IS_ERR(lt9611->regmap)) {
dev_err(lt9611->dev, "regmap i2c init failed\n");
return PTR_ERR(lt9611->regmap);
}
ret = lt9611_parse_dt(dev, lt9611);
if (ret) {
dev_err(dev, "failed to parse device tree\n");
return ret;
}
ret = lt9611_gpio_init(lt9611);
if (ret < 0)
goto err_of_put;
ret = lt9611_regulator_init(lt9611);
if (ret < 0)
goto err_of_put;
lt9611_assert_5v(lt9611);
ret = lt9611_regulator_enable(lt9611);
if (ret)
goto err_of_put;
lt9611_reset(lt9611);
ret = lt9611_read_device_rev(lt9611);
if (ret) {
dev_err(dev, "failed to read chip rev\n");
goto err_disable_regulators;
}
ret = devm_request_threaded_irq(dev, client->irq, NULL,
lt9611_irq_thread_handler,
IRQF_ONESHOT, "lt9611", lt9611);
if (ret) {
dev_err(dev, "failed to request irq\n");
goto err_disable_regulators;
}
i2c_set_clientdata(client, lt9611);
lt9611->bridge.funcs = &lt9611_bridge_funcs;
lt9611->bridge.of_node = client->dev.of_node;
lt9611->bridge.ops = DRM_BRIDGE_OP_DETECT | DRM_BRIDGE_OP_EDID |
DRM_BRIDGE_OP_HPD | DRM_BRIDGE_OP_MODES;
lt9611->bridge.type = DRM_MODE_CONNECTOR_HDMIA;
drm_bridge_add(&lt9611->bridge);
/* Attach primary DSI */
lt9611->dsi0 = lt9611_attach_dsi(lt9611, lt9611->dsi0_node);
if (IS_ERR(lt9611->dsi0)) {
ret = PTR_ERR(lt9611->dsi0);
goto err_remove_bridge;
}
/* Attach secondary DSI, if specified */
if (lt9611->dsi1_node) {
lt9611->dsi1 = lt9611_attach_dsi(lt9611, lt9611->dsi1_node);
if (IS_ERR(lt9611->dsi1)) {
ret = PTR_ERR(lt9611->dsi1);
goto err_remove_bridge;
}
}
lt9611_enable_hpd_interrupts(lt9611);
ret = lt9611_audio_init(dev, lt9611);
if (ret)
goto err_remove_bridge;
return 0;
err_remove_bridge:
drm_bridge_remove(&lt9611->bridge);
err_disable_regulators:
regulator_bulk_disable(ARRAY_SIZE(lt9611->supplies), lt9611->supplies);
err_of_put:
of_node_put(lt9611->dsi1_node);
of_node_put(lt9611->dsi0_node);
return ret;
}
static void lt9611_remove(struct i2c_client *client)
{
struct lt9611 *lt9611 = i2c_get_clientdata(client);
disable_irq(client->irq);
lt9611_audio_exit(lt9611);
drm_bridge_remove(&lt9611->bridge);
regulator_bulk_disable(ARRAY_SIZE(lt9611->supplies), lt9611->supplies);
of_node_put(lt9611->dsi1_node);
of_node_put(lt9611->dsi0_node);
}
static struct i2c_device_id lt9611_id[] = {
{ "lontium,lt9611", 0 },
{}
};
MODULE_DEVICE_TABLE(i2c, lt9611_id);
static const struct of_device_id lt9611_match_table[] = {
{ .compatible = "lontium,lt9611" },
{ }
};
MODULE_DEVICE_TABLE(of, lt9611_match_table);
static struct i2c_driver lt9611_driver = {
.driver = {
.name = "lt9611",
.of_match_table = lt9611_match_table,
},
.probe_new = lt9611_probe,
.remove = lt9611_remove,
.id_table = lt9611_id,
};
module_i2c_driver(lt9611_driver);
MODULE_LICENSE("GPL v2");