[PATCH 4/5] net: dsa: lantiq: Add fast age function

[Hauke Mehrtens]

Fast aging per port is not supported directly by the hardware, it is
only possible to configure a global aging time.

Do the fast aging by iterating over the MAC forwarding table and remove
all dynamic entries for a given port.

Signed-off-by: Hauke Mehrtens <ha...@hauke-m.de>
---
 drivers/net/dsa/lantiq_gswip.c | 38 ++++++++++++++++++++++++++++++++++
 1 file changed, 38 insertions(+)

diff --git a/drivers/net/dsa/lantiq_gswip.c b/drivers/net/dsa/lantiq_gswip.c
index 23686b8399ea..ef8e2a827e16 100644
--- a/drivers/net/dsa/lantiq_gswip.c
+++ b/drivers/net/dsa/lantiq_gswip.c
@@ -1221,6 +1221,43 @@ static int gswip_port_vlan_del(struct dsa_switch *ds, 
int port,
        return 0;
 }
 
+static void gswip_port_fast_age(struct dsa_switch *ds, int port)
+{
+       struct gswip_priv *priv = ds->priv;
+       struct gswip_pce_table_entry mac_bridge = {0,};
+       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 read mac brigde: %d\n",
+                               err);
+                       return;
+               }
+
+               if (!mac_bridge.valid)
+                       continue;
+
+               if (mac_bridge.val[1] & 0x01)
+                       continue;
+
+               if (((mac_bridge.val[0] & GENMASK(7, 4)) >> 4) != port)
+                       continue;
+
+               mac_bridge.valid = false;
+               err = gswip_pce_table_entry_write(priv, &mac_bridge);
+               if (err) {
+                       dev_err(priv->dev, "failed to write mac brigde: %d\n",
+                               err);
+                       return;
+               }
+       }
+}
+
 static void gswip_port_stp_state_set(struct dsa_switch *ds, int port, u8 state)
 {
        struct gswip_priv *priv = ds->priv;
@@ -1461,6 +1498,7 @@ static const struct dsa_switch_ops gswip_switch_ops = {
        .port_disable           = gswip_port_disable,
        .port_bridge_join       = gswip_port_bridge_join,
        .port_bridge_leave      = gswip_port_bridge_leave,
+       .port_fast_age          = gswip_port_fast_age,
        .port_vlan_filtering    = gswip_port_vlan_filtering,
        .port_vlan_prepare      = gswip_port_vlan_prepare,
        .port_vlan_add          = gswip_port_vlan_add,
-- 
2.20.1