kevin/linux
1
Fork 0
Code
cb6fcef8b4
linux/drivers/phy/phy-airoha-pcie.c
Lorenzo Bianconi 7f7315db3d phy: airoha: adjust initialization delay in airoha_pcie_phy_init() 
Align phy-pcie initialization delay to the vendor sdk in
airoha_pcie_phy_init routine and allow the hw to complete required
configuration before proceeding

Reviewed-by: AngeloGioacchino Del Regno <angelogioacchino.delregno@collabora.com>
Signed-off-by: Lorenzo Bianconi <lorenzo@kernel.org>
Link: https://lore.kernel.org/r/8af6f27857619f1e0dd227f08b8584ae8fb22fb2.1722959625.git.lorenzo@kernel.org
Signed-off-by: Vinod Koul <vkoul@kernel.org>
2024-08-29 23:48:51 +05:30

1291 lines
49 KiB
C
Raw Blame History

// SPDX-License-Identifier: GPL-2.0-only
/*
* Copyright (c) 2024 AIROHA Inc
* Author: Lorenzo Bianconi <lorenzo@kernel.org>
*/
#include <linux/bitfield.h>
#include <linux/delay.h>
#include <linux/io.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"
#define LEQ_LEN_CTRL_MAX_VAL 7
#define FREQ_LOCK_MAX_ATTEMPT 10
/* PCIe-PHY initialization time in ms needed by the hw to complete */
#define PHY_HW_INIT_TIME_MS 30
enum airoha_pcie_port_gen {
PCIE_PORT_GEN1 = 1,
PCIE_PORT_GEN2,
PCIE_PORT_GEN3,
};
/**
* 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
* @p0_xr_dtime: IO mapped register base address of port0 Tx-Rx detection time
* @p1_xr_dtime: IO mapped register base address of port1 Tx-Rx detection time
* @rx_aeq: IO mapped register base address of Rx AEQ training
*/
struct airoha_pcie_phy {
struct device *dev;
struct phy *phy;
void __iomem *csr_2l;
void __iomem *pma0;
void __iomem *pma1;
void __iomem *p0_xr_dtime;
void __iomem *p1_xr_dtime;
void __iomem *rx_aeq;
};
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,
enum airoha_pcie_port_gen gen)
{
u32 fl_out_target = gen == PCIE_PORT_GEN3 ? 41600 : 41941;
u32 lock_cyclecnt = gen == PCIE_PORT_GEN3 ? 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 < LEQ_LEN_CTRL_MAX_VAL; 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 = LEQ_LEN_CTRL_MAX_VAL; 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 < FREQ_LOCK_MAX_ATTEMPT; i++) {
u32 val;
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 = readl(pcie_phy->pma0 + REG_PCIE_PMA_RO_RX_FREQDET);
if (val & PCIE_RO_FBCK_LOCK)
break;
}
/* 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 == PCIE_PORT_GEN3) {
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,
enum airoha_pcie_port_gen gen)
{
u32 fl_out_target = gen == PCIE_PORT_GEN3 ? 41600 : 41941;
u32 lock_cyclecnt = gen == PCIE_PORT_GEN3 ? 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 < LEQ_LEN_CTRL_MAX_VAL; 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 = LEQ_LEN_CTRL_MAX_VAL; 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 < FREQ_LOCK_MAX_ATTEMPT; i++) {
u32 val;
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 = readl(pcie_phy->pma1 + REG_PCIE_PMA_RO_RX_FREQDET);
if (val & PCIE_RO_FBCK_LOCK)
break;
}
/* 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 == PCIE_PORT_GEN3) {
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, PCIE_PORT_GEN3);
airoha_phy_init_lane1_rx_fw_pre_calib(pcie_phy, PCIE_PORT_GEN3);
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, PCIE_PORT_GEN2);
airoha_phy_init_lane1_rx_fw_pre_calib(pcie_phy, PCIE_PORT_GEN2);
}
/**
* 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);
u32 val;
/* Setup Tx-Rx detection time */
val = FIELD_PREP(PCIE_XTP_RXDET_VCM_OFF_STB_T_SEL, 0x33) |
FIELD_PREP(PCIE_XTP_RXDET_EN_STB_T_SEL, 0x1) |
FIELD_PREP(PCIE_XTP_RXDET_FINISH_STB_T_SEL, 0x2) |
FIELD_PREP(PCIE_XTP_TXPD_TX_DATA_EN_DLY, 0x3) |
FIELD_PREP(PCIE_XTP_RXDET_LATCH_STB_T_SEL, 0x1);
writel(val, pcie_phy->p0_xr_dtime + REG_PCIE_PEXTP_DIG_GLB44);
writel(val, pcie_phy->p1_xr_dtime + REG_PCIE_PEXTP_DIG_GLB44);
/* Setup Rx AEQ training time */
val = FIELD_PREP(PCIE_XTP_LN_RX_PDOWN_L1P2_EXIT_WAIT, 0x32) |
FIELD_PREP(PCIE_XTP_LN_RX_PDOWN_E0_AEQEN_WAIT, 0x5050);
writel(val, pcie_phy->rx_aeq + REG_PCIE_PEXTP_DIG_LN_RX30_P0);
writel(val, pcie_phy->rx_aeq + REG_PCIE_PEXTP_DIG_LN_RX30_P1);
/* 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);
/* Wait for the PCIe PHY to complete initialization before returning */
msleep(PHY_HW_INIT_TIME_MS);
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->p0_xr_dtime =
devm_platform_ioremap_resource_byname(pdev, "p0-xr-dtime");
if (IS_ERR(pcie_phy->p0_xr_dtime))
return dev_err_probe(dev, PTR_ERR(pcie_phy->p0_xr_dtime),
"Failed to map P0 Tx-Rx dtime base\n");
pcie_phy->p1_xr_dtime =
devm_platform_ioremap_resource_byname(pdev, "p1-xr-dtime");
if (IS_ERR(pcie_phy->p1_xr_dtime))
return dev_err_probe(dev, PTR_ERR(pcie_phy->p1_xr_dtime),
"Failed to map P1 Tx-Rx dtime base\n");
pcie_phy->rx_aeq = devm_platform_ioremap_resource_byname(pdev, "rx-aeq");
if (IS_ERR(pcie_phy->rx_aeq))
return dev_err_probe(dev, PTR_ERR(pcie_phy->rx_aeq),
"Failed to map Rx AEQ base\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@kernel.org>");
MODULE_LICENSE("GPL");
View Git Blame Copy Permalink