/* * Driver for (BCM4706)? GBit MAC core on BCMA bus. * * Copyright (C) 2012 Rafał Miłecki * * Licensed under the GNU/GPL. See COPYING for details. */ #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt #include #include #include #include "bgmac.h" static inline bool bgmac_is_bcm4707_family(struct bcma_device *core) { switch (core->bus->chipinfo.id) { case BCMA_CHIP_ID_BCM4707: case BCMA_CHIP_ID_BCM47094: case BCMA_CHIP_ID_BCM53018: return true; default: return false; } } /************************************************** * BCMA bus ops **************************************************/ static u32 bcma_bgmac_read(struct bgmac *bgmac, u16 offset) { return bcma_read32(bgmac->bcma.core, offset); } static void bcma_bgmac_write(struct bgmac *bgmac, u16 offset, u32 value) { bcma_write32(bgmac->bcma.core, offset, value); } static u32 bcma_bgmac_idm_read(struct bgmac *bgmac, u16 offset) { return bcma_aread32(bgmac->bcma.core, offset); } static void bcma_bgmac_idm_write(struct bgmac *bgmac, u16 offset, u32 value) { return bcma_awrite32(bgmac->bcma.core, offset, value); } static bool bcma_bgmac_clk_enabled(struct bgmac *bgmac) { return bcma_core_is_enabled(bgmac->bcma.core); } static void bcma_bgmac_clk_enable(struct bgmac *bgmac, u32 flags) { bcma_core_enable(bgmac->bcma.core, flags); } static void bcma_bgmac_cco_ctl_maskset(struct bgmac *bgmac, u32 offset, u32 mask, u32 set) { struct bcma_drv_cc *cc = &bgmac->bcma.core->bus->drv_cc; bcma_chipco_chipctl_maskset(cc, offset, mask, set); } static u32 bcma_bgmac_get_bus_clock(struct bgmac *bgmac) { struct bcma_drv_cc *cc = &bgmac->bcma.core->bus->drv_cc; return bcma_pmu_get_bus_clock(cc); } static void bcma_bgmac_cmn_maskset32(struct bgmac *bgmac, u16 offset, u32 mask, u32 set) { bcma_maskset32(bgmac->bcma.cmn, offset, mask, set); } static int bcma_phy_connect(struct bgmac *bgmac) { struct phy_device *phy_dev; char bus_id[MII_BUS_ID_SIZE + 3]; /* Connect to the PHY */ snprintf(bus_id, sizeof(bus_id), PHY_ID_FMT, bgmac->mii_bus->id, bgmac->phyaddr); phy_dev = phy_connect(bgmac->net_dev, bus_id, bgmac_adjust_link, PHY_INTERFACE_MODE_MII); if (IS_ERR(phy_dev)) { dev_err(bgmac->dev, "PHY connection failed\n"); return PTR_ERR(phy_dev); } return 0; } static const struct bcma_device_id bgmac_bcma_tbl[] = { BCMA_CORE(BCMA_MANUF_BCM, BCMA_CORE_4706_MAC_GBIT, BCMA_ANY_REV, BCMA_ANY_CLASS), BCMA_CORE(BCMA_MANUF_BCM, BCMA_CORE_MAC_GBIT, BCMA_ANY_REV, BCMA_ANY_CLASS), {}, }; MODULE_DEVICE_TABLE(bcma, bgmac_bcma_tbl); /* http://bcm-v4.sipsolutions.net/mac-gbit/gmac/chipattach */ static int bgmac_probe(struct bcma_device *core) { struct bcma_chipinfo *ci = &core->bus->chipinfo; struct ssb_sprom *sprom = &core->bus->sprom; struct mii_bus *mii_bus; struct bgmac *bgmac; u8 *mac; int err; bgmac = bgmac_alloc(&core->dev); if (!bgmac) return -ENOMEM; bgmac->bcma.core = core; bgmac->dma_dev = core->dma_dev; bgmac->irq = core->irq; bcma_set_drvdata(core, bgmac); switch (core->core_unit) { case 0: mac = sprom->et0mac; break; case 1: mac = sprom->et1mac; break; case 2: mac = sprom->et2mac; break; default: dev_err(bgmac->dev, "Unsupported core_unit %d\n", core->core_unit); err = -ENOTSUPP; goto err; } ether_addr_copy(bgmac->net_dev->dev_addr, mac); /* On BCM4706 we need common core to access PHY */ if (core->id.id == BCMA_CORE_4706_MAC_GBIT && !core->bus->drv_gmac_cmn.core) { dev_err(bgmac->dev, "GMAC CMN core not found (required for BCM4706)\n"); err = -ENODEV; goto err; } bgmac->bcma.cmn = core->bus->drv_gmac_cmn.core; switch (core->core_unit) { case 0: bgmac->phyaddr = sprom->et0phyaddr; break; case 1: bgmac->phyaddr = sprom->et1phyaddr; break; case 2: bgmac->phyaddr = sprom->et2phyaddr; break; } bgmac->phyaddr &= BGMAC_PHY_MASK; if (bgmac->phyaddr == BGMAC_PHY_MASK) { dev_err(bgmac->dev, "No PHY found\n"); err = -ENODEV; goto err; } dev_info(bgmac->dev, "Found PHY addr: %d%s\n", bgmac->phyaddr, bgmac->phyaddr == BGMAC_PHY_NOREGS ? " (NOREGS)" : ""); if (!bgmac_is_bcm4707_family(core) && !(ci->id == BCMA_CHIP_ID_BCM53573 && core->core_unit == 1)) { mii_bus = bcma_mdio_mii_register(bgmac); if (IS_ERR(mii_bus)) { err = PTR_ERR(mii_bus); goto err; } bgmac->mii_bus = mii_bus; } if (core->bus->hosttype == BCMA_HOSTTYPE_PCI) { dev_err(bgmac->dev, "PCI setup not implemented\n"); err = -ENOTSUPP; goto err1; } bgmac->has_robosw = !!(sprom->boardflags_lo & BGMAC_BFL_ENETROBO); if (bgmac->has_robosw) dev_warn(bgmac->dev, "Support for Roboswitch not implemented\n"); if (sprom->boardflags_lo & BGMAC_BFL_ENETADM) dev_warn(bgmac->dev, "Support for ADMtek ethernet switch not implemented\n"); /* Feature Flags */ switch (ci->id) { /* BCM 471X/535X family */ case BCMA_CHIP_ID_BCM4716: bgmac->feature_flags |= BGMAC_FEAT_CLKCTLST; /* fallthrough */ case BCMA_CHIP_ID_BCM47162: bgmac->feature_flags |= BGMAC_FEAT_FLW_CTRL2; bgmac->feature_flags |= BGMAC_FEAT_SET_RXQ_CLK; break; case BCMA_CHIP_ID_BCM5357: case BCMA_CHIP_ID_BCM53572: bgmac->feature_flags |= BGMAC_FEAT_SET_RXQ_CLK; bgmac->feature_flags |= BGMAC_FEAT_CLKCTLST; bgmac->feature_flags |= BGMAC_FEAT_FLW_CTRL1; bgmac->feature_flags |= BGMAC_FEAT_SW_TYPE_PHY; if (ci->pkg == BCMA_PKG_ID_BCM47188 || ci->pkg == BCMA_PKG_ID_BCM47186) { bgmac->feature_flags |= BGMAC_FEAT_SW_TYPE_RGMII; bgmac->feature_flags |= BGMAC_FEAT_IOST_ATTACHED; } if (ci->pkg == BCMA_PKG_ID_BCM5358) bgmac->feature_flags |= BGMAC_FEAT_SW_TYPE_EPHYRMII; break; case BCMA_CHIP_ID_BCM53573: bgmac->feature_flags |= BGMAC_FEAT_CLKCTLST; bgmac->feature_flags |= BGMAC_FEAT_SET_RXQ_CLK; if (ci->pkg == BCMA_PKG_ID_BCM47189) bgmac->feature_flags |= BGMAC_FEAT_IOST_ATTACHED; if (core->core_unit == 0) { bgmac->feature_flags |= BGMAC_FEAT_CC4_IF_SW_TYPE; if (ci->pkg == BCMA_PKG_ID_BCM47189) bgmac->feature_flags |= BGMAC_FEAT_CC4_IF_SW_TYPE_RGMII; } else if (core->core_unit == 1) { bgmac->feature_flags |= BGMAC_FEAT_IRQ_ID_OOB_6; bgmac->feature_flags |= BGMAC_FEAT_CC7_IF_TYPE_RGMII; } break; case BCMA_CHIP_ID_BCM4749: bgmac->feature_flags |= BGMAC_FEAT_SET_RXQ_CLK; bgmac->feature_flags |= BGMAC_FEAT_CLKCTLST; bgmac->feature_flags |= BGMAC_FEAT_FLW_CTRL1; bgmac->feature_flags |= BGMAC_FEAT_SW_TYPE_PHY; if (ci->pkg == 10) { bgmac->feature_flags |= BGMAC_FEAT_SW_TYPE_RGMII; bgmac->feature_flags |= BGMAC_FEAT_IOST_ATTACHED; } break; /* bcm4707_family */ case BCMA_CHIP_ID_BCM4707: case BCMA_CHIP_ID_BCM47094: case BCMA_CHIP_ID_BCM53018: bgmac->feature_flags |= BGMAC_FEAT_CLKCTLST; bgmac->feature_flags |= BGMAC_FEAT_NO_RESET; bgmac->feature_flags |= BGMAC_FEAT_FORCE_SPEED_2500; break; default: bgmac->feature_flags |= BGMAC_FEAT_CLKCTLST; bgmac->feature_flags |= BGMAC_FEAT_SET_RXQ_CLK; } if (!bgmac_is_bcm4707_family(core) && core->id.rev > 2) bgmac->feature_flags |= BGMAC_FEAT_MISC_PLL_REQ; if (core->id.id == BCMA_CORE_4706_MAC_GBIT) { bgmac->feature_flags |= BGMAC_FEAT_CMN_PHY_CTL; bgmac->feature_flags |= BGMAC_FEAT_NO_CLR_MIB; } if (core->id.rev >= 4) { bgmac->feature_flags |= BGMAC_FEAT_CMDCFG_SR_REV4; bgmac->feature_flags |= BGMAC_FEAT_TX_MASK_SETUP; bgmac->feature_flags |= BGMAC_FEAT_RX_MASK_SETUP; } bgmac->read = bcma_bgmac_read; bgmac->write = bcma_bgmac_write; bgmac->idm_read = bcma_bgmac_idm_read; bgmac->idm_write = bcma_bgmac_idm_write; bgmac->clk_enabled = bcma_bgmac_clk_enabled; bgmac->clk_enable = bcma_bgmac_clk_enable; bgmac->cco_ctl_maskset = bcma_bgmac_cco_ctl_maskset; bgmac->get_bus_clock = bcma_bgmac_get_bus_clock; bgmac->cmn_maskset32 = bcma_bgmac_cmn_maskset32; if (bgmac->mii_bus) bgmac->phy_connect = bcma_phy_connect; else bgmac->phy_connect = bgmac_phy_connect_direct; err = bgmac_enet_probe(bgmac); if (err) goto err1; return 0; err1: bcma_mdio_mii_unregister(bgmac->mii_bus); err: bcma_set_drvdata(core, NULL); return err; } static void bgmac_remove(struct bcma_device *core) { struct bgmac *bgmac = bcma_get_drvdata(core); bcma_mdio_mii_unregister(bgmac->mii_bus); bgmac_enet_remove(bgmac); bcma_set_drvdata(core, NULL); kfree(bgmac); } static struct bcma_driver bgmac_bcma_driver = { .name = KBUILD_MODNAME, .id_table = bgmac_bcma_tbl, .probe = bgmac_probe, .remove = bgmac_remove, }; static int __init bgmac_init(void) { int err; err = bcma_driver_register(&bgmac_bcma_driver); if (err) return err; pr_info("Broadcom 47xx GBit MAC driver loaded\n"); return 0; } static void __exit bgmac_exit(void) { bcma_driver_unregister(&bgmac_bcma_driver); } module_init(bgmac_init) module_exit(bgmac_exit) MODULE_AUTHOR("Rafał Miłecki"); MODULE_LICENSE("GPL");