drivers/net/ethernet/broadcom/bgmac-bcma.c

   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                 eth_hw_addr_set(bgmac->net_dev, 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");