Commit | Line | Data |
---|---|---|
811ba277 HV |
1 | // SPDX-License-Identifier: GPL-2.0+ |
2 | ||
3 | #include <net/switchdev.h> | |
4 | ||
5 | #include "lan966x_main.h" | |
6 | ||
7 | struct lan966x_fdb_event_work { | |
8 | struct work_struct work; | |
9 | struct switchdev_notifier_fdb_info fdb_info; | |
10 | struct net_device *dev; | |
9b4ed7d2 | 11 | struct net_device *orig_dev; |
811ba277 HV |
12 | struct lan966x *lan966x; |
13 | unsigned long event; | |
14 | }; | |
15 | ||
16 | struct lan966x_fdb_entry { | |
17 | struct list_head list; | |
18 | unsigned char mac[ETH_ALEN] __aligned(2); | |
19 | u16 vid; | |
20 | u32 references; | |
21 | }; | |
22 | ||
23 | static struct lan966x_fdb_entry * | |
24 | lan966x_fdb_find_entry(struct lan966x *lan966x, | |
25 | struct switchdev_notifier_fdb_info *fdb_info) | |
26 | { | |
27 | struct lan966x_fdb_entry *fdb_entry; | |
28 | ||
29 | list_for_each_entry(fdb_entry, &lan966x->fdb_entries, list) { | |
30 | if (fdb_entry->vid == fdb_info->vid && | |
31 | ether_addr_equal(fdb_entry->mac, fdb_info->addr)) | |
32 | return fdb_entry; | |
33 | } | |
34 | ||
35 | return NULL; | |
36 | } | |
37 | ||
38 | static void lan966x_fdb_add_entry(struct lan966x *lan966x, | |
39 | struct switchdev_notifier_fdb_info *fdb_info) | |
40 | { | |
41 | struct lan966x_fdb_entry *fdb_entry; | |
42 | ||
43 | fdb_entry = lan966x_fdb_find_entry(lan966x, fdb_info); | |
44 | if (fdb_entry) { | |
45 | fdb_entry->references++; | |
46 | return; | |
47 | } | |
48 | ||
49 | fdb_entry = kzalloc(sizeof(*fdb_entry), GFP_KERNEL); | |
50 | if (!fdb_entry) | |
51 | return; | |
52 | ||
53 | ether_addr_copy(fdb_entry->mac, fdb_info->addr); | |
54 | fdb_entry->vid = fdb_info->vid; | |
55 | fdb_entry->references = 1; | |
56 | list_add_tail(&fdb_entry->list, &lan966x->fdb_entries); | |
57 | } | |
58 | ||
59 | static bool lan966x_fdb_del_entry(struct lan966x *lan966x, | |
60 | struct switchdev_notifier_fdb_info *fdb_info) | |
61 | { | |
62 | struct lan966x_fdb_entry *fdb_entry, *tmp; | |
63 | ||
64 | list_for_each_entry_safe(fdb_entry, tmp, &lan966x->fdb_entries, | |
65 | list) { | |
66 | if (fdb_entry->vid == fdb_info->vid && | |
67 | ether_addr_equal(fdb_entry->mac, fdb_info->addr)) { | |
68 | fdb_entry->references--; | |
69 | if (!fdb_entry->references) { | |
70 | list_del(&fdb_entry->list); | |
71 | kfree(fdb_entry); | |
72 | return true; | |
73 | } | |
74 | break; | |
75 | } | |
76 | } | |
77 | ||
78 | return false; | |
79 | } | |
80 | ||
81 | void lan966x_fdb_write_entries(struct lan966x *lan966x, u16 vid) | |
82 | { | |
83 | struct lan966x_fdb_entry *fdb_entry; | |
84 | ||
85 | list_for_each_entry(fdb_entry, &lan966x->fdb_entries, list) { | |
86 | if (fdb_entry->vid != vid) | |
87 | continue; | |
88 | ||
89 | lan966x_mac_cpu_learn(lan966x, fdb_entry->mac, fdb_entry->vid); | |
90 | } | |
91 | } | |
92 | ||
93 | void lan966x_fdb_erase_entries(struct lan966x *lan966x, u16 vid) | |
94 | { | |
95 | struct lan966x_fdb_entry *fdb_entry; | |
96 | ||
97 | list_for_each_entry(fdb_entry, &lan966x->fdb_entries, list) { | |
98 | if (fdb_entry->vid != vid) | |
99 | continue; | |
100 | ||
101 | lan966x_mac_cpu_forget(lan966x, fdb_entry->mac, fdb_entry->vid); | |
102 | } | |
103 | } | |
104 | ||
105 | static void lan966x_fdb_purge_entries(struct lan966x *lan966x) | |
106 | { | |
107 | struct lan966x_fdb_entry *fdb_entry, *tmp; | |
108 | ||
109 | list_for_each_entry_safe(fdb_entry, tmp, &lan966x->fdb_entries, list) { | |
110 | list_del(&fdb_entry->list); | |
111 | kfree(fdb_entry); | |
112 | } | |
113 | } | |
114 | ||
115 | int lan966x_fdb_init(struct lan966x *lan966x) | |
116 | { | |
117 | INIT_LIST_HEAD(&lan966x->fdb_entries); | |
118 | lan966x->fdb_work = alloc_ordered_workqueue("lan966x_order", 0); | |
119 | if (!lan966x->fdb_work) | |
120 | return -ENOMEM; | |
121 | ||
122 | return 0; | |
123 | } | |
124 | ||
125 | void lan966x_fdb_deinit(struct lan966x *lan966x) | |
126 | { | |
127 | destroy_workqueue(lan966x->fdb_work); | |
128 | lan966x_fdb_purge_entries(lan966x); | |
129 | } | |
130 | ||
86bac7f1 HV |
131 | void lan966x_fdb_flush_workqueue(struct lan966x *lan966x) |
132 | { | |
133 | flush_workqueue(lan966x->fdb_work); | |
134 | } | |
135 | ||
9b4ed7d2 | 136 | static void lan966x_fdb_port_event_work(struct lan966x_fdb_event_work *fdb_work) |
811ba277 | 137 | { |
811ba277 | 138 | struct switchdev_notifier_fdb_info *fdb_info; |
811ba277 HV |
139 | struct lan966x_port *port; |
140 | struct lan966x *lan966x; | |
811ba277 | 141 | |
811ba277 | 142 | lan966x = fdb_work->lan966x; |
9b4ed7d2 HV |
143 | port = netdev_priv(fdb_work->orig_dev); |
144 | fdb_info = &fdb_work->fdb_info; | |
811ba277 | 145 | |
9b4ed7d2 HV |
146 | switch (fdb_work->event) { |
147 | case SWITCHDEV_FDB_ADD_TO_DEVICE: | |
148 | if (!fdb_info->added_by_user) | |
811ba277 | 149 | break; |
9b4ed7d2 HV |
150 | lan966x_mac_add_entry(lan966x, port, fdb_info->addr, |
151 | fdb_info->vid); | |
152 | break; | |
153 | case SWITCHDEV_FDB_DEL_TO_DEVICE: | |
154 | if (!fdb_info->added_by_user) | |
811ba277 | 155 | break; |
9b4ed7d2 HV |
156 | lan966x_mac_del_entry(lan966x, fdb_info->addr, |
157 | fdb_info->vid); | |
158 | break; | |
159 | } | |
160 | } | |
161 | ||
162 | static void lan966x_fdb_bridge_event_work(struct lan966x_fdb_event_work *fdb_work) | |
163 | { | |
164 | struct switchdev_notifier_fdb_info *fdb_info; | |
165 | struct lan966x *lan966x; | |
166 | int ret; | |
167 | ||
168 | lan966x = fdb_work->lan966x; | |
169 | fdb_info = &fdb_work->fdb_info; | |
170 | ||
171 | /* In case the bridge is called */ | |
172 | switch (fdb_work->event) { | |
173 | case SWITCHDEV_FDB_ADD_TO_DEVICE: | |
174 | /* If there is no front port in this vlan, there is no | |
175 | * point to copy the frame to CPU because it would be | |
176 | * just dropped at later point. So add it only if | |
177 | * there is a port but it is required to store the fdb | |
178 | * entry for later point when a port actually gets in | |
179 | * the vlan. | |
180 | */ | |
181 | lan966x_fdb_add_entry(lan966x, fdb_info); | |
182 | if (!lan966x_vlan_cpu_member_cpu_vlan_mask(lan966x, | |
183 | fdb_info->vid)) | |
811ba277 | 184 | break; |
9b4ed7d2 HV |
185 | |
186 | lan966x_mac_cpu_learn(lan966x, fdb_info->addr, | |
187 | fdb_info->vid); | |
188 | break; | |
189 | case SWITCHDEV_FDB_DEL_TO_DEVICE: | |
190 | ret = lan966x_fdb_del_entry(lan966x, fdb_info); | |
191 | if (!lan966x_vlan_cpu_member_cpu_vlan_mask(lan966x, | |
192 | fdb_info->vid)) | |
811ba277 | 193 | break; |
9b4ed7d2 HV |
194 | |
195 | if (ret) | |
196 | lan966x_mac_cpu_forget(lan966x, fdb_info->addr, | |
197 | fdb_info->vid); | |
198 | break; | |
811ba277 | 199 | } |
9b4ed7d2 HV |
200 | } |
201 | ||
9be99f2d HV |
202 | static void lan966x_fdb_lag_event_work(struct lan966x_fdb_event_work *fdb_work) |
203 | { | |
204 | struct switchdev_notifier_fdb_info *fdb_info; | |
205 | struct lan966x_port *port; | |
206 | struct lan966x *lan966x; | |
207 | ||
208 | if (!lan966x_lag_first_port(fdb_work->orig_dev, fdb_work->dev)) | |
209 | return; | |
210 | ||
211 | lan966x = fdb_work->lan966x; | |
212 | port = netdev_priv(fdb_work->dev); | |
213 | fdb_info = &fdb_work->fdb_info; | |
214 | ||
215 | switch (fdb_work->event) { | |
216 | case SWITCHDEV_FDB_ADD_TO_DEVICE: | |
217 | if (!fdb_info->added_by_user) | |
218 | break; | |
219 | lan966x_mac_add_entry(lan966x, port, fdb_info->addr, | |
220 | fdb_info->vid); | |
221 | break; | |
222 | case SWITCHDEV_FDB_DEL_TO_DEVICE: | |
223 | if (!fdb_info->added_by_user) | |
224 | break; | |
225 | lan966x_mac_del_entry(lan966x, fdb_info->addr, fdb_info->vid); | |
226 | break; | |
227 | } | |
228 | } | |
229 | ||
9b4ed7d2 HV |
230 | static void lan966x_fdb_event_work(struct work_struct *work) |
231 | { | |
232 | struct lan966x_fdb_event_work *fdb_work = | |
233 | container_of(work, struct lan966x_fdb_event_work, work); | |
234 | ||
235 | if (lan966x_netdevice_check(fdb_work->orig_dev)) | |
236 | lan966x_fdb_port_event_work(fdb_work); | |
237 | else if (netif_is_bridge_master(fdb_work->orig_dev)) | |
238 | lan966x_fdb_bridge_event_work(fdb_work); | |
9be99f2d HV |
239 | else if (netif_is_lag_master(fdb_work->orig_dev)) |
240 | lan966x_fdb_lag_event_work(fdb_work); | |
811ba277 | 241 | |
811ba277 HV |
242 | kfree(fdb_work->fdb_info.addr); |
243 | kfree(fdb_work); | |
811ba277 HV |
244 | } |
245 | ||
246 | int lan966x_handle_fdb(struct net_device *dev, | |
247 | struct net_device *orig_dev, | |
248 | unsigned long event, const void *ctx, | |
249 | const struct switchdev_notifier_fdb_info *fdb_info) | |
250 | { | |
251 | struct lan966x_port *port = netdev_priv(dev); | |
252 | struct lan966x *lan966x = port->lan966x; | |
253 | struct lan966x_fdb_event_work *fdb_work; | |
254 | ||
255 | if (ctx && ctx != port) | |
256 | return 0; | |
257 | ||
258 | switch (event) { | |
259 | case SWITCHDEV_FDB_ADD_TO_DEVICE: | |
260 | case SWITCHDEV_FDB_DEL_TO_DEVICE: | |
261 | if (lan966x_netdevice_check(orig_dev) && | |
262 | !fdb_info->added_by_user) | |
263 | break; | |
264 | ||
265 | fdb_work = kzalloc(sizeof(*fdb_work), GFP_ATOMIC); | |
266 | if (!fdb_work) | |
267 | return -ENOMEM; | |
268 | ||
9b4ed7d2 HV |
269 | fdb_work->dev = dev; |
270 | fdb_work->orig_dev = orig_dev; | |
811ba277 HV |
271 | fdb_work->lan966x = lan966x; |
272 | fdb_work->event = event; | |
273 | INIT_WORK(&fdb_work->work, lan966x_fdb_event_work); | |
274 | memcpy(&fdb_work->fdb_info, fdb_info, sizeof(fdb_work->fdb_info)); | |
275 | fdb_work->fdb_info.addr = kzalloc(ETH_ALEN, GFP_ATOMIC); | |
276 | if (!fdb_work->fdb_info.addr) | |
277 | goto err_addr_alloc; | |
278 | ||
279 | ether_addr_copy((u8 *)fdb_work->fdb_info.addr, fdb_info->addr); | |
811ba277 HV |
280 | |
281 | queue_work(lan966x->fdb_work, &fdb_work->work); | |
282 | break; | |
283 | } | |
284 | ||
285 | return 0; | |
286 | err_addr_alloc: | |
287 | kfree(fdb_work); | |
288 | return -ENOMEM; | |
289 | } |