[[RFC]DPU PATCH] drm/bridge: add sn65dsi86 bridge driver support

[Date Prev][Date Next][Thread Prev][Thread Next][Date Index][Thread Index]

 



Add support for TI's sn65dsi86 dsi2edp bridge chip.
The chip converts DSI transmitted signal to eDP signal,
which is fed to the connected eDP panel.

Signed-off-by: Sandeep Panda <spanda@xxxxxxxxxxxxxx>
---
 .../bindings/display/bridge/ti,sn65dsi86.txt       |   53 +
 drivers/gpu/drm/bridge/ti-sn65dsi86.c              | 1146 ++++++++++++++++++++
 2 files changed, 1199 insertions(+)
 create mode 100644 Documentation/devicetree/bindings/display/bridge/ti,sn65dsi86.txt
 create mode 100644 drivers/gpu/drm/bridge/ti-sn65dsi86.c

diff --git a/Documentation/devicetree/bindings/display/bridge/ti,sn65dsi86.txt b/Documentation/devicetree/bindings/display/bridge/ti,sn65dsi86.txt
new file mode 100644
index 0000000..5794770
--- /dev/null
+++ b/Documentation/devicetree/bindings/display/bridge/ti,sn65dsi86.txt
@@ -0,0 +1,53 @@
+SN65DSI86 DSItoeDP bridge chip
+------------------------------
+
+This is the binding for Texas Instruments SN65DSI86 bridge.
+
+Required properties:
+
+- compatible: Must be "ti,sn65dsi86"
+- reg:					Main I2C slave ID (for I2C host driver)
+- sn,irq-gpio:				Main IRQ gpio mapping
+- sn,enable-gpio			Main reset gpio mapping
+
+Required nodes:
+
+This device has two video ports. Their connections are modelled using the OF
+graph bindings specified in Documentation/devicetree/bindings/graph.txt.
+
+- Video port 0 for DSI input
+- Video port 1 for eDP output
+
+Example
+-------
+
+vga-bridge {
+	compatible = "ti,sn65dsi86";
+	#address-cells = <1>;
+	#size-cells = <0>;
+	reg = <0x39>;
+
+	sn,irq-gpio = <&msmgpio 32 0>;
+	sn,enable-gpio = <&msmgpio 33 0>;
+
+	ports {
+		#address-cells = <1>;
+		#size-cells = <0>;
+
+		port@0 {
+			reg = <0>;
+
+			vga_bridge_in: endpoint {
+				remote-endpoint = <&dsi_out>;
+			};
+		};
+
+		port@1 {
+			reg = <1>;
+
+			vga_bridge_out: endpoint {
+				remote-endpoint = <&edp_in>;
+			};
+		};
+	};
+}
diff --git a/drivers/gpu/drm/bridge/ti-sn65dsi86.c b/drivers/gpu/drm/bridge/ti-sn65dsi86.c
new file mode 100644
index 0000000..ff226b9
--- /dev/null
+++ b/drivers/gpu/drm/bridge/ti-sn65dsi86.c
@@ -0,0 +1,1146 @@
+// SPDX-License-Identifier: GPL-2.0
+/* Copyright (c) 2018, The Linux Foundation. All rights reserved.
+ *
+ * This program is free software; you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License version 2 and
+ * only version 2 as published by the Free Software Foundation.
+ *
+ * This program is distributed in the hope that it will be useful,
+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
+ * GNU General Public License for more details.
+ *
+ */
+
+#define pr_fmt(fmt) "%s: " fmt, __func__
+
+#include <linux/types.h>
+#include <linux/kernel.h>
+#include <linux/module.h>
+#include <linux/init.h>
+#include <linux/device.h>
+#include <linux/platform_device.h>
+#include <linux/delay.h>
+#include <linux/i2c.h>
+#include <linux/gpio.h>
+#include <linux/interrupt.h>
+#include <linux/of_gpio.h>
+#include <linux/of_graph.h>
+#include <linux/of_irq.h>
+#include <linux/regulator/consumer.h>
+#include <drm/drmP.h>
+#include <drm/drm_atomic.h>
+#include <drm/drm_atomic_helper.h>
+#include <drm/drm_crtc_helper.h>
+#include <drm/drm_mipi_dsi.h>
+
+struct sn65dsi86_reg_cfg {
+	u8 reg;
+	u8 val;
+	int sleep_in_ms;
+};
+
+struct sn65dsi86_video_cfg {
+	u32 h_active;
+	u32 h_front_porch;
+	u32 h_pulse_width;
+	u32 h_back_porch;
+	bool h_polarity;
+	u32 v_active;
+	u32 v_front_porch;
+	u32 v_pulse_width;
+	u32 v_back_porch;
+	bool v_polarity;
+	u32 pclk_khz;
+	u32 num_of_lanes;
+};
+
+struct sn65dsi86_gpios {
+	u32 irq_gpio;
+	u32 enable_gpio;
+	u32 i2c_sda;
+	u32 i2c_scl;
+	u32 panel_bias_en;
+	u32 panel_bklt_en;
+	u32 panel_bklt_ctrl;
+};
+
+struct sn65dsi86_reg_cfg reg_cfg_proto_0[] = {
+	{0x0A, 0x02, 0x0},	/* REFCLK 19.2MHz */
+	{0x10, 0x26, 0x14},	/* DSI lanes */
+	{0x12, 0x7B, 0x0},	/* DSIA CLK FREQ 309.03MHz */
+	{0x5A, 0x05, 0x0},	/* enhanced framing and ASSR */
+	{0x93, 0x30, 0x0},	/* 4 DP lanes no SSC */
+	{0x94, 0x80, 0x0},	/* HBR */
+	{0x0D, 0x01, 0x0},	/* PLL ENABLE */
+	{0x95, 0x00, 0x0},	/* POST-Cursor2 0dB */
+	{0x64, 0x01, 0x0},	/* WriteDPCD Register 0x0010A in Sink */
+	{0x74, 0x00, 0x0},
+	{0x75, 0x01, 0x0},
+	{0x76, 0x0A, 0x0},
+	{0x77, 0x01, 0x0},
+	{0x78, 0x81, 0x14},
+	{0x96, 0x0A, 0x14},	/* Semi-Auto TRAIN */
+	{0xFF, 0x14, 0x0},
+	{0x20, 0x70, 0x0},	/* CHA_ACTIVE_LINE_LENGTH */
+	{0x21, 0x08, 0x0},
+	{0x24, 0xA0, 0x0},	/* CHA_VERTICAL_DISPLAY_SIZE */
+	{0x25, 0x05, 0x0},
+	{0x2C, 0x20, 0x0},	/* CHA_HSYNC_PULSE_WIDTH */
+	{0x2D, 0x80, 0x0},
+	{0x30, 0x0A, 0x0},	/* CHA_VSYNC_PULSE_WIDTH */
+	{0x31, 0x80, 0x0},
+	{0x34, 0x50, 0x0},	/* CHA_HORIZONTAL_BACK_PORCH */
+	{0x36, 0x1B, 0x0},	/* CHA_VERTICAL_BACK_PORCH */
+	{0x38, 0x30, 0x0},	/* CHA_HORIZONTAL_FRONT_PORCH */
+	{0x3A, 0x03, 0x0},	/* CHA_VERTICAL_FRONT_PORCH */
+	{0x5B, 0x00, 0x0},	/* DP- 24bpp */
+	{0x3C, 0x00, 0x14},	/* COLOR BAR disabled */
+	{0x5A, 0x0D, 0x0},	/* Ehnc framing, ASSR, Vstream enable */
+};
+
+struct sn65dsi86 {
+	struct device *dev;
+	struct drm_bridge bridge;
+	struct drm_connector connector;
+
+	struct device_node *host_node;
+	struct mipi_dsi_device *dsi;
+
+	u8 i2c_addr;
+	int irq;
+
+	struct sn65dsi86_gpios gpios;
+
+	unsigned int num_supplies;
+	struct regulator_bulk_data *supplies;
+
+	struct i2c_client *i2c_client;
+
+	enum drm_connector_status connector_status;
+	bool power_on;
+
+	bool is_pluggable;
+	u32 num_of_modes;
+	struct list_head mode_list;
+	struct edid *edid;
+
+	struct drm_display_mode curr_mode;
+	struct sn65dsi86_video_cfg video_cfg;
+};
+
+static int sn65dsi86_write(struct sn65dsi86 *pdata, u8 reg, u8 val)
+{
+	struct i2c_client *client = pdata->i2c_client;
+	u8 buf[2] = {reg, val};
+	struct i2c_msg msg = {
+		.addr = client->addr,
+		.flags = 0,
+		.len = 2,
+		.buf = buf,
+	};
+
+	if (i2c_transfer(client->adapter, &msg, 1) < 1) {
+		pr_err("i2c write failed\n");
+		return -EIO;
+	}
+
+	return 0;
+}
+
+static int sn65dsi86_read(struct sn65dsi86 *pdata, u8 reg, char *buf, u32 size)
+{
+	struct i2c_client *client = pdata->i2c_client;
+	struct i2c_msg msg[2] = {
+		{
+			.addr = client->addr,
+			.flags = 0,
+			.len = 1,
+			.buf = &reg,
+		},
+		{
+			.addr = client->addr,
+			.flags = I2C_M_RD,
+			.len = size,
+			.buf = buf,
+		}
+	};
+
+	if (i2c_transfer(client->adapter, msg, 2) != 2) {
+		pr_err("i2c read failed\n");
+		return -EIO;
+	}
+
+	return 0;
+}
+
+static int sn65dsi86_write_array(struct sn65dsi86 *pdata,
+	struct sn65dsi86_reg_cfg *cfg, int size)
+{
+	int ret = 0;
+	int i;
+
+	size = size / sizeof(struct sn65dsi86_reg_cfg);
+	for (i = 0; i < size; i++) {
+		ret = sn65dsi86_write(pdata, cfg[i].reg, cfg[i].val);
+
+		if (ret != 0) {
+			pr_err("reg writes failed. Last write %02X to %02X\n",
+				cfg[i].val, cfg[i].reg);
+			goto w_regs_fail;
+		}
+
+		if (cfg[i].sleep_in_ms)
+			msleep(cfg[i].sleep_in_ms);
+	}
+
+w_regs_fail:
+	if (ret != 0)
+		pr_err("exiting with ret = %d after %d writes\n", ret, i);
+
+	return ret;
+}
+
+static int sn65dsi86_gpio_configure(struct sn65dsi86 *pdata, bool on)
+{
+	int ret = 0;
+
+	if (on) {
+		ret = gpio_request(pdata->gpios.enable_gpio,
+			"sn65dsi86-enable-gpio");
+		if (ret) {
+			pr_err("sn65dsi86 enable gpio request failed\n");
+			goto error;
+		}
+
+		ret = gpio_direction_output(pdata->gpios.enable_gpio, 1);
+		if (ret) {
+			pr_err("sn65dsi86 enable gpio direction failed\n");
+			goto enable_error;
+		}
+
+		if (gpio_is_valid(pdata->gpios.i2c_sda)) {
+			ret = gpio_request(pdata->gpios.i2c_sda,
+					"sn65dsi86-i2c-sda");
+			if (ret) {
+				pr_err("sn65dsi86 i2c sda request failed\n");
+				goto enable_error;
+			}
+
+			ret = gpio_direction_output(pdata->gpios.i2c_sda, 1);
+			if (ret) {
+				pr_err("sn65dsi86 i2c sda direction failed\n");
+				goto i2c_sda_error;
+			}
+		}
+
+		if (gpio_is_valid(pdata->gpios.i2c_scl)) {
+			ret = gpio_request(pdata->gpios.i2c_scl,
+					"sn65dsi86-i2c-scl");
+			if (ret) {
+				pr_err("sn65dsi86 i2c scl request failed\n");
+				goto i2c_sda_error;
+			}
+
+			ret = gpio_direction_output(pdata->gpios.i2c_scl, 1);
+			if (ret) {
+				pr_err("sn65dsi86 i2c scl direction failed\n");
+				goto i2c_scl_error;
+			}
+		}
+
+		if (gpio_is_valid(pdata->gpios.irq_gpio)) {
+			ret = gpio_request(pdata->gpios.irq_gpio,
+				"sn65dsi86-irq-gpio");
+			if (ret) {
+				pr_err("sn65dsi86 irq gpio request failed\n");
+				goto i2c_scl_error;
+			}
+
+			ret = gpio_direction_input(pdata->gpios.irq_gpio);
+			if (ret) {
+				pr_err("sn65dsi86 irq gpio direction failed\n");
+				goto irq_error;
+			}
+		}
+
+		if (gpio_is_valid(pdata->gpios.panel_bias_en)) {
+			ret = gpio_request(pdata->gpios.panel_bias_en,
+				"sn65dsi86-panel-bias-gpio");
+			if (ret) {
+				pr_err("sn65dsi86 bias en request failed\n");
+				goto irq_error;
+			}
+
+			ret = gpio_direction_output(
+					pdata->gpios.panel_bias_en, 1);
+			if (ret) {
+				pr_err("sn65dsi86 bias en direction failed\n");
+				goto panel_bias_error;
+			}
+		}
+
+		if (gpio_is_valid(pdata->gpios.panel_bklt_en)) {
+			ret = gpio_request(pdata->gpios.panel_bklt_en,
+				"sn65dsi86-panel-bklt-en");
+			if (ret) {
+				pr_err("sn65dsi86 bklt en request failed\n");
+				goto panel_bias_error;
+			}
+
+			ret = gpio_direction_output(
+					pdata->gpios.panel_bklt_en, 1);
+			if (ret) {
+				pr_err("sn65dsi86 bklt en direction failed\n");
+				goto panel_bklt_en_error;
+			}
+		}
+
+		if (gpio_is_valid(pdata->gpios.panel_bklt_ctrl)) {
+			ret = gpio_request(pdata->gpios.panel_bklt_ctrl,
+				"sn65dsi86-panel-bklt-ctrl");
+			if (ret) {
+				pr_err("sn65dsi86 bklt ctrl request failed\n");
+				goto panel_bklt_en_error;
+			}
+
+			ret = gpio_direction_output(
+					pdata->gpios.panel_bklt_ctrl, 1);
+			if (ret) {
+				pr_err("sn65dsi86 bklt ctl direction failed\n");
+				goto panel_bklt_ctrl_error;
+			}
+		}
+
+	} else {
+		if (gpio_is_valid(pdata->gpios.panel_bklt_ctrl))
+			gpio_free(pdata->gpios.panel_bklt_ctrl);
+		if (gpio_is_valid(pdata->gpios.panel_bklt_en))
+			gpio_free(pdata->gpios.panel_bklt_en);
+		if (gpio_is_valid(pdata->gpios.panel_bias_en))
+			gpio_free(pdata->gpios.panel_bias_en);
+		if (gpio_is_valid(pdata->gpios.irq_gpio))
+			gpio_free(pdata->gpios.irq_gpio);
+		if (gpio_is_valid(pdata->gpios.i2c_scl))
+			gpio_free(pdata->gpios.i2c_scl);
+		if (gpio_is_valid(pdata->gpios.i2c_sda))
+			gpio_free(pdata->gpios.i2c_sda);
+		gpio_free(pdata->gpios.enable_gpio);
+	}
+
+	return ret;
+
+panel_bklt_ctrl_error:
+	if (gpio_is_valid(pdata->gpios.panel_bklt_ctrl))
+		gpio_free(pdata->gpios.panel_bklt_ctrl);
+panel_bklt_en_error:
+	if (gpio_is_valid(pdata->gpios.panel_bklt_en))
+		gpio_free(pdata->gpios.panel_bklt_en);
+panel_bias_error:
+	if (gpio_is_valid(pdata->gpios.panel_bias_en))
+		gpio_free(pdata->gpios.panel_bias_en);
+irq_error:
+	if (gpio_is_valid(pdata->gpios.irq_gpio))
+		gpio_free(pdata->gpios.irq_gpio);
+i2c_scl_error:
+	if (gpio_is_valid(pdata->gpios.i2c_scl))
+		gpio_free(pdata->gpios.i2c_scl);
+i2c_sda_error:
+	if (gpio_is_valid(pdata->gpios.i2c_sda))
+		gpio_free(pdata->gpios.i2c_sda);
+enable_error:
+	gpio_free(pdata->gpios.enable_gpio);
+error:
+	return ret;
+}
+
+static void sn65dsi86_power_ctrl(struct sn65dsi86 *pdata, bool enable)
+{
+	if (!pdata)
+		return;
+
+	if (!pdata->power_on && enable) {
+		if (sn65dsi86_gpio_configure(pdata, true)) {
+			pr_err("bridge gpio enable failed\n");
+			return;
+		}
+
+		if (regulator_bulk_enable(pdata->num_supplies,
+						pdata->supplies)) {
+			pr_err("bridge regulator enable failed\n");
+			return;
+		}
+		pdata->power_on = true;
+	} else if (pdata->power_on && !enable) {
+		regulator_bulk_disable(pdata->num_supplies, pdata->supplies);
+
+		sn65dsi86_gpio_configure(pdata, false);
+		pdata->power_on = false;
+	} else {
+		pr_debug("unnecessary call to power control\n");
+	}
+}
+
+/* Connector funcs */
+static struct sn65dsi86 *connector_to_sn65dsi86(struct drm_connector *connector)
+{
+	return container_of(connector, struct sn65dsi86, connector);
+}
+
+static int sn65dsi86_send_aux_cmd(struct sn65dsi86 *pdata,
+				  u8 cmd, u8 addr, u8 length, int w_data)
+{
+	u8 read = 0;
+	int retry_cnt = 10;
+
+	sn65dsi86_write(pdata, 0x78, (cmd << 4));	/* AUX_CMD */
+	sn65dsi86_write(pdata, 0x76, addr);		/* AUX_ADDR */
+	sn65dsi86_write(pdata, 0x77, length);		/* AUX_LENGTH */
+	if (w_data >= 0)
+		sn65dsi86_write(pdata, 0x64, (u8)w_data);	/* AUX_WDATA0 */
+
+	/* set SEND bit */
+	sn65dsi86_read(pdata, 0x78, &read, 1);
+	read |= BIT(0);
+	sn65dsi86_write(pdata, 0x78, read);
+
+	/* poll for bridge to ack SEND bit */
+	while (retry_cnt) {
+		sn65dsi86_read(pdata, 0x78, &read, 0x1);
+		if (!(read & BIT(0)))
+			break;
+		retry_cnt--;
+		udelay(1000);
+	}
+
+	if (!retry_cnt) {
+		pr_err("aux_cmd transfer failed\n");
+		return -EINVAL;
+	}
+	return 0;
+}
+
+static int sn65dsi86_read_edid(struct sn65dsi86 *pdata, u8 *buf)
+{
+	int i = 0;
+	u8 addr = 0x79;	/* AUX_RDATA0 */
+	u8 *data = buf;
+
+	if (!data)
+		return -ENOMEM;
+
+	if (sn65dsi86_send_aux_cmd(pdata, 0x4, 0x50, 0x0, -1) ||
+		sn65dsi86_send_aux_cmd(pdata, 0x4, 0x50, 0x01, 0x0) ||
+		sn65dsi86_send_aux_cmd(pdata, 0x5, 0x50, 0x0, -1) ||
+		sn65dsi86_send_aux_cmd(pdata, 0x5, 0x50, 0x10, -1))
+		goto error;
+
+	for (i = 0; i < 16; i++) {
+		if (sn65dsi86_read(pdata, addr, data, 0x1))
+			goto error;
+		addr++;
+		data++;
+	}
+
+	return 0;
+error:
+	pr_err("edid read over i2c failed\n");
+	return -EINVAL;
+}
+
+static int sn65dsi86_read_edid_block(struct sn65dsi86 *pdata,
+			       u8 *buf, unsigned int block)
+{
+	if (block == 0) {
+		if (sn65dsi86_read_edid(pdata, buf))
+			goto error;
+	} else if (block == 1) {
+		/* move segment pointer */
+		if (sn65dsi86_send_aux_cmd(pdata, 0x4, 0x30, 0x0, -1) ||
+			sn65dsi86_send_aux_cmd(pdata, 0x4, 0x30, 0x01, 0x1) ||
+			sn65dsi86_send_aux_cmd(pdata, 0x0, 0x30, 0x00, -1))
+			goto error;
+		else
+			if (sn65dsi86_read_edid(pdata, buf))
+				goto error;
+	} else {
+		pr_debug("unsupported edid block\n");
+		goto error;
+	}
+
+	return 0;
+error:
+	pr_err("edid block read failed\n");
+	return -EINVAL;
+}
+
+static int sn65dsi86_get_edid_block(void *data, u8 *buf, unsigned int block,
+				  size_t len)
+{
+	struct sn65dsi86 *pdata = data;
+	int ret = 0;
+
+	pr_debug("get edid block: block=%d, len=%d\n", block, (int)len);
+
+	if (len > 128 || block > 1)
+		return -EINVAL;
+
+	ret = sn65dsi86_read_edid_block(pdata, buf, block);
+	if (ret) {
+		pr_err("edid read failed for block: %d ret: %d\n", block, ret);
+		return ret;
+	}
+
+	return 0;
+}
+
+static int sn65dsi86_connector_get_modes(struct drm_connector *connector)
+{
+	struct sn65dsi86 *pdata = connector_to_sn65dsi86(connector);
+	struct drm_display_mode *mode, *m;
+
+	if (pdata->edid)
+		return drm_add_edid_modes(connector, pdata->edid);
+
+	sn65dsi86_power_ctrl(pdata, true);
+	if (pdata->is_pluggable) {
+		pdata->edid = drm_do_get_edid(connector,
+				sn65dsi86_get_edid_block, pdata);
+
+		drm_mode_connector_update_edid_property(connector, pdata->edid);
+		pdata->num_of_modes = drm_add_edid_modes(connector,
+								pdata->edid);
+	}
+
+	if (!pdata->is_pluggable || !pdata->num_of_modes) {
+		/*
+		 * if device does not support HPD or due to some reason
+		 * EDID read failed then fall back to mode_list which is
+		 * already parsed from dt.
+		 */
+		list_for_each_entry(mode, &pdata->mode_list, head) {
+			m = drm_mode_duplicate(connector->dev, mode);
+			if (!m) {
+				pr_err("failed to get mode %dx%d\n",
+					mode->hdisplay, mode->vdisplay);
+				break;
+			}
+			drm_mode_probed_add(connector, m);
+		}
+	}
+
+	sn65dsi86_power_ctrl(pdata, false);
+	return pdata->num_of_modes;
+}
+
+static enum drm_mode_status
+sn65dsi86_connector_mode_valid(struct drm_connector *connector,
+			     struct drm_display_mode *mode)
+{
+	struct sn65dsi86 *pdata = connector_to_sn65dsi86(connector);
+	struct drm_display_mode *m;
+
+	if (pdata->edid)
+		return MODE_OK;
+
+	if (!pdata->is_pluggable) {
+		list_for_each_entry(m, &pdata->mode_list, head) {
+			if (m->hdisplay == mode->hdisplay &&
+				m->vdisplay == mode->vdisplay)
+				return MODE_OK;
+		}
+	}
+
+	return MODE_BAD;
+}
+
+static struct drm_connector_helper_funcs sn65dsi86_connector_helper_funcs = {
+	.get_modes = sn65dsi86_connector_get_modes,
+	.mode_valid = sn65dsi86_connector_mode_valid,
+};
+
+static enum drm_connector_status
+sn65dsi86_connector_detect(struct drm_connector *connector, bool force)
+{
+	struct sn65dsi86 *pdata = connector_to_sn65dsi86(connector);
+
+	pdata->connector_status = pdata->power_on ?
+		connector_status_connected : connector_status_disconnected;
+
+	return pdata->connector_status;
+}
+
+static const struct drm_connector_funcs sn65dsi86_connector_funcs = {
+	.fill_modes = drm_helper_probe_single_connector_modes,
+	.detect = sn65dsi86_connector_detect,
+	.destroy = drm_connector_cleanup,
+	.reset = drm_atomic_helper_connector_reset,
+	.atomic_duplicate_state = drm_atomic_helper_connector_duplicate_state,
+	.atomic_destroy_state = drm_atomic_helper_connector_destroy_state,
+};
+
+static struct sn65dsi86 *bridge_to_sn65dsi86(struct drm_bridge *bridge)
+{
+	return container_of(bridge, struct sn65dsi86, bridge);
+}
+
+static int sn65dsi86_read_device_rev(struct sn65dsi86 *pdata)
+{
+	u8 rev = 0;
+	int ret = 0;
+
+	ret = sn65dsi86_read(pdata, 0x08, &rev, 1);
+
+	if (!ret) {
+		if (rev == 0x2) {
+			pr_info("SN65DSI86 revision id: 0x%x\n", rev);
+		} else {
+			pr_warn("SN65DSI86 revision id mismatch\n");
+			ret = -EINVAL;
+		}
+	}
+
+	return ret;
+}
+
+static irqreturn_t sn65dsi86_irq_thread_handler(int irq, void *dev_id)
+{
+	return IRQ_HANDLED;
+}
+
+static const char * const sn65dsi86_supply_names[] = {
+	"vccio",
+	"vcca",
+};
+
+static int sn65dsi86_init_regulators(struct sn65dsi86 *pdata)
+{
+	const char * const *supply_names;
+	unsigned int i;
+	int ret;
+
+	supply_names = sn65dsi86_supply_names;
+	pdata->num_supplies = ARRAY_SIZE(sn65dsi86_supply_names);
+
+	pdata->supplies = devm_kcalloc(pdata->dev, pdata->num_supplies,
+				     sizeof(*pdata->supplies), GFP_KERNEL);
+	if (!pdata->supplies)
+		return -ENOMEM;
+
+	for (i = 0; i < pdata->num_supplies; i++)
+		pdata->supplies[i].supply = supply_names[i];
+
+	ret = devm_regulator_bulk_get(pdata->dev,
+			pdata->num_supplies, pdata->supplies);
+	if (ret)
+		return ret;
+
+	return regulator_bulk_enable(pdata->num_supplies, pdata->supplies);
+}
+
+static int sn65dsi86_bridge_attach(struct drm_bridge *bridge)
+{
+	struct mipi_dsi_host *host;
+	struct mipi_dsi_device *dsi;
+	struct sn65dsi86 *pdata = bridge_to_sn65dsi86(bridge);
+	int ret;
+	const struct mipi_dsi_device_info info = { .type = "sn65dsi86",
+						   .channel = 0,
+						   .node = NULL,
+						 };
+
+	if (!bridge->encoder) {
+		DRM_ERROR("Parent encoder object not found");
+		return -ENODEV;
+	}
+
+	/* No HPD */
+	pdata->connector.polled = 0;
+
+	ret = drm_connector_init(bridge->dev, &pdata->connector,
+				 &sn65dsi86_connector_funcs,
+				 DRM_MODE_CONNECTOR_eDP);
+	if (ret) {
+		DRM_ERROR("Failed to initialize connector with drm\n");
+		return ret;
+	}
+
+	drm_connector_helper_add(&pdata->connector,
+				 &sn65dsi86_connector_helper_funcs);
+	drm_mode_connector_attach_encoder(&pdata->connector, bridge->encoder);
+
+	host = of_find_mipi_dsi_host_by_node(pdata->host_node);
+	if (!host) {
+		pr_err("failed to find dsi host\n");
+		return -ENODEV;
+	}
+
+	dsi = mipi_dsi_device_register_full(host, &info);
+	if (IS_ERR(dsi)) {
+		pr_err("failed to create dsi device\n");
+		ret = PTR_ERR(dsi);
+		goto err_dsi_device;
+	}
+
+	/* setting to 4 lanes always for now */
+	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_EOT_PACKET | MIPI_DSI_MODE_VIDEO_HSE;
+
+	ret = mipi_dsi_attach(dsi);
+	if (ret < 0) {
+		pr_err("failed to attach dsi to host\n");
+		goto err_dsi_attach;
+	}
+
+	pdata->dsi = dsi;
+
+	pr_debug("bridge attached\n");
+
+	return 0;
+
+err_dsi_attach:
+	mipi_dsi_device_unregister(dsi);
+err_dsi_device:
+	return ret;
+}
+
+static void sn65dsi86_set_video_cfg(struct sn65dsi86 *pdata,
+	struct drm_display_mode *mode,
+	struct sn65dsi86_video_cfg *video_cfg)
+{
+	video_cfg->h_active = mode->hdisplay;
+	video_cfg->v_active = mode->vdisplay;
+	video_cfg->h_front_porch = mode->hsync_start - mode->hdisplay;
+	video_cfg->v_front_porch = mode->vsync_start - mode->vdisplay;
+	video_cfg->h_back_porch = mode->htotal - mode->hsync_end;
+	video_cfg->v_back_porch = mode->vtotal - mode->vsync_end;
+	video_cfg->h_pulse_width = mode->hsync_end - mode->hsync_start;
+	video_cfg->v_pulse_width = mode->vsync_end - mode->vsync_start;
+	video_cfg->pclk_khz = mode->clock;
+
+	video_cfg->h_polarity = !!(mode->flags & DRM_MODE_FLAG_PHSYNC);
+	video_cfg->v_polarity = !!(mode->flags & DRM_MODE_FLAG_PVSYNC);
+
+	/* setting to 4 lanes always for now */
+	video_cfg->num_of_lanes = 4;
+
+	pr_debug("video=h[%d,%d,%d,%d] v[%d,%d,%d,%d] pclk=%d lane=%d\n",
+		video_cfg->h_active, video_cfg->h_front_porch,
+		video_cfg->h_pulse_width, video_cfg->h_back_porch,
+		video_cfg->v_active, video_cfg->v_front_porch,
+		video_cfg->v_pulse_width, video_cfg->v_back_porch,
+		video_cfg->pclk_khz, video_cfg->num_of_lanes);
+}
+
+static void sn65dsi86_bridge_mode_set(struct drm_bridge *bridge,
+				    struct drm_display_mode *mode,
+				    struct drm_display_mode *adj_mode)
+{
+	struct sn65dsi86 *pdata = bridge_to_sn65dsi86(bridge);
+	struct sn65dsi86_video_cfg *video_cfg = &pdata->video_cfg;
+	int ret = 0;
+
+	pr_debug("bridge mode_set: hdisplay=%d, vdisplay=%d, vrefresh=%d, clock=%d\n",
+		adj_mode->hdisplay, adj_mode->vdisplay,
+		adj_mode->vrefresh, adj_mode->clock);
+
+	drm_mode_copy(&pdata->curr_mode, adj_mode);
+
+	memset(video_cfg, 0, sizeof(struct sn65dsi86_video_cfg));
+	sn65dsi86_set_video_cfg(pdata, adj_mode, video_cfg);
+
+	if (video_cfg->num_of_lanes != pdata->dsi->lanes) {
+		mipi_dsi_detach(pdata->dsi);
+		pdata->dsi->lanes = video_cfg->num_of_lanes;
+		ret = mipi_dsi_attach(pdata->dsi);
+		if (ret)
+			pr_err("failed to change host lanes\n");
+	}
+}
+
+static void sn65dsi86_bridge_disable(struct drm_bridge *bridge)
+{
+	struct sn65dsi86 *pdata = bridge_to_sn65dsi86(bridge);
+
+	sn65dsi86_power_ctrl(pdata, false);
+
+	pdata->connector_status =  connector_status_disconnected;
+}
+
+static void sn65dsi86_bridge_enable(struct drm_bridge *bridge)
+{
+	struct sn65dsi86 *pdata = bridge_to_sn65dsi86(bridge);
+
+	sn65dsi86_power_ctrl(pdata, true);
+
+	sn65dsi86_write_array(pdata, reg_cfg_proto_0, sizeof(reg_cfg_proto_0));
+}
+
+static const struct drm_bridge_funcs sn65dsi86_bridge_funcs = {
+	.attach = sn65dsi86_bridge_attach,
+	.enable = sn65dsi86_bridge_enable,
+	.disable = sn65dsi86_bridge_disable,
+	.mode_set = sn65dsi86_bridge_mode_set,
+};
+
+static int sn65dsi86_parse_dt_modes(struct device_node *np,
+					struct list_head *head,
+					u32 *num_of_modes)
+{
+	int rc = 0;
+	struct drm_display_mode *mode;
+	u32 mode_count = 0;
+	struct device_node *node = NULL;
+	struct device_node *root_node = NULL;
+	u32 h_front_porch, h_pulse_width, h_back_porch;
+	u32 v_front_porch, v_pulse_width, v_back_porch;
+	bool h_active_high, v_active_high;
+	u32 flags = 0;
+
+	root_node = of_get_child_by_name(np, "sn,custom-modes");
+	if (!root_node) {
+		root_node = of_parse_phandle(np, "sn,custom-modes", 0);
+		if (!root_node) {
+			pr_info("No modes present for sn,custom-modes");
+			goto end;
+		}
+	}
+
+	for_each_child_of_node(root_node, node) {
+		rc = 0;
+		mode = kzalloc(sizeof(*mode), GFP_KERNEL);
+		if (!mode) {
+			rc =  -ENOMEM;
+			goto end;
+		}
+
+		of_property_read_u32(node, "sn,mode-h-active",
+						&mode->hdisplay);
+
+		of_property_read_u32(node, "sn,mode-h-front-porch",
+						&h_front_porch);
+		of_property_read_u32(node, "sn,mode-h-pulse-width",
+						&h_pulse_width);
+
+		of_property_read_u32(node, "sn,mode-h-back-porch",
+						&h_back_porch);
+
+		h_active_high = of_property_read_bool(node,
+						"sn,mode-h-active-high");
+
+		of_property_read_u32(node, "sn,mode-v-active",
+						&mode->vdisplay);
+		of_property_read_u32(node, "sn,mode-v-front-porch",
+						&v_front_porch);
+
+		of_property_read_u32(node, "sn,mode-v-pulse-width",
+						&v_pulse_width);
+		of_property_read_u32(node, "sn,mode-v-back-porch",
+						&v_back_porch);
+		v_active_high = of_property_read_bool(node,
+						"sn,mode-v-active-high");
+
+		of_property_read_u32(node, "sn,mode-refresh-rate",
+						&mode->vrefresh);
+
+		of_property_read_u32(node, "sn,mode-clock-in-khz",
+						&mode->clock);
+
+		mode->hsync_start = mode->hdisplay + h_front_porch;
+		mode->hsync_end = mode->hsync_start + h_pulse_width;
+		mode->htotal = mode->hsync_end + h_back_porch;
+		mode->vsync_start = mode->vdisplay + v_front_porch;
+		mode->vsync_end = mode->vsync_start + v_pulse_width;
+		mode->vtotal = mode->vsync_end + v_back_porch;
+
+		if (!mode->htotal || !mode->vtotal) {
+			rc = -EINVAL;
+			goto fail;
+		}
+
+		if (h_active_high)
+			flags |= DRM_MODE_FLAG_PHSYNC;
+		else
+			flags |= DRM_MODE_FLAG_NHSYNC;
+		if (v_active_high)
+			flags |= DRM_MODE_FLAG_PVSYNC;
+		else
+			flags |= DRM_MODE_FLAG_NVSYNC;
+		mode->flags = flags;
+
+		if (!rc) {
+			mode_count++;
+			list_add_tail(&mode->head, head);
+		}
+
+		drm_mode_set_name(mode);
+
+		pr_debug("mode[%s] h[%d,%d,%d,%d] v[%d,%d,%d,%d] %d %x %dkHZ\n",
+			mode->name, mode->hdisplay, mode->hsync_start,
+			mode->hsync_end, mode->htotal, mode->vdisplay,
+			mode->vsync_start, mode->vsync_end, mode->vtotal,
+			mode->vrefresh, mode->flags, mode->clock);
+fail:
+		if (rc) {
+			kfree(mode);
+			continue;
+		}
+	}
+
+	if (num_of_modes)
+		*num_of_modes = mode_count;
+
+end:
+	return rc;
+}
+
+static int sn65dsi86_parse_gpios(struct device_node *np,
+					struct sn65dsi86 *pdata)
+{
+	int ret = 0;
+
+	pdata->gpios.irq_gpio =
+		of_get_named_gpio(np, "sn,irq-gpio", 0);
+	if (!gpio_is_valid(pdata->gpios.irq_gpio)) {
+		pr_err("irq gpio not specified\n");
+		ret = -EINVAL;
+		goto exit;
+	}
+
+	pdata->gpios.enable_gpio =
+		of_get_named_gpio(np, "sn,enable-gpio", 0);
+	if (!gpio_is_valid(pdata->gpios.enable_gpio)) {
+		pr_err("enable gpio not specified\n");
+		ret = -EINVAL;
+		goto exit;
+	}
+
+	pdata->gpios.i2c_sda =
+		of_get_named_gpio(np, "sn,i2c-sda", 0);
+	if (!gpio_is_valid(pdata->gpios.i2c_sda)) {
+		pr_err("i2c sda gpio not specified\n");
+		ret = -EINVAL;
+		goto exit;
+	}
+
+	pdata->gpios.i2c_scl =
+		of_get_named_gpio(np, "sn,i2c-scl", 0);
+	if (!gpio_is_valid(pdata->gpios.i2c_scl)) {
+		pr_err("i2c scl gpio not specified\n");
+		ret = -EINVAL;
+		goto exit;
+	}
+
+	pdata->gpios.panel_bias_en =
+		of_get_named_gpio(np, "sn,panel-bias-en", 0);
+	if (!gpio_is_valid(pdata->gpios.panel_bias_en)) {
+		pr_err("panel bias gpio not specified\n");
+		ret = -EINVAL;
+		goto exit;
+	}
+
+	pdata->gpios.panel_bklt_en =
+		of_get_named_gpio(np, "sn,panel-bklt-en", 0);
+	if (!gpio_is_valid(pdata->gpios.panel_bklt_en)) {
+		pr_err("panel bklt en gpio not specified\n");
+		ret = -EINVAL;
+		goto exit;
+	}
+
+	pdata->gpios.panel_bklt_ctrl =
+		of_get_named_gpio(np, "sn,panel-bklt-ctrl", 0);
+	if (!gpio_is_valid(pdata->gpios.panel_bklt_ctrl)) {
+		pr_err("panel bklt ctrl gpio not specified\n");
+		ret = -EINVAL;
+		goto exit;
+	}
+
+exit:
+	return ret;
+}
+
+static int sn65dsi86_parse_dt(struct device *dev, struct sn65dsi86 *pdata)
+{
+	struct device_node *np = dev->of_node;
+	struct device_node *end_node;
+	int ret = 0;
+
+	end_node = of_graph_get_endpoint_by_regs(np, 0, 0);
+	if (!end_node) {
+		pr_err("remote endpoint not found\n");
+		return -ENODEV;
+	}
+
+	pdata->host_node = of_graph_get_remote_port_parent(end_node);
+	of_node_put(end_node);
+	if (!pdata->host_node) {
+		pr_err("remote node not found\n");
+		return -ENODEV;
+	}
+	of_node_put(pdata->host_node);
+
+	ret = sn65dsi86_parse_gpios(np, pdata);
+
+	pdata->is_pluggable = of_property_read_bool(np, "sn,is-pluggable");
+	pr_debug("is_pluggable = %d\n", pdata->is_pluggable);
+	if (!pdata->is_pluggable) {
+		INIT_LIST_HEAD(&pdata->mode_list);
+		sn65dsi86_parse_dt_modes(np,
+			&pdata->mode_list, &pdata->num_of_modes);
+	}
+
+	return ret;
+}
+
+static int sn65dsi86_probe(struct i2c_client *client,
+	 const struct i2c_device_id *id)
+{
+	struct sn65dsi86 *pdata;
+	int ret = 0;
+	struct drm_display_mode *mode, *n;
+
+	if (!client || !client->dev.of_node) {
+		pr_err("invalid input\n");
+		return -EINVAL;
+	}
+
+	if (!i2c_check_functionality(client->adapter, I2C_FUNC_I2C)) {
+		pr_err("device doesn't support I2C\n");
+		return -ENODEV;
+	}
+
+	pdata = devm_kzalloc(&client->dev,
+		sizeof(struct sn65dsi86), GFP_KERNEL);
+	if (!pdata)
+		return -ENOMEM;
+
+	pdata->power_on = false;
+	pdata->is_pluggable = false;
+	pdata->connector_status = connector_status_disconnected;
+	pdata->dev = &client->dev;
+	pdata->i2c_client = client;
+	pr_debug("I2C address is %x\n", client->addr);
+
+	ret = sn65dsi86_parse_dt(&client->dev, pdata);
+	if (ret) {
+		pr_err("failed to parse device tree\n");
+		goto err_dt_parse;
+	}
+
+	ret = sn65dsi86_gpio_configure(pdata, true);
+	if (ret) {
+		pr_err("failed to configure GPIOs\n");
+		goto err_gpio_config;
+	}
+
+	ret = sn65dsi86_init_regulators(pdata);
+	if (ret) {
+		pr_err("failed to enable regulators\n");
+		goto err_gpio_config;
+	}
+
+	ret = sn65dsi86_read_device_rev(pdata);
+	if (ret) {
+		pr_err("failed to read chip rev\n");
+		goto err_gpio_config;
+	} else {
+		pr_debug("bridge chip enabled successfully\n");
+		pdata->power_on = true;
+	}
+
+	pdata->irq = gpio_to_irq(pdata->gpios.irq_gpio);
+	ret = request_threaded_irq(pdata->irq, NULL,
+			sn65dsi86_irq_thread_handler,
+			IRQF_TRIGGER_FALLING | IRQF_ONESHOT,
+			"sn65dsi86", pdata);
+
+	i2c_set_clientdata(client, pdata);
+	dev_set_drvdata(&client->dev, pdata);
+
+	/*
+	 * power down the bridge chip until
+	 * drm bridge enable or drm get modes APIs
+	 * are invoked.
+	 */
+	sn65dsi86_power_ctrl(pdata, false);
+
+	pdata->bridge.funcs = &sn65dsi86_bridge_funcs;
+	pdata->bridge.of_node = client->dev.of_node;
+
+	drm_bridge_add(&pdata->bridge);
+
+	return ret;
+
+err_gpio_config:
+	sn65dsi86_gpio_configure(pdata, false);
+err_dt_parse:
+	if (!pdata->is_pluggable) {
+		list_for_each_entry_safe(mode, n, &pdata->mode_list, head) {
+			list_del(&mode->head);
+			kfree(mode);
+		}
+		pdata->num_of_modes = 0;
+	}
+	devm_kfree(&client->dev, pdata);
+	return ret;
+}
+
+static int sn65dsi86_remove(struct i2c_client *client)
+{
+	int ret = -EINVAL;
+	struct sn65dsi86 *pdata = i2c_get_clientdata(client);
+	struct drm_display_mode *mode, *n;
+
+	if (!pdata)
+		goto end;
+
+	mipi_dsi_detach(pdata->dsi);
+	mipi_dsi_device_unregister(pdata->dsi);
+
+	drm_bridge_remove(&pdata->bridge);
+
+	disable_irq(pdata->irq);
+	free_irq(pdata->irq, pdata);
+
+	ret = sn65dsi86_gpio_configure(pdata, false);
+
+	if (!pdata->is_pluggable) {
+		list_for_each_entry_safe(mode, n, &pdata->mode_list, head) {
+			list_del(&mode->head);
+			kfree(mode);
+		}
+	}
+
+	devm_kfree(&client->dev, pdata);
+
+end:
+	return ret;
+}
+
+static struct i2c_device_id sn65dsi86_id[] = {
+	{ "ti,sn65dsi86", 0},
+	{}
+};
+MODULE_DEVICE_TABLE(i2c, sn65dsi86_id);
+
+static const struct of_device_id sn65dsi86_match_table[] = {
+	{.compatible = "ti,sn65dsi86"},
+	{}
+};
+MODULE_DEVICE_TABLE(of, sn65dsi86_match_table);
+
+static struct i2c_driver sn65dsi86_driver = {
+	.driver = {
+		.name = "sn65dsi86",
+		.owner = THIS_MODULE,
+		.of_match_table = sn65dsi86_match_table,
+	},
+	.probe = sn65dsi86_probe,
+	.remove = sn65dsi86_remove,
+	.id_table = sn65dsi86_id,
+};
+
+module_i2c_driver(sn65dsi86_driver);
+MODULE_DESCRIPTION("SN65DSI86 DSI to eDP bridge driver");
-- 
The Qualcomm Innovation Center, Inc. is a member of the Code Aurora Forum,
a Linux Foundation Collaborative Project

_______________________________________________
dri-devel mailing list
dri-devel@xxxxxxxxxxxxxxxxxxxxx
https://lists.freedesktop.org/mailman/listinfo/dri-devel




[Index of Archives]     [Linux DRI Users]     [Linux Intel Graphics]     [Linux USB Devel]     [Video for Linux]     [Linux Audio Users]     [Yosemite News]     [Linux Kernel]     [Linux SCSI]     [XFree86]     [Linux USB Devel]     [Video for Linux]     [Linux Audio Users]     [Linux Kernel]     [Linux SCSI]     [XFree86]
  Powered by Linux