1 // SPDX-License-Identifier: GPL-2.0
2 /* Copyright (c) 2018, Intel Corporation. */
3 
4 #include "ice_switch.h"
5 
6 #define ICE_ETH_DA_OFFSET		0
7 #define ICE_ETH_ETHTYPE_OFFSET		12
8 #define ICE_ETH_VLAN_TCI_OFFSET		14
9 #define ICE_MAX_VLAN_ID			0xFFF
10 
11 /* Dummy ethernet header needed in the ice_aqc_sw_rules_elem
12  * struct to configure any switch filter rules.
13  * {DA (6 bytes), SA(6 bytes),
14  * Ether type (2 bytes for header without VLAN tag) OR
15  * VLAN tag (4 bytes for header with VLAN tag) }
16  *
17  * Word on Hardcoded values
18  * byte 0 = 0x2: to identify it as locally administered DA MAC
19  * byte 6 = 0x2: to identify it as locally administered SA MAC
20  * byte 12 = 0x81 & byte 13 = 0x00:
21  *	In case of VLAN filter first two bytes defines ether type (0x8100)
22  *	and remaining two bytes are placeholder for programming a given VLAN ID
23  *	In case of Ether type filter it is treated as header without VLAN tag
24  *	and byte 12 and 13 is used to program a given Ether type instead
25  */
26 #define DUMMY_ETH_HDR_LEN		16
27 static const u8 dummy_eth_header[DUMMY_ETH_HDR_LEN] = { 0x2, 0, 0, 0, 0, 0,
28 							0x2, 0, 0, 0, 0, 0,
29 							0x81, 0, 0, 0};
30 
31 #define ICE_SW_RULE_RX_TX_ETH_HDR_SIZE \
32 	(sizeof(struct ice_aqc_sw_rules_elem) - \
33 	 sizeof(((struct ice_aqc_sw_rules_elem *)0)->pdata) + \
34 	 sizeof(struct ice_sw_rule_lkup_rx_tx) + DUMMY_ETH_HDR_LEN - 1)
35 #define ICE_SW_RULE_RX_TX_NO_HDR_SIZE \
36 	(sizeof(struct ice_aqc_sw_rules_elem) - \
37 	 sizeof(((struct ice_aqc_sw_rules_elem *)0)->pdata) + \
38 	 sizeof(struct ice_sw_rule_lkup_rx_tx) - 1)
39 #define ICE_SW_RULE_LG_ACT_SIZE(n) \
40 	(sizeof(struct ice_aqc_sw_rules_elem) - \
41 	 sizeof(((struct ice_aqc_sw_rules_elem *)0)->pdata) + \
42 	 sizeof(struct ice_sw_rule_lg_act) - \
43 	 sizeof(((struct ice_sw_rule_lg_act *)0)->act) + \
44 	 ((n) * sizeof(((struct ice_sw_rule_lg_act *)0)->act)))
45 #define ICE_SW_RULE_VSI_LIST_SIZE(n) \
46 	(sizeof(struct ice_aqc_sw_rules_elem) - \
47 	 sizeof(((struct ice_aqc_sw_rules_elem *)0)->pdata) + \
48 	 sizeof(struct ice_sw_rule_vsi_list) - \
49 	 sizeof(((struct ice_sw_rule_vsi_list *)0)->vsi) + \
50 	 ((n) * sizeof(((struct ice_sw_rule_vsi_list *)0)->vsi)))
51 
52 /**
53  * ice_aq_alloc_free_res - command to allocate/free resources
54  * @hw: pointer to the HW struct
55  * @num_entries: number of resource entries in buffer
56  * @buf: Indirect buffer to hold data parameters and response
57  * @buf_size: size of buffer for indirect commands
58  * @opc: pass in the command opcode
59  * @cd: pointer to command details structure or NULL
60  *
61  * Helper function to allocate/free resources using the admin queue commands
62  */
63 static enum ice_status
64 ice_aq_alloc_free_res(struct ice_hw *hw, u16 num_entries,
65 		      struct ice_aqc_alloc_free_res_elem *buf, u16 buf_size,
66 		      enum ice_adminq_opc opc, struct ice_sq_cd *cd)
67 {
68 	struct ice_aqc_alloc_free_res_cmd *cmd;
69 	struct ice_aq_desc desc;
70 
71 	cmd = &desc.params.sw_res_ctrl;
72 
73 	if (!buf)
74 		return ICE_ERR_PARAM;
75 
76 	if (buf_size < (num_entries * sizeof(buf->elem[0])))
77 		return ICE_ERR_PARAM;
78 
79 	ice_fill_dflt_direct_cmd_desc(&desc, opc);
80 
81 	desc.flags |= cpu_to_le16(ICE_AQ_FLAG_RD);
82 
83 	cmd->num_entries = cpu_to_le16(num_entries);
84 
85 	return ice_aq_send_cmd(hw, &desc, buf, buf_size, cd);
86 }
87 
88 /**
89  * ice_init_def_sw_recp - initialize the recipe book keeping tables
90  * @hw: pointer to the HW struct
91  *
92  * Allocate memory for the entire recipe table and initialize the structures/
93  * entries corresponding to basic recipes.
94  */
95 enum ice_status ice_init_def_sw_recp(struct ice_hw *hw)
96 {
97 	struct ice_sw_recipe *recps;
98 	u8 i;
99 
100 	recps = devm_kcalloc(ice_hw_to_dev(hw), ICE_MAX_NUM_RECIPES,
101 			     sizeof(*recps), GFP_KERNEL);
102 	if (!recps)
103 		return ICE_ERR_NO_MEMORY;
104 
105 	for (i = 0; i < ICE_SW_LKUP_LAST; i++) {
106 		recps[i].root_rid = i;
107 		INIT_LIST_HEAD(&recps[i].filt_rules);
108 		INIT_LIST_HEAD(&recps[i].filt_replay_rules);
109 		mutex_init(&recps[i].filt_rule_lock);
110 	}
111 
112 	hw->switch_info->recp_list = recps;
113 
114 	return 0;
115 }
116 
117 /**
118  * ice_aq_get_sw_cfg - get switch configuration
119  * @hw: pointer to the hardware structure
120  * @buf: pointer to the result buffer
121  * @buf_size: length of the buffer available for response
122  * @req_desc: pointer to requested descriptor
123  * @num_elems: pointer to number of elements
124  * @cd: pointer to command details structure or NULL
125  *
126  * Get switch configuration (0x0200) to be placed in 'buff'.
127  * This admin command returns information such as initial VSI/port number
128  * and switch ID it belongs to.
129  *
130  * NOTE: *req_desc is both an input/output parameter.
131  * The caller of this function first calls this function with *request_desc set
132  * to 0. If the response from f/w has *req_desc set to 0, all the switch
133  * configuration information has been returned; if non-zero (meaning not all
134  * the information was returned), the caller should call this function again
135  * with *req_desc set to the previous value returned by f/w to get the
136  * next block of switch configuration information.
137  *
138  * *num_elems is output only parameter. This reflects the number of elements
139  * in response buffer. The caller of this function to use *num_elems while
140  * parsing the response buffer.
141  */
142 static enum ice_status
143 ice_aq_get_sw_cfg(struct ice_hw *hw, struct ice_aqc_get_sw_cfg_resp *buf,
144 		  u16 buf_size, u16 *req_desc, u16 *num_elems,
145 		  struct ice_sq_cd *cd)
146 {
147 	struct ice_aqc_get_sw_cfg *cmd;
148 	enum ice_status status;
149 	struct ice_aq_desc desc;
150 
151 	ice_fill_dflt_direct_cmd_desc(&desc, ice_aqc_opc_get_sw_cfg);
152 	cmd = &desc.params.get_sw_conf;
153 	cmd->element = cpu_to_le16(*req_desc);
154 
155 	status = ice_aq_send_cmd(hw, &desc, buf, buf_size, cd);
156 	if (!status) {
157 		*req_desc = le16_to_cpu(cmd->element);
158 		*num_elems = le16_to_cpu(cmd->num_elems);
159 	}
160 
161 	return status;
162 }
163 
164 /**
165  * ice_aq_add_vsi
166  * @hw: pointer to the HW struct
167  * @vsi_ctx: pointer to a VSI context struct
168  * @cd: pointer to command details structure or NULL
169  *
170  * Add a VSI context to the hardware (0x0210)
171  */
172 static enum ice_status
173 ice_aq_add_vsi(struct ice_hw *hw, struct ice_vsi_ctx *vsi_ctx,
174 	       struct ice_sq_cd *cd)
175 {
176 	struct ice_aqc_add_update_free_vsi_resp *res;
177 	struct ice_aqc_add_get_update_free_vsi *cmd;
178 	struct ice_aq_desc desc;
179 	enum ice_status status;
180 
181 	cmd = &desc.params.vsi_cmd;
182 	res = &desc.params.add_update_free_vsi_res;
183 
184 	ice_fill_dflt_direct_cmd_desc(&desc, ice_aqc_opc_add_vsi);
185 
186 	if (!vsi_ctx->alloc_from_pool)
187 		cmd->vsi_num = cpu_to_le16(vsi_ctx->vsi_num |
188 					   ICE_AQ_VSI_IS_VALID);
189 	cmd->vf_id = vsi_ctx->vf_num;
190 
191 	cmd->vsi_flags = cpu_to_le16(vsi_ctx->flags);
192 
193 	desc.flags |= cpu_to_le16(ICE_AQ_FLAG_RD);
194 
195 	status = ice_aq_send_cmd(hw, &desc, &vsi_ctx->info,
196 				 sizeof(vsi_ctx->info), cd);
197 
198 	if (!status) {
199 		vsi_ctx->vsi_num = le16_to_cpu(res->vsi_num) & ICE_AQ_VSI_NUM_M;
200 		vsi_ctx->vsis_allocd = le16_to_cpu(res->vsi_used);
201 		vsi_ctx->vsis_unallocated = le16_to_cpu(res->vsi_free);
202 	}
203 
204 	return status;
205 }
206 
207 /**
208  * ice_aq_free_vsi
209  * @hw: pointer to the HW struct
210  * @vsi_ctx: pointer to a VSI context struct
211  * @keep_vsi_alloc: keep VSI allocation as part of this PF's resources
212  * @cd: pointer to command details structure or NULL
213  *
214  * Free VSI context info from hardware (0x0213)
215  */
216 static enum ice_status
217 ice_aq_free_vsi(struct ice_hw *hw, struct ice_vsi_ctx *vsi_ctx,
218 		bool keep_vsi_alloc, struct ice_sq_cd *cd)
219 {
220 	struct ice_aqc_add_update_free_vsi_resp *resp;
221 	struct ice_aqc_add_get_update_free_vsi *cmd;
222 	struct ice_aq_desc desc;
223 	enum ice_status status;
224 
225 	cmd = &desc.params.vsi_cmd;
226 	resp = &desc.params.add_update_free_vsi_res;
227 
228 	ice_fill_dflt_direct_cmd_desc(&desc, ice_aqc_opc_free_vsi);
229 
230 	cmd->vsi_num = cpu_to_le16(vsi_ctx->vsi_num | ICE_AQ_VSI_IS_VALID);
231 	if (keep_vsi_alloc)
232 		cmd->cmd_flags = cpu_to_le16(ICE_AQ_VSI_KEEP_ALLOC);
233 
234 	status = ice_aq_send_cmd(hw, &desc, NULL, 0, cd);
235 	if (!status) {
236 		vsi_ctx->vsis_allocd = le16_to_cpu(resp->vsi_used);
237 		vsi_ctx->vsis_unallocated = le16_to_cpu(resp->vsi_free);
238 	}
239 
240 	return status;
241 }
242 
243 /**
244  * ice_aq_update_vsi
245  * @hw: pointer to the HW struct
246  * @vsi_ctx: pointer to a VSI context struct
247  * @cd: pointer to command details structure or NULL
248  *
249  * Update VSI context in the hardware (0x0211)
250  */
251 static enum ice_status
252 ice_aq_update_vsi(struct ice_hw *hw, struct ice_vsi_ctx *vsi_ctx,
253 		  struct ice_sq_cd *cd)
254 {
255 	struct ice_aqc_add_update_free_vsi_resp *resp;
256 	struct ice_aqc_add_get_update_free_vsi *cmd;
257 	struct ice_aq_desc desc;
258 	enum ice_status status;
259 
260 	cmd = &desc.params.vsi_cmd;
261 	resp = &desc.params.add_update_free_vsi_res;
262 
263 	ice_fill_dflt_direct_cmd_desc(&desc, ice_aqc_opc_update_vsi);
264 
265 	cmd->vsi_num = cpu_to_le16(vsi_ctx->vsi_num | ICE_AQ_VSI_IS_VALID);
266 
267 	desc.flags |= cpu_to_le16(ICE_AQ_FLAG_RD);
268 
269 	status = ice_aq_send_cmd(hw, &desc, &vsi_ctx->info,
270 				 sizeof(vsi_ctx->info), cd);
271 
272 	if (!status) {
273 		vsi_ctx->vsis_allocd = le16_to_cpu(resp->vsi_used);
274 		vsi_ctx->vsis_unallocated = le16_to_cpu(resp->vsi_free);
275 	}
276 
277 	return status;
278 }
279 
280 /**
281  * ice_is_vsi_valid - check whether the VSI is valid or not
282  * @hw: pointer to the HW struct
283  * @vsi_handle: VSI handle
284  *
285  * check whether the VSI is valid or not
286  */
287 bool ice_is_vsi_valid(struct ice_hw *hw, u16 vsi_handle)
288 {
289 	return vsi_handle < ICE_MAX_VSI && hw->vsi_ctx[vsi_handle];
290 }
291 
292 /**
293  * ice_get_hw_vsi_num - return the HW VSI number
294  * @hw: pointer to the HW struct
295  * @vsi_handle: VSI handle
296  *
297  * return the HW VSI number
298  * Caution: call this function only if VSI is valid (ice_is_vsi_valid)
299  */
300 u16 ice_get_hw_vsi_num(struct ice_hw *hw, u16 vsi_handle)
301 {
302 	return hw->vsi_ctx[vsi_handle]->vsi_num;
303 }
304 
305 /**
306  * ice_get_vsi_ctx - return the VSI context entry for a given VSI handle
307  * @hw: pointer to the HW struct
308  * @vsi_handle: VSI handle
309  *
310  * return the VSI context entry for a given VSI handle
311  */
312 struct ice_vsi_ctx *ice_get_vsi_ctx(struct ice_hw *hw, u16 vsi_handle)
313 {
314 	return (vsi_handle >= ICE_MAX_VSI) ? NULL : hw->vsi_ctx[vsi_handle];
315 }
316 
317 /**
318  * ice_save_vsi_ctx - save the VSI context for a given VSI handle
319  * @hw: pointer to the HW struct
320  * @vsi_handle: VSI handle
321  * @vsi: VSI context pointer
322  *
323  * save the VSI context entry for a given VSI handle
324  */
325 static void
326 ice_save_vsi_ctx(struct ice_hw *hw, u16 vsi_handle, struct ice_vsi_ctx *vsi)
327 {
328 	hw->vsi_ctx[vsi_handle] = vsi;
329 }
330 
331 /**
332  * ice_clear_vsi_q_ctx - clear VSI queue contexts for all TCs
333  * @hw: pointer to the HW struct
334  * @vsi_handle: VSI handle
335  */
336 static void ice_clear_vsi_q_ctx(struct ice_hw *hw, u16 vsi_handle)
337 {
338 	struct ice_vsi_ctx *vsi;
339 	u8 i;
340 
341 	vsi = ice_get_vsi_ctx(hw, vsi_handle);
342 	if (!vsi)
343 		return;
344 	ice_for_each_traffic_class(i) {
345 		if (vsi->lan_q_ctx[i]) {
346 			devm_kfree(ice_hw_to_dev(hw), vsi->lan_q_ctx[i]);
347 			vsi->lan_q_ctx[i] = NULL;
348 		}
349 	}
350 }
351 
352 /**
353  * ice_clear_vsi_ctx - clear the VSI context entry
354  * @hw: pointer to the HW struct
355  * @vsi_handle: VSI handle
356  *
357  * clear the VSI context entry
358  */
359 static void ice_clear_vsi_ctx(struct ice_hw *hw, u16 vsi_handle)
360 {
361 	struct ice_vsi_ctx *vsi;
362 
363 	vsi = ice_get_vsi_ctx(hw, vsi_handle);
364 	if (vsi) {
365 		ice_clear_vsi_q_ctx(hw, vsi_handle);
366 		devm_kfree(ice_hw_to_dev(hw), vsi);
367 		hw->vsi_ctx[vsi_handle] = NULL;
368 	}
369 }
370 
371 /**
372  * ice_clear_all_vsi_ctx - clear all the VSI context entries
373  * @hw: pointer to the HW struct
374  */
375 void ice_clear_all_vsi_ctx(struct ice_hw *hw)
376 {
377 	u16 i;
378 
379 	for (i = 0; i < ICE_MAX_VSI; i++)
380 		ice_clear_vsi_ctx(hw, i);
381 }
382 
383 /**
384  * ice_add_vsi - add VSI context to the hardware and VSI handle list
385  * @hw: pointer to the HW struct
386  * @vsi_handle: unique VSI handle provided by drivers
387  * @vsi_ctx: pointer to a VSI context struct
388  * @cd: pointer to command details structure or NULL
389  *
390  * Add a VSI context to the hardware also add it into the VSI handle list.
391  * If this function gets called after reset for existing VSIs then update
392  * with the new HW VSI number in the corresponding VSI handle list entry.
393  */
394 enum ice_status
395 ice_add_vsi(struct ice_hw *hw, u16 vsi_handle, struct ice_vsi_ctx *vsi_ctx,
396 	    struct ice_sq_cd *cd)
397 {
398 	struct ice_vsi_ctx *tmp_vsi_ctx;
399 	enum ice_status status;
400 
401 	if (vsi_handle >= ICE_MAX_VSI)
402 		return ICE_ERR_PARAM;
403 	status = ice_aq_add_vsi(hw, vsi_ctx, cd);
404 	if (status)
405 		return status;
406 	tmp_vsi_ctx = ice_get_vsi_ctx(hw, vsi_handle);
407 	if (!tmp_vsi_ctx) {
408 		/* Create a new VSI context */
409 		tmp_vsi_ctx = devm_kzalloc(ice_hw_to_dev(hw),
410 					   sizeof(*tmp_vsi_ctx), GFP_KERNEL);
411 		if (!tmp_vsi_ctx) {
412 			ice_aq_free_vsi(hw, vsi_ctx, false, cd);
413 			return ICE_ERR_NO_MEMORY;
414 		}
415 		*tmp_vsi_ctx = *vsi_ctx;
416 		ice_save_vsi_ctx(hw, vsi_handle, tmp_vsi_ctx);
417 	} else {
418 		/* update with new HW VSI num */
419 		if (tmp_vsi_ctx->vsi_num != vsi_ctx->vsi_num)
420 			tmp_vsi_ctx->vsi_num = vsi_ctx->vsi_num;
421 	}
422 
423 	return 0;
424 }
425 
426 /**
427  * ice_free_vsi- free VSI context from hardware and VSI handle list
428  * @hw: pointer to the HW struct
429  * @vsi_handle: unique VSI handle
430  * @vsi_ctx: pointer to a VSI context struct
431  * @keep_vsi_alloc: keep VSI allocation as part of this PF's resources
432  * @cd: pointer to command details structure or NULL
433  *
434  * Free VSI context info from hardware as well as from VSI handle list
435  */
436 enum ice_status
437 ice_free_vsi(struct ice_hw *hw, u16 vsi_handle, struct ice_vsi_ctx *vsi_ctx,
438 	     bool keep_vsi_alloc, struct ice_sq_cd *cd)
439 {
440 	enum ice_status status;
441 
442 	if (!ice_is_vsi_valid(hw, vsi_handle))
443 		return ICE_ERR_PARAM;
444 	vsi_ctx->vsi_num = ice_get_hw_vsi_num(hw, vsi_handle);
445 	status = ice_aq_free_vsi(hw, vsi_ctx, keep_vsi_alloc, cd);
446 	if (!status)
447 		ice_clear_vsi_ctx(hw, vsi_handle);
448 	return status;
449 }
450 
451 /**
452  * ice_update_vsi
453  * @hw: pointer to the HW struct
454  * @vsi_handle: unique VSI handle
455  * @vsi_ctx: pointer to a VSI context struct
456  * @cd: pointer to command details structure or NULL
457  *
458  * Update VSI context in the hardware
459  */
460 enum ice_status
461 ice_update_vsi(struct ice_hw *hw, u16 vsi_handle, struct ice_vsi_ctx *vsi_ctx,
462 	       struct ice_sq_cd *cd)
463 {
464 	if (!ice_is_vsi_valid(hw, vsi_handle))
465 		return ICE_ERR_PARAM;
466 	vsi_ctx->vsi_num = ice_get_hw_vsi_num(hw, vsi_handle);
467 	return ice_aq_update_vsi(hw, vsi_ctx, cd);
468 }
469 
470 /**
471  * ice_aq_alloc_free_vsi_list
472  * @hw: pointer to the HW struct
473  * @vsi_list_id: VSI list ID returned or used for lookup
474  * @lkup_type: switch rule filter lookup type
475  * @opc: switch rules population command type - pass in the command opcode
476  *
477  * allocates or free a VSI list resource
478  */
479 static enum ice_status
480 ice_aq_alloc_free_vsi_list(struct ice_hw *hw, u16 *vsi_list_id,
481 			   enum ice_sw_lkup_type lkup_type,
482 			   enum ice_adminq_opc opc)
483 {
484 	struct ice_aqc_alloc_free_res_elem *sw_buf;
485 	struct ice_aqc_res_elem *vsi_ele;
486 	enum ice_status status;
487 	u16 buf_len;
488 
489 	buf_len = sizeof(*sw_buf);
490 	sw_buf = devm_kzalloc(ice_hw_to_dev(hw), buf_len, GFP_KERNEL);
491 	if (!sw_buf)
492 		return ICE_ERR_NO_MEMORY;
493 	sw_buf->num_elems = cpu_to_le16(1);
494 
495 	if (lkup_type == ICE_SW_LKUP_MAC ||
496 	    lkup_type == ICE_SW_LKUP_MAC_VLAN ||
497 	    lkup_type == ICE_SW_LKUP_ETHERTYPE ||
498 	    lkup_type == ICE_SW_LKUP_ETHERTYPE_MAC ||
499 	    lkup_type == ICE_SW_LKUP_PROMISC ||
500 	    lkup_type == ICE_SW_LKUP_PROMISC_VLAN) {
501 		sw_buf->res_type = cpu_to_le16(ICE_AQC_RES_TYPE_VSI_LIST_REP);
502 	} else if (lkup_type == ICE_SW_LKUP_VLAN) {
503 		sw_buf->res_type =
504 			cpu_to_le16(ICE_AQC_RES_TYPE_VSI_LIST_PRUNE);
505 	} else {
506 		status = ICE_ERR_PARAM;
507 		goto ice_aq_alloc_free_vsi_list_exit;
508 	}
509 
510 	if (opc == ice_aqc_opc_free_res)
511 		sw_buf->elem[0].e.sw_resp = cpu_to_le16(*vsi_list_id);
512 
513 	status = ice_aq_alloc_free_res(hw, 1, sw_buf, buf_len, opc, NULL);
514 	if (status)
515 		goto ice_aq_alloc_free_vsi_list_exit;
516 
517 	if (opc == ice_aqc_opc_alloc_res) {
518 		vsi_ele = &sw_buf->elem[0];
519 		*vsi_list_id = le16_to_cpu(vsi_ele->e.sw_resp);
520 	}
521 
522 ice_aq_alloc_free_vsi_list_exit:
523 	devm_kfree(ice_hw_to_dev(hw), sw_buf);
524 	return status;
525 }
526 
527 /**
528  * ice_aq_sw_rules - add/update/remove switch rules
529  * @hw: pointer to the HW struct
530  * @rule_list: pointer to switch rule population list
531  * @rule_list_sz: total size of the rule list in bytes
532  * @num_rules: number of switch rules in the rule_list
533  * @opc: switch rules population command type - pass in the command opcode
534  * @cd: pointer to command details structure or NULL
535  *
536  * Add(0x02a0)/Update(0x02a1)/Remove(0x02a2) switch rules commands to firmware
537  */
538 static enum ice_status
539 ice_aq_sw_rules(struct ice_hw *hw, void *rule_list, u16 rule_list_sz,
540 		u8 num_rules, enum ice_adminq_opc opc, struct ice_sq_cd *cd)
541 {
542 	struct ice_aq_desc desc;
543 
544 	if (opc != ice_aqc_opc_add_sw_rules &&
545 	    opc != ice_aqc_opc_update_sw_rules &&
546 	    opc != ice_aqc_opc_remove_sw_rules)
547 		return ICE_ERR_PARAM;
548 
549 	ice_fill_dflt_direct_cmd_desc(&desc, opc);
550 
551 	desc.flags |= cpu_to_le16(ICE_AQ_FLAG_RD);
552 	desc.params.sw_rules.num_rules_fltr_entry_index =
553 		cpu_to_le16(num_rules);
554 	return ice_aq_send_cmd(hw, &desc, rule_list, rule_list_sz, cd);
555 }
556 
557 /* ice_init_port_info - Initialize port_info with switch configuration data
558  * @pi: pointer to port_info
559  * @vsi_port_num: VSI number or port number
560  * @type: Type of switch element (port or VSI)
561  * @swid: switch ID of the switch the element is attached to
562  * @pf_vf_num: PF or VF number
563  * @is_vf: true if the element is a VF, false otherwise
564  */
565 static void
566 ice_init_port_info(struct ice_port_info *pi, u16 vsi_port_num, u8 type,
567 		   u16 swid, u16 pf_vf_num, bool is_vf)
568 {
569 	switch (type) {
570 	case ICE_AQC_GET_SW_CONF_RESP_PHYS_PORT:
571 		pi->lport = (u8)(vsi_port_num & ICE_LPORT_MASK);
572 		pi->sw_id = swid;
573 		pi->pf_vf_num = pf_vf_num;
574 		pi->is_vf = is_vf;
575 		pi->dflt_tx_vsi_num = ICE_DFLT_VSI_INVAL;
576 		pi->dflt_rx_vsi_num = ICE_DFLT_VSI_INVAL;
577 		break;
578 	default:
579 		ice_debug(pi->hw, ICE_DBG_SW,
580 			  "incorrect VSI/port type received\n");
581 		break;
582 	}
583 }
584 
585 /* ice_get_initial_sw_cfg - Get initial port and default VSI data
586  * @hw: pointer to the hardware structure
587  */
588 enum ice_status ice_get_initial_sw_cfg(struct ice_hw *hw)
589 {
590 	struct ice_aqc_get_sw_cfg_resp *rbuf;
591 	enum ice_status status;
592 	u16 req_desc = 0;
593 	u16 num_elems;
594 	u16 i;
595 
596 	rbuf = devm_kzalloc(ice_hw_to_dev(hw), ICE_SW_CFG_MAX_BUF_LEN,
597 			    GFP_KERNEL);
598 
599 	if (!rbuf)
600 		return ICE_ERR_NO_MEMORY;
601 
602 	/* Multiple calls to ice_aq_get_sw_cfg may be required
603 	 * to get all the switch configuration information. The need
604 	 * for additional calls is indicated by ice_aq_get_sw_cfg
605 	 * writing a non-zero value in req_desc
606 	 */
607 	do {
608 		status = ice_aq_get_sw_cfg(hw, rbuf, ICE_SW_CFG_MAX_BUF_LEN,
609 					   &req_desc, &num_elems, NULL);
610 
611 		if (status)
612 			break;
613 
614 		for (i = 0; i < num_elems; i++) {
615 			struct ice_aqc_get_sw_cfg_resp_elem *ele;
616 			u16 pf_vf_num, swid, vsi_port_num;
617 			bool is_vf = false;
618 			u8 type;
619 
620 			ele = rbuf[i].elements;
621 			vsi_port_num = le16_to_cpu(ele->vsi_port_num) &
622 				ICE_AQC_GET_SW_CONF_RESP_VSI_PORT_NUM_M;
623 
624 			pf_vf_num = le16_to_cpu(ele->pf_vf_num) &
625 				ICE_AQC_GET_SW_CONF_RESP_FUNC_NUM_M;
626 
627 			swid = le16_to_cpu(ele->swid);
628 
629 			if (le16_to_cpu(ele->pf_vf_num) &
630 			    ICE_AQC_GET_SW_CONF_RESP_IS_VF)
631 				is_vf = true;
632 
633 			type = le16_to_cpu(ele->vsi_port_num) >>
634 				ICE_AQC_GET_SW_CONF_RESP_TYPE_S;
635 
636 			if (type == ICE_AQC_GET_SW_CONF_RESP_VSI) {
637 				/* FW VSI is not needed. Just continue. */
638 				continue;
639 			}
640 
641 			ice_init_port_info(hw->port_info, vsi_port_num,
642 					   type, swid, pf_vf_num, is_vf);
643 		}
644 	} while (req_desc && !status);
645 
646 	devm_kfree(ice_hw_to_dev(hw), (void *)rbuf);
647 	return status;
648 }
649 
650 /**
651  * ice_fill_sw_info - Helper function to populate lb_en and lan_en
652  * @hw: pointer to the hardware structure
653  * @fi: filter info structure to fill/update
654  *
655  * This helper function populates the lb_en and lan_en elements of the provided
656  * ice_fltr_info struct using the switch's type and characteristics of the
657  * switch rule being configured.
658  */
659 static void ice_fill_sw_info(struct ice_hw *hw, struct ice_fltr_info *fi)
660 {
661 	fi->lb_en = false;
662 	fi->lan_en = false;
663 	if ((fi->flag & ICE_FLTR_TX) &&
664 	    (fi->fltr_act == ICE_FWD_TO_VSI ||
665 	     fi->fltr_act == ICE_FWD_TO_VSI_LIST ||
666 	     fi->fltr_act == ICE_FWD_TO_Q ||
667 	     fi->fltr_act == ICE_FWD_TO_QGRP)) {
668 		/* Setting LB for prune actions will result in replicated
669 		 * packets to the internal switch that will be dropped.
670 		 */
671 		if (fi->lkup_type != ICE_SW_LKUP_VLAN)
672 			fi->lb_en = true;
673 
674 		/* Set lan_en to TRUE if
675 		 * 1. The switch is a VEB AND
676 		 * 2
677 		 * 2.1 The lookup is a directional lookup like ethertype,
678 		 * promiscuous, ethertype-MAC, promiscuous-VLAN
679 		 * and default-port OR
680 		 * 2.2 The lookup is VLAN, OR
681 		 * 2.3 The lookup is MAC with mcast or bcast addr for MAC, OR
682 		 * 2.4 The lookup is MAC_VLAN with mcast or bcast addr for MAC.
683 		 *
684 		 * OR
685 		 *
686 		 * The switch is a VEPA.
687 		 *
688 		 * In all other cases, the LAN enable has to be set to false.
689 		 */
690 		if (hw->evb_veb) {
691 			if (fi->lkup_type == ICE_SW_LKUP_ETHERTYPE ||
692 			    fi->lkup_type == ICE_SW_LKUP_PROMISC ||
693 			    fi->lkup_type == ICE_SW_LKUP_ETHERTYPE_MAC ||
694 			    fi->lkup_type == ICE_SW_LKUP_PROMISC_VLAN ||
695 			    fi->lkup_type == ICE_SW_LKUP_DFLT ||
696 			    fi->lkup_type == ICE_SW_LKUP_VLAN ||
697 			    (fi->lkup_type == ICE_SW_LKUP_MAC &&
698 			     !is_unicast_ether_addr(fi->l_data.mac.mac_addr)) ||
699 			    (fi->lkup_type == ICE_SW_LKUP_MAC_VLAN &&
700 			     !is_unicast_ether_addr(fi->l_data.mac.mac_addr)))
701 				fi->lan_en = true;
702 		} else {
703 			fi->lan_en = true;
704 		}
705 	}
706 }
707 
708 /**
709  * ice_fill_sw_rule - Helper function to fill switch rule structure
710  * @hw: pointer to the hardware structure
711  * @f_info: entry containing packet forwarding information
712  * @s_rule: switch rule structure to be filled in based on mac_entry
713  * @opc: switch rules population command type - pass in the command opcode
714  */
715 static void
716 ice_fill_sw_rule(struct ice_hw *hw, struct ice_fltr_info *f_info,
717 		 struct ice_aqc_sw_rules_elem *s_rule, enum ice_adminq_opc opc)
718 {
719 	u16 vlan_id = ICE_MAX_VLAN_ID + 1;
720 	void *daddr = NULL;
721 	u16 eth_hdr_sz;
722 	u8 *eth_hdr;
723 	u32 act = 0;
724 	__be16 *off;
725 	u8 q_rgn;
726 
727 	if (opc == ice_aqc_opc_remove_sw_rules) {
728 		s_rule->pdata.lkup_tx_rx.act = 0;
729 		s_rule->pdata.lkup_tx_rx.index =
730 			cpu_to_le16(f_info->fltr_rule_id);
731 		s_rule->pdata.lkup_tx_rx.hdr_len = 0;
732 		return;
733 	}
734 
735 	eth_hdr_sz = sizeof(dummy_eth_header);
736 	eth_hdr = s_rule->pdata.lkup_tx_rx.hdr;
737 
738 	/* initialize the ether header with a dummy header */
739 	memcpy(eth_hdr, dummy_eth_header, eth_hdr_sz);
740 	ice_fill_sw_info(hw, f_info);
741 
742 	switch (f_info->fltr_act) {
743 	case ICE_FWD_TO_VSI:
744 		act |= (f_info->fwd_id.hw_vsi_id << ICE_SINGLE_ACT_VSI_ID_S) &
745 			ICE_SINGLE_ACT_VSI_ID_M;
746 		if (f_info->lkup_type != ICE_SW_LKUP_VLAN)
747 			act |= ICE_SINGLE_ACT_VSI_FORWARDING |
748 				ICE_SINGLE_ACT_VALID_BIT;
749 		break;
750 	case ICE_FWD_TO_VSI_LIST:
751 		act |= ICE_SINGLE_ACT_VSI_LIST;
752 		act |= (f_info->fwd_id.vsi_list_id <<
753 			ICE_SINGLE_ACT_VSI_LIST_ID_S) &
754 			ICE_SINGLE_ACT_VSI_LIST_ID_M;
755 		if (f_info->lkup_type != ICE_SW_LKUP_VLAN)
756 			act |= ICE_SINGLE_ACT_VSI_FORWARDING |
757 				ICE_SINGLE_ACT_VALID_BIT;
758 		break;
759 	case ICE_FWD_TO_Q:
760 		act |= ICE_SINGLE_ACT_TO_Q;
761 		act |= (f_info->fwd_id.q_id << ICE_SINGLE_ACT_Q_INDEX_S) &
762 			ICE_SINGLE_ACT_Q_INDEX_M;
763 		break;
764 	case ICE_DROP_PACKET:
765 		act |= ICE_SINGLE_ACT_VSI_FORWARDING | ICE_SINGLE_ACT_DROP |
766 			ICE_SINGLE_ACT_VALID_BIT;
767 		break;
768 	case ICE_FWD_TO_QGRP:
769 		q_rgn = f_info->qgrp_size > 0 ?
770 			(u8)ilog2(f_info->qgrp_size) : 0;
771 		act |= ICE_SINGLE_ACT_TO_Q;
772 		act |= (f_info->fwd_id.q_id << ICE_SINGLE_ACT_Q_INDEX_S) &
773 			ICE_SINGLE_ACT_Q_INDEX_M;
774 		act |= (q_rgn << ICE_SINGLE_ACT_Q_REGION_S) &
775 			ICE_SINGLE_ACT_Q_REGION_M;
776 		break;
777 	default:
778 		return;
779 	}
780 
781 	if (f_info->lb_en)
782 		act |= ICE_SINGLE_ACT_LB_ENABLE;
783 	if (f_info->lan_en)
784 		act |= ICE_SINGLE_ACT_LAN_ENABLE;
785 
786 	switch (f_info->lkup_type) {
787 	case ICE_SW_LKUP_MAC:
788 		daddr = f_info->l_data.mac.mac_addr;
789 		break;
790 	case ICE_SW_LKUP_VLAN:
791 		vlan_id = f_info->l_data.vlan.vlan_id;
792 		if (f_info->fltr_act == ICE_FWD_TO_VSI ||
793 		    f_info->fltr_act == ICE_FWD_TO_VSI_LIST) {
794 			act |= ICE_SINGLE_ACT_PRUNE;
795 			act |= ICE_SINGLE_ACT_EGRESS | ICE_SINGLE_ACT_INGRESS;
796 		}
797 		break;
798 	case ICE_SW_LKUP_ETHERTYPE_MAC:
799 		daddr = f_info->l_data.ethertype_mac.mac_addr;
800 		/* fall-through */
801 	case ICE_SW_LKUP_ETHERTYPE:
802 		off = (__be16 *)(eth_hdr + ICE_ETH_ETHTYPE_OFFSET);
803 		*off = cpu_to_be16(f_info->l_data.ethertype_mac.ethertype);
804 		break;
805 	case ICE_SW_LKUP_MAC_VLAN:
806 		daddr = f_info->l_data.mac_vlan.mac_addr;
807 		vlan_id = f_info->l_data.mac_vlan.vlan_id;
808 		break;
809 	case ICE_SW_LKUP_PROMISC_VLAN:
810 		vlan_id = f_info->l_data.mac_vlan.vlan_id;
811 		/* fall-through */
812 	case ICE_SW_LKUP_PROMISC:
813 		daddr = f_info->l_data.mac_vlan.mac_addr;
814 		break;
815 	default:
816 		break;
817 	}
818 
819 	s_rule->type = (f_info->flag & ICE_FLTR_RX) ?
820 		cpu_to_le16(ICE_AQC_SW_RULES_T_LKUP_RX) :
821 		cpu_to_le16(ICE_AQC_SW_RULES_T_LKUP_TX);
822 
823 	/* Recipe set depending on lookup type */
824 	s_rule->pdata.lkup_tx_rx.recipe_id = cpu_to_le16(f_info->lkup_type);
825 	s_rule->pdata.lkup_tx_rx.src = cpu_to_le16(f_info->src);
826 	s_rule->pdata.lkup_tx_rx.act = cpu_to_le32(act);
827 
828 	if (daddr)
829 		ether_addr_copy(eth_hdr + ICE_ETH_DA_OFFSET, daddr);
830 
831 	if (!(vlan_id > ICE_MAX_VLAN_ID)) {
832 		off = (__be16 *)(eth_hdr + ICE_ETH_VLAN_TCI_OFFSET);
833 		*off = cpu_to_be16(vlan_id);
834 	}
835 
836 	/* Create the switch rule with the final dummy Ethernet header */
837 	if (opc != ice_aqc_opc_update_sw_rules)
838 		s_rule->pdata.lkup_tx_rx.hdr_len = cpu_to_le16(eth_hdr_sz);
839 }
840 
841 /**
842  * ice_add_marker_act
843  * @hw: pointer to the hardware structure
844  * @m_ent: the management entry for which sw marker needs to be added
845  * @sw_marker: sw marker to tag the Rx descriptor with
846  * @l_id: large action resource ID
847  *
848  * Create a large action to hold software marker and update the switch rule
849  * entry pointed by m_ent with newly created large action
850  */
851 static enum ice_status
852 ice_add_marker_act(struct ice_hw *hw, struct ice_fltr_mgmt_list_entry *m_ent,
853 		   u16 sw_marker, u16 l_id)
854 {
855 	struct ice_aqc_sw_rules_elem *lg_act, *rx_tx;
856 	/* For software marker we need 3 large actions
857 	 * 1. FWD action: FWD TO VSI or VSI LIST
858 	 * 2. GENERIC VALUE action to hold the profile ID
859 	 * 3. GENERIC VALUE action to hold the software marker ID
860 	 */
861 	const u16 num_lg_acts = 3;
862 	enum ice_status status;
863 	u16 lg_act_size;
864 	u16 rules_size;
865 	u32 act;
866 	u16 id;
867 
868 	if (m_ent->fltr_info.lkup_type != ICE_SW_LKUP_MAC)
869 		return ICE_ERR_PARAM;
870 
871 	/* Create two back-to-back switch rules and submit them to the HW using
872 	 * one memory buffer:
873 	 *    1. Large Action
874 	 *    2. Look up Tx Rx
875 	 */
876 	lg_act_size = (u16)ICE_SW_RULE_LG_ACT_SIZE(num_lg_acts);
877 	rules_size = lg_act_size + ICE_SW_RULE_RX_TX_ETH_HDR_SIZE;
878 	lg_act = devm_kzalloc(ice_hw_to_dev(hw), rules_size, GFP_KERNEL);
879 	if (!lg_act)
880 		return ICE_ERR_NO_MEMORY;
881 
882 	rx_tx = (struct ice_aqc_sw_rules_elem *)((u8 *)lg_act + lg_act_size);
883 
884 	/* Fill in the first switch rule i.e. large action */
885 	lg_act->type = cpu_to_le16(ICE_AQC_SW_RULES_T_LG_ACT);
886 	lg_act->pdata.lg_act.index = cpu_to_le16(l_id);
887 	lg_act->pdata.lg_act.size = cpu_to_le16(num_lg_acts);
888 
889 	/* First action VSI forwarding or VSI list forwarding depending on how
890 	 * many VSIs
891 	 */
892 	id = (m_ent->vsi_count > 1) ? m_ent->fltr_info.fwd_id.vsi_list_id :
893 		m_ent->fltr_info.fwd_id.hw_vsi_id;
894 
895 	act = ICE_LG_ACT_VSI_FORWARDING | ICE_LG_ACT_VALID_BIT;
896 	act |= (id << ICE_LG_ACT_VSI_LIST_ID_S) &
897 		ICE_LG_ACT_VSI_LIST_ID_M;
898 	if (m_ent->vsi_count > 1)
899 		act |= ICE_LG_ACT_VSI_LIST;
900 	lg_act->pdata.lg_act.act[0] = cpu_to_le32(act);
901 
902 	/* Second action descriptor type */
903 	act = ICE_LG_ACT_GENERIC;
904 
905 	act |= (1 << ICE_LG_ACT_GENERIC_VALUE_S) & ICE_LG_ACT_GENERIC_VALUE_M;
906 	lg_act->pdata.lg_act.act[1] = cpu_to_le32(act);
907 
908 	act = (ICE_LG_ACT_GENERIC_OFF_RX_DESC_PROF_IDX <<
909 	       ICE_LG_ACT_GENERIC_OFFSET_S) & ICE_LG_ACT_GENERIC_OFFSET_M;
910 
911 	/* Third action Marker value */
912 	act |= ICE_LG_ACT_GENERIC;
913 	act |= (sw_marker << ICE_LG_ACT_GENERIC_VALUE_S) &
914 		ICE_LG_ACT_GENERIC_VALUE_M;
915 
916 	lg_act->pdata.lg_act.act[2] = cpu_to_le32(act);
917 
918 	/* call the fill switch rule to fill the lookup Tx Rx structure */
919 	ice_fill_sw_rule(hw, &m_ent->fltr_info, rx_tx,
920 			 ice_aqc_opc_update_sw_rules);
921 
922 	/* Update the action to point to the large action ID */
923 	rx_tx->pdata.lkup_tx_rx.act =
924 		cpu_to_le32(ICE_SINGLE_ACT_PTR |
925 			    ((l_id << ICE_SINGLE_ACT_PTR_VAL_S) &
926 			     ICE_SINGLE_ACT_PTR_VAL_M));
927 
928 	/* Use the filter rule ID of the previously created rule with single
929 	 * act. Once the update happens, hardware will treat this as large
930 	 * action
931 	 */
932 	rx_tx->pdata.lkup_tx_rx.index =
933 		cpu_to_le16(m_ent->fltr_info.fltr_rule_id);
934 
935 	status = ice_aq_sw_rules(hw, lg_act, rules_size, 2,
936 				 ice_aqc_opc_update_sw_rules, NULL);
937 	if (!status) {
938 		m_ent->lg_act_idx = l_id;
939 		m_ent->sw_marker_id = sw_marker;
940 	}
941 
942 	devm_kfree(ice_hw_to_dev(hw), lg_act);
943 	return status;
944 }
945 
946 /**
947  * ice_create_vsi_list_map
948  * @hw: pointer to the hardware structure
949  * @vsi_handle_arr: array of VSI handles to set in the VSI mapping
950  * @num_vsi: number of VSI handles in the array
951  * @vsi_list_id: VSI list ID generated as part of allocate resource
952  *
953  * Helper function to create a new entry of VSI list ID to VSI mapping
954  * using the given VSI list ID
955  */
956 static struct ice_vsi_list_map_info *
957 ice_create_vsi_list_map(struct ice_hw *hw, u16 *vsi_handle_arr, u16 num_vsi,
958 			u16 vsi_list_id)
959 {
960 	struct ice_switch_info *sw = hw->switch_info;
961 	struct ice_vsi_list_map_info *v_map;
962 	int i;
963 
964 	v_map = devm_kcalloc(ice_hw_to_dev(hw), 1, sizeof(*v_map), GFP_KERNEL);
965 	if (!v_map)
966 		return NULL;
967 
968 	v_map->vsi_list_id = vsi_list_id;
969 	v_map->ref_cnt = 1;
970 	for (i = 0; i < num_vsi; i++)
971 		set_bit(vsi_handle_arr[i], v_map->vsi_map);
972 
973 	list_add(&v_map->list_entry, &sw->vsi_list_map_head);
974 	return v_map;
975 }
976 
977 /**
978  * ice_update_vsi_list_rule
979  * @hw: pointer to the hardware structure
980  * @vsi_handle_arr: array of VSI handles to form a VSI list
981  * @num_vsi: number of VSI handles in the array
982  * @vsi_list_id: VSI list ID generated as part of allocate resource
983  * @remove: Boolean value to indicate if this is a remove action
984  * @opc: switch rules population command type - pass in the command opcode
985  * @lkup_type: lookup type of the filter
986  *
987  * Call AQ command to add a new switch rule or update existing switch rule
988  * using the given VSI list ID
989  */
990 static enum ice_status
991 ice_update_vsi_list_rule(struct ice_hw *hw, u16 *vsi_handle_arr, u16 num_vsi,
992 			 u16 vsi_list_id, bool remove, enum ice_adminq_opc opc,
993 			 enum ice_sw_lkup_type lkup_type)
994 {
995 	struct ice_aqc_sw_rules_elem *s_rule;
996 	enum ice_status status;
997 	u16 s_rule_size;
998 	u16 type;
999 	int i;
1000 
1001 	if (!num_vsi)
1002 		return ICE_ERR_PARAM;
1003 
1004 	if (lkup_type == ICE_SW_LKUP_MAC ||
1005 	    lkup_type == ICE_SW_LKUP_MAC_VLAN ||
1006 	    lkup_type == ICE_SW_LKUP_ETHERTYPE ||
1007 	    lkup_type == ICE_SW_LKUP_ETHERTYPE_MAC ||
1008 	    lkup_type == ICE_SW_LKUP_PROMISC ||
1009 	    lkup_type == ICE_SW_LKUP_PROMISC_VLAN)
1010 		type = remove ? ICE_AQC_SW_RULES_T_VSI_LIST_CLEAR :
1011 				ICE_AQC_SW_RULES_T_VSI_LIST_SET;
1012 	else if (lkup_type == ICE_SW_LKUP_VLAN)
1013 		type = remove ? ICE_AQC_SW_RULES_T_PRUNE_LIST_CLEAR :
1014 				ICE_AQC_SW_RULES_T_PRUNE_LIST_SET;
1015 	else
1016 		return ICE_ERR_PARAM;
1017 
1018 	s_rule_size = (u16)ICE_SW_RULE_VSI_LIST_SIZE(num_vsi);
1019 	s_rule = devm_kzalloc(ice_hw_to_dev(hw), s_rule_size, GFP_KERNEL);
1020 	if (!s_rule)
1021 		return ICE_ERR_NO_MEMORY;
1022 	for (i = 0; i < num_vsi; i++) {
1023 		if (!ice_is_vsi_valid(hw, vsi_handle_arr[i])) {
1024 			status = ICE_ERR_PARAM;
1025 			goto exit;
1026 		}
1027 		/* AQ call requires hw_vsi_id(s) */
1028 		s_rule->pdata.vsi_list.vsi[i] =
1029 			cpu_to_le16(ice_get_hw_vsi_num(hw, vsi_handle_arr[i]));
1030 	}
1031 
1032 	s_rule->type = cpu_to_le16(type);
1033 	s_rule->pdata.vsi_list.number_vsi = cpu_to_le16(num_vsi);
1034 	s_rule->pdata.vsi_list.index = cpu_to_le16(vsi_list_id);
1035 
1036 	status = ice_aq_sw_rules(hw, s_rule, s_rule_size, 1, opc, NULL);
1037 
1038 exit:
1039 	devm_kfree(ice_hw_to_dev(hw), s_rule);
1040 	return status;
1041 }
1042 
1043 /**
1044  * ice_create_vsi_list_rule - Creates and populates a VSI list rule
1045  * @hw: pointer to the HW struct
1046  * @vsi_handle_arr: array of VSI handles to form a VSI list
1047  * @num_vsi: number of VSI handles in the array
1048  * @vsi_list_id: stores the ID of the VSI list to be created
1049  * @lkup_type: switch rule filter's lookup type
1050  */
1051 static enum ice_status
1052 ice_create_vsi_list_rule(struct ice_hw *hw, u16 *vsi_handle_arr, u16 num_vsi,
1053 			 u16 *vsi_list_id, enum ice_sw_lkup_type lkup_type)
1054 {
1055 	enum ice_status status;
1056 
1057 	status = ice_aq_alloc_free_vsi_list(hw, vsi_list_id, lkup_type,
1058 					    ice_aqc_opc_alloc_res);
1059 	if (status)
1060 		return status;
1061 
1062 	/* Update the newly created VSI list to include the specified VSIs */
1063 	return ice_update_vsi_list_rule(hw, vsi_handle_arr, num_vsi,
1064 					*vsi_list_id, false,
1065 					ice_aqc_opc_add_sw_rules, lkup_type);
1066 }
1067 
1068 /**
1069  * ice_create_pkt_fwd_rule
1070  * @hw: pointer to the hardware structure
1071  * @f_entry: entry containing packet forwarding information
1072  *
1073  * Create switch rule with given filter information and add an entry
1074  * to the corresponding filter management list to track this switch rule
1075  * and VSI mapping
1076  */
1077 static enum ice_status
1078 ice_create_pkt_fwd_rule(struct ice_hw *hw,
1079 			struct ice_fltr_list_entry *f_entry)
1080 {
1081 	struct ice_fltr_mgmt_list_entry *fm_entry;
1082 	struct ice_aqc_sw_rules_elem *s_rule;
1083 	enum ice_sw_lkup_type l_type;
1084 	struct ice_sw_recipe *recp;
1085 	enum ice_status status;
1086 
1087 	s_rule = devm_kzalloc(ice_hw_to_dev(hw),
1088 			      ICE_SW_RULE_RX_TX_ETH_HDR_SIZE, GFP_KERNEL);
1089 	if (!s_rule)
1090 		return ICE_ERR_NO_MEMORY;
1091 	fm_entry = devm_kzalloc(ice_hw_to_dev(hw), sizeof(*fm_entry),
1092 				GFP_KERNEL);
1093 	if (!fm_entry) {
1094 		status = ICE_ERR_NO_MEMORY;
1095 		goto ice_create_pkt_fwd_rule_exit;
1096 	}
1097 
1098 	fm_entry->fltr_info = f_entry->fltr_info;
1099 
1100 	/* Initialize all the fields for the management entry */
1101 	fm_entry->vsi_count = 1;
1102 	fm_entry->lg_act_idx = ICE_INVAL_LG_ACT_INDEX;
1103 	fm_entry->sw_marker_id = ICE_INVAL_SW_MARKER_ID;
1104 	fm_entry->counter_index = ICE_INVAL_COUNTER_ID;
1105 
1106 	ice_fill_sw_rule(hw, &fm_entry->fltr_info, s_rule,
1107 			 ice_aqc_opc_add_sw_rules);
1108 
1109 	status = ice_aq_sw_rules(hw, s_rule, ICE_SW_RULE_RX_TX_ETH_HDR_SIZE, 1,
1110 				 ice_aqc_opc_add_sw_rules, NULL);
1111 	if (status) {
1112 		devm_kfree(ice_hw_to_dev(hw), fm_entry);
1113 		goto ice_create_pkt_fwd_rule_exit;
1114 	}
1115 
1116 	f_entry->fltr_info.fltr_rule_id =
1117 		le16_to_cpu(s_rule->pdata.lkup_tx_rx.index);
1118 	fm_entry->fltr_info.fltr_rule_id =
1119 		le16_to_cpu(s_rule->pdata.lkup_tx_rx.index);
1120 
1121 	/* The book keeping entries will get removed when base driver
1122 	 * calls remove filter AQ command
1123 	 */
1124 	l_type = fm_entry->fltr_info.lkup_type;
1125 	recp = &hw->switch_info->recp_list[l_type];
1126 	list_add(&fm_entry->list_entry, &recp->filt_rules);
1127 
1128 ice_create_pkt_fwd_rule_exit:
1129 	devm_kfree(ice_hw_to_dev(hw), s_rule);
1130 	return status;
1131 }
1132 
1133 /**
1134  * ice_update_pkt_fwd_rule
1135  * @hw: pointer to the hardware structure
1136  * @f_info: filter information for switch rule
1137  *
1138  * Call AQ command to update a previously created switch rule with a
1139  * VSI list ID
1140  */
1141 static enum ice_status
1142 ice_update_pkt_fwd_rule(struct ice_hw *hw, struct ice_fltr_info *f_info)
1143 {
1144 	struct ice_aqc_sw_rules_elem *s_rule;
1145 	enum ice_status status;
1146 
1147 	s_rule = devm_kzalloc(ice_hw_to_dev(hw),
1148 			      ICE_SW_RULE_RX_TX_ETH_HDR_SIZE, GFP_KERNEL);
1149 	if (!s_rule)
1150 		return ICE_ERR_NO_MEMORY;
1151 
1152 	ice_fill_sw_rule(hw, f_info, s_rule, ice_aqc_opc_update_sw_rules);
1153 
1154 	s_rule->pdata.lkup_tx_rx.index = cpu_to_le16(f_info->fltr_rule_id);
1155 
1156 	/* Update switch rule with new rule set to forward VSI list */
1157 	status = ice_aq_sw_rules(hw, s_rule, ICE_SW_RULE_RX_TX_ETH_HDR_SIZE, 1,
1158 				 ice_aqc_opc_update_sw_rules, NULL);
1159 
1160 	devm_kfree(ice_hw_to_dev(hw), s_rule);
1161 	return status;
1162 }
1163 
1164 /**
1165  * ice_update_sw_rule_bridge_mode
1166  * @hw: pointer to the HW struct
1167  *
1168  * Updates unicast switch filter rules based on VEB/VEPA mode
1169  */
1170 enum ice_status ice_update_sw_rule_bridge_mode(struct ice_hw *hw)
1171 {
1172 	struct ice_switch_info *sw = hw->switch_info;
1173 	struct ice_fltr_mgmt_list_entry *fm_entry;
1174 	enum ice_status status = 0;
1175 	struct list_head *rule_head;
1176 	struct mutex *rule_lock; /* Lock to protect filter rule list */
1177 
1178 	rule_lock = &sw->recp_list[ICE_SW_LKUP_MAC].filt_rule_lock;
1179 	rule_head = &sw->recp_list[ICE_SW_LKUP_MAC].filt_rules;
1180 
1181 	mutex_lock(rule_lock);
1182 	list_for_each_entry(fm_entry, rule_head, list_entry) {
1183 		struct ice_fltr_info *fi = &fm_entry->fltr_info;
1184 		u8 *addr = fi->l_data.mac.mac_addr;
1185 
1186 		/* Update unicast Tx rules to reflect the selected
1187 		 * VEB/VEPA mode
1188 		 */
1189 		if ((fi->flag & ICE_FLTR_TX) && is_unicast_ether_addr(addr) &&
1190 		    (fi->fltr_act == ICE_FWD_TO_VSI ||
1191 		     fi->fltr_act == ICE_FWD_TO_VSI_LIST ||
1192 		     fi->fltr_act == ICE_FWD_TO_Q ||
1193 		     fi->fltr_act == ICE_FWD_TO_QGRP)) {
1194 			status = ice_update_pkt_fwd_rule(hw, fi);
1195 			if (status)
1196 				break;
1197 		}
1198 	}
1199 
1200 	mutex_unlock(rule_lock);
1201 
1202 	return status;
1203 }
1204 
1205 /**
1206  * ice_add_update_vsi_list
1207  * @hw: pointer to the hardware structure
1208  * @m_entry: pointer to current filter management list entry
1209  * @cur_fltr: filter information from the book keeping entry
1210  * @new_fltr: filter information with the new VSI to be added
1211  *
1212  * Call AQ command to add or update previously created VSI list with new VSI.
1213  *
1214  * Helper function to do book keeping associated with adding filter information
1215  * The algorithm to do the book keeping is described below :
1216  * When a VSI needs to subscribe to a given filter (MAC/VLAN/Ethtype etc.)
1217  *	if only one VSI has been added till now
1218  *		Allocate a new VSI list and add two VSIs
1219  *		to this list using switch rule command
1220  *		Update the previously created switch rule with the
1221  *		newly created VSI list ID
1222  *	if a VSI list was previously created
1223  *		Add the new VSI to the previously created VSI list set
1224  *		using the update switch rule command
1225  */
1226 static enum ice_status
1227 ice_add_update_vsi_list(struct ice_hw *hw,
1228 			struct ice_fltr_mgmt_list_entry *m_entry,
1229 			struct ice_fltr_info *cur_fltr,
1230 			struct ice_fltr_info *new_fltr)
1231 {
1232 	enum ice_status status = 0;
1233 	u16 vsi_list_id = 0;
1234 
1235 	if ((cur_fltr->fltr_act == ICE_FWD_TO_Q ||
1236 	     cur_fltr->fltr_act == ICE_FWD_TO_QGRP))
1237 		return ICE_ERR_NOT_IMPL;
1238 
1239 	if ((new_fltr->fltr_act == ICE_FWD_TO_Q ||
1240 	     new_fltr->fltr_act == ICE_FWD_TO_QGRP) &&
1241 	    (cur_fltr->fltr_act == ICE_FWD_TO_VSI ||
1242 	     cur_fltr->fltr_act == ICE_FWD_TO_VSI_LIST))
1243 		return ICE_ERR_NOT_IMPL;
1244 
1245 	if (m_entry->vsi_count < 2 && !m_entry->vsi_list_info) {
1246 		/* Only one entry existed in the mapping and it was not already
1247 		 * a part of a VSI list. So, create a VSI list with the old and
1248 		 * new VSIs.
1249 		 */
1250 		struct ice_fltr_info tmp_fltr;
1251 		u16 vsi_handle_arr[2];
1252 
1253 		/* A rule already exists with the new VSI being added */
1254 		if (cur_fltr->fwd_id.hw_vsi_id == new_fltr->fwd_id.hw_vsi_id)
1255 			return ICE_ERR_ALREADY_EXISTS;
1256 
1257 		vsi_handle_arr[0] = cur_fltr->vsi_handle;
1258 		vsi_handle_arr[1] = new_fltr->vsi_handle;
1259 		status = ice_create_vsi_list_rule(hw, &vsi_handle_arr[0], 2,
1260 						  &vsi_list_id,
1261 						  new_fltr->lkup_type);
1262 		if (status)
1263 			return status;
1264 
1265 		tmp_fltr = *new_fltr;
1266 		tmp_fltr.fltr_rule_id = cur_fltr->fltr_rule_id;
1267 		tmp_fltr.fltr_act = ICE_FWD_TO_VSI_LIST;
1268 		tmp_fltr.fwd_id.vsi_list_id = vsi_list_id;
1269 		/* Update the previous switch rule of "MAC forward to VSI" to
1270 		 * "MAC fwd to VSI list"
1271 		 */
1272 		status = ice_update_pkt_fwd_rule(hw, &tmp_fltr);
1273 		if (status)
1274 			return status;
1275 
1276 		cur_fltr->fwd_id.vsi_list_id = vsi_list_id;
1277 		cur_fltr->fltr_act = ICE_FWD_TO_VSI_LIST;
1278 		m_entry->vsi_list_info =
1279 			ice_create_vsi_list_map(hw, &vsi_handle_arr[0], 2,
1280 						vsi_list_id);
1281 
1282 		/* If this entry was large action then the large action needs
1283 		 * to be updated to point to FWD to VSI list
1284 		 */
1285 		if (m_entry->sw_marker_id != ICE_INVAL_SW_MARKER_ID)
1286 			status =
1287 			    ice_add_marker_act(hw, m_entry,
1288 					       m_entry->sw_marker_id,
1289 					       m_entry->lg_act_idx);
1290 	} else {
1291 		u16 vsi_handle = new_fltr->vsi_handle;
1292 		enum ice_adminq_opc opcode;
1293 
1294 		if (!m_entry->vsi_list_info)
1295 			return ICE_ERR_CFG;
1296 
1297 		/* A rule already exists with the new VSI being added */
1298 		if (test_bit(vsi_handle, m_entry->vsi_list_info->vsi_map))
1299 			return 0;
1300 
1301 		/* Update the previously created VSI list set with
1302 		 * the new VSI ID passed in
1303 		 */
1304 		vsi_list_id = cur_fltr->fwd_id.vsi_list_id;
1305 		opcode = ice_aqc_opc_update_sw_rules;
1306 
1307 		status = ice_update_vsi_list_rule(hw, &vsi_handle, 1,
1308 						  vsi_list_id, false, opcode,
1309 						  new_fltr->lkup_type);
1310 		/* update VSI list mapping info with new VSI ID */
1311 		if (!status)
1312 			set_bit(vsi_handle, m_entry->vsi_list_info->vsi_map);
1313 	}
1314 	if (!status)
1315 		m_entry->vsi_count++;
1316 	return status;
1317 }
1318 
1319 /**
1320  * ice_find_rule_entry - Search a rule entry
1321  * @hw: pointer to the hardware structure
1322  * @recp_id: lookup type for which the specified rule needs to be searched
1323  * @f_info: rule information
1324  *
1325  * Helper function to search for a given rule entry
1326  * Returns pointer to entry storing the rule if found
1327  */
1328 static struct ice_fltr_mgmt_list_entry *
1329 ice_find_rule_entry(struct ice_hw *hw, u8 recp_id, struct ice_fltr_info *f_info)
1330 {
1331 	struct ice_fltr_mgmt_list_entry *list_itr, *ret = NULL;
1332 	struct ice_switch_info *sw = hw->switch_info;
1333 	struct list_head *list_head;
1334 
1335 	list_head = &sw->recp_list[recp_id].filt_rules;
1336 	list_for_each_entry(list_itr, list_head, list_entry) {
1337 		if (!memcmp(&f_info->l_data, &list_itr->fltr_info.l_data,
1338 			    sizeof(f_info->l_data)) &&
1339 		    f_info->flag == list_itr->fltr_info.flag) {
1340 			ret = list_itr;
1341 			break;
1342 		}
1343 	}
1344 	return ret;
1345 }
1346 
1347 /**
1348  * ice_find_vsi_list_entry - Search VSI list map with VSI count 1
1349  * @hw: pointer to the hardware structure
1350  * @recp_id: lookup type for which VSI lists needs to be searched
1351  * @vsi_handle: VSI handle to be found in VSI list
1352  * @vsi_list_id: VSI list ID found containing vsi_handle
1353  *
1354  * Helper function to search a VSI list with single entry containing given VSI
1355  * handle element. This can be extended further to search VSI list with more
1356  * than 1 vsi_count. Returns pointer to VSI list entry if found.
1357  */
1358 static struct ice_vsi_list_map_info *
1359 ice_find_vsi_list_entry(struct ice_hw *hw, u8 recp_id, u16 vsi_handle,
1360 			u16 *vsi_list_id)
1361 {
1362 	struct ice_vsi_list_map_info *map_info = NULL;
1363 	struct ice_switch_info *sw = hw->switch_info;
1364 	struct ice_fltr_mgmt_list_entry *list_itr;
1365 	struct list_head *list_head;
1366 
1367 	list_head = &sw->recp_list[recp_id].filt_rules;
1368 	list_for_each_entry(list_itr, list_head, list_entry) {
1369 		if (list_itr->vsi_count == 1 && list_itr->vsi_list_info) {
1370 			map_info = list_itr->vsi_list_info;
1371 			if (test_bit(vsi_handle, map_info->vsi_map)) {
1372 				*vsi_list_id = map_info->vsi_list_id;
1373 				return map_info;
1374 			}
1375 		}
1376 	}
1377 	return NULL;
1378 }
1379 
1380 /**
1381  * ice_add_rule_internal - add rule for a given lookup type
1382  * @hw: pointer to the hardware structure
1383  * @recp_id: lookup type (recipe ID) for which rule has to be added
1384  * @f_entry: structure containing MAC forwarding information
1385  *
1386  * Adds or updates the rule lists for a given recipe
1387  */
1388 static enum ice_status
1389 ice_add_rule_internal(struct ice_hw *hw, u8 recp_id,
1390 		      struct ice_fltr_list_entry *f_entry)
1391 {
1392 	struct ice_switch_info *sw = hw->switch_info;
1393 	struct ice_fltr_info *new_fltr, *cur_fltr;
1394 	struct ice_fltr_mgmt_list_entry *m_entry;
1395 	struct mutex *rule_lock; /* Lock to protect filter rule list */
1396 	enum ice_status status = 0;
1397 
1398 	if (!ice_is_vsi_valid(hw, f_entry->fltr_info.vsi_handle))
1399 		return ICE_ERR_PARAM;
1400 	f_entry->fltr_info.fwd_id.hw_vsi_id =
1401 		ice_get_hw_vsi_num(hw, f_entry->fltr_info.vsi_handle);
1402 
1403 	rule_lock = &sw->recp_list[recp_id].filt_rule_lock;
1404 
1405 	mutex_lock(rule_lock);
1406 	new_fltr = &f_entry->fltr_info;
1407 	if (new_fltr->flag & ICE_FLTR_RX)
1408 		new_fltr->src = hw->port_info->lport;
1409 	else if (new_fltr->flag & ICE_FLTR_TX)
1410 		new_fltr->src = f_entry->fltr_info.fwd_id.hw_vsi_id;
1411 
1412 	m_entry = ice_find_rule_entry(hw, recp_id, new_fltr);
1413 	if (!m_entry) {
1414 		mutex_unlock(rule_lock);
1415 		return ice_create_pkt_fwd_rule(hw, f_entry);
1416 	}
1417 
1418 	cur_fltr = &m_entry->fltr_info;
1419 	status = ice_add_update_vsi_list(hw, m_entry, cur_fltr, new_fltr);
1420 	mutex_unlock(rule_lock);
1421 
1422 	return status;
1423 }
1424 
1425 /**
1426  * ice_remove_vsi_list_rule
1427  * @hw: pointer to the hardware structure
1428  * @vsi_list_id: VSI list ID generated as part of allocate resource
1429  * @lkup_type: switch rule filter lookup type
1430  *
1431  * The VSI list should be emptied before this function is called to remove the
1432  * VSI list.
1433  */
1434 static enum ice_status
1435 ice_remove_vsi_list_rule(struct ice_hw *hw, u16 vsi_list_id,
1436 			 enum ice_sw_lkup_type lkup_type)
1437 {
1438 	struct ice_aqc_sw_rules_elem *s_rule;
1439 	enum ice_status status;
1440 	u16 s_rule_size;
1441 
1442 	s_rule_size = (u16)ICE_SW_RULE_VSI_LIST_SIZE(0);
1443 	s_rule = devm_kzalloc(ice_hw_to_dev(hw), s_rule_size, GFP_KERNEL);
1444 	if (!s_rule)
1445 		return ICE_ERR_NO_MEMORY;
1446 
1447 	s_rule->type = cpu_to_le16(ICE_AQC_SW_RULES_T_VSI_LIST_CLEAR);
1448 	s_rule->pdata.vsi_list.index = cpu_to_le16(vsi_list_id);
1449 
1450 	/* Free the vsi_list resource that we allocated. It is assumed that the
1451 	 * list is empty at this point.
1452 	 */
1453 	status = ice_aq_alloc_free_vsi_list(hw, &vsi_list_id, lkup_type,
1454 					    ice_aqc_opc_free_res);
1455 
1456 	devm_kfree(ice_hw_to_dev(hw), s_rule);
1457 	return status;
1458 }
1459 
1460 /**
1461  * ice_rem_update_vsi_list
1462  * @hw: pointer to the hardware structure
1463  * @vsi_handle: VSI handle of the VSI to remove
1464  * @fm_list: filter management entry for which the VSI list management needs to
1465  *           be done
1466  */
1467 static enum ice_status
1468 ice_rem_update_vsi_list(struct ice_hw *hw, u16 vsi_handle,
1469 			struct ice_fltr_mgmt_list_entry *fm_list)
1470 {
1471 	enum ice_sw_lkup_type lkup_type;
1472 	enum ice_status status = 0;
1473 	u16 vsi_list_id;
1474 
1475 	if (fm_list->fltr_info.fltr_act != ICE_FWD_TO_VSI_LIST ||
1476 	    fm_list->vsi_count == 0)
1477 		return ICE_ERR_PARAM;
1478 
1479 	/* A rule with the VSI being removed does not exist */
1480 	if (!test_bit(vsi_handle, fm_list->vsi_list_info->vsi_map))
1481 		return ICE_ERR_DOES_NOT_EXIST;
1482 
1483 	lkup_type = fm_list->fltr_info.lkup_type;
1484 	vsi_list_id = fm_list->fltr_info.fwd_id.vsi_list_id;
1485 	status = ice_update_vsi_list_rule(hw, &vsi_handle, 1, vsi_list_id, true,
1486 					  ice_aqc_opc_update_sw_rules,
1487 					  lkup_type);
1488 	if (status)
1489 		return status;
1490 
1491 	fm_list->vsi_count--;
1492 	clear_bit(vsi_handle, fm_list->vsi_list_info->vsi_map);
1493 
1494 	if (fm_list->vsi_count == 1 && lkup_type != ICE_SW_LKUP_VLAN) {
1495 		struct ice_fltr_info tmp_fltr_info = fm_list->fltr_info;
1496 		struct ice_vsi_list_map_info *vsi_list_info =
1497 			fm_list->vsi_list_info;
1498 		u16 rem_vsi_handle;
1499 
1500 		rem_vsi_handle = find_first_bit(vsi_list_info->vsi_map,
1501 						ICE_MAX_VSI);
1502 		if (!ice_is_vsi_valid(hw, rem_vsi_handle))
1503 			return ICE_ERR_OUT_OF_RANGE;
1504 
1505 		/* Make sure VSI list is empty before removing it below */
1506 		status = ice_update_vsi_list_rule(hw, &rem_vsi_handle, 1,
1507 						  vsi_list_id, true,
1508 						  ice_aqc_opc_update_sw_rules,
1509 						  lkup_type);
1510 		if (status)
1511 			return status;
1512 
1513 		tmp_fltr_info.fltr_act = ICE_FWD_TO_VSI;
1514 		tmp_fltr_info.fwd_id.hw_vsi_id =
1515 			ice_get_hw_vsi_num(hw, rem_vsi_handle);
1516 		tmp_fltr_info.vsi_handle = rem_vsi_handle;
1517 		status = ice_update_pkt_fwd_rule(hw, &tmp_fltr_info);
1518 		if (status) {
1519 			ice_debug(hw, ICE_DBG_SW,
1520 				  "Failed to update pkt fwd rule to FWD_TO_VSI on HW VSI %d, error %d\n",
1521 				  tmp_fltr_info.fwd_id.hw_vsi_id, status);
1522 			return status;
1523 		}
1524 
1525 		fm_list->fltr_info = tmp_fltr_info;
1526 	}
1527 
1528 	if ((fm_list->vsi_count == 1 && lkup_type != ICE_SW_LKUP_VLAN) ||
1529 	    (fm_list->vsi_count == 0 && lkup_type == ICE_SW_LKUP_VLAN)) {
1530 		struct ice_vsi_list_map_info *vsi_list_info =
1531 			fm_list->vsi_list_info;
1532 
1533 		/* Remove the VSI list since it is no longer used */
1534 		status = ice_remove_vsi_list_rule(hw, vsi_list_id, lkup_type);
1535 		if (status) {
1536 			ice_debug(hw, ICE_DBG_SW,
1537 				  "Failed to remove VSI list %d, error %d\n",
1538 				  vsi_list_id, status);
1539 			return status;
1540 		}
1541 
1542 		list_del(&vsi_list_info->list_entry);
1543 		devm_kfree(ice_hw_to_dev(hw), vsi_list_info);
1544 		fm_list->vsi_list_info = NULL;
1545 	}
1546 
1547 	return status;
1548 }
1549 
1550 /**
1551  * ice_remove_rule_internal - Remove a filter rule of a given type
1552  * @hw: pointer to the hardware structure
1553  * @recp_id: recipe ID for which the rule needs to removed
1554  * @f_entry: rule entry containing filter information
1555  */
1556 static enum ice_status
1557 ice_remove_rule_internal(struct ice_hw *hw, u8 recp_id,
1558 			 struct ice_fltr_list_entry *f_entry)
1559 {
1560 	struct ice_switch_info *sw = hw->switch_info;
1561 	struct ice_fltr_mgmt_list_entry *list_elem;
1562 	struct mutex *rule_lock; /* Lock to protect filter rule list */
1563 	enum ice_status status = 0;
1564 	bool remove_rule = false;
1565 	u16 vsi_handle;
1566 
1567 	if (!ice_is_vsi_valid(hw, f_entry->fltr_info.vsi_handle))
1568 		return ICE_ERR_PARAM;
1569 	f_entry->fltr_info.fwd_id.hw_vsi_id =
1570 		ice_get_hw_vsi_num(hw, f_entry->fltr_info.vsi_handle);
1571 
1572 	rule_lock = &sw->recp_list[recp_id].filt_rule_lock;
1573 	mutex_lock(rule_lock);
1574 	list_elem = ice_find_rule_entry(hw, recp_id, &f_entry->fltr_info);
1575 	if (!list_elem) {
1576 		status = ICE_ERR_DOES_NOT_EXIST;
1577 		goto exit;
1578 	}
1579 
1580 	if (list_elem->fltr_info.fltr_act != ICE_FWD_TO_VSI_LIST) {
1581 		remove_rule = true;
1582 	} else if (!list_elem->vsi_list_info) {
1583 		status = ICE_ERR_DOES_NOT_EXIST;
1584 		goto exit;
1585 	} else if (list_elem->vsi_list_info->ref_cnt > 1) {
1586 		/* a ref_cnt > 1 indicates that the vsi_list is being
1587 		 * shared by multiple rules. Decrement the ref_cnt and
1588 		 * remove this rule, but do not modify the list, as it
1589 		 * is in-use by other rules.
1590 		 */
1591 		list_elem->vsi_list_info->ref_cnt--;
1592 		remove_rule = true;
1593 	} else {
1594 		/* a ref_cnt of 1 indicates the vsi_list is only used
1595 		 * by one rule. However, the original removal request is only
1596 		 * for a single VSI. Update the vsi_list first, and only
1597 		 * remove the rule if there are no further VSIs in this list.
1598 		 */
1599 		vsi_handle = f_entry->fltr_info.vsi_handle;
1600 		status = ice_rem_update_vsi_list(hw, vsi_handle, list_elem);
1601 		if (status)
1602 			goto exit;
1603 		/* if VSI count goes to zero after updating the VSI list */
1604 		if (list_elem->vsi_count == 0)
1605 			remove_rule = true;
1606 	}
1607 
1608 	if (remove_rule) {
1609 		/* Remove the lookup rule */
1610 		struct ice_aqc_sw_rules_elem *s_rule;
1611 
1612 		s_rule = devm_kzalloc(ice_hw_to_dev(hw),
1613 				      ICE_SW_RULE_RX_TX_NO_HDR_SIZE,
1614 				      GFP_KERNEL);
1615 		if (!s_rule) {
1616 			status = ICE_ERR_NO_MEMORY;
1617 			goto exit;
1618 		}
1619 
1620 		ice_fill_sw_rule(hw, &list_elem->fltr_info, s_rule,
1621 				 ice_aqc_opc_remove_sw_rules);
1622 
1623 		status = ice_aq_sw_rules(hw, s_rule,
1624 					 ICE_SW_RULE_RX_TX_NO_HDR_SIZE, 1,
1625 					 ice_aqc_opc_remove_sw_rules, NULL);
1626 		if (status)
1627 			goto exit;
1628 
1629 		/* Remove a book keeping from the list */
1630 		devm_kfree(ice_hw_to_dev(hw), s_rule);
1631 
1632 		list_del(&list_elem->list_entry);
1633 		devm_kfree(ice_hw_to_dev(hw), list_elem);
1634 	}
1635 exit:
1636 	mutex_unlock(rule_lock);
1637 	return status;
1638 }
1639 
1640 /**
1641  * ice_add_mac - Add a MAC address based filter rule
1642  * @hw: pointer to the hardware structure
1643  * @m_list: list of MAC addresses and forwarding information
1644  *
1645  * IMPORTANT: When the ucast_shared flag is set to false and m_list has
1646  * multiple unicast addresses, the function assumes that all the
1647  * addresses are unique in a given add_mac call. It doesn't
1648  * check for duplicates in this case, removing duplicates from a given
1649  * list should be taken care of in the caller of this function.
1650  */
1651 enum ice_status
1652 ice_add_mac(struct ice_hw *hw, struct list_head *m_list)
1653 {
1654 	struct ice_aqc_sw_rules_elem *s_rule, *r_iter;
1655 	struct ice_fltr_list_entry *m_list_itr;
1656 	struct list_head *rule_head;
1657 	u16 elem_sent, total_elem_left;
1658 	struct ice_switch_info *sw;
1659 	struct mutex *rule_lock; /* Lock to protect filter rule list */
1660 	enum ice_status status = 0;
1661 	u16 num_unicast = 0;
1662 	u16 s_rule_size;
1663 
1664 	if (!m_list || !hw)
1665 		return ICE_ERR_PARAM;
1666 
1667 	s_rule = NULL;
1668 	sw = hw->switch_info;
1669 	rule_lock = &sw->recp_list[ICE_SW_LKUP_MAC].filt_rule_lock;
1670 	list_for_each_entry(m_list_itr, m_list, list_entry) {
1671 		u8 *add = &m_list_itr->fltr_info.l_data.mac.mac_addr[0];
1672 		u16 vsi_handle;
1673 		u16 hw_vsi_id;
1674 
1675 		m_list_itr->fltr_info.flag = ICE_FLTR_TX;
1676 		vsi_handle = m_list_itr->fltr_info.vsi_handle;
1677 		if (!ice_is_vsi_valid(hw, vsi_handle))
1678 			return ICE_ERR_PARAM;
1679 		hw_vsi_id = ice_get_hw_vsi_num(hw, vsi_handle);
1680 		m_list_itr->fltr_info.fwd_id.hw_vsi_id = hw_vsi_id;
1681 		/* update the src in case it is VSI num */
1682 		if (m_list_itr->fltr_info.src_id != ICE_SRC_ID_VSI)
1683 			return ICE_ERR_PARAM;
1684 		m_list_itr->fltr_info.src = hw_vsi_id;
1685 		if (m_list_itr->fltr_info.lkup_type != ICE_SW_LKUP_MAC ||
1686 		    is_zero_ether_addr(add))
1687 			return ICE_ERR_PARAM;
1688 		if (is_unicast_ether_addr(add) && !hw->ucast_shared) {
1689 			/* Don't overwrite the unicast address */
1690 			mutex_lock(rule_lock);
1691 			if (ice_find_rule_entry(hw, ICE_SW_LKUP_MAC,
1692 						&m_list_itr->fltr_info)) {
1693 				mutex_unlock(rule_lock);
1694 				return ICE_ERR_ALREADY_EXISTS;
1695 			}
1696 			mutex_unlock(rule_lock);
1697 			num_unicast++;
1698 		} else if (is_multicast_ether_addr(add) ||
1699 			   (is_unicast_ether_addr(add) && hw->ucast_shared)) {
1700 			m_list_itr->status =
1701 				ice_add_rule_internal(hw, ICE_SW_LKUP_MAC,
1702 						      m_list_itr);
1703 			if (m_list_itr->status)
1704 				return m_list_itr->status;
1705 		}
1706 	}
1707 
1708 	mutex_lock(rule_lock);
1709 	/* Exit if no suitable entries were found for adding bulk switch rule */
1710 	if (!num_unicast) {
1711 		status = 0;
1712 		goto ice_add_mac_exit;
1713 	}
1714 
1715 	rule_head = &sw->recp_list[ICE_SW_LKUP_MAC].filt_rules;
1716 
1717 	/* Allocate switch rule buffer for the bulk update for unicast */
1718 	s_rule_size = ICE_SW_RULE_RX_TX_ETH_HDR_SIZE;
1719 	s_rule = devm_kcalloc(ice_hw_to_dev(hw), num_unicast, s_rule_size,
1720 			      GFP_KERNEL);
1721 	if (!s_rule) {
1722 		status = ICE_ERR_NO_MEMORY;
1723 		goto ice_add_mac_exit;
1724 	}
1725 
1726 	r_iter = s_rule;
1727 	list_for_each_entry(m_list_itr, m_list, list_entry) {
1728 		struct ice_fltr_info *f_info = &m_list_itr->fltr_info;
1729 		u8 *mac_addr = &f_info->l_data.mac.mac_addr[0];
1730 
1731 		if (is_unicast_ether_addr(mac_addr)) {
1732 			ice_fill_sw_rule(hw, &m_list_itr->fltr_info, r_iter,
1733 					 ice_aqc_opc_add_sw_rules);
1734 			r_iter = (struct ice_aqc_sw_rules_elem *)
1735 				((u8 *)r_iter + s_rule_size);
1736 		}
1737 	}
1738 
1739 	/* Call AQ bulk switch rule update for all unicast addresses */
1740 	r_iter = s_rule;
1741 	/* Call AQ switch rule in AQ_MAX chunk */
1742 	for (total_elem_left = num_unicast; total_elem_left > 0;
1743 	     total_elem_left -= elem_sent) {
1744 		struct ice_aqc_sw_rules_elem *entry = r_iter;
1745 
1746 		elem_sent = min(total_elem_left,
1747 				(u16)(ICE_AQ_MAX_BUF_LEN / s_rule_size));
1748 		status = ice_aq_sw_rules(hw, entry, elem_sent * s_rule_size,
1749 					 elem_sent, ice_aqc_opc_add_sw_rules,
1750 					 NULL);
1751 		if (status)
1752 			goto ice_add_mac_exit;
1753 		r_iter = (struct ice_aqc_sw_rules_elem *)
1754 			((u8 *)r_iter + (elem_sent * s_rule_size));
1755 	}
1756 
1757 	/* Fill up rule ID based on the value returned from FW */
1758 	r_iter = s_rule;
1759 	list_for_each_entry(m_list_itr, m_list, list_entry) {
1760 		struct ice_fltr_info *f_info = &m_list_itr->fltr_info;
1761 		u8 *mac_addr = &f_info->l_data.mac.mac_addr[0];
1762 		struct ice_fltr_mgmt_list_entry *fm_entry;
1763 
1764 		if (is_unicast_ether_addr(mac_addr)) {
1765 			f_info->fltr_rule_id =
1766 				le16_to_cpu(r_iter->pdata.lkup_tx_rx.index);
1767 			f_info->fltr_act = ICE_FWD_TO_VSI;
1768 			/* Create an entry to track this MAC address */
1769 			fm_entry = devm_kzalloc(ice_hw_to_dev(hw),
1770 						sizeof(*fm_entry), GFP_KERNEL);
1771 			if (!fm_entry) {
1772 				status = ICE_ERR_NO_MEMORY;
1773 				goto ice_add_mac_exit;
1774 			}
1775 			fm_entry->fltr_info = *f_info;
1776 			fm_entry->vsi_count = 1;
1777 			/* The book keeping entries will get removed when
1778 			 * base driver calls remove filter AQ command
1779 			 */
1780 
1781 			list_add(&fm_entry->list_entry, rule_head);
1782 			r_iter = (struct ice_aqc_sw_rules_elem *)
1783 				((u8 *)r_iter + s_rule_size);
1784 		}
1785 	}
1786 
1787 ice_add_mac_exit:
1788 	mutex_unlock(rule_lock);
1789 	if (s_rule)
1790 		devm_kfree(ice_hw_to_dev(hw), s_rule);
1791 	return status;
1792 }
1793 
1794 /**
1795  * ice_add_vlan_internal - Add one VLAN based filter rule
1796  * @hw: pointer to the hardware structure
1797  * @f_entry: filter entry containing one VLAN information
1798  */
1799 static enum ice_status
1800 ice_add_vlan_internal(struct ice_hw *hw, struct ice_fltr_list_entry *f_entry)
1801 {
1802 	struct ice_switch_info *sw = hw->switch_info;
1803 	struct ice_fltr_mgmt_list_entry *v_list_itr;
1804 	struct ice_fltr_info *new_fltr, *cur_fltr;
1805 	enum ice_sw_lkup_type lkup_type;
1806 	u16 vsi_list_id = 0, vsi_handle;
1807 	struct mutex *rule_lock; /* Lock to protect filter rule list */
1808 	enum ice_status status = 0;
1809 
1810 	if (!ice_is_vsi_valid(hw, f_entry->fltr_info.vsi_handle))
1811 		return ICE_ERR_PARAM;
1812 
1813 	f_entry->fltr_info.fwd_id.hw_vsi_id =
1814 		ice_get_hw_vsi_num(hw, f_entry->fltr_info.vsi_handle);
1815 	new_fltr = &f_entry->fltr_info;
1816 
1817 	/* VLAN ID should only be 12 bits */
1818 	if (new_fltr->l_data.vlan.vlan_id > ICE_MAX_VLAN_ID)
1819 		return ICE_ERR_PARAM;
1820 
1821 	if (new_fltr->src_id != ICE_SRC_ID_VSI)
1822 		return ICE_ERR_PARAM;
1823 
1824 	new_fltr->src = new_fltr->fwd_id.hw_vsi_id;
1825 	lkup_type = new_fltr->lkup_type;
1826 	vsi_handle = new_fltr->vsi_handle;
1827 	rule_lock = &sw->recp_list[ICE_SW_LKUP_VLAN].filt_rule_lock;
1828 	mutex_lock(rule_lock);
1829 	v_list_itr = ice_find_rule_entry(hw, ICE_SW_LKUP_VLAN, new_fltr);
1830 	if (!v_list_itr) {
1831 		struct ice_vsi_list_map_info *map_info = NULL;
1832 
1833 		if (new_fltr->fltr_act == ICE_FWD_TO_VSI) {
1834 			/* All VLAN pruning rules use a VSI list. Check if
1835 			 * there is already a VSI list containing VSI that we
1836 			 * want to add. If found, use the same vsi_list_id for
1837 			 * this new VLAN rule or else create a new list.
1838 			 */
1839 			map_info = ice_find_vsi_list_entry(hw, ICE_SW_LKUP_VLAN,
1840 							   vsi_handle,
1841 							   &vsi_list_id);
1842 			if (!map_info) {
1843 				status = ice_create_vsi_list_rule(hw,
1844 								  &vsi_handle,
1845 								  1,
1846 								  &vsi_list_id,
1847 								  lkup_type);
1848 				if (status)
1849 					goto exit;
1850 			}
1851 			/* Convert the action to forwarding to a VSI list. */
1852 			new_fltr->fltr_act = ICE_FWD_TO_VSI_LIST;
1853 			new_fltr->fwd_id.vsi_list_id = vsi_list_id;
1854 		}
1855 
1856 		status = ice_create_pkt_fwd_rule(hw, f_entry);
1857 		if (!status) {
1858 			v_list_itr = ice_find_rule_entry(hw, ICE_SW_LKUP_VLAN,
1859 							 new_fltr);
1860 			if (!v_list_itr) {
1861 				status = ICE_ERR_DOES_NOT_EXIST;
1862 				goto exit;
1863 			}
1864 			/* reuse VSI list for new rule and increment ref_cnt */
1865 			if (map_info) {
1866 				v_list_itr->vsi_list_info = map_info;
1867 				map_info->ref_cnt++;
1868 			} else {
1869 				v_list_itr->vsi_list_info =
1870 					ice_create_vsi_list_map(hw, &vsi_handle,
1871 								1, vsi_list_id);
1872 			}
1873 		}
1874 	} else if (v_list_itr->vsi_list_info->ref_cnt == 1) {
1875 		/* Update existing VSI list to add new VSI ID only if it used
1876 		 * by one VLAN rule.
1877 		 */
1878 		cur_fltr = &v_list_itr->fltr_info;
1879 		status = ice_add_update_vsi_list(hw, v_list_itr, cur_fltr,
1880 						 new_fltr);
1881 	} else {
1882 		/* If VLAN rule exists and VSI list being used by this rule is
1883 		 * referenced by more than 1 VLAN rule. Then create a new VSI
1884 		 * list appending previous VSI with new VSI and update existing
1885 		 * VLAN rule to point to new VSI list ID
1886 		 */
1887 		struct ice_fltr_info tmp_fltr;
1888 		u16 vsi_handle_arr[2];
1889 		u16 cur_handle;
1890 
1891 		/* Current implementation only supports reusing VSI list with
1892 		 * one VSI count. We should never hit below condition
1893 		 */
1894 		if (v_list_itr->vsi_count > 1 &&
1895 		    v_list_itr->vsi_list_info->ref_cnt > 1) {
1896 			ice_debug(hw, ICE_DBG_SW,
1897 				  "Invalid configuration: Optimization to reuse VSI list with more than one VSI is not being done yet\n");
1898 			status = ICE_ERR_CFG;
1899 			goto exit;
1900 		}
1901 
1902 		cur_handle =
1903 			find_first_bit(v_list_itr->vsi_list_info->vsi_map,
1904 				       ICE_MAX_VSI);
1905 
1906 		/* A rule already exists with the new VSI being added */
1907 		if (cur_handle == vsi_handle) {
1908 			status = ICE_ERR_ALREADY_EXISTS;
1909 			goto exit;
1910 		}
1911 
1912 		vsi_handle_arr[0] = cur_handle;
1913 		vsi_handle_arr[1] = vsi_handle;
1914 		status = ice_create_vsi_list_rule(hw, &vsi_handle_arr[0], 2,
1915 						  &vsi_list_id, lkup_type);
1916 		if (status)
1917 			goto exit;
1918 
1919 		tmp_fltr = v_list_itr->fltr_info;
1920 		tmp_fltr.fltr_rule_id = v_list_itr->fltr_info.fltr_rule_id;
1921 		tmp_fltr.fwd_id.vsi_list_id = vsi_list_id;
1922 		tmp_fltr.fltr_act = ICE_FWD_TO_VSI_LIST;
1923 		/* Update the previous switch rule to a new VSI list which
1924 		 * includes current VSI that is requested
1925 		 */
1926 		status = ice_update_pkt_fwd_rule(hw, &tmp_fltr);
1927 		if (status)
1928 			goto exit;
1929 
1930 		/* before overriding VSI list map info. decrement ref_cnt of
1931 		 * previous VSI list
1932 		 */
1933 		v_list_itr->vsi_list_info->ref_cnt--;
1934 
1935 		/* now update to newly created list */
1936 		v_list_itr->fltr_info.fwd_id.vsi_list_id = vsi_list_id;
1937 		v_list_itr->vsi_list_info =
1938 			ice_create_vsi_list_map(hw, &vsi_handle_arr[0], 2,
1939 						vsi_list_id);
1940 		v_list_itr->vsi_count++;
1941 	}
1942 
1943 exit:
1944 	mutex_unlock(rule_lock);
1945 	return status;
1946 }
1947 
1948 /**
1949  * ice_add_vlan - Add VLAN based filter rule
1950  * @hw: pointer to the hardware structure
1951  * @v_list: list of VLAN entries and forwarding information
1952  */
1953 enum ice_status
1954 ice_add_vlan(struct ice_hw *hw, struct list_head *v_list)
1955 {
1956 	struct ice_fltr_list_entry *v_list_itr;
1957 
1958 	if (!v_list || !hw)
1959 		return ICE_ERR_PARAM;
1960 
1961 	list_for_each_entry(v_list_itr, v_list, list_entry) {
1962 		if (v_list_itr->fltr_info.lkup_type != ICE_SW_LKUP_VLAN)
1963 			return ICE_ERR_PARAM;
1964 		v_list_itr->fltr_info.flag = ICE_FLTR_TX;
1965 		v_list_itr->status = ice_add_vlan_internal(hw, v_list_itr);
1966 		if (v_list_itr->status)
1967 			return v_list_itr->status;
1968 	}
1969 	return 0;
1970 }
1971 
1972 /**
1973  * ice_add_eth_mac - Add ethertype and MAC based filter rule
1974  * @hw: pointer to the hardware structure
1975  * @em_list: list of ether type MAC filter, MAC is optional
1976  */
1977 enum ice_status
1978 ice_add_eth_mac(struct ice_hw *hw, struct list_head *em_list)
1979 {
1980 	struct ice_fltr_list_entry *em_list_itr;
1981 
1982 	if (!em_list || !hw)
1983 		return ICE_ERR_PARAM;
1984 
1985 	list_for_each_entry(em_list_itr, em_list, list_entry) {
1986 		enum ice_sw_lkup_type l_type =
1987 			em_list_itr->fltr_info.lkup_type;
1988 
1989 		if (l_type != ICE_SW_LKUP_ETHERTYPE_MAC &&
1990 		    l_type != ICE_SW_LKUP_ETHERTYPE)
1991 			return ICE_ERR_PARAM;
1992 
1993 		em_list_itr->fltr_info.flag = ICE_FLTR_TX;
1994 		em_list_itr->status = ice_add_rule_internal(hw, l_type,
1995 							    em_list_itr);
1996 		if (em_list_itr->status)
1997 			return em_list_itr->status;
1998 	}
1999 	return 0;
2000 }
2001 
2002 /**
2003  * ice_remove_eth_mac - Remove an ethertype (or MAC) based filter rule
2004  * @hw: pointer to the hardware structure
2005  * @em_list: list of ethertype or ethertype MAC entries
2006  */
2007 enum ice_status
2008 ice_remove_eth_mac(struct ice_hw *hw, struct list_head *em_list)
2009 {
2010 	struct ice_fltr_list_entry *em_list_itr, *tmp;
2011 
2012 	if (!em_list || !hw)
2013 		return ICE_ERR_PARAM;
2014 
2015 	list_for_each_entry_safe(em_list_itr, tmp, em_list, list_entry) {
2016 		enum ice_sw_lkup_type l_type =
2017 			em_list_itr->fltr_info.lkup_type;
2018 
2019 		if (l_type != ICE_SW_LKUP_ETHERTYPE_MAC &&
2020 		    l_type != ICE_SW_LKUP_ETHERTYPE)
2021 			return ICE_ERR_PARAM;
2022 
2023 		em_list_itr->status = ice_remove_rule_internal(hw, l_type,
2024 							       em_list_itr);
2025 		if (em_list_itr->status)
2026 			return em_list_itr->status;
2027 	}
2028 	return 0;
2029 }
2030 
2031 /**
2032  * ice_rem_sw_rule_info
2033  * @hw: pointer to the hardware structure
2034  * @rule_head: pointer to the switch list structure that we want to delete
2035  */
2036 static void
2037 ice_rem_sw_rule_info(struct ice_hw *hw, struct list_head *rule_head)
2038 {
2039 	if (!list_empty(rule_head)) {
2040 		struct ice_fltr_mgmt_list_entry *entry;
2041 		struct ice_fltr_mgmt_list_entry *tmp;
2042 
2043 		list_for_each_entry_safe(entry, tmp, rule_head, list_entry) {
2044 			list_del(&entry->list_entry);
2045 			devm_kfree(ice_hw_to_dev(hw), entry);
2046 		}
2047 	}
2048 }
2049 
2050 /**
2051  * ice_cfg_dflt_vsi - change state of VSI to set/clear default
2052  * @hw: pointer to the hardware structure
2053  * @vsi_handle: VSI handle to set as default
2054  * @set: true to add the above mentioned switch rule, false to remove it
2055  * @direction: ICE_FLTR_RX or ICE_FLTR_TX
2056  *
2057  * add filter rule to set/unset given VSI as default VSI for the switch
2058  * (represented by swid)
2059  */
2060 enum ice_status
2061 ice_cfg_dflt_vsi(struct ice_hw *hw, u16 vsi_handle, bool set, u8 direction)
2062 {
2063 	struct ice_aqc_sw_rules_elem *s_rule;
2064 	struct ice_fltr_info f_info;
2065 	enum ice_adminq_opc opcode;
2066 	enum ice_status status;
2067 	u16 s_rule_size;
2068 	u16 hw_vsi_id;
2069 
2070 	if (!ice_is_vsi_valid(hw, vsi_handle))
2071 		return ICE_ERR_PARAM;
2072 	hw_vsi_id = ice_get_hw_vsi_num(hw, vsi_handle);
2073 
2074 	s_rule_size = set ? ICE_SW_RULE_RX_TX_ETH_HDR_SIZE :
2075 			    ICE_SW_RULE_RX_TX_NO_HDR_SIZE;
2076 	s_rule = devm_kzalloc(ice_hw_to_dev(hw), s_rule_size, GFP_KERNEL);
2077 	if (!s_rule)
2078 		return ICE_ERR_NO_MEMORY;
2079 
2080 	memset(&f_info, 0, sizeof(f_info));
2081 
2082 	f_info.lkup_type = ICE_SW_LKUP_DFLT;
2083 	f_info.flag = direction;
2084 	f_info.fltr_act = ICE_FWD_TO_VSI;
2085 	f_info.fwd_id.hw_vsi_id = hw_vsi_id;
2086 
2087 	if (f_info.flag & ICE_FLTR_RX) {
2088 		f_info.src = hw->port_info->lport;
2089 		f_info.src_id = ICE_SRC_ID_LPORT;
2090 		if (!set)
2091 			f_info.fltr_rule_id =
2092 				hw->port_info->dflt_rx_vsi_rule_id;
2093 	} else if (f_info.flag & ICE_FLTR_TX) {
2094 		f_info.src_id = ICE_SRC_ID_VSI;
2095 		f_info.src = hw_vsi_id;
2096 		if (!set)
2097 			f_info.fltr_rule_id =
2098 				hw->port_info->dflt_tx_vsi_rule_id;
2099 	}
2100 
2101 	if (set)
2102 		opcode = ice_aqc_opc_add_sw_rules;
2103 	else
2104 		opcode = ice_aqc_opc_remove_sw_rules;
2105 
2106 	ice_fill_sw_rule(hw, &f_info, s_rule, opcode);
2107 
2108 	status = ice_aq_sw_rules(hw, s_rule, s_rule_size, 1, opcode, NULL);
2109 	if (status || !(f_info.flag & ICE_FLTR_TX_RX))
2110 		goto out;
2111 	if (set) {
2112 		u16 index = le16_to_cpu(s_rule->pdata.lkup_tx_rx.index);
2113 
2114 		if (f_info.flag & ICE_FLTR_TX) {
2115 			hw->port_info->dflt_tx_vsi_num = hw_vsi_id;
2116 			hw->port_info->dflt_tx_vsi_rule_id = index;
2117 		} else if (f_info.flag & ICE_FLTR_RX) {
2118 			hw->port_info->dflt_rx_vsi_num = hw_vsi_id;
2119 			hw->port_info->dflt_rx_vsi_rule_id = index;
2120 		}
2121 	} else {
2122 		if (f_info.flag & ICE_FLTR_TX) {
2123 			hw->port_info->dflt_tx_vsi_num = ICE_DFLT_VSI_INVAL;
2124 			hw->port_info->dflt_tx_vsi_rule_id = ICE_INVAL_ACT;
2125 		} else if (f_info.flag & ICE_FLTR_RX) {
2126 			hw->port_info->dflt_rx_vsi_num = ICE_DFLT_VSI_INVAL;
2127 			hw->port_info->dflt_rx_vsi_rule_id = ICE_INVAL_ACT;
2128 		}
2129 	}
2130 
2131 out:
2132 	devm_kfree(ice_hw_to_dev(hw), s_rule);
2133 	return status;
2134 }
2135 
2136 /**
2137  * ice_remove_mac - remove a MAC address based filter rule
2138  * @hw: pointer to the hardware structure
2139  * @m_list: list of MAC addresses and forwarding information
2140  *
2141  * This function removes either a MAC filter rule or a specific VSI from a
2142  * VSI list for a multicast MAC address.
2143  *
2144  * Returns ICE_ERR_DOES_NOT_EXIST if a given entry was not added by
2145  * ice_add_mac. Caller should be aware that this call will only work if all
2146  * the entries passed into m_list were added previously. It will not attempt to
2147  * do a partial remove of entries that were found.
2148  */
2149 enum ice_status
2150 ice_remove_mac(struct ice_hw *hw, struct list_head *m_list)
2151 {
2152 	struct ice_fltr_list_entry *list_itr, *tmp;
2153 
2154 	if (!m_list)
2155 		return ICE_ERR_PARAM;
2156 
2157 	list_for_each_entry_safe(list_itr, tmp, m_list, list_entry) {
2158 		enum ice_sw_lkup_type l_type = list_itr->fltr_info.lkup_type;
2159 
2160 		if (l_type != ICE_SW_LKUP_MAC)
2161 			return ICE_ERR_PARAM;
2162 		list_itr->status = ice_remove_rule_internal(hw,
2163 							    ICE_SW_LKUP_MAC,
2164 							    list_itr);
2165 		if (list_itr->status)
2166 			return list_itr->status;
2167 	}
2168 	return 0;
2169 }
2170 
2171 /**
2172  * ice_remove_vlan - Remove VLAN based filter rule
2173  * @hw: pointer to the hardware structure
2174  * @v_list: list of VLAN entries and forwarding information
2175  */
2176 enum ice_status
2177 ice_remove_vlan(struct ice_hw *hw, struct list_head *v_list)
2178 {
2179 	struct ice_fltr_list_entry *v_list_itr, *tmp;
2180 
2181 	if (!v_list || !hw)
2182 		return ICE_ERR_PARAM;
2183 
2184 	list_for_each_entry_safe(v_list_itr, tmp, v_list, list_entry) {
2185 		enum ice_sw_lkup_type l_type = v_list_itr->fltr_info.lkup_type;
2186 
2187 		if (l_type != ICE_SW_LKUP_VLAN)
2188 			return ICE_ERR_PARAM;
2189 		v_list_itr->status = ice_remove_rule_internal(hw,
2190 							      ICE_SW_LKUP_VLAN,
2191 							      v_list_itr);
2192 		if (v_list_itr->status)
2193 			return v_list_itr->status;
2194 	}
2195 	return 0;
2196 }
2197 
2198 /**
2199  * ice_vsi_uses_fltr - Determine if given VSI uses specified filter
2200  * @fm_entry: filter entry to inspect
2201  * @vsi_handle: VSI handle to compare with filter info
2202  */
2203 static bool
2204 ice_vsi_uses_fltr(struct ice_fltr_mgmt_list_entry *fm_entry, u16 vsi_handle)
2205 {
2206 	return ((fm_entry->fltr_info.fltr_act == ICE_FWD_TO_VSI &&
2207 		 fm_entry->fltr_info.vsi_handle == vsi_handle) ||
2208 		(fm_entry->fltr_info.fltr_act == ICE_FWD_TO_VSI_LIST &&
2209 		 (test_bit(vsi_handle, fm_entry->vsi_list_info->vsi_map))));
2210 }
2211 
2212 /**
2213  * ice_add_entry_to_vsi_fltr_list - Add copy of fltr_list_entry to remove list
2214  * @hw: pointer to the hardware structure
2215  * @vsi_handle: VSI handle to remove filters from
2216  * @vsi_list_head: pointer to the list to add entry to
2217  * @fi: pointer to fltr_info of filter entry to copy & add
2218  *
2219  * Helper function, used when creating a list of filters to remove from
2220  * a specific VSI. The entry added to vsi_list_head is a COPY of the
2221  * original filter entry, with the exception of fltr_info.fltr_act and
2222  * fltr_info.fwd_id fields. These are set such that later logic can
2223  * extract which VSI to remove the fltr from, and pass on that information.
2224  */
2225 static enum ice_status
2226 ice_add_entry_to_vsi_fltr_list(struct ice_hw *hw, u16 vsi_handle,
2227 			       struct list_head *vsi_list_head,
2228 			       struct ice_fltr_info *fi)
2229 {
2230 	struct ice_fltr_list_entry *tmp;
2231 
2232 	/* this memory is freed up in the caller function
2233 	 * once filters for this VSI are removed
2234 	 */
2235 	tmp = devm_kzalloc(ice_hw_to_dev(hw), sizeof(*tmp), GFP_KERNEL);
2236 	if (!tmp)
2237 		return ICE_ERR_NO_MEMORY;
2238 
2239 	tmp->fltr_info = *fi;
2240 
2241 	/* Overwrite these fields to indicate which VSI to remove filter from,
2242 	 * so find and remove logic can extract the information from the
2243 	 * list entries. Note that original entries will still have proper
2244 	 * values.
2245 	 */
2246 	tmp->fltr_info.fltr_act = ICE_FWD_TO_VSI;
2247 	tmp->fltr_info.vsi_handle = vsi_handle;
2248 	tmp->fltr_info.fwd_id.hw_vsi_id = ice_get_hw_vsi_num(hw, vsi_handle);
2249 
2250 	list_add(&tmp->list_entry, vsi_list_head);
2251 
2252 	return 0;
2253 }
2254 
2255 /**
2256  * ice_add_to_vsi_fltr_list - Add VSI filters to the list
2257  * @hw: pointer to the hardware structure
2258  * @vsi_handle: VSI handle to remove filters from
2259  * @lkup_list_head: pointer to the list that has certain lookup type filters
2260  * @vsi_list_head: pointer to the list pertaining to VSI with vsi_handle
2261  *
2262  * Locates all filters in lkup_list_head that are used by the given VSI,
2263  * and adds COPIES of those entries to vsi_list_head (intended to be used
2264  * to remove the listed filters).
2265  * Note that this means all entries in vsi_list_head must be explicitly
2266  * deallocated by the caller when done with list.
2267  */
2268 static enum ice_status
2269 ice_add_to_vsi_fltr_list(struct ice_hw *hw, u16 vsi_handle,
2270 			 struct list_head *lkup_list_head,
2271 			 struct list_head *vsi_list_head)
2272 {
2273 	struct ice_fltr_mgmt_list_entry *fm_entry;
2274 	enum ice_status status = 0;
2275 
2276 	/* check to make sure VSI ID is valid and within boundary */
2277 	if (!ice_is_vsi_valid(hw, vsi_handle))
2278 		return ICE_ERR_PARAM;
2279 
2280 	list_for_each_entry(fm_entry, lkup_list_head, list_entry) {
2281 		struct ice_fltr_info *fi;
2282 
2283 		fi = &fm_entry->fltr_info;
2284 		if (!fi || !ice_vsi_uses_fltr(fm_entry, vsi_handle))
2285 			continue;
2286 
2287 		status = ice_add_entry_to_vsi_fltr_list(hw, vsi_handle,
2288 							vsi_list_head, fi);
2289 		if (status)
2290 			return status;
2291 	}
2292 	return status;
2293 }
2294 
2295 /**
2296  * ice_determine_promisc_mask
2297  * @fi: filter info to parse
2298  *
2299  * Helper function to determine which ICE_PROMISC_ mask corresponds
2300  * to given filter into.
2301  */
2302 static u8 ice_determine_promisc_mask(struct ice_fltr_info *fi)
2303 {
2304 	u16 vid = fi->l_data.mac_vlan.vlan_id;
2305 	u8 *macaddr = fi->l_data.mac.mac_addr;
2306 	bool is_tx_fltr = false;
2307 	u8 promisc_mask = 0;
2308 
2309 	if (fi->flag == ICE_FLTR_TX)
2310 		is_tx_fltr = true;
2311 
2312 	if (is_broadcast_ether_addr(macaddr))
2313 		promisc_mask |= is_tx_fltr ?
2314 			ICE_PROMISC_BCAST_TX : ICE_PROMISC_BCAST_RX;
2315 	else if (is_multicast_ether_addr(macaddr))
2316 		promisc_mask |= is_tx_fltr ?
2317 			ICE_PROMISC_MCAST_TX : ICE_PROMISC_MCAST_RX;
2318 	else if (is_unicast_ether_addr(macaddr))
2319 		promisc_mask |= is_tx_fltr ?
2320 			ICE_PROMISC_UCAST_TX : ICE_PROMISC_UCAST_RX;
2321 	if (vid)
2322 		promisc_mask |= is_tx_fltr ?
2323 			ICE_PROMISC_VLAN_TX : ICE_PROMISC_VLAN_RX;
2324 
2325 	return promisc_mask;
2326 }
2327 
2328 /**
2329  * ice_remove_promisc - Remove promisc based filter rules
2330  * @hw: pointer to the hardware structure
2331  * @recp_id: recipe ID for which the rule needs to removed
2332  * @v_list: list of promisc entries
2333  */
2334 static enum ice_status
2335 ice_remove_promisc(struct ice_hw *hw, u8 recp_id,
2336 		   struct list_head *v_list)
2337 {
2338 	struct ice_fltr_list_entry *v_list_itr, *tmp;
2339 
2340 	list_for_each_entry_safe(v_list_itr, tmp, v_list, list_entry) {
2341 		v_list_itr->status =
2342 			ice_remove_rule_internal(hw, recp_id, v_list_itr);
2343 		if (v_list_itr->status)
2344 			return v_list_itr->status;
2345 	}
2346 	return 0;
2347 }
2348 
2349 /**
2350  * ice_clear_vsi_promisc - clear specified promiscuous mode(s) for given VSI
2351  * @hw: pointer to the hardware structure
2352  * @vsi_handle: VSI handle to clear mode
2353  * @promisc_mask: mask of promiscuous config bits to clear
2354  * @vid: VLAN ID to clear VLAN promiscuous
2355  */
2356 enum ice_status
2357 ice_clear_vsi_promisc(struct ice_hw *hw, u16 vsi_handle, u8 promisc_mask,
2358 		      u16 vid)
2359 {
2360 	struct ice_switch_info *sw = hw->switch_info;
2361 	struct ice_fltr_list_entry *fm_entry, *tmp;
2362 	struct list_head remove_list_head;
2363 	struct ice_fltr_mgmt_list_entry *itr;
2364 	struct list_head *rule_head;
2365 	struct mutex *rule_lock;	/* Lock to protect filter rule list */
2366 	enum ice_status status = 0;
2367 	u8 recipe_id;
2368 
2369 	if (!ice_is_vsi_valid(hw, vsi_handle))
2370 		return ICE_ERR_PARAM;
2371 
2372 	if (vid)
2373 		recipe_id = ICE_SW_LKUP_PROMISC_VLAN;
2374 	else
2375 		recipe_id = ICE_SW_LKUP_PROMISC;
2376 
2377 	rule_head = &sw->recp_list[recipe_id].filt_rules;
2378 	rule_lock = &sw->recp_list[recipe_id].filt_rule_lock;
2379 
2380 	INIT_LIST_HEAD(&remove_list_head);
2381 
2382 	mutex_lock(rule_lock);
2383 	list_for_each_entry(itr, rule_head, list_entry) {
2384 		u8 fltr_promisc_mask = 0;
2385 
2386 		if (!ice_vsi_uses_fltr(itr, vsi_handle))
2387 			continue;
2388 
2389 		fltr_promisc_mask |=
2390 			ice_determine_promisc_mask(&itr->fltr_info);
2391 
2392 		/* Skip if filter is not completely specified by given mask */
2393 		if (fltr_promisc_mask & ~promisc_mask)
2394 			continue;
2395 
2396 		status = ice_add_entry_to_vsi_fltr_list(hw, vsi_handle,
2397 							&remove_list_head,
2398 							&itr->fltr_info);
2399 		if (status) {
2400 			mutex_unlock(rule_lock);
2401 			goto free_fltr_list;
2402 		}
2403 	}
2404 	mutex_unlock(rule_lock);
2405 
2406 	status = ice_remove_promisc(hw, recipe_id, &remove_list_head);
2407 
2408 free_fltr_list:
2409 	list_for_each_entry_safe(fm_entry, tmp, &remove_list_head, list_entry) {
2410 		list_del(&fm_entry->list_entry);
2411 		devm_kfree(ice_hw_to_dev(hw), fm_entry);
2412 	}
2413 
2414 	return status;
2415 }
2416 
2417 /**
2418  * ice_set_vsi_promisc - set given VSI to given promiscuous mode(s)
2419  * @hw: pointer to the hardware structure
2420  * @vsi_handle: VSI handle to configure
2421  * @promisc_mask: mask of promiscuous config bits
2422  * @vid: VLAN ID to set VLAN promiscuous
2423  */
2424 enum ice_status
2425 ice_set_vsi_promisc(struct ice_hw *hw, u16 vsi_handle, u8 promisc_mask, u16 vid)
2426 {
2427 	enum { UCAST_FLTR = 1, MCAST_FLTR, BCAST_FLTR };
2428 	struct ice_fltr_list_entry f_list_entry;
2429 	struct ice_fltr_info new_fltr;
2430 	enum ice_status status = 0;
2431 	bool is_tx_fltr;
2432 	u16 hw_vsi_id;
2433 	int pkt_type;
2434 	u8 recipe_id;
2435 
2436 	if (!ice_is_vsi_valid(hw, vsi_handle))
2437 		return ICE_ERR_PARAM;
2438 	hw_vsi_id = ice_get_hw_vsi_num(hw, vsi_handle);
2439 
2440 	memset(&new_fltr, 0, sizeof(new_fltr));
2441 
2442 	if (promisc_mask & (ICE_PROMISC_VLAN_RX | ICE_PROMISC_VLAN_TX)) {
2443 		new_fltr.lkup_type = ICE_SW_LKUP_PROMISC_VLAN;
2444 		new_fltr.l_data.mac_vlan.vlan_id = vid;
2445 		recipe_id = ICE_SW_LKUP_PROMISC_VLAN;
2446 	} else {
2447 		new_fltr.lkup_type = ICE_SW_LKUP_PROMISC;
2448 		recipe_id = ICE_SW_LKUP_PROMISC;
2449 	}
2450 
2451 	/* Separate filters must be set for each direction/packet type
2452 	 * combination, so we will loop over the mask value, store the
2453 	 * individual type, and clear it out in the input mask as it
2454 	 * is found.
2455 	 */
2456 	while (promisc_mask) {
2457 		u8 *mac_addr;
2458 
2459 		pkt_type = 0;
2460 		is_tx_fltr = false;
2461 
2462 		if (promisc_mask & ICE_PROMISC_UCAST_RX) {
2463 			promisc_mask &= ~ICE_PROMISC_UCAST_RX;
2464 			pkt_type = UCAST_FLTR;
2465 		} else if (promisc_mask & ICE_PROMISC_UCAST_TX) {
2466 			promisc_mask &= ~ICE_PROMISC_UCAST_TX;
2467 			pkt_type = UCAST_FLTR;
2468 			is_tx_fltr = true;
2469 		} else if (promisc_mask & ICE_PROMISC_MCAST_RX) {
2470 			promisc_mask &= ~ICE_PROMISC_MCAST_RX;
2471 			pkt_type = MCAST_FLTR;
2472 		} else if (promisc_mask & ICE_PROMISC_MCAST_TX) {
2473 			promisc_mask &= ~ICE_PROMISC_MCAST_TX;
2474 			pkt_type = MCAST_FLTR;
2475 			is_tx_fltr = true;
2476 		} else if (promisc_mask & ICE_PROMISC_BCAST_RX) {
2477 			promisc_mask &= ~ICE_PROMISC_BCAST_RX;
2478 			pkt_type = BCAST_FLTR;
2479 		} else if (promisc_mask & ICE_PROMISC_BCAST_TX) {
2480 			promisc_mask &= ~ICE_PROMISC_BCAST_TX;
2481 			pkt_type = BCAST_FLTR;
2482 			is_tx_fltr = true;
2483 		}
2484 
2485 		/* Check for VLAN promiscuous flag */
2486 		if (promisc_mask & ICE_PROMISC_VLAN_RX) {
2487 			promisc_mask &= ~ICE_PROMISC_VLAN_RX;
2488 		} else if (promisc_mask & ICE_PROMISC_VLAN_TX) {
2489 			promisc_mask &= ~ICE_PROMISC_VLAN_TX;
2490 			is_tx_fltr = true;
2491 		}
2492 
2493 		/* Set filter DA based on packet type */
2494 		mac_addr = new_fltr.l_data.mac.mac_addr;
2495 		if (pkt_type == BCAST_FLTR) {
2496 			eth_broadcast_addr(mac_addr);
2497 		} else if (pkt_type == MCAST_FLTR ||
2498 			   pkt_type == UCAST_FLTR) {
2499 			/* Use the dummy ether header DA */
2500 			ether_addr_copy(mac_addr, dummy_eth_header);
2501 			if (pkt_type == MCAST_FLTR)
2502 				mac_addr[0] |= 0x1;	/* Set multicast bit */
2503 		}
2504 
2505 		/* Need to reset this to zero for all iterations */
2506 		new_fltr.flag = 0;
2507 		if (is_tx_fltr) {
2508 			new_fltr.flag |= ICE_FLTR_TX;
2509 			new_fltr.src = hw_vsi_id;
2510 		} else {
2511 			new_fltr.flag |= ICE_FLTR_RX;
2512 			new_fltr.src = hw->port_info->lport;
2513 		}
2514 
2515 		new_fltr.fltr_act = ICE_FWD_TO_VSI;
2516 		new_fltr.vsi_handle = vsi_handle;
2517 		new_fltr.fwd_id.hw_vsi_id = hw_vsi_id;
2518 		f_list_entry.fltr_info = new_fltr;
2519 
2520 		status = ice_add_rule_internal(hw, recipe_id, &f_list_entry);
2521 		if (status)
2522 			goto set_promisc_exit;
2523 	}
2524 
2525 set_promisc_exit:
2526 	return status;
2527 }
2528 
2529 /**
2530  * ice_set_vlan_vsi_promisc
2531  * @hw: pointer to the hardware structure
2532  * @vsi_handle: VSI handle to configure
2533  * @promisc_mask: mask of promiscuous config bits
2534  * @rm_vlan_promisc: Clear VLANs VSI promisc mode
2535  *
2536  * Configure VSI with all associated VLANs to given promiscuous mode(s)
2537  */
2538 enum ice_status
2539 ice_set_vlan_vsi_promisc(struct ice_hw *hw, u16 vsi_handle, u8 promisc_mask,
2540 			 bool rm_vlan_promisc)
2541 {
2542 	struct ice_switch_info *sw = hw->switch_info;
2543 	struct ice_fltr_list_entry *list_itr, *tmp;
2544 	struct list_head vsi_list_head;
2545 	struct list_head *vlan_head;
2546 	struct mutex *vlan_lock; /* Lock to protect filter rule list */
2547 	enum ice_status status;
2548 	u16 vlan_id;
2549 
2550 	INIT_LIST_HEAD(&vsi_list_head);
2551 	vlan_lock = &sw->recp_list[ICE_SW_LKUP_VLAN].filt_rule_lock;
2552 	vlan_head = &sw->recp_list[ICE_SW_LKUP_VLAN].filt_rules;
2553 	mutex_lock(vlan_lock);
2554 	status = ice_add_to_vsi_fltr_list(hw, vsi_handle, vlan_head,
2555 					  &vsi_list_head);
2556 	mutex_unlock(vlan_lock);
2557 	if (status)
2558 		goto free_fltr_list;
2559 
2560 	list_for_each_entry(list_itr, &vsi_list_head, list_entry) {
2561 		vlan_id = list_itr->fltr_info.l_data.vlan.vlan_id;
2562 		if (rm_vlan_promisc)
2563 			status = ice_clear_vsi_promisc(hw, vsi_handle,
2564 						       promisc_mask, vlan_id);
2565 		else
2566 			status = ice_set_vsi_promisc(hw, vsi_handle,
2567 						     promisc_mask, vlan_id);
2568 		if (status)
2569 			break;
2570 	}
2571 
2572 free_fltr_list:
2573 	list_for_each_entry_safe(list_itr, tmp, &vsi_list_head, list_entry) {
2574 		list_del(&list_itr->list_entry);
2575 		devm_kfree(ice_hw_to_dev(hw), list_itr);
2576 	}
2577 	return status;
2578 }
2579 
2580 /**
2581  * ice_remove_vsi_lkup_fltr - Remove lookup type filters for a VSI
2582  * @hw: pointer to the hardware structure
2583  * @vsi_handle: VSI handle to remove filters from
2584  * @lkup: switch rule filter lookup type
2585  */
2586 static void
2587 ice_remove_vsi_lkup_fltr(struct ice_hw *hw, u16 vsi_handle,
2588 			 enum ice_sw_lkup_type lkup)
2589 {
2590 	struct ice_switch_info *sw = hw->switch_info;
2591 	struct ice_fltr_list_entry *fm_entry;
2592 	struct list_head remove_list_head;
2593 	struct list_head *rule_head;
2594 	struct ice_fltr_list_entry *tmp;
2595 	struct mutex *rule_lock;	/* Lock to protect filter rule list */
2596 	enum ice_status status;
2597 
2598 	INIT_LIST_HEAD(&remove_list_head);
2599 	rule_lock = &sw->recp_list[lkup].filt_rule_lock;
2600 	rule_head = &sw->recp_list[lkup].filt_rules;
2601 	mutex_lock(rule_lock);
2602 	status = ice_add_to_vsi_fltr_list(hw, vsi_handle, rule_head,
2603 					  &remove_list_head);
2604 	mutex_unlock(rule_lock);
2605 	if (status)
2606 		return;
2607 
2608 	switch (lkup) {
2609 	case ICE_SW_LKUP_MAC:
2610 		ice_remove_mac(hw, &remove_list_head);
2611 		break;
2612 	case ICE_SW_LKUP_VLAN:
2613 		ice_remove_vlan(hw, &remove_list_head);
2614 		break;
2615 	case ICE_SW_LKUP_PROMISC:
2616 	case ICE_SW_LKUP_PROMISC_VLAN:
2617 		ice_remove_promisc(hw, lkup, &remove_list_head);
2618 		break;
2619 	case ICE_SW_LKUP_MAC_VLAN:
2620 	case ICE_SW_LKUP_ETHERTYPE:
2621 	case ICE_SW_LKUP_ETHERTYPE_MAC:
2622 	case ICE_SW_LKUP_DFLT:
2623 	case ICE_SW_LKUP_LAST:
2624 	default:
2625 		ice_debug(hw, ICE_DBG_SW, "Unsupported lookup type %d\n", lkup);
2626 		break;
2627 	}
2628 
2629 	list_for_each_entry_safe(fm_entry, tmp, &remove_list_head, list_entry) {
2630 		list_del(&fm_entry->list_entry);
2631 		devm_kfree(ice_hw_to_dev(hw), fm_entry);
2632 	}
2633 }
2634 
2635 /**
2636  * ice_remove_vsi_fltr - Remove all filters for a VSI
2637  * @hw: pointer to the hardware structure
2638  * @vsi_handle: VSI handle to remove filters from
2639  */
2640 void ice_remove_vsi_fltr(struct ice_hw *hw, u16 vsi_handle)
2641 {
2642 	ice_remove_vsi_lkup_fltr(hw, vsi_handle, ICE_SW_LKUP_MAC);
2643 	ice_remove_vsi_lkup_fltr(hw, vsi_handle, ICE_SW_LKUP_MAC_VLAN);
2644 	ice_remove_vsi_lkup_fltr(hw, vsi_handle, ICE_SW_LKUP_PROMISC);
2645 	ice_remove_vsi_lkup_fltr(hw, vsi_handle, ICE_SW_LKUP_VLAN);
2646 	ice_remove_vsi_lkup_fltr(hw, vsi_handle, ICE_SW_LKUP_DFLT);
2647 	ice_remove_vsi_lkup_fltr(hw, vsi_handle, ICE_SW_LKUP_ETHERTYPE);
2648 	ice_remove_vsi_lkup_fltr(hw, vsi_handle, ICE_SW_LKUP_ETHERTYPE_MAC);
2649 	ice_remove_vsi_lkup_fltr(hw, vsi_handle, ICE_SW_LKUP_PROMISC_VLAN);
2650 }
2651 
2652 /**
2653  * ice_replay_vsi_fltr - Replay filters for requested VSI
2654  * @hw: pointer to the hardware structure
2655  * @vsi_handle: driver VSI handle
2656  * @recp_id: Recipe ID for which rules need to be replayed
2657  * @list_head: list for which filters need to be replayed
2658  *
2659  * Replays the filter of recipe recp_id for a VSI represented via vsi_handle.
2660  * It is required to pass valid VSI handle.
2661  */
2662 static enum ice_status
2663 ice_replay_vsi_fltr(struct ice_hw *hw, u16 vsi_handle, u8 recp_id,
2664 		    struct list_head *list_head)
2665 {
2666 	struct ice_fltr_mgmt_list_entry *itr;
2667 	enum ice_status status = 0;
2668 	u16 hw_vsi_id;
2669 
2670 	if (list_empty(list_head))
2671 		return status;
2672 	hw_vsi_id = ice_get_hw_vsi_num(hw, vsi_handle);
2673 
2674 	list_for_each_entry(itr, list_head, list_entry) {
2675 		struct ice_fltr_list_entry f_entry;
2676 
2677 		f_entry.fltr_info = itr->fltr_info;
2678 		if (itr->vsi_count < 2 && recp_id != ICE_SW_LKUP_VLAN &&
2679 		    itr->fltr_info.vsi_handle == vsi_handle) {
2680 			/* update the src in case it is VSI num */
2681 			if (f_entry.fltr_info.src_id == ICE_SRC_ID_VSI)
2682 				f_entry.fltr_info.src = hw_vsi_id;
2683 			status = ice_add_rule_internal(hw, recp_id, &f_entry);
2684 			if (status)
2685 				goto end;
2686 			continue;
2687 		}
2688 		if (!itr->vsi_list_info ||
2689 		    !test_bit(vsi_handle, itr->vsi_list_info->vsi_map))
2690 			continue;
2691 		/* Clearing it so that the logic can add it back */
2692 		clear_bit(vsi_handle, itr->vsi_list_info->vsi_map);
2693 		f_entry.fltr_info.vsi_handle = vsi_handle;
2694 		f_entry.fltr_info.fltr_act = ICE_FWD_TO_VSI;
2695 		/* update the src in case it is VSI num */
2696 		if (f_entry.fltr_info.src_id == ICE_SRC_ID_VSI)
2697 			f_entry.fltr_info.src = hw_vsi_id;
2698 		if (recp_id == ICE_SW_LKUP_VLAN)
2699 			status = ice_add_vlan_internal(hw, &f_entry);
2700 		else
2701 			status = ice_add_rule_internal(hw, recp_id, &f_entry);
2702 		if (status)
2703 			goto end;
2704 	}
2705 end:
2706 	return status;
2707 }
2708 
2709 /**
2710  * ice_replay_vsi_all_fltr - replay all filters stored in bookkeeping lists
2711  * @hw: pointer to the hardware structure
2712  * @vsi_handle: driver VSI handle
2713  *
2714  * Replays filters for requested VSI via vsi_handle.
2715  */
2716 enum ice_status ice_replay_vsi_all_fltr(struct ice_hw *hw, u16 vsi_handle)
2717 {
2718 	struct ice_switch_info *sw = hw->switch_info;
2719 	enum ice_status status = 0;
2720 	u8 i;
2721 
2722 	for (i = 0; i < ICE_SW_LKUP_LAST; i++) {
2723 		struct list_head *head;
2724 
2725 		head = &sw->recp_list[i].filt_replay_rules;
2726 		status = ice_replay_vsi_fltr(hw, vsi_handle, i, head);
2727 		if (status)
2728 			return status;
2729 	}
2730 	return status;
2731 }
2732 
2733 /**
2734  * ice_rm_all_sw_replay_rule_info - deletes filter replay rules
2735  * @hw: pointer to the HW struct
2736  *
2737  * Deletes the filter replay rules.
2738  */
2739 void ice_rm_all_sw_replay_rule_info(struct ice_hw *hw)
2740 {
2741 	struct ice_switch_info *sw = hw->switch_info;
2742 	u8 i;
2743 
2744 	if (!sw)
2745 		return;
2746 
2747 	for (i = 0; i < ICE_SW_LKUP_LAST; i++) {
2748 		if (!list_empty(&sw->recp_list[i].filt_replay_rules)) {
2749 			struct list_head *l_head;
2750 
2751 			l_head = &sw->recp_list[i].filt_replay_rules;
2752 			ice_rem_sw_rule_info(hw, l_head);
2753 		}
2754 	}
2755 }
2756