1 // SPDX-License-Identifier: GPL-2.0+
3 #include <linux/if_bridge.h>
4 #include <net/switchdev.h>
6 #include "lan966x_main.h"
8 static struct notifier_block lan966x_netdevice_nb __read_mostly;
10 static void lan966x_port_set_mcast_ip_flood(struct lan966x_port *port,
13 struct lan966x *lan966x = port->lan966x;
16 flood_mask_ip = lan_rd(lan966x, ANA_PGID(pgid_ip));
17 flood_mask_ip = ANA_PGID_PGID_GET(flood_mask_ip);
19 /* If mcast snooping is not enabled then use mcast flood mask
20 * to decide to enable multicast flooding or not.
22 if (!port->mcast_ena) {
25 flood_mask = lan_rd(lan966x, ANA_PGID(PGID_MC));
26 flood_mask = ANA_PGID_PGID_GET(flood_mask);
28 if (flood_mask & BIT(port->chip_port))
29 flood_mask_ip |= BIT(port->chip_port);
31 flood_mask_ip &= ~BIT(port->chip_port);
33 flood_mask_ip &= ~BIT(port->chip_port);
36 lan_rmw(ANA_PGID_PGID_SET(flood_mask_ip),
38 lan966x, ANA_PGID(pgid_ip));
41 static void lan966x_port_set_mcast_flood(struct lan966x_port *port,
44 u32 val = lan_rd(port->lan966x, ANA_PGID(PGID_MC));
46 val = ANA_PGID_PGID_GET(val);
48 val |= BIT(port->chip_port);
50 val &= ~BIT(port->chip_port);
52 lan_rmw(ANA_PGID_PGID_SET(val),
54 port->lan966x, ANA_PGID(PGID_MC));
56 if (!port->mcast_ena) {
57 lan966x_port_set_mcast_ip_flood(port, PGID_MCIPV4);
58 lan966x_port_set_mcast_ip_flood(port, PGID_MCIPV6);
62 static void lan966x_port_set_ucast_flood(struct lan966x_port *port,
65 u32 val = lan_rd(port->lan966x, ANA_PGID(PGID_UC));
67 val = ANA_PGID_PGID_GET(val);
69 val |= BIT(port->chip_port);
71 val &= ~BIT(port->chip_port);
73 lan_rmw(ANA_PGID_PGID_SET(val),
75 port->lan966x, ANA_PGID(PGID_UC));
78 static void lan966x_port_set_bcast_flood(struct lan966x_port *port,
81 u32 val = lan_rd(port->lan966x, ANA_PGID(PGID_BC));
83 val = ANA_PGID_PGID_GET(val);
85 val |= BIT(port->chip_port);
87 val &= ~BIT(port->chip_port);
89 lan_rmw(ANA_PGID_PGID_SET(val),
91 port->lan966x, ANA_PGID(PGID_BC));
94 static void lan966x_port_set_learning(struct lan966x_port *port, bool enabled)
96 lan_rmw(ANA_PORT_CFG_LEARN_ENA_SET(enabled),
97 ANA_PORT_CFG_LEARN_ENA,
98 port->lan966x, ANA_PORT_CFG(port->chip_port));
100 port->learn_ena = enabled;
103 static void lan966x_port_bridge_flags(struct lan966x_port *port,
104 struct switchdev_brport_flags flags)
106 if (flags.mask & BR_MCAST_FLOOD)
107 lan966x_port_set_mcast_flood(port,
108 !!(flags.val & BR_MCAST_FLOOD));
110 if (flags.mask & BR_FLOOD)
111 lan966x_port_set_ucast_flood(port,
112 !!(flags.val & BR_FLOOD));
114 if (flags.mask & BR_BCAST_FLOOD)
115 lan966x_port_set_bcast_flood(port,
116 !!(flags.val & BR_BCAST_FLOOD));
118 if (flags.mask & BR_LEARNING)
119 lan966x_port_set_learning(port,
120 !!(flags.val & BR_LEARNING));
123 static int lan966x_port_pre_bridge_flags(struct lan966x_port *port,
124 struct switchdev_brport_flags flags)
126 if (flags.mask & ~(BR_MCAST_FLOOD | BR_FLOOD | BR_BCAST_FLOOD |
133 void lan966x_update_fwd_mask(struct lan966x *lan966x)
137 for (i = 0; i < lan966x->num_phys_ports; i++) {
138 struct lan966x_port *port = lan966x->ports[i];
139 unsigned long mask = 0;
141 if (port && lan966x->bridge_fwd_mask & BIT(i)) {
142 mask = lan966x->bridge_fwd_mask & ~BIT(i);
145 mask &= ~lan966x_lag_get_mask(lan966x,
149 mask |= BIT(CPU_PORT);
151 lan_wr(ANA_PGID_PGID_SET(mask),
152 lan966x, ANA_PGID(PGID_SRC + i));
156 void lan966x_port_stp_state_set(struct lan966x_port *port, u8 state)
158 struct lan966x *lan966x = port->lan966x;
159 bool learn_ena = false;
161 if ((state == BR_STATE_FORWARDING || state == BR_STATE_LEARNING) &&
165 if (state == BR_STATE_FORWARDING)
166 lan966x->bridge_fwd_mask |= BIT(port->chip_port);
168 lan966x->bridge_fwd_mask &= ~BIT(port->chip_port);
170 lan_rmw(ANA_PORT_CFG_LEARN_ENA_SET(learn_ena),
171 ANA_PORT_CFG_LEARN_ENA,
172 lan966x, ANA_PORT_CFG(port->chip_port));
174 lan966x_update_fwd_mask(lan966x);
177 void lan966x_port_ageing_set(struct lan966x_port *port,
178 unsigned long ageing_clock_t)
180 unsigned long ageing_jiffies = clock_t_to_jiffies(ageing_clock_t);
181 u32 ageing_time = jiffies_to_msecs(ageing_jiffies) / 1000;
183 lan966x_mac_set_ageing(port->lan966x, ageing_time);
186 static void lan966x_port_mc_set(struct lan966x_port *port, bool mcast_ena)
188 struct lan966x *lan966x = port->lan966x;
190 port->mcast_ena = mcast_ena;
192 lan966x_mdb_restore_entries(lan966x);
194 lan966x_mdb_clear_entries(lan966x);
196 lan_rmw(ANA_CPU_FWD_CFG_IGMP_REDIR_ENA_SET(mcast_ena) |
197 ANA_CPU_FWD_CFG_MLD_REDIR_ENA_SET(mcast_ena) |
198 ANA_CPU_FWD_CFG_IPMC_CTRL_COPY_ENA_SET(mcast_ena),
199 ANA_CPU_FWD_CFG_IGMP_REDIR_ENA |
200 ANA_CPU_FWD_CFG_MLD_REDIR_ENA |
201 ANA_CPU_FWD_CFG_IPMC_CTRL_COPY_ENA,
202 lan966x, ANA_CPU_FWD_CFG(port->chip_port));
204 lan966x_port_set_mcast_ip_flood(port, PGID_MCIPV4);
205 lan966x_port_set_mcast_ip_flood(port, PGID_MCIPV6);
208 static int lan966x_port_attr_set(struct net_device *dev, const void *ctx,
209 const struct switchdev_attr *attr,
210 struct netlink_ext_ack *extack)
212 struct lan966x_port *port = netdev_priv(dev);
215 if (ctx && ctx != port)
219 case SWITCHDEV_ATTR_ID_PORT_BRIDGE_FLAGS:
220 lan966x_port_bridge_flags(port, attr->u.brport_flags);
222 case SWITCHDEV_ATTR_ID_PORT_PRE_BRIDGE_FLAGS:
223 err = lan966x_port_pre_bridge_flags(port, attr->u.brport_flags);
225 case SWITCHDEV_ATTR_ID_PORT_STP_STATE:
226 lan966x_port_stp_state_set(port, attr->u.stp_state);
228 case SWITCHDEV_ATTR_ID_BRIDGE_AGEING_TIME:
229 lan966x_port_ageing_set(port, attr->u.ageing_time);
231 case SWITCHDEV_ATTR_ID_BRIDGE_VLAN_FILTERING:
232 lan966x_vlan_port_set_vlan_aware(port, attr->u.vlan_filtering);
233 lan966x_vlan_port_apply(port);
235 case SWITCHDEV_ATTR_ID_BRIDGE_MC_DISABLED:
236 lan966x_port_mc_set(port, !attr->u.mc_disabled);
246 static int lan966x_port_bridge_join(struct lan966x_port *port,
247 struct net_device *brport_dev,
248 struct net_device *bridge,
249 struct netlink_ext_ack *extack)
251 struct switchdev_brport_flags flags = {0};
252 struct lan966x *lan966x = port->lan966x;
253 struct net_device *dev = port->dev;
256 if (!lan966x->bridge_mask) {
257 lan966x->bridge = bridge;
259 if (lan966x->bridge != bridge) {
260 NL_SET_ERR_MSG_MOD(extack, "Not allow to add port to different bridge");
265 err = switchdev_bridge_port_offload(brport_dev, dev, port,
266 &lan966x_switchdev_nb,
267 &lan966x_switchdev_blocking_nb,
272 lan966x->bridge_mask |= BIT(port->chip_port);
274 flags.mask = BR_LEARNING | BR_FLOOD | BR_MCAST_FLOOD | BR_BCAST_FLOOD;
275 flags.val = flags.mask;
276 lan966x_port_bridge_flags(port, flags);
281 static void lan966x_port_bridge_leave(struct lan966x_port *port,
282 struct net_device *bridge)
284 struct switchdev_brport_flags flags = {0};
285 struct lan966x *lan966x = port->lan966x;
287 flags.mask = BR_LEARNING | BR_FLOOD | BR_MCAST_FLOOD | BR_BCAST_FLOOD;
288 flags.val = flags.mask & ~BR_LEARNING;
289 lan966x_port_bridge_flags(port, flags);
291 lan966x->bridge_mask &= ~BIT(port->chip_port);
293 if (!lan966x->bridge_mask)
294 lan966x->bridge = NULL;
296 /* Set the port back to host mode */
297 lan966x_vlan_port_set_vlan_aware(port, false);
298 lan966x_vlan_port_set_vid(port, HOST_PVID, false, false);
299 lan966x_vlan_port_apply(port);
302 int lan966x_port_changeupper(struct net_device *dev,
303 struct net_device *brport_dev,
304 struct netdev_notifier_changeupper_info *info)
306 struct lan966x_port *port = netdev_priv(dev);
307 struct netlink_ext_ack *extack;
310 extack = netdev_notifier_info_to_extack(&info->info);
312 if (netif_is_bridge_master(info->upper_dev)) {
314 err = lan966x_port_bridge_join(port, brport_dev,
318 lan966x_port_bridge_leave(port, info->upper_dev);
321 if (netif_is_lag_master(info->upper_dev)) {
323 err = lan966x_lag_port_join(port, info->upper_dev,
327 lan966x_lag_port_leave(port, info->upper_dev);
333 int lan966x_port_prechangeupper(struct net_device *dev,
334 struct net_device *brport_dev,
335 struct netdev_notifier_changeupper_info *info)
337 struct lan966x_port *port = netdev_priv(dev);
338 int err = NOTIFY_DONE;
340 if (netif_is_bridge_master(info->upper_dev) && !info->linking) {
341 switchdev_bridge_port_unoffload(port->dev, port, NULL, NULL);
342 lan966x_fdb_flush_workqueue(port->lan966x);
345 if (netif_is_lag_master(info->upper_dev)) {
346 err = lan966x_lag_port_prechangeupper(dev, info);
347 if (err || info->linking)
350 switchdev_bridge_port_unoffload(brport_dev, port, NULL, NULL);
351 lan966x_fdb_flush_workqueue(port->lan966x);
357 static int lan966x_foreign_bridging_check(struct net_device *upper,
360 struct netlink_ext_ack *extack)
362 struct lan966x *lan966x = NULL;
363 struct net_device *dev;
364 struct list_head *iter;
366 if (!netif_is_bridge_master(upper) &&
367 !netif_is_lag_master(upper))
370 netdev_for_each_lower_dev(upper, dev, iter) {
371 if (lan966x_netdevice_check(dev)) {
372 struct lan966x_port *port = netdev_priv(dev);
375 /* Upper already has at least one port of a
376 * lan966x switch inside it, check that it's
377 * the same instance of the driver.
379 if (port->lan966x != lan966x) {
380 NL_SET_ERR_MSG_MOD(extack,
381 "Bridging between multiple lan966x switches disallowed");
385 /* This is the first lan966x port inside this
388 lan966x = port->lan966x;
389 *seen_lan966x = true;
391 } else if (netif_is_lag_master(dev)) {
392 /* Allow to have bond interfaces that have only lan966x
395 if (lan966x_foreign_bridging_check(dev, has_foreign,
403 if (*seen_lan966x && *has_foreign) {
404 NL_SET_ERR_MSG_MOD(extack,
405 "Bridging lan966x ports with foreign interfaces disallowed");
413 static int lan966x_bridge_check(struct net_device *dev,
414 struct netdev_notifier_changeupper_info *info)
416 bool has_foreign = false;
417 bool seen_lan966x = false;
419 return lan966x_foreign_bridging_check(info->upper_dev,
425 static int lan966x_netdevice_port_event(struct net_device *dev,
426 struct notifier_block *nb,
427 unsigned long event, void *ptr)
431 if (!lan966x_netdevice_check(dev)) {
433 case NETDEV_CHANGEUPPER:
434 case NETDEV_PRECHANGEUPPER:
435 err = lan966x_bridge_check(dev, ptr);
439 if (netif_is_lag_master(dev)) {
440 if (event == NETDEV_CHANGEUPPER)
441 err = lan966x_lag_netdev_changeupper(dev,
444 err = lan966x_lag_netdev_prechangeupper(dev,
458 case NETDEV_PRECHANGEUPPER:
459 err = lan966x_port_prechangeupper(dev, dev, ptr);
461 case NETDEV_CHANGEUPPER:
462 err = lan966x_bridge_check(dev, ptr);
466 err = lan966x_port_changeupper(dev, dev, ptr);
468 case NETDEV_CHANGELOWERSTATE:
469 err = lan966x_lag_port_changelowerstate(dev, ptr);
476 static int lan966x_netdevice_event(struct notifier_block *nb,
477 unsigned long event, void *ptr)
479 struct net_device *dev = netdev_notifier_info_to_dev(ptr);
482 ret = lan966x_netdevice_port_event(dev, nb, event, ptr);
484 return notifier_from_errno(ret);
487 static bool lan966x_foreign_dev_check(const struct net_device *dev,
488 const struct net_device *foreign_dev)
490 struct lan966x_port *port = netdev_priv(dev);
491 struct lan966x *lan966x = port->lan966x;
494 if (netif_is_bridge_master(foreign_dev))
495 if (lan966x->bridge == foreign_dev)
498 if (netif_is_lag_master(foreign_dev))
499 for (i = 0; i < lan966x->num_phys_ports; ++i)
500 if (lan966x->ports[i] &&
501 lan966x->ports[i]->bond == foreign_dev)
507 static int lan966x_switchdev_event(struct notifier_block *nb,
508 unsigned long event, void *ptr)
510 struct net_device *dev = switchdev_notifier_info_to_dev(ptr);
514 case SWITCHDEV_PORT_ATTR_SET:
515 err = switchdev_handle_port_attr_set(dev, ptr,
516 lan966x_netdevice_check,
517 lan966x_port_attr_set);
518 return notifier_from_errno(err);
519 case SWITCHDEV_FDB_ADD_TO_DEVICE:
520 case SWITCHDEV_FDB_DEL_TO_DEVICE:
521 err = switchdev_handle_fdb_event_to_device(dev, event, ptr,
522 lan966x_netdevice_check,
523 lan966x_foreign_dev_check,
525 return notifier_from_errno(err);
531 static int lan966x_handle_port_vlan_add(struct lan966x_port *port,
532 const struct switchdev_obj *obj)
534 const struct switchdev_obj_port_vlan *v = SWITCHDEV_OBJ_PORT_VLAN(obj);
535 struct lan966x *lan966x = port->lan966x;
537 if (!netif_is_bridge_master(obj->orig_dev))
538 lan966x_vlan_port_add_vlan(port, v->vid,
539 v->flags & BRIDGE_VLAN_INFO_PVID,
540 v->flags & BRIDGE_VLAN_INFO_UNTAGGED);
542 lan966x_vlan_cpu_add_vlan(lan966x, v->vid);
547 static int lan966x_handle_port_obj_add(struct net_device *dev, const void *ctx,
548 const struct switchdev_obj *obj,
549 struct netlink_ext_ack *extack)
551 struct lan966x_port *port = netdev_priv(dev);
554 if (ctx && ctx != port)
558 case SWITCHDEV_OBJ_ID_PORT_VLAN:
559 err = lan966x_handle_port_vlan_add(port, obj);
561 case SWITCHDEV_OBJ_ID_PORT_MDB:
562 case SWITCHDEV_OBJ_ID_HOST_MDB:
563 err = lan966x_handle_port_mdb_add(port, obj);
573 static int lan966x_handle_port_vlan_del(struct lan966x_port *port,
574 const struct switchdev_obj *obj)
576 const struct switchdev_obj_port_vlan *v = SWITCHDEV_OBJ_PORT_VLAN(obj);
577 struct lan966x *lan966x = port->lan966x;
579 if (!netif_is_bridge_master(obj->orig_dev))
580 lan966x_vlan_port_del_vlan(port, v->vid);
582 lan966x_vlan_cpu_del_vlan(lan966x, v->vid);
587 static int lan966x_handle_port_obj_del(struct net_device *dev, const void *ctx,
588 const struct switchdev_obj *obj)
590 struct lan966x_port *port = netdev_priv(dev);
593 if (ctx && ctx != port)
597 case SWITCHDEV_OBJ_ID_PORT_VLAN:
598 err = lan966x_handle_port_vlan_del(port, obj);
600 case SWITCHDEV_OBJ_ID_PORT_MDB:
601 case SWITCHDEV_OBJ_ID_HOST_MDB:
602 err = lan966x_handle_port_mdb_del(port, obj);
612 static int lan966x_switchdev_blocking_event(struct notifier_block *nb,
616 struct net_device *dev = switchdev_notifier_info_to_dev(ptr);
620 case SWITCHDEV_PORT_OBJ_ADD:
621 err = switchdev_handle_port_obj_add(dev, ptr,
622 lan966x_netdevice_check,
623 lan966x_handle_port_obj_add);
624 return notifier_from_errno(err);
625 case SWITCHDEV_PORT_OBJ_DEL:
626 err = switchdev_handle_port_obj_del(dev, ptr,
627 lan966x_netdevice_check,
628 lan966x_handle_port_obj_del);
629 return notifier_from_errno(err);
630 case SWITCHDEV_PORT_ATTR_SET:
631 err = switchdev_handle_port_attr_set(dev, ptr,
632 lan966x_netdevice_check,
633 lan966x_port_attr_set);
634 return notifier_from_errno(err);
640 static struct notifier_block lan966x_netdevice_nb __read_mostly = {
641 .notifier_call = lan966x_netdevice_event,
644 struct notifier_block lan966x_switchdev_nb __read_mostly = {
645 .notifier_call = lan966x_switchdev_event,
648 struct notifier_block lan966x_switchdev_blocking_nb __read_mostly = {
649 .notifier_call = lan966x_switchdev_blocking_event,
652 void lan966x_register_notifier_blocks(void)
654 register_netdevice_notifier(&lan966x_netdevice_nb);
655 register_switchdev_notifier(&lan966x_switchdev_nb);
656 register_switchdev_blocking_notifier(&lan966x_switchdev_blocking_nb);
659 void lan966x_unregister_notifier_blocks(void)
661 unregister_switchdev_blocking_notifier(&lan966x_switchdev_blocking_nb);
662 unregister_switchdev_notifier(&lan966x_switchdev_nb);
663 unregister_netdevice_notifier(&lan966x_netdevice_nb);