From: Jagan Teki <ja...@edgeble.ai>

Add Rockchip RK3328 HDMI Out driver.

Signed-off-by: Jagan Teki <ja...@edgeble.ai>
---
 drivers/video/rockchip/Makefile      |   1 +
 drivers/video/rockchip/rk3328_hdmi.c | 131 +++++++++++++++++++++++++++
 drivers/video/rockchip/rk_hdmi.h     |   3 +
 3 files changed, 135 insertions(+)
 create mode 100644 drivers/video/rockchip/rk3328_hdmi.c

diff --git a/drivers/video/rockchip/Makefile b/drivers/video/rockchip/Makefile
index 8128289cc8..4991303c73 100644
--- a/drivers/video/rockchip/Makefile
+++ b/drivers/video/rockchip/Makefile
@@ -10,6 +10,7 @@ obj-$(CONFIG_ROCKCHIP_RK3399) += rk3399_vop.o
 obj-$(CONFIG_DISPLAY_ROCKCHIP_EDP) += rk_edp.o
 obj-$(CONFIG_DISPLAY_ROCKCHIP_LVDS) += rk_lvds.o
 obj-hdmi-$(CONFIG_ROCKCHIP_RK3288) += rk3288_hdmi.o
+obj-hdmi-$(CONFIG_ROCKCHIP_RK3328) += rk3328_hdmi.o
 obj-hdmi-$(CONFIG_ROCKCHIP_RK3399) += rk3399_hdmi.o
 obj-$(CONFIG_DISPLAY_ROCKCHIP_HDMI) += rk_hdmi.o $(obj-hdmi-y)
 obj-mipi-$(CONFIG_ROCKCHIP_RK3288) += rk3288_mipi.o
diff --git a/drivers/video/rockchip/rk3328_hdmi.c 
b/drivers/video/rockchip/rk3328_hdmi.c
new file mode 100644
index 0000000000..23624699ba
--- /dev/null
+++ b/drivers/video/rockchip/rk3328_hdmi.c
@@ -0,0 +1,131 @@
+// SPDX-License-Identifier: GPL-2.0+
+/*
+ * Copyright (c) 2023 Edgeble AI Technologies Pvt. Ltd.
+ */
+
+#include <clk.h>
+#include <display.h>
+#include <dm.h>
+#include <dw_hdmi.h>
+#include <asm/io.h>
+#include <asm/arch-rockchip/grf_rk3328.h>
+#include "rk_hdmi.h"
+
+#define RK3328_IO_3V_DOMAIN              (7 << (9 + 16))
+#define RK3328_IO_5V_DOMAIN              ((7 << 9) | (3 << (9 + 16)))
+#define RK3328_IO_DDC_IN_MSK             ((3 << 10) | (3 << (10 + 16)))
+#define RK3328_IO_CTRL_BY_HDMI           ((1 << 13) | (1 << (13 + 16)))
+
+static int rk3328_hdmi_enable(struct udevice *dev, int panel_bpp,
+                             const struct display_timing *edid)
+{
+       struct rk_hdmi_priv *priv = dev_get_priv(dev);
+
+       return dw_hdmi_enable(&priv->hdmi, edid);
+}
+
+static int rk3328_dw_hdmi_phy_cfg(struct dw_hdmi *hdmi, uint pixclock)
+{
+       struct rk_hdmi_priv *priv = container_of(hdmi, struct rk_hdmi_priv, 
hdmi);
+       int ret;
+
+       ret = generic_phy_init(&priv->phy);
+       if (ret) {
+               printf("failed to init phy (ret=%d)\n", ret);
+               return ret;
+       }
+
+       ret = generic_phy_power_on(&priv->phy);
+       if (ret) {
+               printf("failed to power on phy (ret=%d)\n", ret);
+               return ret;
+       }
+
+       return 0;
+}
+
+static void rk3328_dw_hdmi_setup_hpd(struct dw_hdmi *hdmi)
+{
+       struct rk_hdmi_priv *priv = container_of(hdmi, struct rk_hdmi_priv, 
hdmi);
+       struct rk3328_grf_regs *grf = priv->grf;
+
+       writel(RK3328_IO_DDC_IN_MSK, &grf->soc_con[2]);
+       writel(RK3328_IO_CTRL_BY_HDMI, &grf->soc_con[3]);
+}
+
+static void rk3328_dw_hdmi_read_hpd(struct dw_hdmi *hdmi, bool hpd_status)
+{
+       struct rk_hdmi_priv *priv = container_of(hdmi, struct rk_hdmi_priv, 
hdmi);
+       struct rk3328_grf_regs *grf = priv->grf;
+
+       if (hpd_status)
+               writel(RK3328_IO_5V_DOMAIN, &grf->soc_con[4]);
+       else
+               writel(RK3328_IO_3V_DOMAIN, &grf->soc_con[4]);
+}
+
+static const struct dw_hdmi_phy_ops dw_hdmi_rk3328_phy_ops = {
+       .phy_set = rk3328_dw_hdmi_phy_cfg,
+       .setup_hpd = rk3328_dw_hdmi_setup_hpd,
+       .read_hpd = rk3328_dw_hdmi_read_hpd,
+};
+
+static const struct dw_hdmi_plat_data dw_hdmi_rk3328_plat_data = {
+       .phy_force_vendor = true,
+       .phy_ops = &dw_hdmi_rk3328_phy_ops,
+};
+
+static int rk3328_hdmi_of_to_plat(struct udevice *dev)
+{
+       struct rk_hdmi_priv *priv = dev_get_priv(dev);
+       struct dw_hdmi *hdmi = &priv->hdmi;
+
+       hdmi->i2c_clk_high = 0x71;
+       hdmi->i2c_clk_low = 0x76;
+
+       rk_hdmi_of_to_plat(dev);
+
+       hdmi->data = &dw_hdmi_rk3328_plat_data;
+
+       return 0;
+}
+
+static int rk3328_hdmi_probe(struct udevice *dev)
+{
+       struct rk_hdmi_priv *priv = dev_get_priv(dev);
+       int ret;
+
+       ret = generic_phy_get_by_name(dev, "hdmi", &priv->phy);
+       if (ret) {
+               printf("failed to get hdmi phy\n");
+               return ret;
+       };
+
+       ret = rk_hdmi_probe(dev);
+       if (ret) {
+               printf("failed to probe rk hdmi\n");
+               return ret;
+       }
+
+       return 0;
+}
+
+static const struct dm_display_ops rk3328_hdmi_ops = {
+       .read_edid = rk_hdmi_read_edid,
+       .enable = rk3328_hdmi_enable,
+};
+
+static const struct udevice_id rk3328_hdmi_ids[] = {
+       { .compatible = "rockchip,rk3328-dw-hdmi" },
+       { }
+};
+
+U_BOOT_DRIVER(rk3328_hdmi_rockchip) = {
+       .name = "rk3328_hdmi_rockchip",
+       .id = UCLASS_DISPLAY,
+       .of_match = rk3328_hdmi_ids,
+       .ops = &rk3328_hdmi_ops,
+       .of_to_plat = rk3328_hdmi_of_to_plat,
+       .probe = rk3328_hdmi_probe,
+       .priv_auto      = sizeof(struct rk_hdmi_priv),
+};
diff --git a/drivers/video/rockchip/rk_hdmi.h b/drivers/video/rockchip/rk_hdmi.h
index 200dbaea74..dcfba3d3d7 100644
--- a/drivers/video/rockchip/rk_hdmi.h
+++ b/drivers/video/rockchip/rk_hdmi.h
@@ -6,6 +6,8 @@
 #ifndef __RK_HDMI_H__
 #define __RK_HDMI_H__
 
+#include <generic-phy.h>
+
 struct rkhdmi_driverdata {
        /* configuration */
        u8 i2c_clk_high;
@@ -19,6 +21,7 @@ struct rkhdmi_driverdata {
 
 struct rk_hdmi_priv {
        struct dw_hdmi hdmi;
+       struct phy phy;
        void *grf;
 };
 
-- 
2.25.1

Reply via email to