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