net: mscc: Move mac_table_add function into different file.

Move the function mac_table_add into a different file,
so it can be reused.

Signed-off-by: Horatiu Vultur <horatiu.vultur@microchip.com>

diff --git a/drivers/net/mscc_eswitch/Makefile b/drivers/net/mscc_eswitch/Makefile
index 20e8e4c32a5aa41018937c768f4eb6af658440a9..704f854f061c1e79b297681e174ffe5b18f1f4b9 100644 (file)
--- a/drivers/net/mscc_eswitch/Makefile
+++ b/drivers/net/mscc_eswitch/Makefile
@@ -1,2 +1,2 @@
 
-obj-$(CONFIG_MSCC_OCELOT_SWITCH) += ocelot_switch.o mscc_miim.o mscc_xfer.o
+obj-$(CONFIG_MSCC_OCELOT_SWITCH) += ocelot_switch.o mscc_miim.o mscc_xfer.o mscc_mac_table.o

diff --git a/drivers/net/mscc_eswitch/mscc_mac_table.c b/drivers/net/mscc_eswitch/mscc_mac_table.c
new file mode 100644 (file)
index 0000000..833e233
--- /dev/null
+++ b/drivers/net/mscc_eswitch/mscc_mac_table.c
@@ -0,0 +1,74 @@
+// SPDX-License-Identifier: (GPL-2.0+ OR MIT)
+/*
+ * Copyright (c) 2018 Microsemi Corporation
+ */
+
+#include <linux/io.h>
+#include "mscc_mac_table.h"
+
+#define ANA_TABLES_MACACCESS_VALID             BIT(11)
+#define ANA_TABLES_MACACCESS_ENTRYTYPE(x)      ((x) << 9)
+#define ANA_TABLES_MACACCESS_DEST_IDX(x)       ((x) << 3)
+#define ANA_TABLES_MACACCESS_MAC_TABLE_CMD(x)  (x)
+#define ANA_TABLES_MACACCESS_MAC_TABLE_CMD_M   GENMASK(2, 0)
+#define MACACCESS_CMD_IDLE                     0
+#define MACACCESS_CMD_LEARN                    1
+
+/* MAC table entry types.
+ * ENTRYTYPE_NORMAL is subject to aging.
+ * ENTRYTYPE_LOCKED is not subject to aging.
+ */
+enum macaccess_entry_type {
+       ENTRYTYPE_NORMAL = 0,
+       ENTRYTYPE_LOCKED,
+};
+
+static int vlan_wait_for_completion(void __iomem *regs,
+                                   const unsigned long *mscc_mac_table_offset)
+{
+       unsigned int val, timeout = 10;
+
+       /* Wait for the issued mac table command to be completed, or timeout.
+        * When the command read from ANA_TABLES_MACACCESS is
+        * MACACCESS_CMD_IDLE, the issued command completed successfully.
+        */
+       do {
+               val = readl(regs +
+                           mscc_mac_table_offset[MSCC_ANA_TABLES_MACACCESS]);
+               val &= ANA_TABLES_MACACCESS_MAC_TABLE_CMD_M;
+       } while (val != MACACCESS_CMD_IDLE && timeout--);
+
+       if (!timeout)
+               return -ETIMEDOUT;
+
+       return 0;
+}
+
+int mscc_mac_table_add(void __iomem *regs,
+                      const unsigned long *mscc_mac_table_offset,
+                      const unsigned char mac[ETH_LEN], int pgid)
+{
+       u32 macl = 0, mach = 0;
+
+       /* Set the MAC address to handle and the vlan associated in a format
+        * understood by the hardware.
+        */
+       mach |= MAC_VID << 16;
+       mach |= ((u32)mac[0]) << 8;
+       mach |= ((u32)mac[1]) << 0;
+       macl |= ((u32)mac[2]) << 24;
+       macl |= ((u32)mac[3]) << 16;
+       macl |= ((u32)mac[4]) << 8;
+       macl |= ((u32)mac[5]) << 0;
+
+       writel(macl, regs + mscc_mac_table_offset[MSCC_ANA_TABLES_MACLDATA]);
+       writel(mach, regs + mscc_mac_table_offset[MSCC_ANA_TABLES_MACHDATA]);
+
+       writel(ANA_TABLES_MACACCESS_VALID |
+              ANA_TABLES_MACACCESS_DEST_IDX(pgid) |
+              ANA_TABLES_MACACCESS_ENTRYTYPE(ENTRYTYPE_LOCKED) |
+              ANA_TABLES_MACACCESS_MAC_TABLE_CMD(MACACCESS_CMD_LEARN),
+              regs + mscc_mac_table_offset[MSCC_ANA_TABLES_MACACCESS]);
+
+       return vlan_wait_for_completion(regs, mscc_mac_table_offset);
+}

diff --git a/drivers/net/mscc_eswitch/mscc_mac_table.h b/drivers/net/mscc_eswitch/mscc_mac_table.h
new file mode 100644 (file)
index 0000000..17fed2e
--- /dev/null
+++ b/drivers/net/mscc_eswitch/mscc_mac_table.h
@@ -0,0 +1,19 @@
+/* SPDX-License-Identifier: (GPL-2.0+ OR MIT) */
+/*
+ * Copyright (c) 2018 Microsemi Corporation
+ */
+
+#include <common.h>
+
+#define ETH_LEN 6
+#define MAC_VID 1
+
+enum mscc_regs_ana_table {
+       MSCC_ANA_TABLES_MACHDATA,
+       MSCC_ANA_TABLES_MACLDATA,
+       MSCC_ANA_TABLES_MACACCESS,
+};
+
+int mscc_mac_table_add(void __iomem *regs,
+                      const unsigned long *mscc_mac_table_offset,
+                      const unsigned char mac[ETH_LEN], int pgid);

diff --git a/drivers/net/mscc_eswitch/ocelot_switch.c b/drivers/net/mscc_eswitch/ocelot_switch.c
index c33ecd44a0f402df0c6465fb3c14012120cd877a..40152e60d85860d859d928108bd82f173c6a16bc 100644 (file)
--- a/drivers/net/mscc_eswitch/ocelot_switch.c
+++ b/drivers/net/mscc_eswitch/ocelot_switch.c
@@ -17,6 +17,7 @@
 
 #include "mscc_miim.h"
 #include "mscc_xfer.h"
+#include "mscc_mac_table.h"
 
 #define PHY_CFG                                0x0
 #define PHY_CFG_ENA                            0xF
@@ -30,17 +31,6 @@
 #define                ANA_PORT_VLAN_CFG_POP_CNT(x)    ((x) << 18)
 #define ANA_PORT_PORT_CFG(x)           (0x7070 + 0x100 * (x))
 #define                ANA_PORT_PORT_CFG_RECV_ENA      BIT(6)
-#define        ANA_TABLES_MACHDATA             0x8b34
-#define        ANA_TABLES_MACLDATA             0x8b38
-#define ANA_TABLES_MACACCESS           0x8b3c
-#define                ANA_TABLES_MACACCESS_VALID      BIT(11)
-#define                ANA_TABLES_MACACCESS_ENTRYTYPE(x)   ((x) << 9)
-#define                ANA_TABLES_MACACCESS_DEST_IDX(x)    ((x) << 3)
-#define                ANA_TABLES_MACACCESS_MAC_TABLE_CMD(x)   (x)
-#define                ANA_TABLES_MACACCESS_MAC_TABLE_CMD_M    GENMASK(2, 0)
-#define                MACACCESS_CMD_IDLE                     0
-#define                MACACCESS_CMD_LEARN                    1
-#define                MACACCESS_CMD_GET_NEXT                 4
 #define ANA_PGID(x)                    (0x8c00 + 4 * (x))
 
 #define SYS_FRM_AGING                  0x574
@@ -119,19 +109,6 @@ enum ocelot_target {
 
 #define MAX_PORT (PORT3 - PORT0)
 
-/* MAC table entry types.
- * ENTRYTYPE_NORMAL is subject to aging.
- * ENTRYTYPE_LOCKED is not subject to aging.
- * ENTRYTYPE_MACv4 is not subject to aging. For IPv4 multicast.
- * ENTRYTYPE_MACv6 is not subject to aging. For IPv6 multicast.
- */
-enum macaccess_entry_type {
-       ENTRYTYPE_NORMAL = 0,
-       ENTRYTYPE_LOCKED,
-       ENTRYTYPE_MACv4,
-       ENTRYTYPE_MACv6,
-};
-
 enum ocelot_mdio_target {
        MIIM,
        PHY,
@@ -169,6 +146,12 @@ static const unsigned long ocelot_regs_qs[] = {
        [MSCC_QS_INJ_CTRL] = 0x34,
 };
 
+static const unsigned long ocelot_regs_ana_table[] = {
+       [MSCC_ANA_TABLES_MACHDATA] = 0x8b34,
+       [MSCC_ANA_TABLES_MACLDATA] = 0x8b38,
+       [MSCC_ANA_TABLES_MACACCESS] = 0x8b3c,
+};
+
 struct mscc_miim_dev miim[NUM_PHY];
 
 static int mscc_miim_reset(struct mii_dev *bus)
@@ -388,62 +371,13 @@ static int ocelot_initialize(struct ocelot_private *priv)
        return 0;
 }
 
-static inline int ocelot_vlant_wait_for_completion(struct ocelot_private *priv)
-{
-       unsigned int val, timeout = 10;
-
-       /* Wait for the issued mac table command to be completed, or timeout.
-        * When the command read from ANA_TABLES_MACACCESS is
-        * MACACCESS_CMD_IDLE, the issued command completed successfully.
-        */
-       do {
-               val = readl(priv->regs[ANA] + ANA_TABLES_MACACCESS);
-               val &= ANA_TABLES_MACACCESS_MAC_TABLE_CMD_M;
-       } while (val != MACACCESS_CMD_IDLE && timeout--);
-
-       if (!timeout)
-               return -ETIMEDOUT;
-
-       return 0;
-}
-
-static int ocelot_mac_table_add(struct ocelot_private *priv,
-                               const unsigned char mac[ETH_ALEN], int pgid)
-{
-       u32 macl = 0, mach = 0;
-       int ret;
-
-       /* Set the MAC address to handle and the vlan associated in a format
-        * understood by the hardware.
-        */
-       mach |= MAC_VID << 16;
-       mach |= ((u32)mac[0]) << 8;
-       mach |= ((u32)mac[1]) << 0;
-       macl |= ((u32)mac[2]) << 24;
-       macl |= ((u32)mac[3]) << 16;
-       macl |= ((u32)mac[4]) << 8;
-       macl |= ((u32)mac[5]) << 0;
-
-       writel(macl, priv->regs[ANA] + ANA_TABLES_MACLDATA);
-       writel(mach, priv->regs[ANA] + ANA_TABLES_MACHDATA);
-
-       writel(ANA_TABLES_MACACCESS_VALID |
-              ANA_TABLES_MACACCESS_DEST_IDX(pgid) |
-              ANA_TABLES_MACACCESS_ENTRYTYPE(ENTRYTYPE_LOCKED) |
-              ANA_TABLES_MACACCESS_MAC_TABLE_CMD(MACACCESS_CMD_LEARN),
-              priv->regs[ANA] + ANA_TABLES_MACACCESS);
-
-       ret = ocelot_vlant_wait_for_completion(priv);
-
-       return ret;
-}
-
 static int ocelot_write_hwaddr(struct udevice *dev)
 {
        struct ocelot_private *priv = dev_get_priv(dev);
        struct eth_pdata *pdata = dev_get_platdata(dev);
 
-       ocelot_mac_table_add(priv, pdata->enetaddr, PGID_UNICAST);
+       mscc_mac_table_add(priv->regs[ANA], ocelot_regs_ana_table,
+                          pdata->enetaddr, PGID_UNICAST);
 
        writel(BIT(CPU_PORT), priv->regs[ANA] + ANA_PGID(PGID_UNICAST));
 
@@ -463,13 +397,15 @@ static int ocelot_start(struct udevice *dev)
                return ret;
 
        /* Set MAC address tables entries for CPU redirection */
-       ocelot_mac_table_add(priv, mac, PGID_BROADCAST);
+       mscc_mac_table_add(priv->regs[ANA], ocelot_regs_ana_table, mac,
+                          PGID_BROADCAST);
 
        writel(BIT(CPU_PORT) | INTERNAL_PORT_MSK,
               priv->regs[ANA] + ANA_PGID(PGID_BROADCAST));
 
        /* It should be setup latter in ocelot_write_hwaddr */
-       ocelot_mac_table_add(priv, pdata->enetaddr, PGID_UNICAST);
+       mscc_mac_table_add(priv->regs[ANA], ocelot_regs_ana_table,
+                          pdata->enetaddr, PGID_UNICAST);
 
        writel(BIT(CPU_PORT), priv->regs[ANA] + ANA_PGID(PGID_UNICAST));