^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1) // SPDX-License-Identifier: GPL-2.0-only
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3) * Broadcom Northstar USB 3.0 PHY Driver
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5) * Copyright (C) 2016 Rafał Miłecki <rafal@milecki.pl>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 6) * Copyright (C) 2016 Broadcom
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 7) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 8) * All magic values used for initialization (and related comments) were obtained
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 9) * from Broadcom's SDK:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 10) * Copyright (c) Broadcom Corp, 2012
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 11) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 12)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 13) #include <linux/bcma/bcma.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 14) #include <linux/delay.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 15) #include <linux/err.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 16) #include <linux/iopoll.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 17) #include <linux/mdio.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 18) #include <linux/module.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 19) #include <linux/of_address.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 20) #include <linux/of_platform.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 21) #include <linux/platform_device.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 22) #include <linux/phy/phy.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 23) #include <linux/slab.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 24)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 25) #define BCM_NS_USB3_MII_MNG_TIMEOUT_US 1000 /* usecs */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 26)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 27) #define BCM_NS_USB3_PHY_BASE_ADDR_REG 0x1f
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 28) #define BCM_NS_USB3_PHY_PLL30_BLOCK 0x8000
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 29) #define BCM_NS_USB3_PHY_TX_PMD_BLOCK 0x8040
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 30) #define BCM_NS_USB3_PHY_PIPE_BLOCK 0x8060
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 31)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 32) /* Registers of PLL30 block */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 33) #define BCM_NS_USB3_PLL_CONTROL 0x01
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 34) #define BCM_NS_USB3_PLLA_CONTROL0 0x0a
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 35) #define BCM_NS_USB3_PLLA_CONTROL1 0x0b
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 36)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 37) /* Registers of TX PMD block */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 38) #define BCM_NS_USB3_TX_PMD_CONTROL1 0x01
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 39)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 40) /* Registers of PIPE block */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 41) #define BCM_NS_USB3_LFPS_CMP 0x02
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 42) #define BCM_NS_USB3_LFPS_DEGLITCH 0x03
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 43)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 44) enum bcm_ns_family {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 45) BCM_NS_UNKNOWN,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 46) BCM_NS_AX,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 47) BCM_NS_BX,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 48) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 49)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 50) struct bcm_ns_usb3 {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 51) struct device *dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 52) enum bcm_ns_family family;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 53) void __iomem *dmp;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 54) void __iomem *ccb_mii;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 55) struct mdio_device *mdiodev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 56) struct phy *phy;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 57)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 58) int (*phy_write)(struct bcm_ns_usb3 *usb3, u16 reg, u16 value);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 59) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 60)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 61) static const struct of_device_id bcm_ns_usb3_id_table[] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 62) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 63) .compatible = "brcm,ns-ax-usb3-phy",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 64) .data = (int *)BCM_NS_AX,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 65) },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 66) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 67) .compatible = "brcm,ns-bx-usb3-phy",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 68) .data = (int *)BCM_NS_BX,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 69) },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 70) {},
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 71) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 72) MODULE_DEVICE_TABLE(of, bcm_ns_usb3_id_table);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 73)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 74) static int bcm_ns_usb3_mdio_phy_write(struct bcm_ns_usb3 *usb3, u16 reg,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 75) u16 value)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 76) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 77) return usb3->phy_write(usb3, reg, value);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 78) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 79)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 80) static int bcm_ns_usb3_phy_init_ns_bx(struct bcm_ns_usb3 *usb3)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 81) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 82) int err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 83)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 84) /* USB3 PLL Block */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 85) err = bcm_ns_usb3_mdio_phy_write(usb3, BCM_NS_USB3_PHY_BASE_ADDR_REG,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 86) BCM_NS_USB3_PHY_PLL30_BLOCK);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 87) if (err < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 88) return err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 89)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 90) /* Assert Ana_Pllseq start */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 91) bcm_ns_usb3_mdio_phy_write(usb3, BCM_NS_USB3_PLL_CONTROL, 0x1000);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 92)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 93) /* Assert CML Divider ratio to 26 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 94) bcm_ns_usb3_mdio_phy_write(usb3, BCM_NS_USB3_PLLA_CONTROL0, 0x6400);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 95)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 96) /* Asserting PLL Reset */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 97) bcm_ns_usb3_mdio_phy_write(usb3, BCM_NS_USB3_PLLA_CONTROL1, 0xc000);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 98)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 99) /* Deaaserting PLL Reset */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 100) bcm_ns_usb3_mdio_phy_write(usb3, BCM_NS_USB3_PLLA_CONTROL1, 0x8000);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 101)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 102) /* Deasserting USB3 system reset */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 103) writel(0, usb3->dmp + BCMA_RESET_CTL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 104)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 105) /* PLL frequency monitor enable */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 106) bcm_ns_usb3_mdio_phy_write(usb3, BCM_NS_USB3_PLL_CONTROL, 0x9000);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 107)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 108) /* PIPE Block */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 109) bcm_ns_usb3_mdio_phy_write(usb3, BCM_NS_USB3_PHY_BASE_ADDR_REG,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 110) BCM_NS_USB3_PHY_PIPE_BLOCK);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 111)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 112) /* CMPMAX & CMPMINTH setting */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 113) bcm_ns_usb3_mdio_phy_write(usb3, BCM_NS_USB3_LFPS_CMP, 0xf30d);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 114)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 115) /* DEGLITCH MIN & MAX setting */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 116) bcm_ns_usb3_mdio_phy_write(usb3, BCM_NS_USB3_LFPS_DEGLITCH, 0x6302);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 117)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 118) /* TXPMD block */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 119) bcm_ns_usb3_mdio_phy_write(usb3, BCM_NS_USB3_PHY_BASE_ADDR_REG,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 120) BCM_NS_USB3_PHY_TX_PMD_BLOCK);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 121)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 122) /* Enabling SSC */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 123) bcm_ns_usb3_mdio_phy_write(usb3, BCM_NS_USB3_TX_PMD_CONTROL1, 0x1003);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 124)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 125) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 126) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 127)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 128) static int bcm_ns_usb3_phy_init_ns_ax(struct bcm_ns_usb3 *usb3)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 129) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 130) int err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 131)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 132) /* PLL30 block */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 133) err = bcm_ns_usb3_mdio_phy_write(usb3, BCM_NS_USB3_PHY_BASE_ADDR_REG,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 134) BCM_NS_USB3_PHY_PLL30_BLOCK);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 135) if (err < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 136) return err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 137)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 138) bcm_ns_usb3_mdio_phy_write(usb3, BCM_NS_USB3_PLLA_CONTROL0, 0x6400);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 139)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 140) bcm_ns_usb3_mdio_phy_write(usb3, BCM_NS_USB3_PHY_BASE_ADDR_REG, 0x80e0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 141)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 142) bcm_ns_usb3_mdio_phy_write(usb3, 0x02, 0x009c);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 143)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 144) /* Enable SSC */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 145) bcm_ns_usb3_mdio_phy_write(usb3, BCM_NS_USB3_PHY_BASE_ADDR_REG,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 146) BCM_NS_USB3_PHY_TX_PMD_BLOCK);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 147)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 148) bcm_ns_usb3_mdio_phy_write(usb3, 0x02, 0x21d3);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 149)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 150) bcm_ns_usb3_mdio_phy_write(usb3, BCM_NS_USB3_TX_PMD_CONTROL1, 0x1003);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 151)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 152) /* Deasserting USB3 system reset */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 153) writel(0, usb3->dmp + BCMA_RESET_CTL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 154)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 155) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 156) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 157)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 158) static int bcm_ns_usb3_phy_init(struct phy *phy)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 159) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 160) struct bcm_ns_usb3 *usb3 = phy_get_drvdata(phy);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 161) int err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 162)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 163) /* Perform USB3 system soft reset */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 164) writel(BCMA_RESET_CTL_RESET, usb3->dmp + BCMA_RESET_CTL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 165)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 166) switch (usb3->family) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 167) case BCM_NS_AX:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 168) err = bcm_ns_usb3_phy_init_ns_ax(usb3);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 169) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 170) case BCM_NS_BX:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 171) err = bcm_ns_usb3_phy_init_ns_bx(usb3);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 172) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 173) default:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 174) WARN_ON(1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 175) err = -ENOTSUPP;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 176) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 177)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 178) return err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 179) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 180)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 181) static const struct phy_ops ops = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 182) .init = bcm_ns_usb3_phy_init,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 183) .owner = THIS_MODULE,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 184) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 185)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 186) /**************************************************
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 187) * MDIO driver code
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 188) **************************************************/
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 189)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 190) static int bcm_ns_usb3_mdiodev_phy_write(struct bcm_ns_usb3 *usb3, u16 reg,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 191) u16 value)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 192) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 193) struct mdio_device *mdiodev = usb3->mdiodev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 194)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 195) return mdiobus_write(mdiodev->bus, mdiodev->addr, reg, value);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 196) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 197)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 198) static int bcm_ns_usb3_mdio_probe(struct mdio_device *mdiodev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 199) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 200) struct device *dev = &mdiodev->dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 201) const struct of_device_id *of_id;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 202) struct phy_provider *phy_provider;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 203) struct device_node *syscon_np;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 204) struct bcm_ns_usb3 *usb3;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 205) struct resource res;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 206) int err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 207)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 208) usb3 = devm_kzalloc(dev, sizeof(*usb3), GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 209) if (!usb3)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 210) return -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 211)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 212) usb3->dev = dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 213) usb3->mdiodev = mdiodev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 214)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 215) of_id = of_match_device(bcm_ns_usb3_id_table, dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 216) if (!of_id)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 217) return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 218) usb3->family = (enum bcm_ns_family)of_id->data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 219)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 220) syscon_np = of_parse_phandle(dev->of_node, "usb3-dmp-syscon", 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 221) err = of_address_to_resource(syscon_np, 0, &res);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 222) of_node_put(syscon_np);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 223) if (err)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 224) return err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 225)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 226) usb3->dmp = devm_ioremap_resource(dev, &res);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 227) if (IS_ERR(usb3->dmp)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 228) dev_err(dev, "Failed to map DMP regs\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 229) return PTR_ERR(usb3->dmp);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 230) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 231)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 232) usb3->phy_write = bcm_ns_usb3_mdiodev_phy_write;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 233)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 234) usb3->phy = devm_phy_create(dev, NULL, &ops);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 235) if (IS_ERR(usb3->phy)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 236) dev_err(dev, "Failed to create PHY\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 237) return PTR_ERR(usb3->phy);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 238) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 239)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 240) phy_set_drvdata(usb3->phy, usb3);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 241)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 242) phy_provider = devm_of_phy_provider_register(dev, of_phy_simple_xlate);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 243)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 244) return PTR_ERR_OR_ZERO(phy_provider);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 245) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 246)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 247) static struct mdio_driver bcm_ns_usb3_mdio_driver = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 248) .mdiodrv = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 249) .driver = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 250) .name = "bcm_ns_mdio_usb3",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 251) .of_match_table = bcm_ns_usb3_id_table,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 252) },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 253) },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 254) .probe = bcm_ns_usb3_mdio_probe,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 255) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 256)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 257) /**************************************************
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 258) * Platform driver code
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 259) **************************************************/
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 260)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 261) static int bcm_ns_usb3_wait_reg(struct bcm_ns_usb3 *usb3, void __iomem *addr,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 262) u32 mask, u32 value, int usec)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 263) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 264) u32 val;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 265) int ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 266)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 267) ret = readl_poll_timeout_atomic(addr, val, ((val & mask) == value),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 268) 10, usec);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 269) if (ret)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 270) dev_err(usb3->dev, "Timeout waiting for register %p\n", addr);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 271)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 272) return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 273) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 274)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 275) static inline int bcm_ns_usb3_mii_mng_wait_idle(struct bcm_ns_usb3 *usb3)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 276) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 277) return bcm_ns_usb3_wait_reg(usb3, usb3->ccb_mii + BCMA_CCB_MII_MNG_CTL,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 278) 0x0100, 0x0000,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 279) BCM_NS_USB3_MII_MNG_TIMEOUT_US);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 280) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 281)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 282) static int bcm_ns_usb3_platform_phy_write(struct bcm_ns_usb3 *usb3, u16 reg,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 283) u16 value)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 284) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 285) u32 tmp = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 286) int err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 287)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 288) err = bcm_ns_usb3_mii_mng_wait_idle(usb3);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 289) if (err < 0) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 290) dev_err(usb3->dev, "Couldn't write 0x%08x value\n", value);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 291) return err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 292) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 293)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 294) /* TODO: Use a proper MDIO bus layer */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 295) tmp |= 0x58020000; /* Magic value for MDIO PHY write */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 296) tmp |= reg << 18;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 297) tmp |= value;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 298) writel(tmp, usb3->ccb_mii + BCMA_CCB_MII_MNG_CMD_DATA);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 299)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 300) return bcm_ns_usb3_mii_mng_wait_idle(usb3);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 301) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 302)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 303) static int bcm_ns_usb3_probe(struct platform_device *pdev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 304) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 305) struct device *dev = &pdev->dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 306) const struct of_device_id *of_id;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 307) struct bcm_ns_usb3 *usb3;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 308) struct resource *res;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 309) struct phy_provider *phy_provider;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 310)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 311) usb3 = devm_kzalloc(dev, sizeof(*usb3), GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 312) if (!usb3)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 313) return -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 314)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 315) usb3->dev = dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 316)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 317) of_id = of_match_device(bcm_ns_usb3_id_table, dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 318) if (!of_id)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 319) return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 320) usb3->family = (enum bcm_ns_family)of_id->data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 321)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 322) res = platform_get_resource_byname(pdev, IORESOURCE_MEM, "dmp");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 323) usb3->dmp = devm_ioremap_resource(dev, res);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 324) if (IS_ERR(usb3->dmp)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 325) dev_err(dev, "Failed to map DMP regs\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 326) return PTR_ERR(usb3->dmp);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 327) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 328)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 329) res = platform_get_resource_byname(pdev, IORESOURCE_MEM, "ccb-mii");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 330) usb3->ccb_mii = devm_ioremap_resource(dev, res);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 331) if (IS_ERR(usb3->ccb_mii)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 332) dev_err(dev, "Failed to map ChipCommon B MII regs\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 333) return PTR_ERR(usb3->ccb_mii);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 334) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 335)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 336) /* Enable MDIO. Setting MDCDIV as 26 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 337) writel(0x0000009a, usb3->ccb_mii + BCMA_CCB_MII_MNG_CTL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 338)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 339) /* Wait for MDIO? */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 340) udelay(2);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 341)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 342) usb3->phy_write = bcm_ns_usb3_platform_phy_write;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 343)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 344) usb3->phy = devm_phy_create(dev, NULL, &ops);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 345) if (IS_ERR(usb3->phy)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 346) dev_err(dev, "Failed to create PHY\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 347) return PTR_ERR(usb3->phy);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 348) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 349)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 350) phy_set_drvdata(usb3->phy, usb3);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 351) platform_set_drvdata(pdev, usb3);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 352)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 353) phy_provider = devm_of_phy_provider_register(dev, of_phy_simple_xlate);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 354) if (!IS_ERR(phy_provider))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 355) dev_info(dev, "Registered Broadcom Northstar USB 3.0 PHY driver\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 356)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 357) return PTR_ERR_OR_ZERO(phy_provider);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 358) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 359)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 360) static struct platform_driver bcm_ns_usb3_driver = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 361) .probe = bcm_ns_usb3_probe,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 362) .driver = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 363) .name = "bcm_ns_usb3",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 364) .of_match_table = bcm_ns_usb3_id_table,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 365) },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 366) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 367)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 368) static int __init bcm_ns_usb3_module_init(void)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 369) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 370) int err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 371)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 372) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 373) * For backward compatibility we register as MDIO and platform driver.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 374) * After getting MDIO binding commonly used (e.g. switching all DT files
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 375) * to use it) we should deprecate the old binding and eventually drop
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 376) * support for it.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 377) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 378)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 379) err = mdio_driver_register(&bcm_ns_usb3_mdio_driver);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 380) if (err)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 381) return err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 382)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 383) err = platform_driver_register(&bcm_ns_usb3_driver);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 384) if (err)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 385) mdio_driver_unregister(&bcm_ns_usb3_mdio_driver);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 386)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 387) return err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 388) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 389) module_init(bcm_ns_usb3_module_init);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 390)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 391) static void __exit bcm_ns_usb3_module_exit(void)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 392) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 393) platform_driver_unregister(&bcm_ns_usb3_driver);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 394) mdio_driver_unregister(&bcm_ns_usb3_mdio_driver);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 395) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 396) module_exit(bcm_ns_usb3_module_exit)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 397)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 398) MODULE_LICENSE("GPL v2");
Orange Pi5 kernel
Deprecated Linux kernel 5.10.110 for OrangePi 5/5B/5+ boards
3 Commits
0 Branches
0 Tags