net: dsa: tag_ksz: Extend ksz9477_xmit() for HSR frame duplication

The KSZ9477 has support for HSR (High-Availability Seamless Redundancy).
One of its offloading (i.e. performed in the switch IC hardware) features
is to duplicate received frame to both HSR aware switch ports.

To achieve this goal - the tail TAG needs to be modified. To be more
specific, both ports must be marked as destination (egress) ones.

The NETIF_F_HW_HSR_DUP flag indicates that the device supports HSR and
assures (in HSR core code) that frame is sent only once from HOST to
switch with tail tag indicating both ports.

Signed-off-by: Lukasz Majewski <lukma@denx.de>
Reviewed-by: Florian Fainelli <florian.fainelli@broadcom.com>
Reviewed-by: Vladimir Oltean <vladimir.oltean@nxp.com>
Signed-off-by: Paolo Abeni <pabeni@redhat.com>

diff --git a/net/dsa/tag_ksz.c b/net/dsa/tag_ksz.c
index ea100bd..3632e47 100644 (file)
--- a/net/dsa/tag_ksz.c
+++ b/net/dsa/tag_ksz.c
@@ -293,6 +293,14 @@ static struct sk_buff *ksz9477_xmit(struct sk_buff *skb,
        if (is_link_local_ether_addr(hdr->h_dest))
                val |= KSZ9477_TAIL_TAG_OVERRIDE;
 
+       if (dev->features & NETIF_F_HW_HSR_DUP) {
+               struct net_device *hsr_dev = dp->hsr_dev;
+               struct dsa_port *other_dp;
+
+               dsa_hsr_foreach_port(other_dp, dp->ds, hsr_dev)
+                       val |= BIT(other_dp->index);
+       }
+
        *tag = cpu_to_be16(val);
 
        return ksz_defer_xmit(dp, skb);