net: lan966x: Implement the callback SWITCHDEV_ATTR_ID_BRIDGE_MC_DISABLED

The callback allows to enable/disable multicast snooping.
When the snooping is enabled, all IGMP and MLD frames are redirected to
the CPU, therefore make sure not to set the skb flag 'offload_fwd_mark'.
The HW will not flood multicast ipv4/ipv6 data frames.
When the snooping is disabled, the HW will flood IGMP, MLD and multicast
ipv4/ipv6 frames according to the mcast_flood flag.

Signed-off-by: Horatiu Vultur <horatiu.vultur@microchip.com>
Signed-off-by: David S. Miller <davem@davemloft.net>
This commit is contained in:
Horatiu Vultur
2022-02-04 10:14:51 +01:00
committed by David S. Miller
parent 1c213f05a3
commit 47aeea0d57
4 changed files with 110 additions and 1 deletions

View File

@@ -9,6 +9,37 @@ static struct notifier_block lan966x_netdevice_nb __read_mostly;
static struct notifier_block lan966x_switchdev_nb __read_mostly;
static struct notifier_block lan966x_switchdev_blocking_nb __read_mostly;
static void lan966x_port_set_mcast_ip_flood(struct lan966x_port *port,
u32 pgid_ip)
{
struct lan966x *lan966x = port->lan966x;
u32 flood_mask_ip;
flood_mask_ip = lan_rd(lan966x, ANA_PGID(pgid_ip));
flood_mask_ip = ANA_PGID_PGID_GET(flood_mask_ip);
/* If mcast snooping is not enabled then use mcast flood mask
* to decide to enable multicast flooding or not.
*/
if (!port->mcast_ena) {
u32 flood_mask;
flood_mask = lan_rd(lan966x, ANA_PGID(PGID_MC));
flood_mask = ANA_PGID_PGID_GET(flood_mask);
if (flood_mask & BIT(port->chip_port))
flood_mask_ip |= BIT(port->chip_port);
else
flood_mask_ip &= ~BIT(port->chip_port);
} else {
flood_mask_ip &= ~BIT(port->chip_port);
}
lan_rmw(ANA_PGID_PGID_SET(flood_mask_ip),
ANA_PGID_PGID,
lan966x, ANA_PGID(pgid_ip));
}
static void lan966x_port_set_mcast_flood(struct lan966x_port *port,
bool enabled)
{
@@ -23,6 +54,11 @@ static void lan966x_port_set_mcast_flood(struct lan966x_port *port,
lan_rmw(ANA_PGID_PGID_SET(val),
ANA_PGID_PGID,
port->lan966x, ANA_PGID(PGID_MC));
if (!port->mcast_ena) {
lan966x_port_set_mcast_ip_flood(port, PGID_MCIPV4);
lan966x_port_set_mcast_ip_flood(port, PGID_MCIPV6);
}
}
static void lan966x_port_set_ucast_flood(struct lan966x_port *port,
@@ -144,6 +180,24 @@ static void lan966x_port_ageing_set(struct lan966x_port *port,
lan966x_mac_set_ageing(port->lan966x, ageing_time);
}
static void lan966x_port_mc_set(struct lan966x_port *port, bool mcast_ena)
{
struct lan966x *lan966x = port->lan966x;
port->mcast_ena = mcast_ena;
lan_rmw(ANA_CPU_FWD_CFG_IGMP_REDIR_ENA_SET(mcast_ena) |
ANA_CPU_FWD_CFG_MLD_REDIR_ENA_SET(mcast_ena) |
ANA_CPU_FWD_CFG_IPMC_CTRL_COPY_ENA_SET(mcast_ena),
ANA_CPU_FWD_CFG_IGMP_REDIR_ENA |
ANA_CPU_FWD_CFG_MLD_REDIR_ENA |
ANA_CPU_FWD_CFG_IPMC_CTRL_COPY_ENA,
lan966x, ANA_CPU_FWD_CFG(port->chip_port));
lan966x_port_set_mcast_ip_flood(port, PGID_MCIPV4);
lan966x_port_set_mcast_ip_flood(port, PGID_MCIPV6);
}
static int lan966x_port_attr_set(struct net_device *dev, const void *ctx,
const struct switchdev_attr *attr,
struct netlink_ext_ack *extack)
@@ -171,6 +225,9 @@ static int lan966x_port_attr_set(struct net_device *dev, const void *ctx,
lan966x_vlan_port_set_vlan_aware(port, attr->u.vlan_filtering);
lan966x_vlan_port_apply(port);
break;
case SWITCHDEV_ATTR_ID_BRIDGE_MC_DISABLED:
lan966x_port_mc_set(port, !attr->u.mc_disabled);
break;
default:
err = -EOPNOTSUPP;
break;