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>

diff --git a/drivers/net/dsa/lantiq_gswip.c b/drivers/net/dsa/lantiq_gswip.c
index 80afd3b..553831d 100644 (file)
--- a/drivers/net/dsa/lantiq_gswip.c
+++ b/drivers/net/dsa/lantiq_gswip.c
@@ -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,