Lines Matching +full:cp110 +full:- +full:utmi +full:- +full:phy
1 // SPDX-License-Identifier: GPL-2.0
11 * Structure inspired from phy-mvebu-cp110-comphy.c written by Antoine Tenart.
22 #include <linux/phy.h>
23 #include <linux/phy/phy.h>
35 /* SATA and USB3 PHY offset compared to SATA PHY */
39 * When accessing common PHY lane registers directly, we need to shift by 1,
40 * since the registers are 16-bit.
174 * This register is not from PHY lane register space. It only exists in the
175 * indirect register space, before the actual PHY lane 2 registers. So the
177 * It is used only for SATA PHY initialization.
182 /* South Bridge PHY Configuration Registers */
183 #define COMPHY_PHY_REG(lane, reg) (((1 - (lane)) * 0x28) + ((reg) & 0x3f))
186 * lane0: USB3/GbE1 PHY Configuration 1
187 * lane1: PCIe/GbE0 PHY Configuration 1
207 * lane0: USB3/GbE1 PHY Status 1
208 * lane1: PCIe/GbE0 PHY Status 1
216 /* PHY Selector */
265 spinlock_t lock; /* for PHY selector access */
300 /*-----------------------------------------------------------*/
386 /* Used for accessing lane 2 registers (SATA/USB3 PHY) */
391 priv->lane2_phy_indirect + COMPHY_LANE2_INDIR_ADDR); in comphy_set_indirect()
392 comphy_reg_set(priv->lane2_phy_indirect + COMPHY_LANE2_INDIR_DATA, in comphy_set_indirect()
399 if (lane->id == 2) { in comphy_lane_reg_set()
400 /* lane 2 PHY registers are accessed indirectly */ in comphy_lane_reg_set()
401 comphy_set_indirect(lane->priv, in comphy_lane_reg_set()
405 void __iomem *base = lane->id == 1 ? in comphy_lane_reg_set()
406 lane->priv->lane1_phy_regs : in comphy_lane_reg_set()
407 lane->priv->lane0_phy_regs; in comphy_lane_reg_set()
420 if (lane->id == 2) { in comphy_lane_reg_poll()
423 /* lane 2 PHY registers are accessed indirectly */ in comphy_lane_reg_poll()
425 lane->priv->lane2_phy_indirect + in comphy_lane_reg_poll()
428 ret = readl_poll_timeout(lane->priv->lane2_phy_indirect + in comphy_lane_reg_poll()
433 void __iomem *base = lane->id == 1 ? in comphy_lane_reg_poll()
434 lane->priv->lane1_phy_regs : in comphy_lane_reg_poll()
435 lane->priv->lane0_phy_regs; in comphy_lane_reg_poll()
449 comphy_reg_set(lane->priv->comphy_regs + COMPHY_PHY_REG(lane->id, reg), in comphy_periph_reg_set()
459 return readl_poll_timeout(lane->priv->comphy_regs + in comphy_periph_reg_poll()
460 COMPHY_PHY_REG(lane->id, reg), in comphy_periph_reg_poll()
465 /* PHY selector configures with corresponding modes */
472 switch (lane->mode) { in mvebu_a3700_comphy_set_phy_selector()
475 if (lane->id == 2) in mvebu_a3700_comphy_set_phy_selector()
482 if (lane->id == 0) in mvebu_a3700_comphy_set_phy_selector()
484 else if (lane->id == 1) in mvebu_a3700_comphy_set_phy_selector()
491 if (lane->id == 2) in mvebu_a3700_comphy_set_phy_selector()
493 else if (lane->id == 0) in mvebu_a3700_comphy_set_phy_selector()
501 if (lane->id == 1) in mvebu_a3700_comphy_set_phy_selector()
511 spin_lock_irqsave(&lane->priv->lock, flags); in mvebu_a3700_comphy_set_phy_selector()
513 old = readl(lane->priv->comphy_regs + COMPHY_SELECTOR_PHY_REG); in mvebu_a3700_comphy_set_phy_selector()
515 writel(new, lane->priv->comphy_regs + COMPHY_SELECTOR_PHY_REG); in mvebu_a3700_comphy_set_phy_selector()
517 spin_unlock_irqrestore(&lane->priv->lock, flags); in mvebu_a3700_comphy_set_phy_selector()
519 dev_dbg(lane->dev, in mvebu_a3700_comphy_set_phy_selector()
520 "COMPHY[%d] mode[%d] changed PHY selector 0x%08x -> 0x%08x\n", in mvebu_a3700_comphy_set_phy_selector()
521 lane->id, lane->mode, old, new); in mvebu_a3700_comphy_set_phy_selector()
525 dev_err(lane->dev, "COMPHY[%d] mode[%d] is invalid\n", lane->id, in mvebu_a3700_comphy_set_phy_selector()
526 lane->mode); in mvebu_a3700_comphy_set_phy_selector()
527 return -EINVAL; in mvebu_a3700_comphy_set_phy_selector()
536 /* Configure phy selector for SATA */ in mvebu_a3700_comphy_sata_power_on()
541 /* Clear phy isolation mode to make it work in normal mode */ in mvebu_a3700_comphy_sata_power_on()
547 if (lane->invert_tx) in mvebu_a3700_comphy_sata_power_on()
549 if (lane->invert_rx) in mvebu_a3700_comphy_sata_power_on()
554 /* 1. Select 40-bit data width */ in mvebu_a3700_comphy_sata_power_on()
558 /* 2. Select reference clock(25M) and PHY mode (SATA) */ in mvebu_a3700_comphy_sata_power_on()
559 if (lane->priv->xtal_is_40m) in mvebu_a3700_comphy_sata_power_on()
573 comphy_set_indirect(lane->priv, COMPHY_RESERVED_REG, in mvebu_a3700_comphy_sata_power_on()
576 /* 5. Set vendor-specific configuration (It is done in sata driver) */ in mvebu_a3700_comphy_sata_power_on()
577 /* XXX: in U-Boot below sequence was executed in this place, in Linux in mvebu_a3700_comphy_sata_power_on()
578 * not. Now it is done only in U-Boot before this comphy in mvebu_a3700_comphy_sata_power_on()
579 * initialization - tests shows that it works ok, but in case of any in mvebu_a3700_comphy_sata_power_on()
593 dev_err(lane->dev, "Failed to lock SATA PLL\n"); in mvebu_a3700_comphy_sata_power_on()
607 * All PHY register values are defined in full for 3.125Gbps in comphy_gbe_phy_init()
638 * 1. Reset PHY by setting PHY input port PIN_RESET=1. in mvebu_a3700_comphy_ethernet_power_on()
639 * 2. Set PHY input port PIN_TX_IDLE=1, PIN_PU_IVREF=1 to keep in mvebu_a3700_comphy_ethernet_power_on()
640 * PHY TXP/TXN output to idle state during PHY initialization in mvebu_a3700_comphy_ethernet_power_on()
641 * 3. Set PHY input port PIN_PU_PLL=0, PIN_PU_RX=0, PIN_PU_TX=0. in mvebu_a3700_comphy_ethernet_power_on()
648 /* 4. Release reset to the PHY by setting PIN_RESET=0. */ in mvebu_a3700_comphy_ethernet_power_on()
657 switch (lane->submode) { in mvebu_a3700_comphy_ethernet_power_on()
664 /* 2500Base-X, SerDes speed 3.125G */ in mvebu_a3700_comphy_ethernet_power_on()
669 dev_err(lane->dev, in mvebu_a3700_comphy_ethernet_power_on()
670 "unsupported phy speed %d on comphy lane%d\n", in mvebu_a3700_comphy_ethernet_power_on()
671 lane->submode, lane->id); in mvebu_a3700_comphy_ethernet_power_on()
672 return -EINVAL; in mvebu_a3700_comphy_ethernet_power_on()
701 if (lane->priv->xtal_is_40m) in mvebu_a3700_comphy_ethernet_power_on()
730 * default value after reset of the PHY. in mvebu_a3700_comphy_ethernet_power_on()
737 * the related GEN table during real chip bring-up. We only required to in mvebu_a3700_comphy_ethernet_power_on()
740 * 25 MHz the default values stored in PHY registers are OK. in mvebu_a3700_comphy_ethernet_power_on()
742 dev_dbg(lane->dev, "Running C-DPI phy init %s mode\n", in mvebu_a3700_comphy_ethernet_power_on()
743 lane->submode == PHY_INTERFACE_MODE_2500BASEX ? "2G5" : "1G"); in mvebu_a3700_comphy_ethernet_power_on()
744 if (lane->priv->xtal_is_40m) in mvebu_a3700_comphy_ethernet_power_on()
746 lane->submode != PHY_INTERFACE_MODE_2500BASEX); in mvebu_a3700_comphy_ethernet_power_on()
749 * 14. Check the PHY Polarity invert bit in mvebu_a3700_comphy_ethernet_power_on()
752 if (lane->invert_tx) in mvebu_a3700_comphy_ethernet_power_on()
754 if (lane->invert_rx) in mvebu_a3700_comphy_ethernet_power_on()
760 * 15. Set PHY input ports PIN_PU_PLL, PIN_PU_TX and PIN_PU_RX to 1 to in mvebu_a3700_comphy_ethernet_power_on()
761 * start PHY power up sequence. All the PHY register programming should in mvebu_a3700_comphy_ethernet_power_on()
763 * for normal PHY operation from this point. in mvebu_a3700_comphy_ethernet_power_on()
770 * 16. Wait for PHY power up sequence to finish by checking output ports in mvebu_a3700_comphy_ethernet_power_on()
778 dev_err(lane->dev, "Failed to lock PLL for SERDES PHY %d\n", in mvebu_a3700_comphy_ethernet_power_on()
779 lane->id); in mvebu_a3700_comphy_ethernet_power_on()
791 * PHY After RX initialization is done, PIN_RX_INIT_DONE will be set to in mvebu_a3700_comphy_ethernet_power_on()
803 dev_err(lane->dev, "Failed to lock PLL for SERDES PHY %d\n", in mvebu_a3700_comphy_ethernet_power_on()
804 lane->id); in mvebu_a3700_comphy_ethernet_power_on()
812 dev_err(lane->dev, "Failed to init RX of SERDES PHY %d\n", in mvebu_a3700_comphy_ethernet_power_on()
813 lane->id); in mvebu_a3700_comphy_ethernet_power_on()
824 /* Set phy seclector */ in mvebu_a3700_comphy_usb3_power_on()
830 * 0. Set PHY OTG Control(0x5d034), bit 4, Power up OTG module The in mvebu_a3700_comphy_usb3_power_on()
831 * register belong to UTMI module, so it is set in UTMI phy driver. in mvebu_a3700_comphy_usb3_power_on()
835 * 1. Set PRD_TXDEEMPH (3.5db de-emph) in mvebu_a3700_comphy_usb3_power_on()
846 * Unset BIT15: set to 0 to set USB3 De-emphasize level to -3.5db in mvebu_a3700_comphy_usb3_power_on()
868 * 5. Set Lane-to-Lane Bundle Clock Sampling Period = per PCLK cycles in mvebu_a3700_comphy_usb3_power_on()
895 if (lane->priv->xtal_is_40m) { in mvebu_a3700_comphy_usb3_power_on()
927 * 11. Set 20-bit data width in mvebu_a3700_comphy_usb3_power_on()
943 if (lane->invert_tx) in mvebu_a3700_comphy_usb3_power_on()
945 if (lane->invert_rx) in mvebu_a3700_comphy_usb3_power_on()
975 dev_err(lane->dev, "Failed to lock USB3 PLL\n"); in mvebu_a3700_comphy_usb3_power_on()
986 /* Configure phy selector for PCIe */ in mvebu_a3700_comphy_pcie_power_on()
1020 * PCI-E driver in mvebu_a3700_comphy_pcie_power_on()
1028 if (lane->priv->xtal_is_40m) in mvebu_a3700_comphy_pcie_power_on()
1045 if (lane->invert_tx) in mvebu_a3700_comphy_pcie_power_on()
1047 if (lane->invert_rx) in mvebu_a3700_comphy_pcie_power_on()
1063 dev_err(lane->dev, "Failed to lock PCIE PLL\n"); in mvebu_a3700_comphy_pcie_power_on()
1071 /* Set phy isolation mode */ in mvebu_a3700_comphy_sata_power_off()
1102 * The USB3 MAC sets the USB3 PHY to low state, so we do not in mvebu_a3700_comphy_usb3_power_off()
1103 * need to power off USB3 PHY again. in mvebu_a3700_comphy_usb3_power_off()
1113 /* Unused PHY mux value is 0x0 */ in mvebu_a3700_comphy_check_mode()
1130 static int mvebu_a3700_comphy_set_mode(struct phy *phy, enum phy_mode mode, in mvebu_a3700_comphy_set_mode() argument
1133 struct mvebu_a3700_comphy_lane *lane = phy_get_drvdata(phy); in mvebu_a3700_comphy_set_mode()
1135 if (!mvebu_a3700_comphy_check_mode(lane->id, mode, submode)) { in mvebu_a3700_comphy_set_mode()
1136 dev_err(lane->dev, "invalid COMPHY mode\n"); in mvebu_a3700_comphy_set_mode()
1137 return -EINVAL; in mvebu_a3700_comphy_set_mode()
1140 /* Mode cannot be changed while the PHY is powered on */ in mvebu_a3700_comphy_set_mode()
1141 if (phy->power_count && in mvebu_a3700_comphy_set_mode()
1142 (lane->mode != mode || lane->submode != submode)) in mvebu_a3700_comphy_set_mode()
1143 return -EBUSY; in mvebu_a3700_comphy_set_mode()
1145 /* Just remember the mode, ->power_on() will do the real setup */ in mvebu_a3700_comphy_set_mode()
1146 lane->mode = mode; in mvebu_a3700_comphy_set_mode()
1147 lane->submode = submode; in mvebu_a3700_comphy_set_mode()
1152 static int mvebu_a3700_comphy_power_on(struct phy *phy) in mvebu_a3700_comphy_power_on() argument
1154 struct mvebu_a3700_comphy_lane *lane = phy_get_drvdata(phy); in mvebu_a3700_comphy_power_on()
1156 if (!mvebu_a3700_comphy_check_mode(lane->id, lane->mode, in mvebu_a3700_comphy_power_on()
1157 lane->submode)) { in mvebu_a3700_comphy_power_on()
1158 dev_err(lane->dev, "invalid COMPHY mode\n"); in mvebu_a3700_comphy_power_on()
1159 return -EINVAL; in mvebu_a3700_comphy_power_on()
1162 switch (lane->mode) { in mvebu_a3700_comphy_power_on()
1164 dev_dbg(lane->dev, "set lane %d to USB3 host mode\n", lane->id); in mvebu_a3700_comphy_power_on()
1167 dev_dbg(lane->dev, "set lane %d to SATA mode\n", lane->id); in mvebu_a3700_comphy_power_on()
1170 dev_dbg(lane->dev, "set lane %d to Ethernet mode\n", lane->id); in mvebu_a3700_comphy_power_on()
1173 dev_dbg(lane->dev, "set lane %d to PCIe mode\n", lane->id); in mvebu_a3700_comphy_power_on()
1176 dev_err(lane->dev, "unsupported PHY mode (%d)\n", lane->mode); in mvebu_a3700_comphy_power_on()
1177 return -EOPNOTSUPP; in mvebu_a3700_comphy_power_on()
1181 static int mvebu_a3700_comphy_power_off(struct phy *phy) in mvebu_a3700_comphy_power_off() argument
1183 struct mvebu_a3700_comphy_lane *lane = phy_get_drvdata(phy); in mvebu_a3700_comphy_power_off()
1185 switch (lane->id) { in mvebu_a3700_comphy_power_off()
1199 dev_err(lane->dev, "invalid COMPHY mode\n"); in mvebu_a3700_comphy_power_off()
1200 return -EINVAL; in mvebu_a3700_comphy_power_off()
1211 static struct phy *mvebu_a3700_comphy_xlate(struct device *dev, in mvebu_a3700_comphy_xlate()
1216 struct phy *phy; in mvebu_a3700_comphy_xlate() local
1218 phy = of_phy_simple_xlate(dev, args); in mvebu_a3700_comphy_xlate()
1219 if (IS_ERR(phy)) in mvebu_a3700_comphy_xlate()
1220 return phy; in mvebu_a3700_comphy_xlate()
1222 lane = phy_get_drvdata(phy); in mvebu_a3700_comphy_xlate()
1224 port = args->args[0]; in mvebu_a3700_comphy_xlate()
1225 if (port != 0 && (port != 1 || lane->id != 0)) { in mvebu_a3700_comphy_xlate()
1226 dev_err(lane->dev, "invalid port number %u\n", port); in mvebu_a3700_comphy_xlate()
1227 return ERR_PTR(-EINVAL); in mvebu_a3700_comphy_xlate()
1230 lane->invert_tx = args->args[1] & BIT(0); in mvebu_a3700_comphy_xlate()
1231 lane->invert_rx = args->args[1] & BIT(1); in mvebu_a3700_comphy_xlate()
1233 return phy; in mvebu_a3700_comphy_xlate()
1245 priv = devm_kzalloc(&pdev->dev, sizeof(*priv), GFP_KERNEL); in mvebu_a3700_comphy_probe()
1247 return -ENOMEM; in mvebu_a3700_comphy_probe()
1249 spin_lock_init(&priv->lock); in mvebu_a3700_comphy_probe()
1252 priv->comphy_regs = devm_ioremap_resource(&pdev->dev, res); in mvebu_a3700_comphy_probe()
1253 if (IS_ERR(priv->comphy_regs)) in mvebu_a3700_comphy_probe()
1254 return PTR_ERR(priv->comphy_regs); in mvebu_a3700_comphy_probe()
1258 priv->lane1_phy_regs = devm_ioremap_resource(&pdev->dev, res); in mvebu_a3700_comphy_probe()
1259 if (IS_ERR(priv->lane1_phy_regs)) in mvebu_a3700_comphy_probe()
1260 return PTR_ERR(priv->lane1_phy_regs); in mvebu_a3700_comphy_probe()
1264 priv->lane0_phy_regs = devm_ioremap_resource(&pdev->dev, res); in mvebu_a3700_comphy_probe()
1265 if (IS_ERR(priv->lane0_phy_regs)) in mvebu_a3700_comphy_probe()
1266 return PTR_ERR(priv->lane0_phy_regs); in mvebu_a3700_comphy_probe()
1270 priv->lane2_phy_indirect = devm_ioremap_resource(&pdev->dev, res); in mvebu_a3700_comphy_probe()
1271 if (IS_ERR(priv->lane2_phy_indirect)) in mvebu_a3700_comphy_probe()
1272 return PTR_ERR(priv->lane2_phy_indirect); in mvebu_a3700_comphy_probe()
1279 clk = clk_get(&pdev->dev, "xtal"); in mvebu_a3700_comphy_probe()
1281 if (PTR_ERR(clk) == -EPROBE_DEFER) in mvebu_a3700_comphy_probe()
1282 return -EPROBE_DEFER; in mvebu_a3700_comphy_probe()
1283 dev_warn(&pdev->dev, "missing 'xtal' clk (%ld)\n", in mvebu_a3700_comphy_probe()
1288 dev_warn(&pdev->dev, "enabling xtal clk failed (%d)\n", in mvebu_a3700_comphy_probe()
1292 priv->xtal_is_40m = true; in mvebu_a3700_comphy_probe()
1298 dev_set_drvdata(&pdev->dev, priv); in mvebu_a3700_comphy_probe()
1300 for_each_available_child_of_node(pdev->dev.of_node, child) { in mvebu_a3700_comphy_probe()
1302 struct phy *phy; in mvebu_a3700_comphy_probe() local
1308 dev_err(&pdev->dev, "missing 'reg' property (%d)\n", in mvebu_a3700_comphy_probe()
1314 dev_err(&pdev->dev, "invalid 'reg' property\n"); in mvebu_a3700_comphy_probe()
1318 lane = devm_kzalloc(&pdev->dev, sizeof(*lane), GFP_KERNEL); in mvebu_a3700_comphy_probe()
1321 return -ENOMEM; in mvebu_a3700_comphy_probe()
1324 phy = devm_phy_create(&pdev->dev, child, in mvebu_a3700_comphy_probe()
1326 if (IS_ERR(phy)) { in mvebu_a3700_comphy_probe()
1328 return PTR_ERR(phy); in mvebu_a3700_comphy_probe()
1331 lane->priv = priv; in mvebu_a3700_comphy_probe()
1332 lane->dev = &pdev->dev; in mvebu_a3700_comphy_probe()
1333 lane->mode = PHY_MODE_INVALID; in mvebu_a3700_comphy_probe()
1334 lane->submode = PHY_INTERFACE_MODE_NA; in mvebu_a3700_comphy_probe()
1335 lane->id = lane_id; in mvebu_a3700_comphy_probe()
1336 lane->invert_tx = false; in mvebu_a3700_comphy_probe()
1337 lane->invert_rx = false; in mvebu_a3700_comphy_probe()
1338 phy_set_drvdata(phy, lane); in mvebu_a3700_comphy_probe()
1344 mvebu_a3700_comphy_power_off(phy); in mvebu_a3700_comphy_probe()
1347 provider = devm_of_phy_provider_register(&pdev->dev, in mvebu_a3700_comphy_probe()
1354 { .compatible = "marvell,comphy-a3700" },
1362 .name = "mvebu-a3700-comphy",
1371 MODULE_DESCRIPTION("Common PHY driver for A3700");