xref: /linux/drivers/net/ethernet/intel/ice/virt/virtchnl.c (revision 5de6c855e23e99d76c143ee2a29766e7f7f9fe65)
1*5de6c855SPrzemek Kitszel // SPDX-License-Identifier: GPL-2.0
2*5de6c855SPrzemek Kitszel /* Copyright (C) 2022, Intel Corporation. */
3*5de6c855SPrzemek Kitszel 
4*5de6c855SPrzemek Kitszel #include "virtchnl.h"
5*5de6c855SPrzemek Kitszel #include "ice_vf_lib_private.h"
6*5de6c855SPrzemek Kitszel #include "ice.h"
7*5de6c855SPrzemek Kitszel #include "ice_base.h"
8*5de6c855SPrzemek Kitszel #include "ice_lib.h"
9*5de6c855SPrzemek Kitszel #include "ice_fltr.h"
10*5de6c855SPrzemek Kitszel #include "allowlist.h"
11*5de6c855SPrzemek Kitszel #include "ice_vf_vsi_vlan_ops.h"
12*5de6c855SPrzemek Kitszel #include "ice_vlan.h"
13*5de6c855SPrzemek Kitszel #include "ice_flex_pipe.h"
14*5de6c855SPrzemek Kitszel #include "ice_dcb_lib.h"
15*5de6c855SPrzemek Kitszel 
16*5de6c855SPrzemek Kitszel #define FIELD_SELECTOR(proto_hdr_field) \
17*5de6c855SPrzemek Kitszel 		BIT((proto_hdr_field) & PROTO_HDR_FIELD_MASK)
18*5de6c855SPrzemek Kitszel 
19*5de6c855SPrzemek Kitszel struct ice_vc_hdr_match_type {
20*5de6c855SPrzemek Kitszel 	u32 vc_hdr;	/* virtchnl headers (VIRTCHNL_PROTO_HDR_XXX) */
21*5de6c855SPrzemek Kitszel 	u32 ice_hdr;	/* ice headers (ICE_FLOW_SEG_HDR_XXX) */
22*5de6c855SPrzemek Kitszel };
23*5de6c855SPrzemek Kitszel 
24*5de6c855SPrzemek Kitszel static const struct ice_vc_hdr_match_type ice_vc_hdr_list[] = {
25*5de6c855SPrzemek Kitszel 	{VIRTCHNL_PROTO_HDR_NONE,	ICE_FLOW_SEG_HDR_NONE},
26*5de6c855SPrzemek Kitszel 	{VIRTCHNL_PROTO_HDR_ETH,	ICE_FLOW_SEG_HDR_ETH},
27*5de6c855SPrzemek Kitszel 	{VIRTCHNL_PROTO_HDR_S_VLAN,	ICE_FLOW_SEG_HDR_VLAN},
28*5de6c855SPrzemek Kitszel 	{VIRTCHNL_PROTO_HDR_C_VLAN,	ICE_FLOW_SEG_HDR_VLAN},
29*5de6c855SPrzemek Kitszel 	{VIRTCHNL_PROTO_HDR_IPV4,	ICE_FLOW_SEG_HDR_IPV4 |
30*5de6c855SPrzemek Kitszel 					ICE_FLOW_SEG_HDR_IPV_OTHER},
31*5de6c855SPrzemek Kitszel 	{VIRTCHNL_PROTO_HDR_IPV6,	ICE_FLOW_SEG_HDR_IPV6 |
32*5de6c855SPrzemek Kitszel 					ICE_FLOW_SEG_HDR_IPV_OTHER},
33*5de6c855SPrzemek Kitszel 	{VIRTCHNL_PROTO_HDR_TCP,	ICE_FLOW_SEG_HDR_TCP},
34*5de6c855SPrzemek Kitszel 	{VIRTCHNL_PROTO_HDR_UDP,	ICE_FLOW_SEG_HDR_UDP},
35*5de6c855SPrzemek Kitszel 	{VIRTCHNL_PROTO_HDR_SCTP,	ICE_FLOW_SEG_HDR_SCTP},
36*5de6c855SPrzemek Kitszel 	{VIRTCHNL_PROTO_HDR_PPPOE,	ICE_FLOW_SEG_HDR_PPPOE},
37*5de6c855SPrzemek Kitszel 	{VIRTCHNL_PROTO_HDR_GTPU_IP,	ICE_FLOW_SEG_HDR_GTPU_IP},
38*5de6c855SPrzemek Kitszel 	{VIRTCHNL_PROTO_HDR_GTPU_EH,	ICE_FLOW_SEG_HDR_GTPU_EH},
39*5de6c855SPrzemek Kitszel 	{VIRTCHNL_PROTO_HDR_GTPU_EH_PDU_DWN,
40*5de6c855SPrzemek Kitszel 					ICE_FLOW_SEG_HDR_GTPU_DWN},
41*5de6c855SPrzemek Kitszel 	{VIRTCHNL_PROTO_HDR_GTPU_EH_PDU_UP,
42*5de6c855SPrzemek Kitszel 					ICE_FLOW_SEG_HDR_GTPU_UP},
43*5de6c855SPrzemek Kitszel 	{VIRTCHNL_PROTO_HDR_L2TPV3,	ICE_FLOW_SEG_HDR_L2TPV3},
44*5de6c855SPrzemek Kitszel 	{VIRTCHNL_PROTO_HDR_ESP,	ICE_FLOW_SEG_HDR_ESP},
45*5de6c855SPrzemek Kitszel 	{VIRTCHNL_PROTO_HDR_AH,		ICE_FLOW_SEG_HDR_AH},
46*5de6c855SPrzemek Kitszel 	{VIRTCHNL_PROTO_HDR_PFCP,	ICE_FLOW_SEG_HDR_PFCP_SESSION},
47*5de6c855SPrzemek Kitszel };
48*5de6c855SPrzemek Kitszel 
49*5de6c855SPrzemek Kitszel struct ice_vc_hash_field_match_type {
50*5de6c855SPrzemek Kitszel 	u32 vc_hdr;		/* virtchnl headers
51*5de6c855SPrzemek Kitszel 				 * (VIRTCHNL_PROTO_HDR_XXX)
52*5de6c855SPrzemek Kitszel 				 */
53*5de6c855SPrzemek Kitszel 	u32 vc_hash_field;	/* virtchnl hash fields selector
54*5de6c855SPrzemek Kitszel 				 * FIELD_SELECTOR((VIRTCHNL_PROTO_HDR_ETH_XXX))
55*5de6c855SPrzemek Kitszel 				 */
56*5de6c855SPrzemek Kitszel 	u64 ice_hash_field;	/* ice hash fields
57*5de6c855SPrzemek Kitszel 				 * (BIT_ULL(ICE_FLOW_FIELD_IDX_XXX))
58*5de6c855SPrzemek Kitszel 				 */
59*5de6c855SPrzemek Kitszel };
60*5de6c855SPrzemek Kitszel 
61*5de6c855SPrzemek Kitszel static const struct
62*5de6c855SPrzemek Kitszel ice_vc_hash_field_match_type ice_vc_hash_field_list[] = {
63*5de6c855SPrzemek Kitszel 	{VIRTCHNL_PROTO_HDR_ETH, FIELD_SELECTOR(VIRTCHNL_PROTO_HDR_ETH_SRC),
64*5de6c855SPrzemek Kitszel 		BIT_ULL(ICE_FLOW_FIELD_IDX_ETH_SA)},
65*5de6c855SPrzemek Kitszel 	{VIRTCHNL_PROTO_HDR_ETH, FIELD_SELECTOR(VIRTCHNL_PROTO_HDR_ETH_DST),
66*5de6c855SPrzemek Kitszel 		BIT_ULL(ICE_FLOW_FIELD_IDX_ETH_DA)},
67*5de6c855SPrzemek Kitszel 	{VIRTCHNL_PROTO_HDR_ETH, FIELD_SELECTOR(VIRTCHNL_PROTO_HDR_ETH_SRC) |
68*5de6c855SPrzemek Kitszel 		FIELD_SELECTOR(VIRTCHNL_PROTO_HDR_ETH_DST),
69*5de6c855SPrzemek Kitszel 		ICE_FLOW_HASH_ETH},
70*5de6c855SPrzemek Kitszel 	{VIRTCHNL_PROTO_HDR_ETH,
71*5de6c855SPrzemek Kitszel 		FIELD_SELECTOR(VIRTCHNL_PROTO_HDR_ETH_ETHERTYPE),
72*5de6c855SPrzemek Kitszel 		BIT_ULL(ICE_FLOW_FIELD_IDX_ETH_TYPE)},
73*5de6c855SPrzemek Kitszel 	{VIRTCHNL_PROTO_HDR_S_VLAN,
74*5de6c855SPrzemek Kitszel 		FIELD_SELECTOR(VIRTCHNL_PROTO_HDR_S_VLAN_ID),
75*5de6c855SPrzemek Kitszel 		BIT_ULL(ICE_FLOW_FIELD_IDX_S_VLAN)},
76*5de6c855SPrzemek Kitszel 	{VIRTCHNL_PROTO_HDR_C_VLAN,
77*5de6c855SPrzemek Kitszel 		FIELD_SELECTOR(VIRTCHNL_PROTO_HDR_C_VLAN_ID),
78*5de6c855SPrzemek Kitszel 		BIT_ULL(ICE_FLOW_FIELD_IDX_C_VLAN)},
79*5de6c855SPrzemek Kitszel 	{VIRTCHNL_PROTO_HDR_IPV4, FIELD_SELECTOR(VIRTCHNL_PROTO_HDR_IPV4_SRC),
80*5de6c855SPrzemek Kitszel 		BIT_ULL(ICE_FLOW_FIELD_IDX_IPV4_SA)},
81*5de6c855SPrzemek Kitszel 	{VIRTCHNL_PROTO_HDR_IPV4, FIELD_SELECTOR(VIRTCHNL_PROTO_HDR_IPV4_DST),
82*5de6c855SPrzemek Kitszel 		BIT_ULL(ICE_FLOW_FIELD_IDX_IPV4_DA)},
83*5de6c855SPrzemek Kitszel 	{VIRTCHNL_PROTO_HDR_IPV4, FIELD_SELECTOR(VIRTCHNL_PROTO_HDR_IPV4_SRC) |
84*5de6c855SPrzemek Kitszel 		FIELD_SELECTOR(VIRTCHNL_PROTO_HDR_IPV4_DST),
85*5de6c855SPrzemek Kitszel 		ICE_FLOW_HASH_IPV4},
86*5de6c855SPrzemek Kitszel 	{VIRTCHNL_PROTO_HDR_IPV4, FIELD_SELECTOR(VIRTCHNL_PROTO_HDR_IPV4_SRC) |
87*5de6c855SPrzemek Kitszel 		FIELD_SELECTOR(VIRTCHNL_PROTO_HDR_IPV4_PROT),
88*5de6c855SPrzemek Kitszel 		BIT_ULL(ICE_FLOW_FIELD_IDX_IPV4_SA) |
89*5de6c855SPrzemek Kitszel 		BIT_ULL(ICE_FLOW_FIELD_IDX_IPV4_PROT)},
90*5de6c855SPrzemek Kitszel 	{VIRTCHNL_PROTO_HDR_IPV4, FIELD_SELECTOR(VIRTCHNL_PROTO_HDR_IPV4_DST) |
91*5de6c855SPrzemek Kitszel 		FIELD_SELECTOR(VIRTCHNL_PROTO_HDR_IPV4_PROT),
92*5de6c855SPrzemek Kitszel 		BIT_ULL(ICE_FLOW_FIELD_IDX_IPV4_DA) |
93*5de6c855SPrzemek Kitszel 		BIT_ULL(ICE_FLOW_FIELD_IDX_IPV4_PROT)},
94*5de6c855SPrzemek Kitszel 	{VIRTCHNL_PROTO_HDR_IPV4, FIELD_SELECTOR(VIRTCHNL_PROTO_HDR_IPV4_SRC) |
95*5de6c855SPrzemek Kitszel 		FIELD_SELECTOR(VIRTCHNL_PROTO_HDR_IPV4_DST) |
96*5de6c855SPrzemek Kitszel 		FIELD_SELECTOR(VIRTCHNL_PROTO_HDR_IPV4_PROT),
97*5de6c855SPrzemek Kitszel 		ICE_FLOW_HASH_IPV4 | BIT_ULL(ICE_FLOW_FIELD_IDX_IPV4_PROT)},
98*5de6c855SPrzemek Kitszel 	{VIRTCHNL_PROTO_HDR_IPV4, FIELD_SELECTOR(VIRTCHNL_PROTO_HDR_IPV4_PROT),
99*5de6c855SPrzemek Kitszel 		BIT_ULL(ICE_FLOW_FIELD_IDX_IPV4_PROT)},
100*5de6c855SPrzemek Kitszel 	{VIRTCHNL_PROTO_HDR_IPV6, FIELD_SELECTOR(VIRTCHNL_PROTO_HDR_IPV6_SRC),
101*5de6c855SPrzemek Kitszel 		BIT_ULL(ICE_FLOW_FIELD_IDX_IPV6_SA)},
102*5de6c855SPrzemek Kitszel 	{VIRTCHNL_PROTO_HDR_IPV6, FIELD_SELECTOR(VIRTCHNL_PROTO_HDR_IPV6_DST),
103*5de6c855SPrzemek Kitszel 		BIT_ULL(ICE_FLOW_FIELD_IDX_IPV6_DA)},
104*5de6c855SPrzemek Kitszel 	{VIRTCHNL_PROTO_HDR_IPV6, FIELD_SELECTOR(VIRTCHNL_PROTO_HDR_IPV6_SRC) |
105*5de6c855SPrzemek Kitszel 		FIELD_SELECTOR(VIRTCHNL_PROTO_HDR_IPV6_DST),
106*5de6c855SPrzemek Kitszel 		ICE_FLOW_HASH_IPV6},
107*5de6c855SPrzemek Kitszel 	{VIRTCHNL_PROTO_HDR_IPV6, FIELD_SELECTOR(VIRTCHNL_PROTO_HDR_IPV6_SRC) |
108*5de6c855SPrzemek Kitszel 		FIELD_SELECTOR(VIRTCHNL_PROTO_HDR_IPV6_PROT),
109*5de6c855SPrzemek Kitszel 		BIT_ULL(ICE_FLOW_FIELD_IDX_IPV6_SA) |
110*5de6c855SPrzemek Kitszel 		BIT_ULL(ICE_FLOW_FIELD_IDX_IPV6_PROT)},
111*5de6c855SPrzemek Kitszel 	{VIRTCHNL_PROTO_HDR_IPV6, FIELD_SELECTOR(VIRTCHNL_PROTO_HDR_IPV6_DST) |
112*5de6c855SPrzemek Kitszel 		FIELD_SELECTOR(VIRTCHNL_PROTO_HDR_IPV6_PROT),
113*5de6c855SPrzemek Kitszel 		BIT_ULL(ICE_FLOW_FIELD_IDX_IPV6_DA) |
114*5de6c855SPrzemek Kitszel 		BIT_ULL(ICE_FLOW_FIELD_IDX_IPV6_PROT)},
115*5de6c855SPrzemek Kitszel 	{VIRTCHNL_PROTO_HDR_IPV6, FIELD_SELECTOR(VIRTCHNL_PROTO_HDR_IPV6_SRC) |
116*5de6c855SPrzemek Kitszel 		FIELD_SELECTOR(VIRTCHNL_PROTO_HDR_IPV6_DST) |
117*5de6c855SPrzemek Kitszel 		FIELD_SELECTOR(VIRTCHNL_PROTO_HDR_IPV6_PROT),
118*5de6c855SPrzemek Kitszel 		ICE_FLOW_HASH_IPV6 | BIT_ULL(ICE_FLOW_FIELD_IDX_IPV6_PROT)},
119*5de6c855SPrzemek Kitszel 	{VIRTCHNL_PROTO_HDR_IPV6, FIELD_SELECTOR(VIRTCHNL_PROTO_HDR_IPV6_PROT),
120*5de6c855SPrzemek Kitszel 		BIT_ULL(ICE_FLOW_FIELD_IDX_IPV6_PROT)},
121*5de6c855SPrzemek Kitszel 	{VIRTCHNL_PROTO_HDR_TCP,
122*5de6c855SPrzemek Kitszel 		FIELD_SELECTOR(VIRTCHNL_PROTO_HDR_TCP_SRC_PORT),
123*5de6c855SPrzemek Kitszel 		BIT_ULL(ICE_FLOW_FIELD_IDX_TCP_SRC_PORT)},
124*5de6c855SPrzemek Kitszel 	{VIRTCHNL_PROTO_HDR_TCP,
125*5de6c855SPrzemek Kitszel 		FIELD_SELECTOR(VIRTCHNL_PROTO_HDR_TCP_DST_PORT),
126*5de6c855SPrzemek Kitszel 		BIT_ULL(ICE_FLOW_FIELD_IDX_TCP_DST_PORT)},
127*5de6c855SPrzemek Kitszel 	{VIRTCHNL_PROTO_HDR_TCP,
128*5de6c855SPrzemek Kitszel 		FIELD_SELECTOR(VIRTCHNL_PROTO_HDR_TCP_SRC_PORT) |
129*5de6c855SPrzemek Kitszel 		FIELD_SELECTOR(VIRTCHNL_PROTO_HDR_TCP_DST_PORT),
130*5de6c855SPrzemek Kitszel 		ICE_FLOW_HASH_TCP_PORT},
131*5de6c855SPrzemek Kitszel 	{VIRTCHNL_PROTO_HDR_UDP,
132*5de6c855SPrzemek Kitszel 		FIELD_SELECTOR(VIRTCHNL_PROTO_HDR_UDP_SRC_PORT),
133*5de6c855SPrzemek Kitszel 		BIT_ULL(ICE_FLOW_FIELD_IDX_UDP_SRC_PORT)},
134*5de6c855SPrzemek Kitszel 	{VIRTCHNL_PROTO_HDR_UDP,
135*5de6c855SPrzemek Kitszel 		FIELD_SELECTOR(VIRTCHNL_PROTO_HDR_UDP_DST_PORT),
136*5de6c855SPrzemek Kitszel 		BIT_ULL(ICE_FLOW_FIELD_IDX_UDP_DST_PORT)},
137*5de6c855SPrzemek Kitszel 	{VIRTCHNL_PROTO_HDR_UDP,
138*5de6c855SPrzemek Kitszel 		FIELD_SELECTOR(VIRTCHNL_PROTO_HDR_UDP_SRC_PORT) |
139*5de6c855SPrzemek Kitszel 		FIELD_SELECTOR(VIRTCHNL_PROTO_HDR_UDP_DST_PORT),
140*5de6c855SPrzemek Kitszel 		ICE_FLOW_HASH_UDP_PORT},
141*5de6c855SPrzemek Kitszel 	{VIRTCHNL_PROTO_HDR_SCTP,
142*5de6c855SPrzemek Kitszel 		FIELD_SELECTOR(VIRTCHNL_PROTO_HDR_SCTP_SRC_PORT),
143*5de6c855SPrzemek Kitszel 		BIT_ULL(ICE_FLOW_FIELD_IDX_SCTP_SRC_PORT)},
144*5de6c855SPrzemek Kitszel 	{VIRTCHNL_PROTO_HDR_SCTP,
145*5de6c855SPrzemek Kitszel 		FIELD_SELECTOR(VIRTCHNL_PROTO_HDR_SCTP_DST_PORT),
146*5de6c855SPrzemek Kitszel 		BIT_ULL(ICE_FLOW_FIELD_IDX_SCTP_DST_PORT)},
147*5de6c855SPrzemek Kitszel 	{VIRTCHNL_PROTO_HDR_SCTP,
148*5de6c855SPrzemek Kitszel 		FIELD_SELECTOR(VIRTCHNL_PROTO_HDR_SCTP_SRC_PORT) |
149*5de6c855SPrzemek Kitszel 		FIELD_SELECTOR(VIRTCHNL_PROTO_HDR_SCTP_DST_PORT),
150*5de6c855SPrzemek Kitszel 		ICE_FLOW_HASH_SCTP_PORT},
151*5de6c855SPrzemek Kitszel 	{VIRTCHNL_PROTO_HDR_PPPOE,
152*5de6c855SPrzemek Kitszel 		FIELD_SELECTOR(VIRTCHNL_PROTO_HDR_PPPOE_SESS_ID),
153*5de6c855SPrzemek Kitszel 		BIT_ULL(ICE_FLOW_FIELD_IDX_PPPOE_SESS_ID)},
154*5de6c855SPrzemek Kitszel 	{VIRTCHNL_PROTO_HDR_GTPU_IP,
155*5de6c855SPrzemek Kitszel 		FIELD_SELECTOR(VIRTCHNL_PROTO_HDR_GTPU_IP_TEID),
156*5de6c855SPrzemek Kitszel 		BIT_ULL(ICE_FLOW_FIELD_IDX_GTPU_IP_TEID)},
157*5de6c855SPrzemek Kitszel 	{VIRTCHNL_PROTO_HDR_L2TPV3,
158*5de6c855SPrzemek Kitszel 		FIELD_SELECTOR(VIRTCHNL_PROTO_HDR_L2TPV3_SESS_ID),
159*5de6c855SPrzemek Kitszel 		BIT_ULL(ICE_FLOW_FIELD_IDX_L2TPV3_SESS_ID)},
160*5de6c855SPrzemek Kitszel 	{VIRTCHNL_PROTO_HDR_ESP, FIELD_SELECTOR(VIRTCHNL_PROTO_HDR_ESP_SPI),
161*5de6c855SPrzemek Kitszel 		BIT_ULL(ICE_FLOW_FIELD_IDX_ESP_SPI)},
162*5de6c855SPrzemek Kitszel 	{VIRTCHNL_PROTO_HDR_AH, FIELD_SELECTOR(VIRTCHNL_PROTO_HDR_AH_SPI),
163*5de6c855SPrzemek Kitszel 		BIT_ULL(ICE_FLOW_FIELD_IDX_AH_SPI)},
164*5de6c855SPrzemek Kitszel 	{VIRTCHNL_PROTO_HDR_PFCP, FIELD_SELECTOR(VIRTCHNL_PROTO_HDR_PFCP_SEID),
165*5de6c855SPrzemek Kitszel 		BIT_ULL(ICE_FLOW_FIELD_IDX_PFCP_SEID)},
166*5de6c855SPrzemek Kitszel };
167*5de6c855SPrzemek Kitszel 
168*5de6c855SPrzemek Kitszel /**
169*5de6c855SPrzemek Kitszel  * ice_vc_vf_broadcast - Broadcast a message to all VFs on PF
170*5de6c855SPrzemek Kitszel  * @pf: pointer to the PF structure
171*5de6c855SPrzemek Kitszel  * @v_opcode: operation code
172*5de6c855SPrzemek Kitszel  * @v_retval: return value
173*5de6c855SPrzemek Kitszel  * @msg: pointer to the msg buffer
174*5de6c855SPrzemek Kitszel  * @msglen: msg length
175*5de6c855SPrzemek Kitszel  */
176*5de6c855SPrzemek Kitszel static void
177*5de6c855SPrzemek Kitszel ice_vc_vf_broadcast(struct ice_pf *pf, enum virtchnl_ops v_opcode,
178*5de6c855SPrzemek Kitszel 		    enum virtchnl_status_code v_retval, u8 *msg, u16 msglen)
179*5de6c855SPrzemek Kitszel {
180*5de6c855SPrzemek Kitszel 	struct ice_hw *hw = &pf->hw;
181*5de6c855SPrzemek Kitszel 	struct ice_vf *vf;
182*5de6c855SPrzemek Kitszel 	unsigned int bkt;
183*5de6c855SPrzemek Kitszel 
184*5de6c855SPrzemek Kitszel 	mutex_lock(&pf->vfs.table_lock);
185*5de6c855SPrzemek Kitszel 	ice_for_each_vf(pf, bkt, vf) {
186*5de6c855SPrzemek Kitszel 		/* Not all vfs are enabled so skip the ones that are not */
187*5de6c855SPrzemek Kitszel 		if (!test_bit(ICE_VF_STATE_INIT, vf->vf_states) &&
188*5de6c855SPrzemek Kitszel 		    !test_bit(ICE_VF_STATE_ACTIVE, vf->vf_states))
189*5de6c855SPrzemek Kitszel 			continue;
190*5de6c855SPrzemek Kitszel 
191*5de6c855SPrzemek Kitszel 		/* Ignore return value on purpose - a given VF may fail, but
192*5de6c855SPrzemek Kitszel 		 * we need to keep going and send to all of them
193*5de6c855SPrzemek Kitszel 		 */
194*5de6c855SPrzemek Kitszel 		ice_aq_send_msg_to_vf(hw, vf->vf_id, v_opcode, v_retval, msg,
195*5de6c855SPrzemek Kitszel 				      msglen, NULL);
196*5de6c855SPrzemek Kitszel 	}
197*5de6c855SPrzemek Kitszel 	mutex_unlock(&pf->vfs.table_lock);
198*5de6c855SPrzemek Kitszel }
199*5de6c855SPrzemek Kitszel 
200*5de6c855SPrzemek Kitszel /**
201*5de6c855SPrzemek Kitszel  * ice_set_pfe_link - Set the link speed/status of the virtchnl_pf_event
202*5de6c855SPrzemek Kitszel  * @vf: pointer to the VF structure
203*5de6c855SPrzemek Kitszel  * @pfe: pointer to the virtchnl_pf_event to set link speed/status for
204*5de6c855SPrzemek Kitszel  * @ice_link_speed: link speed specified by ICE_AQ_LINK_SPEED_*
205*5de6c855SPrzemek Kitszel  * @link_up: whether or not to set the link up/down
206*5de6c855SPrzemek Kitszel  */
207*5de6c855SPrzemek Kitszel static void
208*5de6c855SPrzemek Kitszel ice_set_pfe_link(struct ice_vf *vf, struct virtchnl_pf_event *pfe,
209*5de6c855SPrzemek Kitszel 		 int ice_link_speed, bool link_up)
210*5de6c855SPrzemek Kitszel {
211*5de6c855SPrzemek Kitszel 	if (vf->driver_caps & VIRTCHNL_VF_CAP_ADV_LINK_SPEED) {
212*5de6c855SPrzemek Kitszel 		pfe->event_data.link_event_adv.link_status = link_up;
213*5de6c855SPrzemek Kitszel 		/* Speed in Mbps */
214*5de6c855SPrzemek Kitszel 		pfe->event_data.link_event_adv.link_speed =
215*5de6c855SPrzemek Kitszel 			ice_conv_link_speed_to_virtchnl(true, ice_link_speed);
216*5de6c855SPrzemek Kitszel 	} else {
217*5de6c855SPrzemek Kitszel 		pfe->event_data.link_event.link_status = link_up;
218*5de6c855SPrzemek Kitszel 		/* Legacy method for virtchnl link speeds */
219*5de6c855SPrzemek Kitszel 		pfe->event_data.link_event.link_speed =
220*5de6c855SPrzemek Kitszel 			(enum virtchnl_link_speed)
221*5de6c855SPrzemek Kitszel 			ice_conv_link_speed_to_virtchnl(false, ice_link_speed);
222*5de6c855SPrzemek Kitszel 	}
223*5de6c855SPrzemek Kitszel }
224*5de6c855SPrzemek Kitszel 
225*5de6c855SPrzemek Kitszel /**
226*5de6c855SPrzemek Kitszel  * ice_vc_notify_vf_link_state - Inform a VF of link status
227*5de6c855SPrzemek Kitszel  * @vf: pointer to the VF structure
228*5de6c855SPrzemek Kitszel  *
229*5de6c855SPrzemek Kitszel  * send a link status message to a single VF
230*5de6c855SPrzemek Kitszel  */
231*5de6c855SPrzemek Kitszel void ice_vc_notify_vf_link_state(struct ice_vf *vf)
232*5de6c855SPrzemek Kitszel {
233*5de6c855SPrzemek Kitszel 	struct virtchnl_pf_event pfe = { 0 };
234*5de6c855SPrzemek Kitszel 	struct ice_hw *hw = &vf->pf->hw;
235*5de6c855SPrzemek Kitszel 
236*5de6c855SPrzemek Kitszel 	pfe.event = VIRTCHNL_EVENT_LINK_CHANGE;
237*5de6c855SPrzemek Kitszel 	pfe.severity = PF_EVENT_SEVERITY_INFO;
238*5de6c855SPrzemek Kitszel 
239*5de6c855SPrzemek Kitszel 	if (ice_is_vf_link_up(vf))
240*5de6c855SPrzemek Kitszel 		ice_set_pfe_link(vf, &pfe,
241*5de6c855SPrzemek Kitszel 				 hw->port_info->phy.link_info.link_speed, true);
242*5de6c855SPrzemek Kitszel 	else
243*5de6c855SPrzemek Kitszel 		ice_set_pfe_link(vf, &pfe, ICE_AQ_LINK_SPEED_UNKNOWN, false);
244*5de6c855SPrzemek Kitszel 
245*5de6c855SPrzemek Kitszel 	ice_aq_send_msg_to_vf(hw, vf->vf_id, VIRTCHNL_OP_EVENT,
246*5de6c855SPrzemek Kitszel 			      VIRTCHNL_STATUS_SUCCESS, (u8 *)&pfe,
247*5de6c855SPrzemek Kitszel 			      sizeof(pfe), NULL);
248*5de6c855SPrzemek Kitszel }
249*5de6c855SPrzemek Kitszel 
250*5de6c855SPrzemek Kitszel /**
251*5de6c855SPrzemek Kitszel  * ice_vc_notify_link_state - Inform all VFs on a PF of link status
252*5de6c855SPrzemek Kitszel  * @pf: pointer to the PF structure
253*5de6c855SPrzemek Kitszel  */
254*5de6c855SPrzemek Kitszel void ice_vc_notify_link_state(struct ice_pf *pf)
255*5de6c855SPrzemek Kitszel {
256*5de6c855SPrzemek Kitszel 	struct ice_vf *vf;
257*5de6c855SPrzemek Kitszel 	unsigned int bkt;
258*5de6c855SPrzemek Kitszel 
259*5de6c855SPrzemek Kitszel 	mutex_lock(&pf->vfs.table_lock);
260*5de6c855SPrzemek Kitszel 	ice_for_each_vf(pf, bkt, vf)
261*5de6c855SPrzemek Kitszel 		ice_vc_notify_vf_link_state(vf);
262*5de6c855SPrzemek Kitszel 	mutex_unlock(&pf->vfs.table_lock);
263*5de6c855SPrzemek Kitszel }
264*5de6c855SPrzemek Kitszel 
265*5de6c855SPrzemek Kitszel /**
266*5de6c855SPrzemek Kitszel  * ice_vc_notify_reset - Send pending reset message to all VFs
267*5de6c855SPrzemek Kitszel  * @pf: pointer to the PF structure
268*5de6c855SPrzemek Kitszel  *
269*5de6c855SPrzemek Kitszel  * indicate a pending reset to all VFs on a given PF
270*5de6c855SPrzemek Kitszel  */
271*5de6c855SPrzemek Kitszel void ice_vc_notify_reset(struct ice_pf *pf)
272*5de6c855SPrzemek Kitszel {
273*5de6c855SPrzemek Kitszel 	struct virtchnl_pf_event pfe;
274*5de6c855SPrzemek Kitszel 
275*5de6c855SPrzemek Kitszel 	if (!ice_has_vfs(pf))
276*5de6c855SPrzemek Kitszel 		return;
277*5de6c855SPrzemek Kitszel 
278*5de6c855SPrzemek Kitszel 	pfe.event = VIRTCHNL_EVENT_RESET_IMPENDING;
279*5de6c855SPrzemek Kitszel 	pfe.severity = PF_EVENT_SEVERITY_CERTAIN_DOOM;
280*5de6c855SPrzemek Kitszel 	ice_vc_vf_broadcast(pf, VIRTCHNL_OP_EVENT, VIRTCHNL_STATUS_SUCCESS,
281*5de6c855SPrzemek Kitszel 			    (u8 *)&pfe, sizeof(struct virtchnl_pf_event));
282*5de6c855SPrzemek Kitszel }
283*5de6c855SPrzemek Kitszel 
284*5de6c855SPrzemek Kitszel /**
285*5de6c855SPrzemek Kitszel  * ice_vc_send_msg_to_vf - Send message to VF
286*5de6c855SPrzemek Kitszel  * @vf: pointer to the VF info
287*5de6c855SPrzemek Kitszel  * @v_opcode: virtual channel opcode
288*5de6c855SPrzemek Kitszel  * @v_retval: virtual channel return value
289*5de6c855SPrzemek Kitszel  * @msg: pointer to the msg buffer
290*5de6c855SPrzemek Kitszel  * @msglen: msg length
291*5de6c855SPrzemek Kitszel  *
292*5de6c855SPrzemek Kitszel  * send msg to VF
293*5de6c855SPrzemek Kitszel  */
294*5de6c855SPrzemek Kitszel int
295*5de6c855SPrzemek Kitszel ice_vc_send_msg_to_vf(struct ice_vf *vf, u32 v_opcode,
296*5de6c855SPrzemek Kitszel 		      enum virtchnl_status_code v_retval, u8 *msg, u16 msglen)
297*5de6c855SPrzemek Kitszel {
298*5de6c855SPrzemek Kitszel 	struct device *dev;
299*5de6c855SPrzemek Kitszel 	struct ice_pf *pf;
300*5de6c855SPrzemek Kitszel 	int aq_ret;
301*5de6c855SPrzemek Kitszel 
302*5de6c855SPrzemek Kitszel 	pf = vf->pf;
303*5de6c855SPrzemek Kitszel 	dev = ice_pf_to_dev(pf);
304*5de6c855SPrzemek Kitszel 
305*5de6c855SPrzemek Kitszel 	aq_ret = ice_aq_send_msg_to_vf(&pf->hw, vf->vf_id, v_opcode, v_retval,
306*5de6c855SPrzemek Kitszel 				       msg, msglen, NULL);
307*5de6c855SPrzemek Kitszel 	if (aq_ret && pf->hw.mailboxq.sq_last_status != LIBIE_AQ_RC_ENOSYS) {
308*5de6c855SPrzemek Kitszel 		dev_info(dev, "Unable to send the message to VF %d ret %d aq_err %s\n",
309*5de6c855SPrzemek Kitszel 			 vf->vf_id, aq_ret,
310*5de6c855SPrzemek Kitszel 			 libie_aq_str(pf->hw.mailboxq.sq_last_status));
311*5de6c855SPrzemek Kitszel 		return -EIO;
312*5de6c855SPrzemek Kitszel 	}
313*5de6c855SPrzemek Kitszel 
314*5de6c855SPrzemek Kitszel 	return 0;
315*5de6c855SPrzemek Kitszel }
316*5de6c855SPrzemek Kitszel 
317*5de6c855SPrzemek Kitszel /**
318*5de6c855SPrzemek Kitszel  * ice_vc_get_ver_msg
319*5de6c855SPrzemek Kitszel  * @vf: pointer to the VF info
320*5de6c855SPrzemek Kitszel  * @msg: pointer to the msg buffer
321*5de6c855SPrzemek Kitszel  *
322*5de6c855SPrzemek Kitszel  * called from the VF to request the API version used by the PF
323*5de6c855SPrzemek Kitszel  */
324*5de6c855SPrzemek Kitszel static int ice_vc_get_ver_msg(struct ice_vf *vf, u8 *msg)
325*5de6c855SPrzemek Kitszel {
326*5de6c855SPrzemek Kitszel 	struct virtchnl_version_info info = {
327*5de6c855SPrzemek Kitszel 		VIRTCHNL_VERSION_MAJOR, VIRTCHNL_VERSION_MINOR
328*5de6c855SPrzemek Kitszel 	};
329*5de6c855SPrzemek Kitszel 
330*5de6c855SPrzemek Kitszel 	vf->vf_ver = *(struct virtchnl_version_info *)msg;
331*5de6c855SPrzemek Kitszel 	/* VFs running the 1.0 API expect to get 1.0 back or they will cry. */
332*5de6c855SPrzemek Kitszel 	if (VF_IS_V10(&vf->vf_ver))
333*5de6c855SPrzemek Kitszel 		info.minor = VIRTCHNL_VERSION_MINOR_NO_VF_CAPS;
334*5de6c855SPrzemek Kitszel 
335*5de6c855SPrzemek Kitszel 	return ice_vc_send_msg_to_vf(vf, VIRTCHNL_OP_VERSION,
336*5de6c855SPrzemek Kitszel 				     VIRTCHNL_STATUS_SUCCESS, (u8 *)&info,
337*5de6c855SPrzemek Kitszel 				     sizeof(struct virtchnl_version_info));
338*5de6c855SPrzemek Kitszel }
339*5de6c855SPrzemek Kitszel 
340*5de6c855SPrzemek Kitszel /**
341*5de6c855SPrzemek Kitszel  * ice_vc_get_max_frame_size - get max frame size allowed for VF
342*5de6c855SPrzemek Kitszel  * @vf: VF used to determine max frame size
343*5de6c855SPrzemek Kitszel  *
344*5de6c855SPrzemek Kitszel  * Max frame size is determined based on the current port's max frame size and
345*5de6c855SPrzemek Kitszel  * whether a port VLAN is configured on this VF. The VF is not aware whether
346*5de6c855SPrzemek Kitszel  * it's in a port VLAN so the PF needs to account for this in max frame size
347*5de6c855SPrzemek Kitszel  * checks and sending the max frame size to the VF.
348*5de6c855SPrzemek Kitszel  */
349*5de6c855SPrzemek Kitszel static u16 ice_vc_get_max_frame_size(struct ice_vf *vf)
350*5de6c855SPrzemek Kitszel {
351*5de6c855SPrzemek Kitszel 	struct ice_port_info *pi = ice_vf_get_port_info(vf);
352*5de6c855SPrzemek Kitszel 	u16 max_frame_size;
353*5de6c855SPrzemek Kitszel 
354*5de6c855SPrzemek Kitszel 	max_frame_size = pi->phy.link_info.max_frame_size;
355*5de6c855SPrzemek Kitszel 
356*5de6c855SPrzemek Kitszel 	if (ice_vf_is_port_vlan_ena(vf))
357*5de6c855SPrzemek Kitszel 		max_frame_size -= VLAN_HLEN;
358*5de6c855SPrzemek Kitszel 
359*5de6c855SPrzemek Kitszel 	return max_frame_size;
360*5de6c855SPrzemek Kitszel }
361*5de6c855SPrzemek Kitszel 
362*5de6c855SPrzemek Kitszel /**
363*5de6c855SPrzemek Kitszel  * ice_vc_get_vlan_caps
364*5de6c855SPrzemek Kitszel  * @hw: pointer to the hw
365*5de6c855SPrzemek Kitszel  * @vf: pointer to the VF info
366*5de6c855SPrzemek Kitszel  * @vsi: pointer to the VSI
367*5de6c855SPrzemek Kitszel  * @driver_caps: current driver caps
368*5de6c855SPrzemek Kitszel  *
369*5de6c855SPrzemek Kitszel  * Return 0 if there is no VLAN caps supported, or VLAN caps value
370*5de6c855SPrzemek Kitszel  */
371*5de6c855SPrzemek Kitszel static u32
372*5de6c855SPrzemek Kitszel ice_vc_get_vlan_caps(struct ice_hw *hw, struct ice_vf *vf, struct ice_vsi *vsi,
373*5de6c855SPrzemek Kitszel 		     u32 driver_caps)
374*5de6c855SPrzemek Kitszel {
375*5de6c855SPrzemek Kitszel 	if (ice_is_eswitch_mode_switchdev(vf->pf))
376*5de6c855SPrzemek Kitszel 		/* In switchdev setting VLAN from VF isn't supported */
377*5de6c855SPrzemek Kitszel 		return 0;
378*5de6c855SPrzemek Kitszel 
379*5de6c855SPrzemek Kitszel 	if (driver_caps & VIRTCHNL_VF_OFFLOAD_VLAN_V2) {
380*5de6c855SPrzemek Kitszel 		/* VLAN offloads based on current device configuration */
381*5de6c855SPrzemek Kitszel 		return VIRTCHNL_VF_OFFLOAD_VLAN_V2;
382*5de6c855SPrzemek Kitszel 	} else if (driver_caps & VIRTCHNL_VF_OFFLOAD_VLAN) {
383*5de6c855SPrzemek Kitszel 		/* allow VF to negotiate VIRTCHNL_VF_OFFLOAD explicitly for
384*5de6c855SPrzemek Kitszel 		 * these two conditions, which amounts to guest VLAN filtering
385*5de6c855SPrzemek Kitszel 		 * and offloads being based on the inner VLAN or the
386*5de6c855SPrzemek Kitszel 		 * inner/single VLAN respectively and don't allow VF to
387*5de6c855SPrzemek Kitszel 		 * negotiate VIRTCHNL_VF_OFFLOAD in any other cases
388*5de6c855SPrzemek Kitszel 		 */
389*5de6c855SPrzemek Kitszel 		if (ice_is_dvm_ena(hw) && ice_vf_is_port_vlan_ena(vf)) {
390*5de6c855SPrzemek Kitszel 			return VIRTCHNL_VF_OFFLOAD_VLAN;
391*5de6c855SPrzemek Kitszel 		} else if (!ice_is_dvm_ena(hw) &&
392*5de6c855SPrzemek Kitszel 			   !ice_vf_is_port_vlan_ena(vf)) {
393*5de6c855SPrzemek Kitszel 			/* configure backward compatible support for VFs that
394*5de6c855SPrzemek Kitszel 			 * only support VIRTCHNL_VF_OFFLOAD_VLAN, the PF is
395*5de6c855SPrzemek Kitszel 			 * configured in SVM, and no port VLAN is configured
396*5de6c855SPrzemek Kitszel 			 */
397*5de6c855SPrzemek Kitszel 			ice_vf_vsi_cfg_svm_legacy_vlan_mode(vsi);
398*5de6c855SPrzemek Kitszel 			return VIRTCHNL_VF_OFFLOAD_VLAN;
399*5de6c855SPrzemek Kitszel 		} else if (ice_is_dvm_ena(hw)) {
400*5de6c855SPrzemek Kitszel 			/* configure software offloaded VLAN support when DVM
401*5de6c855SPrzemek Kitszel 			 * is enabled, but no port VLAN is enabled
402*5de6c855SPrzemek Kitszel 			 */
403*5de6c855SPrzemek Kitszel 			ice_vf_vsi_cfg_dvm_legacy_vlan_mode(vsi);
404*5de6c855SPrzemek Kitszel 		}
405*5de6c855SPrzemek Kitszel 	}
406*5de6c855SPrzemek Kitszel 
407*5de6c855SPrzemek Kitszel 	return 0;
408*5de6c855SPrzemek Kitszel }
409*5de6c855SPrzemek Kitszel 
410*5de6c855SPrzemek Kitszel /**
411*5de6c855SPrzemek Kitszel  * ice_vc_get_vf_res_msg
412*5de6c855SPrzemek Kitszel  * @vf: pointer to the VF info
413*5de6c855SPrzemek Kitszel  * @msg: pointer to the msg buffer
414*5de6c855SPrzemek Kitszel  *
415*5de6c855SPrzemek Kitszel  * called from the VF to request its resources
416*5de6c855SPrzemek Kitszel  */
417*5de6c855SPrzemek Kitszel static int ice_vc_get_vf_res_msg(struct ice_vf *vf, u8 *msg)
418*5de6c855SPrzemek Kitszel {
419*5de6c855SPrzemek Kitszel 	enum virtchnl_status_code v_ret = VIRTCHNL_STATUS_SUCCESS;
420*5de6c855SPrzemek Kitszel 	struct virtchnl_vf_resource *vfres = NULL;
421*5de6c855SPrzemek Kitszel 	struct ice_hw *hw = &vf->pf->hw;
422*5de6c855SPrzemek Kitszel 	struct ice_vsi *vsi;
423*5de6c855SPrzemek Kitszel 	int len = 0;
424*5de6c855SPrzemek Kitszel 	int ret;
425*5de6c855SPrzemek Kitszel 
426*5de6c855SPrzemek Kitszel 	if (ice_check_vf_init(vf)) {
427*5de6c855SPrzemek Kitszel 		v_ret = VIRTCHNL_STATUS_ERR_PARAM;
428*5de6c855SPrzemek Kitszel 		goto err;
429*5de6c855SPrzemek Kitszel 	}
430*5de6c855SPrzemek Kitszel 
431*5de6c855SPrzemek Kitszel 	len = virtchnl_struct_size(vfres, vsi_res, 0);
432*5de6c855SPrzemek Kitszel 
433*5de6c855SPrzemek Kitszel 	vfres = kzalloc(len, GFP_KERNEL);
434*5de6c855SPrzemek Kitszel 	if (!vfres) {
435*5de6c855SPrzemek Kitszel 		v_ret = VIRTCHNL_STATUS_ERR_NO_MEMORY;
436*5de6c855SPrzemek Kitszel 		len = 0;
437*5de6c855SPrzemek Kitszel 		goto err;
438*5de6c855SPrzemek Kitszel 	}
439*5de6c855SPrzemek Kitszel 	if (VF_IS_V11(&vf->vf_ver))
440*5de6c855SPrzemek Kitszel 		vf->driver_caps = *(u32 *)msg;
441*5de6c855SPrzemek Kitszel 	else
442*5de6c855SPrzemek Kitszel 		vf->driver_caps = VIRTCHNL_VF_OFFLOAD_L2 |
443*5de6c855SPrzemek Kitszel 				  VIRTCHNL_VF_OFFLOAD_VLAN;
444*5de6c855SPrzemek Kitszel 
445*5de6c855SPrzemek Kitszel 	vfres->vf_cap_flags = VIRTCHNL_VF_OFFLOAD_L2;
446*5de6c855SPrzemek Kitszel 	vsi = ice_get_vf_vsi(vf);
447*5de6c855SPrzemek Kitszel 	if (!vsi) {
448*5de6c855SPrzemek Kitszel 		v_ret = VIRTCHNL_STATUS_ERR_PARAM;
449*5de6c855SPrzemek Kitszel 		goto err;
450*5de6c855SPrzemek Kitszel 	}
451*5de6c855SPrzemek Kitszel 
452*5de6c855SPrzemek Kitszel 	vfres->vf_cap_flags |= ice_vc_get_vlan_caps(hw, vf, vsi,
453*5de6c855SPrzemek Kitszel 						    vf->driver_caps);
454*5de6c855SPrzemek Kitszel 
455*5de6c855SPrzemek Kitszel 	if (vf->driver_caps & VIRTCHNL_VF_OFFLOAD_RSS_PF)
456*5de6c855SPrzemek Kitszel 		vfres->vf_cap_flags |= VIRTCHNL_VF_OFFLOAD_RSS_PF;
457*5de6c855SPrzemek Kitszel 
458*5de6c855SPrzemek Kitszel 	if (vf->driver_caps & VIRTCHNL_VF_OFFLOAD_RX_FLEX_DESC)
459*5de6c855SPrzemek Kitszel 		vfres->vf_cap_flags |= VIRTCHNL_VF_OFFLOAD_RX_FLEX_DESC;
460*5de6c855SPrzemek Kitszel 
461*5de6c855SPrzemek Kitszel 	if (vf->driver_caps & VIRTCHNL_VF_OFFLOAD_FDIR_PF)
462*5de6c855SPrzemek Kitszel 		vfres->vf_cap_flags |= VIRTCHNL_VF_OFFLOAD_FDIR_PF;
463*5de6c855SPrzemek Kitszel 
464*5de6c855SPrzemek Kitszel 	if (vf->driver_caps & VIRTCHNL_VF_OFFLOAD_TC_U32 &&
465*5de6c855SPrzemek Kitszel 	    vfres->vf_cap_flags & VIRTCHNL_VF_OFFLOAD_FDIR_PF)
466*5de6c855SPrzemek Kitszel 		vfres->vf_cap_flags |= VIRTCHNL_VF_OFFLOAD_TC_U32;
467*5de6c855SPrzemek Kitszel 
468*5de6c855SPrzemek Kitszel 	if (vf->driver_caps & VIRTCHNL_VF_OFFLOAD_RSS_PCTYPE_V2)
469*5de6c855SPrzemek Kitszel 		vfres->vf_cap_flags |= VIRTCHNL_VF_OFFLOAD_RSS_PCTYPE_V2;
470*5de6c855SPrzemek Kitszel 
471*5de6c855SPrzemek Kitszel 	if (vf->driver_caps & VIRTCHNL_VF_OFFLOAD_ENCAP)
472*5de6c855SPrzemek Kitszel 		vfres->vf_cap_flags |= VIRTCHNL_VF_OFFLOAD_ENCAP;
473*5de6c855SPrzemek Kitszel 
474*5de6c855SPrzemek Kitszel 	if (vf->driver_caps & VIRTCHNL_VF_OFFLOAD_ENCAP_CSUM)
475*5de6c855SPrzemek Kitszel 		vfres->vf_cap_flags |= VIRTCHNL_VF_OFFLOAD_ENCAP_CSUM;
476*5de6c855SPrzemek Kitszel 
477*5de6c855SPrzemek Kitszel 	if (vf->driver_caps & VIRTCHNL_VF_OFFLOAD_RX_POLLING)
478*5de6c855SPrzemek Kitszel 		vfres->vf_cap_flags |= VIRTCHNL_VF_OFFLOAD_RX_POLLING;
479*5de6c855SPrzemek Kitszel 
480*5de6c855SPrzemek Kitszel 	if (vf->driver_caps & VIRTCHNL_VF_OFFLOAD_WB_ON_ITR)
481*5de6c855SPrzemek Kitszel 		vfres->vf_cap_flags |= VIRTCHNL_VF_OFFLOAD_WB_ON_ITR;
482*5de6c855SPrzemek Kitszel 
483*5de6c855SPrzemek Kitszel 	if (vf->driver_caps & VIRTCHNL_VF_OFFLOAD_REQ_QUEUES)
484*5de6c855SPrzemek Kitszel 		vfres->vf_cap_flags |= VIRTCHNL_VF_OFFLOAD_REQ_QUEUES;
485*5de6c855SPrzemek Kitszel 
486*5de6c855SPrzemek Kitszel 	if (vf->driver_caps & VIRTCHNL_VF_OFFLOAD_CRC)
487*5de6c855SPrzemek Kitszel 		vfres->vf_cap_flags |= VIRTCHNL_VF_OFFLOAD_CRC;
488*5de6c855SPrzemek Kitszel 
489*5de6c855SPrzemek Kitszel 	if (vf->driver_caps & VIRTCHNL_VF_CAP_ADV_LINK_SPEED)
490*5de6c855SPrzemek Kitszel 		vfres->vf_cap_flags |= VIRTCHNL_VF_CAP_ADV_LINK_SPEED;
491*5de6c855SPrzemek Kitszel 
492*5de6c855SPrzemek Kitszel 	if (vf->driver_caps & VIRTCHNL_VF_OFFLOAD_ADV_RSS_PF)
493*5de6c855SPrzemek Kitszel 		vfres->vf_cap_flags |= VIRTCHNL_VF_OFFLOAD_ADV_RSS_PF;
494*5de6c855SPrzemek Kitszel 
495*5de6c855SPrzemek Kitszel 	if (vf->driver_caps & VIRTCHNL_VF_OFFLOAD_USO)
496*5de6c855SPrzemek Kitszel 		vfres->vf_cap_flags |= VIRTCHNL_VF_OFFLOAD_USO;
497*5de6c855SPrzemek Kitszel 
498*5de6c855SPrzemek Kitszel 	if (vf->driver_caps & VIRTCHNL_VF_OFFLOAD_QOS)
499*5de6c855SPrzemek Kitszel 		vfres->vf_cap_flags |= VIRTCHNL_VF_OFFLOAD_QOS;
500*5de6c855SPrzemek Kitszel 
501*5de6c855SPrzemek Kitszel 	if (vf->driver_caps & VIRTCHNL_VF_CAP_PTP)
502*5de6c855SPrzemek Kitszel 		vfres->vf_cap_flags |= VIRTCHNL_VF_CAP_PTP;
503*5de6c855SPrzemek Kitszel 
504*5de6c855SPrzemek Kitszel 	vfres->num_vsis = 1;
505*5de6c855SPrzemek Kitszel 	/* Tx and Rx queue are equal for VF */
506*5de6c855SPrzemek Kitszel 	vfres->num_queue_pairs = vsi->num_txq;
507*5de6c855SPrzemek Kitszel 	vfres->max_vectors = vf->num_msix;
508*5de6c855SPrzemek Kitszel 	vfres->rss_key_size = ICE_VSIQF_HKEY_ARRAY_SIZE;
509*5de6c855SPrzemek Kitszel 	vfres->rss_lut_size = ICE_LUT_VSI_SIZE;
510*5de6c855SPrzemek Kitszel 	vfres->max_mtu = ice_vc_get_max_frame_size(vf);
511*5de6c855SPrzemek Kitszel 
512*5de6c855SPrzemek Kitszel 	vfres->vsi_res[0].vsi_id = ICE_VF_VSI_ID;
513*5de6c855SPrzemek Kitszel 	vfres->vsi_res[0].vsi_type = VIRTCHNL_VSI_SRIOV;
514*5de6c855SPrzemek Kitszel 	vfres->vsi_res[0].num_queue_pairs = vsi->num_txq;
515*5de6c855SPrzemek Kitszel 	ether_addr_copy(vfres->vsi_res[0].default_mac_addr,
516*5de6c855SPrzemek Kitszel 			vf->hw_lan_addr);
517*5de6c855SPrzemek Kitszel 
518*5de6c855SPrzemek Kitszel 	/* match guest capabilities */
519*5de6c855SPrzemek Kitszel 	vf->driver_caps = vfres->vf_cap_flags;
520*5de6c855SPrzemek Kitszel 
521*5de6c855SPrzemek Kitszel 	ice_vc_set_caps_allowlist(vf);
522*5de6c855SPrzemek Kitszel 	ice_vc_set_working_allowlist(vf);
523*5de6c855SPrzemek Kitszel 
524*5de6c855SPrzemek Kitszel 	set_bit(ICE_VF_STATE_ACTIVE, vf->vf_states);
525*5de6c855SPrzemek Kitszel 
526*5de6c855SPrzemek Kitszel err:
527*5de6c855SPrzemek Kitszel 	/* send the response back to the VF */
528*5de6c855SPrzemek Kitszel 	ret = ice_vc_send_msg_to_vf(vf, VIRTCHNL_OP_GET_VF_RESOURCES, v_ret,
529*5de6c855SPrzemek Kitszel 				    (u8 *)vfres, len);
530*5de6c855SPrzemek Kitszel 
531*5de6c855SPrzemek Kitszel 	kfree(vfres);
532*5de6c855SPrzemek Kitszel 	return ret;
533*5de6c855SPrzemek Kitszel }
534*5de6c855SPrzemek Kitszel 
535*5de6c855SPrzemek Kitszel /**
536*5de6c855SPrzemek Kitszel  * ice_vc_reset_vf_msg
537*5de6c855SPrzemek Kitszel  * @vf: pointer to the VF info
538*5de6c855SPrzemek Kitszel  *
539*5de6c855SPrzemek Kitszel  * called from the VF to reset itself,
540*5de6c855SPrzemek Kitszel  * unlike other virtchnl messages, PF driver
541*5de6c855SPrzemek Kitszel  * doesn't send the response back to the VF
542*5de6c855SPrzemek Kitszel  */
543*5de6c855SPrzemek Kitszel static void ice_vc_reset_vf_msg(struct ice_vf *vf)
544*5de6c855SPrzemek Kitszel {
545*5de6c855SPrzemek Kitszel 	if (test_bit(ICE_VF_STATE_INIT, vf->vf_states))
546*5de6c855SPrzemek Kitszel 		ice_reset_vf(vf, 0);
547*5de6c855SPrzemek Kitszel }
548*5de6c855SPrzemek Kitszel 
549*5de6c855SPrzemek Kitszel /**
550*5de6c855SPrzemek Kitszel  * ice_vc_isvalid_vsi_id
551*5de6c855SPrzemek Kitszel  * @vf: pointer to the VF info
552*5de6c855SPrzemek Kitszel  * @vsi_id: VF relative VSI ID
553*5de6c855SPrzemek Kitszel  *
554*5de6c855SPrzemek Kitszel  * check for the valid VSI ID
555*5de6c855SPrzemek Kitszel  */
556*5de6c855SPrzemek Kitszel bool ice_vc_isvalid_vsi_id(struct ice_vf *vf, u16 vsi_id)
557*5de6c855SPrzemek Kitszel {
558*5de6c855SPrzemek Kitszel 	return vsi_id == ICE_VF_VSI_ID;
559*5de6c855SPrzemek Kitszel }
560*5de6c855SPrzemek Kitszel 
561*5de6c855SPrzemek Kitszel /**
562*5de6c855SPrzemek Kitszel  * ice_vc_isvalid_q_id
563*5de6c855SPrzemek Kitszel  * @vsi: VSI to check queue ID against
564*5de6c855SPrzemek Kitszel  * @qid: VSI relative queue ID
565*5de6c855SPrzemek Kitszel  *
566*5de6c855SPrzemek Kitszel  * check for the valid queue ID
567*5de6c855SPrzemek Kitszel  */
568*5de6c855SPrzemek Kitszel static bool ice_vc_isvalid_q_id(struct ice_vsi *vsi, u16 qid)
569*5de6c855SPrzemek Kitszel {
570*5de6c855SPrzemek Kitszel 	/* allocated Tx and Rx queues should be always equal for VF VSI */
571*5de6c855SPrzemek Kitszel 	return qid < vsi->alloc_txq;
572*5de6c855SPrzemek Kitszel }
573*5de6c855SPrzemek Kitszel 
574*5de6c855SPrzemek Kitszel /**
575*5de6c855SPrzemek Kitszel  * ice_vc_isvalid_ring_len
576*5de6c855SPrzemek Kitszel  * @ring_len: length of ring
577*5de6c855SPrzemek Kitszel  *
578*5de6c855SPrzemek Kitszel  * check for the valid ring count, should be multiple of ICE_REQ_DESC_MULTIPLE
579*5de6c855SPrzemek Kitszel  * or zero
580*5de6c855SPrzemek Kitszel  */
581*5de6c855SPrzemek Kitszel static bool ice_vc_isvalid_ring_len(u16 ring_len)
582*5de6c855SPrzemek Kitszel {
583*5de6c855SPrzemek Kitszel 	return ring_len == 0 ||
584*5de6c855SPrzemek Kitszel 	       (ring_len >= ICE_MIN_NUM_DESC &&
585*5de6c855SPrzemek Kitszel 		ring_len <= ICE_MAX_NUM_DESC &&
586*5de6c855SPrzemek Kitszel 		!(ring_len % ICE_REQ_DESC_MULTIPLE));
587*5de6c855SPrzemek Kitszel }
588*5de6c855SPrzemek Kitszel 
589*5de6c855SPrzemek Kitszel /**
590*5de6c855SPrzemek Kitszel  * ice_vc_validate_pattern
591*5de6c855SPrzemek Kitszel  * @vf: pointer to the VF info
592*5de6c855SPrzemek Kitszel  * @proto: virtchnl protocol headers
593*5de6c855SPrzemek Kitszel  *
594*5de6c855SPrzemek Kitszel  * validate the pattern is supported or not.
595*5de6c855SPrzemek Kitszel  *
596*5de6c855SPrzemek Kitszel  * Return: true on success, false on error.
597*5de6c855SPrzemek Kitszel  */
598*5de6c855SPrzemek Kitszel bool
599*5de6c855SPrzemek Kitszel ice_vc_validate_pattern(struct ice_vf *vf, struct virtchnl_proto_hdrs *proto)
600*5de6c855SPrzemek Kitszel {
601*5de6c855SPrzemek Kitszel 	bool is_ipv4 = false;
602*5de6c855SPrzemek Kitszel 	bool is_ipv6 = false;
603*5de6c855SPrzemek Kitszel 	bool is_udp = false;
604*5de6c855SPrzemek Kitszel 	u16 ptype = -1;
605*5de6c855SPrzemek Kitszel 	int i = 0;
606*5de6c855SPrzemek Kitszel 
607*5de6c855SPrzemek Kitszel 	while (i < proto->count &&
608*5de6c855SPrzemek Kitszel 	       proto->proto_hdr[i].type != VIRTCHNL_PROTO_HDR_NONE) {
609*5de6c855SPrzemek Kitszel 		switch (proto->proto_hdr[i].type) {
610*5de6c855SPrzemek Kitszel 		case VIRTCHNL_PROTO_HDR_ETH:
611*5de6c855SPrzemek Kitszel 			ptype = ICE_PTYPE_MAC_PAY;
612*5de6c855SPrzemek Kitszel 			break;
613*5de6c855SPrzemek Kitszel 		case VIRTCHNL_PROTO_HDR_IPV4:
614*5de6c855SPrzemek Kitszel 			ptype = ICE_PTYPE_IPV4_PAY;
615*5de6c855SPrzemek Kitszel 			is_ipv4 = true;
616*5de6c855SPrzemek Kitszel 			break;
617*5de6c855SPrzemek Kitszel 		case VIRTCHNL_PROTO_HDR_IPV6:
618*5de6c855SPrzemek Kitszel 			ptype = ICE_PTYPE_IPV6_PAY;
619*5de6c855SPrzemek Kitszel 			is_ipv6 = true;
620*5de6c855SPrzemek Kitszel 			break;
621*5de6c855SPrzemek Kitszel 		case VIRTCHNL_PROTO_HDR_UDP:
622*5de6c855SPrzemek Kitszel 			if (is_ipv4)
623*5de6c855SPrzemek Kitszel 				ptype = ICE_PTYPE_IPV4_UDP_PAY;
624*5de6c855SPrzemek Kitszel 			else if (is_ipv6)
625*5de6c855SPrzemek Kitszel 				ptype = ICE_PTYPE_IPV6_UDP_PAY;
626*5de6c855SPrzemek Kitszel 			is_udp = true;
627*5de6c855SPrzemek Kitszel 			break;
628*5de6c855SPrzemek Kitszel 		case VIRTCHNL_PROTO_HDR_TCP:
629*5de6c855SPrzemek Kitszel 			if (is_ipv4)
630*5de6c855SPrzemek Kitszel 				ptype = ICE_PTYPE_IPV4_TCP_PAY;
631*5de6c855SPrzemek Kitszel 			else if (is_ipv6)
632*5de6c855SPrzemek Kitszel 				ptype = ICE_PTYPE_IPV6_TCP_PAY;
633*5de6c855SPrzemek Kitszel 			break;
634*5de6c855SPrzemek Kitszel 		case VIRTCHNL_PROTO_HDR_SCTP:
635*5de6c855SPrzemek Kitszel 			if (is_ipv4)
636*5de6c855SPrzemek Kitszel 				ptype = ICE_PTYPE_IPV4_SCTP_PAY;
637*5de6c855SPrzemek Kitszel 			else if (is_ipv6)
638*5de6c855SPrzemek Kitszel 				ptype = ICE_PTYPE_IPV6_SCTP_PAY;
639*5de6c855SPrzemek Kitszel 			break;
640*5de6c855SPrzemek Kitszel 		case VIRTCHNL_PROTO_HDR_GTPU_IP:
641*5de6c855SPrzemek Kitszel 		case VIRTCHNL_PROTO_HDR_GTPU_EH:
642*5de6c855SPrzemek Kitszel 			if (is_ipv4)
643*5de6c855SPrzemek Kitszel 				ptype = ICE_MAC_IPV4_GTPU;
644*5de6c855SPrzemek Kitszel 			else if (is_ipv6)
645*5de6c855SPrzemek Kitszel 				ptype = ICE_MAC_IPV6_GTPU;
646*5de6c855SPrzemek Kitszel 			goto out;
647*5de6c855SPrzemek Kitszel 		case VIRTCHNL_PROTO_HDR_L2TPV3:
648*5de6c855SPrzemek Kitszel 			if (is_ipv4)
649*5de6c855SPrzemek Kitszel 				ptype = ICE_MAC_IPV4_L2TPV3;
650*5de6c855SPrzemek Kitszel 			else if (is_ipv6)
651*5de6c855SPrzemek Kitszel 				ptype = ICE_MAC_IPV6_L2TPV3;
652*5de6c855SPrzemek Kitszel 			goto out;
653*5de6c855SPrzemek Kitszel 		case VIRTCHNL_PROTO_HDR_ESP:
654*5de6c855SPrzemek Kitszel 			if (is_ipv4)
655*5de6c855SPrzemek Kitszel 				ptype = is_udp ? ICE_MAC_IPV4_NAT_T_ESP :
656*5de6c855SPrzemek Kitszel 						ICE_MAC_IPV4_ESP;
657*5de6c855SPrzemek Kitszel 			else if (is_ipv6)
658*5de6c855SPrzemek Kitszel 				ptype = is_udp ? ICE_MAC_IPV6_NAT_T_ESP :
659*5de6c855SPrzemek Kitszel 						ICE_MAC_IPV6_ESP;
660*5de6c855SPrzemek Kitszel 			goto out;
661*5de6c855SPrzemek Kitszel 		case VIRTCHNL_PROTO_HDR_AH:
662*5de6c855SPrzemek Kitszel 			if (is_ipv4)
663*5de6c855SPrzemek Kitszel 				ptype = ICE_MAC_IPV4_AH;
664*5de6c855SPrzemek Kitszel 			else if (is_ipv6)
665*5de6c855SPrzemek Kitszel 				ptype = ICE_MAC_IPV6_AH;
666*5de6c855SPrzemek Kitszel 			goto out;
667*5de6c855SPrzemek Kitszel 		case VIRTCHNL_PROTO_HDR_PFCP:
668*5de6c855SPrzemek Kitszel 			if (is_ipv4)
669*5de6c855SPrzemek Kitszel 				ptype = ICE_MAC_IPV4_PFCP_SESSION;
670*5de6c855SPrzemek Kitszel 			else if (is_ipv6)
671*5de6c855SPrzemek Kitszel 				ptype = ICE_MAC_IPV6_PFCP_SESSION;
672*5de6c855SPrzemek Kitszel 			goto out;
673*5de6c855SPrzemek Kitszel 		default:
674*5de6c855SPrzemek Kitszel 			break;
675*5de6c855SPrzemek Kitszel 		}
676*5de6c855SPrzemek Kitszel 		i++;
677*5de6c855SPrzemek Kitszel 	}
678*5de6c855SPrzemek Kitszel 
679*5de6c855SPrzemek Kitszel out:
680*5de6c855SPrzemek Kitszel 	return ice_hw_ptype_ena(&vf->pf->hw, ptype);
681*5de6c855SPrzemek Kitszel }
682*5de6c855SPrzemek Kitszel 
683*5de6c855SPrzemek Kitszel /**
684*5de6c855SPrzemek Kitszel  * ice_vc_parse_rss_cfg - parses hash fields and headers from
685*5de6c855SPrzemek Kitszel  * a specific virtchnl RSS cfg
686*5de6c855SPrzemek Kitszel  * @hw: pointer to the hardware
687*5de6c855SPrzemek Kitszel  * @rss_cfg: pointer to the virtchnl RSS cfg
688*5de6c855SPrzemek Kitszel  * @hash_cfg: pointer to the HW hash configuration
689*5de6c855SPrzemek Kitszel  *
690*5de6c855SPrzemek Kitszel  * Return true if all the protocol header and hash fields in the RSS cfg could
691*5de6c855SPrzemek Kitszel  * be parsed, else return false
692*5de6c855SPrzemek Kitszel  *
693*5de6c855SPrzemek Kitszel  * This function parses the virtchnl RSS cfg to be the intended
694*5de6c855SPrzemek Kitszel  * hash fields and the intended header for RSS configuration
695*5de6c855SPrzemek Kitszel  */
696*5de6c855SPrzemek Kitszel static bool ice_vc_parse_rss_cfg(struct ice_hw *hw,
697*5de6c855SPrzemek Kitszel 				 struct virtchnl_rss_cfg *rss_cfg,
698*5de6c855SPrzemek Kitszel 				 struct ice_rss_hash_cfg *hash_cfg)
699*5de6c855SPrzemek Kitszel {
700*5de6c855SPrzemek Kitszel 	const struct ice_vc_hash_field_match_type *hf_list;
701*5de6c855SPrzemek Kitszel 	const struct ice_vc_hdr_match_type *hdr_list;
702*5de6c855SPrzemek Kitszel 	int i, hf_list_len, hdr_list_len;
703*5de6c855SPrzemek Kitszel 	u32 *addl_hdrs = &hash_cfg->addl_hdrs;
704*5de6c855SPrzemek Kitszel 	u64 *hash_flds = &hash_cfg->hash_flds;
705*5de6c855SPrzemek Kitszel 
706*5de6c855SPrzemek Kitszel 	/* set outer layer RSS as default */
707*5de6c855SPrzemek Kitszel 	hash_cfg->hdr_type = ICE_RSS_OUTER_HEADERS;
708*5de6c855SPrzemek Kitszel 
709*5de6c855SPrzemek Kitszel 	if (rss_cfg->rss_algorithm == VIRTCHNL_RSS_ALG_TOEPLITZ_SYMMETRIC)
710*5de6c855SPrzemek Kitszel 		hash_cfg->symm = true;
711*5de6c855SPrzemek Kitszel 	else
712*5de6c855SPrzemek Kitszel 		hash_cfg->symm = false;
713*5de6c855SPrzemek Kitszel 
714*5de6c855SPrzemek Kitszel 	hf_list = ice_vc_hash_field_list;
715*5de6c855SPrzemek Kitszel 	hf_list_len = ARRAY_SIZE(ice_vc_hash_field_list);
716*5de6c855SPrzemek Kitszel 	hdr_list = ice_vc_hdr_list;
717*5de6c855SPrzemek Kitszel 	hdr_list_len = ARRAY_SIZE(ice_vc_hdr_list);
718*5de6c855SPrzemek Kitszel 
719*5de6c855SPrzemek Kitszel 	for (i = 0; i < rss_cfg->proto_hdrs.count; i++) {
720*5de6c855SPrzemek Kitszel 		struct virtchnl_proto_hdr *proto_hdr =
721*5de6c855SPrzemek Kitszel 					&rss_cfg->proto_hdrs.proto_hdr[i];
722*5de6c855SPrzemek Kitszel 		bool hdr_found = false;
723*5de6c855SPrzemek Kitszel 		int j;
724*5de6c855SPrzemek Kitszel 
725*5de6c855SPrzemek Kitszel 		/* Find matched ice headers according to virtchnl headers. */
726*5de6c855SPrzemek Kitszel 		for (j = 0; j < hdr_list_len; j++) {
727*5de6c855SPrzemek Kitszel 			struct ice_vc_hdr_match_type hdr_map = hdr_list[j];
728*5de6c855SPrzemek Kitszel 
729*5de6c855SPrzemek Kitszel 			if (proto_hdr->type == hdr_map.vc_hdr) {
730*5de6c855SPrzemek Kitszel 				*addl_hdrs |= hdr_map.ice_hdr;
731*5de6c855SPrzemek Kitszel 				hdr_found = true;
732*5de6c855SPrzemek Kitszel 			}
733*5de6c855SPrzemek Kitszel 		}
734*5de6c855SPrzemek Kitszel 
735*5de6c855SPrzemek Kitszel 		if (!hdr_found)
736*5de6c855SPrzemek Kitszel 			return false;
737*5de6c855SPrzemek Kitszel 
738*5de6c855SPrzemek Kitszel 		/* Find matched ice hash fields according to
739*5de6c855SPrzemek Kitszel 		 * virtchnl hash fields.
740*5de6c855SPrzemek Kitszel 		 */
741*5de6c855SPrzemek Kitszel 		for (j = 0; j < hf_list_len; j++) {
742*5de6c855SPrzemek Kitszel 			struct ice_vc_hash_field_match_type hf_map = hf_list[j];
743*5de6c855SPrzemek Kitszel 
744*5de6c855SPrzemek Kitszel 			if (proto_hdr->type == hf_map.vc_hdr &&
745*5de6c855SPrzemek Kitszel 			    proto_hdr->field_selector == hf_map.vc_hash_field) {
746*5de6c855SPrzemek Kitszel 				*hash_flds |= hf_map.ice_hash_field;
747*5de6c855SPrzemek Kitszel 				break;
748*5de6c855SPrzemek Kitszel 			}
749*5de6c855SPrzemek Kitszel 		}
750*5de6c855SPrzemek Kitszel 	}
751*5de6c855SPrzemek Kitszel 
752*5de6c855SPrzemek Kitszel 	return true;
753*5de6c855SPrzemek Kitszel }
754*5de6c855SPrzemek Kitszel 
755*5de6c855SPrzemek Kitszel /**
756*5de6c855SPrzemek Kitszel  * ice_vf_adv_rss_offload_ena - determine if capabilities support advanced
757*5de6c855SPrzemek Kitszel  * RSS offloads
758*5de6c855SPrzemek Kitszel  * @caps: VF driver negotiated capabilities
759*5de6c855SPrzemek Kitszel  *
760*5de6c855SPrzemek Kitszel  * Return true if VIRTCHNL_VF_OFFLOAD_ADV_RSS_PF capability is set,
761*5de6c855SPrzemek Kitszel  * else return false
762*5de6c855SPrzemek Kitszel  */
763*5de6c855SPrzemek Kitszel static bool ice_vf_adv_rss_offload_ena(u32 caps)
764*5de6c855SPrzemek Kitszel {
765*5de6c855SPrzemek Kitszel 	return !!(caps & VIRTCHNL_VF_OFFLOAD_ADV_RSS_PF);
766*5de6c855SPrzemek Kitszel }
767*5de6c855SPrzemek Kitszel 
768*5de6c855SPrzemek Kitszel /**
769*5de6c855SPrzemek Kitszel  * ice_vc_handle_rss_cfg
770*5de6c855SPrzemek Kitszel  * @vf: pointer to the VF info
771*5de6c855SPrzemek Kitszel  * @msg: pointer to the message buffer
772*5de6c855SPrzemek Kitszel  * @add: add a RSS config if true, otherwise delete a RSS config
773*5de6c855SPrzemek Kitszel  *
774*5de6c855SPrzemek Kitszel  * This function adds/deletes a RSS config
775*5de6c855SPrzemek Kitszel  */
776*5de6c855SPrzemek Kitszel static int ice_vc_handle_rss_cfg(struct ice_vf *vf, u8 *msg, bool add)
777*5de6c855SPrzemek Kitszel {
778*5de6c855SPrzemek Kitszel 	u32 v_opcode = add ? VIRTCHNL_OP_ADD_RSS_CFG : VIRTCHNL_OP_DEL_RSS_CFG;
779*5de6c855SPrzemek Kitszel 	struct virtchnl_rss_cfg *rss_cfg = (struct virtchnl_rss_cfg *)msg;
780*5de6c855SPrzemek Kitszel 	enum virtchnl_status_code v_ret = VIRTCHNL_STATUS_SUCCESS;
781*5de6c855SPrzemek Kitszel 	struct device *dev = ice_pf_to_dev(vf->pf);
782*5de6c855SPrzemek Kitszel 	struct ice_hw *hw = &vf->pf->hw;
783*5de6c855SPrzemek Kitszel 	struct ice_vsi *vsi;
784*5de6c855SPrzemek Kitszel 
785*5de6c855SPrzemek Kitszel 	if (!test_bit(ICE_FLAG_RSS_ENA, vf->pf->flags)) {
786*5de6c855SPrzemek Kitszel 		dev_dbg(dev, "VF %d attempting to configure RSS, but RSS is not supported by the PF\n",
787*5de6c855SPrzemek Kitszel 			vf->vf_id);
788*5de6c855SPrzemek Kitszel 		v_ret = VIRTCHNL_STATUS_ERR_NOT_SUPPORTED;
789*5de6c855SPrzemek Kitszel 		goto error_param;
790*5de6c855SPrzemek Kitszel 	}
791*5de6c855SPrzemek Kitszel 
792*5de6c855SPrzemek Kitszel 	if (!ice_vf_adv_rss_offload_ena(vf->driver_caps)) {
793*5de6c855SPrzemek Kitszel 		dev_dbg(dev, "VF %d attempting to configure RSS, but Advanced RSS offload is not supported\n",
794*5de6c855SPrzemek Kitszel 			vf->vf_id);
795*5de6c855SPrzemek Kitszel 		v_ret = VIRTCHNL_STATUS_ERR_PARAM;
796*5de6c855SPrzemek Kitszel 		goto error_param;
797*5de6c855SPrzemek Kitszel 	}
798*5de6c855SPrzemek Kitszel 
799*5de6c855SPrzemek Kitszel 	if (!test_bit(ICE_VF_STATE_ACTIVE, vf->vf_states)) {
800*5de6c855SPrzemek Kitszel 		v_ret = VIRTCHNL_STATUS_ERR_PARAM;
801*5de6c855SPrzemek Kitszel 		goto error_param;
802*5de6c855SPrzemek Kitszel 	}
803*5de6c855SPrzemek Kitszel 
804*5de6c855SPrzemek Kitszel 	if (rss_cfg->proto_hdrs.count > VIRTCHNL_MAX_NUM_PROTO_HDRS ||
805*5de6c855SPrzemek Kitszel 	    rss_cfg->rss_algorithm < VIRTCHNL_RSS_ALG_TOEPLITZ_ASYMMETRIC ||
806*5de6c855SPrzemek Kitszel 	    rss_cfg->rss_algorithm > VIRTCHNL_RSS_ALG_XOR_SYMMETRIC) {
807*5de6c855SPrzemek Kitszel 		dev_dbg(dev, "VF %d attempting to configure RSS, but RSS configuration is not valid\n",
808*5de6c855SPrzemek Kitszel 			vf->vf_id);
809*5de6c855SPrzemek Kitszel 		v_ret = VIRTCHNL_STATUS_ERR_PARAM;
810*5de6c855SPrzemek Kitszel 		goto error_param;
811*5de6c855SPrzemek Kitszel 	}
812*5de6c855SPrzemek Kitszel 
813*5de6c855SPrzemek Kitszel 	vsi = ice_get_vf_vsi(vf);
814*5de6c855SPrzemek Kitszel 	if (!vsi) {
815*5de6c855SPrzemek Kitszel 		v_ret = VIRTCHNL_STATUS_ERR_PARAM;
816*5de6c855SPrzemek Kitszel 		goto error_param;
817*5de6c855SPrzemek Kitszel 	}
818*5de6c855SPrzemek Kitszel 
819*5de6c855SPrzemek Kitszel 	if (!ice_vc_validate_pattern(vf, &rss_cfg->proto_hdrs)) {
820*5de6c855SPrzemek Kitszel 		v_ret = VIRTCHNL_STATUS_ERR_PARAM;
821*5de6c855SPrzemek Kitszel 		goto error_param;
822*5de6c855SPrzemek Kitszel 	}
823*5de6c855SPrzemek Kitszel 
824*5de6c855SPrzemek Kitszel 	if (rss_cfg->rss_algorithm == VIRTCHNL_RSS_ALG_R_ASYMMETRIC) {
825*5de6c855SPrzemek Kitszel 		struct ice_vsi_ctx *ctx;
826*5de6c855SPrzemek Kitszel 		u8 lut_type, hash_type;
827*5de6c855SPrzemek Kitszel 		int status;
828*5de6c855SPrzemek Kitszel 
829*5de6c855SPrzemek Kitszel 		lut_type = ICE_AQ_VSI_Q_OPT_RSS_LUT_VSI;
830*5de6c855SPrzemek Kitszel 		hash_type = add ? ICE_AQ_VSI_Q_OPT_RSS_HASH_XOR :
831*5de6c855SPrzemek Kitszel 				ICE_AQ_VSI_Q_OPT_RSS_HASH_TPLZ;
832*5de6c855SPrzemek Kitszel 
833*5de6c855SPrzemek Kitszel 		ctx = kzalloc(sizeof(*ctx), GFP_KERNEL);
834*5de6c855SPrzemek Kitszel 		if (!ctx) {
835*5de6c855SPrzemek Kitszel 			v_ret = VIRTCHNL_STATUS_ERR_NO_MEMORY;
836*5de6c855SPrzemek Kitszel 			goto error_param;
837*5de6c855SPrzemek Kitszel 		}
838*5de6c855SPrzemek Kitszel 
839*5de6c855SPrzemek Kitszel 		ctx->info.q_opt_rss =
840*5de6c855SPrzemek Kitszel 			FIELD_PREP(ICE_AQ_VSI_Q_OPT_RSS_LUT_M, lut_type) |
841*5de6c855SPrzemek Kitszel 			FIELD_PREP(ICE_AQ_VSI_Q_OPT_RSS_HASH_M, hash_type);
842*5de6c855SPrzemek Kitszel 
843*5de6c855SPrzemek Kitszel 		/* Preserve existing queueing option setting */
844*5de6c855SPrzemek Kitszel 		ctx->info.q_opt_rss |= (vsi->info.q_opt_rss &
845*5de6c855SPrzemek Kitszel 					  ICE_AQ_VSI_Q_OPT_RSS_GBL_LUT_M);
846*5de6c855SPrzemek Kitszel 		ctx->info.q_opt_tc = vsi->info.q_opt_tc;
847*5de6c855SPrzemek Kitszel 		ctx->info.q_opt_flags = vsi->info.q_opt_rss;
848*5de6c855SPrzemek Kitszel 
849*5de6c855SPrzemek Kitszel 		ctx->info.valid_sections =
850*5de6c855SPrzemek Kitszel 				cpu_to_le16(ICE_AQ_VSI_PROP_Q_OPT_VALID);
851*5de6c855SPrzemek Kitszel 
852*5de6c855SPrzemek Kitszel 		status = ice_update_vsi(hw, vsi->idx, ctx, NULL);
853*5de6c855SPrzemek Kitszel 		if (status) {
854*5de6c855SPrzemek Kitszel 			dev_err(dev, "update VSI for RSS failed, err %d aq_err %s\n",
855*5de6c855SPrzemek Kitszel 				status, libie_aq_str(hw->adminq.sq_last_status));
856*5de6c855SPrzemek Kitszel 			v_ret = VIRTCHNL_STATUS_ERR_PARAM;
857*5de6c855SPrzemek Kitszel 		} else {
858*5de6c855SPrzemek Kitszel 			vsi->info.q_opt_rss = ctx->info.q_opt_rss;
859*5de6c855SPrzemek Kitszel 		}
860*5de6c855SPrzemek Kitszel 
861*5de6c855SPrzemek Kitszel 		kfree(ctx);
862*5de6c855SPrzemek Kitszel 	} else {
863*5de6c855SPrzemek Kitszel 		struct ice_rss_hash_cfg cfg;
864*5de6c855SPrzemek Kitszel 
865*5de6c855SPrzemek Kitszel 		/* Only check for none raw pattern case */
866*5de6c855SPrzemek Kitszel 		if (!ice_vc_validate_pattern(vf, &rss_cfg->proto_hdrs)) {
867*5de6c855SPrzemek Kitszel 			v_ret = VIRTCHNL_STATUS_ERR_PARAM;
868*5de6c855SPrzemek Kitszel 			goto error_param;
869*5de6c855SPrzemek Kitszel 		}
870*5de6c855SPrzemek Kitszel 		cfg.addl_hdrs = ICE_FLOW_SEG_HDR_NONE;
871*5de6c855SPrzemek Kitszel 		cfg.hash_flds = ICE_HASH_INVALID;
872*5de6c855SPrzemek Kitszel 		cfg.hdr_type = ICE_RSS_ANY_HEADERS;
873*5de6c855SPrzemek Kitszel 
874*5de6c855SPrzemek Kitszel 		if (!ice_vc_parse_rss_cfg(hw, rss_cfg, &cfg)) {
875*5de6c855SPrzemek Kitszel 			v_ret = VIRTCHNL_STATUS_ERR_PARAM;
876*5de6c855SPrzemek Kitszel 			goto error_param;
877*5de6c855SPrzemek Kitszel 		}
878*5de6c855SPrzemek Kitszel 
879*5de6c855SPrzemek Kitszel 		if (add) {
880*5de6c855SPrzemek Kitszel 			if (ice_add_rss_cfg(hw, vsi, &cfg)) {
881*5de6c855SPrzemek Kitszel 				v_ret = VIRTCHNL_STATUS_ERR_PARAM;
882*5de6c855SPrzemek Kitszel 				dev_err(dev, "ice_add_rss_cfg failed for vsi = %d, v_ret = %d\n",
883*5de6c855SPrzemek Kitszel 					vsi->vsi_num, v_ret);
884*5de6c855SPrzemek Kitszel 			}
885*5de6c855SPrzemek Kitszel 		} else {
886*5de6c855SPrzemek Kitszel 			int status;
887*5de6c855SPrzemek Kitszel 
888*5de6c855SPrzemek Kitszel 			status = ice_rem_rss_cfg(hw, vsi->idx, &cfg);
889*5de6c855SPrzemek Kitszel 			/* We just ignore -ENOENT, because if two configurations
890*5de6c855SPrzemek Kitszel 			 * share the same profile remove one of them actually
891*5de6c855SPrzemek Kitszel 			 * removes both, since the profile is deleted.
892*5de6c855SPrzemek Kitszel 			 */
893*5de6c855SPrzemek Kitszel 			if (status && status != -ENOENT) {
894*5de6c855SPrzemek Kitszel 				v_ret = VIRTCHNL_STATUS_ERR_PARAM;
895*5de6c855SPrzemek Kitszel 				dev_err(dev, "ice_rem_rss_cfg failed for VF ID:%d, error:%d\n",
896*5de6c855SPrzemek Kitszel 					vf->vf_id, status);
897*5de6c855SPrzemek Kitszel 			}
898*5de6c855SPrzemek Kitszel 		}
899*5de6c855SPrzemek Kitszel 	}
900*5de6c855SPrzemek Kitszel 
901*5de6c855SPrzemek Kitszel error_param:
902*5de6c855SPrzemek Kitszel 	return ice_vc_send_msg_to_vf(vf, v_opcode, v_ret, NULL, 0);
903*5de6c855SPrzemek Kitszel }
904*5de6c855SPrzemek Kitszel 
905*5de6c855SPrzemek Kitszel /**
906*5de6c855SPrzemek Kitszel  * ice_vc_config_rss_key
907*5de6c855SPrzemek Kitszel  * @vf: pointer to the VF info
908*5de6c855SPrzemek Kitszel  * @msg: pointer to the msg buffer
909*5de6c855SPrzemek Kitszel  *
910*5de6c855SPrzemek Kitszel  * Configure the VF's RSS key
911*5de6c855SPrzemek Kitszel  */
912*5de6c855SPrzemek Kitszel static int ice_vc_config_rss_key(struct ice_vf *vf, u8 *msg)
913*5de6c855SPrzemek Kitszel {
914*5de6c855SPrzemek Kitszel 	enum virtchnl_status_code v_ret = VIRTCHNL_STATUS_SUCCESS;
915*5de6c855SPrzemek Kitszel 	struct virtchnl_rss_key *vrk =
916*5de6c855SPrzemek Kitszel 		(struct virtchnl_rss_key *)msg;
917*5de6c855SPrzemek Kitszel 	struct ice_vsi *vsi;
918*5de6c855SPrzemek Kitszel 
919*5de6c855SPrzemek Kitszel 	if (!test_bit(ICE_VF_STATE_ACTIVE, vf->vf_states)) {
920*5de6c855SPrzemek Kitszel 		v_ret = VIRTCHNL_STATUS_ERR_PARAM;
921*5de6c855SPrzemek Kitszel 		goto error_param;
922*5de6c855SPrzemek Kitszel 	}
923*5de6c855SPrzemek Kitszel 
924*5de6c855SPrzemek Kitszel 	if (!ice_vc_isvalid_vsi_id(vf, vrk->vsi_id)) {
925*5de6c855SPrzemek Kitszel 		v_ret = VIRTCHNL_STATUS_ERR_PARAM;
926*5de6c855SPrzemek Kitszel 		goto error_param;
927*5de6c855SPrzemek Kitszel 	}
928*5de6c855SPrzemek Kitszel 
929*5de6c855SPrzemek Kitszel 	if (vrk->key_len != ICE_VSIQF_HKEY_ARRAY_SIZE) {
930*5de6c855SPrzemek Kitszel 		v_ret = VIRTCHNL_STATUS_ERR_PARAM;
931*5de6c855SPrzemek Kitszel 		goto error_param;
932*5de6c855SPrzemek Kitszel 	}
933*5de6c855SPrzemek Kitszel 
934*5de6c855SPrzemek Kitszel 	if (!test_bit(ICE_FLAG_RSS_ENA, vf->pf->flags)) {
935*5de6c855SPrzemek Kitszel 		v_ret = VIRTCHNL_STATUS_ERR_PARAM;
936*5de6c855SPrzemek Kitszel 		goto error_param;
937*5de6c855SPrzemek Kitszel 	}
938*5de6c855SPrzemek Kitszel 
939*5de6c855SPrzemek Kitszel 	vsi = ice_get_vf_vsi(vf);
940*5de6c855SPrzemek Kitszel 	if (!vsi) {
941*5de6c855SPrzemek Kitszel 		v_ret = VIRTCHNL_STATUS_ERR_PARAM;
942*5de6c855SPrzemek Kitszel 		goto error_param;
943*5de6c855SPrzemek Kitszel 	}
944*5de6c855SPrzemek Kitszel 
945*5de6c855SPrzemek Kitszel 	if (ice_set_rss_key(vsi, vrk->key))
946*5de6c855SPrzemek Kitszel 		v_ret = VIRTCHNL_STATUS_ERR_ADMIN_QUEUE_ERROR;
947*5de6c855SPrzemek Kitszel error_param:
948*5de6c855SPrzemek Kitszel 	return ice_vc_send_msg_to_vf(vf, VIRTCHNL_OP_CONFIG_RSS_KEY, v_ret,
949*5de6c855SPrzemek Kitszel 				     NULL, 0);
950*5de6c855SPrzemek Kitszel }
951*5de6c855SPrzemek Kitszel 
952*5de6c855SPrzemek Kitszel /**
953*5de6c855SPrzemek Kitszel  * ice_vc_config_rss_lut
954*5de6c855SPrzemek Kitszel  * @vf: pointer to the VF info
955*5de6c855SPrzemek Kitszel  * @msg: pointer to the msg buffer
956*5de6c855SPrzemek Kitszel  *
957*5de6c855SPrzemek Kitszel  * Configure the VF's RSS LUT
958*5de6c855SPrzemek Kitszel  */
959*5de6c855SPrzemek Kitszel static int ice_vc_config_rss_lut(struct ice_vf *vf, u8 *msg)
960*5de6c855SPrzemek Kitszel {
961*5de6c855SPrzemek Kitszel 	struct virtchnl_rss_lut *vrl = (struct virtchnl_rss_lut *)msg;
962*5de6c855SPrzemek Kitszel 	enum virtchnl_status_code v_ret = VIRTCHNL_STATUS_SUCCESS;
963*5de6c855SPrzemek Kitszel 	struct ice_vsi *vsi;
964*5de6c855SPrzemek Kitszel 
965*5de6c855SPrzemek Kitszel 	if (!test_bit(ICE_VF_STATE_ACTIVE, vf->vf_states)) {
966*5de6c855SPrzemek Kitszel 		v_ret = VIRTCHNL_STATUS_ERR_PARAM;
967*5de6c855SPrzemek Kitszel 		goto error_param;
968*5de6c855SPrzemek Kitszel 	}
969*5de6c855SPrzemek Kitszel 
970*5de6c855SPrzemek Kitszel 	if (!ice_vc_isvalid_vsi_id(vf, vrl->vsi_id)) {
971*5de6c855SPrzemek Kitszel 		v_ret = VIRTCHNL_STATUS_ERR_PARAM;
972*5de6c855SPrzemek Kitszel 		goto error_param;
973*5de6c855SPrzemek Kitszel 	}
974*5de6c855SPrzemek Kitszel 
975*5de6c855SPrzemek Kitszel 	if (vrl->lut_entries != ICE_LUT_VSI_SIZE) {
976*5de6c855SPrzemek Kitszel 		v_ret = VIRTCHNL_STATUS_ERR_PARAM;
977*5de6c855SPrzemek Kitszel 		goto error_param;
978*5de6c855SPrzemek Kitszel 	}
979*5de6c855SPrzemek Kitszel 
980*5de6c855SPrzemek Kitszel 	if (!test_bit(ICE_FLAG_RSS_ENA, vf->pf->flags)) {
981*5de6c855SPrzemek Kitszel 		v_ret = VIRTCHNL_STATUS_ERR_PARAM;
982*5de6c855SPrzemek Kitszel 		goto error_param;
983*5de6c855SPrzemek Kitszel 	}
984*5de6c855SPrzemek Kitszel 
985*5de6c855SPrzemek Kitszel 	vsi = ice_get_vf_vsi(vf);
986*5de6c855SPrzemek Kitszel 	if (!vsi) {
987*5de6c855SPrzemek Kitszel 		v_ret = VIRTCHNL_STATUS_ERR_PARAM;
988*5de6c855SPrzemek Kitszel 		goto error_param;
989*5de6c855SPrzemek Kitszel 	}
990*5de6c855SPrzemek Kitszel 
991*5de6c855SPrzemek Kitszel 	if (ice_set_rss_lut(vsi, vrl->lut, ICE_LUT_VSI_SIZE))
992*5de6c855SPrzemek Kitszel 		v_ret = VIRTCHNL_STATUS_ERR_ADMIN_QUEUE_ERROR;
993*5de6c855SPrzemek Kitszel error_param:
994*5de6c855SPrzemek Kitszel 	return ice_vc_send_msg_to_vf(vf, VIRTCHNL_OP_CONFIG_RSS_LUT, v_ret,
995*5de6c855SPrzemek Kitszel 				     NULL, 0);
996*5de6c855SPrzemek Kitszel }
997*5de6c855SPrzemek Kitszel 
998*5de6c855SPrzemek Kitszel /**
999*5de6c855SPrzemek Kitszel  * ice_vc_config_rss_hfunc
1000*5de6c855SPrzemek Kitszel  * @vf: pointer to the VF info
1001*5de6c855SPrzemek Kitszel  * @msg: pointer to the msg buffer
1002*5de6c855SPrzemek Kitszel  *
1003*5de6c855SPrzemek Kitszel  * Configure the VF's RSS Hash function
1004*5de6c855SPrzemek Kitszel  */
1005*5de6c855SPrzemek Kitszel static int ice_vc_config_rss_hfunc(struct ice_vf *vf, u8 *msg)
1006*5de6c855SPrzemek Kitszel {
1007*5de6c855SPrzemek Kitszel 	struct virtchnl_rss_hfunc *vrh = (struct virtchnl_rss_hfunc *)msg;
1008*5de6c855SPrzemek Kitszel 	enum virtchnl_status_code v_ret = VIRTCHNL_STATUS_SUCCESS;
1009*5de6c855SPrzemek Kitszel 	u8 hfunc = ICE_AQ_VSI_Q_OPT_RSS_HASH_TPLZ;
1010*5de6c855SPrzemek Kitszel 	struct ice_vsi *vsi;
1011*5de6c855SPrzemek Kitszel 
1012*5de6c855SPrzemek Kitszel 	if (!test_bit(ICE_VF_STATE_ACTIVE, vf->vf_states)) {
1013*5de6c855SPrzemek Kitszel 		v_ret = VIRTCHNL_STATUS_ERR_PARAM;
1014*5de6c855SPrzemek Kitszel 		goto error_param;
1015*5de6c855SPrzemek Kitszel 	}
1016*5de6c855SPrzemek Kitszel 
1017*5de6c855SPrzemek Kitszel 	if (!ice_vc_isvalid_vsi_id(vf, vrh->vsi_id)) {
1018*5de6c855SPrzemek Kitszel 		v_ret = VIRTCHNL_STATUS_ERR_PARAM;
1019*5de6c855SPrzemek Kitszel 		goto error_param;
1020*5de6c855SPrzemek Kitszel 	}
1021*5de6c855SPrzemek Kitszel 
1022*5de6c855SPrzemek Kitszel 	if (!test_bit(ICE_FLAG_RSS_ENA, vf->pf->flags)) {
1023*5de6c855SPrzemek Kitszel 		v_ret = VIRTCHNL_STATUS_ERR_PARAM;
1024*5de6c855SPrzemek Kitszel 		goto error_param;
1025*5de6c855SPrzemek Kitszel 	}
1026*5de6c855SPrzemek Kitszel 
1027*5de6c855SPrzemek Kitszel 	vsi = ice_get_vf_vsi(vf);
1028*5de6c855SPrzemek Kitszel 	if (!vsi) {
1029*5de6c855SPrzemek Kitszel 		v_ret = VIRTCHNL_STATUS_ERR_PARAM;
1030*5de6c855SPrzemek Kitszel 		goto error_param;
1031*5de6c855SPrzemek Kitszel 	}
1032*5de6c855SPrzemek Kitszel 
1033*5de6c855SPrzemek Kitszel 	if (vrh->rss_algorithm == VIRTCHNL_RSS_ALG_TOEPLITZ_SYMMETRIC)
1034*5de6c855SPrzemek Kitszel 		hfunc = ICE_AQ_VSI_Q_OPT_RSS_HASH_SYM_TPLZ;
1035*5de6c855SPrzemek Kitszel 
1036*5de6c855SPrzemek Kitszel 	if (ice_set_rss_hfunc(vsi, hfunc))
1037*5de6c855SPrzemek Kitszel 		v_ret = VIRTCHNL_STATUS_ERR_ADMIN_QUEUE_ERROR;
1038*5de6c855SPrzemek Kitszel error_param:
1039*5de6c855SPrzemek Kitszel 	return ice_vc_send_msg_to_vf(vf, VIRTCHNL_OP_CONFIG_RSS_HFUNC, v_ret,
1040*5de6c855SPrzemek Kitszel 				     NULL, 0);
1041*5de6c855SPrzemek Kitszel }
1042*5de6c855SPrzemek Kitszel 
1043*5de6c855SPrzemek Kitszel /**
1044*5de6c855SPrzemek Kitszel  * ice_vc_get_qos_caps - Get current QoS caps from PF
1045*5de6c855SPrzemek Kitszel  * @vf: pointer to the VF info
1046*5de6c855SPrzemek Kitszel  *
1047*5de6c855SPrzemek Kitszel  * Get VF's QoS capabilities, such as TC number, arbiter and
1048*5de6c855SPrzemek Kitszel  * bandwidth from PF.
1049*5de6c855SPrzemek Kitszel  *
1050*5de6c855SPrzemek Kitszel  * Return: 0 on success or negative error value.
1051*5de6c855SPrzemek Kitszel  */
1052*5de6c855SPrzemek Kitszel static int ice_vc_get_qos_caps(struct ice_vf *vf)
1053*5de6c855SPrzemek Kitszel {
1054*5de6c855SPrzemek Kitszel 	enum virtchnl_status_code v_ret = VIRTCHNL_STATUS_SUCCESS;
1055*5de6c855SPrzemek Kitszel 	struct virtchnl_qos_cap_list *cap_list = NULL;
1056*5de6c855SPrzemek Kitszel 	u8 tc_prio[ICE_MAX_TRAFFIC_CLASS] = { 0 };
1057*5de6c855SPrzemek Kitszel 	struct virtchnl_qos_cap_elem *cfg = NULL;
1058*5de6c855SPrzemek Kitszel 	struct ice_vsi_ctx *vsi_ctx;
1059*5de6c855SPrzemek Kitszel 	struct ice_pf *pf = vf->pf;
1060*5de6c855SPrzemek Kitszel 	struct ice_port_info *pi;
1061*5de6c855SPrzemek Kitszel 	struct ice_vsi *vsi;
1062*5de6c855SPrzemek Kitszel 	u8 numtc, tc;
1063*5de6c855SPrzemek Kitszel 	u16 len = 0;
1064*5de6c855SPrzemek Kitszel 	int ret, i;
1065*5de6c855SPrzemek Kitszel 
1066*5de6c855SPrzemek Kitszel 	if (!test_bit(ICE_VF_STATE_ACTIVE, vf->vf_states)) {
1067*5de6c855SPrzemek Kitszel 		v_ret = VIRTCHNL_STATUS_ERR_PARAM;
1068*5de6c855SPrzemek Kitszel 		goto err;
1069*5de6c855SPrzemek Kitszel 	}
1070*5de6c855SPrzemek Kitszel 
1071*5de6c855SPrzemek Kitszel 	vsi = ice_get_vf_vsi(vf);
1072*5de6c855SPrzemek Kitszel 	if (!vsi) {
1073*5de6c855SPrzemek Kitszel 		v_ret = VIRTCHNL_STATUS_ERR_PARAM;
1074*5de6c855SPrzemek Kitszel 		goto err;
1075*5de6c855SPrzemek Kitszel 	}
1076*5de6c855SPrzemek Kitszel 
1077*5de6c855SPrzemek Kitszel 	pi = pf->hw.port_info;
1078*5de6c855SPrzemek Kitszel 	numtc = vsi->tc_cfg.numtc;
1079*5de6c855SPrzemek Kitszel 
1080*5de6c855SPrzemek Kitszel 	vsi_ctx = ice_get_vsi_ctx(pi->hw, vf->lan_vsi_idx);
1081*5de6c855SPrzemek Kitszel 	if (!vsi_ctx) {
1082*5de6c855SPrzemek Kitszel 		v_ret = VIRTCHNL_STATUS_ERR_PARAM;
1083*5de6c855SPrzemek Kitszel 		goto err;
1084*5de6c855SPrzemek Kitszel 	}
1085*5de6c855SPrzemek Kitszel 
1086*5de6c855SPrzemek Kitszel 	len = struct_size(cap_list, cap, numtc);
1087*5de6c855SPrzemek Kitszel 	cap_list = kzalloc(len, GFP_KERNEL);
1088*5de6c855SPrzemek Kitszel 	if (!cap_list) {
1089*5de6c855SPrzemek Kitszel 		v_ret = VIRTCHNL_STATUS_ERR_NO_MEMORY;
1090*5de6c855SPrzemek Kitszel 		len = 0;
1091*5de6c855SPrzemek Kitszel 		goto err;
1092*5de6c855SPrzemek Kitszel 	}
1093*5de6c855SPrzemek Kitszel 
1094*5de6c855SPrzemek Kitszel 	cap_list->vsi_id = vsi->vsi_num;
1095*5de6c855SPrzemek Kitszel 	cap_list->num_elem = numtc;
1096*5de6c855SPrzemek Kitszel 
1097*5de6c855SPrzemek Kitszel 	/* Store the UP2TC configuration from DCB to a user priority bitmap
1098*5de6c855SPrzemek Kitszel 	 * of each TC. Each element of prio_of_tc represents one TC. Each
1099*5de6c855SPrzemek Kitszel 	 * bitmap indicates the user priorities belong to this TC.
1100*5de6c855SPrzemek Kitszel 	 */
1101*5de6c855SPrzemek Kitszel 	for (i = 0; i < ICE_MAX_USER_PRIORITY; i++) {
1102*5de6c855SPrzemek Kitszel 		tc = pi->qos_cfg.local_dcbx_cfg.etscfg.prio_table[i];
1103*5de6c855SPrzemek Kitszel 		tc_prio[tc] |= BIT(i);
1104*5de6c855SPrzemek Kitszel 	}
1105*5de6c855SPrzemek Kitszel 
1106*5de6c855SPrzemek Kitszel 	for (i = 0; i < numtc; i++) {
1107*5de6c855SPrzemek Kitszel 		cfg = &cap_list->cap[i];
1108*5de6c855SPrzemek Kitszel 		cfg->tc_num = i;
1109*5de6c855SPrzemek Kitszel 		cfg->tc_prio = tc_prio[i];
1110*5de6c855SPrzemek Kitszel 		cfg->arbiter = pi->qos_cfg.local_dcbx_cfg.etscfg.tsatable[i];
1111*5de6c855SPrzemek Kitszel 		cfg->weight = VIRTCHNL_STRICT_WEIGHT;
1112*5de6c855SPrzemek Kitszel 		cfg->type = VIRTCHNL_BW_SHAPER;
1113*5de6c855SPrzemek Kitszel 		cfg->shaper.committed = vsi_ctx->sched.bw_t_info[i].cir_bw.bw;
1114*5de6c855SPrzemek Kitszel 		cfg->shaper.peak = vsi_ctx->sched.bw_t_info[i].eir_bw.bw;
1115*5de6c855SPrzemek Kitszel 	}
1116*5de6c855SPrzemek Kitszel 
1117*5de6c855SPrzemek Kitszel err:
1118*5de6c855SPrzemek Kitszel 	ret = ice_vc_send_msg_to_vf(vf, VIRTCHNL_OP_GET_QOS_CAPS, v_ret,
1119*5de6c855SPrzemek Kitszel 				    (u8 *)cap_list, len);
1120*5de6c855SPrzemek Kitszel 	kfree(cap_list);
1121*5de6c855SPrzemek Kitszel 	return ret;
1122*5de6c855SPrzemek Kitszel }
1123*5de6c855SPrzemek Kitszel 
1124*5de6c855SPrzemek Kitszel /**
1125*5de6c855SPrzemek Kitszel  * ice_vf_cfg_qs_bw - Configure per queue bandwidth
1126*5de6c855SPrzemek Kitszel  * @vf: pointer to the VF info
1127*5de6c855SPrzemek Kitszel  * @num_queues: number of queues to be configured
1128*5de6c855SPrzemek Kitszel  *
1129*5de6c855SPrzemek Kitszel  * Configure per queue bandwidth.
1130*5de6c855SPrzemek Kitszel  *
1131*5de6c855SPrzemek Kitszel  * Return: 0 on success or negative error value.
1132*5de6c855SPrzemek Kitszel  */
1133*5de6c855SPrzemek Kitszel static int ice_vf_cfg_qs_bw(struct ice_vf *vf, u16 num_queues)
1134*5de6c855SPrzemek Kitszel {
1135*5de6c855SPrzemek Kitszel 	struct ice_hw *hw = &vf->pf->hw;
1136*5de6c855SPrzemek Kitszel 	struct ice_vsi *vsi;
1137*5de6c855SPrzemek Kitszel 	int ret;
1138*5de6c855SPrzemek Kitszel 	u16 i;
1139*5de6c855SPrzemek Kitszel 
1140*5de6c855SPrzemek Kitszel 	vsi = ice_get_vf_vsi(vf);
1141*5de6c855SPrzemek Kitszel 	if (!vsi)
1142*5de6c855SPrzemek Kitszel 		return -EINVAL;
1143*5de6c855SPrzemek Kitszel 
1144*5de6c855SPrzemek Kitszel 	for (i = 0; i < num_queues; i++) {
1145*5de6c855SPrzemek Kitszel 		u32 p_rate, min_rate;
1146*5de6c855SPrzemek Kitszel 		u8 tc;
1147*5de6c855SPrzemek Kitszel 
1148*5de6c855SPrzemek Kitszel 		p_rate = vf->qs_bw[i].peak;
1149*5de6c855SPrzemek Kitszel 		min_rate = vf->qs_bw[i].committed;
1150*5de6c855SPrzemek Kitszel 		tc = vf->qs_bw[i].tc;
1151*5de6c855SPrzemek Kitszel 		if (p_rate)
1152*5de6c855SPrzemek Kitszel 			ret = ice_cfg_q_bw_lmt(hw->port_info, vsi->idx, tc,
1153*5de6c855SPrzemek Kitszel 					       vf->qs_bw[i].queue_id,
1154*5de6c855SPrzemek Kitszel 					       ICE_MAX_BW, p_rate);
1155*5de6c855SPrzemek Kitszel 		else
1156*5de6c855SPrzemek Kitszel 			ret = ice_cfg_q_bw_dflt_lmt(hw->port_info, vsi->idx, tc,
1157*5de6c855SPrzemek Kitszel 						    vf->qs_bw[i].queue_id,
1158*5de6c855SPrzemek Kitszel 						    ICE_MAX_BW);
1159*5de6c855SPrzemek Kitszel 		if (ret)
1160*5de6c855SPrzemek Kitszel 			return ret;
1161*5de6c855SPrzemek Kitszel 
1162*5de6c855SPrzemek Kitszel 		if (min_rate)
1163*5de6c855SPrzemek Kitszel 			ret = ice_cfg_q_bw_lmt(hw->port_info, vsi->idx, tc,
1164*5de6c855SPrzemek Kitszel 					       vf->qs_bw[i].queue_id,
1165*5de6c855SPrzemek Kitszel 					       ICE_MIN_BW, min_rate);
1166*5de6c855SPrzemek Kitszel 		else
1167*5de6c855SPrzemek Kitszel 			ret = ice_cfg_q_bw_dflt_lmt(hw->port_info, vsi->idx, tc,
1168*5de6c855SPrzemek Kitszel 						    vf->qs_bw[i].queue_id,
1169*5de6c855SPrzemek Kitszel 						    ICE_MIN_BW);
1170*5de6c855SPrzemek Kitszel 
1171*5de6c855SPrzemek Kitszel 		if (ret)
1172*5de6c855SPrzemek Kitszel 			return ret;
1173*5de6c855SPrzemek Kitszel 	}
1174*5de6c855SPrzemek Kitszel 
1175*5de6c855SPrzemek Kitszel 	return 0;
1176*5de6c855SPrzemek Kitszel }
1177*5de6c855SPrzemek Kitszel 
1178*5de6c855SPrzemek Kitszel /**
1179*5de6c855SPrzemek Kitszel  * ice_vf_cfg_q_quanta_profile - Configure quanta profile
1180*5de6c855SPrzemek Kitszel  * @vf: pointer to the VF info
1181*5de6c855SPrzemek Kitszel  * @quanta_prof_idx: pointer to the quanta profile index
1182*5de6c855SPrzemek Kitszel  * @quanta_size: quanta size to be set
1183*5de6c855SPrzemek Kitszel  *
1184*5de6c855SPrzemek Kitszel  * This function chooses available quanta profile and configures the register.
1185*5de6c855SPrzemek Kitszel  * The quanta profile is evenly divided by the number of device ports, and then
1186*5de6c855SPrzemek Kitszel  * available to the specific PF and VFs. The first profile for each PF is a
1187*5de6c855SPrzemek Kitszel  * reserved default profile. Only quanta size of the rest unused profile can be
1188*5de6c855SPrzemek Kitszel  * modified.
1189*5de6c855SPrzemek Kitszel  *
1190*5de6c855SPrzemek Kitszel  * Return: 0 on success or negative error value.
1191*5de6c855SPrzemek Kitszel  */
1192*5de6c855SPrzemek Kitszel static int ice_vf_cfg_q_quanta_profile(struct ice_vf *vf, u16 quanta_size,
1193*5de6c855SPrzemek Kitszel 				       u16 *quanta_prof_idx)
1194*5de6c855SPrzemek Kitszel {
1195*5de6c855SPrzemek Kitszel 	const u16 n_desc = calc_quanta_desc(quanta_size);
1196*5de6c855SPrzemek Kitszel 	struct ice_hw *hw = &vf->pf->hw;
1197*5de6c855SPrzemek Kitszel 	const u16 n_cmd = 2 * n_desc;
1198*5de6c855SPrzemek Kitszel 	struct ice_pf *pf = vf->pf;
1199*5de6c855SPrzemek Kitszel 	u16 per_pf, begin_id;
1200*5de6c855SPrzemek Kitszel 	u8 n_used;
1201*5de6c855SPrzemek Kitszel 	u32 reg;
1202*5de6c855SPrzemek Kitszel 
1203*5de6c855SPrzemek Kitszel 	begin_id = (GLCOMM_QUANTA_PROF_MAX_INDEX + 1) / hw->dev_caps.num_funcs *
1204*5de6c855SPrzemek Kitszel 		   hw->logical_pf_id;
1205*5de6c855SPrzemek Kitszel 
1206*5de6c855SPrzemek Kitszel 	if (quanta_size == ICE_DFLT_QUANTA) {
1207*5de6c855SPrzemek Kitszel 		*quanta_prof_idx = begin_id;
1208*5de6c855SPrzemek Kitszel 	} else {
1209*5de6c855SPrzemek Kitszel 		per_pf = (GLCOMM_QUANTA_PROF_MAX_INDEX + 1) /
1210*5de6c855SPrzemek Kitszel 			 hw->dev_caps.num_funcs;
1211*5de6c855SPrzemek Kitszel 		n_used = pf->num_quanta_prof_used;
1212*5de6c855SPrzemek Kitszel 		if (n_used < per_pf) {
1213*5de6c855SPrzemek Kitszel 			*quanta_prof_idx = begin_id + 1 + n_used;
1214*5de6c855SPrzemek Kitszel 			pf->num_quanta_prof_used++;
1215*5de6c855SPrzemek Kitszel 		} else {
1216*5de6c855SPrzemek Kitszel 			return -EINVAL;
1217*5de6c855SPrzemek Kitszel 		}
1218*5de6c855SPrzemek Kitszel 	}
1219*5de6c855SPrzemek Kitszel 
1220*5de6c855SPrzemek Kitszel 	reg = FIELD_PREP(GLCOMM_QUANTA_PROF_QUANTA_SIZE_M, quanta_size) |
1221*5de6c855SPrzemek Kitszel 	      FIELD_PREP(GLCOMM_QUANTA_PROF_MAX_CMD_M, n_cmd) |
1222*5de6c855SPrzemek Kitszel 	      FIELD_PREP(GLCOMM_QUANTA_PROF_MAX_DESC_M, n_desc);
1223*5de6c855SPrzemek Kitszel 	wr32(hw, GLCOMM_QUANTA_PROF(*quanta_prof_idx), reg);
1224*5de6c855SPrzemek Kitszel 
1225*5de6c855SPrzemek Kitszel 	return 0;
1226*5de6c855SPrzemek Kitszel }
1227*5de6c855SPrzemek Kitszel 
1228*5de6c855SPrzemek Kitszel /**
1229*5de6c855SPrzemek Kitszel  * ice_vc_cfg_promiscuous_mode_msg
1230*5de6c855SPrzemek Kitszel  * @vf: pointer to the VF info
1231*5de6c855SPrzemek Kitszel  * @msg: pointer to the msg buffer
1232*5de6c855SPrzemek Kitszel  *
1233*5de6c855SPrzemek Kitszel  * called from the VF to configure VF VSIs promiscuous mode
1234*5de6c855SPrzemek Kitszel  */
1235*5de6c855SPrzemek Kitszel static int ice_vc_cfg_promiscuous_mode_msg(struct ice_vf *vf, u8 *msg)
1236*5de6c855SPrzemek Kitszel {
1237*5de6c855SPrzemek Kitszel 	enum virtchnl_status_code v_ret = VIRTCHNL_STATUS_SUCCESS;
1238*5de6c855SPrzemek Kitszel 	bool rm_promisc, alluni = false, allmulti = false;
1239*5de6c855SPrzemek Kitszel 	struct virtchnl_promisc_info *info =
1240*5de6c855SPrzemek Kitszel 	    (struct virtchnl_promisc_info *)msg;
1241*5de6c855SPrzemek Kitszel 	struct ice_vsi_vlan_ops *vlan_ops;
1242*5de6c855SPrzemek Kitszel 	int mcast_err = 0, ucast_err = 0;
1243*5de6c855SPrzemek Kitszel 	struct ice_pf *pf = vf->pf;
1244*5de6c855SPrzemek Kitszel 	struct ice_vsi *vsi;
1245*5de6c855SPrzemek Kitszel 	u8 mcast_m, ucast_m;
1246*5de6c855SPrzemek Kitszel 	struct device *dev;
1247*5de6c855SPrzemek Kitszel 	int ret = 0;
1248*5de6c855SPrzemek Kitszel 
1249*5de6c855SPrzemek Kitszel 	if (!test_bit(ICE_VF_STATE_ACTIVE, vf->vf_states)) {
1250*5de6c855SPrzemek Kitszel 		v_ret = VIRTCHNL_STATUS_ERR_PARAM;
1251*5de6c855SPrzemek Kitszel 		goto error_param;
1252*5de6c855SPrzemek Kitszel 	}
1253*5de6c855SPrzemek Kitszel 
1254*5de6c855SPrzemek Kitszel 	if (!ice_vc_isvalid_vsi_id(vf, info->vsi_id)) {
1255*5de6c855SPrzemek Kitszel 		v_ret = VIRTCHNL_STATUS_ERR_PARAM;
1256*5de6c855SPrzemek Kitszel 		goto error_param;
1257*5de6c855SPrzemek Kitszel 	}
1258*5de6c855SPrzemek Kitszel 
1259*5de6c855SPrzemek Kitszel 	vsi = ice_get_vf_vsi(vf);
1260*5de6c855SPrzemek Kitszel 	if (!vsi) {
1261*5de6c855SPrzemek Kitszel 		v_ret = VIRTCHNL_STATUS_ERR_PARAM;
1262*5de6c855SPrzemek Kitszel 		goto error_param;
1263*5de6c855SPrzemek Kitszel 	}
1264*5de6c855SPrzemek Kitszel 
1265*5de6c855SPrzemek Kitszel 	dev = ice_pf_to_dev(pf);
1266*5de6c855SPrzemek Kitszel 	if (!ice_is_vf_trusted(vf)) {
1267*5de6c855SPrzemek Kitszel 		dev_err(dev, "Unprivileged VF %d is attempting to configure promiscuous mode\n",
1268*5de6c855SPrzemek Kitszel 			vf->vf_id);
1269*5de6c855SPrzemek Kitszel 		/* Leave v_ret alone, lie to the VF on purpose. */
1270*5de6c855SPrzemek Kitszel 		goto error_param;
1271*5de6c855SPrzemek Kitszel 	}
1272*5de6c855SPrzemek Kitszel 
1273*5de6c855SPrzemek Kitszel 	if (info->flags & FLAG_VF_UNICAST_PROMISC)
1274*5de6c855SPrzemek Kitszel 		alluni = true;
1275*5de6c855SPrzemek Kitszel 
1276*5de6c855SPrzemek Kitszel 	if (info->flags & FLAG_VF_MULTICAST_PROMISC)
1277*5de6c855SPrzemek Kitszel 		allmulti = true;
1278*5de6c855SPrzemek Kitszel 
1279*5de6c855SPrzemek Kitszel 	rm_promisc = !allmulti && !alluni;
1280*5de6c855SPrzemek Kitszel 
1281*5de6c855SPrzemek Kitszel 	vlan_ops = ice_get_compat_vsi_vlan_ops(vsi);
1282*5de6c855SPrzemek Kitszel 	if (rm_promisc)
1283*5de6c855SPrzemek Kitszel 		ret = vlan_ops->ena_rx_filtering(vsi);
1284*5de6c855SPrzemek Kitszel 	else
1285*5de6c855SPrzemek Kitszel 		ret = vlan_ops->dis_rx_filtering(vsi);
1286*5de6c855SPrzemek Kitszel 	if (ret) {
1287*5de6c855SPrzemek Kitszel 		dev_err(dev, "Failed to configure VLAN pruning in promiscuous mode\n");
1288*5de6c855SPrzemek Kitszel 		v_ret = VIRTCHNL_STATUS_ERR_PARAM;
1289*5de6c855SPrzemek Kitszel 		goto error_param;
1290*5de6c855SPrzemek Kitszel 	}
1291*5de6c855SPrzemek Kitszel 
1292*5de6c855SPrzemek Kitszel 	ice_vf_get_promisc_masks(vf, vsi, &ucast_m, &mcast_m);
1293*5de6c855SPrzemek Kitszel 
1294*5de6c855SPrzemek Kitszel 	if (!test_bit(ICE_FLAG_VF_TRUE_PROMISC_ENA, pf->flags)) {
1295*5de6c855SPrzemek Kitszel 		if (alluni) {
1296*5de6c855SPrzemek Kitszel 			/* in this case we're turning on promiscuous mode */
1297*5de6c855SPrzemek Kitszel 			ret = ice_set_dflt_vsi(vsi);
1298*5de6c855SPrzemek Kitszel 		} else {
1299*5de6c855SPrzemek Kitszel 			/* in this case we're turning off promiscuous mode */
1300*5de6c855SPrzemek Kitszel 			if (ice_is_dflt_vsi_in_use(vsi->port_info))
1301*5de6c855SPrzemek Kitszel 				ret = ice_clear_dflt_vsi(vsi);
1302*5de6c855SPrzemek Kitszel 		}
1303*5de6c855SPrzemek Kitszel 
1304*5de6c855SPrzemek Kitszel 		/* in this case we're turning on/off only
1305*5de6c855SPrzemek Kitszel 		 * allmulticast
1306*5de6c855SPrzemek Kitszel 		 */
1307*5de6c855SPrzemek Kitszel 		if (allmulti)
1308*5de6c855SPrzemek Kitszel 			mcast_err = ice_vf_set_vsi_promisc(vf, vsi, mcast_m);
1309*5de6c855SPrzemek Kitszel 		else
1310*5de6c855SPrzemek Kitszel 			mcast_err = ice_vf_clear_vsi_promisc(vf, vsi, mcast_m);
1311*5de6c855SPrzemek Kitszel 
1312*5de6c855SPrzemek Kitszel 		if (ret) {
1313*5de6c855SPrzemek Kitszel 			dev_err(dev, "Turning on/off promiscuous mode for VF %d failed, error: %d\n",
1314*5de6c855SPrzemek Kitszel 				vf->vf_id, ret);
1315*5de6c855SPrzemek Kitszel 			v_ret = VIRTCHNL_STATUS_ERR_ADMIN_QUEUE_ERROR;
1316*5de6c855SPrzemek Kitszel 			goto error_param;
1317*5de6c855SPrzemek Kitszel 		}
1318*5de6c855SPrzemek Kitszel 	} else {
1319*5de6c855SPrzemek Kitszel 		if (alluni)
1320*5de6c855SPrzemek Kitszel 			ucast_err = ice_vf_set_vsi_promisc(vf, vsi, ucast_m);
1321*5de6c855SPrzemek Kitszel 		else
1322*5de6c855SPrzemek Kitszel 			ucast_err = ice_vf_clear_vsi_promisc(vf, vsi, ucast_m);
1323*5de6c855SPrzemek Kitszel 
1324*5de6c855SPrzemek Kitszel 		if (allmulti)
1325*5de6c855SPrzemek Kitszel 			mcast_err = ice_vf_set_vsi_promisc(vf, vsi, mcast_m);
1326*5de6c855SPrzemek Kitszel 		else
1327*5de6c855SPrzemek Kitszel 			mcast_err = ice_vf_clear_vsi_promisc(vf, vsi, mcast_m);
1328*5de6c855SPrzemek Kitszel 
1329*5de6c855SPrzemek Kitszel 		if (ucast_err || mcast_err)
1330*5de6c855SPrzemek Kitszel 			v_ret = VIRTCHNL_STATUS_ERR_PARAM;
1331*5de6c855SPrzemek Kitszel 	}
1332*5de6c855SPrzemek Kitszel 
1333*5de6c855SPrzemek Kitszel 	if (!mcast_err) {
1334*5de6c855SPrzemek Kitszel 		if (allmulti &&
1335*5de6c855SPrzemek Kitszel 		    !test_and_set_bit(ICE_VF_STATE_MC_PROMISC, vf->vf_states))
1336*5de6c855SPrzemek Kitszel 			dev_info(dev, "VF %u successfully set multicast promiscuous mode\n",
1337*5de6c855SPrzemek Kitszel 				 vf->vf_id);
1338*5de6c855SPrzemek Kitszel 		else if (!allmulti &&
1339*5de6c855SPrzemek Kitszel 			 test_and_clear_bit(ICE_VF_STATE_MC_PROMISC,
1340*5de6c855SPrzemek Kitszel 					    vf->vf_states))
1341*5de6c855SPrzemek Kitszel 			dev_info(dev, "VF %u successfully unset multicast promiscuous mode\n",
1342*5de6c855SPrzemek Kitszel 				 vf->vf_id);
1343*5de6c855SPrzemek Kitszel 	} else {
1344*5de6c855SPrzemek Kitszel 		dev_err(dev, "Error while modifying multicast promiscuous mode for VF %u, error: %d\n",
1345*5de6c855SPrzemek Kitszel 			vf->vf_id, mcast_err);
1346*5de6c855SPrzemek Kitszel 	}
1347*5de6c855SPrzemek Kitszel 
1348*5de6c855SPrzemek Kitszel 	if (!ucast_err) {
1349*5de6c855SPrzemek Kitszel 		if (alluni &&
1350*5de6c855SPrzemek Kitszel 		    !test_and_set_bit(ICE_VF_STATE_UC_PROMISC, vf->vf_states))
1351*5de6c855SPrzemek Kitszel 			dev_info(dev, "VF %u successfully set unicast promiscuous mode\n",
1352*5de6c855SPrzemek Kitszel 				 vf->vf_id);
1353*5de6c855SPrzemek Kitszel 		else if (!alluni &&
1354*5de6c855SPrzemek Kitszel 			 test_and_clear_bit(ICE_VF_STATE_UC_PROMISC,
1355*5de6c855SPrzemek Kitszel 					    vf->vf_states))
1356*5de6c855SPrzemek Kitszel 			dev_info(dev, "VF %u successfully unset unicast promiscuous mode\n",
1357*5de6c855SPrzemek Kitszel 				 vf->vf_id);
1358*5de6c855SPrzemek Kitszel 	} else {
1359*5de6c855SPrzemek Kitszel 		dev_err(dev, "Error while modifying unicast promiscuous mode for VF %u, error: %d\n",
1360*5de6c855SPrzemek Kitszel 			vf->vf_id, ucast_err);
1361*5de6c855SPrzemek Kitszel 	}
1362*5de6c855SPrzemek Kitszel 
1363*5de6c855SPrzemek Kitszel error_param:
1364*5de6c855SPrzemek Kitszel 	return ice_vc_send_msg_to_vf(vf, VIRTCHNL_OP_CONFIG_PROMISCUOUS_MODE,
1365*5de6c855SPrzemek Kitszel 				     v_ret, NULL, 0);
1366*5de6c855SPrzemek Kitszel }
1367*5de6c855SPrzemek Kitszel 
1368*5de6c855SPrzemek Kitszel /**
1369*5de6c855SPrzemek Kitszel  * ice_vc_get_stats_msg
1370*5de6c855SPrzemek Kitszel  * @vf: pointer to the VF info
1371*5de6c855SPrzemek Kitszel  * @msg: pointer to the msg buffer
1372*5de6c855SPrzemek Kitszel  *
1373*5de6c855SPrzemek Kitszel  * called from the VF to get VSI stats
1374*5de6c855SPrzemek Kitszel  */
1375*5de6c855SPrzemek Kitszel static int ice_vc_get_stats_msg(struct ice_vf *vf, u8 *msg)
1376*5de6c855SPrzemek Kitszel {
1377*5de6c855SPrzemek Kitszel 	enum virtchnl_status_code v_ret = VIRTCHNL_STATUS_SUCCESS;
1378*5de6c855SPrzemek Kitszel 	struct virtchnl_queue_select *vqs =
1379*5de6c855SPrzemek Kitszel 		(struct virtchnl_queue_select *)msg;
1380*5de6c855SPrzemek Kitszel 	struct ice_eth_stats stats = { 0 };
1381*5de6c855SPrzemek Kitszel 	struct ice_vsi *vsi;
1382*5de6c855SPrzemek Kitszel 
1383*5de6c855SPrzemek Kitszel 	if (!test_bit(ICE_VF_STATE_ACTIVE, vf->vf_states)) {
1384*5de6c855SPrzemek Kitszel 		v_ret = VIRTCHNL_STATUS_ERR_PARAM;
1385*5de6c855SPrzemek Kitszel 		goto error_param;
1386*5de6c855SPrzemek Kitszel 	}
1387*5de6c855SPrzemek Kitszel 
1388*5de6c855SPrzemek Kitszel 	if (!ice_vc_isvalid_vsi_id(vf, vqs->vsi_id)) {
1389*5de6c855SPrzemek Kitszel 		v_ret = VIRTCHNL_STATUS_ERR_PARAM;
1390*5de6c855SPrzemek Kitszel 		goto error_param;
1391*5de6c855SPrzemek Kitszel 	}
1392*5de6c855SPrzemek Kitszel 
1393*5de6c855SPrzemek Kitszel 	vsi = ice_get_vf_vsi(vf);
1394*5de6c855SPrzemek Kitszel 	if (!vsi) {
1395*5de6c855SPrzemek Kitszel 		v_ret = VIRTCHNL_STATUS_ERR_PARAM;
1396*5de6c855SPrzemek Kitszel 		goto error_param;
1397*5de6c855SPrzemek Kitszel 	}
1398*5de6c855SPrzemek Kitszel 
1399*5de6c855SPrzemek Kitszel 	ice_update_eth_stats(vsi);
1400*5de6c855SPrzemek Kitszel 
1401*5de6c855SPrzemek Kitszel 	stats = vsi->eth_stats;
1402*5de6c855SPrzemek Kitszel 
1403*5de6c855SPrzemek Kitszel error_param:
1404*5de6c855SPrzemek Kitszel 	/* send the response to the VF */
1405*5de6c855SPrzemek Kitszel 	return ice_vc_send_msg_to_vf(vf, VIRTCHNL_OP_GET_STATS, v_ret,
1406*5de6c855SPrzemek Kitszel 				     (u8 *)&stats, sizeof(stats));
1407*5de6c855SPrzemek Kitszel }
1408*5de6c855SPrzemek Kitszel 
1409*5de6c855SPrzemek Kitszel /**
1410*5de6c855SPrzemek Kitszel  * ice_vc_validate_vqs_bitmaps - validate Rx/Tx queue bitmaps from VIRTCHNL
1411*5de6c855SPrzemek Kitszel  * @vqs: virtchnl_queue_select structure containing bitmaps to validate
1412*5de6c855SPrzemek Kitszel  *
1413*5de6c855SPrzemek Kitszel  * Return true on successful validation, else false
1414*5de6c855SPrzemek Kitszel  */
1415*5de6c855SPrzemek Kitszel static bool ice_vc_validate_vqs_bitmaps(struct virtchnl_queue_select *vqs)
1416*5de6c855SPrzemek Kitszel {
1417*5de6c855SPrzemek Kitszel 	if ((!vqs->rx_queues && !vqs->tx_queues) ||
1418*5de6c855SPrzemek Kitszel 	    vqs->rx_queues >= BIT(ICE_MAX_RSS_QS_PER_VF) ||
1419*5de6c855SPrzemek Kitszel 	    vqs->tx_queues >= BIT(ICE_MAX_RSS_QS_PER_VF))
1420*5de6c855SPrzemek Kitszel 		return false;
1421*5de6c855SPrzemek Kitszel 
1422*5de6c855SPrzemek Kitszel 	return true;
1423*5de6c855SPrzemek Kitszel }
1424*5de6c855SPrzemek Kitszel 
1425*5de6c855SPrzemek Kitszel /**
1426*5de6c855SPrzemek Kitszel  * ice_vf_ena_txq_interrupt - enable Tx queue interrupt via QINT_TQCTL
1427*5de6c855SPrzemek Kitszel  * @vsi: VSI of the VF to configure
1428*5de6c855SPrzemek Kitszel  * @q_idx: VF queue index used to determine the queue in the PF's space
1429*5de6c855SPrzemek Kitszel  */
1430*5de6c855SPrzemek Kitszel void ice_vf_ena_txq_interrupt(struct ice_vsi *vsi, u32 q_idx)
1431*5de6c855SPrzemek Kitszel {
1432*5de6c855SPrzemek Kitszel 	struct ice_hw *hw = &vsi->back->hw;
1433*5de6c855SPrzemek Kitszel 	u32 pfq = vsi->txq_map[q_idx];
1434*5de6c855SPrzemek Kitszel 	u32 reg;
1435*5de6c855SPrzemek Kitszel 
1436*5de6c855SPrzemek Kitszel 	reg = rd32(hw, QINT_TQCTL(pfq));
1437*5de6c855SPrzemek Kitszel 
1438*5de6c855SPrzemek Kitszel 	/* MSI-X index 0 in the VF's space is always for the OICR, which means
1439*5de6c855SPrzemek Kitszel 	 * this is most likely a poll mode VF driver, so don't enable an
1440*5de6c855SPrzemek Kitszel 	 * interrupt that was never configured via VIRTCHNL_OP_CONFIG_IRQ_MAP
1441*5de6c855SPrzemek Kitszel 	 */
1442*5de6c855SPrzemek Kitszel 	if (!(reg & QINT_TQCTL_MSIX_INDX_M))
1443*5de6c855SPrzemek Kitszel 		return;
1444*5de6c855SPrzemek Kitszel 
1445*5de6c855SPrzemek Kitszel 	wr32(hw, QINT_TQCTL(pfq), reg | QINT_TQCTL_CAUSE_ENA_M);
1446*5de6c855SPrzemek Kitszel }
1447*5de6c855SPrzemek Kitszel 
1448*5de6c855SPrzemek Kitszel /**
1449*5de6c855SPrzemek Kitszel  * ice_vf_ena_rxq_interrupt - enable Tx queue interrupt via QINT_RQCTL
1450*5de6c855SPrzemek Kitszel  * @vsi: VSI of the VF to configure
1451*5de6c855SPrzemek Kitszel  * @q_idx: VF queue index used to determine the queue in the PF's space
1452*5de6c855SPrzemek Kitszel  */
1453*5de6c855SPrzemek Kitszel void ice_vf_ena_rxq_interrupt(struct ice_vsi *vsi, u32 q_idx)
1454*5de6c855SPrzemek Kitszel {
1455*5de6c855SPrzemek Kitszel 	struct ice_hw *hw = &vsi->back->hw;
1456*5de6c855SPrzemek Kitszel 	u32 pfq = vsi->rxq_map[q_idx];
1457*5de6c855SPrzemek Kitszel 	u32 reg;
1458*5de6c855SPrzemek Kitszel 
1459*5de6c855SPrzemek Kitszel 	reg = rd32(hw, QINT_RQCTL(pfq));
1460*5de6c855SPrzemek Kitszel 
1461*5de6c855SPrzemek Kitszel 	/* MSI-X index 0 in the VF's space is always for the OICR, which means
1462*5de6c855SPrzemek Kitszel 	 * this is most likely a poll mode VF driver, so don't enable an
1463*5de6c855SPrzemek Kitszel 	 * interrupt that was never configured via VIRTCHNL_OP_CONFIG_IRQ_MAP
1464*5de6c855SPrzemek Kitszel 	 */
1465*5de6c855SPrzemek Kitszel 	if (!(reg & QINT_RQCTL_MSIX_INDX_M))
1466*5de6c855SPrzemek Kitszel 		return;
1467*5de6c855SPrzemek Kitszel 
1468*5de6c855SPrzemek Kitszel 	wr32(hw, QINT_RQCTL(pfq), reg | QINT_RQCTL_CAUSE_ENA_M);
1469*5de6c855SPrzemek Kitszel }
1470*5de6c855SPrzemek Kitszel 
1471*5de6c855SPrzemek Kitszel /**
1472*5de6c855SPrzemek Kitszel  * ice_vc_ena_qs_msg
1473*5de6c855SPrzemek Kitszel  * @vf: pointer to the VF info
1474*5de6c855SPrzemek Kitszel  * @msg: pointer to the msg buffer
1475*5de6c855SPrzemek Kitszel  *
1476*5de6c855SPrzemek Kitszel  * called from the VF to enable all or specific queue(s)
1477*5de6c855SPrzemek Kitszel  */
1478*5de6c855SPrzemek Kitszel static int ice_vc_ena_qs_msg(struct ice_vf *vf, u8 *msg)
1479*5de6c855SPrzemek Kitszel {
1480*5de6c855SPrzemek Kitszel 	enum virtchnl_status_code v_ret = VIRTCHNL_STATUS_SUCCESS;
1481*5de6c855SPrzemek Kitszel 	struct virtchnl_queue_select *vqs =
1482*5de6c855SPrzemek Kitszel 	    (struct virtchnl_queue_select *)msg;
1483*5de6c855SPrzemek Kitszel 	struct ice_vsi *vsi;
1484*5de6c855SPrzemek Kitszel 	unsigned long q_map;
1485*5de6c855SPrzemek Kitszel 	u16 vf_q_id;
1486*5de6c855SPrzemek Kitszel 
1487*5de6c855SPrzemek Kitszel 	if (!test_bit(ICE_VF_STATE_ACTIVE, vf->vf_states)) {
1488*5de6c855SPrzemek Kitszel 		v_ret = VIRTCHNL_STATUS_ERR_PARAM;
1489*5de6c855SPrzemek Kitszel 		goto error_param;
1490*5de6c855SPrzemek Kitszel 	}
1491*5de6c855SPrzemek Kitszel 
1492*5de6c855SPrzemek Kitszel 	if (!ice_vc_isvalid_vsi_id(vf, vqs->vsi_id)) {
1493*5de6c855SPrzemek Kitszel 		v_ret = VIRTCHNL_STATUS_ERR_PARAM;
1494*5de6c855SPrzemek Kitszel 		goto error_param;
1495*5de6c855SPrzemek Kitszel 	}
1496*5de6c855SPrzemek Kitszel 
1497*5de6c855SPrzemek Kitszel 	if (!ice_vc_validate_vqs_bitmaps(vqs)) {
1498*5de6c855SPrzemek Kitszel 		v_ret = VIRTCHNL_STATUS_ERR_PARAM;
1499*5de6c855SPrzemek Kitszel 		goto error_param;
1500*5de6c855SPrzemek Kitszel 	}
1501*5de6c855SPrzemek Kitszel 
1502*5de6c855SPrzemek Kitszel 	vsi = ice_get_vf_vsi(vf);
1503*5de6c855SPrzemek Kitszel 	if (!vsi) {
1504*5de6c855SPrzemek Kitszel 		v_ret = VIRTCHNL_STATUS_ERR_PARAM;
1505*5de6c855SPrzemek Kitszel 		goto error_param;
1506*5de6c855SPrzemek Kitszel 	}
1507*5de6c855SPrzemek Kitszel 
1508*5de6c855SPrzemek Kitszel 	/* Enable only Rx rings, Tx rings were enabled by the FW when the
1509*5de6c855SPrzemek Kitszel 	 * Tx queue group list was configured and the context bits were
1510*5de6c855SPrzemek Kitszel 	 * programmed using ice_vsi_cfg_txqs
1511*5de6c855SPrzemek Kitszel 	 */
1512*5de6c855SPrzemek Kitszel 	q_map = vqs->rx_queues;
1513*5de6c855SPrzemek Kitszel 	for_each_set_bit(vf_q_id, &q_map, ICE_MAX_RSS_QS_PER_VF) {
1514*5de6c855SPrzemek Kitszel 		if (!ice_vc_isvalid_q_id(vsi, vf_q_id)) {
1515*5de6c855SPrzemek Kitszel 			v_ret = VIRTCHNL_STATUS_ERR_PARAM;
1516*5de6c855SPrzemek Kitszel 			goto error_param;
1517*5de6c855SPrzemek Kitszel 		}
1518*5de6c855SPrzemek Kitszel 
1519*5de6c855SPrzemek Kitszel 		/* Skip queue if enabled */
1520*5de6c855SPrzemek Kitszel 		if (test_bit(vf_q_id, vf->rxq_ena))
1521*5de6c855SPrzemek Kitszel 			continue;
1522*5de6c855SPrzemek Kitszel 
1523*5de6c855SPrzemek Kitszel 		if (ice_vsi_ctrl_one_rx_ring(vsi, true, vf_q_id, true)) {
1524*5de6c855SPrzemek Kitszel 			dev_err(ice_pf_to_dev(vsi->back), "Failed to enable Rx ring %d on VSI %d\n",
1525*5de6c855SPrzemek Kitszel 				vf_q_id, vsi->vsi_num);
1526*5de6c855SPrzemek Kitszel 			v_ret = VIRTCHNL_STATUS_ERR_PARAM;
1527*5de6c855SPrzemek Kitszel 			goto error_param;
1528*5de6c855SPrzemek Kitszel 		}
1529*5de6c855SPrzemek Kitszel 
1530*5de6c855SPrzemek Kitszel 		ice_vf_ena_rxq_interrupt(vsi, vf_q_id);
1531*5de6c855SPrzemek Kitszel 		set_bit(vf_q_id, vf->rxq_ena);
1532*5de6c855SPrzemek Kitszel 	}
1533*5de6c855SPrzemek Kitszel 
1534*5de6c855SPrzemek Kitszel 	q_map = vqs->tx_queues;
1535*5de6c855SPrzemek Kitszel 	for_each_set_bit(vf_q_id, &q_map, ICE_MAX_RSS_QS_PER_VF) {
1536*5de6c855SPrzemek Kitszel 		if (!ice_vc_isvalid_q_id(vsi, vf_q_id)) {
1537*5de6c855SPrzemek Kitszel 			v_ret = VIRTCHNL_STATUS_ERR_PARAM;
1538*5de6c855SPrzemek Kitszel 			goto error_param;
1539*5de6c855SPrzemek Kitszel 		}
1540*5de6c855SPrzemek Kitszel 
1541*5de6c855SPrzemek Kitszel 		/* Skip queue if enabled */
1542*5de6c855SPrzemek Kitszel 		if (test_bit(vf_q_id, vf->txq_ena))
1543*5de6c855SPrzemek Kitszel 			continue;
1544*5de6c855SPrzemek Kitszel 
1545*5de6c855SPrzemek Kitszel 		ice_vf_ena_txq_interrupt(vsi, vf_q_id);
1546*5de6c855SPrzemek Kitszel 		set_bit(vf_q_id, vf->txq_ena);
1547*5de6c855SPrzemek Kitszel 	}
1548*5de6c855SPrzemek Kitszel 
1549*5de6c855SPrzemek Kitszel 	/* Set flag to indicate that queues are enabled */
1550*5de6c855SPrzemek Kitszel 	if (v_ret == VIRTCHNL_STATUS_SUCCESS)
1551*5de6c855SPrzemek Kitszel 		set_bit(ICE_VF_STATE_QS_ENA, vf->vf_states);
1552*5de6c855SPrzemek Kitszel 
1553*5de6c855SPrzemek Kitszel error_param:
1554*5de6c855SPrzemek Kitszel 	/* send the response to the VF */
1555*5de6c855SPrzemek Kitszel 	return ice_vc_send_msg_to_vf(vf, VIRTCHNL_OP_ENABLE_QUEUES, v_ret,
1556*5de6c855SPrzemek Kitszel 				     NULL, 0);
1557*5de6c855SPrzemek Kitszel }
1558*5de6c855SPrzemek Kitszel 
1559*5de6c855SPrzemek Kitszel /**
1560*5de6c855SPrzemek Kitszel  * ice_vf_vsi_dis_single_txq - disable a single Tx queue
1561*5de6c855SPrzemek Kitszel  * @vf: VF to disable queue for
1562*5de6c855SPrzemek Kitszel  * @vsi: VSI for the VF
1563*5de6c855SPrzemek Kitszel  * @q_id: VF relative (0-based) queue ID
1564*5de6c855SPrzemek Kitszel  *
1565*5de6c855SPrzemek Kitszel  * Attempt to disable the Tx queue passed in. If the Tx queue was successfully
1566*5de6c855SPrzemek Kitszel  * disabled then clear q_id bit in the enabled queues bitmap and return
1567*5de6c855SPrzemek Kitszel  * success. Otherwise return error.
1568*5de6c855SPrzemek Kitszel  */
1569*5de6c855SPrzemek Kitszel int ice_vf_vsi_dis_single_txq(struct ice_vf *vf, struct ice_vsi *vsi, u16 q_id)
1570*5de6c855SPrzemek Kitszel {
1571*5de6c855SPrzemek Kitszel 	struct ice_txq_meta txq_meta = { 0 };
1572*5de6c855SPrzemek Kitszel 	struct ice_tx_ring *ring;
1573*5de6c855SPrzemek Kitszel 	int err;
1574*5de6c855SPrzemek Kitszel 
1575*5de6c855SPrzemek Kitszel 	if (!test_bit(q_id, vf->txq_ena))
1576*5de6c855SPrzemek Kitszel 		dev_dbg(ice_pf_to_dev(vsi->back), "Queue %u on VSI %u is not enabled, but stopping it anyway\n",
1577*5de6c855SPrzemek Kitszel 			q_id, vsi->vsi_num);
1578*5de6c855SPrzemek Kitszel 
1579*5de6c855SPrzemek Kitszel 	ring = vsi->tx_rings[q_id];
1580*5de6c855SPrzemek Kitszel 	if (!ring)
1581*5de6c855SPrzemek Kitszel 		return -EINVAL;
1582*5de6c855SPrzemek Kitszel 
1583*5de6c855SPrzemek Kitszel 	ice_fill_txq_meta(vsi, ring, &txq_meta);
1584*5de6c855SPrzemek Kitszel 
1585*5de6c855SPrzemek Kitszel 	err = ice_vsi_stop_tx_ring(vsi, ICE_NO_RESET, vf->vf_id, ring, &txq_meta);
1586*5de6c855SPrzemek Kitszel 	if (err) {
1587*5de6c855SPrzemek Kitszel 		dev_err(ice_pf_to_dev(vsi->back), "Failed to stop Tx ring %d on VSI %d\n",
1588*5de6c855SPrzemek Kitszel 			q_id, vsi->vsi_num);
1589*5de6c855SPrzemek Kitszel 		return err;
1590*5de6c855SPrzemek Kitszel 	}
1591*5de6c855SPrzemek Kitszel 
1592*5de6c855SPrzemek Kitszel 	/* Clear enabled queues flag */
1593*5de6c855SPrzemek Kitszel 	clear_bit(q_id, vf->txq_ena);
1594*5de6c855SPrzemek Kitszel 
1595*5de6c855SPrzemek Kitszel 	return 0;
1596*5de6c855SPrzemek Kitszel }
1597*5de6c855SPrzemek Kitszel 
1598*5de6c855SPrzemek Kitszel /**
1599*5de6c855SPrzemek Kitszel  * ice_vc_dis_qs_msg
1600*5de6c855SPrzemek Kitszel  * @vf: pointer to the VF info
1601*5de6c855SPrzemek Kitszel  * @msg: pointer to the msg buffer
1602*5de6c855SPrzemek Kitszel  *
1603*5de6c855SPrzemek Kitszel  * called from the VF to disable all or specific queue(s)
1604*5de6c855SPrzemek Kitszel  */
1605*5de6c855SPrzemek Kitszel static int ice_vc_dis_qs_msg(struct ice_vf *vf, u8 *msg)
1606*5de6c855SPrzemek Kitszel {
1607*5de6c855SPrzemek Kitszel 	enum virtchnl_status_code v_ret = VIRTCHNL_STATUS_SUCCESS;
1608*5de6c855SPrzemek Kitszel 	struct virtchnl_queue_select *vqs =
1609*5de6c855SPrzemek Kitszel 	    (struct virtchnl_queue_select *)msg;
1610*5de6c855SPrzemek Kitszel 	struct ice_vsi *vsi;
1611*5de6c855SPrzemek Kitszel 	unsigned long q_map;
1612*5de6c855SPrzemek Kitszel 	u16 vf_q_id;
1613*5de6c855SPrzemek Kitszel 
1614*5de6c855SPrzemek Kitszel 	if (!test_bit(ICE_VF_STATE_ACTIVE, vf->vf_states) &&
1615*5de6c855SPrzemek Kitszel 	    !test_bit(ICE_VF_STATE_QS_ENA, vf->vf_states)) {
1616*5de6c855SPrzemek Kitszel 		v_ret = VIRTCHNL_STATUS_ERR_PARAM;
1617*5de6c855SPrzemek Kitszel 		goto error_param;
1618*5de6c855SPrzemek Kitszel 	}
1619*5de6c855SPrzemek Kitszel 
1620*5de6c855SPrzemek Kitszel 	if (!ice_vc_isvalid_vsi_id(vf, vqs->vsi_id)) {
1621*5de6c855SPrzemek Kitszel 		v_ret = VIRTCHNL_STATUS_ERR_PARAM;
1622*5de6c855SPrzemek Kitszel 		goto error_param;
1623*5de6c855SPrzemek Kitszel 	}
1624*5de6c855SPrzemek Kitszel 
1625*5de6c855SPrzemek Kitszel 	if (!ice_vc_validate_vqs_bitmaps(vqs)) {
1626*5de6c855SPrzemek Kitszel 		v_ret = VIRTCHNL_STATUS_ERR_PARAM;
1627*5de6c855SPrzemek Kitszel 		goto error_param;
1628*5de6c855SPrzemek Kitszel 	}
1629*5de6c855SPrzemek Kitszel 
1630*5de6c855SPrzemek Kitszel 	vsi = ice_get_vf_vsi(vf);
1631*5de6c855SPrzemek Kitszel 	if (!vsi) {
1632*5de6c855SPrzemek Kitszel 		v_ret = VIRTCHNL_STATUS_ERR_PARAM;
1633*5de6c855SPrzemek Kitszel 		goto error_param;
1634*5de6c855SPrzemek Kitszel 	}
1635*5de6c855SPrzemek Kitszel 
1636*5de6c855SPrzemek Kitszel 	if (vqs->tx_queues) {
1637*5de6c855SPrzemek Kitszel 		q_map = vqs->tx_queues;
1638*5de6c855SPrzemek Kitszel 
1639*5de6c855SPrzemek Kitszel 		for_each_set_bit(vf_q_id, &q_map, ICE_MAX_RSS_QS_PER_VF) {
1640*5de6c855SPrzemek Kitszel 			if (!ice_vc_isvalid_q_id(vsi, vf_q_id)) {
1641*5de6c855SPrzemek Kitszel 				v_ret = VIRTCHNL_STATUS_ERR_PARAM;
1642*5de6c855SPrzemek Kitszel 				goto error_param;
1643*5de6c855SPrzemek Kitszel 			}
1644*5de6c855SPrzemek Kitszel 
1645*5de6c855SPrzemek Kitszel 			if (ice_vf_vsi_dis_single_txq(vf, vsi, vf_q_id)) {
1646*5de6c855SPrzemek Kitszel 				v_ret = VIRTCHNL_STATUS_ERR_PARAM;
1647*5de6c855SPrzemek Kitszel 				goto error_param;
1648*5de6c855SPrzemek Kitszel 			}
1649*5de6c855SPrzemek Kitszel 		}
1650*5de6c855SPrzemek Kitszel 	}
1651*5de6c855SPrzemek Kitszel 
1652*5de6c855SPrzemek Kitszel 	q_map = vqs->rx_queues;
1653*5de6c855SPrzemek Kitszel 	/* speed up Rx queue disable by batching them if possible */
1654*5de6c855SPrzemek Kitszel 	if (q_map &&
1655*5de6c855SPrzemek Kitszel 	    bitmap_equal(&q_map, vf->rxq_ena, ICE_MAX_RSS_QS_PER_VF)) {
1656*5de6c855SPrzemek Kitszel 		if (ice_vsi_stop_all_rx_rings(vsi)) {
1657*5de6c855SPrzemek Kitszel 			dev_err(ice_pf_to_dev(vsi->back), "Failed to stop all Rx rings on VSI %d\n",
1658*5de6c855SPrzemek Kitszel 				vsi->vsi_num);
1659*5de6c855SPrzemek Kitszel 			v_ret = VIRTCHNL_STATUS_ERR_PARAM;
1660*5de6c855SPrzemek Kitszel 			goto error_param;
1661*5de6c855SPrzemek Kitszel 		}
1662*5de6c855SPrzemek Kitszel 
1663*5de6c855SPrzemek Kitszel 		bitmap_zero(vf->rxq_ena, ICE_MAX_RSS_QS_PER_VF);
1664*5de6c855SPrzemek Kitszel 	} else if (q_map) {
1665*5de6c855SPrzemek Kitszel 		for_each_set_bit(vf_q_id, &q_map, ICE_MAX_RSS_QS_PER_VF) {
1666*5de6c855SPrzemek Kitszel 			if (!ice_vc_isvalid_q_id(vsi, vf_q_id)) {
1667*5de6c855SPrzemek Kitszel 				v_ret = VIRTCHNL_STATUS_ERR_PARAM;
1668*5de6c855SPrzemek Kitszel 				goto error_param;
1669*5de6c855SPrzemek Kitszel 			}
1670*5de6c855SPrzemek Kitszel 
1671*5de6c855SPrzemek Kitszel 			/* Skip queue if not enabled */
1672*5de6c855SPrzemek Kitszel 			if (!test_bit(vf_q_id, vf->rxq_ena))
1673*5de6c855SPrzemek Kitszel 				continue;
1674*5de6c855SPrzemek Kitszel 
1675*5de6c855SPrzemek Kitszel 			if (ice_vsi_ctrl_one_rx_ring(vsi, false, vf_q_id,
1676*5de6c855SPrzemek Kitszel 						     true)) {
1677*5de6c855SPrzemek Kitszel 				dev_err(ice_pf_to_dev(vsi->back), "Failed to stop Rx ring %d on VSI %d\n",
1678*5de6c855SPrzemek Kitszel 					vf_q_id, vsi->vsi_num);
1679*5de6c855SPrzemek Kitszel 				v_ret = VIRTCHNL_STATUS_ERR_PARAM;
1680*5de6c855SPrzemek Kitszel 				goto error_param;
1681*5de6c855SPrzemek Kitszel 			}
1682*5de6c855SPrzemek Kitszel 
1683*5de6c855SPrzemek Kitszel 			/* Clear enabled queues flag */
1684*5de6c855SPrzemek Kitszel 			clear_bit(vf_q_id, vf->rxq_ena);
1685*5de6c855SPrzemek Kitszel 		}
1686*5de6c855SPrzemek Kitszel 	}
1687*5de6c855SPrzemek Kitszel 
1688*5de6c855SPrzemek Kitszel 	/* Clear enabled queues flag */
1689*5de6c855SPrzemek Kitszel 	if (v_ret == VIRTCHNL_STATUS_SUCCESS && ice_vf_has_no_qs_ena(vf))
1690*5de6c855SPrzemek Kitszel 		clear_bit(ICE_VF_STATE_QS_ENA, vf->vf_states);
1691*5de6c855SPrzemek Kitszel 
1692*5de6c855SPrzemek Kitszel error_param:
1693*5de6c855SPrzemek Kitszel 	/* send the response to the VF */
1694*5de6c855SPrzemek Kitszel 	return ice_vc_send_msg_to_vf(vf, VIRTCHNL_OP_DISABLE_QUEUES, v_ret,
1695*5de6c855SPrzemek Kitszel 				     NULL, 0);
1696*5de6c855SPrzemek Kitszel }
1697*5de6c855SPrzemek Kitszel 
1698*5de6c855SPrzemek Kitszel /**
1699*5de6c855SPrzemek Kitszel  * ice_cfg_interrupt
1700*5de6c855SPrzemek Kitszel  * @vf: pointer to the VF info
1701*5de6c855SPrzemek Kitszel  * @vsi: the VSI being configured
1702*5de6c855SPrzemek Kitszel  * @map: vector map for mapping vectors to queues
1703*5de6c855SPrzemek Kitszel  * @q_vector: structure for interrupt vector
1704*5de6c855SPrzemek Kitszel  * configure the IRQ to queue map
1705*5de6c855SPrzemek Kitszel  */
1706*5de6c855SPrzemek Kitszel static enum virtchnl_status_code
1707*5de6c855SPrzemek Kitszel ice_cfg_interrupt(struct ice_vf *vf, struct ice_vsi *vsi,
1708*5de6c855SPrzemek Kitszel 		  struct virtchnl_vector_map *map,
1709*5de6c855SPrzemek Kitszel 		  struct ice_q_vector *q_vector)
1710*5de6c855SPrzemek Kitszel {
1711*5de6c855SPrzemek Kitszel 	u16 vsi_q_id, vsi_q_id_idx;
1712*5de6c855SPrzemek Kitszel 	unsigned long qmap;
1713*5de6c855SPrzemek Kitszel 
1714*5de6c855SPrzemek Kitszel 	q_vector->num_ring_rx = 0;
1715*5de6c855SPrzemek Kitszel 	q_vector->num_ring_tx = 0;
1716*5de6c855SPrzemek Kitszel 
1717*5de6c855SPrzemek Kitszel 	qmap = map->rxq_map;
1718*5de6c855SPrzemek Kitszel 	for_each_set_bit(vsi_q_id_idx, &qmap, ICE_MAX_RSS_QS_PER_VF) {
1719*5de6c855SPrzemek Kitszel 		vsi_q_id = vsi_q_id_idx;
1720*5de6c855SPrzemek Kitszel 
1721*5de6c855SPrzemek Kitszel 		if (!ice_vc_isvalid_q_id(vsi, vsi_q_id))
1722*5de6c855SPrzemek Kitszel 			return VIRTCHNL_STATUS_ERR_PARAM;
1723*5de6c855SPrzemek Kitszel 
1724*5de6c855SPrzemek Kitszel 		q_vector->num_ring_rx++;
1725*5de6c855SPrzemek Kitszel 		q_vector->rx.itr_idx = map->rxitr_idx;
1726*5de6c855SPrzemek Kitszel 		vsi->rx_rings[vsi_q_id]->q_vector = q_vector;
1727*5de6c855SPrzemek Kitszel 		ice_cfg_rxq_interrupt(vsi, vsi_q_id,
1728*5de6c855SPrzemek Kitszel 				      q_vector->vf_reg_idx,
1729*5de6c855SPrzemek Kitszel 				      q_vector->rx.itr_idx);
1730*5de6c855SPrzemek Kitszel 	}
1731*5de6c855SPrzemek Kitszel 
1732*5de6c855SPrzemek Kitszel 	qmap = map->txq_map;
1733*5de6c855SPrzemek Kitszel 	for_each_set_bit(vsi_q_id_idx, &qmap, ICE_MAX_RSS_QS_PER_VF) {
1734*5de6c855SPrzemek Kitszel 		vsi_q_id = vsi_q_id_idx;
1735*5de6c855SPrzemek Kitszel 
1736*5de6c855SPrzemek Kitszel 		if (!ice_vc_isvalid_q_id(vsi, vsi_q_id))
1737*5de6c855SPrzemek Kitszel 			return VIRTCHNL_STATUS_ERR_PARAM;
1738*5de6c855SPrzemek Kitszel 
1739*5de6c855SPrzemek Kitszel 		q_vector->num_ring_tx++;
1740*5de6c855SPrzemek Kitszel 		q_vector->tx.itr_idx = map->txitr_idx;
1741*5de6c855SPrzemek Kitszel 		vsi->tx_rings[vsi_q_id]->q_vector = q_vector;
1742*5de6c855SPrzemek Kitszel 		ice_cfg_txq_interrupt(vsi, vsi_q_id,
1743*5de6c855SPrzemek Kitszel 				      q_vector->vf_reg_idx,
1744*5de6c855SPrzemek Kitszel 				      q_vector->tx.itr_idx);
1745*5de6c855SPrzemek Kitszel 	}
1746*5de6c855SPrzemek Kitszel 
1747*5de6c855SPrzemek Kitszel 	return VIRTCHNL_STATUS_SUCCESS;
1748*5de6c855SPrzemek Kitszel }
1749*5de6c855SPrzemek Kitszel 
1750*5de6c855SPrzemek Kitszel /**
1751*5de6c855SPrzemek Kitszel  * ice_vc_cfg_irq_map_msg
1752*5de6c855SPrzemek Kitszel  * @vf: pointer to the VF info
1753*5de6c855SPrzemek Kitszel  * @msg: pointer to the msg buffer
1754*5de6c855SPrzemek Kitszel  *
1755*5de6c855SPrzemek Kitszel  * called from the VF to configure the IRQ to queue map
1756*5de6c855SPrzemek Kitszel  */
1757*5de6c855SPrzemek Kitszel static int ice_vc_cfg_irq_map_msg(struct ice_vf *vf, u8 *msg)
1758*5de6c855SPrzemek Kitszel {
1759*5de6c855SPrzemek Kitszel 	enum virtchnl_status_code v_ret = VIRTCHNL_STATUS_SUCCESS;
1760*5de6c855SPrzemek Kitszel 	u16 num_q_vectors_mapped, vsi_id, vector_id;
1761*5de6c855SPrzemek Kitszel 	struct virtchnl_irq_map_info *irqmap_info;
1762*5de6c855SPrzemek Kitszel 	struct virtchnl_vector_map *map;
1763*5de6c855SPrzemek Kitszel 	struct ice_vsi *vsi;
1764*5de6c855SPrzemek Kitszel 	int i;
1765*5de6c855SPrzemek Kitszel 
1766*5de6c855SPrzemek Kitszel 	irqmap_info = (struct virtchnl_irq_map_info *)msg;
1767*5de6c855SPrzemek Kitszel 	num_q_vectors_mapped = irqmap_info->num_vectors;
1768*5de6c855SPrzemek Kitszel 
1769*5de6c855SPrzemek Kitszel 	/* Check to make sure number of VF vectors mapped is not greater than
1770*5de6c855SPrzemek Kitszel 	 * number of VF vectors originally allocated, and check that
1771*5de6c855SPrzemek Kitszel 	 * there is actually at least a single VF queue vector mapped
1772*5de6c855SPrzemek Kitszel 	 */
1773*5de6c855SPrzemek Kitszel 	if (!test_bit(ICE_VF_STATE_ACTIVE, vf->vf_states) ||
1774*5de6c855SPrzemek Kitszel 	    vf->num_msix < num_q_vectors_mapped ||
1775*5de6c855SPrzemek Kitszel 	    !num_q_vectors_mapped) {
1776*5de6c855SPrzemek Kitszel 		v_ret = VIRTCHNL_STATUS_ERR_PARAM;
1777*5de6c855SPrzemek Kitszel 		goto error_param;
1778*5de6c855SPrzemek Kitszel 	}
1779*5de6c855SPrzemek Kitszel 
1780*5de6c855SPrzemek Kitszel 	vsi = ice_get_vf_vsi(vf);
1781*5de6c855SPrzemek Kitszel 	if (!vsi) {
1782*5de6c855SPrzemek Kitszel 		v_ret = VIRTCHNL_STATUS_ERR_PARAM;
1783*5de6c855SPrzemek Kitszel 		goto error_param;
1784*5de6c855SPrzemek Kitszel 	}
1785*5de6c855SPrzemek Kitszel 
1786*5de6c855SPrzemek Kitszel 	for (i = 0; i < num_q_vectors_mapped; i++) {
1787*5de6c855SPrzemek Kitszel 		struct ice_q_vector *q_vector;
1788*5de6c855SPrzemek Kitszel 
1789*5de6c855SPrzemek Kitszel 		map = &irqmap_info->vecmap[i];
1790*5de6c855SPrzemek Kitszel 
1791*5de6c855SPrzemek Kitszel 		vector_id = map->vector_id;
1792*5de6c855SPrzemek Kitszel 		vsi_id = map->vsi_id;
1793*5de6c855SPrzemek Kitszel 		/* vector_id is always 0-based for each VF, and can never be
1794*5de6c855SPrzemek Kitszel 		 * larger than or equal to the max allowed interrupts per VF
1795*5de6c855SPrzemek Kitszel 		 */
1796*5de6c855SPrzemek Kitszel 		if (!(vector_id < vf->num_msix) ||
1797*5de6c855SPrzemek Kitszel 		    !ice_vc_isvalid_vsi_id(vf, vsi_id) ||
1798*5de6c855SPrzemek Kitszel 		    (!vector_id && (map->rxq_map || map->txq_map))) {
1799*5de6c855SPrzemek Kitszel 			v_ret = VIRTCHNL_STATUS_ERR_PARAM;
1800*5de6c855SPrzemek Kitszel 			goto error_param;
1801*5de6c855SPrzemek Kitszel 		}
1802*5de6c855SPrzemek Kitszel 
1803*5de6c855SPrzemek Kitszel 		/* No need to map VF miscellaneous or rogue vector */
1804*5de6c855SPrzemek Kitszel 		if (!vector_id)
1805*5de6c855SPrzemek Kitszel 			continue;
1806*5de6c855SPrzemek Kitszel 
1807*5de6c855SPrzemek Kitszel 		/* Subtract non queue vector from vector_id passed by VF
1808*5de6c855SPrzemek Kitszel 		 * to get actual number of VSI queue vector array index
1809*5de6c855SPrzemek Kitszel 		 */
1810*5de6c855SPrzemek Kitszel 		q_vector = vsi->q_vectors[vector_id - ICE_NONQ_VECS_VF];
1811*5de6c855SPrzemek Kitszel 		if (!q_vector) {
1812*5de6c855SPrzemek Kitszel 			v_ret = VIRTCHNL_STATUS_ERR_PARAM;
1813*5de6c855SPrzemek Kitszel 			goto error_param;
1814*5de6c855SPrzemek Kitszel 		}
1815*5de6c855SPrzemek Kitszel 
1816*5de6c855SPrzemek Kitszel 		/* lookout for the invalid queue index */
1817*5de6c855SPrzemek Kitszel 		v_ret = ice_cfg_interrupt(vf, vsi, map, q_vector);
1818*5de6c855SPrzemek Kitszel 		if (v_ret)
1819*5de6c855SPrzemek Kitszel 			goto error_param;
1820*5de6c855SPrzemek Kitszel 	}
1821*5de6c855SPrzemek Kitszel 
1822*5de6c855SPrzemek Kitszel error_param:
1823*5de6c855SPrzemek Kitszel 	/* send the response to the VF */
1824*5de6c855SPrzemek Kitszel 	return ice_vc_send_msg_to_vf(vf, VIRTCHNL_OP_CONFIG_IRQ_MAP, v_ret,
1825*5de6c855SPrzemek Kitszel 				     NULL, 0);
1826*5de6c855SPrzemek Kitszel }
1827*5de6c855SPrzemek Kitszel 
1828*5de6c855SPrzemek Kitszel /**
1829*5de6c855SPrzemek Kitszel  * ice_vc_cfg_q_bw - Configure per queue bandwidth
1830*5de6c855SPrzemek Kitszel  * @vf: pointer to the VF info
1831*5de6c855SPrzemek Kitszel  * @msg: pointer to the msg buffer which holds the command descriptor
1832*5de6c855SPrzemek Kitszel  *
1833*5de6c855SPrzemek Kitszel  * Configure VF queues bandwidth.
1834*5de6c855SPrzemek Kitszel  *
1835*5de6c855SPrzemek Kitszel  * Return: 0 on success or negative error value.
1836*5de6c855SPrzemek Kitszel  */
1837*5de6c855SPrzemek Kitszel static int ice_vc_cfg_q_bw(struct ice_vf *vf, u8 *msg)
1838*5de6c855SPrzemek Kitszel {
1839*5de6c855SPrzemek Kitszel 	enum virtchnl_status_code v_ret = VIRTCHNL_STATUS_SUCCESS;
1840*5de6c855SPrzemek Kitszel 	struct virtchnl_queues_bw_cfg *qbw =
1841*5de6c855SPrzemek Kitszel 		(struct virtchnl_queues_bw_cfg *)msg;
1842*5de6c855SPrzemek Kitszel 	struct ice_vsi *vsi;
1843*5de6c855SPrzemek Kitszel 	u16 i;
1844*5de6c855SPrzemek Kitszel 
1845*5de6c855SPrzemek Kitszel 	if (!test_bit(ICE_VF_STATE_ACTIVE, vf->vf_states) ||
1846*5de6c855SPrzemek Kitszel 	    !ice_vc_isvalid_vsi_id(vf, qbw->vsi_id)) {
1847*5de6c855SPrzemek Kitszel 		v_ret = VIRTCHNL_STATUS_ERR_PARAM;
1848*5de6c855SPrzemek Kitszel 		goto err;
1849*5de6c855SPrzemek Kitszel 	}
1850*5de6c855SPrzemek Kitszel 
1851*5de6c855SPrzemek Kitszel 	vsi = ice_get_vf_vsi(vf);
1852*5de6c855SPrzemek Kitszel 	if (!vsi) {
1853*5de6c855SPrzemek Kitszel 		v_ret = VIRTCHNL_STATUS_ERR_PARAM;
1854*5de6c855SPrzemek Kitszel 		goto err;
1855*5de6c855SPrzemek Kitszel 	}
1856*5de6c855SPrzemek Kitszel 
1857*5de6c855SPrzemek Kitszel 	if (qbw->num_queues > ICE_MAX_RSS_QS_PER_VF ||
1858*5de6c855SPrzemek Kitszel 	    qbw->num_queues > min_t(u16, vsi->alloc_txq, vsi->alloc_rxq)) {
1859*5de6c855SPrzemek Kitszel 		dev_err(ice_pf_to_dev(vf->pf), "VF-%d trying to configure more than allocated number of queues: %d\n",
1860*5de6c855SPrzemek Kitszel 			vf->vf_id, min_t(u16, vsi->alloc_txq, vsi->alloc_rxq));
1861*5de6c855SPrzemek Kitszel 		v_ret = VIRTCHNL_STATUS_ERR_PARAM;
1862*5de6c855SPrzemek Kitszel 		goto err;
1863*5de6c855SPrzemek Kitszel 	}
1864*5de6c855SPrzemek Kitszel 
1865*5de6c855SPrzemek Kitszel 	for (i = 0; i < qbw->num_queues; i++) {
1866*5de6c855SPrzemek Kitszel 		if (qbw->cfg[i].shaper.peak != 0 && vf->max_tx_rate != 0 &&
1867*5de6c855SPrzemek Kitszel 		    qbw->cfg[i].shaper.peak > vf->max_tx_rate) {
1868*5de6c855SPrzemek Kitszel 			dev_warn(ice_pf_to_dev(vf->pf), "The maximum queue %d rate limit configuration may not take effect because the maximum TX rate for VF-%d is %d\n",
1869*5de6c855SPrzemek Kitszel 				 qbw->cfg[i].queue_id, vf->vf_id,
1870*5de6c855SPrzemek Kitszel 				 vf->max_tx_rate);
1871*5de6c855SPrzemek Kitszel 			v_ret = VIRTCHNL_STATUS_ERR_PARAM;
1872*5de6c855SPrzemek Kitszel 			goto err;
1873*5de6c855SPrzemek Kitszel 		}
1874*5de6c855SPrzemek Kitszel 		if (qbw->cfg[i].shaper.committed != 0 && vf->min_tx_rate != 0 &&
1875*5de6c855SPrzemek Kitszel 		    qbw->cfg[i].shaper.committed < vf->min_tx_rate) {
1876*5de6c855SPrzemek Kitszel 			dev_warn(ice_pf_to_dev(vf->pf), "The minimum queue %d rate limit configuration may not take effect because the minimum TX rate for VF-%d is %d\n",
1877*5de6c855SPrzemek Kitszel 				 qbw->cfg[i].queue_id, vf->vf_id,
1878*5de6c855SPrzemek Kitszel 				 vf->min_tx_rate);
1879*5de6c855SPrzemek Kitszel 			v_ret = VIRTCHNL_STATUS_ERR_PARAM;
1880*5de6c855SPrzemek Kitszel 			goto err;
1881*5de6c855SPrzemek Kitszel 		}
1882*5de6c855SPrzemek Kitszel 		if (qbw->cfg[i].queue_id > vf->num_vf_qs) {
1883*5de6c855SPrzemek Kitszel 			dev_warn(ice_pf_to_dev(vf->pf), "VF-%d trying to configure invalid queue_id\n",
1884*5de6c855SPrzemek Kitszel 				 vf->vf_id);
1885*5de6c855SPrzemek Kitszel 			v_ret = VIRTCHNL_STATUS_ERR_PARAM;
1886*5de6c855SPrzemek Kitszel 			goto err;
1887*5de6c855SPrzemek Kitszel 		}
1888*5de6c855SPrzemek Kitszel 		if (qbw->cfg[i].tc >= ICE_MAX_TRAFFIC_CLASS) {
1889*5de6c855SPrzemek Kitszel 			dev_warn(ice_pf_to_dev(vf->pf), "VF-%d trying to configure a traffic class higher than allowed\n",
1890*5de6c855SPrzemek Kitszel 				 vf->vf_id);
1891*5de6c855SPrzemek Kitszel 			v_ret = VIRTCHNL_STATUS_ERR_PARAM;
1892*5de6c855SPrzemek Kitszel 			goto err;
1893*5de6c855SPrzemek Kitszel 		}
1894*5de6c855SPrzemek Kitszel 	}
1895*5de6c855SPrzemek Kitszel 
1896*5de6c855SPrzemek Kitszel 	for (i = 0; i < qbw->num_queues; i++) {
1897*5de6c855SPrzemek Kitszel 		vf->qs_bw[i].queue_id = qbw->cfg[i].queue_id;
1898*5de6c855SPrzemek Kitszel 		vf->qs_bw[i].peak = qbw->cfg[i].shaper.peak;
1899*5de6c855SPrzemek Kitszel 		vf->qs_bw[i].committed = qbw->cfg[i].shaper.committed;
1900*5de6c855SPrzemek Kitszel 		vf->qs_bw[i].tc = qbw->cfg[i].tc;
1901*5de6c855SPrzemek Kitszel 	}
1902*5de6c855SPrzemek Kitszel 
1903*5de6c855SPrzemek Kitszel 	if (ice_vf_cfg_qs_bw(vf, qbw->num_queues))
1904*5de6c855SPrzemek Kitszel 		v_ret = VIRTCHNL_STATUS_ERR_PARAM;
1905*5de6c855SPrzemek Kitszel 
1906*5de6c855SPrzemek Kitszel err:
1907*5de6c855SPrzemek Kitszel 	/* send the response to the VF */
1908*5de6c855SPrzemek Kitszel 	return ice_vc_send_msg_to_vf(vf, VIRTCHNL_OP_CONFIG_QUEUE_BW,
1909*5de6c855SPrzemek Kitszel 				    v_ret, NULL, 0);
1910*5de6c855SPrzemek Kitszel }
1911*5de6c855SPrzemek Kitszel 
1912*5de6c855SPrzemek Kitszel /**
1913*5de6c855SPrzemek Kitszel  * ice_vc_cfg_q_quanta - Configure per queue quanta
1914*5de6c855SPrzemek Kitszel  * @vf: pointer to the VF info
1915*5de6c855SPrzemek Kitszel  * @msg: pointer to the msg buffer which holds the command descriptor
1916*5de6c855SPrzemek Kitszel  *
1917*5de6c855SPrzemek Kitszel  * Configure VF queues quanta.
1918*5de6c855SPrzemek Kitszel  *
1919*5de6c855SPrzemek Kitszel  * Return: 0 on success or negative error value.
1920*5de6c855SPrzemek Kitszel  */
1921*5de6c855SPrzemek Kitszel static int ice_vc_cfg_q_quanta(struct ice_vf *vf, u8 *msg)
1922*5de6c855SPrzemek Kitszel {
1923*5de6c855SPrzemek Kitszel 	u16 quanta_prof_id, quanta_size, start_qid, num_queues, end_qid, i;
1924*5de6c855SPrzemek Kitszel 	enum virtchnl_status_code v_ret = VIRTCHNL_STATUS_SUCCESS;
1925*5de6c855SPrzemek Kitszel 	struct virtchnl_quanta_cfg *qquanta =
1926*5de6c855SPrzemek Kitszel 		(struct virtchnl_quanta_cfg *)msg;
1927*5de6c855SPrzemek Kitszel 	struct ice_vsi *vsi;
1928*5de6c855SPrzemek Kitszel 	int ret;
1929*5de6c855SPrzemek Kitszel 
1930*5de6c855SPrzemek Kitszel 	start_qid = qquanta->queue_select.start_queue_id;
1931*5de6c855SPrzemek Kitszel 	num_queues = qquanta->queue_select.num_queues;
1932*5de6c855SPrzemek Kitszel 
1933*5de6c855SPrzemek Kitszel 	if (check_add_overflow(start_qid, num_queues, &end_qid)) {
1934*5de6c855SPrzemek Kitszel 		v_ret = VIRTCHNL_STATUS_ERR_PARAM;
1935*5de6c855SPrzemek Kitszel 		goto err;
1936*5de6c855SPrzemek Kitszel 	}
1937*5de6c855SPrzemek Kitszel 
1938*5de6c855SPrzemek Kitszel 	if (!test_bit(ICE_VF_STATE_ACTIVE, vf->vf_states)) {
1939*5de6c855SPrzemek Kitszel 		v_ret = VIRTCHNL_STATUS_ERR_PARAM;
1940*5de6c855SPrzemek Kitszel 		goto err;
1941*5de6c855SPrzemek Kitszel 	}
1942*5de6c855SPrzemek Kitszel 
1943*5de6c855SPrzemek Kitszel 	vsi = ice_get_vf_vsi(vf);
1944*5de6c855SPrzemek Kitszel 	if (!vsi) {
1945*5de6c855SPrzemek Kitszel 		v_ret = VIRTCHNL_STATUS_ERR_PARAM;
1946*5de6c855SPrzemek Kitszel 		goto err;
1947*5de6c855SPrzemek Kitszel 	}
1948*5de6c855SPrzemek Kitszel 
1949*5de6c855SPrzemek Kitszel 	if (end_qid > ICE_MAX_RSS_QS_PER_VF ||
1950*5de6c855SPrzemek Kitszel 	    end_qid > min_t(u16, vsi->alloc_txq, vsi->alloc_rxq)) {
1951*5de6c855SPrzemek Kitszel 		dev_err(ice_pf_to_dev(vf->pf), "VF-%d trying to configure more than allocated number of queues: %d\n",
1952*5de6c855SPrzemek Kitszel 			vf->vf_id, min_t(u16, vsi->alloc_txq, vsi->alloc_rxq));
1953*5de6c855SPrzemek Kitszel 		v_ret = VIRTCHNL_STATUS_ERR_PARAM;
1954*5de6c855SPrzemek Kitszel 		goto err;
1955*5de6c855SPrzemek Kitszel 	}
1956*5de6c855SPrzemek Kitszel 
1957*5de6c855SPrzemek Kitszel 	quanta_size = qquanta->quanta_size;
1958*5de6c855SPrzemek Kitszel 	if (quanta_size > ICE_MAX_QUANTA_SIZE ||
1959*5de6c855SPrzemek Kitszel 	    quanta_size < ICE_MIN_QUANTA_SIZE) {
1960*5de6c855SPrzemek Kitszel 		v_ret = VIRTCHNL_STATUS_ERR_PARAM;
1961*5de6c855SPrzemek Kitszel 		goto err;
1962*5de6c855SPrzemek Kitszel 	}
1963*5de6c855SPrzemek Kitszel 
1964*5de6c855SPrzemek Kitszel 	if (quanta_size % 64) {
1965*5de6c855SPrzemek Kitszel 		dev_err(ice_pf_to_dev(vf->pf), "quanta size should be the product of 64\n");
1966*5de6c855SPrzemek Kitszel 		v_ret = VIRTCHNL_STATUS_ERR_PARAM;
1967*5de6c855SPrzemek Kitszel 		goto err;
1968*5de6c855SPrzemek Kitszel 	}
1969*5de6c855SPrzemek Kitszel 
1970*5de6c855SPrzemek Kitszel 	ret = ice_vf_cfg_q_quanta_profile(vf, quanta_size,
1971*5de6c855SPrzemek Kitszel 					  &quanta_prof_id);
1972*5de6c855SPrzemek Kitszel 	if (ret) {
1973*5de6c855SPrzemek Kitszel 		v_ret = VIRTCHNL_STATUS_ERR_NOT_SUPPORTED;
1974*5de6c855SPrzemek Kitszel 		goto err;
1975*5de6c855SPrzemek Kitszel 	}
1976*5de6c855SPrzemek Kitszel 
1977*5de6c855SPrzemek Kitszel 	for (i = start_qid; i < end_qid; i++)
1978*5de6c855SPrzemek Kitszel 		vsi->tx_rings[i]->quanta_prof_id = quanta_prof_id;
1979*5de6c855SPrzemek Kitszel 
1980*5de6c855SPrzemek Kitszel err:
1981*5de6c855SPrzemek Kitszel 	/* send the response to the VF */
1982*5de6c855SPrzemek Kitszel 	return ice_vc_send_msg_to_vf(vf, VIRTCHNL_OP_CONFIG_QUANTA,
1983*5de6c855SPrzemek Kitszel 				     v_ret, NULL, 0);
1984*5de6c855SPrzemek Kitszel }
1985*5de6c855SPrzemek Kitszel 
1986*5de6c855SPrzemek Kitszel /**
1987*5de6c855SPrzemek Kitszel  * ice_vc_cfg_qs_msg
1988*5de6c855SPrzemek Kitszel  * @vf: pointer to the VF info
1989*5de6c855SPrzemek Kitszel  * @msg: pointer to the msg buffer
1990*5de6c855SPrzemek Kitszel  *
1991*5de6c855SPrzemek Kitszel  * called from the VF to configure the Rx/Tx queues
1992*5de6c855SPrzemek Kitszel  */
1993*5de6c855SPrzemek Kitszel static int ice_vc_cfg_qs_msg(struct ice_vf *vf, u8 *msg)
1994*5de6c855SPrzemek Kitszel {
1995*5de6c855SPrzemek Kitszel 	struct virtchnl_vsi_queue_config_info *qci =
1996*5de6c855SPrzemek Kitszel 	    (struct virtchnl_vsi_queue_config_info *)msg;
1997*5de6c855SPrzemek Kitszel 	struct virtchnl_queue_pair_info *qpi;
1998*5de6c855SPrzemek Kitszel 	struct ice_pf *pf = vf->pf;
1999*5de6c855SPrzemek Kitszel 	struct ice_vsi *vsi;
2000*5de6c855SPrzemek Kitszel 	int i = -1, q_idx;
2001*5de6c855SPrzemek Kitszel 	bool ena_ts;
2002*5de6c855SPrzemek Kitszel 	u8 act_prt;
2003*5de6c855SPrzemek Kitszel 
2004*5de6c855SPrzemek Kitszel 	mutex_lock(&pf->lag_mutex);
2005*5de6c855SPrzemek Kitszel 	act_prt = ice_lag_prepare_vf_reset(pf->lag);
2006*5de6c855SPrzemek Kitszel 
2007*5de6c855SPrzemek Kitszel 	if (!test_bit(ICE_VF_STATE_ACTIVE, vf->vf_states))
2008*5de6c855SPrzemek Kitszel 		goto error_param;
2009*5de6c855SPrzemek Kitszel 
2010*5de6c855SPrzemek Kitszel 	if (!ice_vc_isvalid_vsi_id(vf, qci->vsi_id))
2011*5de6c855SPrzemek Kitszel 		goto error_param;
2012*5de6c855SPrzemek Kitszel 
2013*5de6c855SPrzemek Kitszel 	vsi = ice_get_vf_vsi(vf);
2014*5de6c855SPrzemek Kitszel 	if (!vsi)
2015*5de6c855SPrzemek Kitszel 		goto error_param;
2016*5de6c855SPrzemek Kitszel 
2017*5de6c855SPrzemek Kitszel 	if (qci->num_queue_pairs > ICE_MAX_RSS_QS_PER_VF ||
2018*5de6c855SPrzemek Kitszel 	    qci->num_queue_pairs > min_t(u16, vsi->alloc_txq, vsi->alloc_rxq)) {
2019*5de6c855SPrzemek Kitszel 		dev_err(ice_pf_to_dev(pf), "VF-%d requesting more than supported number of queues: %d\n",
2020*5de6c855SPrzemek Kitszel 			vf->vf_id, min_t(u16, vsi->alloc_txq, vsi->alloc_rxq));
2021*5de6c855SPrzemek Kitszel 		goto error_param;
2022*5de6c855SPrzemek Kitszel 	}
2023*5de6c855SPrzemek Kitszel 
2024*5de6c855SPrzemek Kitszel 	for (i = 0; i < qci->num_queue_pairs; i++) {
2025*5de6c855SPrzemek Kitszel 		if (!qci->qpair[i].rxq.crc_disable)
2026*5de6c855SPrzemek Kitszel 			continue;
2027*5de6c855SPrzemek Kitszel 
2028*5de6c855SPrzemek Kitszel 		if (!(vf->driver_caps & VIRTCHNL_VF_OFFLOAD_CRC) ||
2029*5de6c855SPrzemek Kitszel 		    vf->vlan_strip_ena)
2030*5de6c855SPrzemek Kitszel 			goto error_param;
2031*5de6c855SPrzemek Kitszel 	}
2032*5de6c855SPrzemek Kitszel 
2033*5de6c855SPrzemek Kitszel 	for (i = 0; i < qci->num_queue_pairs; i++) {
2034*5de6c855SPrzemek Kitszel 		qpi = &qci->qpair[i];
2035*5de6c855SPrzemek Kitszel 		if (qpi->txq.vsi_id != qci->vsi_id ||
2036*5de6c855SPrzemek Kitszel 		    qpi->rxq.vsi_id != qci->vsi_id ||
2037*5de6c855SPrzemek Kitszel 		    qpi->rxq.queue_id != qpi->txq.queue_id ||
2038*5de6c855SPrzemek Kitszel 		    qpi->txq.headwb_enabled ||
2039*5de6c855SPrzemek Kitszel 		    !ice_vc_isvalid_ring_len(qpi->txq.ring_len) ||
2040*5de6c855SPrzemek Kitszel 		    !ice_vc_isvalid_ring_len(qpi->rxq.ring_len) ||
2041*5de6c855SPrzemek Kitszel 		    !ice_vc_isvalid_q_id(vsi, qpi->txq.queue_id)) {
2042*5de6c855SPrzemek Kitszel 			goto error_param;
2043*5de6c855SPrzemek Kitszel 		}
2044*5de6c855SPrzemek Kitszel 
2045*5de6c855SPrzemek Kitszel 		q_idx = qpi->rxq.queue_id;
2046*5de6c855SPrzemek Kitszel 
2047*5de6c855SPrzemek Kitszel 		/* make sure selected "q_idx" is in valid range of queues
2048*5de6c855SPrzemek Kitszel 		 * for selected "vsi"
2049*5de6c855SPrzemek Kitszel 		 */
2050*5de6c855SPrzemek Kitszel 		if (q_idx >= vsi->alloc_txq || q_idx >= vsi->alloc_rxq) {
2051*5de6c855SPrzemek Kitszel 			goto error_param;
2052*5de6c855SPrzemek Kitszel 		}
2053*5de6c855SPrzemek Kitszel 
2054*5de6c855SPrzemek Kitszel 		/* copy Tx queue info from VF into VSI */
2055*5de6c855SPrzemek Kitszel 		if (qpi->txq.ring_len > 0) {
2056*5de6c855SPrzemek Kitszel 			vsi->tx_rings[q_idx]->dma = qpi->txq.dma_ring_addr;
2057*5de6c855SPrzemek Kitszel 			vsi->tx_rings[q_idx]->count = qpi->txq.ring_len;
2058*5de6c855SPrzemek Kitszel 
2059*5de6c855SPrzemek Kitszel 			/* Disable any existing queue first */
2060*5de6c855SPrzemek Kitszel 			if (ice_vf_vsi_dis_single_txq(vf, vsi, q_idx))
2061*5de6c855SPrzemek Kitszel 				goto error_param;
2062*5de6c855SPrzemek Kitszel 
2063*5de6c855SPrzemek Kitszel 			/* Configure a queue with the requested settings */
2064*5de6c855SPrzemek Kitszel 			if (ice_vsi_cfg_single_txq(vsi, vsi->tx_rings, q_idx)) {
2065*5de6c855SPrzemek Kitszel 				dev_warn(ice_pf_to_dev(pf), "VF-%d failed to configure TX queue %d\n",
2066*5de6c855SPrzemek Kitszel 					 vf->vf_id, q_idx);
2067*5de6c855SPrzemek Kitszel 				goto error_param;
2068*5de6c855SPrzemek Kitszel 			}
2069*5de6c855SPrzemek Kitszel 		}
2070*5de6c855SPrzemek Kitszel 
2071*5de6c855SPrzemek Kitszel 		/* copy Rx queue info from VF into VSI */
2072*5de6c855SPrzemek Kitszel 		if (qpi->rxq.ring_len > 0) {
2073*5de6c855SPrzemek Kitszel 			u16 max_frame_size = ice_vc_get_max_frame_size(vf);
2074*5de6c855SPrzemek Kitszel 			struct ice_rx_ring *ring = vsi->rx_rings[q_idx];
2075*5de6c855SPrzemek Kitszel 			u32 rxdid;
2076*5de6c855SPrzemek Kitszel 
2077*5de6c855SPrzemek Kitszel 			ring->dma = qpi->rxq.dma_ring_addr;
2078*5de6c855SPrzemek Kitszel 			ring->count = qpi->rxq.ring_len;
2079*5de6c855SPrzemek Kitszel 
2080*5de6c855SPrzemek Kitszel 			if (qpi->rxq.crc_disable)
2081*5de6c855SPrzemek Kitszel 				ring->flags |= ICE_RX_FLAGS_CRC_STRIP_DIS;
2082*5de6c855SPrzemek Kitszel 			else
2083*5de6c855SPrzemek Kitszel 				ring->flags &= ~ICE_RX_FLAGS_CRC_STRIP_DIS;
2084*5de6c855SPrzemek Kitszel 
2085*5de6c855SPrzemek Kitszel 			if (qpi->rxq.databuffer_size != 0 &&
2086*5de6c855SPrzemek Kitszel 			    (qpi->rxq.databuffer_size > ((16 * 1024) - 128) ||
2087*5de6c855SPrzemek Kitszel 			     qpi->rxq.databuffer_size < 1024))
2088*5de6c855SPrzemek Kitszel 				goto error_param;
2089*5de6c855SPrzemek Kitszel 			ring->rx_buf_len = qpi->rxq.databuffer_size;
2090*5de6c855SPrzemek Kitszel 			if (qpi->rxq.max_pkt_size > max_frame_size ||
2091*5de6c855SPrzemek Kitszel 			    qpi->rxq.max_pkt_size < 64)
2092*5de6c855SPrzemek Kitszel 				goto error_param;
2093*5de6c855SPrzemek Kitszel 
2094*5de6c855SPrzemek Kitszel 			ring->max_frame = qpi->rxq.max_pkt_size;
2095*5de6c855SPrzemek Kitszel 			/* add space for the port VLAN since the VF driver is
2096*5de6c855SPrzemek Kitszel 			 * not expected to account for it in the MTU
2097*5de6c855SPrzemek Kitszel 			 * calculation
2098*5de6c855SPrzemek Kitszel 			 */
2099*5de6c855SPrzemek Kitszel 			if (ice_vf_is_port_vlan_ena(vf))
2100*5de6c855SPrzemek Kitszel 				ring->max_frame += VLAN_HLEN;
2101*5de6c855SPrzemek Kitszel 
2102*5de6c855SPrzemek Kitszel 			if (ice_vsi_cfg_single_rxq(vsi, q_idx)) {
2103*5de6c855SPrzemek Kitszel 				dev_warn(ice_pf_to_dev(pf), "VF-%d failed to configure RX queue %d\n",
2104*5de6c855SPrzemek Kitszel 					 vf->vf_id, q_idx);
2105*5de6c855SPrzemek Kitszel 				goto error_param;
2106*5de6c855SPrzemek Kitszel 			}
2107*5de6c855SPrzemek Kitszel 
2108*5de6c855SPrzemek Kitszel 			/* If Rx flex desc is supported, select RXDID for Rx
2109*5de6c855SPrzemek Kitszel 			 * queues. Otherwise, use legacy 32byte descriptor
2110*5de6c855SPrzemek Kitszel 			 * format. Legacy 16byte descriptor is not supported.
2111*5de6c855SPrzemek Kitszel 			 * If this RXDID is selected, return error.
2112*5de6c855SPrzemek Kitszel 			 */
2113*5de6c855SPrzemek Kitszel 			if (vf->driver_caps &
2114*5de6c855SPrzemek Kitszel 			    VIRTCHNL_VF_OFFLOAD_RX_FLEX_DESC) {
2115*5de6c855SPrzemek Kitszel 				rxdid = qpi->rxq.rxdid;
2116*5de6c855SPrzemek Kitszel 				if (!(BIT(rxdid) & pf->supported_rxdids))
2117*5de6c855SPrzemek Kitszel 					goto error_param;
2118*5de6c855SPrzemek Kitszel 			} else {
2119*5de6c855SPrzemek Kitszel 				rxdid = ICE_RXDID_LEGACY_1;
2120*5de6c855SPrzemek Kitszel 			}
2121*5de6c855SPrzemek Kitszel 
2122*5de6c855SPrzemek Kitszel 			ena_ts = ((vf->driver_caps &
2123*5de6c855SPrzemek Kitszel 				  VIRTCHNL_VF_OFFLOAD_RX_FLEX_DESC) &&
2124*5de6c855SPrzemek Kitszel 				  (vf->driver_caps & VIRTCHNL_VF_CAP_PTP) &&
2125*5de6c855SPrzemek Kitszel 				  (qpi->rxq.flags & VIRTCHNL_PTP_RX_TSTAMP));
2126*5de6c855SPrzemek Kitszel 
2127*5de6c855SPrzemek Kitszel 			ice_write_qrxflxp_cntxt(&vsi->back->hw,
2128*5de6c855SPrzemek Kitszel 						vsi->rxq_map[q_idx], rxdid,
2129*5de6c855SPrzemek Kitszel 						ICE_RXDID_PRIO, ena_ts);
2130*5de6c855SPrzemek Kitszel 		}
2131*5de6c855SPrzemek Kitszel 	}
2132*5de6c855SPrzemek Kitszel 
2133*5de6c855SPrzemek Kitszel 	ice_lag_complete_vf_reset(pf->lag, act_prt);
2134*5de6c855SPrzemek Kitszel 	mutex_unlock(&pf->lag_mutex);
2135*5de6c855SPrzemek Kitszel 
2136*5de6c855SPrzemek Kitszel 	/* send the response to the VF */
2137*5de6c855SPrzemek Kitszel 	return ice_vc_send_msg_to_vf(vf, VIRTCHNL_OP_CONFIG_VSI_QUEUES,
2138*5de6c855SPrzemek Kitszel 				     VIRTCHNL_STATUS_SUCCESS, NULL, 0);
2139*5de6c855SPrzemek Kitszel error_param:
2140*5de6c855SPrzemek Kitszel 	/* disable whatever we can */
2141*5de6c855SPrzemek Kitszel 	for (; i >= 0; i--) {
2142*5de6c855SPrzemek Kitszel 		if (ice_vsi_ctrl_one_rx_ring(vsi, false, i, true))
2143*5de6c855SPrzemek Kitszel 			dev_err(ice_pf_to_dev(pf), "VF-%d could not disable RX queue %d\n",
2144*5de6c855SPrzemek Kitszel 				vf->vf_id, i);
2145*5de6c855SPrzemek Kitszel 		if (ice_vf_vsi_dis_single_txq(vf, vsi, i))
2146*5de6c855SPrzemek Kitszel 			dev_err(ice_pf_to_dev(pf), "VF-%d could not disable TX queue %d\n",
2147*5de6c855SPrzemek Kitszel 				vf->vf_id, i);
2148*5de6c855SPrzemek Kitszel 	}
2149*5de6c855SPrzemek Kitszel 
2150*5de6c855SPrzemek Kitszel 	ice_lag_complete_vf_reset(pf->lag, act_prt);
2151*5de6c855SPrzemek Kitszel 	mutex_unlock(&pf->lag_mutex);
2152*5de6c855SPrzemek Kitszel 
2153*5de6c855SPrzemek Kitszel 	ice_lag_move_new_vf_nodes(vf);
2154*5de6c855SPrzemek Kitszel 
2155*5de6c855SPrzemek Kitszel 	/* send the response to the VF */
2156*5de6c855SPrzemek Kitszel 	return ice_vc_send_msg_to_vf(vf, VIRTCHNL_OP_CONFIG_VSI_QUEUES,
2157*5de6c855SPrzemek Kitszel 				     VIRTCHNL_STATUS_ERR_PARAM, NULL, 0);
2158*5de6c855SPrzemek Kitszel }
2159*5de6c855SPrzemek Kitszel 
2160*5de6c855SPrzemek Kitszel /**
2161*5de6c855SPrzemek Kitszel  * ice_can_vf_change_mac
2162*5de6c855SPrzemek Kitszel  * @vf: pointer to the VF info
2163*5de6c855SPrzemek Kitszel  *
2164*5de6c855SPrzemek Kitszel  * Return true if the VF is allowed to change its MAC filters, false otherwise
2165*5de6c855SPrzemek Kitszel  */
2166*5de6c855SPrzemek Kitszel static bool ice_can_vf_change_mac(struct ice_vf *vf)
2167*5de6c855SPrzemek Kitszel {
2168*5de6c855SPrzemek Kitszel 	/* If the VF MAC address has been set administratively (via the
2169*5de6c855SPrzemek Kitszel 	 * ndo_set_vf_mac command), then deny permission to the VF to
2170*5de6c855SPrzemek Kitszel 	 * add/delete unicast MAC addresses, unless the VF is trusted
2171*5de6c855SPrzemek Kitszel 	 */
2172*5de6c855SPrzemek Kitszel 	if (vf->pf_set_mac && !ice_is_vf_trusted(vf))
2173*5de6c855SPrzemek Kitszel 		return false;
2174*5de6c855SPrzemek Kitszel 
2175*5de6c855SPrzemek Kitszel 	return true;
2176*5de6c855SPrzemek Kitszel }
2177*5de6c855SPrzemek Kitszel 
2178*5de6c855SPrzemek Kitszel /**
2179*5de6c855SPrzemek Kitszel  * ice_vc_ether_addr_type - get type of virtchnl_ether_addr
2180*5de6c855SPrzemek Kitszel  * @vc_ether_addr: used to extract the type
2181*5de6c855SPrzemek Kitszel  */
2182*5de6c855SPrzemek Kitszel static u8
2183*5de6c855SPrzemek Kitszel ice_vc_ether_addr_type(struct virtchnl_ether_addr *vc_ether_addr)
2184*5de6c855SPrzemek Kitszel {
2185*5de6c855SPrzemek Kitszel 	return (vc_ether_addr->type & VIRTCHNL_ETHER_ADDR_TYPE_MASK);
2186*5de6c855SPrzemek Kitszel }
2187*5de6c855SPrzemek Kitszel 
2188*5de6c855SPrzemek Kitszel /**
2189*5de6c855SPrzemek Kitszel  * ice_is_vc_addr_legacy - check if the MAC address is from an older VF
2190*5de6c855SPrzemek Kitszel  * @vc_ether_addr: VIRTCHNL structure that contains MAC and type
2191*5de6c855SPrzemek Kitszel  */
2192*5de6c855SPrzemek Kitszel static bool
2193*5de6c855SPrzemek Kitszel ice_is_vc_addr_legacy(struct virtchnl_ether_addr *vc_ether_addr)
2194*5de6c855SPrzemek Kitszel {
2195*5de6c855SPrzemek Kitszel 	u8 type = ice_vc_ether_addr_type(vc_ether_addr);
2196*5de6c855SPrzemek Kitszel 
2197*5de6c855SPrzemek Kitszel 	return (type == VIRTCHNL_ETHER_ADDR_LEGACY);
2198*5de6c855SPrzemek Kitszel }
2199*5de6c855SPrzemek Kitszel 
2200*5de6c855SPrzemek Kitszel /**
2201*5de6c855SPrzemek Kitszel  * ice_is_vc_addr_primary - check if the MAC address is the VF's primary MAC
2202*5de6c855SPrzemek Kitszel  * @vc_ether_addr: VIRTCHNL structure that contains MAC and type
2203*5de6c855SPrzemek Kitszel  *
2204*5de6c855SPrzemek Kitszel  * This function should only be called when the MAC address in
2205*5de6c855SPrzemek Kitszel  * virtchnl_ether_addr is a valid unicast MAC
2206*5de6c855SPrzemek Kitszel  */
2207*5de6c855SPrzemek Kitszel static bool
2208*5de6c855SPrzemek Kitszel ice_is_vc_addr_primary(struct virtchnl_ether_addr __maybe_unused *vc_ether_addr)
2209*5de6c855SPrzemek Kitszel {
2210*5de6c855SPrzemek Kitszel 	u8 type = ice_vc_ether_addr_type(vc_ether_addr);
2211*5de6c855SPrzemek Kitszel 
2212*5de6c855SPrzemek Kitszel 	return (type == VIRTCHNL_ETHER_ADDR_PRIMARY);
2213*5de6c855SPrzemek Kitszel }
2214*5de6c855SPrzemek Kitszel 
2215*5de6c855SPrzemek Kitszel /**
2216*5de6c855SPrzemek Kitszel  * ice_vfhw_mac_add - update the VF's cached hardware MAC if allowed
2217*5de6c855SPrzemek Kitszel  * @vf: VF to update
2218*5de6c855SPrzemek Kitszel  * @vc_ether_addr: structure from VIRTCHNL with MAC to add
2219*5de6c855SPrzemek Kitszel  */
2220*5de6c855SPrzemek Kitszel static void
2221*5de6c855SPrzemek Kitszel ice_vfhw_mac_add(struct ice_vf *vf, struct virtchnl_ether_addr *vc_ether_addr)
2222*5de6c855SPrzemek Kitszel {
2223*5de6c855SPrzemek Kitszel 	u8 *mac_addr = vc_ether_addr->addr;
2224*5de6c855SPrzemek Kitszel 
2225*5de6c855SPrzemek Kitszel 	if (!is_valid_ether_addr(mac_addr))
2226*5de6c855SPrzemek Kitszel 		return;
2227*5de6c855SPrzemek Kitszel 
2228*5de6c855SPrzemek Kitszel 	/* only allow legacy VF drivers to set the device and hardware MAC if it
2229*5de6c855SPrzemek Kitszel 	 * is zero and allow new VF drivers to set the hardware MAC if the type
2230*5de6c855SPrzemek Kitszel 	 * was correctly specified over VIRTCHNL
2231*5de6c855SPrzemek Kitszel 	 */
2232*5de6c855SPrzemek Kitszel 	if ((ice_is_vc_addr_legacy(vc_ether_addr) &&
2233*5de6c855SPrzemek Kitszel 	     is_zero_ether_addr(vf->hw_lan_addr)) ||
2234*5de6c855SPrzemek Kitszel 	    ice_is_vc_addr_primary(vc_ether_addr)) {
2235*5de6c855SPrzemek Kitszel 		ether_addr_copy(vf->dev_lan_addr, mac_addr);
2236*5de6c855SPrzemek Kitszel 		ether_addr_copy(vf->hw_lan_addr, mac_addr);
2237*5de6c855SPrzemek Kitszel 	}
2238*5de6c855SPrzemek Kitszel 
2239*5de6c855SPrzemek Kitszel 	/* hardware and device MACs are already set, but its possible that the
2240*5de6c855SPrzemek Kitszel 	 * VF driver sent the VIRTCHNL_OP_ADD_ETH_ADDR message before the
2241*5de6c855SPrzemek Kitszel 	 * VIRTCHNL_OP_DEL_ETH_ADDR when trying to update its MAC, so save it
2242*5de6c855SPrzemek Kitszel 	 * away for the legacy VF driver case as it will be updated in the
2243*5de6c855SPrzemek Kitszel 	 * delete flow for this case
2244*5de6c855SPrzemek Kitszel 	 */
2245*5de6c855SPrzemek Kitszel 	if (ice_is_vc_addr_legacy(vc_ether_addr)) {
2246*5de6c855SPrzemek Kitszel 		ether_addr_copy(vf->legacy_last_added_umac.addr,
2247*5de6c855SPrzemek Kitszel 				mac_addr);
2248*5de6c855SPrzemek Kitszel 		vf->legacy_last_added_umac.time_modified = jiffies;
2249*5de6c855SPrzemek Kitszel 	}
2250*5de6c855SPrzemek Kitszel }
2251*5de6c855SPrzemek Kitszel 
2252*5de6c855SPrzemek Kitszel /**
2253*5de6c855SPrzemek Kitszel  * ice_is_mc_lldp_eth_addr - check if the given MAC is a multicast LLDP address
2254*5de6c855SPrzemek Kitszel  * @mac: address to check
2255*5de6c855SPrzemek Kitszel  *
2256*5de6c855SPrzemek Kitszel  * Return: true if the address is one of the three possible LLDP multicast
2257*5de6c855SPrzemek Kitszel  *	   addresses, false otherwise.
2258*5de6c855SPrzemek Kitszel  */
2259*5de6c855SPrzemek Kitszel static bool ice_is_mc_lldp_eth_addr(const u8 *mac)
2260*5de6c855SPrzemek Kitszel {
2261*5de6c855SPrzemek Kitszel 	const u8 lldp_mac_base[] = {0x01, 0x80, 0xc2, 0x00, 0x00};
2262*5de6c855SPrzemek Kitszel 
2263*5de6c855SPrzemek Kitszel 	if (memcmp(mac, lldp_mac_base, sizeof(lldp_mac_base)))
2264*5de6c855SPrzemek Kitszel 		return false;
2265*5de6c855SPrzemek Kitszel 
2266*5de6c855SPrzemek Kitszel 	return (mac[5] == 0x0e || mac[5] == 0x03 || mac[5] == 0x00);
2267*5de6c855SPrzemek Kitszel }
2268*5de6c855SPrzemek Kitszel 
2269*5de6c855SPrzemek Kitszel /**
2270*5de6c855SPrzemek Kitszel  * ice_vc_can_add_mac - check if the VF is allowed to add a given MAC
2271*5de6c855SPrzemek Kitszel  * @vf: a VF to add the address to
2272*5de6c855SPrzemek Kitszel  * @mac: address to check
2273*5de6c855SPrzemek Kitszel  *
2274*5de6c855SPrzemek Kitszel  * Return: true if the VF is allowed to add such MAC address, false otherwise.
2275*5de6c855SPrzemek Kitszel  */
2276*5de6c855SPrzemek Kitszel static bool ice_vc_can_add_mac(const struct ice_vf *vf, const u8 *mac)
2277*5de6c855SPrzemek Kitszel {
2278*5de6c855SPrzemek Kitszel 	struct device *dev = ice_pf_to_dev(vf->pf);
2279*5de6c855SPrzemek Kitszel 
2280*5de6c855SPrzemek Kitszel 	if (is_unicast_ether_addr(mac) &&
2281*5de6c855SPrzemek Kitszel 	    !ice_can_vf_change_mac((struct ice_vf *)vf)) {
2282*5de6c855SPrzemek Kitszel 		dev_err(dev,
2283*5de6c855SPrzemek Kitszel 			"VF attempting to override administratively set MAC address, bring down and up the VF interface to resume normal operation\n");
2284*5de6c855SPrzemek Kitszel 		return false;
2285*5de6c855SPrzemek Kitszel 	}
2286*5de6c855SPrzemek Kitszel 
2287*5de6c855SPrzemek Kitszel 	if (!vf->trusted && ice_is_mc_lldp_eth_addr(mac)) {
2288*5de6c855SPrzemek Kitszel 		dev_warn(dev,
2289*5de6c855SPrzemek Kitszel 			 "An untrusted VF %u is attempting to configure an LLDP multicast address\n",
2290*5de6c855SPrzemek Kitszel 			 vf->vf_id);
2291*5de6c855SPrzemek Kitszel 		return false;
2292*5de6c855SPrzemek Kitszel 	}
2293*5de6c855SPrzemek Kitszel 
2294*5de6c855SPrzemek Kitszel 	return true;
2295*5de6c855SPrzemek Kitszel }
2296*5de6c855SPrzemek Kitszel 
2297*5de6c855SPrzemek Kitszel /**
2298*5de6c855SPrzemek Kitszel  * ice_vc_add_mac_addr - attempt to add the MAC address passed in
2299*5de6c855SPrzemek Kitszel  * @vf: pointer to the VF info
2300*5de6c855SPrzemek Kitszel  * @vsi: pointer to the VF's VSI
2301*5de6c855SPrzemek Kitszel  * @vc_ether_addr: VIRTCHNL MAC address structure used to add MAC
2302*5de6c855SPrzemek Kitszel  */
2303*5de6c855SPrzemek Kitszel static int
2304*5de6c855SPrzemek Kitszel ice_vc_add_mac_addr(struct ice_vf *vf, struct ice_vsi *vsi,
2305*5de6c855SPrzemek Kitszel 		    struct virtchnl_ether_addr *vc_ether_addr)
2306*5de6c855SPrzemek Kitszel {
2307*5de6c855SPrzemek Kitszel 	struct device *dev = ice_pf_to_dev(vf->pf);
2308*5de6c855SPrzemek Kitszel 	u8 *mac_addr = vc_ether_addr->addr;
2309*5de6c855SPrzemek Kitszel 	int ret;
2310*5de6c855SPrzemek Kitszel 
2311*5de6c855SPrzemek Kitszel 	/* device MAC already added */
2312*5de6c855SPrzemek Kitszel 	if (ether_addr_equal(mac_addr, vf->dev_lan_addr))
2313*5de6c855SPrzemek Kitszel 		return 0;
2314*5de6c855SPrzemek Kitszel 
2315*5de6c855SPrzemek Kitszel 	if (!ice_vc_can_add_mac(vf, mac_addr))
2316*5de6c855SPrzemek Kitszel 		return -EPERM;
2317*5de6c855SPrzemek Kitszel 
2318*5de6c855SPrzemek Kitszel 	ret = ice_fltr_add_mac(vsi, mac_addr, ICE_FWD_TO_VSI);
2319*5de6c855SPrzemek Kitszel 	if (ret == -EEXIST) {
2320*5de6c855SPrzemek Kitszel 		dev_dbg(dev, "MAC %pM already exists for VF %d\n", mac_addr,
2321*5de6c855SPrzemek Kitszel 			vf->vf_id);
2322*5de6c855SPrzemek Kitszel 		/* don't return since we might need to update
2323*5de6c855SPrzemek Kitszel 		 * the primary MAC in ice_vfhw_mac_add() below
2324*5de6c855SPrzemek Kitszel 		 */
2325*5de6c855SPrzemek Kitszel 	} else if (ret) {
2326*5de6c855SPrzemek Kitszel 		dev_err(dev, "Failed to add MAC %pM for VF %d\n, error %d\n",
2327*5de6c855SPrzemek Kitszel 			mac_addr, vf->vf_id, ret);
2328*5de6c855SPrzemek Kitszel 		return ret;
2329*5de6c855SPrzemek Kitszel 	} else {
2330*5de6c855SPrzemek Kitszel 		vf->num_mac++;
2331*5de6c855SPrzemek Kitszel 		if (ice_is_mc_lldp_eth_addr(mac_addr))
2332*5de6c855SPrzemek Kitszel 			ice_vf_update_mac_lldp_num(vf, vsi, true);
2333*5de6c855SPrzemek Kitszel 	}
2334*5de6c855SPrzemek Kitszel 
2335*5de6c855SPrzemek Kitszel 	ice_vfhw_mac_add(vf, vc_ether_addr);
2336*5de6c855SPrzemek Kitszel 
2337*5de6c855SPrzemek Kitszel 	return ret;
2338*5de6c855SPrzemek Kitszel }
2339*5de6c855SPrzemek Kitszel 
2340*5de6c855SPrzemek Kitszel /**
2341*5de6c855SPrzemek Kitszel  * ice_is_legacy_umac_expired - check if last added legacy unicast MAC expired
2342*5de6c855SPrzemek Kitszel  * @last_added_umac: structure used to check expiration
2343*5de6c855SPrzemek Kitszel  */
2344*5de6c855SPrzemek Kitszel static bool ice_is_legacy_umac_expired(struct ice_time_mac *last_added_umac)
2345*5de6c855SPrzemek Kitszel {
2346*5de6c855SPrzemek Kitszel #define ICE_LEGACY_VF_MAC_CHANGE_EXPIRE_TIME	msecs_to_jiffies(3000)
2347*5de6c855SPrzemek Kitszel 	return time_is_before_jiffies(last_added_umac->time_modified +
2348*5de6c855SPrzemek Kitszel 				      ICE_LEGACY_VF_MAC_CHANGE_EXPIRE_TIME);
2349*5de6c855SPrzemek Kitszel }
2350*5de6c855SPrzemek Kitszel 
2351*5de6c855SPrzemek Kitszel /**
2352*5de6c855SPrzemek Kitszel  * ice_update_legacy_cached_mac - update cached hardware MAC for legacy VF
2353*5de6c855SPrzemek Kitszel  * @vf: VF to update
2354*5de6c855SPrzemek Kitszel  * @vc_ether_addr: structure from VIRTCHNL with MAC to check
2355*5de6c855SPrzemek Kitszel  *
2356*5de6c855SPrzemek Kitszel  * only update cached hardware MAC for legacy VF drivers on delete
2357*5de6c855SPrzemek Kitszel  * because we cannot guarantee order/type of MAC from the VF driver
2358*5de6c855SPrzemek Kitszel  */
2359*5de6c855SPrzemek Kitszel static void
2360*5de6c855SPrzemek Kitszel ice_update_legacy_cached_mac(struct ice_vf *vf,
2361*5de6c855SPrzemek Kitszel 			     struct virtchnl_ether_addr *vc_ether_addr)
2362*5de6c855SPrzemek Kitszel {
2363*5de6c855SPrzemek Kitszel 	if (!ice_is_vc_addr_legacy(vc_ether_addr) ||
2364*5de6c855SPrzemek Kitszel 	    ice_is_legacy_umac_expired(&vf->legacy_last_added_umac))
2365*5de6c855SPrzemek Kitszel 		return;
2366*5de6c855SPrzemek Kitszel 
2367*5de6c855SPrzemek Kitszel 	ether_addr_copy(vf->dev_lan_addr, vf->legacy_last_added_umac.addr);
2368*5de6c855SPrzemek Kitszel 	ether_addr_copy(vf->hw_lan_addr, vf->legacy_last_added_umac.addr);
2369*5de6c855SPrzemek Kitszel }
2370*5de6c855SPrzemek Kitszel 
2371*5de6c855SPrzemek Kitszel /**
2372*5de6c855SPrzemek Kitszel  * ice_vfhw_mac_del - update the VF's cached hardware MAC if allowed
2373*5de6c855SPrzemek Kitszel  * @vf: VF to update
2374*5de6c855SPrzemek Kitszel  * @vc_ether_addr: structure from VIRTCHNL with MAC to delete
2375*5de6c855SPrzemek Kitszel  */
2376*5de6c855SPrzemek Kitszel static void
2377*5de6c855SPrzemek Kitszel ice_vfhw_mac_del(struct ice_vf *vf, struct virtchnl_ether_addr *vc_ether_addr)
2378*5de6c855SPrzemek Kitszel {
2379*5de6c855SPrzemek Kitszel 	u8 *mac_addr = vc_ether_addr->addr;
2380*5de6c855SPrzemek Kitszel 
2381*5de6c855SPrzemek Kitszel 	if (!is_valid_ether_addr(mac_addr) ||
2382*5de6c855SPrzemek Kitszel 	    !ether_addr_equal(vf->dev_lan_addr, mac_addr))
2383*5de6c855SPrzemek Kitszel 		return;
2384*5de6c855SPrzemek Kitszel 
2385*5de6c855SPrzemek Kitszel 	/* allow the device MAC to be repopulated in the add flow and don't
2386*5de6c855SPrzemek Kitszel 	 * clear the hardware MAC (i.e. hw_lan_addr) here as that is meant
2387*5de6c855SPrzemek Kitszel 	 * to be persistent on VM reboot and across driver unload/load, which
2388*5de6c855SPrzemek Kitszel 	 * won't work if we clear the hardware MAC here
2389*5de6c855SPrzemek Kitszel 	 */
2390*5de6c855SPrzemek Kitszel 	eth_zero_addr(vf->dev_lan_addr);
2391*5de6c855SPrzemek Kitszel 
2392*5de6c855SPrzemek Kitszel 	ice_update_legacy_cached_mac(vf, vc_ether_addr);
2393*5de6c855SPrzemek Kitszel }
2394*5de6c855SPrzemek Kitszel 
2395*5de6c855SPrzemek Kitszel /**
2396*5de6c855SPrzemek Kitszel  * ice_vc_del_mac_addr - attempt to delete the MAC address passed in
2397*5de6c855SPrzemek Kitszel  * @vf: pointer to the VF info
2398*5de6c855SPrzemek Kitszel  * @vsi: pointer to the VF's VSI
2399*5de6c855SPrzemek Kitszel  * @vc_ether_addr: VIRTCHNL MAC address structure used to delete MAC
2400*5de6c855SPrzemek Kitszel  */
2401*5de6c855SPrzemek Kitszel static int
2402*5de6c855SPrzemek Kitszel ice_vc_del_mac_addr(struct ice_vf *vf, struct ice_vsi *vsi,
2403*5de6c855SPrzemek Kitszel 		    struct virtchnl_ether_addr *vc_ether_addr)
2404*5de6c855SPrzemek Kitszel {
2405*5de6c855SPrzemek Kitszel 	struct device *dev = ice_pf_to_dev(vf->pf);
2406*5de6c855SPrzemek Kitszel 	u8 *mac_addr = vc_ether_addr->addr;
2407*5de6c855SPrzemek Kitszel 	int status;
2408*5de6c855SPrzemek Kitszel 
2409*5de6c855SPrzemek Kitszel 	if (!ice_can_vf_change_mac(vf) &&
2410*5de6c855SPrzemek Kitszel 	    ether_addr_equal(vf->dev_lan_addr, mac_addr))
2411*5de6c855SPrzemek Kitszel 		return 0;
2412*5de6c855SPrzemek Kitszel 
2413*5de6c855SPrzemek Kitszel 	status = ice_fltr_remove_mac(vsi, mac_addr, ICE_FWD_TO_VSI);
2414*5de6c855SPrzemek Kitszel 	if (status == -ENOENT) {
2415*5de6c855SPrzemek Kitszel 		dev_err(dev, "MAC %pM does not exist for VF %d\n", mac_addr,
2416*5de6c855SPrzemek Kitszel 			vf->vf_id);
2417*5de6c855SPrzemek Kitszel 		return -ENOENT;
2418*5de6c855SPrzemek Kitszel 	} else if (status) {
2419*5de6c855SPrzemek Kitszel 		dev_err(dev, "Failed to delete MAC %pM for VF %d, error %d\n",
2420*5de6c855SPrzemek Kitszel 			mac_addr, vf->vf_id, status);
2421*5de6c855SPrzemek Kitszel 		return -EIO;
2422*5de6c855SPrzemek Kitszel 	}
2423*5de6c855SPrzemek Kitszel 
2424*5de6c855SPrzemek Kitszel 	ice_vfhw_mac_del(vf, vc_ether_addr);
2425*5de6c855SPrzemek Kitszel 
2426*5de6c855SPrzemek Kitszel 	vf->num_mac--;
2427*5de6c855SPrzemek Kitszel 	if (ice_is_mc_lldp_eth_addr(mac_addr))
2428*5de6c855SPrzemek Kitszel 		ice_vf_update_mac_lldp_num(vf, vsi, false);
2429*5de6c855SPrzemek Kitszel 
2430*5de6c855SPrzemek Kitszel 	return 0;
2431*5de6c855SPrzemek Kitszel }
2432*5de6c855SPrzemek Kitszel 
2433*5de6c855SPrzemek Kitszel /**
2434*5de6c855SPrzemek Kitszel  * ice_vc_handle_mac_addr_msg
2435*5de6c855SPrzemek Kitszel  * @vf: pointer to the VF info
2436*5de6c855SPrzemek Kitszel  * @msg: pointer to the msg buffer
2437*5de6c855SPrzemek Kitszel  * @set: true if MAC filters are being set, false otherwise
2438*5de6c855SPrzemek Kitszel  *
2439*5de6c855SPrzemek Kitszel  * add guest MAC address filter
2440*5de6c855SPrzemek Kitszel  */
2441*5de6c855SPrzemek Kitszel static int
2442*5de6c855SPrzemek Kitszel ice_vc_handle_mac_addr_msg(struct ice_vf *vf, u8 *msg, bool set)
2443*5de6c855SPrzemek Kitszel {
2444*5de6c855SPrzemek Kitszel 	int (*ice_vc_cfg_mac)
2445*5de6c855SPrzemek Kitszel 		(struct ice_vf *vf, struct ice_vsi *vsi,
2446*5de6c855SPrzemek Kitszel 		 struct virtchnl_ether_addr *virtchnl_ether_addr);
2447*5de6c855SPrzemek Kitszel 	enum virtchnl_status_code v_ret = VIRTCHNL_STATUS_SUCCESS;
2448*5de6c855SPrzemek Kitszel 	struct virtchnl_ether_addr_list *al =
2449*5de6c855SPrzemek Kitszel 	    (struct virtchnl_ether_addr_list *)msg;
2450*5de6c855SPrzemek Kitszel 	struct ice_pf *pf = vf->pf;
2451*5de6c855SPrzemek Kitszel 	enum virtchnl_ops vc_op;
2452*5de6c855SPrzemek Kitszel 	struct ice_vsi *vsi;
2453*5de6c855SPrzemek Kitszel 	int i;
2454*5de6c855SPrzemek Kitszel 
2455*5de6c855SPrzemek Kitszel 	if (set) {
2456*5de6c855SPrzemek Kitszel 		vc_op = VIRTCHNL_OP_ADD_ETH_ADDR;
2457*5de6c855SPrzemek Kitszel 		ice_vc_cfg_mac = ice_vc_add_mac_addr;
2458*5de6c855SPrzemek Kitszel 	} else {
2459*5de6c855SPrzemek Kitszel 		vc_op = VIRTCHNL_OP_DEL_ETH_ADDR;
2460*5de6c855SPrzemek Kitszel 		ice_vc_cfg_mac = ice_vc_del_mac_addr;
2461*5de6c855SPrzemek Kitszel 	}
2462*5de6c855SPrzemek Kitszel 
2463*5de6c855SPrzemek Kitszel 	if (!test_bit(ICE_VF_STATE_ACTIVE, vf->vf_states) ||
2464*5de6c855SPrzemek Kitszel 	    !ice_vc_isvalid_vsi_id(vf, al->vsi_id)) {
2465*5de6c855SPrzemek Kitszel 		v_ret = VIRTCHNL_STATUS_ERR_PARAM;
2466*5de6c855SPrzemek Kitszel 		goto handle_mac_exit;
2467*5de6c855SPrzemek Kitszel 	}
2468*5de6c855SPrzemek Kitszel 
2469*5de6c855SPrzemek Kitszel 	/* If this VF is not privileged, then we can't add more than a
2470*5de6c855SPrzemek Kitszel 	 * limited number of addresses. Check to make sure that the
2471*5de6c855SPrzemek Kitszel 	 * additions do not push us over the limit.
2472*5de6c855SPrzemek Kitszel 	 */
2473*5de6c855SPrzemek Kitszel 	if (set && !ice_is_vf_trusted(vf) &&
2474*5de6c855SPrzemek Kitszel 	    (vf->num_mac + al->num_elements) > ICE_MAX_MACADDR_PER_VF) {
2475*5de6c855SPrzemek Kitszel 		dev_err(ice_pf_to_dev(pf), "Can't add more MAC addresses, because VF-%d is not trusted, switch the VF to trusted mode in order to add more functionalities\n",
2476*5de6c855SPrzemek Kitszel 			vf->vf_id);
2477*5de6c855SPrzemek Kitszel 		v_ret = VIRTCHNL_STATUS_ERR_PARAM;
2478*5de6c855SPrzemek Kitszel 		goto handle_mac_exit;
2479*5de6c855SPrzemek Kitszel 	}
2480*5de6c855SPrzemek Kitszel 
2481*5de6c855SPrzemek Kitszel 	vsi = ice_get_vf_vsi(vf);
2482*5de6c855SPrzemek Kitszel 	if (!vsi) {
2483*5de6c855SPrzemek Kitszel 		v_ret = VIRTCHNL_STATUS_ERR_PARAM;
2484*5de6c855SPrzemek Kitszel 		goto handle_mac_exit;
2485*5de6c855SPrzemek Kitszel 	}
2486*5de6c855SPrzemek Kitszel 
2487*5de6c855SPrzemek Kitszel 	for (i = 0; i < al->num_elements; i++) {
2488*5de6c855SPrzemek Kitszel 		u8 *mac_addr = al->list[i].addr;
2489*5de6c855SPrzemek Kitszel 		int result;
2490*5de6c855SPrzemek Kitszel 
2491*5de6c855SPrzemek Kitszel 		if (is_broadcast_ether_addr(mac_addr) ||
2492*5de6c855SPrzemek Kitszel 		    is_zero_ether_addr(mac_addr))
2493*5de6c855SPrzemek Kitszel 			continue;
2494*5de6c855SPrzemek Kitszel 
2495*5de6c855SPrzemek Kitszel 		result = ice_vc_cfg_mac(vf, vsi, &al->list[i]);
2496*5de6c855SPrzemek Kitszel 		if (result == -EEXIST || result == -ENOENT) {
2497*5de6c855SPrzemek Kitszel 			continue;
2498*5de6c855SPrzemek Kitszel 		} else if (result) {
2499*5de6c855SPrzemek Kitszel 			v_ret = VIRTCHNL_STATUS_ERR_ADMIN_QUEUE_ERROR;
2500*5de6c855SPrzemek Kitszel 			goto handle_mac_exit;
2501*5de6c855SPrzemek Kitszel 		}
2502*5de6c855SPrzemek Kitszel 	}
2503*5de6c855SPrzemek Kitszel 
2504*5de6c855SPrzemek Kitszel handle_mac_exit:
2505*5de6c855SPrzemek Kitszel 	/* send the response to the VF */
2506*5de6c855SPrzemek Kitszel 	return ice_vc_send_msg_to_vf(vf, vc_op, v_ret, NULL, 0);
2507*5de6c855SPrzemek Kitszel }
2508*5de6c855SPrzemek Kitszel 
2509*5de6c855SPrzemek Kitszel /**
2510*5de6c855SPrzemek Kitszel  * ice_vc_add_mac_addr_msg
2511*5de6c855SPrzemek Kitszel  * @vf: pointer to the VF info
2512*5de6c855SPrzemek Kitszel  * @msg: pointer to the msg buffer
2513*5de6c855SPrzemek Kitszel  *
2514*5de6c855SPrzemek Kitszel  * add guest MAC address filter
2515*5de6c855SPrzemek Kitszel  */
2516*5de6c855SPrzemek Kitszel static int ice_vc_add_mac_addr_msg(struct ice_vf *vf, u8 *msg)
2517*5de6c855SPrzemek Kitszel {
2518*5de6c855SPrzemek Kitszel 	return ice_vc_handle_mac_addr_msg(vf, msg, true);
2519*5de6c855SPrzemek Kitszel }
2520*5de6c855SPrzemek Kitszel 
2521*5de6c855SPrzemek Kitszel /**
2522*5de6c855SPrzemek Kitszel  * ice_vc_del_mac_addr_msg
2523*5de6c855SPrzemek Kitszel  * @vf: pointer to the VF info
2524*5de6c855SPrzemek Kitszel  * @msg: pointer to the msg buffer
2525*5de6c855SPrzemek Kitszel  *
2526*5de6c855SPrzemek Kitszel  * remove guest MAC address filter
2527*5de6c855SPrzemek Kitszel  */
2528*5de6c855SPrzemek Kitszel static int ice_vc_del_mac_addr_msg(struct ice_vf *vf, u8 *msg)
2529*5de6c855SPrzemek Kitszel {
2530*5de6c855SPrzemek Kitszel 	return ice_vc_handle_mac_addr_msg(vf, msg, false);
2531*5de6c855SPrzemek Kitszel }
2532*5de6c855SPrzemek Kitszel 
2533*5de6c855SPrzemek Kitszel /**
2534*5de6c855SPrzemek Kitszel  * ice_vc_request_qs_msg
2535*5de6c855SPrzemek Kitszel  * @vf: pointer to the VF info
2536*5de6c855SPrzemek Kitszel  * @msg: pointer to the msg buffer
2537*5de6c855SPrzemek Kitszel  *
2538*5de6c855SPrzemek Kitszel  * VFs get a default number of queues but can use this message to request a
2539*5de6c855SPrzemek Kitszel  * different number. If the request is successful, PF will reset the VF and
2540*5de6c855SPrzemek Kitszel  * return 0. If unsuccessful, PF will send message informing VF of number of
2541*5de6c855SPrzemek Kitszel  * available queue pairs via virtchnl message response to VF.
2542*5de6c855SPrzemek Kitszel  */
2543*5de6c855SPrzemek Kitszel static int ice_vc_request_qs_msg(struct ice_vf *vf, u8 *msg)
2544*5de6c855SPrzemek Kitszel {
2545*5de6c855SPrzemek Kitszel 	enum virtchnl_status_code v_ret = VIRTCHNL_STATUS_SUCCESS;
2546*5de6c855SPrzemek Kitszel 	struct virtchnl_vf_res_request *vfres =
2547*5de6c855SPrzemek Kitszel 		(struct virtchnl_vf_res_request *)msg;
2548*5de6c855SPrzemek Kitszel 	u16 req_queues = vfres->num_queue_pairs;
2549*5de6c855SPrzemek Kitszel 	struct ice_pf *pf = vf->pf;
2550*5de6c855SPrzemek Kitszel 	u16 max_allowed_vf_queues;
2551*5de6c855SPrzemek Kitszel 	u16 tx_rx_queue_left;
2552*5de6c855SPrzemek Kitszel 	struct device *dev;
2553*5de6c855SPrzemek Kitszel 	u16 cur_queues;
2554*5de6c855SPrzemek Kitszel 
2555*5de6c855SPrzemek Kitszel 	dev = ice_pf_to_dev(pf);
2556*5de6c855SPrzemek Kitszel 	if (!test_bit(ICE_VF_STATE_ACTIVE, vf->vf_states)) {
2557*5de6c855SPrzemek Kitszel 		v_ret = VIRTCHNL_STATUS_ERR_PARAM;
2558*5de6c855SPrzemek Kitszel 		goto error_param;
2559*5de6c855SPrzemek Kitszel 	}
2560*5de6c855SPrzemek Kitszel 
2561*5de6c855SPrzemek Kitszel 	cur_queues = vf->num_vf_qs;
2562*5de6c855SPrzemek Kitszel 	tx_rx_queue_left = min_t(u16, ice_get_avail_txq_count(pf),
2563*5de6c855SPrzemek Kitszel 				 ice_get_avail_rxq_count(pf));
2564*5de6c855SPrzemek Kitszel 	max_allowed_vf_queues = tx_rx_queue_left + cur_queues;
2565*5de6c855SPrzemek Kitszel 	if (!req_queues) {
2566*5de6c855SPrzemek Kitszel 		dev_err(dev, "VF %d tried to request 0 queues. Ignoring.\n",
2567*5de6c855SPrzemek Kitszel 			vf->vf_id);
2568*5de6c855SPrzemek Kitszel 	} else if (req_queues > ICE_MAX_RSS_QS_PER_VF) {
2569*5de6c855SPrzemek Kitszel 		dev_err(dev, "VF %d tried to request more than %d queues.\n",
2570*5de6c855SPrzemek Kitszel 			vf->vf_id, ICE_MAX_RSS_QS_PER_VF);
2571*5de6c855SPrzemek Kitszel 		vfres->num_queue_pairs = ICE_MAX_RSS_QS_PER_VF;
2572*5de6c855SPrzemek Kitszel 	} else if (req_queues > cur_queues &&
2573*5de6c855SPrzemek Kitszel 		   req_queues - cur_queues > tx_rx_queue_left) {
2574*5de6c855SPrzemek Kitszel 		dev_warn(dev, "VF %d requested %u more queues, but only %u left.\n",
2575*5de6c855SPrzemek Kitszel 			 vf->vf_id, req_queues - cur_queues, tx_rx_queue_left);
2576*5de6c855SPrzemek Kitszel 		vfres->num_queue_pairs = min_t(u16, max_allowed_vf_queues,
2577*5de6c855SPrzemek Kitszel 					       ICE_MAX_RSS_QS_PER_VF);
2578*5de6c855SPrzemek Kitszel 	} else {
2579*5de6c855SPrzemek Kitszel 		/* request is successful, then reset VF */
2580*5de6c855SPrzemek Kitszel 		vf->num_req_qs = req_queues;
2581*5de6c855SPrzemek Kitszel 		ice_reset_vf(vf, ICE_VF_RESET_NOTIFY);
2582*5de6c855SPrzemek Kitszel 		dev_info(dev, "VF %d granted request of %u queues.\n",
2583*5de6c855SPrzemek Kitszel 			 vf->vf_id, req_queues);
2584*5de6c855SPrzemek Kitszel 		return 0;
2585*5de6c855SPrzemek Kitszel 	}
2586*5de6c855SPrzemek Kitszel 
2587*5de6c855SPrzemek Kitszel error_param:
2588*5de6c855SPrzemek Kitszel 	/* send the response to the VF */
2589*5de6c855SPrzemek Kitszel 	return ice_vc_send_msg_to_vf(vf, VIRTCHNL_OP_REQUEST_QUEUES,
2590*5de6c855SPrzemek Kitszel 				     v_ret, (u8 *)vfres, sizeof(*vfres));
2591*5de6c855SPrzemek Kitszel }
2592*5de6c855SPrzemek Kitszel 
2593*5de6c855SPrzemek Kitszel /**
2594*5de6c855SPrzemek Kitszel  * ice_vf_vlan_offload_ena - determine if capabilities support VLAN offloads
2595*5de6c855SPrzemek Kitszel  * @caps: VF driver negotiated capabilities
2596*5de6c855SPrzemek Kitszel  *
2597*5de6c855SPrzemek Kitszel  * Return true if VIRTCHNL_VF_OFFLOAD_VLAN capability is set, else return false
2598*5de6c855SPrzemek Kitszel  */
2599*5de6c855SPrzemek Kitszel static bool ice_vf_vlan_offload_ena(u32 caps)
2600*5de6c855SPrzemek Kitszel {
2601*5de6c855SPrzemek Kitszel 	return !!(caps & VIRTCHNL_VF_OFFLOAD_VLAN);
2602*5de6c855SPrzemek Kitszel }
2603*5de6c855SPrzemek Kitszel 
2604*5de6c855SPrzemek Kitszel /**
2605*5de6c855SPrzemek Kitszel  * ice_is_vlan_promisc_allowed - check if VLAN promiscuous config is allowed
2606*5de6c855SPrzemek Kitszel  * @vf: VF used to determine if VLAN promiscuous config is allowed
2607*5de6c855SPrzemek Kitszel  */
2608*5de6c855SPrzemek Kitszel bool ice_is_vlan_promisc_allowed(struct ice_vf *vf)
2609*5de6c855SPrzemek Kitszel {
2610*5de6c855SPrzemek Kitszel 	if ((test_bit(ICE_VF_STATE_UC_PROMISC, vf->vf_states) ||
2611*5de6c855SPrzemek Kitszel 	     test_bit(ICE_VF_STATE_MC_PROMISC, vf->vf_states)) &&
2612*5de6c855SPrzemek Kitszel 	    test_bit(ICE_FLAG_VF_TRUE_PROMISC_ENA, vf->pf->flags))
2613*5de6c855SPrzemek Kitszel 		return true;
2614*5de6c855SPrzemek Kitszel 
2615*5de6c855SPrzemek Kitszel 	return false;
2616*5de6c855SPrzemek Kitszel }
2617*5de6c855SPrzemek Kitszel 
2618*5de6c855SPrzemek Kitszel /**
2619*5de6c855SPrzemek Kitszel  * ice_vf_ena_vlan_promisc - Enable Tx/Rx VLAN promiscuous for the VLAN
2620*5de6c855SPrzemek Kitszel  * @vf: VF to enable VLAN promisc on
2621*5de6c855SPrzemek Kitszel  * @vsi: VF's VSI used to enable VLAN promiscuous mode
2622*5de6c855SPrzemek Kitszel  * @vlan: VLAN used to enable VLAN promiscuous
2623*5de6c855SPrzemek Kitszel  *
2624*5de6c855SPrzemek Kitszel  * This function should only be called if VLAN promiscuous mode is allowed,
2625*5de6c855SPrzemek Kitszel  * which can be determined via ice_is_vlan_promisc_allowed().
2626*5de6c855SPrzemek Kitszel  */
2627*5de6c855SPrzemek Kitszel int ice_vf_ena_vlan_promisc(struct ice_vf *vf, struct ice_vsi *vsi,
2628*5de6c855SPrzemek Kitszel 			    struct ice_vlan *vlan)
2629*5de6c855SPrzemek Kitszel {
2630*5de6c855SPrzemek Kitszel 	u8 promisc_m = 0;
2631*5de6c855SPrzemek Kitszel 	int status;
2632*5de6c855SPrzemek Kitszel 
2633*5de6c855SPrzemek Kitszel 	if (test_bit(ICE_VF_STATE_UC_PROMISC, vf->vf_states))
2634*5de6c855SPrzemek Kitszel 		promisc_m |= ICE_UCAST_VLAN_PROMISC_BITS;
2635*5de6c855SPrzemek Kitszel 	if (test_bit(ICE_VF_STATE_MC_PROMISC, vf->vf_states))
2636*5de6c855SPrzemek Kitszel 		promisc_m |= ICE_MCAST_VLAN_PROMISC_BITS;
2637*5de6c855SPrzemek Kitszel 
2638*5de6c855SPrzemek Kitszel 	if (!promisc_m)
2639*5de6c855SPrzemek Kitszel 		return 0;
2640*5de6c855SPrzemek Kitszel 
2641*5de6c855SPrzemek Kitszel 	status = ice_fltr_set_vsi_promisc(&vsi->back->hw, vsi->idx, promisc_m,
2642*5de6c855SPrzemek Kitszel 					  vlan->vid);
2643*5de6c855SPrzemek Kitszel 	if (status && status != -EEXIST)
2644*5de6c855SPrzemek Kitszel 		return status;
2645*5de6c855SPrzemek Kitszel 
2646*5de6c855SPrzemek Kitszel 	return 0;
2647*5de6c855SPrzemek Kitszel }
2648*5de6c855SPrzemek Kitszel 
2649*5de6c855SPrzemek Kitszel /**
2650*5de6c855SPrzemek Kitszel  * ice_vf_dis_vlan_promisc - Disable Tx/Rx VLAN promiscuous for the VLAN
2651*5de6c855SPrzemek Kitszel  * @vsi: VF's VSI used to disable VLAN promiscuous mode for
2652*5de6c855SPrzemek Kitszel  * @vlan: VLAN used to disable VLAN promiscuous
2653*5de6c855SPrzemek Kitszel  *
2654*5de6c855SPrzemek Kitszel  * This function should only be called if VLAN promiscuous mode is allowed,
2655*5de6c855SPrzemek Kitszel  * which can be determined via ice_is_vlan_promisc_allowed().
2656*5de6c855SPrzemek Kitszel  */
2657*5de6c855SPrzemek Kitszel static int ice_vf_dis_vlan_promisc(struct ice_vsi *vsi, struct ice_vlan *vlan)
2658*5de6c855SPrzemek Kitszel {
2659*5de6c855SPrzemek Kitszel 	u8 promisc_m = ICE_UCAST_VLAN_PROMISC_BITS | ICE_MCAST_VLAN_PROMISC_BITS;
2660*5de6c855SPrzemek Kitszel 	int status;
2661*5de6c855SPrzemek Kitszel 
2662*5de6c855SPrzemek Kitszel 	status = ice_fltr_clear_vsi_promisc(&vsi->back->hw, vsi->idx, promisc_m,
2663*5de6c855SPrzemek Kitszel 					    vlan->vid);
2664*5de6c855SPrzemek Kitszel 	if (status && status != -ENOENT)
2665*5de6c855SPrzemek Kitszel 		return status;
2666*5de6c855SPrzemek Kitszel 
2667*5de6c855SPrzemek Kitszel 	return 0;
2668*5de6c855SPrzemek Kitszel }
2669*5de6c855SPrzemek Kitszel 
2670*5de6c855SPrzemek Kitszel /**
2671*5de6c855SPrzemek Kitszel  * ice_vf_has_max_vlans - check if VF already has the max allowed VLAN filters
2672*5de6c855SPrzemek Kitszel  * @vf: VF to check against
2673*5de6c855SPrzemek Kitszel  * @vsi: VF's VSI
2674*5de6c855SPrzemek Kitszel  *
2675*5de6c855SPrzemek Kitszel  * If the VF is trusted then the VF is allowed to add as many VLANs as it
2676*5de6c855SPrzemek Kitszel  * wants to, so return false.
2677*5de6c855SPrzemek Kitszel  *
2678*5de6c855SPrzemek Kitszel  * When the VF is untrusted compare the number of non-zero VLANs + 1 to the max
2679*5de6c855SPrzemek Kitszel  * allowed VLANs for an untrusted VF. Return the result of this comparison.
2680*5de6c855SPrzemek Kitszel  */
2681*5de6c855SPrzemek Kitszel static bool ice_vf_has_max_vlans(struct ice_vf *vf, struct ice_vsi *vsi)
2682*5de6c855SPrzemek Kitszel {
2683*5de6c855SPrzemek Kitszel 	if (ice_is_vf_trusted(vf))
2684*5de6c855SPrzemek Kitszel 		return false;
2685*5de6c855SPrzemek Kitszel 
2686*5de6c855SPrzemek Kitszel #define ICE_VF_ADDED_VLAN_ZERO_FLTRS	1
2687*5de6c855SPrzemek Kitszel 	return ((ice_vsi_num_non_zero_vlans(vsi) +
2688*5de6c855SPrzemek Kitszel 		ICE_VF_ADDED_VLAN_ZERO_FLTRS) >= ICE_MAX_VLAN_PER_VF);
2689*5de6c855SPrzemek Kitszel }
2690*5de6c855SPrzemek Kitszel 
2691*5de6c855SPrzemek Kitszel /**
2692*5de6c855SPrzemek Kitszel  * ice_vc_process_vlan_msg
2693*5de6c855SPrzemek Kitszel  * @vf: pointer to the VF info
2694*5de6c855SPrzemek Kitszel  * @msg: pointer to the msg buffer
2695*5de6c855SPrzemek Kitszel  * @add_v: Add VLAN if true, otherwise delete VLAN
2696*5de6c855SPrzemek Kitszel  *
2697*5de6c855SPrzemek Kitszel  * Process virtchnl op to add or remove programmed guest VLAN ID
2698*5de6c855SPrzemek Kitszel  */
2699*5de6c855SPrzemek Kitszel static int ice_vc_process_vlan_msg(struct ice_vf *vf, u8 *msg, bool add_v)
2700*5de6c855SPrzemek Kitszel {
2701*5de6c855SPrzemek Kitszel 	enum virtchnl_status_code v_ret = VIRTCHNL_STATUS_SUCCESS;
2702*5de6c855SPrzemek Kitszel 	struct virtchnl_vlan_filter_list *vfl =
2703*5de6c855SPrzemek Kitszel 	    (struct virtchnl_vlan_filter_list *)msg;
2704*5de6c855SPrzemek Kitszel 	struct ice_pf *pf = vf->pf;
2705*5de6c855SPrzemek Kitszel 	bool vlan_promisc = false;
2706*5de6c855SPrzemek Kitszel 	struct ice_vsi *vsi;
2707*5de6c855SPrzemek Kitszel 	struct device *dev;
2708*5de6c855SPrzemek Kitszel 	int status = 0;
2709*5de6c855SPrzemek Kitszel 	int i;
2710*5de6c855SPrzemek Kitszel 
2711*5de6c855SPrzemek Kitszel 	dev = ice_pf_to_dev(pf);
2712*5de6c855SPrzemek Kitszel 	if (!test_bit(ICE_VF_STATE_ACTIVE, vf->vf_states)) {
2713*5de6c855SPrzemek Kitszel 		v_ret = VIRTCHNL_STATUS_ERR_PARAM;
2714*5de6c855SPrzemek Kitszel 		goto error_param;
2715*5de6c855SPrzemek Kitszel 	}
2716*5de6c855SPrzemek Kitszel 
2717*5de6c855SPrzemek Kitszel 	if (!ice_vf_vlan_offload_ena(vf->driver_caps)) {
2718*5de6c855SPrzemek Kitszel 		v_ret = VIRTCHNL_STATUS_ERR_PARAM;
2719*5de6c855SPrzemek Kitszel 		goto error_param;
2720*5de6c855SPrzemek Kitszel 	}
2721*5de6c855SPrzemek Kitszel 
2722*5de6c855SPrzemek Kitszel 	if (!ice_vc_isvalid_vsi_id(vf, vfl->vsi_id)) {
2723*5de6c855SPrzemek Kitszel 		v_ret = VIRTCHNL_STATUS_ERR_PARAM;
2724*5de6c855SPrzemek Kitszel 		goto error_param;
2725*5de6c855SPrzemek Kitszel 	}
2726*5de6c855SPrzemek Kitszel 
2727*5de6c855SPrzemek Kitszel 	for (i = 0; i < vfl->num_elements; i++) {
2728*5de6c855SPrzemek Kitszel 		if (vfl->vlan_id[i] >= VLAN_N_VID) {
2729*5de6c855SPrzemek Kitszel 			v_ret = VIRTCHNL_STATUS_ERR_PARAM;
2730*5de6c855SPrzemek Kitszel 			dev_err(dev, "invalid VF VLAN id %d\n",
2731*5de6c855SPrzemek Kitszel 				vfl->vlan_id[i]);
2732*5de6c855SPrzemek Kitszel 			goto error_param;
2733*5de6c855SPrzemek Kitszel 		}
2734*5de6c855SPrzemek Kitszel 	}
2735*5de6c855SPrzemek Kitszel 
2736*5de6c855SPrzemek Kitszel 	vsi = ice_get_vf_vsi(vf);
2737*5de6c855SPrzemek Kitszel 	if (!vsi) {
2738*5de6c855SPrzemek Kitszel 		v_ret = VIRTCHNL_STATUS_ERR_PARAM;
2739*5de6c855SPrzemek Kitszel 		goto error_param;
2740*5de6c855SPrzemek Kitszel 	}
2741*5de6c855SPrzemek Kitszel 
2742*5de6c855SPrzemek Kitszel 	if (add_v && ice_vf_has_max_vlans(vf, vsi)) {
2743*5de6c855SPrzemek Kitszel 		dev_info(dev, "VF-%d is not trusted, switch the VF to trusted mode, in order to add more VLAN addresses\n",
2744*5de6c855SPrzemek Kitszel 			 vf->vf_id);
2745*5de6c855SPrzemek Kitszel 		/* There is no need to let VF know about being not trusted,
2746*5de6c855SPrzemek Kitszel 		 * so we can just return success message here
2747*5de6c855SPrzemek Kitszel 		 */
2748*5de6c855SPrzemek Kitszel 		goto error_param;
2749*5de6c855SPrzemek Kitszel 	}
2750*5de6c855SPrzemek Kitszel 
2751*5de6c855SPrzemek Kitszel 	/* in DVM a VF can add/delete inner VLAN filters when
2752*5de6c855SPrzemek Kitszel 	 * VIRTCHNL_VF_OFFLOAD_VLAN is negotiated, so only reject in SVM
2753*5de6c855SPrzemek Kitszel 	 */
2754*5de6c855SPrzemek Kitszel 	if (ice_vf_is_port_vlan_ena(vf) && !ice_is_dvm_ena(&pf->hw)) {
2755*5de6c855SPrzemek Kitszel 		v_ret = VIRTCHNL_STATUS_ERR_PARAM;
2756*5de6c855SPrzemek Kitszel 		goto error_param;
2757*5de6c855SPrzemek Kitszel 	}
2758*5de6c855SPrzemek Kitszel 
2759*5de6c855SPrzemek Kitszel 	/* in DVM VLAN promiscuous is based on the outer VLAN, which would be
2760*5de6c855SPrzemek Kitszel 	 * the port VLAN if VIRTCHNL_VF_OFFLOAD_VLAN was negotiated, so only
2761*5de6c855SPrzemek Kitszel 	 * allow vlan_promisc = true in SVM and if no port VLAN is configured
2762*5de6c855SPrzemek Kitszel 	 */
2763*5de6c855SPrzemek Kitszel 	vlan_promisc = ice_is_vlan_promisc_allowed(vf) &&
2764*5de6c855SPrzemek Kitszel 		!ice_is_dvm_ena(&pf->hw) &&
2765*5de6c855SPrzemek Kitszel 		!ice_vf_is_port_vlan_ena(vf);
2766*5de6c855SPrzemek Kitszel 
2767*5de6c855SPrzemek Kitszel 	if (add_v) {
2768*5de6c855SPrzemek Kitszel 		for (i = 0; i < vfl->num_elements; i++) {
2769*5de6c855SPrzemek Kitszel 			u16 vid = vfl->vlan_id[i];
2770*5de6c855SPrzemek Kitszel 			struct ice_vlan vlan;
2771*5de6c855SPrzemek Kitszel 
2772*5de6c855SPrzemek Kitszel 			if (ice_vf_has_max_vlans(vf, vsi)) {
2773*5de6c855SPrzemek Kitszel 				dev_info(dev, "VF-%d is not trusted, switch the VF to trusted mode, in order to add more VLAN addresses\n",
2774*5de6c855SPrzemek Kitszel 					 vf->vf_id);
2775*5de6c855SPrzemek Kitszel 				/* There is no need to let VF know about being
2776*5de6c855SPrzemek Kitszel 				 * not trusted, so we can just return success
2777*5de6c855SPrzemek Kitszel 				 * message here as well.
2778*5de6c855SPrzemek Kitszel 				 */
2779*5de6c855SPrzemek Kitszel 				goto error_param;
2780*5de6c855SPrzemek Kitszel 			}
2781*5de6c855SPrzemek Kitszel 
2782*5de6c855SPrzemek Kitszel 			/* we add VLAN 0 by default for each VF so we can enable
2783*5de6c855SPrzemek Kitszel 			 * Tx VLAN anti-spoof without triggering MDD events so
2784*5de6c855SPrzemek Kitszel 			 * we don't need to add it again here
2785*5de6c855SPrzemek Kitszel 			 */
2786*5de6c855SPrzemek Kitszel 			if (!vid)
2787*5de6c855SPrzemek Kitszel 				continue;
2788*5de6c855SPrzemek Kitszel 
2789*5de6c855SPrzemek Kitszel 			vlan = ICE_VLAN(ETH_P_8021Q, vid, 0);
2790*5de6c855SPrzemek Kitszel 			status = vsi->inner_vlan_ops.add_vlan(vsi, &vlan);
2791*5de6c855SPrzemek Kitszel 			if (status) {
2792*5de6c855SPrzemek Kitszel 				v_ret = VIRTCHNL_STATUS_ERR_PARAM;
2793*5de6c855SPrzemek Kitszel 				goto error_param;
2794*5de6c855SPrzemek Kitszel 			}
2795*5de6c855SPrzemek Kitszel 
2796*5de6c855SPrzemek Kitszel 			/* Enable VLAN filtering on first non-zero VLAN */
2797*5de6c855SPrzemek Kitszel 			if (!vlan_promisc && vid && !ice_is_dvm_ena(&pf->hw)) {
2798*5de6c855SPrzemek Kitszel 				if (vf->spoofchk) {
2799*5de6c855SPrzemek Kitszel 					status = vsi->inner_vlan_ops.ena_tx_filtering(vsi);
2800*5de6c855SPrzemek Kitszel 					if (status) {
2801*5de6c855SPrzemek Kitszel 						v_ret = VIRTCHNL_STATUS_ERR_PARAM;
2802*5de6c855SPrzemek Kitszel 						dev_err(dev, "Enable VLAN anti-spoofing on VLAN ID: %d failed error-%d\n",
2803*5de6c855SPrzemek Kitszel 							vid, status);
2804*5de6c855SPrzemek Kitszel 						goto error_param;
2805*5de6c855SPrzemek Kitszel 					}
2806*5de6c855SPrzemek Kitszel 				}
2807*5de6c855SPrzemek Kitszel 				if (vsi->inner_vlan_ops.ena_rx_filtering(vsi)) {
2808*5de6c855SPrzemek Kitszel 					v_ret = VIRTCHNL_STATUS_ERR_PARAM;
2809*5de6c855SPrzemek Kitszel 					dev_err(dev, "Enable VLAN pruning on VLAN ID: %d failed error-%d\n",
2810*5de6c855SPrzemek Kitszel 						vid, status);
2811*5de6c855SPrzemek Kitszel 					goto error_param;
2812*5de6c855SPrzemek Kitszel 				}
2813*5de6c855SPrzemek Kitszel 			} else if (vlan_promisc) {
2814*5de6c855SPrzemek Kitszel 				status = ice_vf_ena_vlan_promisc(vf, vsi, &vlan);
2815*5de6c855SPrzemek Kitszel 				if (status) {
2816*5de6c855SPrzemek Kitszel 					v_ret = VIRTCHNL_STATUS_ERR_PARAM;
2817*5de6c855SPrzemek Kitszel 					dev_err(dev, "Enable Unicast/multicast promiscuous mode on VLAN ID:%d failed error-%d\n",
2818*5de6c855SPrzemek Kitszel 						vid, status);
2819*5de6c855SPrzemek Kitszel 				}
2820*5de6c855SPrzemek Kitszel 			}
2821*5de6c855SPrzemek Kitszel 		}
2822*5de6c855SPrzemek Kitszel 	} else {
2823*5de6c855SPrzemek Kitszel 		/* In case of non_trusted VF, number of VLAN elements passed
2824*5de6c855SPrzemek Kitszel 		 * to PF for removal might be greater than number of VLANs
2825*5de6c855SPrzemek Kitszel 		 * filter programmed for that VF - So, use actual number of
2826*5de6c855SPrzemek Kitszel 		 * VLANS added earlier with add VLAN opcode. In order to avoid
2827*5de6c855SPrzemek Kitszel 		 * removing VLAN that doesn't exist, which result to sending
2828*5de6c855SPrzemek Kitszel 		 * erroneous failed message back to the VF
2829*5de6c855SPrzemek Kitszel 		 */
2830*5de6c855SPrzemek Kitszel 		int num_vf_vlan;
2831*5de6c855SPrzemek Kitszel 
2832*5de6c855SPrzemek Kitszel 		num_vf_vlan = vsi->num_vlan;
2833*5de6c855SPrzemek Kitszel 		for (i = 0; i < vfl->num_elements && i < num_vf_vlan; i++) {
2834*5de6c855SPrzemek Kitszel 			u16 vid = vfl->vlan_id[i];
2835*5de6c855SPrzemek Kitszel 			struct ice_vlan vlan;
2836*5de6c855SPrzemek Kitszel 
2837*5de6c855SPrzemek Kitszel 			/* we add VLAN 0 by default for each VF so we can enable
2838*5de6c855SPrzemek Kitszel 			 * Tx VLAN anti-spoof without triggering MDD events so
2839*5de6c855SPrzemek Kitszel 			 * we don't want a VIRTCHNL request to remove it
2840*5de6c855SPrzemek Kitszel 			 */
2841*5de6c855SPrzemek Kitszel 			if (!vid)
2842*5de6c855SPrzemek Kitszel 				continue;
2843*5de6c855SPrzemek Kitszel 
2844*5de6c855SPrzemek Kitszel 			vlan = ICE_VLAN(ETH_P_8021Q, vid, 0);
2845*5de6c855SPrzemek Kitszel 			status = vsi->inner_vlan_ops.del_vlan(vsi, &vlan);
2846*5de6c855SPrzemek Kitszel 			if (status) {
2847*5de6c855SPrzemek Kitszel 				v_ret = VIRTCHNL_STATUS_ERR_PARAM;
2848*5de6c855SPrzemek Kitszel 				goto error_param;
2849*5de6c855SPrzemek Kitszel 			}
2850*5de6c855SPrzemek Kitszel 
2851*5de6c855SPrzemek Kitszel 			/* Disable VLAN filtering when only VLAN 0 is left */
2852*5de6c855SPrzemek Kitszel 			if (!ice_vsi_has_non_zero_vlans(vsi)) {
2853*5de6c855SPrzemek Kitszel 				vsi->inner_vlan_ops.dis_tx_filtering(vsi);
2854*5de6c855SPrzemek Kitszel 				vsi->inner_vlan_ops.dis_rx_filtering(vsi);
2855*5de6c855SPrzemek Kitszel 			}
2856*5de6c855SPrzemek Kitszel 
2857*5de6c855SPrzemek Kitszel 			if (vlan_promisc)
2858*5de6c855SPrzemek Kitszel 				ice_vf_dis_vlan_promisc(vsi, &vlan);
2859*5de6c855SPrzemek Kitszel 		}
2860*5de6c855SPrzemek Kitszel 	}
2861*5de6c855SPrzemek Kitszel 
2862*5de6c855SPrzemek Kitszel error_param:
2863*5de6c855SPrzemek Kitszel 	/* send the response to the VF */
2864*5de6c855SPrzemek Kitszel 	if (add_v)
2865*5de6c855SPrzemek Kitszel 		return ice_vc_send_msg_to_vf(vf, VIRTCHNL_OP_ADD_VLAN, v_ret,
2866*5de6c855SPrzemek Kitszel 					     NULL, 0);
2867*5de6c855SPrzemek Kitszel 	else
2868*5de6c855SPrzemek Kitszel 		return ice_vc_send_msg_to_vf(vf, VIRTCHNL_OP_DEL_VLAN, v_ret,
2869*5de6c855SPrzemek Kitszel 					     NULL, 0);
2870*5de6c855SPrzemek Kitszel }
2871*5de6c855SPrzemek Kitszel 
2872*5de6c855SPrzemek Kitszel /**
2873*5de6c855SPrzemek Kitszel  * ice_vc_add_vlan_msg
2874*5de6c855SPrzemek Kitszel  * @vf: pointer to the VF info
2875*5de6c855SPrzemek Kitszel  * @msg: pointer to the msg buffer
2876*5de6c855SPrzemek Kitszel  *
2877*5de6c855SPrzemek Kitszel  * Add and program guest VLAN ID
2878*5de6c855SPrzemek Kitszel  */
2879*5de6c855SPrzemek Kitszel static int ice_vc_add_vlan_msg(struct ice_vf *vf, u8 *msg)
2880*5de6c855SPrzemek Kitszel {
2881*5de6c855SPrzemek Kitszel 	return ice_vc_process_vlan_msg(vf, msg, true);
2882*5de6c855SPrzemek Kitszel }
2883*5de6c855SPrzemek Kitszel 
2884*5de6c855SPrzemek Kitszel /**
2885*5de6c855SPrzemek Kitszel  * ice_vc_remove_vlan_msg
2886*5de6c855SPrzemek Kitszel  * @vf: pointer to the VF info
2887*5de6c855SPrzemek Kitszel  * @msg: pointer to the msg buffer
2888*5de6c855SPrzemek Kitszel  *
2889*5de6c855SPrzemek Kitszel  * remove programmed guest VLAN ID
2890*5de6c855SPrzemek Kitszel  */
2891*5de6c855SPrzemek Kitszel static int ice_vc_remove_vlan_msg(struct ice_vf *vf, u8 *msg)
2892*5de6c855SPrzemek Kitszel {
2893*5de6c855SPrzemek Kitszel 	return ice_vc_process_vlan_msg(vf, msg, false);
2894*5de6c855SPrzemek Kitszel }
2895*5de6c855SPrzemek Kitszel 
2896*5de6c855SPrzemek Kitszel /**
2897*5de6c855SPrzemek Kitszel  * ice_vsi_is_rxq_crc_strip_dis - check if Rx queue CRC strip is disabled or not
2898*5de6c855SPrzemek Kitszel  * @vsi: pointer to the VF VSI info
2899*5de6c855SPrzemek Kitszel  */
2900*5de6c855SPrzemek Kitszel static bool ice_vsi_is_rxq_crc_strip_dis(struct ice_vsi *vsi)
2901*5de6c855SPrzemek Kitszel {
2902*5de6c855SPrzemek Kitszel 	unsigned int i;
2903*5de6c855SPrzemek Kitszel 
2904*5de6c855SPrzemek Kitszel 	ice_for_each_alloc_rxq(vsi, i)
2905*5de6c855SPrzemek Kitszel 		if (vsi->rx_rings[i]->flags & ICE_RX_FLAGS_CRC_STRIP_DIS)
2906*5de6c855SPrzemek Kitszel 			return true;
2907*5de6c855SPrzemek Kitszel 
2908*5de6c855SPrzemek Kitszel 	return false;
2909*5de6c855SPrzemek Kitszel }
2910*5de6c855SPrzemek Kitszel 
2911*5de6c855SPrzemek Kitszel /**
2912*5de6c855SPrzemek Kitszel  * ice_vc_ena_vlan_stripping
2913*5de6c855SPrzemek Kitszel  * @vf: pointer to the VF info
2914*5de6c855SPrzemek Kitszel  *
2915*5de6c855SPrzemek Kitszel  * Enable VLAN header stripping for a given VF
2916*5de6c855SPrzemek Kitszel  */
2917*5de6c855SPrzemek Kitszel static int ice_vc_ena_vlan_stripping(struct ice_vf *vf)
2918*5de6c855SPrzemek Kitszel {
2919*5de6c855SPrzemek Kitszel 	enum virtchnl_status_code v_ret = VIRTCHNL_STATUS_SUCCESS;
2920*5de6c855SPrzemek Kitszel 	struct ice_vsi *vsi;
2921*5de6c855SPrzemek Kitszel 
2922*5de6c855SPrzemek Kitszel 	if (!test_bit(ICE_VF_STATE_ACTIVE, vf->vf_states)) {
2923*5de6c855SPrzemek Kitszel 		v_ret = VIRTCHNL_STATUS_ERR_PARAM;
2924*5de6c855SPrzemek Kitszel 		goto error_param;
2925*5de6c855SPrzemek Kitszel 	}
2926*5de6c855SPrzemek Kitszel 
2927*5de6c855SPrzemek Kitszel 	if (!ice_vf_vlan_offload_ena(vf->driver_caps)) {
2928*5de6c855SPrzemek Kitszel 		v_ret = VIRTCHNL_STATUS_ERR_PARAM;
2929*5de6c855SPrzemek Kitszel 		goto error_param;
2930*5de6c855SPrzemek Kitszel 	}
2931*5de6c855SPrzemek Kitszel 
2932*5de6c855SPrzemek Kitszel 	vsi = ice_get_vf_vsi(vf);
2933*5de6c855SPrzemek Kitszel 	if (!vsi) {
2934*5de6c855SPrzemek Kitszel 		v_ret = VIRTCHNL_STATUS_ERR_PARAM;
2935*5de6c855SPrzemek Kitszel 		goto error_param;
2936*5de6c855SPrzemek Kitszel 	}
2937*5de6c855SPrzemek Kitszel 
2938*5de6c855SPrzemek Kitszel 	if (vsi->inner_vlan_ops.ena_stripping(vsi, ETH_P_8021Q))
2939*5de6c855SPrzemek Kitszel 		v_ret = VIRTCHNL_STATUS_ERR_PARAM;
2940*5de6c855SPrzemek Kitszel 	else
2941*5de6c855SPrzemek Kitszel 		vf->vlan_strip_ena |= ICE_INNER_VLAN_STRIP_ENA;
2942*5de6c855SPrzemek Kitszel 
2943*5de6c855SPrzemek Kitszel error_param:
2944*5de6c855SPrzemek Kitszel 	return ice_vc_send_msg_to_vf(vf, VIRTCHNL_OP_ENABLE_VLAN_STRIPPING,
2945*5de6c855SPrzemek Kitszel 				     v_ret, NULL, 0);
2946*5de6c855SPrzemek Kitszel }
2947*5de6c855SPrzemek Kitszel 
2948*5de6c855SPrzemek Kitszel /**
2949*5de6c855SPrzemek Kitszel  * ice_vc_dis_vlan_stripping
2950*5de6c855SPrzemek Kitszel  * @vf: pointer to the VF info
2951*5de6c855SPrzemek Kitszel  *
2952*5de6c855SPrzemek Kitszel  * Disable VLAN header stripping for a given VF
2953*5de6c855SPrzemek Kitszel  */
2954*5de6c855SPrzemek Kitszel static int ice_vc_dis_vlan_stripping(struct ice_vf *vf)
2955*5de6c855SPrzemek Kitszel {
2956*5de6c855SPrzemek Kitszel 	enum virtchnl_status_code v_ret = VIRTCHNL_STATUS_SUCCESS;
2957*5de6c855SPrzemek Kitszel 	struct ice_vsi *vsi;
2958*5de6c855SPrzemek Kitszel 
2959*5de6c855SPrzemek Kitszel 	if (!test_bit(ICE_VF_STATE_ACTIVE, vf->vf_states)) {
2960*5de6c855SPrzemek Kitszel 		v_ret = VIRTCHNL_STATUS_ERR_PARAM;
2961*5de6c855SPrzemek Kitszel 		goto error_param;
2962*5de6c855SPrzemek Kitszel 	}
2963*5de6c855SPrzemek Kitszel 
2964*5de6c855SPrzemek Kitszel 	if (!ice_vf_vlan_offload_ena(vf->driver_caps)) {
2965*5de6c855SPrzemek Kitszel 		v_ret = VIRTCHNL_STATUS_ERR_PARAM;
2966*5de6c855SPrzemek Kitszel 		goto error_param;
2967*5de6c855SPrzemek Kitszel 	}
2968*5de6c855SPrzemek Kitszel 
2969*5de6c855SPrzemek Kitszel 	vsi = ice_get_vf_vsi(vf);
2970*5de6c855SPrzemek Kitszel 	if (!vsi) {
2971*5de6c855SPrzemek Kitszel 		v_ret = VIRTCHNL_STATUS_ERR_PARAM;
2972*5de6c855SPrzemek Kitszel 		goto error_param;
2973*5de6c855SPrzemek Kitszel 	}
2974*5de6c855SPrzemek Kitszel 
2975*5de6c855SPrzemek Kitszel 	if (vsi->inner_vlan_ops.dis_stripping(vsi))
2976*5de6c855SPrzemek Kitszel 		v_ret = VIRTCHNL_STATUS_ERR_PARAM;
2977*5de6c855SPrzemek Kitszel 	else
2978*5de6c855SPrzemek Kitszel 		vf->vlan_strip_ena &= ~ICE_INNER_VLAN_STRIP_ENA;
2979*5de6c855SPrzemek Kitszel 
2980*5de6c855SPrzemek Kitszel error_param:
2981*5de6c855SPrzemek Kitszel 	return ice_vc_send_msg_to_vf(vf, VIRTCHNL_OP_DISABLE_VLAN_STRIPPING,
2982*5de6c855SPrzemek Kitszel 				     v_ret, NULL, 0);
2983*5de6c855SPrzemek Kitszel }
2984*5de6c855SPrzemek Kitszel 
2985*5de6c855SPrzemek Kitszel /**
2986*5de6c855SPrzemek Kitszel  * ice_vc_get_rss_hashcfg - return the RSS Hash configuration
2987*5de6c855SPrzemek Kitszel  * @vf: pointer to the VF info
2988*5de6c855SPrzemek Kitszel  */
2989*5de6c855SPrzemek Kitszel static int ice_vc_get_rss_hashcfg(struct ice_vf *vf)
2990*5de6c855SPrzemek Kitszel {
2991*5de6c855SPrzemek Kitszel 	enum virtchnl_status_code v_ret = VIRTCHNL_STATUS_SUCCESS;
2992*5de6c855SPrzemek Kitszel 	struct virtchnl_rss_hashcfg *vrh = NULL;
2993*5de6c855SPrzemek Kitszel 	int len = 0, ret;
2994*5de6c855SPrzemek Kitszel 
2995*5de6c855SPrzemek Kitszel 	if (!test_bit(ICE_VF_STATE_ACTIVE, vf->vf_states)) {
2996*5de6c855SPrzemek Kitszel 		v_ret = VIRTCHNL_STATUS_ERR_PARAM;
2997*5de6c855SPrzemek Kitszel 		goto err;
2998*5de6c855SPrzemek Kitszel 	}
2999*5de6c855SPrzemek Kitszel 
3000*5de6c855SPrzemek Kitszel 	if (!test_bit(ICE_FLAG_RSS_ENA, vf->pf->flags)) {
3001*5de6c855SPrzemek Kitszel 		dev_err(ice_pf_to_dev(vf->pf), "RSS not supported by PF\n");
3002*5de6c855SPrzemek Kitszel 		v_ret = VIRTCHNL_STATUS_ERR_PARAM;
3003*5de6c855SPrzemek Kitszel 		goto err;
3004*5de6c855SPrzemek Kitszel 	}
3005*5de6c855SPrzemek Kitszel 
3006*5de6c855SPrzemek Kitszel 	len = sizeof(struct virtchnl_rss_hashcfg);
3007*5de6c855SPrzemek Kitszel 	vrh = kzalloc(len, GFP_KERNEL);
3008*5de6c855SPrzemek Kitszel 	if (!vrh) {
3009*5de6c855SPrzemek Kitszel 		v_ret = VIRTCHNL_STATUS_ERR_NO_MEMORY;
3010*5de6c855SPrzemek Kitszel 		len = 0;
3011*5de6c855SPrzemek Kitszel 		goto err;
3012*5de6c855SPrzemek Kitszel 	}
3013*5de6c855SPrzemek Kitszel 
3014*5de6c855SPrzemek Kitszel 	vrh->hashcfg = ICE_DEFAULT_RSS_HASHCFG;
3015*5de6c855SPrzemek Kitszel err:
3016*5de6c855SPrzemek Kitszel 	/* send the response back to the VF */
3017*5de6c855SPrzemek Kitszel 	ret = ice_vc_send_msg_to_vf(vf, VIRTCHNL_OP_GET_RSS_HASHCFG_CAPS, v_ret,
3018*5de6c855SPrzemek Kitszel 				    (u8 *)vrh, len);
3019*5de6c855SPrzemek Kitszel 	kfree(vrh);
3020*5de6c855SPrzemek Kitszel 	return ret;
3021*5de6c855SPrzemek Kitszel }
3022*5de6c855SPrzemek Kitszel 
3023*5de6c855SPrzemek Kitszel /**
3024*5de6c855SPrzemek Kitszel  * ice_vc_set_rss_hashcfg - set RSS Hash configuration bits for the VF
3025*5de6c855SPrzemek Kitszel  * @vf: pointer to the VF info
3026*5de6c855SPrzemek Kitszel  * @msg: pointer to the msg buffer
3027*5de6c855SPrzemek Kitszel  */
3028*5de6c855SPrzemek Kitszel static int ice_vc_set_rss_hashcfg(struct ice_vf *vf, u8 *msg)
3029*5de6c855SPrzemek Kitszel {
3030*5de6c855SPrzemek Kitszel 	struct virtchnl_rss_hashcfg *vrh = (struct virtchnl_rss_hashcfg *)msg;
3031*5de6c855SPrzemek Kitszel 	enum virtchnl_status_code v_ret = VIRTCHNL_STATUS_SUCCESS;
3032*5de6c855SPrzemek Kitszel 	struct ice_pf *pf = vf->pf;
3033*5de6c855SPrzemek Kitszel 	struct ice_vsi *vsi;
3034*5de6c855SPrzemek Kitszel 	struct device *dev;
3035*5de6c855SPrzemek Kitszel 	int status;
3036*5de6c855SPrzemek Kitszel 
3037*5de6c855SPrzemek Kitszel 	dev = ice_pf_to_dev(pf);
3038*5de6c855SPrzemek Kitszel 
3039*5de6c855SPrzemek Kitszel 	if (!test_bit(ICE_VF_STATE_ACTIVE, vf->vf_states)) {
3040*5de6c855SPrzemek Kitszel 		v_ret = VIRTCHNL_STATUS_ERR_PARAM;
3041*5de6c855SPrzemek Kitszel 		goto err;
3042*5de6c855SPrzemek Kitszel 	}
3043*5de6c855SPrzemek Kitszel 
3044*5de6c855SPrzemek Kitszel 	if (!test_bit(ICE_FLAG_RSS_ENA, pf->flags)) {
3045*5de6c855SPrzemek Kitszel 		dev_err(dev, "RSS not supported by PF\n");
3046*5de6c855SPrzemek Kitszel 		v_ret = VIRTCHNL_STATUS_ERR_PARAM;
3047*5de6c855SPrzemek Kitszel 		goto err;
3048*5de6c855SPrzemek Kitszel 	}
3049*5de6c855SPrzemek Kitszel 
3050*5de6c855SPrzemek Kitszel 	vsi = ice_get_vf_vsi(vf);
3051*5de6c855SPrzemek Kitszel 	if (!vsi) {
3052*5de6c855SPrzemek Kitszel 		v_ret = VIRTCHNL_STATUS_ERR_PARAM;
3053*5de6c855SPrzemek Kitszel 		goto err;
3054*5de6c855SPrzemek Kitszel 	}
3055*5de6c855SPrzemek Kitszel 
3056*5de6c855SPrzemek Kitszel 	/* clear all previously programmed RSS configuration to allow VF drivers
3057*5de6c855SPrzemek Kitszel 	 * the ability to customize the RSS configuration and/or completely
3058*5de6c855SPrzemek Kitszel 	 * disable RSS
3059*5de6c855SPrzemek Kitszel 	 */
3060*5de6c855SPrzemek Kitszel 	status = ice_rem_vsi_rss_cfg(&pf->hw, vsi->idx);
3061*5de6c855SPrzemek Kitszel 	if (status && !vrh->hashcfg) {
3062*5de6c855SPrzemek Kitszel 		/* only report failure to clear the current RSS configuration if
3063*5de6c855SPrzemek Kitszel 		 * that was clearly the VF's intention (i.e. vrh->hashcfg = 0)
3064*5de6c855SPrzemek Kitszel 		 */
3065*5de6c855SPrzemek Kitszel 		v_ret = ice_err_to_virt_err(status);
3066*5de6c855SPrzemek Kitszel 		goto err;
3067*5de6c855SPrzemek Kitszel 	} else if (status) {
3068*5de6c855SPrzemek Kitszel 		/* allow the VF to update the RSS configuration even on failure
3069*5de6c855SPrzemek Kitszel 		 * to clear the current RSS confguration in an attempt to keep
3070*5de6c855SPrzemek Kitszel 		 * RSS in a working state
3071*5de6c855SPrzemek Kitszel 		 */
3072*5de6c855SPrzemek Kitszel 		dev_warn(dev, "Failed to clear the RSS configuration for VF %u\n",
3073*5de6c855SPrzemek Kitszel 			 vf->vf_id);
3074*5de6c855SPrzemek Kitszel 	}
3075*5de6c855SPrzemek Kitszel 
3076*5de6c855SPrzemek Kitszel 	if (vrh->hashcfg) {
3077*5de6c855SPrzemek Kitszel 		status = ice_add_avf_rss_cfg(&pf->hw, vsi, vrh->hashcfg);
3078*5de6c855SPrzemek Kitszel 		v_ret = ice_err_to_virt_err(status);
3079*5de6c855SPrzemek Kitszel 	}
3080*5de6c855SPrzemek Kitszel 
3081*5de6c855SPrzemek Kitszel 	/* save the requested VF configuration */
3082*5de6c855SPrzemek Kitszel 	if (!v_ret)
3083*5de6c855SPrzemek Kitszel 		vf->rss_hashcfg = vrh->hashcfg;
3084*5de6c855SPrzemek Kitszel 
3085*5de6c855SPrzemek Kitszel 	/* send the response to the VF */
3086*5de6c855SPrzemek Kitszel err:
3087*5de6c855SPrzemek Kitszel 	return ice_vc_send_msg_to_vf(vf, VIRTCHNL_OP_SET_RSS_HASHCFG, v_ret,
3088*5de6c855SPrzemek Kitszel 				     NULL, 0);
3089*5de6c855SPrzemek Kitszel }
3090*5de6c855SPrzemek Kitszel 
3091*5de6c855SPrzemek Kitszel /**
3092*5de6c855SPrzemek Kitszel  * ice_vc_query_rxdid - query RXDID supported by DDP package
3093*5de6c855SPrzemek Kitszel  * @vf: pointer to VF info
3094*5de6c855SPrzemek Kitszel  *
3095*5de6c855SPrzemek Kitszel  * Called from VF to query a bitmap of supported flexible
3096*5de6c855SPrzemek Kitszel  * descriptor RXDIDs of a DDP package.
3097*5de6c855SPrzemek Kitszel  */
3098*5de6c855SPrzemek Kitszel static int ice_vc_query_rxdid(struct ice_vf *vf)
3099*5de6c855SPrzemek Kitszel {
3100*5de6c855SPrzemek Kitszel 	enum virtchnl_status_code v_ret = VIRTCHNL_STATUS_SUCCESS;
3101*5de6c855SPrzemek Kitszel 	struct ice_pf *pf = vf->pf;
3102*5de6c855SPrzemek Kitszel 	u64 rxdid;
3103*5de6c855SPrzemek Kitszel 
3104*5de6c855SPrzemek Kitszel 	if (!test_bit(ICE_VF_STATE_ACTIVE, vf->vf_states)) {
3105*5de6c855SPrzemek Kitszel 		v_ret = VIRTCHNL_STATUS_ERR_PARAM;
3106*5de6c855SPrzemek Kitszel 		goto err;
3107*5de6c855SPrzemek Kitszel 	}
3108*5de6c855SPrzemek Kitszel 
3109*5de6c855SPrzemek Kitszel 	if (!(vf->driver_caps & VIRTCHNL_VF_OFFLOAD_RX_FLEX_DESC)) {
3110*5de6c855SPrzemek Kitszel 		v_ret = VIRTCHNL_STATUS_ERR_PARAM;
3111*5de6c855SPrzemek Kitszel 		goto err;
3112*5de6c855SPrzemek Kitszel 	}
3113*5de6c855SPrzemek Kitszel 
3114*5de6c855SPrzemek Kitszel 	rxdid = pf->supported_rxdids;
3115*5de6c855SPrzemek Kitszel 
3116*5de6c855SPrzemek Kitszel err:
3117*5de6c855SPrzemek Kitszel 	return ice_vc_send_msg_to_vf(vf, VIRTCHNL_OP_GET_SUPPORTED_RXDIDS,
3118*5de6c855SPrzemek Kitszel 				     v_ret, (u8 *)&rxdid, sizeof(rxdid));
3119*5de6c855SPrzemek Kitszel }
3120*5de6c855SPrzemek Kitszel 
3121*5de6c855SPrzemek Kitszel /**
3122*5de6c855SPrzemek Kitszel  * ice_vf_init_vlan_stripping - enable/disable VLAN stripping on initialization
3123*5de6c855SPrzemek Kitszel  * @vf: VF to enable/disable VLAN stripping for on initialization
3124*5de6c855SPrzemek Kitszel  *
3125*5de6c855SPrzemek Kitszel  * Set the default for VLAN stripping based on whether a port VLAN is configured
3126*5de6c855SPrzemek Kitszel  * and the current VLAN mode of the device.
3127*5de6c855SPrzemek Kitszel  */
3128*5de6c855SPrzemek Kitszel static int ice_vf_init_vlan_stripping(struct ice_vf *vf)
3129*5de6c855SPrzemek Kitszel {
3130*5de6c855SPrzemek Kitszel 	struct ice_vsi *vsi = ice_get_vf_vsi(vf);
3131*5de6c855SPrzemek Kitszel 
3132*5de6c855SPrzemek Kitszel 	vf->vlan_strip_ena = 0;
3133*5de6c855SPrzemek Kitszel 
3134*5de6c855SPrzemek Kitszel 	if (!vsi)
3135*5de6c855SPrzemek Kitszel 		return -EINVAL;
3136*5de6c855SPrzemek Kitszel 
3137*5de6c855SPrzemek Kitszel 	/* don't modify stripping if port VLAN is configured in SVM since the
3138*5de6c855SPrzemek Kitszel 	 * port VLAN is based on the inner/single VLAN in SVM
3139*5de6c855SPrzemek Kitszel 	 */
3140*5de6c855SPrzemek Kitszel 	if (ice_vf_is_port_vlan_ena(vf) && !ice_is_dvm_ena(&vsi->back->hw))
3141*5de6c855SPrzemek Kitszel 		return 0;
3142*5de6c855SPrzemek Kitszel 
3143*5de6c855SPrzemek Kitszel 	if (ice_vf_vlan_offload_ena(vf->driver_caps)) {
3144*5de6c855SPrzemek Kitszel 		int err;
3145*5de6c855SPrzemek Kitszel 
3146*5de6c855SPrzemek Kitszel 		err = vsi->inner_vlan_ops.ena_stripping(vsi, ETH_P_8021Q);
3147*5de6c855SPrzemek Kitszel 		if (!err)
3148*5de6c855SPrzemek Kitszel 			vf->vlan_strip_ena |= ICE_INNER_VLAN_STRIP_ENA;
3149*5de6c855SPrzemek Kitszel 		return err;
3150*5de6c855SPrzemek Kitszel 	}
3151*5de6c855SPrzemek Kitszel 
3152*5de6c855SPrzemek Kitszel 	return vsi->inner_vlan_ops.dis_stripping(vsi);
3153*5de6c855SPrzemek Kitszel }
3154*5de6c855SPrzemek Kitszel 
3155*5de6c855SPrzemek Kitszel static u16 ice_vc_get_max_vlan_fltrs(struct ice_vf *vf)
3156*5de6c855SPrzemek Kitszel {
3157*5de6c855SPrzemek Kitszel 	if (vf->trusted)
3158*5de6c855SPrzemek Kitszel 		return VLAN_N_VID;
3159*5de6c855SPrzemek Kitszel 	else
3160*5de6c855SPrzemek Kitszel 		return ICE_MAX_VLAN_PER_VF;
3161*5de6c855SPrzemek Kitszel }
3162*5de6c855SPrzemek Kitszel 
3163*5de6c855SPrzemek Kitszel /**
3164*5de6c855SPrzemek Kitszel  * ice_vf_outer_vlan_not_allowed - check if outer VLAN can be used
3165*5de6c855SPrzemek Kitszel  * @vf: VF that being checked for
3166*5de6c855SPrzemek Kitszel  *
3167*5de6c855SPrzemek Kitszel  * When the device is in double VLAN mode, check whether or not the outer VLAN
3168*5de6c855SPrzemek Kitszel  * is allowed.
3169*5de6c855SPrzemek Kitszel  */
3170*5de6c855SPrzemek Kitszel static bool ice_vf_outer_vlan_not_allowed(struct ice_vf *vf)
3171*5de6c855SPrzemek Kitszel {
3172*5de6c855SPrzemek Kitszel 	if (ice_vf_is_port_vlan_ena(vf))
3173*5de6c855SPrzemek Kitszel 		return true;
3174*5de6c855SPrzemek Kitszel 
3175*5de6c855SPrzemek Kitszel 	return false;
3176*5de6c855SPrzemek Kitszel }
3177*5de6c855SPrzemek Kitszel 
3178*5de6c855SPrzemek Kitszel /**
3179*5de6c855SPrzemek Kitszel  * ice_vc_set_dvm_caps - set VLAN capabilities when the device is in DVM
3180*5de6c855SPrzemek Kitszel  * @vf: VF that capabilities are being set for
3181*5de6c855SPrzemek Kitszel  * @caps: VLAN capabilities to populate
3182*5de6c855SPrzemek Kitszel  *
3183*5de6c855SPrzemek Kitszel  * Determine VLAN capabilities support based on whether a port VLAN is
3184*5de6c855SPrzemek Kitszel  * configured. If a port VLAN is configured then the VF should use the inner
3185*5de6c855SPrzemek Kitszel  * filtering/offload capabilities since the port VLAN is using the outer VLAN
3186*5de6c855SPrzemek Kitszel  * capabilies.
3187*5de6c855SPrzemek Kitszel  */
3188*5de6c855SPrzemek Kitszel static void
3189*5de6c855SPrzemek Kitszel ice_vc_set_dvm_caps(struct ice_vf *vf, struct virtchnl_vlan_caps *caps)
3190*5de6c855SPrzemek Kitszel {
3191*5de6c855SPrzemek Kitszel 	struct virtchnl_vlan_supported_caps *supported_caps;
3192*5de6c855SPrzemek Kitszel 
3193*5de6c855SPrzemek Kitszel 	if (ice_vf_outer_vlan_not_allowed(vf)) {
3194*5de6c855SPrzemek Kitszel 		/* until support for inner VLAN filtering is added when a port
3195*5de6c855SPrzemek Kitszel 		 * VLAN is configured, only support software offloaded inner
3196*5de6c855SPrzemek Kitszel 		 * VLANs when a port VLAN is confgured in DVM
3197*5de6c855SPrzemek Kitszel 		 */
3198*5de6c855SPrzemek Kitszel 		supported_caps = &caps->filtering.filtering_support;
3199*5de6c855SPrzemek Kitszel 		supported_caps->inner = VIRTCHNL_VLAN_UNSUPPORTED;
3200*5de6c855SPrzemek Kitszel 
3201*5de6c855SPrzemek Kitszel 		supported_caps = &caps->offloads.stripping_support;
3202*5de6c855SPrzemek Kitszel 		supported_caps->inner = VIRTCHNL_VLAN_ETHERTYPE_8100 |
3203*5de6c855SPrzemek Kitszel 					VIRTCHNL_VLAN_TOGGLE |
3204*5de6c855SPrzemek Kitszel 					VIRTCHNL_VLAN_TAG_LOCATION_L2TAG1;
3205*5de6c855SPrzemek Kitszel 		supported_caps->outer = VIRTCHNL_VLAN_UNSUPPORTED;
3206*5de6c855SPrzemek Kitszel 
3207*5de6c855SPrzemek Kitszel 		supported_caps = &caps->offloads.insertion_support;
3208*5de6c855SPrzemek Kitszel 		supported_caps->inner = VIRTCHNL_VLAN_ETHERTYPE_8100 |
3209*5de6c855SPrzemek Kitszel 					VIRTCHNL_VLAN_TOGGLE |
3210*5de6c855SPrzemek Kitszel 					VIRTCHNL_VLAN_TAG_LOCATION_L2TAG1;
3211*5de6c855SPrzemek Kitszel 		supported_caps->outer = VIRTCHNL_VLAN_UNSUPPORTED;
3212*5de6c855SPrzemek Kitszel 
3213*5de6c855SPrzemek Kitszel 		caps->offloads.ethertype_init = VIRTCHNL_VLAN_ETHERTYPE_8100;
3214*5de6c855SPrzemek Kitszel 		caps->offloads.ethertype_match =
3215*5de6c855SPrzemek Kitszel 			VIRTCHNL_ETHERTYPE_STRIPPING_MATCHES_INSERTION;
3216*5de6c855SPrzemek Kitszel 	} else {
3217*5de6c855SPrzemek Kitszel 		supported_caps = &caps->filtering.filtering_support;
3218*5de6c855SPrzemek Kitszel 		supported_caps->inner = VIRTCHNL_VLAN_UNSUPPORTED;
3219*5de6c855SPrzemek Kitszel 		supported_caps->outer = VIRTCHNL_VLAN_ETHERTYPE_8100 |
3220*5de6c855SPrzemek Kitszel 					VIRTCHNL_VLAN_ETHERTYPE_88A8 |
3221*5de6c855SPrzemek Kitszel 					VIRTCHNL_VLAN_ETHERTYPE_9100 |
3222*5de6c855SPrzemek Kitszel 					VIRTCHNL_VLAN_ETHERTYPE_AND;
3223*5de6c855SPrzemek Kitszel 		caps->filtering.ethertype_init = VIRTCHNL_VLAN_ETHERTYPE_8100 |
3224*5de6c855SPrzemek Kitszel 						 VIRTCHNL_VLAN_ETHERTYPE_88A8 |
3225*5de6c855SPrzemek Kitszel 						 VIRTCHNL_VLAN_ETHERTYPE_9100;
3226*5de6c855SPrzemek Kitszel 
3227*5de6c855SPrzemek Kitszel 		supported_caps = &caps->offloads.stripping_support;
3228*5de6c855SPrzemek Kitszel 		supported_caps->inner = VIRTCHNL_VLAN_TOGGLE |
3229*5de6c855SPrzemek Kitszel 					VIRTCHNL_VLAN_ETHERTYPE_8100 |
3230*5de6c855SPrzemek Kitszel 					VIRTCHNL_VLAN_TAG_LOCATION_L2TAG1;
3231*5de6c855SPrzemek Kitszel 		supported_caps->outer = VIRTCHNL_VLAN_TOGGLE |
3232*5de6c855SPrzemek Kitszel 					VIRTCHNL_VLAN_ETHERTYPE_8100 |
3233*5de6c855SPrzemek Kitszel 					VIRTCHNL_VLAN_ETHERTYPE_88A8 |
3234*5de6c855SPrzemek Kitszel 					VIRTCHNL_VLAN_ETHERTYPE_9100 |
3235*5de6c855SPrzemek Kitszel 					VIRTCHNL_VLAN_ETHERTYPE_XOR |
3236*5de6c855SPrzemek Kitszel 					VIRTCHNL_VLAN_TAG_LOCATION_L2TAG2_2;
3237*5de6c855SPrzemek Kitszel 
3238*5de6c855SPrzemek Kitszel 		supported_caps = &caps->offloads.insertion_support;
3239*5de6c855SPrzemek Kitszel 		supported_caps->inner = VIRTCHNL_VLAN_TOGGLE |
3240*5de6c855SPrzemek Kitszel 					VIRTCHNL_VLAN_ETHERTYPE_8100 |
3241*5de6c855SPrzemek Kitszel 					VIRTCHNL_VLAN_TAG_LOCATION_L2TAG1;
3242*5de6c855SPrzemek Kitszel 		supported_caps->outer = VIRTCHNL_VLAN_TOGGLE |
3243*5de6c855SPrzemek Kitszel 					VIRTCHNL_VLAN_ETHERTYPE_8100 |
3244*5de6c855SPrzemek Kitszel 					VIRTCHNL_VLAN_ETHERTYPE_88A8 |
3245*5de6c855SPrzemek Kitszel 					VIRTCHNL_VLAN_ETHERTYPE_9100 |
3246*5de6c855SPrzemek Kitszel 					VIRTCHNL_VLAN_ETHERTYPE_XOR |
3247*5de6c855SPrzemek Kitszel 					VIRTCHNL_VLAN_TAG_LOCATION_L2TAG2;
3248*5de6c855SPrzemek Kitszel 
3249*5de6c855SPrzemek Kitszel 		caps->offloads.ethertype_init = VIRTCHNL_VLAN_ETHERTYPE_8100;
3250*5de6c855SPrzemek Kitszel 
3251*5de6c855SPrzemek Kitszel 		caps->offloads.ethertype_match =
3252*5de6c855SPrzemek Kitszel 			VIRTCHNL_ETHERTYPE_STRIPPING_MATCHES_INSERTION;
3253*5de6c855SPrzemek Kitszel 	}
3254*5de6c855SPrzemek Kitszel 
3255*5de6c855SPrzemek Kitszel 	caps->filtering.max_filters = ice_vc_get_max_vlan_fltrs(vf);
3256*5de6c855SPrzemek Kitszel }
3257*5de6c855SPrzemek Kitszel 
3258*5de6c855SPrzemek Kitszel /**
3259*5de6c855SPrzemek Kitszel  * ice_vc_set_svm_caps - set VLAN capabilities when the device is in SVM
3260*5de6c855SPrzemek Kitszel  * @vf: VF that capabilities are being set for
3261*5de6c855SPrzemek Kitszel  * @caps: VLAN capabilities to populate
3262*5de6c855SPrzemek Kitszel  *
3263*5de6c855SPrzemek Kitszel  * Determine VLAN capabilities support based on whether a port VLAN is
3264*5de6c855SPrzemek Kitszel  * configured. If a port VLAN is configured then the VF does not have any VLAN
3265*5de6c855SPrzemek Kitszel  * filtering or offload capabilities since the port VLAN is using the inner VLAN
3266*5de6c855SPrzemek Kitszel  * capabilities in single VLAN mode (SVM). Otherwise allow the VF to use inner
3267*5de6c855SPrzemek Kitszel  * VLAN fitlering and offload capabilities.
3268*5de6c855SPrzemek Kitszel  */
3269*5de6c855SPrzemek Kitszel static void
3270*5de6c855SPrzemek Kitszel ice_vc_set_svm_caps(struct ice_vf *vf, struct virtchnl_vlan_caps *caps)
3271*5de6c855SPrzemek Kitszel {
3272*5de6c855SPrzemek Kitszel 	struct virtchnl_vlan_supported_caps *supported_caps;
3273*5de6c855SPrzemek Kitszel 
3274*5de6c855SPrzemek Kitszel 	if (ice_vf_is_port_vlan_ena(vf)) {
3275*5de6c855SPrzemek Kitszel 		supported_caps = &caps->filtering.filtering_support;
3276*5de6c855SPrzemek Kitszel 		supported_caps->inner = VIRTCHNL_VLAN_UNSUPPORTED;
3277*5de6c855SPrzemek Kitszel 		supported_caps->outer = VIRTCHNL_VLAN_UNSUPPORTED;
3278*5de6c855SPrzemek Kitszel 
3279*5de6c855SPrzemek Kitszel 		supported_caps = &caps->offloads.stripping_support;
3280*5de6c855SPrzemek Kitszel 		supported_caps->inner = VIRTCHNL_VLAN_UNSUPPORTED;
3281*5de6c855SPrzemek Kitszel 		supported_caps->outer = VIRTCHNL_VLAN_UNSUPPORTED;
3282*5de6c855SPrzemek Kitszel 
3283*5de6c855SPrzemek Kitszel 		supported_caps = &caps->offloads.insertion_support;
3284*5de6c855SPrzemek Kitszel 		supported_caps->inner = VIRTCHNL_VLAN_UNSUPPORTED;
3285*5de6c855SPrzemek Kitszel 		supported_caps->outer = VIRTCHNL_VLAN_UNSUPPORTED;
3286*5de6c855SPrzemek Kitszel 
3287*5de6c855SPrzemek Kitszel 		caps->offloads.ethertype_init = VIRTCHNL_VLAN_UNSUPPORTED;
3288*5de6c855SPrzemek Kitszel 		caps->offloads.ethertype_match = VIRTCHNL_VLAN_UNSUPPORTED;
3289*5de6c855SPrzemek Kitszel 		caps->filtering.max_filters = 0;
3290*5de6c855SPrzemek Kitszel 	} else {
3291*5de6c855SPrzemek Kitszel 		supported_caps = &caps->filtering.filtering_support;
3292*5de6c855SPrzemek Kitszel 		supported_caps->inner = VIRTCHNL_VLAN_ETHERTYPE_8100;
3293*5de6c855SPrzemek Kitszel 		supported_caps->outer = VIRTCHNL_VLAN_UNSUPPORTED;
3294*5de6c855SPrzemek Kitszel 		caps->filtering.ethertype_init = VIRTCHNL_VLAN_ETHERTYPE_8100;
3295*5de6c855SPrzemek Kitszel 
3296*5de6c855SPrzemek Kitszel 		supported_caps = &caps->offloads.stripping_support;
3297*5de6c855SPrzemek Kitszel 		supported_caps->inner = VIRTCHNL_VLAN_ETHERTYPE_8100 |
3298*5de6c855SPrzemek Kitszel 					VIRTCHNL_VLAN_TOGGLE |
3299*5de6c855SPrzemek Kitszel 					VIRTCHNL_VLAN_TAG_LOCATION_L2TAG1;
3300*5de6c855SPrzemek Kitszel 		supported_caps->outer = VIRTCHNL_VLAN_UNSUPPORTED;
3301*5de6c855SPrzemek Kitszel 
3302*5de6c855SPrzemek Kitszel 		supported_caps = &caps->offloads.insertion_support;
3303*5de6c855SPrzemek Kitszel 		supported_caps->inner = VIRTCHNL_VLAN_ETHERTYPE_8100 |
3304*5de6c855SPrzemek Kitszel 					VIRTCHNL_VLAN_TOGGLE |
3305*5de6c855SPrzemek Kitszel 					VIRTCHNL_VLAN_TAG_LOCATION_L2TAG1;
3306*5de6c855SPrzemek Kitszel 		supported_caps->outer = VIRTCHNL_VLAN_UNSUPPORTED;
3307*5de6c855SPrzemek Kitszel 
3308*5de6c855SPrzemek Kitszel 		caps->offloads.ethertype_init = VIRTCHNL_VLAN_ETHERTYPE_8100;
3309*5de6c855SPrzemek Kitszel 		caps->offloads.ethertype_match =
3310*5de6c855SPrzemek Kitszel 			VIRTCHNL_ETHERTYPE_STRIPPING_MATCHES_INSERTION;
3311*5de6c855SPrzemek Kitszel 		caps->filtering.max_filters = ice_vc_get_max_vlan_fltrs(vf);
3312*5de6c855SPrzemek Kitszel 	}
3313*5de6c855SPrzemek Kitszel }
3314*5de6c855SPrzemek Kitszel 
3315*5de6c855SPrzemek Kitszel /**
3316*5de6c855SPrzemek Kitszel  * ice_vc_get_offload_vlan_v2_caps - determine VF's VLAN capabilities
3317*5de6c855SPrzemek Kitszel  * @vf: VF to determine VLAN capabilities for
3318*5de6c855SPrzemek Kitszel  *
3319*5de6c855SPrzemek Kitszel  * This will only be called if the VF and PF successfully negotiated
3320*5de6c855SPrzemek Kitszel  * VIRTCHNL_VF_OFFLOAD_VLAN_V2.
3321*5de6c855SPrzemek Kitszel  *
3322*5de6c855SPrzemek Kitszel  * Set VLAN capabilities based on the current VLAN mode and whether a port VLAN
3323*5de6c855SPrzemek Kitszel  * is configured or not.
3324*5de6c855SPrzemek Kitszel  */
3325*5de6c855SPrzemek Kitszel static int ice_vc_get_offload_vlan_v2_caps(struct ice_vf *vf)
3326*5de6c855SPrzemek Kitszel {
3327*5de6c855SPrzemek Kitszel 	enum virtchnl_status_code v_ret = VIRTCHNL_STATUS_SUCCESS;
3328*5de6c855SPrzemek Kitszel 	struct virtchnl_vlan_caps *caps = NULL;
3329*5de6c855SPrzemek Kitszel 	int err, len = 0;
3330*5de6c855SPrzemek Kitszel 
3331*5de6c855SPrzemek Kitszel 	if (!test_bit(ICE_VF_STATE_ACTIVE, vf->vf_states)) {
3332*5de6c855SPrzemek Kitszel 		v_ret = VIRTCHNL_STATUS_ERR_PARAM;
3333*5de6c855SPrzemek Kitszel 		goto out;
3334*5de6c855SPrzemek Kitszel 	}
3335*5de6c855SPrzemek Kitszel 
3336*5de6c855SPrzemek Kitszel 	caps = kzalloc(sizeof(*caps), GFP_KERNEL);
3337*5de6c855SPrzemek Kitszel 	if (!caps) {
3338*5de6c855SPrzemek Kitszel 		v_ret = VIRTCHNL_STATUS_ERR_NO_MEMORY;
3339*5de6c855SPrzemek Kitszel 		goto out;
3340*5de6c855SPrzemek Kitszel 	}
3341*5de6c855SPrzemek Kitszel 	len = sizeof(*caps);
3342*5de6c855SPrzemek Kitszel 
3343*5de6c855SPrzemek Kitszel 	if (ice_is_dvm_ena(&vf->pf->hw))
3344*5de6c855SPrzemek Kitszel 		ice_vc_set_dvm_caps(vf, caps);
3345*5de6c855SPrzemek Kitszel 	else
3346*5de6c855SPrzemek Kitszel 		ice_vc_set_svm_caps(vf, caps);
3347*5de6c855SPrzemek Kitszel 
3348*5de6c855SPrzemek Kitszel 	/* store negotiated caps to prevent invalid VF messages */
3349*5de6c855SPrzemek Kitszel 	memcpy(&vf->vlan_v2_caps, caps, sizeof(*caps));
3350*5de6c855SPrzemek Kitszel 
3351*5de6c855SPrzemek Kitszel out:
3352*5de6c855SPrzemek Kitszel 	err = ice_vc_send_msg_to_vf(vf, VIRTCHNL_OP_GET_OFFLOAD_VLAN_V2_CAPS,
3353*5de6c855SPrzemek Kitszel 				    v_ret, (u8 *)caps, len);
3354*5de6c855SPrzemek Kitszel 	kfree(caps);
3355*5de6c855SPrzemek Kitszel 	return err;
3356*5de6c855SPrzemek Kitszel }
3357*5de6c855SPrzemek Kitszel 
3358*5de6c855SPrzemek Kitszel /**
3359*5de6c855SPrzemek Kitszel  * ice_vc_validate_vlan_tpid - validate VLAN TPID
3360*5de6c855SPrzemek Kitszel  * @filtering_caps: negotiated/supported VLAN filtering capabilities
3361*5de6c855SPrzemek Kitszel  * @tpid: VLAN TPID used for validation
3362*5de6c855SPrzemek Kitszel  *
3363*5de6c855SPrzemek Kitszel  * Convert the VLAN TPID to a VIRTCHNL_VLAN_ETHERTYPE_* and then compare against
3364*5de6c855SPrzemek Kitszel  * the negotiated/supported filtering caps to see if the VLAN TPID is valid.
3365*5de6c855SPrzemek Kitszel  */
3366*5de6c855SPrzemek Kitszel static bool ice_vc_validate_vlan_tpid(u16 filtering_caps, u16 tpid)
3367*5de6c855SPrzemek Kitszel {
3368*5de6c855SPrzemek Kitszel 	enum virtchnl_vlan_support vlan_ethertype = VIRTCHNL_VLAN_UNSUPPORTED;
3369*5de6c855SPrzemek Kitszel 
3370*5de6c855SPrzemek Kitszel 	switch (tpid) {
3371*5de6c855SPrzemek Kitszel 	case ETH_P_8021Q:
3372*5de6c855SPrzemek Kitszel 		vlan_ethertype = VIRTCHNL_VLAN_ETHERTYPE_8100;
3373*5de6c855SPrzemek Kitszel 		break;
3374*5de6c855SPrzemek Kitszel 	case ETH_P_8021AD:
3375*5de6c855SPrzemek Kitszel 		vlan_ethertype = VIRTCHNL_VLAN_ETHERTYPE_88A8;
3376*5de6c855SPrzemek Kitszel 		break;
3377*5de6c855SPrzemek Kitszel 	case ETH_P_QINQ1:
3378*5de6c855SPrzemek Kitszel 		vlan_ethertype = VIRTCHNL_VLAN_ETHERTYPE_9100;
3379*5de6c855SPrzemek Kitszel 		break;
3380*5de6c855SPrzemek Kitszel 	}
3381*5de6c855SPrzemek Kitszel 
3382*5de6c855SPrzemek Kitszel 	if (!(filtering_caps & vlan_ethertype))
3383*5de6c855SPrzemek Kitszel 		return false;
3384*5de6c855SPrzemek Kitszel 
3385*5de6c855SPrzemek Kitszel 	return true;
3386*5de6c855SPrzemek Kitszel }
3387*5de6c855SPrzemek Kitszel 
3388*5de6c855SPrzemek Kitszel /**
3389*5de6c855SPrzemek Kitszel  * ice_vc_is_valid_vlan - validate the virtchnl_vlan
3390*5de6c855SPrzemek Kitszel  * @vc_vlan: virtchnl_vlan to validate
3391*5de6c855SPrzemek Kitszel  *
3392*5de6c855SPrzemek Kitszel  * If the VLAN TCI and VLAN TPID are 0, then this filter is invalid, so return
3393*5de6c855SPrzemek Kitszel  * false. Otherwise return true.
3394*5de6c855SPrzemek Kitszel  */
3395*5de6c855SPrzemek Kitszel static bool ice_vc_is_valid_vlan(struct virtchnl_vlan *vc_vlan)
3396*5de6c855SPrzemek Kitszel {
3397*5de6c855SPrzemek Kitszel 	if (!vc_vlan->tci || !vc_vlan->tpid)
3398*5de6c855SPrzemek Kitszel 		return false;
3399*5de6c855SPrzemek Kitszel 
3400*5de6c855SPrzemek Kitszel 	return true;
3401*5de6c855SPrzemek Kitszel }
3402*5de6c855SPrzemek Kitszel 
3403*5de6c855SPrzemek Kitszel /**
3404*5de6c855SPrzemek Kitszel  * ice_vc_validate_vlan_filter_list - validate the filter list from the VF
3405*5de6c855SPrzemek Kitszel  * @vfc: negotiated/supported VLAN filtering capabilities
3406*5de6c855SPrzemek Kitszel  * @vfl: VLAN filter list from VF to validate
3407*5de6c855SPrzemek Kitszel  *
3408*5de6c855SPrzemek Kitszel  * Validate all of the filters in the VLAN filter list from the VF. If any of
3409*5de6c855SPrzemek Kitszel  * the checks fail then return false. Otherwise return true.
3410*5de6c855SPrzemek Kitszel  */
3411*5de6c855SPrzemek Kitszel static bool
3412*5de6c855SPrzemek Kitszel ice_vc_validate_vlan_filter_list(struct virtchnl_vlan_filtering_caps *vfc,
3413*5de6c855SPrzemek Kitszel 				 struct virtchnl_vlan_filter_list_v2 *vfl)
3414*5de6c855SPrzemek Kitszel {
3415*5de6c855SPrzemek Kitszel 	u16 i;
3416*5de6c855SPrzemek Kitszel 
3417*5de6c855SPrzemek Kitszel 	if (!vfl->num_elements)
3418*5de6c855SPrzemek Kitszel 		return false;
3419*5de6c855SPrzemek Kitszel 
3420*5de6c855SPrzemek Kitszel 	for (i = 0; i < vfl->num_elements; i++) {
3421*5de6c855SPrzemek Kitszel 		struct virtchnl_vlan_supported_caps *filtering_support =
3422*5de6c855SPrzemek Kitszel 			&vfc->filtering_support;
3423*5de6c855SPrzemek Kitszel 		struct virtchnl_vlan_filter *vlan_fltr = &vfl->filters[i];
3424*5de6c855SPrzemek Kitszel 		struct virtchnl_vlan *outer = &vlan_fltr->outer;
3425*5de6c855SPrzemek Kitszel 		struct virtchnl_vlan *inner = &vlan_fltr->inner;
3426*5de6c855SPrzemek Kitszel 
3427*5de6c855SPrzemek Kitszel 		if ((ice_vc_is_valid_vlan(outer) &&
3428*5de6c855SPrzemek Kitszel 		     filtering_support->outer == VIRTCHNL_VLAN_UNSUPPORTED) ||
3429*5de6c855SPrzemek Kitszel 		    (ice_vc_is_valid_vlan(inner) &&
3430*5de6c855SPrzemek Kitszel 		     filtering_support->inner == VIRTCHNL_VLAN_UNSUPPORTED))
3431*5de6c855SPrzemek Kitszel 			return false;
3432*5de6c855SPrzemek Kitszel 
3433*5de6c855SPrzemek Kitszel 		if ((outer->tci_mask &&
3434*5de6c855SPrzemek Kitszel 		     !(filtering_support->outer & VIRTCHNL_VLAN_FILTER_MASK)) ||
3435*5de6c855SPrzemek Kitszel 		    (inner->tci_mask &&
3436*5de6c855SPrzemek Kitszel 		     !(filtering_support->inner & VIRTCHNL_VLAN_FILTER_MASK)))
3437*5de6c855SPrzemek Kitszel 			return false;
3438*5de6c855SPrzemek Kitszel 
3439*5de6c855SPrzemek Kitszel 		if (((outer->tci & VLAN_PRIO_MASK) &&
3440*5de6c855SPrzemek Kitszel 		     !(filtering_support->outer & VIRTCHNL_VLAN_PRIO)) ||
3441*5de6c855SPrzemek Kitszel 		    ((inner->tci & VLAN_PRIO_MASK) &&
3442*5de6c855SPrzemek Kitszel 		     !(filtering_support->inner & VIRTCHNL_VLAN_PRIO)))
3443*5de6c855SPrzemek Kitszel 			return false;
3444*5de6c855SPrzemek Kitszel 
3445*5de6c855SPrzemek Kitszel 		if ((ice_vc_is_valid_vlan(outer) &&
3446*5de6c855SPrzemek Kitszel 		     !ice_vc_validate_vlan_tpid(filtering_support->outer,
3447*5de6c855SPrzemek Kitszel 						outer->tpid)) ||
3448*5de6c855SPrzemek Kitszel 		    (ice_vc_is_valid_vlan(inner) &&
3449*5de6c855SPrzemek Kitszel 		     !ice_vc_validate_vlan_tpid(filtering_support->inner,
3450*5de6c855SPrzemek Kitszel 						inner->tpid)))
3451*5de6c855SPrzemek Kitszel 			return false;
3452*5de6c855SPrzemek Kitszel 	}
3453*5de6c855SPrzemek Kitszel 
3454*5de6c855SPrzemek Kitszel 	return true;
3455*5de6c855SPrzemek Kitszel }
3456*5de6c855SPrzemek Kitszel 
3457*5de6c855SPrzemek Kitszel /**
3458*5de6c855SPrzemek Kitszel  * ice_vc_to_vlan - transform from struct virtchnl_vlan to struct ice_vlan
3459*5de6c855SPrzemek Kitszel  * @vc_vlan: struct virtchnl_vlan to transform
3460*5de6c855SPrzemek Kitszel  */
3461*5de6c855SPrzemek Kitszel static struct ice_vlan ice_vc_to_vlan(struct virtchnl_vlan *vc_vlan)
3462*5de6c855SPrzemek Kitszel {
3463*5de6c855SPrzemek Kitszel 	struct ice_vlan vlan = { 0 };
3464*5de6c855SPrzemek Kitszel 
3465*5de6c855SPrzemek Kitszel 	vlan.prio = FIELD_GET(VLAN_PRIO_MASK, vc_vlan->tci);
3466*5de6c855SPrzemek Kitszel 	vlan.vid = vc_vlan->tci & VLAN_VID_MASK;
3467*5de6c855SPrzemek Kitszel 	vlan.tpid = vc_vlan->tpid;
3468*5de6c855SPrzemek Kitszel 
3469*5de6c855SPrzemek Kitszel 	return vlan;
3470*5de6c855SPrzemek Kitszel }
3471*5de6c855SPrzemek Kitszel 
3472*5de6c855SPrzemek Kitszel /**
3473*5de6c855SPrzemek Kitszel  * ice_vc_vlan_action - action to perform on the virthcnl_vlan
3474*5de6c855SPrzemek Kitszel  * @vsi: VF's VSI used to perform the action
3475*5de6c855SPrzemek Kitszel  * @vlan_action: function to perform the action with (i.e. add/del)
3476*5de6c855SPrzemek Kitszel  * @vlan: VLAN filter to perform the action with
3477*5de6c855SPrzemek Kitszel  */
3478*5de6c855SPrzemek Kitszel static int
3479*5de6c855SPrzemek Kitszel ice_vc_vlan_action(struct ice_vsi *vsi,
3480*5de6c855SPrzemek Kitszel 		   int (*vlan_action)(struct ice_vsi *, struct ice_vlan *),
3481*5de6c855SPrzemek Kitszel 		   struct ice_vlan *vlan)
3482*5de6c855SPrzemek Kitszel {
3483*5de6c855SPrzemek Kitszel 	int err;
3484*5de6c855SPrzemek Kitszel 
3485*5de6c855SPrzemek Kitszel 	err = vlan_action(vsi, vlan);
3486*5de6c855SPrzemek Kitszel 	if (err)
3487*5de6c855SPrzemek Kitszel 		return err;
3488*5de6c855SPrzemek Kitszel 
3489*5de6c855SPrzemek Kitszel 	return 0;
3490*5de6c855SPrzemek Kitszel }
3491*5de6c855SPrzemek Kitszel 
3492*5de6c855SPrzemek Kitszel /**
3493*5de6c855SPrzemek Kitszel  * ice_vc_del_vlans - delete VLAN(s) from the virtchnl filter list
3494*5de6c855SPrzemek Kitszel  * @vf: VF used to delete the VLAN(s)
3495*5de6c855SPrzemek Kitszel  * @vsi: VF's VSI used to delete the VLAN(s)
3496*5de6c855SPrzemek Kitszel  * @vfl: virthchnl filter list used to delete the filters
3497*5de6c855SPrzemek Kitszel  */
3498*5de6c855SPrzemek Kitszel static int
3499*5de6c855SPrzemek Kitszel ice_vc_del_vlans(struct ice_vf *vf, struct ice_vsi *vsi,
3500*5de6c855SPrzemek Kitszel 		 struct virtchnl_vlan_filter_list_v2 *vfl)
3501*5de6c855SPrzemek Kitszel {
3502*5de6c855SPrzemek Kitszel 	bool vlan_promisc = ice_is_vlan_promisc_allowed(vf);
3503*5de6c855SPrzemek Kitszel 	int err;
3504*5de6c855SPrzemek Kitszel 	u16 i;
3505*5de6c855SPrzemek Kitszel 
3506*5de6c855SPrzemek Kitszel 	for (i = 0; i < vfl->num_elements; i++) {
3507*5de6c855SPrzemek Kitszel 		struct virtchnl_vlan_filter *vlan_fltr = &vfl->filters[i];
3508*5de6c855SPrzemek Kitszel 		struct virtchnl_vlan *vc_vlan;
3509*5de6c855SPrzemek Kitszel 
3510*5de6c855SPrzemek Kitszel 		vc_vlan = &vlan_fltr->outer;
3511*5de6c855SPrzemek Kitszel 		if (ice_vc_is_valid_vlan(vc_vlan)) {
3512*5de6c855SPrzemek Kitszel 			struct ice_vlan vlan = ice_vc_to_vlan(vc_vlan);
3513*5de6c855SPrzemek Kitszel 
3514*5de6c855SPrzemek Kitszel 			err = ice_vc_vlan_action(vsi,
3515*5de6c855SPrzemek Kitszel 						 vsi->outer_vlan_ops.del_vlan,
3516*5de6c855SPrzemek Kitszel 						 &vlan);
3517*5de6c855SPrzemek Kitszel 			if (err)
3518*5de6c855SPrzemek Kitszel 				return err;
3519*5de6c855SPrzemek Kitszel 
3520*5de6c855SPrzemek Kitszel 			if (vlan_promisc)
3521*5de6c855SPrzemek Kitszel 				ice_vf_dis_vlan_promisc(vsi, &vlan);
3522*5de6c855SPrzemek Kitszel 
3523*5de6c855SPrzemek Kitszel 			/* Disable VLAN filtering when only VLAN 0 is left */
3524*5de6c855SPrzemek Kitszel 			if (!ice_vsi_has_non_zero_vlans(vsi) && ice_is_dvm_ena(&vsi->back->hw)) {
3525*5de6c855SPrzemek Kitszel 				err = vsi->outer_vlan_ops.dis_tx_filtering(vsi);
3526*5de6c855SPrzemek Kitszel 				if (err)
3527*5de6c855SPrzemek Kitszel 					return err;
3528*5de6c855SPrzemek Kitszel 			}
3529*5de6c855SPrzemek Kitszel 		}
3530*5de6c855SPrzemek Kitszel 
3531*5de6c855SPrzemek Kitszel 		vc_vlan = &vlan_fltr->inner;
3532*5de6c855SPrzemek Kitszel 		if (ice_vc_is_valid_vlan(vc_vlan)) {
3533*5de6c855SPrzemek Kitszel 			struct ice_vlan vlan = ice_vc_to_vlan(vc_vlan);
3534*5de6c855SPrzemek Kitszel 
3535*5de6c855SPrzemek Kitszel 			err = ice_vc_vlan_action(vsi,
3536*5de6c855SPrzemek Kitszel 						 vsi->inner_vlan_ops.del_vlan,
3537*5de6c855SPrzemek Kitszel 						 &vlan);
3538*5de6c855SPrzemek Kitszel 			if (err)
3539*5de6c855SPrzemek Kitszel 				return err;
3540*5de6c855SPrzemek Kitszel 
3541*5de6c855SPrzemek Kitszel 			/* no support for VLAN promiscuous on inner VLAN unless
3542*5de6c855SPrzemek Kitszel 			 * we are in Single VLAN Mode (SVM)
3543*5de6c855SPrzemek Kitszel 			 */
3544*5de6c855SPrzemek Kitszel 			if (!ice_is_dvm_ena(&vsi->back->hw)) {
3545*5de6c855SPrzemek Kitszel 				if (vlan_promisc)
3546*5de6c855SPrzemek Kitszel 					ice_vf_dis_vlan_promisc(vsi, &vlan);
3547*5de6c855SPrzemek Kitszel 
3548*5de6c855SPrzemek Kitszel 				/* Disable VLAN filtering when only VLAN 0 is left */
3549*5de6c855SPrzemek Kitszel 				if (!ice_vsi_has_non_zero_vlans(vsi)) {
3550*5de6c855SPrzemek Kitszel 					err = vsi->inner_vlan_ops.dis_tx_filtering(vsi);
3551*5de6c855SPrzemek Kitszel 					if (err)
3552*5de6c855SPrzemek Kitszel 						return err;
3553*5de6c855SPrzemek Kitszel 				}
3554*5de6c855SPrzemek Kitszel 			}
3555*5de6c855SPrzemek Kitszel 		}
3556*5de6c855SPrzemek Kitszel 	}
3557*5de6c855SPrzemek Kitszel 
3558*5de6c855SPrzemek Kitszel 	return 0;
3559*5de6c855SPrzemek Kitszel }
3560*5de6c855SPrzemek Kitszel 
3561*5de6c855SPrzemek Kitszel /**
3562*5de6c855SPrzemek Kitszel  * ice_vc_remove_vlan_v2_msg - virtchnl handler for VIRTCHNL_OP_DEL_VLAN_V2
3563*5de6c855SPrzemek Kitszel  * @vf: VF the message was received from
3564*5de6c855SPrzemek Kitszel  * @msg: message received from the VF
3565*5de6c855SPrzemek Kitszel  */
3566*5de6c855SPrzemek Kitszel static int ice_vc_remove_vlan_v2_msg(struct ice_vf *vf, u8 *msg)
3567*5de6c855SPrzemek Kitszel {
3568*5de6c855SPrzemek Kitszel 	struct virtchnl_vlan_filter_list_v2 *vfl =
3569*5de6c855SPrzemek Kitszel 		(struct virtchnl_vlan_filter_list_v2 *)msg;
3570*5de6c855SPrzemek Kitszel 	enum virtchnl_status_code v_ret = VIRTCHNL_STATUS_SUCCESS;
3571*5de6c855SPrzemek Kitszel 	struct ice_vsi *vsi;
3572*5de6c855SPrzemek Kitszel 
3573*5de6c855SPrzemek Kitszel 	if (!ice_vc_validate_vlan_filter_list(&vf->vlan_v2_caps.filtering,
3574*5de6c855SPrzemek Kitszel 					      vfl)) {
3575*5de6c855SPrzemek Kitszel 		v_ret = VIRTCHNL_STATUS_ERR_PARAM;
3576*5de6c855SPrzemek Kitszel 		goto out;
3577*5de6c855SPrzemek Kitszel 	}
3578*5de6c855SPrzemek Kitszel 
3579*5de6c855SPrzemek Kitszel 	if (!ice_vc_isvalid_vsi_id(vf, vfl->vport_id)) {
3580*5de6c855SPrzemek Kitszel 		v_ret = VIRTCHNL_STATUS_ERR_PARAM;
3581*5de6c855SPrzemek Kitszel 		goto out;
3582*5de6c855SPrzemek Kitszel 	}
3583*5de6c855SPrzemek Kitszel 
3584*5de6c855SPrzemek Kitszel 	vsi = ice_get_vf_vsi(vf);
3585*5de6c855SPrzemek Kitszel 	if (!vsi) {
3586*5de6c855SPrzemek Kitszel 		v_ret = VIRTCHNL_STATUS_ERR_PARAM;
3587*5de6c855SPrzemek Kitszel 		goto out;
3588*5de6c855SPrzemek Kitszel 	}
3589*5de6c855SPrzemek Kitszel 
3590*5de6c855SPrzemek Kitszel 	if (ice_vc_del_vlans(vf, vsi, vfl))
3591*5de6c855SPrzemek Kitszel 		v_ret = VIRTCHNL_STATUS_ERR_PARAM;
3592*5de6c855SPrzemek Kitszel 
3593*5de6c855SPrzemek Kitszel out:
3594*5de6c855SPrzemek Kitszel 	return ice_vc_send_msg_to_vf(vf, VIRTCHNL_OP_DEL_VLAN_V2, v_ret, NULL,
3595*5de6c855SPrzemek Kitszel 				     0);
3596*5de6c855SPrzemek Kitszel }
3597*5de6c855SPrzemek Kitszel 
3598*5de6c855SPrzemek Kitszel /**
3599*5de6c855SPrzemek Kitszel  * ice_vc_add_vlans - add VLAN(s) from the virtchnl filter list
3600*5de6c855SPrzemek Kitszel  * @vf: VF used to add the VLAN(s)
3601*5de6c855SPrzemek Kitszel  * @vsi: VF's VSI used to add the VLAN(s)
3602*5de6c855SPrzemek Kitszel  * @vfl: virthchnl filter list used to add the filters
3603*5de6c855SPrzemek Kitszel  */
3604*5de6c855SPrzemek Kitszel static int
3605*5de6c855SPrzemek Kitszel ice_vc_add_vlans(struct ice_vf *vf, struct ice_vsi *vsi,
3606*5de6c855SPrzemek Kitszel 		 struct virtchnl_vlan_filter_list_v2 *vfl)
3607*5de6c855SPrzemek Kitszel {
3608*5de6c855SPrzemek Kitszel 	bool vlan_promisc = ice_is_vlan_promisc_allowed(vf);
3609*5de6c855SPrzemek Kitszel 	int err;
3610*5de6c855SPrzemek Kitszel 	u16 i;
3611*5de6c855SPrzemek Kitszel 
3612*5de6c855SPrzemek Kitszel 	for (i = 0; i < vfl->num_elements; i++) {
3613*5de6c855SPrzemek Kitszel 		struct virtchnl_vlan_filter *vlan_fltr = &vfl->filters[i];
3614*5de6c855SPrzemek Kitszel 		struct virtchnl_vlan *vc_vlan;
3615*5de6c855SPrzemek Kitszel 
3616*5de6c855SPrzemek Kitszel 		vc_vlan = &vlan_fltr->outer;
3617*5de6c855SPrzemek Kitszel 		if (ice_vc_is_valid_vlan(vc_vlan)) {
3618*5de6c855SPrzemek Kitszel 			struct ice_vlan vlan = ice_vc_to_vlan(vc_vlan);
3619*5de6c855SPrzemek Kitszel 
3620*5de6c855SPrzemek Kitszel 			err = ice_vc_vlan_action(vsi,
3621*5de6c855SPrzemek Kitszel 						 vsi->outer_vlan_ops.add_vlan,
3622*5de6c855SPrzemek Kitszel 						 &vlan);
3623*5de6c855SPrzemek Kitszel 			if (err)
3624*5de6c855SPrzemek Kitszel 				return err;
3625*5de6c855SPrzemek Kitszel 
3626*5de6c855SPrzemek Kitszel 			if (vlan_promisc) {
3627*5de6c855SPrzemek Kitszel 				err = ice_vf_ena_vlan_promisc(vf, vsi, &vlan);
3628*5de6c855SPrzemek Kitszel 				if (err)
3629*5de6c855SPrzemek Kitszel 					return err;
3630*5de6c855SPrzemek Kitszel 			}
3631*5de6c855SPrzemek Kitszel 
3632*5de6c855SPrzemek Kitszel 			/* Enable VLAN filtering on first non-zero VLAN */
3633*5de6c855SPrzemek Kitszel 			if (vf->spoofchk && vlan.vid && ice_is_dvm_ena(&vsi->back->hw)) {
3634*5de6c855SPrzemek Kitszel 				err = vsi->outer_vlan_ops.ena_tx_filtering(vsi);
3635*5de6c855SPrzemek Kitszel 				if (err)
3636*5de6c855SPrzemek Kitszel 					return err;
3637*5de6c855SPrzemek Kitszel 			}
3638*5de6c855SPrzemek Kitszel 		}
3639*5de6c855SPrzemek Kitszel 
3640*5de6c855SPrzemek Kitszel 		vc_vlan = &vlan_fltr->inner;
3641*5de6c855SPrzemek Kitszel 		if (ice_vc_is_valid_vlan(vc_vlan)) {
3642*5de6c855SPrzemek Kitszel 			struct ice_vlan vlan = ice_vc_to_vlan(vc_vlan);
3643*5de6c855SPrzemek Kitszel 
3644*5de6c855SPrzemek Kitszel 			err = ice_vc_vlan_action(vsi,
3645*5de6c855SPrzemek Kitszel 						 vsi->inner_vlan_ops.add_vlan,
3646*5de6c855SPrzemek Kitszel 						 &vlan);
3647*5de6c855SPrzemek Kitszel 			if (err)
3648*5de6c855SPrzemek Kitszel 				return err;
3649*5de6c855SPrzemek Kitszel 
3650*5de6c855SPrzemek Kitszel 			/* no support for VLAN promiscuous on inner VLAN unless
3651*5de6c855SPrzemek Kitszel 			 * we are in Single VLAN Mode (SVM)
3652*5de6c855SPrzemek Kitszel 			 */
3653*5de6c855SPrzemek Kitszel 			if (!ice_is_dvm_ena(&vsi->back->hw)) {
3654*5de6c855SPrzemek Kitszel 				if (vlan_promisc) {
3655*5de6c855SPrzemek Kitszel 					err = ice_vf_ena_vlan_promisc(vf, vsi,
3656*5de6c855SPrzemek Kitszel 								      &vlan);
3657*5de6c855SPrzemek Kitszel 					if (err)
3658*5de6c855SPrzemek Kitszel 						return err;
3659*5de6c855SPrzemek Kitszel 				}
3660*5de6c855SPrzemek Kitszel 
3661*5de6c855SPrzemek Kitszel 				/* Enable VLAN filtering on first non-zero VLAN */
3662*5de6c855SPrzemek Kitszel 				if (vf->spoofchk && vlan.vid) {
3663*5de6c855SPrzemek Kitszel 					err = vsi->inner_vlan_ops.ena_tx_filtering(vsi);
3664*5de6c855SPrzemek Kitszel 					if (err)
3665*5de6c855SPrzemek Kitszel 						return err;
3666*5de6c855SPrzemek Kitszel 				}
3667*5de6c855SPrzemek Kitszel 			}
3668*5de6c855SPrzemek Kitszel 		}
3669*5de6c855SPrzemek Kitszel 	}
3670*5de6c855SPrzemek Kitszel 
3671*5de6c855SPrzemek Kitszel 	return 0;
3672*5de6c855SPrzemek Kitszel }
3673*5de6c855SPrzemek Kitszel 
3674*5de6c855SPrzemek Kitszel /**
3675*5de6c855SPrzemek Kitszel  * ice_vc_validate_add_vlan_filter_list - validate add filter list from the VF
3676*5de6c855SPrzemek Kitszel  * @vsi: VF VSI used to get number of existing VLAN filters
3677*5de6c855SPrzemek Kitszel  * @vfc: negotiated/supported VLAN filtering capabilities
3678*5de6c855SPrzemek Kitszel  * @vfl: VLAN filter list from VF to validate
3679*5de6c855SPrzemek Kitszel  *
3680*5de6c855SPrzemek Kitszel  * Validate all of the filters in the VLAN filter list from the VF during the
3681*5de6c855SPrzemek Kitszel  * VIRTCHNL_OP_ADD_VLAN_V2 opcode. If any of the checks fail then return false.
3682*5de6c855SPrzemek Kitszel  * Otherwise return true.
3683*5de6c855SPrzemek Kitszel  */
3684*5de6c855SPrzemek Kitszel static bool
3685*5de6c855SPrzemek Kitszel ice_vc_validate_add_vlan_filter_list(struct ice_vsi *vsi,
3686*5de6c855SPrzemek Kitszel 				     struct virtchnl_vlan_filtering_caps *vfc,
3687*5de6c855SPrzemek Kitszel 				     struct virtchnl_vlan_filter_list_v2 *vfl)
3688*5de6c855SPrzemek Kitszel {
3689*5de6c855SPrzemek Kitszel 	u16 num_requested_filters = ice_vsi_num_non_zero_vlans(vsi) +
3690*5de6c855SPrzemek Kitszel 		vfl->num_elements;
3691*5de6c855SPrzemek Kitszel 
3692*5de6c855SPrzemek Kitszel 	if (num_requested_filters > vfc->max_filters)
3693*5de6c855SPrzemek Kitszel 		return false;
3694*5de6c855SPrzemek Kitszel 
3695*5de6c855SPrzemek Kitszel 	return ice_vc_validate_vlan_filter_list(vfc, vfl);
3696*5de6c855SPrzemek Kitszel }
3697*5de6c855SPrzemek Kitszel 
3698*5de6c855SPrzemek Kitszel /**
3699*5de6c855SPrzemek Kitszel  * ice_vc_add_vlan_v2_msg - virtchnl handler for VIRTCHNL_OP_ADD_VLAN_V2
3700*5de6c855SPrzemek Kitszel  * @vf: VF the message was received from
3701*5de6c855SPrzemek Kitszel  * @msg: message received from the VF
3702*5de6c855SPrzemek Kitszel  */
3703*5de6c855SPrzemek Kitszel static int ice_vc_add_vlan_v2_msg(struct ice_vf *vf, u8 *msg)
3704*5de6c855SPrzemek Kitszel {
3705*5de6c855SPrzemek Kitszel 	enum virtchnl_status_code v_ret = VIRTCHNL_STATUS_SUCCESS;
3706*5de6c855SPrzemek Kitszel 	struct virtchnl_vlan_filter_list_v2 *vfl =
3707*5de6c855SPrzemek Kitszel 		(struct virtchnl_vlan_filter_list_v2 *)msg;
3708*5de6c855SPrzemek Kitszel 	struct ice_vsi *vsi;
3709*5de6c855SPrzemek Kitszel 
3710*5de6c855SPrzemek Kitszel 	if (!test_bit(ICE_VF_STATE_ACTIVE, vf->vf_states)) {
3711*5de6c855SPrzemek Kitszel 		v_ret = VIRTCHNL_STATUS_ERR_PARAM;
3712*5de6c855SPrzemek Kitszel 		goto out;
3713*5de6c855SPrzemek Kitszel 	}
3714*5de6c855SPrzemek Kitszel 
3715*5de6c855SPrzemek Kitszel 	if (!ice_vc_isvalid_vsi_id(vf, vfl->vport_id)) {
3716*5de6c855SPrzemek Kitszel 		v_ret = VIRTCHNL_STATUS_ERR_PARAM;
3717*5de6c855SPrzemek Kitszel 		goto out;
3718*5de6c855SPrzemek Kitszel 	}
3719*5de6c855SPrzemek Kitszel 
3720*5de6c855SPrzemek Kitszel 	vsi = ice_get_vf_vsi(vf);
3721*5de6c855SPrzemek Kitszel 	if (!vsi) {
3722*5de6c855SPrzemek Kitszel 		v_ret = VIRTCHNL_STATUS_ERR_PARAM;
3723*5de6c855SPrzemek Kitszel 		goto out;
3724*5de6c855SPrzemek Kitszel 	}
3725*5de6c855SPrzemek Kitszel 
3726*5de6c855SPrzemek Kitszel 	if (!ice_vc_validate_add_vlan_filter_list(vsi,
3727*5de6c855SPrzemek Kitszel 						  &vf->vlan_v2_caps.filtering,
3728*5de6c855SPrzemek Kitszel 						  vfl)) {
3729*5de6c855SPrzemek Kitszel 		v_ret = VIRTCHNL_STATUS_ERR_PARAM;
3730*5de6c855SPrzemek Kitszel 		goto out;
3731*5de6c855SPrzemek Kitszel 	}
3732*5de6c855SPrzemek Kitszel 
3733*5de6c855SPrzemek Kitszel 	if (ice_vc_add_vlans(vf, vsi, vfl))
3734*5de6c855SPrzemek Kitszel 		v_ret = VIRTCHNL_STATUS_ERR_PARAM;
3735*5de6c855SPrzemek Kitszel 
3736*5de6c855SPrzemek Kitszel out:
3737*5de6c855SPrzemek Kitszel 	return ice_vc_send_msg_to_vf(vf, VIRTCHNL_OP_ADD_VLAN_V2, v_ret, NULL,
3738*5de6c855SPrzemek Kitszel 				     0);
3739*5de6c855SPrzemek Kitszel }
3740*5de6c855SPrzemek Kitszel 
3741*5de6c855SPrzemek Kitszel /**
3742*5de6c855SPrzemek Kitszel  * ice_vc_valid_vlan_setting - validate VLAN setting
3743*5de6c855SPrzemek Kitszel  * @negotiated_settings: negotiated VLAN settings during VF init
3744*5de6c855SPrzemek Kitszel  * @ethertype_setting: ethertype(s) requested for the VLAN setting
3745*5de6c855SPrzemek Kitszel  */
3746*5de6c855SPrzemek Kitszel static bool
3747*5de6c855SPrzemek Kitszel ice_vc_valid_vlan_setting(u32 negotiated_settings, u32 ethertype_setting)
3748*5de6c855SPrzemek Kitszel {
3749*5de6c855SPrzemek Kitszel 	if (ethertype_setting && !(negotiated_settings & ethertype_setting))
3750*5de6c855SPrzemek Kitszel 		return false;
3751*5de6c855SPrzemek Kitszel 
3752*5de6c855SPrzemek Kitszel 	/* only allow a single VIRTCHNL_VLAN_ETHERTYPE if
3753*5de6c855SPrzemek Kitszel 	 * VIRTHCNL_VLAN_ETHERTYPE_AND is not negotiated/supported
3754*5de6c855SPrzemek Kitszel 	 */
3755*5de6c855SPrzemek Kitszel 	if (!(negotiated_settings & VIRTCHNL_VLAN_ETHERTYPE_AND) &&
3756*5de6c855SPrzemek Kitszel 	    hweight32(ethertype_setting) > 1)
3757*5de6c855SPrzemek Kitszel 		return false;
3758*5de6c855SPrzemek Kitszel 
3759*5de6c855SPrzemek Kitszel 	/* ability to modify the VLAN setting was not negotiated */
3760*5de6c855SPrzemek Kitszel 	if (!(negotiated_settings & VIRTCHNL_VLAN_TOGGLE))
3761*5de6c855SPrzemek Kitszel 		return false;
3762*5de6c855SPrzemek Kitszel 
3763*5de6c855SPrzemek Kitszel 	return true;
3764*5de6c855SPrzemek Kitszel }
3765*5de6c855SPrzemek Kitszel 
3766*5de6c855SPrzemek Kitszel /**
3767*5de6c855SPrzemek Kitszel  * ice_vc_valid_vlan_setting_msg - validate the VLAN setting message
3768*5de6c855SPrzemek Kitszel  * @caps: negotiated VLAN settings during VF init
3769*5de6c855SPrzemek Kitszel  * @msg: message to validate
3770*5de6c855SPrzemek Kitszel  *
3771*5de6c855SPrzemek Kitszel  * Used to validate any VLAN virtchnl message sent as a
3772*5de6c855SPrzemek Kitszel  * virtchnl_vlan_setting structure. Validates the message against the
3773*5de6c855SPrzemek Kitszel  * negotiated/supported caps during VF driver init.
3774*5de6c855SPrzemek Kitszel  */
3775*5de6c855SPrzemek Kitszel static bool
3776*5de6c855SPrzemek Kitszel ice_vc_valid_vlan_setting_msg(struct virtchnl_vlan_supported_caps *caps,
3777*5de6c855SPrzemek Kitszel 			      struct virtchnl_vlan_setting *msg)
3778*5de6c855SPrzemek Kitszel {
3779*5de6c855SPrzemek Kitszel 	if ((!msg->outer_ethertype_setting &&
3780*5de6c855SPrzemek Kitszel 	     !msg->inner_ethertype_setting) ||
3781*5de6c855SPrzemek Kitszel 	    (!caps->outer && !caps->inner))
3782*5de6c855SPrzemek Kitszel 		return false;
3783*5de6c855SPrzemek Kitszel 
3784*5de6c855SPrzemek Kitszel 	if (msg->outer_ethertype_setting &&
3785*5de6c855SPrzemek Kitszel 	    !ice_vc_valid_vlan_setting(caps->outer,
3786*5de6c855SPrzemek Kitszel 				       msg->outer_ethertype_setting))
3787*5de6c855SPrzemek Kitszel 		return false;
3788*5de6c855SPrzemek Kitszel 
3789*5de6c855SPrzemek Kitszel 	if (msg->inner_ethertype_setting &&
3790*5de6c855SPrzemek Kitszel 	    !ice_vc_valid_vlan_setting(caps->inner,
3791*5de6c855SPrzemek Kitszel 				       msg->inner_ethertype_setting))
3792*5de6c855SPrzemek Kitszel 		return false;
3793*5de6c855SPrzemek Kitszel 
3794*5de6c855SPrzemek Kitszel 	return true;
3795*5de6c855SPrzemek Kitszel }
3796*5de6c855SPrzemek Kitszel 
3797*5de6c855SPrzemek Kitszel /**
3798*5de6c855SPrzemek Kitszel  * ice_vc_get_tpid - transform from VIRTCHNL_VLAN_ETHERTYPE_* to VLAN TPID
3799*5de6c855SPrzemek Kitszel  * @ethertype_setting: VIRTCHNL_VLAN_ETHERTYPE_* used to get VLAN TPID
3800*5de6c855SPrzemek Kitszel  * @tpid: VLAN TPID to populate
3801*5de6c855SPrzemek Kitszel  */
3802*5de6c855SPrzemek Kitszel static int ice_vc_get_tpid(u32 ethertype_setting, u16 *tpid)
3803*5de6c855SPrzemek Kitszel {
3804*5de6c855SPrzemek Kitszel 	switch (ethertype_setting) {
3805*5de6c855SPrzemek Kitszel 	case VIRTCHNL_VLAN_ETHERTYPE_8100:
3806*5de6c855SPrzemek Kitszel 		*tpid = ETH_P_8021Q;
3807*5de6c855SPrzemek Kitszel 		break;
3808*5de6c855SPrzemek Kitszel 	case VIRTCHNL_VLAN_ETHERTYPE_88A8:
3809*5de6c855SPrzemek Kitszel 		*tpid = ETH_P_8021AD;
3810*5de6c855SPrzemek Kitszel 		break;
3811*5de6c855SPrzemek Kitszel 	case VIRTCHNL_VLAN_ETHERTYPE_9100:
3812*5de6c855SPrzemek Kitszel 		*tpid = ETH_P_QINQ1;
3813*5de6c855SPrzemek Kitszel 		break;
3814*5de6c855SPrzemek Kitszel 	default:
3815*5de6c855SPrzemek Kitszel 		*tpid = 0;
3816*5de6c855SPrzemek Kitszel 		return -EINVAL;
3817*5de6c855SPrzemek Kitszel 	}
3818*5de6c855SPrzemek Kitszel 
3819*5de6c855SPrzemek Kitszel 	return 0;
3820*5de6c855SPrzemek Kitszel }
3821*5de6c855SPrzemek Kitszel 
3822*5de6c855SPrzemek Kitszel /**
3823*5de6c855SPrzemek Kitszel  * ice_vc_ena_vlan_offload - enable VLAN offload based on the ethertype_setting
3824*5de6c855SPrzemek Kitszel  * @vsi: VF's VSI used to enable the VLAN offload
3825*5de6c855SPrzemek Kitszel  * @ena_offload: function used to enable the VLAN offload
3826*5de6c855SPrzemek Kitszel  * @ethertype_setting: VIRTCHNL_VLAN_ETHERTYPE_* to enable offloads for
3827*5de6c855SPrzemek Kitszel  */
3828*5de6c855SPrzemek Kitszel static int
3829*5de6c855SPrzemek Kitszel ice_vc_ena_vlan_offload(struct ice_vsi *vsi,
3830*5de6c855SPrzemek Kitszel 			int (*ena_offload)(struct ice_vsi *vsi, u16 tpid),
3831*5de6c855SPrzemek Kitszel 			u32 ethertype_setting)
3832*5de6c855SPrzemek Kitszel {
3833*5de6c855SPrzemek Kitszel 	u16 tpid;
3834*5de6c855SPrzemek Kitszel 	int err;
3835*5de6c855SPrzemek Kitszel 
3836*5de6c855SPrzemek Kitszel 	err = ice_vc_get_tpid(ethertype_setting, &tpid);
3837*5de6c855SPrzemek Kitszel 	if (err)
3838*5de6c855SPrzemek Kitszel 		return err;
3839*5de6c855SPrzemek Kitszel 
3840*5de6c855SPrzemek Kitszel 	err = ena_offload(vsi, tpid);
3841*5de6c855SPrzemek Kitszel 	if (err)
3842*5de6c855SPrzemek Kitszel 		return err;
3843*5de6c855SPrzemek Kitszel 
3844*5de6c855SPrzemek Kitszel 	return 0;
3845*5de6c855SPrzemek Kitszel }
3846*5de6c855SPrzemek Kitszel 
3847*5de6c855SPrzemek Kitszel /**
3848*5de6c855SPrzemek Kitszel  * ice_vc_ena_vlan_stripping_v2_msg
3849*5de6c855SPrzemek Kitszel  * @vf: VF the message was received from
3850*5de6c855SPrzemek Kitszel  * @msg: message received from the VF
3851*5de6c855SPrzemek Kitszel  *
3852*5de6c855SPrzemek Kitszel  * virthcnl handler for VIRTCHNL_OP_ENABLE_VLAN_STRIPPING_V2
3853*5de6c855SPrzemek Kitszel  */
3854*5de6c855SPrzemek Kitszel static int ice_vc_ena_vlan_stripping_v2_msg(struct ice_vf *vf, u8 *msg)
3855*5de6c855SPrzemek Kitszel {
3856*5de6c855SPrzemek Kitszel 	enum virtchnl_status_code v_ret = VIRTCHNL_STATUS_SUCCESS;
3857*5de6c855SPrzemek Kitszel 	struct virtchnl_vlan_supported_caps *stripping_support;
3858*5de6c855SPrzemek Kitszel 	struct virtchnl_vlan_setting *strip_msg =
3859*5de6c855SPrzemek Kitszel 		(struct virtchnl_vlan_setting *)msg;
3860*5de6c855SPrzemek Kitszel 	u32 ethertype_setting;
3861*5de6c855SPrzemek Kitszel 	struct ice_vsi *vsi;
3862*5de6c855SPrzemek Kitszel 
3863*5de6c855SPrzemek Kitszel 	if (!test_bit(ICE_VF_STATE_ACTIVE, vf->vf_states)) {
3864*5de6c855SPrzemek Kitszel 		v_ret = VIRTCHNL_STATUS_ERR_PARAM;
3865*5de6c855SPrzemek Kitszel 		goto out;
3866*5de6c855SPrzemek Kitszel 	}
3867*5de6c855SPrzemek Kitszel 
3868*5de6c855SPrzemek Kitszel 	if (!ice_vc_isvalid_vsi_id(vf, strip_msg->vport_id)) {
3869*5de6c855SPrzemek Kitszel 		v_ret = VIRTCHNL_STATUS_ERR_PARAM;
3870*5de6c855SPrzemek Kitszel 		goto out;
3871*5de6c855SPrzemek Kitszel 	}
3872*5de6c855SPrzemek Kitszel 
3873*5de6c855SPrzemek Kitszel 	vsi = ice_get_vf_vsi(vf);
3874*5de6c855SPrzemek Kitszel 	if (!vsi) {
3875*5de6c855SPrzemek Kitszel 		v_ret = VIRTCHNL_STATUS_ERR_PARAM;
3876*5de6c855SPrzemek Kitszel 		goto out;
3877*5de6c855SPrzemek Kitszel 	}
3878*5de6c855SPrzemek Kitszel 
3879*5de6c855SPrzemek Kitszel 	stripping_support = &vf->vlan_v2_caps.offloads.stripping_support;
3880*5de6c855SPrzemek Kitszel 	if (!ice_vc_valid_vlan_setting_msg(stripping_support, strip_msg)) {
3881*5de6c855SPrzemek Kitszel 		v_ret = VIRTCHNL_STATUS_ERR_PARAM;
3882*5de6c855SPrzemek Kitszel 		goto out;
3883*5de6c855SPrzemek Kitszel 	}
3884*5de6c855SPrzemek Kitszel 
3885*5de6c855SPrzemek Kitszel 	if (ice_vsi_is_rxq_crc_strip_dis(vsi)) {
3886*5de6c855SPrzemek Kitszel 		v_ret = VIRTCHNL_STATUS_ERR_NOT_SUPPORTED;
3887*5de6c855SPrzemek Kitszel 		goto out;
3888*5de6c855SPrzemek Kitszel 	}
3889*5de6c855SPrzemek Kitszel 
3890*5de6c855SPrzemek Kitszel 	ethertype_setting = strip_msg->outer_ethertype_setting;
3891*5de6c855SPrzemek Kitszel 	if (ethertype_setting) {
3892*5de6c855SPrzemek Kitszel 		if (ice_vc_ena_vlan_offload(vsi,
3893*5de6c855SPrzemek Kitszel 					    vsi->outer_vlan_ops.ena_stripping,
3894*5de6c855SPrzemek Kitszel 					    ethertype_setting)) {
3895*5de6c855SPrzemek Kitszel 			v_ret = VIRTCHNL_STATUS_ERR_PARAM;
3896*5de6c855SPrzemek Kitszel 			goto out;
3897*5de6c855SPrzemek Kitszel 		} else {
3898*5de6c855SPrzemek Kitszel 			enum ice_l2tsel l2tsel =
3899*5de6c855SPrzemek Kitszel 				ICE_L2TSEL_EXTRACT_FIRST_TAG_L2TAG2_2ND;
3900*5de6c855SPrzemek Kitszel 
3901*5de6c855SPrzemek Kitszel 			/* PF tells the VF that the outer VLAN tag is always
3902*5de6c855SPrzemek Kitszel 			 * extracted to VIRTCHNL_VLAN_TAG_LOCATION_L2TAG2_2 and
3903*5de6c855SPrzemek Kitszel 			 * inner is always extracted to
3904*5de6c855SPrzemek Kitszel 			 * VIRTCHNL_VLAN_TAG_LOCATION_L2TAG1. This is needed to
3905*5de6c855SPrzemek Kitszel 			 * support outer stripping so the first tag always ends
3906*5de6c855SPrzemek Kitszel 			 * up in L2TAG2_2ND and the second/inner tag, if
3907*5de6c855SPrzemek Kitszel 			 * enabled, is extracted in L2TAG1.
3908*5de6c855SPrzemek Kitszel 			 */
3909*5de6c855SPrzemek Kitszel 			ice_vsi_update_l2tsel(vsi, l2tsel);
3910*5de6c855SPrzemek Kitszel 
3911*5de6c855SPrzemek Kitszel 			vf->vlan_strip_ena |= ICE_OUTER_VLAN_STRIP_ENA;
3912*5de6c855SPrzemek Kitszel 		}
3913*5de6c855SPrzemek Kitszel 	}
3914*5de6c855SPrzemek Kitszel 
3915*5de6c855SPrzemek Kitszel 	ethertype_setting = strip_msg->inner_ethertype_setting;
3916*5de6c855SPrzemek Kitszel 	if (ethertype_setting &&
3917*5de6c855SPrzemek Kitszel 	    ice_vc_ena_vlan_offload(vsi, vsi->inner_vlan_ops.ena_stripping,
3918*5de6c855SPrzemek Kitszel 				    ethertype_setting)) {
3919*5de6c855SPrzemek Kitszel 		v_ret = VIRTCHNL_STATUS_ERR_PARAM;
3920*5de6c855SPrzemek Kitszel 		goto out;
3921*5de6c855SPrzemek Kitszel 	}
3922*5de6c855SPrzemek Kitszel 
3923*5de6c855SPrzemek Kitszel 	if (ethertype_setting)
3924*5de6c855SPrzemek Kitszel 		vf->vlan_strip_ena |= ICE_INNER_VLAN_STRIP_ENA;
3925*5de6c855SPrzemek Kitszel 
3926*5de6c855SPrzemek Kitszel out:
3927*5de6c855SPrzemek Kitszel 	return ice_vc_send_msg_to_vf(vf, VIRTCHNL_OP_ENABLE_VLAN_STRIPPING_V2,
3928*5de6c855SPrzemek Kitszel 				     v_ret, NULL, 0);
3929*5de6c855SPrzemek Kitszel }
3930*5de6c855SPrzemek Kitszel 
3931*5de6c855SPrzemek Kitszel /**
3932*5de6c855SPrzemek Kitszel  * ice_vc_dis_vlan_stripping_v2_msg
3933*5de6c855SPrzemek Kitszel  * @vf: VF the message was received from
3934*5de6c855SPrzemek Kitszel  * @msg: message received from the VF
3935*5de6c855SPrzemek Kitszel  *
3936*5de6c855SPrzemek Kitszel  * virthcnl handler for VIRTCHNL_OP_DISABLE_VLAN_STRIPPING_V2
3937*5de6c855SPrzemek Kitszel  */
3938*5de6c855SPrzemek Kitszel static int ice_vc_dis_vlan_stripping_v2_msg(struct ice_vf *vf, u8 *msg)
3939*5de6c855SPrzemek Kitszel {
3940*5de6c855SPrzemek Kitszel 	enum virtchnl_status_code v_ret = VIRTCHNL_STATUS_SUCCESS;
3941*5de6c855SPrzemek Kitszel 	struct virtchnl_vlan_supported_caps *stripping_support;
3942*5de6c855SPrzemek Kitszel 	struct virtchnl_vlan_setting *strip_msg =
3943*5de6c855SPrzemek Kitszel 		(struct virtchnl_vlan_setting *)msg;
3944*5de6c855SPrzemek Kitszel 	u32 ethertype_setting;
3945*5de6c855SPrzemek Kitszel 	struct ice_vsi *vsi;
3946*5de6c855SPrzemek Kitszel 
3947*5de6c855SPrzemek Kitszel 	if (!test_bit(ICE_VF_STATE_ACTIVE, vf->vf_states)) {
3948*5de6c855SPrzemek Kitszel 		v_ret = VIRTCHNL_STATUS_ERR_PARAM;
3949*5de6c855SPrzemek Kitszel 		goto out;
3950*5de6c855SPrzemek Kitszel 	}
3951*5de6c855SPrzemek Kitszel 
3952*5de6c855SPrzemek Kitszel 	if (!ice_vc_isvalid_vsi_id(vf, strip_msg->vport_id)) {
3953*5de6c855SPrzemek Kitszel 		v_ret = VIRTCHNL_STATUS_ERR_PARAM;
3954*5de6c855SPrzemek Kitszel 		goto out;
3955*5de6c855SPrzemek Kitszel 	}
3956*5de6c855SPrzemek Kitszel 
3957*5de6c855SPrzemek Kitszel 	vsi = ice_get_vf_vsi(vf);
3958*5de6c855SPrzemek Kitszel 	if (!vsi) {
3959*5de6c855SPrzemek Kitszel 		v_ret = VIRTCHNL_STATUS_ERR_PARAM;
3960*5de6c855SPrzemek Kitszel 		goto out;
3961*5de6c855SPrzemek Kitszel 	}
3962*5de6c855SPrzemek Kitszel 
3963*5de6c855SPrzemek Kitszel 	stripping_support = &vf->vlan_v2_caps.offloads.stripping_support;
3964*5de6c855SPrzemek Kitszel 	if (!ice_vc_valid_vlan_setting_msg(stripping_support, strip_msg)) {
3965*5de6c855SPrzemek Kitszel 		v_ret = VIRTCHNL_STATUS_ERR_PARAM;
3966*5de6c855SPrzemek Kitszel 		goto out;
3967*5de6c855SPrzemek Kitszel 	}
3968*5de6c855SPrzemek Kitszel 
3969*5de6c855SPrzemek Kitszel 	ethertype_setting = strip_msg->outer_ethertype_setting;
3970*5de6c855SPrzemek Kitszel 	if (ethertype_setting) {
3971*5de6c855SPrzemek Kitszel 		if (vsi->outer_vlan_ops.dis_stripping(vsi)) {
3972*5de6c855SPrzemek Kitszel 			v_ret = VIRTCHNL_STATUS_ERR_PARAM;
3973*5de6c855SPrzemek Kitszel 			goto out;
3974*5de6c855SPrzemek Kitszel 		} else {
3975*5de6c855SPrzemek Kitszel 			enum ice_l2tsel l2tsel =
3976*5de6c855SPrzemek Kitszel 				ICE_L2TSEL_EXTRACT_FIRST_TAG_L2TAG1;
3977*5de6c855SPrzemek Kitszel 
3978*5de6c855SPrzemek Kitszel 			/* PF tells the VF that the outer VLAN tag is always
3979*5de6c855SPrzemek Kitszel 			 * extracted to VIRTCHNL_VLAN_TAG_LOCATION_L2TAG2_2 and
3980*5de6c855SPrzemek Kitszel 			 * inner is always extracted to
3981*5de6c855SPrzemek Kitszel 			 * VIRTCHNL_VLAN_TAG_LOCATION_L2TAG1. This is needed to
3982*5de6c855SPrzemek Kitszel 			 * support inner stripping while outer stripping is
3983*5de6c855SPrzemek Kitszel 			 * disabled so that the first and only tag is extracted
3984*5de6c855SPrzemek Kitszel 			 * in L2TAG1.
3985*5de6c855SPrzemek Kitszel 			 */
3986*5de6c855SPrzemek Kitszel 			ice_vsi_update_l2tsel(vsi, l2tsel);
3987*5de6c855SPrzemek Kitszel 
3988*5de6c855SPrzemek Kitszel 			vf->vlan_strip_ena &= ~ICE_OUTER_VLAN_STRIP_ENA;
3989*5de6c855SPrzemek Kitszel 		}
3990*5de6c855SPrzemek Kitszel 	}
3991*5de6c855SPrzemek Kitszel 
3992*5de6c855SPrzemek Kitszel 	ethertype_setting = strip_msg->inner_ethertype_setting;
3993*5de6c855SPrzemek Kitszel 	if (ethertype_setting && vsi->inner_vlan_ops.dis_stripping(vsi)) {
3994*5de6c855SPrzemek Kitszel 		v_ret = VIRTCHNL_STATUS_ERR_PARAM;
3995*5de6c855SPrzemek Kitszel 		goto out;
3996*5de6c855SPrzemek Kitszel 	}
3997*5de6c855SPrzemek Kitszel 
3998*5de6c855SPrzemek Kitszel 	if (ethertype_setting)
3999*5de6c855SPrzemek Kitszel 		vf->vlan_strip_ena &= ~ICE_INNER_VLAN_STRIP_ENA;
4000*5de6c855SPrzemek Kitszel 
4001*5de6c855SPrzemek Kitszel out:
4002*5de6c855SPrzemek Kitszel 	return ice_vc_send_msg_to_vf(vf, VIRTCHNL_OP_DISABLE_VLAN_STRIPPING_V2,
4003*5de6c855SPrzemek Kitszel 				     v_ret, NULL, 0);
4004*5de6c855SPrzemek Kitszel }
4005*5de6c855SPrzemek Kitszel 
4006*5de6c855SPrzemek Kitszel /**
4007*5de6c855SPrzemek Kitszel  * ice_vc_ena_vlan_insertion_v2_msg
4008*5de6c855SPrzemek Kitszel  * @vf: VF the message was received from
4009*5de6c855SPrzemek Kitszel  * @msg: message received from the VF
4010*5de6c855SPrzemek Kitszel  *
4011*5de6c855SPrzemek Kitszel  * virthcnl handler for VIRTCHNL_OP_ENABLE_VLAN_INSERTION_V2
4012*5de6c855SPrzemek Kitszel  */
4013*5de6c855SPrzemek Kitszel static int ice_vc_ena_vlan_insertion_v2_msg(struct ice_vf *vf, u8 *msg)
4014*5de6c855SPrzemek Kitszel {
4015*5de6c855SPrzemek Kitszel 	enum virtchnl_status_code v_ret = VIRTCHNL_STATUS_SUCCESS;
4016*5de6c855SPrzemek Kitszel 	struct virtchnl_vlan_supported_caps *insertion_support;
4017*5de6c855SPrzemek Kitszel 	struct virtchnl_vlan_setting *insertion_msg =
4018*5de6c855SPrzemek Kitszel 		(struct virtchnl_vlan_setting *)msg;
4019*5de6c855SPrzemek Kitszel 	u32 ethertype_setting;
4020*5de6c855SPrzemek Kitszel 	struct ice_vsi *vsi;
4021*5de6c855SPrzemek Kitszel 
4022*5de6c855SPrzemek Kitszel 	if (!test_bit(ICE_VF_STATE_ACTIVE, vf->vf_states)) {
4023*5de6c855SPrzemek Kitszel 		v_ret = VIRTCHNL_STATUS_ERR_PARAM;
4024*5de6c855SPrzemek Kitszel 		goto out;
4025*5de6c855SPrzemek Kitszel 	}
4026*5de6c855SPrzemek Kitszel 
4027*5de6c855SPrzemek Kitszel 	if (!ice_vc_isvalid_vsi_id(vf, insertion_msg->vport_id)) {
4028*5de6c855SPrzemek Kitszel 		v_ret = VIRTCHNL_STATUS_ERR_PARAM;
4029*5de6c855SPrzemek Kitszel 		goto out;
4030*5de6c855SPrzemek Kitszel 	}
4031*5de6c855SPrzemek Kitszel 
4032*5de6c855SPrzemek Kitszel 	vsi = ice_get_vf_vsi(vf);
4033*5de6c855SPrzemek Kitszel 	if (!vsi) {
4034*5de6c855SPrzemek Kitszel 		v_ret = VIRTCHNL_STATUS_ERR_PARAM;
4035*5de6c855SPrzemek Kitszel 		goto out;
4036*5de6c855SPrzemek Kitszel 	}
4037*5de6c855SPrzemek Kitszel 
4038*5de6c855SPrzemek Kitszel 	insertion_support = &vf->vlan_v2_caps.offloads.insertion_support;
4039*5de6c855SPrzemek Kitszel 	if (!ice_vc_valid_vlan_setting_msg(insertion_support, insertion_msg)) {
4040*5de6c855SPrzemek Kitszel 		v_ret = VIRTCHNL_STATUS_ERR_PARAM;
4041*5de6c855SPrzemek Kitszel 		goto out;
4042*5de6c855SPrzemek Kitszel 	}
4043*5de6c855SPrzemek Kitszel 
4044*5de6c855SPrzemek Kitszel 	ethertype_setting = insertion_msg->outer_ethertype_setting;
4045*5de6c855SPrzemek Kitszel 	if (ethertype_setting &&
4046*5de6c855SPrzemek Kitszel 	    ice_vc_ena_vlan_offload(vsi, vsi->outer_vlan_ops.ena_insertion,
4047*5de6c855SPrzemek Kitszel 				    ethertype_setting)) {
4048*5de6c855SPrzemek Kitszel 		v_ret = VIRTCHNL_STATUS_ERR_PARAM;
4049*5de6c855SPrzemek Kitszel 		goto out;
4050*5de6c855SPrzemek Kitszel 	}
4051*5de6c855SPrzemek Kitszel 
4052*5de6c855SPrzemek Kitszel 	ethertype_setting = insertion_msg->inner_ethertype_setting;
4053*5de6c855SPrzemek Kitszel 	if (ethertype_setting &&
4054*5de6c855SPrzemek Kitszel 	    ice_vc_ena_vlan_offload(vsi, vsi->inner_vlan_ops.ena_insertion,
4055*5de6c855SPrzemek Kitszel 				    ethertype_setting)) {
4056*5de6c855SPrzemek Kitszel 		v_ret = VIRTCHNL_STATUS_ERR_PARAM;
4057*5de6c855SPrzemek Kitszel 		goto out;
4058*5de6c855SPrzemek Kitszel 	}
4059*5de6c855SPrzemek Kitszel 
4060*5de6c855SPrzemek Kitszel out:
4061*5de6c855SPrzemek Kitszel 	return ice_vc_send_msg_to_vf(vf, VIRTCHNL_OP_ENABLE_VLAN_INSERTION_V2,
4062*5de6c855SPrzemek Kitszel 				     v_ret, NULL, 0);
4063*5de6c855SPrzemek Kitszel }
4064*5de6c855SPrzemek Kitszel 
4065*5de6c855SPrzemek Kitszel /**
4066*5de6c855SPrzemek Kitszel  * ice_vc_dis_vlan_insertion_v2_msg
4067*5de6c855SPrzemek Kitszel  * @vf: VF the message was received from
4068*5de6c855SPrzemek Kitszel  * @msg: message received from the VF
4069*5de6c855SPrzemek Kitszel  *
4070*5de6c855SPrzemek Kitszel  * virthcnl handler for VIRTCHNL_OP_DISABLE_VLAN_INSERTION_V2
4071*5de6c855SPrzemek Kitszel  */
4072*5de6c855SPrzemek Kitszel static int ice_vc_dis_vlan_insertion_v2_msg(struct ice_vf *vf, u8 *msg)
4073*5de6c855SPrzemek Kitszel {
4074*5de6c855SPrzemek Kitszel 	enum virtchnl_status_code v_ret = VIRTCHNL_STATUS_SUCCESS;
4075*5de6c855SPrzemek Kitszel 	struct virtchnl_vlan_supported_caps *insertion_support;
4076*5de6c855SPrzemek Kitszel 	struct virtchnl_vlan_setting *insertion_msg =
4077*5de6c855SPrzemek Kitszel 		(struct virtchnl_vlan_setting *)msg;
4078*5de6c855SPrzemek Kitszel 	u32 ethertype_setting;
4079*5de6c855SPrzemek Kitszel 	struct ice_vsi *vsi;
4080*5de6c855SPrzemek Kitszel 
4081*5de6c855SPrzemek Kitszel 	if (!test_bit(ICE_VF_STATE_ACTIVE, vf->vf_states)) {
4082*5de6c855SPrzemek Kitszel 		v_ret = VIRTCHNL_STATUS_ERR_PARAM;
4083*5de6c855SPrzemek Kitszel 		goto out;
4084*5de6c855SPrzemek Kitszel 	}
4085*5de6c855SPrzemek Kitszel 
4086*5de6c855SPrzemek Kitszel 	if (!ice_vc_isvalid_vsi_id(vf, insertion_msg->vport_id)) {
4087*5de6c855SPrzemek Kitszel 		v_ret = VIRTCHNL_STATUS_ERR_PARAM;
4088*5de6c855SPrzemek Kitszel 		goto out;
4089*5de6c855SPrzemek Kitszel 	}
4090*5de6c855SPrzemek Kitszel 
4091*5de6c855SPrzemek Kitszel 	vsi = ice_get_vf_vsi(vf);
4092*5de6c855SPrzemek Kitszel 	if (!vsi) {
4093*5de6c855SPrzemek Kitszel 		v_ret = VIRTCHNL_STATUS_ERR_PARAM;
4094*5de6c855SPrzemek Kitszel 		goto out;
4095*5de6c855SPrzemek Kitszel 	}
4096*5de6c855SPrzemek Kitszel 
4097*5de6c855SPrzemek Kitszel 	insertion_support = &vf->vlan_v2_caps.offloads.insertion_support;
4098*5de6c855SPrzemek Kitszel 	if (!ice_vc_valid_vlan_setting_msg(insertion_support, insertion_msg)) {
4099*5de6c855SPrzemek Kitszel 		v_ret = VIRTCHNL_STATUS_ERR_PARAM;
4100*5de6c855SPrzemek Kitszel 		goto out;
4101*5de6c855SPrzemek Kitszel 	}
4102*5de6c855SPrzemek Kitszel 
4103*5de6c855SPrzemek Kitszel 	ethertype_setting = insertion_msg->outer_ethertype_setting;
4104*5de6c855SPrzemek Kitszel 	if (ethertype_setting && vsi->outer_vlan_ops.dis_insertion(vsi)) {
4105*5de6c855SPrzemek Kitszel 		v_ret = VIRTCHNL_STATUS_ERR_PARAM;
4106*5de6c855SPrzemek Kitszel 		goto out;
4107*5de6c855SPrzemek Kitszel 	}
4108*5de6c855SPrzemek Kitszel 
4109*5de6c855SPrzemek Kitszel 	ethertype_setting = insertion_msg->inner_ethertype_setting;
4110*5de6c855SPrzemek Kitszel 	if (ethertype_setting && vsi->inner_vlan_ops.dis_insertion(vsi)) {
4111*5de6c855SPrzemek Kitszel 		v_ret = VIRTCHNL_STATUS_ERR_PARAM;
4112*5de6c855SPrzemek Kitszel 		goto out;
4113*5de6c855SPrzemek Kitszel 	}
4114*5de6c855SPrzemek Kitszel 
4115*5de6c855SPrzemek Kitszel out:
4116*5de6c855SPrzemek Kitszel 	return ice_vc_send_msg_to_vf(vf, VIRTCHNL_OP_DISABLE_VLAN_INSERTION_V2,
4117*5de6c855SPrzemek Kitszel 				     v_ret, NULL, 0);
4118*5de6c855SPrzemek Kitszel }
4119*5de6c855SPrzemek Kitszel 
4120*5de6c855SPrzemek Kitszel static int ice_vc_get_ptp_cap(struct ice_vf *vf,
4121*5de6c855SPrzemek Kitszel 			      const struct virtchnl_ptp_caps *msg)
4122*5de6c855SPrzemek Kitszel {
4123*5de6c855SPrzemek Kitszel 	enum virtchnl_status_code v_ret = VIRTCHNL_STATUS_ERR_PARAM;
4124*5de6c855SPrzemek Kitszel 	u32 caps = VIRTCHNL_1588_PTP_CAP_RX_TSTAMP |
4125*5de6c855SPrzemek Kitszel 		   VIRTCHNL_1588_PTP_CAP_READ_PHC;
4126*5de6c855SPrzemek Kitszel 
4127*5de6c855SPrzemek Kitszel 	if (!test_bit(ICE_VF_STATE_ACTIVE, vf->vf_states))
4128*5de6c855SPrzemek Kitszel 		goto err;
4129*5de6c855SPrzemek Kitszel 
4130*5de6c855SPrzemek Kitszel 	v_ret = VIRTCHNL_STATUS_SUCCESS;
4131*5de6c855SPrzemek Kitszel 
4132*5de6c855SPrzemek Kitszel 	if (msg->caps & caps)
4133*5de6c855SPrzemek Kitszel 		vf->ptp_caps = caps;
4134*5de6c855SPrzemek Kitszel 
4135*5de6c855SPrzemek Kitszel err:
4136*5de6c855SPrzemek Kitszel 	/* send the response back to the VF */
4137*5de6c855SPrzemek Kitszel 	return ice_vc_send_msg_to_vf(vf, VIRTCHNL_OP_1588_PTP_GET_CAPS, v_ret,
4138*5de6c855SPrzemek Kitszel 				     (u8 *)&vf->ptp_caps,
4139*5de6c855SPrzemek Kitszel 				     sizeof(struct virtchnl_ptp_caps));
4140*5de6c855SPrzemek Kitszel }
4141*5de6c855SPrzemek Kitszel 
4142*5de6c855SPrzemek Kitszel static int ice_vc_get_phc_time(struct ice_vf *vf)
4143*5de6c855SPrzemek Kitszel {
4144*5de6c855SPrzemek Kitszel 	enum virtchnl_status_code v_ret = VIRTCHNL_STATUS_ERR_PARAM;
4145*5de6c855SPrzemek Kitszel 	struct virtchnl_phc_time *phc_time = NULL;
4146*5de6c855SPrzemek Kitszel 	struct ice_pf *pf = vf->pf;
4147*5de6c855SPrzemek Kitszel 	u32 len = 0;
4148*5de6c855SPrzemek Kitszel 	int ret;
4149*5de6c855SPrzemek Kitszel 
4150*5de6c855SPrzemek Kitszel 	if (!test_bit(ICE_VF_STATE_ACTIVE, vf->vf_states))
4151*5de6c855SPrzemek Kitszel 		goto err;
4152*5de6c855SPrzemek Kitszel 
4153*5de6c855SPrzemek Kitszel 	v_ret = VIRTCHNL_STATUS_SUCCESS;
4154*5de6c855SPrzemek Kitszel 
4155*5de6c855SPrzemek Kitszel 	phc_time = kzalloc(sizeof(*phc_time), GFP_KERNEL);
4156*5de6c855SPrzemek Kitszel 	if (!phc_time) {
4157*5de6c855SPrzemek Kitszel 		v_ret = VIRTCHNL_STATUS_ERR_NO_MEMORY;
4158*5de6c855SPrzemek Kitszel 		goto err;
4159*5de6c855SPrzemek Kitszel 	}
4160*5de6c855SPrzemek Kitszel 
4161*5de6c855SPrzemek Kitszel 	len = sizeof(*phc_time);
4162*5de6c855SPrzemek Kitszel 
4163*5de6c855SPrzemek Kitszel 	phc_time->time = ice_ptp_read_src_clk_reg(pf, NULL);
4164*5de6c855SPrzemek Kitszel 
4165*5de6c855SPrzemek Kitszel err:
4166*5de6c855SPrzemek Kitszel 	/* send the response back to the VF */
4167*5de6c855SPrzemek Kitszel 	ret = ice_vc_send_msg_to_vf(vf, VIRTCHNL_OP_1588_PTP_GET_TIME, v_ret,
4168*5de6c855SPrzemek Kitszel 				    (u8 *)phc_time, len);
4169*5de6c855SPrzemek Kitszel 	kfree(phc_time);
4170*5de6c855SPrzemek Kitszel 	return ret;
4171*5de6c855SPrzemek Kitszel }
4172*5de6c855SPrzemek Kitszel 
4173*5de6c855SPrzemek Kitszel static const struct ice_virtchnl_ops ice_virtchnl_dflt_ops = {
4174*5de6c855SPrzemek Kitszel 	.get_ver_msg = ice_vc_get_ver_msg,
4175*5de6c855SPrzemek Kitszel 	.get_vf_res_msg = ice_vc_get_vf_res_msg,
4176*5de6c855SPrzemek Kitszel 	.reset_vf = ice_vc_reset_vf_msg,
4177*5de6c855SPrzemek Kitszel 	.add_mac_addr_msg = ice_vc_add_mac_addr_msg,
4178*5de6c855SPrzemek Kitszel 	.del_mac_addr_msg = ice_vc_del_mac_addr_msg,
4179*5de6c855SPrzemek Kitszel 	.cfg_qs_msg = ice_vc_cfg_qs_msg,
4180*5de6c855SPrzemek Kitszel 	.ena_qs_msg = ice_vc_ena_qs_msg,
4181*5de6c855SPrzemek Kitszel 	.dis_qs_msg = ice_vc_dis_qs_msg,
4182*5de6c855SPrzemek Kitszel 	.request_qs_msg = ice_vc_request_qs_msg,
4183*5de6c855SPrzemek Kitszel 	.cfg_irq_map_msg = ice_vc_cfg_irq_map_msg,
4184*5de6c855SPrzemek Kitszel 	.config_rss_key = ice_vc_config_rss_key,
4185*5de6c855SPrzemek Kitszel 	.config_rss_lut = ice_vc_config_rss_lut,
4186*5de6c855SPrzemek Kitszel 	.config_rss_hfunc = ice_vc_config_rss_hfunc,
4187*5de6c855SPrzemek Kitszel 	.get_stats_msg = ice_vc_get_stats_msg,
4188*5de6c855SPrzemek Kitszel 	.cfg_promiscuous_mode_msg = ice_vc_cfg_promiscuous_mode_msg,
4189*5de6c855SPrzemek Kitszel 	.add_vlan_msg = ice_vc_add_vlan_msg,
4190*5de6c855SPrzemek Kitszel 	.remove_vlan_msg = ice_vc_remove_vlan_msg,
4191*5de6c855SPrzemek Kitszel 	.query_rxdid = ice_vc_query_rxdid,
4192*5de6c855SPrzemek Kitszel 	.get_rss_hashcfg = ice_vc_get_rss_hashcfg,
4193*5de6c855SPrzemek Kitszel 	.set_rss_hashcfg = ice_vc_set_rss_hashcfg,
4194*5de6c855SPrzemek Kitszel 	.ena_vlan_stripping = ice_vc_ena_vlan_stripping,
4195*5de6c855SPrzemek Kitszel 	.dis_vlan_stripping = ice_vc_dis_vlan_stripping,
4196*5de6c855SPrzemek Kitszel 	.handle_rss_cfg_msg = ice_vc_handle_rss_cfg,
4197*5de6c855SPrzemek Kitszel 	.add_fdir_fltr_msg = ice_vc_add_fdir_fltr,
4198*5de6c855SPrzemek Kitszel 	.del_fdir_fltr_msg = ice_vc_del_fdir_fltr,
4199*5de6c855SPrzemek Kitszel 	.get_offload_vlan_v2_caps = ice_vc_get_offload_vlan_v2_caps,
4200*5de6c855SPrzemek Kitszel 	.add_vlan_v2_msg = ice_vc_add_vlan_v2_msg,
4201*5de6c855SPrzemek Kitszel 	.remove_vlan_v2_msg = ice_vc_remove_vlan_v2_msg,
4202*5de6c855SPrzemek Kitszel 	.ena_vlan_stripping_v2_msg = ice_vc_ena_vlan_stripping_v2_msg,
4203*5de6c855SPrzemek Kitszel 	.dis_vlan_stripping_v2_msg = ice_vc_dis_vlan_stripping_v2_msg,
4204*5de6c855SPrzemek Kitszel 	.ena_vlan_insertion_v2_msg = ice_vc_ena_vlan_insertion_v2_msg,
4205*5de6c855SPrzemek Kitszel 	.dis_vlan_insertion_v2_msg = ice_vc_dis_vlan_insertion_v2_msg,
4206*5de6c855SPrzemek Kitszel 	.get_qos_caps = ice_vc_get_qos_caps,
4207*5de6c855SPrzemek Kitszel 	.cfg_q_bw = ice_vc_cfg_q_bw,
4208*5de6c855SPrzemek Kitszel 	.cfg_q_quanta = ice_vc_cfg_q_quanta,
4209*5de6c855SPrzemek Kitszel 	.get_ptp_cap = ice_vc_get_ptp_cap,
4210*5de6c855SPrzemek Kitszel 	.get_phc_time = ice_vc_get_phc_time,
4211*5de6c855SPrzemek Kitszel 	/* If you add a new op here please make sure to add it to
4212*5de6c855SPrzemek Kitszel 	 * ice_virtchnl_repr_ops as well.
4213*5de6c855SPrzemek Kitszel 	 */
4214*5de6c855SPrzemek Kitszel };
4215*5de6c855SPrzemek Kitszel 
4216*5de6c855SPrzemek Kitszel /**
4217*5de6c855SPrzemek Kitszel  * ice_virtchnl_set_dflt_ops - Switch to default virtchnl ops
4218*5de6c855SPrzemek Kitszel  * @vf: the VF to switch ops
4219*5de6c855SPrzemek Kitszel  */
4220*5de6c855SPrzemek Kitszel void ice_virtchnl_set_dflt_ops(struct ice_vf *vf)
4221*5de6c855SPrzemek Kitszel {
4222*5de6c855SPrzemek Kitszel 	vf->virtchnl_ops = &ice_virtchnl_dflt_ops;
4223*5de6c855SPrzemek Kitszel }
4224*5de6c855SPrzemek Kitszel 
4225*5de6c855SPrzemek Kitszel /**
4226*5de6c855SPrzemek Kitszel  * ice_vc_repr_add_mac
4227*5de6c855SPrzemek Kitszel  * @vf: pointer to VF
4228*5de6c855SPrzemek Kitszel  * @msg: virtchannel message
4229*5de6c855SPrzemek Kitszel  *
4230*5de6c855SPrzemek Kitszel  * When port representors are created, we do not add MAC rule
4231*5de6c855SPrzemek Kitszel  * to firmware, we store it so that PF could report same
4232*5de6c855SPrzemek Kitszel  * MAC as VF.
4233*5de6c855SPrzemek Kitszel  */
4234*5de6c855SPrzemek Kitszel static int ice_vc_repr_add_mac(struct ice_vf *vf, u8 *msg)
4235*5de6c855SPrzemek Kitszel {
4236*5de6c855SPrzemek Kitszel 	enum virtchnl_status_code v_ret = VIRTCHNL_STATUS_SUCCESS;
4237*5de6c855SPrzemek Kitszel 	struct virtchnl_ether_addr_list *al =
4238*5de6c855SPrzemek Kitszel 	    (struct virtchnl_ether_addr_list *)msg;
4239*5de6c855SPrzemek Kitszel 	struct ice_vsi *vsi;
4240*5de6c855SPrzemek Kitszel 	struct ice_pf *pf;
4241*5de6c855SPrzemek Kitszel 	int i;
4242*5de6c855SPrzemek Kitszel 
4243*5de6c855SPrzemek Kitszel 	if (!test_bit(ICE_VF_STATE_ACTIVE, vf->vf_states) ||
4244*5de6c855SPrzemek Kitszel 	    !ice_vc_isvalid_vsi_id(vf, al->vsi_id)) {
4245*5de6c855SPrzemek Kitszel 		v_ret = VIRTCHNL_STATUS_ERR_PARAM;
4246*5de6c855SPrzemek Kitszel 		goto handle_mac_exit;
4247*5de6c855SPrzemek Kitszel 	}
4248*5de6c855SPrzemek Kitszel 
4249*5de6c855SPrzemek Kitszel 	pf = vf->pf;
4250*5de6c855SPrzemek Kitszel 
4251*5de6c855SPrzemek Kitszel 	vsi = ice_get_vf_vsi(vf);
4252*5de6c855SPrzemek Kitszel 	if (!vsi) {
4253*5de6c855SPrzemek Kitszel 		v_ret = VIRTCHNL_STATUS_ERR_PARAM;
4254*5de6c855SPrzemek Kitszel 		goto handle_mac_exit;
4255*5de6c855SPrzemek Kitszel 	}
4256*5de6c855SPrzemek Kitszel 
4257*5de6c855SPrzemek Kitszel 	for (i = 0; i < al->num_elements; i++) {
4258*5de6c855SPrzemek Kitszel 		u8 *mac_addr = al->list[i].addr;
4259*5de6c855SPrzemek Kitszel 
4260*5de6c855SPrzemek Kitszel 		if (!is_unicast_ether_addr(mac_addr) ||
4261*5de6c855SPrzemek Kitszel 		    ether_addr_equal(mac_addr, vf->hw_lan_addr))
4262*5de6c855SPrzemek Kitszel 			continue;
4263*5de6c855SPrzemek Kitszel 
4264*5de6c855SPrzemek Kitszel 		if (vf->pf_set_mac) {
4265*5de6c855SPrzemek Kitszel 			dev_err(ice_pf_to_dev(pf), "VF attempting to override administratively set MAC address\n");
4266*5de6c855SPrzemek Kitszel 			v_ret = VIRTCHNL_STATUS_ERR_NOT_SUPPORTED;
4267*5de6c855SPrzemek Kitszel 			goto handle_mac_exit;
4268*5de6c855SPrzemek Kitszel 		}
4269*5de6c855SPrzemek Kitszel 
4270*5de6c855SPrzemek Kitszel 		ice_vfhw_mac_add(vf, &al->list[i]);
4271*5de6c855SPrzemek Kitszel 		break;
4272*5de6c855SPrzemek Kitszel 	}
4273*5de6c855SPrzemek Kitszel 
4274*5de6c855SPrzemek Kitszel handle_mac_exit:
4275*5de6c855SPrzemek Kitszel 	return ice_vc_send_msg_to_vf(vf, VIRTCHNL_OP_ADD_ETH_ADDR,
4276*5de6c855SPrzemek Kitszel 				     v_ret, NULL, 0);
4277*5de6c855SPrzemek Kitszel }
4278*5de6c855SPrzemek Kitszel 
4279*5de6c855SPrzemek Kitszel /**
4280*5de6c855SPrzemek Kitszel  * ice_vc_repr_del_mac - response with success for deleting MAC
4281*5de6c855SPrzemek Kitszel  * @vf: pointer to VF
4282*5de6c855SPrzemek Kitszel  * @msg: virtchannel message
4283*5de6c855SPrzemek Kitszel  *
4284*5de6c855SPrzemek Kitszel  * Respond with success to not break normal VF flow.
4285*5de6c855SPrzemek Kitszel  * For legacy VF driver try to update cached MAC address.
4286*5de6c855SPrzemek Kitszel  */
4287*5de6c855SPrzemek Kitszel static int
4288*5de6c855SPrzemek Kitszel ice_vc_repr_del_mac(struct ice_vf __always_unused *vf, u8 __always_unused *msg)
4289*5de6c855SPrzemek Kitszel {
4290*5de6c855SPrzemek Kitszel 	struct virtchnl_ether_addr_list *al =
4291*5de6c855SPrzemek Kitszel 		(struct virtchnl_ether_addr_list *)msg;
4292*5de6c855SPrzemek Kitszel 
4293*5de6c855SPrzemek Kitszel 	ice_update_legacy_cached_mac(vf, &al->list[0]);
4294*5de6c855SPrzemek Kitszel 
4295*5de6c855SPrzemek Kitszel 	return ice_vc_send_msg_to_vf(vf, VIRTCHNL_OP_DEL_ETH_ADDR,
4296*5de6c855SPrzemek Kitszel 				     VIRTCHNL_STATUS_SUCCESS, NULL, 0);
4297*5de6c855SPrzemek Kitszel }
4298*5de6c855SPrzemek Kitszel 
4299*5de6c855SPrzemek Kitszel static int
4300*5de6c855SPrzemek Kitszel ice_vc_repr_cfg_promiscuous_mode(struct ice_vf *vf, u8 __always_unused *msg)
4301*5de6c855SPrzemek Kitszel {
4302*5de6c855SPrzemek Kitszel 	dev_dbg(ice_pf_to_dev(vf->pf),
4303*5de6c855SPrzemek Kitszel 		"Can't config promiscuous mode in switchdev mode for VF %d\n",
4304*5de6c855SPrzemek Kitszel 		vf->vf_id);
4305*5de6c855SPrzemek Kitszel 	return ice_vc_send_msg_to_vf(vf, VIRTCHNL_OP_CONFIG_PROMISCUOUS_MODE,
4306*5de6c855SPrzemek Kitszel 				     VIRTCHNL_STATUS_ERR_NOT_SUPPORTED,
4307*5de6c855SPrzemek Kitszel 				     NULL, 0);
4308*5de6c855SPrzemek Kitszel }
4309*5de6c855SPrzemek Kitszel 
4310*5de6c855SPrzemek Kitszel static const struct ice_virtchnl_ops ice_virtchnl_repr_ops = {
4311*5de6c855SPrzemek Kitszel 	.get_ver_msg = ice_vc_get_ver_msg,
4312*5de6c855SPrzemek Kitszel 	.get_vf_res_msg = ice_vc_get_vf_res_msg,
4313*5de6c855SPrzemek Kitszel 	.reset_vf = ice_vc_reset_vf_msg,
4314*5de6c855SPrzemek Kitszel 	.add_mac_addr_msg = ice_vc_repr_add_mac,
4315*5de6c855SPrzemek Kitszel 	.del_mac_addr_msg = ice_vc_repr_del_mac,
4316*5de6c855SPrzemek Kitszel 	.cfg_qs_msg = ice_vc_cfg_qs_msg,
4317*5de6c855SPrzemek Kitszel 	.ena_qs_msg = ice_vc_ena_qs_msg,
4318*5de6c855SPrzemek Kitszel 	.dis_qs_msg = ice_vc_dis_qs_msg,
4319*5de6c855SPrzemek Kitszel 	.request_qs_msg = ice_vc_request_qs_msg,
4320*5de6c855SPrzemek Kitszel 	.cfg_irq_map_msg = ice_vc_cfg_irq_map_msg,
4321*5de6c855SPrzemek Kitszel 	.config_rss_key = ice_vc_config_rss_key,
4322*5de6c855SPrzemek Kitszel 	.config_rss_lut = ice_vc_config_rss_lut,
4323*5de6c855SPrzemek Kitszel 	.config_rss_hfunc = ice_vc_config_rss_hfunc,
4324*5de6c855SPrzemek Kitszel 	.get_stats_msg = ice_vc_get_stats_msg,
4325*5de6c855SPrzemek Kitszel 	.cfg_promiscuous_mode_msg = ice_vc_repr_cfg_promiscuous_mode,
4326*5de6c855SPrzemek Kitszel 	.add_vlan_msg = ice_vc_add_vlan_msg,
4327*5de6c855SPrzemek Kitszel 	.remove_vlan_msg = ice_vc_remove_vlan_msg,
4328*5de6c855SPrzemek Kitszel 	.query_rxdid = ice_vc_query_rxdid,
4329*5de6c855SPrzemek Kitszel 	.get_rss_hashcfg = ice_vc_get_rss_hashcfg,
4330*5de6c855SPrzemek Kitszel 	.set_rss_hashcfg = ice_vc_set_rss_hashcfg,
4331*5de6c855SPrzemek Kitszel 	.ena_vlan_stripping = ice_vc_ena_vlan_stripping,
4332*5de6c855SPrzemek Kitszel 	.dis_vlan_stripping = ice_vc_dis_vlan_stripping,
4333*5de6c855SPrzemek Kitszel 	.handle_rss_cfg_msg = ice_vc_handle_rss_cfg,
4334*5de6c855SPrzemek Kitszel 	.add_fdir_fltr_msg = ice_vc_add_fdir_fltr,
4335*5de6c855SPrzemek Kitszel 	.del_fdir_fltr_msg = ice_vc_del_fdir_fltr,
4336*5de6c855SPrzemek Kitszel 	.get_offload_vlan_v2_caps = ice_vc_get_offload_vlan_v2_caps,
4337*5de6c855SPrzemek Kitszel 	.add_vlan_v2_msg = ice_vc_add_vlan_v2_msg,
4338*5de6c855SPrzemek Kitszel 	.remove_vlan_v2_msg = ice_vc_remove_vlan_v2_msg,
4339*5de6c855SPrzemek Kitszel 	.ena_vlan_stripping_v2_msg = ice_vc_ena_vlan_stripping_v2_msg,
4340*5de6c855SPrzemek Kitszel 	.dis_vlan_stripping_v2_msg = ice_vc_dis_vlan_stripping_v2_msg,
4341*5de6c855SPrzemek Kitszel 	.ena_vlan_insertion_v2_msg = ice_vc_ena_vlan_insertion_v2_msg,
4342*5de6c855SPrzemek Kitszel 	.dis_vlan_insertion_v2_msg = ice_vc_dis_vlan_insertion_v2_msg,
4343*5de6c855SPrzemek Kitszel 	.get_qos_caps = ice_vc_get_qos_caps,
4344*5de6c855SPrzemek Kitszel 	.cfg_q_bw = ice_vc_cfg_q_bw,
4345*5de6c855SPrzemek Kitszel 	.cfg_q_quanta = ice_vc_cfg_q_quanta,
4346*5de6c855SPrzemek Kitszel 	.get_ptp_cap = ice_vc_get_ptp_cap,
4347*5de6c855SPrzemek Kitszel 	.get_phc_time = ice_vc_get_phc_time,
4348*5de6c855SPrzemek Kitszel };
4349*5de6c855SPrzemek Kitszel 
4350*5de6c855SPrzemek Kitszel /**
4351*5de6c855SPrzemek Kitszel  * ice_virtchnl_set_repr_ops - Switch to representor virtchnl ops
4352*5de6c855SPrzemek Kitszel  * @vf: the VF to switch ops
4353*5de6c855SPrzemek Kitszel  */
4354*5de6c855SPrzemek Kitszel void ice_virtchnl_set_repr_ops(struct ice_vf *vf)
4355*5de6c855SPrzemek Kitszel {
4356*5de6c855SPrzemek Kitszel 	vf->virtchnl_ops = &ice_virtchnl_repr_ops;
4357*5de6c855SPrzemek Kitszel }
4358*5de6c855SPrzemek Kitszel 
4359*5de6c855SPrzemek Kitszel /**
4360*5de6c855SPrzemek Kitszel  * ice_is_malicious_vf - check if this vf might be overflowing mailbox
4361*5de6c855SPrzemek Kitszel  * @vf: the VF to check
4362*5de6c855SPrzemek Kitszel  * @mbxdata: data about the state of the mailbox
4363*5de6c855SPrzemek Kitszel  *
4364*5de6c855SPrzemek Kitszel  * Detect if a given VF might be malicious and attempting to overflow the PF
4365*5de6c855SPrzemek Kitszel  * mailbox. If so, log a warning message and ignore this event.
4366*5de6c855SPrzemek Kitszel  */
4367*5de6c855SPrzemek Kitszel static bool
4368*5de6c855SPrzemek Kitszel ice_is_malicious_vf(struct ice_vf *vf, struct ice_mbx_data *mbxdata)
4369*5de6c855SPrzemek Kitszel {
4370*5de6c855SPrzemek Kitszel 	bool report_malvf = false;
4371*5de6c855SPrzemek Kitszel 	struct device *dev;
4372*5de6c855SPrzemek Kitszel 	struct ice_pf *pf;
4373*5de6c855SPrzemek Kitszel 	int status;
4374*5de6c855SPrzemek Kitszel 
4375*5de6c855SPrzemek Kitszel 	pf = vf->pf;
4376*5de6c855SPrzemek Kitszel 	dev = ice_pf_to_dev(pf);
4377*5de6c855SPrzemek Kitszel 
4378*5de6c855SPrzemek Kitszel 	if (test_bit(ICE_VF_STATE_DIS, vf->vf_states))
4379*5de6c855SPrzemek Kitszel 		return vf->mbx_info.malicious;
4380*5de6c855SPrzemek Kitszel 
4381*5de6c855SPrzemek Kitszel 	/* check to see if we have a newly malicious VF */
4382*5de6c855SPrzemek Kitszel 	status = ice_mbx_vf_state_handler(&pf->hw, mbxdata, &vf->mbx_info,
4383*5de6c855SPrzemek Kitszel 					  &report_malvf);
4384*5de6c855SPrzemek Kitszel 	if (status)
4385*5de6c855SPrzemek Kitszel 		dev_warn_ratelimited(dev, "Unable to check status of mailbox overflow for VF %u MAC %pM, status %d\n",
4386*5de6c855SPrzemek Kitszel 				     vf->vf_id, vf->dev_lan_addr, status);
4387*5de6c855SPrzemek Kitszel 
4388*5de6c855SPrzemek Kitszel 	if (report_malvf) {
4389*5de6c855SPrzemek Kitszel 		struct ice_vsi *pf_vsi = ice_get_main_vsi(pf);
4390*5de6c855SPrzemek Kitszel 		u8 zero_addr[ETH_ALEN] = {};
4391*5de6c855SPrzemek Kitszel 
4392*5de6c855SPrzemek Kitszel 		dev_warn(dev, "VF MAC %pM on PF MAC %pM is generating asynchronous messages and may be overflowing the PF message queue. Please see the Adapter User Guide for more information\n",
4393*5de6c855SPrzemek Kitszel 			 vf->dev_lan_addr,
4394*5de6c855SPrzemek Kitszel 			 pf_vsi ? pf_vsi->netdev->dev_addr : zero_addr);
4395*5de6c855SPrzemek Kitszel 	}
4396*5de6c855SPrzemek Kitszel 
4397*5de6c855SPrzemek Kitszel 	return vf->mbx_info.malicious;
4398*5de6c855SPrzemek Kitszel }
4399*5de6c855SPrzemek Kitszel 
4400*5de6c855SPrzemek Kitszel /**
4401*5de6c855SPrzemek Kitszel  * ice_vc_process_vf_msg - Process request from VF
4402*5de6c855SPrzemek Kitszel  * @pf: pointer to the PF structure
4403*5de6c855SPrzemek Kitszel  * @event: pointer to the AQ event
4404*5de6c855SPrzemek Kitszel  * @mbxdata: information used to detect VF attempting mailbox overflow
4405*5de6c855SPrzemek Kitszel  *
4406*5de6c855SPrzemek Kitszel  * Called from the common asq/arq handler to process request from VF. When this
4407*5de6c855SPrzemek Kitszel  * flow is used for devices with hardware VF to PF message queue overflow
4408*5de6c855SPrzemek Kitszel  * support (ICE_F_MBX_LIMIT) mbxdata is set to NULL and ice_is_malicious_vf
4409*5de6c855SPrzemek Kitszel  * check is skipped.
4410*5de6c855SPrzemek Kitszel  */
4411*5de6c855SPrzemek Kitszel void ice_vc_process_vf_msg(struct ice_pf *pf, struct ice_rq_event_info *event,
4412*5de6c855SPrzemek Kitszel 			   struct ice_mbx_data *mbxdata)
4413*5de6c855SPrzemek Kitszel {
4414*5de6c855SPrzemek Kitszel 	u32 v_opcode = le32_to_cpu(event->desc.cookie_high);
4415*5de6c855SPrzemek Kitszel 	s16 vf_id = le16_to_cpu(event->desc.retval);
4416*5de6c855SPrzemek Kitszel 	const struct ice_virtchnl_ops *ops;
4417*5de6c855SPrzemek Kitszel 	u16 msglen = event->msg_len;
4418*5de6c855SPrzemek Kitszel 	u8 *msg = event->msg_buf;
4419*5de6c855SPrzemek Kitszel 	struct ice_vf *vf = NULL;
4420*5de6c855SPrzemek Kitszel 	struct device *dev;
4421*5de6c855SPrzemek Kitszel 	int err = 0;
4422*5de6c855SPrzemek Kitszel 
4423*5de6c855SPrzemek Kitszel 	dev = ice_pf_to_dev(pf);
4424*5de6c855SPrzemek Kitszel 
4425*5de6c855SPrzemek Kitszel 	vf = ice_get_vf_by_id(pf, vf_id);
4426*5de6c855SPrzemek Kitszel 	if (!vf) {
4427*5de6c855SPrzemek Kitszel 		dev_err(dev, "Unable to locate VF for message from VF ID %d, opcode %d, len %d\n",
4428*5de6c855SPrzemek Kitszel 			vf_id, v_opcode, msglen);
4429*5de6c855SPrzemek Kitszel 		return;
4430*5de6c855SPrzemek Kitszel 	}
4431*5de6c855SPrzemek Kitszel 
4432*5de6c855SPrzemek Kitszel 	mutex_lock(&vf->cfg_lock);
4433*5de6c855SPrzemek Kitszel 
4434*5de6c855SPrzemek Kitszel 	/* Check if the VF is trying to overflow the mailbox */
4435*5de6c855SPrzemek Kitszel 	if (mbxdata && ice_is_malicious_vf(vf, mbxdata))
4436*5de6c855SPrzemek Kitszel 		goto finish;
4437*5de6c855SPrzemek Kitszel 
4438*5de6c855SPrzemek Kitszel 	/* Check if VF is disabled. */
4439*5de6c855SPrzemek Kitszel 	if (test_bit(ICE_VF_STATE_DIS, vf->vf_states)) {
4440*5de6c855SPrzemek Kitszel 		err = -EPERM;
4441*5de6c855SPrzemek Kitszel 		goto error_handler;
4442*5de6c855SPrzemek Kitszel 	}
4443*5de6c855SPrzemek Kitszel 
4444*5de6c855SPrzemek Kitszel 	ops = vf->virtchnl_ops;
4445*5de6c855SPrzemek Kitszel 
4446*5de6c855SPrzemek Kitszel 	/* Perform basic checks on the msg */
4447*5de6c855SPrzemek Kitszel 	err = virtchnl_vc_validate_vf_msg(&vf->vf_ver, v_opcode, msg, msglen);
4448*5de6c855SPrzemek Kitszel 	if (err) {
4449*5de6c855SPrzemek Kitszel 		if (err == VIRTCHNL_STATUS_ERR_PARAM)
4450*5de6c855SPrzemek Kitszel 			err = -EPERM;
4451*5de6c855SPrzemek Kitszel 		else
4452*5de6c855SPrzemek Kitszel 			err = -EINVAL;
4453*5de6c855SPrzemek Kitszel 	}
4454*5de6c855SPrzemek Kitszel 
4455*5de6c855SPrzemek Kitszel error_handler:
4456*5de6c855SPrzemek Kitszel 	if (err) {
4457*5de6c855SPrzemek Kitszel 		ice_vc_send_msg_to_vf(vf, v_opcode, VIRTCHNL_STATUS_ERR_PARAM,
4458*5de6c855SPrzemek Kitszel 				      NULL, 0);
4459*5de6c855SPrzemek Kitszel 		dev_err(dev, "Invalid message from VF %d, opcode %d, len %d, error %d\n",
4460*5de6c855SPrzemek Kitszel 			vf_id, v_opcode, msglen, err);
4461*5de6c855SPrzemek Kitszel 		goto finish;
4462*5de6c855SPrzemek Kitszel 	}
4463*5de6c855SPrzemek Kitszel 
4464*5de6c855SPrzemek Kitszel 	if (!ice_vc_is_opcode_allowed(vf, v_opcode)) {
4465*5de6c855SPrzemek Kitszel 		ice_vc_send_msg_to_vf(vf, v_opcode,
4466*5de6c855SPrzemek Kitszel 				      VIRTCHNL_STATUS_ERR_NOT_SUPPORTED, NULL,
4467*5de6c855SPrzemek Kitszel 				      0);
4468*5de6c855SPrzemek Kitszel 		goto finish;
4469*5de6c855SPrzemek Kitszel 	}
4470*5de6c855SPrzemek Kitszel 
4471*5de6c855SPrzemek Kitszel 	switch (v_opcode) {
4472*5de6c855SPrzemek Kitszel 	case VIRTCHNL_OP_VERSION:
4473*5de6c855SPrzemek Kitszel 		err = ops->get_ver_msg(vf, msg);
4474*5de6c855SPrzemek Kitszel 		break;
4475*5de6c855SPrzemek Kitszel 	case VIRTCHNL_OP_GET_VF_RESOURCES:
4476*5de6c855SPrzemek Kitszel 		err = ops->get_vf_res_msg(vf, msg);
4477*5de6c855SPrzemek Kitszel 		if (ice_vf_init_vlan_stripping(vf))
4478*5de6c855SPrzemek Kitszel 			dev_dbg(dev, "Failed to initialize VLAN stripping for VF %d\n",
4479*5de6c855SPrzemek Kitszel 				vf->vf_id);
4480*5de6c855SPrzemek Kitszel 		ice_vc_notify_vf_link_state(vf);
4481*5de6c855SPrzemek Kitszel 		break;
4482*5de6c855SPrzemek Kitszel 	case VIRTCHNL_OP_RESET_VF:
4483*5de6c855SPrzemek Kitszel 		ops->reset_vf(vf);
4484*5de6c855SPrzemek Kitszel 		break;
4485*5de6c855SPrzemek Kitszel 	case VIRTCHNL_OP_ADD_ETH_ADDR:
4486*5de6c855SPrzemek Kitszel 		err = ops->add_mac_addr_msg(vf, msg);
4487*5de6c855SPrzemek Kitszel 		break;
4488*5de6c855SPrzemek Kitszel 	case VIRTCHNL_OP_DEL_ETH_ADDR:
4489*5de6c855SPrzemek Kitszel 		err = ops->del_mac_addr_msg(vf, msg);
4490*5de6c855SPrzemek Kitszel 		break;
4491*5de6c855SPrzemek Kitszel 	case VIRTCHNL_OP_CONFIG_VSI_QUEUES:
4492*5de6c855SPrzemek Kitszel 		err = ops->cfg_qs_msg(vf, msg);
4493*5de6c855SPrzemek Kitszel 		break;
4494*5de6c855SPrzemek Kitszel 	case VIRTCHNL_OP_ENABLE_QUEUES:
4495*5de6c855SPrzemek Kitszel 		err = ops->ena_qs_msg(vf, msg);
4496*5de6c855SPrzemek Kitszel 		ice_vc_notify_vf_link_state(vf);
4497*5de6c855SPrzemek Kitszel 		break;
4498*5de6c855SPrzemek Kitszel 	case VIRTCHNL_OP_DISABLE_QUEUES:
4499*5de6c855SPrzemek Kitszel 		err = ops->dis_qs_msg(vf, msg);
4500*5de6c855SPrzemek Kitszel 		break;
4501*5de6c855SPrzemek Kitszel 	case VIRTCHNL_OP_REQUEST_QUEUES:
4502*5de6c855SPrzemek Kitszel 		err = ops->request_qs_msg(vf, msg);
4503*5de6c855SPrzemek Kitszel 		break;
4504*5de6c855SPrzemek Kitszel 	case VIRTCHNL_OP_CONFIG_IRQ_MAP:
4505*5de6c855SPrzemek Kitszel 		err = ops->cfg_irq_map_msg(vf, msg);
4506*5de6c855SPrzemek Kitszel 		break;
4507*5de6c855SPrzemek Kitszel 	case VIRTCHNL_OP_CONFIG_RSS_KEY:
4508*5de6c855SPrzemek Kitszel 		err = ops->config_rss_key(vf, msg);
4509*5de6c855SPrzemek Kitszel 		break;
4510*5de6c855SPrzemek Kitszel 	case VIRTCHNL_OP_CONFIG_RSS_LUT:
4511*5de6c855SPrzemek Kitszel 		err = ops->config_rss_lut(vf, msg);
4512*5de6c855SPrzemek Kitszel 		break;
4513*5de6c855SPrzemek Kitszel 	case VIRTCHNL_OP_CONFIG_RSS_HFUNC:
4514*5de6c855SPrzemek Kitszel 		err = ops->config_rss_hfunc(vf, msg);
4515*5de6c855SPrzemek Kitszel 		break;
4516*5de6c855SPrzemek Kitszel 	case VIRTCHNL_OP_GET_STATS:
4517*5de6c855SPrzemek Kitszel 		err = ops->get_stats_msg(vf, msg);
4518*5de6c855SPrzemek Kitszel 		break;
4519*5de6c855SPrzemek Kitszel 	case VIRTCHNL_OP_CONFIG_PROMISCUOUS_MODE:
4520*5de6c855SPrzemek Kitszel 		err = ops->cfg_promiscuous_mode_msg(vf, msg);
4521*5de6c855SPrzemek Kitszel 		break;
4522*5de6c855SPrzemek Kitszel 	case VIRTCHNL_OP_ADD_VLAN:
4523*5de6c855SPrzemek Kitszel 		err = ops->add_vlan_msg(vf, msg);
4524*5de6c855SPrzemek Kitszel 		break;
4525*5de6c855SPrzemek Kitszel 	case VIRTCHNL_OP_DEL_VLAN:
4526*5de6c855SPrzemek Kitszel 		err = ops->remove_vlan_msg(vf, msg);
4527*5de6c855SPrzemek Kitszel 		break;
4528*5de6c855SPrzemek Kitszel 	case VIRTCHNL_OP_GET_SUPPORTED_RXDIDS:
4529*5de6c855SPrzemek Kitszel 		err = ops->query_rxdid(vf);
4530*5de6c855SPrzemek Kitszel 		break;
4531*5de6c855SPrzemek Kitszel 	case VIRTCHNL_OP_GET_RSS_HASHCFG_CAPS:
4532*5de6c855SPrzemek Kitszel 		err = ops->get_rss_hashcfg(vf);
4533*5de6c855SPrzemek Kitszel 		break;
4534*5de6c855SPrzemek Kitszel 	case VIRTCHNL_OP_SET_RSS_HASHCFG:
4535*5de6c855SPrzemek Kitszel 		err = ops->set_rss_hashcfg(vf, msg);
4536*5de6c855SPrzemek Kitszel 		break;
4537*5de6c855SPrzemek Kitszel 	case VIRTCHNL_OP_ENABLE_VLAN_STRIPPING:
4538*5de6c855SPrzemek Kitszel 		err = ops->ena_vlan_stripping(vf);
4539*5de6c855SPrzemek Kitszel 		break;
4540*5de6c855SPrzemek Kitszel 	case VIRTCHNL_OP_DISABLE_VLAN_STRIPPING:
4541*5de6c855SPrzemek Kitszel 		err = ops->dis_vlan_stripping(vf);
4542*5de6c855SPrzemek Kitszel 		break;
4543*5de6c855SPrzemek Kitszel 	case VIRTCHNL_OP_ADD_FDIR_FILTER:
4544*5de6c855SPrzemek Kitszel 		err = ops->add_fdir_fltr_msg(vf, msg);
4545*5de6c855SPrzemek Kitszel 		break;
4546*5de6c855SPrzemek Kitszel 	case VIRTCHNL_OP_DEL_FDIR_FILTER:
4547*5de6c855SPrzemek Kitszel 		err = ops->del_fdir_fltr_msg(vf, msg);
4548*5de6c855SPrzemek Kitszel 		break;
4549*5de6c855SPrzemek Kitszel 	case VIRTCHNL_OP_ADD_RSS_CFG:
4550*5de6c855SPrzemek Kitszel 		err = ops->handle_rss_cfg_msg(vf, msg, true);
4551*5de6c855SPrzemek Kitszel 		break;
4552*5de6c855SPrzemek Kitszel 	case VIRTCHNL_OP_DEL_RSS_CFG:
4553*5de6c855SPrzemek Kitszel 		err = ops->handle_rss_cfg_msg(vf, msg, false);
4554*5de6c855SPrzemek Kitszel 		break;
4555*5de6c855SPrzemek Kitszel 	case VIRTCHNL_OP_GET_OFFLOAD_VLAN_V2_CAPS:
4556*5de6c855SPrzemek Kitszel 		err = ops->get_offload_vlan_v2_caps(vf);
4557*5de6c855SPrzemek Kitszel 		break;
4558*5de6c855SPrzemek Kitszel 	case VIRTCHNL_OP_ADD_VLAN_V2:
4559*5de6c855SPrzemek Kitszel 		err = ops->add_vlan_v2_msg(vf, msg);
4560*5de6c855SPrzemek Kitszel 		break;
4561*5de6c855SPrzemek Kitszel 	case VIRTCHNL_OP_DEL_VLAN_V2:
4562*5de6c855SPrzemek Kitszel 		err = ops->remove_vlan_v2_msg(vf, msg);
4563*5de6c855SPrzemek Kitszel 		break;
4564*5de6c855SPrzemek Kitszel 	case VIRTCHNL_OP_ENABLE_VLAN_STRIPPING_V2:
4565*5de6c855SPrzemek Kitszel 		err = ops->ena_vlan_stripping_v2_msg(vf, msg);
4566*5de6c855SPrzemek Kitszel 		break;
4567*5de6c855SPrzemek Kitszel 	case VIRTCHNL_OP_DISABLE_VLAN_STRIPPING_V2:
4568*5de6c855SPrzemek Kitszel 		err = ops->dis_vlan_stripping_v2_msg(vf, msg);
4569*5de6c855SPrzemek Kitszel 		break;
4570*5de6c855SPrzemek Kitszel 	case VIRTCHNL_OP_ENABLE_VLAN_INSERTION_V2:
4571*5de6c855SPrzemek Kitszel 		err = ops->ena_vlan_insertion_v2_msg(vf, msg);
4572*5de6c855SPrzemek Kitszel 		break;
4573*5de6c855SPrzemek Kitszel 	case VIRTCHNL_OP_DISABLE_VLAN_INSERTION_V2:
4574*5de6c855SPrzemek Kitszel 		err = ops->dis_vlan_insertion_v2_msg(vf, msg);
4575*5de6c855SPrzemek Kitszel 		break;
4576*5de6c855SPrzemek Kitszel 	case VIRTCHNL_OP_GET_QOS_CAPS:
4577*5de6c855SPrzemek Kitszel 		err = ops->get_qos_caps(vf);
4578*5de6c855SPrzemek Kitszel 		break;
4579*5de6c855SPrzemek Kitszel 	case VIRTCHNL_OP_CONFIG_QUEUE_BW:
4580*5de6c855SPrzemek Kitszel 		err = ops->cfg_q_bw(vf, msg);
4581*5de6c855SPrzemek Kitszel 		break;
4582*5de6c855SPrzemek Kitszel 	case VIRTCHNL_OP_CONFIG_QUANTA:
4583*5de6c855SPrzemek Kitszel 		err = ops->cfg_q_quanta(vf, msg);
4584*5de6c855SPrzemek Kitszel 		break;
4585*5de6c855SPrzemek Kitszel 	case VIRTCHNL_OP_1588_PTP_GET_CAPS:
4586*5de6c855SPrzemek Kitszel 		err = ops->get_ptp_cap(vf, (const void *)msg);
4587*5de6c855SPrzemek Kitszel 		break;
4588*5de6c855SPrzemek Kitszel 	case VIRTCHNL_OP_1588_PTP_GET_TIME:
4589*5de6c855SPrzemek Kitszel 		err = ops->get_phc_time(vf);
4590*5de6c855SPrzemek Kitszel 		break;
4591*5de6c855SPrzemek Kitszel 	case VIRTCHNL_OP_UNKNOWN:
4592*5de6c855SPrzemek Kitszel 	default:
4593*5de6c855SPrzemek Kitszel 		dev_err(dev, "Unsupported opcode %d from VF %d\n", v_opcode,
4594*5de6c855SPrzemek Kitszel 			vf_id);
4595*5de6c855SPrzemek Kitszel 		err = ice_vc_send_msg_to_vf(vf, v_opcode,
4596*5de6c855SPrzemek Kitszel 					    VIRTCHNL_STATUS_ERR_NOT_SUPPORTED,
4597*5de6c855SPrzemek Kitszel 					    NULL, 0);
4598*5de6c855SPrzemek Kitszel 		break;
4599*5de6c855SPrzemek Kitszel 	}
4600*5de6c855SPrzemek Kitszel 	if (err) {
4601*5de6c855SPrzemek Kitszel 		/* Helper function cares less about error return values here
4602*5de6c855SPrzemek Kitszel 		 * as it is busy with pending work.
4603*5de6c855SPrzemek Kitszel 		 */
4604*5de6c855SPrzemek Kitszel 		dev_info(dev, "PF failed to honor VF %d, opcode %d, error %d\n",
4605*5de6c855SPrzemek Kitszel 			 vf_id, v_opcode, err);
4606*5de6c855SPrzemek Kitszel 	}
4607*5de6c855SPrzemek Kitszel 
4608*5de6c855SPrzemek Kitszel finish:
4609*5de6c855SPrzemek Kitszel 	mutex_unlock(&vf->cfg_lock);
4610*5de6c855SPrzemek Kitszel 	ice_put_vf(vf);
4611*5de6c855SPrzemek Kitszel }
4612