| // SPDX-License-Identifier: GPL-2.0 |
| /* |
| * Cadence Sierra PHY Driver |
| * |
| * Based on the linux driver provided by Cadence |
| * |
| * Copyright (c) 2018 Cadence Design Systems |
| * Author: Alan Douglas <adouglas@cadence.com> |
| * |
| * Copyright (C) 2019 Texas Instruments Incorporated - http://www.ti.com/ |
| * Jean-Jacques Hiblot <jjhiblot@ti.com> |
| * |
| */ |
| #include <common.h> |
| #include <clk.h> |
| #include <generic-phy.h> |
| #include <reset.h> |
| #include <dm/device.h> |
| #include <dm/device-internal.h> |
| #include <dm/device_compat.h> |
| #include <dm/lists.h> |
| #include <dm/read.h> |
| #include <dm/uclass.h> |
| #include <dm/devres.h> |
| #include <linux/io.h> |
| #include <dt-bindings/phy/phy.h> |
| #include <regmap.h> |
| |
| /* PHY register offsets */ |
| #define SIERRA_COMMON_CDB_OFFSET 0x0 |
| #define SIERRA_MACRO_ID_REG 0x0 |
| #define SIERRA_CMN_PLLLC_MODE_PREG 0x48 |
| #define SIERRA_CMN_PLLLC_LF_COEFF_MODE1_PREG 0x49 |
| #define SIERRA_CMN_PLLLC_LF_COEFF_MODE0_PREG 0x4A |
| #define SIERRA_CMN_PLLLC_LOCK_CNTSTART_PREG 0x4B |
| #define SIERRA_CMN_PLLLC_BWCAL_MODE1_PREG 0x4F |
| #define SIERRA_CMN_PLLLC_BWCAL_MODE0_PREG 0x50 |
| #define SIERRA_CMN_PLLLC_SS_TIME_STEPSIZE_MODE_PREG 0x62 |
| |
| #define SIERRA_LANE_CDB_OFFSET(ln, offset) \ |
| (0x4000 + ((ln) * (0x800 >> (2 - (offset))))) |
| |
| #define SIERRA_DET_STANDEC_A_PREG 0x000 |
| #define SIERRA_DET_STANDEC_B_PREG 0x001 |
| #define SIERRA_DET_STANDEC_C_PREG 0x002 |
| #define SIERRA_DET_STANDEC_D_PREG 0x003 |
| #define SIERRA_DET_STANDEC_E_PREG 0x004 |
| #define SIERRA_PSM_LANECAL_DLY_A1_RESETS_PREG 0x008 |
| #define SIERRA_PSM_A0IN_TMR_PREG 0x009 |
| #define SIERRA_PSM_DIAG_PREG 0x015 |
| #define SIERRA_PSC_TX_A0_PREG 0x028 |
| #define SIERRA_PSC_TX_A1_PREG 0x029 |
| #define SIERRA_PSC_TX_A2_PREG 0x02A |
| #define SIERRA_PSC_TX_A3_PREG 0x02B |
| #define SIERRA_PSC_RX_A0_PREG 0x030 |
| #define SIERRA_PSC_RX_A1_PREG 0x031 |
| #define SIERRA_PSC_RX_A2_PREG 0x032 |
| #define SIERRA_PSC_RX_A3_PREG 0x033 |
| #define SIERRA_PLLCTRL_SUBRATE_PREG 0x03A |
| #define SIERRA_PLLCTRL_GEN_D_PREG 0x03E |
| #define SIERRA_PLLCTRL_CPGAIN_MODE_PREG 0x03F |
| #define SIERRA_PLLCTRL_STATUS_PREG 0x044 |
| #define SIERRA_CLKPATH_BIASTRIM_PREG 0x04B |
| #define SIERRA_DFE_BIASTRIM_PREG 0x04C |
| #define SIERRA_DRVCTRL_ATTEN_PREG 0x06A |
| #define SIERRA_CLKPATHCTRL_TMR_PREG 0x081 |
| #define SIERRA_RX_CREQ_FLTR_A_MODE3_PREG 0x085 |
| #define SIERRA_RX_CREQ_FLTR_A_MODE2_PREG 0x086 |
| #define SIERRA_RX_CREQ_FLTR_A_MODE1_PREG 0x087 |
| #define SIERRA_RX_CREQ_FLTR_A_MODE0_PREG 0x088 |
| #define SIERRA_CREQ_CCLKDET_MODE01_PREG 0x08E |
| #define SIERRA_RX_CTLE_MAINTENANCE_PREG 0x091 |
| #define SIERRA_CREQ_FSMCLK_SEL_PREG 0x092 |
| #define SIERRA_CREQ_EQ_CTRL_PREG 0x093 |
| #define SIERRA_CREQ_SPARE_PREG 0x096 |
| #define SIERRA_CREQ_EQ_OPEN_EYE_THRESH_PREG 0x097 |
| #define SIERRA_CTLELUT_CTRL_PREG 0x098 |
| #define SIERRA_DFE_ECMP_RATESEL_PREG 0x0C0 |
| #define SIERRA_DFE_SMP_RATESEL_PREG 0x0C1 |
| #define SIERRA_DEQ_PHALIGN_CTRL 0x0C4 |
| #define SIERRA_DEQ_CONCUR_CTRL1_PREG 0x0C8 |
| #define SIERRA_DEQ_CONCUR_CTRL2_PREG 0x0C9 |
| #define SIERRA_DEQ_EPIPWR_CTRL2_PREG 0x0CD |
| #define SIERRA_DEQ_FAST_MAINT_CYCLES_PREG 0x0CE |
| #define SIERRA_DEQ_ERRCMP_CTRL_PREG 0x0D0 |
| #define SIERRA_DEQ_OFFSET_CTRL_PREG 0x0D8 |
| #define SIERRA_DEQ_GAIN_CTRL_PREG 0x0E0 |
| #define SIERRA_DEQ_VGATUNE_CTRL_PREG 0x0E1 |
| #define SIERRA_DEQ_GLUT0 0x0E8 |
| #define SIERRA_DEQ_GLUT1 0x0E9 |
| #define SIERRA_DEQ_GLUT2 0x0EA |
| #define SIERRA_DEQ_GLUT3 0x0EB |
| #define SIERRA_DEQ_GLUT4 0x0EC |
| #define SIERRA_DEQ_GLUT5 0x0ED |
| #define SIERRA_DEQ_GLUT6 0x0EE |
| #define SIERRA_DEQ_GLUT7 0x0EF |
| #define SIERRA_DEQ_GLUT8 0x0F0 |
| #define SIERRA_DEQ_GLUT9 0x0F1 |
| #define SIERRA_DEQ_GLUT10 0x0F2 |
| #define SIERRA_DEQ_GLUT11 0x0F3 |
| #define SIERRA_DEQ_GLUT12 0x0F4 |
| #define SIERRA_DEQ_GLUT13 0x0F5 |
| #define SIERRA_DEQ_GLUT14 0x0F6 |
| #define SIERRA_DEQ_GLUT15 0x0F7 |
| #define SIERRA_DEQ_GLUT16 0x0F8 |
| #define SIERRA_DEQ_ALUT0 0x108 |
| #define SIERRA_DEQ_ALUT1 0x109 |
| #define SIERRA_DEQ_ALUT2 0x10A |
| #define SIERRA_DEQ_ALUT3 0x10B |
| #define SIERRA_DEQ_ALUT4 0x10C |
| #define SIERRA_DEQ_ALUT5 0x10D |
| #define SIERRA_DEQ_ALUT6 0x10E |
| #define SIERRA_DEQ_ALUT7 0x10F |
| #define SIERRA_DEQ_ALUT8 0x110 |
| #define SIERRA_DEQ_ALUT9 0x111 |
| #define SIERRA_DEQ_ALUT10 0x112 |
| #define SIERRA_DEQ_ALUT11 0x113 |
| #define SIERRA_DEQ_ALUT12 0x114 |
| #define SIERRA_DEQ_ALUT13 0x115 |
| #define SIERRA_DEQ_DFETAP_CTRL_PREG 0x128 |
| #define SIERRA_DFE_EN_1010_IGNORE_PREG 0x134 |
| #define SIERRA_DEQ_TAU_CTRL1_SLOW_MAINT_PREG 0x150 |
| #define SIERRA_DEQ_TAU_CTRL2_PREG 0x151 |
| #define SIERRA_DEQ_PICTRL_PREG 0x161 |
| #define SIERRA_CPICAL_TMRVAL_MODE1_PREG 0x170 |
| #define SIERRA_CPICAL_TMRVAL_MODE0_PREG 0x171 |
| #define SIERRA_CPICAL_PICNT_MODE1_PREG 0x174 |
| #define SIERRA_CPI_OUTBUF_RATESEL_PREG 0x17C |
| #define SIERRA_CPICAL_RES_STARTCODE_MODE23_PREG 0x183 |
| #define SIERRA_LFPSDET_SUPPORT_PREG 0x188 |
| #define SIERRA_LFPSFILT_NS_PREG 0x18A |
| #define SIERRA_LFPSFILT_RD_PREG 0x18B |
| #define SIERRA_LFPSFILT_MP_PREG 0x18C |
| #define SIERRA_SIGDET_SUPPORT_PREG 0x190 |
| #define SIERRA_SDFILT_H2L_A_PREG 0x191 |
| #define SIERRA_SDFILT_L2H_PREG 0x193 |
| #define SIERRA_RXBUFFER_CTLECTRL_PREG 0x19E |
| #define SIERRA_RXBUFFER_RCDFECTRL_PREG 0x19F |
| #define SIERRA_RXBUFFER_DFECTRL_PREG 0x1A0 |
| #define SIERRA_DEQ_TAU_CTRL1_FAST_MAINT_PREG 0x14F |
| #define SIERRA_DEQ_TAU_CTRL1_SLOW_MAINT_PREG 0x150 |
| |
| #define SIERRA_PHY_CONFIG_CTRL_OFFSET 0xc000 |
| #define SIERRA_PHY_PLL_CFG 0xe |
| |
| #define SIERRA_MACRO_ID 0x00007364 |
| #define SIERRA_MAX_LANES 16 |
| #define PLL_LOCK_TIME 100 |
| |
| static const struct reg_field macro_id_type = |
| REG_FIELD(SIERRA_MACRO_ID_REG, 0, 15); |
| static const struct reg_field phy_pll_cfg_1 = |
| REG_FIELD(SIERRA_PHY_PLL_CFG, 1, 1); |
| static const struct reg_field pllctrl_lock = |
| REG_FIELD(SIERRA_PLLCTRL_STATUS_PREG, 0, 0); |
| |
| #define reset_control_assert(rst) cdns_reset_assert(rst) |
| #define reset_control_deassert(rst) cdns_reset_deassert(rst) |
| #define reset_control reset_ctl |
| |
| struct cdns_sierra_inst { |
| u32 phy_type; |
| u32 num_lanes; |
| u32 mlane; |
| struct reset_ctl_bulk *lnk_rst; |
| }; |
| |
| struct cdns_reg_pairs { |
| u16 val; |
| u32 off; |
| }; |
| |
| struct cdns_sierra_data { |
| u32 id_value; |
| u8 block_offset_shift; |
| u8 reg_offset_shift; |
| u32 pcie_cmn_regs; |
| u32 pcie_ln_regs; |
| u32 usb_cmn_regs; |
| u32 usb_ln_regs; |
| struct cdns_reg_pairs *pcie_cmn_vals; |
| struct cdns_reg_pairs *pcie_ln_vals; |
| struct cdns_reg_pairs *usb_cmn_vals; |
| struct cdns_reg_pairs *usb_ln_vals; |
| }; |
| |
| struct cdns_regmap_cdb_context { |
| struct udevice *dev; |
| void __iomem *base; |
| u8 reg_offset_shift; |
| }; |
| |
| struct cdns_sierra_phy { |
| struct udevice *dev; |
| void *base; |
| size_t size; |
| struct regmap *regmap; |
| struct cdns_sierra_data *init_data; |
| struct cdns_sierra_inst phys[SIERRA_MAX_LANES]; |
| struct reset_control *phy_rst; |
| struct regmap *regmap_lane_cdb[SIERRA_MAX_LANES]; |
| struct regmap *regmap_phy_config_ctrl; |
| struct regmap *regmap_common_cdb; |
| struct regmap_field *macro_id_type; |
| struct regmap_field *phy_pll_cfg_1; |
| struct regmap_field *pllctrl_lock[SIERRA_MAX_LANES]; |
| struct clk *clk; |
| struct clk *cmn_refclk; |
| struct clk *cmn_refclk1; |
| int nsubnodes; |
| u32 num_lanes; |
| bool autoconf; |
| }; |
| |
| static inline int cdns_reset_assert(struct reset_control *rst) |
| { |
| if (rst) |
| return reset_assert(rst); |
| else |
| return 0; |
| } |
| |
| static inline int cdns_reset_deassert(struct reset_control *rst) |
| { |
| if (rst) |
| return reset_deassert(rst); |
| else |
| return 0; |
| } |
| |
| static inline struct cdns_sierra_inst *phy_get_drvdata(struct phy *phy) |
| { |
| struct cdns_sierra_phy *sp = dev_get_priv(phy->dev); |
| int index; |
| |
| if (phy->id >= SIERRA_MAX_LANES) |
| return NULL; |
| |
| for (index = 0; index < sp->nsubnodes; index++) { |
| if (phy->id == sp->phys[index].mlane) |
| return &sp->phys[index]; |
| } |
| |
| return NULL; |
| } |
| |
| static int cdns_sierra_phy_init(struct phy *gphy) |
| { |
| struct cdns_sierra_inst *ins = phy_get_drvdata(gphy); |
| struct cdns_sierra_phy *phy = dev_get_priv(gphy->dev); |
| struct regmap *regmap = phy->regmap; |
| int i, j; |
| struct cdns_reg_pairs *cmn_vals, *ln_vals; |
| u32 num_cmn_regs, num_ln_regs; |
| |
| /* Initialise the PHY registers, unless auto configured */ |
| if (phy->autoconf) |
| return 0; |
| |
| clk_set_rate(phy->cmn_refclk, 25000000); |
| clk_set_rate(phy->cmn_refclk1, 25000000); |
| |
| if (ins->phy_type == PHY_TYPE_PCIE) { |
| num_cmn_regs = phy->init_data->pcie_cmn_regs; |
| num_ln_regs = phy->init_data->pcie_ln_regs; |
| cmn_vals = phy->init_data->pcie_cmn_vals; |
| ln_vals = phy->init_data->pcie_ln_vals; |
| } else if (ins->phy_type == PHY_TYPE_USB3) { |
| num_cmn_regs = phy->init_data->usb_cmn_regs; |
| num_ln_regs = phy->init_data->usb_ln_regs; |
| cmn_vals = phy->init_data->usb_cmn_vals; |
| ln_vals = phy->init_data->usb_ln_vals; |
| } else { |
| return -EINVAL; |
| } |
| |
| regmap = phy->regmap_common_cdb; |
| for (j = 0; j < num_cmn_regs ; j++) |
| regmap_write(regmap, cmn_vals[j].off, cmn_vals[j].val); |
| |
| for (i = 0; i < ins->num_lanes; i++) { |
| for (j = 0; j < num_ln_regs ; j++) { |
| regmap = phy->regmap_lane_cdb[i + ins->mlane]; |
| regmap_write(regmap, ln_vals[j].off, ln_vals[j].val); |
| } |
| } |
| |
| return 0; |
| } |
| |
| static int cdns_sierra_phy_on(struct phy *gphy) |
| { |
| struct cdns_sierra_inst *ins = phy_get_drvdata(gphy); |
| struct cdns_sierra_phy *sp = dev_get_priv(gphy->dev); |
| struct udevice *dev = gphy->dev; |
| u32 val; |
| int ret; |
| |
| ret = reset_control_deassert(sp->phy_rst); |
| if (ret) { |
| dev_err(dev, "Failed to take the PHY out of reset\n"); |
| return ret; |
| } |
| |
| /* Take the PHY lane group out of reset */ |
| ret = reset_deassert_bulk(ins->lnk_rst); |
| if (ret) { |
| dev_err(dev, "Failed to take the PHY lane out of reset\n"); |
| return ret; |
| } |
| |
| ret = regmap_field_read_poll_timeout(sp->pllctrl_lock[ins->mlane], |
| val, val, 1000, PLL_LOCK_TIME); |
| if (ret < 0) |
| dev_err(dev, "PLL lock of lane failed\n"); |
| |
| reset_control_assert(sp->phy_rst); |
| reset_control_deassert(sp->phy_rst); |
| |
| return ret; |
| } |
| |
| static int cdns_sierra_phy_off(struct phy *gphy) |
| { |
| struct cdns_sierra_inst *ins = phy_get_drvdata(gphy); |
| |
| return reset_assert_bulk(ins->lnk_rst); |
| } |
| |
| static int cdns_sierra_phy_reset(struct phy *gphy) |
| { |
| struct cdns_sierra_phy *sp = dev_get_priv(gphy->dev); |
| |
| reset_control_assert(sp->phy_rst); |
| reset_control_deassert(sp->phy_rst); |
| return 0; |
| }; |
| |
| static const struct phy_ops ops = { |
| .init = cdns_sierra_phy_init, |
| .power_on = cdns_sierra_phy_on, |
| .power_off = cdns_sierra_phy_off, |
| .reset = cdns_sierra_phy_reset, |
| }; |
| |
| static int cdns_sierra_get_optional(struct cdns_sierra_inst *inst, |
| ofnode child) |
| { |
| if (ofnode_read_u32(child, "reg", &inst->mlane)) |
| return -EINVAL; |
| |
| if (ofnode_read_u32(child, "cdns,num-lanes", &inst->num_lanes)) |
| return -EINVAL; |
| |
| if (ofnode_read_u32(child, "cdns,phy-type", &inst->phy_type)) |
| return -EINVAL; |
| |
| return 0; |
| } |
| |
| static struct regmap *cdns_regmap_init(struct udevice *dev, void __iomem *base, |
| u32 block_offset, u8 block_offset_shift, |
| u8 reg_offset_shift) |
| { |
| struct cdns_sierra_phy *sp = dev_get_priv(dev); |
| struct regmap_config config; |
| |
| config.r_start = (ulong)(base + (block_offset << block_offset_shift)); |
| config.r_size = sp->size - (block_offset << block_offset_shift); |
| config.reg_offset_shift = reg_offset_shift; |
| config.width = REGMAP_SIZE_16; |
| |
| return devm_regmap_init(dev, NULL, NULL, &config); |
| } |
| |
| static int cdns_regfield_init(struct cdns_sierra_phy *sp) |
| { |
| struct udevice *dev = sp->dev; |
| struct regmap_field *field; |
| struct regmap *regmap; |
| int i; |
| |
| regmap = sp->regmap_common_cdb; |
| field = devm_regmap_field_alloc(dev, regmap, macro_id_type); |
| if (IS_ERR(field)) { |
| dev_err(dev, "MACRO_ID_TYPE reg field init failed\n"); |
| return PTR_ERR(field); |
| } |
| sp->macro_id_type = field; |
| |
| regmap = sp->regmap_phy_config_ctrl; |
| field = devm_regmap_field_alloc(dev, regmap, phy_pll_cfg_1); |
| if (IS_ERR(field)) { |
| dev_err(dev, "PHY_PLL_CFG_1 reg field init failed\n"); |
| return PTR_ERR(field); |
| } |
| sp->phy_pll_cfg_1 = field; |
| |
| for (i = 0; i < SIERRA_MAX_LANES; i++) { |
| regmap = sp->regmap_lane_cdb[i]; |
| field = devm_regmap_field_alloc(dev, regmap, pllctrl_lock); |
| if (IS_ERR(field)) { |
| dev_err(dev, "P%d_ENABLE reg field init failed\n", i); |
| return PTR_ERR(field); |
| } |
| sp->pllctrl_lock[i] = field; |
| } |
| |
| return 0; |
| } |
| |
| static int cdns_regmap_init_blocks(struct cdns_sierra_phy *sp, |
| void __iomem *base, u8 block_offset_shift, |
| u8 reg_offset_shift) |
| { |
| struct udevice *dev = sp->dev; |
| struct regmap *regmap; |
| u32 block_offset; |
| int i; |
| |
| for (i = 0; i < SIERRA_MAX_LANES; i++) { |
| block_offset = SIERRA_LANE_CDB_OFFSET(i, reg_offset_shift); |
| regmap = cdns_regmap_init(dev, base, block_offset, |
| block_offset_shift, reg_offset_shift); |
| if (IS_ERR(regmap)) { |
| dev_err(dev, "Failed to init lane CDB regmap\n"); |
| return PTR_ERR(regmap); |
| } |
| sp->regmap_lane_cdb[i] = regmap; |
| } |
| |
| regmap = cdns_regmap_init(dev, base, SIERRA_COMMON_CDB_OFFSET, |
| block_offset_shift, reg_offset_shift); |
| if (IS_ERR(regmap)) { |
| dev_err(dev, "Failed to init common CDB regmap\n"); |
| return PTR_ERR(regmap); |
| } |
| sp->regmap_common_cdb = regmap; |
| |
| regmap = cdns_regmap_init(dev, base, SIERRA_PHY_CONFIG_CTRL_OFFSET, |
| block_offset_shift, reg_offset_shift); |
| if (IS_ERR(regmap)) { |
| dev_err(dev, "Failed to init PHY config and control regmap\n"); |
| return PTR_ERR(regmap); |
| } |
| sp->regmap_phy_config_ctrl = regmap; |
| |
| return 0; |
| } |
| |
| static int cdns_sierra_phy_probe(struct udevice *dev) |
| { |
| struct cdns_sierra_phy *sp = dev_get_priv(dev); |
| struct cdns_sierra_data *data; |
| unsigned int id_value; |
| int ret, node = 0; |
| struct clk *clk; |
| ofnode child; |
| |
| sp->dev = dev; |
| |
| sp->base = devfdt_remap_addr_index(dev, 0); |
| if (!sp->base) { |
| dev_err(dev, "unable to map regs\n"); |
| return -ENOMEM; |
| } |
| devfdt_get_addr_size_index(dev, 0, (fdt_size_t *)&sp->size); |
| |
| /* Get init data for this PHY */ |
| data = (struct cdns_sierra_data *)dev_get_driver_data(dev); |
| sp->init_data = data; |
| |
| ret = cdns_regmap_init_blocks(sp, sp->base, data->block_offset_shift, |
| data->reg_offset_shift); |
| if (ret) |
| return ret; |
| |
| ret = cdns_regfield_init(sp); |
| if (ret) |
| return ret; |
| |
| sp->clk = devm_clk_get_optional(dev, "phy_clk"); |
| if (IS_ERR(sp->clk)) { |
| dev_err(dev, "failed to get clock phy_clk\n"); |
| return PTR_ERR(sp->clk); |
| } |
| |
| sp->phy_rst = devm_reset_control_get(dev, "sierra_reset"); |
| if (IS_ERR(sp->phy_rst)) { |
| dev_err(dev, "failed to get reset\n"); |
| return PTR_ERR(sp->phy_rst); |
| } |
| |
| clk = devm_clk_get_optional(dev, "cmn_refclk_dig_div"); |
| if (IS_ERR(clk)) { |
| dev_err(dev, "cmn_refclk clock not found\n"); |
| ret = PTR_ERR(clk); |
| return ret; |
| } |
| sp->cmn_refclk = clk; |
| |
| clk = devm_clk_get_optional(dev, "cmn_refclk1_dig_div"); |
| if (IS_ERR(clk)) { |
| dev_err(dev, "cmn_refclk1 clock not found\n"); |
| ret = PTR_ERR(clk); |
| return ret; |
| } |
| sp->cmn_refclk1 = clk; |
| |
| ret = clk_prepare_enable(sp->clk); |
| if (ret) |
| return ret; |
| |
| /* Check that PHY is present */ |
| regmap_field_read(sp->macro_id_type, &id_value); |
| if (sp->init_data->id_value != id_value) { |
| dev_err(dev, "PHY not found 0x%x vs 0x%x\n", |
| sp->init_data->id_value, id_value); |
| ret = -EINVAL; |
| goto clk_disable; |
| } |
| |
| sp->autoconf = dev_read_bool(dev, "cdns,autoconf"); |
| |
| ofnode_for_each_subnode(child, dev_ofnode(dev)) { |
| if (!(ofnode_name_eq(child, "phy") || |
| ofnode_name_eq(child, "link"))) |
| continue; |
| |
| sp->phys[node].lnk_rst = devm_reset_bulk_get_by_node(dev, |
| child); |
| if (IS_ERR(sp->phys[node].lnk_rst)) { |
| ret = PTR_ERR(sp->phys[node].lnk_rst); |
| dev_err(dev, "failed to get reset %s\n", |
| ofnode_get_name(child)); |
| goto put_child2; |
| } |
| |
| if (!sp->autoconf) { |
| ret = cdns_sierra_get_optional(&sp->phys[node], child); |
| if (ret) { |
| dev_err(dev, "missing property in node %s\n", |
| ofnode_get_name(child)); |
| goto put_child; |
| } |
| } |
| sp->num_lanes += sp->phys[node].num_lanes; |
| |
| node++; |
| } |
| sp->nsubnodes = node; |
| |
| /* If more than one subnode, configure the PHY as multilink */ |
| if (!sp->autoconf && sp->nsubnodes > 1) |
| regmap_field_write(sp->phy_pll_cfg_1, 0x1); |
| |
| dev_info(dev, "sierra probed\n"); |
| return 0; |
| |
| put_child: |
| node++; |
| put_child2: |
| |
| clk_disable: |
| clk_disable_unprepare(sp->clk); |
| return ret; |
| } |
| |
| static int cdns_sierra_phy_remove(struct udevice *dev) |
| { |
| struct cdns_sierra_phy *phy = dev_get_priv(dev); |
| int i; |
| |
| reset_control_assert(phy->phy_rst); |
| |
| /* |
| * The device level resets will be put automatically. |
| * Need to put the subnode resets here though. |
| */ |
| for (i = 0; i < phy->nsubnodes; i++) |
| reset_assert_bulk(phy->phys[i].lnk_rst); |
| |
| return 0; |
| } |
| |
| /* refclk100MHz_32b_PCIe_cmn_pll_ext_ssc */ |
| static struct cdns_reg_pairs cdns_pcie_cmn_regs_ext_ssc[] = { |
| {0x2106, SIERRA_CMN_PLLLC_LF_COEFF_MODE1_PREG}, |
| {0x2106, SIERRA_CMN_PLLLC_LF_COEFF_MODE0_PREG}, |
| {0x8A06, SIERRA_CMN_PLLLC_BWCAL_MODE1_PREG}, |
| {0x8A06, SIERRA_CMN_PLLLC_BWCAL_MODE0_PREG}, |
| {0x1B1B, SIERRA_CMN_PLLLC_SS_TIME_STEPSIZE_MODE_PREG} |
| }; |
| |
| /* refclk100MHz_32b_PCIe_ln_ext_ssc */ |
| static struct cdns_reg_pairs cdns_pcie_ln_regs_ext_ssc[] = { |
| {0x813E, SIERRA_CLKPATHCTRL_TMR_PREG}, |
| {0x8047, SIERRA_RX_CREQ_FLTR_A_MODE3_PREG}, |
| {0x808F, SIERRA_RX_CREQ_FLTR_A_MODE2_PREG}, |
| {0x808F, SIERRA_RX_CREQ_FLTR_A_MODE1_PREG}, |
| {0x808F, SIERRA_RX_CREQ_FLTR_A_MODE0_PREG}, |
| {0x033C, SIERRA_RX_CTLE_MAINTENANCE_PREG}, |
| {0x44CC, SIERRA_CREQ_EQ_OPEN_EYE_THRESH_PREG} |
| }; |
| |
| /* refclk100MHz_20b_USB_cmn_pll_ext_ssc */ |
| static struct cdns_reg_pairs cdns_usb_cmn_regs_ext_ssc[] = { |
| {0x2085, SIERRA_CMN_PLLLC_LF_COEFF_MODE1_PREG}, |
| {0x2085, SIERRA_CMN_PLLLC_LF_COEFF_MODE0_PREG}, |
| {0x0000, SIERRA_CMN_PLLLC_BWCAL_MODE0_PREG}, |
| {0x0000, SIERRA_CMN_PLLLC_SS_TIME_STEPSIZE_MODE_PREG} |
| }; |
| |
| /* refclk100MHz_20b_USB_ln_ext_ssc */ |
| static struct cdns_reg_pairs cdns_usb_ln_regs_ext_ssc[] = { |
| {0xFE0A, SIERRA_DET_STANDEC_A_PREG}, |
| {0x000F, SIERRA_DET_STANDEC_B_PREG}, |
| {0x55A5, SIERRA_DET_STANDEC_C_PREG}, |
| {0x69ad, SIERRA_DET_STANDEC_D_PREG}, |
| {0x0241, SIERRA_DET_STANDEC_E_PREG}, |
| {0x0110, SIERRA_PSM_LANECAL_DLY_A1_RESETS_PREG}, |
| {0x0014, SIERRA_PSM_A0IN_TMR_PREG}, |
| {0xCF00, SIERRA_PSM_DIAG_PREG}, |
| {0x001F, SIERRA_PSC_TX_A0_PREG}, |
| {0x0007, SIERRA_PSC_TX_A1_PREG}, |
| {0x0003, SIERRA_PSC_TX_A2_PREG}, |
| {0x0003, SIERRA_PSC_TX_A3_PREG}, |
| {0x0FFF, SIERRA_PSC_RX_A0_PREG}, |
| {0x0003, SIERRA_PSC_RX_A1_PREG}, |
| {0x0003, SIERRA_PSC_RX_A2_PREG}, |
| {0x0001, SIERRA_PSC_RX_A3_PREG}, |
| {0x0001, SIERRA_PLLCTRL_SUBRATE_PREG}, |
| {0x0406, SIERRA_PLLCTRL_GEN_D_PREG}, |
| {0x5233, SIERRA_PLLCTRL_CPGAIN_MODE_PREG}, |
| {0x00CA, SIERRA_CLKPATH_BIASTRIM_PREG}, |
| {0x2512, SIERRA_DFE_BIASTRIM_PREG}, |
| {0x0000, SIERRA_DRVCTRL_ATTEN_PREG}, |
| {0x823E, SIERRA_CLKPATHCTRL_TMR_PREG}, |
| {0x078F, SIERRA_RX_CREQ_FLTR_A_MODE1_PREG}, |
| {0x078F, SIERRA_RX_CREQ_FLTR_A_MODE0_PREG}, |
| {0x7B3C, SIERRA_CREQ_CCLKDET_MODE01_PREG}, |
| {0x023C, SIERRA_RX_CTLE_MAINTENANCE_PREG}, |
| {0x3232, SIERRA_CREQ_FSMCLK_SEL_PREG}, |
| {0x0000, SIERRA_CREQ_EQ_CTRL_PREG}, |
| {0x0000, SIERRA_CREQ_SPARE_PREG}, |
| {0xCC44, SIERRA_CREQ_EQ_OPEN_EYE_THRESH_PREG}, |
| {0x8452, SIERRA_CTLELUT_CTRL_PREG}, |
| {0x4121, SIERRA_DFE_ECMP_RATESEL_PREG}, |
| {0x4121, SIERRA_DFE_SMP_RATESEL_PREG}, |
| {0x0003, SIERRA_DEQ_PHALIGN_CTRL}, |
| {0x3200, SIERRA_DEQ_CONCUR_CTRL1_PREG}, |
| {0x5064, SIERRA_DEQ_CONCUR_CTRL2_PREG}, |
| {0x0030, SIERRA_DEQ_EPIPWR_CTRL2_PREG}, |
| {0x0048, SIERRA_DEQ_FAST_MAINT_CYCLES_PREG}, |
| {0x5A5A, SIERRA_DEQ_ERRCMP_CTRL_PREG}, |
| {0x02F5, SIERRA_DEQ_OFFSET_CTRL_PREG}, |
| {0x02F5, SIERRA_DEQ_GAIN_CTRL_PREG}, |
| {0x9999, SIERRA_DEQ_VGATUNE_CTRL_PREG}, |
| {0x0014, SIERRA_DEQ_GLUT0}, |
| {0x0014, SIERRA_DEQ_GLUT1}, |
| {0x0014, SIERRA_DEQ_GLUT2}, |
| {0x0014, SIERRA_DEQ_GLUT3}, |
| {0x0014, SIERRA_DEQ_GLUT4}, |
| {0x0014, SIERRA_DEQ_GLUT5}, |
| {0x0014, SIERRA_DEQ_GLUT6}, |
| {0x0014, SIERRA_DEQ_GLUT7}, |
| {0x0014, SIERRA_DEQ_GLUT8}, |
| {0x0014, SIERRA_DEQ_GLUT9}, |
| {0x0014, SIERRA_DEQ_GLUT10}, |
| {0x0014, SIERRA_DEQ_GLUT11}, |
| {0x0014, SIERRA_DEQ_GLUT12}, |
| {0x0014, SIERRA_DEQ_GLUT13}, |
| {0x0014, SIERRA_DEQ_GLUT14}, |
| {0x0014, SIERRA_DEQ_GLUT15}, |
| {0x0014, SIERRA_DEQ_GLUT16}, |
| {0x0BAE, SIERRA_DEQ_ALUT0}, |
| {0x0AEB, SIERRA_DEQ_ALUT1}, |
| {0x0A28, SIERRA_DEQ_ALUT2}, |
| {0x0965, SIERRA_DEQ_ALUT3}, |
| {0x08A2, SIERRA_DEQ_ALUT4}, |
| {0x07DF, SIERRA_DEQ_ALUT5}, |
| {0x071C, SIERRA_DEQ_ALUT6}, |
| {0x0659, SIERRA_DEQ_ALUT7}, |
| {0x0596, SIERRA_DEQ_ALUT8}, |
| {0x0514, SIERRA_DEQ_ALUT9}, |
| {0x0492, SIERRA_DEQ_ALUT10}, |
| {0x0410, SIERRA_DEQ_ALUT11}, |
| {0x038E, SIERRA_DEQ_ALUT12}, |
| {0x030C, SIERRA_DEQ_ALUT13}, |
| {0x03F4, SIERRA_DEQ_DFETAP_CTRL_PREG}, |
| {0x0001, SIERRA_DFE_EN_1010_IGNORE_PREG}, |
| {0x3C01, SIERRA_DEQ_TAU_CTRL1_FAST_MAINT_PREG}, |
| {0x3C40, SIERRA_DEQ_TAU_CTRL1_SLOW_MAINT_PREG}, |
| {0x1C08, SIERRA_DEQ_TAU_CTRL2_PREG}, |
| {0x0033, SIERRA_DEQ_PICTRL_PREG}, |
| {0x0400, SIERRA_CPICAL_TMRVAL_MODE1_PREG}, |
| {0x0330, SIERRA_CPICAL_TMRVAL_MODE0_PREG}, |
| {0x01FF, SIERRA_CPICAL_PICNT_MODE1_PREG}, |
| {0x0009, SIERRA_CPI_OUTBUF_RATESEL_PREG}, |
| {0x3232, SIERRA_CPICAL_RES_STARTCODE_MODE23_PREG}, |
| {0x0005, SIERRA_LFPSDET_SUPPORT_PREG}, |
| {0x000F, SIERRA_LFPSFILT_NS_PREG}, |
| {0x0009, SIERRA_LFPSFILT_RD_PREG}, |
| {0x0001, SIERRA_LFPSFILT_MP_PREG}, |
| {0x6013, SIERRA_SIGDET_SUPPORT_PREG}, |
| {0x8013, SIERRA_SDFILT_H2L_A_PREG}, |
| {0x8009, SIERRA_SDFILT_L2H_PREG}, |
| {0x0024, SIERRA_RXBUFFER_CTLECTRL_PREG}, |
| {0x0020, SIERRA_RXBUFFER_RCDFECTRL_PREG}, |
| {0x4243, SIERRA_RXBUFFER_DFECTRL_PREG} |
| }; |
| |
| static const struct cdns_sierra_data cdns_map_sierra = { |
| SIERRA_MACRO_ID, |
| 0x2, |
| 0x2, |
| ARRAY_SIZE(cdns_pcie_cmn_regs_ext_ssc), |
| ARRAY_SIZE(cdns_pcie_ln_regs_ext_ssc), |
| ARRAY_SIZE(cdns_usb_cmn_regs_ext_ssc), |
| ARRAY_SIZE(cdns_usb_ln_regs_ext_ssc), |
| cdns_pcie_cmn_regs_ext_ssc, |
| cdns_pcie_ln_regs_ext_ssc, |
| cdns_usb_cmn_regs_ext_ssc, |
| cdns_usb_ln_regs_ext_ssc, |
| }; |
| |
| static const struct cdns_sierra_data cdns_ti_map_sierra = { |
| SIERRA_MACRO_ID, |
| 0x0, |
| 0x1, |
| ARRAY_SIZE(cdns_pcie_cmn_regs_ext_ssc), |
| ARRAY_SIZE(cdns_pcie_ln_regs_ext_ssc), |
| ARRAY_SIZE(cdns_usb_cmn_regs_ext_ssc), |
| ARRAY_SIZE(cdns_usb_ln_regs_ext_ssc), |
| cdns_pcie_cmn_regs_ext_ssc, |
| cdns_pcie_ln_regs_ext_ssc, |
| cdns_usb_cmn_regs_ext_ssc, |
| cdns_usb_ln_regs_ext_ssc, |
| }; |
| |
| static const struct udevice_id cdns_sierra_id_table[] = { |
| { |
| .compatible = "cdns,sierra-phy-t0", |
| .data = (ulong)&cdns_map_sierra, |
| }, |
| { |
| .compatible = "ti,sierra-phy-t0", |
| .data = (ulong)&cdns_ti_map_sierra, |
| }, |
| {} |
| }; |
| |
| U_BOOT_DRIVER(sierra_phy_provider) = { |
| .name = "cdns,sierra", |
| .id = UCLASS_PHY, |
| .of_match = cdns_sierra_id_table, |
| .probe = cdns_sierra_phy_probe, |
| .remove = cdns_sierra_phy_remove, |
| .ops = &ops, |
| .priv_auto = sizeof(struct cdns_sierra_phy), |
| }; |