| Message ID | 20240205-phy-hdptx-v2-0-a7150814c047@collabora.com |
|---|---|
| Headers | show |
| Series | Add support for RK3588 HDMI/eDP Combo PHY | expand |
On 05-02-24, 13:24, Cristian Ciocaltea wrote: > Add driver for the HDMI/eDP TX Combo PHY found on Rockchip RK3588 SoC. > > The PHY is based on a Samsung IP block and supports HDMI 2.1 TMDS, FRL > and eDP links. The maximum data rate is 12Gbps (FRL), while the minimum > is 250Mbps (TMDS). > > Only the TMDS link is currently supported. > > Co-developed-by: Algea Cao <algea.cao@rock-chips.com> > Signed-off-by: Algea Cao <algea.cao@rock-chips.com> > Signed-off-by: Cristian Ciocaltea <cristian.ciocaltea@collabora.com> > --- > drivers/phy/rockchip/Kconfig | 8 + > drivers/phy/rockchip/Makefile | 1 + > drivers/phy/rockchip/phy-rockchip-samsung-hdptx.c | 1040 +++++++++++++++++++++ > 3 files changed, 1049 insertions(+) > > diff --git a/drivers/phy/rockchip/Kconfig b/drivers/phy/rockchip/Kconfig > index 94360fc96a6f..a34f67bb7e61 100644 > --- a/drivers/phy/rockchip/Kconfig > +++ b/drivers/phy/rockchip/Kconfig > @@ -83,6 +83,14 @@ config PHY_ROCKCHIP_PCIE > help > Enable this to support the Rockchip PCIe PHY. > > +config PHY_ROCKCHIP_SAMSUNG_HDPTX > + tristate "Rockchip Samsung HDMI/eDP Combo PHY driver" > + depends on (ARCH_ROCKCHIP || COMPILE_TEST) && OF > + select GENERIC_PHY > + help > + Enable this to support the Rockchip HDMI/eDP Combo PHY > + with Samsung IP block. > + > config PHY_ROCKCHIP_SNPS_PCIE3 > tristate "Rockchip Snps PCIe3 PHY Driver" > depends on (ARCH_ROCKCHIP && OF) || COMPILE_TEST > diff --git a/drivers/phy/rockchip/Makefile b/drivers/phy/rockchip/Makefile > index 7eab129230d1..3d911304e654 100644 > --- a/drivers/phy/rockchip/Makefile > +++ b/drivers/phy/rockchip/Makefile > @@ -8,6 +8,7 @@ obj-$(CONFIG_PHY_ROCKCHIP_INNO_HDMI) += phy-rockchip-inno-hdmi.o > obj-$(CONFIG_PHY_ROCKCHIP_INNO_USB2) += phy-rockchip-inno-usb2.o > obj-$(CONFIG_PHY_ROCKCHIP_NANENG_COMBO_PHY) += phy-rockchip-naneng-combphy.o > obj-$(CONFIG_PHY_ROCKCHIP_PCIE) += phy-rockchip-pcie.o > +obj-$(CONFIG_PHY_ROCKCHIP_SAMSUNG_HDPTX) += phy-rockchip-samsung-hdptx.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_USB) += phy-rockchip-usb.o > diff --git a/drivers/phy/rockchip/phy-rockchip-samsung-hdptx.c b/drivers/phy/rockchip/phy-rockchip-samsung-hdptx.c > new file mode 100644 > index 000000000000..744bbe8280a8 > --- /dev/null > +++ b/drivers/phy/rockchip/phy-rockchip-samsung-hdptx.c > @@ -0,0 +1,1040 @@ > +// SPDX-License-Identifier: GPL-2.0+ > +/* > + * Copyright (c) 2021-2022 Rockchip Electronics Co., Ltd. > + * Copyright (c) 2024 Collabora Ltd. > + * > + * Author: Algea Cao <algea.cao@rock-chips.com> > + * Author: Cristian Ciocaltea <cristian.ciocaltea@collabora.com> > + */ > +#include <linux/bitfield.h> > +#include <linux/clk.h> > +#include <linux/delay.h> > +#include <linux/mfd/syscon.h> > +#include <linux/module.h> > +#include <linux/of.h> > +#include <linux/of_platform.h> > +#include <linux/phy/phy.h> > +#include <linux/platform_device.h> > +#include <linux/rational.h> > +#include <linux/regmap.h> > +#include <linux/reset.h> > + > +#define GRF_HDPTX_CON0 0x00 > +#define HDPTX_I_PLL_EN BIT(7) > +#define HDPTX_I_BIAS_EN BIT(6) > +#define HDPTX_I_BGR_EN BIT(5) > +#define GRF_HDPTX_STATUS 0x80 > +#define HDPTX_O_PLL_LOCK_DONE BIT(3) > +#define HDPTX_O_PHY_CLK_RDY BIT(2) > +#define HDPTX_O_PHY_RDY BIT(1) > +#define HDPTX_O_SB_RDY BIT(0) > + > +#define HDTPX_REG(_n, _min, _max) \ > + ( \ > + BUILD_BUG_ON_ZERO((0x##_n) < (0x##_min)) + \ > + BUILD_BUG_ON_ZERO((0x##_n) > (0x##_max)) + \ > + ((0x##_n) * 4) \ > + ) > + > +#define CMN_REG(n) HDTPX_REG(n, 0000, 00A7) > +#define SB_REG(n) HDTPX_REG(n, 0100, 0129) > +#define LNTOP_REG(n) HDTPX_REG(n, 0200, 0229) > +#define LANE_REG(n) HDTPX_REG(n, 0300, 062D) > + > +/* CMN_REG(0008) */ > +#define LCPLL_EN_MASK BIT(6) > +#define LCPLL_LCVCO_MODE_EN_MASK BIT(4) > +/* CMN_REG(001E) */ > +#define LCPLL_PI_EN_MASK BIT(5) > +#define LCPLL_100M_CLK_EN_MASK BIT(0) > +/* CMN_REG(0025) */ > +#define LCPLL_PMS_IQDIV_RSTN BIT(4) > +/* CMN_REG(0028) */ > +#define LCPLL_SDC_FRAC_EN BIT(2) > +#define LCPLL_SDC_FRAC_RSTN BIT(0) > +/* CMN_REG(002D) */ > +#define LCPLL_SDC_N_MASK GENMASK(3, 1) > +/* CMN_REG(002E) */ > +#define LCPLL_SDC_NUMBERATOR_MASK GENMASK(5, 0) > +/* CMN_REG(002F) */ > +#define LCPLL_SDC_DENOMINATOR_MASK GENMASK(7, 2) > +#define LCPLL_SDC_NDIV_RSTN BIT(0) > +/* CMN_REG(003D) */ > +#define ROPLL_LCVCO_EN BIT(4) > +/* CMN_REG(004E) */ > +#define ROPLL_PI_EN BIT(5) > +/* CMN_REG(005C) */ > +#define ROPLL_PMS_IQDIV_RSTN BIT(5) > +/* CMN_REG(005E) */ > +#define ROPLL_SDM_EN_MASK BIT(6) > +#define ROPLL_SDM_FRAC_EN_RBR BIT(3) > +#define ROPLL_SDM_FRAC_EN_HBR BIT(2) > +#define ROPLL_SDM_FRAC_EN_HBR2 BIT(1) > +#define ROPLL_SDM_FRAC_EN_HBR3 BIT(0) > +/* CMN_REG(0064) */ > +#define ROPLL_SDM_NUM_SIGN_RBR_MASK BIT(3) > +/* CMN_REG(0069) */ > +#define ROPLL_SDC_N_RBR_MASK GENMASK(2, 0) > +/* CMN_REG(0074) */ > +#define ROPLL_SDC_NDIV_RSTN BIT(2) > +#define ROPLL_SSC_EN BIT(0) > +/* CMN_REG(0081) */ > +#define OVRD_PLL_CD_CLK_EN BIT(8) > +#define PLL_CD_HSCLK_EAST_EN BIT(0) > +/* CMN_REG(0086) */ > +#define PLL_PCG_POSTDIV_SEL_MASK GENMASK(7, 4) > +#define PLL_PCG_CLK_SEL_MASK GENMASK(3, 1) > +#define PLL_PCG_CLK_EN BIT(0) > +/* CMN_REG(0087) */ > +#define PLL_FRL_MODE_EN BIT(3) > +#define PLL_TX_HS_CLK_EN BIT(2) > +/* CMN_REG(0089) */ > +#define LCPLL_ALONE_MODE BIT(1) > +/* CMN_REG(0097) */ > +#define DIG_CLK_SEL BIT(1) > +#define ROPLL_REF BIT(1) > +#define LCPLL_REF 0 > +/* CMN_REG(0099) */ > +#define CMN_ROPLL_ALONE_MODE BIT(2) > +#define ROPLL_ALONE_MODE BIT(2) > +/* CMN_REG(009A) */ > +#define HS_SPEED_SEL BIT(0) > +#define DIV_10_CLOCK BIT(0) > +/* CMN_REG(009B) */ > +#define IS_SPEED_SEL BIT(4) > +#define LINK_SYMBOL_CLOCK BIT(4) > +#define LINK_SYMBOL_CLOCK1_2 0 > + > +/* SB_REG(0102) */ > +#define OVRD_SB_RXTERM_EN_MASK BIT(5) > +#define SB_RXTERM_EN_MASK BIT(4) > +#define ANA_SB_RXTERM_OFFSP_MASK GENMASK(3, 0) > +/* SB_REG(0103) */ > +#define ANA_SB_RXTERM_OFFSN_MASK GENMASK(6, 3) > +#define OVRD_SB_RX_RESCAL_DONE_MASK BIT(1) > +#define SB_RX_RESCAL_DONE_MASK BIT(0) > +/* SB_REG(0104) */ > +#define OVRD_SB_EN_MASK BIT(5) > +#define SB_EN_MASK BIT(4) > +/* SB_REG(0105) */ > +#define OVRD_SB_EARC_CMDC_EN_MASK BIT(6) > +#define SB_EARC_CMDC_EN_MASK BIT(5) > +#define ANA_SB_TX_HLVL_PROG_MASK GENMASK(2, 0) > +/* SB_REG(0106) */ > +#define ANA_SB_TX_LLVL_PROG_MASK GENMASK(6, 4) > +/* SB_REG(0109) */ > +#define ANA_SB_DMRX_AFC_DIV_RATIO_MASK GENMASK(2, 0) > +/* SB_REG(010F) */ > +#define OVRD_SB_VREG_EN_MASK BIT(7) > +#define SB_VREG_EN_MASK BIT(6) > +#define OVRD_SB_VREG_LPF_BYPASS_MASK BIT(5) > +#define SB_VREG_LPF_BYPASS_MASK BIT(4) > +#define ANA_SB_VREG_GAIN_CTRL_MASK GENMASK(3, 0) > +/* SB_REG(0110) */ > +#define ANA_SB_VREG_REF_SEL_MASK BIT(0) > +/* SB_REG(0113) */ > +#define SB_RX_RCAL_OPT_CODE_MASK GENMASK(5, 4) > +#define SB_RX_RTERM_CTRL_MASK GENMASK(3, 0) > +/* SB_REG(0114) */ > +#define SB_TG_SB_EN_DELAY_TIME_MASK GENMASK(5, 3) > +#define SB_TG_RXTERM_EN_DELAY_TIME_MASK GENMASK(2, 0) > +/* SB_REG(0115) */ > +#define SB_READY_DELAY_TIME_MASK GENMASK(5, 3) > +#define SB_TG_OSC_EN_DELAY_TIME_MASK GENMASK(2, 0) > +/* SB_REG(0116) */ > +#define AFC_RSTN_DELAY_TIME_MASK GENMASK(6, 4) > +/* SB_REG(0117) */ > +#define FAST_PULSE_TIME_MASK GENMASK(3, 0) > +/* SB_REG(011B) */ > +#define SB_EARC_SIG_DET_BYPASS_MASK BIT(4) > +#define SB_AFC_TOL_MASK GENMASK(3, 0) > +/* SB_REG(011F) */ > +#define SB_PWM_AFC_CTRL_MASK GENMASK(7, 2) > +#define SB_RCAL_RSTN_MASK BIT(1) > +/* SB_REG(0120) */ > +#define SB_EARC_EN_MASK BIT(1) > +#define SB_EARC_AFC_EN_MASK BIT(2) > +/* SB_REG(0123) */ > +#define OVRD_SB_READY_MASK BIT(5) > +#define SB_READY_MASK BIT(4) > + > +/* LNTOP_REG(0200) */ > +#define PROTOCOL_SEL BIT(2) > +#define HDMI_MODE BIT(2) > +#define HDMI_TMDS_FRL_SEL BIT(1) > +/* LNTOP_REG(0206) */ > +#define DATA_BUS_SEL BIT(0) > +#define DATA_BUS_36_40 BIT(0) > +/* LNTOP_REG(0207) */ > +#define LANE_EN 0xf > +#define ALL_LANE_EN 0xf > + > +/* LANE_REG(0312) */ > +#define LN0_TX_SER_RATE_SEL_RBR BIT(5) > +#define LN0_TX_SER_RATE_SEL_HBR BIT(4) > +#define LN0_TX_SER_RATE_SEL_HBR2 BIT(3) > +#define LN0_TX_SER_RATE_SEL_HBR3 BIT(2) > +/* LANE_REG(0412) */ > +#define LN1_TX_SER_RATE_SEL_RBR BIT(5) > +#define LN1_TX_SER_RATE_SEL_HBR BIT(4) > +#define LN1_TX_SER_RATE_SEL_HBR2 BIT(3) > +#define LN1_TX_SER_RATE_SEL_HBR3 BIT(2) > +/* LANE_REG(0512) */ > +#define LN2_TX_SER_RATE_SEL_RBR BIT(5) > +#define LN2_TX_SER_RATE_SEL_HBR BIT(4) > +#define LN2_TX_SER_RATE_SEL_HBR2 BIT(3) > +#define LN2_TX_SER_RATE_SEL_HBR3 BIT(2) > +/* LANE_REG(0612) */ > +#define LN3_TX_SER_RATE_SEL_RBR BIT(5) > +#define LN3_TX_SER_RATE_SEL_HBR BIT(4) > +#define LN3_TX_SER_RATE_SEL_HBR2 BIT(3) > +#define LN3_TX_SER_RATE_SEL_HBR3 BIT(2) > + > +struct lcpll_config { > + u32 bit_rate; > + u8 lcvco_mode_en; > + u8 pi_en; > + u8 clk_en_100m; > + u8 pms_mdiv; > + u8 pms_mdiv_afc; > + u8 pms_pdiv; > + u8 pms_refdiv; > + u8 pms_sdiv; > + u8 pi_cdiv_rstn; > + u8 pi_cdiv_sel; > + u8 sdm_en; > + u8 sdm_rstn; > + u8 sdc_frac_en; > + u8 sdc_rstn; > + u8 sdm_deno; > + u8 sdm_num_sign; > + u8 sdm_num; > + u8 sdc_n; > + u8 sdc_n2; > + u8 sdc_num; > + u8 sdc_deno; > + u8 sdc_ndiv_rstn; > + u8 ssc_en; > + u8 ssc_fm_dev; > + u8 ssc_fm_freq; > + u8 ssc_clk_div_sel; > + u8 cd_tx_ser_rate_sel; > +}; > + > +struct ropll_config { > + u32 bit_rate; > + u8 pms_mdiv; > + u8 pms_mdiv_afc; > + u8 pms_pdiv; > + u8 pms_refdiv; > + u8 pms_sdiv; > + u8 pms_iqdiv_rstn; > + u8 ref_clk_sel; > + u8 sdm_en; > + u8 sdm_rstn; > + u8 sdc_frac_en; > + u8 sdc_rstn; > + u8 sdm_clk_div; > + u8 sdm_deno; > + u8 sdm_num_sign; > + u8 sdm_num; > + u8 sdc_n; > + u8 sdc_num; > + u8 sdc_deno; > + u8 sdc_ndiv_rstn; > + u8 ssc_en; > + u8 ssc_fm_dev; > + u8 ssc_fm_freq; > + u8 ssc_clk_div_sel; > + u8 ana_cpp_ctrl; > + u8 ana_lpf_c_sel; > + u8 cd_tx_ser_rate_sel; > +}; > + > +enum rockchip_hdptx_reset { > + RST_PHY = 0, > + RST_APB, > + RST_INIT, > + RST_CMN, > + RST_LANE, > + RST_ROPLL, > + RST_LCPLL, > + RST_MAX > +}; > + > +struct rockchip_hdptx_phy { > + struct device *dev; > + struct regmap *regmap; > + struct regmap *grf; > + > + struct phy *phy; > + struct phy_config *phy_cfg; > + struct clk_bulk_data *clks; > + int nr_clks; > + struct reset_control_bulk_data rsts[RST_MAX]; > +}; > + > +static const struct ropll_config ropll_tmds_cfg[] = { > + { 5940000, 124, 124, 1, 1, 0, 1, 1, 1, 1, 1, 1, 1, 62, 1, 16, 5, 0, > + 1, 1, 0, 0x20, 0x0c, 1, 0x0e, 0, 0, }, > + { 3712500, 155, 155, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 62, 1, 16, 5, 0, > + 1, 1, 0, 0x20, 0x0c, 1, 0x0e, 0, 0, }, > + { 2970000, 124, 124, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 62, 1, 16, 5, 0, > + 1, 1, 0, 0x20, 0x0c, 1, 0x0e, 0, 0, }, > + { 1620000, 135, 135, 1, 1, 3, 1, 1, 0, 1, 1, 1, 1, 4, 0, 3, 5, 5, 0x10, > + 1, 0, 0x20, 0x0c, 1, 0x0e, 0, 0, }, > + { 1856250, 155, 155, 1, 1, 3, 1, 1, 1, 1, 1, 1, 1, 62, 1, 16, 5, 0, > + 1, 1, 0, 0x20, 0x0c, 1, 0x0e, 0, 0, }, > + { 1540000, 193, 193, 1, 1, 5, 1, 1, 1, 1, 1, 1, 1, 193, 1, 32, 2, 1, > + 1, 1, 0, 0x20, 0x0c, 1, 0x0e, 0, 0, }, > + { 1485000, 0x7b, 0x7b, 1, 1, 3, 1, 1, 1, 1, 1, 1, 1, 4, 0, 3, 5, 5, > + 0x10, 1, 0, 0x20, 0x0c, 1, 0x0e, 0, 0, }, > + { 1462500, 122, 122, 1, 1, 3, 1, 1, 1, 1, 1, 1, 1, 244, 1, 16, 2, 1, 1, > + 1, 0, 0x20, 0x0c, 1, 0x0e, 0, 0, }, > + { 1190000, 149, 149, 1, 1, 5, 1, 1, 1, 1, 1, 1, 1, 149, 1, 16, 2, 1, 1, > + 1, 0, 0x20, 0x0c, 1, 0x0e, 0, 0, }, > + { 1065000, 89, 89, 1, 1, 3, 1, 1, 1, 1, 1, 1, 1, 89, 1, 16, 1, 0, 1, > + 1, 0, 0x20, 0x0c, 1, 0x0e, 0, 0, }, > + { 1080000, 135, 135, 1, 1, 5, 1, 1, 0, 1, 0, 1, 1, 0x9, 0, 0x05, 0, > + 0x14, 0x18, 1, 0, 0x20, 0x0c, 1, 0x0e, 0, 0, }, > + { 855000, 214, 214, 1, 1, 11, 1, 1, 1, 1, 1, 1, 1, 214, 1, 16, 2, 1, > + 1, 1, 0, 0x20, 0x0c, 1, 0x0e, 0, 0, }, > + { 835000, 105, 105, 1, 1, 5, 1, 1, 1, 1, 1, 1, 1, 42, 1, 16, 1, 0, > + 1, 1, 0, 0x20, 0x0c, 1, 0x0e, 0, 0, }, > + { 928125, 155, 155, 1, 1, 7, 1, 1, 1, 1, 1, 1, 1, 62, 1, 16, 5, 0, > + 1, 1, 0, 0x20, 0x0c, 1, 0x0e, 0, 0, }, > + { 742500, 124, 124, 1, 1, 7, 1, 1, 1, 1, 1, 1, 1, 62, 1, 16, 5, 0, > + 1, 1, 0, 0x20, 0x0c, 1, 0x0e, 0, 0, }, > + { 650000, 162, 162, 1, 1, 11, 1, 1, 1, 1, 1, 1, 1, 54, 0, 16, 4, 1, > + 1, 1, 0, 0x20, 0x0c, 1, 0x0e, 0, 0, }, > + { 337500, 0x70, 0x70, 1, 1, 0xf, 1, 1, 1, 1, 1, 1, 1, 0x2, 0, 0x01, 5, > + 1, 1, 1, 0, 0x20, 0x0c, 1, 0x0e, 0, 0, }, > + { 400000, 100, 100, 1, 1, 11, 1, 1, 0, 1, 0, 1, 1, 0x9, 0, 0x05, 0, > + 0x14, 0x18, 1, 0, 0x20, 0x0c, 1, 0x0e, 0, 0, }, > + { 270000, 0x5a, 0x5a, 1, 1, 0xf, 1, 1, 0, 1, 0, 1, 1, 0x9, 0, 0x05, 0, > + 0x14, 0x18, 1, 0, 0x20, 0x0c, 1, 0x0e, 0, 0, }, > + { 251750, 84, 84, 1, 1, 0xf, 1, 1, 1, 1, 1, 1, 1, 168, 1, 16, 4, 1, 1, > + 1, 0, 0x20, 0x0c, 1, 0x0e, 0, 0, }, > +}; > + > +static const struct reg_sequence hdtpx_common_cmn_init_seq[] = { > + REG_SEQ0(CMN_REG(0009), 0x0c), > + REG_SEQ0(CMN_REG(000A), 0x83), > + REG_SEQ0(CMN_REG(000B), 0x06), > + REG_SEQ0(CMN_REG(000C), 0x20), > + REG_SEQ0(CMN_REG(000D), 0xb8), > + REG_SEQ0(CMN_REG(000E), 0x0f), > + REG_SEQ0(CMN_REG(000F), 0x0f), Any reason for these to be mixed case, lets have lower case pls everywhere > + REG_SEQ0(CMN_REG(0010), 0x04), > + REG_SEQ0(CMN_REG(0011), 0x00), > + REG_SEQ0(CMN_REG(0012), 0x26), > + REG_SEQ0(CMN_REG(0013), 0x22), > + REG_SEQ0(CMN_REG(0014), 0x24), > + REG_SEQ0(CMN_REG(0015), 0x77), > + REG_SEQ0(CMN_REG(0016), 0x08), > + REG_SEQ0(CMN_REG(0017), 0x00), > + REG_SEQ0(CMN_REG(0018), 0x04), > + REG_SEQ0(CMN_REG(0019), 0x48), > + REG_SEQ0(CMN_REG(001A), 0x01), > + REG_SEQ0(CMN_REG(001B), 0x00), > + REG_SEQ0(CMN_REG(001C), 0x01), > + REG_SEQ0(CMN_REG(001D), 0x64), > + REG_SEQ0(CMN_REG(001F), 0x00), > + REG_SEQ0(CMN_REG(0026), 0x53), > + REG_SEQ0(CMN_REG(0029), 0x01), > + REG_SEQ0(CMN_REG(0030), 0x00), > + REG_SEQ0(CMN_REG(0031), 0x20), > + REG_SEQ0(CMN_REG(0032), 0x30), > + REG_SEQ0(CMN_REG(0033), 0x0b), > + REG_SEQ0(CMN_REG(0034), 0x23), > + REG_SEQ0(CMN_REG(0035), 0x00), > + REG_SEQ0(CMN_REG(0038), 0x00), > + REG_SEQ0(CMN_REG(0039), 0x00), > + REG_SEQ0(CMN_REG(003A), 0x00), > + REG_SEQ0(CMN_REG(003B), 0x00), > + REG_SEQ0(CMN_REG(003C), 0x80), > + REG_SEQ0(CMN_REG(003E), 0x0c), > + REG_SEQ0(CMN_REG(003F), 0x83), > + REG_SEQ0(CMN_REG(0040), 0x06), > + REG_SEQ0(CMN_REG(0041), 0x20), > + REG_SEQ0(CMN_REG(0042), 0xb8), > + REG_SEQ0(CMN_REG(0043), 0x00), > + REG_SEQ0(CMN_REG(0044), 0x46), > + REG_SEQ0(CMN_REG(0045), 0x24), > + REG_SEQ0(CMN_REG(0046), 0xff), > + REG_SEQ0(CMN_REG(0047), 0x00), > + REG_SEQ0(CMN_REG(0048), 0x44), > + REG_SEQ0(CMN_REG(0049), 0xfa), > + REG_SEQ0(CMN_REG(004A), 0x08), > + REG_SEQ0(CMN_REG(004B), 0x00), > + REG_SEQ0(CMN_REG(004C), 0x01), > + REG_SEQ0(CMN_REG(004D), 0x64), > + REG_SEQ0(CMN_REG(004E), 0x14), > + REG_SEQ0(CMN_REG(004F), 0x00), > + REG_SEQ0(CMN_REG(0050), 0x00), > + REG_SEQ0(CMN_REG(005D), 0x0c), > + REG_SEQ0(CMN_REG(005F), 0x01), > + REG_SEQ0(CMN_REG(006B), 0x04), > + REG_SEQ0(CMN_REG(0073), 0x30), > + REG_SEQ0(CMN_REG(0074), 0x00), > + REG_SEQ0(CMN_REG(0075), 0x20), > + REG_SEQ0(CMN_REG(0076), 0x30), > + REG_SEQ0(CMN_REG(0077), 0x08), > + REG_SEQ0(CMN_REG(0078), 0x0c), > + REG_SEQ0(CMN_REG(0079), 0x00), > + REG_SEQ0(CMN_REG(007B), 0x00), > + REG_SEQ0(CMN_REG(007C), 0x00), > + REG_SEQ0(CMN_REG(007D), 0x00), > + REG_SEQ0(CMN_REG(007E), 0x00), > + REG_SEQ0(CMN_REG(007F), 0x00), > + REG_SEQ0(CMN_REG(0080), 0x00), > + REG_SEQ0(CMN_REG(0081), 0x09), > + REG_SEQ0(CMN_REG(0082), 0x04), > + REG_SEQ0(CMN_REG(0083), 0x24), > + REG_SEQ0(CMN_REG(0084), 0x20), > + REG_SEQ0(CMN_REG(0085), 0x03), > + REG_SEQ0(CMN_REG(0086), 0x01), > + REG_SEQ0(CMN_REG(0087), 0x0c), > + REG_SEQ0(CMN_REG(008A), 0x55), > + REG_SEQ0(CMN_REG(008B), 0x25), > + REG_SEQ0(CMN_REG(008C), 0x2c), > + REG_SEQ0(CMN_REG(008D), 0x22), > + REG_SEQ0(CMN_REG(008E), 0x14), > + REG_SEQ0(CMN_REG(008F), 0x20), > + REG_SEQ0(CMN_REG(0090), 0x00), > + REG_SEQ0(CMN_REG(0091), 0x00), > + REG_SEQ0(CMN_REG(0092), 0x00), > + REG_SEQ0(CMN_REG(0093), 0x00), > + REG_SEQ0(CMN_REG(009A), 0x11), > + REG_SEQ0(CMN_REG(009B), 0x10), > +}; > + > +static const struct reg_sequence hdtpx_tmds_cmn_init_seq[] = { > + REG_SEQ0(CMN_REG(0008), 0x00), > + REG_SEQ0(CMN_REG(0011), 0x01), > + REG_SEQ0(CMN_REG(0017), 0x20), > + REG_SEQ0(CMN_REG(001E), 0x14), > + REG_SEQ0(CMN_REG(0020), 0x00), > + REG_SEQ0(CMN_REG(0021), 0x00), > + REG_SEQ0(CMN_REG(0022), 0x11), > + REG_SEQ0(CMN_REG(0023), 0x00), > + REG_SEQ0(CMN_REG(0024), 0x00), > + REG_SEQ0(CMN_REG(0025), 0x53), > + REG_SEQ0(CMN_REG(0026), 0x00), > + REG_SEQ0(CMN_REG(0027), 0x00), > + REG_SEQ0(CMN_REG(0028), 0x01), > + REG_SEQ0(CMN_REG(002A), 0x00), > + REG_SEQ0(CMN_REG(002B), 0x00), > + REG_SEQ0(CMN_REG(002C), 0x00), > + REG_SEQ0(CMN_REG(002D), 0x00), > + REG_SEQ0(CMN_REG(002E), 0x04), > + REG_SEQ0(CMN_REG(002F), 0x00), > + REG_SEQ0(CMN_REG(0030), 0x20), > + REG_SEQ0(CMN_REG(0031), 0x30), > + REG_SEQ0(CMN_REG(0032), 0x0b), > + REG_SEQ0(CMN_REG(0033), 0x23), > + REG_SEQ0(CMN_REG(0034), 0x00), > + REG_SEQ0(CMN_REG(003D), 0x40), > + REG_SEQ0(CMN_REG(0042), 0x78), > + REG_SEQ0(CMN_REG(004E), 0x34), > + REG_SEQ0(CMN_REG(005C), 0x25), > + REG_SEQ0(CMN_REG(005E), 0x4f), > + REG_SEQ0(CMN_REG(0074), 0x04), > + REG_SEQ0(CMN_REG(0081), 0x01), > + REG_SEQ0(CMN_REG(0087), 0x04), > + REG_SEQ0(CMN_REG(0089), 0x00), > + REG_SEQ0(CMN_REG(0095), 0x00), > + REG_SEQ0(CMN_REG(0097), 0x02), > + REG_SEQ0(CMN_REG(0099), 0x04), > + REG_SEQ0(CMN_REG(009B), 0x00), > +}; > + > +static const struct reg_sequence hdtpx_common_sb_init_seq[] = { > + REG_SEQ0(SB_REG(0114), 0x00), > + REG_SEQ0(SB_REG(0115), 0x00), > + REG_SEQ0(SB_REG(0116), 0x00), > + REG_SEQ0(SB_REG(0117), 0x00), > +}; > + > +static const struct reg_sequence hdtpx_tmds_lntop_highbr_seq[] = { > + REG_SEQ0(LNTOP_REG(0201), 0x00), > + REG_SEQ0(LNTOP_REG(0202), 0x00), > + REG_SEQ0(LNTOP_REG(0203), 0x0f), > + REG_SEQ0(LNTOP_REG(0204), 0xff), > + REG_SEQ0(LNTOP_REG(0205), 0xff), > +}; > + > +static const struct reg_sequence hdtpx_tmds_lntop_lowbr_seq[] = { > + REG_SEQ0(LNTOP_REG(0201), 0x07), > + REG_SEQ0(LNTOP_REG(0202), 0xc1), > + REG_SEQ0(LNTOP_REG(0203), 0xf0), > + REG_SEQ0(LNTOP_REG(0204), 0x7c), > + REG_SEQ0(LNTOP_REG(0205), 0x1f), > +}; > + > +static const struct reg_sequence hdtpx_common_lane_init_seq[] = { > + REG_SEQ0(LANE_REG(0303), 0x0c), > + REG_SEQ0(LANE_REG(0307), 0x20), > + REG_SEQ0(LANE_REG(030A), 0x17), > + REG_SEQ0(LANE_REG(030B), 0x77), > + REG_SEQ0(LANE_REG(030C), 0x77), > + REG_SEQ0(LANE_REG(030D), 0x77), > + REG_SEQ0(LANE_REG(030E), 0x38), > + REG_SEQ0(LANE_REG(0310), 0x03), > + REG_SEQ0(LANE_REG(0311), 0x0f), > + REG_SEQ0(LANE_REG(0316), 0x02), > + REG_SEQ0(LANE_REG(031B), 0x01), > + REG_SEQ0(LANE_REG(031F), 0x15), > + REG_SEQ0(LANE_REG(0320), 0xa0), > + REG_SEQ0(LANE_REG(0403), 0x0c), > + REG_SEQ0(LANE_REG(0407), 0x20), > + REG_SEQ0(LANE_REG(040A), 0x17), > + REG_SEQ0(LANE_REG(040B), 0x77), > + REG_SEQ0(LANE_REG(040C), 0x77), > + REG_SEQ0(LANE_REG(040D), 0x77), > + REG_SEQ0(LANE_REG(040E), 0x38), > + REG_SEQ0(LANE_REG(0410), 0x03), > + REG_SEQ0(LANE_REG(0411), 0x0f), > + REG_SEQ0(LANE_REG(0416), 0x02), > + REG_SEQ0(LANE_REG(041B), 0x01), > + REG_SEQ0(LANE_REG(041F), 0x15), > + REG_SEQ0(LANE_REG(0420), 0xa0), > + REG_SEQ0(LANE_REG(0503), 0x0c), > + REG_SEQ0(LANE_REG(0507), 0x20), > + REG_SEQ0(LANE_REG(050A), 0x17), > + REG_SEQ0(LANE_REG(050B), 0x77), > + REG_SEQ0(LANE_REG(050C), 0x77), > + REG_SEQ0(LANE_REG(050D), 0x77), > + REG_SEQ0(LANE_REG(050E), 0x38), > + REG_SEQ0(LANE_REG(0510), 0x03), > + REG_SEQ0(LANE_REG(0511), 0x0f), > + REG_SEQ0(LANE_REG(0516), 0x02), > + REG_SEQ0(LANE_REG(051B), 0x01), > + REG_SEQ0(LANE_REG(051F), 0x15), > + REG_SEQ0(LANE_REG(0520), 0xa0), > + REG_SEQ0(LANE_REG(0603), 0x0c), > + REG_SEQ0(LANE_REG(0607), 0x20), > + REG_SEQ0(LANE_REG(060A), 0x17), > + REG_SEQ0(LANE_REG(060B), 0x77), > + REG_SEQ0(LANE_REG(060C), 0x77), > + REG_SEQ0(LANE_REG(060D), 0x77), > + REG_SEQ0(LANE_REG(060E), 0x38), > + REG_SEQ0(LANE_REG(0610), 0x03), > + REG_SEQ0(LANE_REG(0611), 0x0f), > + REG_SEQ0(LANE_REG(0616), 0x02), > + REG_SEQ0(LANE_REG(061B), 0x01), > + REG_SEQ0(LANE_REG(061F), 0x15), > + REG_SEQ0(LANE_REG(0620), 0xa0), > +}; > + > +static const struct reg_sequence hdtpx_tmds_lane_init_seq[] = { > + REG_SEQ0(LANE_REG(0312), 0x00), > + REG_SEQ0(LANE_REG(031E), 0x00), > + REG_SEQ0(LANE_REG(0412), 0x00), > + REG_SEQ0(LANE_REG(041E), 0x00), > + REG_SEQ0(LANE_REG(0512), 0x00), > + REG_SEQ0(LANE_REG(051E), 0x00), > + REG_SEQ0(LANE_REG(0612), 0x00), > + REG_SEQ0(LANE_REG(061E), 0x08), > + REG_SEQ0(LANE_REG(0303), 0x2f), > + REG_SEQ0(LANE_REG(0403), 0x2f), > + REG_SEQ0(LANE_REG(0503), 0x2f), > + REG_SEQ0(LANE_REG(0603), 0x2f), > + REG_SEQ0(LANE_REG(0305), 0x03), > + REG_SEQ0(LANE_REG(0405), 0x03), > + REG_SEQ0(LANE_REG(0505), 0x03), > + REG_SEQ0(LANE_REG(0605), 0x03), > + REG_SEQ0(LANE_REG(0306), 0x1c), > + REG_SEQ0(LANE_REG(0406), 0x1c), > + REG_SEQ0(LANE_REG(0506), 0x1c), > + REG_SEQ0(LANE_REG(0606), 0x1c), > +}; > + > +static bool rockchip_hdptx_phy_is_rw_reg(struct device *dev, unsigned int reg) > +{ > + switch (reg) { > + case 0x0000 ... 0x029c: > + case 0x0400 ... 0x04a4: > + case 0x0800 ... 0x08a4: > + case 0x0c00 ... 0x0cb4: > + case 0x1000 ... 0x10b4: > + case 0x1400 ... 0x14b4: > + case 0x1800 ... 0x18b4: > + return true; > + } > + > + return false; > +} > + > +static const struct regmap_config rockchip_hdptx_phy_regmap_config = { > + .reg_bits = 32, > + .reg_stride = 4, > + .val_bits = 32, > + .writeable_reg = rockchip_hdptx_phy_is_rw_reg, > + .readable_reg = rockchip_hdptx_phy_is_rw_reg, > + .fast_io = true, > + .max_register = 0x18b4, > +}; > + > +static int hdptx_write(struct rockchip_hdptx_phy *hdptx, u32 reg, u8 val) > +{ > + return regmap_write(hdptx->regmap, reg, val); > +} > + > +#define hdptx_multi_reg_write(hdptx, seq) \ > + regmap_multi_reg_write((hdptx)->regmap, seq, ARRAY_SIZE(seq)) > + > +static int hdptx_update_bits(struct rockchip_hdptx_phy *hdptx, u32 reg, > + u8 mask, u8 val) > +{ > + return regmap_update_bits(hdptx->regmap, reg, mask, val); > +} > + > +static int hdptx_grf_write(struct rockchip_hdptx_phy *hdptx, u32 reg, u32 val) > +{ > + return regmap_write(hdptx->grf, reg, val); > +} > + > +static u8 hdptx_grf_read(struct rockchip_hdptx_phy *hdptx, u32 reg) > +{ > + u32 val; > + > + regmap_read(hdptx->grf, reg, &val); > + > + return val; > +} why use wrappers, why not call regmap_ apis directly > + > +static void hdptx_pre_power_up(struct rockchip_hdptx_phy *hdptx) > +{ > + u32 val; > + > + reset_control_assert(hdptx->rsts[RST_APB].rstc); > + usleep_range(20, 25); > + reset_control_deassert(hdptx->rsts[RST_APB].rstc); > + > + reset_control_assert(hdptx->rsts[RST_LANE].rstc); > + reset_control_assert(hdptx->rsts[RST_CMN].rstc); > + reset_control_assert(hdptx->rsts[RST_INIT].rstc); > + > + val = (HDPTX_I_PLL_EN | HDPTX_I_BIAS_EN | HDPTX_I_BGR_EN) << 16; > + hdptx_grf_write(hdptx, GRF_HDPTX_CON0, val); > +} > + > +static int hdptx_post_enable_lane(struct rockchip_hdptx_phy *hdptx) > +{ > + u32 val; > + int ret; > + > + reset_control_deassert(hdptx->rsts[RST_LANE].rstc); > + > + val = (HDPTX_I_BIAS_EN | HDPTX_I_BGR_EN) << 16 | > + HDPTX_I_BIAS_EN | HDPTX_I_BGR_EN; > + hdptx_grf_write(hdptx, GRF_HDPTX_CON0, val); > + > + ret = regmap_read_poll_timeout(hdptx->grf, GRF_HDPTX_STATUS, val, > + (val & HDPTX_O_PHY_RDY) && > + (val & HDPTX_O_PLL_LOCK_DONE), > + 100, 5000); > + if (ret) { > + dev_err(hdptx->dev, "Failed to get PHY lane lock: %d\n", ret); > + return ret; > + } > + > + dev_dbg(hdptx->dev, "PHY lane locked\n"); > + > + return 0; > +} > + > +static int hdptx_post_enable_pll(struct rockchip_hdptx_phy *hdptx) > +{ > + u32 val; > + int ret; > + > + val = (HDPTX_I_BIAS_EN | HDPTX_I_BGR_EN) << 16 | > + HDPTX_I_BIAS_EN | HDPTX_I_BGR_EN; > + hdptx_grf_write(hdptx, GRF_HDPTX_CON0, val); > + > + usleep_range(10, 15); > + reset_control_deassert(hdptx->rsts[RST_INIT].rstc); > + > + usleep_range(10, 15); > + val = HDPTX_I_PLL_EN << 16 | HDPTX_I_PLL_EN; > + hdptx_grf_write(hdptx, GRF_HDPTX_CON0, val); > + > + usleep_range(10, 15); > + reset_control_deassert(hdptx->rsts[RST_CMN].rstc); > + > + ret = regmap_read_poll_timeout(hdptx->grf, GRF_HDPTX_STATUS, val, > + val & HDPTX_O_PHY_CLK_RDY, 20, 400); > + if (ret) { > + dev_err(hdptx->dev, "Failed to get PHY clk ready: %d\n", ret); > + return ret; > + } > + > + dev_dbg(hdptx->dev, "PHY clk ready\n"); > + > + return 0; > +} > + > +static void hdptx_phy_disable(struct rockchip_hdptx_phy *hdptx) > +{ > + u32 val; > + > + /* reset phy and apb, or phy locked flag may keep 1 */ > + reset_control_assert(hdptx->rsts[RST_PHY].rstc); > + usleep_range(20, 30); > + reset_control_deassert(hdptx->rsts[RST_PHY].rstc); > + > + reset_control_assert(hdptx->rsts[RST_APB].rstc); > + usleep_range(20, 30); > + reset_control_deassert(hdptx->rsts[RST_APB].rstc); > + > + hdptx_write(hdptx, LANE_REG(0300), 0x82); > + hdptx_write(hdptx, SB_REG(010F), 0xc1); > + hdptx_write(hdptx, SB_REG(0110), 0x1); > + hdptx_write(hdptx, LANE_REG(0301), 0x80); > + hdptx_write(hdptx, LANE_REG(0401), 0x80); > + hdptx_write(hdptx, LANE_REG(0501), 0x80); > + hdptx_write(hdptx, LANE_REG(0601), 0x80); > + > + reset_control_assert(hdptx->rsts[RST_LANE].rstc); > + reset_control_assert(hdptx->rsts[RST_CMN].rstc); > + reset_control_assert(hdptx->rsts[RST_INIT].rstc); > + > + val = (HDPTX_I_PLL_EN | HDPTX_I_BIAS_EN | HDPTX_I_BGR_EN) << 16; > + hdptx_grf_write(hdptx, GRF_HDPTX_CON0, val); > +} > + > +static bool hdptx_phy_clk_pll_calc(unsigned int data_rate, > + struct ropll_config *cfg) > +{ > + const unsigned int fout = data_rate / 2, fref = 24000; > + unsigned long k = 0, lc, k_sub, lc_sub; > + unsigned int fvco, sdc; > + u32 mdiv, sdiv, n = 8; > + > + for (sdiv = 16; sdiv >= 1; sdiv--) { > + if (sdiv % 2 && sdiv != 1) > + continue; > + > + fvco = fout * sdiv; > + > + if (fvco < 2000000 || fvco > 4000000) > + continue; > + > + mdiv = DIV_ROUND_UP(fvco, fref); > + if (mdiv < 20 || mdiv > 255) > + continue; > + > + if (fref * mdiv - fvco) { > + for (sdc = 264000; sdc <= 750000; sdc += fref) > + if (sdc * n > fref * mdiv) > + break; > + > + if (sdc > 750000) > + continue; > + > + rational_best_approximation(fref * mdiv - fvco, > + sdc / 16, > + GENMASK(6, 0), > + GENMASK(7, 0), > + &k, &lc); > + > + rational_best_approximation(sdc * n - fref * mdiv, > + sdc, > + GENMASK(6, 0), > + GENMASK(7, 0), > + &k_sub, &lc_sub); > + } > + > + break; > + } > + > + if (sdiv < 1) > + return false; > + > + if (cfg) { > + cfg->pms_mdiv = mdiv; > + cfg->pms_mdiv_afc = mdiv; > + cfg->pms_pdiv = 1; > + cfg->pms_refdiv = 1; > + cfg->pms_sdiv = sdiv - 1; > + > + cfg->sdm_en = k > 0 ? 1 : 0; > + if (cfg->sdm_en) { > + cfg->sdm_deno = lc; > + cfg->sdm_num_sign = 1; > + cfg->sdm_num = k; > + cfg->sdc_n = n - 3; > + cfg->sdc_num = k_sub; > + cfg->sdc_deno = lc_sub; > + } > + } > + > + return true; > +} > + > +static int hdptx_ropll_tmds_cmn_config(struct rockchip_hdptx_phy *hdptx, > + unsigned int rate) > +{ > + const struct ropll_config *cfg = NULL; > + struct ropll_config rc = {0}; > + int i; > + > + for (i = 0; i < ARRAY_SIZE(ropll_tmds_cfg); i++) > + if (rate == ropll_tmds_cfg[i].bit_rate) { > + cfg = &ropll_tmds_cfg[i]; > + break; > + } > + > + if (!cfg) { > + if (hdptx_phy_clk_pll_calc(rate, &rc)) { > + cfg = &rc; > + } else { > + dev_err(hdptx->dev, "%s cannot find pll cfg\n", __func__); > + return -EINVAL; > + } > + } > + > + dev_dbg(hdptx->dev, "mdiv=%u, sdiv=%u, sdm_en=%u, k_sign=%u, k=%u, lc=%u\n", > + cfg->pms_mdiv, cfg->pms_sdiv + 1, cfg->sdm_en, > + cfg->sdm_num_sign, cfg->sdm_num, cfg->sdm_deno); > + > + hdptx_pre_power_up(hdptx); > + > + reset_control_assert(hdptx->rsts[RST_ROPLL].rstc); > + usleep_range(20, 30); > + reset_control_deassert(hdptx->rsts[RST_ROPLL].rstc); > + > + hdptx_multi_reg_write(hdptx, hdtpx_common_cmn_init_seq); > + hdptx_multi_reg_write(hdptx, hdtpx_tmds_cmn_init_seq); > + > + hdptx_write(hdptx, CMN_REG(0051), cfg->pms_mdiv); > + hdptx_write(hdptx, CMN_REG(0055), cfg->pms_mdiv_afc); > + hdptx_write(hdptx, CMN_REG(0059), (cfg->pms_pdiv << 4) | cfg->pms_refdiv); > + hdptx_write(hdptx, CMN_REG(005A), cfg->pms_sdiv << 4); small case here as well pls > + > + hdptx_update_bits(hdptx, CMN_REG(005E), ROPLL_SDM_EN_MASK, > + FIELD_PREP(ROPLL_SDM_EN_MASK, cfg->sdm_en)); > + if (!cfg->sdm_en) > + hdptx_update_bits(hdptx, CMN_REG(005E), 0xf, 0); > + > + hdptx_update_bits(hdptx, CMN_REG(0064), ROPLL_SDM_NUM_SIGN_RBR_MASK, > + FIELD_PREP(ROPLL_SDM_NUM_SIGN_RBR_MASK, cfg->sdm_num_sign)); > + > + hdptx_write(hdptx, CMN_REG(0060), cfg->sdm_deno); > + hdptx_write(hdptx, CMN_REG(0065), cfg->sdm_num); > + > + hdptx_update_bits(hdptx, CMN_REG(0069), ROPLL_SDC_N_RBR_MASK, > + FIELD_PREP(ROPLL_SDC_N_RBR_MASK, cfg->sdc_n)); > + > + hdptx_write(hdptx, CMN_REG(006C), cfg->sdc_num); > + hdptx_write(hdptx, CMN_REG(0070), cfg->sdc_deno); > + > + hdptx_update_bits(hdptx, CMN_REG(0086), PLL_PCG_POSTDIV_SEL_MASK, > + FIELD_PREP(PLL_PCG_POSTDIV_SEL_MASK, cfg->pms_sdiv)); > + > + hdptx_update_bits(hdptx, CMN_REG(0086), PLL_PCG_CLK_EN, PLL_PCG_CLK_EN); > + > + return hdptx_post_enable_pll(hdptx); > +} > + > +static int hdptx_ropll_tmds_mode_config(struct rockchip_hdptx_phy *hdptx, > + unsigned int rate) > +{ > + int ret; > + > + if (!(hdptx_grf_read(hdptx, GRF_HDPTX_STATUS) & HDPTX_O_PLL_LOCK_DONE)) { > + ret = hdptx_ropll_tmds_cmn_config(hdptx, rate); > + if (ret) > + return ret; > + } > + > + hdptx_multi_reg_write(hdptx, hdtpx_common_sb_init_seq); > + > + hdptx_write(hdptx, LNTOP_REG(0200), 0x06); > + > + if (rate >= 3400000) { > + /* For 1/40 bitrate clk */ > + hdptx_multi_reg_write(hdptx, hdtpx_tmds_lntop_highbr_seq); > + } else { > + /* For 1/10 bitrate clk */ > + hdptx_multi_reg_write(hdptx, hdtpx_tmds_lntop_lowbr_seq); > + } > + > + hdptx_write(hdptx, LNTOP_REG(0206), 0x07); > + hdptx_write(hdptx, LNTOP_REG(0207), 0x0f); > + > + hdptx_multi_reg_write(hdptx, hdtpx_common_lane_init_seq); > + hdptx_multi_reg_write(hdptx, hdtpx_tmds_lane_init_seq); > + > + return hdptx_post_enable_lane(hdptx); > +} > + > +static int rockchip_hdptx_phy_power_on(struct phy *phy) > +{ > + struct rockchip_hdptx_phy *hdptx = phy_get_drvdata(phy); > + int ret, bus_width = phy_get_bus_width(hdptx->phy); > + /* > + * FIXME: Temporary workaround to pass pixel_clk_rate > + * from the HDMI bridge driver until phy_configure_opts_hdmi > + * becomes available in the PHY API. > + */ > + unsigned int rate = bus_width & 0xFFFFFFF; > + > + dev_dbg(hdptx->dev, "%s bus_width=%x rate=%u\n", > + __func__, bus_width, rate); > + > + ret = pm_runtime_resume_and_get(hdptx->dev); > + if (ret) { > + dev_err(hdptx->dev, "Failed to resume phy: %d\n", ret); > + return ret; > + } > + > + ret = hdptx_ropll_tmds_mode_config(hdptx, rate); > + if (ret) > + pm_runtime_put(hdptx->dev); > + > + return ret; > +} > + > +static int rockchip_hdptx_phy_power_off(struct phy *phy) > +{ > + struct rockchip_hdptx_phy *hdptx = phy_get_drvdata(phy); > + > + if (hdptx_grf_read(hdptx, GRF_HDPTX_STATUS) & HDPTX_O_PLL_LOCK_DONE) > + hdptx_phy_disable(hdptx); > + > + pm_runtime_put(hdptx->dev); > + > + return 0; > +} > + > +static const struct phy_ops rockchip_hdptx_phy_ops = { > + .power_on = rockchip_hdptx_phy_power_on, > + .power_off = rockchip_hdptx_phy_power_off, > + .owner = THIS_MODULE, > +}; > + > +static int rockchip_hdptx_phy_runtime_suspend(struct device *dev) > +{ > + struct rockchip_hdptx_phy *hdptx = dev_get_drvdata(dev); > + > + clk_bulk_disable_unprepare(hdptx->nr_clks, hdptx->clks); > + > + return 0; > +} > + > +static int rockchip_hdptx_phy_runtime_resume(struct device *dev) > +{ > + struct rockchip_hdptx_phy *hdptx = dev_get_drvdata(dev); > + int ret; > + > + ret = clk_bulk_prepare_enable(hdptx->nr_clks, hdptx->clks); > + if (ret) > + dev_err(hdptx->dev, "Failed to enable clocks: %d\n", ret); > + > + return ret; > +} > + > +static int rockchip_hdptx_phy_probe(struct platform_device *pdev) > +{ > + struct device *dev = &pdev->dev; > + struct rockchip_hdptx_phy *hdptx; > + struct phy_provider *phy_provider; > + void __iomem *regs; > + int ret; > + > + hdptx = devm_kzalloc(dev, sizeof(*hdptx), GFP_KERNEL); > + if (!hdptx) > + return -ENOMEM; > + > + hdptx->dev = dev; > + > + regs = devm_platform_ioremap_resource(pdev, 0); > + if (IS_ERR(regs)) > + return dev_err_probe(dev, PTR_ERR(regs), > + "Failed to ioremap resource\n"); > + > + ret = devm_clk_bulk_get_all(dev, &hdptx->clks); > + if (ret < 0) > + return dev_err_probe(dev, ret, "Failed to get clocks\n"); > + if (ret == 0) > + return dev_err_probe(dev, -EINVAL, "Missing clocks\n"); > + > + hdptx->nr_clks = ret; > + > + hdptx->regmap = devm_regmap_init_mmio(dev, regs, > + &rockchip_hdptx_phy_regmap_config); > + if (IS_ERR(hdptx->regmap)) > + return dev_err_probe(dev, PTR_ERR(hdptx->regmap), > + "Failed to init regmap\n"); > + > + hdptx->rsts[RST_PHY].id = "phy"; > + hdptx->rsts[RST_APB].id = "apb"; > + hdptx->rsts[RST_INIT].id = "init"; > + hdptx->rsts[RST_CMN].id = "cmn"; > + hdptx->rsts[RST_LANE].id = "lane"; > + hdptx->rsts[RST_ROPLL].id = "ropll"; > + hdptx->rsts[RST_LCPLL].id = "lcpll"; > + > + ret = devm_reset_control_bulk_get_exclusive(dev, RST_MAX, hdptx->rsts); > + if (ret) > + return dev_err_probe(dev, ret, "Failed to get resets\n"); > + > + hdptx->grf = syscon_regmap_lookup_by_phandle(dev->of_node, > + "rockchip,grf"); > + if (IS_ERR(hdptx->grf)) > + return dev_err_probe(dev, PTR_ERR(hdptx->grf), > + "Could not get GRF syscon\n"); > + > + hdptx->phy = devm_phy_create(dev, NULL, &rockchip_hdptx_phy_ops); > + if (IS_ERR(hdptx->phy)) > + return dev_err_probe(dev, PTR_ERR(hdptx->phy), > + "Failed to create HDMI PHY\n"); > + > + platform_set_drvdata(pdev, hdptx); > + phy_set_drvdata(hdptx->phy, hdptx); > + phy_set_bus_width(hdptx->phy, 8); > + > + ret = devm_pm_runtime_enable(dev); > + if (ret) > + return dev_err_probe(dev, ret, "Failed to enable runtime PM\n"); > + > + phy_provider = devm_of_phy_provider_register(dev, of_phy_simple_xlate); > + if (IS_ERR(phy_provider)) > + return dev_err_probe(dev, PTR_ERR(phy_provider), > + "Failed to register PHY provider\n"); > + > + reset_control_deassert(hdptx->rsts[RST_APB].rstc); > + reset_control_deassert(hdptx->rsts[RST_CMN].rstc); > + reset_control_deassert(hdptx->rsts[RST_INIT].rstc); > + > + return 0; > +} > + > +static const struct dev_pm_ops rockchip_hdptx_phy_pm_ops = { > + RUNTIME_PM_OPS(rockchip_hdptx_phy_runtime_suspend, > + rockchip_hdptx_phy_runtime_resume, NULL) > +}; > + > +static const struct of_device_id rockchip_hdptx_phy_of_match[] = { > + { .compatible = "rockchip,rk3588-hdptx-phy", }, > + {} > +}; > +MODULE_DEVICE_TABLE(of, rockchip_hdptx_phy_of_match); > + > +static struct platform_driver rockchip_hdptx_phy_driver = { > + .probe = rockchip_hdptx_phy_probe, > + .driver = { > + .name = "rockchip-hdptx-phy", > + .pm = &rockchip_hdptx_phy_pm_ops, > + .of_match_table = rockchip_hdptx_phy_of_match, > + }, > +}; > +module_platform_driver(rockchip_hdptx_phy_driver); > + > +MODULE_AUTHOR("Algea Cao <algea.cao@rock-chips.com>"); > +MODULE_AUTHOR("Cristian Ciocaltea <cristian.ciocaltea@collabora.com>"); > +MODULE_DESCRIPTION("Samsung HDMI/eDP Transmitter Combo PHY Driver"); > +MODULE_LICENSE("GPL"); > > -- > 2.43.0
On 2/7/24 12:16, Vinod Koul wrote: > On 05-02-24, 13:24, Cristian Ciocaltea wrote: >> Add driver for the HDMI/eDP TX Combo PHY found on Rockchip RK3588 SoC. [...] >> +static const struct reg_sequence hdtpx_common_cmn_init_seq[] = { >> + REG_SEQ0(CMN_REG(0009), 0x0c), >> + REG_SEQ0(CMN_REG(000A), 0x83), >> + REG_SEQ0(CMN_REG(000B), 0x06), >> + REG_SEQ0(CMN_REG(000C), 0x20), >> + REG_SEQ0(CMN_REG(000D), 0xb8), >> + REG_SEQ0(CMN_REG(000E), 0x0f), >> + REG_SEQ0(CMN_REG(000F), 0x0f), > > Any reason for these to be mixed case, lets have lower case pls > everywhere These were initially part of the register name defines, as specified in the RK3588 Technical Reference Manual, e.g. HDPTXPHY_CMN_REG000A. But consistency is more important, I assume, hence I will do a lower case conversion. [...] >> +static int hdptx_write(struct rockchip_hdptx_phy *hdptx, u32 reg, u8 val) >> +{ >> + return regmap_write(hdptx->regmap, reg, val); >> +} >> + >> +#define hdptx_multi_reg_write(hdptx, seq) \ >> + regmap_multi_reg_write((hdptx)->regmap, seq, ARRAY_SIZE(seq)) >> + >> +static int hdptx_update_bits(struct rockchip_hdptx_phy *hdptx, u32 reg, >> + u8 mask, u8 val) >> +{ >> + return regmap_update_bits(hdptx->regmap, reg, mask, val); >> +} >> + >> +static int hdptx_grf_write(struct rockchip_hdptx_phy *hdptx, u32 reg, u32 val) >> +{ >> + return regmap_write(hdptx->grf, reg, val); >> +} >> + >> +static u8 hdptx_grf_read(struct rockchip_hdptx_phy *hdptx, u32 reg) >> +{ >> + u32 val; >> + >> + regmap_read(hdptx->grf, reg, &val); >> + >> + return val; >> +} > > why use wrappers, why not call regmap_ apis directly Agree, no real benefit, will drop them, except probably hdptx_multi_reg_write() for the extra savings. So I'd keep using that one if there's no strong reason against. [...] >> + hdptx_write(hdptx, CMN_REG(0059), (cfg->pms_pdiv << 4) | cfg->pms_refdiv); >> + hdptx_write(hdptx, CMN_REG(005A), cfg->pms_sdiv << 4); > > small case here as well pls Yes, will make sure to handle them all. Thanks for the review, Cristian
On 07-02-24, 14:39, Cristian Ciocaltea wrote: > On 2/7/24 12:16, Vinod Koul wrote: > > On 05-02-24, 13:24, Cristian Ciocaltea wrote: > >> +static u8 hdptx_grf_read(struct rockchip_hdptx_phy *hdptx, u32 reg) > >> +{ > >> + u32 val; > >> + > >> + regmap_read(hdptx->grf, reg, &val); > >> + > >> + return val; > >> +} > > > > why use wrappers, why not call regmap_ apis directly > > Agree, no real benefit, will drop them, except probably > hdptx_multi_reg_write() for the extra savings. That one is fine as there is good logic on the helper > So I'd keep using that one if there's no strong reason against. ok
Am Montag, 5. Februar 2024, 12:24:25 CET schrieb Cristian Ciocaltea: > Add driver for the HDMI/eDP TX Combo PHY found on Rockchip RK3588 SoC. > > The PHY is based on a Samsung IP block and supports HDMI 2.1 TMDS, FRL > and eDP links. The maximum data rate is 12Gbps (FRL), while the minimum > is 250Mbps (TMDS). > > Only the TMDS link is currently supported. > > Co-developed-by: Algea Cao <algea.cao@rock-chips.com> > Signed-off-by: Algea Cao <algea.cao@rock-chips.com> > Signed-off-by: Cristian Ciocaltea <cristian.ciocaltea@collabora.com> on a rk3588-jaguar Tested-by: Heiko Stuebner <heiko@sntech.de>
On 2/8/24 10:00, Heiko Stübner wrote: > Am Montag, 5. Februar 2024, 12:24:25 CET schrieb Cristian Ciocaltea: >> Add driver for the HDMI/eDP TX Combo PHY found on Rockchip RK3588 SoC. >> >> The PHY is based on a Samsung IP block and supports HDMI 2.1 TMDS, FRL >> and eDP links. The maximum data rate is 12Gbps (FRL), while the minimum >> is 250Mbps (TMDS). >> >> Only the TMDS link is currently supported. >> >> Co-developed-by: Algea Cao <algea.cao@rock-chips.com> >> Signed-off-by: Algea Cao <algea.cao@rock-chips.com> >> Signed-off-by: Cristian Ciocaltea <cristian.ciocaltea@collabora.com> > > on a rk3588-jaguar > Tested-by: Heiko Stuebner <heiko@sntech.de> Thanks for testing this! Will send v3 soon. Regards, Cristian
Hi Cristian, On Mon, 2024-02-05 at 13:24 +0200, Cristian Ciocaltea wrote: > + > +static bool hdptx_phy_clk_pll_calc(unsigned int data_rate, > + struct ropll_config *cfg) > +{ > + const unsigned int fout = data_rate / 2, fref = 24000; > + unsigned long k = 0, lc, k_sub, lc_sub; > + unsigned int fvco, sdc; > + u32 mdiv, sdiv, n = 8; > + > + for (sdiv = 16; sdiv >= 1; sdiv--) { > + if (sdiv % 2 && sdiv != 1) > + continue; > + > + fvco = fout * sdiv; > + > + if (fvco < 2000000 || fvco > 4000000) > + continue; > + What about adding a check to data_rate, maybe like if (fout > 0x0FFFFFFF) return false; or similar, before the for loop, to keep the multiplication safe? Right now it would be redundant, given that data_rate was, at some point, encoded in 28 bits within bus_width. But can prevent future pain, especially after changing to phy_configure_opts_hdmi. Luis
Hi Luis, On 2/12/24 18:44, Luis de Arquer wrote: > Hi Cristian, > > On Mon, 2024-02-05 at 13:24 +0200, Cristian Ciocaltea wrote: >> + >> +static bool hdptx_phy_clk_pll_calc(unsigned int data_rate, >> + struct ropll_config *cfg) >> +{ >> + const unsigned int fout = data_rate / 2, fref = 24000; >> + unsigned long k = 0, lc, k_sub, lc_sub; >> + unsigned int fvco, sdc; >> + u32 mdiv, sdiv, n = 8; >> + >> + for (sdiv = 16; sdiv >= 1; sdiv--) { >> + if (sdiv % 2 && sdiv != 1) >> + continue; >> + >> + fvco = fout * sdiv; >> + >> + if (fvco < 2000000 || fvco > 4000000) >> + continue; >> + > > What about adding a check to data_rate, maybe like > > if (fout > 0x0FFFFFFF) > return false; > > or similar, before the for loop, to keep the multiplication safe? > > Right now it would be redundant, given that data_rate was, at some > point, encoded in 28 bits within bus_width. But can prevent future pain, > especially after changing to phy_configure_opts_hdmi. Indeed, it makes sense to do the check, thanks for the heads up! I was almost ready to submit v3, so this arrived just in time. :-) Regards, Cristian
Add driver and bindings to add initial support the Rockchip HDMI/eDP TX Combo PHY found on RK3588 SoC. The PHY is based on a Samsung IP block and supports HDMI 2.1 TMDS, FRL and eDP links. Please note that currently only the TMDS related functionality has been implemented. This has been tested on Radxa ROCK 5B and Rockchip EVB1 boards. Changes in v2: - Rebased series onto next-20240129 - Removed patch 'dt-bindings: soc: rockchip: Add rk3588 hdptxphy syscon' already applied by Heiko - For consistency with SoC TRM, replaced all references to DP with eDP - Updated PHY schema per Krzysztof's review; also collected his R-b tag - Dropped FRL, EARC and 10-bit color depth functionality until the HDMI configuration options become available in PHY API - Squashed lots of regmap_write operations via regmap_multi_reg_write (Sebastian) - Introduced parametrized {CMN|SB|LNTOP|LANE}_REG() macros to replace the long list of register defines - Optimized handling of the config arrays by using ARRAY_SIZE() (Sascha) - Link to v1: https://lore.kernel.org/r/20240119193806.1030214-1-cristian.ciocaltea@collabora.com --- Cristian Ciocaltea (2): dt-bindings: phy: Add Rockchip HDMI/eDP Combo PHY schema phy: rockchip: Add Samsung HDMI/eDP Combo PHY driver .../bindings/phy/rockchip,rk3588-hdptx-phy.yaml | 91 ++ drivers/phy/rockchip/Kconfig | 8 + drivers/phy/rockchip/Makefile | 1 + drivers/phy/rockchip/phy-rockchip-samsung-hdptx.c | 1040 ++++++++++++++++++++ 4 files changed, 1140 insertions(+) --- base-commit: 596764183be8ebb13352b281a442a1f1151c9b06 change-id: 20240128-phy-hdptx-8a98ab60d18e