* [PATCH 0/2] rockchip: Add DSI support for RK3568 @ 2023-03-24 18:53 Chris Morgan 2023-03-24 18:53 ` [PATCH 1/2] drivers: phy: add Innosilicon DSI-DPHY driver Chris Morgan 2023-03-24 18:53 ` [PATCH 2/2] rockchip: video: Add support for RK3568 DSI Host Chris Morgan 0 siblings, 2 replies; 5+ messages in thread From: Chris Morgan @ 2023-03-24 18:53 UTC (permalink / raw) To: u-boot Cc: yifeng.zhao, jagan, agust, kever.yang, philipp.tomsich, sjg, Chris Morgan From: Chris Morgan <macromorgan@hotmail.com> This patch series is to add DSI support for the RK3568 SoC. DSI and DSI-DPHY support is needed in my use case so that I may read the panel ID via DSI commands prior to loading Linux in order to differentiate between different panels and correct the device tree. The drivers are heavily based on upstream Linux drivers, and should allow support for display to a DSI panel if an appropriate video output device and panel driver is also written. Tested drivers on Anbernic RG353 series devices to read panel ID in U-Boot. Chris Morgan (2): drivers: phy: add Innosilicon DSI-DPHY driver rockchip: video: Add support for RK3568 DSI Host drivers/phy/rockchip/Kconfig | 8 + drivers/phy/rockchip/Makefile | 1 + .../phy/rockchip/phy-rockchip-inno-dsidphy.c | 680 +++++++++++++ drivers/video/dw_mipi_dsi.c | 9 + drivers/video/rockchip/Kconfig | 8 + drivers/video/rockchip/Makefile | 1 + drivers/video/rockchip/dw_mipi_dsi_rockchip.c | 898 ++++++++++++++++++ 7 files changed, 1605 insertions(+) create mode 100644 drivers/phy/rockchip/phy-rockchip-inno-dsidphy.c create mode 100644 drivers/video/rockchip/dw_mipi_dsi_rockchip.c -- 2.34.1 ^ permalink raw reply [flat|nested] 5+ messages in thread
* [PATCH 1/2] drivers: phy: add Innosilicon DSI-DPHY driver 2023-03-24 18:53 [PATCH 0/2] rockchip: Add DSI support for RK3568 Chris Morgan @ 2023-03-24 18:53 ` Chris Morgan 2023-04-14 8:52 ` Kever Yang 2023-03-24 18:53 ` [PATCH 2/2] rockchip: video: Add support for RK3568 DSI Host Chris Morgan 1 sibling, 1 reply; 5+ messages in thread From: Chris Morgan @ 2023-03-24 18:53 UTC (permalink / raw) To: u-boot Cc: yifeng.zhao, jagan, agust, kever.yang, philipp.tomsich, sjg, Chris Morgan From: Chris Morgan <macromorgan@hotmail.com> Add support for the Innosilicon DSI-DPHY driver for Rockchip SOCs. The driver was ported from Linux and tested on a Rockchip RK3566 based device to query the panel ID via a DSI command. Signed-off-by: Chris Morgan <macromorgan@hotmail.com> --- drivers/phy/rockchip/Kconfig | 8 + drivers/phy/rockchip/Makefile | 1 + .../phy/rockchip/phy-rockchip-inno-dsidphy.c | 680 ++++++++++++++++++ 3 files changed, 689 insertions(+) create mode 100644 drivers/phy/rockchip/phy-rockchip-inno-dsidphy.c diff --git a/drivers/phy/rockchip/Kconfig b/drivers/phy/rockchip/Kconfig index 1305763940..f87ca8c310 100644 --- a/drivers/phy/rockchip/Kconfig +++ b/drivers/phy/rockchip/Kconfig @@ -4,6 +4,14 @@ menu "Rockchip PHY driver" +config PHY_ROCKCHIP_INNO_DSIDPHY + bool "Rockchip INNO DSIDPHY Driver" + depends on ARCH_ROCKCHIP + select PHY + select MIPI_DPHY_HELPERS + help + Support for Rockchip MIPI DPHY with Innosilicon IP block. + config PHY_ROCKCHIP_INNO_USB2 bool "Rockchip INNO USB2PHY Driver" depends on ARCH_ROCKCHIP diff --git a/drivers/phy/rockchip/Makefile b/drivers/phy/rockchip/Makefile index a236877234..25a803a8a8 100644 --- a/drivers/phy/rockchip/Makefile +++ b/drivers/phy/rockchip/Makefile @@ -8,3 +8,4 @@ obj-$(CONFIG_PHY_ROCKCHIP_NANENG_COMBOPHY) += phy-rockchip-naneng-combphy.o obj-$(CONFIG_PHY_ROCKCHIP_PCIE) += phy-rockchip-pcie.o obj-$(CONFIG_PHY_ROCKCHIP_SNPS_PCIE3) += phy-rockchip-snps-pcie3.o obj-$(CONFIG_PHY_ROCKCHIP_TYPEC) += phy-rockchip-typec.o +obj-$(CONFIG_PHY_ROCKCHIP_INNO_DSIDPHY) += phy-rockchip-inno-dsidphy.o diff --git a/drivers/phy/rockchip/phy-rockchip-inno-dsidphy.c b/drivers/phy/rockchip/phy-rockchip-inno-dsidphy.c new file mode 100644 index 0000000000..9ed7af0d6e --- /dev/null +++ b/drivers/phy/rockchip/phy-rockchip-inno-dsidphy.c @@ -0,0 +1,680 @@ +// SPDX-License-Identifier: GPL-2.0 +/* + * Copyright (c) 2018 Rockchip Electronics Co. Ltd. + * + * Author: Wyon Bi <bivvy.bi@rock-chips.com> + */ + +#include <dm.h> +#include <dm/device_compat.h> +#include <dm/devres.h> +#include <div64.h> +#include <generic-phy.h> +#include <linux/kernel.h> +#include <linux/iopoll.h> +#include <linux/clk-provider.h> +#include <linux/delay.h> +#include <linux/math64.h> +#include <phy-mipi-dphy.h> +#include <reset.h> + +#define UPDATE(x, h, l) (((x) << (l)) & GENMASK((h), (l))) + +/* + * The offset address[7:0] is distributed two parts, one from the bit7 to bit5 + * is the first address, the other from the bit4 to bit0 is the second address. + * when you configure the registers, you must set both of them. The Clock Lane + * and Data Lane use the same registers with the same second address, but the + * first address is different. + */ +#define FIRST_ADDRESS(x) (((x) & 0x7) << 5) +#define SECOND_ADDRESS(x) (((x) & 0x1f) << 0) +#define PHY_REG(first, second) (FIRST_ADDRESS(first) | \ + SECOND_ADDRESS(second)) + +/* Analog Register Part: reg00 */ +#define BANDGAP_POWER_MASK BIT(7) +#define BANDGAP_POWER_DOWN BIT(7) +#define BANDGAP_POWER_ON 0 +#define LANE_EN_MASK GENMASK(6, 2) +#define LANE_EN_CK BIT(6) +#define LANE_EN_3 BIT(5) +#define LANE_EN_2 BIT(4) +#define LANE_EN_1 BIT(3) +#define LANE_EN_0 BIT(2) +#define POWER_WORK_MASK GENMASK(1, 0) +#define POWER_WORK_ENABLE UPDATE(1, 1, 0) +#define POWER_WORK_DISABLE UPDATE(2, 1, 0) +/* Analog Register Part: reg01 */ +#define REG_SYNCRST_MASK BIT(2) +#define REG_SYNCRST_RESET BIT(2) +#define REG_SYNCRST_NORMAL 0 +#define REG_LDOPD_MASK BIT(1) +#define REG_LDOPD_POWER_DOWN BIT(1) +#define REG_LDOPD_POWER_ON 0 +#define REG_PLLPD_MASK BIT(0) +#define REG_PLLPD_POWER_DOWN BIT(0) +#define REG_PLLPD_POWER_ON 0 +/* Analog Register Part: reg03 */ +#define REG_FBDIV_HI_MASK BIT(5) +#define REG_FBDIV_HI(x) UPDATE((x >> 8), 5, 5) +#define REG_PREDIV_MASK GENMASK(4, 0) +#define REG_PREDIV(x) UPDATE(x, 4, 0) +/* Analog Register Part: reg04 */ +#define REG_FBDIV_LO_MASK GENMASK(7, 0) +#define REG_FBDIV_LO(x) UPDATE(x, 7, 0) +/* Analog Register Part: reg05 */ +#define SAMPLE_CLOCK_PHASE_MASK GENMASK(6, 4) +#define SAMPLE_CLOCK_PHASE(x) UPDATE(x, 6, 4) +#define CLOCK_LANE_SKEW_PHASE_MASK GENMASK(2, 0) +#define CLOCK_LANE_SKEW_PHASE(x) UPDATE(x, 2, 0) +/* Analog Register Part: reg06 */ +#define DATA_LANE_3_SKEW_PHASE_MASK GENMASK(6, 4) +#define DATA_LANE_3_SKEW_PHASE(x) UPDATE(x, 6, 4) +#define DATA_LANE_2_SKEW_PHASE_MASK GENMASK(2, 0) +#define DATA_LANE_2_SKEW_PHASE(x) UPDATE(x, 2, 0) +/* Analog Register Part: reg07 */ +#define DATA_LANE_1_SKEW_PHASE_MASK GENMASK(6, 4) +#define DATA_LANE_1_SKEW_PHASE(x) UPDATE(x, 6, 4) +#define DATA_LANE_0_SKEW_PHASE_MASK GENMASK(2, 0) +#define DATA_LANE_0_SKEW_PHASE(x) UPDATE(x, 2, 0) +/* Analog Register Part: reg08 */ +#define PLL_POST_DIV_ENABLE_MASK BIT(5) +#define PLL_POST_DIV_ENABLE BIT(5) +#define SAMPLE_CLOCK_DIRECTION_MASK BIT(4) +#define SAMPLE_CLOCK_DIRECTION_REVERSE BIT(4) +#define SAMPLE_CLOCK_DIRECTION_FORWARD 0 +#define LOWFRE_EN_MASK BIT(5) +#define PLL_OUTPUT_FREQUENCY_DIV_BY_1 0 +#define PLL_OUTPUT_FREQUENCY_DIV_BY_2 1 +/* Analog Register Part: reg0b */ +#define CLOCK_LANE_VOD_RANGE_SET_MASK GENMASK(3, 0) +#define CLOCK_LANE_VOD_RANGE_SET(x) UPDATE(x, 3, 0) +#define VOD_MIN_RANGE 0x1 +#define VOD_MID_RANGE 0x3 +#define VOD_BIG_RANGE 0x7 +#define VOD_MAX_RANGE 0xf +/* Analog Register Part: reg1E */ +#define PLL_MODE_SEL_MASK GENMASK(6, 5) +#define PLL_MODE_SEL_LVDS_MODE 0 +#define PLL_MODE_SEL_MIPI_MODE BIT(5) +/* Digital Register Part: reg00 */ +#define REG_DIG_RSTN_MASK BIT(0) +#define REG_DIG_RSTN_NORMAL BIT(0) +#define REG_DIG_RSTN_RESET 0 +/* Digital Register Part: reg01 */ +#define INVERT_TXCLKESC_MASK BIT(1) +#define INVERT_TXCLKESC_ENABLE BIT(1) +#define INVERT_TXCLKESC_DISABLE 0 +#define INVERT_TXBYTECLKHS_MASK BIT(0) +#define INVERT_TXBYTECLKHS_ENABLE BIT(0) +#define INVERT_TXBYTECLKHS_DISABLE 0 +/* Clock/Data0/Data1/Data2/Data3 Lane Register Part: reg05 */ +#define T_LPX_CNT_MASK GENMASK(5, 0) +#define T_LPX_CNT(x) UPDATE(x, 5, 0) +/* Clock/Data0/Data1/Data2/Data3 Lane Register Part: reg06 */ +#define T_HS_ZERO_CNT_HI_MASK BIT(7) +#define T_HS_ZERO_CNT_HI(x) UPDATE(x, 7, 7) +#define T_HS_PREPARE_CNT_MASK GENMASK(6, 0) +#define T_HS_PREPARE_CNT(x) UPDATE(x, 6, 0) +/* Clock/Data0/Data1/Data2/Data3 Lane Register Part: reg07 */ +#define T_HS_ZERO_CNT_LO_MASK GENMASK(5, 0) +#define T_HS_ZERO_CNT_LO(x) UPDATE(x, 5, 0) +/* Clock/Data0/Data1/Data2/Data3 Lane Register Part: reg08 */ +#define T_HS_TRAIL_CNT_MASK GENMASK(6, 0) +#define T_HS_TRAIL_CNT(x) UPDATE(x, 6, 0) +/* Clock/Data0/Data1/Data2/Data3 Lane Register Part: reg09 */ +#define T_HS_EXIT_CNT_LO_MASK GENMASK(4, 0) +#define T_HS_EXIT_CNT_LO(x) UPDATE(x, 4, 0) +/* Clock/Data0/Data1/Data2/Data3 Lane Register Part: reg0a */ +#define T_CLK_POST_CNT_LO_MASK GENMASK(3, 0) +#define T_CLK_POST_CNT_LO(x) UPDATE(x, 3, 0) +/* Clock/Data0/Data1/Data2/Data3 Lane Register Part: reg0c */ +#define LPDT_TX_PPI_SYNC_MASK BIT(2) +#define LPDT_TX_PPI_SYNC_ENABLE BIT(2) +#define LPDT_TX_PPI_SYNC_DISABLE 0 +#define T_WAKEUP_CNT_HI_MASK GENMASK(1, 0) +#define T_WAKEUP_CNT_HI(x) UPDATE(x, 1, 0) +/* Clock/Data0/Data1/Data2/Data3 Lane Register Part: reg0d */ +#define T_WAKEUP_CNT_LO_MASK GENMASK(7, 0) +#define T_WAKEUP_CNT_LO(x) UPDATE(x, 7, 0) +/* Clock/Data0/Data1/Data2/Data3 Lane Register Part: reg0e */ +#define T_CLK_PRE_CNT_MASK GENMASK(3, 0) +#define T_CLK_PRE_CNT(x) UPDATE(x, 3, 0) +/* Clock/Data0/Data1/Data2/Data3 Lane Register Part: reg10 */ +#define T_CLK_POST_CNT_HI_MASK GENMASK(7, 6) +#define T_CLK_POST_CNT_HI(x) UPDATE(x, 7, 6) +#define T_TA_GO_CNT_MASK GENMASK(5, 0) +#define T_TA_GO_CNT(x) UPDATE(x, 5, 0) +/* Clock/Data0/Data1/Data2/Data3 Lane Register Part: reg11 */ +#define T_HS_EXIT_CNT_HI_MASK BIT(6) +#define T_HS_EXIT_CNT_HI(x) UPDATE(x, 6, 6) +#define T_TA_SURE_CNT_MASK GENMASK(5, 0) +#define T_TA_SURE_CNT(x) UPDATE(x, 5, 0) +/* Clock/Data0/Data1/Data2/Data3 Lane Register Part: reg12 */ +#define T_TA_WAIT_CNT_MASK GENMASK(5, 0) +#define T_TA_WAIT_CNT(x) UPDATE(x, 5, 0) +/* LVDS Register Part: reg00 */ +#define LVDS_DIGITAL_INTERNAL_RESET_MASK BIT(2) +#define LVDS_DIGITAL_INTERNAL_RESET_DISABLE BIT(2) +#define LVDS_DIGITAL_INTERNAL_RESET_ENABLE 0 +/* LVDS Register Part: reg01 */ +#define LVDS_DIGITAL_INTERNAL_ENABLE_MASK BIT(7) +#define LVDS_DIGITAL_INTERNAL_ENABLE BIT(7) +#define LVDS_DIGITAL_INTERNAL_DISABLE 0 +/* LVDS Register Part: reg03 */ +#define MODE_ENABLE_MASK GENMASK(2, 0) +#define TTL_MODE_ENABLE BIT(2) +#define LVDS_MODE_ENABLE BIT(1) +#define MIPI_MODE_ENABLE BIT(0) +/* LVDS Register Part: reg0b */ +#define LVDS_LANE_EN_MASK GENMASK(7, 3) +#define LVDS_DATA_LANE0_EN BIT(7) +#define LVDS_DATA_LANE1_EN BIT(6) +#define LVDS_DATA_LANE2_EN BIT(5) +#define LVDS_DATA_LANE3_EN BIT(4) +#define LVDS_CLK_LANE_EN BIT(3) +#define LVDS_PLL_POWER_MASK BIT(2) +#define LVDS_PLL_POWER_OFF BIT(2) +#define LVDS_PLL_POWER_ON 0 +#define LVDS_BANDGAP_POWER_MASK BIT(0) +#define LVDS_BANDGAP_POWER_DOWN BIT(0) +#define LVDS_BANDGAP_POWER_ON 0 + +#define DSI_PHY_RSTZ 0xa0 +#define PHY_ENABLECLK BIT(2) +#define DSI_PHY_STATUS 0xb0 +#define PHY_LOCK BIT(0) + +#define PSEC_PER_SEC 1000000000000LL + +#define msleep(a) udelay(a * 1000) + +enum phy_max_rate { + MAX_1GHZ, + MAX_2_5GHZ, +}; + +struct clk_hw { + struct clk_core *core; + struct clk *clk; + const struct clk_init_data *init; +}; + +struct inno_video_phy_plat_data { + const struct inno_mipi_dphy_timing *inno_mipi_dphy_timing_table; + const unsigned int num_timings; + enum phy_max_rate max_rate; +}; + +struct inno_dsidphy { + struct udevice *dev; + struct clk *ref_clk; + struct clk *pclk_phy; + struct clk *pclk_host; + const struct inno_video_phy_plat_data *pdata; + void __iomem *phy_base; + void __iomem *host_base; + struct reset_ctl *rst; + struct phy_configure_opts_mipi_dphy dphy_cfg; + + struct clk *pll_clk; + struct { + struct clk_hw hw; + u8 prediv; + u16 fbdiv; + unsigned long rate; + } pll; +}; + +enum { + REGISTER_PART_ANALOG, + REGISTER_PART_DIGITAL, + REGISTER_PART_CLOCK_LANE, + REGISTER_PART_DATA0_LANE, + REGISTER_PART_DATA1_LANE, + REGISTER_PART_DATA2_LANE, + REGISTER_PART_DATA3_LANE, + REGISTER_PART_LVDS, +}; + +struct inno_mipi_dphy_timing { + unsigned long rate; + u8 lpx; + u8 hs_prepare; + u8 clk_lane_hs_zero; + u8 data_lane_hs_zero; + u8 hs_trail; +}; + +static const +struct inno_mipi_dphy_timing inno_mipi_dphy_timing_table_max_1ghz[] = { + { 110000000, 0x0, 0x20, 0x16, 0x02, 0x22}, + { 150000000, 0x0, 0x06, 0x16, 0x03, 0x45}, + { 200000000, 0x0, 0x18, 0x17, 0x04, 0x0b}, + { 250000000, 0x0, 0x05, 0x17, 0x05, 0x16}, + { 300000000, 0x0, 0x51, 0x18, 0x06, 0x2c}, + { 400000000, 0x0, 0x64, 0x19, 0x07, 0x33}, + { 500000000, 0x0, 0x20, 0x1b, 0x07, 0x4e}, + { 600000000, 0x0, 0x6a, 0x1d, 0x08, 0x3a}, + { 700000000, 0x0, 0x3e, 0x1e, 0x08, 0x6a}, + { 800000000, 0x0, 0x21, 0x1f, 0x09, 0x29}, + {1000000000, 0x0, 0x09, 0x20, 0x09, 0x27}, +}; + +static const +struct inno_mipi_dphy_timing inno_mipi_dphy_timing_table_max_2_5ghz[] = { + { 110000000, 0x02, 0x7f, 0x16, 0x02, 0x02}, + { 150000000, 0x02, 0x7f, 0x16, 0x03, 0x02}, + { 200000000, 0x02, 0x7f, 0x17, 0x04, 0x02}, + { 250000000, 0x02, 0x7f, 0x17, 0x05, 0x04}, + { 300000000, 0x02, 0x7f, 0x18, 0x06, 0x04}, + { 400000000, 0x03, 0x7e, 0x19, 0x07, 0x04}, + { 500000000, 0x03, 0x7c, 0x1b, 0x07, 0x08}, + { 600000000, 0x03, 0x70, 0x1d, 0x08, 0x10}, + { 700000000, 0x05, 0x40, 0x1e, 0x08, 0x30}, + { 800000000, 0x05, 0x02, 0x1f, 0x09, 0x30}, + {1000000000, 0x05, 0x08, 0x20, 0x09, 0x30}, + {1200000000, 0x06, 0x03, 0x32, 0x14, 0x0f}, + {1400000000, 0x09, 0x03, 0x32, 0x14, 0x0f}, + {1600000000, 0x0d, 0x42, 0x36, 0x0e, 0x0f}, + {1800000000, 0x0e, 0x47, 0x7a, 0x0e, 0x0f}, + {2000000000, 0x11, 0x64, 0x7a, 0x0e, 0x0b}, + {2200000000, 0x13, 0x64, 0x7e, 0x15, 0x0b}, + {2400000000, 0x13, 0x33, 0x7f, 0x15, 0x6a}, + {2500000000, 0x15, 0x54, 0x7f, 0x15, 0x6a}, +}; + +static void phy_update_bits(struct inno_dsidphy *inno, + u8 first, u8 second, u8 mask, u8 val) +{ + u32 reg = PHY_REG(first, second) << 2; + unsigned int tmp, orig; + + orig = readl(inno->phy_base + reg); + tmp = orig & ~mask; + tmp |= val & mask; + writel(tmp, inno->phy_base + reg); +} + +static unsigned long inno_dsidphy_pll_calc_rate(struct inno_dsidphy *inno, + unsigned long rate) +{ + unsigned long prate; + unsigned long best_freq = 0; + unsigned long fref, fout; + u8 min_prediv, max_prediv; + u8 _prediv, best_prediv = 1; + u16 _fbdiv, best_fbdiv = 1; + u32 min_delta = UINT_MAX; + + /* + * Upstream Linux tries to read the ref_clk, while the BSP + * U-Boot hard-codes this as 24MHz. Try the first, and if that + * fails do the second. + */ + prate = clk_get_rate(inno->ref_clk); + if (IS_ERR_VALUE(prate)) + prate = 24000000; + + /* + * The PLL output frequency can be calculated using a simple formula: + * PLL_Output_Frequency = (FREF / PREDIV * FBDIV) / 2 + * PLL_Output_Frequency: it is equal to DDR-Clock-Frequency * 2 + */ + fref = prate / 2; + if (rate > 1000000000UL) + fout = 1000000000UL; + else + fout = rate; + + /* 5Mhz < Fref / prediv < 40MHz */ + min_prediv = DIV_ROUND_UP(fref, 40000000); + max_prediv = fref / 5000000; + + for (_prediv = min_prediv; _prediv <= max_prediv; _prediv++) { + u64 tmp; + u32 delta; + + tmp = (u64)fout * _prediv; + do_div(tmp, fref); + _fbdiv = tmp; + + /* + * The possible settings of feedback divider are + * 12, 13, 14, 16, ~ 511 + */ + if (_fbdiv == 15) + continue; + + if (_fbdiv < 12 || _fbdiv > 511) + continue; + + tmp = (u64)_fbdiv * fref; + do_div(tmp, _prediv); + + delta = abs(fout - tmp); + if (!delta) { + best_prediv = _prediv; + best_fbdiv = _fbdiv; + best_freq = tmp; + break; + } else if (delta < min_delta) { + best_prediv = _prediv; + best_fbdiv = _fbdiv; + best_freq = tmp; + min_delta = delta; + } + } + + if (best_freq) { + inno->pll.prediv = best_prediv; + inno->pll.fbdiv = best_fbdiv; + inno->pll.rate = best_freq; + } + + return best_freq; +} + +static void inno_dsidphy_mipi_mode_enable(struct inno_dsidphy *inno) +{ + struct phy_configure_opts_mipi_dphy *cfg = &inno->dphy_cfg; + const struct inno_mipi_dphy_timing *timings; + u32 t_txbyteclkhs, t_txclkesc; + u32 txbyteclkhs, txclkesc, esc_clk_div; + u32 hs_exit, clk_post, clk_pre, wakeup, lpx, ta_go, ta_sure, ta_wait; + u32 hs_prepare, hs_trail, hs_zero, clk_lane_hs_zero, data_lane_hs_zero; + unsigned int i; + + timings = inno->pdata->inno_mipi_dphy_timing_table; + + inno_dsidphy_pll_calc_rate(inno, cfg->hs_clk_rate); + + /* Select MIPI mode */ + phy_update_bits(inno, REGISTER_PART_LVDS, 0x03, + MODE_ENABLE_MASK, MIPI_MODE_ENABLE); + /* Configure PLL */ + phy_update_bits(inno, REGISTER_PART_ANALOG, 0x03, + REG_PREDIV_MASK, REG_PREDIV(inno->pll.prediv)); + phy_update_bits(inno, REGISTER_PART_ANALOG, 0x03, + REG_FBDIV_HI_MASK, REG_FBDIV_HI(inno->pll.fbdiv)); + phy_update_bits(inno, REGISTER_PART_ANALOG, 0x04, + REG_FBDIV_LO_MASK, REG_FBDIV_LO(inno->pll.fbdiv)); + if (inno->pdata->max_rate == MAX_2_5GHZ) { + phy_update_bits(inno, REGISTER_PART_ANALOG, 0x08, + PLL_POST_DIV_ENABLE_MASK, PLL_POST_DIV_ENABLE); + phy_update_bits(inno, REGISTER_PART_ANALOG, 0x0b, + CLOCK_LANE_VOD_RANGE_SET_MASK, + CLOCK_LANE_VOD_RANGE_SET(VOD_MAX_RANGE)); + } + /* Enable PLL and LDO */ + phy_update_bits(inno, REGISTER_PART_ANALOG, 0x01, + REG_LDOPD_MASK | REG_PLLPD_MASK, + REG_LDOPD_POWER_ON | REG_PLLPD_POWER_ON); + /* Reset analog */ + phy_update_bits(inno, REGISTER_PART_ANALOG, 0x01, + REG_SYNCRST_MASK, REG_SYNCRST_RESET); + udelay(1); + phy_update_bits(inno, REGISTER_PART_ANALOG, 0x01, + REG_SYNCRST_MASK, REG_SYNCRST_NORMAL); + /* Reset digital */ + phy_update_bits(inno, REGISTER_PART_DIGITAL, 0x00, + REG_DIG_RSTN_MASK, REG_DIG_RSTN_RESET); + udelay(1); + phy_update_bits(inno, REGISTER_PART_DIGITAL, 0x00, + REG_DIG_RSTN_MASK, REG_DIG_RSTN_NORMAL); + + txbyteclkhs = inno->pll.rate / 8; + t_txbyteclkhs = div_u64(PSEC_PER_SEC, txbyteclkhs); + + esc_clk_div = DIV_ROUND_UP(txbyteclkhs, 20000000); + txclkesc = txbyteclkhs / esc_clk_div; + t_txclkesc = div_u64(PSEC_PER_SEC, txclkesc); + + /* + * The value of counter for HS Ths-exit + * Ths-exit = Tpin_txbyteclkhs * value + */ + hs_exit = DIV_ROUND_UP(cfg->hs_exit, t_txbyteclkhs); + /* + * The value of counter for HS Tclk-post + * Tclk-post = Tpin_txbyteclkhs * value + */ + clk_post = DIV_ROUND_UP(cfg->clk_post, t_txbyteclkhs); + /* + * The value of counter for HS Tclk-pre + * Tclk-pre = Tpin_txbyteclkhs * value + */ + clk_pre = DIV_ROUND_UP(cfg->clk_pre, BITS_PER_BYTE); + + /* + * The value of counter for HS Tta-go + * Tta-go for turnaround + * Tta-go = Ttxclkesc * value + */ + ta_go = DIV_ROUND_UP(cfg->ta_go, t_txclkesc); + /* + * The value of counter for HS Tta-sure + * Tta-sure for turnaround + * Tta-sure = Ttxclkesc * value + */ + ta_sure = DIV_ROUND_UP(cfg->ta_sure, t_txclkesc); + /* + * The value of counter for HS Tta-wait + * Tta-wait for turnaround + * Tta-wait = Ttxclkesc * value + */ + ta_wait = DIV_ROUND_UP(cfg->ta_get, t_txclkesc); + + for (i = 0; i < inno->pdata->num_timings; i++) + if (inno->pll.rate <= timings[i].rate) + break; + + if (i == inno->pdata->num_timings) + --i; + + /* + * The value of counter for HS Tlpx Time + * Tlpx = Tpin_txbyteclkhs * (2 + value) + */ + if (inno->pdata->max_rate == MAX_1GHZ) { + lpx = DIV_ROUND_UP(cfg->lpx, t_txbyteclkhs); + if (lpx >= 2) + lpx -= 2; + } else { + lpx = timings[i].lpx; + } + + hs_prepare = timings[i].hs_prepare; + hs_trail = timings[i].hs_trail; + clk_lane_hs_zero = timings[i].clk_lane_hs_zero; + data_lane_hs_zero = timings[i].data_lane_hs_zero; + wakeup = 0x3ff; + + for (i = REGISTER_PART_CLOCK_LANE; i <= REGISTER_PART_DATA3_LANE; i++) { + if (i == REGISTER_PART_CLOCK_LANE) + hs_zero = clk_lane_hs_zero; + else + hs_zero = data_lane_hs_zero; + + phy_update_bits(inno, i, 0x05, T_LPX_CNT_MASK, + T_LPX_CNT(lpx)); + phy_update_bits(inno, i, 0x06, T_HS_PREPARE_CNT_MASK, + T_HS_PREPARE_CNT(hs_prepare)); + if (inno->pdata->max_rate == MAX_2_5GHZ) + phy_update_bits(inno, i, 0x06, T_HS_ZERO_CNT_HI_MASK, + T_HS_ZERO_CNT_HI(hs_zero >> 6)); + phy_update_bits(inno, i, 0x07, T_HS_ZERO_CNT_LO_MASK, + T_HS_ZERO_CNT_LO(hs_zero)); + phy_update_bits(inno, i, 0x08, T_HS_TRAIL_CNT_MASK, + T_HS_TRAIL_CNT(hs_trail)); + if (inno->pdata->max_rate == MAX_2_5GHZ) + phy_update_bits(inno, i, 0x11, T_HS_EXIT_CNT_HI_MASK, + T_HS_EXIT_CNT_HI(hs_exit >> 5)); + phy_update_bits(inno, i, 0x09, T_HS_EXIT_CNT_LO_MASK, + T_HS_EXIT_CNT_LO(hs_exit)); + if (inno->pdata->max_rate == MAX_2_5GHZ) + phy_update_bits(inno, i, 0x10, T_CLK_POST_CNT_HI_MASK, + T_CLK_POST_CNT_HI(clk_post >> 4)); + phy_update_bits(inno, i, 0x0a, T_CLK_POST_CNT_LO_MASK, + T_CLK_POST_CNT_LO(clk_post)); + phy_update_bits(inno, i, 0x0e, T_CLK_PRE_CNT_MASK, + T_CLK_PRE_CNT(clk_pre)); + phy_update_bits(inno, i, 0x0c, T_WAKEUP_CNT_HI_MASK, + T_WAKEUP_CNT_HI(wakeup >> 8)); + phy_update_bits(inno, i, 0x0d, T_WAKEUP_CNT_LO_MASK, + T_WAKEUP_CNT_LO(wakeup)); + phy_update_bits(inno, i, 0x10, T_TA_GO_CNT_MASK, + T_TA_GO_CNT(ta_go)); + phy_update_bits(inno, i, 0x11, T_TA_SURE_CNT_MASK, + T_TA_SURE_CNT(ta_sure)); + phy_update_bits(inno, i, 0x12, T_TA_WAIT_CNT_MASK, + T_TA_WAIT_CNT(ta_wait)); + } + + /* Enable all lanes on analog part */ + phy_update_bits(inno, REGISTER_PART_ANALOG, 0x00, + LANE_EN_MASK, LANE_EN_CK | LANE_EN_3 | LANE_EN_2 | + LANE_EN_1 | LANE_EN_0); +} + +static int inno_dsidphy_power_on(struct phy *phy) +{ + struct inno_dsidphy *inno = dev_get_priv(phy->dev); + + clk_prepare_enable(inno->pclk_phy); + clk_prepare_enable(inno->ref_clk); + + /* Bandgap power on */ + phy_update_bits(inno, REGISTER_PART_ANALOG, 0x00, + BANDGAP_POWER_MASK, BANDGAP_POWER_ON); + /* Enable power work */ + phy_update_bits(inno, REGISTER_PART_ANALOG, 0x00, + POWER_WORK_MASK, POWER_WORK_ENABLE); + + inno_dsidphy_mipi_mode_enable(inno); + + return 0; +} + +static int inno_dsidphy_power_off(struct phy *phy) +{ + struct inno_dsidphy *inno = dev_get_priv(phy->dev); + + phy_update_bits(inno, REGISTER_PART_ANALOG, 0x00, LANE_EN_MASK, 0); + phy_update_bits(inno, REGISTER_PART_ANALOG, 0x01, + REG_LDOPD_MASK | REG_PLLPD_MASK, + REG_LDOPD_POWER_DOWN | REG_PLLPD_POWER_DOWN); + phy_update_bits(inno, REGISTER_PART_ANALOG, 0x00, + POWER_WORK_MASK, POWER_WORK_DISABLE); + phy_update_bits(inno, REGISTER_PART_ANALOG, 0x00, + BANDGAP_POWER_MASK, BANDGAP_POWER_DOWN); + + phy_update_bits(inno, REGISTER_PART_LVDS, 0x0b, LVDS_LANE_EN_MASK, 0); + phy_update_bits(inno, REGISTER_PART_LVDS, 0x01, + LVDS_DIGITAL_INTERNAL_ENABLE_MASK, + LVDS_DIGITAL_INTERNAL_DISABLE); + phy_update_bits(inno, REGISTER_PART_LVDS, 0x0b, + LVDS_PLL_POWER_MASK | LVDS_BANDGAP_POWER_MASK, + LVDS_PLL_POWER_OFF | LVDS_BANDGAP_POWER_DOWN); + + clk_disable_unprepare(inno->ref_clk); + clk_disable_unprepare(inno->pclk_phy); + + return 0; +} + +static int inno_dsidphy_configure(struct phy *phy, void *params) +{ + struct inno_dsidphy *inno = dev_get_priv(phy->dev); + struct phy_configure_opts_mipi_dphy *config = params; + int ret; + + ret = phy_mipi_dphy_config_validate(config); + if (ret) + return ret; + + memcpy(&inno->dphy_cfg, config, sizeof(inno->dphy_cfg)); + + return 0; +} + +static const struct phy_ops inno_dsidphy_ops = { + .configure = inno_dsidphy_configure, + .power_on = inno_dsidphy_power_on, + .power_off = inno_dsidphy_power_off, +}; + +static const struct inno_video_phy_plat_data max_1ghz_video_phy_plat_data = { + .inno_mipi_dphy_timing_table = inno_mipi_dphy_timing_table_max_1ghz, + .num_timings = ARRAY_SIZE(inno_mipi_dphy_timing_table_max_1ghz), + .max_rate = MAX_1GHZ, +}; + +static const struct inno_video_phy_plat_data max_2_5ghz_video_phy_plat_data = { + .inno_mipi_dphy_timing_table = inno_mipi_dphy_timing_table_max_2_5ghz, + .num_timings = ARRAY_SIZE(inno_mipi_dphy_timing_table_max_2_5ghz), + .max_rate = MAX_2_5GHZ, +}; + +static int inno_dsidphy_probe(struct udevice *dev) +{ + struct inno_dsidphy *inno = dev_get_priv(dev); + int ret; + + inno->dev = dev; + inno->pdata = (const struct inno_video_phy_plat_data *)dev_get_driver_data(dev); + + inno->phy_base = dev_read_addr_ptr(dev); + if (IS_ERR(inno->phy_base)) + return PTR_ERR(inno->phy_base); + + inno->ref_clk = devm_clk_get(dev, "ref"); + if (IS_ERR(inno->ref_clk)) { + ret = PTR_ERR(inno->ref_clk); + dev_err(dev, "failed to get ref clock: %d\n", ret); + return ret; + } + + inno->pclk_phy = devm_clk_get(dev, "pclk"); + if (IS_ERR(inno->pclk_phy)) { + ret = PTR_ERR(inno->pclk_phy); + dev_err(dev, "failed to get phy pclk: %d\n", ret); + return ret; + } + + inno->rst = devm_reset_control_get(dev, "apb"); + if (IS_ERR(inno->rst)) { + ret = PTR_ERR(inno->rst); + dev_err(dev, "failed to get system reset control: %d\n", ret); + return ret; + } + + return 0; +} + +static const struct udevice_id inno_dsidphy_of_match[] = { + { + .compatible = "rockchip,px30-dsi-dphy", + .data = (long)&max_1ghz_video_phy_plat_data, + }, { + .compatible = "rockchip,rk3128-dsi-dphy", + .data = (long)&max_1ghz_video_phy_plat_data, + }, { + .compatible = "rockchip,rk3368-dsi-dphy", + .data = (long)&max_1ghz_video_phy_plat_data, + }, { + .compatible = "rockchip,rk3568-dsi-dphy", + .data = (long)&max_2_5ghz_video_phy_plat_data, + }, + {} +}; + +U_BOOT_DRIVER(rockchip_inno_dsidphy) = { + .name = "rockchip-inno-dsidphy", + .id = UCLASS_PHY, + .of_match = inno_dsidphy_of_match, + .probe = inno_dsidphy_probe, + .ops = &inno_dsidphy_ops, + .priv_auto = sizeof(struct inno_dsidphy), +}; -- 2.34.1 ^ permalink raw reply related [flat|nested] 5+ messages in thread
* Re: [PATCH 1/2] drivers: phy: add Innosilicon DSI-DPHY driver 2023-03-24 18:53 ` [PATCH 1/2] drivers: phy: add Innosilicon DSI-DPHY driver Chris Morgan @ 2023-04-14 8:52 ` Kever Yang 0 siblings, 0 replies; 5+ messages in thread From: Kever Yang @ 2023-04-14 8:52 UTC (permalink / raw) To: Chris Morgan, u-boot Cc: yifeng.zhao, jagan, agust, philipp.tomsich, sjg, Chris Morgan On 2023/3/25 02:53, Chris Morgan wrote: > From: Chris Morgan <macromorgan@hotmail.com> > > Add support for the Innosilicon DSI-DPHY driver for Rockchip SOCs. > The driver was ported from Linux and tested on a Rockchip RK3566 > based device to query the panel ID via a DSI command. > > Signed-off-by: Chris Morgan <macromorgan@hotmail.com> Reviewed-by: Kever Yang <kever.yang@rock-chips.com> Thanks, - Kever > --- > drivers/phy/rockchip/Kconfig | 8 + > drivers/phy/rockchip/Makefile | 1 + > .../phy/rockchip/phy-rockchip-inno-dsidphy.c | 680 ++++++++++++++++++ > 3 files changed, 689 insertions(+) > create mode 100644 drivers/phy/rockchip/phy-rockchip-inno-dsidphy.c > > diff --git a/drivers/phy/rockchip/Kconfig b/drivers/phy/rockchip/Kconfig > index 1305763940..f87ca8c310 100644 > --- a/drivers/phy/rockchip/Kconfig > +++ b/drivers/phy/rockchip/Kconfig > @@ -4,6 +4,14 @@ > > menu "Rockchip PHY driver" > > +config PHY_ROCKCHIP_INNO_DSIDPHY > + bool "Rockchip INNO DSIDPHY Driver" > + depends on ARCH_ROCKCHIP > + select PHY > + select MIPI_DPHY_HELPERS > + help > + Support for Rockchip MIPI DPHY with Innosilicon IP block. > + > config PHY_ROCKCHIP_INNO_USB2 > bool "Rockchip INNO USB2PHY Driver" > depends on ARCH_ROCKCHIP > diff --git a/drivers/phy/rockchip/Makefile b/drivers/phy/rockchip/Makefile > index a236877234..25a803a8a8 100644 > --- a/drivers/phy/rockchip/Makefile > +++ b/drivers/phy/rockchip/Makefile > @@ -8,3 +8,4 @@ obj-$(CONFIG_PHY_ROCKCHIP_NANENG_COMBOPHY) += phy-rockchip-naneng-combphy.o > obj-$(CONFIG_PHY_ROCKCHIP_PCIE) += phy-rockchip-pcie.o > obj-$(CONFIG_PHY_ROCKCHIP_SNPS_PCIE3) += phy-rockchip-snps-pcie3.o > obj-$(CONFIG_PHY_ROCKCHIP_TYPEC) += phy-rockchip-typec.o > +obj-$(CONFIG_PHY_ROCKCHIP_INNO_DSIDPHY) += phy-rockchip-inno-dsidphy.o > diff --git a/drivers/phy/rockchip/phy-rockchip-inno-dsidphy.c b/drivers/phy/rockchip/phy-rockchip-inno-dsidphy.c > new file mode 100644 > index 0000000000..9ed7af0d6e > --- /dev/null > +++ b/drivers/phy/rockchip/phy-rockchip-inno-dsidphy.c > @@ -0,0 +1,680 @@ > +// SPDX-License-Identifier: GPL-2.0 > +/* > + * Copyright (c) 2018 Rockchip Electronics Co. Ltd. > + * > + * Author: Wyon Bi <bivvy.bi@rock-chips.com> > + */ > + > +#include <dm.h> > +#include <dm/device_compat.h> > +#include <dm/devres.h> > +#include <div64.h> > +#include <generic-phy.h> > +#include <linux/kernel.h> > +#include <linux/iopoll.h> > +#include <linux/clk-provider.h> > +#include <linux/delay.h> > +#include <linux/math64.h> > +#include <phy-mipi-dphy.h> > +#include <reset.h> > + > +#define UPDATE(x, h, l) (((x) << (l)) & GENMASK((h), (l))) > + > +/* > + * The offset address[7:0] is distributed two parts, one from the bit7 to bit5 > + * is the first address, the other from the bit4 to bit0 is the second address. > + * when you configure the registers, you must set both of them. The Clock Lane > + * and Data Lane use the same registers with the same second address, but the > + * first address is different. > + */ > +#define FIRST_ADDRESS(x) (((x) & 0x7) << 5) > +#define SECOND_ADDRESS(x) (((x) & 0x1f) << 0) > +#define PHY_REG(first, second) (FIRST_ADDRESS(first) | \ > + SECOND_ADDRESS(second)) > + > +/* Analog Register Part: reg00 */ > +#define BANDGAP_POWER_MASK BIT(7) > +#define BANDGAP_POWER_DOWN BIT(7) > +#define BANDGAP_POWER_ON 0 > +#define LANE_EN_MASK GENMASK(6, 2) > +#define LANE_EN_CK BIT(6) > +#define LANE_EN_3 BIT(5) > +#define LANE_EN_2 BIT(4) > +#define LANE_EN_1 BIT(3) > +#define LANE_EN_0 BIT(2) > +#define POWER_WORK_MASK GENMASK(1, 0) > +#define POWER_WORK_ENABLE UPDATE(1, 1, 0) > +#define POWER_WORK_DISABLE UPDATE(2, 1, 0) > +/* Analog Register Part: reg01 */ > +#define REG_SYNCRST_MASK BIT(2) > +#define REG_SYNCRST_RESET BIT(2) > +#define REG_SYNCRST_NORMAL 0 > +#define REG_LDOPD_MASK BIT(1) > +#define REG_LDOPD_POWER_DOWN BIT(1) > +#define REG_LDOPD_POWER_ON 0 > +#define REG_PLLPD_MASK BIT(0) > +#define REG_PLLPD_POWER_DOWN BIT(0) > +#define REG_PLLPD_POWER_ON 0 > +/* Analog Register Part: reg03 */ > +#define REG_FBDIV_HI_MASK BIT(5) > +#define REG_FBDIV_HI(x) UPDATE((x >> 8), 5, 5) > +#define REG_PREDIV_MASK GENMASK(4, 0) > +#define REG_PREDIV(x) UPDATE(x, 4, 0) > +/* Analog Register Part: reg04 */ > +#define REG_FBDIV_LO_MASK GENMASK(7, 0) > +#define REG_FBDIV_LO(x) UPDATE(x, 7, 0) > +/* Analog Register Part: reg05 */ > +#define SAMPLE_CLOCK_PHASE_MASK GENMASK(6, 4) > +#define SAMPLE_CLOCK_PHASE(x) UPDATE(x, 6, 4) > +#define CLOCK_LANE_SKEW_PHASE_MASK GENMASK(2, 0) > +#define CLOCK_LANE_SKEW_PHASE(x) UPDATE(x, 2, 0) > +/* Analog Register Part: reg06 */ > +#define DATA_LANE_3_SKEW_PHASE_MASK GENMASK(6, 4) > +#define DATA_LANE_3_SKEW_PHASE(x) UPDATE(x, 6, 4) > +#define DATA_LANE_2_SKEW_PHASE_MASK GENMASK(2, 0) > +#define DATA_LANE_2_SKEW_PHASE(x) UPDATE(x, 2, 0) > +/* Analog Register Part: reg07 */ > +#define DATA_LANE_1_SKEW_PHASE_MASK GENMASK(6, 4) > +#define DATA_LANE_1_SKEW_PHASE(x) UPDATE(x, 6, 4) > +#define DATA_LANE_0_SKEW_PHASE_MASK GENMASK(2, 0) > +#define DATA_LANE_0_SKEW_PHASE(x) UPDATE(x, 2, 0) > +/* Analog Register Part: reg08 */ > +#define PLL_POST_DIV_ENABLE_MASK BIT(5) > +#define PLL_POST_DIV_ENABLE BIT(5) > +#define SAMPLE_CLOCK_DIRECTION_MASK BIT(4) > +#define SAMPLE_CLOCK_DIRECTION_REVERSE BIT(4) > +#define SAMPLE_CLOCK_DIRECTION_FORWARD 0 > +#define LOWFRE_EN_MASK BIT(5) > +#define PLL_OUTPUT_FREQUENCY_DIV_BY_1 0 > +#define PLL_OUTPUT_FREQUENCY_DIV_BY_2 1 > +/* Analog Register Part: reg0b */ > +#define CLOCK_LANE_VOD_RANGE_SET_MASK GENMASK(3, 0) > +#define CLOCK_LANE_VOD_RANGE_SET(x) UPDATE(x, 3, 0) > +#define VOD_MIN_RANGE 0x1 > +#define VOD_MID_RANGE 0x3 > +#define VOD_BIG_RANGE 0x7 > +#define VOD_MAX_RANGE 0xf > +/* Analog Register Part: reg1E */ > +#define PLL_MODE_SEL_MASK GENMASK(6, 5) > +#define PLL_MODE_SEL_LVDS_MODE 0 > +#define PLL_MODE_SEL_MIPI_MODE BIT(5) > +/* Digital Register Part: reg00 */ > +#define REG_DIG_RSTN_MASK BIT(0) > +#define REG_DIG_RSTN_NORMAL BIT(0) > +#define REG_DIG_RSTN_RESET 0 > +/* Digital Register Part: reg01 */ > +#define INVERT_TXCLKESC_MASK BIT(1) > +#define INVERT_TXCLKESC_ENABLE BIT(1) > +#define INVERT_TXCLKESC_DISABLE 0 > +#define INVERT_TXBYTECLKHS_MASK BIT(0) > +#define INVERT_TXBYTECLKHS_ENABLE BIT(0) > +#define INVERT_TXBYTECLKHS_DISABLE 0 > +/* Clock/Data0/Data1/Data2/Data3 Lane Register Part: reg05 */ > +#define T_LPX_CNT_MASK GENMASK(5, 0) > +#define T_LPX_CNT(x) UPDATE(x, 5, 0) > +/* Clock/Data0/Data1/Data2/Data3 Lane Register Part: reg06 */ > +#define T_HS_ZERO_CNT_HI_MASK BIT(7) > +#define T_HS_ZERO_CNT_HI(x) UPDATE(x, 7, 7) > +#define T_HS_PREPARE_CNT_MASK GENMASK(6, 0) > +#define T_HS_PREPARE_CNT(x) UPDATE(x, 6, 0) > +/* Clock/Data0/Data1/Data2/Data3 Lane Register Part: reg07 */ > +#define T_HS_ZERO_CNT_LO_MASK GENMASK(5, 0) > +#define T_HS_ZERO_CNT_LO(x) UPDATE(x, 5, 0) > +/* Clock/Data0/Data1/Data2/Data3 Lane Register Part: reg08 */ > +#define T_HS_TRAIL_CNT_MASK GENMASK(6, 0) > +#define T_HS_TRAIL_CNT(x) UPDATE(x, 6, 0) > +/* Clock/Data0/Data1/Data2/Data3 Lane Register Part: reg09 */ > +#define T_HS_EXIT_CNT_LO_MASK GENMASK(4, 0) > +#define T_HS_EXIT_CNT_LO(x) UPDATE(x, 4, 0) > +/* Clock/Data0/Data1/Data2/Data3 Lane Register Part: reg0a */ > +#define T_CLK_POST_CNT_LO_MASK GENMASK(3, 0) > +#define T_CLK_POST_CNT_LO(x) UPDATE(x, 3, 0) > +/* Clock/Data0/Data1/Data2/Data3 Lane Register Part: reg0c */ > +#define LPDT_TX_PPI_SYNC_MASK BIT(2) > +#define LPDT_TX_PPI_SYNC_ENABLE BIT(2) > +#define LPDT_TX_PPI_SYNC_DISABLE 0 > +#define T_WAKEUP_CNT_HI_MASK GENMASK(1, 0) > +#define T_WAKEUP_CNT_HI(x) UPDATE(x, 1, 0) > +/* Clock/Data0/Data1/Data2/Data3 Lane Register Part: reg0d */ > +#define T_WAKEUP_CNT_LO_MASK GENMASK(7, 0) > +#define T_WAKEUP_CNT_LO(x) UPDATE(x, 7, 0) > +/* Clock/Data0/Data1/Data2/Data3 Lane Register Part: reg0e */ > +#define T_CLK_PRE_CNT_MASK GENMASK(3, 0) > +#define T_CLK_PRE_CNT(x) UPDATE(x, 3, 0) > +/* Clock/Data0/Data1/Data2/Data3 Lane Register Part: reg10 */ > +#define T_CLK_POST_CNT_HI_MASK GENMASK(7, 6) > +#define T_CLK_POST_CNT_HI(x) UPDATE(x, 7, 6) > +#define T_TA_GO_CNT_MASK GENMASK(5, 0) > +#define T_TA_GO_CNT(x) UPDATE(x, 5, 0) > +/* Clock/Data0/Data1/Data2/Data3 Lane Register Part: reg11 */ > +#define T_HS_EXIT_CNT_HI_MASK BIT(6) > +#define T_HS_EXIT_CNT_HI(x) UPDATE(x, 6, 6) > +#define T_TA_SURE_CNT_MASK GENMASK(5, 0) > +#define T_TA_SURE_CNT(x) UPDATE(x, 5, 0) > +/* Clock/Data0/Data1/Data2/Data3 Lane Register Part: reg12 */ > +#define T_TA_WAIT_CNT_MASK GENMASK(5, 0) > +#define T_TA_WAIT_CNT(x) UPDATE(x, 5, 0) > +/* LVDS Register Part: reg00 */ > +#define LVDS_DIGITAL_INTERNAL_RESET_MASK BIT(2) > +#define LVDS_DIGITAL_INTERNAL_RESET_DISABLE BIT(2) > +#define LVDS_DIGITAL_INTERNAL_RESET_ENABLE 0 > +/* LVDS Register Part: reg01 */ > +#define LVDS_DIGITAL_INTERNAL_ENABLE_MASK BIT(7) > +#define LVDS_DIGITAL_INTERNAL_ENABLE BIT(7) > +#define LVDS_DIGITAL_INTERNAL_DISABLE 0 > +/* LVDS Register Part: reg03 */ > +#define MODE_ENABLE_MASK GENMASK(2, 0) > +#define TTL_MODE_ENABLE BIT(2) > +#define LVDS_MODE_ENABLE BIT(1) > +#define MIPI_MODE_ENABLE BIT(0) > +/* LVDS Register Part: reg0b */ > +#define LVDS_LANE_EN_MASK GENMASK(7, 3) > +#define LVDS_DATA_LANE0_EN BIT(7) > +#define LVDS_DATA_LANE1_EN BIT(6) > +#define LVDS_DATA_LANE2_EN BIT(5) > +#define LVDS_DATA_LANE3_EN BIT(4) > +#define LVDS_CLK_LANE_EN BIT(3) > +#define LVDS_PLL_POWER_MASK BIT(2) > +#define LVDS_PLL_POWER_OFF BIT(2) > +#define LVDS_PLL_POWER_ON 0 > +#define LVDS_BANDGAP_POWER_MASK BIT(0) > +#define LVDS_BANDGAP_POWER_DOWN BIT(0) > +#define LVDS_BANDGAP_POWER_ON 0 > + > +#define DSI_PHY_RSTZ 0xa0 > +#define PHY_ENABLECLK BIT(2) > +#define DSI_PHY_STATUS 0xb0 > +#define PHY_LOCK BIT(0) > + > +#define PSEC_PER_SEC 1000000000000LL > + > +#define msleep(a) udelay(a * 1000) > + > +enum phy_max_rate { > + MAX_1GHZ, > + MAX_2_5GHZ, > +}; > + > +struct clk_hw { > + struct clk_core *core; > + struct clk *clk; > + const struct clk_init_data *init; > +}; > + > +struct inno_video_phy_plat_data { > + const struct inno_mipi_dphy_timing *inno_mipi_dphy_timing_table; > + const unsigned int num_timings; > + enum phy_max_rate max_rate; > +}; > + > +struct inno_dsidphy { > + struct udevice *dev; > + struct clk *ref_clk; > + struct clk *pclk_phy; > + struct clk *pclk_host; > + const struct inno_video_phy_plat_data *pdata; > + void __iomem *phy_base; > + void __iomem *host_base; > + struct reset_ctl *rst; > + struct phy_configure_opts_mipi_dphy dphy_cfg; > + > + struct clk *pll_clk; > + struct { > + struct clk_hw hw; > + u8 prediv; > + u16 fbdiv; > + unsigned long rate; > + } pll; > +}; > + > +enum { > + REGISTER_PART_ANALOG, > + REGISTER_PART_DIGITAL, > + REGISTER_PART_CLOCK_LANE, > + REGISTER_PART_DATA0_LANE, > + REGISTER_PART_DATA1_LANE, > + REGISTER_PART_DATA2_LANE, > + REGISTER_PART_DATA3_LANE, > + REGISTER_PART_LVDS, > +}; > + > +struct inno_mipi_dphy_timing { > + unsigned long rate; > + u8 lpx; > + u8 hs_prepare; > + u8 clk_lane_hs_zero; > + u8 data_lane_hs_zero; > + u8 hs_trail; > +}; > + > +static const > +struct inno_mipi_dphy_timing inno_mipi_dphy_timing_table_max_1ghz[] = { > + { 110000000, 0x0, 0x20, 0x16, 0x02, 0x22}, > + { 150000000, 0x0, 0x06, 0x16, 0x03, 0x45}, > + { 200000000, 0x0, 0x18, 0x17, 0x04, 0x0b}, > + { 250000000, 0x0, 0x05, 0x17, 0x05, 0x16}, > + { 300000000, 0x0, 0x51, 0x18, 0x06, 0x2c}, > + { 400000000, 0x0, 0x64, 0x19, 0x07, 0x33}, > + { 500000000, 0x0, 0x20, 0x1b, 0x07, 0x4e}, > + { 600000000, 0x0, 0x6a, 0x1d, 0x08, 0x3a}, > + { 700000000, 0x0, 0x3e, 0x1e, 0x08, 0x6a}, > + { 800000000, 0x0, 0x21, 0x1f, 0x09, 0x29}, > + {1000000000, 0x0, 0x09, 0x20, 0x09, 0x27}, > +}; > + > +static const > +struct inno_mipi_dphy_timing inno_mipi_dphy_timing_table_max_2_5ghz[] = { > + { 110000000, 0x02, 0x7f, 0x16, 0x02, 0x02}, > + { 150000000, 0x02, 0x7f, 0x16, 0x03, 0x02}, > + { 200000000, 0x02, 0x7f, 0x17, 0x04, 0x02}, > + { 250000000, 0x02, 0x7f, 0x17, 0x05, 0x04}, > + { 300000000, 0x02, 0x7f, 0x18, 0x06, 0x04}, > + { 400000000, 0x03, 0x7e, 0x19, 0x07, 0x04}, > + { 500000000, 0x03, 0x7c, 0x1b, 0x07, 0x08}, > + { 600000000, 0x03, 0x70, 0x1d, 0x08, 0x10}, > + { 700000000, 0x05, 0x40, 0x1e, 0x08, 0x30}, > + { 800000000, 0x05, 0x02, 0x1f, 0x09, 0x30}, > + {1000000000, 0x05, 0x08, 0x20, 0x09, 0x30}, > + {1200000000, 0x06, 0x03, 0x32, 0x14, 0x0f}, > + {1400000000, 0x09, 0x03, 0x32, 0x14, 0x0f}, > + {1600000000, 0x0d, 0x42, 0x36, 0x0e, 0x0f}, > + {1800000000, 0x0e, 0x47, 0x7a, 0x0e, 0x0f}, > + {2000000000, 0x11, 0x64, 0x7a, 0x0e, 0x0b}, > + {2200000000, 0x13, 0x64, 0x7e, 0x15, 0x0b}, > + {2400000000, 0x13, 0x33, 0x7f, 0x15, 0x6a}, > + {2500000000, 0x15, 0x54, 0x7f, 0x15, 0x6a}, > +}; > + > +static void phy_update_bits(struct inno_dsidphy *inno, > + u8 first, u8 second, u8 mask, u8 val) > +{ > + u32 reg = PHY_REG(first, second) << 2; > + unsigned int tmp, orig; > + > + orig = readl(inno->phy_base + reg); > + tmp = orig & ~mask; > + tmp |= val & mask; > + writel(tmp, inno->phy_base + reg); > +} > + > +static unsigned long inno_dsidphy_pll_calc_rate(struct inno_dsidphy *inno, > + unsigned long rate) > +{ > + unsigned long prate; > + unsigned long best_freq = 0; > + unsigned long fref, fout; > + u8 min_prediv, max_prediv; > + u8 _prediv, best_prediv = 1; > + u16 _fbdiv, best_fbdiv = 1; > + u32 min_delta = UINT_MAX; > + > + /* > + * Upstream Linux tries to read the ref_clk, while the BSP > + * U-Boot hard-codes this as 24MHz. Try the first, and if that > + * fails do the second. > + */ > + prate = clk_get_rate(inno->ref_clk); > + if (IS_ERR_VALUE(prate)) > + prate = 24000000; > + > + /* > + * The PLL output frequency can be calculated using a simple formula: > + * PLL_Output_Frequency = (FREF / PREDIV * FBDIV) / 2 > + * PLL_Output_Frequency: it is equal to DDR-Clock-Frequency * 2 > + */ > + fref = prate / 2; > + if (rate > 1000000000UL) > + fout = 1000000000UL; > + else > + fout = rate; > + > + /* 5Mhz < Fref / prediv < 40MHz */ > + min_prediv = DIV_ROUND_UP(fref, 40000000); > + max_prediv = fref / 5000000; > + > + for (_prediv = min_prediv; _prediv <= max_prediv; _prediv++) { > + u64 tmp; > + u32 delta; > + > + tmp = (u64)fout * _prediv; > + do_div(tmp, fref); > + _fbdiv = tmp; > + > + /* > + * The possible settings of feedback divider are > + * 12, 13, 14, 16, ~ 511 > + */ > + if (_fbdiv == 15) > + continue; > + > + if (_fbdiv < 12 || _fbdiv > 511) > + continue; > + > + tmp = (u64)_fbdiv * fref; > + do_div(tmp, _prediv); > + > + delta = abs(fout - tmp); > + if (!delta) { > + best_prediv = _prediv; > + best_fbdiv = _fbdiv; > + best_freq = tmp; > + break; > + } else if (delta < min_delta) { > + best_prediv = _prediv; > + best_fbdiv = _fbdiv; > + best_freq = tmp; > + min_delta = delta; > + } > + } > + > + if (best_freq) { > + inno->pll.prediv = best_prediv; > + inno->pll.fbdiv = best_fbdiv; > + inno->pll.rate = best_freq; > + } > + > + return best_freq; > +} > + > +static void inno_dsidphy_mipi_mode_enable(struct inno_dsidphy *inno) > +{ > + struct phy_configure_opts_mipi_dphy *cfg = &inno->dphy_cfg; > + const struct inno_mipi_dphy_timing *timings; > + u32 t_txbyteclkhs, t_txclkesc; > + u32 txbyteclkhs, txclkesc, esc_clk_div; > + u32 hs_exit, clk_post, clk_pre, wakeup, lpx, ta_go, ta_sure, ta_wait; > + u32 hs_prepare, hs_trail, hs_zero, clk_lane_hs_zero, data_lane_hs_zero; > + unsigned int i; > + > + timings = inno->pdata->inno_mipi_dphy_timing_table; > + > + inno_dsidphy_pll_calc_rate(inno, cfg->hs_clk_rate); > + > + /* Select MIPI mode */ > + phy_update_bits(inno, REGISTER_PART_LVDS, 0x03, > + MODE_ENABLE_MASK, MIPI_MODE_ENABLE); > + /* Configure PLL */ > + phy_update_bits(inno, REGISTER_PART_ANALOG, 0x03, > + REG_PREDIV_MASK, REG_PREDIV(inno->pll.prediv)); > + phy_update_bits(inno, REGISTER_PART_ANALOG, 0x03, > + REG_FBDIV_HI_MASK, REG_FBDIV_HI(inno->pll.fbdiv)); > + phy_update_bits(inno, REGISTER_PART_ANALOG, 0x04, > + REG_FBDIV_LO_MASK, REG_FBDIV_LO(inno->pll.fbdiv)); > + if (inno->pdata->max_rate == MAX_2_5GHZ) { > + phy_update_bits(inno, REGISTER_PART_ANALOG, 0x08, > + PLL_POST_DIV_ENABLE_MASK, PLL_POST_DIV_ENABLE); > + phy_update_bits(inno, REGISTER_PART_ANALOG, 0x0b, > + CLOCK_LANE_VOD_RANGE_SET_MASK, > + CLOCK_LANE_VOD_RANGE_SET(VOD_MAX_RANGE)); > + } > + /* Enable PLL and LDO */ > + phy_update_bits(inno, REGISTER_PART_ANALOG, 0x01, > + REG_LDOPD_MASK | REG_PLLPD_MASK, > + REG_LDOPD_POWER_ON | REG_PLLPD_POWER_ON); > + /* Reset analog */ > + phy_update_bits(inno, REGISTER_PART_ANALOG, 0x01, > + REG_SYNCRST_MASK, REG_SYNCRST_RESET); > + udelay(1); > + phy_update_bits(inno, REGISTER_PART_ANALOG, 0x01, > + REG_SYNCRST_MASK, REG_SYNCRST_NORMAL); > + /* Reset digital */ > + phy_update_bits(inno, REGISTER_PART_DIGITAL, 0x00, > + REG_DIG_RSTN_MASK, REG_DIG_RSTN_RESET); > + udelay(1); > + phy_update_bits(inno, REGISTER_PART_DIGITAL, 0x00, > + REG_DIG_RSTN_MASK, REG_DIG_RSTN_NORMAL); > + > + txbyteclkhs = inno->pll.rate / 8; > + t_txbyteclkhs = div_u64(PSEC_PER_SEC, txbyteclkhs); > + > + esc_clk_div = DIV_ROUND_UP(txbyteclkhs, 20000000); > + txclkesc = txbyteclkhs / esc_clk_div; > + t_txclkesc = div_u64(PSEC_PER_SEC, txclkesc); > + > + /* > + * The value of counter for HS Ths-exit > + * Ths-exit = Tpin_txbyteclkhs * value > + */ > + hs_exit = DIV_ROUND_UP(cfg->hs_exit, t_txbyteclkhs); > + /* > + * The value of counter for HS Tclk-post > + * Tclk-post = Tpin_txbyteclkhs * value > + */ > + clk_post = DIV_ROUND_UP(cfg->clk_post, t_txbyteclkhs); > + /* > + * The value of counter for HS Tclk-pre > + * Tclk-pre = Tpin_txbyteclkhs * value > + */ > + clk_pre = DIV_ROUND_UP(cfg->clk_pre, BITS_PER_BYTE); > + > + /* > + * The value of counter for HS Tta-go > + * Tta-go for turnaround > + * Tta-go = Ttxclkesc * value > + */ > + ta_go = DIV_ROUND_UP(cfg->ta_go, t_txclkesc); > + /* > + * The value of counter for HS Tta-sure > + * Tta-sure for turnaround > + * Tta-sure = Ttxclkesc * value > + */ > + ta_sure = DIV_ROUND_UP(cfg->ta_sure, t_txclkesc); > + /* > + * The value of counter for HS Tta-wait > + * Tta-wait for turnaround > + * Tta-wait = Ttxclkesc * value > + */ > + ta_wait = DIV_ROUND_UP(cfg->ta_get, t_txclkesc); > + > + for (i = 0; i < inno->pdata->num_timings; i++) > + if (inno->pll.rate <= timings[i].rate) > + break; > + > + if (i == inno->pdata->num_timings) > + --i; > + > + /* > + * The value of counter for HS Tlpx Time > + * Tlpx = Tpin_txbyteclkhs * (2 + value) > + */ > + if (inno->pdata->max_rate == MAX_1GHZ) { > + lpx = DIV_ROUND_UP(cfg->lpx, t_txbyteclkhs); > + if (lpx >= 2) > + lpx -= 2; > + } else { > + lpx = timings[i].lpx; > + } > + > + hs_prepare = timings[i].hs_prepare; > + hs_trail = timings[i].hs_trail; > + clk_lane_hs_zero = timings[i].clk_lane_hs_zero; > + data_lane_hs_zero = timings[i].data_lane_hs_zero; > + wakeup = 0x3ff; > + > + for (i = REGISTER_PART_CLOCK_LANE; i <= REGISTER_PART_DATA3_LANE; i++) { > + if (i == REGISTER_PART_CLOCK_LANE) > + hs_zero = clk_lane_hs_zero; > + else > + hs_zero = data_lane_hs_zero; > + > + phy_update_bits(inno, i, 0x05, T_LPX_CNT_MASK, > + T_LPX_CNT(lpx)); > + phy_update_bits(inno, i, 0x06, T_HS_PREPARE_CNT_MASK, > + T_HS_PREPARE_CNT(hs_prepare)); > + if (inno->pdata->max_rate == MAX_2_5GHZ) > + phy_update_bits(inno, i, 0x06, T_HS_ZERO_CNT_HI_MASK, > + T_HS_ZERO_CNT_HI(hs_zero >> 6)); > + phy_update_bits(inno, i, 0x07, T_HS_ZERO_CNT_LO_MASK, > + T_HS_ZERO_CNT_LO(hs_zero)); > + phy_update_bits(inno, i, 0x08, T_HS_TRAIL_CNT_MASK, > + T_HS_TRAIL_CNT(hs_trail)); > + if (inno->pdata->max_rate == MAX_2_5GHZ) > + phy_update_bits(inno, i, 0x11, T_HS_EXIT_CNT_HI_MASK, > + T_HS_EXIT_CNT_HI(hs_exit >> 5)); > + phy_update_bits(inno, i, 0x09, T_HS_EXIT_CNT_LO_MASK, > + T_HS_EXIT_CNT_LO(hs_exit)); > + if (inno->pdata->max_rate == MAX_2_5GHZ) > + phy_update_bits(inno, i, 0x10, T_CLK_POST_CNT_HI_MASK, > + T_CLK_POST_CNT_HI(clk_post >> 4)); > + phy_update_bits(inno, i, 0x0a, T_CLK_POST_CNT_LO_MASK, > + T_CLK_POST_CNT_LO(clk_post)); > + phy_update_bits(inno, i, 0x0e, T_CLK_PRE_CNT_MASK, > + T_CLK_PRE_CNT(clk_pre)); > + phy_update_bits(inno, i, 0x0c, T_WAKEUP_CNT_HI_MASK, > + T_WAKEUP_CNT_HI(wakeup >> 8)); > + phy_update_bits(inno, i, 0x0d, T_WAKEUP_CNT_LO_MASK, > + T_WAKEUP_CNT_LO(wakeup)); > + phy_update_bits(inno, i, 0x10, T_TA_GO_CNT_MASK, > + T_TA_GO_CNT(ta_go)); > + phy_update_bits(inno, i, 0x11, T_TA_SURE_CNT_MASK, > + T_TA_SURE_CNT(ta_sure)); > + phy_update_bits(inno, i, 0x12, T_TA_WAIT_CNT_MASK, > + T_TA_WAIT_CNT(ta_wait)); > + } > + > + /* Enable all lanes on analog part */ > + phy_update_bits(inno, REGISTER_PART_ANALOG, 0x00, > + LANE_EN_MASK, LANE_EN_CK | LANE_EN_3 | LANE_EN_2 | > + LANE_EN_1 | LANE_EN_0); > +} > + > +static int inno_dsidphy_power_on(struct phy *phy) > +{ > + struct inno_dsidphy *inno = dev_get_priv(phy->dev); > + > + clk_prepare_enable(inno->pclk_phy); > + clk_prepare_enable(inno->ref_clk); > + > + /* Bandgap power on */ > + phy_update_bits(inno, REGISTER_PART_ANALOG, 0x00, > + BANDGAP_POWER_MASK, BANDGAP_POWER_ON); > + /* Enable power work */ > + phy_update_bits(inno, REGISTER_PART_ANALOG, 0x00, > + POWER_WORK_MASK, POWER_WORK_ENABLE); > + > + inno_dsidphy_mipi_mode_enable(inno); > + > + return 0; > +} > + > +static int inno_dsidphy_power_off(struct phy *phy) > +{ > + struct inno_dsidphy *inno = dev_get_priv(phy->dev); > + > + phy_update_bits(inno, REGISTER_PART_ANALOG, 0x00, LANE_EN_MASK, 0); > + phy_update_bits(inno, REGISTER_PART_ANALOG, 0x01, > + REG_LDOPD_MASK | REG_PLLPD_MASK, > + REG_LDOPD_POWER_DOWN | REG_PLLPD_POWER_DOWN); > + phy_update_bits(inno, REGISTER_PART_ANALOG, 0x00, > + POWER_WORK_MASK, POWER_WORK_DISABLE); > + phy_update_bits(inno, REGISTER_PART_ANALOG, 0x00, > + BANDGAP_POWER_MASK, BANDGAP_POWER_DOWN); > + > + phy_update_bits(inno, REGISTER_PART_LVDS, 0x0b, LVDS_LANE_EN_MASK, 0); > + phy_update_bits(inno, REGISTER_PART_LVDS, 0x01, > + LVDS_DIGITAL_INTERNAL_ENABLE_MASK, > + LVDS_DIGITAL_INTERNAL_DISABLE); > + phy_update_bits(inno, REGISTER_PART_LVDS, 0x0b, > + LVDS_PLL_POWER_MASK | LVDS_BANDGAP_POWER_MASK, > + LVDS_PLL_POWER_OFF | LVDS_BANDGAP_POWER_DOWN); > + > + clk_disable_unprepare(inno->ref_clk); > + clk_disable_unprepare(inno->pclk_phy); > + > + return 0; > +} > + > +static int inno_dsidphy_configure(struct phy *phy, void *params) > +{ > + struct inno_dsidphy *inno = dev_get_priv(phy->dev); > + struct phy_configure_opts_mipi_dphy *config = params; > + int ret; > + > + ret = phy_mipi_dphy_config_validate(config); > + if (ret) > + return ret; > + > + memcpy(&inno->dphy_cfg, config, sizeof(inno->dphy_cfg)); > + > + return 0; > +} > + > +static const struct phy_ops inno_dsidphy_ops = { > + .configure = inno_dsidphy_configure, > + .power_on = inno_dsidphy_power_on, > + .power_off = inno_dsidphy_power_off, > +}; > + > +static const struct inno_video_phy_plat_data max_1ghz_video_phy_plat_data = { > + .inno_mipi_dphy_timing_table = inno_mipi_dphy_timing_table_max_1ghz, > + .num_timings = ARRAY_SIZE(inno_mipi_dphy_timing_table_max_1ghz), > + .max_rate = MAX_1GHZ, > +}; > + > +static const struct inno_video_phy_plat_data max_2_5ghz_video_phy_plat_data = { > + .inno_mipi_dphy_timing_table = inno_mipi_dphy_timing_table_max_2_5ghz, > + .num_timings = ARRAY_SIZE(inno_mipi_dphy_timing_table_max_2_5ghz), > + .max_rate = MAX_2_5GHZ, > +}; > + > +static int inno_dsidphy_probe(struct udevice *dev) > +{ > + struct inno_dsidphy *inno = dev_get_priv(dev); > + int ret; > + > + inno->dev = dev; > + inno->pdata = (const struct inno_video_phy_plat_data *)dev_get_driver_data(dev); > + > + inno->phy_base = dev_read_addr_ptr(dev); > + if (IS_ERR(inno->phy_base)) > + return PTR_ERR(inno->phy_base); > + > + inno->ref_clk = devm_clk_get(dev, "ref"); > + if (IS_ERR(inno->ref_clk)) { > + ret = PTR_ERR(inno->ref_clk); > + dev_err(dev, "failed to get ref clock: %d\n", ret); > + return ret; > + } > + > + inno->pclk_phy = devm_clk_get(dev, "pclk"); > + if (IS_ERR(inno->pclk_phy)) { > + ret = PTR_ERR(inno->pclk_phy); > + dev_err(dev, "failed to get phy pclk: %d\n", ret); > + return ret; > + } > + > + inno->rst = devm_reset_control_get(dev, "apb"); > + if (IS_ERR(inno->rst)) { > + ret = PTR_ERR(inno->rst); > + dev_err(dev, "failed to get system reset control: %d\n", ret); > + return ret; > + } > + > + return 0; > +} > + > +static const struct udevice_id inno_dsidphy_of_match[] = { > + { > + .compatible = "rockchip,px30-dsi-dphy", > + .data = (long)&max_1ghz_video_phy_plat_data, > + }, { > + .compatible = "rockchip,rk3128-dsi-dphy", > + .data = (long)&max_1ghz_video_phy_plat_data, > + }, { > + .compatible = "rockchip,rk3368-dsi-dphy", > + .data = (long)&max_1ghz_video_phy_plat_data, > + }, { > + .compatible = "rockchip,rk3568-dsi-dphy", > + .data = (long)&max_2_5ghz_video_phy_plat_data, > + }, > + {} > +}; > + > +U_BOOT_DRIVER(rockchip_inno_dsidphy) = { > + .name = "rockchip-inno-dsidphy", > + .id = UCLASS_PHY, > + .of_match = inno_dsidphy_of_match, > + .probe = inno_dsidphy_probe, > + .ops = &inno_dsidphy_ops, > + .priv_auto = sizeof(struct inno_dsidphy), > +}; ^ permalink raw reply [flat|nested] 5+ messages in thread
* [PATCH 2/2] rockchip: video: Add support for RK3568 DSI Host 2023-03-24 18:53 [PATCH 0/2] rockchip: Add DSI support for RK3568 Chris Morgan 2023-03-24 18:53 ` [PATCH 1/2] drivers: phy: add Innosilicon DSI-DPHY driver Chris Morgan @ 2023-03-24 18:53 ` Chris Morgan 2023-04-14 8:53 ` Kever Yang 1 sibling, 1 reply; 5+ messages in thread From: Chris Morgan @ 2023-03-24 18:53 UTC (permalink / raw) To: u-boot Cc: yifeng.zhao, jagan, agust, kever.yang, philipp.tomsich, sjg, Chris Morgan From: Chris Morgan <macromorgan@hotmail.com> Add support for DSI Host controller on Rockchip RK3568. This driver is heavily based on the Rockchip dw_mipi_dsi_rockchip.c driver in Linux and the stm32_dsi.c driver in U-Boot. It should be easy to add support for other SoCs as the only missing component from the mainline driver is setting the VOP big or VOP little (which the rk3568 does not have). Driver was tested for use in sending commands to a DSI panel in order to obtain the panel ID. Signed-off-by: Chris Morgan <macromorgan@hotmail.com> --- drivers/video/dw_mipi_dsi.c | 9 + drivers/video/rockchip/Kconfig | 8 + drivers/video/rockchip/Makefile | 1 + drivers/video/rockchip/dw_mipi_dsi_rockchip.c | 898 ++++++++++++++++++ 4 files changed, 916 insertions(+) create mode 100644 drivers/video/rockchip/dw_mipi_dsi_rockchip.c diff --git a/drivers/video/dw_mipi_dsi.c b/drivers/video/dw_mipi_dsi.c index 6d9c5a9476..a4606923ff 100644 --- a/drivers/video/dw_mipi_dsi.c +++ b/drivers/video/dw_mipi_dsi.c @@ -806,6 +806,15 @@ static int dw_mipi_dsi_init(struct udevice *dev, return -EINVAL; } + /* + * The Rockchip based devices don't have px_clk, so simply move + * on. + */ + if (IS_ENABLED(CONFIG_DISPLAY_ROCKCHIP_DW_MIPI)) { + dw_mipi_dsi_bridge_set(dsi, timings); + return 0; + } + ret = clk_get_by_name(device->dev, "px_clk", &clk); if (ret) { dev_err(device->dev, "peripheral clock get error %d\n", ret); diff --git a/drivers/video/rockchip/Kconfig b/drivers/video/rockchip/Kconfig index b03866347b..01804dcb1c 100644 --- a/drivers/video/rockchip/Kconfig +++ b/drivers/video/rockchip/Kconfig @@ -69,4 +69,12 @@ config DISPLAY_ROCKCHIP_MIPI support. The mipi controller and dphy on rk3288& rk3399 support 16,18, 24 bits per pixel with up to 2k resolution ratio. +config DISPLAY_ROCKCHIP_DW_MIPI + bool "Rockchip Designware MIPI" + depends on VIDEO_ROCKCHIP + select VIDEO_DW_MIPI_DSI + help + Select the Designware MIPI DSI controller in use on some Rockchip + SOCs. + endif diff --git a/drivers/video/rockchip/Makefile b/drivers/video/rockchip/Makefile index 9aced5ef3f..8128289cc8 100644 --- a/drivers/video/rockchip/Makefile +++ b/drivers/video/rockchip/Makefile @@ -15,4 +15,5 @@ obj-$(CONFIG_DISPLAY_ROCKCHIP_HDMI) += rk_hdmi.o $(obj-hdmi-y) obj-mipi-$(CONFIG_ROCKCHIP_RK3288) += rk3288_mipi.o obj-mipi-$(CONFIG_ROCKCHIP_RK3399) += rk3399_mipi.o obj-$(CONFIG_DISPLAY_ROCKCHIP_MIPI) += rk_mipi.o $(obj-mipi-y) +obj-$(CONFIG_DISPLAY_ROCKCHIP_DW_MIPI) += dw_mipi_dsi_rockchip.o endif diff --git a/drivers/video/rockchip/dw_mipi_dsi_rockchip.c b/drivers/video/rockchip/dw_mipi_dsi_rockchip.c new file mode 100644 index 0000000000..ca548a60b7 --- /dev/null +++ b/drivers/video/rockchip/dw_mipi_dsi_rockchip.c @@ -0,0 +1,898 @@ +// SPDX-License-Identifier: GPL-2.0+ +/* + * Author(s): Chris Morgan <macromorgan@hotmail.com> + * + * This MIPI DSI controller driver is heavily based on the Linux Kernel + * driver from drivers/gpu/drm/rockchip/dw-mipi-dsi-rockchip.c and the + * U-Boot driver from drivers/video/stm32/stm32_dsi.c. + */ + +#define LOG_CATEGORY UCLASS_VIDEO_BRIDGE + +#include <clk.h> +#include <dm.h> +#include <div64.h> +#include <dsi_host.h> +#include <generic-phy.h> +#include <mipi_dsi.h> +#include <panel.h> +#include <phy-mipi-dphy.h> +#include <reset.h> +#include <video_bridge.h> +#include <dm/device_compat.h> +#include <dm/lists.h> +#include <linux/iopoll.h> + +#include <common.h> +#include <log.h> +#include <video.h> +#include <asm/io.h> +#include <dm/device-internal.h> +#include <linux/bitops.h> + +#define USEC_PER_SEC 1000000L + +/* + * DSI wrapper registers & bit definitions + * Note: registers are named as in the Reference Manual + */ +#define DSI_WCR 0x0404 /* Wrapper Control Reg */ +#define WCR_DSIEN BIT(3) /* DSI ENable */ + +#define DSI_PHY_TST_CTRL0 0xb4 +#define PHY_TESTCLK BIT(1) +#define PHY_UNTESTCLK 0 +#define PHY_TESTCLR BIT(0) +#define PHY_UNTESTCLR 0 + +#define DSI_PHY_TST_CTRL1 0xb8 +#define PHY_TESTEN BIT(16) +#define PHY_UNTESTEN 0 +#define PHY_TESTDOUT(n) (((n) & 0xff) << 8) +#define PHY_TESTDIN(n) (((n) & 0xff) << 0) + +#define BYPASS_VCO_RANGE BIT(7) +#define VCO_RANGE_CON_SEL(val) (((val) & 0x7) << 3) +#define VCO_IN_CAP_CON_DEFAULT (0x0 << 1) +#define VCO_IN_CAP_CON_LOW (0x1 << 1) +#define VCO_IN_CAP_CON_HIGH (0x2 << 1) +#define REF_BIAS_CUR_SEL BIT(0) + +#define CP_CURRENT_3UA 0x1 +#define CP_CURRENT_4_5UA 0x2 +#define CP_CURRENT_7_5UA 0x6 +#define CP_CURRENT_6UA 0x9 +#define CP_CURRENT_12UA 0xb +#define CP_CURRENT_SEL(val) ((val) & 0xf) +#define CP_PROGRAM_EN BIT(7) + +#define LPF_RESISTORS_15_5KOHM 0x1 +#define LPF_RESISTORS_13KOHM 0x2 +#define LPF_RESISTORS_11_5KOHM 0x4 +#define LPF_RESISTORS_10_5KOHM 0x8 +#define LPF_RESISTORS_8KOHM 0x10 +#define LPF_PROGRAM_EN BIT(6) +#define LPF_RESISTORS_SEL(val) ((val) & 0x3f) + +#define HSFREQRANGE_SEL(val) (((val) & 0x3f) << 1) + +#define INPUT_DIVIDER(val) (((val) - 1) & 0x7f) +#define LOW_PROGRAM_EN 0 +#define HIGH_PROGRAM_EN BIT(7) +#define LOOP_DIV_LOW_SEL(val) (((val) - 1) & 0x1f) +#define LOOP_DIV_HIGH_SEL(val) ((((val) - 1) >> 5) & 0xf) +#define PLL_LOOP_DIV_EN BIT(5) +#define PLL_INPUT_DIV_EN BIT(4) + +#define POWER_CONTROL BIT(6) +#define INTERNAL_REG_CURRENT BIT(3) +#define BIAS_BLOCK_ON BIT(2) +#define BANDGAP_ON BIT(0) + +#define TER_RESISTOR_HIGH BIT(7) +#define TER_RESISTOR_LOW 0 +#define LEVEL_SHIFTERS_ON BIT(6) +#define TER_CAL_DONE BIT(5) +#define SETRD_MAX (0x7 << 2) +#define POWER_MANAGE BIT(1) +#define TER_RESISTORS_ON BIT(0) + +#define BIASEXTR_SEL(val) ((val) & 0x7) +#define BANDGAP_SEL(val) ((val) & 0x7) +#define TLP_PROGRAM_EN BIT(7) +#define THS_PRE_PROGRAM_EN BIT(7) +#define THS_ZERO_PROGRAM_EN BIT(6) + +#define PLL_BIAS_CUR_SEL_CAP_VCO_CONTROL 0x10 +#define PLL_CP_CONTROL_PLL_LOCK_BYPASS 0x11 +#define PLL_LPF_AND_CP_CONTROL 0x12 +#define PLL_INPUT_DIVIDER_RATIO 0x17 +#define PLL_LOOP_DIVIDER_RATIO 0x18 +#define PLL_INPUT_AND_LOOP_DIVIDER_RATIOS_CONTROL 0x19 +#define BANDGAP_AND_BIAS_CONTROL 0x20 +#define TERMINATION_RESISTER_CONTROL 0x21 +#define AFE_BIAS_BANDGAP_ANALOG_PROGRAMMABILITY 0x22 +#define HS_RX_CONTROL_OF_LANE_CLK 0x34 +#define HS_RX_CONTROL_OF_LANE_0 0x44 +#define HS_RX_CONTROL_OF_LANE_1 0x54 +#define HS_TX_CLOCK_LANE_REQUEST_STATE_TIME_CONTROL 0x60 +#define HS_TX_CLOCK_LANE_PREPARE_STATE_TIME_CONTROL 0x61 +#define HS_TX_CLOCK_LANE_HS_ZERO_STATE_TIME_CONTROL 0x62 +#define HS_TX_CLOCK_LANE_TRAIL_STATE_TIME_CONTROL 0x63 +#define HS_TX_CLOCK_LANE_EXIT_STATE_TIME_CONTROL 0x64 +#define HS_TX_CLOCK_LANE_POST_TIME_CONTROL 0x65 +#define HS_TX_DATA_LANE_REQUEST_STATE_TIME_CONTROL 0x70 +#define HS_TX_DATA_LANE_PREPARE_STATE_TIME_CONTROL 0x71 +#define HS_TX_DATA_LANE_HS_ZERO_STATE_TIME_CONTROL 0x72 +#define HS_TX_DATA_LANE_TRAIL_STATE_TIME_CONTROL 0x73 +#define HS_TX_DATA_LANE_EXIT_STATE_TIME_CONTROL 0x74 +#define HS_RX_DATA_LANE_THS_SETTLE_CONTROL 0x75 +#define HS_RX_CONTROL_OF_LANE_2 0x84 +#define HS_RX_CONTROL_OF_LANE_3 0x94 + +#define RK3568_GRF_VO_CON2 0x0368 +#define RK3568_DSI0_SKEWCALHS (0x1f << 11) +#define RK3568_DSI0_FORCETXSTOPMODE (0xf << 4) +#define RK3568_DSI0_TURNDISABLE BIT(2) +#define RK3568_DSI0_FORCERXMODE BIT(0) + +/* + * Note these registers do not appear in the datasheet, they are + * however present in the BSP driver which is where these values + * come from. Name GRF_VO_CON3 is assumed. + */ +#define RK3568_GRF_VO_CON3 0x36c +#define RK3568_DSI1_SKEWCALHS (0x1f << 11) +#define RK3568_DSI1_FORCETXSTOPMODE (0xf << 4) +#define RK3568_DSI1_TURNDISABLE BIT(2) +#define RK3568_DSI1_FORCERXMODE BIT(0) + +#define HIWORD_UPDATE(val, mask) (val | (mask) << 16) + +/* Timeout for regulator on/off, pll lock/unlock & fifo empty */ +#define TIMEOUT_US 200000 + +enum { + BANDGAP_97_07, + BANDGAP_98_05, + BANDGAP_99_02, + BANDGAP_100_00, + BANDGAP_93_17, + BANDGAP_94_15, + BANDGAP_95_12, + BANDGAP_96_10, +}; + +enum { + BIASEXTR_87_1, + BIASEXTR_91_5, + BIASEXTR_95_9, + BIASEXTR_100, + BIASEXTR_105_94, + BIASEXTR_111_88, + BIASEXTR_118_8, + BIASEXTR_127_7, +}; + +struct rockchip_dw_dsi_chip_data { + u32 reg; + + u32 lcdsel_grf_reg; + u32 lcdsel_big; + u32 lcdsel_lit; + + u32 enable_grf_reg; + u32 enable; + + u32 lanecfg1_grf_reg; + u32 lanecfg1; + u32 lanecfg2_grf_reg; + u32 lanecfg2; + + unsigned int flags; + unsigned int max_data_lanes; +}; + +struct dw_rockchip_dsi_priv { + struct mipi_dsi_device device; + void __iomem *base; + struct udevice *panel; + + /* Optional external dphy */ + struct phy phy; + struct phy_configure_opts_mipi_dphy phy_opts; + + struct clk *pclk; + struct clk *ref; + struct reset_ctl *rst; + unsigned int lane_mbps; /* per lane */ + u16 input_div; + u16 feedback_div; + const struct rockchip_dw_dsi_chip_data *cdata; + struct udevice *dsi_host; +}; + +static inline void dsi_write(struct dw_rockchip_dsi_priv *dsi, u32 reg, u32 val) +{ + writel(val, dsi->base + reg); +} + +static inline u32 dsi_read(struct dw_rockchip_dsi_priv *dsi, u32 reg) +{ + return readl(dsi->base + reg); +} + +static inline void dsi_set(struct dw_rockchip_dsi_priv *dsi, u32 reg, u32 mask) +{ + dsi_write(dsi, reg, dsi_read(dsi, reg) | mask); +} + +static inline void dsi_clear(struct dw_rockchip_dsi_priv *dsi, u32 reg, u32 mask) +{ + dsi_write(dsi, reg, dsi_read(dsi, reg) & ~mask); +} + +static inline void dsi_update_bits(struct dw_rockchip_dsi_priv *dsi, u32 reg, + u32 mask, u32 val) +{ + dsi_write(dsi, reg, (dsi_read(dsi, reg) & ~mask) | val); +} + +static void dw_mipi_dsi_phy_write(struct dw_rockchip_dsi_priv *dsi, + u8 test_code, + u8 test_data) +{ + /* + * With the falling edge on TESTCLK, the TESTDIN[7:0] signal content + * is latched internally as the current test code. Test data is + * programmed internally by rising edge on TESTCLK. + */ + dsi_write(dsi, DSI_PHY_TST_CTRL0, PHY_TESTCLK | PHY_UNTESTCLR); + + dsi_write(dsi, DSI_PHY_TST_CTRL1, PHY_TESTEN | PHY_TESTDOUT(0) | + PHY_TESTDIN(test_code)); + + dsi_write(dsi, DSI_PHY_TST_CTRL0, PHY_UNTESTCLK | PHY_UNTESTCLR); + + dsi_write(dsi, DSI_PHY_TST_CTRL1, PHY_UNTESTEN | PHY_TESTDOUT(0) | + PHY_TESTDIN(test_data)); + + dsi_write(dsi, DSI_PHY_TST_CTRL0, PHY_TESTCLK | PHY_UNTESTCLR); +} + +struct dphy_pll_parameter_map { + unsigned int max_mbps; + u8 hsfreqrange; + u8 icpctrl; + u8 lpfctrl; +}; + +/* The table is based on 27MHz DPHY pll reference clock. */ +static const struct dphy_pll_parameter_map dppa_map[] = { + { 89, 0x00, CP_CURRENT_3UA, LPF_RESISTORS_13KOHM }, + { 99, 0x10, CP_CURRENT_3UA, LPF_RESISTORS_13KOHM }, + { 109, 0x20, CP_CURRENT_3UA, LPF_RESISTORS_13KOHM }, + { 129, 0x01, CP_CURRENT_3UA, LPF_RESISTORS_15_5KOHM }, + { 139, 0x11, CP_CURRENT_3UA, LPF_RESISTORS_15_5KOHM }, + { 149, 0x21, CP_CURRENT_3UA, LPF_RESISTORS_15_5KOHM }, + { 169, 0x02, CP_CURRENT_6UA, LPF_RESISTORS_13KOHM }, + { 179, 0x12, CP_CURRENT_6UA, LPF_RESISTORS_13KOHM }, + { 199, 0x22, CP_CURRENT_6UA, LPF_RESISTORS_13KOHM }, + { 219, 0x03, CP_CURRENT_4_5UA, LPF_RESISTORS_13KOHM }, + { 239, 0x13, CP_CURRENT_4_5UA, LPF_RESISTORS_13KOHM }, + { 249, 0x23, CP_CURRENT_4_5UA, LPF_RESISTORS_13KOHM }, + { 269, 0x04, CP_CURRENT_6UA, LPF_RESISTORS_11_5KOHM }, + { 299, 0x14, CP_CURRENT_6UA, LPF_RESISTORS_11_5KOHM }, + { 329, 0x05, CP_CURRENT_3UA, LPF_RESISTORS_15_5KOHM }, + { 359, 0x15, CP_CURRENT_3UA, LPF_RESISTORS_15_5KOHM }, + { 399, 0x25, CP_CURRENT_3UA, LPF_RESISTORS_15_5KOHM }, + { 449, 0x06, CP_CURRENT_7_5UA, LPF_RESISTORS_11_5KOHM }, + { 499, 0x16, CP_CURRENT_7_5UA, LPF_RESISTORS_11_5KOHM }, + { 549, 0x07, CP_CURRENT_7_5UA, LPF_RESISTORS_10_5KOHM }, + { 599, 0x17, CP_CURRENT_7_5UA, LPF_RESISTORS_10_5KOHM }, + { 649, 0x08, CP_CURRENT_7_5UA, LPF_RESISTORS_11_5KOHM }, + { 699, 0x18, CP_CURRENT_7_5UA, LPF_RESISTORS_11_5KOHM }, + { 749, 0x09, CP_CURRENT_7_5UA, LPF_RESISTORS_11_5KOHM }, + { 799, 0x19, CP_CURRENT_7_5UA, LPF_RESISTORS_11_5KOHM }, + { 849, 0x29, CP_CURRENT_7_5UA, LPF_RESISTORS_11_5KOHM }, + { 899, 0x39, CP_CURRENT_7_5UA, LPF_RESISTORS_11_5KOHM }, + { 949, 0x0a, CP_CURRENT_12UA, LPF_RESISTORS_8KOHM }, + { 999, 0x1a, CP_CURRENT_12UA, LPF_RESISTORS_8KOHM }, + {1049, 0x2a, CP_CURRENT_12UA, LPF_RESISTORS_8KOHM }, + {1099, 0x3a, CP_CURRENT_12UA, LPF_RESISTORS_8KOHM }, + {1149, 0x0b, CP_CURRENT_12UA, LPF_RESISTORS_10_5KOHM }, + {1199, 0x1b, CP_CURRENT_12UA, LPF_RESISTORS_10_5KOHM }, + {1249, 0x2b, CP_CURRENT_12UA, LPF_RESISTORS_10_5KOHM }, + {1299, 0x3b, CP_CURRENT_12UA, LPF_RESISTORS_10_5KOHM }, + {1349, 0x0c, CP_CURRENT_12UA, LPF_RESISTORS_10_5KOHM }, + {1399, 0x1c, CP_CURRENT_12UA, LPF_RESISTORS_10_5KOHM }, + {1449, 0x2c, CP_CURRENT_12UA, LPF_RESISTORS_10_5KOHM }, + {1500, 0x3c, CP_CURRENT_12UA, LPF_RESISTORS_10_5KOHM } +}; + +static int max_mbps_to_parameter(unsigned int max_mbps) +{ + int i; + + for (i = 0; i < ARRAY_SIZE(dppa_map); i++) + if (dppa_map[i].max_mbps >= max_mbps) + return i; + + return -EINVAL; +} + +/* + * ns2bc - Nanoseconds to byte clock cycles + */ +static inline unsigned int ns2bc(struct dw_rockchip_dsi_priv *dsi, int ns) +{ + return DIV_ROUND_UP(ns * dsi->lane_mbps / 8, 1000); +} + +/* + * ns2ui - Nanoseconds to UI time periods + */ +static inline unsigned int ns2ui(struct dw_rockchip_dsi_priv *dsi, int ns) +{ + return DIV_ROUND_UP(ns * dsi->lane_mbps, 1000); +} + +static int dsi_phy_init(void *priv_data) +{ + struct mipi_dsi_device *device = priv_data; + struct udevice *dev = device->dev; + struct dw_rockchip_dsi_priv *dsi = dev_get_priv(dev); + int ret, i, vco; + + if (&dsi->phy) { + ret = generic_phy_configure(&dsi->phy, &dsi->phy_opts); + if (ret) { + dev_err(dsi->dsi_host, + "Configure external dphy fail %d\n", + ret); + return ret; + } + + ret = generic_phy_power_on(&dsi->phy); + if (ret) { + dev_err(dsi->dsi_host, + "Generic phy power on fail %d\n", ret); + return ret; + } + + return 0; + } + + /* + * Get vco from frequency(lane_mbps) + * vco frequency table + * 000 - between 80 and 200 MHz + * 001 - between 200 and 300 MHz + * 010 - between 300 and 500 MHz + * 011 - between 500 and 700 MHz + * 100 - between 700 and 900 MHz + * 101 - between 900 and 1100 MHz + * 110 - between 1100 and 1300 MHz + * 111 - between 1300 and 1500 MHz + */ + vco = (dsi->lane_mbps < 200) ? 0 : (dsi->lane_mbps + 100) / 200; + + i = max_mbps_to_parameter(dsi->lane_mbps); + if (i < 0) { + dev_err(dsi->dsi_host, + "failed to get parameter for %dmbps clock\n", + dsi->lane_mbps); + return i; + } + + dw_mipi_dsi_phy_write(dsi, PLL_BIAS_CUR_SEL_CAP_VCO_CONTROL, + BYPASS_VCO_RANGE | + VCO_RANGE_CON_SEL(vco) | + VCO_IN_CAP_CON_LOW | + REF_BIAS_CUR_SEL); + + dw_mipi_dsi_phy_write(dsi, PLL_CP_CONTROL_PLL_LOCK_BYPASS, + CP_CURRENT_SEL(dppa_map[i].icpctrl)); + dw_mipi_dsi_phy_write(dsi, PLL_LPF_AND_CP_CONTROL, + CP_PROGRAM_EN | LPF_PROGRAM_EN | + LPF_RESISTORS_SEL(dppa_map[i].lpfctrl)); + + dw_mipi_dsi_phy_write(dsi, HS_RX_CONTROL_OF_LANE_0, + HSFREQRANGE_SEL(dppa_map[i].hsfreqrange)); + + dw_mipi_dsi_phy_write(dsi, PLL_INPUT_DIVIDER_RATIO, + INPUT_DIVIDER(dsi->input_div)); + dw_mipi_dsi_phy_write(dsi, PLL_LOOP_DIVIDER_RATIO, + LOOP_DIV_LOW_SEL(dsi->feedback_div) | + LOW_PROGRAM_EN); + /* + * We need set PLL_INPUT_AND_LOOP_DIVIDER_RATIOS_CONTROL immediately + * to make the configured LSB effective according to IP simulation + * and lab test results. + * Only in this way can we get correct mipi phy pll frequency. + */ + dw_mipi_dsi_phy_write(dsi, PLL_INPUT_AND_LOOP_DIVIDER_RATIOS_CONTROL, + PLL_LOOP_DIV_EN | PLL_INPUT_DIV_EN); + dw_mipi_dsi_phy_write(dsi, PLL_LOOP_DIVIDER_RATIO, + LOOP_DIV_HIGH_SEL(dsi->feedback_div) | + HIGH_PROGRAM_EN); + dw_mipi_dsi_phy_write(dsi, PLL_INPUT_AND_LOOP_DIVIDER_RATIOS_CONTROL, + PLL_LOOP_DIV_EN | PLL_INPUT_DIV_EN); + + dw_mipi_dsi_phy_write(dsi, AFE_BIAS_BANDGAP_ANALOG_PROGRAMMABILITY, + LOW_PROGRAM_EN | BIASEXTR_SEL(BIASEXTR_127_7)); + dw_mipi_dsi_phy_write(dsi, AFE_BIAS_BANDGAP_ANALOG_PROGRAMMABILITY, + HIGH_PROGRAM_EN | BANDGAP_SEL(BANDGAP_96_10)); + + dw_mipi_dsi_phy_write(dsi, BANDGAP_AND_BIAS_CONTROL, + POWER_CONTROL | INTERNAL_REG_CURRENT | + BIAS_BLOCK_ON | BANDGAP_ON); + + dw_mipi_dsi_phy_write(dsi, TERMINATION_RESISTER_CONTROL, + TER_RESISTOR_LOW | TER_CAL_DONE | + SETRD_MAX | TER_RESISTORS_ON); + dw_mipi_dsi_phy_write(dsi, TERMINATION_RESISTER_CONTROL, + TER_RESISTOR_HIGH | LEVEL_SHIFTERS_ON | + SETRD_MAX | POWER_MANAGE | + TER_RESISTORS_ON); + + dw_mipi_dsi_phy_write(dsi, HS_TX_CLOCK_LANE_REQUEST_STATE_TIME_CONTROL, + TLP_PROGRAM_EN | ns2bc(dsi, 500)); + dw_mipi_dsi_phy_write(dsi, HS_TX_CLOCK_LANE_PREPARE_STATE_TIME_CONTROL, + THS_PRE_PROGRAM_EN | ns2ui(dsi, 40)); + dw_mipi_dsi_phy_write(dsi, HS_TX_CLOCK_LANE_HS_ZERO_STATE_TIME_CONTROL, + THS_ZERO_PROGRAM_EN | ns2bc(dsi, 300)); + dw_mipi_dsi_phy_write(dsi, HS_TX_CLOCK_LANE_TRAIL_STATE_TIME_CONTROL, + THS_PRE_PROGRAM_EN | ns2ui(dsi, 100)); + dw_mipi_dsi_phy_write(dsi, HS_TX_CLOCK_LANE_EXIT_STATE_TIME_CONTROL, + BIT(5) | ns2bc(dsi, 100)); + dw_mipi_dsi_phy_write(dsi, HS_TX_CLOCK_LANE_POST_TIME_CONTROL, + BIT(5) | (ns2bc(dsi, 60) + 7)); + + dw_mipi_dsi_phy_write(dsi, HS_TX_DATA_LANE_REQUEST_STATE_TIME_CONTROL, + TLP_PROGRAM_EN | ns2bc(dsi, 500)); + dw_mipi_dsi_phy_write(dsi, HS_TX_DATA_LANE_PREPARE_STATE_TIME_CONTROL, + THS_PRE_PROGRAM_EN | (ns2ui(dsi, 50) + 20)); + dw_mipi_dsi_phy_write(dsi, HS_TX_DATA_LANE_HS_ZERO_STATE_TIME_CONTROL, + THS_ZERO_PROGRAM_EN | (ns2bc(dsi, 140) + 2)); + dw_mipi_dsi_phy_write(dsi, HS_TX_DATA_LANE_TRAIL_STATE_TIME_CONTROL, + THS_PRE_PROGRAM_EN | (ns2ui(dsi, 60) + 8)); + dw_mipi_dsi_phy_write(dsi, HS_TX_DATA_LANE_EXIT_STATE_TIME_CONTROL, + BIT(5) | ns2bc(dsi, 100)); + + return ret; +} + +static void dsi_phy_post_set_mode(void *priv_data, unsigned long mode_flags) +{ + struct mipi_dsi_device *device = priv_data; + struct udevice *dev = device->dev; + struct dw_rockchip_dsi_priv *dsi = dev_get_priv(dev); + + dev_dbg(dev, "Set mode %p enable %ld\n", dsi, + mode_flags & MIPI_DSI_MODE_VIDEO); + + if (!dsi) + return; + + /* + * DSI wrapper must be enabled in video mode & disabled in command mode. + * If wrapper is enabled in command mode, the display controller + * register access will hang. Note that this was carried over from the + * stm32 dsi driver and is unknown if necessary for Rockchip. + */ + + if (mode_flags & MIPI_DSI_MODE_VIDEO) + dsi_set(dsi, DSI_WCR, WCR_DSIEN); + else + dsi_clear(dsi, DSI_WCR, WCR_DSIEN); +} + +static int +dw_mipi_dsi_get_lane_mbps(void *priv_data, struct display_timing *timings, + u32 lanes, u32 format, unsigned int *lane_mbps) +{ + struct mipi_dsi_device *device = priv_data; + struct udevice *dev = device->dev; + struct dw_rockchip_dsi_priv *dsi = dev_get_priv(dev); + int bpp; + unsigned long mpclk, tmp; + unsigned int target_mbps = 1000; + unsigned int max_mbps = dppa_map[ARRAY_SIZE(dppa_map) - 1].max_mbps; + unsigned long best_freq = 0; + unsigned long fvco_min, fvco_max, fin, fout; + unsigned int min_prediv, max_prediv; + unsigned int _prediv, best_prediv; + unsigned long _fbdiv, best_fbdiv; + unsigned long min_delta = ULONG_MAX; + unsigned int pllref_clk; + + bpp = mipi_dsi_pixel_format_to_bpp(format); + if (bpp < 0) { + dev_err(dsi->dsi_host, + "failed to get bpp for pixel format %d\n", + format); + return bpp; + } + + mpclk = DIV_ROUND_UP(timings->pixelclock.typ, 1000); + if (mpclk) { + /* take 1 / 0.8, since mbps must big than bandwidth of RGB */ + tmp = (mpclk * (bpp / lanes) * 10 / 8) / 1000; + if (tmp < max_mbps) + target_mbps = tmp; + else + dev_err(dsi->dsi_host, + "DPHY clock frequency is out of range\n"); + } + + /* for external phy only the mipi_dphy_config is necessary */ + if (&dsi->phy) { + phy_mipi_dphy_get_default_config(timings->pixelclock.typ * 10 / 8, + bpp, lanes, + &dsi->phy_opts); + dsi->lane_mbps = target_mbps; + *lane_mbps = dsi->lane_mbps; + + return 0; + } + + pllref_clk = clk_get_rate(dsi->ref); + fout = target_mbps * USEC_PER_SEC; + + /* constraint: 5Mhz <= Fref / N <= 40MHz */ + min_prediv = DIV_ROUND_UP(fin, 40 * USEC_PER_SEC); + max_prediv = fin / (5 * USEC_PER_SEC); + + /* constraint: 80MHz <= Fvco <= 1500Mhz */ + fvco_min = 80 * USEC_PER_SEC; + fvco_max = 1500 * USEC_PER_SEC; + + for (_prediv = min_prediv; _prediv <= max_prediv; _prediv++) { + u64 tmp; + u32 delta; + /* Fvco = Fref * M / N */ + tmp = (u64)fout * _prediv; + do_div(tmp, fin); + _fbdiv = tmp; + /* + * Due to the use of a "by 2 pre-scaler," the range of the + * feedback multiplication value M is limited to even division + * numbers, and m must be greater than 6, not bigger than 512. + */ + if (_fbdiv < 6 || _fbdiv > 512) + continue; + + _fbdiv += _fbdiv % 2; + + tmp = (u64)_fbdiv * fin; + do_div(tmp, _prediv); + if (tmp < fvco_min || tmp > fvco_max) + continue; + + delta = abs(fout - tmp); + if (delta < min_delta) { + best_prediv = _prediv; + best_fbdiv = _fbdiv; + min_delta = delta; + best_freq = tmp; + } + } + + if (best_freq) { + dsi->lane_mbps = DIV_ROUND_UP(best_freq, USEC_PER_SEC); + *lane_mbps = dsi->lane_mbps; + dsi->input_div = best_prediv; + dsi->feedback_div = best_fbdiv; + } else { + dev_err(dsi->dsi_host, "Can not find best_freq for DPHY\n"); + return -EINVAL; + } + + return 0; +} + +struct hstt { + unsigned int maxfreq; + struct mipi_dsi_phy_timing timing; +}; + +#define HSTT(_maxfreq, _c_lp2hs, _c_hs2lp, _d_lp2hs, _d_hs2lp) \ +{ \ + .maxfreq = _maxfreq, \ + .timing = { \ + .clk_lp2hs = _c_lp2hs, \ + .clk_hs2lp = _c_hs2lp, \ + .data_lp2hs = _d_lp2hs, \ + .data_hs2lp = _d_hs2lp, \ + } \ +} + +/* + * Table A-3 High-Speed Transition Times + * (Note spacing is deliberate for readability). + */ +static struct hstt hstt_table[] = { + HSTT( 90, 32, 20, 26, 13), + HSTT( 100, 35, 23, 28, 14), + HSTT( 110, 32, 22, 26, 13), + HSTT( 130, 31, 20, 27, 13), + HSTT( 140, 33, 22, 26, 14), + HSTT( 150, 33, 21, 26, 14), + HSTT( 170, 32, 20, 27, 13), + HSTT( 180, 36, 23, 30, 15), + HSTT( 200, 40, 22, 33, 15), + HSTT( 220, 40, 22, 33, 15), + HSTT( 240, 44, 24, 36, 16), + HSTT( 250, 48, 24, 38, 17), + HSTT( 270, 48, 24, 38, 17), + HSTT( 300, 50, 27, 41, 18), + HSTT( 330, 56, 28, 45, 18), + HSTT( 360, 59, 28, 48, 19), + HSTT( 400, 61, 30, 50, 20), + HSTT( 450, 67, 31, 55, 21), + HSTT( 500, 73, 31, 59, 22), + HSTT( 550, 79, 36, 63, 24), + HSTT( 600, 83, 37, 68, 25), + HSTT( 650, 90, 38, 73, 27), + HSTT( 700, 95, 40, 77, 28), + HSTT( 750, 102, 40, 84, 28), + HSTT( 800, 106, 42, 87, 30), + HSTT( 850, 113, 44, 93, 31), + HSTT( 900, 118, 47, 98, 32), + HSTT( 950, 124, 47, 102, 34), + HSTT(1000, 130, 49, 107, 35), + HSTT(1050, 135, 51, 111, 37), + HSTT(1100, 139, 51, 114, 38), + HSTT(1150, 146, 54, 120, 40), + HSTT(1200, 153, 57, 125, 41), + HSTT(1250, 158, 58, 130, 42), + HSTT(1300, 163, 58, 135, 44), + HSTT(1350, 168, 60, 140, 45), + HSTT(1400, 172, 64, 144, 47), + HSTT(1450, 176, 65, 148, 48), + HSTT(1500, 181, 66, 153, 50) +}; + +static int dw_mipi_dsi_rockchip_get_timing(void *priv_data, + unsigned int lane_mbps, + struct mipi_dsi_phy_timing *timing) +{ + int i; + + for (i = 0; i < ARRAY_SIZE(hstt_table); i++) + if (lane_mbps < hstt_table[i].maxfreq) + break; + + if (i == ARRAY_SIZE(hstt_table)) + i--; + + *timing = hstt_table[i].timing; + + return 0; +} + +static const struct mipi_dsi_phy_ops dsi_rockchip_phy_ops = { + .init = dsi_phy_init, + .get_lane_mbps = dw_mipi_dsi_get_lane_mbps, + .get_timing = dw_mipi_dsi_rockchip_get_timing, + .post_set_mode = dsi_phy_post_set_mode, +}; + +static int dw_mipi_dsi_rockchip_attach(struct udevice *dev) +{ + struct dw_rockchip_dsi_priv *priv = dev_get_priv(dev); + struct mipi_dsi_device *device = &priv->device; + struct mipi_dsi_panel_plat *mplat; + struct display_timing timings; + int ret; + + ret = uclass_first_device_err(UCLASS_PANEL, &priv->panel); + if (ret) { + dev_err(dev, "panel device error %d\n", ret); + return ret; + } + + mplat = dev_get_plat(priv->panel); + mplat->device = &priv->device; + device->lanes = mplat->lanes; + device->format = mplat->format; + device->mode_flags = mplat->mode_flags; + + ret = panel_get_display_timing(priv->panel, &timings); + if (ret) { + ret = ofnode_decode_display_timing(dev_ofnode(priv->panel), + 0, &timings); + if (ret) { + dev_err(dev, "decode display timing error %d\n", ret); + return ret; + } + } + + ret = uclass_get_device(UCLASS_DSI_HOST, 0, &priv->dsi_host); + if (ret) { + dev_err(dev, "No video dsi host detected %d\n", ret); + return ret; + } + + ret = dsi_host_init(priv->dsi_host, device, &timings, 4, + &dsi_rockchip_phy_ops); + if (ret) { + dev_err(dev, "failed to initialize mipi dsi host\n"); + return ret; + } + + return 0; +} + +static int dw_mipi_dsi_rockchip_set_bl(struct udevice *dev, int percent) +{ + struct dw_rockchip_dsi_priv *priv = dev_get_priv(dev); + int ret; + + /* + * Allow backlight to be optional, since this driver may be + * used to simply detect a panel rather than bring one up. + */ + ret = panel_enable_backlight(priv->panel); + if ((ret) && (ret != -ENOSYS)) { + dev_err(dev, "panel %s enable backlight error %d\n", + priv->panel->name, ret); + return ret; + } + + ret = dsi_host_enable(priv->dsi_host); + if (ret) { + dev_err(dev, "failed to enable mipi dsi host\n"); + return ret; + } + + return 0; +} + +static void dw_mipi_dsi_rockchip_config(struct dw_rockchip_dsi_priv *dsi) +{ + if (dsi->cdata->lanecfg1_grf_reg) + dsi_write(dsi, dsi->cdata->lanecfg1_grf_reg, + dsi->cdata->lanecfg1); + + if (dsi->cdata->lanecfg2_grf_reg) + dsi_write(dsi, dsi->cdata->lanecfg2_grf_reg, + dsi->cdata->lanecfg2); + + if (dsi->cdata->enable_grf_reg) + dsi_write(dsi, dsi->cdata->enable_grf_reg, + dsi->cdata->enable); +} + +static int dw_mipi_dsi_rockchip_bind(struct udevice *dev) +{ + int ret; + + ret = device_bind_driver_to_node(dev, "dw_mipi_dsi", "dsihost", + dev_ofnode(dev), NULL); + if (ret) { + dev_err(dev, "failed to bind driver to node\n"); + return ret; + } + + return dm_scan_fdt_dev(dev); +} + +static int dw_mipi_dsi_rockchip_probe(struct udevice *dev) +{ + struct dw_rockchip_dsi_priv *priv = dev_get_priv(dev); + struct mipi_dsi_device *device = &priv->device; + int ret, i; + const struct rockchip_dw_dsi_chip_data *cdata = + (const struct rockchip_dw_dsi_chip_data *)dev_get_driver_data(dev); + + device->dev = dev; + + priv->base = (void *)dev_read_addr(dev); + if ((fdt_addr_t)priv->base == FDT_ADDR_T_NONE) { + dev_err(dev, "dsi dt register address error\n"); + return -EINVAL; + } + + i = 0; + while (cdata[i].reg) { + if (cdata[i].reg == (fdt_addr_t)priv->base) { + priv->cdata = &cdata[i]; + break; + } + + i++; + } + + if (!priv->cdata) { + dev_err(dev, "no dsi-config for %s node\n", dev->name); + return -EINVAL; + } + + /* + * Get an optional external dphy. The external dphy stays as + * NULL if it's not initialized. + */ + ret = generic_phy_get_by_name(dev, "dphy", &priv->phy); + if ((ret) && (ret != -ENODEV)) { + dev_err(dev, "failed to get mipi dphy: %d\n", ret); + return -EINVAL; + } + + priv->pclk = devm_clk_get(dev, "pclk"); + if (IS_ERR(priv->pclk)) { + dev_err(dev, "peripheral clock get error %d\n", ret); + return ret; + } + + /* Get a ref clock only if not using an external phy. */ + if (&priv->phy) { + dev_dbg(dev, "setting priv->ref to NULL\n"); + priv->ref = NULL; + + } else { + priv->ref = devm_clk_get(dev, "ref"); + if (ret) { + dev_err(dev, "pll reference clock get error %d\n", ret); + return ret; + } + } + + priv->rst = devm_reset_control_get_by_index(device->dev, 0); + if (IS_ERR(priv->rst)) { + dev_err(dev, "missing dsi hardware reset\n"); + return ret; + } + + /* Reset */ + reset_deassert(priv->rst); + + dw_mipi_dsi_rockchip_config(priv); + + return 0; +} + +struct video_bridge_ops dw_mipi_dsi_rockchip_ops = { + .attach = dw_mipi_dsi_rockchip_attach, + .set_backlight = dw_mipi_dsi_rockchip_set_bl, +}; + +static const struct rockchip_dw_dsi_chip_data rk3568_chip_data[] = { + { + .reg = 0xfe060000, + .lanecfg1_grf_reg = RK3568_GRF_VO_CON2, + .lanecfg1 = HIWORD_UPDATE(0, RK3568_DSI0_SKEWCALHS | + RK3568_DSI0_FORCETXSTOPMODE | + RK3568_DSI0_TURNDISABLE | + RK3568_DSI0_FORCERXMODE), + .max_data_lanes = 4, + }, + { + .reg = 0xfe070000, + .lanecfg1_grf_reg = RK3568_GRF_VO_CON3, + .lanecfg1 = HIWORD_UPDATE(0, RK3568_DSI1_SKEWCALHS | + RK3568_DSI1_FORCETXSTOPMODE | + RK3568_DSI1_TURNDISABLE | + RK3568_DSI1_FORCERXMODE), + .max_data_lanes = 4, + }, + { /* sentinel */ } +}; + +static const struct udevice_id dw_mipi_dsi_rockchip_dt_ids[] = { + { .compatible = "rockchip,rk3568-mipi-dsi", + .data = (long)&rk3568_chip_data, + }, + { /* sentinel */ } +}; + +U_BOOT_DRIVER(dw_mipi_dsi_rockchip) = { + .name = "dw-mipi-dsi-rockchip", + .id = UCLASS_VIDEO_BRIDGE, + .of_match = dw_mipi_dsi_rockchip_dt_ids, + .bind = dw_mipi_dsi_rockchip_bind, + .probe = dw_mipi_dsi_rockchip_probe, + .ops = &dw_mipi_dsi_rockchip_ops, + .priv_auto = sizeof(struct dw_rockchip_dsi_priv), +}; -- 2.34.1 ^ permalink raw reply related [flat|nested] 5+ messages in thread
* Re: [PATCH 2/2] rockchip: video: Add support for RK3568 DSI Host 2023-03-24 18:53 ` [PATCH 2/2] rockchip: video: Add support for RK3568 DSI Host Chris Morgan @ 2023-04-14 8:53 ` Kever Yang 0 siblings, 0 replies; 5+ messages in thread From: Kever Yang @ 2023-04-14 8:53 UTC (permalink / raw) To: Chris Morgan, u-boot Cc: yifeng.zhao, jagan, agust, philipp.tomsich, sjg, Chris Morgan On 2023/3/25 02:53, Chris Morgan wrote: > From: Chris Morgan <macromorgan@hotmail.com> > > Add support for DSI Host controller on Rockchip RK3568. This driver > is heavily based on the Rockchip dw_mipi_dsi_rockchip.c driver in > Linux and the stm32_dsi.c driver in U-Boot. It should be easy to add > support for other SoCs as the only missing component from the mainline > driver is setting the VOP big or VOP little (which the rk3568 does > not have). > > Driver was tested for use in sending commands to a DSI panel in order > to obtain the panel ID. > > Signed-off-by: Chris Morgan <macromorgan@hotmail.com> Reviewed-by: Kever Yang <kever.yang@rock-chips.com> Thanks, - Kever > --- > drivers/video/dw_mipi_dsi.c | 9 + > drivers/video/rockchip/Kconfig | 8 + > drivers/video/rockchip/Makefile | 1 + > drivers/video/rockchip/dw_mipi_dsi_rockchip.c | 898 ++++++++++++++++++ > 4 files changed, 916 insertions(+) > create mode 100644 drivers/video/rockchip/dw_mipi_dsi_rockchip.c > > diff --git a/drivers/video/dw_mipi_dsi.c b/drivers/video/dw_mipi_dsi.c > index 6d9c5a9476..a4606923ff 100644 > --- a/drivers/video/dw_mipi_dsi.c > +++ b/drivers/video/dw_mipi_dsi.c > @@ -806,6 +806,15 @@ static int dw_mipi_dsi_init(struct udevice *dev, > return -EINVAL; > } > > + /* > + * The Rockchip based devices don't have px_clk, so simply move > + * on. > + */ > + if (IS_ENABLED(CONFIG_DISPLAY_ROCKCHIP_DW_MIPI)) { > + dw_mipi_dsi_bridge_set(dsi, timings); > + return 0; > + } > + > ret = clk_get_by_name(device->dev, "px_clk", &clk); > if (ret) { > dev_err(device->dev, "peripheral clock get error %d\n", ret); > diff --git a/drivers/video/rockchip/Kconfig b/drivers/video/rockchip/Kconfig > index b03866347b..01804dcb1c 100644 > --- a/drivers/video/rockchip/Kconfig > +++ b/drivers/video/rockchip/Kconfig > @@ -69,4 +69,12 @@ config DISPLAY_ROCKCHIP_MIPI > support. The mipi controller and dphy on rk3288& rk3399 support > 16,18, 24 bits per pixel with up to 2k resolution ratio. > > +config DISPLAY_ROCKCHIP_DW_MIPI > + bool "Rockchip Designware MIPI" > + depends on VIDEO_ROCKCHIP > + select VIDEO_DW_MIPI_DSI > + help > + Select the Designware MIPI DSI controller in use on some Rockchip > + SOCs. > + > endif > diff --git a/drivers/video/rockchip/Makefile b/drivers/video/rockchip/Makefile > index 9aced5ef3f..8128289cc8 100644 > --- a/drivers/video/rockchip/Makefile > +++ b/drivers/video/rockchip/Makefile > @@ -15,4 +15,5 @@ obj-$(CONFIG_DISPLAY_ROCKCHIP_HDMI) += rk_hdmi.o $(obj-hdmi-y) > obj-mipi-$(CONFIG_ROCKCHIP_RK3288) += rk3288_mipi.o > obj-mipi-$(CONFIG_ROCKCHIP_RK3399) += rk3399_mipi.o > obj-$(CONFIG_DISPLAY_ROCKCHIP_MIPI) += rk_mipi.o $(obj-mipi-y) > +obj-$(CONFIG_DISPLAY_ROCKCHIP_DW_MIPI) += dw_mipi_dsi_rockchip.o > endif > diff --git a/drivers/video/rockchip/dw_mipi_dsi_rockchip.c b/drivers/video/rockchip/dw_mipi_dsi_rockchip.c > new file mode 100644 > index 0000000000..ca548a60b7 > --- /dev/null > +++ b/drivers/video/rockchip/dw_mipi_dsi_rockchip.c > @@ -0,0 +1,898 @@ > +// SPDX-License-Identifier: GPL-2.0+ > +/* > + * Author(s): Chris Morgan <macromorgan@hotmail.com> > + * > + * This MIPI DSI controller driver is heavily based on the Linux Kernel > + * driver from drivers/gpu/drm/rockchip/dw-mipi-dsi-rockchip.c and the > + * U-Boot driver from drivers/video/stm32/stm32_dsi.c. > + */ > + > +#define LOG_CATEGORY UCLASS_VIDEO_BRIDGE > + > +#include <clk.h> > +#include <dm.h> > +#include <div64.h> > +#include <dsi_host.h> > +#include <generic-phy.h> > +#include <mipi_dsi.h> > +#include <panel.h> > +#include <phy-mipi-dphy.h> > +#include <reset.h> > +#include <video_bridge.h> > +#include <dm/device_compat.h> > +#include <dm/lists.h> > +#include <linux/iopoll.h> > + > +#include <common.h> > +#include <log.h> > +#include <video.h> > +#include <asm/io.h> > +#include <dm/device-internal.h> > +#include <linux/bitops.h> > + > +#define USEC_PER_SEC 1000000L > + > +/* > + * DSI wrapper registers & bit definitions > + * Note: registers are named as in the Reference Manual > + */ > +#define DSI_WCR 0x0404 /* Wrapper Control Reg */ > +#define WCR_DSIEN BIT(3) /* DSI ENable */ > + > +#define DSI_PHY_TST_CTRL0 0xb4 > +#define PHY_TESTCLK BIT(1) > +#define PHY_UNTESTCLK 0 > +#define PHY_TESTCLR BIT(0) > +#define PHY_UNTESTCLR 0 > + > +#define DSI_PHY_TST_CTRL1 0xb8 > +#define PHY_TESTEN BIT(16) > +#define PHY_UNTESTEN 0 > +#define PHY_TESTDOUT(n) (((n) & 0xff) << 8) > +#define PHY_TESTDIN(n) (((n) & 0xff) << 0) > + > +#define BYPASS_VCO_RANGE BIT(7) > +#define VCO_RANGE_CON_SEL(val) (((val) & 0x7) << 3) > +#define VCO_IN_CAP_CON_DEFAULT (0x0 << 1) > +#define VCO_IN_CAP_CON_LOW (0x1 << 1) > +#define VCO_IN_CAP_CON_HIGH (0x2 << 1) > +#define REF_BIAS_CUR_SEL BIT(0) > + > +#define CP_CURRENT_3UA 0x1 > +#define CP_CURRENT_4_5UA 0x2 > +#define CP_CURRENT_7_5UA 0x6 > +#define CP_CURRENT_6UA 0x9 > +#define CP_CURRENT_12UA 0xb > +#define CP_CURRENT_SEL(val) ((val) & 0xf) > +#define CP_PROGRAM_EN BIT(7) > + > +#define LPF_RESISTORS_15_5KOHM 0x1 > +#define LPF_RESISTORS_13KOHM 0x2 > +#define LPF_RESISTORS_11_5KOHM 0x4 > +#define LPF_RESISTORS_10_5KOHM 0x8 > +#define LPF_RESISTORS_8KOHM 0x10 > +#define LPF_PROGRAM_EN BIT(6) > +#define LPF_RESISTORS_SEL(val) ((val) & 0x3f) > + > +#define HSFREQRANGE_SEL(val) (((val) & 0x3f) << 1) > + > +#define INPUT_DIVIDER(val) (((val) - 1) & 0x7f) > +#define LOW_PROGRAM_EN 0 > +#define HIGH_PROGRAM_EN BIT(7) > +#define LOOP_DIV_LOW_SEL(val) (((val) - 1) & 0x1f) > +#define LOOP_DIV_HIGH_SEL(val) ((((val) - 1) >> 5) & 0xf) > +#define PLL_LOOP_DIV_EN BIT(5) > +#define PLL_INPUT_DIV_EN BIT(4) > + > +#define POWER_CONTROL BIT(6) > +#define INTERNAL_REG_CURRENT BIT(3) > +#define BIAS_BLOCK_ON BIT(2) > +#define BANDGAP_ON BIT(0) > + > +#define TER_RESISTOR_HIGH BIT(7) > +#define TER_RESISTOR_LOW 0 > +#define LEVEL_SHIFTERS_ON BIT(6) > +#define TER_CAL_DONE BIT(5) > +#define SETRD_MAX (0x7 << 2) > +#define POWER_MANAGE BIT(1) > +#define TER_RESISTORS_ON BIT(0) > + > +#define BIASEXTR_SEL(val) ((val) & 0x7) > +#define BANDGAP_SEL(val) ((val) & 0x7) > +#define TLP_PROGRAM_EN BIT(7) > +#define THS_PRE_PROGRAM_EN BIT(7) > +#define THS_ZERO_PROGRAM_EN BIT(6) > + > +#define PLL_BIAS_CUR_SEL_CAP_VCO_CONTROL 0x10 > +#define PLL_CP_CONTROL_PLL_LOCK_BYPASS 0x11 > +#define PLL_LPF_AND_CP_CONTROL 0x12 > +#define PLL_INPUT_DIVIDER_RATIO 0x17 > +#define PLL_LOOP_DIVIDER_RATIO 0x18 > +#define PLL_INPUT_AND_LOOP_DIVIDER_RATIOS_CONTROL 0x19 > +#define BANDGAP_AND_BIAS_CONTROL 0x20 > +#define TERMINATION_RESISTER_CONTROL 0x21 > +#define AFE_BIAS_BANDGAP_ANALOG_PROGRAMMABILITY 0x22 > +#define HS_RX_CONTROL_OF_LANE_CLK 0x34 > +#define HS_RX_CONTROL_OF_LANE_0 0x44 > +#define HS_RX_CONTROL_OF_LANE_1 0x54 > +#define HS_TX_CLOCK_LANE_REQUEST_STATE_TIME_CONTROL 0x60 > +#define HS_TX_CLOCK_LANE_PREPARE_STATE_TIME_CONTROL 0x61 > +#define HS_TX_CLOCK_LANE_HS_ZERO_STATE_TIME_CONTROL 0x62 > +#define HS_TX_CLOCK_LANE_TRAIL_STATE_TIME_CONTROL 0x63 > +#define HS_TX_CLOCK_LANE_EXIT_STATE_TIME_CONTROL 0x64 > +#define HS_TX_CLOCK_LANE_POST_TIME_CONTROL 0x65 > +#define HS_TX_DATA_LANE_REQUEST_STATE_TIME_CONTROL 0x70 > +#define HS_TX_DATA_LANE_PREPARE_STATE_TIME_CONTROL 0x71 > +#define HS_TX_DATA_LANE_HS_ZERO_STATE_TIME_CONTROL 0x72 > +#define HS_TX_DATA_LANE_TRAIL_STATE_TIME_CONTROL 0x73 > +#define HS_TX_DATA_LANE_EXIT_STATE_TIME_CONTROL 0x74 > +#define HS_RX_DATA_LANE_THS_SETTLE_CONTROL 0x75 > +#define HS_RX_CONTROL_OF_LANE_2 0x84 > +#define HS_RX_CONTROL_OF_LANE_3 0x94 > + > +#define RK3568_GRF_VO_CON2 0x0368 > +#define RK3568_DSI0_SKEWCALHS (0x1f << 11) > +#define RK3568_DSI0_FORCETXSTOPMODE (0xf << 4) > +#define RK3568_DSI0_TURNDISABLE BIT(2) > +#define RK3568_DSI0_FORCERXMODE BIT(0) > + > +/* > + * Note these registers do not appear in the datasheet, they are > + * however present in the BSP driver which is where these values > + * come from. Name GRF_VO_CON3 is assumed. > + */ > +#define RK3568_GRF_VO_CON3 0x36c > +#define RK3568_DSI1_SKEWCALHS (0x1f << 11) > +#define RK3568_DSI1_FORCETXSTOPMODE (0xf << 4) > +#define RK3568_DSI1_TURNDISABLE BIT(2) > +#define RK3568_DSI1_FORCERXMODE BIT(0) > + > +#define HIWORD_UPDATE(val, mask) (val | (mask) << 16) > + > +/* Timeout for regulator on/off, pll lock/unlock & fifo empty */ > +#define TIMEOUT_US 200000 > + > +enum { > + BANDGAP_97_07, > + BANDGAP_98_05, > + BANDGAP_99_02, > + BANDGAP_100_00, > + BANDGAP_93_17, > + BANDGAP_94_15, > + BANDGAP_95_12, > + BANDGAP_96_10, > +}; > + > +enum { > + BIASEXTR_87_1, > + BIASEXTR_91_5, > + BIASEXTR_95_9, > + BIASEXTR_100, > + BIASEXTR_105_94, > + BIASEXTR_111_88, > + BIASEXTR_118_8, > + BIASEXTR_127_7, > +}; > + > +struct rockchip_dw_dsi_chip_data { > + u32 reg; > + > + u32 lcdsel_grf_reg; > + u32 lcdsel_big; > + u32 lcdsel_lit; > + > + u32 enable_grf_reg; > + u32 enable; > + > + u32 lanecfg1_grf_reg; > + u32 lanecfg1; > + u32 lanecfg2_grf_reg; > + u32 lanecfg2; > + > + unsigned int flags; > + unsigned int max_data_lanes; > +}; > + > +struct dw_rockchip_dsi_priv { > + struct mipi_dsi_device device; > + void __iomem *base; > + struct udevice *panel; > + > + /* Optional external dphy */ > + struct phy phy; > + struct phy_configure_opts_mipi_dphy phy_opts; > + > + struct clk *pclk; > + struct clk *ref; > + struct reset_ctl *rst; > + unsigned int lane_mbps; /* per lane */ > + u16 input_div; > + u16 feedback_div; > + const struct rockchip_dw_dsi_chip_data *cdata; > + struct udevice *dsi_host; > +}; > + > +static inline void dsi_write(struct dw_rockchip_dsi_priv *dsi, u32 reg, u32 val) > +{ > + writel(val, dsi->base + reg); > +} > + > +static inline u32 dsi_read(struct dw_rockchip_dsi_priv *dsi, u32 reg) > +{ > + return readl(dsi->base + reg); > +} > + > +static inline void dsi_set(struct dw_rockchip_dsi_priv *dsi, u32 reg, u32 mask) > +{ > + dsi_write(dsi, reg, dsi_read(dsi, reg) | mask); > +} > + > +static inline void dsi_clear(struct dw_rockchip_dsi_priv *dsi, u32 reg, u32 mask) > +{ > + dsi_write(dsi, reg, dsi_read(dsi, reg) & ~mask); > +} > + > +static inline void dsi_update_bits(struct dw_rockchip_dsi_priv *dsi, u32 reg, > + u32 mask, u32 val) > +{ > + dsi_write(dsi, reg, (dsi_read(dsi, reg) & ~mask) | val); > +} > + > +static void dw_mipi_dsi_phy_write(struct dw_rockchip_dsi_priv *dsi, > + u8 test_code, > + u8 test_data) > +{ > + /* > + * With the falling edge on TESTCLK, the TESTDIN[7:0] signal content > + * is latched internally as the current test code. Test data is > + * programmed internally by rising edge on TESTCLK. > + */ > + dsi_write(dsi, DSI_PHY_TST_CTRL0, PHY_TESTCLK | PHY_UNTESTCLR); > + > + dsi_write(dsi, DSI_PHY_TST_CTRL1, PHY_TESTEN | PHY_TESTDOUT(0) | > + PHY_TESTDIN(test_code)); > + > + dsi_write(dsi, DSI_PHY_TST_CTRL0, PHY_UNTESTCLK | PHY_UNTESTCLR); > + > + dsi_write(dsi, DSI_PHY_TST_CTRL1, PHY_UNTESTEN | PHY_TESTDOUT(0) | > + PHY_TESTDIN(test_data)); > + > + dsi_write(dsi, DSI_PHY_TST_CTRL0, PHY_TESTCLK | PHY_UNTESTCLR); > +} > + > +struct dphy_pll_parameter_map { > + unsigned int max_mbps; > + u8 hsfreqrange; > + u8 icpctrl; > + u8 lpfctrl; > +}; > + > +/* The table is based on 27MHz DPHY pll reference clock. */ > +static const struct dphy_pll_parameter_map dppa_map[] = { > + { 89, 0x00, CP_CURRENT_3UA, LPF_RESISTORS_13KOHM }, > + { 99, 0x10, CP_CURRENT_3UA, LPF_RESISTORS_13KOHM }, > + { 109, 0x20, CP_CURRENT_3UA, LPF_RESISTORS_13KOHM }, > + { 129, 0x01, CP_CURRENT_3UA, LPF_RESISTORS_15_5KOHM }, > + { 139, 0x11, CP_CURRENT_3UA, LPF_RESISTORS_15_5KOHM }, > + { 149, 0x21, CP_CURRENT_3UA, LPF_RESISTORS_15_5KOHM }, > + { 169, 0x02, CP_CURRENT_6UA, LPF_RESISTORS_13KOHM }, > + { 179, 0x12, CP_CURRENT_6UA, LPF_RESISTORS_13KOHM }, > + { 199, 0x22, CP_CURRENT_6UA, LPF_RESISTORS_13KOHM }, > + { 219, 0x03, CP_CURRENT_4_5UA, LPF_RESISTORS_13KOHM }, > + { 239, 0x13, CP_CURRENT_4_5UA, LPF_RESISTORS_13KOHM }, > + { 249, 0x23, CP_CURRENT_4_5UA, LPF_RESISTORS_13KOHM }, > + { 269, 0x04, CP_CURRENT_6UA, LPF_RESISTORS_11_5KOHM }, > + { 299, 0x14, CP_CURRENT_6UA, LPF_RESISTORS_11_5KOHM }, > + { 329, 0x05, CP_CURRENT_3UA, LPF_RESISTORS_15_5KOHM }, > + { 359, 0x15, CP_CURRENT_3UA, LPF_RESISTORS_15_5KOHM }, > + { 399, 0x25, CP_CURRENT_3UA, LPF_RESISTORS_15_5KOHM }, > + { 449, 0x06, CP_CURRENT_7_5UA, LPF_RESISTORS_11_5KOHM }, > + { 499, 0x16, CP_CURRENT_7_5UA, LPF_RESISTORS_11_5KOHM }, > + { 549, 0x07, CP_CURRENT_7_5UA, LPF_RESISTORS_10_5KOHM }, > + { 599, 0x17, CP_CURRENT_7_5UA, LPF_RESISTORS_10_5KOHM }, > + { 649, 0x08, CP_CURRENT_7_5UA, LPF_RESISTORS_11_5KOHM }, > + { 699, 0x18, CP_CURRENT_7_5UA, LPF_RESISTORS_11_5KOHM }, > + { 749, 0x09, CP_CURRENT_7_5UA, LPF_RESISTORS_11_5KOHM }, > + { 799, 0x19, CP_CURRENT_7_5UA, LPF_RESISTORS_11_5KOHM }, > + { 849, 0x29, CP_CURRENT_7_5UA, LPF_RESISTORS_11_5KOHM }, > + { 899, 0x39, CP_CURRENT_7_5UA, LPF_RESISTORS_11_5KOHM }, > + { 949, 0x0a, CP_CURRENT_12UA, LPF_RESISTORS_8KOHM }, > + { 999, 0x1a, CP_CURRENT_12UA, LPF_RESISTORS_8KOHM }, > + {1049, 0x2a, CP_CURRENT_12UA, LPF_RESISTORS_8KOHM }, > + {1099, 0x3a, CP_CURRENT_12UA, LPF_RESISTORS_8KOHM }, > + {1149, 0x0b, CP_CURRENT_12UA, LPF_RESISTORS_10_5KOHM }, > + {1199, 0x1b, CP_CURRENT_12UA, LPF_RESISTORS_10_5KOHM }, > + {1249, 0x2b, CP_CURRENT_12UA, LPF_RESISTORS_10_5KOHM }, > + {1299, 0x3b, CP_CURRENT_12UA, LPF_RESISTORS_10_5KOHM }, > + {1349, 0x0c, CP_CURRENT_12UA, LPF_RESISTORS_10_5KOHM }, > + {1399, 0x1c, CP_CURRENT_12UA, LPF_RESISTORS_10_5KOHM }, > + {1449, 0x2c, CP_CURRENT_12UA, LPF_RESISTORS_10_5KOHM }, > + {1500, 0x3c, CP_CURRENT_12UA, LPF_RESISTORS_10_5KOHM } > +}; > + > +static int max_mbps_to_parameter(unsigned int max_mbps) > +{ > + int i; > + > + for (i = 0; i < ARRAY_SIZE(dppa_map); i++) > + if (dppa_map[i].max_mbps >= max_mbps) > + return i; > + > + return -EINVAL; > +} > + > +/* > + * ns2bc - Nanoseconds to byte clock cycles > + */ > +static inline unsigned int ns2bc(struct dw_rockchip_dsi_priv *dsi, int ns) > +{ > + return DIV_ROUND_UP(ns * dsi->lane_mbps / 8, 1000); > +} > + > +/* > + * ns2ui - Nanoseconds to UI time periods > + */ > +static inline unsigned int ns2ui(struct dw_rockchip_dsi_priv *dsi, int ns) > +{ > + return DIV_ROUND_UP(ns * dsi->lane_mbps, 1000); > +} > + > +static int dsi_phy_init(void *priv_data) > +{ > + struct mipi_dsi_device *device = priv_data; > + struct udevice *dev = device->dev; > + struct dw_rockchip_dsi_priv *dsi = dev_get_priv(dev); > + int ret, i, vco; > + > + if (&dsi->phy) { > + ret = generic_phy_configure(&dsi->phy, &dsi->phy_opts); > + if (ret) { > + dev_err(dsi->dsi_host, > + "Configure external dphy fail %d\n", > + ret); > + return ret; > + } > + > + ret = generic_phy_power_on(&dsi->phy); > + if (ret) { > + dev_err(dsi->dsi_host, > + "Generic phy power on fail %d\n", ret); > + return ret; > + } > + > + return 0; > + } > + > + /* > + * Get vco from frequency(lane_mbps) > + * vco frequency table > + * 000 - between 80 and 200 MHz > + * 001 - between 200 and 300 MHz > + * 010 - between 300 and 500 MHz > + * 011 - between 500 and 700 MHz > + * 100 - between 700 and 900 MHz > + * 101 - between 900 and 1100 MHz > + * 110 - between 1100 and 1300 MHz > + * 111 - between 1300 and 1500 MHz > + */ > + vco = (dsi->lane_mbps < 200) ? 0 : (dsi->lane_mbps + 100) / 200; > + > + i = max_mbps_to_parameter(dsi->lane_mbps); > + if (i < 0) { > + dev_err(dsi->dsi_host, > + "failed to get parameter for %dmbps clock\n", > + dsi->lane_mbps); > + return i; > + } > + > + dw_mipi_dsi_phy_write(dsi, PLL_BIAS_CUR_SEL_CAP_VCO_CONTROL, > + BYPASS_VCO_RANGE | > + VCO_RANGE_CON_SEL(vco) | > + VCO_IN_CAP_CON_LOW | > + REF_BIAS_CUR_SEL); > + > + dw_mipi_dsi_phy_write(dsi, PLL_CP_CONTROL_PLL_LOCK_BYPASS, > + CP_CURRENT_SEL(dppa_map[i].icpctrl)); > + dw_mipi_dsi_phy_write(dsi, PLL_LPF_AND_CP_CONTROL, > + CP_PROGRAM_EN | LPF_PROGRAM_EN | > + LPF_RESISTORS_SEL(dppa_map[i].lpfctrl)); > + > + dw_mipi_dsi_phy_write(dsi, HS_RX_CONTROL_OF_LANE_0, > + HSFREQRANGE_SEL(dppa_map[i].hsfreqrange)); > + > + dw_mipi_dsi_phy_write(dsi, PLL_INPUT_DIVIDER_RATIO, > + INPUT_DIVIDER(dsi->input_div)); > + dw_mipi_dsi_phy_write(dsi, PLL_LOOP_DIVIDER_RATIO, > + LOOP_DIV_LOW_SEL(dsi->feedback_div) | > + LOW_PROGRAM_EN); > + /* > + * We need set PLL_INPUT_AND_LOOP_DIVIDER_RATIOS_CONTROL immediately > + * to make the configured LSB effective according to IP simulation > + * and lab test results. > + * Only in this way can we get correct mipi phy pll frequency. > + */ > + dw_mipi_dsi_phy_write(dsi, PLL_INPUT_AND_LOOP_DIVIDER_RATIOS_CONTROL, > + PLL_LOOP_DIV_EN | PLL_INPUT_DIV_EN); > + dw_mipi_dsi_phy_write(dsi, PLL_LOOP_DIVIDER_RATIO, > + LOOP_DIV_HIGH_SEL(dsi->feedback_div) | > + HIGH_PROGRAM_EN); > + dw_mipi_dsi_phy_write(dsi, PLL_INPUT_AND_LOOP_DIVIDER_RATIOS_CONTROL, > + PLL_LOOP_DIV_EN | PLL_INPUT_DIV_EN); > + > + dw_mipi_dsi_phy_write(dsi, AFE_BIAS_BANDGAP_ANALOG_PROGRAMMABILITY, > + LOW_PROGRAM_EN | BIASEXTR_SEL(BIASEXTR_127_7)); > + dw_mipi_dsi_phy_write(dsi, AFE_BIAS_BANDGAP_ANALOG_PROGRAMMABILITY, > + HIGH_PROGRAM_EN | BANDGAP_SEL(BANDGAP_96_10)); > + > + dw_mipi_dsi_phy_write(dsi, BANDGAP_AND_BIAS_CONTROL, > + POWER_CONTROL | INTERNAL_REG_CURRENT | > + BIAS_BLOCK_ON | BANDGAP_ON); > + > + dw_mipi_dsi_phy_write(dsi, TERMINATION_RESISTER_CONTROL, > + TER_RESISTOR_LOW | TER_CAL_DONE | > + SETRD_MAX | TER_RESISTORS_ON); > + dw_mipi_dsi_phy_write(dsi, TERMINATION_RESISTER_CONTROL, > + TER_RESISTOR_HIGH | LEVEL_SHIFTERS_ON | > + SETRD_MAX | POWER_MANAGE | > + TER_RESISTORS_ON); > + > + dw_mipi_dsi_phy_write(dsi, HS_TX_CLOCK_LANE_REQUEST_STATE_TIME_CONTROL, > + TLP_PROGRAM_EN | ns2bc(dsi, 500)); > + dw_mipi_dsi_phy_write(dsi, HS_TX_CLOCK_LANE_PREPARE_STATE_TIME_CONTROL, > + THS_PRE_PROGRAM_EN | ns2ui(dsi, 40)); > + dw_mipi_dsi_phy_write(dsi, HS_TX_CLOCK_LANE_HS_ZERO_STATE_TIME_CONTROL, > + THS_ZERO_PROGRAM_EN | ns2bc(dsi, 300)); > + dw_mipi_dsi_phy_write(dsi, HS_TX_CLOCK_LANE_TRAIL_STATE_TIME_CONTROL, > + THS_PRE_PROGRAM_EN | ns2ui(dsi, 100)); > + dw_mipi_dsi_phy_write(dsi, HS_TX_CLOCK_LANE_EXIT_STATE_TIME_CONTROL, > + BIT(5) | ns2bc(dsi, 100)); > + dw_mipi_dsi_phy_write(dsi, HS_TX_CLOCK_LANE_POST_TIME_CONTROL, > + BIT(5) | (ns2bc(dsi, 60) + 7)); > + > + dw_mipi_dsi_phy_write(dsi, HS_TX_DATA_LANE_REQUEST_STATE_TIME_CONTROL, > + TLP_PROGRAM_EN | ns2bc(dsi, 500)); > + dw_mipi_dsi_phy_write(dsi, HS_TX_DATA_LANE_PREPARE_STATE_TIME_CONTROL, > + THS_PRE_PROGRAM_EN | (ns2ui(dsi, 50) + 20)); > + dw_mipi_dsi_phy_write(dsi, HS_TX_DATA_LANE_HS_ZERO_STATE_TIME_CONTROL, > + THS_ZERO_PROGRAM_EN | (ns2bc(dsi, 140) + 2)); > + dw_mipi_dsi_phy_write(dsi, HS_TX_DATA_LANE_TRAIL_STATE_TIME_CONTROL, > + THS_PRE_PROGRAM_EN | (ns2ui(dsi, 60) + 8)); > + dw_mipi_dsi_phy_write(dsi, HS_TX_DATA_LANE_EXIT_STATE_TIME_CONTROL, > + BIT(5) | ns2bc(dsi, 100)); > + > + return ret; > +} > + > +static void dsi_phy_post_set_mode(void *priv_data, unsigned long mode_flags) > +{ > + struct mipi_dsi_device *device = priv_data; > + struct udevice *dev = device->dev; > + struct dw_rockchip_dsi_priv *dsi = dev_get_priv(dev); > + > + dev_dbg(dev, "Set mode %p enable %ld\n", dsi, > + mode_flags & MIPI_DSI_MODE_VIDEO); > + > + if (!dsi) > + return; > + > + /* > + * DSI wrapper must be enabled in video mode & disabled in command mode. > + * If wrapper is enabled in command mode, the display controller > + * register access will hang. Note that this was carried over from the > + * stm32 dsi driver and is unknown if necessary for Rockchip. > + */ > + > + if (mode_flags & MIPI_DSI_MODE_VIDEO) > + dsi_set(dsi, DSI_WCR, WCR_DSIEN); > + else > + dsi_clear(dsi, DSI_WCR, WCR_DSIEN); > +} > + > +static int > +dw_mipi_dsi_get_lane_mbps(void *priv_data, struct display_timing *timings, > + u32 lanes, u32 format, unsigned int *lane_mbps) > +{ > + struct mipi_dsi_device *device = priv_data; > + struct udevice *dev = device->dev; > + struct dw_rockchip_dsi_priv *dsi = dev_get_priv(dev); > + int bpp; > + unsigned long mpclk, tmp; > + unsigned int target_mbps = 1000; > + unsigned int max_mbps = dppa_map[ARRAY_SIZE(dppa_map) - 1].max_mbps; > + unsigned long best_freq = 0; > + unsigned long fvco_min, fvco_max, fin, fout; > + unsigned int min_prediv, max_prediv; > + unsigned int _prediv, best_prediv; > + unsigned long _fbdiv, best_fbdiv; > + unsigned long min_delta = ULONG_MAX; > + unsigned int pllref_clk; > + > + bpp = mipi_dsi_pixel_format_to_bpp(format); > + if (bpp < 0) { > + dev_err(dsi->dsi_host, > + "failed to get bpp for pixel format %d\n", > + format); > + return bpp; > + } > + > + mpclk = DIV_ROUND_UP(timings->pixelclock.typ, 1000); > + if (mpclk) { > + /* take 1 / 0.8, since mbps must big than bandwidth of RGB */ > + tmp = (mpclk * (bpp / lanes) * 10 / 8) / 1000; > + if (tmp < max_mbps) > + target_mbps = tmp; > + else > + dev_err(dsi->dsi_host, > + "DPHY clock frequency is out of range\n"); > + } > + > + /* for external phy only the mipi_dphy_config is necessary */ > + if (&dsi->phy) { > + phy_mipi_dphy_get_default_config(timings->pixelclock.typ * 10 / 8, > + bpp, lanes, > + &dsi->phy_opts); > + dsi->lane_mbps = target_mbps; > + *lane_mbps = dsi->lane_mbps; > + > + return 0; > + } > + > + pllref_clk = clk_get_rate(dsi->ref); > + fout = target_mbps * USEC_PER_SEC; > + > + /* constraint: 5Mhz <= Fref / N <= 40MHz */ > + min_prediv = DIV_ROUND_UP(fin, 40 * USEC_PER_SEC); > + max_prediv = fin / (5 * USEC_PER_SEC); > + > + /* constraint: 80MHz <= Fvco <= 1500Mhz */ > + fvco_min = 80 * USEC_PER_SEC; > + fvco_max = 1500 * USEC_PER_SEC; > + > + for (_prediv = min_prediv; _prediv <= max_prediv; _prediv++) { > + u64 tmp; > + u32 delta; > + /* Fvco = Fref * M / N */ > + tmp = (u64)fout * _prediv; > + do_div(tmp, fin); > + _fbdiv = tmp; > + /* > + * Due to the use of a "by 2 pre-scaler," the range of the > + * feedback multiplication value M is limited to even division > + * numbers, and m must be greater than 6, not bigger than 512. > + */ > + if (_fbdiv < 6 || _fbdiv > 512) > + continue; > + > + _fbdiv += _fbdiv % 2; > + > + tmp = (u64)_fbdiv * fin; > + do_div(tmp, _prediv); > + if (tmp < fvco_min || tmp > fvco_max) > + continue; > + > + delta = abs(fout - tmp); > + if (delta < min_delta) { > + best_prediv = _prediv; > + best_fbdiv = _fbdiv; > + min_delta = delta; > + best_freq = tmp; > + } > + } > + > + if (best_freq) { > + dsi->lane_mbps = DIV_ROUND_UP(best_freq, USEC_PER_SEC); > + *lane_mbps = dsi->lane_mbps; > + dsi->input_div = best_prediv; > + dsi->feedback_div = best_fbdiv; > + } else { > + dev_err(dsi->dsi_host, "Can not find best_freq for DPHY\n"); > + return -EINVAL; > + } > + > + return 0; > +} > + > +struct hstt { > + unsigned int maxfreq; > + struct mipi_dsi_phy_timing timing; > +}; > + > +#define HSTT(_maxfreq, _c_lp2hs, _c_hs2lp, _d_lp2hs, _d_hs2lp) \ > +{ \ > + .maxfreq = _maxfreq, \ > + .timing = { \ > + .clk_lp2hs = _c_lp2hs, \ > + .clk_hs2lp = _c_hs2lp, \ > + .data_lp2hs = _d_lp2hs, \ > + .data_hs2lp = _d_hs2lp, \ > + } \ > +} > + > +/* > + * Table A-3 High-Speed Transition Times > + * (Note spacing is deliberate for readability). > + */ > +static struct hstt hstt_table[] = { > + HSTT( 90, 32, 20, 26, 13), > + HSTT( 100, 35, 23, 28, 14), > + HSTT( 110, 32, 22, 26, 13), > + HSTT( 130, 31, 20, 27, 13), > + HSTT( 140, 33, 22, 26, 14), > + HSTT( 150, 33, 21, 26, 14), > + HSTT( 170, 32, 20, 27, 13), > + HSTT( 180, 36, 23, 30, 15), > + HSTT( 200, 40, 22, 33, 15), > + HSTT( 220, 40, 22, 33, 15), > + HSTT( 240, 44, 24, 36, 16), > + HSTT( 250, 48, 24, 38, 17), > + HSTT( 270, 48, 24, 38, 17), > + HSTT( 300, 50, 27, 41, 18), > + HSTT( 330, 56, 28, 45, 18), > + HSTT( 360, 59, 28, 48, 19), > + HSTT( 400, 61, 30, 50, 20), > + HSTT( 450, 67, 31, 55, 21), > + HSTT( 500, 73, 31, 59, 22), > + HSTT( 550, 79, 36, 63, 24), > + HSTT( 600, 83, 37, 68, 25), > + HSTT( 650, 90, 38, 73, 27), > + HSTT( 700, 95, 40, 77, 28), > + HSTT( 750, 102, 40, 84, 28), > + HSTT( 800, 106, 42, 87, 30), > + HSTT( 850, 113, 44, 93, 31), > + HSTT( 900, 118, 47, 98, 32), > + HSTT( 950, 124, 47, 102, 34), > + HSTT(1000, 130, 49, 107, 35), > + HSTT(1050, 135, 51, 111, 37), > + HSTT(1100, 139, 51, 114, 38), > + HSTT(1150, 146, 54, 120, 40), > + HSTT(1200, 153, 57, 125, 41), > + HSTT(1250, 158, 58, 130, 42), > + HSTT(1300, 163, 58, 135, 44), > + HSTT(1350, 168, 60, 140, 45), > + HSTT(1400, 172, 64, 144, 47), > + HSTT(1450, 176, 65, 148, 48), > + HSTT(1500, 181, 66, 153, 50) > +}; > + > +static int dw_mipi_dsi_rockchip_get_timing(void *priv_data, > + unsigned int lane_mbps, > + struct mipi_dsi_phy_timing *timing) > +{ > + int i; > + > + for (i = 0; i < ARRAY_SIZE(hstt_table); i++) > + if (lane_mbps < hstt_table[i].maxfreq) > + break; > + > + if (i == ARRAY_SIZE(hstt_table)) > + i--; > + > + *timing = hstt_table[i].timing; > + > + return 0; > +} > + > +static const struct mipi_dsi_phy_ops dsi_rockchip_phy_ops = { > + .init = dsi_phy_init, > + .get_lane_mbps = dw_mipi_dsi_get_lane_mbps, > + .get_timing = dw_mipi_dsi_rockchip_get_timing, > + .post_set_mode = dsi_phy_post_set_mode, > +}; > + > +static int dw_mipi_dsi_rockchip_attach(struct udevice *dev) > +{ > + struct dw_rockchip_dsi_priv *priv = dev_get_priv(dev); > + struct mipi_dsi_device *device = &priv->device; > + struct mipi_dsi_panel_plat *mplat; > + struct display_timing timings; > + int ret; > + > + ret = uclass_first_device_err(UCLASS_PANEL, &priv->panel); > + if (ret) { > + dev_err(dev, "panel device error %d\n", ret); > + return ret; > + } > + > + mplat = dev_get_plat(priv->panel); > + mplat->device = &priv->device; > + device->lanes = mplat->lanes; > + device->format = mplat->format; > + device->mode_flags = mplat->mode_flags; > + > + ret = panel_get_display_timing(priv->panel, &timings); > + if (ret) { > + ret = ofnode_decode_display_timing(dev_ofnode(priv->panel), > + 0, &timings); > + if (ret) { > + dev_err(dev, "decode display timing error %d\n", ret); > + return ret; > + } > + } > + > + ret = uclass_get_device(UCLASS_DSI_HOST, 0, &priv->dsi_host); > + if (ret) { > + dev_err(dev, "No video dsi host detected %d\n", ret); > + return ret; > + } > + > + ret = dsi_host_init(priv->dsi_host, device, &timings, 4, > + &dsi_rockchip_phy_ops); > + if (ret) { > + dev_err(dev, "failed to initialize mipi dsi host\n"); > + return ret; > + } > + > + return 0; > +} > + > +static int dw_mipi_dsi_rockchip_set_bl(struct udevice *dev, int percent) > +{ > + struct dw_rockchip_dsi_priv *priv = dev_get_priv(dev); > + int ret; > + > + /* > + * Allow backlight to be optional, since this driver may be > + * used to simply detect a panel rather than bring one up. > + */ > + ret = panel_enable_backlight(priv->panel); > + if ((ret) && (ret != -ENOSYS)) { > + dev_err(dev, "panel %s enable backlight error %d\n", > + priv->panel->name, ret); > + return ret; > + } > + > + ret = dsi_host_enable(priv->dsi_host); > + if (ret) { > + dev_err(dev, "failed to enable mipi dsi host\n"); > + return ret; > + } > + > + return 0; > +} > + > +static void dw_mipi_dsi_rockchip_config(struct dw_rockchip_dsi_priv *dsi) > +{ > + if (dsi->cdata->lanecfg1_grf_reg) > + dsi_write(dsi, dsi->cdata->lanecfg1_grf_reg, > + dsi->cdata->lanecfg1); > + > + if (dsi->cdata->lanecfg2_grf_reg) > + dsi_write(dsi, dsi->cdata->lanecfg2_grf_reg, > + dsi->cdata->lanecfg2); > + > + if (dsi->cdata->enable_grf_reg) > + dsi_write(dsi, dsi->cdata->enable_grf_reg, > + dsi->cdata->enable); > +} > + > +static int dw_mipi_dsi_rockchip_bind(struct udevice *dev) > +{ > + int ret; > + > + ret = device_bind_driver_to_node(dev, "dw_mipi_dsi", "dsihost", > + dev_ofnode(dev), NULL); > + if (ret) { > + dev_err(dev, "failed to bind driver to node\n"); > + return ret; > + } > + > + return dm_scan_fdt_dev(dev); > +} > + > +static int dw_mipi_dsi_rockchip_probe(struct udevice *dev) > +{ > + struct dw_rockchip_dsi_priv *priv = dev_get_priv(dev); > + struct mipi_dsi_device *device = &priv->device; > + int ret, i; > + const struct rockchip_dw_dsi_chip_data *cdata = > + (const struct rockchip_dw_dsi_chip_data *)dev_get_driver_data(dev); > + > + device->dev = dev; > + > + priv->base = (void *)dev_read_addr(dev); > + if ((fdt_addr_t)priv->base == FDT_ADDR_T_NONE) { > + dev_err(dev, "dsi dt register address error\n"); > + return -EINVAL; > + } > + > + i = 0; > + while (cdata[i].reg) { > + if (cdata[i].reg == (fdt_addr_t)priv->base) { > + priv->cdata = &cdata[i]; > + break; > + } > + > + i++; > + } > + > + if (!priv->cdata) { > + dev_err(dev, "no dsi-config for %s node\n", dev->name); > + return -EINVAL; > + } > + > + /* > + * Get an optional external dphy. The external dphy stays as > + * NULL if it's not initialized. > + */ > + ret = generic_phy_get_by_name(dev, "dphy", &priv->phy); > + if ((ret) && (ret != -ENODEV)) { > + dev_err(dev, "failed to get mipi dphy: %d\n", ret); > + return -EINVAL; > + } > + > + priv->pclk = devm_clk_get(dev, "pclk"); > + if (IS_ERR(priv->pclk)) { > + dev_err(dev, "peripheral clock get error %d\n", ret); > + return ret; > + } > + > + /* Get a ref clock only if not using an external phy. */ > + if (&priv->phy) { > + dev_dbg(dev, "setting priv->ref to NULL\n"); > + priv->ref = NULL; > + > + } else { > + priv->ref = devm_clk_get(dev, "ref"); > + if (ret) { > + dev_err(dev, "pll reference clock get error %d\n", ret); > + return ret; > + } > + } > + > + priv->rst = devm_reset_control_get_by_index(device->dev, 0); > + if (IS_ERR(priv->rst)) { > + dev_err(dev, "missing dsi hardware reset\n"); > + return ret; > + } > + > + /* Reset */ > + reset_deassert(priv->rst); > + > + dw_mipi_dsi_rockchip_config(priv); > + > + return 0; > +} > + > +struct video_bridge_ops dw_mipi_dsi_rockchip_ops = { > + .attach = dw_mipi_dsi_rockchip_attach, > + .set_backlight = dw_mipi_dsi_rockchip_set_bl, > +}; > + > +static const struct rockchip_dw_dsi_chip_data rk3568_chip_data[] = { > + { > + .reg = 0xfe060000, > + .lanecfg1_grf_reg = RK3568_GRF_VO_CON2, > + .lanecfg1 = HIWORD_UPDATE(0, RK3568_DSI0_SKEWCALHS | > + RK3568_DSI0_FORCETXSTOPMODE | > + RK3568_DSI0_TURNDISABLE | > + RK3568_DSI0_FORCERXMODE), > + .max_data_lanes = 4, > + }, > + { > + .reg = 0xfe070000, > + .lanecfg1_grf_reg = RK3568_GRF_VO_CON3, > + .lanecfg1 = HIWORD_UPDATE(0, RK3568_DSI1_SKEWCALHS | > + RK3568_DSI1_FORCETXSTOPMODE | > + RK3568_DSI1_TURNDISABLE | > + RK3568_DSI1_FORCERXMODE), > + .max_data_lanes = 4, > + }, > + { /* sentinel */ } > +}; > + > +static const struct udevice_id dw_mipi_dsi_rockchip_dt_ids[] = { > + { .compatible = "rockchip,rk3568-mipi-dsi", > + .data = (long)&rk3568_chip_data, > + }, > + { /* sentinel */ } > +}; > + > +U_BOOT_DRIVER(dw_mipi_dsi_rockchip) = { > + .name = "dw-mipi-dsi-rockchip", > + .id = UCLASS_VIDEO_BRIDGE, > + .of_match = dw_mipi_dsi_rockchip_dt_ids, > + .bind = dw_mipi_dsi_rockchip_bind, > + .probe = dw_mipi_dsi_rockchip_probe, > + .ops = &dw_mipi_dsi_rockchip_ops, > + .priv_auto = sizeof(struct dw_rockchip_dsi_priv), > +}; ^ permalink raw reply [flat|nested] 5+ messages in thread
end of thread, other threads:[~2023-04-14 8:53 UTC | newest] Thread overview: 5+ messages (download: mbox.gz follow: Atom feed -- links below jump to the message on this page -- 2023-03-24 18:53 [PATCH 0/2] rockchip: Add DSI support for RK3568 Chris Morgan 2023-03-24 18:53 ` [PATCH 1/2] drivers: phy: add Innosilicon DSI-DPHY driver Chris Morgan 2023-04-14 8:52 ` Kever Yang 2023-03-24 18:53 ` [PATCH 2/2] rockchip: video: Add support for RK3568 DSI Host Chris Morgan 2023-04-14 8:53 ` Kever Yang
This is a public inbox, see mirroring instructions for how to clone and mirror all data and code used for this inbox