1 /* 2 * Driver for (BCM4706)? GBit MAC core on BCMA bus. 3 * 4 * Copyright (C) 2012 Rafał Miłecki <zajec5@gmail.com> 5 * 6 * Licensed under the GNU/GPL. See COPYING for details. 7 */ 8 9 #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt 10 11 #include <linux/bcma/bcma.h> 12 #include <linux/brcmphy.h> 13 #include <linux/etherdevice.h> 14 #include <linux/of_net.h> 15 #include "bgmac.h" 16 17 static inline bool bgmac_is_bcm4707_family(struct bcma_device *core) 18 { 19 switch (core->bus->chipinfo.id) { 20 case BCMA_CHIP_ID_BCM4707: 21 case BCMA_CHIP_ID_BCM47094: 22 case BCMA_CHIP_ID_BCM53018: 23 return true; 24 default: 25 return false; 26 } 27 } 28 29 /************************************************** 30 * BCMA bus ops 31 **************************************************/ 32 33 static u32 bcma_bgmac_read(struct bgmac *bgmac, u16 offset) 34 { 35 return bcma_read32(bgmac->bcma.core, offset); 36 } 37 38 static void bcma_bgmac_write(struct bgmac *bgmac, u16 offset, u32 value) 39 { 40 bcma_write32(bgmac->bcma.core, offset, value); 41 } 42 43 static u32 bcma_bgmac_idm_read(struct bgmac *bgmac, u16 offset) 44 { 45 return bcma_aread32(bgmac->bcma.core, offset); 46 } 47 48 static void bcma_bgmac_idm_write(struct bgmac *bgmac, u16 offset, u32 value) 49 { 50 return bcma_awrite32(bgmac->bcma.core, offset, value); 51 } 52 53 static bool bcma_bgmac_clk_enabled(struct bgmac *bgmac) 54 { 55 return bcma_core_is_enabled(bgmac->bcma.core); 56 } 57 58 static void bcma_bgmac_clk_enable(struct bgmac *bgmac, u32 flags) 59 { 60 bcma_core_enable(bgmac->bcma.core, flags); 61 } 62 63 static void bcma_bgmac_cco_ctl_maskset(struct bgmac *bgmac, u32 offset, 64 u32 mask, u32 set) 65 { 66 struct bcma_drv_cc *cc = &bgmac->bcma.core->bus->drv_cc; 67 68 bcma_chipco_chipctl_maskset(cc, offset, mask, set); 69 } 70 71 static u32 bcma_bgmac_get_bus_clock(struct bgmac *bgmac) 72 { 73 struct bcma_drv_cc *cc = &bgmac->bcma.core->bus->drv_cc; 74 75 return bcma_pmu_get_bus_clock(cc); 76 } 77 78 static void bcma_bgmac_cmn_maskset32(struct bgmac *bgmac, u16 offset, u32 mask, 79 u32 set) 80 { 81 bcma_maskset32(bgmac->bcma.cmn, offset, mask, set); 82 } 83 84 static int bcma_phy_connect(struct bgmac *bgmac) 85 { 86 struct phy_device *phy_dev; 87 char bus_id[MII_BUS_ID_SIZE + 3]; 88 89 /* Connect to the PHY */ 90 snprintf(bus_id, sizeof(bus_id), PHY_ID_FMT, bgmac->mii_bus->id, 91 bgmac->phyaddr); 92 phy_dev = phy_connect(bgmac->net_dev, bus_id, bgmac_adjust_link, 93 PHY_INTERFACE_MODE_MII); 94 if (IS_ERR(phy_dev)) { 95 dev_err(bgmac->dev, "PHY connection failed\n"); 96 return PTR_ERR(phy_dev); 97 } 98 99 return 0; 100 } 101 102 static const struct bcma_device_id bgmac_bcma_tbl[] = { 103 BCMA_CORE(BCMA_MANUF_BCM, BCMA_CORE_4706_MAC_GBIT, 104 BCMA_ANY_REV, BCMA_ANY_CLASS), 105 BCMA_CORE(BCMA_MANUF_BCM, BCMA_CORE_MAC_GBIT, BCMA_ANY_REV, 106 BCMA_ANY_CLASS), 107 {}, 108 }; 109 MODULE_DEVICE_TABLE(bcma, bgmac_bcma_tbl); 110 111 /* http://bcm-v4.sipsolutions.net/mac-gbit/gmac/chipattach */ 112 static int bgmac_probe(struct bcma_device *core) 113 { 114 struct bcma_chipinfo *ci = &core->bus->chipinfo; 115 struct ssb_sprom *sprom = &core->bus->sprom; 116 struct mii_bus *mii_bus; 117 struct bgmac *bgmac; 118 const u8 *mac; 119 int err; 120 121 bgmac = bgmac_alloc(&core->dev); 122 if (!bgmac) 123 return -ENOMEM; 124 125 bgmac->bcma.core = core; 126 bgmac->dma_dev = core->dma_dev; 127 bgmac->irq = core->irq; 128 129 bcma_set_drvdata(core, bgmac); 130 131 err = of_get_mac_address(bgmac->dev->of_node, bgmac->net_dev->dev_addr); 132 if (err == -EPROBE_DEFER) 133 return err; 134 135 /* If no MAC address assigned via device tree, check SPROM */ 136 if (err) { 137 switch (core->core_unit) { 138 case 0: 139 mac = sprom->et0mac; 140 break; 141 case 1: 142 mac = sprom->et1mac; 143 break; 144 case 2: 145 mac = sprom->et2mac; 146 break; 147 default: 148 dev_err(bgmac->dev, "Unsupported core_unit %d\n", 149 core->core_unit); 150 err = -ENOTSUPP; 151 goto err; 152 } 153 ether_addr_copy(bgmac->net_dev->dev_addr, mac); 154 } 155 156 /* On BCM4706 we need common core to access PHY */ 157 if (core->id.id == BCMA_CORE_4706_MAC_GBIT && 158 !core->bus->drv_gmac_cmn.core) { 159 dev_err(bgmac->dev, "GMAC CMN core not found (required for BCM4706)\n"); 160 err = -ENODEV; 161 goto err; 162 } 163 bgmac->bcma.cmn = core->bus->drv_gmac_cmn.core; 164 165 switch (core->core_unit) { 166 case 0: 167 bgmac->phyaddr = sprom->et0phyaddr; 168 break; 169 case 1: 170 bgmac->phyaddr = sprom->et1phyaddr; 171 break; 172 case 2: 173 bgmac->phyaddr = sprom->et2phyaddr; 174 break; 175 } 176 bgmac->phyaddr &= BGMAC_PHY_MASK; 177 if (bgmac->phyaddr == BGMAC_PHY_MASK) { 178 dev_err(bgmac->dev, "No PHY found\n"); 179 err = -ENODEV; 180 goto err; 181 } 182 dev_info(bgmac->dev, "Found PHY addr: %d%s\n", bgmac->phyaddr, 183 bgmac->phyaddr == BGMAC_PHY_NOREGS ? " (NOREGS)" : ""); 184 185 if (!bgmac_is_bcm4707_family(core) && 186 !(ci->id == BCMA_CHIP_ID_BCM53573 && core->core_unit == 1)) { 187 struct phy_device *phydev; 188 189 mii_bus = bcma_mdio_mii_register(bgmac); 190 if (IS_ERR(mii_bus)) { 191 err = PTR_ERR(mii_bus); 192 goto err; 193 } 194 bgmac->mii_bus = mii_bus; 195 196 phydev = mdiobus_get_phy(bgmac->mii_bus, bgmac->phyaddr); 197 if (ci->id == BCMA_CHIP_ID_BCM53573 && phydev && 198 (phydev->drv->phy_id & phydev->drv->phy_id_mask) == PHY_ID_BCM54210E) 199 phydev->dev_flags |= PHY_BRCM_EN_MASTER_MODE; 200 } 201 202 if (core->bus->hosttype == BCMA_HOSTTYPE_PCI) { 203 dev_err(bgmac->dev, "PCI setup not implemented\n"); 204 err = -ENOTSUPP; 205 goto err1; 206 } 207 208 bgmac->has_robosw = !!(sprom->boardflags_lo & BGMAC_BFL_ENETROBO); 209 if (bgmac->has_robosw) 210 dev_warn(bgmac->dev, "Support for Roboswitch not implemented\n"); 211 212 if (sprom->boardflags_lo & BGMAC_BFL_ENETADM) 213 dev_warn(bgmac->dev, "Support for ADMtek ethernet switch not implemented\n"); 214 215 /* Feature Flags */ 216 switch (ci->id) { 217 /* BCM 471X/535X family */ 218 case BCMA_CHIP_ID_BCM4716: 219 bgmac->feature_flags |= BGMAC_FEAT_CLKCTLST; 220 fallthrough; 221 case BCMA_CHIP_ID_BCM47162: 222 bgmac->feature_flags |= BGMAC_FEAT_FLW_CTRL2; 223 bgmac->feature_flags |= BGMAC_FEAT_SET_RXQ_CLK; 224 break; 225 case BCMA_CHIP_ID_BCM5357: 226 case BCMA_CHIP_ID_BCM53572: 227 bgmac->feature_flags |= BGMAC_FEAT_SET_RXQ_CLK; 228 bgmac->feature_flags |= BGMAC_FEAT_CLKCTLST; 229 bgmac->feature_flags |= BGMAC_FEAT_FLW_CTRL1; 230 bgmac->feature_flags |= BGMAC_FEAT_SW_TYPE_PHY; 231 if (ci->pkg == BCMA_PKG_ID_BCM47188 || 232 ci->pkg == BCMA_PKG_ID_BCM47186) { 233 bgmac->feature_flags |= BGMAC_FEAT_SW_TYPE_RGMII; 234 bgmac->feature_flags |= BGMAC_FEAT_IOST_ATTACHED; 235 } 236 if (ci->pkg == BCMA_PKG_ID_BCM5358) 237 bgmac->feature_flags |= BGMAC_FEAT_SW_TYPE_EPHYRMII; 238 break; 239 case BCMA_CHIP_ID_BCM53573: 240 bgmac->feature_flags |= BGMAC_FEAT_CLKCTLST; 241 bgmac->feature_flags |= BGMAC_FEAT_SET_RXQ_CLK; 242 if (ci->pkg == BCMA_PKG_ID_BCM47189) 243 bgmac->feature_flags |= BGMAC_FEAT_IOST_ATTACHED; 244 if (core->core_unit == 0) { 245 bgmac->feature_flags |= BGMAC_FEAT_CC4_IF_SW_TYPE; 246 if (ci->pkg == BCMA_PKG_ID_BCM47189) 247 bgmac->feature_flags |= 248 BGMAC_FEAT_CC4_IF_SW_TYPE_RGMII; 249 } else if (core->core_unit == 1) { 250 bgmac->feature_flags |= BGMAC_FEAT_IRQ_ID_OOB_6; 251 bgmac->feature_flags |= BGMAC_FEAT_CC7_IF_TYPE_RGMII; 252 } 253 break; 254 case BCMA_CHIP_ID_BCM4749: 255 bgmac->feature_flags |= BGMAC_FEAT_SET_RXQ_CLK; 256 bgmac->feature_flags |= BGMAC_FEAT_CLKCTLST; 257 bgmac->feature_flags |= BGMAC_FEAT_FLW_CTRL1; 258 bgmac->feature_flags |= BGMAC_FEAT_SW_TYPE_PHY; 259 if (ci->pkg == 10) { 260 bgmac->feature_flags |= BGMAC_FEAT_SW_TYPE_RGMII; 261 bgmac->feature_flags |= BGMAC_FEAT_IOST_ATTACHED; 262 } 263 break; 264 /* bcm4707_family */ 265 case BCMA_CHIP_ID_BCM4707: 266 case BCMA_CHIP_ID_BCM47094: 267 case BCMA_CHIP_ID_BCM53018: 268 bgmac->feature_flags |= BGMAC_FEAT_CLKCTLST; 269 bgmac->feature_flags |= BGMAC_FEAT_NO_RESET; 270 bgmac->feature_flags |= BGMAC_FEAT_FORCE_SPEED_2500; 271 break; 272 default: 273 bgmac->feature_flags |= BGMAC_FEAT_CLKCTLST; 274 bgmac->feature_flags |= BGMAC_FEAT_SET_RXQ_CLK; 275 } 276 277 if (!bgmac_is_bcm4707_family(core) && core->id.rev > 2) 278 bgmac->feature_flags |= BGMAC_FEAT_MISC_PLL_REQ; 279 280 if (core->id.id == BCMA_CORE_4706_MAC_GBIT) { 281 bgmac->feature_flags |= BGMAC_FEAT_CMN_PHY_CTL; 282 bgmac->feature_flags |= BGMAC_FEAT_NO_CLR_MIB; 283 } 284 285 if (core->id.rev >= 4) { 286 bgmac->feature_flags |= BGMAC_FEAT_CMDCFG_SR_REV4; 287 bgmac->feature_flags |= BGMAC_FEAT_TX_MASK_SETUP; 288 bgmac->feature_flags |= BGMAC_FEAT_RX_MASK_SETUP; 289 } 290 291 bgmac->read = bcma_bgmac_read; 292 bgmac->write = bcma_bgmac_write; 293 bgmac->idm_read = bcma_bgmac_idm_read; 294 bgmac->idm_write = bcma_bgmac_idm_write; 295 bgmac->clk_enabled = bcma_bgmac_clk_enabled; 296 bgmac->clk_enable = bcma_bgmac_clk_enable; 297 bgmac->cco_ctl_maskset = bcma_bgmac_cco_ctl_maskset; 298 bgmac->get_bus_clock = bcma_bgmac_get_bus_clock; 299 bgmac->cmn_maskset32 = bcma_bgmac_cmn_maskset32; 300 if (bgmac->mii_bus) 301 bgmac->phy_connect = bcma_phy_connect; 302 else 303 bgmac->phy_connect = bgmac_phy_connect_direct; 304 305 err = bgmac_enet_probe(bgmac); 306 if (err) 307 goto err1; 308 309 return 0; 310 311 err1: 312 bcma_mdio_mii_unregister(bgmac->mii_bus); 313 err: 314 bcma_set_drvdata(core, NULL); 315 316 return err; 317 } 318 319 static void bgmac_remove(struct bcma_device *core) 320 { 321 struct bgmac *bgmac = bcma_get_drvdata(core); 322 323 bcma_mdio_mii_unregister(bgmac->mii_bus); 324 bgmac_enet_remove(bgmac); 325 bcma_set_drvdata(core, NULL); 326 kfree(bgmac); 327 } 328 329 static struct bcma_driver bgmac_bcma_driver = { 330 .name = KBUILD_MODNAME, 331 .id_table = bgmac_bcma_tbl, 332 .probe = bgmac_probe, 333 .remove = bgmac_remove, 334 }; 335 336 static int __init bgmac_init(void) 337 { 338 int err; 339 340 err = bcma_driver_register(&bgmac_bcma_driver); 341 if (err) 342 return err; 343 pr_info("Broadcom 47xx GBit MAC driver loaded\n"); 344 345 return 0; 346 } 347 348 static void __exit bgmac_exit(void) 349 { 350 bcma_driver_unregister(&bgmac_bcma_driver); 351 } 352 353 module_init(bgmac_init) 354 module_exit(bgmac_exit) 355 356 MODULE_AUTHOR("Rafał Miłecki"); 357 MODULE_LICENSE("GPL"); 358