[PATCH v2 1/2] drm/bridge: add initial support for TI FPDLINK bridge drivers

[Vince Kim]

ti-fpdlink/ti-fpdlink.c:

  - A wrapper bridge driver for TI FPD LINK serializer and deserializer.

  - This driver takes care of initilizing FPD link connection between
  serializer and deserializer.

  - of_drm_find_bridge() looks up matching serializer/deserializer bridges
  from given serializer/deserializer device node.

ti-fpdlink/ti-ub927.c:

  - drm bridge driver for TI DS90UB927 FPD-Link III Serializer

ti-fpdlink/ti-ub949.c:

  - drm bridge driver for TI DS90UB949 FPD-Link III Serializer

ti-fpdlink/ti-ub948.c:

  - drm bridge driver for TI DS90UB948 FPD-Link III Deserializer

Signed-off-by: Vince Kim <vince.k.kim@xxxxxxxxx>
---
 drivers/gpu/drm/bridge/Kconfig                |   2 +
 drivers/gpu/drm/bridge/Makefile               |   1 +
 drivers/gpu/drm/bridge/ti-fpdlink/Kconfig     |  32 ++
 drivers/gpu/drm/bridge/ti-fpdlink/Makefile    |   5 +
 .../gpu/drm/bridge/ti-fpdlink/ti-ds90ub927.c  | 421 +++++++++++++++++
 .../gpu/drm/bridge/ti-fpdlink/ti-ds90ub948.c  | 333 ++++++++++++++
 .../gpu/drm/bridge/ti-fpdlink/ti-ds90ub949.c  | 435 ++++++++++++++++++
 .../gpu/drm/bridge/ti-fpdlink/ti-fpdlink.c    | 396 ++++++++++++++++
 .../gpu/drm/bridge/ti-fpdlink/ti-fpdlink.h    |  70 +++
 9 files changed, 1695 insertions(+)
 create mode 100644 drivers/gpu/drm/bridge/ti-fpdlink/Kconfig
 create mode 100644 drivers/gpu/drm/bridge/ti-fpdlink/Makefile
 create mode 100644 drivers/gpu/drm/bridge/ti-fpdlink/ti-ds90ub927.c
 create mode 100644 drivers/gpu/drm/bridge/ti-fpdlink/ti-ds90ub948.c
 create mode 100644 drivers/gpu/drm/bridge/ti-fpdlink/ti-ds90ub949.c
 create mode 100644 drivers/gpu/drm/bridge/ti-fpdlink/ti-fpdlink.c
 create mode 100644 drivers/gpu/drm/bridge/ti-fpdlink/ti-fpdlink.h

diff --git a/drivers/gpu/drm/bridge/Kconfig b/drivers/gpu/drm/bridge/Kconfig
index 8840f396a7b6..f37a3c50dc69 100644
--- a/drivers/gpu/drm/bridge/Kconfig
+++ b/drivers/gpu/drm/bridge/Kconfig
@@ -154,4 +154,6 @@ source "drivers/gpu/drm/bridge/adv7511/Kconfig"
 
 source "drivers/gpu/drm/bridge/synopsys/Kconfig"
 
+source "drivers/gpu/drm/bridge/ti-fpdlink/Kconfig"
+
 endmenu
diff --git a/drivers/gpu/drm/bridge/Makefile b/drivers/gpu/drm/bridge/Makefile
index 4934fcf5a6f8..6d251aba65d4 100644
--- a/drivers/gpu/drm/bridge/Makefile
+++ b/drivers/gpu/drm/bridge/Makefile
@@ -16,4 +16,5 @@ obj-$(CONFIG_DRM_ANALOGIX_DP) += analogix/
 obj-$(CONFIG_DRM_I2C_ADV7511) += adv7511/
 obj-$(CONFIG_DRM_TI_SN65DSI86) += ti-sn65dsi86.o
 obj-$(CONFIG_DRM_TI_TFP410) += ti-tfp410.o
+obj-$(CONFIG_DRM_TI_FPDLINK) += ti-fpdlink/
 obj-y += synopsys/
diff --git a/drivers/gpu/drm/bridge/ti-fpdlink/Kconfig b/drivers/gpu/drm/bridge/ti-fpdlink/Kconfig
new file mode 100644
index 000000000000..4e81e6454cfe
--- /dev/null
+++ b/drivers/gpu/drm/bridge/ti-fpdlink/Kconfig
@@ -0,0 +1,32 @@
+
+config DRM_TI_FPDLINK
+	tristate "TI FPD-Link III bridge"
+	depends on OF
+	select DRM_KMS_HELPER
+	help
+          Support wrapper bridge driver for Texas Instruments FPD-Link
+          Serializer and Deserializer chip.
+
+config DRM_TI_UB949
+	tristate "TI FPD-Link III UB949 Serializer"
+	depends on DRM_TI_FPDLINK
+	select DRM_KMS_HELPER
+	help
+          Support Texas Instruments FPD-Link III DS90UB949
+          Serializer which converts HDMI input to FPD-link output.
+
+config DRM_TI_UB948
+	tristate "TI FPD-Link III UB948 Deserializer"
+	depends on DRM_TI_FPDLINK
+	select DRM_KMS_HELPER
+	help
+          Supports Texas Instruments FPD-Link III DS90UB948
+          Deserializer which converts FPD-link input to LVDS output.
+
+config DRM_TI_UB927
+	tristate "TI FPD-Link III UB927 Serializer"
+	depends on DRM_TI_FPDLINK
+	select DRM_KMS_HELPER
+	help
+          Support Texas Instruments FPD-Link III DS90UB927
+          Serializer which converts LVDS input to FPD-link output.
diff --git a/drivers/gpu/drm/bridge/ti-fpdlink/Makefile b/drivers/gpu/drm/bridge/ti-fpdlink/Makefile
new file mode 100644
index 000000000000..a176a388f872
--- /dev/null
+++ b/drivers/gpu/drm/bridge/ti-fpdlink/Makefile
@@ -0,0 +1,5 @@
+# SPDX-License-Identifier: GPL-2.0
+obj-$(CONFIG_DRM_TI_FPDLINK) += ti-fpdlink.o
+obj-$(CONFIG_DRM_TI_UB949) += ti-ds90ub949.o
+obj-$(CONFIG_DRM_TI_UB948) += ti-ds90ub948.o
+obj-$(CONFIG_DRM_TI_UB927) += ti-ds90ub927.o
diff --git a/drivers/gpu/drm/bridge/ti-fpdlink/ti-ds90ub927.c b/drivers/gpu/drm/bridge/ti-fpdlink/ti-ds90ub927.c
new file mode 100644
index 000000000000..88173f8b18ae
--- /dev/null
+++ b/drivers/gpu/drm/bridge/ti-fpdlink/ti-ds90ub927.c
@@ -0,0 +1,421 @@
+// SPDX-License-Identifier: GPL-2.0
+/*
+ * TI FPD-LinkIII DS90UB927 driver
+ *
+ * Copyright (C) 2019 Lucid Motors Inc.
+ *
+ * Contact: Vince Kim <vince.k.kim@xxxxxxxxx>
+ *
+ * This program is free software; you can redistribute it and/or
+ * modify it under the terms of the GNU General Public License as
+ * published by the Free Software Foundation; either version 2 of
+ * the License, or (at your option) any later version.
+ *
+ * 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.
+ */
+
+#include <linux/module.h>
+#include <linux/regmap.h>
+#include <linux/of_gpio.h>
+#include <drm/drmP.h>
+#include "ti-fpdlink.h"
+
+#define UB927_RESET_REG				0x01
+#define UB927_RESET_DGTL_RST1			(1<<1)
+
+#define UB927_GS_REG				0x0c
+#define UB927_GS_BIST_CRC_ERROR			(1<<3)
+#define UB927_GS_PCLK_DETECT			(1<<2)
+#define UB927_GS_DES_CRC_ERROR			(1<<1)
+#define UB927_GS_LINK_DETECT			(1<<0)
+
+#define UB927_I2C_CTRL_REG			0x17
+#define UB927_I2C_CTRL_PASS_ALL			(1<<7)
+
+#define MAX_I2C_RETRY 10
+
+
+static inline struct fpdlink_dev *
+drm_bridge_to_ub927(struct drm_bridge *bridge)
+{
+	return container_of(bridge, struct fpdlink_dev, bridge);
+}
+
+static inline int
+regmap_write_fpdlink(struct regmap *map, unsigned int reg, unsigned int val)
+{
+	int count = MAX_I2C_RETRY;
+	int ret = -1;
+
+	while (count-- && (ret = regmap_write(map, reg, val)))
+		usleep_range(1000, 1100);
+
+	return ret;
+}
+
+static const struct regmap_config ub927_regmap_config = {
+	.reg_bits = 8,
+	.val_bits = 8,
+	.cache_type = REGCACHE_NONE,
+	.max_register = 0xff,
+};
+
+static int ub927_enable(struct fpdlink_dev *ub927)
+{
+	if (gpio_is_valid(ub927->gpio_power_en)) {
+		gpio_set_value(ub927->gpio_power_en, 1);
+	} else {
+		if (ub927->gpio_power_en > 0) {
+			dev_err(ub927->dev, "invalid gpio for gpio_disp_en %s\n",
+				ub927->gpio_name);
+			return -ENXIO;
+		}
+	}
+	msleep(200);
+	return 0;
+}
+
+static void ub927_disable(struct fpdlink_dev *ub927)
+{
+	regmap_write_fpdlink(ub927->regmap, UB927_RESET_REG,
+			UB927_RESET_DGTL_RST1);
+}
+
+static int ub927_reset(struct fpdlink_dev *ub927)
+{
+	int ret;
+
+	ret = regmap_write_fpdlink(ub927->regmap, UB927_RESET_REG,
+				   UB927_RESET_DGTL_RST1);
+	usleep_range(1000, 1500);
+	return ret;
+}
+
+static int ub927_enable_i2c_passthrough(struct fpdlink_dev *ub927)
+{
+	int ret;
+	unsigned int val;
+
+	ret = regmap_read(ub927->regmap, UB927_I2C_CTRL_REG, &val);
+	if (ret < 0) {
+		dev_err(ub927->dev, "failed on regmap_read at %s()\n",
+				__func__);
+		return ret;
+	}
+
+	ret = regmap_write_fpdlink(ub927->regmap, UB927_I2C_CTRL_REG,
+				   (val | UB927_I2C_CTRL_PASS_ALL));
+	if (ret < 0) {
+		dev_err(ub927->dev, "failed onregmap_write_fpdlink at %s()\n",
+			__func__);
+		return ret;
+	}
+
+	msleep(100);
+	return ret;
+}
+
+static int ub927_reg_write(struct fpdlink_dev *ub927, u8 reg, u8 val)
+{
+	return regmap_write_fpdlink(ub927->regmap, reg, val);
+}
+
+static int ub927_update_config(struct fpdlink_dev *ub927)
+{
+	int i = 0;
+	int size;
+	u8 *config_array;
+	int ret = 0;
+
+	size = ub927->config_array_size;
+	config_array = ub927->config_array;
+
+	if (!config_array)
+		return 0;
+
+	while (i < size) {
+		ret = regmap_write_fpdlink(ub927->regmap, config_array[i],
+					   config_array[i+1]);
+		if (ret) {
+			dev_err(ub927->dev,
+				"%s: failed to update register\n", __func__);
+			return -EINVAL;
+		}
+		i += 2;
+	}
+	return 0;
+}
+
+static bool ub927_link_detect(struct fpdlink_dev *ub927)
+{
+	unsigned int val;
+	int count, ret;
+
+	mutex_lock(&ub927->lock);
+	ub927->link_status = not_detected;
+
+	for (count = 0; count < MAX_I2C_RETRY; count++) {
+		usleep_range(10000, 15000);
+		ret = regmap_read(ub927->regmap, UB927_GS_REG, &val);
+		if (!ret && (val & UB927_GS_LINK_DETECT)) {
+			dev_info(ub927->dev,
+				 "LVDS: %d Serializer FPD link ready!\n",
+				 ub927->index);
+			ub927->link_status = detected;
+			ret = true;
+			goto done;
+		}
+	}
+
+	dev_info(ub927->dev, "LVDS: %d Serializer FPD link failed!!\n",
+			ub927->index);
+
+done:
+	mutex_unlock(&ub927->lock);
+
+	if (ret < 0) {
+		dev_info(ub927->dev,
+				"failed on regmap_read at %s()\n", __func__);
+	}
+	return (ub927->link_status ? true : false);
+}
+
+static bool ub927_pixel_clk_detect(struct fpdlink_dev *ub927)
+{
+	unsigned int val;
+	int count, ret;
+
+	mutex_lock(&ub927->lock);
+
+	for (count = 0; count < MAX_I2C_RETRY; count++) {
+		ret = regmap_read(ub927->regmap, UB927_GS_REG, &val);
+		if (!ret && (val & UB927_GS_PCLK_DETECT)) {
+			dev_info(ub927->dev,
+					"LVDS: %d, Serializer LVDS CLK OK!!\n",
+					ub927->index);
+			ub927->pixel_clk_status = detected;
+			ret = true;
+			goto done;
+		}
+	}
+	dev_info(ub927->dev,
+			"LVDS:%d LVDS CLK is not detected at Serializer !!\n",
+			ub927->index);
+	ub927->pixel_clk_status = not_detected;
+
+done:
+	mutex_unlock(&ub927->lock);
+	if (ret < 0) {
+		dev_info(ub927->dev,
+				"failed on regmap_read at %s()\n", __func__);
+	}
+	return (ub927->pixel_clk_status ? true : false);
+
+}
+
+static int parse_config_val(struct fpdlink_dev *ub927, struct device_node *np)
+{
+	const u32 *config_property;
+	int len;
+	u8 *config_array;
+	int config_array_size;
+	int i = 0;
+
+	config_property = of_get_property(np, "reg_config", &len);
+	config_array_size = len/sizeof(u32);
+
+	/*config value must be pair of register offset and value */
+	if (!config_property || config_array_size <= 1 || config_array_size%2)
+		return -EINVAL;
+
+	config_array = kcalloc(config_array_size, sizeof(u8), GFP_KERNEL);
+	if (!config_array_size)
+		return -ENOMEM;
+
+	for (i = 0; i < config_array_size; i++)
+		config_array[i] = (u8)be32_to_cpu(config_property[i]);
+
+	ub927->config_array_size = config_array_size;
+	ub927->config_array = config_array;
+	return 0;
+}
+
+static const struct fpdlink_dev_funcs ub927_fpdlink_dev_funcs = {
+	.enable				= ub927_enable,
+	.reset				= ub927_reset,
+	.enable_i2c_passthrough		= ub927_enable_i2c_passthrough,
+	.reg_write			= ub927_reg_write,
+	.link_detect			= ub927_link_detect,
+	.pixel_clk_detect		= ub927_pixel_clk_detect,
+	.config				= ub927_update_config,
+};
+
+static void ub927_shutdown(struct i2c_client *client)
+{
+	struct fpdlink_dev *ub927 = i2c_get_clientdata(client);
+
+	ub927_disable(ub927);
+}
+
+static ssize_t link_status_show(struct device *dev,
+		struct device_attribute *attr, char *buf)
+{
+	struct fpdlink_dev *ub927 = dev_get_drvdata(dev);
+	int ret = 0;
+	int count, status;
+	unsigned int val;
+
+	ret = mutex_lock_interruptible(&ub927->lock);
+	if (ret)
+		return ret;
+
+	ub927->link_status = not_detected;
+	for (count = 0; count < MAX_I2C_RETRY; count++) {
+		usleep_range(10000, 15000);
+		ret = regmap_read(ub927->regmap, UB927_GS_REG, &val);
+		if (!ret && (val & UB927_GS_LINK_DETECT)) {
+			ub927->link_status = detected;
+			break;
+		}
+		usleep_range(10000, 15000);
+	}
+	status = ub927->link_status;
+	mutex_unlock(&ub927->lock);
+
+	if (ret < 0) {
+		dev_info(ub927->dev, "failed on regmap_read at %s()\n",
+				__func__);
+	}
+
+	return snprintf(buf, PAGE_SIZE, "%s\n",
+			status ? "connected":"disconnected");
+}
+
+static ssize_t pixel_clk_status_show(struct device *dev,
+		struct device_attribute *attr, char *buf)
+{
+	struct fpdlink_dev *ub927 = dev_get_drvdata(dev);
+	int count, status;
+	int ret = 0;
+	unsigned int val;
+
+	ret = mutex_lock_interruptible(&ub927->lock);
+	if (ret)
+		return ret;
+
+	ub927->pixel_clk_status = not_detected;
+	for (count = 0; count < MAX_I2C_RETRY; count++) {
+		ret = regmap_read(ub927->regmap, UB927_GS_REG, &val);
+		if (!ret && (val & UB927_GS_PCLK_DETECT)) {
+			ub927->pixel_clk_status = detected;
+			break;
+		}
+		usleep_range(10000, 15000);
+	}
+
+	status = ub927->pixel_clk_status;
+	mutex_unlock(&ub927->lock);
+
+	if (ret < 0) {
+		dev_info(ub927->dev, "failed on regmap_read at %s()\n",
+				__func__);
+	}
+	return snprintf(buf, PAGE_SIZE, "%s\n", status ? "on":"off");
+}
+
+static DEVICE_ATTR_RO(link_status);
+static DEVICE_ATTR_RO(pixel_clk_status);
+
+
+static int ub927_probe(struct i2c_client *client,
+		const struct i2c_device_id *id)
+{
+	struct device *dev = &client->dev;
+	struct fpdlink_dev *ub927;
+	struct device_node *node_ptr;
+
+	int ret = 0;
+
+	ub927 = devm_kzalloc(dev, sizeof(*ub927), GFP_KERNEL);
+	if (!ub927)
+		return -ENOMEM;
+
+	ub927->dev = dev;
+	node_ptr = dev->of_node;
+
+	ub927->gpio_power_en = of_get_named_gpio(node_ptr, "power-en-pin", 0);
+	if (ub927->gpio_power_en > 0) {
+		sprintf(ub927->gpio_name, "ub927 %d", ub927->index);
+		if (!gpio_is_valid(ub927->gpio_power_en)) {
+			dev_err(dev, "invalid gpio for gpio_power_en %s\n",
+					ub927->gpio_name);
+			ret = -ENXIO;
+			goto done;
+		}
+	}
+
+	ub927->client = client;
+	ub927->regmap = devm_regmap_init_i2c(client, &ub927_regmap_config);
+	if (IS_ERR(ub927->regmap)) {
+		dev_err(dev, "failed to allocate register map\n");
+		ret = PTR_ERR(ub927->regmap);
+		goto done;
+	}
+
+	ub927->bridge.of_node = node_ptr;
+	ub927_disable(ub927);
+
+	mutex_init(&ub927->lock);
+	ub927->funcs = &ub927_fpdlink_dev_funcs;
+	parse_config_val(ub927, node_ptr);
+	i2c_set_clientdata(client, ub927);
+
+	drm_bridge_add(&ub927->bridge);
+
+	device_create_file(dev, &dev_attr_link_status);
+	device_create_file(dev, &dev_attr_pixel_clk_status);
+
+done:
+	if (ret < 0)
+		devm_kfree(&client->dev, ub927);
+	return ret;
+}
+
+static int ub927_remove(struct i2c_client *client)
+{
+	struct fpdlink_dev *ub927 =  i2c_get_clientdata(client);
+
+	drm_bridge_remove(&ub927->bridge);
+	return 0;
+}
+
+static const struct i2c_device_id ub927_id[] = {
+	{ "ds90ub927", 0 },
+	{ }
+};
+MODULE_DEVICE_TABLE(i2c, ub927_id);
+
+static const struct of_device_id ub927_match[] = {
+	{ .compatible = "ti,ds90ub927" },
+	{},
+};
+MODULE_DEVICE_TABLE(of, ub927_match);
+
+static struct i2c_driver ti_ub927_driver = {
+	.id_table	= ub927_id,
+	.probe		= ub927_probe,
+	.remove		= ub927_remove,
+	.shutdown	= ub927_shutdown,
+	.driver		= {
+	.name		= "ti-ub927",
+	.of_match_table	= ub927_match,
+	},
+};
+module_i2c_driver(ti_ub927_driver);
+
+MODULE_AUTHOR("Vince Kim <vince.k.kim@xxxxxxxxx>");
+MODULE_DESCRIPTION("TI UB927 Serializer driver");
+MODULE_LICENSE("GPL");
diff --git a/drivers/gpu/drm/bridge/ti-fpdlink/ti-ds90ub948.c b/drivers/gpu/drm/bridge/ti-fpdlink/ti-ds90ub948.c
new file mode 100644
index 000000000000..f42130a19533
--- /dev/null
+++ b/drivers/gpu/drm/bridge/ti-fpdlink/ti-ds90ub948.c
@@ -0,0 +1,333 @@
+// SPDX-License-Identifier: GPL-2.0
+/*
+ * TI FPD-LinkIII DS90UB948 driver
+ *
+ * Copyright (C) 2019 Lucid Motors Inc.
+ *
+ * Contact: Vince Kim <vince.k.kim@xxxxxxxxx>
+ *
+ * This program is free software; you can redistribute it and/or
+ * modify it under the terms of the GNU General Public License as
+ * published by the Free Software Foundation; either version 2 of
+ * the License, or (at your option) any later version.
+ *
+ * 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.
+ */
+
+#include <linux/module.h>
+#include <linux/regmap.h>
+#include <linux/of_gpio.h>
+#include <drm/drmP.h>
+#include "ti-fpdlink.h"
+
+#define UB948_RESET_REG				0x01
+#define UB948_RESET_DGTL_RST0			(1<<2)
+
+#define UB948_GS_REG				0x1c
+#define UB948_GS_LOCK_DETECT			(1<<0)
+
+#define UB948_DUAL_CTL1_REG			0x5b
+
+#define UB948_DUAL_STS_REG			0x5a
+#define UB948_DUAL_STS_FPD3_LINK_READY		(1<<7)
+
+#define MAX_I2C_RETRY 10
+
+static inline struct fpdlink_dev *
+drm_bridge_to_ub948(struct drm_bridge *bridge)
+{
+	return container_of(bridge, struct fpdlink_dev, bridge);
+}
+
+static inline int regmap_write_fpdlink(struct regmap *map, unsigned int reg,
+					unsigned int val)
+{
+	int count = MAX_I2C_RETRY;
+	int ret = -1;
+
+	while (count-- && (ret = regmap_write(map, reg, val)))
+		usleep_range(1000, 1100);
+
+	return ret;
+}
+
+static const struct regmap_config ub948_regmap_config = {
+	.reg_bits = 8,
+	.val_bits = 8,
+	.cache_type = REGCACHE_NONE,
+	.max_register = 0xff,
+};
+
+static int ub948_enable(struct fpdlink_dev *ub948)
+{
+	if (gpio_is_valid(ub948->gpio_power_en)) {
+		gpio_set_value(ub948->gpio_power_en, 1);
+	} else {
+		if (ub948->gpio_power_en > 0) {
+			dev_err(ub948->dev,
+				"invalid gpio for gpio_disp_en %s\n",
+				ub948->gpio_name);
+			return -ENXIO;
+		}
+	}
+	msleep(200);
+	return 0;
+}
+
+static void ub948_disable(struct fpdlink_dev *ub948)
+{
+	if (gpio_is_valid(ub948->gpio_power_en))
+		gpio_set_value(ub948->gpio_power_en, 0);
+}
+
+static int ub948_reset(struct fpdlink_dev *ub948)
+{
+	int ret;
+
+	ret = regmap_write_fpdlink(ub948->regmap,
+			UB948_RESET_REG, UB948_RESET_DGTL_RST0);
+	msleep(100);
+	if (ret == 0)
+		ub948->detected = true;
+	return ret;
+}
+
+static int ub948_reg_write(struct fpdlink_dev *ub948, u8 reg, u8 val)
+{
+	return regmap_write_fpdlink(ub948->regmap, reg, val);
+}
+
+static int ub948_update_config(struct fpdlink_dev *ub948)
+{
+	int i = 0;
+	int size;
+	u8 *config_array;
+	int ret = 0;
+
+	size = ub948->config_array_size;
+	config_array = ub948->config_array;
+
+	if (!config_array)
+		return 0;
+
+	while (i < size) {
+		ret = regmap_write_fpdlink(ub948->regmap, config_array[i],
+				config_array[i+1]);
+		if (ret) {
+			dev_err(ub948->dev,
+				"%s: failed to update register\n", __func__);
+			return -EINVAL;
+		}
+		i += 2;
+	}
+	return 0;
+}
+
+static bool ub948_link_detect(struct fpdlink_dev *ub948)
+{
+	unsigned int val;
+	int count, ret;
+
+	if (ub948->detected == false)
+		return false;
+
+	mutex_lock(&ub948->lock);
+	ub948->link_status = not_detected;
+	for (count = 0; count < MAX_I2C_RETRY; count++) {
+		ret = regmap_read(ub948->regmap, UB948_GS_REG, &val);
+
+		if (!ret && (val & UB948_GS_LOCK_DETECT)) {
+			dev_info(ub948->dev,
+				"HDMI: %d DeSerializer FPD link ready!\n",
+				ub948->index);
+			ub948->link_status = detected;
+			ret = true;
+			goto done;
+		}
+		usleep_range(10000, 11000);
+	}
+	dev_info(ub948->dev, "HDMI: %d DeSerializer FPD link failed!!\n",
+			ub948->index);
+
+done:
+	mutex_unlock(&ub948->lock);
+
+	if (ret < 0)
+		dev_info(ub948->dev, "failed on regmap_read at %s()\n",
+				__func__);
+
+	return ub948->link_status ? true : false;
+}
+
+static int parse_config_val(struct fpdlink_dev *ub948,
+		struct device_node *node_ptr)
+{
+	const u32 *config_property;
+	int len;
+	u8 *config_array;
+	int config_array_size;
+	int i = 0;
+
+	config_property = of_get_property(node_ptr, "reg_config", &len);
+	config_array_size = len/sizeof(u32);
+
+	/*config value must be pair of register offset and value */
+	if (!config_property || config_array_size <= 1 || config_array_size%2)
+		return -EINVAL;
+
+	config_array = kcalloc(config_array_size, sizeof(u8), GFP_KERNEL);
+	if (!config_array_size)
+		return -ENOMEM;
+
+	for (i = 0; i < config_array_size; i++)
+		config_array[i] = (u8)be32_to_cpu(config_property[i]);
+
+	ub948->config_array_size = config_array_size;
+	ub948->config_array = config_array;
+	return 0;
+}
+
+static const struct fpdlink_dev_funcs ub948_fpdlink_dev_funcs = {
+	.enable				= ub948_enable,
+	.reset				= ub948_reset,
+	.reg_write			= ub948_reg_write,
+	.link_detect			= ub948_link_detect,
+	.config				= ub948_update_config,
+};
+
+static void ub948_shutdown(struct i2c_client *client)
+{
+	struct fpdlink_dev *ub948 = i2c_get_clientdata(client);
+
+	ub948_disable(ub948);
+}
+
+static ssize_t lock_status_show(struct device *dev,
+		struct device_attribute *attr, char *buf)
+{
+	struct fpdlink_dev *ub948 = dev_get_drvdata(dev);
+	int ret = 0;
+	int status;
+	unsigned int val;
+	int count;
+
+	if (ub948->detected == false)
+		return snprintf(buf, PAGE_SIZE, "%s\n", "off");
+
+	ret = mutex_lock_interruptible(&ub948->lock);
+	if (ret)
+		return ret;
+
+	ub948->link_status = not_detected;
+	for (count = 0; count < MAX_I2C_RETRY; count++) {
+		ret = regmap_read(ub948->regmap, UB948_GS_REG, &val);
+		if (!ret && (val & UB948_GS_LOCK_DETECT)) {
+			ub948->link_status = detected;
+			break;
+		}
+		usleep_range(10000, 11000);
+	}
+	status = ub948->link_status;
+	mutex_unlock(&ub948->lock);
+
+	if (ret < 0) {
+		dev_info(ub948->dev, "failed on regmap_read at %s()\n",
+				__func__);
+	}
+
+	return snprintf(buf, PAGE_SIZE, "%s\n", status ? "on":"off");
+}
+static DEVICE_ATTR_RO(lock_status);
+
+static int ub948_probe(struct i2c_client *client,
+		const struct i2c_device_id *id)
+{
+	struct device *dev = &client->dev;
+	struct fpdlink_dev *ub948;
+	struct device_node *node_ptr;
+
+	int ret = 0;
+
+	ub948 = devm_kzalloc(dev, sizeof(*ub948), GFP_KERNEL);
+	if (!ub948)
+		return -ENOMEM;
+
+	ub948->dev = dev;
+	node_ptr = dev->of_node;
+
+	ub948->gpio_power_en = of_get_named_gpio(node_ptr, "power-en-pin", 0);
+	if (ub948->gpio_power_en > 0) {
+		sprintf(ub948->gpio_name, "ub948 %d", ub948->index);
+		if (!gpio_is_valid(ub948->gpio_power_en)) {
+			dev_err(dev, "invalid gpio for gpio_power_en %s\n",
+					ub948->gpio_name);
+			ret = -ENXIO;
+			goto done;
+		}
+	}
+
+	ub948->client = client;
+	ub948->regmap = devm_regmap_init_i2c(client, &ub948_regmap_config);
+	if (IS_ERR(ub948->regmap)) {
+		dev_err(dev, "failed to allocate register map\n");
+		ret = PTR_ERR(ub948->regmap);
+		goto done;
+	}
+
+	mutex_init(&ub948->lock);
+	ub948->bridge.of_node = node_ptr;
+	ub948_disable(ub948);
+
+	ub948->funcs = &ub948_fpdlink_dev_funcs;
+	parse_config_val(ub948, node_ptr);
+	i2c_set_clientdata(client, ub948);
+
+	drm_bridge_add(&ub948->bridge);
+	device_create_file(dev, &dev_attr_lock_status);
+	/*
+	 * we don't know if deserializer is attached until serializer is ready.
+	 */
+	ub948->detected = false;
+
+done:
+	return ret;
+}
+
+static int ub948_remove(struct i2c_client *client)
+{
+	struct fpdlink_dev *ub948 =  i2c_get_clientdata(client);
+
+	drm_bridge_remove(&ub948->bridge);
+	return 0;
+}
+
+static const struct i2c_device_id ub948_id[] = {
+	{ "ds90ub948", 0 },
+	{ }
+};
+MODULE_DEVICE_TABLE(i2c, ub948_id);
+
+static const struct of_device_id ub948_match[] = {
+	{ .compatible = "ti,ds90ub948" },
+	{},
+};
+MODULE_DEVICE_TABLE(of, ub948_match);
+
+static struct i2c_driver ti_ub948_driver = {
+	.id_table	= ub948_id,
+	.probe		= ub948_probe,
+	.remove		= ub948_remove,
+	.shutdown	= ub948_shutdown,
+	.driver		= {
+	.name		= "ti-ub948",
+	.of_match_table	= ub948_match,
+	},
+};
+module_i2c_driver(ti_ub948_driver);
+
+MODULE_AUTHOR("Vince Kim <vince.k.kim@xxxxxxxxx>");
+MODULE_DESCRIPTION("TI UB948 Serializer driver");
+MODULE_LICENSE("GPL");
diff --git a/drivers/gpu/drm/bridge/ti-fpdlink/ti-ds90ub949.c b/drivers/gpu/drm/bridge/ti-fpdlink/ti-ds90ub949.c
new file mode 100644
index 000000000000..bb99d296fbb8
--- /dev/null
+++ b/drivers/gpu/drm/bridge/ti-fpdlink/ti-ds90ub949.c
@@ -0,0 +1,435 @@
+// SPDX-License-Identifier: GPL-2.0
+/*
+ * TI FPD-LinkIII DS90UB949 driver
+ *
+ * Copyright (C) 2019 Lucid Motors Inc.
+ *
+ * Contact: Vince Kim <vince.k.kim@xxxxxxxxx>
+ *
+ * This program is free software; you can redistribute it and/or
+ * modify it under the terms of the GNU General Public License as
+ * published by the Free Software Foundation; either version 2 of
+ * the License, or (at your option) any later version.
+ *
+ * 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.
+ */
+
+#include <linux/module.h>
+#include <linux/regmap.h>
+#include <linux/of_gpio.h>
+#include <drm/drmP.h>
+#include "ti-fpdlink.h"
+
+#define UB949_RESET_REG				0x01
+#define UB949_RESET_HDMI_RST			(1<<4)
+#define UB949_RESET_DGTL_RST1			(1<<1)
+
+#define UB949_GS_REG				0x0c
+#define UB949_GS_BIST_CRC_ERROR			(1<<3)
+#define UB949_GS_TMDS_CLK_DETECT		(1<<2)
+#define UB949_GS_DES_CRC_ERROR			(1<<1)
+#define UB949_GS_LINK_DETECT			(1<<0)
+
+#define UB949_I2C_CTRL_REG			0x17
+#define UB949_I2C_CTRL_PASS_ALL			(1<<7)
+
+#define UB949_DUAL_STS_REG			0x5a
+#define UB949_DUAL_STS_FPD3_LINK_READY		(1<<7)
+#define UB949_DUAL_STS_FPD3_TX_STS		(1<<6)
+
+#define UB949_DUAL_CTL1_REG			0x5b
+#define UB949_DUAL_CTL2_REG			0x5c
+#define UB949_HDMI_FREQ				0x5f
+
+#define MAX_I2C_RETRY 10
+
+
+static inline struct fpdlink_dev *
+drm_bridge_to_ub949(struct drm_bridge *bridge)
+{
+	return container_of(bridge, struct fpdlink_dev, bridge);
+}
+
+static inline int regmap_write_fpdlink(struct regmap *map, unsigned int reg,
+					unsigned int val)
+{
+	int count = MAX_I2C_RETRY;
+	int ret = -1;
+
+	while (count-- && (ret = regmap_write(map, reg, val)))
+		usleep_range(1000, 1100);
+
+	return ret;
+}
+
+static const struct regmap_config ub949_regmap_config = {
+	.reg_bits = 8,
+	.val_bits = 8,
+	.cache_type = REGCACHE_NONE,
+	.max_register = 0xff,
+};
+
+static int ub949_enable(struct fpdlink_dev *ub949)
+{
+	if (gpio_is_valid(ub949->gpio_power_en)) {
+		gpio_set_value(ub949->gpio_power_en, 1);
+	} else {
+		if (ub949->gpio_power_en > 0) {
+			dev_err(ub949->dev,
+				"invalid gpio for gpio_disp_en %s\n",
+				ub949->gpio_name);
+			return -ENXIO;
+		}
+	}
+
+	msleep(200);
+	return 0;
+}
+
+static void ub949_disable(struct fpdlink_dev *ub949)
+{
+	regmap_write_fpdlink(ub949->regmap, UB949_RESET_REG,
+			(UB949_RESET_HDMI_RST|UB949_RESET_DGTL_RST1));
+}
+
+static int ub949_reset(struct fpdlink_dev *ub949)
+{
+	int ret;
+
+	ret = regmap_write_fpdlink(ub949->regmap, UB949_RESET_REG,
+			(UB949_RESET_HDMI_RST|UB949_RESET_DGTL_RST1));
+	usleep_range(10000, 11000);
+
+	return ret;
+}
+
+static int ub949_enable_i2c_passthrough(struct fpdlink_dev *ub949)
+{
+	int ret;
+	unsigned int val;
+
+	ret = regmap_read(ub949->regmap, UB949_I2C_CTRL_REG, &val);
+	if (ret < 0) {
+		dev_err(ub949->dev, "failed on regmap_read at %s()\n",
+				__func__);
+		return ret;
+	}
+
+	ret = regmap_write_fpdlink(ub949->regmap, UB949_I2C_CTRL_REG,
+			(val | UB949_I2C_CTRL_PASS_ALL));
+	msleep(100);
+
+	return ret;
+}
+
+static int ub949_reg_write(struct fpdlink_dev *ub949, u8 reg, u8 val)
+{
+	return regmap_write_fpdlink(ub949->regmap, reg, val);
+}
+
+static int ub949_update_config(struct fpdlink_dev *ub949)
+{
+	int i = 0;
+	int size;
+	u8 *config_array;
+	int ret = 0;
+
+	size = ub949->config_array_size;
+	config_array = ub949->config_array;
+
+	if (!config_array)
+		return 0;
+
+	while (i < size) {
+		ret = regmap_write_fpdlink(ub949->regmap, config_array[i],
+				config_array[i+1]);
+		if (ret) {
+			dev_err(ub949->dev,
+				"%s: failed to update register\n", __func__);
+			return -EINVAL;
+		}
+		i += 2;
+	}
+
+	return 0;
+}
+
+static bool ub949_link_detect(struct fpdlink_dev *ub949)
+{
+	unsigned int val, val2;
+	int count, ret;
+
+	mutex_lock(&ub949->lock);
+	ub949->link_status = not_detected;
+
+	for (count = 0; count < MAX_I2C_RETRY; count++) {
+		usleep_range(10000, 11000);
+		ret = regmap_read(ub949->regmap, UB949_GS_REG, &val);
+		ret += regmap_read(ub949->regmap, UB949_DUAL_STS_REG, &val2);
+		if (!ret && (val & UB949_GS_LINK_DETECT) &&
+				(val2 & UB949_DUAL_STS_FPD3_LINK_READY)) {
+			dev_info(ub949->dev,
+					"HDMI: %d Serializer FPD link ready!\n",
+					ub949->index);
+			ub949->link_status = detected;
+			ret = true;
+			goto done;
+		}
+	}
+	dev_info(ub949->dev,
+			"HDMI:%d Serializer FPD link failed!!\n", ub949->index);
+
+done:
+	mutex_unlock(&ub949->lock);
+
+	if (ret < 0) {
+		dev_info(ub949->dev,
+				"failed on regmap_read at %s()\n", __func__);
+	}
+
+	return (ub949->link_status ? true : false);
+}
+
+static bool ub949_pixel_clk_detect(struct fpdlink_dev *ub949)
+{
+	unsigned int val;
+	int count, ret;
+
+	mutex_lock(&ub949->lock);
+
+	for (count = 0; count < 1; count++) {
+		ret = regmap_read(ub949->regmap, UB949_HDMI_FREQ, &val);
+		if (!ret && val) {
+			dev_info(ub949->dev,
+					"HDMI: %d,  Serializer HDMI CLK OK!!\n",
+					ub949->index);
+			ub949->pixel_clk_status = detected;
+			ret = true;
+			goto done;
+		}
+	}
+	dev_info(ub949->dev,
+			"HDMI:%d HDMI CLK is not detected at Serializer !!\n",
+			ub949->index);
+	ub949->pixel_clk_status = not_detected;
+
+done:
+	mutex_unlock(&ub949->lock);
+
+	if (ret < 0)
+		dev_info(ub949->dev,
+				"failed on regmap_read at %s()\n", __func__);
+
+	return ub949->pixel_clk_status ? true : false;
+
+}
+
+static int parse_config_val(struct fpdlink_dev *ub949,
+		struct device_node *node_ptr)
+{
+	const u32 *config_property;
+	int len;
+	u8 *config_array;
+	int config_array_size;
+	int i = 0;
+
+	config_property = of_get_property(node_ptr, "reg_config", &len);
+	config_array_size = len/sizeof(u32);
+
+	/*config value must be a pair of register offset and value */
+	if (!config_property || config_array_size <= 1 || config_array_size%2)
+		return -EINVAL;
+
+	config_array = kcalloc(config_array_size, sizeof(u8), GFP_KERNEL);
+	if (!config_array_size)
+		return -ENOMEM;
+
+	for (i = 0; i < config_array_size; i++)
+		config_array[i] = (u8)be32_to_cpu(config_property[i]);
+
+	ub949->config_array_size = config_array_size;
+	ub949->config_array = config_array;
+	return 0;
+}
+
+static const struct fpdlink_dev_funcs ub949_fpdlink_dev_funcs = {
+	.enable				= ub949_enable,
+	.reset				= ub949_reset,
+	.enable_i2c_passthrough		= ub949_enable_i2c_passthrough,
+	.reg_write			= ub949_reg_write,
+	.link_detect			= ub949_link_detect,
+	.pixel_clk_detect		= ub949_pixel_clk_detect,
+	.config				= ub949_update_config,
+};
+
+static void ub949_shutdown(struct i2c_client *client)
+{
+	struct fpdlink_dev *ub949 = i2c_get_clientdata(client);
+
+	ub949_disable(ub949);
+}
+
+static ssize_t link_status_show(struct device *dev,
+		struct device_attribute *attr, char *buf)
+{
+	struct fpdlink_dev *ub949 = dev_get_drvdata(dev);
+	int status, ret;
+	unsigned int val, val2;
+	int count;
+
+	ret = mutex_lock_interruptible(&ub949->lock);
+	if (ret)
+		return ret;
+
+	ub949->link_status = not_detected;
+
+	for (count = 0; count < MAX_I2C_RETRY; count++) {
+		ret = regmap_read(ub949->regmap, UB949_GS_REG, &val);
+		ret += regmap_read(ub949->regmap, UB949_DUAL_STS_REG, &val2);
+		if (!ret && (val & UB949_GS_LINK_DETECT)
+			 && (val2 & UB949_DUAL_STS_FPD3_LINK_READY)) {
+			ub949->link_status = detected;
+			break;
+		}
+		usleep_range(10000, 11000);
+	}
+	status = ub949->link_status;
+	mutex_unlock(&ub949->lock);
+
+	if (ret < 0)
+		dev_err(ub949->dev,
+				"failed on regmap_read at %s()\n", __func__);
+
+	return snprintf(buf, PAGE_SIZE, "%s\n",
+			status ? "connected":"disconnected");
+}
+
+static ssize_t pixel_clk_status_show(struct device *dev,
+		struct device_attribute *attr, char *buf)
+{
+	struct fpdlink_dev *ub949 = dev_get_drvdata(dev);
+	int status, ret;
+	unsigned int val, val2;
+	int count;
+
+	ret = mutex_lock_interruptible(&ub949->lock);
+	if (ret)
+		return ret;
+
+	ub949->pixel_clk_status = not_detected;
+	for (count = 0; count < MAX_I2C_RETRY; count++) {
+		ret = regmap_read(ub949->regmap, UB949_HDMI_FREQ, &val);
+		ret += regmap_read(ub949->regmap, UB949_GS_REG, &val2);
+		if (!ret && val && (val2 & UB949_GS_TMDS_CLK_DETECT)) {
+			ub949->pixel_clk_status = detected;
+			break;
+		}
+		usleep_range(10000, 11000);
+	}
+	status = ub949->pixel_clk_status;
+	mutex_unlock(&ub949->lock);
+
+	if (ret < 0)
+		dev_err(ub949->dev,
+				"failed on regmap_read at %s()\n", __func__);
+
+	return snprintf(buf, PAGE_SIZE, "%s\n", status ? "on":"off");
+}
+
+static DEVICE_ATTR_RO(link_status);
+static DEVICE_ATTR_RO(pixel_clk_status);
+
+static int ub949_probe(struct i2c_client *client,
+		const struct i2c_device_id *id)
+{
+	struct device *dev = &client->dev;
+	struct fpdlink_dev *ub949;
+	struct device_node *node_ptr;
+
+	int ret = 0;
+
+	ub949 = devm_kzalloc(dev, sizeof(*ub949), GFP_KERNEL);
+	if (!ub949)
+		return -ENOMEM;
+
+	ub949->dev = dev;
+	node_ptr = dev->of_node;
+
+	ub949->gpio_power_en = of_get_named_gpio(node_ptr, "power-en-pin", 0);
+	if (ub949->gpio_power_en > 0) {
+		sprintf(ub949->gpio_name, "ub949 %d", ub949->index);
+		if (!gpio_is_valid(ub949->gpio_power_en)) {
+			dev_err(dev, "invalid gpio for gpio_power_en %s\n",
+					ub949->gpio_name);
+			ret = -ENXIO;
+			goto done;
+		}
+	}
+
+	ub949->client = client;
+	ub949->regmap = devm_regmap_init_i2c(client, &ub949_regmap_config);
+	if (IS_ERR(ub949->regmap)) {
+		dev_err(dev, "failed to allocate register map\n");
+		ret = PTR_ERR(ub949->regmap);
+		goto done;
+	}
+
+	mutex_init(&ub949->lock);
+
+	ub949->bridge.of_node = node_ptr;
+	ub949_disable(ub949);
+
+	ub949->funcs = &ub949_fpdlink_dev_funcs;
+	parse_config_val(ub949, node_ptr);
+	i2c_set_clientdata(client, ub949);
+
+	drm_bridge_add(&ub949->bridge);
+
+	device_create_file(dev, &dev_attr_link_status);
+	device_create_file(dev, &dev_attr_pixel_clk_status);
+
+done:
+	if (ret < 0)
+		devm_kfree(&client->dev, ub949);
+
+	return ret;
+}
+
+static int ub949_remove(struct i2c_client *client)
+{
+	struct fpdlink_dev *ub949 =  i2c_get_clientdata(client);
+
+	drm_bridge_remove(&ub949->bridge);
+	return 0;
+}
+
+static const struct i2c_device_id ub949_id[] = {
+	{ "ds90ub949", 0 },
+	{ }
+};
+MODULE_DEVICE_TABLE(i2c, ub949_id);
+
+static const struct of_device_id ub949_match[] = {
+	{ .compatible = "ti,ds90ub949" },
+	{},
+};
+MODULE_DEVICE_TABLE(of, ub949_match);
+
+static struct i2c_driver ti_ub949_driver = {
+	.id_table	= ub949_id,
+	.probe		= ub949_probe,
+	.remove		= ub949_remove,
+	.shutdown	= ub949_shutdown,
+	.driver		= {
+		.name		= "ti-ub949",
+		.of_match_table	= ub949_match,
+	},
+};
+module_i2c_driver(ti_ub949_driver);
+
+MODULE_AUTHOR("Vince Kim <vince.k.kim@xxxxxxxxx>");
+MODULE_DESCRIPTION("TI UB949 Serializer driver");
+MODULE_LICENSE("GPL");
diff --git a/drivers/gpu/drm/bridge/ti-fpdlink/ti-fpdlink.c b/drivers/gpu/drm/bridge/ti-fpdlink/ti-fpdlink.c
new file mode 100644
index 000000000000..fa4cd5806f19
--- /dev/null
+++ b/drivers/gpu/drm/bridge/ti-fpdlink/ti-fpdlink.c
@@ -0,0 +1,396 @@
+// SPDX-License-Identifier: GPL-2.0
+/*
+ * TI FPD-LinkIII interface bridge driver
+ *
+ * Copyright (C) 2019 Lucid Motors Inc.
+ *
+ * Contact: Vince Kim <vince.k.kim@xxxxxxxxx>
+ *
+ * This program is free software; you can redistribute it and/or
+ * modify it under the terms of the GNU General Public License as
+ * published by the Free Software Foundation; either version 2 of
+ * the License, or (at your option) any later version.
+ *
+ * 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.
+ */
+
+#include <linux/module.h>
+#include <drm/drmP.h>
+#include <drm/drm_atomic_helper.h>
+#include <drm/drm_probe_helper.h>
+#include <linux/of_gpio.h>
+#include "ti-fpdlink.h"
+
+struct fpdlink {
+	struct drm_bridge	bridge;
+	struct drm_connector	connector;
+
+	struct fpdlink_dev	*serializer;
+	struct fpdlink_dev	*deserializer;
+	struct device_node	*fpdlink_node;
+	struct mutex lock;
+
+	unsigned int index;
+	enum clk_status pixel_clk_status;
+	enum clk_status link_status;
+	bool enabled;
+};
+
+
+static inline struct fpdlink *
+drm_bridge_to_fpdlink(struct drm_bridge *bridge)
+{
+	return container_of(bridge, struct fpdlink, bridge);
+}
+
+static inline struct fpdlink *
+drm_connector_to_fpdlink(struct drm_connector *connector)
+{
+	return container_of(connector, struct fpdlink, connector);
+}
+
+static int fpdlink_dev_enable(struct fpdlink_dev *dev)
+{
+	int ret;
+
+	if (!dev)
+		return -EINVAL;
+	if (!dev->funcs)
+		return -EINVAL;
+	if (!dev->funcs->enable)
+		return -EINVAL;
+
+	ret = dev->funcs->enable(dev);
+
+	return ret;
+}
+
+static int fpdlink_dev_reset(struct fpdlink_dev *dev)
+{
+	int ret;
+
+	if (!dev)
+		return -EINVAL;
+	if (!dev->funcs)
+		return -EINVAL;
+	if (!dev->funcs->reset)
+		return -EINVAL;
+
+	ret = dev->funcs->reset(dev);
+	return ret;
+}
+
+static int fpdlink_dev_enable_i2c_passthrough(struct fpdlink_dev *dev)
+{
+	int ret;
+
+	if (!dev)
+		return -EINVAL;
+	if (!dev->funcs)
+		return -EINVAL;
+	if (!dev->funcs->enable_i2c_passthrough)
+		return -EINVAL;
+
+	ret = dev->funcs->enable_i2c_passthrough(dev);
+	return ret;
+}
+
+static bool fpdlink_dev_link_detect(struct fpdlink_dev *dev)
+{
+	bool ret;
+
+	if (!dev)
+		return -EINVAL;
+	if (!dev->funcs)
+		return -EINVAL;
+	if (!dev->funcs->link_detect)
+		return -EINVAL;
+
+	ret = dev->funcs->link_detect(dev);
+	return ret;
+}
+
+static bool fpdlink_dev_pixel_clk_detect(struct fpdlink_dev *dev)
+{
+	bool ret;
+
+	if (!dev)
+		return -EINVAL;
+	if (!dev->funcs)
+		return -EINVAL;
+	if (!dev->funcs->pixel_clk_detect)
+		return -EINVAL;
+
+	ret = dev->funcs->pixel_clk_detect(dev);
+	return ret;
+}
+
+static int fpdlink_dev_config(struct fpdlink_dev *dev)
+{
+	int ret;
+
+	if (!dev)
+		return -EINVAL;
+	if (!dev->funcs)
+		return -EINVAL;
+	if (!dev->funcs->config)
+		return -EINVAL;
+
+	ret = dev->funcs->config(dev);
+	return ret;
+}
+
+static enum drm_connector_status
+fpdlink_connector_detect(struct drm_connector *connector, bool force)
+{
+	struct fpdlink *fpdlink_bridge = drm_connector_to_fpdlink(connector);
+
+	if (fpdlink_bridge->link_status == detected)
+		return connector_status_connected;
+
+	return connector_status_disconnected;
+}
+
+static const struct drm_connector_funcs fpdlink_con_funcs = {
+	.detect			= fpdlink_connector_detect,
+	.fill_modes		= drm_helper_probe_single_connector_modes,
+	.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 void fpdlink_pre_enable(struct drm_bridge *bridge)
+{
+	struct fpdlink *fpdlink_bridge = drm_bridge_to_fpdlink(bridge);
+
+	struct fpdlink_dev *serializer = fpdlink_bridge->serializer;
+	struct fpdlink_dev *deserializer = fpdlink_bridge->deserializer;
+	int ret = 0;
+
+	mutex_lock(&fpdlink_bridge->lock);
+
+	if (fpdlink_bridge->link_status == detected)
+		goto done;
+
+	fpdlink_dev_enable(deserializer);
+	fpdlink_dev_enable(serializer);
+	fpdlink_dev_reset(serializer);
+	fpdlink_dev_enable_i2c_passthrough(serializer);
+	ret = fpdlink_dev_reset(deserializer);
+	if (ret != 0) {
+		fpdlink_bridge->connector.status =
+				connector_status_disconnected;
+		DRM_INFO("Not able to detect Deserializer at %pOF\n",
+				fpdlink_bridge->fpdlink_node);
+		goto done;
+	}
+
+	ret = fpdlink_dev_link_detect(serializer);
+	if (ret != true) {
+		fpdlink_bridge->connector.status =
+				connector_status_disconnected;
+		goto done;
+	}
+
+	fpdlink_bridge->link_status = detected;
+	fpdlink_bridge->pixel_clk_status = not_detected;
+	fpdlink_bridge->connector.status = connector_status_connected;
+done:
+	mutex_unlock(&fpdlink_bridge->lock);
+}
+
+static void fpdlink_enable(struct drm_bridge *bridge)
+{
+	struct fpdlink *fpdlink_bridge = drm_bridge_to_fpdlink(bridge);
+	int ret = 0;
+	struct fpdlink_dev *serializer = fpdlink_bridge->serializer;
+	struct fpdlink_dev *deserializer = fpdlink_bridge->deserializer;
+
+	mutex_lock(&fpdlink_bridge->lock);
+
+	if (fpdlink_bridge->link_status == not_detected) {
+		fpdlink_bridge->connector.status =
+				connector_status_disconnected;
+		fpdlink_bridge->pixel_clk_status = not_detected;
+		goto done;
+	}
+
+	if (fpdlink_bridge->enabled)
+		goto done;
+
+	ret = fpdlink_dev_pixel_clk_detect(serializer);
+
+	if (ret != true) {
+		fpdlink_bridge->connector.status =
+				connector_status_disconnected;
+		fpdlink_bridge->pixel_clk_status = not_detected;
+		pr_err("pixel_clk_status not detected\n");
+		goto done;
+	}
+
+	fpdlink_bridge->pixel_clk_status = detected;
+	fpdlink_bridge->connector.status = connector_status_connected;
+	fpdlink_dev_config(serializer);
+	fpdlink_dev_config(deserializer);
+	fpdlink_bridge->enabled = 1;
+
+done:
+	mutex_unlock(&fpdlink_bridge->lock);
+}
+
+static int fpdlink_get_modes(struct drm_connector *connector)
+{
+	struct fpdlink *fpdlink_bridge = drm_connector_to_fpdlink(connector);
+
+	if (fpdlink_bridge->enabled == 0)
+		fpdlink_enable(&fpdlink_bridge->bridge);
+
+	return 0;
+}
+static const struct drm_connector_helper_funcs fpdlink_con_helper_funcs = {
+	.get_modes	= fpdlink_get_modes,
+};
+
+
+static int fpdlink_attach(struct drm_bridge *bridge)
+{
+	struct fpdlink *fpdlink_bridge = drm_bridge_to_fpdlink(bridge);
+	struct device_node *fpdlink_node = bridge->of_node;
+	struct device_node *serializer_node;
+	struct device_node *deserializer_node;
+	struct drm_bridge *serializer_bridge = NULL;
+	struct drm_bridge *deserializer_bridge = NULL;
+	struct drm_connector *connector;
+	int ret;
+
+	if (!bridge->encoder) {
+		DRM_ERROR("Missing encoder\n");
+		return -ENODEV;
+	}
+	connector = dev_get_drvdata(bridge->dev->dev);
+	fpdlink_node = fpdlink_bridge->fpdlink_node;
+
+	drm_connector_helper_add(&fpdlink_bridge->connector,
+				 &fpdlink_con_helper_funcs);
+
+	ret = drm_connector_init(bridge->dev, &fpdlink_bridge->connector,
+				 &fpdlink_con_funcs, DRM_MODE_CONNECTOR_VGA);
+	if (ret) {
+		DRM_ERROR("Failed to initialize connector\n");
+		return ret;
+	}
+
+	drm_connector_attach_encoder(&fpdlink_bridge->connector,
+					  bridge->encoder);
+
+	serializer_node = of_parse_phandle(fpdlink_node,
+					   "fpdlink-serializer-i2c-handle", 0);
+	if (!serializer_node) {
+		DRM_INFO("failed to find fpdlink-serializer-i2c-handle node at %pOF\n",
+				fpdlink_node);
+		return -ENODEV;
+	}
+
+	serializer_bridge = of_drm_find_bridge(serializer_node);
+
+
+	if (!serializer_bridge) {
+		DRM_INFO("failed to find serializer bridge for %pOF\n",
+				serializer_node);
+		return -ENODEV;
+	}
+
+	fpdlink_bridge->serializer =
+				drm_bridge_to_fpdlink_dev(serializer_bridge);
+	fpdlink_bridge->serializer->index = bridge->encoder->index;
+
+	deserializer_node = of_parse_phandle(fpdlink_node,
+			"fpdlink-deserializer-i2c-handle", 0);
+	if (!deserializer_node) {
+		DRM_INFO("failed to find fpdlink-deserializer-i2c-handle node at %pOF\n",
+				fpdlink_node);
+		return -ENODEV;
+	}
+
+	deserializer_bridge = of_drm_find_bridge(deserializer_node);
+	if (!deserializer_bridge) {
+		DRM_INFO("failed to find deserializer bridge for %pOF\n",
+				deserializer_node);
+		return -ENODEV;
+	}
+
+	fpdlink_bridge->deserializer =
+				drm_bridge_to_fpdlink_dev(deserializer_bridge);
+	fpdlink_bridge->deserializer->index = bridge->encoder->index;
+	fpdlink_bridge->index = bridge->encoder->index;
+	fpdlink_bridge->link_status = not_detected;
+	fpdlink_bridge->pixel_clk_status = not_detected;
+	return ret;
+}
+
+static const struct drm_bridge_funcs fpdlink_bridge_funcs = {
+	.attach		= fpdlink_attach,
+	.pre_enable	= fpdlink_pre_enable,
+	.enable		= fpdlink_enable,
+};
+
+
+
+static int fpdlink_probe(struct platform_device *pdev)
+{
+	struct fpdlink *fpdlink_bridge;
+	int gpio_pin;
+	struct device_node *np;
+
+	fpdlink_bridge = devm_kzalloc(&pdev->dev, sizeof(*fpdlink_bridge),
+					GFP_KERNEL);
+	if (!fpdlink_bridge)
+		return -ENOMEM;
+
+	mutex_init(&fpdlink_bridge->lock);
+
+
+	platform_set_drvdata(pdev, fpdlink_bridge);
+
+	fpdlink_bridge->bridge.funcs = &fpdlink_bridge_funcs;
+	np = pdev->dev.of_node;
+	fpdlink_bridge->bridge.of_node = np;
+	fpdlink_bridge->fpdlink_node = np;
+
+	gpio_pin = of_get_named_gpio(np, "disp-en-pin", 0);
+
+	drm_bridge_add(&fpdlink_bridge->bridge);
+	return 0;
+}
+
+static int fpdlink_remove(struct platform_device *pdev)
+{
+	struct fpdlink *fpdlink_bridge = platform_get_drvdata(pdev);
+
+	drm_bridge_remove(&fpdlink_bridge->bridge);
+	return 0;
+}
+
+static const struct of_device_id fpdlink_match[] = {
+	{ .compatible = "ti,fpdlink" },
+	{},
+};
+MODULE_DEVICE_TABLE(of, fpdlink_match);
+
+static struct platform_driver ti_fpdlink_driver = {
+	.probe	= fpdlink_probe,
+	.remove	= fpdlink_remove,
+	.driver		= {
+		.name		= "ti-fpdlink",
+		.of_match_table	= fpdlink_match,
+	},
+};
+module_platform_driver(ti_fpdlink_driver);
+
+MODULE_AUTHOR("Vince Kim <vince.k.kim@xxxxxxxxx>");
+MODULE_DESCRIPTION("TI FPDlink driver");
+MODULE_LICENSE("GPL");
diff --git a/drivers/gpu/drm/bridge/ti-fpdlink/ti-fpdlink.h b/drivers/gpu/drm/bridge/ti-fpdlink/ti-fpdlink.h
new file mode 100644
index 000000000000..073d4b4601f3
--- /dev/null
+++ b/drivers/gpu/drm/bridge/ti-fpdlink/ti-fpdlink.h
@@ -0,0 +1,70 @@
+/* SPDX-License-Identifier: GPL-2.0 */
+/*
+ * TI FPD-LinkIII interface bridge driver header file
+ *
+ * Copyright (C) 2019 Lucid Motors Inc.
+ *
+ * Contact: Vince Kim <vince.k.kim@xxxxxxxxx>
+ *
+ * This program is free software; you can redistribute it and/or
+ * modify it under the terms of the GNU General Public License as
+ * published by the Free Software Foundation; either version 2 of
+ * the License, or (at your option) any later version.
+ *
+ * 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.
+ */
+
+#ifndef __TI_FPDLINK_H__
+#define __TI_FPDLINK_H__
+#include <linux/list.h>
+#include <linux/ctype.h>
+#include <drm/drm_mode_object.h>
+#include <drm/drm_modes.h>
+
+struct fpdlink_dev;
+
+enum clk_status {
+	not_detected = 0,
+	detected = 1,
+};
+
+struct fpdlink_dev_funcs {
+	int (*enable)(struct fpdlink_dev *dev);
+	void (*disable)(struct fpdlink_dev *dev);
+	int (*reset)(struct fpdlink_dev *dev);
+	int (*enable_i2c_passthrough)(struct fpdlink_dev *dev);
+	bool (*link_detect)(struct fpdlink_dev *dev);
+	bool (*pixel_clk_detect)(struct fpdlink_dev *dev);
+	int (*config)(struct fpdlink_dev *dev);
+	int (*reg_write)(struct fpdlink_dev *dev, u8 reg, u8 val);
+};
+
+struct fpdlink_dev {
+	struct drm_bridge	bridge;
+	struct drm_connector	connector;
+	struct device		*dev;
+	struct i2c_client	*client;
+	struct regmap		*regmap;
+	struct mutex		lock;
+
+	const struct fpdlink_dev_funcs *funcs;
+
+	char gpio_name[20];
+	unsigned int index;
+	bool	detected;
+	int gpio_power_en;
+	enum clk_status pixel_clk_status;
+	enum clk_status link_status;
+	int config_array_size;
+	u8 *config_array;
+};
+
+static inline struct fpdlink_dev *
+drm_bridge_to_fpdlink_dev(struct drm_bridge *bridge)
+{
+	return container_of(bridge, struct fpdlink_dev, bridge);
+}
+#endif
-- 
2.17.1