[PATCH v2 net-next 8/9] net: dsa: microchip: add support for fdb and mdb management
From: Prasanna Vengateshan
Date: Thu Apr 22 2021 - 05:44:06 EST
Support for fdb_add, mdb_add, fdb_del, mdb_del and
fdb_dump operations
It aligns with latest update of removing switchdev
transactional logic from mdb entries
Signed-off-by: Prasanna Vengateshan <prasanna.vengateshan@xxxxxxxxxxxxx>
---
drivers/net/dsa/microchip/lan937x_main.c | 516 +++++++++++++++++++++++
1 file changed, 516 insertions(+)
diff --git a/drivers/net/dsa/microchip/lan937x_main.c b/drivers/net/dsa/microchip/lan937x_main.c
index bfce5098ea69..7f6183dc0e31 100644
--- a/drivers/net/dsa/microchip/lan937x_main.c
+++ b/drivers/net/dsa/microchip/lan937x_main.c
@@ -14,6 +14,68 @@
#include "ksz_common.h"
#include "lan937x_dev.h"
+static int lan937x_read_table(struct ksz_device *dev, u32 *table)
+{
+ int rc;
+
+ /* read alu table */
+ rc = ksz_read32(dev, REG_SW_ALU_VAL_A, &table[0]);
+ if (rc < 0)
+ return rc;
+
+ rc = ksz_read32(dev, REG_SW_ALU_VAL_B, &table[1]);
+ if (rc < 0)
+ return rc;
+
+ rc = ksz_read32(dev, REG_SW_ALU_VAL_C, &table[2]);
+ if (rc < 0)
+ return rc;
+
+ rc = ksz_read32(dev, REG_SW_ALU_VAL_D, &table[3]);
+
+ return rc;
+}
+
+static int lan937x_write_table(struct ksz_device *dev, u32 *table)
+{
+ int rc;
+
+ /* write alu table */
+ rc = ksz_write32(dev, REG_SW_ALU_VAL_A, table[0]);
+ if (rc < 0)
+ return rc;
+
+ rc = ksz_write32(dev, REG_SW_ALU_VAL_B, table[1]);
+ if (rc < 0)
+ return rc;
+
+ rc = ksz_write32(dev, REG_SW_ALU_VAL_C, table[2]);
+ if (rc < 0)
+ return rc;
+
+ rc = ksz_write32(dev, REG_SW_ALU_VAL_D, table[3]);
+
+ return rc;
+}
+
+static int lan937x_wait_alu_ready(int alu, struct ksz_device *dev)
+{
+ unsigned int val;
+
+ return regmap_read_poll_timeout(dev->regmap[2], REG_SW_ALU_CTRL(alu),
+ val, !(val & ALU_START), 10, 1000);
+}
+
+static int lan937x_wait_alu_sta_ready(struct ksz_device *dev)
+{
+ unsigned int val;
+
+ return regmap_read_poll_timeout(dev->regmap[2],
+ REG_SW_ALU_STAT_CTRL__4,
+ val, !(val & ALU_STAT_START),
+ 10, 1000);
+}
+
static enum dsa_tag_protocol lan937x_get_tag_protocol(struct dsa_switch *ds,
int port,
enum dsa_tag_protocol mp)
@@ -128,6 +190,455 @@ static void lan937x_port_stp_state_set(struct dsa_switch *ds, int port,
mutex_unlock(&dev->dev_mutex);
}
+static u8 lan937x_get_fid(u16 vid)
+{
+ if (vid > ALU_FID_SIZE)
+ return LAN937X_GET_FID(vid);
+ else
+ return vid;
+}
+
+static int lan937x_port_fdb_add(struct dsa_switch *ds, int port,
+ const unsigned char *addr, u16 vid)
+{
+ struct ksz_device *dev = ds->priv;
+ u8 fid = lan937x_get_fid(vid);
+ u32 alu_table[4];
+ int rc, i;
+ u32 data;
+ u8 val;
+
+ mutex_lock(&dev->alu_mutex);
+
+ for (i = 0; i < ALU_STA_DYN_CNT; i++) {
+ /* find any entry with mac & fid */
+ data = fid << ALU_FID_INDEX_S;
+ data |= ((addr[0] << 8) | addr[1]);
+
+ rc = ksz_write32(dev, REG_SW_ALU_INDEX_0, data);
+ if (rc < 0)
+ goto exit;
+
+ data = ((addr[2] << 24) | (addr[3] << 16));
+ data |= ((addr[4] << 8) | addr[5]);
+
+ rc = ksz_write32(dev, REG_SW_ALU_INDEX_1, data);
+ if (rc < 0)
+ goto exit;
+
+ /* start read operation */
+ rc = ksz_write32(dev, REG_SW_ALU_CTRL(i), ALU_READ | ALU_START);
+ if (rc < 0)
+ goto exit;
+
+ /* wait to be finished */
+ rc = lan937x_wait_alu_ready(i, dev);
+ if (rc < 0) {
+ dev_err(dev->dev, "Failed to read ALU\n");
+ goto exit;
+ }
+
+ /* read ALU entry */
+ rc = lan937x_read_table(dev, alu_table);
+ if (rc < 0) {
+ dev_err(dev->dev, "Failed to read ALU\n");
+ goto exit;
+ }
+
+ /* update ALU entry */
+ alu_table[0] = ALU_V_STATIC_VALID;
+
+ /* update port number */
+ alu_table[1] |= BIT(port);
+
+ if (fid)
+ alu_table[1] |= ALU_V_USE_FID;
+ alu_table[2] = (fid << ALU_V_FID_S);
+ alu_table[2] |= ((addr[0] << 8) | addr[1]);
+ alu_table[3] = ((addr[2] << 24) | (addr[3] << 16));
+ alu_table[3] |= ((addr[4] << 8) | addr[5]);
+
+ rc = lan937x_write_table(dev, alu_table);
+ if (rc < 0)
+ goto exit;
+
+ rc = ksz_write32(dev, REG_SW_ALU_CTRL(i), ALU_WRITE | ALU_START);
+ if (rc < 0)
+ goto exit;
+
+ /* wait to be finished */
+ rc = lan937x_wait_alu_ready(i, dev);
+
+ if (rc < 0) {
+ dev_err(dev->dev, "Failed to write ALU\n");
+ goto exit;
+ }
+
+ rc = ksz_read8(dev, REG_SW_LUE_INT_STATUS__1, &val);
+ if (rc < 0)
+ goto exit;
+
+ /* ALU write failed & do not return before checking ALU2*/
+ if (val & WRITE_FAIL_INT && i == 1)
+ dev_err(dev->dev, "Failed to write ALU\n");
+
+ /* ALU1 write failed and attempt to write ALU2, otherwise exit*/
+ if (val & WRITE_FAIL_INT) {
+ /* Write to clear the Write Fail */
+ rc = ksz_write8(dev, REG_SW_LUE_INT_STATUS__1, WRITE_FAIL_INT);
+ if (rc < 0)
+ goto exit;
+ } else {
+ goto exit;
+ }
+ }
+
+exit:
+ mutex_unlock(&dev->alu_mutex);
+
+ return rc;
+}
+
+static int lan937x_port_fdb_del(struct dsa_switch *ds, int port,
+ const unsigned char *addr, u16 vid)
+{
+ struct ksz_device *dev = ds->priv;
+ u8 fid = lan937x_get_fid(vid);
+ u32 alu_table[4];
+ int rc, i;
+ u32 data;
+
+ mutex_lock(&dev->alu_mutex);
+
+ for (i = 0; i < ALU_STA_DYN_CNT; i++) {
+ /* read any entry with mac & fid */
+ data = fid << ALU_FID_INDEX_S;
+ data |= ((addr[0] << 8) | addr[1]);
+ rc = ksz_write32(dev, REG_SW_ALU_INDEX_0, data);
+ if (rc < 0)
+ goto exit;
+
+ data = ((addr[2] << 24) | (addr[3] << 16));
+ data |= ((addr[4] << 8) | addr[5]);
+ rc = ksz_write32(dev, REG_SW_ALU_INDEX_1, data);
+ if (rc < 0)
+ goto exit;
+
+ /* start read operation */
+ rc = ksz_write32(dev, REG_SW_ALU_CTRL(i), ALU_READ | ALU_START);
+ if (rc < 0)
+ goto exit;
+
+ /* wait to be finished */
+ rc = lan937x_wait_alu_ready(i, dev);
+ if (rc < 0) {
+ dev_err(dev->dev, "Failed to read ALU\n");
+ goto exit;
+ }
+
+ rc = ksz_read32(dev, REG_SW_ALU_VAL_A, &alu_table[0]);
+ if (rc < 0)
+ goto exit;
+
+ if (alu_table[0] & ALU_V_STATIC_VALID) {
+ /* read ALU entry */
+ rc = lan937x_read_table(dev, alu_table);
+ if (rc < 0) {
+ dev_err(dev->dev, "Failed to read ALU\n");
+ goto exit;
+ }
+
+ /* clear forwarding port */
+ alu_table[1] &= ~BIT(port);
+
+ /* if there is no port to forward, clear table */
+ if ((alu_table[1] & ALU_V_PORT_MAP) == 0) {
+ alu_table[0] = 0;
+ alu_table[1] = 0;
+ alu_table[2] = 0;
+ alu_table[3] = 0;
+ }
+ } else {
+ alu_table[0] = 0;
+ alu_table[1] = 0;
+ alu_table[2] = 0;
+ alu_table[3] = 0;
+ }
+
+ rc = lan937x_write_table(dev, alu_table);
+ if (rc < 0)
+ goto exit;
+
+ rc = ksz_write32(dev, REG_SW_ALU_CTRL(i), ALU_WRITE | ALU_START);
+ if (rc < 0)
+ goto exit;
+
+ /* wait to be finished */
+ rc = lan937x_wait_alu_ready(i, dev);
+ if (rc < 0)
+ dev_err(dev->dev, "Failed to write ALU\n");
+ }
+
+exit:
+ mutex_unlock(&dev->alu_mutex);
+
+ return rc;
+}
+
+static void lan937x_convert_alu(struct lan_alu_struct *alu, u32 *alu_table)
+{
+ alu->is_static = !!(alu_table[0] & ALU_V_STATIC_VALID);
+ alu->is_src_filter = !!(alu_table[0] & ALU_V_SRC_FILTER);
+ alu->is_dst_filter = !!(alu_table[0] & ALU_V_DST_FILTER);
+ alu->prio_age = (alu_table[0] >> ALU_V_PRIO_AGE_CNT_S) &
+ ALU_V_PRIO_AGE_CNT_M;
+ alu->mstp = alu_table[0] & ALU_V_MSTP_M;
+
+ alu->is_override = !!(alu_table[1] & ALU_V_OVERRIDE);
+ alu->is_use_fid = !!(alu_table[1] & ALU_V_USE_FID);
+ alu->port_forward = alu_table[1] & ALU_V_PORT_MAP;
+
+ alu->fid = (alu_table[2] >> ALU_V_FID_S) & ALU_V_FID_M;
+
+ alu->mac[0] = (alu_table[2] >> 8) & 0xFF;
+ alu->mac[1] = alu_table[2] & 0xFF;
+ alu->mac[2] = (alu_table[3] >> 24) & 0xFF;
+ alu->mac[3] = (alu_table[3] >> 16) & 0xFF;
+ alu->mac[4] = (alu_table[3] >> 8) & 0xFF;
+ alu->mac[5] = alu_table[3] & 0xFF;
+}
+
+static int lan937x_port_fdb_dump(struct dsa_switch *ds, int port,
+ dsa_fdb_dump_cb_t *cb, void *data)
+{
+ struct ksz_device *dev = ds->priv;
+ struct lan_alu_struct alu;
+ u32 lan937x_data;
+ u32 alu_table[4];
+ int timeout;
+ int rc, i;
+
+ mutex_lock(&dev->alu_mutex);
+
+ for (i = 0; i < ALU_STA_DYN_CNT; i++) {
+ /* start ALU search */
+ rc = ksz_write32(dev, REG_SW_ALU_CTRL(i), ALU_START | ALU_SEARCH);
+
+ if (rc < 0)
+ goto exit;
+
+ do {
+ timeout = 1000;
+ do {
+ rc = ksz_read32(dev, REG_SW_ALU_CTRL(i), &lan937x_data);
+
+ if (rc < 0)
+ goto exit;
+
+ if ((lan937x_data & ALU_VALID) || !(lan937x_data & ALU_START))
+ break;
+ usleep_range(1, 10);
+ } while (timeout-- > 0);
+
+ if (!timeout) {
+ dev_err(dev->dev, "Failed to search ALU\n");
+ rc = -ETIMEDOUT;
+ goto exit;
+ }
+
+ /* read ALU table */
+ rc = lan937x_read_table(dev, alu_table);
+ if (rc < 0)
+ goto exit;
+
+ lan937x_convert_alu(&alu, alu_table);
+
+ if (alu.port_forward & BIT(port)) {
+ rc = cb(alu.mac, alu.fid, alu.is_static, data);
+ if (rc)
+ goto exit;
+ }
+ } while (lan937x_data & ALU_START);
+
+exit:
+ /* stop ALU search & continue to next ALU if available */
+ rc = ksz_write32(dev, REG_SW_ALU_CTRL(i), 0);
+ }
+
+ mutex_unlock(&dev->alu_mutex);
+
+ return rc;
+}
+
+static int lan937x_port_mdb_add(struct dsa_switch *ds, int port,
+ const struct switchdev_obj_port_mdb *mdb)
+{
+ struct ksz_device *dev = ds->priv;
+ u8 fid = lan937x_get_fid(mdb->vid);
+ u32 static_table[4];
+ u32 mac_hi, mac_lo;
+ int index, rc;
+ u32 data;
+
+ mac_hi = ((mdb->addr[0] << 8) | mdb->addr[1]);
+ mac_lo = ((mdb->addr[2] << 24) | (mdb->addr[3] << 16));
+ mac_lo |= ((mdb->addr[4] << 8) | mdb->addr[5]);
+
+ mutex_lock(&dev->alu_mutex);
+
+ for (index = 0; index < dev->num_statics; index++) {
+ /* find empty slot first */
+ data = (index << ALU_STAT_INDEX_S) |
+ ALU_STAT_READ | ALU_STAT_START;
+ rc = ksz_write32(dev, REG_SW_ALU_STAT_CTRL__4, data);
+ if (rc < 0)
+ goto exit;
+
+ /* wait to be finished */
+ rc = lan937x_wait_alu_sta_ready(dev);
+ if (rc < 0) {
+ dev_err(dev->dev, "Failed to read ALU STATIC\n");
+ goto exit;
+ }
+
+ /* read ALU static table */
+ rc = lan937x_read_table(dev, static_table);
+ if (rc < 0)
+ goto exit;
+
+ if (static_table[0] & ALU_V_STATIC_VALID) {
+ /* check this has same fid & mac address */
+ if (((static_table[2] >> ALU_V_FID_S) == fid) &&
+ ((static_table[2] & ALU_V_MAC_ADDR_HI) == mac_hi) &&
+ static_table[3] == mac_lo) {
+ /* found matching one */
+ break;
+ }
+ } else {
+ /* found empty one */
+ break;
+ }
+ }
+
+ /* no available entry */
+ if (index == dev->num_statics) {
+ rc = -ENOSPC;
+ goto exit;
+ }
+
+ /* add entry */
+ static_table[0] = ALU_V_STATIC_VALID;
+
+ static_table[1] |= BIT(port);
+ if (fid)
+ static_table[1] |= ALU_V_USE_FID;
+ static_table[2] = (fid << ALU_V_FID_S);
+ static_table[2] |= mac_hi;
+ static_table[3] = mac_lo;
+
+ rc = lan937x_write_table(dev, static_table);
+ if (rc < 0)
+ goto exit;
+
+ data = (index << ALU_STAT_INDEX_S) | ALU_STAT_START;
+ rc = ksz_write32(dev, REG_SW_ALU_STAT_CTRL__4, data);
+ if (rc < 0)
+ goto exit;
+
+ /* wait to be finished */
+ rc = lan937x_wait_alu_sta_ready(dev);
+ if (rc < 0)
+ dev_err(dev->dev, "Failed to read ALU STATIC\n");
+
+exit:
+ mutex_unlock(&dev->alu_mutex);
+ return rc;
+}
+
+static int lan937x_port_mdb_del(struct dsa_switch *ds, int port,
+ const struct switchdev_obj_port_mdb *mdb)
+{
+ struct ksz_device *dev = ds->priv;
+ u8 fid = lan937x_get_fid(mdb->vid);
+ u32 static_table[4];
+ u32 mac_hi, mac_lo;
+ int index, rc;
+ u32 data;
+
+ mac_hi = ((mdb->addr[0] << 8) | mdb->addr[1]);
+ mac_lo = ((mdb->addr[2] << 24) | (mdb->addr[3] << 16));
+ mac_lo |= ((mdb->addr[4] << 8) | mdb->addr[5]);
+
+ mutex_lock(&dev->alu_mutex);
+
+ for (index = 0; index < dev->num_statics; index++) {
+ /* find empty slot first */
+ data = (index << ALU_STAT_INDEX_S) |
+ ALU_STAT_READ | ALU_STAT_START;
+ rc = ksz_write32(dev, REG_SW_ALU_STAT_CTRL__4, data);
+ if (rc < 0)
+ goto exit;
+
+ /* wait to be finished */
+ rc = lan937x_wait_alu_sta_ready(dev);
+ if (rc < 0) {
+ dev_err(dev->dev, "Failed to read ALU STATIC\n");
+ goto exit;
+ }
+
+ /* read ALU static table */
+ rc = lan937x_read_table(dev, static_table);
+
+ if (rc < 0)
+ goto exit;
+
+ if (static_table[0] & ALU_V_STATIC_VALID) {
+ /* check this has same fid & mac address */
+
+ if (((static_table[2] >> ALU_V_FID_S) == fid) &&
+ ((static_table[2] & ALU_V_MAC_ADDR_HI) == mac_hi) &&
+ static_table[3] == mac_lo) {
+ /* found matching one */
+ break;
+ }
+ }
+ }
+
+ /* no available entry */
+ if (index == dev->num_statics)
+ goto exit;
+
+ /* clear port based on port arg */
+ static_table[1] &= ~BIT(port);
+
+ if ((static_table[1] & ALU_V_PORT_MAP) == 0) {
+ /* delete entry */
+ static_table[0] = 0;
+ static_table[1] = 0;
+ static_table[2] = 0;
+ static_table[3] = 0;
+ }
+
+ rc = lan937x_write_table(dev, static_table);
+ if (rc < 0)
+ goto exit;
+
+ data = (index << ALU_STAT_INDEX_S) | ALU_STAT_START;
+ rc = ksz_write32(dev, REG_SW_ALU_STAT_CTRL__4, data);
+ if (rc < 0)
+ goto exit;
+
+ /* wait to be finished */
+ rc = lan937x_wait_alu_sta_ready(dev);
+ if (rc < 0)
+ dev_err(dev->dev, "Failed to read ALU STATIC\n");
+
+exit:
+ mutex_unlock(&dev->alu_mutex);
+
+ return rc;
+}
+
static int lan937x_port_mirror_add(struct dsa_switch *ds, int port,
struct dsa_mall_mirror_tc_entry *mirror,
bool ingress)
@@ -444,6 +955,11 @@ const struct dsa_switch_ops lan937x_switch_ops = {
.port_bridge_flags = lan937x_port_bridge_flags,
.port_stp_state_set = lan937x_port_stp_state_set,
.port_fast_age = ksz_port_fast_age,
+ .port_fdb_dump = lan937x_port_fdb_dump,
+ .port_fdb_add = lan937x_port_fdb_add,
+ .port_fdb_del = lan937x_port_fdb_del,
+ .port_mdb_add = lan937x_port_mdb_add,
+ .port_mdb_del = lan937x_port_mdb_del,
.port_mirror_add = lan937x_port_mirror_add,
.port_mirror_del = lan937x_port_mirror_del,
.port_max_mtu = lan937x_get_max_mtu,
--
2.27.0