forked from Qortal/Brooklyn
You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
357 lines
9.2 KiB
357 lines
9.2 KiB
/* |
|
* Driver for (BCM4706)? GBit MAC core on BCMA bus. |
|
* |
|
* Copyright (C) 2012 Rafał Miłecki <[email protected]> |
|
* |
|
* Licensed under the GNU/GPL. See COPYING for details. |
|
*/ |
|
|
|
#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt |
|
|
|
#include <linux/bcma/bcma.h> |
|
#include <linux/brcmphy.h> |
|
#include <linux/etherdevice.h> |
|
#include <linux/of_net.h> |
|
#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; |
|
const 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); |
|
|
|
err = of_get_mac_address(bgmac->dev->of_node, bgmac->net_dev->dev_addr); |
|
if (err == -EPROBE_DEFER) |
|
return err; |
|
|
|
/* If no MAC address assigned via device tree, check SPROM */ |
|
if (err) { |
|
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)) { |
|
struct phy_device *phydev; |
|
|
|
mii_bus = bcma_mdio_mii_register(bgmac); |
|
if (IS_ERR(mii_bus)) { |
|
err = PTR_ERR(mii_bus); |
|
goto err; |
|
} |
|
bgmac->mii_bus = mii_bus; |
|
|
|
phydev = mdiobus_get_phy(bgmac->mii_bus, bgmac->phyaddr); |
|
if (ci->id == BCMA_CHIP_ID_BCM53573 && phydev && |
|
(phydev->drv->phy_id & phydev->drv->phy_id_mask) == PHY_ID_BCM54210E) |
|
phydev->dev_flags |= PHY_BRCM_EN_MASTER_MODE; |
|
} |
|
|
|
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");
|
|
|