1 // SPDX-License-Identifier: GPL-2.0-only
3 * Broadcom Northstar USB 3.0 PHY Driver
5 * Copyright (C) 2016 Rafał Miłecki <rafal@milecki.pl>
6 * Copyright (C) 2016 Broadcom
8 * All magic values used for initialization (and related comments) were obtained
10 * Copyright (c) Broadcom Corp, 2012
13 #include <linux/bcma/bcma.h>
14 #include <linux/delay.h>
15 #include <linux/err.h>
16 #include <linux/iopoll.h>
17 #include <linux/mdio.h>
18 #include <linux/module.h>
19 #include <linux/of_address.h>
20 #include <linux/of_platform.h>
21 #include <linux/platform_device.h>
22 #include <linux/phy/phy.h>
23 #include <linux/slab.h>
25 #define BCM_NS_USB3_MII_MNG_TIMEOUT_US 1000 /* usecs */
27 #define BCM_NS_USB3_PHY_BASE_ADDR_REG 0x1f
28 #define BCM_NS_USB3_PHY_PLL30_BLOCK 0x8000
29 #define BCM_NS_USB3_PHY_TX_PMD_BLOCK 0x8040
30 #define BCM_NS_USB3_PHY_PIPE_BLOCK 0x8060
32 /* Registers of PLL30 block */
33 #define BCM_NS_USB3_PLL_CONTROL 0x01
34 #define BCM_NS_USB3_PLLA_CONTROL0 0x0a
35 #define BCM_NS_USB3_PLLA_CONTROL1 0x0b
37 /* Registers of TX PMD block */
38 #define BCM_NS_USB3_TX_PMD_CONTROL1 0x01
40 /* Registers of PIPE block */
41 #define BCM_NS_USB3_LFPS_CMP 0x02
42 #define BCM_NS_USB3_LFPS_DEGLITCH 0x03
52 enum bcm_ns_family family;
54 void __iomem *ccb_mii;
55 struct mdio_device *mdiodev;
58 int (*phy_write)(struct bcm_ns_usb3 *usb3, u16 reg, u16 value);
61 static const struct of_device_id bcm_ns_usb3_id_table[] = {
63 .compatible = "brcm,ns-ax-usb3-phy",
64 .data = (int *)BCM_NS_AX,
67 .compatible = "brcm,ns-bx-usb3-phy",
68 .data = (int *)BCM_NS_BX,
72 MODULE_DEVICE_TABLE(of, bcm_ns_usb3_id_table);
74 static int bcm_ns_usb3_mdio_phy_write(struct bcm_ns_usb3 *usb3, u16 reg,
77 return usb3->phy_write(usb3, reg, value);
80 static int bcm_ns_usb3_phy_init_ns_bx(struct bcm_ns_usb3 *usb3)
85 err = bcm_ns_usb3_mdio_phy_write(usb3, BCM_NS_USB3_PHY_BASE_ADDR_REG,
86 BCM_NS_USB3_PHY_PLL30_BLOCK);
90 /* Assert Ana_Pllseq start */
91 bcm_ns_usb3_mdio_phy_write(usb3, BCM_NS_USB3_PLL_CONTROL, 0x1000);
93 /* Assert CML Divider ratio to 26 */
94 bcm_ns_usb3_mdio_phy_write(usb3, BCM_NS_USB3_PLLA_CONTROL0, 0x6400);
96 /* Asserting PLL Reset */
97 bcm_ns_usb3_mdio_phy_write(usb3, BCM_NS_USB3_PLLA_CONTROL1, 0xc000);
99 /* Deaaserting PLL Reset */
100 bcm_ns_usb3_mdio_phy_write(usb3, BCM_NS_USB3_PLLA_CONTROL1, 0x8000);
102 /* Deasserting USB3 system reset */
103 writel(0, usb3->dmp + BCMA_RESET_CTL);
105 /* PLL frequency monitor enable */
106 bcm_ns_usb3_mdio_phy_write(usb3, BCM_NS_USB3_PLL_CONTROL, 0x9000);
109 bcm_ns_usb3_mdio_phy_write(usb3, BCM_NS_USB3_PHY_BASE_ADDR_REG,
110 BCM_NS_USB3_PHY_PIPE_BLOCK);
112 /* CMPMAX & CMPMINTH setting */
113 bcm_ns_usb3_mdio_phy_write(usb3, BCM_NS_USB3_LFPS_CMP, 0xf30d);
115 /* DEGLITCH MIN & MAX setting */
116 bcm_ns_usb3_mdio_phy_write(usb3, BCM_NS_USB3_LFPS_DEGLITCH, 0x6302);
119 bcm_ns_usb3_mdio_phy_write(usb3, BCM_NS_USB3_PHY_BASE_ADDR_REG,
120 BCM_NS_USB3_PHY_TX_PMD_BLOCK);
123 bcm_ns_usb3_mdio_phy_write(usb3, BCM_NS_USB3_TX_PMD_CONTROL1, 0x1003);
128 static int bcm_ns_usb3_phy_init_ns_ax(struct bcm_ns_usb3 *usb3)
133 err = bcm_ns_usb3_mdio_phy_write(usb3, BCM_NS_USB3_PHY_BASE_ADDR_REG,
134 BCM_NS_USB3_PHY_PLL30_BLOCK);
138 bcm_ns_usb3_mdio_phy_write(usb3, BCM_NS_USB3_PLLA_CONTROL0, 0x6400);
140 bcm_ns_usb3_mdio_phy_write(usb3, BCM_NS_USB3_PHY_BASE_ADDR_REG, 0x80e0);
142 bcm_ns_usb3_mdio_phy_write(usb3, 0x02, 0x009c);
145 bcm_ns_usb3_mdio_phy_write(usb3, BCM_NS_USB3_PHY_BASE_ADDR_REG,
146 BCM_NS_USB3_PHY_TX_PMD_BLOCK);
148 bcm_ns_usb3_mdio_phy_write(usb3, 0x02, 0x21d3);
150 bcm_ns_usb3_mdio_phy_write(usb3, BCM_NS_USB3_TX_PMD_CONTROL1, 0x1003);
152 /* Deasserting USB3 system reset */
153 writel(0, usb3->dmp + BCMA_RESET_CTL);
158 static int bcm_ns_usb3_phy_init(struct phy *phy)
160 struct bcm_ns_usb3 *usb3 = phy_get_drvdata(phy);
163 /* Perform USB3 system soft reset */
164 writel(BCMA_RESET_CTL_RESET, usb3->dmp + BCMA_RESET_CTL);
166 switch (usb3->family) {
168 err = bcm_ns_usb3_phy_init_ns_ax(usb3);
171 err = bcm_ns_usb3_phy_init_ns_bx(usb3);
181 static const struct phy_ops ops = {
182 .init = bcm_ns_usb3_phy_init,
183 .owner = THIS_MODULE,
186 /**************************************************
188 **************************************************/
190 static int bcm_ns_usb3_mdiodev_phy_write(struct bcm_ns_usb3 *usb3, u16 reg,
193 struct mdio_device *mdiodev = usb3->mdiodev;
195 return mdiobus_write(mdiodev->bus, mdiodev->addr, reg, value);
198 static int bcm_ns_usb3_mdio_probe(struct mdio_device *mdiodev)
200 struct device *dev = &mdiodev->dev;
201 const struct of_device_id *of_id;
202 struct phy_provider *phy_provider;
203 struct device_node *syscon_np;
204 struct bcm_ns_usb3 *usb3;
208 usb3 = devm_kzalloc(dev, sizeof(*usb3), GFP_KERNEL);
213 usb3->mdiodev = mdiodev;
215 of_id = of_match_device(bcm_ns_usb3_id_table, dev);
218 usb3->family = (enum bcm_ns_family)of_id->data;
220 syscon_np = of_parse_phandle(dev->of_node, "usb3-dmp-syscon", 0);
221 err = of_address_to_resource(syscon_np, 0, &res);
222 of_node_put(syscon_np);
226 usb3->dmp = devm_ioremap_resource(dev, &res);
227 if (IS_ERR(usb3->dmp)) {
228 dev_err(dev, "Failed to map DMP regs\n");
229 return PTR_ERR(usb3->dmp);
232 usb3->phy_write = bcm_ns_usb3_mdiodev_phy_write;
234 usb3->phy = devm_phy_create(dev, NULL, &ops);
235 if (IS_ERR(usb3->phy)) {
236 dev_err(dev, "Failed to create PHY\n");
237 return PTR_ERR(usb3->phy);
240 phy_set_drvdata(usb3->phy, usb3);
242 phy_provider = devm_of_phy_provider_register(dev, of_phy_simple_xlate);
244 return PTR_ERR_OR_ZERO(phy_provider);
247 static struct mdio_driver bcm_ns_usb3_mdio_driver = {
250 .name = "bcm_ns_mdio_usb3",
251 .of_match_table = bcm_ns_usb3_id_table,
254 .probe = bcm_ns_usb3_mdio_probe,
257 /**************************************************
258 * Platform driver code
259 **************************************************/
261 static int bcm_ns_usb3_wait_reg(struct bcm_ns_usb3 *usb3, void __iomem *addr,
262 u32 mask, u32 value, int usec)
267 ret = readl_poll_timeout_atomic(addr, val, ((val & mask) == value),
270 dev_err(usb3->dev, "Timeout waiting for register %p\n", addr);
275 static inline int bcm_ns_usb3_mii_mng_wait_idle(struct bcm_ns_usb3 *usb3)
277 return bcm_ns_usb3_wait_reg(usb3, usb3->ccb_mii + BCMA_CCB_MII_MNG_CTL,
279 BCM_NS_USB3_MII_MNG_TIMEOUT_US);
282 static int bcm_ns_usb3_platform_phy_write(struct bcm_ns_usb3 *usb3, u16 reg,
288 err = bcm_ns_usb3_mii_mng_wait_idle(usb3);
290 dev_err(usb3->dev, "Couldn't write 0x%08x value\n", value);
294 /* TODO: Use a proper MDIO bus layer */
295 tmp |= 0x58020000; /* Magic value for MDIO PHY write */
298 writel(tmp, usb3->ccb_mii + BCMA_CCB_MII_MNG_CMD_DATA);
300 return bcm_ns_usb3_mii_mng_wait_idle(usb3);
303 static int bcm_ns_usb3_probe(struct platform_device *pdev)
305 struct device *dev = &pdev->dev;
306 const struct of_device_id *of_id;
307 struct bcm_ns_usb3 *usb3;
308 struct resource *res;
309 struct phy_provider *phy_provider;
311 usb3 = devm_kzalloc(dev, sizeof(*usb3), GFP_KERNEL);
317 of_id = of_match_device(bcm_ns_usb3_id_table, dev);
320 usb3->family = (enum bcm_ns_family)of_id->data;
322 res = platform_get_resource_byname(pdev, IORESOURCE_MEM, "dmp");
323 usb3->dmp = devm_ioremap_resource(dev, res);
324 if (IS_ERR(usb3->dmp)) {
325 dev_err(dev, "Failed to map DMP regs\n");
326 return PTR_ERR(usb3->dmp);
329 res = platform_get_resource_byname(pdev, IORESOURCE_MEM, "ccb-mii");
330 usb3->ccb_mii = devm_ioremap_resource(dev, res);
331 if (IS_ERR(usb3->ccb_mii)) {
332 dev_err(dev, "Failed to map ChipCommon B MII regs\n");
333 return PTR_ERR(usb3->ccb_mii);
336 /* Enable MDIO. Setting MDCDIV as 26 */
337 writel(0x0000009a, usb3->ccb_mii + BCMA_CCB_MII_MNG_CTL);
342 usb3->phy_write = bcm_ns_usb3_platform_phy_write;
344 usb3->phy = devm_phy_create(dev, NULL, &ops);
345 if (IS_ERR(usb3->phy)) {
346 dev_err(dev, "Failed to create PHY\n");
347 return PTR_ERR(usb3->phy);
350 phy_set_drvdata(usb3->phy, usb3);
351 platform_set_drvdata(pdev, usb3);
353 phy_provider = devm_of_phy_provider_register(dev, of_phy_simple_xlate);
354 if (!IS_ERR(phy_provider))
355 dev_info(dev, "Registered Broadcom Northstar USB 3.0 PHY driver\n");
357 return PTR_ERR_OR_ZERO(phy_provider);
360 static struct platform_driver bcm_ns_usb3_driver = {
361 .probe = bcm_ns_usb3_probe,
363 .name = "bcm_ns_usb3",
364 .of_match_table = bcm_ns_usb3_id_table,
368 static int __init bcm_ns_usb3_module_init(void)
373 * For backward compatibility we register as MDIO and platform driver.
374 * After getting MDIO binding commonly used (e.g. switching all DT files
375 * to use it) we should deprecate the old binding and eventually drop
379 err = mdio_driver_register(&bcm_ns_usb3_mdio_driver);
383 err = platform_driver_register(&bcm_ns_usb3_driver);
385 mdio_driver_unregister(&bcm_ns_usb3_mdio_driver);
389 module_init(bcm_ns_usb3_module_init);
391 static void __exit bcm_ns_usb3_module_exit(void)
393 platform_driver_unregister(&bcm_ns_usb3_driver);
394 mdio_driver_unregister(&bcm_ns_usb3_mdio_driver);
396 module_exit(bcm_ns_usb3_module_exit)
398 MODULE_LICENSE("GPL v2");