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 */
15void 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 */
31static int
32ice_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 */
57int
58ice_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 && result != -EEXIST)
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 */
81int
82ice_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 && result != -EEXIST)
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 */
104int
105ice_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 && result != -EEXIST)
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 */
127int
128ice_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 && result != -EEXIST)
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 */
148int 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 */
158int 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 */
168static 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 */
178static int
179ice_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 */
189static 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 */
199static 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 */
208void ice_fltr_remove_all(struct ice_vsi *vsi)
209{
210	ice_remove_vsi_fltr(&vsi->back->hw, vsi->idx);
211	/* sync netdev filters if exist */
212	if (vsi->netdev) {
213		__dev_uc_unsync(vsi->netdev, NULL);
214		__dev_mc_unsync(vsi->netdev, NULL);
215	}
216}
217
218/**
219 * ice_fltr_add_mac_to_list - add MAC filter info to exsisting list
220 * @vsi: pointer to VSI struct
221 * @list: list to add filter info to
222 * @mac: MAC address to add
223 * @action: filter action
224 */
225int
226ice_fltr_add_mac_to_list(struct ice_vsi *vsi, struct list_head *list,
227			 const u8 *mac, enum ice_sw_fwd_act_type action)
228{
229	struct ice_fltr_info info = { 0 };
230
231	info.flag = ICE_FLTR_TX;
232	info.src_id = ICE_SRC_ID_VSI;
233	info.lkup_type = ICE_SW_LKUP_MAC;
234	info.fltr_act = action;
235	info.vsi_handle = vsi->idx;
236
237	ether_addr_copy(info.l_data.mac.mac_addr, mac);
238
239	return ice_fltr_add_entry_to_list(ice_pf_to_dev(vsi->back), &info,
240					  list);
241}
242
243/**
244 * ice_fltr_add_vlan_to_list - add VLAN filter info to exsisting list
245 * @vsi: pointer to VSI struct
246 * @list: list to add filter info to
247 * @vlan: VLAN filter details
248 */
249static int
250ice_fltr_add_vlan_to_list(struct ice_vsi *vsi, struct list_head *list,
251			  struct ice_vlan *vlan)
252{
253	struct ice_fltr_info info = { 0 };
254
255	info.flag = ICE_FLTR_TX;
256	info.src_id = ICE_SRC_ID_VSI;
257	info.lkup_type = ICE_SW_LKUP_VLAN;
258	info.fltr_act = ICE_FWD_TO_VSI;
259	info.vsi_handle = vsi->idx;
260	info.l_data.vlan.vlan_id = vlan->vid;
261	info.l_data.vlan.tpid = vlan->tpid;
262	info.l_data.vlan.tpid_valid = true;
263
264	return ice_fltr_add_entry_to_list(ice_pf_to_dev(vsi->back), &info,
265					  list);
266}
267
268/**
269 * ice_fltr_add_eth_to_list - add ethertype filter info to exsisting list
270 * @vsi: pointer to VSI struct
271 * @list: list to add filter info to
272 * @ethertype: ethertype of packet that matches filter
273 * @flag: filter direction, Tx or Rx
274 * @action: filter action
275 */
276static int
277ice_fltr_add_eth_to_list(struct ice_vsi *vsi, struct list_head *list,
278			 u16 ethertype, u16 flag,
279			 enum ice_sw_fwd_act_type action)
280{
281	struct ice_fltr_info info = { 0 };
282
283	info.flag = flag;
284	info.lkup_type = ICE_SW_LKUP_ETHERTYPE;
285	info.fltr_act = action;
286	info.vsi_handle = vsi->idx;
287	info.l_data.ethertype_mac.ethertype = ethertype;
288
289	if (flag == ICE_FLTR_TX)
290		info.src_id = ICE_SRC_ID_VSI;
291	else
292		info.src_id = ICE_SRC_ID_LPORT;
293
294	return ice_fltr_add_entry_to_list(ice_pf_to_dev(vsi->back), &info,
295					  list);
296}
297
298/**
299 * ice_fltr_prepare_mac - add or remove MAC rule
300 * @vsi: pointer to VSI struct
301 * @mac: MAC address to add
302 * @action: action to be performed on filter match
303 * @mac_action: pointer to add or remove MAC function
304 */
305static int
306ice_fltr_prepare_mac(struct ice_vsi *vsi, const u8 *mac,
307		     enum ice_sw_fwd_act_type action,
308		     int (*mac_action)(struct ice_vsi *, struct list_head *))
309{
310	LIST_HEAD(tmp_list);
311	int result;
312
313	if (ice_fltr_add_mac_to_list(vsi, &tmp_list, mac, action)) {
314		ice_fltr_free_list(ice_pf_to_dev(vsi->back), &tmp_list);
315		return -ENOMEM;
316	}
317
318	result = mac_action(vsi, &tmp_list);
319	ice_fltr_free_list(ice_pf_to_dev(vsi->back), &tmp_list);
320	return result;
321}
322
323/**
324 * ice_fltr_prepare_mac_and_broadcast - add or remove MAC and broadcast filter
325 * @vsi: pointer to VSI struct
326 * @mac: MAC address to add
327 * @action: action to be performed on filter match
328 * @mac_action: pointer to add or remove MAC function
329 */
330static int
331ice_fltr_prepare_mac_and_broadcast(struct ice_vsi *vsi, const u8 *mac,
332				   enum ice_sw_fwd_act_type action,
333				   int(*mac_action)
334				   (struct ice_vsi *, struct list_head *))
335{
336	u8 broadcast[ETH_ALEN];
337	LIST_HEAD(tmp_list);
338	int result;
339
340	eth_broadcast_addr(broadcast);
341	if (ice_fltr_add_mac_to_list(vsi, &tmp_list, mac, action) ||
342	    ice_fltr_add_mac_to_list(vsi, &tmp_list, broadcast, action)) {
343		ice_fltr_free_list(ice_pf_to_dev(vsi->back), &tmp_list);
344		return -ENOMEM;
345	}
346
347	result = mac_action(vsi, &tmp_list);
348	ice_fltr_free_list(ice_pf_to_dev(vsi->back), &tmp_list);
349	return result;
350}
351
352/**
353 * ice_fltr_prepare_vlan - add or remove VLAN filter
354 * @vsi: pointer to VSI struct
355 * @vlan: VLAN filter details
356 * @vlan_action: pointer to add or remove VLAN function
357 */
358static int
359ice_fltr_prepare_vlan(struct ice_vsi *vsi, struct ice_vlan *vlan,
360		      int (*vlan_action)(struct ice_vsi *, struct list_head *))
361{
362	LIST_HEAD(tmp_list);
363	int result;
364
365	if (ice_fltr_add_vlan_to_list(vsi, &tmp_list, vlan))
366		return -ENOMEM;
367
368	result = vlan_action(vsi, &tmp_list);
369	ice_fltr_free_list(ice_pf_to_dev(vsi->back), &tmp_list);
370	return result;
371}
372
373/**
374 * ice_fltr_prepare_eth - add or remove ethertype filter
375 * @vsi: pointer to VSI struct
376 * @ethertype: ethertype of packet to be filtered
377 * @flag: direction of packet, Tx or Rx
378 * @action: action to be performed on filter match
379 * @eth_action: pointer to add or remove ethertype function
380 */
381static int
382ice_fltr_prepare_eth(struct ice_vsi *vsi, u16 ethertype, u16 flag,
383		     enum ice_sw_fwd_act_type action,
384		     int (*eth_action)(struct ice_vsi *, struct list_head *))
385{
386	LIST_HEAD(tmp_list);
387	int result;
388
389	if (ice_fltr_add_eth_to_list(vsi, &tmp_list, ethertype, flag, action))
390		return -ENOMEM;
391
392	result = eth_action(vsi, &tmp_list);
393	ice_fltr_free_list(ice_pf_to_dev(vsi->back), &tmp_list);
394	return result;
395}
396
397/**
398 * ice_fltr_add_mac - add single MAC filter
399 * @vsi: pointer to VSI struct
400 * @mac: MAC to add
401 * @action: action to be performed on filter match
402 */
403int ice_fltr_add_mac(struct ice_vsi *vsi, const u8 *mac,
404		     enum ice_sw_fwd_act_type action)
405{
406	return ice_fltr_prepare_mac(vsi, mac, action, ice_fltr_add_mac_list);
407}
408
409/**
410 * ice_fltr_add_mac_and_broadcast - add single MAC and broadcast
411 * @vsi: pointer to VSI struct
412 * @mac: MAC to add
413 * @action: action to be performed on filter match
414 */
415int
416ice_fltr_add_mac_and_broadcast(struct ice_vsi *vsi, const u8 *mac,
417			       enum ice_sw_fwd_act_type action)
418{
419	return ice_fltr_prepare_mac_and_broadcast(vsi, mac, action,
420						  ice_fltr_add_mac_list);
421}
422
423/**
424 * ice_fltr_remove_mac - remove MAC filter
425 * @vsi: pointer to VSI struct
426 * @mac: filter MAC to remove
427 * @action: action to remove
428 */
429int ice_fltr_remove_mac(struct ice_vsi *vsi, const u8 *mac,
430			enum ice_sw_fwd_act_type action)
431{
432	return ice_fltr_prepare_mac(vsi, mac, action, ice_fltr_remove_mac_list);
433}
434
435/**
436 * ice_fltr_add_vlan - add single VLAN filter
437 * @vsi: pointer to VSI struct
438 * @vlan: VLAN filter details
439 */
440int ice_fltr_add_vlan(struct ice_vsi *vsi, struct ice_vlan *vlan)
441{
442	return ice_fltr_prepare_vlan(vsi, vlan, ice_fltr_add_vlan_list);
443}
444
445/**
446 * ice_fltr_remove_vlan - remove VLAN filter
447 * @vsi: pointer to VSI struct
448 * @vlan: VLAN filter details
449 */
450int ice_fltr_remove_vlan(struct ice_vsi *vsi, struct ice_vlan *vlan)
451{
452	return ice_fltr_prepare_vlan(vsi, vlan, ice_fltr_remove_vlan_list);
453}
454
455/**
456 * ice_fltr_add_eth - add specyfic ethertype filter
457 * @vsi: pointer to VSI struct
458 * @ethertype: ethertype of filter
459 * @flag: direction of packet to be filtered, Tx or Rx
460 * @action: action to be performed on filter match
461 */
462int ice_fltr_add_eth(struct ice_vsi *vsi, u16 ethertype, u16 flag,
463		     enum ice_sw_fwd_act_type action)
464{
465	return ice_fltr_prepare_eth(vsi, ethertype, flag, action,
466				    ice_fltr_add_eth_list);
467}
468
469/**
470 * ice_fltr_remove_eth - remove ethertype filter
471 * @vsi: pointer to VSI struct
472 * @ethertype: ethertype of filter
473 * @flag: direction of filter
474 * @action: action to remove
475 */
476int ice_fltr_remove_eth(struct ice_vsi *vsi, u16 ethertype, u16 flag,
477			enum ice_sw_fwd_act_type action)
478{
479	return ice_fltr_prepare_eth(vsi, ethertype, flag, action,
480				    ice_fltr_remove_eth_list);
481}
482