2016-07-08 07:08:57 +08:00
|
|
|
/*
|
|
|
|
|
* Driver for (BCM4706)? GBit MAC core on BCMA bus.
|
|
|
|
|
*
|
|
|
|
|
* Copyright (C) 2012 Rafał Miłecki <zajec5@gmail.com>
|
|
|
|
|
*
|
|
|
|
|
* 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>
|
2021-10-03 01:58:11 +08:00
|
|
|
#include <linux/of_mdio.h>
|
2017-03-16 23:48:58 +08:00
|
|
|
#include <linux/of_net.h>
|
2016-07-08 07:08:57 +08:00
|
|
|
#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);
|
|
|
|
|
}
|
|
|
|
|
|
2016-11-04 13:11:00 +08:00
|
|
|
static int bcma_phy_connect(struct bgmac *bgmac)
|
|
|
|
|
{
|
|
|
|
|
struct phy_device *phy_dev;
|
|
|
|
|
char bus_id[MII_BUS_ID_SIZE + 3];
|
|
|
|
|
|
2021-10-03 01:58:11 +08:00
|
|
|
/* DT info should be the most accurate */
|
|
|
|
|
phy_dev = of_phy_get_and_connect(bgmac->net_dev, bgmac->dev->of_node,
|
|
|
|
|
bgmac_adjust_link);
|
|
|
|
|
if (phy_dev)
|
|
|
|
|
return 0;
|
|
|
|
|
|
2016-11-04 13:11:00 +08:00
|
|
|
/* Connect to the PHY */
|
2021-10-03 01:58:11 +08:00
|
|
|
if (bgmac->mii_bus && bgmac->phyaddr != BGMAC_PHY_NOREGS) {
|
|
|
|
|
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;
|
2016-11-04 13:11:00 +08:00
|
|
|
}
|
|
|
|
|
|
2021-10-03 01:58:11 +08:00
|
|
|
/* Assume a fixed link to the switch port */
|
|
|
|
|
return bgmac_phy_connect_direct(bgmac);
|
2016-11-04 13:11:00 +08:00
|
|
|
}
|
|
|
|
|
|
2016-07-08 07:08:57 +08:00
|
|
|
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)
|
|
|
|
|
{
|
2016-08-18 05:00:30 +08:00
|
|
|
struct bcma_chipinfo *ci = &core->bus->chipinfo;
|
2016-07-08 07:08:57 +08:00
|
|
|
struct ssb_sprom *sprom = &core->bus->sprom;
|
|
|
|
|
struct mii_bus *mii_bus;
|
|
|
|
|
struct bgmac *bgmac;
|
of: net: pass the dst buffer to of_get_mac_address()
of_get_mac_address() returns a "const void*" pointer to a MAC address.
Lately, support to fetch the MAC address by an NVMEM provider was added.
But this will only work with platform devices. It will not work with
PCI devices (e.g. of an integrated root complex) and esp. not with DSA
ports.
There is an of_* variant of the nvmem binding which works without
devices. The returned data of a nvmem_cell_read() has to be freed after
use. On the other hand the return of_get_mac_address() points to some
static data without a lifetime. The trick for now, was to allocate a
device resource managed buffer which is then returned. This will only
work if we have an actual device.
Change it, so that the caller of of_get_mac_address() has to supply a
buffer where the MAC address is written to. Unfortunately, this will
touch all drivers which use the of_get_mac_address().
Usually the code looks like:
const char *addr;
addr = of_get_mac_address(np);
if (!IS_ERR(addr))
ether_addr_copy(ndev->dev_addr, addr);
This can then be simply rewritten as:
of_get_mac_address(np, ndev->dev_addr);
Sometimes is_valid_ether_addr() is used to test the MAC address.
of_get_mac_address() already makes sure, it just returns a valid MAC
address. Thus we can just test its return code. But we have to be
careful if there are still other sources for the MAC address before the
of_get_mac_address(). In this case we have to keep the
is_valid_ether_addr() call.
The following coccinelle patch was used to convert common cases to the
new style. Afterwards, I've manually gone over the drivers and fixed the
return code variable: either used a new one or if one was already
available use that. Mansour Moufid, thanks for that coccinelle patch!
<spml>
@a@
identifier x;
expression y, z;
@@
- x = of_get_mac_address(y);
+ x = of_get_mac_address(y, z);
<...
- ether_addr_copy(z, x);
...>
@@
identifier a.x;
@@
- if (<+... x ...+>) {}
@@
identifier a.x;
@@
if (<+... x ...+>) {
...
}
- else {}
@@
identifier a.x;
expression e;
@@
- if (<+... x ...+>@e)
- {}
- else
+ if (!(e))
{...}
@@
expression x, y, z;
@@
- x = of_get_mac_address(y, z);
+ of_get_mac_address(y, z);
... when != x
</spml>
All drivers, except drivers/net/ethernet/aeroflex/greth.c, were
compile-time tested.
Suggested-by: Andrew Lunn <andrew@lunn.ch>
Signed-off-by: Michael Walle <michael@walle.cc>
Reviewed-by: Andrew Lunn <andrew@lunn.ch>
Signed-off-by: David S. Miller <davem@davemloft.net>
2021-04-13 01:47:17 +08:00
|
|
|
const u8 *mac;
|
2016-07-08 07:08:57 +08:00
|
|
|
int err;
|
|
|
|
|
|
2017-02-01 02:37:54 +08:00
|
|
|
bgmac = bgmac_alloc(&core->dev);
|
2016-07-08 07:08:57 +08:00
|
|
|
if (!bgmac)
|
|
|
|
|
return -ENOMEM;
|
|
|
|
|
|
|
|
|
|
bgmac->bcma.core = core;
|
|
|
|
|
bgmac->dma_dev = core->dma_dev;
|
|
|
|
|
bgmac->irq = core->irq;
|
|
|
|
|
|
|
|
|
|
bcma_set_drvdata(core, bgmac);
|
|
|
|
|
|
2021-10-07 09:06:56 +08:00
|
|
|
err = of_get_ethdev_address(bgmac->dev->of_node, bgmac->net_dev);
|
2021-09-19 19:57:25 +08:00
|
|
|
if (err == -EPROBE_DEFER)
|
|
|
|
|
return err;
|
2017-03-16 23:48:58 +08:00
|
|
|
|
|
|
|
|
/* If no MAC address assigned via device tree, check SPROM */
|
of: net: pass the dst buffer to of_get_mac_address()
of_get_mac_address() returns a "const void*" pointer to a MAC address.
Lately, support to fetch the MAC address by an NVMEM provider was added.
But this will only work with platform devices. It will not work with
PCI devices (e.g. of an integrated root complex) and esp. not with DSA
ports.
There is an of_* variant of the nvmem binding which works without
devices. The returned data of a nvmem_cell_read() has to be freed after
use. On the other hand the return of_get_mac_address() points to some
static data without a lifetime. The trick for now, was to allocate a
device resource managed buffer which is then returned. This will only
work if we have an actual device.
Change it, so that the caller of of_get_mac_address() has to supply a
buffer where the MAC address is written to. Unfortunately, this will
touch all drivers which use the of_get_mac_address().
Usually the code looks like:
const char *addr;
addr = of_get_mac_address(np);
if (!IS_ERR(addr))
ether_addr_copy(ndev->dev_addr, addr);
This can then be simply rewritten as:
of_get_mac_address(np, ndev->dev_addr);
Sometimes is_valid_ether_addr() is used to test the MAC address.
of_get_mac_address() already makes sure, it just returns a valid MAC
address. Thus we can just test its return code. But we have to be
careful if there are still other sources for the MAC address before the
of_get_mac_address(). In this case we have to keep the
is_valid_ether_addr() call.
The following coccinelle patch was used to convert common cases to the
new style. Afterwards, I've manually gone over the drivers and fixed the
return code variable: either used a new one or if one was already
available use that. Mansour Moufid, thanks for that coccinelle patch!
<spml>
@a@
identifier x;
expression y, z;
@@
- x = of_get_mac_address(y);
+ x = of_get_mac_address(y, z);
<...
- ether_addr_copy(z, x);
...>
@@
identifier a.x;
@@
- if (<+... x ...+>) {}
@@
identifier a.x;
@@
if (<+... x ...+>) {
...
}
- else {}
@@
identifier a.x;
expression e;
@@
- if (<+... x ...+>@e)
- {}
- else
+ if (!(e))
{...}
@@
expression x, y, z;
@@
- x = of_get_mac_address(y, z);
+ of_get_mac_address(y, z);
... when != x
</spml>
All drivers, except drivers/net/ethernet/aeroflex/greth.c, were
compile-time tested.
Suggested-by: Andrew Lunn <andrew@lunn.ch>
Signed-off-by: Michael Walle <michael@walle.cc>
Reviewed-by: Andrew Lunn <andrew@lunn.ch>
Signed-off-by: David S. Miller <davem@davemloft.net>
2021-04-13 01:47:17 +08:00
|
|
|
if (err) {
|
2017-03-16 23:48:58 +08:00
|
|
|
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;
|
|
|
|
|
}
|
2021-10-02 05:32:23 +08:00
|
|
|
eth_hw_addr_set(bgmac->net_dev, mac);
|
2016-07-08 07:08:57 +08:00
|
|
|
}
|
|
|
|
|
|
|
|
|
|
/* 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)" : "");
|
|
|
|
|
|
2016-08-18 05:00:30 +08:00
|
|
|
if (!bgmac_is_bcm4707_family(core) &&
|
|
|
|
|
!(ci->id == BCMA_CHIP_ID_BCM53573 && core->core_unit == 1)) {
|
2017-10-12 16:21:26 +08:00
|
|
|
struct phy_device *phydev;
|
|
|
|
|
|
2017-02-01 02:37:55 +08:00
|
|
|
mii_bus = bcma_mdio_mii_register(bgmac);
|
2016-08-17 21:37:14 +08:00
|
|
|
if (IS_ERR(mii_bus)) {
|
2016-07-08 07:08:57 +08:00
|
|
|
err = PTR_ERR(mii_bus);
|
|
|
|
|
goto err;
|
|
|
|
|
}
|
|
|
|
|
bgmac->mii_bus = mii_bus;
|
2017-10-12 16:21:26 +08:00
|
|
|
|
|
|
|
|
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;
|
2016-07-08 07:08:57 +08:00
|
|
|
}
|
|
|
|
|
|
|
|
|
|
if (core->bus->hosttype == BCMA_HOSTTYPE_PCI) {
|
|
|
|
|
dev_err(bgmac->dev, "PCI setup not implemented\n");
|
|
|
|
|
err = -ENOTSUPP;
|
|
|
|
|
goto err1;
|
|
|
|
|
}
|
|
|
|
|
|
2017-03-01 02:51:00 +08:00
|
|
|
bgmac->has_robosw = !!(sprom->boardflags_lo & BGMAC_BFL_ENETROBO);
|
2016-07-08 07:08:57 +08:00
|
|
|
if (bgmac->has_robosw)
|
|
|
|
|
dev_warn(bgmac->dev, "Support for Roboswitch not implemented\n");
|
|
|
|
|
|
2017-03-01 02:51:00 +08:00
|
|
|
if (sprom->boardflags_lo & BGMAC_BFL_ENETADM)
|
2016-07-08 07:08:57 +08:00
|
|
|
dev_warn(bgmac->dev, "Support for ADMtek ethernet switch not implemented\n");
|
|
|
|
|
|
|
|
|
|
/* Feature Flags */
|
2017-03-01 02:51:00 +08:00
|
|
|
switch (ci->id) {
|
|
|
|
|
/* BCM 471X/535X family */
|
|
|
|
|
case BCMA_CHIP_ID_BCM4716:
|
|
|
|
|
bgmac->feature_flags |= BGMAC_FEAT_CLKCTLST;
|
2020-08-24 06:36:59 +08:00
|
|
|
fallthrough;
|
2017-03-01 02:51:00 +08:00
|
|
|
case BCMA_CHIP_ID_BCM47162:
|
|
|
|
|
bgmac->feature_flags |= BGMAC_FEAT_FLW_CTRL2;
|
|
|
|
|
bgmac->feature_flags |= BGMAC_FEAT_SET_RXQ_CLK;
|
|
|
|
|
break;
|
2016-07-08 07:08:57 +08:00
|
|
|
case BCMA_CHIP_ID_BCM5357:
|
2017-03-01 02:51:00 +08:00
|
|
|
case BCMA_CHIP_ID_BCM53572:
|
2016-07-08 07:08:57 +08:00
|
|
|
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;
|
2017-03-01 02:51:00 +08:00
|
|
|
if (ci->pkg == BCMA_PKG_ID_BCM47188 ||
|
|
|
|
|
ci->pkg == BCMA_PKG_ID_BCM47186) {
|
2016-07-08 07:08:57 +08:00
|
|
|
bgmac->feature_flags |= BGMAC_FEAT_SW_TYPE_RGMII;
|
2017-03-01 02:51:00 +08:00
|
|
|
bgmac->feature_flags |= BGMAC_FEAT_IOST_ATTACHED;
|
2016-07-08 07:08:57 +08:00
|
|
|
}
|
2017-03-01 02:51:00 +08:00
|
|
|
if (ci->pkg == BCMA_PKG_ID_BCM5358)
|
2016-07-08 07:08:57 +08:00
|
|
|
bgmac->feature_flags |= BGMAC_FEAT_SW_TYPE_EPHYRMII;
|
|
|
|
|
break;
|
2017-03-01 02:51:00 +08:00
|
|
|
case BCMA_CHIP_ID_BCM53573:
|
2016-07-08 07:08:57 +08:00
|
|
|
bgmac->feature_flags |= BGMAC_FEAT_CLKCTLST;
|
2017-03-01 02:51:00 +08:00
|
|
|
bgmac->feature_flags |= BGMAC_FEAT_SET_RXQ_CLK;
|
|
|
|
|
if (ci->pkg == BCMA_PKG_ID_BCM47189)
|
2016-07-08 07:08:57 +08:00
|
|
|
bgmac->feature_flags |= BGMAC_FEAT_IOST_ATTACHED;
|
2017-03-01 02:51:00 +08:00
|
|
|
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;
|
2016-07-08 07:08:57 +08:00
|
|
|
}
|
|
|
|
|
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;
|
2017-03-01 02:51:00 +08:00
|
|
|
if (ci->pkg == 10) {
|
2016-07-08 07:08:57 +08:00
|
|
|
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;
|
2021-10-03 01:58:11 +08:00
|
|
|
bgmac->phy_connect = bcma_phy_connect;
|
2016-07-08 07:08:57 +08:00
|
|
|
|
|
|
|
|
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");
|
