microchip/lan966x/lan966x_fdb.c

0001 // SPDX-License-Identifier: GPL-2.0+
0002
0003 #include <net/switchdev.h>
0004
0005 #include "lan966x_main.h"
0006
0007 struct lan966x_fdb_event_work {
0008     struct work_struct work;
0009     struct switchdev_notifier_fdb_info fdb_info;
0010     struct net_device *dev;
0011     struct lan966x *lan966x;
0012     unsigned long event;
0013 };
0014
0015 struct lan966x_fdb_entry {
0016     struct list_head list;
0017     unsigned char mac[ETH_ALEN] __aligned(2);
0018     u16 vid;
0019     u32 references;
0020 };
0021
0022 static struct lan966x_fdb_entry *
0023 lan966x_fdb_find_entry(struct lan966x *lan966x,
0024                struct switchdev_notifier_fdb_info *fdb_info)
0025 {
0026     struct lan966x_fdb_entry *fdb_entry;
0027
0028     list_for_each_entry(fdb_entry, &lan966x->fdb_entries, list) {
0029         if (fdb_entry->vid == fdb_info->vid &&
0030             ether_addr_equal(fdb_entry->mac, fdb_info->addr))
0031             return fdb_entry;
0032     }
0033
0034     return NULL;
0035 }
0036
0037 static void lan966x_fdb_add_entry(struct lan966x *lan966x,
0038                   struct switchdev_notifier_fdb_info *fdb_info)
0039 {
0040     struct lan966x_fdb_entry *fdb_entry;
0041
0042     fdb_entry = lan966x_fdb_find_entry(lan966x, fdb_info);
0043     if (fdb_entry) {
0044         fdb_entry->references++;
0045         return;
0046     }
0047
0048     fdb_entry = kzalloc(sizeof(*fdb_entry), GFP_KERNEL);
0049     if (!fdb_entry)
0050         return;
0051
0052     ether_addr_copy(fdb_entry->mac, fdb_info->addr);
0053     fdb_entry->vid = fdb_info->vid;
0054     fdb_entry->references = 1;
0055     list_add_tail(&fdb_entry->list, &lan966x->fdb_entries);
0056 }
0057
0058 static bool lan966x_fdb_del_entry(struct lan966x *lan966x,
0059                   struct switchdev_notifier_fdb_info *fdb_info)
0060 {
0061     struct lan966x_fdb_entry *fdb_entry, *tmp;
0062
0063     list_for_each_entry_safe(fdb_entry, tmp, &lan966x->fdb_entries,
0064                  list) {
0065         if (fdb_entry->vid == fdb_info->vid &&
0066             ether_addr_equal(fdb_entry->mac, fdb_info->addr)) {
0067             fdb_entry->references--;
0068             if (!fdb_entry->references) {
0069                 list_del(&fdb_entry->list);
0070                 kfree(fdb_entry);
0071                 return true;
0072             }
0073             break;
0074         }
0075     }
0076
0077     return false;
0078 }
0079
0080 void lan966x_fdb_write_entries(struct lan966x *lan966x, u16 vid)
0081 {
0082     struct lan966x_fdb_entry *fdb_entry;
0083
0084     list_for_each_entry(fdb_entry, &lan966x->fdb_entries, list) {
0085         if (fdb_entry->vid != vid)
0086             continue;
0087
0088         lan966x_mac_cpu_learn(lan966x, fdb_entry->mac, fdb_entry->vid);
0089     }
0090 }
0091
0092 void lan966x_fdb_erase_entries(struct lan966x *lan966x, u16 vid)
0093 {
0094     struct lan966x_fdb_entry *fdb_entry;
0095
0096     list_for_each_entry(fdb_entry, &lan966x->fdb_entries, list) {
0097         if (fdb_entry->vid != vid)
0098             continue;
0099
0100         lan966x_mac_cpu_forget(lan966x, fdb_entry->mac, fdb_entry->vid);
0101     }
0102 }
0103
0104 static void lan966x_fdb_purge_entries(struct lan966x *lan966x)
0105 {
0106     struct lan966x_fdb_entry *fdb_entry, *tmp;
0107
0108     list_for_each_entry_safe(fdb_entry, tmp, &lan966x->fdb_entries, list) {
0109         list_del(&fdb_entry->list);
0110         kfree(fdb_entry);
0111     }
0112 }
0113
0114 int lan966x_fdb_init(struct lan966x *lan966x)
0115 {
0116     INIT_LIST_HEAD(&lan966x->fdb_entries);
0117     lan966x->fdb_work = alloc_ordered_workqueue("lan966x_order", 0);
0118     if (!lan966x->fdb_work)
0119         return -ENOMEM;
0120
0121     return 0;
0122 }
0123
0124 void lan966x_fdb_deinit(struct lan966x *lan966x)
0125 {
0126     destroy_workqueue(lan966x->fdb_work);
0127     lan966x_fdb_purge_entries(lan966x);
0128 }
0129
0130 static void lan966x_fdb_event_work(struct work_struct *work)
0131 {
0132     struct lan966x_fdb_event_work *fdb_work =
0133         container_of(work, struct lan966x_fdb_event_work, work);
0134     struct switchdev_notifier_fdb_info *fdb_info;
0135     struct net_device *dev = fdb_work->dev;
0136     struct lan966x_port *port;
0137     struct lan966x *lan966x;
0138     int ret;
0139
0140     fdb_info = &fdb_work->fdb_info;
0141     lan966x = fdb_work->lan966x;
0142
0143     if (lan966x_netdevice_check(dev)) {
0144         port = netdev_priv(dev);
0145
0146         switch (fdb_work->event) {
0147         case SWITCHDEV_FDB_ADD_TO_DEVICE:
0148             if (!fdb_info->added_by_user)
0149                 break;
0150             lan966x_mac_add_entry(lan966x, port, fdb_info->addr,
0151                           fdb_info->vid);
0152             break;
0153         case SWITCHDEV_FDB_DEL_TO_DEVICE:
0154             if (!fdb_info->added_by_user)
0155                 break;
0156             lan966x_mac_del_entry(lan966x, fdb_info->addr,
0157                           fdb_info->vid);
0158             break;
0159         }
0160     } else {
0161         if (!netif_is_bridge_master(dev))
0162             goto out;
0163
0164         /* In case the bridge is called */
0165         switch (fdb_work->event) {
0166         case SWITCHDEV_FDB_ADD_TO_DEVICE:
0167             /* If there is no front port in this vlan, there is no
0168              * point to copy the frame to CPU because it would be
0169              * just dropped at later point. So add it only if
0170              * there is a port but it is required to store the fdb
0171              * entry for later point when a port actually gets in
0172              * the vlan.
0173              */
0174             lan966x_fdb_add_entry(lan966x, fdb_info);
0175             if (!lan966x_vlan_cpu_member_cpu_vlan_mask(lan966x,
0176                                    fdb_info->vid))
0177                 break;
0178
0179             lan966x_mac_cpu_learn(lan966x, fdb_info->addr,
0180                           fdb_info->vid);
0181             break;
0182         case SWITCHDEV_FDB_DEL_TO_DEVICE:
0183             ret = lan966x_fdb_del_entry(lan966x, fdb_info);
0184             if (!lan966x_vlan_cpu_member_cpu_vlan_mask(lan966x,
0185                                    fdb_info->vid))
0186                 break;
0187
0188             if (ret)
0189                 lan966x_mac_cpu_forget(lan966x, fdb_info->addr,
0190                                fdb_info->vid);
0191             break;
0192         }
0193     }
0194
0195 out:
0196     kfree(fdb_work->fdb_info.addr);
0197     kfree(fdb_work);
0198     dev_put(dev);
0199 }
0200
0201 int lan966x_handle_fdb(struct net_device *dev,
0202                struct net_device *orig_dev,
0203                unsigned long event, const void *ctx,
0204                const struct switchdev_notifier_fdb_info *fdb_info)
0205 {
0206     struct lan966x_port *port = netdev_priv(dev);
0207     struct lan966x *lan966x = port->lan966x;
0208     struct lan966x_fdb_event_work *fdb_work;
0209
0210     if (ctx && ctx != port)
0211         return 0;
0212
0213     switch (event) {
0214     case SWITCHDEV_FDB_ADD_TO_DEVICE:
0215     case SWITCHDEV_FDB_DEL_TO_DEVICE:
0216         if (lan966x_netdevice_check(orig_dev) &&
0217             !fdb_info->added_by_user)
0218             break;
0219
0220         fdb_work = kzalloc(sizeof(*fdb_work), GFP_ATOMIC);
0221         if (!fdb_work)
0222             return -ENOMEM;
0223
0224         fdb_work->dev = orig_dev;
0225         fdb_work->lan966x = lan966x;
0226         fdb_work->event = event;
0227         INIT_WORK(&fdb_work->work, lan966x_fdb_event_work);
0228         memcpy(&fdb_work->fdb_info, fdb_info, sizeof(fdb_work->fdb_info));
0229         fdb_work->fdb_info.addr = kzalloc(ETH_ALEN, GFP_ATOMIC);
0230         if (!fdb_work->fdb_info.addr)
0231             goto err_addr_alloc;
0232
0233         ether_addr_copy((u8 *)fdb_work->fdb_info.addr, fdb_info->addr);
0234         dev_hold(orig_dev);
0235
0236         queue_work(lan966x->fdb_work, &fdb_work->work);
0237         break;
0238     }
0239
0240     return 0;
0241 err_addr_alloc:
0242     kfree(fdb_work);
0243     return -ENOMEM;
0244 }