Re: [PATCH 3/3] phy: airoha: Add PCIe PHY driver for EN7581 SoC.

[Date Prev][Date Next][Thread Prev][Thread Next][Date Index][Thread Index]

 



[...]

> > +#endif /* _PHY_AIROHA_PCIE_H */
> > diff --git a/drivers/phy/phy-airoha-pcie.c b/drivers/phy/phy-airoha-pcie.c
> > new file mode 100644
> > index 000000000000..66d8bee93ee6
> > --- /dev/null
> > +++ b/drivers/phy/phy-airoha-pcie.c
> > @@ -0,0 +1,1227 @@
> > +// SPDX-License-Identifier: GPL-2.0-only
> > +/*
> > + * Copyright (c) 2024 AIROHA Inc
> > + * Author: Lorenzo Bianconi <lorenzo@xxxxxxxxxx>
> > + */
> > +
> > +#include <linux/delay.h>
> > +#include <linux/bitfield.h>
> > +#include <linux/module.h>
> > +#include <linux/of.h>
> > +#include <linux/phy/phy.h>
> > +#include <linux/platform_device.h>
> > +#include <linux/slab.h>
> > +
> > +#include "phy-airoha-pcie-regs.h"
> > +
> > +/**
> > + * struct airoha_pcie_phy - PCIe phy driver main structure
> > + * @dev: pointer to device
> > + * @phy: pointer to generic phy
> > + * @csr_2l: Analogic lane IO mapped register base address
> > + * @pma0: IO mapped register base address of PMA0-PCIe
> > + * @pma1: IO mapped register base address of PMA1-PCIe
> > + * @data: pointer to SoC dependent data
> 
> The structure below lacks this data pointer.

ack, it is just a leftover. I will fix it in v2.

Regards,
Lorenzo

> > + */
> > +struct airoha_pcie_phy {
> > +	struct device *dev;
> > +	struct phy *phy;
> > +	void __iomem *csr_2l;
> > +	void __iomem *pma0;
> > +	void __iomem *pma1;
> > +};
> > +
> > +static void airoha_phy_clear_bits(void __iomem *reg, u32 mask)
> > +{
> > +	u32 val = readl(reg) & ~mask;
> > +
> > +	writel(val, reg);
> > +}
> > +
> > +static void airoha_phy_set_bits(void __iomem *reg, u32 mask)
> > +{
> > +	u32 val = readl(reg) | mask;
> > +
> > +	writel(val, reg);
> > +}
> > +
> > +static void airoha_phy_update_bits(void __iomem *reg, u32 mask, u32 val)
> > +{
> > +	u32 tmp = readl(reg);
> > +
> > +	tmp &= ~mask;
> > +	tmp |= val & mask;
> > +	writel(tmp, reg);
> > +}
> > +
> > +#define airoha_phy_update_field(reg, mask, val)					\
> > +	do {									\
> > +		BUILD_BUG_ON_MSG(!__builtin_constant_p((mask)),			\
> > +				 "mask is not constant");			\
> > +		airoha_phy_update_bits((reg), (mask),				\
> > +				       FIELD_PREP((mask), (val)));		\
> > +	} while (0)
> > +
> > +#define airoha_phy_csr_2l_clear_bits(pcie_phy, reg, mask)			\
> > +	airoha_phy_clear_bits((pcie_phy)->csr_2l + (reg), (mask))
> > +#define airoha_phy_csr_2l_set_bits(pcie_phy, reg, mask)				\
> > +	airoha_phy_set_bits((pcie_phy)->csr_2l + (reg), (mask))
> > +#define airoha_phy_csr_2l_update_field(pcie_phy, reg, mask, val)		\
> > +	airoha_phy_update_field((pcie_phy)->csr_2l + (reg), (mask), (val))
> > +#define airoha_phy_pma0_clear_bits(pcie_phy, reg, mask)				\
> > +	airoha_phy_clear_bits((pcie_phy)->pma0 + (reg), (mask))
> > +#define airoha_phy_pma1_clear_bits(pcie_phy, reg, mask)				\
> > +	airoha_phy_clear_bits((pcie_phy)->pma1 + (reg), (mask))
> > +#define airoha_phy_pma0_set_bits(pcie_phy, reg, mask)				\
> > +	airoha_phy_set_bits((pcie_phy)->pma0 + (reg), (mask))
> > +#define airoha_phy_pma1_set_bits(pcie_phy, reg, mask)				\
> > +	airoha_phy_set_bits((pcie_phy)->pma1 + (reg), (mask))
> > +#define airoha_phy_pma0_update_field(pcie_phy, reg, mask, val)			\
> > +	airoha_phy_update_field((pcie_phy)->pma0 + (reg), (mask), (val))
> > +#define airoha_phy_pma1_update_field(pcie_phy, reg, mask, val)			\
> > +	airoha_phy_update_field((pcie_phy)->pma1 + (reg), (mask), (val))
> > +
> > +static void
> > +airoha_phy_init_lane0_rx_fw_pre_calib(struct airoha_pcie_phy *pcie_phy,
> > +				      int gen)
> > +{
> > +	u32 fl_out_target = gen == 3 ? 41600 : 41941;
> > +	u32 lock_cyclecnt = gen == 3 ? 26000 : 32767;
> > +	u32 pr_idac, val, cdr_pr_idac_tmp = 0;
> > +	int i;
> > +
> > +	airoha_phy_pma0_set_bits(pcie_phy,
> > +				 REG_PCIE_PMA_SS_LCPLL_PWCTL_SETTING_1,
> > +				 PCIE_LCPLL_MAN_PWDB);
> > +	airoha_phy_pma0_update_field(pcie_phy, REG_PCIE_PMA_SS_RX_FREQ_DET2,
> > +				     PCIE_LOCK_TARGET_BEG,
> > +				     fl_out_target - 100);
> > +	airoha_phy_pma0_update_field(pcie_phy, REG_PCIE_PMA_SS_RX_FREQ_DET2,
> > +				     PCIE_LOCK_TARGET_END,
> > +				     fl_out_target + 100);
> > +	airoha_phy_pma0_update_field(pcie_phy, REG_PCIE_PMA_SS_RX_FREQ_DET1,
> > +				     PCIE_PLL_FT_LOCK_CYCLECNT, lock_cyclecnt);
> > +	airoha_phy_pma0_update_field(pcie_phy, REG_PCIE_PMA_SS_RX_FREQ_DET4,
> > +				     PCIE_LOCK_LOCKTH, 0x3);
> > +	airoha_phy_pma0_update_field(pcie_phy, REG_PCIE_PMA_SS_RX_FREQ_DET3,
> > +				     PCIE_UNLOCK_TARGET_BEG,
> > +				     fl_out_target - 100);
> > +	airoha_phy_pma0_update_field(pcie_phy, REG_PCIE_PMA_SS_RX_FREQ_DET3,
> > +				     PCIE_UNLOCK_TARGET_END,
> > +				     fl_out_target + 100);
> > +	airoha_phy_pma0_update_field(pcie_phy, REG_PCIE_PMA_SS_RX_FREQ_DET1,
> > +				     PCIE_PLL_FT_UNLOCK_CYCLECNT,
> > +				     lock_cyclecnt);
> > +	airoha_phy_pma0_update_field(pcie_phy, REG_PCIE_PMA_SS_RX_FREQ_DET4,
> > +				     PCIE_UNLOCK_LOCKTH, 0x3);
> > +
> > +	airoha_phy_csr_2l_set_bits(pcie_phy, REG_CSR_2L_CDR0_PR_INJ_MODE,
> > +				   CSR_2L_PXP_CDR0_INJ_FORCE_OFF);
> > +
> > +	airoha_phy_pma0_set_bits(pcie_phy,
> > +				 REG_PCIE_PMA_FORCE_DA_PXP_CDR_PR_LPF_C,
> > +				 PCIE_FORCE_SEL_DA_PXP_CDR_PR_LPF_R_EN);
> > +	airoha_phy_pma0_set_bits(pcie_phy,
> > +				 REG_PCIE_PMA_FORCE_DA_PXP_CDR_PR_LPF_C,
> > +				 PCIE_FORCE_DA_PXP_CDR_PR_LPF_R_EN);
> > +	airoha_phy_pma0_set_bits(pcie_phy,
> > +				 REG_PCIE_PMA_FORCE_DA_PXP_CDR_PR_LPF_C,
> > +				 PCIE_FORCE_SEL_DA_PXP_CDR_PR_LPF_C_EN);
> > +	airoha_phy_pma0_clear_bits(pcie_phy,
> > +				   REG_PCIE_PMA_FORCE_DA_PXP_CDR_PR_LPF_C,
> > +				   PCIE_FORCE_DA_PXP_CDR_PR_LPF_C_EN);
> > +	airoha_phy_pma0_set_bits(pcie_phy,
> > +				 REG_PCIE_PMA_FORCE_DA_PXP_CDR_PR_IDAC,
> > +				 PCIE_FORCE_SEL_DA_PXP_CDR_PR_IDAC);
> > +
> > +	airoha_phy_pma0_set_bits(pcie_phy,
> > +				 REG_PCIE_PMA_FORCE_DA_PXP_CDR_PR_PIEYE_PWDB,
> > +				 PCIE_FORCE_SEL_DA_PXP_CDR_PR_PWDB);
> > +	airoha_phy_pma0_clear_bits(pcie_phy,
> > +				   REG_PCIE_PMA_FORCE_DA_PXP_CDR_PR_PIEYE_PWDB,
> > +				   PCIE_FORCE_DA_PXP_CDR_PR_PWDB);
> > +	airoha_phy_pma0_set_bits(pcie_phy,
> > +				 REG_PCIE_PMA_FORCE_DA_PXP_CDR_PR_PIEYE_PWDB,
> > +				 PCIE_FORCE_DA_PXP_CDR_PR_PWDB);
> > +
> > +	for (i = 0; i < 7; i++) {
> > +		airoha_phy_pma0_update_field(pcie_phy,
> > +				REG_PCIE_PMA_FORCE_DA_PXP_CDR_PR_IDAC,
> > +				PCIE_FORCE_DA_PXP_CDR_PR_IDAC, i << 8);
> > +		airoha_phy_pma0_clear_bits(pcie_phy,
> > +					   REG_PCIE_PMA_SS_RX_FREQ_DET4,
> > +					   PCIE_FREQLOCK_DET_EN);
> > +		airoha_phy_pma0_update_field(pcie_phy,
> > +					     REG_PCIE_PMA_SS_RX_FREQ_DET4,
> > +					     PCIE_FREQLOCK_DET_EN, 0x3);
> > +
> > +		usleep_range(10000, 15000);
> > +
> > +		val = FIELD_GET(PCIE_RO_FL_OUT,
> > +				readl(pcie_phy->pma0 +
> > +				      REG_PCIE_PMA_RO_RX_FREQDET));
> > +		if (val > fl_out_target)
> > +			cdr_pr_idac_tmp = i << 8;
> > +	}
> > +
> > +	for (i = 7; i >= 0; i--) {
> > +		pr_idac = cdr_pr_idac_tmp | (0x1 << i);
> > +		airoha_phy_pma0_update_field(pcie_phy,
> > +				REG_PCIE_PMA_FORCE_DA_PXP_CDR_PR_IDAC,
> > +				PCIE_FORCE_DA_PXP_CDR_PR_IDAC, pr_idac);
> > +		airoha_phy_pma0_clear_bits(pcie_phy,
> > +					   REG_PCIE_PMA_SS_RX_FREQ_DET4,
> > +					   PCIE_FREQLOCK_DET_EN);
> > +		airoha_phy_pma0_update_field(pcie_phy,
> > +					     REG_PCIE_PMA_SS_RX_FREQ_DET4,
> > +					     PCIE_FREQLOCK_DET_EN, 0x3);
> > +
> > +		usleep_range(10000, 15000);
> > +
> > +		val = FIELD_GET(PCIE_RO_FL_OUT,
> > +				readl(pcie_phy->pma0 +
> > +				      REG_PCIE_PMA_RO_RX_FREQDET));
> > +		if (val < fl_out_target)
> > +			pr_idac &= ~(0x1 << i);
> > +
> > +		cdr_pr_idac_tmp = pr_idac;
> > +	}
> > +
> > +	airoha_phy_pma0_update_field(pcie_phy,
> > +				     REG_PCIE_PMA_FORCE_DA_PXP_CDR_PR_IDAC,
> > +				     PCIE_FORCE_DA_PXP_CDR_PR_IDAC,
> > +				     cdr_pr_idac_tmp);
> > +
> > +	for (i = 0; i < 10; i++) {
> > +		airoha_phy_pma0_clear_bits(pcie_phy,
> > +					   REG_PCIE_PMA_SS_RX_FREQ_DET4,
> > +					   PCIE_FREQLOCK_DET_EN);
> > +		airoha_phy_pma0_update_field(pcie_phy,
> > +					     REG_PCIE_PMA_SS_RX_FREQ_DET4,
> > +					     PCIE_FREQLOCK_DET_EN, 0x3);
> > +
> > +		usleep_range(10000, 15000);
> > +	}
> > +
> > +	/* turn off force mode and update band values */
> > +	airoha_phy_csr_2l_clear_bits(pcie_phy, REG_CSR_2L_CDR0_PR_INJ_MODE,
> > +				     CSR_2L_PXP_CDR0_INJ_FORCE_OFF);
> > +
> > +	airoha_phy_pma0_clear_bits(pcie_phy,
> > +				   REG_PCIE_PMA_FORCE_DA_PXP_CDR_PR_LPF_C,
> > +				   PCIE_FORCE_SEL_DA_PXP_CDR_PR_LPF_R_EN);
> > +	airoha_phy_pma0_clear_bits(pcie_phy,
> > +				   REG_PCIE_PMA_FORCE_DA_PXP_CDR_PR_LPF_C,
> > +				   PCIE_FORCE_SEL_DA_PXP_CDR_PR_LPF_C_EN);
> > +	airoha_phy_pma0_clear_bits(pcie_phy,
> > +				   REG_PCIE_PMA_FORCE_DA_PXP_CDR_PR_PIEYE_PWDB,
> > +				   PCIE_FORCE_SEL_DA_PXP_CDR_PR_PWDB);
> > +	airoha_phy_pma0_clear_bits(pcie_phy,
> > +				   REG_PCIE_PMA_FORCE_DA_PXP_CDR_PR_IDAC,
> > +				   PCIE_FORCE_SEL_DA_PXP_CDR_PR_IDAC);
> > +	if (gen == 3) {
> > +		airoha_phy_pma0_update_field(pcie_phy,
> > +					     REG_PCIE_PMA_DIG_RESERVE_14,
> > +					     PCIE_FLL_IDAC_PCIEG3,
> > +					     cdr_pr_idac_tmp);
> > +	} else {
> > +		airoha_phy_pma0_update_field(pcie_phy,
> > +					     REG_PCIE_PMA_DIG_RESERVE_13,
> > +					     PCIE_FLL_IDAC_PCIEG1,
> > +					     cdr_pr_idac_tmp);
> > +		airoha_phy_pma0_update_field(pcie_phy,
> > +					     REG_PCIE_PMA_DIG_RESERVE_13,
> > +					     PCIE_FLL_IDAC_PCIEG2,
> > +					     cdr_pr_idac_tmp);
> > +	}
> > +}
> > +
> > +static void
> > +airoha_phy_init_lane1_rx_fw_pre_calib(struct airoha_pcie_phy *pcie_phy,
> > +				      int gen)
> > +{
> > +	u32 fl_out_target = gen == 3 ? 41600 : 41941;
> > +	u32 lock_cyclecnt = gen == 3 ? 26000 : 32767;
> > +	u32 pr_idac, val, cdr_pr_idac_tmp = 0;
> > +	int i;
> > +
> > +	airoha_phy_pma1_set_bits(pcie_phy,
> > +				 REG_PCIE_PMA_SS_LCPLL_PWCTL_SETTING_1,
> > +				 PCIE_LCPLL_MAN_PWDB);
> > +	airoha_phy_pma1_update_field(pcie_phy, REG_PCIE_PMA_SS_RX_FREQ_DET2,
> > +				     PCIE_LOCK_TARGET_BEG,
> > +				     fl_out_target - 100);
> > +	airoha_phy_pma1_update_field(pcie_phy, REG_PCIE_PMA_SS_RX_FREQ_DET2,
> > +				     PCIE_LOCK_TARGET_END,
> > +				     fl_out_target + 100);
> > +	airoha_phy_pma1_update_field(pcie_phy, REG_PCIE_PMA_SS_RX_FREQ_DET1,
> > +				     PCIE_PLL_FT_LOCK_CYCLECNT, lock_cyclecnt);
> > +	airoha_phy_pma1_update_field(pcie_phy, REG_PCIE_PMA_SS_RX_FREQ_DET4,
> > +				     PCIE_LOCK_LOCKTH, 0x3);
> > +	airoha_phy_pma1_update_field(pcie_phy, REG_PCIE_PMA_SS_RX_FREQ_DET3,
> > +				     PCIE_UNLOCK_TARGET_BEG,
> > +				     fl_out_target - 100);
> > +	airoha_phy_pma1_update_field(pcie_phy, REG_PCIE_PMA_SS_RX_FREQ_DET3,
> > +				     PCIE_UNLOCK_TARGET_END,
> > +				     fl_out_target + 100);
> > +	airoha_phy_pma1_update_field(pcie_phy, REG_PCIE_PMA_SS_RX_FREQ_DET1,
> > +				     PCIE_PLL_FT_UNLOCK_CYCLECNT,
> > +				     lock_cyclecnt);
> > +	airoha_phy_pma1_update_field(pcie_phy, REG_PCIE_PMA_SS_RX_FREQ_DET4,
> > +				     PCIE_UNLOCK_LOCKTH, 0x3);
> > +
> > +	airoha_phy_csr_2l_set_bits(pcie_phy, REG_CSR_2L_CDR1_PR_INJ_MODE,
> > +				   CSR_2L_PXP_CDR1_INJ_FORCE_OFF);
> > +
> > +	airoha_phy_pma1_set_bits(pcie_phy,
> > +				 REG_PCIE_PMA_FORCE_DA_PXP_CDR_PR_LPF_C,
> > +				 PCIE_FORCE_SEL_DA_PXP_CDR_PR_LPF_R_EN);
> > +	airoha_phy_pma1_set_bits(pcie_phy,
> > +				 REG_PCIE_PMA_FORCE_DA_PXP_CDR_PR_LPF_C,
> > +				 PCIE_FORCE_DA_PXP_CDR_PR_LPF_R_EN);
> > +	airoha_phy_pma1_set_bits(pcie_phy,
> > +				 REG_PCIE_PMA_FORCE_DA_PXP_CDR_PR_LPF_C,
> > +				 PCIE_FORCE_SEL_DA_PXP_CDR_PR_LPF_C_EN);
> > +	airoha_phy_pma1_clear_bits(pcie_phy,
> > +				   REG_PCIE_PMA_FORCE_DA_PXP_CDR_PR_LPF_C,
> > +				   PCIE_FORCE_DA_PXP_CDR_PR_LPF_C_EN);
> > +	airoha_phy_pma1_set_bits(pcie_phy,
> > +				 REG_PCIE_PMA_FORCE_DA_PXP_CDR_PR_IDAC,
> > +				 PCIE_FORCE_SEL_DA_PXP_CDR_PR_IDAC);
> > +	airoha_phy_pma1_set_bits(pcie_phy,
> > +				 REG_PCIE_PMA_FORCE_DA_PXP_CDR_PR_PIEYE_PWDB,
> > +				 PCIE_FORCE_SEL_DA_PXP_CDR_PR_PWDB);
> > +	airoha_phy_pma1_clear_bits(pcie_phy,
> > +				   REG_PCIE_PMA_FORCE_DA_PXP_CDR_PR_PIEYE_PWDB,
> > +				   PCIE_FORCE_DA_PXP_CDR_PR_PWDB);
> > +	airoha_phy_pma1_set_bits(pcie_phy,
> > +				 REG_PCIE_PMA_FORCE_DA_PXP_CDR_PR_PIEYE_PWDB,
> > +				 PCIE_FORCE_DA_PXP_CDR_PR_PWDB);
> > +
> > +	for (i = 0; i < 7; i++) {
> > +		airoha_phy_pma1_update_field(pcie_phy,
> > +				REG_PCIE_PMA_FORCE_DA_PXP_CDR_PR_IDAC,
> > +				PCIE_FORCE_DA_PXP_CDR_PR_IDAC, i << 8);
> > +		airoha_phy_pma1_clear_bits(pcie_phy,
> > +					   REG_PCIE_PMA_SS_RX_FREQ_DET4,
> > +					   PCIE_FREQLOCK_DET_EN);
> > +		airoha_phy_pma1_update_field(pcie_phy,
> > +					     REG_PCIE_PMA_SS_RX_FREQ_DET4,
> > +					     PCIE_FREQLOCK_DET_EN, 0x3);
> > +
> > +		usleep_range(10000, 15000);
> > +
> > +		val = FIELD_GET(PCIE_RO_FL_OUT,
> > +				readl(pcie_phy->pma1 +
> > +				      REG_PCIE_PMA_RO_RX_FREQDET));
> > +		if (val > fl_out_target)
> > +			cdr_pr_idac_tmp = i << 8;
> > +	}
> > +
> > +	for (i = 7; i >= 0; i--) {
> > +		pr_idac = cdr_pr_idac_tmp | (0x1 << i);
> > +		airoha_phy_pma1_update_field(pcie_phy,
> > +				REG_PCIE_PMA_FORCE_DA_PXP_CDR_PR_IDAC,
> > +				PCIE_FORCE_DA_PXP_CDR_PR_IDAC, pr_idac);
> > +		airoha_phy_pma1_clear_bits(pcie_phy,
> > +					   REG_PCIE_PMA_SS_RX_FREQ_DET4,
> > +					   PCIE_FREQLOCK_DET_EN);
> > +		airoha_phy_pma1_update_field(pcie_phy,
> > +					     REG_PCIE_PMA_SS_RX_FREQ_DET4,
> > +					     PCIE_FREQLOCK_DET_EN, 0x3);
> > +
> > +		usleep_range(10000, 15000);
> > +
> > +		val = FIELD_GET(PCIE_RO_FL_OUT,
> > +				readl(pcie_phy->pma1 +
> > +				      REG_PCIE_PMA_RO_RX_FREQDET));
> > +		if (val < fl_out_target)
> > +			pr_idac &= ~(0x1 << i);
> > +
> > +		cdr_pr_idac_tmp = pr_idac;
> > +	}
> > +
> > +	airoha_phy_pma1_update_field(pcie_phy,
> > +				     REG_PCIE_PMA_FORCE_DA_PXP_CDR_PR_IDAC,
> > +				     PCIE_FORCE_DA_PXP_CDR_PR_IDAC,
> > +				     cdr_pr_idac_tmp);
> > +
> > +	for (i = 0; i < 10; i++) {
> > +		airoha_phy_pma1_clear_bits(pcie_phy,
> > +					   REG_PCIE_PMA_SS_RX_FREQ_DET4,
> > +					   PCIE_FREQLOCK_DET_EN);
> > +		airoha_phy_pma1_update_field(pcie_phy,
> > +					     REG_PCIE_PMA_SS_RX_FREQ_DET4,
> > +					     PCIE_FREQLOCK_DET_EN, 0x3);
> > +
> > +		usleep_range(10000, 15000);
> > +	}
> > +
> > +	/* turn off force mode and update band values */
> > +	airoha_phy_csr_2l_clear_bits(pcie_phy, REG_CSR_2L_CDR1_PR_INJ_MODE,
> > +				     CSR_2L_PXP_CDR1_INJ_FORCE_OFF);
> > +
> > +	airoha_phy_pma1_clear_bits(pcie_phy,
> > +				   REG_PCIE_PMA_FORCE_DA_PXP_CDR_PR_LPF_C,
> > +				   PCIE_FORCE_SEL_DA_PXP_CDR_PR_LPF_R_EN);
> > +	airoha_phy_pma1_clear_bits(pcie_phy,
> > +				   REG_PCIE_PMA_FORCE_DA_PXP_CDR_PR_LPF_C,
> > +				   PCIE_FORCE_SEL_DA_PXP_CDR_PR_LPF_C_EN);
> > +	airoha_phy_pma1_clear_bits(pcie_phy,
> > +				   REG_PCIE_PMA_FORCE_DA_PXP_CDR_PR_PIEYE_PWDB,
> > +				   PCIE_FORCE_SEL_DA_PXP_CDR_PR_PWDB);
> > +	airoha_phy_pma1_clear_bits(pcie_phy,
> > +				   REG_PCIE_PMA_FORCE_DA_PXP_CDR_PR_IDAC,
> > +				   PCIE_FORCE_SEL_DA_PXP_CDR_PR_IDAC);
> > +	if (gen == 3) {
> > +		airoha_phy_pma1_update_field(pcie_phy,
> > +					     REG_PCIE_PMA_DIG_RESERVE_14,
> > +					     PCIE_FLL_IDAC_PCIEG3,
> > +					     cdr_pr_idac_tmp);
> > +	} else {
> > +		airoha_phy_pma1_update_field(pcie_phy,
> > +					     REG_PCIE_PMA_DIG_RESERVE_13,
> > +					     PCIE_FLL_IDAC_PCIEG1,
> > +					     cdr_pr_idac_tmp);
> > +		airoha_phy_pma1_update_field(pcie_phy,
> > +					     REG_PCIE_PMA_DIG_RESERVE_13,
> > +					     PCIE_FLL_IDAC_PCIEG2,
> > +					     cdr_pr_idac_tmp);
> > +	}
> > +}
> > +
> > +static void airoha_pcie_phy_init_default(struct airoha_pcie_phy *pcie_phy)
> > +{
> > +	airoha_phy_csr_2l_update_field(pcie_phy, REG_CSR_2L_CMN,
> > +				       CSR_2L_PXP_CMN_TRIM_MASK, 0x10);
> > +	writel(0xcccbcccb, pcie_phy->pma0 + REG_PCIE_PMA_DIG_RESERVE_21);
> > +	writel(0xcccb, pcie_phy->pma0 + REG_PCIE_PMA_DIG_RESERVE_22);
> > +	writel(0xcccbcccb, pcie_phy->pma1 + REG_PCIE_PMA_DIG_RESERVE_21);
> > +	writel(0xcccb, pcie_phy->pma1 + REG_PCIE_PMA_DIG_RESERVE_22);
> > +	airoha_phy_csr_2l_set_bits(pcie_phy, REG_CSR_2L_CMN,
> > +				   CSR_2L_PXP_CMN_LANE_EN);
> > +}
> > +
> > +static void airoha_pcie_phy_init_clk_out(struct airoha_pcie_phy *pcie_phy)
> > +{
> > +	airoha_phy_csr_2l_update_field(pcie_phy,
> > +				       REG_CSR_2L_TXPLL_POSTDIV_D256,
> > +				       CSR_2L_PXP_CLKTX0_AMP, 0x5);
> > +	airoha_phy_csr_2l_update_field(pcie_phy,
> > +				       REG_CSR_2L_CLKTX0_FORCE_OUT1,
> > +				       CSR_2L_PXP_CLKTX1_AMP, 0x5);
> > +	airoha_phy_csr_2l_update_field(pcie_phy,
> > +				       REG_CSR_2L_TXPLL_POSTDIV_D256,
> > +				       CSR_2L_PXP_CLKTX0_OFFSET, 0x2);
> > +	airoha_phy_csr_2l_update_field(pcie_phy, REG_CSR_2L_CLKTX1_OFFSET,
> > +				       CSR_2L_PXP_CLKTX1_OFFSET, 0x2);
> > +	airoha_phy_csr_2l_clear_bits(pcie_phy, REG_CSR_2L_CLKTX0_FORCE_OUT1,
> > +				     CSR_2L_PXP_CLKTX0_HZ);
> > +	airoha_phy_csr_2l_clear_bits(pcie_phy, REG_CSR_2L_CLKTX1_OFFSET,
> > +				     CSR_2L_PXP_CLKTX1_HZ);
> > +	airoha_phy_csr_2l_update_field(pcie_phy,
> > +				       REG_CSR_2L_CLKTX0_FORCE_OUT1,
> > +				       CSR_2L_PXP_CLKTX0_IMP_SEL, 0x12);
> > +	airoha_phy_csr_2l_update_field(pcie_phy, REG_CSR_2L_CLKTX1_IMP_SEL,
> > +				       CSR_2L_PXP_CLKTX1_IMP_SEL, 0x12);
> > +	airoha_phy_csr_2l_clear_bits(pcie_phy, REG_CSR_2L_TXPLL_POSTDIV_D256,
> > +				     CSR_2L_PXP_CLKTX0_SR);
> > +	airoha_phy_csr_2l_clear_bits(pcie_phy, REG_CSR_2L_CLKTX1_OFFSET,
> > +				     CSR_2L_PXP_CLKTX1_SR);
> > +	airoha_phy_csr_2l_update_field(pcie_phy, REG_CSR_2L_PLL_CMN_RESERVE0,
> > +				       CSR_2L_PXP_PLL_RESERVE_MASK, 0xdd);
> > +}
> > +
> > +static void airoha_pcie_phy_init_csr_2l(struct airoha_pcie_phy *pcie_phy)
> > +{
> > +	airoha_phy_pma0_set_bits(pcie_phy, REG_PCIE_PMA_SW_RESET,
> > +				 PCIE_SW_XFI_RXPCS_RST | PCIE_SW_REF_RST |
> > +				 PCIE_SW_RX_RST);
> > +	airoha_phy_pma1_set_bits(pcie_phy, REG_PCIE_PMA_SW_RESET,
> > +				 PCIE_SW_XFI_RXPCS_RST | PCIE_SW_REF_RST |
> > +				 PCIE_SW_RX_RST);
> > +	airoha_phy_pma0_set_bits(pcie_phy, REG_PCIE_PMA_TX_RESET,
> > +				 PCIE_TX_TOP_RST | REG_PCIE_PMA_TX_RESET);
> > +	airoha_phy_pma1_set_bits(pcie_phy, REG_PCIE_PMA_TX_RESET,
> > +				 PCIE_TX_TOP_RST | REG_PCIE_PMA_TX_RESET);
> > +}
> > +
> > +static void airoha_pcie_phy_init_rx(struct airoha_pcie_phy *pcie_phy)
> > +{
> > +	writel(0x2a00090b, pcie_phy->pma0 + REG_PCIE_PMA_DIG_RESERVE_17);
> > +	writel(0x2a00090b, pcie_phy->pma1 + REG_PCIE_PMA_DIG_RESERVE_17);
> > +	airoha_phy_csr_2l_set_bits(pcie_phy, REG_CSR_2L_CDR0_PR_MONPI,
> > +				   CSR_2L_PXP_CDR0_PR_XFICK_EN);
> > +	airoha_phy_csr_2l_set_bits(pcie_phy, REG_CSR_2L_CDR1_PR_MONPI,
> > +				   CSR_2L_PXP_CDR1_PR_XFICK_EN);
> > +	airoha_phy_csr_2l_clear_bits(pcie_phy,
> > +				     REG_CSR_2L_CDR0_PD_PICAL_CKD8_INV,
> > +				     CSR_2L_PXP_CDR0_PD_EDGE_DISABLE);
> > +	airoha_phy_csr_2l_clear_bits(pcie_phy,
> > +				     REG_CSR_2L_CDR1_PD_PICAL_CKD8_INV,
> > +				     CSR_2L_PXP_CDR1_PD_EDGE_DISABLE);
> > +	airoha_phy_csr_2l_update_field(pcie_phy, REG_CSR_2L_RX0_PHYCK_DIV,
> > +				       CSR_2L_PXP_RX0_PHYCK_SEL, 0x1);
> > +	airoha_phy_csr_2l_update_field(pcie_phy, REG_CSR_2L_RX1_PHYCK_DIV,
> > +				       CSR_2L_PXP_RX1_PHYCK_SEL, 0x1);
> > +}
> > +
> > +static void airoha_pcie_phy_init_jcpll(struct airoha_pcie_phy *pcie_phy)
> > +{
> > +	airoha_phy_pma0_set_bits(pcie_phy, REG_PCIE_PMA_FORCE_PXP_JCPLL_CKOUT,
> > +				 PCIE_FORCE_SEL_DA_PXP_JCPLL_EN);
> > +	airoha_phy_pma0_clear_bits(pcie_phy,
> > +				   REG_PCIE_PMA_FORCE_PXP_JCPLL_CKOUT,
> > +				   PCIE_FORCE_DA_PXP_JCPLL_EN);
> > +	airoha_phy_pma1_set_bits(pcie_phy, REG_PCIE_PMA_FORCE_PXP_JCPLL_CKOUT,
> > +				 PCIE_FORCE_SEL_DA_PXP_JCPLL_EN);
> > +	airoha_phy_pma1_clear_bits(pcie_phy,
> > +				   REG_PCIE_PMA_FORCE_PXP_JCPLL_CKOUT,
> > +				   PCIE_FORCE_DA_PXP_JCPLL_EN);
> > +	airoha_phy_csr_2l_update_field(pcie_phy, REG_CSR_2L_JCPLL_TCL_VTP_EN,
> > +				       CSR_2L_PXP_JCPLL_SPARE_LOW, 0x20);
> > +	airoha_phy_csr_2l_set_bits(pcie_phy, REG_CSR_2L_JCPLL_RST_DLY,
> > +				   CSR_2L_PXP_JCPLL_RST);
> > +	writel(0x0, pcie_phy->csr_2l + REG_CSR_2L_JCPLL_SSC_DELTA1);
> > +	airoha_phy_csr_2l_clear_bits(pcie_phy, REG_CSR_2L_JCPLL_SSC_PERIOD,
> > +				     CSR_2L_PXP_JCPLL_SSC_PERIOD);
> > +	airoha_phy_csr_2l_clear_bits(pcie_phy, REG_CSR_2L_JCPLL_SSC,
> > +				     CSR_2L_PXP_JCPLL_SSC_PHASE_INI);
> > +	airoha_phy_csr_2l_clear_bits(pcie_phy, REG_CSR_2L_JCPLL_SSC,
> > +				     CSR_2L_PXP_JCPLL_SSC_TRI_EN);
> > +	airoha_phy_csr_2l_update_field(pcie_phy, REG_CSR_2L_JCPLL_LPF_BR,
> > +				       CSR_2L_PXP_JCPLL_LPF_BR, 0xa);
> > +	airoha_phy_csr_2l_update_field(pcie_phy, REG_CSR_2L_JCPLL_LPF_BR,
> > +				       CSR_2L_PXP_JCPLL_LPF_BP, 0xc);
> > +	airoha_phy_csr_2l_update_field(pcie_phy, REG_CSR_2L_JCPLL_LPF_BR,
> > +				       CSR_2L_PXP_JCPLL_LPF_BC, 0x1f);
> > +	airoha_phy_csr_2l_update_field(pcie_phy, REG_CSR_2L_JCPLL_LPF_BWC,
> > +				       CSR_2L_PXP_JCPLL_LPF_BWC, 0x1e);
> > +	airoha_phy_csr_2l_update_field(pcie_phy, REG_CSR_2L_JCPLL_LPF_BR,
> > +				       CSR_2L_PXP_JCPLL_LPF_BWR, 0xa);
> > +	airoha_phy_csr_2l_update_field(pcie_phy,
> > +				       REG_CSR_2L_JCPLL_MMD_PREDIV_MODE,
> > +				       CSR_2L_PXP_JCPLL_MMD_PREDIV_MODE,
> > +				       0x1);
> > +	airoha_phy_csr_2l_clear_bits(pcie_phy, CSR_2L_PXP_JCPLL_MONCK,
> > +				     CSR_2L_PXP_JCPLL_REFIN_DIV);
> > +
> > +	airoha_phy_pma0_set_bits(pcie_phy, REG_PCIE_PMA_FORCE_DA_PXP_RX_FE_VOS,
> > +				 PCIE_FORCE_SEL_DA_PXP_JCPLL_SDM_PCW);
> > +	airoha_phy_pma1_set_bits(pcie_phy, REG_PCIE_PMA_FORCE_DA_PXP_RX_FE_VOS,
> > +				 PCIE_FORCE_SEL_DA_PXP_JCPLL_SDM_PCW);
> > +	airoha_phy_pma0_update_field(pcie_phy,
> > +				     REG_PCIE_PMA_FORCE_DA_PXP_JCPLL_SDM_PCW,
> > +				     PCIE_FORCE_DA_PXP_JCPLL_SDM_PCW,
> > +				     0x50000000);
> > +	airoha_phy_pma1_update_field(pcie_phy,
> > +				     REG_PCIE_PMA_FORCE_DA_PXP_JCPLL_SDM_PCW,
> > +				     PCIE_FORCE_DA_PXP_JCPLL_SDM_PCW,
> > +				     0x50000000);
> > +
> > +	airoha_phy_csr_2l_set_bits(pcie_phy,
> > +				   REG_CSR_2L_JCPLL_MMD_PREDIV_MODE,
> > +				   CSR_2L_PXP_JCPLL_POSTDIV_D5);
> > +	airoha_phy_csr_2l_set_bits(pcie_phy,
> > +				   REG_CSR_2L_JCPLL_MMD_PREDIV_MODE,
> > +				   CSR_2L_PXP_JCPLL_POSTDIV_D2);
> > +	airoha_phy_csr_2l_update_field(pcie_phy, REG_CSR_2L_JCPLL_RST_DLY,
> > +				       CSR_2L_PXP_JCPLL_RST_DLY, 0x4);
> > +	airoha_phy_csr_2l_clear_bits(pcie_phy, REG_CSR_2L_JCPLL_RST_DLY,
> > +				     CSR_2L_PXP_JCPLL_SDM_DI_LS);
> > +	airoha_phy_csr_2l_clear_bits(pcie_phy, REG_CSR_2L_JCPLL_TCL_KBAND_VREF,
> > +				     CSR_2L_PXP_JCPLL_VCO_KBAND_MEAS_EN);
> > +	airoha_phy_csr_2l_clear_bits(pcie_phy, REG_CSR_2L_JCPLL_IB_EXT,
> > +				     CSR_2L_PXP_JCPLL_CHP_IOFST);
> > +	airoha_phy_csr_2l_update_field(pcie_phy, REG_CSR_2L_JCPLL_IB_EXT,
> > +				       CSR_2L_PXP_JCPLL_CHP_IBIAS, 0xc);
> > +	airoha_phy_csr_2l_update_field(pcie_phy,
> > +				       REG_CSR_2L_JCPLL_MMD_PREDIV_MODE,
> > +				       CSR_2L_PXP_JCPLL_MMD_PREDIV_MODE,
> > +				       0x1);
> > +	airoha_phy_csr_2l_set_bits(pcie_phy, REG_CSR_2L_JCPLL_VCODIV,
> > +				   CSR_2L_PXP_JCPLL_VCO_HALFLSB_EN);
> > +	airoha_phy_csr_2l_update_field(pcie_phy, REG_CSR_2L_JCPLL_VCODIV,
> > +				       CSR_2L_PXP_JCPLL_VCO_CFIX, 0x1);
> > +	airoha_phy_csr_2l_update_field(pcie_phy, REG_CSR_2L_JCPLL_VCODIV,
> > +				       CSR_2L_PXP_JCPLL_VCO_SCAPWR, 0x4);
> > +	airoha_phy_csr_2l_clear_bits(pcie_phy, REG_CSR_2L_JCPLL_IB_EXT,
> > +				     REG_CSR_2L_JCPLL_LPF_SHCK_EN);
> > +	airoha_phy_csr_2l_set_bits(pcie_phy, REG_CSR_2L_JCPLL_KBAND_KFC,
> > +				   CSR_2L_PXP_JCPLL_POSTDIV_EN);
> > +	airoha_phy_csr_2l_clear_bits(pcie_phy, REG_CSR_2L_JCPLL_KBAND_KFC,
> > +				     CSR_2L_PXP_JCPLL_KBAND_KFC);
> > +	airoha_phy_csr_2l_update_field(pcie_phy, REG_CSR_2L_JCPLL_KBAND_KFC,
> > +				       CSR_2L_PXP_JCPLL_KBAND_KF, 0x3);
> > +	airoha_phy_csr_2l_clear_bits(pcie_phy, REG_CSR_2L_JCPLL_KBAND_KFC,
> > +				     CSR_2L_PXP_JCPLL_KBAND_KS);
> > +	airoha_phy_csr_2l_update_field(pcie_phy, REG_CSR_2L_JCPLL_LPF_BWC,
> > +				       CSR_2L_PXP_JCPLL_KBAND_DIV, 0x1);
> > +
> > +	airoha_phy_pma0_set_bits(pcie_phy, REG_PCIE_PMA_SCAN_MODE,
> > +				 PCIE_FORCE_SEL_DA_PXP_JCPLL_KBAND_LOAD_EN);
> > +	airoha_phy_pma0_clear_bits(pcie_phy, REG_PCIE_PMA_SCAN_MODE,
> > +				   PCIE_FORCE_DA_PXP_JCPLL_KBAND_LOAD_EN);
> > +
> > +	airoha_phy_csr_2l_update_field(pcie_phy, REG_CSR_2L_JCPLL_LPF_BWC,
> > +				       CSR_2L_PXP_JCPLL_KBAND_CODE, 0xe4);
> > +	airoha_phy_csr_2l_set_bits(pcie_phy, REG_CSR_2L_JCPLL_SDM_HREN,
> > +				   CSR_2L_PXP_JCPLL_TCL_AMP_EN);
> > +	airoha_phy_csr_2l_set_bits(pcie_phy, REG_CSR_2L_JCPLL_TCL_CMP,
> > +				   CSR_2L_PXP_JCPLL_TCL_LPF_EN);
> > +	airoha_phy_csr_2l_update_field(pcie_phy,
> > +				       REG_CSR_2L_JCPLL_TCL_KBAND_VREF,
> > +				       CSR_2L_PXP_JCPLL_TCL_KBAND_VREF, 0xf);
> > +	airoha_phy_csr_2l_update_field(pcie_phy, REG_CSR_2L_JCPLL_SDM_HREN,
> > +				       CSR_2L_PXP_JCPLL_TCL_AMP_GAIN, 0x1);
> > +	airoha_phy_csr_2l_update_field(pcie_phy, REG_CSR_2L_JCPLL_SDM_HREN,
> > +				       CSR_2L_PXP_JCPLL_TCL_AMP_VREF, 0x5);
> > +	airoha_phy_csr_2l_update_field(pcie_phy, REG_CSR_2L_JCPLL_TCL_CMP,
> > +				       CSR_2L_PXP_JCPLL_TCL_LPF_BW, 0x1);
> > +	airoha_phy_csr_2l_update_field(pcie_phy, REG_CSR_2L_JCPLL_VCO_TCLVAR,
> > +				       CSR_2L_PXP_JCPLL_VCO_TCLVAR, 0x3);
> > +
> > +	airoha_phy_pma0_set_bits(pcie_phy, REG_PCIE_PMA_FORCE_PXP_JCPLL_CKOUT,
> > +				 PCIE_FORCE_SEL_DA_PXP_JCPLL_CKOUT_EN);
> > +	airoha_phy_pma0_set_bits(pcie_phy, REG_PCIE_PMA_FORCE_PXP_JCPLL_CKOUT,
> > +				 PCIE_FORCE_DA_PXP_JCPLL_CKOUT_EN);
> > +	airoha_phy_pma1_set_bits(pcie_phy, REG_PCIE_PMA_FORCE_PXP_JCPLL_CKOUT,
> > +				 PCIE_FORCE_SEL_DA_PXP_JCPLL_CKOUT_EN);
> > +	airoha_phy_pma1_set_bits(pcie_phy, REG_PCIE_PMA_FORCE_PXP_JCPLL_CKOUT,
> > +				 PCIE_FORCE_DA_PXP_JCPLL_CKOUT_EN);
> > +	airoha_phy_pma0_set_bits(pcie_phy, REG_PCIE_PMA_FORCE_PXP_JCPLL_CKOUT,
> > +				 PCIE_FORCE_SEL_DA_PXP_JCPLL_EN);
> > +	airoha_phy_pma0_set_bits(pcie_phy, REG_PCIE_PMA_FORCE_PXP_JCPLL_CKOUT,
> > +				 PCIE_FORCE_DA_PXP_JCPLL_EN);
> > +	airoha_phy_pma1_set_bits(pcie_phy, REG_PCIE_PMA_FORCE_PXP_JCPLL_CKOUT,
> > +				 PCIE_FORCE_SEL_DA_PXP_JCPLL_EN);
> > +	airoha_phy_pma1_set_bits(pcie_phy, REG_PCIE_PMA_FORCE_PXP_JCPLL_CKOUT,
> > +				 PCIE_FORCE_DA_PXP_JCPLL_EN);
> > +}
> > +
> > +static void airoha_pcie_phy_txpll(struct airoha_pcie_phy *pcie_phy)
> > +{
> > +	airoha_phy_pma0_set_bits(pcie_phy,
> > +				 REG_PCIE_PMA_FORCE_DA_PXP_TXPLL_CKOUT,
> > +				 PCIE_FORCE_SEL_DA_PXP_TXPLL_EN);
> > +	airoha_phy_pma0_clear_bits(pcie_phy,
> > +				   REG_PCIE_PMA_FORCE_DA_PXP_TXPLL_CKOUT,
> > +				   PCIE_FORCE_DA_PXP_TXPLL_EN);
> > +	airoha_phy_pma1_set_bits(pcie_phy,
> > +				 REG_PCIE_PMA_FORCE_DA_PXP_TXPLL_CKOUT,
> > +				 PCIE_FORCE_SEL_DA_PXP_TXPLL_EN);
> > +	airoha_phy_pma1_clear_bits(pcie_phy,
> > +				   REG_PCIE_PMA_FORCE_DA_PXP_TXPLL_CKOUT,
> > +				   PCIE_FORCE_DA_PXP_TXPLL_EN);
> > +
> > +	airoha_phy_csr_2l_set_bits(pcie_phy, REG_CSR_2L_TXPLL_REFIN_DIV,
> > +				   CSR_2L_PXP_TXPLL_PLL_RSTB);
> > +	writel(0x0, pcie_phy->csr_2l + REG_CSR_2L_TXPLL_SSC_DELTA1);
> > +	airoha_phy_csr_2l_clear_bits(pcie_phy, REG_CSR_2L_TXPLL_SSC_PERIOD,
> > +				     CSR_2L_PXP_txpll_SSC_PERIOD);
> > +	airoha_phy_csr_2l_update_field(pcie_phy, REG_CSR_2L_TXPLL_CHP_IOFST,
> > +				       CSR_2L_PXP_TXPLL_CHP_IOFST, 0x1);
> > +	airoha_phy_csr_2l_update_field(pcie_phy, REG_CSR_2L_750M_SYS_CK,
> > +				       CSR_2L_PXP_TXPLL_CHP_IBIAS, 0x2d);
> > +	airoha_phy_csr_2l_clear_bits(pcie_phy, REG_CSR_2L_TXPLL_REFIN_DIV,
> > +				     CSR_2L_PXP_TXPLL_REFIN_DIV);
> > +	airoha_phy_csr_2l_update_field(pcie_phy, REG_CSR_2L_TXPLL_TCL_LPF_BW,
> > +				       CSR_2L_PXP_TXPLL_VCO_CFIX, 0x3);
> > +
> > +	airoha_phy_pma0_set_bits(pcie_phy, REG_PCIE_PMA_FORCE_DA_PXP_CDR_PR_IDAC,
> > +				 PCIE_FORCE_SEL_DA_PXP_TXPLL_SDM_PCW);
> > +	airoha_phy_pma1_set_bits(pcie_phy, REG_PCIE_PMA_FORCE_DA_PXP_CDR_PR_IDAC,
> > +				 PCIE_FORCE_SEL_DA_PXP_TXPLL_SDM_PCW);
> > +	airoha_phy_pma0_update_field(pcie_phy,
> > +				     REG_PCIE_PMA_FORCE_DA_PXP_TXPLL_SDM_PCW,
> > +				     PCIE_FORCE_DA_PXP_TXPLL_SDM_PCW,
> > +				     0xc800000);
> > +	airoha_phy_pma1_update_field(pcie_phy,
> > +				     REG_PCIE_PMA_FORCE_DA_PXP_TXPLL_SDM_PCW,
> > +				     PCIE_FORCE_DA_PXP_TXPLL_SDM_PCW,
> > +				     0xc800000);
> > +
> > +	airoha_phy_csr_2l_clear_bits(pcie_phy, REG_CSR_2L_TXPLL_SDM_DI_LS,
> > +				     CSR_2L_PXP_TXPLL_SDM_IFM);
> > +	airoha_phy_csr_2l_clear_bits(pcie_phy, REG_CSR_2L_TXPLL_SSC,
> > +				     CSR_2L_PXP_TXPLL_SSC_PHASE_INI);
> > +	airoha_phy_csr_2l_update_field(pcie_phy, REG_CSR_2L_TXPLL_REFIN_DIV,
> > +				       CSR_2L_PXP_TXPLL_RST_DLY, 0x4);
> > +	airoha_phy_csr_2l_clear_bits(pcie_phy, REG_CSR_2L_TXPLL_SDM_DI_LS,
> > +				     CSR_2L_PXP_TXPLL_SDM_DI_LS);
> > +	airoha_phy_csr_2l_update_field(pcie_phy, REG_CSR_2L_TXPLL_SDM_DI_LS,
> > +				       CSR_2L_PXP_TXPLL_SDM_ORD, 0x3);
> > +	airoha_phy_csr_2l_clear_bits(pcie_phy, REG_CSR_2L_TXPLL_TCL_KBAND_VREF,
> > +				     CSR_2L_PXP_TXPLL_VCO_KBAND_MEAS_EN);
> > +	writel(0x0, pcie_phy->csr_2l + REG_CSR_2L_TXPLL_SSC_DELTA1);
> > +	airoha_phy_csr_2l_update_field(pcie_phy, REG_CSR_2L_TXPLL_CHP_IOFST,
> > +				       CSR_2L_PXP_TXPLL_LPF_BP, 0x1);
> > +	airoha_phy_csr_2l_update_field(pcie_phy, REG_CSR_2L_TXPLL_CHP_IOFST,
> > +				       CSR_2L_PXP_TXPLL_LPF_BC, 0x18);
> > +	airoha_phy_csr_2l_update_field(pcie_phy, REG_CSR_2L_TXPLL_CHP_IOFST,
> > +				       CSR_2L_PXP_TXPLL_LPF_BR, 0x5);
> > +	airoha_phy_csr_2l_update_field(pcie_phy, REG_CSR_2L_TXPLL_CHP_IOFST,
> > +				       CSR_2L_PXP_TXPLL_CHP_IOFST, 0x1);
> > +	airoha_phy_csr_2l_update_field(pcie_phy, REG_CSR_2L_750M_SYS_CK,
> > +				       CSR_2L_PXP_TXPLL_CHP_IBIAS, 0x2d);
> > +	airoha_phy_csr_2l_update_field(pcie_phy, REG_CSR_2L_TXPLL_TCL_VTP,
> > +				       CSR_2L_PXP_TXPLL_SPARE_L, 0x1);
> > +	airoha_phy_csr_2l_clear_bits(pcie_phy, REG_CSR_2L_TXPLL_LPF_BWR,
> > +				     CSR_2L_PXP_TXPLL_LPF_BWC);
> > +	airoha_phy_csr_2l_clear_bits(pcie_phy, REG_CSR_2L_TXPLL_POSTDIV,
> > +				     CSR_2L_PXP_TXPLL_MMD_PREDIV_MODE);
> > +	airoha_phy_csr_2l_clear_bits(pcie_phy, REG_CSR_2L_TXPLL_REFIN_DIV,
> > +				     CSR_2L_PXP_TXPLL_REFIN_DIV);
> > +	airoha_phy_csr_2l_set_bits(pcie_phy, REG_CSR_2L_TXPLL_TCL_LPF_BW,
> > +				   CSR_2L_PXP_TXPLL_VCO_HALFLSB_EN);
> > +	airoha_phy_csr_2l_update_field(pcie_phy, REG_CSR_2L_TXPLL_VCO_SCAPWR,
> > +				       CSR_2L_PXP_TXPLL_VCO_SCAPWR, 0x7);
> > +	airoha_phy_csr_2l_update_field(pcie_phy, REG_CSR_2L_TXPLL_TCL_LPF_BW,
> > +				       CSR_2L_PXP_TXPLL_VCO_CFIX, 0x3);
> > +
> > +	airoha_phy_pma0_set_bits(pcie_phy,
> > +				 REG_PCIE_PMA_FORCE_DA_PXP_CDR_PR_IDAC,
> > +				 PCIE_FORCE_SEL_DA_PXP_TXPLL_SDM_PCW);
> > +	airoha_phy_pma1_set_bits(pcie_phy,
> > +				 REG_PCIE_PMA_FORCE_DA_PXP_CDR_PR_IDAC,
> > +				 PCIE_FORCE_SEL_DA_PXP_TXPLL_SDM_PCW);
> > +
> > +	airoha_phy_csr_2l_clear_bits(pcie_phy, REG_CSR_2L_TXPLL_SSC,
> > +				     CSR_2L_PXP_TXPLL_SSC_PHASE_INI);
> > +	airoha_phy_csr_2l_clear_bits(pcie_phy, REG_CSR_2L_TXPLL_LPF_BWR,
> > +				     CSR_2L_PXP_TXPLL_LPF_BWR);
> > +	airoha_phy_csr_2l_set_bits(pcie_phy, REG_CSR_2L_TXPLL_PHY_CK2,
> > +				   CSR_2L_PXP_TXPLL_REFIN_INTERNAL);
> > +	airoha_phy_csr_2l_clear_bits(pcie_phy, REG_CSR_2L_TXPLL_TCL_KBAND_VREF,
> > +				     CSR_2L_PXP_TXPLL_VCO_KBAND_MEAS_EN);
> > +	airoha_phy_csr_2l_clear_bits(pcie_phy, REG_CSR_2L_TXPLL_VTP,
> > +				     CSR_2L_PXP_TXPLL_VTP_EN);
> > +	airoha_phy_csr_2l_clear_bits(pcie_phy, REG_CSR_2L_TXPLL_POSTDIV,
> > +				     CSR_2L_PXP_TXPLL_PHY_CK1_EN);
> > +	airoha_phy_csr_2l_set_bits(pcie_phy, REG_CSR_2L_TXPLL_PHY_CK2,
> > +				   CSR_2L_PXP_TXPLL_REFIN_INTERNAL);
> > +	airoha_phy_csr_2l_clear_bits(pcie_phy, REG_CSR_2L_TXPLL_SSC,
> > +				     CSR_2L_PXP_TXPLL_SSC_EN);
> > +	airoha_phy_csr_2l_clear_bits(pcie_phy, REG_CSR_2L_750M_SYS_CK,
> > +				     CSR_2L_PXP_TXPLL_LPF_SHCK_EN);
> > +	airoha_phy_csr_2l_clear_bits(pcie_phy, REG_CSR_2L_TXPLL_POSTDIV,
> > +				     CSR_2L_PXP_TXPLL_POSTDIV_EN);
> > +	airoha_phy_csr_2l_clear_bits(pcie_phy, REG_CSR_2L_TXPLL_KBAND_DIV,
> > +				     CSR_2L_PXP_TXPLL_KBAND_KFC);
> > +	airoha_phy_csr_2l_update_field(pcie_phy, REG_CSR_2L_TXPLL_KBAND_DIV,
> > +				       CSR_2L_PXP_TXPLL_KBAND_KF, 0x3);
> > +	airoha_phy_csr_2l_update_field(pcie_phy, REG_CSR_2L_TXPLL_KBAND_DIV,
> > +				       CSR_2L_PXP_txpll_KBAND_KS, 0x1);
> > +	airoha_phy_csr_2l_update_field(pcie_phy, REG_CSR_2L_TXPLL_KBAND_DIV,
> > +				       CSR_2L_PXP_TXPLL_KBAND_DIV, 0x4);
> > +	airoha_phy_csr_2l_update_field(pcie_phy, REG_CSR_2L_TXPLL_LPF_BWR,
> > +				       CSR_2L_PXP_TXPLL_KBAND_CODE, 0xe4);
> > +	airoha_phy_csr_2l_set_bits(pcie_phy, REG_CSR_2L_TXPLL_SDM_OUT,
> > +				   CSR_2L_PXP_TXPLL_TCL_AMP_EN);
> > +	airoha_phy_csr_2l_set_bits(pcie_phy, REG_CSR_2L_TXPLL_TCL_AMP_VREF,
> > +				   CSR_2L_PXP_TXPLL_TCL_LPF_EN);
> > +	airoha_phy_csr_2l_update_field(pcie_phy,
> > +				       REG_CSR_2L_TXPLL_TCL_KBAND_VREF,
> > +				       CSR_2L_PXP_TXPLL_TCL_KBAND_VREF, 0xf);
> > +	airoha_phy_csr_2l_update_field(pcie_phy, REG_CSR_2L_TXPLL_SDM_OUT,
> > +				       CSR_2L_PXP_TXPLL_TCL_AMP_GAIN, 0x3);
> > +	airoha_phy_csr_2l_update_field(pcie_phy,
> > +				       REG_CSR_2L_TXPLL_TCL_AMP_VREF,
> > +				       CSR_2L_PXP_TXPLL_TCL_AMP_VREF, 0xb);
> > +	airoha_phy_csr_2l_update_field(pcie_phy, REG_CSR_2L_TXPLL_TCL_LPF_BW,
> > +				       CSR_2L_PXP_TXPLL_TCL_LPF_BW, 0x3);
> > +
> > +	airoha_phy_pma0_set_bits(pcie_phy,
> > +				 REG_PCIE_PMA_FORCE_DA_PXP_TXPLL_CKOUT,
> > +				 PCIE_FORCE_SEL_DA_PXP_TXPLL_CKOUT_EN);
> > +	airoha_phy_pma0_set_bits(pcie_phy,
> > +				 REG_PCIE_PMA_FORCE_DA_PXP_TXPLL_CKOUT,
> > +				 PCIE_FORCE_DA_PXP_TXPLL_CKOUT_EN);
> > +	airoha_phy_pma1_set_bits(pcie_phy,
> > +				 REG_PCIE_PMA_FORCE_DA_PXP_TXPLL_CKOUT,
> > +				 PCIE_FORCE_SEL_DA_PXP_TXPLL_CKOUT_EN);
> > +	airoha_phy_pma1_set_bits(pcie_phy,
> > +				 REG_PCIE_PMA_FORCE_DA_PXP_TXPLL_CKOUT,
> > +				 PCIE_FORCE_DA_PXP_TXPLL_CKOUT_EN);
> > +	airoha_phy_pma0_set_bits(pcie_phy,
> > +				 REG_PCIE_PMA_FORCE_DA_PXP_TXPLL_CKOUT,
> > +				 PCIE_FORCE_SEL_DA_PXP_TXPLL_EN);
> > +	airoha_phy_pma0_set_bits(pcie_phy,
> > +				 REG_PCIE_PMA_FORCE_DA_PXP_TXPLL_CKOUT,
> > +				 PCIE_FORCE_DA_PXP_TXPLL_EN);
> > +	airoha_phy_pma1_set_bits(pcie_phy,
> > +				 REG_PCIE_PMA_FORCE_DA_PXP_TXPLL_CKOUT,
> > +				 PCIE_FORCE_SEL_DA_PXP_TXPLL_EN);
> > +	airoha_phy_pma1_set_bits(pcie_phy,
> > +				 REG_PCIE_PMA_FORCE_DA_PXP_TXPLL_CKOUT,
> > +				 PCIE_FORCE_DA_PXP_TXPLL_EN);
> > +}
> > +
> > +static void airoha_pcie_phy_init_ssc_jcpll(struct airoha_pcie_phy *pcie_phy)
> > +{
> > +	airoha_phy_csr_2l_update_field(pcie_phy, REG_CSR_2L_JCPLL_SSC_DELTA1,
> > +				       CSR_2L_PXP_JCPLL_SSC_DELTA1, 0x106);
> > +	airoha_phy_csr_2l_update_field(pcie_phy, REG_CSR_2L_JCPLL_SSC_DELTA1,
> > +				       CSR_2L_PXP_JCPLL_SSC_DELTA, 0x106);
> > +	airoha_phy_csr_2l_update_field(pcie_phy, REG_CSR_2L_JCPLL_SSC_PERIOD,
> > +				       CSR_2L_PXP_JCPLL_SSC_PERIOD, 0x31b);
> > +	airoha_phy_csr_2l_set_bits(pcie_phy, REG_CSR_2L_JCPLL_SSC,
> > +				   CSR_2L_PXP_JCPLL_SSC_PHASE_INI);
> > +	airoha_phy_csr_2l_set_bits(pcie_phy, REG_CSR_2L_JCPLL_SSC,
> > +				   CSR_2L_PXP_JCPLL_SSC_EN);
> > +	airoha_phy_csr_2l_set_bits(pcie_phy, REG_CSR_2L_JCPLL_SDM_IFM,
> > +				   CSR_2L_PXP_JCPLL_SDM_IFM);
> > +	airoha_phy_csr_2l_set_bits(pcie_phy, REG_CSR_2L_JCPLL_SDM_HREN,
> > +				   REG_CSR_2L_JCPLL_SDM_HREN);
> > +	airoha_phy_csr_2l_clear_bits(pcie_phy, REG_CSR_2L_JCPLL_RST_DLY,
> > +				     CSR_2L_PXP_JCPLL_SDM_DI_EN);
> > +	airoha_phy_csr_2l_set_bits(pcie_phy, REG_CSR_2L_JCPLL_SSC,
> > +				   CSR_2L_PXP_JCPLL_SSC_TRI_EN);
> > +}
> > +
> > +static void
> > +airoha_pcie_phy_set_rxlan0_signal_detect(struct airoha_pcie_phy *pcie_phy)
> > +{
> > +	airoha_phy_csr_2l_set_bits(pcie_phy, REG_CSR_2L_CDR0_PR_COR_HBW,
> > +				   CSR_2L_PXP_CDR0_PR_LDO_FORCE_ON);
> > +
> > +	usleep_range(100, 200);
> > +
> > +	airoha_phy_pma0_update_field(pcie_phy, REG_PCIE_PMA_DIG_RESERVE_19,
> > +				     PCIE_PCP_RX_REV0_PCIE_GEN1, 0x18b0);
> > +	airoha_phy_pma0_update_field(pcie_phy, REG_PCIE_PMA_DIG_RESERVE_20,
> > +				     PCIE_PCP_RX_REV0_PCIE_GEN2, 0x18b0);
> > +	airoha_phy_pma0_update_field(pcie_phy, REG_PCIE_PMA_DIG_RESERVE_20,
> > +				     PCIE_PCP_RX_REV0_PCIE_GEN3, 0x1030);
> > +
> > +	airoha_phy_csr_2l_update_field(pcie_phy, REG_CSR_2L_RX0_SIGDET_DCTEST,
> > +				       CSR_2L_PXP_RX0_SIGDET_PEAK, 0x2);
> > +	airoha_phy_csr_2l_update_field(pcie_phy, REG_CSR_2L_RX0_SIGDET_VTH_SEL,
> > +				       CSR_2L_PXP_RX0_SIGDET_VTH_SEL, 0x5);
> > +	airoha_phy_csr_2l_update_field(pcie_phy, REG_CSR_2L_RX0_REV0,
> > +				       CSR_2L_PXP_VOS_PNINV, 0x2);
> > +	airoha_phy_csr_2l_update_field(pcie_phy, REG_CSR_2L_RX0_SIGDET_DCTEST,
> > +				       CSR_2L_PXP_RX0_SIGDET_LPF_CTRL, 0x1);
> > +
> > +	airoha_phy_pma0_update_field(pcie_phy, REG_PCIE_PMA_SS_RX_CAL2,
> > +				     PCIE_CAL_OUT_OS, 0x0);
> > +
> > +	airoha_phy_csr_2l_set_bits(pcie_phy, REG_CSR_2L_PXP_RX0_FE_VB_EQ2,
> > +				   CSR_2L_PXP_RX0_FE_VCM_GEN_PWDB);
> > +
> > +	airoha_phy_pma0_set_bits(pcie_phy,
> > +				 REG_PCIE_PMA_FORCE_DA_PXP_RX_FE_GAIN_CTRL,
> > +				 PCIE_FORCE_SEL_DA_PXP_RX_FE_PWDB);
> > +	airoha_phy_pma0_update_field(pcie_phy,
> > +				     REG_PCIE_PMA_FORCE_DA_PXP_RX_FE_GAIN_CTRL,
> > +				     PCIE_FORCE_DA_PXP_RX_FE_GAIN_CTRL, 0x3);
> > +	airoha_phy_pma0_update_field(pcie_phy, REG_PCIE_PMA_RX_FORCE_MODE0,
> > +				     PCIE_FORCE_DA_XPON_RX_FE_GAIN_CTRL, 0x1);
> > +	airoha_phy_pma0_update_field(pcie_phy, REG_PCIE_PMA_SS_RX_SIGDET0,
> > +				     PCIE_SIGDET_WIN_NONVLD_TIMES, 0x3);
> > +	airoha_phy_pma0_clear_bits(pcie_phy, REG_PCIE_PMA_SEQUENCE_DISB_CTRL1,
> > +				   PCIE_DISB_RX_SDCAL_EN);
> > +
> > +	airoha_phy_pma0_set_bits(pcie_phy,
> > +				 REG_PCIE_PMA_CTRL_SEQUENCE_FORCE_CTRL1,
> > +				 PCIE_FORCE_RX_SDCAL_EN);
> > +	usleep_range(150, 200);
> > +	airoha_phy_pma0_clear_bits(pcie_phy,
> > +				   REG_PCIE_PMA_CTRL_SEQUENCE_FORCE_CTRL1,
> > +				   PCIE_FORCE_RX_SDCAL_EN);
> > +}
> > +
> > +static void
> > +airoha_pcie_phy_set_rxlan1_signal_detect(struct airoha_pcie_phy *pcie_phy)
> > +{
> > +	airoha_phy_csr_2l_set_bits(pcie_phy, REG_CSR_2L_CDR1_PR_COR_HBW,
> > +				   CSR_2L_PXP_CDR1_PR_LDO_FORCE_ON);
> > +
> > +	usleep_range(100, 200);
> > +
> > +	airoha_phy_pma1_update_field(pcie_phy, REG_PCIE_PMA_DIG_RESERVE_19,
> > +				     PCIE_PCP_RX_REV0_PCIE_GEN1, 0x18b0);
> > +	airoha_phy_pma1_update_field(pcie_phy, REG_PCIE_PMA_DIG_RESERVE_20,
> > +				     PCIE_PCP_RX_REV0_PCIE_GEN2, 0x18b0);
> > +	airoha_phy_pma1_update_field(pcie_phy, REG_PCIE_PMA_DIG_RESERVE_20,
> > +				     PCIE_PCP_RX_REV0_PCIE_GEN3, 0x1030);
> > +
> > +	airoha_phy_csr_2l_update_field(pcie_phy, REG_CSR_2L_RX1_SIGDET_NOVTH,
> > +				       CSR_2L_PXP_RX1_SIGDET_PEAK, 0x2);
> > +	airoha_phy_csr_2l_update_field(pcie_phy, REG_CSR_2L_RX1_SIGDET_NOVTH,
> > +				       CSR_2L_PXP_RX1_SIGDET_VTH_SEL, 0x5);
> > +	airoha_phy_csr_2l_update_field(pcie_phy, REG_CSR_2L_RX1_REV0,
> > +				       CSR_2L_PXP_VOS_PNINV, 0x2);
> > +	airoha_phy_csr_2l_update_field(pcie_phy, REG_CSR_2L_RX1_DAC_RANGE_EYE,
> > +				       CSR_2L_PXP_RX1_SIGDET_LPF_CTRL, 0x1);
> > +
> > +	airoha_phy_pma1_update_field(pcie_phy, REG_PCIE_PMA_SS_RX_CAL2,
> > +				     PCIE_CAL_OUT_OS, 0x0);
> > +
> > +	airoha_phy_csr_2l_set_bits(pcie_phy, REG_CSR_2L_RX1_FE_VB_EQ1,
> > +				   CSR_2L_PXP_RX1_FE_VCM_GEN_PWDB);
> > +
> > +	airoha_phy_pma1_set_bits(pcie_phy,
> > +				 REG_PCIE_PMA_FORCE_DA_PXP_RX_FE_GAIN_CTRL,
> > +				 PCIE_FORCE_SEL_DA_PXP_RX_FE_PWDB);
> > +	airoha_phy_pma1_update_field(pcie_phy,
> > +				     REG_PCIE_PMA_FORCE_DA_PXP_RX_FE_GAIN_CTRL,
> > +				     PCIE_FORCE_DA_PXP_RX_FE_GAIN_CTRL, 0x3);
> > +	airoha_phy_pma1_update_field(pcie_phy, REG_PCIE_PMA_RX_FORCE_MODE0,
> > +				     PCIE_FORCE_DA_XPON_RX_FE_GAIN_CTRL, 0x1);
> > +	airoha_phy_pma1_update_field(pcie_phy, REG_PCIE_PMA_SS_RX_SIGDET0,
> > +				     PCIE_SIGDET_WIN_NONVLD_TIMES, 0x3);
> > +	airoha_phy_pma1_clear_bits(pcie_phy, REG_PCIE_PMA_SEQUENCE_DISB_CTRL1,
> > +				   PCIE_DISB_RX_SDCAL_EN);
> > +
> > +	airoha_phy_pma1_set_bits(pcie_phy,
> > +				 REG_PCIE_PMA_CTRL_SEQUENCE_FORCE_CTRL1,
> > +				 PCIE_FORCE_RX_SDCAL_EN);
> > +	usleep_range(150, 200);
> > +	airoha_phy_pma1_clear_bits(pcie_phy,
> > +				   REG_PCIE_PMA_CTRL_SEQUENCE_FORCE_CTRL1,
> > +				   PCIE_FORCE_RX_SDCAL_EN);
> > +}
> > +
> > +static void airoha_pcie_phy_set_rxflow(struct airoha_pcie_phy *pcie_phy)
> > +{
> > +	airoha_phy_pma0_set_bits(pcie_phy,
> > +				 REG_PCIE_PMA_FORCE_DA_PXP_RX_SCAN_RST,
> > +				 PCIE_FORCE_DA_PXP_RX_SIGDET_PWDB |
> > +				 PCIE_FORCE_SEL_DA_PXP_RX_SIGDET_PWDB);
> > +	airoha_phy_pma1_set_bits(pcie_phy,
> > +				 REG_PCIE_PMA_FORCE_DA_PXP_RX_SCAN_RST,
> > +				 PCIE_FORCE_DA_PXP_RX_SIGDET_PWDB |
> > +				 PCIE_FORCE_SEL_DA_PXP_RX_SIGDET_PWDB);
> > +
> > +	airoha_phy_pma0_set_bits(pcie_phy,
> > +				 REG_PCIE_PMA_FORCE_DA_PXP_CDR_PD_PWDB,
> > +				 PCIE_FORCE_DA_PXP_CDR_PD_PWDB |
> > +				 PCIE_FORCE_SEL_DA_PXP_CDR_PD_PWDB);
> > +	airoha_phy_pma0_set_bits(pcie_phy,
> > +				 REG_PCIE_PMA_FORCE_DA_PXP_RX_FE_PWDB,
> > +				 PCIE_FORCE_DA_PXP_RX_FE_PWDB |
> > +				 PCIE_FORCE_SEL_DA_PXP_RX_FE_PWDB);
> > +	airoha_phy_pma1_set_bits(pcie_phy,
> > +				 REG_PCIE_PMA_FORCE_DA_PXP_CDR_PD_PWDB,
> > +				 PCIE_FORCE_DA_PXP_CDR_PD_PWDB |
> > +				 PCIE_FORCE_SEL_DA_PXP_CDR_PD_PWDB);
> > +	airoha_phy_pma1_set_bits(pcie_phy,
> > +				 REG_PCIE_PMA_FORCE_DA_PXP_RX_FE_PWDB,
> > +				 PCIE_FORCE_DA_PXP_RX_FE_PWDB |
> > +				 PCIE_FORCE_SEL_DA_PXP_RX_FE_PWDB);
> > +
> > +	airoha_phy_csr_2l_set_bits(pcie_phy, REG_CSR_2L_RX0_PHYCK_DIV,
> > +				   CSR_2L_PXP_RX0_PHYCK_RSTB |
> > +				   CSR_2L_PXP_RX0_TDC_CK_SEL);
> > +	airoha_phy_csr_2l_set_bits(pcie_phy, REG_CSR_2L_RX1_PHYCK_DIV,
> > +				   CSR_2L_PXP_RX1_PHYCK_RSTB |
> > +				   CSR_2L_PXP_RX1_TDC_CK_SEL);
> > +
> > +	airoha_phy_pma0_set_bits(pcie_phy, REG_PCIE_PMA_SW_RESET,
> > +				 PCIE_SW_RX_FIFO_RST | PCIE_SW_TX_RST |
> > +				 PCIE_SW_PMA_RST | PCIE_SW_ALLPCS_RST |
> > +				 PCIE_SW_TX_FIFO_RST);
> > +	airoha_phy_pma1_set_bits(pcie_phy, REG_PCIE_PMA_SW_RESET,
> > +				 PCIE_SW_RX_FIFO_RST | PCIE_SW_TX_RST |
> > +				 PCIE_SW_PMA_RST | PCIE_SW_ALLPCS_RST |
> > +				 PCIE_SW_TX_FIFO_RST);
> > +
> > +	airoha_phy_csr_2l_set_bits(pcie_phy, REG_CSR_2L_PXP_RX0_FE_VB_EQ2,
> > +				   CSR_2L_PXP_RX0_FE_VB_EQ2_EN |
> > +				   CSR_2L_PXP_RX0_FE_VB_EQ3_EN);
> > +	airoha_phy_csr_2l_set_bits(pcie_phy, REG_CSR_2L_RX0_SIGDET_VTH_SEL,
> > +				   CSR_2L_PXP_RX0_FE_VB_EQ1_EN);
> > +	airoha_phy_csr_2l_set_bits(pcie_phy, REG_CSR_2L_RX1_FE_VB_EQ1,
> > +				   CSR_2L_PXP_RX1_FE_VB_EQ1_EN |
> > +				   CSR_2L_PXP_RX1_FE_VB_EQ2_EN |
> > +				   CSR_2L_PXP_RX1_FE_VB_EQ3_EN);
> > +
> > +	airoha_phy_csr_2l_update_field(pcie_phy, REG_CSR_2L_RX0_REV0,
> > +				       CSR_2L_PXP_FE_GAIN_NORMAL_MODE, 0x4);
> > +	airoha_phy_csr_2l_update_field(pcie_phy, REG_CSR_2L_RX0_REV0,
> > +				       CSR_2L_PXP_FE_GAIN_TRAIN_MODE, 0x4);
> > +	airoha_phy_csr_2l_update_field(pcie_phy, REG_CSR_2L_RX1_REV0,
> > +				       CSR_2L_PXP_FE_GAIN_NORMAL_MODE, 0x4);
> > +	airoha_phy_csr_2l_update_field(pcie_phy, REG_CSR_2L_RX1_REV0,
> > +				       CSR_2L_PXP_FE_GAIN_TRAIN_MODE, 0x4);
> > +}
> > +
> > +static void airoha_pcie_phy_set_pr(struct airoha_pcie_phy *pcie_phy)
> > +{
> > +	airoha_phy_csr_2l_update_field(pcie_phy, REG_CSR_2L_CDR0_PR_VREG_IBAND,
> > +				       CSR_2L_PXP_CDR0_PR_VREG_IBAND, 0x5);
> > +	airoha_phy_csr_2l_update_field(pcie_phy, REG_CSR_2L_CDR0_PR_VREG_IBAND,
> > +				       CSR_2L_PXP_CDR0_PR_VREG_CKBUF, 0x5);
> > +
> > +	airoha_phy_csr_2l_clear_bits(pcie_phy, REG_CSR_2L_CDR0_PR_CKREF_DIV,
> > +				     CSR_2L_PXP_CDR0_PR_CKREF_DIV);
> > +	airoha_phy_csr_2l_clear_bits(pcie_phy, REG_CSR_2L_CDR0_PR_COR_HBW,
> > +				     CSR_2L_PXP_CDR0_PR_CKREF_DIV1);
> > +
> > +	airoha_phy_csr_2l_update_field(pcie_phy,
> > +				       REG_CSR_2L_CDR1_PR_VREG_IBAND_VAL,
> > +				       CSR_2L_PXP_CDR1_PR_VREG_IBAND, 0x5);
> > +	airoha_phy_csr_2l_update_field(pcie_phy,
> > +				       REG_CSR_2L_CDR1_PR_VREG_IBAND_VAL,
> > +				       CSR_2L_PXP_CDR1_PR_VREG_CKBUF, 0x5);
> > +
> > +	airoha_phy_csr_2l_clear_bits(pcie_phy, REG_CSR_2L_CDR1_PR_CKREF_DIV,
> > +				     CSR_2L_PXP_CDR1_PR_CKREF_DIV);
> > +	airoha_phy_csr_2l_clear_bits(pcie_phy, REG_CSR_2L_CDR1_PR_COR_HBW,
> > +				     CSR_2L_PXP_CDR1_PR_CKREF_DIV1);
> > +
> > +	airoha_phy_csr_2l_update_field(pcie_phy, REG_CSR_2L_CDR0_LPF_RATIO,
> > +				       CSR_2L_PXP_CDR0_LPF_TOP_LIM, 0x20000);
> > +	airoha_phy_csr_2l_update_field(pcie_phy, REG_CSR_2L_CDR1_LPF_RATIO,
> > +				       CSR_2L_PXP_CDR1_LPF_TOP_LIM, 0x20000);
> > +
> > +	airoha_phy_csr_2l_update_field(pcie_phy, REG_CSR_2L_CDR0_PR_BETA_DAC,
> > +				       CSR_2L_PXP_CDR0_PR_BETA_SEL, 0x2);
> > +	airoha_phy_csr_2l_update_field(pcie_phy, REG_CSR_2L_CDR1_PR_BETA_DAC,
> > +				       CSR_2L_PXP_CDR1_PR_BETA_SEL, 0x2);
> > +	airoha_phy_csr_2l_update_field(pcie_phy, REG_CSR_2L_CDR0_PR_BETA_DAC,
> > +				       CSR_2L_PXP_CDR0_PR_KBAND_DIV, 0x4);
> > +	airoha_phy_csr_2l_update_field(pcie_phy, REG_CSR_2L_CDR1_PR_BETA_DAC,
> > +				       CSR_2L_PXP_CDR1_PR_KBAND_DIV, 0x4);
> > +}
> > +
> > +static void airoha_pcie_phy_set_txflow(struct airoha_pcie_phy *pcie_phy)
> > +{
> > +	airoha_phy_csr_2l_set_bits(pcie_phy, REG_CSR_2L_TX0_CKLDO,
> > +				   CSR_2L_PXP_TX0_CKLDO_EN);
> > +	airoha_phy_csr_2l_set_bits(pcie_phy, REG_CSR_2L_TX1_CKLDO,
> > +				   CSR_2L_PXP_TX1_CKLDO_EN);
> > +
> > +	airoha_phy_csr_2l_set_bits(pcie_phy, REG_CSR_2L_TX0_CKLDO,
> > +				   CSR_2L_PXP_TX0_DMEDGEGEN_EN);
> > +	airoha_phy_csr_2l_set_bits(pcie_phy, REG_CSR_2L_TX1_CKLDO,
> > +				   CSR_2L_PXP_TX1_DMEDGEGEN_EN);
> > +	airoha_phy_csr_2l_clear_bits(pcie_phy, REG_CSR_2L_TX1_MULTLANE,
> > +				     CSR_2L_PXP_TX1_MULTLANE_EN);
> > +}
> > +
> > +static void airoha_pcie_phy_set_rx_mode(struct airoha_pcie_phy *pcie_phy)
> > +{
> > +	writel(0x804000, pcie_phy->pma0 + REG_PCIE_PMA_DIG_RESERVE_27);
> > +	airoha_phy_pma0_update_field(pcie_phy, REG_PCIE_PMA_DIG_RESERVE_18,
> > +				     PCIE_PXP_RX_VTH_SEL_PCIE_G1, 0x5);
> > +	airoha_phy_pma0_update_field(pcie_phy, REG_PCIE_PMA_DIG_RESERVE_18,
> > +				     PCIE_PXP_RX_VTH_SEL_PCIE_G2, 0x5);
> > +	airoha_phy_pma0_update_field(pcie_phy, REG_PCIE_PMA_DIG_RESERVE_18,
> > +				     PCIE_PXP_RX_VTH_SEL_PCIE_G3, 0x5);
> > +	airoha_phy_pma0_set_bits(pcie_phy, REG_PCIE_PMA_DIG_RESERVE_30,
> > +				 0x77700);
> > +
> > +	airoha_phy_csr_2l_clear_bits(pcie_phy, REG_CSR_2L_CDR0_PR_MONCK,
> > +				     CSR_2L_PXP_CDR0_PR_MONCK_ENABLE);
> > +	airoha_phy_csr_2l_update_field(pcie_phy, REG_CSR_2L_CDR0_PR_MONCK,
> > +				       CSR_2L_PXP_CDR0_PR_RESERVE0, 0x2);
> > +	airoha_phy_csr_2l_update_field(pcie_phy,
> > +				       REG_CSR_2L_PXP_RX0_OSCAL_CTLE1IOS,
> > +				       CSR_2L_PXP_RX0_PR_OSCAL_VGA1IOS, 0x19);
> > +	airoha_phy_csr_2l_update_field(pcie_phy,
> > +				       REG_CSR_2L_PXP_RX0_OSCA_VGA1VOS,
> > +				       CSR_2L_PXP_RX0_PR_OSCAL_VGA1VOS, 0x19);
> > +	airoha_phy_csr_2l_update_field(pcie_phy,
> > +				       REG_CSR_2L_PXP_RX0_OSCA_VGA1VOS,
> > +				       CSR_2L_PXP_RX0_PR_OSCAL_VGA2IOS, 0x14);
> > +
> > +	writel(0x804000, pcie_phy->pma1 + REG_PCIE_PMA_DIG_RESERVE_27);
> > +	airoha_phy_pma1_update_field(pcie_phy, REG_PCIE_PMA_DIG_RESERVE_18,
> > +				     PCIE_PXP_RX_VTH_SEL_PCIE_G1, 0x5);
> > +	airoha_phy_pma1_update_field(pcie_phy, REG_PCIE_PMA_DIG_RESERVE_18,
> > +				     PCIE_PXP_RX_VTH_SEL_PCIE_G2, 0x5);
> > +	airoha_phy_pma1_update_field(pcie_phy, REG_PCIE_PMA_DIG_RESERVE_18,
> > +				     PCIE_PXP_RX_VTH_SEL_PCIE_G3, 0x5);
> > +
> > +	airoha_phy_pma1_set_bits(pcie_phy, REG_PCIE_PMA_DIG_RESERVE_30,
> > +				 0x77700);
> > +
> > +	airoha_phy_csr_2l_clear_bits(pcie_phy, REG_CSR_2L_CDR1_PR_MONCK,
> > +				     CSR_2L_PXP_CDR1_PR_MONCK_ENABLE);
> > +	airoha_phy_csr_2l_update_field(pcie_phy, REG_CSR_2L_CDR1_PR_MONCK,
> > +				       CSR_2L_PXP_CDR1_PR_RESERVE0, 0x2);
> > +	airoha_phy_csr_2l_update_field(pcie_phy, REG_CSR_2L_RX1_OSCAL_VGA1IOS,
> > +				       CSR_2L_PXP_RX1_PR_OSCAL_VGA1IOS, 0x19);
> > +	airoha_phy_csr_2l_update_field(pcie_phy, REG_CSR_2L_RX1_OSCAL_VGA1IOS,
> > +				       CSR_2L_PXP_RX1_PR_OSCAL_VGA1VOS, 0x19);
> > +	airoha_phy_csr_2l_update_field(pcie_phy, REG_CSR_2L_RX1_OSCAL_VGA1IOS,
> > +				       CSR_2L_PXP_RX1_PR_OSCAL_VGA2IOS, 0x14);
> > +}
> > +
> > +static void airoha_pcie_phy_load_kflow(struct airoha_pcie_phy *pcie_phy)
> > +{
> > +	airoha_phy_pma0_update_field(pcie_phy, REG_PCIE_PMA_DIG_RESERVE_12,
> > +				     PCIE_FORCE_PMA_RX_SPEED, 0xa);
> > +	airoha_phy_pma1_update_field(pcie_phy, REG_PCIE_PMA_DIG_RESERVE_12,
> > +				     PCIE_FORCE_PMA_RX_SPEED, 0xa);
> > +	airoha_phy_init_lane0_rx_fw_pre_calib(pcie_phy, 3);
> > +	airoha_phy_init_lane1_rx_fw_pre_calib(pcie_phy, 3);
> > +
> > +	airoha_phy_pma0_clear_bits(pcie_phy, REG_PCIE_PMA_DIG_RESERVE_12,
> > +				   PCIE_FORCE_PMA_RX_SPEED);
> > +	airoha_phy_pma1_clear_bits(pcie_phy, REG_PCIE_PMA_DIG_RESERVE_12,
> > +				   PCIE_FORCE_PMA_RX_SPEED);
> > +	usleep_range(100, 200);
> > +
> > +	airoha_phy_init_lane0_rx_fw_pre_calib(pcie_phy, 2);
> > +	airoha_phy_init_lane1_rx_fw_pre_calib(pcie_phy, 2);
> > +}
> > +
> > +/**
> > + * airoha_pcie_phy_init() - Initialize the phy
> > + * @phy: the phy to be initialized
> > + *
> > + * Initialize the phy registers.
> > + * The hardware settings will be reset during suspend, it should be
> > + * reinitialized when the consumer calls phy_init() again on resume.
> > + */
> > +static int airoha_pcie_phy_init(struct phy *phy)
> > +{
> > +	struct airoha_pcie_phy *pcie_phy = phy_get_drvdata(phy);
> > +
> > +	/* enable load FLL-K flow */
> > +	airoha_phy_pma0_set_bits(pcie_phy, REG_PCIE_PMA_DIG_RESERVE_14,
> > +				 PCIE_FLL_LOAD_EN);
> > +	airoha_phy_pma1_set_bits(pcie_phy, REG_PCIE_PMA_DIG_RESERVE_14,
> > +				 PCIE_FLL_LOAD_EN);
> > +
> > +	airoha_pcie_phy_init_default(pcie_phy);
> > +	airoha_pcie_phy_init_clk_out(pcie_phy);
> > +	airoha_pcie_phy_init_csr_2l(pcie_phy);
> > +
> > +	usleep_range(100, 200);
> > +
> > +	airoha_pcie_phy_init_rx(pcie_phy);
> > +	/* phase 1, no ssc for K TXPLL */
> > +	airoha_pcie_phy_init_jcpll(pcie_phy);
> > +
> > +	usleep_range(500, 600);
> > +
> > +	/* TX PLL settings */
> > +	airoha_pcie_phy_txpll(pcie_phy);
> > +
> > +	usleep_range(200, 300);
> > +
> > +	/* SSC JCPLL setting */
> > +	airoha_pcie_phy_init_ssc_jcpll(pcie_phy);
> > +
> > +	usleep_range(100, 200);
> > +
> > +	/* Rx lan0 signal detect */
> > +	airoha_pcie_phy_set_rxlan0_signal_detect(pcie_phy);
> > +	/* Rx lan1 signal detect */
> > +	airoha_pcie_phy_set_rxlan1_signal_detect(pcie_phy);
> > +	/* RX FLOW */
> > +	airoha_pcie_phy_set_rxflow(pcie_phy);
> > +
> > +	usleep_range(100, 200);
> > +
> > +	airoha_pcie_phy_set_pr(pcie_phy);
> > +	/* TX FLOW */
> > +	airoha_pcie_phy_set_txflow(pcie_phy);
> > +
> > +	usleep_range(100, 200);
> > +	/* RX mode setting */
> > +	airoha_pcie_phy_set_rx_mode(pcie_phy);
> > +	/* Load K-Flow */
> > +	airoha_pcie_phy_load_kflow(pcie_phy);
> > +	airoha_phy_pma0_clear_bits(pcie_phy, REG_PCIE_PMA_SS_DA_XPON_PWDB0,
> > +				   PCIE_DA_XPON_CDR_PR_PWDB);
> > +	airoha_phy_pma1_clear_bits(pcie_phy, REG_PCIE_PMA_SS_DA_XPON_PWDB0,
> > +				   PCIE_DA_XPON_CDR_PR_PWDB);
> > +
> > +	usleep_range(100, 200);
> > +
> > +	airoha_phy_pma0_set_bits(pcie_phy, REG_PCIE_PMA_SS_DA_XPON_PWDB0,
> > +				 PCIE_DA_XPON_CDR_PR_PWDB);
> > +	airoha_phy_pma1_set_bits(pcie_phy, REG_PCIE_PMA_SS_DA_XPON_PWDB0,
> > +				 PCIE_DA_XPON_CDR_PR_PWDB);
> > +
> > +	usleep_range(100, 200);
> > +
> > +	return 0;
> > +}
> > +
> > +static int airoha_pcie_phy_exit(struct phy *phy)
> > +{
> > +	struct airoha_pcie_phy *pcie_phy = phy_get_drvdata(phy);
> > +
> > +	airoha_phy_pma0_clear_bits(pcie_phy, REG_PCIE_PMA_SW_RESET,
> > +				   PCIE_PMA_SW_RST);
> > +	airoha_phy_pma1_clear_bits(pcie_phy, REG_PCIE_PMA_SW_RESET,
> > +				   PCIE_PMA_SW_RST);
> > +	airoha_phy_csr_2l_clear_bits(pcie_phy, REG_CSR_2L_JCPLL_SSC,
> > +				     CSR_2L_PXP_JCPLL_SSC_PHASE_INI |
> > +				     CSR_2L_PXP_JCPLL_SSC_TRI_EN |
> > +				     CSR_2L_PXP_JCPLL_SSC_EN);
> > +
> > +	return 0;
> > +}
> > +
> > +static const struct phy_ops airoha_pcie_phy_ops = {
> > +	.init = airoha_pcie_phy_init,
> > +	.exit = airoha_pcie_phy_exit,
> > +	.owner = THIS_MODULE,
> > +};
> > +
> > +static int airoha_pcie_phy_probe(struct platform_device *pdev)
> > +{
> > +	struct airoha_pcie_phy *pcie_phy;
> > +	struct device *dev = &pdev->dev;
> > +	struct phy_provider *provider;
> > +
> > +	pcie_phy = devm_kzalloc(dev, sizeof(*pcie_phy), GFP_KERNEL);
> > +	if (!pcie_phy)
> > +		return -ENOMEM;
> > +
> > +	pcie_phy->csr_2l = devm_platform_ioremap_resource_byname(pdev, "csr_2l");
> > +	if (IS_ERR(pcie_phy->csr_2l))
> > +		return dev_err_probe(dev, PTR_ERR(pcie_phy->csr_2l),
> > +				     "Failed to map phy-csr_2l base\n");
> > +
> > +	pcie_phy->pma0 = devm_platform_ioremap_resource_byname(pdev, "pma0");
> > +	if (IS_ERR(pcie_phy->pma0))
> > +		return dev_err_probe(dev, PTR_ERR(pcie_phy->pma0),
> > +				     "Failed to map phy-pma0 base\n");
> > +
> > +	pcie_phy->pma1 = devm_platform_ioremap_resource_byname(pdev, "pma1");
> > +	if (IS_ERR(pcie_phy->pma1))
> > +		return dev_err_probe(dev, PTR_ERR(pcie_phy->pma1),
> > +				     "Failed to map phy-pma1 base\n");
> > +
> > +	pcie_phy->phy = devm_phy_create(dev, dev->of_node, &airoha_pcie_phy_ops);
> > +	if (IS_ERR(pcie_phy->phy))
> > +		return dev_err_probe(dev, PTR_ERR(pcie_phy->phy),
> > +				     "Failed to create PCIe phy\n");
> > +
> > +	pcie_phy->dev = dev;
> > +	phy_set_drvdata(pcie_phy->phy, pcie_phy);
> > +
> > +	provider = devm_of_phy_provider_register(dev, of_phy_simple_xlate);
> > +	if (IS_ERR(provider))
> > +		return dev_err_probe(dev, PTR_ERR(provider),
> > +				     "PCIe phy probe failed\n");
> > +
> > +	return 0;
> > +}
> > +
> > +static const struct of_device_id airoha_pcie_phy_of_match[] = {
> > +	{ .compatible = "airoha,en7581-pcie-phy" },
> > +	{ /* sentinel */ }
> > +};
> > +MODULE_DEVICE_TABLE(of, airoha_pcie_phy_of_match);
> > +
> > +static struct platform_driver airoha_pcie_phy_driver = {
> > +	.probe	= airoha_pcie_phy_probe,
> > +	.driver	= {
> > +		.name = "airoha-pcie-phy",
> > +		.of_match_table = airoha_pcie_phy_of_match,
> > +	},
> > +};
> > +module_platform_driver(airoha_pcie_phy_driver);
> > +
> > +MODULE_DESCRIPTION("Airoha PCIe PHY driver");
> > +MODULE_AUTHOR("Lorenzo Bianconi <lorenzo@xxxxxxxxxx>");
> > +MODULE_LICENSE("GPL");
> 

Attachment: signature.asc
Description: PGP signature


[Index of Archives]     [Device Tree Compilter]     [Device Tree Spec]     [Linux Driver Backports]     [Video for Linux]     [Linux USB Devel]     [Linux PCI Devel]     [Linux Audio Users]     [Linux Kernel]     [Linux SCSI]     [XFree86]     [Yosemite Backpacking]


  Powered by Linux