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