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_add_mac_list - add list of MAC filters
51  * @vsi: pointer to VSI struct
52  * @list: list of filters
53  */
54 enum ice_status
55 ice_fltr_add_mac_list(struct ice_vsi *vsi, struct list_head *list)
56 {
57 	return ice_add_mac(&vsi->back->hw, list);
58 }
59 
60 /**
61  * ice_fltr_remove_mac_list - remove list of MAC filters
62  * @vsi: pointer to VSI struct
63  * @list: list of filters
64  */
65 enum ice_status
66 ice_fltr_remove_mac_list(struct ice_vsi *vsi, struct list_head *list)
67 {
68 	return ice_remove_mac(&vsi->back->hw, list);
69 }
70 
71 /**
72  * ice_fltr_add_vlan_list - add list of VLAN filters
73  * @vsi: pointer to VSI struct
74  * @list: list of filters
75  */
76 static enum ice_status
77 ice_fltr_add_vlan_list(struct ice_vsi *vsi, struct list_head *list)
78 {
79 	return ice_add_vlan(&vsi->back->hw, list);
80 }
81 
82 /**
83  * ice_fltr_remove_vlan_list - remove list of VLAN filters
84  * @vsi: pointer to VSI struct
85  * @list: list of filters
86  */
87 static enum ice_status
88 ice_fltr_remove_vlan_list(struct ice_vsi *vsi, struct list_head *list)
89 {
90 	return ice_remove_vlan(&vsi->back->hw, list);
91 }
92 
93 /**
94  * ice_fltr_add_eth_list - add list of ethertype filters
95  * @vsi: pointer to VSI struct
96  * @list: list of filters
97  */
98 static enum ice_status
99 ice_fltr_add_eth_list(struct ice_vsi *vsi, struct list_head *list)
100 {
101 	return ice_add_eth_mac(&vsi->back->hw, list);
102 }
103 
104 /**
105  * ice_fltr_remove_eth_list - remove list of ethertype filters
106  * @vsi: pointer to VSI struct
107  * @list: list of filters
108  */
109 static enum ice_status
110 ice_fltr_remove_eth_list(struct ice_vsi *vsi, struct list_head *list)
111 {
112 	return ice_remove_eth_mac(&vsi->back->hw, list);
113 }
114 
115 /**
116  * ice_fltr_remove_all - remove all filters associated with VSI
117  * @vsi: pointer to VSI struct
118  */
119 void ice_fltr_remove_all(struct ice_vsi *vsi)
120 {
121 	ice_remove_vsi_fltr(&vsi->back->hw, vsi->idx);
122 }
123 
124 /**
125  * ice_fltr_add_mac_to_list - add MAC filter info to exsisting list
126  * @vsi: pointer to VSI struct
127  * @list: list to add filter info to
128  * @mac: MAC address to add
129  * @action: filter action
130  */
131 int
132 ice_fltr_add_mac_to_list(struct ice_vsi *vsi, struct list_head *list,
133 			 const u8 *mac, enum ice_sw_fwd_act_type action)
134 {
135 	struct ice_fltr_info info = { 0 };
136 
137 	info.flag = ICE_FLTR_TX;
138 	info.src_id = ICE_SRC_ID_VSI;
139 	info.lkup_type = ICE_SW_LKUP_MAC;
140 	info.fltr_act = action;
141 	info.vsi_handle = vsi->idx;
142 
143 	ether_addr_copy(info.l_data.mac.mac_addr, mac);
144 
145 	return ice_fltr_add_entry_to_list(ice_pf_to_dev(vsi->back), &info,
146 					  list);
147 }
148 
149 /**
150  * ice_fltr_add_vlan_to_list - add VLAN filter info to exsisting list
151  * @vsi: pointer to VSI struct
152  * @list: list to add filter info to
153  * @vlan_id: VLAN ID to add
154  * @action: filter action
155  */
156 static int
157 ice_fltr_add_vlan_to_list(struct ice_vsi *vsi, struct list_head *list,
158 			  u16 vlan_id, enum ice_sw_fwd_act_type action)
159 {
160 	struct ice_fltr_info info = { 0 };
161 
162 	info.flag = ICE_FLTR_TX;
163 	info.src_id = ICE_SRC_ID_VSI;
164 	info.lkup_type = ICE_SW_LKUP_VLAN;
165 	info.fltr_act = action;
166 	info.vsi_handle = vsi->idx;
167 	info.l_data.vlan.vlan_id = vlan_id;
168 
169 	return ice_fltr_add_entry_to_list(ice_pf_to_dev(vsi->back), &info,
170 					  list);
171 }
172 
173 /**
174  * ice_fltr_add_eth_to_list - add ethertype filter info to exsisting list
175  * @vsi: pointer to VSI struct
176  * @list: list to add filter info to
177  * @ethertype: ethertype of packet that matches filter
178  * @flag: filter direction, Tx or Rx
179  * @action: filter action
180  */
181 static int
182 ice_fltr_add_eth_to_list(struct ice_vsi *vsi, struct list_head *list,
183 			 u16 ethertype, u16 flag,
184 			 enum ice_sw_fwd_act_type action)
185 {
186 	struct ice_fltr_info info = { 0 };
187 
188 	info.flag = flag;
189 	info.lkup_type = ICE_SW_LKUP_ETHERTYPE;
190 	info.fltr_act = action;
191 	info.vsi_handle = vsi->idx;
192 	info.l_data.ethertype_mac.ethertype = ethertype;
193 
194 	if (flag == ICE_FLTR_TX)
195 		info.src_id = ICE_SRC_ID_VSI;
196 	else
197 		info.src_id = ICE_SRC_ID_LPORT;
198 
199 	return ice_fltr_add_entry_to_list(ice_pf_to_dev(vsi->back), &info,
200 					  list);
201 }
202 
203 /**
204  * ice_fltr_prepare_mac - add or remove MAC rule
205  * @vsi: pointer to VSI struct
206  * @mac: MAC address to add
207  * @action: action to be performed on filter match
208  * @mac_action: pointer to add or remove MAC function
209  */
210 static enum ice_status
211 ice_fltr_prepare_mac(struct ice_vsi *vsi, const u8 *mac,
212 		     enum ice_sw_fwd_act_type action,
213 		     enum ice_status (*mac_action)(struct ice_vsi *,
214 						   struct list_head *))
215 {
216 	enum ice_status result;
217 	LIST_HEAD(tmp_list);
218 
219 	if (ice_fltr_add_mac_to_list(vsi, &tmp_list, mac, action)) {
220 		ice_fltr_free_list(ice_pf_to_dev(vsi->back), &tmp_list);
221 		return ICE_ERR_NO_MEMORY;
222 	}
223 
224 	result = mac_action(vsi, &tmp_list);
225 	ice_fltr_free_list(ice_pf_to_dev(vsi->back), &tmp_list);
226 	return result;
227 }
228 
229 /**
230  * ice_fltr_prepare_mac_and_broadcast - add or remove MAC and broadcast filter
231  * @vsi: pointer to VSI struct
232  * @mac: MAC address to add
233  * @action: action to be performed on filter match
234  * @mac_action: pointer to add or remove MAC function
235  */
236 static enum ice_status
237 ice_fltr_prepare_mac_and_broadcast(struct ice_vsi *vsi, const u8 *mac,
238 				   enum ice_sw_fwd_act_type action,
239 				   enum ice_status(*mac_action)
240 				   (struct ice_vsi *, struct list_head *))
241 {
242 	u8 broadcast[ETH_ALEN];
243 	enum ice_status result;
244 	LIST_HEAD(tmp_list);
245 
246 	eth_broadcast_addr(broadcast);
247 	if (ice_fltr_add_mac_to_list(vsi, &tmp_list, mac, action) ||
248 	    ice_fltr_add_mac_to_list(vsi, &tmp_list, broadcast, action)) {
249 		ice_fltr_free_list(ice_pf_to_dev(vsi->back), &tmp_list);
250 		return ICE_ERR_NO_MEMORY;
251 	}
252 
253 	result = mac_action(vsi, &tmp_list);
254 	ice_fltr_free_list(ice_pf_to_dev(vsi->back), &tmp_list);
255 	return result;
256 }
257 
258 /**
259  * ice_fltr_prepare_vlan - add or remove VLAN filter
260  * @vsi: pointer to VSI struct
261  * @vlan_id: VLAN ID to add
262  * @action: action to be performed on filter match
263  * @vlan_action: pointer to add or remove VLAN function
264  */
265 static enum ice_status
266 ice_fltr_prepare_vlan(struct ice_vsi *vsi, u16 vlan_id,
267 		      enum ice_sw_fwd_act_type action,
268 		      enum ice_status (*vlan_action)(struct ice_vsi *,
269 						     struct list_head *))
270 {
271 	enum ice_status result;
272 	LIST_HEAD(tmp_list);
273 
274 	if (ice_fltr_add_vlan_to_list(vsi, &tmp_list, vlan_id, action))
275 		return ICE_ERR_NO_MEMORY;
276 
277 	result = vlan_action(vsi, &tmp_list);
278 	ice_fltr_free_list(ice_pf_to_dev(vsi->back), &tmp_list);
279 	return result;
280 }
281 
282 /**
283  * ice_fltr_prepare_eth - add or remove ethertype filter
284  * @vsi: pointer to VSI struct
285  * @ethertype: ethertype of packet to be filtered
286  * @flag: direction of packet, Tx or Rx
287  * @action: action to be performed on filter match
288  * @eth_action: pointer to add or remove ethertype function
289  */
290 static enum ice_status
291 ice_fltr_prepare_eth(struct ice_vsi *vsi, u16 ethertype, u16 flag,
292 		     enum ice_sw_fwd_act_type action,
293 		     enum ice_status (*eth_action)(struct ice_vsi *,
294 						   struct list_head *))
295 {
296 	enum ice_status result;
297 	LIST_HEAD(tmp_list);
298 
299 	if (ice_fltr_add_eth_to_list(vsi, &tmp_list, ethertype, flag, action))
300 		return ICE_ERR_NO_MEMORY;
301 
302 	result = eth_action(vsi, &tmp_list);
303 	ice_fltr_free_list(ice_pf_to_dev(vsi->back), &tmp_list);
304 	return result;
305 }
306 
307 /**
308  * ice_fltr_add_mac - add single MAC filter
309  * @vsi: pointer to VSI struct
310  * @mac: MAC to add
311  * @action: action to be performed on filter match
312  */
313 enum ice_status ice_fltr_add_mac(struct ice_vsi *vsi, const u8 *mac,
314 				 enum ice_sw_fwd_act_type action)
315 {
316 	return ice_fltr_prepare_mac(vsi, mac, action, ice_fltr_add_mac_list);
317 }
318 
319 /**
320  * ice_fltr_add_mac_and_broadcast - add single MAC and broadcast
321  * @vsi: pointer to VSI struct
322  * @mac: MAC to add
323  * @action: action to be performed on filter match
324  */
325 enum ice_status
326 ice_fltr_add_mac_and_broadcast(struct ice_vsi *vsi, const u8 *mac,
327 			       enum ice_sw_fwd_act_type action)
328 {
329 	return ice_fltr_prepare_mac_and_broadcast(vsi, mac, action,
330 						  ice_fltr_add_mac_list);
331 }
332 
333 /**
334  * ice_fltr_remove_mac - remove MAC filter
335  * @vsi: pointer to VSI struct
336  * @mac: filter MAC to remove
337  * @action: action to remove
338  */
339 enum ice_status ice_fltr_remove_mac(struct ice_vsi *vsi, const u8 *mac,
340 				    enum ice_sw_fwd_act_type action)
341 {
342 	return ice_fltr_prepare_mac(vsi, mac, action, ice_fltr_remove_mac_list);
343 }
344 
345 /**
346  * ice_fltr_add_vlan - add single VLAN filter
347  * @vsi: pointer to VSI struct
348  * @vlan_id: VLAN ID to add
349  * @action: action to be performed on filter match
350  */
351 enum ice_status ice_fltr_add_vlan(struct ice_vsi *vsi, u16 vlan_id,
352 				  enum ice_sw_fwd_act_type action)
353 {
354 	return ice_fltr_prepare_vlan(vsi, vlan_id, action,
355 				     ice_fltr_add_vlan_list);
356 }
357 
358 /**
359  * ice_fltr_remove_vlan - remove VLAN filter
360  * @vsi: pointer to VSI struct
361  * @vlan_id: filter VLAN to remove
362  * @action: action to remove
363  */
364 enum ice_status ice_fltr_remove_vlan(struct ice_vsi *vsi, u16 vlan_id,
365 				     enum ice_sw_fwd_act_type action)
366 {
367 	return ice_fltr_prepare_vlan(vsi, vlan_id, action,
368 				     ice_fltr_remove_vlan_list);
369 }
370 
371 /**
372  * ice_fltr_add_eth - add specyfic ethertype filter
373  * @vsi: pointer to VSI struct
374  * @ethertype: ethertype of filter
375  * @flag: direction of packet to be filtered, Tx or Rx
376  * @action: action to be performed on filter match
377  */
378 enum ice_status ice_fltr_add_eth(struct ice_vsi *vsi, u16 ethertype, u16 flag,
379 				 enum ice_sw_fwd_act_type action)
380 {
381 	return ice_fltr_prepare_eth(vsi, ethertype, flag, action,
382 				    ice_fltr_add_eth_list);
383 }
384 
385 /**
386  * ice_fltr_remove_eth - remove ethertype filter
387  * @vsi: pointer to VSI struct
388  * @ethertype: ethertype of filter
389  * @flag: direction of filter
390  * @action: action to remove
391  */
392 enum ice_status ice_fltr_remove_eth(struct ice_vsi *vsi, u16 ethertype,
393 				    u16 flag, enum ice_sw_fwd_act_type action)
394 {
395 	return ice_fltr_prepare_eth(vsi, ethertype, flag, action,
396 				    ice_fltr_remove_eth_list);
397 }
398