phy: mediatek: Move mtk_mipi_dsi_phy driver into drivers/phy/mediatek folder
authorChun-Kuang Hu <chunkuang.hu@kernel.org>
Mon, 5 Oct 2020 23:37:07 +0000 (07:37 +0800)
committerChun-Kuang Hu <chunkuang.hu@kernel.org>
Mon, 30 Nov 2020 15:42:40 +0000 (23:42 +0800)
mtk_mipi_dsi_phy is currently placed inside mediatek drm driver, but it's
more suitable to place a phy driver into phy driver folder, so move
mtk_mipi_dsi_phy driver into phy driver folder.

Signed-off-by: Chun-Kuang Hu <chunkuang.hu@kernel.org>
Acked-by: Chunfeng Yun <chunfeng.yun@mediatek.com>
Acked-by: Vinod Koul <vkoul@kernel.org>
12 files changed:
drivers/gpu/drm/mediatek/Kconfig
drivers/gpu/drm/mediatek/Makefile
drivers/gpu/drm/mediatek/mtk_mipi_tx.c [deleted file]
drivers/gpu/drm/mediatek/mtk_mipi_tx.h [deleted file]
drivers/gpu/drm/mediatek/mtk_mt8173_mipi_tx.c [deleted file]
drivers/gpu/drm/mediatek/mtk_mt8183_mipi_tx.c [deleted file]
drivers/phy/mediatek/Kconfig
drivers/phy/mediatek/Makefile
drivers/phy/mediatek/phy-mtk-mipi-dsi-mt8173.c [new file with mode: 0644]
drivers/phy/mediatek/phy-mtk-mipi-dsi-mt8183.c [new file with mode: 0644]
drivers/phy/mediatek/phy-mtk-mipi-dsi.c [new file with mode: 0644]
drivers/phy/mediatek/phy-mtk-mipi-dsi.h [new file with mode: 0644]

index 24c4890..2976d21 100644 (file)
@@ -28,10 +28,3 @@ config DRM_MEDIATEK_HDMI
        select PHY_MTK_HDMI
        help
          DRM/KMS HDMI driver for Mediatek SoCs
-
-config PHY_MTK_MIPI_DSI
-       tristate "Mediatek MIPI-DSI-PHY Driver"
-       depends on ARCH_MEDIATEK && OF
-       select GENERIC_PHY
-       help
-         Support MIPI DSI PHY for Mediatek SoCs.
index baa1880..a892ede 100644 (file)
@@ -19,9 +19,3 @@ mediatek-drm-hdmi-objs := mtk_cec.o \
                          mtk_hdmi_ddc.o
 
 obj-$(CONFIG_DRM_MEDIATEK_HDMI) += mediatek-drm-hdmi.o
-
-phy-mtk-mipi-dsi-drv-objs := mtk_mipi_tx.o \
-                            mtk_mt8173_mipi_tx.o \
-                            mtk_mt8183_mipi_tx.o
-
-obj-$(CONFIG_PHY_MTK_MIPI_DSI) += phy-mtk-mipi-dsi-drv.o
diff --git a/drivers/gpu/drm/mediatek/mtk_mipi_tx.c b/drivers/gpu/drm/mediatek/mtk_mipi_tx.c
deleted file mode 100644 (file)
index f2a892e..0000000
+++ /dev/null
@@ -1,248 +0,0 @@
-// SPDX-License-Identifier: GPL-2.0-only
-/*
- * Copyright (c) 2015 MediaTek Inc.
- */
-
-#include "mtk_mipi_tx.h"
-
-inline struct mtk_mipi_tx *mtk_mipi_tx_from_clk_hw(struct clk_hw *hw)
-{
-       return container_of(hw, struct mtk_mipi_tx, pll_hw);
-}
-
-void mtk_mipi_tx_clear_bits(struct mtk_mipi_tx *mipi_tx, u32 offset,
-                           u32 bits)
-{
-       u32 temp = readl(mipi_tx->regs + offset);
-
-       writel(temp & ~bits, mipi_tx->regs + offset);
-}
-
-void mtk_mipi_tx_set_bits(struct mtk_mipi_tx *mipi_tx, u32 offset,
-                         u32 bits)
-{
-       u32 temp = readl(mipi_tx->regs + offset);
-
-       writel(temp | bits, mipi_tx->regs + offset);
-}
-
-void mtk_mipi_tx_update_bits(struct mtk_mipi_tx *mipi_tx, u32 offset,
-                            u32 mask, u32 data)
-{
-       u32 temp = readl(mipi_tx->regs + offset);
-
-       writel((temp & ~mask) | (data & mask), mipi_tx->regs + offset);
-}
-
-int mtk_mipi_tx_pll_set_rate(struct clk_hw *hw, unsigned long rate,
-                            unsigned long parent_rate)
-{
-       struct mtk_mipi_tx *mipi_tx = mtk_mipi_tx_from_clk_hw(hw);
-
-       dev_dbg(mipi_tx->dev, "set rate: %lu Hz\n", rate);
-
-       mipi_tx->data_rate = rate;
-
-       return 0;
-}
-
-unsigned long mtk_mipi_tx_pll_recalc_rate(struct clk_hw *hw,
-                                         unsigned long parent_rate)
-{
-       struct mtk_mipi_tx *mipi_tx = mtk_mipi_tx_from_clk_hw(hw);
-
-       return mipi_tx->data_rate;
-}
-
-static int mtk_mipi_tx_power_on(struct phy *phy)
-{
-       struct mtk_mipi_tx *mipi_tx = phy_get_drvdata(phy);
-       int ret;
-
-       /* Power up core and enable PLL */
-       ret = clk_prepare_enable(mipi_tx->pll);
-       if (ret < 0)
-               return ret;
-
-       /* Enable DSI Lane LDO outputs, disable pad tie low */
-       mipi_tx->driver_data->mipi_tx_enable_signal(phy);
-       return 0;
-}
-
-static int mtk_mipi_tx_power_off(struct phy *phy)
-{
-       struct mtk_mipi_tx *mipi_tx = phy_get_drvdata(phy);
-
-       /* Enable pad tie low, disable DSI Lane LDO outputs */
-       mipi_tx->driver_data->mipi_tx_disable_signal(phy);
-
-       /* Disable PLL and power down core */
-       clk_disable_unprepare(mipi_tx->pll);
-
-       return 0;
-}
-
-static const struct phy_ops mtk_mipi_tx_ops = {
-       .power_on = mtk_mipi_tx_power_on,
-       .power_off = mtk_mipi_tx_power_off,
-       .owner = THIS_MODULE,
-};
-
-static void mtk_mipi_tx_get_calibration_datal(struct mtk_mipi_tx *mipi_tx)
-{
-       struct nvmem_cell *cell;
-       size_t len;
-       u32 *buf;
-
-       cell = nvmem_cell_get(mipi_tx->dev, "calibration-data");
-       if (IS_ERR(cell)) {
-               dev_info(mipi_tx->dev, "can't get nvmem_cell_get, ignore it\n");
-               return;
-       }
-       buf = (u32 *)nvmem_cell_read(cell, &len);
-       nvmem_cell_put(cell);
-
-       if (IS_ERR(buf)) {
-               dev_info(mipi_tx->dev, "can't get data, ignore it\n");
-               return;
-       }
-
-       if (len < 3 * sizeof(u32)) {
-               dev_info(mipi_tx->dev, "invalid calibration data\n");
-               kfree(buf);
-               return;
-       }
-
-       mipi_tx->rt_code[0] = ((buf[0] >> 6 & 0x1f) << 5) |
-                              (buf[0] >> 11 & 0x1f);
-       mipi_tx->rt_code[1] = ((buf[1] >> 27 & 0x1f) << 5) |
-                              (buf[0] >> 1 & 0x1f);
-       mipi_tx->rt_code[2] = ((buf[1] >> 17 & 0x1f) << 5) |
-                              (buf[1] >> 22 & 0x1f);
-       mipi_tx->rt_code[3] = ((buf[1] >> 7 & 0x1f) << 5) |
-                              (buf[1] >> 12 & 0x1f);
-       mipi_tx->rt_code[4] = ((buf[2] >> 27 & 0x1f) << 5) |
-                              (buf[1] >> 2 & 0x1f);
-       kfree(buf);
-}
-
-static int mtk_mipi_tx_probe(struct platform_device *pdev)
-{
-       struct device *dev = &pdev->dev;
-       struct mtk_mipi_tx *mipi_tx;
-       struct resource *mem;
-       const char *ref_clk_name;
-       struct clk *ref_clk;
-       struct clk_init_data clk_init = {
-               .num_parents = 1,
-               .parent_names = (const char * const *)&ref_clk_name,
-               .flags = CLK_SET_RATE_GATE,
-       };
-       struct phy *phy;
-       struct phy_provider *phy_provider;
-       int ret;
-
-       mipi_tx = devm_kzalloc(dev, sizeof(*mipi_tx), GFP_KERNEL);
-       if (!mipi_tx)
-               return -ENOMEM;
-
-       mipi_tx->driver_data = of_device_get_match_data(dev);
-
-       mem = platform_get_resource(pdev, IORESOURCE_MEM, 0);
-       mipi_tx->regs = devm_ioremap_resource(dev, mem);
-       if (IS_ERR(mipi_tx->regs)) {
-               ret = PTR_ERR(mipi_tx->regs);
-               dev_err(dev, "Failed to get memory resource: %d\n", ret);
-               return ret;
-       }
-
-       ref_clk = devm_clk_get(dev, NULL);
-       if (IS_ERR(ref_clk)) {
-               ret = PTR_ERR(ref_clk);
-               dev_err(dev, "Failed to get reference clock: %d\n", ret);
-               return ret;
-       }
-
-       ret = of_property_read_u32(dev->of_node, "drive-strength-microamp",
-                                  &mipi_tx->mipitx_drive);
-       /* If can't get the "mipi_tx->mipitx_drive", set it default 0x8 */
-       if (ret < 0)
-               mipi_tx->mipitx_drive = 4600;
-
-       /* check the mipitx_drive valid */
-       if (mipi_tx->mipitx_drive > 6000 || mipi_tx->mipitx_drive < 3000) {
-               dev_warn(dev, "drive-strength-microamp is invalid %d, not in 3000 ~ 6000\n",
-                        mipi_tx->mipitx_drive);
-               mipi_tx->mipitx_drive = clamp_val(mipi_tx->mipitx_drive, 3000,
-                                                 6000);
-       }
-
-       ref_clk_name = __clk_get_name(ref_clk);
-
-       ret = of_property_read_string(dev->of_node, "clock-output-names",
-                                     &clk_init.name);
-       if (ret < 0) {
-               dev_err(dev, "Failed to read clock-output-names: %d\n", ret);
-               return ret;
-       }
-
-       clk_init.ops = mipi_tx->driver_data->mipi_tx_clk_ops;
-
-       mipi_tx->pll_hw.init = &clk_init;
-       mipi_tx->pll = devm_clk_register(dev, &mipi_tx->pll_hw);
-       if (IS_ERR(mipi_tx->pll)) {
-               ret = PTR_ERR(mipi_tx->pll);
-               dev_err(dev, "Failed to register PLL: %d\n", ret);
-               return ret;
-       }
-
-       phy = devm_phy_create(dev, NULL, &mtk_mipi_tx_ops);
-       if (IS_ERR(phy)) {
-               ret = PTR_ERR(phy);
-               dev_err(dev, "Failed to create MIPI D-PHY: %d\n", ret);
-               return ret;
-       }
-       phy_set_drvdata(phy, mipi_tx);
-
-       phy_provider = devm_of_phy_provider_register(dev, of_phy_simple_xlate);
-       if (IS_ERR(phy_provider)) {
-               ret = PTR_ERR(phy_provider);
-               return ret;
-       }
-
-       mipi_tx->dev = dev;
-
-       mtk_mipi_tx_get_calibration_datal(mipi_tx);
-
-       return of_clk_add_provider(dev->of_node, of_clk_src_simple_get,
-                                  mipi_tx->pll);
-}
-
-static int mtk_mipi_tx_remove(struct platform_device *pdev)
-{
-       of_clk_del_provider(pdev->dev.of_node);
-       return 0;
-}
-
-static const struct of_device_id mtk_mipi_tx_match[] = {
-       { .compatible = "mediatek,mt2701-mipi-tx",
-         .data = &mt2701_mipitx_data },
-       { .compatible = "mediatek,mt8173-mipi-tx",
-         .data = &mt8173_mipitx_data },
-       { .compatible = "mediatek,mt8183-mipi-tx",
-         .data = &mt8183_mipitx_data },
-       { },
-};
-
-struct platform_driver mtk_mipi_tx_driver = {
-       .probe = mtk_mipi_tx_probe,
-       .remove = mtk_mipi_tx_remove,
-       .driver = {
-               .name = "mediatek-mipi-tx",
-               .of_match_table = mtk_mipi_tx_match,
-       },
-};
-module_platform_driver(mtk_mipi_tx_driver);
-
-MODULE_DESCRIPTION("MediaTek MIPI TX Driver");
-MODULE_LICENSE("GPL v2");
diff --git a/drivers/gpu/drm/mediatek/mtk_mipi_tx.h b/drivers/gpu/drm/mediatek/mtk_mipi_tx.h
deleted file mode 100644 (file)
index c76f07c..0000000
+++ /dev/null
@@ -1,53 +0,0 @@
-/* SPDX-License-Identifier: GPL-2.0 */
-/*
- * Copyright (c) 2019 MediaTek Inc.
- * Author: Jitao Shi <jitao.shi@mediatek.com>
- */
-
-#ifndef _MTK_MIPI_TX_H
-#define _MTK_MIPI_TX_H
-
-#include <linux/clk.h>
-#include <linux/clk-provider.h>
-#include <linux/delay.h>
-#include <linux/io.h>
-#include <linux/module.h>
-#include <linux/nvmem-consumer.h>
-#include <linux/of_device.h>
-#include <linux/platform_device.h>
-#include <linux/phy/phy.h>
-#include <linux/slab.h>
-
-struct mtk_mipitx_data {
-       const u32 mppll_preserve;
-       const struct clk_ops *mipi_tx_clk_ops;
-       void (*mipi_tx_enable_signal)(struct phy *phy);
-       void (*mipi_tx_disable_signal)(struct phy *phy);
-};
-
-struct mtk_mipi_tx {
-       struct device *dev;
-       void __iomem *regs;
-       u32 data_rate;
-       u32 mipitx_drive;
-       u32 rt_code[5];
-       const struct mtk_mipitx_data *driver_data;
-       struct clk_hw pll_hw;
-       struct clk *pll;
-};
-
-struct mtk_mipi_tx *mtk_mipi_tx_from_clk_hw(struct clk_hw *hw);
-void mtk_mipi_tx_clear_bits(struct mtk_mipi_tx *mipi_tx, u32 offset, u32 bits);
-void mtk_mipi_tx_set_bits(struct mtk_mipi_tx *mipi_tx, u32 offset, u32 bits);
-void mtk_mipi_tx_update_bits(struct mtk_mipi_tx *mipi_tx, u32 offset, u32 mask,
-                            u32 data);
-int mtk_mipi_tx_pll_set_rate(struct clk_hw *hw, unsigned long rate,
-                            unsigned long parent_rate);
-unsigned long mtk_mipi_tx_pll_recalc_rate(struct clk_hw *hw,
-                                         unsigned long parent_rate);
-
-extern const struct mtk_mipitx_data mt2701_mipitx_data;
-extern const struct mtk_mipitx_data mt8173_mipitx_data;
-extern const struct mtk_mipitx_data mt8183_mipitx_data;
-
-#endif
diff --git a/drivers/gpu/drm/mediatek/mtk_mt8173_mipi_tx.c b/drivers/gpu/drm/mediatek/mtk_mt8173_mipi_tx.c
deleted file mode 100644 (file)
index f18db14..0000000
+++ /dev/null
@@ -1,288 +0,0 @@
-// SPDX-License-Identifier: GPL-2.0
-/*
- * Copyright (c) 2019 MediaTek Inc.
- * Author: jitao.shi <jitao.shi@mediatek.com>
- */
-
-#include "mtk_mipi_tx.h"
-
-#define MIPITX_DSI_CON         0x00
-#define RG_DSI_LDOCORE_EN              BIT(0)
-#define RG_DSI_CKG_LDOOUT_EN           BIT(1)
-#define RG_DSI_BCLK_SEL                        (3 << 2)
-#define RG_DSI_LD_IDX_SEL              (7 << 4)
-#define RG_DSI_PHYCLK_SEL              (2 << 8)
-#define RG_DSI_DSICLK_FREQ_SEL         BIT(10)
-#define RG_DSI_LPTX_CLMP_EN            BIT(11)
-
-#define MIPITX_DSI_CLOCK_LANE  0x04
-#define MIPITX_DSI_DATA_LANE0  0x08
-#define MIPITX_DSI_DATA_LANE1  0x0c
-#define MIPITX_DSI_DATA_LANE2  0x10
-#define MIPITX_DSI_DATA_LANE3  0x14
-#define RG_DSI_LNTx_LDOOUT_EN          BIT(0)
-#define RG_DSI_LNTx_CKLANE_EN          BIT(1)
-#define RG_DSI_LNTx_LPTX_IPLUS1                BIT(2)
-#define RG_DSI_LNTx_LPTX_IPLUS2                BIT(3)
-#define RG_DSI_LNTx_LPTX_IMINUS                BIT(4)
-#define RG_DSI_LNTx_LPCD_IPLUS         BIT(5)
-#define RG_DSI_LNTx_LPCD_IMINUS                BIT(6)
-#define RG_DSI_LNTx_RT_CODE            (0xf << 8)
-
-#define MIPITX_DSI_TOP_CON     0x40
-#define RG_DSI_LNT_INTR_EN             BIT(0)
-#define RG_DSI_LNT_HS_BIAS_EN          BIT(1)
-#define RG_DSI_LNT_IMP_CAL_EN          BIT(2)
-#define RG_DSI_LNT_TESTMODE_EN         BIT(3)
-#define RG_DSI_LNT_IMP_CAL_CODE                (0xf << 4)
-#define RG_DSI_LNT_AIO_SEL             (7 << 8)
-#define RG_DSI_PAD_TIE_LOW_EN          BIT(11)
-#define RG_DSI_DEBUG_INPUT_EN          BIT(12)
-#define RG_DSI_PRESERVE                        (7 << 13)
-
-#define MIPITX_DSI_BG_CON      0x44
-#define RG_DSI_BG_CORE_EN              BIT(0)
-#define RG_DSI_BG_CKEN                 BIT(1)
-#define RG_DSI_BG_DIV                  (0x3 << 2)
-#define RG_DSI_BG_FAST_CHARGE          BIT(4)
-#define RG_DSI_VOUT_MSK                        (0x3ffff << 5)
-#define RG_DSI_V12_SEL                 (7 << 5)
-#define RG_DSI_V10_SEL                 (7 << 8)
-#define RG_DSI_V072_SEL                        (7 << 11)
-#define RG_DSI_V04_SEL                 (7 << 14)
-#define RG_DSI_V032_SEL                        (7 << 17)
-#define RG_DSI_V02_SEL                 (7 << 20)
-#define RG_DSI_BG_R1_TRIM              (0xf << 24)
-#define RG_DSI_BG_R2_TRIM              (0xf << 28)
-
-#define MIPITX_DSI_PLL_CON0    0x50
-#define RG_DSI_MPPLL_PLL_EN            BIT(0)
-#define RG_DSI_MPPLL_DIV_MSK           (0x1ff << 1)
-#define RG_DSI_MPPLL_PREDIV            (3 << 1)
-#define RG_DSI_MPPLL_TXDIV0            (3 << 3)
-#define RG_DSI_MPPLL_TXDIV1            (3 << 5)
-#define RG_DSI_MPPLL_POSDIV            (7 << 7)
-#define RG_DSI_MPPLL_MONVC_EN          BIT(10)
-#define RG_DSI_MPPLL_MONREF_EN         BIT(11)
-#define RG_DSI_MPPLL_VOD_EN            BIT(12)
-
-#define MIPITX_DSI_PLL_CON1    0x54
-#define RG_DSI_MPPLL_SDM_FRA_EN                BIT(0)
-#define RG_DSI_MPPLL_SDM_SSC_PH_INIT   BIT(1)
-#define RG_DSI_MPPLL_SDM_SSC_EN                BIT(2)
-#define RG_DSI_MPPLL_SDM_SSC_PRD       (0xffff << 16)
-
-#define MIPITX_DSI_PLL_CON2    0x58
-
-#define MIPITX_DSI_PLL_TOP     0x64
-#define RG_DSI_MPPLL_PRESERVE          (0xff << 8)
-
-#define MIPITX_DSI_PLL_PWR     0x68
-#define RG_DSI_MPPLL_SDM_PWR_ON                BIT(0)
-#define RG_DSI_MPPLL_SDM_ISO_EN                BIT(1)
-#define RG_DSI_MPPLL_SDM_PWR_ACK       BIT(8)
-
-#define MIPITX_DSI_SW_CTRL     0x80
-#define SW_CTRL_EN                     BIT(0)
-
-#define MIPITX_DSI_SW_CTRL_CON0        0x84
-#define SW_LNTC_LPTX_PRE_OE            BIT(0)
-#define SW_LNTC_LPTX_OE                        BIT(1)
-#define SW_LNTC_LPTX_P                 BIT(2)
-#define SW_LNTC_LPTX_N                 BIT(3)
-#define SW_LNTC_HSTX_PRE_OE            BIT(4)
-#define SW_LNTC_HSTX_OE                        BIT(5)
-#define SW_LNTC_HSTX_ZEROCLK           BIT(6)
-#define SW_LNT0_LPTX_PRE_OE            BIT(7)
-#define SW_LNT0_LPTX_OE                        BIT(8)
-#define SW_LNT0_LPTX_P                 BIT(9)
-#define SW_LNT0_LPTX_N                 BIT(10)
-#define SW_LNT0_HSTX_PRE_OE            BIT(11)
-#define SW_LNT0_HSTX_OE                        BIT(12)
-#define SW_LNT0_LPRX_EN                        BIT(13)
-#define SW_LNT1_LPTX_PRE_OE            BIT(14)
-#define SW_LNT1_LPTX_OE                        BIT(15)
-#define SW_LNT1_LPTX_P                 BIT(16)
-#define SW_LNT1_LPTX_N                 BIT(17)
-#define SW_LNT1_HSTX_PRE_OE            BIT(18)
-#define SW_LNT1_HSTX_OE                        BIT(19)
-#define SW_LNT2_LPTX_PRE_OE            BIT(20)
-#define SW_LNT2_LPTX_OE                        BIT(21)
-#define SW_LNT2_LPTX_P                 BIT(22)
-#define SW_LNT2_LPTX_N                 BIT(23)
-#define SW_LNT2_HSTX_PRE_OE            BIT(24)
-#define SW_LNT2_HSTX_OE                        BIT(25)
-
-static int mtk_mipi_tx_pll_prepare(struct clk_hw *hw)
-{
-       struct mtk_mipi_tx *mipi_tx = mtk_mipi_tx_from_clk_hw(hw);
-       u8 txdiv, txdiv0, txdiv1;
-       u64 pcw;
-
-       dev_dbg(mipi_tx->dev, "prepare: %u Hz\n", mipi_tx->data_rate);
-
-       if (mipi_tx->data_rate >= 500000000) {
-               txdiv = 1;
-               txdiv0 = 0;
-               txdiv1 = 0;
-       } else if (mipi_tx->data_rate >= 250000000) {
-               txdiv = 2;
-               txdiv0 = 1;
-               txdiv1 = 0;
-       } else if (mipi_tx->data_rate >= 125000000) {
-               txdiv = 4;
-               txdiv0 = 2;
-               txdiv1 = 0;
-       } else if (mipi_tx->data_rate > 62000000) {
-               txdiv = 8;
-               txdiv0 = 2;
-               txdiv1 = 1;
-       } else if (mipi_tx->data_rate >= 50000000) {
-               txdiv = 16;
-               txdiv0 = 2;
-               txdiv1 = 2;
-       } else {
-               return -EINVAL;
-       }
-
-       mtk_mipi_tx_update_bits(mipi_tx, MIPITX_DSI_BG_CON,
-                               RG_DSI_VOUT_MSK |
-                               RG_DSI_BG_CKEN | RG_DSI_BG_CORE_EN,
-                               (4 << 20) | (4 << 17) | (4 << 14) |
-                               (4 << 11) | (4 << 8) | (4 << 5) |
-                               RG_DSI_BG_CKEN | RG_DSI_BG_CORE_EN);
-
-       usleep_range(30, 100);
-
-       mtk_mipi_tx_update_bits(mipi_tx, MIPITX_DSI_TOP_CON,
-                               RG_DSI_LNT_IMP_CAL_CODE | RG_DSI_LNT_HS_BIAS_EN,
-                               (8 << 4) | RG_DSI_LNT_HS_BIAS_EN);
-
-       mtk_mipi_tx_set_bits(mipi_tx, MIPITX_DSI_CON,
-                            RG_DSI_CKG_LDOOUT_EN | RG_DSI_LDOCORE_EN);
-
-       mtk_mipi_tx_update_bits(mipi_tx, MIPITX_DSI_PLL_PWR,
-                               RG_DSI_MPPLL_SDM_PWR_ON |
-                               RG_DSI_MPPLL_SDM_ISO_EN,
-                               RG_DSI_MPPLL_SDM_PWR_ON);
-
-       mtk_mipi_tx_clear_bits(mipi_tx, MIPITX_DSI_PLL_CON0,
-                              RG_DSI_MPPLL_PLL_EN);
-
-       mtk_mipi_tx_update_bits(mipi_tx, MIPITX_DSI_PLL_CON0,
-                               RG_DSI_MPPLL_TXDIV0 | RG_DSI_MPPLL_TXDIV1 |
-                               RG_DSI_MPPLL_PREDIV,
-                               (txdiv0 << 3) | (txdiv1 << 5));
-
-       /*
-        * PLL PCW config
-        * PCW bit 24~30 = integer part of pcw
-        * PCW bit 0~23 = fractional part of pcw
-        * pcw = data_Rate*4*txdiv/(Ref_clk*2);
-        * Post DIV =4, so need data_Rate*4
-        * Ref_clk is 26MHz
-        */
-       pcw = div_u64(((u64)mipi_tx->data_rate * 2 * txdiv) << 24,
-                     26000000);
-       writel(pcw, mipi_tx->regs + MIPITX_DSI_PLL_CON2);
-
-       mtk_mipi_tx_set_bits(mipi_tx, MIPITX_DSI_PLL_CON1,
-                            RG_DSI_MPPLL_SDM_FRA_EN);
-
-       mtk_mipi_tx_set_bits(mipi_tx, MIPITX_DSI_PLL_CON0, RG_DSI_MPPLL_PLL_EN);
-
-       usleep_range(20, 100);
-
-       mtk_mipi_tx_clear_bits(mipi_tx, MIPITX_DSI_PLL_CON1,
-                              RG_DSI_MPPLL_SDM_SSC_EN);
-
-       mtk_mipi_tx_update_bits(mipi_tx, MIPITX_DSI_PLL_TOP,
-                               RG_DSI_MPPLL_PRESERVE,
-                               mipi_tx->driver_data->mppll_preserve);
-
-       return 0;
-}
-
-static void mtk_mipi_tx_pll_unprepare(struct clk_hw *hw)
-{
-       struct mtk_mipi_tx *mipi_tx = mtk_mipi_tx_from_clk_hw(hw);
-
-       dev_dbg(mipi_tx->dev, "unprepare\n");
-
-       mtk_mipi_tx_clear_bits(mipi_tx, MIPITX_DSI_PLL_CON0,
-                              RG_DSI_MPPLL_PLL_EN);
-
-       mtk_mipi_tx_update_bits(mipi_tx, MIPITX_DSI_PLL_TOP,
-                               RG_DSI_MPPLL_PRESERVE, 0);
-
-       mtk_mipi_tx_update_bits(mipi_tx, MIPITX_DSI_PLL_PWR,
-                               RG_DSI_MPPLL_SDM_ISO_EN |
-                               RG_DSI_MPPLL_SDM_PWR_ON,
-                               RG_DSI_MPPLL_SDM_ISO_EN);
-
-       mtk_mipi_tx_clear_bits(mipi_tx, MIPITX_DSI_TOP_CON,
-                              RG_DSI_LNT_HS_BIAS_EN);
-
-       mtk_mipi_tx_clear_bits(mipi_tx, MIPITX_DSI_CON,
-                              RG_DSI_CKG_LDOOUT_EN | RG_DSI_LDOCORE_EN);
-
-       mtk_mipi_tx_clear_bits(mipi_tx, MIPITX_DSI_BG_CON,
-                              RG_DSI_BG_CKEN | RG_DSI_BG_CORE_EN);
-
-       mtk_mipi_tx_clear_bits(mipi_tx, MIPITX_DSI_PLL_CON0,
-                              RG_DSI_MPPLL_DIV_MSK);
-}
-
-static long mtk_mipi_tx_pll_round_rate(struct clk_hw *hw, unsigned long rate,
-                                      unsigned long *prate)
-{
-       return clamp_val(rate, 50000000, 1250000000);
-}
-
-static const struct clk_ops mtk_mipi_tx_pll_ops = {
-       .prepare = mtk_mipi_tx_pll_prepare,
-       .unprepare = mtk_mipi_tx_pll_unprepare,
-       .round_rate = mtk_mipi_tx_pll_round_rate,
-       .set_rate = mtk_mipi_tx_pll_set_rate,
-       .recalc_rate = mtk_mipi_tx_pll_recalc_rate,
-};
-
-static void mtk_mipi_tx_power_on_signal(struct phy *phy)
-{
-       struct mtk_mipi_tx *mipi_tx = phy_get_drvdata(phy);
-       u32 reg;
-
-       for (reg = MIPITX_DSI_CLOCK_LANE;
-            reg <= MIPITX_DSI_DATA_LANE3; reg += 4)
-               mtk_mipi_tx_set_bits(mipi_tx, reg, RG_DSI_LNTx_LDOOUT_EN);
-
-       mtk_mipi_tx_clear_bits(mipi_tx, MIPITX_DSI_TOP_CON,
-                              RG_DSI_PAD_TIE_LOW_EN);
-}
-
-static void mtk_mipi_tx_power_off_signal(struct phy *phy)
-{
-       struct mtk_mipi_tx *mipi_tx = phy_get_drvdata(phy);
-       u32 reg;
-
-       mtk_mipi_tx_set_bits(mipi_tx, MIPITX_DSI_TOP_CON,
-                            RG_DSI_PAD_TIE_LOW_EN);
-
-       for (reg = MIPITX_DSI_CLOCK_LANE;
-            reg <= MIPITX_DSI_DATA_LANE3; reg += 4)
-               mtk_mipi_tx_clear_bits(mipi_tx, reg, RG_DSI_LNTx_LDOOUT_EN);
-}
-
-const struct mtk_mipitx_data mt2701_mipitx_data = {
-       .mppll_preserve = (3 << 8),
-       .mipi_tx_clk_ops = &mtk_mipi_tx_pll_ops,
-       .mipi_tx_enable_signal = mtk_mipi_tx_power_on_signal,
-       .mipi_tx_disable_signal = mtk_mipi_tx_power_off_signal,
-};
-
-const struct mtk_mipitx_data mt8173_mipitx_data = {
-       .mppll_preserve = (0 << 8),
-       .mipi_tx_clk_ops = &mtk_mipi_tx_pll_ops,
-       .mipi_tx_enable_signal = mtk_mipi_tx_power_on_signal,
-       .mipi_tx_disable_signal = mtk_mipi_tx_power_off_signal,
-};
diff --git a/drivers/gpu/drm/mediatek/mtk_mt8183_mipi_tx.c b/drivers/gpu/drm/mediatek/mtk_mt8183_mipi_tx.c
deleted file mode 100644 (file)
index 9f3e55a..0000000
+++ /dev/null
@@ -1,177 +0,0 @@
-// SPDX-License-Identifier: GPL-2.0
-/*
- * Copyright (c) 2019 MediaTek Inc.
- * Author: jitao.shi <jitao.shi@mediatek.com>
- */
-
-#include "mtk_mipi_tx.h"
-
-#define MIPITX_LANE_CON                0x000c
-#define RG_DSI_CPHY_T1DRV_EN           BIT(0)
-#define RG_DSI_ANA_CK_SEL              BIT(1)
-#define RG_DSI_PHY_CK_SEL              BIT(2)
-#define RG_DSI_CPHY_EN                 BIT(3)
-#define RG_DSI_PHYCK_INV_EN            BIT(4)
-#define RG_DSI_PWR04_EN                        BIT(5)
-#define RG_DSI_BG_LPF_EN               BIT(6)
-#define RG_DSI_BG_CORE_EN              BIT(7)
-#define RG_DSI_PAD_TIEL_SEL            BIT(8)
-
-#define MIPITX_VOLTAGE_SEL     0x0010
-#define RG_DSI_HSTX_LDO_REF_SEL                (0xf << 6)
-
-#define MIPITX_PLL_PWR         0x0028
-#define MIPITX_PLL_CON0                0x002c
-#define MIPITX_PLL_CON1                0x0030
-#define MIPITX_PLL_CON2                0x0034
-#define MIPITX_PLL_CON3                0x0038
-#define MIPITX_PLL_CON4                0x003c
-#define RG_DSI_PLL_IBIAS               (3 << 10)
-
-#define MIPITX_D2P_RTCODE      0x0100
-#define MIPITX_D2_SW_CTL_EN    0x0144
-#define MIPITX_D0_SW_CTL_EN    0x0244
-#define MIPITX_CK_CKMODE_EN    0x0328
-#define DSI_CK_CKMODE_EN               BIT(0)
-#define MIPITX_CK_SW_CTL_EN    0x0344
-#define MIPITX_D1_SW_CTL_EN    0x0444
-#define MIPITX_D3_SW_CTL_EN    0x0544
-#define DSI_SW_CTL_EN                  BIT(0)
-#define AD_DSI_PLL_SDM_PWR_ON          BIT(0)
-#define AD_DSI_PLL_SDM_ISO_EN          BIT(1)
-
-#define RG_DSI_PLL_EN                  BIT(4)
-#define RG_DSI_PLL_POSDIV              (0x7 << 8)
-
-static int mtk_mipi_tx_pll_enable(struct clk_hw *hw)
-{
-       struct mtk_mipi_tx *mipi_tx = mtk_mipi_tx_from_clk_hw(hw);
-       unsigned int txdiv, txdiv0;
-       u64 pcw;
-
-       dev_dbg(mipi_tx->dev, "enable: %u bps\n", mipi_tx->data_rate);
-
-       if (mipi_tx->data_rate >= 2000000000) {
-               txdiv = 1;
-               txdiv0 = 0;
-       } else if (mipi_tx->data_rate >= 1000000000) {
-               txdiv = 2;
-               txdiv0 = 1;
-       } else if (mipi_tx->data_rate >= 500000000) {
-               txdiv = 4;
-               txdiv0 = 2;
-       } else if (mipi_tx->data_rate > 250000000) {
-               txdiv = 8;
-               txdiv0 = 3;
-       } else if (mipi_tx->data_rate >= 125000000) {
-               txdiv = 16;
-               txdiv0 = 4;
-       } else {
-               return -EINVAL;
-       }
-
-       mtk_mipi_tx_clear_bits(mipi_tx, MIPITX_PLL_CON4, RG_DSI_PLL_IBIAS);
-
-       mtk_mipi_tx_set_bits(mipi_tx, MIPITX_PLL_PWR, AD_DSI_PLL_SDM_PWR_ON);
-       mtk_mipi_tx_clear_bits(mipi_tx, MIPITX_PLL_CON1, RG_DSI_PLL_EN);
-       udelay(1);
-       mtk_mipi_tx_clear_bits(mipi_tx, MIPITX_PLL_PWR, AD_DSI_PLL_SDM_ISO_EN);
-       pcw = div_u64(((u64)mipi_tx->data_rate * txdiv) << 24, 26000000);
-       writel(pcw, mipi_tx->regs + MIPITX_PLL_CON0);
-       mtk_mipi_tx_update_bits(mipi_tx, MIPITX_PLL_CON1, RG_DSI_PLL_POSDIV,
-                               txdiv0 << 8);
-       mtk_mipi_tx_set_bits(mipi_tx, MIPITX_PLL_CON1, RG_DSI_PLL_EN);
-
-       return 0;
-}
-
-static void mtk_mipi_tx_pll_disable(struct clk_hw *hw)
-{
-       struct mtk_mipi_tx *mipi_tx = mtk_mipi_tx_from_clk_hw(hw);
-
-       mtk_mipi_tx_clear_bits(mipi_tx, MIPITX_PLL_CON1, RG_DSI_PLL_EN);
-
-       mtk_mipi_tx_set_bits(mipi_tx, MIPITX_PLL_PWR, AD_DSI_PLL_SDM_ISO_EN);
-       mtk_mipi_tx_clear_bits(mipi_tx, MIPITX_PLL_PWR, AD_DSI_PLL_SDM_PWR_ON);
-}
-
-static long mtk_mipi_tx_pll_round_rate(struct clk_hw *hw, unsigned long rate,
-                                      unsigned long *prate)
-{
-       return clamp_val(rate, 50000000, 1600000000);
-}
-
-static const struct clk_ops mtk_mipi_tx_pll_ops = {
-       .enable = mtk_mipi_tx_pll_enable,
-       .disable = mtk_mipi_tx_pll_disable,
-       .round_rate = mtk_mipi_tx_pll_round_rate,
-       .set_rate = mtk_mipi_tx_pll_set_rate,
-       .recalc_rate = mtk_mipi_tx_pll_recalc_rate,
-};
-
-static void mtk_mipi_tx_config_calibration_data(struct mtk_mipi_tx *mipi_tx)
-{
-       int i, j;
-
-       for (i = 0; i < 5; i++) {
-               if ((mipi_tx->rt_code[i] & 0x1f) == 0)
-                       mipi_tx->rt_code[i] |= 0x10;
-
-               if ((mipi_tx->rt_code[i] >> 5 & 0x1f) == 0)
-                       mipi_tx->rt_code[i] |= 0x10 << 5;
-
-               for (j = 0; j < 10; j++)
-                       mtk_mipi_tx_update_bits(mipi_tx,
-                               MIPITX_D2P_RTCODE * (i + 1) + j * 4,
-                               1, mipi_tx->rt_code[i] >> j & 1);
-       }
-}
-
-static void mtk_mipi_tx_power_on_signal(struct phy *phy)
-{
-       struct mtk_mipi_tx *mipi_tx = phy_get_drvdata(phy);
-
-       /* BG_LPF_EN / BG_CORE_EN */
-       writel(RG_DSI_PAD_TIEL_SEL | RG_DSI_BG_CORE_EN,
-              mipi_tx->regs + MIPITX_LANE_CON);
-       usleep_range(30, 100);
-       writel(RG_DSI_BG_CORE_EN | RG_DSI_BG_LPF_EN,
-              mipi_tx->regs + MIPITX_LANE_CON);
-
-       /* Switch OFF each Lane */
-       mtk_mipi_tx_clear_bits(mipi_tx, MIPITX_D0_SW_CTL_EN, DSI_SW_CTL_EN);
-       mtk_mipi_tx_clear_bits(mipi_tx, MIPITX_D1_SW_CTL_EN, DSI_SW_CTL_EN);
-       mtk_mipi_tx_clear_bits(mipi_tx, MIPITX_D2_SW_CTL_EN, DSI_SW_CTL_EN);
-       mtk_mipi_tx_clear_bits(mipi_tx, MIPITX_D3_SW_CTL_EN, DSI_SW_CTL_EN);
-       mtk_mipi_tx_clear_bits(mipi_tx, MIPITX_CK_SW_CTL_EN, DSI_SW_CTL_EN);
-
-       mtk_mipi_tx_update_bits(mipi_tx, MIPITX_VOLTAGE_SEL,
-                               RG_DSI_HSTX_LDO_REF_SEL,
-                               (mipi_tx->mipitx_drive - 3000) / 200 << 6);
-
-       mtk_mipi_tx_config_calibration_data(mipi_tx);
-
-       mtk_mipi_tx_set_bits(mipi_tx, MIPITX_CK_CKMODE_EN, DSI_CK_CKMODE_EN);
-}
-
-static void mtk_mipi_tx_power_off_signal(struct phy *phy)
-{
-       struct mtk_mipi_tx *mipi_tx = phy_get_drvdata(phy);
-
-       /* Switch ON each Lane */
-       mtk_mipi_tx_set_bits(mipi_tx, MIPITX_D0_SW_CTL_EN, DSI_SW_CTL_EN);
-       mtk_mipi_tx_set_bits(mipi_tx, MIPITX_D1_SW_CTL_EN, DSI_SW_CTL_EN);
-       mtk_mipi_tx_set_bits(mipi_tx, MIPITX_D2_SW_CTL_EN, DSI_SW_CTL_EN);
-       mtk_mipi_tx_set_bits(mipi_tx, MIPITX_D3_SW_CTL_EN, DSI_SW_CTL_EN);
-       mtk_mipi_tx_set_bits(mipi_tx, MIPITX_CK_SW_CTL_EN, DSI_SW_CTL_EN);
-
-       writel(RG_DSI_PAD_TIEL_SEL | RG_DSI_BG_CORE_EN,
-              mipi_tx->regs + MIPITX_LANE_CON);
-       writel(RG_DSI_PAD_TIEL_SEL, mipi_tx->regs + MIPITX_LANE_CON);
-}
-
-const struct mtk_mipitx_data mt8183_mipitx_data = {
-       .mipi_tx_clk_ops = &mtk_mipi_tx_pll_ops,
-       .mipi_tx_enable_signal = mtk_mipi_tx_power_on_signal,
-       .mipi_tx_disable_signal = mtk_mipi_tx_power_off_signal,
-};
index 50c5e93..574b8e6 100644 (file)
@@ -42,3 +42,10 @@ config PHY_MTK_HDMI
        select GENERIC_PHY
        help
          Support HDMI PHY for Mediatek SoCs.
+
+config PHY_MTK_MIPI_DSI
+       tristate "MediaTek MIPI-DSI Driver"
+       depends on ARCH_MEDIATEK && OF
+       select GENERIC_PHY
+       help
+         Support MIPI DSI for Mediatek SoCs.
index 6325e38..ace660f 100644 (file)
@@ -11,3 +11,8 @@ phy-mtk-hdmi-drv-y                    := phy-mtk-hdmi.o
 phy-mtk-hdmi-drv-y                     += phy-mtk-hdmi-mt2701.o
 phy-mtk-hdmi-drv-y                     += phy-mtk-hdmi-mt8173.o
 obj-$(CONFIG_PHY_MTK_HDMI)             += phy-mtk-hdmi-drv.o
+
+phy-mtk-mipi-dsi-drv-y                 := phy-mtk-mipi-dsi.o
+phy-mtk-mipi-dsi-drv-y                 += phy-mtk-mipi-dsi-mt8173.o
+phy-mtk-mipi-dsi-drv-y                 += phy-mtk-mipi-dsi-mt8183.o
+obj-$(CONFIG_PHY_MTK_MIPI_DSI)         += phy-mtk-mipi-dsi-drv.o
diff --git a/drivers/phy/mediatek/phy-mtk-mipi-dsi-mt8173.c b/drivers/phy/mediatek/phy-mtk-mipi-dsi-mt8173.c
new file mode 100644 (file)
index 0000000..7a84795
--- /dev/null
@@ -0,0 +1,288 @@
+// SPDX-License-Identifier: GPL-2.0
+/*
+ * Copyright (c) 2019 MediaTek Inc.
+ * Author: jitao.shi <jitao.shi@mediatek.com>
+ */
+
+#include "phy-mtk-mipi-dsi.h"
+
+#define MIPITX_DSI_CON         0x00
+#define RG_DSI_LDOCORE_EN              BIT(0)
+#define RG_DSI_CKG_LDOOUT_EN           BIT(1)
+#define RG_DSI_BCLK_SEL                        (3 << 2)
+#define RG_DSI_LD_IDX_SEL              (7 << 4)
+#define RG_DSI_PHYCLK_SEL              (2 << 8)
+#define RG_DSI_DSICLK_FREQ_SEL         BIT(10)
+#define RG_DSI_LPTX_CLMP_EN            BIT(11)
+
+#define MIPITX_DSI_CLOCK_LANE  0x04
+#define MIPITX_DSI_DATA_LANE0  0x08
+#define MIPITX_DSI_DATA_LANE1  0x0c
+#define MIPITX_DSI_DATA_LANE2  0x10
+#define MIPITX_DSI_DATA_LANE3  0x14
+#define RG_DSI_LNTx_LDOOUT_EN          BIT(0)
+#define RG_DSI_LNTx_CKLANE_EN          BIT(1)
+#define RG_DSI_LNTx_LPTX_IPLUS1                BIT(2)
+#define RG_DSI_LNTx_LPTX_IPLUS2                BIT(3)
+#define RG_DSI_LNTx_LPTX_IMINUS                BIT(4)
+#define RG_DSI_LNTx_LPCD_IPLUS         BIT(5)
+#define RG_DSI_LNTx_LPCD_IMINUS                BIT(6)
+#define RG_DSI_LNTx_RT_CODE            (0xf << 8)
+
+#define MIPITX_DSI_TOP_CON     0x40
+#define RG_DSI_LNT_INTR_EN             BIT(0)
+#define RG_DSI_LNT_HS_BIAS_EN          BIT(1)
+#define RG_DSI_LNT_IMP_CAL_EN          BIT(2)
+#define RG_DSI_LNT_TESTMODE_EN         BIT(3)
+#define RG_DSI_LNT_IMP_CAL_CODE                (0xf << 4)
+#define RG_DSI_LNT_AIO_SEL             (7 << 8)
+#define RG_DSI_PAD_TIE_LOW_EN          BIT(11)
+#define RG_DSI_DEBUG_INPUT_EN          BIT(12)
+#define RG_DSI_PRESERVE                        (7 << 13)
+
+#define MIPITX_DSI_BG_CON      0x44
+#define RG_DSI_BG_CORE_EN              BIT(0)
+#define RG_DSI_BG_CKEN                 BIT(1)
+#define RG_DSI_BG_DIV                  (0x3 << 2)
+#define RG_DSI_BG_FAST_CHARGE          BIT(4)
+#define RG_DSI_VOUT_MSK                        (0x3ffff << 5)
+#define RG_DSI_V12_SEL                 (7 << 5)
+#define RG_DSI_V10_SEL                 (7 << 8)
+#define RG_DSI_V072_SEL                        (7 << 11)
+#define RG_DSI_V04_SEL                 (7 << 14)
+#define RG_DSI_V032_SEL                        (7 << 17)
+#define RG_DSI_V02_SEL                 (7 << 20)
+#define RG_DSI_BG_R1_TRIM              (0xf << 24)
+#define RG_DSI_BG_R2_TRIM              (0xf << 28)
+
+#define MIPITX_DSI_PLL_CON0    0x50
+#define RG_DSI_MPPLL_PLL_EN            BIT(0)
+#define RG_DSI_MPPLL_DIV_MSK           (0x1ff << 1)
+#define RG_DSI_MPPLL_PREDIV            (3 << 1)
+#define RG_DSI_MPPLL_TXDIV0            (3 << 3)
+#define RG_DSI_MPPLL_TXDIV1            (3 << 5)
+#define RG_DSI_MPPLL_POSDIV            (7 << 7)
+#define RG_DSI_MPPLL_MONVC_EN          BIT(10)
+#define RG_DSI_MPPLL_MONREF_EN         BIT(11)
+#define RG_DSI_MPPLL_VOD_EN            BIT(12)
+
+#define MIPITX_DSI_PLL_CON1    0x54
+#define RG_DSI_MPPLL_SDM_FRA_EN                BIT(0)
+#define RG_DSI_MPPLL_SDM_SSC_PH_INIT   BIT(1)
+#define RG_DSI_MPPLL_SDM_SSC_EN                BIT(2)
+#define RG_DSI_MPPLL_SDM_SSC_PRD       (0xffff << 16)
+
+#define MIPITX_DSI_PLL_CON2    0x58
+
+#define MIPITX_DSI_PLL_TOP     0x64
+#define RG_DSI_MPPLL_PRESERVE          (0xff << 8)
+
+#define MIPITX_DSI_PLL_PWR     0x68
+#define RG_DSI_MPPLL_SDM_PWR_ON                BIT(0)
+#define RG_DSI_MPPLL_SDM_ISO_EN                BIT(1)
+#define RG_DSI_MPPLL_SDM_PWR_ACK       BIT(8)
+
+#define MIPITX_DSI_SW_CTRL     0x80
+#define SW_CTRL_EN                     BIT(0)
+
+#define MIPITX_DSI_SW_CTRL_CON0        0x84
+#define SW_LNTC_LPTX_PRE_OE            BIT(0)
+#define SW_LNTC_LPTX_OE                        BIT(1)
+#define SW_LNTC_LPTX_P                 BIT(2)
+#define SW_LNTC_LPTX_N                 BIT(3)
+#define SW_LNTC_HSTX_PRE_OE            BIT(4)
+#define SW_LNTC_HSTX_OE                        BIT(5)
+#define SW_LNTC_HSTX_ZEROCLK           BIT(6)
+#define SW_LNT0_LPTX_PRE_OE            BIT(7)
+#define SW_LNT0_LPTX_OE                        BIT(8)
+#define SW_LNT0_LPTX_P                 BIT(9)
+#define SW_LNT0_LPTX_N                 BIT(10)
+#define SW_LNT0_HSTX_PRE_OE            BIT(11)
+#define SW_LNT0_HSTX_OE                        BIT(12)
+#define SW_LNT0_LPRX_EN                        BIT(13)
+#define SW_LNT1_LPTX_PRE_OE            BIT(14)
+#define SW_LNT1_LPTX_OE                        BIT(15)
+#define SW_LNT1_LPTX_P                 BIT(16)
+#define SW_LNT1_LPTX_N                 BIT(17)
+#define SW_LNT1_HSTX_PRE_OE            BIT(18)
+#define SW_LNT1_HSTX_OE                        BIT(19)
+#define SW_LNT2_LPTX_PRE_OE            BIT(20)
+#define SW_LNT2_LPTX_OE                        BIT(21)
+#define SW_LNT2_LPTX_P                 BIT(22)
+#define SW_LNT2_LPTX_N                 BIT(23)
+#define SW_LNT2_HSTX_PRE_OE            BIT(24)
+#define SW_LNT2_HSTX_OE                        BIT(25)
+
+static int mtk_mipi_tx_pll_prepare(struct clk_hw *hw)
+{
+       struct mtk_mipi_tx *mipi_tx = mtk_mipi_tx_from_clk_hw(hw);
+       u8 txdiv, txdiv0, txdiv1;
+       u64 pcw;
+
+       dev_dbg(mipi_tx->dev, "prepare: %u Hz\n", mipi_tx->data_rate);
+
+       if (mipi_tx->data_rate >= 500000000) {
+               txdiv = 1;
+               txdiv0 = 0;
+               txdiv1 = 0;
+       } else if (mipi_tx->data_rate >= 250000000) {
+               txdiv = 2;
+               txdiv0 = 1;
+               txdiv1 = 0;
+       } else if (mipi_tx->data_rate >= 125000000) {
+               txdiv = 4;
+               txdiv0 = 2;
+               txdiv1 = 0;
+       } else if (mipi_tx->data_rate > 62000000) {
+               txdiv = 8;
+               txdiv0 = 2;
+               txdiv1 = 1;
+       } else if (mipi_tx->data_rate >= 50000000) {
+               txdiv = 16;
+               txdiv0 = 2;
+               txdiv1 = 2;
+       } else {
+               return -EINVAL;
+       }
+
+       mtk_mipi_tx_update_bits(mipi_tx, MIPITX_DSI_BG_CON,
+                               RG_DSI_VOUT_MSK |
+                               RG_DSI_BG_CKEN | RG_DSI_BG_CORE_EN,
+                               (4 << 20) | (4 << 17) | (4 << 14) |
+                               (4 << 11) | (4 << 8) | (4 << 5) |
+                               RG_DSI_BG_CKEN | RG_DSI_BG_CORE_EN);
+
+       usleep_range(30, 100);
+
+       mtk_mipi_tx_update_bits(mipi_tx, MIPITX_DSI_TOP_CON,
+                               RG_DSI_LNT_IMP_CAL_CODE | RG_DSI_LNT_HS_BIAS_EN,
+                               (8 << 4) | RG_DSI_LNT_HS_BIAS_EN);
+
+       mtk_mipi_tx_set_bits(mipi_tx, MIPITX_DSI_CON,
+                            RG_DSI_CKG_LDOOUT_EN | RG_DSI_LDOCORE_EN);
+
+       mtk_mipi_tx_update_bits(mipi_tx, MIPITX_DSI_PLL_PWR,
+                               RG_DSI_MPPLL_SDM_PWR_ON |
+                               RG_DSI_MPPLL_SDM_ISO_EN,
+                               RG_DSI_MPPLL_SDM_PWR_ON);
+
+       mtk_mipi_tx_clear_bits(mipi_tx, MIPITX_DSI_PLL_CON0,
+                              RG_DSI_MPPLL_PLL_EN);
+
+       mtk_mipi_tx_update_bits(mipi_tx, MIPITX_DSI_PLL_CON0,
+                               RG_DSI_MPPLL_TXDIV0 | RG_DSI_MPPLL_TXDIV1 |
+                               RG_DSI_MPPLL_PREDIV,
+                               (txdiv0 << 3) | (txdiv1 << 5));
+
+       /*
+        * PLL PCW config
+        * PCW bit 24~30 = integer part of pcw
+        * PCW bit 0~23 = fractional part of pcw
+        * pcw = data_Rate*4*txdiv/(Ref_clk*2);
+        * Post DIV =4, so need data_Rate*4
+        * Ref_clk is 26MHz
+        */
+       pcw = div_u64(((u64)mipi_tx->data_rate * 2 * txdiv) << 24,
+                     26000000);
+       writel(pcw, mipi_tx->regs + MIPITX_DSI_PLL_CON2);
+
+       mtk_mipi_tx_set_bits(mipi_tx, MIPITX_DSI_PLL_CON1,
+                            RG_DSI_MPPLL_SDM_FRA_EN);
+
+       mtk_mipi_tx_set_bits(mipi_tx, MIPITX_DSI_PLL_CON0, RG_DSI_MPPLL_PLL_EN);
+
+       usleep_range(20, 100);
+
+       mtk_mipi_tx_clear_bits(mipi_tx, MIPITX_DSI_PLL_CON1,
+                              RG_DSI_MPPLL_SDM_SSC_EN);
+
+       mtk_mipi_tx_update_bits(mipi_tx, MIPITX_DSI_PLL_TOP,
+                               RG_DSI_MPPLL_PRESERVE,
+                               mipi_tx->driver_data->mppll_preserve);
+
+       return 0;
+}
+
+static void mtk_mipi_tx_pll_unprepare(struct clk_hw *hw)
+{
+       struct mtk_mipi_tx *mipi_tx = mtk_mipi_tx_from_clk_hw(hw);
+
+       dev_dbg(mipi_tx->dev, "unprepare\n");
+
+       mtk_mipi_tx_clear_bits(mipi_tx, MIPITX_DSI_PLL_CON0,
+                              RG_DSI_MPPLL_PLL_EN);
+
+       mtk_mipi_tx_update_bits(mipi_tx, MIPITX_DSI_PLL_TOP,
+                               RG_DSI_MPPLL_PRESERVE, 0);
+
+       mtk_mipi_tx_update_bits(mipi_tx, MIPITX_DSI_PLL_PWR,
+                               RG_DSI_MPPLL_SDM_ISO_EN |
+                               RG_DSI_MPPLL_SDM_PWR_ON,
+                               RG_DSI_MPPLL_SDM_ISO_EN);
+
+       mtk_mipi_tx_clear_bits(mipi_tx, MIPITX_DSI_TOP_CON,
+                              RG_DSI_LNT_HS_BIAS_EN);
+
+       mtk_mipi_tx_clear_bits(mipi_tx, MIPITX_DSI_CON,
+                              RG_DSI_CKG_LDOOUT_EN | RG_DSI_LDOCORE_EN);
+
+       mtk_mipi_tx_clear_bits(mipi_tx, MIPITX_DSI_BG_CON,
+                              RG_DSI_BG_CKEN | RG_DSI_BG_CORE_EN);
+
+       mtk_mipi_tx_clear_bits(mipi_tx, MIPITX_DSI_PLL_CON0,
+                              RG_DSI_MPPLL_DIV_MSK);
+}
+
+static long mtk_mipi_tx_pll_round_rate(struct clk_hw *hw, unsigned long rate,
+                                      unsigned long *prate)
+{
+       return clamp_val(rate, 50000000, 1250000000);
+}
+
+static const struct clk_ops mtk_mipi_tx_pll_ops = {
+       .prepare = mtk_mipi_tx_pll_prepare,
+       .unprepare = mtk_mipi_tx_pll_unprepare,
+       .round_rate = mtk_mipi_tx_pll_round_rate,
+       .set_rate = mtk_mipi_tx_pll_set_rate,
+       .recalc_rate = mtk_mipi_tx_pll_recalc_rate,
+};
+
+static void mtk_mipi_tx_power_on_signal(struct phy *phy)
+{
+       struct mtk_mipi_tx *mipi_tx = phy_get_drvdata(phy);
+       u32 reg;
+
+       for (reg = MIPITX_DSI_CLOCK_LANE;
+            reg <= MIPITX_DSI_DATA_LANE3; reg += 4)
+               mtk_mipi_tx_set_bits(mipi_tx, reg, RG_DSI_LNTx_LDOOUT_EN);
+
+       mtk_mipi_tx_clear_bits(mipi_tx, MIPITX_DSI_TOP_CON,
+                              RG_DSI_PAD_TIE_LOW_EN);
+}
+
+static void mtk_mipi_tx_power_off_signal(struct phy *phy)
+{
+       struct mtk_mipi_tx *mipi_tx = phy_get_drvdata(phy);
+       u32 reg;
+
+       mtk_mipi_tx_set_bits(mipi_tx, MIPITX_DSI_TOP_CON,
+                            RG_DSI_PAD_TIE_LOW_EN);
+
+       for (reg = MIPITX_DSI_CLOCK_LANE;
+            reg <= MIPITX_DSI_DATA_LANE3; reg += 4)
+               mtk_mipi_tx_clear_bits(mipi_tx, reg, RG_DSI_LNTx_LDOOUT_EN);
+}
+
+const struct mtk_mipitx_data mt2701_mipitx_data = {
+       .mppll_preserve = (3 << 8),
+       .mipi_tx_clk_ops = &mtk_mipi_tx_pll_ops,
+       .mipi_tx_enable_signal = mtk_mipi_tx_power_on_signal,
+       .mipi_tx_disable_signal = mtk_mipi_tx_power_off_signal,
+};
+
+const struct mtk_mipitx_data mt8173_mipitx_data = {
+       .mppll_preserve = (0 << 8),
+       .mipi_tx_clk_ops = &mtk_mipi_tx_pll_ops,
+       .mipi_tx_enable_signal = mtk_mipi_tx_power_on_signal,
+       .mipi_tx_disable_signal = mtk_mipi_tx_power_off_signal,
+};
diff --git a/drivers/phy/mediatek/phy-mtk-mipi-dsi-mt8183.c b/drivers/phy/mediatek/phy-mtk-mipi-dsi-mt8183.c
new file mode 100644 (file)
index 0000000..9910842
--- /dev/null
@@ -0,0 +1,177 @@
+// SPDX-License-Identifier: GPL-2.0
+/*
+ * Copyright (c) 2019 MediaTek Inc.
+ * Author: jitao.shi <jitao.shi@mediatek.com>
+ */
+
+#include "phy-mtk-mipi-dsi.h"
+
+#define MIPITX_LANE_CON                0x000c
+#define RG_DSI_CPHY_T1DRV_EN           BIT(0)
+#define RG_DSI_ANA_CK_SEL              BIT(1)
+#define RG_DSI_PHY_CK_SEL              BIT(2)
+#define RG_DSI_CPHY_EN                 BIT(3)
+#define RG_DSI_PHYCK_INV_EN            BIT(4)
+#define RG_DSI_PWR04_EN                        BIT(5)
+#define RG_DSI_BG_LPF_EN               BIT(6)
+#define RG_DSI_BG_CORE_EN              BIT(7)
+#define RG_DSI_PAD_TIEL_SEL            BIT(8)
+
+#define MIPITX_VOLTAGE_SEL     0x0010
+#define RG_DSI_HSTX_LDO_REF_SEL                (0xf << 6)
+
+#define MIPITX_PLL_PWR         0x0028
+#define MIPITX_PLL_CON0                0x002c
+#define MIPITX_PLL_CON1                0x0030
+#define MIPITX_PLL_CON2                0x0034
+#define MIPITX_PLL_CON3                0x0038
+#define MIPITX_PLL_CON4                0x003c
+#define RG_DSI_PLL_IBIAS               (3 << 10)
+
+#define MIPITX_D2P_RTCODE      0x0100
+#define MIPITX_D2_SW_CTL_EN    0x0144
+#define MIPITX_D0_SW_CTL_EN    0x0244
+#define MIPITX_CK_CKMODE_EN    0x0328
+#define DSI_CK_CKMODE_EN               BIT(0)
+#define MIPITX_CK_SW_CTL_EN    0x0344
+#define MIPITX_D1_SW_CTL_EN    0x0444
+#define MIPITX_D3_SW_CTL_EN    0x0544
+#define DSI_SW_CTL_EN                  BIT(0)
+#define AD_DSI_PLL_SDM_PWR_ON          BIT(0)
+#define AD_DSI_PLL_SDM_ISO_EN          BIT(1)
+
+#define RG_DSI_PLL_EN                  BIT(4)
+#define RG_DSI_PLL_POSDIV              (0x7 << 8)
+
+static int mtk_mipi_tx_pll_enable(struct clk_hw *hw)
+{
+       struct mtk_mipi_tx *mipi_tx = mtk_mipi_tx_from_clk_hw(hw);
+       unsigned int txdiv, txdiv0;
+       u64 pcw;
+
+       dev_dbg(mipi_tx->dev, "enable: %u bps\n", mipi_tx->data_rate);
+
+       if (mipi_tx->data_rate >= 2000000000) {
+               txdiv = 1;
+               txdiv0 = 0;
+       } else if (mipi_tx->data_rate >= 1000000000) {
+               txdiv = 2;
+               txdiv0 = 1;
+       } else if (mipi_tx->data_rate >= 500000000) {
+               txdiv = 4;
+               txdiv0 = 2;
+       } else if (mipi_tx->data_rate > 250000000) {
+               txdiv = 8;
+               txdiv0 = 3;
+       } else if (mipi_tx->data_rate >= 125000000) {
+               txdiv = 16;
+               txdiv0 = 4;
+       } else {
+               return -EINVAL;
+       }
+
+       mtk_mipi_tx_clear_bits(mipi_tx, MIPITX_PLL_CON4, RG_DSI_PLL_IBIAS);
+
+       mtk_mipi_tx_set_bits(mipi_tx, MIPITX_PLL_PWR, AD_DSI_PLL_SDM_PWR_ON);
+       mtk_mipi_tx_clear_bits(mipi_tx, MIPITX_PLL_CON1, RG_DSI_PLL_EN);
+       udelay(1);
+       mtk_mipi_tx_clear_bits(mipi_tx, MIPITX_PLL_PWR, AD_DSI_PLL_SDM_ISO_EN);
+       pcw = div_u64(((u64)mipi_tx->data_rate * txdiv) << 24, 26000000);
+       writel(pcw, mipi_tx->regs + MIPITX_PLL_CON0);
+       mtk_mipi_tx_update_bits(mipi_tx, MIPITX_PLL_CON1, RG_DSI_PLL_POSDIV,
+                               txdiv0 << 8);
+       mtk_mipi_tx_set_bits(mipi_tx, MIPITX_PLL_CON1, RG_DSI_PLL_EN);
+
+       return 0;
+}
+
+static void mtk_mipi_tx_pll_disable(struct clk_hw *hw)
+{
+       struct mtk_mipi_tx *mipi_tx = mtk_mipi_tx_from_clk_hw(hw);
+
+       mtk_mipi_tx_clear_bits(mipi_tx, MIPITX_PLL_CON1, RG_DSI_PLL_EN);
+
+       mtk_mipi_tx_set_bits(mipi_tx, MIPITX_PLL_PWR, AD_DSI_PLL_SDM_ISO_EN);
+       mtk_mipi_tx_clear_bits(mipi_tx, MIPITX_PLL_PWR, AD_DSI_PLL_SDM_PWR_ON);
+}
+
+static long mtk_mipi_tx_pll_round_rate(struct clk_hw *hw, unsigned long rate,
+                                      unsigned long *prate)
+{
+       return clamp_val(rate, 50000000, 1600000000);
+}
+
+static const struct clk_ops mtk_mipi_tx_pll_ops = {
+       .enable = mtk_mipi_tx_pll_enable,
+       .disable = mtk_mipi_tx_pll_disable,
+       .round_rate = mtk_mipi_tx_pll_round_rate,
+       .set_rate = mtk_mipi_tx_pll_set_rate,
+       .recalc_rate = mtk_mipi_tx_pll_recalc_rate,
+};
+
+static void mtk_mipi_tx_config_calibration_data(struct mtk_mipi_tx *mipi_tx)
+{
+       int i, j;
+
+       for (i = 0; i < 5; i++) {
+               if ((mipi_tx->rt_code[i] & 0x1f) == 0)
+                       mipi_tx->rt_code[i] |= 0x10;
+
+               if ((mipi_tx->rt_code[i] >> 5 & 0x1f) == 0)
+                       mipi_tx->rt_code[i] |= 0x10 << 5;
+
+               for (j = 0; j < 10; j++)
+                       mtk_mipi_tx_update_bits(mipi_tx,
+                               MIPITX_D2P_RTCODE * (i + 1) + j * 4,
+                               1, mipi_tx->rt_code[i] >> j & 1);
+       }
+}
+
+static void mtk_mipi_tx_power_on_signal(struct phy *phy)
+{
+       struct mtk_mipi_tx *mipi_tx = phy_get_drvdata(phy);
+
+       /* BG_LPF_EN / BG_CORE_EN */
+       writel(RG_DSI_PAD_TIEL_SEL | RG_DSI_BG_CORE_EN,
+              mipi_tx->regs + MIPITX_LANE_CON);
+       usleep_range(30, 100);
+       writel(RG_DSI_BG_CORE_EN | RG_DSI_BG_LPF_EN,
+              mipi_tx->regs + MIPITX_LANE_CON);
+
+       /* Switch OFF each Lane */
+       mtk_mipi_tx_clear_bits(mipi_tx, MIPITX_D0_SW_CTL_EN, DSI_SW_CTL_EN);
+       mtk_mipi_tx_clear_bits(mipi_tx, MIPITX_D1_SW_CTL_EN, DSI_SW_CTL_EN);
+       mtk_mipi_tx_clear_bits(mipi_tx, MIPITX_D2_SW_CTL_EN, DSI_SW_CTL_EN);
+       mtk_mipi_tx_clear_bits(mipi_tx, MIPITX_D3_SW_CTL_EN, DSI_SW_CTL_EN);
+       mtk_mipi_tx_clear_bits(mipi_tx, MIPITX_CK_SW_CTL_EN, DSI_SW_CTL_EN);
+
+       mtk_mipi_tx_update_bits(mipi_tx, MIPITX_VOLTAGE_SEL,
+                               RG_DSI_HSTX_LDO_REF_SEL,
+                               (mipi_tx->mipitx_drive - 3000) / 200 << 6);
+
+       mtk_mipi_tx_config_calibration_data(mipi_tx);
+
+       mtk_mipi_tx_set_bits(mipi_tx, MIPITX_CK_CKMODE_EN, DSI_CK_CKMODE_EN);
+}
+
+static void mtk_mipi_tx_power_off_signal(struct phy *phy)
+{
+       struct mtk_mipi_tx *mipi_tx = phy_get_drvdata(phy);
+
+       /* Switch ON each Lane */
+       mtk_mipi_tx_set_bits(mipi_tx, MIPITX_D0_SW_CTL_EN, DSI_SW_CTL_EN);
+       mtk_mipi_tx_set_bits(mipi_tx, MIPITX_D1_SW_CTL_EN, DSI_SW_CTL_EN);
+       mtk_mipi_tx_set_bits(mipi_tx, MIPITX_D2_SW_CTL_EN, DSI_SW_CTL_EN);
+       mtk_mipi_tx_set_bits(mipi_tx, MIPITX_D3_SW_CTL_EN, DSI_SW_CTL_EN);
+       mtk_mipi_tx_set_bits(mipi_tx, MIPITX_CK_SW_CTL_EN, DSI_SW_CTL_EN);
+
+       writel(RG_DSI_PAD_TIEL_SEL | RG_DSI_BG_CORE_EN,
+              mipi_tx->regs + MIPITX_LANE_CON);
+       writel(RG_DSI_PAD_TIEL_SEL, mipi_tx->regs + MIPITX_LANE_CON);
+}
+
+const struct mtk_mipitx_data mt8183_mipitx_data = {
+       .mipi_tx_clk_ops = &mtk_mipi_tx_pll_ops,
+       .mipi_tx_enable_signal = mtk_mipi_tx_power_on_signal,
+       .mipi_tx_disable_signal = mtk_mipi_tx_power_off_signal,
+};
diff --git a/drivers/phy/mediatek/phy-mtk-mipi-dsi.c b/drivers/phy/mediatek/phy-mtk-mipi-dsi.c
new file mode 100644 (file)
index 0000000..18c4812
--- /dev/null
@@ -0,0 +1,248 @@
+// SPDX-License-Identifier: GPL-2.0-only
+/*
+ * Copyright (c) 2015 MediaTek Inc.
+ */
+
+#include "phy-mtk-mipi-dsi.h"
+
+inline struct mtk_mipi_tx *mtk_mipi_tx_from_clk_hw(struct clk_hw *hw)
+{
+       return container_of(hw, struct mtk_mipi_tx, pll_hw);
+}
+
+void mtk_mipi_tx_clear_bits(struct mtk_mipi_tx *mipi_tx, u32 offset,
+                           u32 bits)
+{
+       u32 temp = readl(mipi_tx->regs + offset);
+
+       writel(temp & ~bits, mipi_tx->regs + offset);
+}
+
+void mtk_mipi_tx_set_bits(struct mtk_mipi_tx *mipi_tx, u32 offset,
+                         u32 bits)
+{
+       u32 temp = readl(mipi_tx->regs + offset);
+
+       writel(temp | bits, mipi_tx->regs + offset);
+}
+
+void mtk_mipi_tx_update_bits(struct mtk_mipi_tx *mipi_tx, u32 offset,
+                            u32 mask, u32 data)
+{
+       u32 temp = readl(mipi_tx->regs + offset);
+
+       writel((temp & ~mask) | (data & mask), mipi_tx->regs + offset);
+}
+
+int mtk_mipi_tx_pll_set_rate(struct clk_hw *hw, unsigned long rate,
+                            unsigned long parent_rate)
+{
+       struct mtk_mipi_tx *mipi_tx = mtk_mipi_tx_from_clk_hw(hw);
+
+       dev_dbg(mipi_tx->dev, "set rate: %lu Hz\n", rate);
+
+       mipi_tx->data_rate = rate;
+
+       return 0;
+}
+
+unsigned long mtk_mipi_tx_pll_recalc_rate(struct clk_hw *hw,
+                                         unsigned long parent_rate)
+{
+       struct mtk_mipi_tx *mipi_tx = mtk_mipi_tx_from_clk_hw(hw);
+
+       return mipi_tx->data_rate;
+}
+
+static int mtk_mipi_tx_power_on(struct phy *phy)
+{
+       struct mtk_mipi_tx *mipi_tx = phy_get_drvdata(phy);
+       int ret;
+
+       /* Power up core and enable PLL */
+       ret = clk_prepare_enable(mipi_tx->pll);
+       if (ret < 0)
+               return ret;
+
+       /* Enable DSI Lane LDO outputs, disable pad tie low */
+       mipi_tx->driver_data->mipi_tx_enable_signal(phy);
+       return 0;
+}
+
+static int mtk_mipi_tx_power_off(struct phy *phy)
+{
+       struct mtk_mipi_tx *mipi_tx = phy_get_drvdata(phy);
+
+       /* Enable pad tie low, disable DSI Lane LDO outputs */
+       mipi_tx->driver_data->mipi_tx_disable_signal(phy);
+
+       /* Disable PLL and power down core */
+       clk_disable_unprepare(mipi_tx->pll);
+
+       return 0;
+}
+
+static const struct phy_ops mtk_mipi_tx_ops = {
+       .power_on = mtk_mipi_tx_power_on,
+       .power_off = mtk_mipi_tx_power_off,
+       .owner = THIS_MODULE,
+};
+
+static void mtk_mipi_tx_get_calibration_datal(struct mtk_mipi_tx *mipi_tx)
+{
+       struct nvmem_cell *cell;
+       size_t len;
+       u32 *buf;
+
+       cell = nvmem_cell_get(mipi_tx->dev, "calibration-data");
+       if (IS_ERR(cell)) {
+               dev_info(mipi_tx->dev, "can't get nvmem_cell_get, ignore it\n");
+               return;
+       }
+       buf = (u32 *)nvmem_cell_read(cell, &len);
+       nvmem_cell_put(cell);
+
+       if (IS_ERR(buf)) {
+               dev_info(mipi_tx->dev, "can't get data, ignore it\n");
+               return;
+       }
+
+       if (len < 3 * sizeof(u32)) {
+               dev_info(mipi_tx->dev, "invalid calibration data\n");
+               kfree(buf);
+               return;
+       }
+
+       mipi_tx->rt_code[0] = ((buf[0] >> 6 & 0x1f) << 5) |
+                              (buf[0] >> 11 & 0x1f);
+       mipi_tx->rt_code[1] = ((buf[1] >> 27 & 0x1f) << 5) |
+                              (buf[0] >> 1 & 0x1f);
+       mipi_tx->rt_code[2] = ((buf[1] >> 17 & 0x1f) << 5) |
+                              (buf[1] >> 22 & 0x1f);
+       mipi_tx->rt_code[3] = ((buf[1] >> 7 & 0x1f) << 5) |
+                              (buf[1] >> 12 & 0x1f);
+       mipi_tx->rt_code[4] = ((buf[2] >> 27 & 0x1f) << 5) |
+                              (buf[1] >> 2 & 0x1f);
+       kfree(buf);
+}
+
+static int mtk_mipi_tx_probe(struct platform_device *pdev)
+{
+       struct device *dev = &pdev->dev;
+       struct mtk_mipi_tx *mipi_tx;
+       struct resource *mem;
+       const char *ref_clk_name;
+       struct clk *ref_clk;
+       struct clk_init_data clk_init = {
+               .num_parents = 1,
+               .parent_names = (const char * const *)&ref_clk_name,
+               .flags = CLK_SET_RATE_GATE,
+       };
+       struct phy *phy;
+       struct phy_provider *phy_provider;
+       int ret;
+
+       mipi_tx = devm_kzalloc(dev, sizeof(*mipi_tx), GFP_KERNEL);
+       if (!mipi_tx)
+               return -ENOMEM;
+
+       mipi_tx->driver_data = of_device_get_match_data(dev);
+
+       mem = platform_get_resource(pdev, IORESOURCE_MEM, 0);
+       mipi_tx->regs = devm_ioremap_resource(dev, mem);
+       if (IS_ERR(mipi_tx->regs)) {
+               ret = PTR_ERR(mipi_tx->regs);
+               dev_err(dev, "Failed to get memory resource: %d\n", ret);
+               return ret;
+       }
+
+       ref_clk = devm_clk_get(dev, NULL);
+       if (IS_ERR(ref_clk)) {
+               ret = PTR_ERR(ref_clk);
+               dev_err(dev, "Failed to get reference clock: %d\n", ret);
+               return ret;
+       }
+
+       ret = of_property_read_u32(dev->of_node, "drive-strength-microamp",
+                                  &mipi_tx->mipitx_drive);
+       /* If can't get the "mipi_tx->mipitx_drive", set it default 0x8 */
+       if (ret < 0)
+               mipi_tx->mipitx_drive = 4600;
+
+       /* check the mipitx_drive valid */
+       if (mipi_tx->mipitx_drive > 6000 || mipi_tx->mipitx_drive < 3000) {
+               dev_warn(dev, "drive-strength-microamp is invalid %d, not in 3000 ~ 6000\n",
+                        mipi_tx->mipitx_drive);
+               mipi_tx->mipitx_drive = clamp_val(mipi_tx->mipitx_drive, 3000,
+                                                 6000);
+       }
+
+       ref_clk_name = __clk_get_name(ref_clk);
+
+       ret = of_property_read_string(dev->of_node, "clock-output-names",
+                                     &clk_init.name);
+       if (ret < 0) {
+               dev_err(dev, "Failed to read clock-output-names: %d\n", ret);
+               return ret;
+       }
+
+       clk_init.ops = mipi_tx->driver_data->mipi_tx_clk_ops;
+
+       mipi_tx->pll_hw.init = &clk_init;
+       mipi_tx->pll = devm_clk_register(dev, &mipi_tx->pll_hw);
+       if (IS_ERR(mipi_tx->pll)) {
+               ret = PTR_ERR(mipi_tx->pll);
+               dev_err(dev, "Failed to register PLL: %d\n", ret);
+               return ret;
+       }
+
+       phy = devm_phy_create(dev, NULL, &mtk_mipi_tx_ops);
+       if (IS_ERR(phy)) {
+               ret = PTR_ERR(phy);
+               dev_err(dev, "Failed to create MIPI D-PHY: %d\n", ret);
+               return ret;
+       }
+       phy_set_drvdata(phy, mipi_tx);
+
+       phy_provider = devm_of_phy_provider_register(dev, of_phy_simple_xlate);
+       if (IS_ERR(phy_provider)) {
+               ret = PTR_ERR(phy_provider);
+               return ret;
+       }
+
+       mipi_tx->dev = dev;
+
+       mtk_mipi_tx_get_calibration_datal(mipi_tx);
+
+       return of_clk_add_provider(dev->of_node, of_clk_src_simple_get,
+                                  mipi_tx->pll);
+}
+
+static int mtk_mipi_tx_remove(struct platform_device *pdev)
+{
+       of_clk_del_provider(pdev->dev.of_node);
+       return 0;
+}
+
+static const struct of_device_id mtk_mipi_tx_match[] = {
+       { .compatible = "mediatek,mt2701-mipi-tx",
+         .data = &mt2701_mipitx_data },
+       { .compatible = "mediatek,mt8173-mipi-tx",
+         .data = &mt8173_mipitx_data },
+       { .compatible = "mediatek,mt8183-mipi-tx",
+         .data = &mt8183_mipitx_data },
+       { },
+};
+
+struct platform_driver mtk_mipi_tx_driver = {
+       .probe = mtk_mipi_tx_probe,
+       .remove = mtk_mipi_tx_remove,
+       .driver = {
+               .name = "mediatek-mipi-tx",
+               .of_match_table = mtk_mipi_tx_match,
+       },
+};
+module_platform_driver(mtk_mipi_tx_driver);
+
+MODULE_DESCRIPTION("MediaTek MIPI TX Driver");
+MODULE_LICENSE("GPL v2");
diff --git a/drivers/phy/mediatek/phy-mtk-mipi-dsi.h b/drivers/phy/mediatek/phy-mtk-mipi-dsi.h
new file mode 100644 (file)
index 0000000..c76f07c
--- /dev/null
@@ -0,0 +1,53 @@
+/* SPDX-License-Identifier: GPL-2.0 */
+/*
+ * Copyright (c) 2019 MediaTek Inc.
+ * Author: Jitao Shi <jitao.shi@mediatek.com>
+ */
+
+#ifndef _MTK_MIPI_TX_H
+#define _MTK_MIPI_TX_H
+
+#include <linux/clk.h>
+#include <linux/clk-provider.h>
+#include <linux/delay.h>
+#include <linux/io.h>
+#include <linux/module.h>
+#include <linux/nvmem-consumer.h>
+#include <linux/of_device.h>
+#include <linux/platform_device.h>
+#include <linux/phy/phy.h>
+#include <linux/slab.h>
+
+struct mtk_mipitx_data {
+       const u32 mppll_preserve;
+       const struct clk_ops *mipi_tx_clk_ops;
+       void (*mipi_tx_enable_signal)(struct phy *phy);
+       void (*mipi_tx_disable_signal)(struct phy *phy);
+};
+
+struct mtk_mipi_tx {
+       struct device *dev;
+       void __iomem *regs;
+       u32 data_rate;
+       u32 mipitx_drive;
+       u32 rt_code[5];
+       const struct mtk_mipitx_data *driver_data;
+       struct clk_hw pll_hw;
+       struct clk *pll;
+};
+
+struct mtk_mipi_tx *mtk_mipi_tx_from_clk_hw(struct clk_hw *hw);
+void mtk_mipi_tx_clear_bits(struct mtk_mipi_tx *mipi_tx, u32 offset, u32 bits);
+void mtk_mipi_tx_set_bits(struct mtk_mipi_tx *mipi_tx, u32 offset, u32 bits);
+void mtk_mipi_tx_update_bits(struct mtk_mipi_tx *mipi_tx, u32 offset, u32 mask,
+                            u32 data);
+int mtk_mipi_tx_pll_set_rate(struct clk_hw *hw, unsigned long rate,
+                            unsigned long parent_rate);
+unsigned long mtk_mipi_tx_pll_recalc_rate(struct clk_hw *hw,
+                                         unsigned long parent_rate);
+
+extern const struct mtk_mipitx_data mt2701_mipitx_data;
+extern const struct mtk_mipitx_data mt8173_mipitx_data;
+extern const struct mtk_mipitx_data mt8183_mipitx_data;
+
+#endif