bcm63xx: expose the internal switch to b53
Allow b53 access to the internal switch of BCM6328, BCM6362 and BCM6368. Signed-off-by: Jonas Gorski <jogo@openwrt.org> SVN-Revision: 35306
This commit is contained in:
Jonas Gorski
parent
bb0118c66f
commit
17d51121a6
1 changed files with 169 additions and 0 deletions
|
|
@ -0,0 +1,169 @@
|
||||||
|
--- a/drivers/net/ethernet/broadcom/bcm63xx_enet.h
|
||||||
|
+++ b/drivers/net/ethernet/broadcom/bcm63xx_enet.h
|
||||||
|
@@ -364,6 +364,9 @@ struct bcm_enet_priv {
|
||||||
|
struct bcm63xx_enetsw_port used_ports[ENETSW_MAX_PORT];
|
||||||
|
int sw_port_link[ENETSW_MAX_PORT];
|
||||||
|
|
||||||
|
+ /* platform device for associated switch */
|
||||||
|
+ struct platform_device *b53_device;
|
||||||
|
+
|
||||||
|
/* used to poll switch port state */
|
||||||
|
struct timer_list swphy_poll;
|
||||||
|
spinlock_t enetsw_mdio_lock;
|
||||||
|
--- a/drivers/net/ethernet/broadcom/bcm63xx_enet.c
|
||||||
|
+++ b/drivers/net/ethernet/broadcom/bcm63xx_enet.c
|
||||||
|
@@ -30,6 +30,7 @@
|
||||||
|
#include <linux/dma-mapping.h>
|
||||||
|
#include <linux/platform_device.h>
|
||||||
|
#include <linux/if_vlan.h>
|
||||||
|
+#include <linux/platform_data/b53.h>
|
||||||
|
|
||||||
|
#include <bcm63xx_dev_enet.h>
|
||||||
|
#include "bcm63xx_enet.h"
|
||||||
|
@@ -2013,7 +2014,8 @@ static int __devexit bcm_enet_remove(str
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
-struct platform_driver bcm63xx_enet_driver = {
|
||||||
|
+
|
||||||
|
+static struct platform_driver bcm63xx_enet_driver = {
|
||||||
|
.probe = bcm_enet_probe,
|
||||||
|
.remove = __devexit_p(bcm_enet_remove),
|
||||||
|
.driver = {
|
||||||
|
@@ -2022,6 +2024,42 @@ struct platform_driver bcm63xx_enet_driv
|
||||||
|
},
|
||||||
|
};
|
||||||
|
|
||||||
|
+struct b53_platform_data bcm63xx_b53_pdata = {
|
||||||
|
+ .chip_id = 0x6300,
|
||||||
|
+ .big_endian = 1,
|
||||||
|
+};
|
||||||
|
+
|
||||||
|
+struct platform_device bcm63xx_b53_dev = {
|
||||||
|
+ .name = "b53-switch",
|
||||||
|
+ .id = -1,
|
||||||
|
+ .dev = {
|
||||||
|
+ .platform_data = &bcm63xx_b53_pdata,
|
||||||
|
+ },
|
||||||
|
+};
|
||||||
|
+
|
||||||
|
+static int bcmenet_switch_register(struct bcm_enet_priv *priv, u16 port_mask)
|
||||||
|
+{
|
||||||
|
+ int ret;
|
||||||
|
+
|
||||||
|
+ bcm63xx_b53_pdata.regs = priv->base;
|
||||||
|
+ bcm63xx_b53_pdata.enabled_ports = port_mask;
|
||||||
|
+ bcm63xx_b53_pdata.alias = priv->net_dev->name;
|
||||||
|
+
|
||||||
|
+ ret = platform_device_register(&bcm63xx_b53_dev);
|
||||||
|
+ if (!ret)
|
||||||
|
+ priv->b53_device = &bcm63xx_b53_dev;
|
||||||
|
+
|
||||||
|
+ return ret;
|
||||||
|
+}
|
||||||
|
+
|
||||||
|
+static void bcmenet_switch_unregister(struct bcm_enet_priv *priv)
|
||||||
|
+{
|
||||||
|
+ if (priv->b53_device)
|
||||||
|
+ platform_device_unregister(&bcm63xx_b53_dev);
|
||||||
|
+
|
||||||
|
+ priv->b53_device = NULL;
|
||||||
|
+}
|
||||||
|
+
|
||||||
|
/*
|
||||||
|
* switch mii access callbacks
|
||||||
|
*/
|
||||||
|
@@ -2270,29 +2308,6 @@ static int bcm_enetsw_open(struct net_de
|
||||||
|
enetsw_writeb(priv, rgmii_ctrl, ENETSW_RGMII_CTRL_REG(i));
|
||||||
|
}
|
||||||
|
|
||||||
|
- /* reset mib */
|
||||||
|
- val = enetsw_readb(priv, ENETSW_GMCR_REG);
|
||||||
|
- val |= ENETSW_GMCR_RST_MIB_MASK;
|
||||||
|
- enetsw_writeb(priv, val, ENETSW_GMCR_REG);
|
||||||
|
- mdelay(1);
|
||||||
|
- val &= ~ENETSW_GMCR_RST_MIB_MASK;
|
||||||
|
- enetsw_writeb(priv, val, ENETSW_GMCR_REG);
|
||||||
|
- mdelay(1);
|
||||||
|
-
|
||||||
|
- /* force CPU port state */
|
||||||
|
- val = enetsw_readb(priv, ENETSW_IMPOV_REG);
|
||||||
|
- val |= ENETSW_IMPOV_FORCE_MASK | ENETSW_IMPOV_LINKUP_MASK;
|
||||||
|
- enetsw_writeb(priv, val, ENETSW_IMPOV_REG);
|
||||||
|
-
|
||||||
|
- /* enable switch forward engine */
|
||||||
|
- val = enetsw_readb(priv, ENETSW_SWMODE_REG);
|
||||||
|
- val |= ENETSW_SWMODE_FWD_EN_MASK;
|
||||||
|
- enetsw_writeb(priv, val, ENETSW_SWMODE_REG);
|
||||||
|
-
|
||||||
|
- /* enable jumbo on all ports */
|
||||||
|
- enetsw_writel(priv, 0x1ff, ENETSW_JMBCTL_PORT_REG);
|
||||||
|
- enetsw_writew(priv, 9728, ENETSW_JMBCTL_MAXSIZE_REG);
|
||||||
|
-
|
||||||
|
/* initialize flow control buffer allocation */
|
||||||
|
enet_dma_writel(priv, ENETDMA_BUFALLOC_FORCE_MASK | 0,
|
||||||
|
ENETDMA_BUFALLOC_REG(priv->rx_chan));
|
||||||
|
@@ -2760,6 +2775,9 @@ static int __devinit bcm_enetsw_probe(st
|
||||||
|
struct bcm63xx_enetsw_platform_data *pd;
|
||||||
|
struct resource *res_mem;
|
||||||
|
int ret, irq_rx, irq_tx;
|
||||||
|
+ unsigned i, num_ports = 0;
|
||||||
|
+ u16 port_mask = BIT(8);
|
||||||
|
+ u8 val;
|
||||||
|
|
||||||
|
/* stop if shared driver failed, assume driver->probe will be
|
||||||
|
* called in the same order we register devices (correct ?) */
|
||||||
|
@@ -2847,6 +2865,43 @@ static int __devinit bcm_enetsw_probe(st
|
||||||
|
priv->pdev = pdev;
|
||||||
|
priv->net_dev = dev;
|
||||||
|
|
||||||
|
+ /* reset mib */
|
||||||
|
+ val = enetsw_readb(priv, ENETSW_GMCR_REG);
|
||||||
|
+ val |= ENETSW_GMCR_RST_MIB_MASK;
|
||||||
|
+ enetsw_writeb(priv, val, ENETSW_GMCR_REG);
|
||||||
|
+ mdelay(1);
|
||||||
|
+ val &= ~ENETSW_GMCR_RST_MIB_MASK;
|
||||||
|
+ enetsw_writeb(priv, val, ENETSW_GMCR_REG);
|
||||||
|
+ mdelay(1);
|
||||||
|
+
|
||||||
|
+ /* force CPU port state */
|
||||||
|
+ val = enetsw_readb(priv, ENETSW_IMPOV_REG);
|
||||||
|
+ val |= ENETSW_IMPOV_FORCE_MASK | ENETSW_IMPOV_LINKUP_MASK;
|
||||||
|
+ enetsw_writeb(priv, val, ENETSW_IMPOV_REG);
|
||||||
|
+
|
||||||
|
+ /* enable switch forward engine */
|
||||||
|
+ val = enetsw_readb(priv, ENETSW_SWMODE_REG);
|
||||||
|
+ val |= ENETSW_SWMODE_FWD_EN_MASK;
|
||||||
|
+ enetsw_writeb(priv, val, ENETSW_SWMODE_REG);
|
||||||
|
+
|
||||||
|
+ /* enable jumbo on all ports */
|
||||||
|
+ enetsw_writel(priv, 0x1ff, ENETSW_JMBCTL_PORT_REG);
|
||||||
|
+ enetsw_writew(priv, 9728, ENETSW_JMBCTL_MAXSIZE_REG);
|
||||||
|
+
|
||||||
|
+ for (i = 0; i < priv->num_ports; i++) {
|
||||||
|
+ struct bcm63xx_enetsw_port *port = &priv->used_ports[i];
|
||||||
|
+
|
||||||
|
+ if (!port->used)
|
||||||
|
+ continue;
|
||||||
|
+
|
||||||
|
+ num_ports++;
|
||||||
|
+ port_mask |= BIT(i);
|
||||||
|
+ }
|
||||||
|
+
|
||||||
|
+ /* only register if there is more than one external port */
|
||||||
|
+ if (num_ports > 1)
|
||||||
|
+ bcmenet_switch_register(priv, port_mask);
|
||||||
|
+
|
||||||
|
return 0;
|
||||||
|
|
||||||
|
out_put_clk:
|
||||||
|
@@ -2877,6 +2932,9 @@ static int __devexit bcm_enetsw_remove(s
|
||||||
|
priv = netdev_priv(dev);
|
||||||
|
unregister_netdev(dev);
|
||||||
|
|
||||||
|
+ /* remove switch */
|
||||||
|
+ bcmenet_switch_unregister(priv);
|
||||||
|
+
|
||||||
|
/* release device resources */
|
||||||
|
iounmap(priv->base);
|
||||||
|
res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
|
||||||
Loading…
Reference in a new issue