[<prev] [next>] [<thread-prev] [thread-next>] [day] [month] [year] [list]
Message-Id: <20210924095226.38079-4-xiaoliang.yang_1@nxp.com>
Date: Fri, 24 Sep 2021 17:52:20 +0800
From: Xiaoliang Yang <xiaoliang.yang_1@....com>
To: davem@...emloft.net, linux-kernel@...r.kernel.org,
netdev@...r.kernel.org
Cc: allan.nielsen@...rochip.com, joergen.andreasen@...rochip.com,
UNGLinuxDriver@...rochip.com, vinicius.gomes@...el.com,
michael.chan@...adcom.com, vishal@...lsio.com, saeedm@...lanox.com,
jiri@...lanox.com, idosch@...lanox.com,
alexandre.belloni@...tlin.com, kuba@...nel.org,
xiaoliang.yang_1@....com, po.liu@....com, vladimir.oltean@....com,
leoyang.li@....com, f.fainelli@...il.com, andrew@...n.ch,
vivien.didelot@...il.com, claudiu.manoil@....com,
linux-mediatek@...ts.infradead.org,
linux-arm-kernel@...ts.infradead.org, matthias.bgg@...il.com,
horatiu.vultur@...rochip.com
Subject: [PATCH v5 net-next 3/9] net: mscc: ocelot: add MAC table stream learn and lookup operations
From: Vladimir Oltean <vladimir.oltean@....com>
ocelot_mact_learn_streamdata() can be used in VSC9959 to overwrite an
FDB entry with stream data. The stream data includes SFID and SSID which
can be used for PSFP and FRER set.
ocelot_mact_lookup() can be used to check if the given {DMAC, VID} FDB
entry is exist, and also can retrieve the DEST_IDX and entry type for
the FDB entry.
Signed-off-by: Vladimir Oltean <vladimir.oltean@....com>
Signed-off-by: Xiaoliang Yang <xiaoliang.yang_1@....com>
---
drivers/net/ethernet/mscc/ocelot.c | 50 ++++++++++++++++++++++++++++++
include/soc/mscc/ocelot.h | 5 +++
2 files changed, 55 insertions(+)
diff --git a/drivers/net/ethernet/mscc/ocelot.c b/drivers/net/ethernet/mscc/ocelot.c
index 35006b0fb963..dc65247b91be 100644
--- a/drivers/net/ethernet/mscc/ocelot.c
+++ b/drivers/net/ethernet/mscc/ocelot.c
@@ -114,6 +114,56 @@ int ocelot_mact_forget(struct ocelot *ocelot,
}
EXPORT_SYMBOL(ocelot_mact_forget);
+int ocelot_mact_lookup(struct ocelot *ocelot, int *dst_idx,
+ struct ocelot_mact_entry *entry)
+{
+ int val;
+
+ mutex_lock(&ocelot->mact_lock);
+
+ ocelot_mact_select(ocelot, entry->mac, entry->vid);
+
+ /* Issue a read command with MACACCESS_VALID=1. */
+ ocelot_write(ocelot, ANA_TABLES_MACACCESS_VALID |
+ ANA_TABLES_MACACCESS_MAC_TABLE_CMD(MACACCESS_CMD_READ),
+ ANA_TABLES_MACACCESS);
+
+ if (ocelot_mact_wait_for_completion(ocelot)) {
+ mutex_unlock(&ocelot->mact_lock);
+ return -ETIMEDOUT;
+ }
+
+ /* Read back the entry flags */
+ val = ocelot_read(ocelot, ANA_TABLES_MACACCESS);
+
+ mutex_unlock(&ocelot->mact_lock);
+
+ if (!(val & ANA_TABLES_MACACCESS_VALID))
+ return -ENOENT;
+
+ *dst_idx = ANA_TABLES_MACACCESS_DEST_IDX_X(val);
+ entry->type = ANA_TABLES_MACACCESS_ENTRYTYPE_X(val);
+
+ return 0;
+}
+EXPORT_SYMBOL(ocelot_mact_lookup);
+
+int ocelot_mact_learn_streamdata(struct ocelot *ocelot, int dst_idx,
+ struct ocelot_mact_entry *entry, u32 data)
+{
+ int ret;
+
+ mutex_lock(&ocelot->mact_lock);
+ ocelot_write(ocelot, data, ANA_TABLES_STREAMDATA);
+ mutex_unlock(&ocelot->mact_lock);
+
+ ret = ocelot_mact_learn(ocelot, dst_idx, entry->mac, entry->vid,
+ entry->type);
+
+ return ret;
+}
+EXPORT_SYMBOL(ocelot_mact_learn_streamdata);
+
static void ocelot_mact_init(struct ocelot *ocelot)
{
/* Configure the learning mode entries attributes:
diff --git a/include/soc/mscc/ocelot.h b/include/soc/mscc/ocelot.h
index e6773f4d09ce..455293652257 100644
--- a/include/soc/mscc/ocelot.h
+++ b/include/soc/mscc/ocelot.h
@@ -926,6 +926,11 @@ void ocelot_phylink_mac_link_up(struct ocelot *ocelot, int port,
bool tx_pause, bool rx_pause,
unsigned long quirks);
+int ocelot_mact_lookup(struct ocelot *ocelot, int *dst_idx,
+ struct ocelot_mact_entry *entry);
+int ocelot_mact_learn_streamdata(struct ocelot *ocelot, int dst_idx,
+ struct ocelot_mact_entry *entry, u32 data);
+
#if IS_ENABLED(CONFIG_BRIDGE_MRP)
int ocelot_mrp_add(struct ocelot *ocelot, int port,
const struct switchdev_obj_mrp *mrp);
--
2.17.1
Powered by blists - more mailing lists