net: dsa: lantiq: Add Forwarding Database access
This adds functions to add and remove static entries to and from the forwarding database and dump the full forwarding database. Signed-off-by: Hauke Mehrtens <hauke@hauke-m.de> Reviewed-by: Florian Fainelli <f.fainelli@gmail.com> Signed-off-by: David S. Miller <davem@davemloft.net>
This commit is contained in:
parent
4581348199
commit
58c59ef9e9
@ -1290,6 +1290,101 @@ static void gswip_port_stp_state_set(struct dsa_switch *ds, int port, u8 state)
|
||||
GSWIP_PCE_PCTRL_0p(port));
|
||||
}
|
||||
|
||||
static int gswip_port_fdb(struct dsa_switch *ds, int port,
|
||||
const unsigned char *addr, u16 vid, bool add)
|
||||
{
|
||||
struct gswip_priv *priv = ds->priv;
|
||||
struct net_device *bridge = dsa_to_port(ds, port)->bridge_dev;
|
||||
struct gswip_pce_table_entry mac_bridge = {0,};
|
||||
unsigned int cpu_port = priv->hw_info->cpu_port;
|
||||
int fid = -1;
|
||||
int i;
|
||||
int err;
|
||||
|
||||
if (!bridge)
|
||||
return -EINVAL;
|
||||
|
||||
for (i = cpu_port; i < ARRAY_SIZE(priv->vlans); i++) {
|
||||
if (priv->vlans[i].bridge == bridge) {
|
||||
fid = priv->vlans[i].fid;
|
||||
break;
|
||||
}
|
||||
}
|
||||
|
||||
if (fid == -1) {
|
||||
dev_err(priv->dev, "Port not part of a bridge\n");
|
||||
return -EINVAL;
|
||||
}
|
||||
|
||||
mac_bridge.table = GSWIP_TABLE_MAC_BRIDGE;
|
||||
mac_bridge.key_mode = true;
|
||||
mac_bridge.key[0] = addr[5] | (addr[4] << 8);
|
||||
mac_bridge.key[1] = addr[3] | (addr[2] << 8);
|
||||
mac_bridge.key[2] = addr[1] | (addr[0] << 8);
|
||||
mac_bridge.key[3] = fid;
|
||||
mac_bridge.val[0] = add ? BIT(port) : 0; /* port map */
|
||||
mac_bridge.val[1] = GSWIP_TABLE_MAC_BRIDGE_STATIC;
|
||||
mac_bridge.valid = add;
|
||||
|
||||
err = gswip_pce_table_entry_write(priv, &mac_bridge);
|
||||
if (err)
|
||||
dev_err(priv->dev, "failed to write mac brigde: %d\n", err);
|
||||
|
||||
return err;
|
||||
}
|
||||
|
||||
static int gswip_port_fdb_add(struct dsa_switch *ds, int port,
|
||||
const unsigned char *addr, u16 vid)
|
||||
{
|
||||
return gswip_port_fdb(ds, port, addr, vid, true);
|
||||
}
|
||||
|
||||
static int gswip_port_fdb_del(struct dsa_switch *ds, int port,
|
||||
const unsigned char *addr, u16 vid)
|
||||
{
|
||||
return gswip_port_fdb(ds, port, addr, vid, false);
|
||||
}
|
||||
|
||||
static int gswip_port_fdb_dump(struct dsa_switch *ds, int port,
|
||||
dsa_fdb_dump_cb_t *cb, void *data)
|
||||
{
|
||||
struct gswip_priv *priv = ds->priv;
|
||||
struct gswip_pce_table_entry mac_bridge = {0,};
|
||||
unsigned char addr[6];
|
||||
int i;
|
||||
int err;
|
||||
|
||||
for (i = 0; i < 2048; i++) {
|
||||
mac_bridge.table = GSWIP_TABLE_MAC_BRIDGE;
|
||||
mac_bridge.index = i;
|
||||
|
||||
err = gswip_pce_table_entry_read(priv, &mac_bridge);
|
||||
if (err) {
|
||||
dev_err(priv->dev, "failed to write mac brigde: %d\n",
|
||||
err);
|
||||
return err;
|
||||
}
|
||||
|
||||
if (!mac_bridge.valid)
|
||||
continue;
|
||||
|
||||
addr[5] = mac_bridge.key[0] & 0xff;
|
||||
addr[4] = (mac_bridge.key[0] >> 8) & 0xff;
|
||||
addr[3] = mac_bridge.key[1] & 0xff;
|
||||
addr[2] = (mac_bridge.key[1] >> 8) & 0xff;
|
||||
addr[1] = mac_bridge.key[2] & 0xff;
|
||||
addr[0] = (mac_bridge.key[2] >> 8) & 0xff;
|
||||
if (mac_bridge.val[1] & GSWIP_TABLE_MAC_BRIDGE_STATIC) {
|
||||
if (mac_bridge.val[0] & BIT(port))
|
||||
cb(addr, 0, true, data);
|
||||
} else {
|
||||
if (((mac_bridge.val[0] & GENMASK(7, 4)) >> 4) == port)
|
||||
cb(addr, 0, false, data);
|
||||
}
|
||||
}
|
||||
return 0;
|
||||
}
|
||||
|
||||
static void gswip_phylink_validate(struct dsa_switch *ds, int port,
|
||||
unsigned long *supported,
|
||||
struct phylink_link_state *state)
|
||||
@ -1505,6 +1600,9 @@ static const struct dsa_switch_ops gswip_switch_ops = {
|
||||
.port_vlan_add = gswip_port_vlan_add,
|
||||
.port_vlan_del = gswip_port_vlan_del,
|
||||
.port_stp_state_set = gswip_port_stp_state_set,
|
||||
.port_fdb_add = gswip_port_fdb_add,
|
||||
.port_fdb_del = gswip_port_fdb_del,
|
||||
.port_fdb_dump = gswip_port_fdb_dump,
|
||||
.phylink_validate = gswip_phylink_validate,
|
||||
.phylink_mac_config = gswip_phylink_mac_config,
|
||||
.phylink_mac_link_down = gswip_phylink_mac_link_down,
|
||||
|
Loading…
Reference in New Issue
Block a user