xref: /rk3399_rockchip-uboot/drivers/video/drm/sii902x.c (revision fb3314187292989ae723483fdba11f4d203724d5)

// SPDX-License-Identifier: GPL-2.0+
/*
 * (C) Copyright 2024 Rockchip Electronics Co., Ltd
 */

#include <common.h>
#include <dm.h>
#include <errno.h>
#include <i2c.h>
#include <video_bridge.h>
#include <linux/delay.h>
#include <linux/iopoll.h>
#include <linux/media-bus-format.h>
#include <linux/hdmi.h>

#include "rockchip_bridge.h"
#include "rockchip_display.h"
#include "rockchip_panel.h"

#define SII902X_TPI_VIDEO_DATA			0x0

#define SII902X_TPI_PIXEL_REPETITION		0x8
#define SII902X_TPI_AVI_PIXEL_REP_BUS_24BIT     BIT(5)
#define SII902X_TPI_AVI_PIXEL_REP_RISING_EDGE   BIT(4)
#define SII902X_TPI_AVI_PIXEL_REP_4X		3
#define SII902X_TPI_AVI_PIXEL_REP_2X		1
#define SII902X_TPI_AVI_PIXEL_REP_NONE		0
#define SII902X_TPI_CLK_RATIO_MASK		GENMASK(7, 6)
#define SII902X_TPI_CLK_RATIO_HALF		(0 << 6)
#define SII902X_TPI_CLK_RATIO_1X		(1 << 6)
#define SII902X_TPI_CLK_RATIO_2X		(2 << 6)
#define SII902X_TPI_CLK_RATIO_4X		(3 << 6)

#define SII902X_TPI_AVI_IN_FORMAT		0x9
#define SII902X_TPI_AVI_INPUT_BITMODE_12BIT	BIT(7)
#define SII902X_TPI_AVI_INPUT_DITHER		BIT(6)
#define SII902X_TPI_AVI_INPUT_RANGE_LIMITED	(2 << 2)
#define SII902X_TPI_AVI_INPUT_RANGE_FULL	(1 << 2)
#define SII902X_TPI_AVI_INPUT_RANGE_AUTO	(0 << 2)
#define SII902X_TPI_AVI_INPUT_COLORSPACE_BLACK	(3 << 0)
#define SII902X_TPI_AVI_INPUT_COLORSPACE_YUV422	(2 << 0)
#define SII902X_TPI_AVI_INPUT_COLORSPACE_YUV444	(1 << 0)
#define SII902X_TPI_AVI_INPUT_COLORSPACE_RGB	(0 << 0)

#define SII902X_TPI_AVI_INFOFRAME		0x0c

#define SII902X_SYS_CTRL_DATA			0x1a
#define SII902X_SYS_CTRL_PWR_DWN		BIT(4)
#define SII902X_SYS_CTRL_AV_MUTE		BIT(3)
#define SII902X_SYS_CTRL_DDC_BUS_REQ		BIT(2)
#define SII902X_SYS_CTRL_DDC_BUS_GRTD		BIT(1)
#define SII902X_SYS_CTRL_OUTPUT_MODE		BIT(0)
#define SII902X_SYS_CTRL_OUTPUT_HDMI		1
#define SII902X_SYS_CTRL_OUTPUT_DVI		0

#define SII902X_REG_CHIPID(n)			(0x1b + (n))

#define SII902X_PWR_STATE_CTRL			0x1e
#define SII902X_AVI_POWER_STATE_MSK		GENMASK(1, 0)
#define SII902X_AVI_POWER_STATE_D(l)		((l) & SII902X_AVI_POWER_STATE_MSK)

/* Audio  */
#define SII902X_TPI_I2S_ENABLE_MAPPING_REG	0x1f
#define SII902X_TPI_I2S_CONFIG_FIFO0		(0 << 0)
#define SII902X_TPI_I2S_CONFIG_FIFO1		(1 << 0)
#define SII902X_TPI_I2S_CONFIG_FIFO2		(2 << 0)
#define SII902X_TPI_I2S_CONFIG_FIFO3		(3 << 0)
#define SII902X_TPI_I2S_LEFT_RIGHT_SWAP		(1 << 2)
#define SII902X_TPI_I2S_AUTO_DOWNSAMPLE		(1 << 3)
#define SII902X_TPI_I2S_SELECT_SD0		(0 << 4)
#define SII902X_TPI_I2S_SELECT_SD1		(1 << 4)
#define SII902X_TPI_I2S_SELECT_SD2		(2 << 4)
#define SII902X_TPI_I2S_SELECT_SD3		(3 << 4)
#define SII902X_TPI_I2S_FIFO_ENABLE		(1 << 7)

#define SII902X_TPI_I2S_INPUT_CONFIG_REG	0x20
#define SII902X_TPI_I2S_FIRST_BIT_SHIFT_YES	(0 << 0)
#define SII902X_TPI_I2S_FIRST_BIT_SHIFT_NO	(1 << 0)
#define SII902X_TPI_I2S_SD_DIRECTION_MSB_FIRST	(0 << 1)
#define SII902X_TPI_I2S_SD_DIRECTION_LSB_FIRST	(1 << 1)
#define SII902X_TPI_I2S_SD_JUSTIFY_LEFT		(0 << 2)
#define SII902X_TPI_I2S_SD_JUSTIFY_RIGHT	(1 << 2)
#define SII902X_TPI_I2S_WS_POLARITY_LOW		(0 << 3)
#define SII902X_TPI_I2S_WS_POLARITY_HIGH	(1 << 3)
#define SII902X_TPI_I2S_MCLK_MULTIPLIER_128	(0 << 4)
#define SII902X_TPI_I2S_MCLK_MULTIPLIER_256	(1 << 4)
#define SII902X_TPI_I2S_MCLK_MULTIPLIER_384	(2 << 4)
#define SII902X_TPI_I2S_MCLK_MULTIPLIER_512	(3 << 4)
#define SII902X_TPI_I2S_MCLK_MULTIPLIER_768	(4 << 4)
#define SII902X_TPI_I2S_MCLK_MULTIPLIER_1024	(5 << 4)
#define SII902X_TPI_I2S_MCLK_MULTIPLIER_1152	(6 << 4)
#define SII902X_TPI_I2S_MCLK_MULTIPLIER_192	(7 << 4)
#define SII902X_TPI_I2S_SCK_EDGE_FALLING	(0 << 7)
#define SII902X_TPI_I2S_SCK_EDGE_RISING		(1 << 7)

#define SII902X_TPI_I2S_STRM_HDR_BASE		0x21
#define SII902X_TPI_I2S_STRM_HDR_SIZE		5

#define SII902X_TPI_AUDIO_CONFIG_BYTE2_REG	0x26
#define SII902X_TPI_AUDIO_CODING_STREAM_HEADER	(0 << 0)
#define SII902X_TPI_AUDIO_CODING_PCM		(1 << 0)
#define SII902X_TPI_AUDIO_CODING_AC3		(2 << 0)
#define SII902X_TPI_AUDIO_CODING_MPEG1		(3 << 0)
#define SII902X_TPI_AUDIO_CODING_MP3		(4 << 0)
#define SII902X_TPI_AUDIO_CODING_MPEG2		(5 << 0)
#define SII902X_TPI_AUDIO_CODING_AAC		(6 << 0)
#define SII902X_TPI_AUDIO_CODING_DTS		(7 << 0)
#define SII902X_TPI_AUDIO_CODING_ATRAC		(8 << 0)
#define SII902X_TPI_AUDIO_MUTE_DISABLE		(0 << 4)
#define SII902X_TPI_AUDIO_MUTE_ENABLE		(1 << 4)
#define SII902X_TPI_AUDIO_LAYOUT_2_CHANNELS	(0 << 5)
#define SII902X_TPI_AUDIO_LAYOUT_8_CHANNELS	(1 << 5)
#define SII902X_TPI_AUDIO_INTERFACE_DISABLE	(0 << 6)
#define SII902X_TPI_AUDIO_INTERFACE_SPDIF	(1 << 6)
#define SII902X_TPI_AUDIO_INTERFACE_I2S		(2 << 6)

#define SII902X_TPI_AUDIO_CONFIG_BYTE3_REG	0x27
#define SII902X_TPI_AUDIO_FREQ_STREAM		(0 << 3)
#define SII902X_TPI_AUDIO_FREQ_32KHZ		(1 << 3)
#define SII902X_TPI_AUDIO_FREQ_44KHZ		(2 << 3)
#define SII902X_TPI_AUDIO_FREQ_48KHZ		(3 << 3)
#define SII902X_TPI_AUDIO_FREQ_88KHZ		(4 << 3)
#define SII902X_TPI_AUDIO_FREQ_96KHZ		(5 << 3)
#define SII902X_TPI_AUDIO_FREQ_176KHZ		(6 << 3)
#define SII902X_TPI_AUDIO_FREQ_192KHZ		(7 << 3)
#define SII902X_TPI_AUDIO_SAMPLE_SIZE_STREAM	(0 << 6)
#define SII902X_TPI_AUDIO_SAMPLE_SIZE_16	(1 << 6)
#define SII902X_TPI_AUDIO_SAMPLE_SIZE_20	(2 << 6)
#define SII902X_TPI_AUDIO_SAMPLE_SIZE_24	(3 << 6)

#define SII902X_TPI_AUDIO_CONFIG_BYTE4_REG	0x28

#define SII902X_INT_ENABLE			0x3c
#define SII902X_INT_STATUS			0x3d
#define SII902X_HOTPLUG_EVENT			BIT(0)
#define SII902X_PLUGGED_STATUS			BIT(2)

#define SII902X_TPI_SYNC_GEN_CTRL		0x60
#define SII902X_TPI_SYNC_POLAR_DETECT		0x61
#define SII902X_TPI_HBIT_TO_HSYNC		0x62
#define SII902X_EMBEDDED_SYNC_EXTRACTION_REG	0x63
#define SII902X_EMBEDDED_SYNC_EXTRACTION	BIT(6)

#define SII902X_REG_TPI_RQB			0xc7

/* Indirect internal register access */
#define SII902X_IND_SET_PAGE			0xbc
#define SII902X_IND_OFFSET			0xbd
#define SII902X_IND_VALUE			0xbe

#define SII902X_TPI_MISC_INFOFRAME_BASE		0xbf
#define SII902X_TPI_MISC_INFOFRAME_END		0xde
#define SII902X_TPI_MISC_INFOFRAME_SIZE	\
	(SII902X_TPI_MISC_INFOFRAME_END - SII902X_TPI_MISC_INFOFRAME_BASE)

#define SII902X_I2C_BUS_ACQUISITION_TIMEOUT_MS	500

#define SII902X_AUDIO_PORT_INDEX		3

struct sii902x {
	struct udevice *dev;
	struct udevice *power_supply;
	struct gpio_desc enable_gpio;
	struct gpio_desc reset_gpio;
	struct rockchip_bridge *bridge;
	struct drm_display_mode mode;
	struct ddc_adapter adap;
	struct hdmi_edid_data edid_data;
	int bus_format;
};

enum sii902x_bus_format {
	FORMAT_RGB_INPUT,
	FORMAT_YCBCR422_INPUT,
	FORMAT_YCBCR444_INPUT,
};

static inline struct sii902x *bridge_to_sii902x(struct rockchip_bridge *bridge)
{
	return container_of(&bridge, struct sii902x, bridge);
}

static int sii902x_reg_update_bits(struct sii902x *sii902x, u8 reg, u8 mask, u8 val)
{
	u8 status;

	status = dm_i2c_reg_read(sii902x->dev, reg);
	status &= ~mask;
	status |= val & mask;

	return dm_i2c_reg_write(sii902x->dev, reg, status);
}

static bool sii902x_bridge_detect(struct rockchip_bridge *bridge)
{
	struct udevice *dev = bridge->dev;
	u8 status;

	status = dm_i2c_reg_read(dev, SII902X_INT_STATUS);

	return (status & SII902X_PLUGGED_STATUS) ? true : false;
}

static bool sii902x_check_embedded_format(uint32_t bus_format)
{
	switch (bus_format) {
	case MEDIA_BUS_FMT_YUYV8_2X8:
	case MEDIA_BUS_FMT_YVYU8_2X8:
	case MEDIA_BUS_FMT_UYVY8_2X8:
	case MEDIA_BUS_FMT_VYUY8_2X8:
	case MEDIA_BUS_FMT_YUYV8_1X16:
	case MEDIA_BUS_FMT_YVYU8_1X16:
	case MEDIA_BUS_FMT_UYVY8_1X16:
	case MEDIA_BUS_FMT_VYUY8_1X16:
		return true;
	default:
		return false;
	}
}

static void sii902x_set_embedded_sync(struct sii902x *sii902x)
{
	struct udevice *dev = sii902x->dev;
	unsigned char data[8];
	struct videomode vm;

	if (!sii902x_check_embedded_format(sii902x->bus_format))
		return;

	switch (sii902x->bus_format) {
	case MEDIA_BUS_FMT_YUYV8_2X8:
	case MEDIA_BUS_FMT_YVYU8_2X8:
	case MEDIA_BUS_FMT_UYVY8_2X8:
	case MEDIA_BUS_FMT_VYUY8_2X8:
		sii902x_reg_update_bits(sii902x, SII902X_TPI_SYNC_GEN_CTRL, 0x20, 0x20);
		break;
	default:
		break;
	}

	sii902x_reg_update_bits(sii902x,  SII902X_TPI_SYNC_GEN_CTRL, 0x80, 0x00);
	dm_i2c_reg_write(dev, SII902X_EMBEDDED_SYNC_EXTRACTION_REG, 0x00);
	sii902x_reg_update_bits(sii902x, SII902X_TPI_SYNC_GEN_CTRL, 0x80, 0x80);

	drm_display_mode_to_videomode(&sii902x->mode, &vm);
	data[0] = vm.hfront_porch & 0xff;
	data[1] = (vm.hfront_porch >> 8) & 0x03;
	if (sii902x->mode.flags & DRM_MODE_FLAG_INTERLACE) {
		data[2] = (sii902x->mode.vtotal >> 1) & 0xff;
		data[3] = ((sii902x->mode.vtotal >> 1) >> 8) & 0x1f;
	} else {
		data[2] = 0;
		data[3] = 0;
	}
	data[4] = vm.hsync_len & 0xff;
	data[5] = (vm.hsync_len >> 8) & 0x03;
	data[6] = vm.vfront_porch;
	data[7] = vm.vsync_len;
	dm_i2c_write(dev, SII902X_TPI_HBIT_TO_HSYNC, data, 8);

	sii902x_reg_update_bits(sii902x, SII902X_TPI_SYNC_GEN_CTRL, 0x80, 0x80);
	sii902x_reg_update_bits(sii902x, SII902X_EMBEDDED_SYNC_EXTRACTION_REG, 0x40, 0x40);

	sii902x_reg_update_bits(sii902x, SII902X_EMBEDDED_SYNC_EXTRACTION_REG,
				SII902X_EMBEDDED_SYNC_EXTRACTION,
				SII902X_EMBEDDED_SYNC_EXTRACTION);
}

static void sii902x_set_format(struct sii902x *sii902x)
{
	struct udevice *dev = sii902x->dev;
	u8 val;

	switch (sii902x->bus_format) {
	case MEDIA_BUS_FMT_YUYV8_1X16:
	case MEDIA_BUS_FMT_YVYU8_1X16:
	case MEDIA_BUS_FMT_UYVY8_1X16:
	case MEDIA_BUS_FMT_VYUY8_1X16:
	case MEDIA_BUS_FMT_YUYV8_2X8:
	case MEDIA_BUS_FMT_YVYU8_2X8:
	case MEDIA_BUS_FMT_UYVY8_2X8:
	case MEDIA_BUS_FMT_VYUY8_2X8:
		val = SII902X_TPI_AVI_INPUT_COLORSPACE_YUV422;
		break;
	case MEDIA_BUS_FMT_YUV8_1X24:
	case MEDIA_BUS_FMT_VUY8_1X24:
		val = SII902X_TPI_AVI_INPUT_COLORSPACE_YUV444;
		break;
	case MEDIA_BUS_FMT_RGB888_1X24:
	default:
		val = SII902X_TPI_AVI_INPUT_COLORSPACE_RGB;
		break;
	}

	val |= SII902X_TPI_AVI_INPUT_RANGE_AUTO;
	val &= ~(SII902X_TPI_AVI_INPUT_DITHER |
		 SII902X_TPI_AVI_INPUT_BITMODE_12BIT);
	dm_i2c_reg_write(dev, SII902X_TPI_AVI_IN_FORMAT, val);

	sii902x_set_embedded_sync(sii902x);
}

static void sii902x_set_connector_display_info(struct sii902x *sii902x,
					       struct connector_state *conn_state)
{
	conn_state->bus_format = sii902x->bus_format;
	switch (conn_state->bus_format) {
	case MEDIA_BUS_FMT_YUYV8_2X8:
	case MEDIA_BUS_FMT_YVYU8_2X8:
	case MEDIA_BUS_FMT_UYVY8_2X8:
	case MEDIA_BUS_FMT_VYUY8_2X8:
		conn_state->output_mode = ROCKCHIP_OUT_MODE_BT656;
		conn_state->output_if = VOP_OUTPUT_IF_BT656;
		conn_state->color_range = DRM_COLOR_YCBCR_LIMITED_RANGE;
		conn_state->color_encoding = DRM_COLOR_YCBCR_BT601;
		break;
	case MEDIA_BUS_FMT_YUYV8_1X16:
	case MEDIA_BUS_FMT_YVYU8_1X16:
	case MEDIA_BUS_FMT_UYVY8_1X16:
	case MEDIA_BUS_FMT_VYUY8_1X16:
		conn_state->output_mode = ROCKCHIP_OUT_MODE_BT1120;
		conn_state->output_if = VOP_OUTPUT_IF_BT1120;
		conn_state->color_range = DRM_COLOR_YCBCR_LIMITED_RANGE;
		conn_state->color_encoding = DRM_COLOR_YCBCR_BT709;
		break;
	case MEDIA_BUS_FMT_RGB888_1X24:
	default:
		conn_state->output_mode = ROCKCHIP_OUT_MODE_P888;
		conn_state->output_if = VOP_OUTPUT_IF_RGB;
		conn_state->color_range = DRM_COLOR_YCBCR_FULL_RANGE;
		conn_state->color_encoding = DRM_COLOR_YCBCR_BT709;
		break;
	}
}

static void sii902x_bridge_mode_set(struct rockchip_bridge *bridge,
				    const struct drm_display_mode *mode)
{
	struct sii902x *sii902x = dev_get_priv(bridge->dev);
	struct connector_state *conn_state = &bridge->state->conn_state;
	struct edid *edid = (struct edid *)conn_state->edid;
	struct udevice *dev = sii902x->dev;
	struct hdmi_avi_infoframe frame;
	u8 buf[HDMI_INFOFRAME_SIZE(AVI)];
	u8 output_mode;
	u16 pixel_clock_10kHz = mode->clock / 10;
	u8 ratio;
	int ret, vrefresh;

	if (drm_detect_hdmi_monitor(edid))
		output_mode = SII902X_SYS_CTRL_OUTPUT_HDMI;
	else
		output_mode = SII902X_SYS_CTRL_OUTPUT_DVI;

	sii902x_reg_update_bits(sii902x, SII902X_SYS_CTRL_DATA,
				SII902X_SYS_CTRL_OUTPUT_MODE,
				output_mode);

	drm_mode_copy(&sii902x->mode, mode);
	vrefresh = drm_mode_vrefresh(mode) * 100;
	buf[0] = pixel_clock_10kHz & 0xff;
	buf[1] = pixel_clock_10kHz >> 8;
	buf[2] = vrefresh & 0xff;
	buf[3] = vrefresh >> 8;
	buf[4] = mode->crtc_htotal;
	buf[5] = mode->crtc_htotal >> 8;
	buf[6] = mode->crtc_vtotal;
	buf[7] = mode->crtc_vtotal >> 8;
	buf[8] = SII902X_TPI_AVI_PIXEL_REP_NONE | SII902X_TPI_AVI_PIXEL_REP_BUS_24BIT;
	switch (sii902x->bus_format) {
	case MEDIA_BUS_FMT_YUYV8_1X16:
	case MEDIA_BUS_FMT_YVYU8_1X16:
	case MEDIA_BUS_FMT_UYVY8_1X16:
	case MEDIA_BUS_FMT_VYUY8_1X16:
	case MEDIA_BUS_FMT_YUYV8_2X8:
	case MEDIA_BUS_FMT_YVYU8_2X8:
	case MEDIA_BUS_FMT_UYVY8_2X8:
	case MEDIA_BUS_FMT_VYUY8_2X8:
		buf[8] |= SII902X_TPI_AVI_PIXEL_REP_RISING_EDGE;
		break;
	default:
		break;
	}

	buf[9] = SII902X_TPI_AVI_INPUT_RANGE_AUTO;
	switch (sii902x->bus_format) {
	case MEDIA_BUS_FMT_YUYV8_1X16:
	case MEDIA_BUS_FMT_YVYU8_1X16:
	case MEDIA_BUS_FMT_UYVY8_1X16:
	case MEDIA_BUS_FMT_VYUY8_1X16:
	case MEDIA_BUS_FMT_YUYV8_2X8:
	case MEDIA_BUS_FMT_YVYU8_2X8:
	case MEDIA_BUS_FMT_UYVY8_2X8:
	case MEDIA_BUS_FMT_VYUY8_2X8:
		buf[9] |= SII902X_TPI_AVI_INPUT_COLORSPACE_YUV422;
		break;
	case MEDIA_BUS_FMT_YUV8_1X24:
	case MEDIA_BUS_FMT_VUY8_1X24:
		buf[9] |= SII902X_TPI_AVI_INPUT_COLORSPACE_YUV444;
		break;
	case MEDIA_BUS_FMT_RGB888_1X24:
	default:
		buf[9] |= SII902X_TPI_AVI_INPUT_COLORSPACE_RGB;
		break;
	}

	ret = dm_i2c_write(dev, SII902X_TPI_VIDEO_DATA, buf, 10);
	if (ret) {
		dev_err(dev, "failed to set video data\n");
		return;
	}

	if (sii902x->mode.flags & DRM_MODE_FLAG_DBLCLK)
		ratio = SII902X_TPI_CLK_RATIO_2X;
	else
		ratio = SII902X_TPI_CLK_RATIO_1X;
	sii902x_reg_update_bits(sii902x, SII902X_TPI_PIXEL_REPETITION,
				SII902X_TPI_CLK_RATIO_MASK, ratio);

	ret = drm_hdmi_avi_infoframe_from_display_mode(&frame, &sii902x->mode, false);
	if (ret < 0) {
		dev_err(dev, "couldn't fill AVI infoframe\n");
		return;
	}

	ret = hdmi_avi_infoframe_pack(&frame, buf, sizeof(buf));
	if (ret < 0) {
		dev_err(dev, "failed to pack AVI infoframe: %d\n", ret);
		return;
	}

	/* Do not send the infoframe header, but keep the CRC field. */
	dm_i2c_write(dev, SII902X_TPI_AVI_INFOFRAME,
		     buf + HDMI_INFOFRAME_HEADER_SIZE - 1,
		     HDMI_AVI_INFOFRAME_SIZE + 1);
	sii902x_set_format(sii902x);
	sii902x_set_connector_display_info(sii902x, conn_state);
}

static void sii902x_bridge_enable(struct rockchip_bridge *bridge)
{
	struct sii902x *sii902x = dev_get_priv(bridge->dev);

	sii902x_reg_update_bits(sii902x, SII902X_PWR_STATE_CTRL,
				SII902X_AVI_POWER_STATE_MSK,
				SII902X_AVI_POWER_STATE_D(0));
	sii902x_reg_update_bits(sii902x, SII902X_SYS_CTRL_DATA, SII902X_SYS_CTRL_PWR_DWN, 0);
}

static void sii902x_bridge_disable(struct rockchip_bridge *bridge)
{
	struct sii902x *sii902x = dev_get_priv(bridge->dev);

	sii902x_reg_update_bits(sii902x, SII902X_SYS_CTRL_DATA,
				SII902X_SYS_CTRL_PWR_DWN,
				SII902X_SYS_CTRL_PWR_DWN);
}

static const struct rockchip_bridge_funcs sii902x_bridge_funcs = {
	.detect		= sii902x_bridge_detect,
	.mode_set	= sii902x_bridge_mode_set,
	.enable		= sii902x_bridge_enable,
	.post_disable	= sii902x_bridge_disable,
};

static void sii902x_reset(struct sii902x *sii902x)
{
	if (!dm_gpio_is_valid(&sii902x->reset_gpio))
		return;

	dm_gpio_set_value(&sii902x->reset_gpio, 1);

	/* The datasheet says treset-min = 100us. Make it 150us to be sure. */
	udelay(500);

	dm_gpio_set_value(&sii902x->reset_gpio, 0);
}

#define SII902X_READ_REG(v)	dm_i2c_reg_read(sii902x->dev, v)

/*
 * The purpose of sii902x_i2c_bypass_select is to enable the pass through
 * mode of the HDMI transmitter. Do not use regmap from within this function,
 * only use sii902x_*_unlocked functions to read/modify/write registers.
 * We are holding the parent adapter lock here, keep this in mind before
 * adding more i2c transactions.
 *
 * Also, since SII902X_SYS_CTRL_DATA is used with regmap_update_bits elsewhere
 * in this driver, we need to make sure that we only touch 0x1A[2:1] from
 * within sii902x_i2c_bypass_select and sii902x_i2c_bypass_deselect, and that
 * we leave the remaining bits as we have found them.
 */
static int sii902x_i2c_bypass_select(struct sii902x *sii902x)
{
	struct udevice *dev = sii902x->dev;
	u8 status;
	int ret;

	sii902x_reg_update_bits(sii902x, SII902X_SYS_CTRL_DATA,
				SII902X_SYS_CTRL_DDC_BUS_REQ,
				SII902X_SYS_CTRL_DDC_BUS_REQ);

	ret = readx_poll_timeout(SII902X_READ_REG, SII902X_SYS_CTRL_DATA, status,
				 status & SII902X_SYS_CTRL_DDC_BUS_GRTD,
				 SII902X_I2C_BUS_ACQUISITION_TIMEOUT_MS * 1000);
	if (ret) {
		dev_err(dev, "Failed to acquire the i2c bus\n");
		return -ETIMEDOUT;
	}

	dm_i2c_reg_write(dev, SII902X_SYS_CTRL_DATA, status);

	return 0;
}

/*
 * The purpose of sii902x_i2c_bypass_deselect is to disable the pass through
 * mode of the HDMI transmitter. Do not use regmap from within this function,
 * only use sii902x_*_unlocked functions to read/modify/write registers.
 * We are holding the parent adapter lock here, keep this in mind before
 * adding more i2c transactions.
 *
 * Also, since SII902X_SYS_CTRL_DATA is used with regmap_update_bits elsewhere
 * in this driver, we need to make sure that we only touch 0x1A[2:1] from
 * within sii902x_i2c_bypass_select and sii902x_i2c_bypass_deselect, and that
 * we leave the remaining bits as we have found them.
 */
static int sii902x_i2c_bypass_deselect(struct sii902x *sii902x)
{
	struct udevice *dev = sii902x->dev;
	unsigned int retries;
	u8 status;
	int ret;

	/*
	 * When the HDMI transmitter is in pass through mode, we need an
	 * (undocumented) additional delay between STOP and START conditions
	 * to guarantee the bus won't get stuck.
	 */
	udelay(30);

	/*
	 * Sometimes the I2C bus can stall after failure to use the
	 * EDID channel. Retry a few times to see if things clear
	 * up, else continue anyway.
	 */
	retries = 5;
	do {
		status = dm_i2c_reg_read(dev, SII902X_SYS_CTRL_DATA);
		retries--;
	} while (status < 0 && retries);
	if (status < 0) {
		dev_err(dev, "failed to read status (%d)\n", status);
		return status;
	}

	ret = sii902x_reg_update_bits(sii902x, SII902X_SYS_CTRL_DATA,
				      SII902X_SYS_CTRL_DDC_BUS_REQ |
				      SII902X_SYS_CTRL_DDC_BUS_GRTD, 0);
	if (ret)
		return ret;

	ret = readx_poll_timeout(SII902X_READ_REG, SII902X_SYS_CTRL_DATA, status,
				 !(status & (SII902X_SYS_CTRL_DDC_BUS_REQ |
					     SII902X_SYS_CTRL_DDC_BUS_GRTD)),
				 SII902X_I2C_BUS_ACQUISITION_TIMEOUT_MS * 1000);
	if (ret) {
		dev_err(dev, "failed to release the i2c bus\n");
		return -ETIMEDOUT;
	}

	return 0;
}

static int sii902x_i2c_xfer(struct ddc_adapter *adap, struct i2c_msg *msgs, int num)
{
	struct sii902x *sii902x = container_of(adap, struct sii902x, adap);
	struct udevice *dev = sii902x->dev;
	u8 addr = msgs[0].addr;
	int i;
	int ret;

	ret = sii902x_i2c_bypass_select(sii902x);
	if (ret)
		return -EINVAL;

	debug("i2c xfer: num: %d, addr: %#x\n", num, addr);

	for (i = 0; i < num; i++) {
		debug("xfer: num: %d/%d, len: %d, flags: %#x\n",
		      i + 1, num, msgs[i].len, msgs[i].flags);

		ret = dm_i2c_xfer(dev, msgs, num);
		if (ret < 0)
			break;
	}

	ret = sii902x_i2c_bypass_deselect(sii902x);
	if (ret)
		return -EINVAL;

	if (!ret)
		ret = num;

	return ret;
}

static int sii902x_init(struct sii902x *sii902x)
{
	struct udevice *dev = sii902x->dev;
	u8 chipid[4];
	u8 status;
	int ret;

	sii902x_reset(sii902x);

	ret = dm_i2c_reg_write(dev, SII902X_REG_TPI_RQB, 0x0);
	if (ret) {
		dev_err(dev, "enable TPI mode failed %d\n", ret);
		return ret;
	}

	ret = dm_i2c_read(dev, SII902X_REG_CHIPID(0), chipid, 4);
	if (ret) {
		dev_err(dev, "regmap_read failed %d\n", ret);
		return ret;
	}

	if (chipid[0] != 0xb0) {
		dev_err(dev, "Invalid chipid: %02x (expecting 0xb0)\n",
			chipid[0]);
		return -EINVAL;
	}

	/* Clear all pending interrupts */
	status = dm_i2c_reg_read(dev, SII902X_INT_STATUS);
	dm_i2c_reg_write(dev, SII902X_INT_STATUS, status);

	sii902x->adap.i2c_bus = dev->parent;
	sii902x->adap.ddc_xfer = sii902x_i2c_xfer;

	sii902x->edid_data.mode_buf = malloc(MODE_LEN * sizeof(struct drm_display_mode));
	if (!sii902x->edid_data.mode_buf) {
		dev_err(dev, "failed to malloc mode buffer for edid\n");
		return -ENOMEM;
	}

	return 0;
}

static int sii902x_probe(struct udevice *dev)
{
	struct sii902x *sii902x = dev_get_priv(dev);
	struct rockchip_bridge *bridge = (struct rockchip_bridge *)dev_get_driver_data(dev);
	int val;
	int ret;

	sii902x->dev = dev;
	sii902x->bridge = bridge;
	bridge->dev = dev;

	ret = gpio_request_by_name(dev, "reset-gpio", 0,
				   &sii902x->reset_gpio, GPIOD_IS_OUT);
	if (ret && ret != -ENOENT) {
		dev_err(dev, "Cannot get reset GPIO: %d\n", ret);
		return ret;
	}

	ret = gpio_request_by_name(dev, "enable-gpio", 0,
				   &sii902x->enable_gpio, GPIOD_IS_OUT);
	if (ret && ret != -ENOENT) {
		dev_err(dev, "Cannot get enable GPIO: %d\n", ret);
		return ret;
	} else {
		dm_gpio_set_value(&sii902x->enable_gpio, 1);
		udelay(2000);
	}

	val = ofnode_read_u32_default(dev->node, "bus-format", -1);
	if (val < 0) {
		sii902x->bus_format = MEDIA_BUS_FMT_RGB888_1X24;
	} else {
		switch (val) {
		case FORMAT_RGB_INPUT:
			sii902x->bus_format = MEDIA_BUS_FMT_RGB888_1X24;
			break;
		case FORMAT_YCBCR422_INPUT:
			sii902x->bus_format = MEDIA_BUS_FMT_YUYV8_1X16;
			break;
		case FORMAT_YCBCR444_INPUT:
			sii902x->bus_format = MEDIA_BUS_FMT_YUV8_1X24;
			break;
		default:
			sii902x->bus_format = val;
			break;
		}
	}
	bridge->bus_format = sii902x->bus_format;

	ret = sii902x_init(sii902x);
	if (ret < 0) {
		dev_err(dev, "Failed to init sii902x %d\n", ret);
		return ret;
	}

	printf("sii902x init successfully\n");

	return 0;
}

static struct rockchip_bridge sii902x_driver_data = {
	.funcs = &sii902x_bridge_funcs,
};

static const struct udevice_id sii902x_of_match[] = {
	{
		.compatible = "sil,sii9022",
		.data = (ulong)&sii902x_driver_data,
	},
	{}
};

static int sii902x_get_timing(struct udevice *dev)
{
	struct sii902x *sii902x = dev_get_priv(dev);
	struct rockchip_bridge *bridge = sii902x->bridge;
	struct display_state *state = bridge->state;
	struct connector_state *conn_state = &state->conn_state;
	struct drm_display_mode *mode = &conn_state->mode;
	int ret = 0;

	conn_state->edid = drm_do_get_edid(&sii902x->adap);
	if (conn_state->edid)
		ret = drm_add_edid_modes(&sii902x->edid_data, conn_state->edid);

	if (ret <= 0) {
		dev_err(dev, "Failed to get edid %d\n", ret);
		return ret;
	}

	drm_mode_max_resolution_filter(&sii902x->edid_data, &state->crtc_state.max_output);
	if (!drm_mode_prune_invalid(&sii902x->edid_data)) {
		dev_err(dev, "Failed to find valid display mode\n");
		return -EINVAL;
	}

	drm_mode_sort(&sii902x->edid_data);
	*mode = *sii902x->edid_data.preferred_mode;

	return 0;
}

struct video_bridge_ops sii902x_ops = {
	.get_timing = sii902x_get_timing,
};

U_BOOT_DRIVER(sii902x) = {
	.name = "sii902x",
	.id = UCLASS_VIDEO_BRIDGE,
	.of_match = sii902x_of_match,
	.probe = sii902x_probe,
	.priv_auto_alloc_size = sizeof(struct sii902x),
	.ops = &sii902x_ops,
};