Merge https://git.kernel.org/pub/scm/linux/kernel/git/bpf/bpf
[linux-2.6-microblaze.git] / drivers / net / ethernet / intel / ice / ice_fltr.c
1 // SPDX-License-Identifier: GPL-2.0
2 /* Copyright (C) 2018-2020, Intel Corporation. */
3
4 #include "ice.h"
5 #include "ice_fltr.h"
6
7 /**
8  * ice_fltr_free_list - free filter lists helper
9  * @dev: pointer to the device struct
10  * @h: pointer to the list head to be freed
11  *
12  * Helper function to free filter lists previously created using
13  * ice_fltr_add_mac_to_list
14  */
15 void ice_fltr_free_list(struct device *dev, struct list_head *h)
16 {
17         struct ice_fltr_list_entry *e, *tmp;
18
19         list_for_each_entry_safe(e, tmp, h, list_entry) {
20                 list_del(&e->list_entry);
21                 devm_kfree(dev, e);
22         }
23 }
24
25 /**
26  * ice_fltr_add_entry_to_list - allocate and add filter entry to list
27  * @dev: pointer to device needed by alloc function
28  * @info: filter info struct that gets added to the passed in list
29  * @list: pointer to the list which contains MAC filters entry
30  */
31 static int
32 ice_fltr_add_entry_to_list(struct device *dev, struct ice_fltr_info *info,
33                            struct list_head *list)
34 {
35         struct ice_fltr_list_entry *entry;
36
37         entry = devm_kzalloc(dev, sizeof(*entry), GFP_ATOMIC);
38         if (!entry)
39                 return -ENOMEM;
40
41         entry->fltr_info = *info;
42
43         INIT_LIST_HEAD(&entry->list_entry);
44         list_add(&entry->list_entry, list);
45
46         return 0;
47 }
48
49 /**
50  * ice_fltr_set_vlan_vsi_promisc
51  * @hw: pointer to the hardware structure
52  * @vsi: the VSI being configured
53  * @promisc_mask: mask of promiscuous config bits
54  *
55  * Set VSI with all associated VLANs to given promiscuous mode(s)
56  */
57 int
58 ice_fltr_set_vlan_vsi_promisc(struct ice_hw *hw, struct ice_vsi *vsi,
59                               u8 promisc_mask)
60 {
61         struct ice_pf *pf = hw->back;
62         int result;
63
64         result = ice_set_vlan_vsi_promisc(hw, vsi->idx, promisc_mask, false);
65         if (result)
66                 dev_err(ice_pf_to_dev(pf),
67                         "Error setting promisc mode on VSI %i (rc=%d)\n",
68                         vsi->vsi_num, result);
69
70         return result;
71 }
72
73 /**
74  * ice_fltr_clear_vlan_vsi_promisc
75  * @hw: pointer to the hardware structure
76  * @vsi: the VSI being configured
77  * @promisc_mask: mask of promiscuous config bits
78  *
79  * Clear VSI with all associated VLANs to given promiscuous mode(s)
80  */
81 int
82 ice_fltr_clear_vlan_vsi_promisc(struct ice_hw *hw, struct ice_vsi *vsi,
83                                 u8 promisc_mask)
84 {
85         struct ice_pf *pf = hw->back;
86         int result;
87
88         result = ice_set_vlan_vsi_promisc(hw, vsi->idx, promisc_mask, true);
89         if (result)
90                 dev_err(ice_pf_to_dev(pf),
91                         "Error clearing promisc mode on VSI %i (rc=%d)\n",
92                         vsi->vsi_num, result);
93
94         return result;
95 }
96
97 /**
98  * ice_fltr_clear_vsi_promisc - clear specified promiscuous mode(s)
99  * @hw: pointer to the hardware structure
100  * @vsi_handle: VSI handle to clear mode
101  * @promisc_mask: mask of promiscuous config bits to clear
102  * @vid: VLAN ID to clear VLAN promiscuous
103  */
104 int
105 ice_fltr_clear_vsi_promisc(struct ice_hw *hw, u16 vsi_handle, u8 promisc_mask,
106                            u16 vid)
107 {
108         struct ice_pf *pf = hw->back;
109         int result;
110
111         result = ice_clear_vsi_promisc(hw, vsi_handle, promisc_mask, vid);
112         if (result)
113                 dev_err(ice_pf_to_dev(pf),
114                         "Error clearing promisc mode on VSI %i for VID %u (rc=%d)\n",
115                         ice_get_hw_vsi_num(hw, vsi_handle), vid, result);
116
117         return result;
118 }
119
120 /**
121  * ice_fltr_set_vsi_promisc - set given VSI to given promiscuous mode(s)
122  * @hw: pointer to the hardware structure
123  * @vsi_handle: VSI handle to configure
124  * @promisc_mask: mask of promiscuous config bits
125  * @vid: VLAN ID to set VLAN promiscuous
126  */
127 int
128 ice_fltr_set_vsi_promisc(struct ice_hw *hw, u16 vsi_handle, u8 promisc_mask,
129                          u16 vid)
130 {
131         struct ice_pf *pf = hw->back;
132         int result;
133
134         result = ice_set_vsi_promisc(hw, vsi_handle, promisc_mask, vid);
135         if (result)
136                 dev_err(ice_pf_to_dev(pf),
137                         "Error setting promisc mode on VSI %i for VID %u (rc=%d)\n",
138                         ice_get_hw_vsi_num(hw, vsi_handle), vid, result);
139
140         return result;
141 }
142
143 /**
144  * ice_fltr_add_mac_list - add list of MAC filters
145  * @vsi: pointer to VSI struct
146  * @list: list of filters
147  */
148 int ice_fltr_add_mac_list(struct ice_vsi *vsi, struct list_head *list)
149 {
150         return ice_add_mac(&vsi->back->hw, list);
151 }
152
153 /**
154  * ice_fltr_remove_mac_list - remove list of MAC filters
155  * @vsi: pointer to VSI struct
156  * @list: list of filters
157  */
158 int ice_fltr_remove_mac_list(struct ice_vsi *vsi, struct list_head *list)
159 {
160         return ice_remove_mac(&vsi->back->hw, list);
161 }
162
163 /**
164  * ice_fltr_add_vlan_list - add list of VLAN filters
165  * @vsi: pointer to VSI struct
166  * @list: list of filters
167  */
168 static int ice_fltr_add_vlan_list(struct ice_vsi *vsi, struct list_head *list)
169 {
170         return ice_add_vlan(&vsi->back->hw, list);
171 }
172
173 /**
174  * ice_fltr_remove_vlan_list - remove list of VLAN filters
175  * @vsi: pointer to VSI struct
176  * @list: list of filters
177  */
178 static int
179 ice_fltr_remove_vlan_list(struct ice_vsi *vsi, struct list_head *list)
180 {
181         return ice_remove_vlan(&vsi->back->hw, list);
182 }
183
184 /**
185  * ice_fltr_add_eth_list - add list of ethertype filters
186  * @vsi: pointer to VSI struct
187  * @list: list of filters
188  */
189 static int ice_fltr_add_eth_list(struct ice_vsi *vsi, struct list_head *list)
190 {
191         return ice_add_eth_mac(&vsi->back->hw, list);
192 }
193
194 /**
195  * ice_fltr_remove_eth_list - remove list of ethertype filters
196  * @vsi: pointer to VSI struct
197  * @list: list of filters
198  */
199 static int ice_fltr_remove_eth_list(struct ice_vsi *vsi, struct list_head *list)
200 {
201         return ice_remove_eth_mac(&vsi->back->hw, list);
202 }
203
204 /**
205  * ice_fltr_remove_all - remove all filters associated with VSI
206  * @vsi: pointer to VSI struct
207  */
208 void ice_fltr_remove_all(struct ice_vsi *vsi)
209 {
210         ice_remove_vsi_fltr(&vsi->back->hw, vsi->idx);
211 }
212
213 /**
214  * ice_fltr_add_mac_to_list - add MAC filter info to exsisting list
215  * @vsi: pointer to VSI struct
216  * @list: list to add filter info to
217  * @mac: MAC address to add
218  * @action: filter action
219  */
220 int
221 ice_fltr_add_mac_to_list(struct ice_vsi *vsi, struct list_head *list,
222                          const u8 *mac, enum ice_sw_fwd_act_type action)
223 {
224         struct ice_fltr_info info = { 0 };
225
226         info.flag = ICE_FLTR_TX;
227         info.src_id = ICE_SRC_ID_VSI;
228         info.lkup_type = ICE_SW_LKUP_MAC;
229         info.fltr_act = action;
230         info.vsi_handle = vsi->idx;
231
232         ether_addr_copy(info.l_data.mac.mac_addr, mac);
233
234         return ice_fltr_add_entry_to_list(ice_pf_to_dev(vsi->back), &info,
235                                           list);
236 }
237
238 /**
239  * ice_fltr_add_vlan_to_list - add VLAN filter info to exsisting list
240  * @vsi: pointer to VSI struct
241  * @list: list to add filter info to
242  * @vlan: VLAN filter details
243  */
244 static int
245 ice_fltr_add_vlan_to_list(struct ice_vsi *vsi, struct list_head *list,
246                           struct ice_vlan *vlan)
247 {
248         struct ice_fltr_info info = { 0 };
249
250         info.flag = ICE_FLTR_TX;
251         info.src_id = ICE_SRC_ID_VSI;
252         info.lkup_type = ICE_SW_LKUP_VLAN;
253         info.fltr_act = ICE_FWD_TO_VSI;
254         info.vsi_handle = vsi->idx;
255         info.l_data.vlan.vlan_id = vlan->vid;
256         info.l_data.vlan.tpid = vlan->tpid;
257         info.l_data.vlan.tpid_valid = true;
258
259         return ice_fltr_add_entry_to_list(ice_pf_to_dev(vsi->back), &info,
260                                           list);
261 }
262
263 /**
264  * ice_fltr_add_eth_to_list - add ethertype filter info to exsisting list
265  * @vsi: pointer to VSI struct
266  * @list: list to add filter info to
267  * @ethertype: ethertype of packet that matches filter
268  * @flag: filter direction, Tx or Rx
269  * @action: filter action
270  */
271 static int
272 ice_fltr_add_eth_to_list(struct ice_vsi *vsi, struct list_head *list,
273                          u16 ethertype, u16 flag,
274                          enum ice_sw_fwd_act_type action)
275 {
276         struct ice_fltr_info info = { 0 };
277
278         info.flag = flag;
279         info.lkup_type = ICE_SW_LKUP_ETHERTYPE;
280         info.fltr_act = action;
281         info.vsi_handle = vsi->idx;
282         info.l_data.ethertype_mac.ethertype = ethertype;
283
284         if (flag == ICE_FLTR_TX)
285                 info.src_id = ICE_SRC_ID_VSI;
286         else
287                 info.src_id = ICE_SRC_ID_LPORT;
288
289         return ice_fltr_add_entry_to_list(ice_pf_to_dev(vsi->back), &info,
290                                           list);
291 }
292
293 /**
294  * ice_fltr_prepare_mac - add or remove MAC rule
295  * @vsi: pointer to VSI struct
296  * @mac: MAC address to add
297  * @action: action to be performed on filter match
298  * @mac_action: pointer to add or remove MAC function
299  */
300 static int
301 ice_fltr_prepare_mac(struct ice_vsi *vsi, const u8 *mac,
302                      enum ice_sw_fwd_act_type action,
303                      int (*mac_action)(struct ice_vsi *, struct list_head *))
304 {
305         LIST_HEAD(tmp_list);
306         int result;
307
308         if (ice_fltr_add_mac_to_list(vsi, &tmp_list, mac, action)) {
309                 ice_fltr_free_list(ice_pf_to_dev(vsi->back), &tmp_list);
310                 return -ENOMEM;
311         }
312
313         result = mac_action(vsi, &tmp_list);
314         ice_fltr_free_list(ice_pf_to_dev(vsi->back), &tmp_list);
315         return result;
316 }
317
318 /**
319  * ice_fltr_prepare_mac_and_broadcast - add or remove MAC and broadcast filter
320  * @vsi: pointer to VSI struct
321  * @mac: MAC address to add
322  * @action: action to be performed on filter match
323  * @mac_action: pointer to add or remove MAC function
324  */
325 static int
326 ice_fltr_prepare_mac_and_broadcast(struct ice_vsi *vsi, const u8 *mac,
327                                    enum ice_sw_fwd_act_type action,
328                                    int(*mac_action)
329                                    (struct ice_vsi *, struct list_head *))
330 {
331         u8 broadcast[ETH_ALEN];
332         LIST_HEAD(tmp_list);
333         int result;
334
335         eth_broadcast_addr(broadcast);
336         if (ice_fltr_add_mac_to_list(vsi, &tmp_list, mac, action) ||
337             ice_fltr_add_mac_to_list(vsi, &tmp_list, broadcast, action)) {
338                 ice_fltr_free_list(ice_pf_to_dev(vsi->back), &tmp_list);
339                 return -ENOMEM;
340         }
341
342         result = mac_action(vsi, &tmp_list);
343         ice_fltr_free_list(ice_pf_to_dev(vsi->back), &tmp_list);
344         return result;
345 }
346
347 /**
348  * ice_fltr_prepare_vlan - add or remove VLAN filter
349  * @vsi: pointer to VSI struct
350  * @vlan: VLAN filter details
351  * @vlan_action: pointer to add or remove VLAN function
352  */
353 static int
354 ice_fltr_prepare_vlan(struct ice_vsi *vsi, struct ice_vlan *vlan,
355                       int (*vlan_action)(struct ice_vsi *, struct list_head *))
356 {
357         LIST_HEAD(tmp_list);
358         int result;
359
360         if (ice_fltr_add_vlan_to_list(vsi, &tmp_list, vlan))
361                 return -ENOMEM;
362
363         result = vlan_action(vsi, &tmp_list);
364         ice_fltr_free_list(ice_pf_to_dev(vsi->back), &tmp_list);
365         return result;
366 }
367
368 /**
369  * ice_fltr_prepare_eth - add or remove ethertype filter
370  * @vsi: pointer to VSI struct
371  * @ethertype: ethertype of packet to be filtered
372  * @flag: direction of packet, Tx or Rx
373  * @action: action to be performed on filter match
374  * @eth_action: pointer to add or remove ethertype function
375  */
376 static int
377 ice_fltr_prepare_eth(struct ice_vsi *vsi, u16 ethertype, u16 flag,
378                      enum ice_sw_fwd_act_type action,
379                      int (*eth_action)(struct ice_vsi *, struct list_head *))
380 {
381         LIST_HEAD(tmp_list);
382         int result;
383
384         if (ice_fltr_add_eth_to_list(vsi, &tmp_list, ethertype, flag, action))
385                 return -ENOMEM;
386
387         result = eth_action(vsi, &tmp_list);
388         ice_fltr_free_list(ice_pf_to_dev(vsi->back), &tmp_list);
389         return result;
390 }
391
392 /**
393  * ice_fltr_add_mac - add single MAC filter
394  * @vsi: pointer to VSI struct
395  * @mac: MAC to add
396  * @action: action to be performed on filter match
397  */
398 int ice_fltr_add_mac(struct ice_vsi *vsi, const u8 *mac,
399                      enum ice_sw_fwd_act_type action)
400 {
401         return ice_fltr_prepare_mac(vsi, mac, action, ice_fltr_add_mac_list);
402 }
403
404 /**
405  * ice_fltr_add_mac_and_broadcast - add single MAC and broadcast
406  * @vsi: pointer to VSI struct
407  * @mac: MAC to add
408  * @action: action to be performed on filter match
409  */
410 int
411 ice_fltr_add_mac_and_broadcast(struct ice_vsi *vsi, const u8 *mac,
412                                enum ice_sw_fwd_act_type action)
413 {
414         return ice_fltr_prepare_mac_and_broadcast(vsi, mac, action,
415                                                   ice_fltr_add_mac_list);
416 }
417
418 /**
419  * ice_fltr_remove_mac - remove MAC filter
420  * @vsi: pointer to VSI struct
421  * @mac: filter MAC to remove
422  * @action: action to remove
423  */
424 int ice_fltr_remove_mac(struct ice_vsi *vsi, const u8 *mac,
425                         enum ice_sw_fwd_act_type action)
426 {
427         return ice_fltr_prepare_mac(vsi, mac, action, ice_fltr_remove_mac_list);
428 }
429
430 /**
431  * ice_fltr_add_vlan - add single VLAN filter
432  * @vsi: pointer to VSI struct
433  * @vlan: VLAN filter details
434  */
435 int ice_fltr_add_vlan(struct ice_vsi *vsi, struct ice_vlan *vlan)
436 {
437         return ice_fltr_prepare_vlan(vsi, vlan, ice_fltr_add_vlan_list);
438 }
439
440 /**
441  * ice_fltr_remove_vlan - remove VLAN filter
442  * @vsi: pointer to VSI struct
443  * @vlan: VLAN filter details
444  */
445 int ice_fltr_remove_vlan(struct ice_vsi *vsi, struct ice_vlan *vlan)
446 {
447         return ice_fltr_prepare_vlan(vsi, vlan, ice_fltr_remove_vlan_list);
448 }
449
450 /**
451  * ice_fltr_add_eth - add specyfic ethertype filter
452  * @vsi: pointer to VSI struct
453  * @ethertype: ethertype of filter
454  * @flag: direction of packet to be filtered, Tx or Rx
455  * @action: action to be performed on filter match
456  */
457 int ice_fltr_add_eth(struct ice_vsi *vsi, u16 ethertype, u16 flag,
458                      enum ice_sw_fwd_act_type action)
459 {
460         return ice_fltr_prepare_eth(vsi, ethertype, flag, action,
461                                     ice_fltr_add_eth_list);
462 }
463
464 /**
465  * ice_fltr_remove_eth - remove ethertype filter
466  * @vsi: pointer to VSI struct
467  * @ethertype: ethertype of filter
468  * @flag: direction of filter
469  * @action: action to remove
470  */
471 int ice_fltr_remove_eth(struct ice_vsi *vsi, u16 ethertype, u16 flag,
472                         enum ice_sw_fwd_act_type action)
473 {
474         return ice_fltr_prepare_eth(vsi, ethertype, flag, action,
475                                     ice_fltr_remove_eth_list);
476 }