[PATCH net-next 6/8] net: dsa: microchip: add support for port mirror operations

[Prasanna Vengateshan]

Added support for port_mirror_add() and port_mirror_del operations

Signed-off-by: Prasanna Vengateshan <prasanna.vengates...@microchip.com>
---
 drivers/net/dsa/microchip/lan937x_main.c | 42 ++++++++++++++++++++++++
 1 file changed, 42 insertions(+)

diff --git a/drivers/net/dsa/microchip/lan937x_main.c 
b/drivers/net/dsa/microchip/lan937x_main.c
index 5693c59df497..aa2efa4e5823 100644
--- a/drivers/net/dsa/microchip/lan937x_main.c
+++ b/drivers/net/dsa/microchip/lan937x_main.c
@@ -162,6 +162,46 @@ static void lan937x_port_stp_state_set(struct dsa_switch 
*ds, int port,
        mutex_unlock(&dev->dev_mutex);
 }
 
+static int lan937x_port_mirror_add(struct dsa_switch *ds, int port,
+                                  struct dsa_mall_mirror_tc_entry *mirror,
+                                  bool ingress)
+{
+       struct ksz_device *dev = ds->priv;
+
+       if (ingress)
+               lan937x_port_cfg(dev, port, P_MIRROR_CTRL, PORT_MIRROR_RX, 
true);
+       else
+               lan937x_port_cfg(dev, port, P_MIRROR_CTRL, PORT_MIRROR_TX, 
true);
+
+       lan937x_port_cfg(dev, port, P_MIRROR_CTRL, PORT_MIRROR_SNIFFER, false);
+
+       /* configure mirror port */
+       lan937x_port_cfg(dev, mirror->to_local_port, P_MIRROR_CTRL,
+                        PORT_MIRROR_SNIFFER, true);
+
+       lan937x_cfg(dev, S_MIRROR_CTRL, SW_MIRROR_RX_TX, false);
+
+       return 0;
+}
+
+static void lan937x_port_mirror_del(struct dsa_switch *ds, int port,
+                                   struct dsa_mall_mirror_tc_entry *mirror)
+{
+       struct ksz_device *dev = ds->priv;
+       u8 data;
+
+       if (mirror->ingress)
+               lan937x_port_cfg(dev, port, P_MIRROR_CTRL, PORT_MIRROR_RX, 
false);
+       else
+               lan937x_port_cfg(dev, port, P_MIRROR_CTRL, PORT_MIRROR_TX, 
false);
+
+       lan937x_pread8(dev, port, P_MIRROR_CTRL, &data);
+
+       if (!(data & (PORT_MIRROR_RX | PORT_MIRROR_TX)))
+               lan937x_port_cfg(dev, mirror->to_local_port, P_MIRROR_CTRL,
+                                PORT_MIRROR_SNIFFER, false);
+}
+
 static phy_interface_t lan937x_get_interface(struct ksz_device *dev, int port)
 {
        phy_interface_t interface;
@@ -393,6 +433,8 @@ const struct dsa_switch_ops lan937x_switch_ops = {
        .port_bridge_leave      = ksz_port_bridge_leave,
        .port_stp_state_set     = lan937x_port_stp_state_set,
        .port_fast_age          = ksz_port_fast_age,
+       .port_mirror_add        = lan937x_port_mirror_add,
+       .port_mirror_del        = lan937x_port_mirror_del,
        .port_max_mtu           = lan937x_get_max_mtu,
        .port_change_mtu        = lan937x_change_mtu,
        .phylink_validate       = lan937x_phylink_validate,
-- 
2.25.1