i40e_virtchnl_pf.c 112.1 KB
Newer Older
1 2 3
/*******************************************************************************
 *
 * Intel Ethernet Controller XL710 Family Linux Driver
4
 * Copyright(c) 2013 - 2016 Intel Corporation.
5 6 7 8 9 10 11 12 13 14
 *
 * This program is free software; you can redistribute it and/or modify it
 * under the terms and conditions of the GNU General Public License,
 * version 2, as published by the Free Software Foundation.
 *
 * This program is distributed in the hope it will be useful, but WITHOUT
 * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
 * FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License for
 * more details.
 *
G
Greg Rose 已提交
15 16
 * You should have received a copy of the GNU General Public License along
 * with this program.  If not, see <http://www.gnu.org/licenses/>.
17 18 19 20 21 22 23 24 25 26 27 28
 *
 * The full GNU General Public License is included in this distribution in
 * the file called "COPYING".
 *
 * Contact Information:
 * e1000-devel Mailing List <e1000-devel@lists.sourceforge.net>
 * Intel Corporation, 5200 N.E. Elam Young Parkway, Hillsboro, OR 97124-6497
 *
 ******************************************************************************/

#include "i40e.h"

29 30 31 32 33 34 35 36 37 38 39 40 41
/*********************notification routines***********************/

/**
 * i40e_vc_vf_broadcast
 * @pf: pointer to the PF structure
 * @opcode: operation code
 * @retval: return value
 * @msg: pointer to the msg buffer
 * @msglen: msg length
 *
 * send a message to all VFs on a given PF
 **/
static void i40e_vc_vf_broadcast(struct i40e_pf *pf,
42
				 enum virtchnl_ops v_opcode,
43 44 45 46 47 48 49 50
				 i40e_status v_retval, u8 *msg,
				 u16 msglen)
{
	struct i40e_hw *hw = &pf->hw;
	struct i40e_vf *vf = pf->vf;
	int i;

	for (i = 0; i < pf->num_alloc_vfs; i++, vf++) {
51
		int abs_vf_id = vf->vf_id + (int)hw->func_caps.vf_base_id;
52
		/* Not all vfs are enabled so skip the ones that are not */
53 54
		if (!test_bit(I40E_VF_STATE_INIT, &vf->vf_states) &&
		    !test_bit(I40E_VF_STATE_ACTIVE, &vf->vf_states))
55 56 57 58 59 60 61 62 63 64 65
			continue;

		/* Ignore return value on purpose - a given VF may fail, but
		 * we need to keep going and send to all of them
		 */
		i40e_aq_send_msg_to_vf(hw, abs_vf_id, v_opcode, v_retval,
				       msg, msglen, NULL);
	}
}

/**
66
 * i40e_vc_notify_vf_link_state
67 68 69 70 71 72
 * @vf: pointer to the VF structure
 *
 * send a link status message to a single VF
 **/
static void i40e_vc_notify_vf_link_state(struct i40e_vf *vf)
{
73
	struct virtchnl_pf_event pfe;
74 75 76
	struct i40e_pf *pf = vf->pf;
	struct i40e_hw *hw = &pf->hw;
	struct i40e_link_status *ls = &pf->hw.phy.link_info;
77
	int abs_vf_id = vf->vf_id + (int)hw->func_caps.vf_base_id;
78

79
	pfe.event = VIRTCHNL_EVENT_LINK_CHANGE;
80
	pfe.severity = PF_EVENT_SEVERITY_INFO;
81 82 83
	if (vf->link_forced) {
		pfe.event_data.link_event.link_status = vf->link_up;
		pfe.event_data.link_event.link_speed =
84
			(vf->link_up ? VIRTCHNL_LINK_SPEED_40GB : 0);
85 86 87
	} else {
		pfe.event_data.link_event.link_status =
			ls->link_info & I40E_AQ_LINK_UP;
88
		pfe.event_data.link_event.link_speed =
89
			i40e_virtchnl_link_speed(ls->link_speed);
90
	}
91
	i40e_aq_send_msg_to_vf(hw, abs_vf_id, VIRTCHNL_OP_EVENT,
92 93 94 95 96 97 98 99 100 101 102 103 104 105 106 107 108 109 110 111 112 113 114 115 116
			       0, (u8 *)&pfe, sizeof(pfe), NULL);
}

/**
 * i40e_vc_notify_link_state
 * @pf: pointer to the PF structure
 *
 * send a link status message to all VFs on a given PF
 **/
void i40e_vc_notify_link_state(struct i40e_pf *pf)
{
	int i;

	for (i = 0; i < pf->num_alloc_vfs; i++)
		i40e_vc_notify_vf_link_state(&pf->vf[i]);
}

/**
 * i40e_vc_notify_reset
 * @pf: pointer to the PF structure
 *
 * indicate a pending reset to all VFs on a given PF
 **/
void i40e_vc_notify_reset(struct i40e_pf *pf)
{
117
	struct virtchnl_pf_event pfe;
118

119
	pfe.event = VIRTCHNL_EVENT_RESET_IMPENDING;
120
	pfe.severity = PF_EVENT_SEVERITY_CERTAIN_DOOM;
121 122
	i40e_vc_vf_broadcast(pf, VIRTCHNL_OP_EVENT, 0,
			     (u8 *)&pfe, sizeof(struct virtchnl_pf_event));
123 124 125 126 127 128 129 130 131 132
}

/**
 * i40e_vc_notify_vf_reset
 * @vf: pointer to the VF structure
 *
 * indicate a pending reset to the given VF
 **/
void i40e_vc_notify_vf_reset(struct i40e_vf *vf)
{
133
	struct virtchnl_pf_event pfe;
134 135 136 137 138 139 140
	int abs_vf_id;

	/* validate the request */
	if (!vf || vf->vf_id >= vf->pf->num_alloc_vfs)
		return;

	/* verify if the VF is in either init or active before proceeding */
141 142
	if (!test_bit(I40E_VF_STATE_INIT, &vf->vf_states) &&
	    !test_bit(I40E_VF_STATE_ACTIVE, &vf->vf_states))
143 144
		return;

145
	abs_vf_id = vf->vf_id + (int)vf->pf->hw.func_caps.vf_base_id;
146

147
	pfe.event = VIRTCHNL_EVENT_RESET_IMPENDING;
148
	pfe.severity = PF_EVENT_SEVERITY_CERTAIN_DOOM;
149
	i40e_aq_send_msg_to_vf(&vf->pf->hw, abs_vf_id, VIRTCHNL_OP_EVENT,
150
			       0, (u8 *)&pfe,
151
			       sizeof(struct virtchnl_pf_event), NULL);
152
}
153 154
/***********************misc routines*****************************/

155 156
/**
 * i40e_vc_disable_vf
157
 * @vf: pointer to the VF info
158
 *
159
 * Disable the VF through a SW reset.
160
 **/
161
static inline void i40e_vc_disable_vf(struct i40e_vf *vf)
162
{
163 164
	int i;

165
	i40e_vc_notify_vf_reset(vf);
166 167 168 169 170 171 172 173 174 175 176 177 178 179 180

	/* We want to ensure that an actual reset occurs initiated after this
	 * function was called. However, we do not want to wait forever, so
	 * we'll give a reasonable time and print a message if we failed to
	 * ensure a reset.
	 */
	for (i = 0; i < 20; i++) {
		if (i40e_reset_vf(vf, false))
			return;
		usleep_range(10000, 20000);
	}

	dev_warn(&vf->pf->pdev->dev,
		 "Failed to initiate reset for VF %d after 200 milliseconds\n",
		 vf->vf_id);
181 182
}

183 184
/**
 * i40e_vc_isvalid_vsi_id
185 186
 * @vf: pointer to the VF info
 * @vsi_id: VF relative VSI id
187
 *
188
 * check for the valid VSI id
189
 **/
190
static inline bool i40e_vc_isvalid_vsi_id(struct i40e_vf *vf, u16 vsi_id)
191 192
{
	struct i40e_pf *pf = vf->pf;
193
	struct i40e_vsi *vsi = i40e_find_vsi_from_id(pf, vsi_id);
194

195
	return (vsi && (vsi->vf_id == vf->vf_id));
196 197 198 199
}

/**
 * i40e_vc_isvalid_queue_id
200
 * @vf: pointer to the VF info
201 202 203 204 205
 * @vsi_id: vsi id
 * @qid: vsi relative queue id
 *
 * check for the valid queue id
 **/
206
static inline bool i40e_vc_isvalid_queue_id(struct i40e_vf *vf, u16 vsi_id,
207 208 209
					    u8 qid)
{
	struct i40e_pf *pf = vf->pf;
210
	struct i40e_vsi *vsi = i40e_find_vsi_from_id(pf, vsi_id);
211

212
	return (vsi && (qid < vsi->alloc_queue_pairs));
213 214 215 216
}

/**
 * i40e_vc_isvalid_vector_id
217 218
 * @vf: pointer to the VF info
 * @vector_id: VF relative vector id
219 220 221 222 223 224 225
 *
 * check for the valid vector id
 **/
static inline bool i40e_vc_isvalid_vector_id(struct i40e_vf *vf, u8 vector_id)
{
	struct i40e_pf *pf = vf->pf;

226
	return vector_id < pf->hw.func_caps.num_msix_vectors_vf;
227 228 229 230 231 232
}

/***********************vf resource mgmt routines*****************/

/**
 * i40e_vc_get_pf_queue_id
233
 * @vf: pointer to the VF info
234
 * @vsi_id: id of VSI as provided by the FW
235 236
 * @vsi_queue_id: vsi relative queue id
 *
237
 * return PF relative queue id
238
 **/
239
static u16 i40e_vc_get_pf_queue_id(struct i40e_vf *vf, u16 vsi_id,
240 241 242
				   u8 vsi_queue_id)
{
	struct i40e_pf *pf = vf->pf;
243
	struct i40e_vsi *vsi = i40e_find_vsi_from_id(pf, vsi_id);
244 245
	u16 pf_queue_id = I40E_QUEUE_END_OF_LIST;

246 247 248
	if (!vsi)
		return pf_queue_id;

249 250 251 252 253 254 255 256 257 258 259
	if (le16_to_cpu(vsi->info.mapping_flags) &
	    I40E_AQ_VSI_QUE_MAP_NONCONTIG)
		pf_queue_id =
			le16_to_cpu(vsi->info.queue_mapping[vsi_queue_id]);
	else
		pf_queue_id = le16_to_cpu(vsi->info.queue_mapping[0]) +
			      vsi_queue_id;

	return pf_queue_id;
}

260 261 262 263 264 265 266 267 268 269 270 271 272 273 274 275 276 277 278 279 280 281 282 283 284 285 286 287 288 289 290 291
/**
 * i40e_get_real_pf_qid
 * @vf: pointer to the VF info
 * @vsi_id: vsi id
 * @queue_id: queue number
 *
 * wrapper function to get pf_queue_id handling ADq code as well
 **/
static u16 i40e_get_real_pf_qid(struct i40e_vf *vf, u16 vsi_id, u16 queue_id)
{
	int i;

	if (vf->adq_enabled) {
		/* Although VF considers all the queues(can be 1 to 16) as its
		 * own but they may actually belong to different VSIs(up to 4).
		 * We need to find which queues belongs to which VSI.
		 */
		for (i = 0; i < vf->num_tc; i++) {
			if (queue_id < vf->ch[i].num_qps) {
				vsi_id = vf->ch[i].vsi_id;
				break;
			}
			/* find right queue id which is relative to a
			 * given VSI.
			 */
			queue_id -= vf->ch[i].num_qps;
			}
		}

	return i40e_vc_get_pf_queue_id(vf, vsi_id, queue_id);
}

292 293
/**
 * i40e_config_irq_link_list
294
 * @vf: pointer to the VF info
295
 * @vsi_id: id of VSI as given by the FW
296 297 298 299
 * @vecmap: irq map info
 *
 * configure irq link list from the map
 **/
300
static void i40e_config_irq_link_list(struct i40e_vf *vf, u16 vsi_id,
301
				      struct virtchnl_vector_map *vecmap)
302 303 304 305 306 307
{
	unsigned long linklistmap = 0, tempmap;
	struct i40e_pf *pf = vf->pf;
	struct i40e_hw *hw = &pf->hw;
	u16 vsi_queue_id, pf_queue_id;
	enum i40e_queue_type qtype;
308
	u16 next_q, vector_id, size;
309 310 311 312 313 314 315 316 317
	u32 reg, reg_idx;
	u16 itr_idx = 0;

	vector_id = vecmap->vector_id;
	/* setup the head */
	if (0 == vector_id)
		reg_idx = I40E_VPINT_LNKLST0(vf->vf_id);
	else
		reg_idx = I40E_VPINT_LNKLSTN(
318 319
		     ((pf->hw.func_caps.num_msix_vectors_vf - 1) * vf->vf_id) +
		     (vector_id - 1));
320 321 322 323 324 325 326

	if (vecmap->rxq_map == 0 && vecmap->txq_map == 0) {
		/* Special case - No queues mapped on this vector */
		wr32(hw, reg_idx, I40E_VPINT_LNKLST0_FIRSTQ_INDX_MASK);
		goto irq_list_done;
	}
	tempmap = vecmap->rxq_map;
327
	for_each_set_bit(vsi_queue_id, &tempmap, I40E_MAX_VSI_QP) {
328 329
		linklistmap |= (BIT(I40E_VIRTCHNL_SUPPORTED_QTYPES *
				    vsi_queue_id));
330 331 332
	}

	tempmap = vecmap->txq_map;
333
	for_each_set_bit(vsi_queue_id, &tempmap, I40E_MAX_VSI_QP) {
334 335
		linklistmap |= (BIT(I40E_VIRTCHNL_SUPPORTED_QTYPES *
				     vsi_queue_id + 1));
336 337
	}

338 339 340
	size = I40E_MAX_VSI_QP * I40E_VIRTCHNL_SUPPORTED_QTYPES;
	next_q = find_first_bit(&linklistmap, size);
	if (unlikely(next_q == size))
341 342
		goto irq_list_done;

M
Mitch Williams 已提交
343 344
	vsi_queue_id = next_q / I40E_VIRTCHNL_SUPPORTED_QTYPES;
	qtype = next_q % I40E_VIRTCHNL_SUPPORTED_QTYPES;
345
	pf_queue_id = i40e_get_real_pf_qid(vf, vsi_id, vsi_queue_id);
346 347 348 349
	reg = ((qtype << I40E_VPINT_LNKLSTN_FIRSTQ_TYPE_SHIFT) | pf_queue_id);

	wr32(hw, reg_idx, reg);

350
	while (next_q < size) {
351 352 353 354 355 356 357 358 359 360 361 362 363
		switch (qtype) {
		case I40E_QUEUE_TYPE_RX:
			reg_idx = I40E_QINT_RQCTL(pf_queue_id);
			itr_idx = vecmap->rxitr_idx;
			break;
		case I40E_QUEUE_TYPE_TX:
			reg_idx = I40E_QINT_TQCTL(pf_queue_id);
			itr_idx = vecmap->txitr_idx;
			break;
		default:
			break;
		}

364 365
		next_q = find_next_bit(&linklistmap, size, next_q + 1);
		if (next_q < size) {
366 367
			vsi_queue_id = next_q / I40E_VIRTCHNL_SUPPORTED_QTYPES;
			qtype = next_q % I40E_VIRTCHNL_SUPPORTED_QTYPES;
368 369 370
			pf_queue_id = i40e_get_real_pf_qid(vf,
							   vsi_id,
							   vsi_queue_id);
371 372 373 374 375 376 377 378 379
		} else {
			pf_queue_id = I40E_QUEUE_END_OF_LIST;
			qtype = 0;
		}

		/* format for the RQCTL & TQCTL regs is same */
		reg = (vector_id) |
		    (qtype << I40E_QINT_RQCTL_NEXTQ_TYPE_SHIFT) |
		    (pf_queue_id << I40E_QINT_RQCTL_NEXTQ_INDX_SHIFT) |
380
		    BIT(I40E_QINT_RQCTL_CAUSE_ENA_SHIFT) |
381 382 383 384
		    (itr_idx << I40E_QINT_RQCTL_ITR_INDX_SHIFT);
		wr32(hw, reg_idx, reg);
	}

385 386 387
	/* if the vf is running in polling mode and using interrupt zero,
	 * need to disable auto-mask on enabling zero interrupt for VFs.
	 */
388
	if ((vf->driver_caps & VIRTCHNL_VF_OFFLOAD_RX_POLLING) &&
389 390 391 392 393 394 395 396
	    (vector_id == 0)) {
		reg = rd32(hw, I40E_GLINT_CTL);
		if (!(reg & I40E_GLINT_CTL_DIS_AUTOMASK_VF0_MASK)) {
			reg |= I40E_GLINT_CTL_DIS_AUTOMASK_VF0_MASK;
			wr32(hw, I40E_GLINT_CTL, reg);
		}
	}

397 398 399 400
irq_list_done:
	i40e_flush(hw);
}

401 402 403 404 405 406 407 408
/**
 * i40e_release_iwarp_qvlist
 * @vf: pointer to the VF.
 *
 **/
static void i40e_release_iwarp_qvlist(struct i40e_vf *vf)
{
	struct i40e_pf *pf = vf->pf;
409
	struct virtchnl_iwarp_qvlist_info *qvlist_info = vf->qvlist_info;
410 411 412 413 414 415 416 417
	u32 msix_vf;
	u32 i;

	if (!vf->qvlist_info)
		return;

	msix_vf = pf->hw.func_caps.num_msix_vectors_vf;
	for (i = 0; i < qvlist_info->num_vectors; i++) {
418
		struct virtchnl_iwarp_qv_info *qv_info;
419 420 421 422 423 424 425 426 427 428 429 430 431 432 433 434 435 436 437 438 439 440 441 442 443 444 445 446 447 448 449 450 451 452 453 454 455 456 457 458
		u32 next_q_index, next_q_type;
		struct i40e_hw *hw = &pf->hw;
		u32 v_idx, reg_idx, reg;

		qv_info = &qvlist_info->qv_info[i];
		if (!qv_info)
			continue;
		v_idx = qv_info->v_idx;
		if (qv_info->ceq_idx != I40E_QUEUE_INVALID_IDX) {
			/* Figure out the queue after CEQ and make that the
			 * first queue.
			 */
			reg_idx = (msix_vf - 1) * vf->vf_id + qv_info->ceq_idx;
			reg = rd32(hw, I40E_VPINT_CEQCTL(reg_idx));
			next_q_index = (reg & I40E_VPINT_CEQCTL_NEXTQ_INDX_MASK)
					>> I40E_VPINT_CEQCTL_NEXTQ_INDX_SHIFT;
			next_q_type = (reg & I40E_VPINT_CEQCTL_NEXTQ_TYPE_MASK)
					>> I40E_VPINT_CEQCTL_NEXTQ_TYPE_SHIFT;

			reg_idx = ((msix_vf - 1) * vf->vf_id) + (v_idx - 1);
			reg = (next_q_index &
			       I40E_VPINT_LNKLSTN_FIRSTQ_INDX_MASK) |
			       (next_q_type <<
			       I40E_VPINT_LNKLSTN_FIRSTQ_TYPE_SHIFT);

			wr32(hw, I40E_VPINT_LNKLSTN(reg_idx), reg);
		}
	}
	kfree(vf->qvlist_info);
	vf->qvlist_info = NULL;
}

/**
 * i40e_config_iwarp_qvlist
 * @vf: pointer to the VF info
 * @qvlist_info: queue and vector list
 *
 * Return 0 on success or < 0 on error
 **/
static int i40e_config_iwarp_qvlist(struct i40e_vf *vf,
459
				    struct virtchnl_iwarp_qvlist_info *qvlist_info)
460 461 462
{
	struct i40e_pf *pf = vf->pf;
	struct i40e_hw *hw = &pf->hw;
463
	struct virtchnl_iwarp_qv_info *qv_info;
464 465 466 467
	u32 v_idx, i, reg_idx, reg;
	u32 next_q_idx, next_q_type;
	u32 msix_vf, size;

468 469
	size = sizeof(struct virtchnl_iwarp_qvlist_info) +
	       (sizeof(struct virtchnl_iwarp_qv_info) *
470 471
						(qvlist_info->num_vectors - 1));
	vf->qvlist_info = kzalloc(size, GFP_KERNEL);
472 473 474
	if (!vf->qvlist_info)
		return -ENOMEM;

475 476 477 478 479 480 481 482 483 484 485 486 487 488 489 490 491 492 493 494 495 496 497 498 499 500 501 502 503 504 505 506 507 508 509 510 511 512 513 514 515 516 517 518 519 520 521 522 523 524 525 526 527 528 529 530 531 532 533
	vf->qvlist_info->num_vectors = qvlist_info->num_vectors;

	msix_vf = pf->hw.func_caps.num_msix_vectors_vf;
	for (i = 0; i < qvlist_info->num_vectors; i++) {
		qv_info = &qvlist_info->qv_info[i];
		if (!qv_info)
			continue;
		v_idx = qv_info->v_idx;

		/* Validate vector id belongs to this vf */
		if (!i40e_vc_isvalid_vector_id(vf, v_idx))
			goto err;

		vf->qvlist_info->qv_info[i] = *qv_info;

		reg_idx = ((msix_vf - 1) * vf->vf_id) + (v_idx - 1);
		/* We might be sharing the interrupt, so get the first queue
		 * index and type, push it down the list by adding the new
		 * queue on top. Also link it with the new queue in CEQCTL.
		 */
		reg = rd32(hw, I40E_VPINT_LNKLSTN(reg_idx));
		next_q_idx = ((reg & I40E_VPINT_LNKLSTN_FIRSTQ_INDX_MASK) >>
				I40E_VPINT_LNKLSTN_FIRSTQ_INDX_SHIFT);
		next_q_type = ((reg & I40E_VPINT_LNKLSTN_FIRSTQ_TYPE_MASK) >>
				I40E_VPINT_LNKLSTN_FIRSTQ_TYPE_SHIFT);

		if (qv_info->ceq_idx != I40E_QUEUE_INVALID_IDX) {
			reg_idx = (msix_vf - 1) * vf->vf_id + qv_info->ceq_idx;
			reg = (I40E_VPINT_CEQCTL_CAUSE_ENA_MASK |
			(v_idx << I40E_VPINT_CEQCTL_MSIX_INDX_SHIFT) |
			(qv_info->itr_idx << I40E_VPINT_CEQCTL_ITR_INDX_SHIFT) |
			(next_q_type << I40E_VPINT_CEQCTL_NEXTQ_TYPE_SHIFT) |
			(next_q_idx << I40E_VPINT_CEQCTL_NEXTQ_INDX_SHIFT));
			wr32(hw, I40E_VPINT_CEQCTL(reg_idx), reg);

			reg_idx = ((msix_vf - 1) * vf->vf_id) + (v_idx - 1);
			reg = (qv_info->ceq_idx &
			       I40E_VPINT_LNKLSTN_FIRSTQ_INDX_MASK) |
			       (I40E_QUEUE_TYPE_PE_CEQ <<
			       I40E_VPINT_LNKLSTN_FIRSTQ_TYPE_SHIFT);
			wr32(hw, I40E_VPINT_LNKLSTN(reg_idx), reg);
		}

		if (qv_info->aeq_idx != I40E_QUEUE_INVALID_IDX) {
			reg = (I40E_VPINT_AEQCTL_CAUSE_ENA_MASK |
			(v_idx << I40E_VPINT_AEQCTL_MSIX_INDX_SHIFT) |
			(qv_info->itr_idx << I40E_VPINT_AEQCTL_ITR_INDX_SHIFT));

			wr32(hw, I40E_VPINT_AEQCTL(vf->vf_id), reg);
		}
	}

	return 0;
err:
	kfree(vf->qvlist_info);
	vf->qvlist_info = NULL;
	return -EINVAL;
}

534 535
/**
 * i40e_config_vsi_tx_queue
536
 * @vf: pointer to the VF info
537
 * @vsi_id: id of VSI as provided by the FW
538 539 540 541 542
 * @vsi_queue_id: vsi relative queue index
 * @info: config. info
 *
 * configure tx queue
 **/
543
static int i40e_config_vsi_tx_queue(struct i40e_vf *vf, u16 vsi_id,
544
				    u16 vsi_queue_id,
545
				    struct virtchnl_txq_info *info)
546 547 548 549
{
	struct i40e_pf *pf = vf->pf;
	struct i40e_hw *hw = &pf->hw;
	struct i40e_hmc_obj_txq tx_ctx;
550
	struct i40e_vsi *vsi;
551 552 553 554
	u16 pf_queue_id;
	u32 qtx_ctl;
	int ret = 0;

C
Carolyn Wyborny 已提交
555 556 557 558
	if (!i40e_vc_isvalid_vsi_id(vf, info->vsi_id)) {
		ret = -ENOENT;
		goto error_context;
	}
559 560
	pf_queue_id = i40e_vc_get_pf_queue_id(vf, vsi_id, vsi_queue_id);
	vsi = i40e_find_vsi_from_id(pf, vsi_id);
C
Carolyn Wyborny 已提交
561 562 563 564
	if (!vsi) {
		ret = -ENOENT;
		goto error_context;
	}
565 566 567 568 569 570 571

	/* clear the context structure first */
	memset(&tx_ctx, 0, sizeof(struct i40e_hmc_obj_txq));

	/* only set the required fields */
	tx_ctx.base = info->dma_ring_addr / 128;
	tx_ctx.qlen = info->ring_len;
572
	tx_ctx.rdylist = le16_to_cpu(vsi->info.qs_handle[0]);
573
	tx_ctx.rdylist_act = 0;
574 575
	tx_ctx.head_wb_ena = info->headwb_enabled;
	tx_ctx.head_wb_addr = info->dma_headwb_addr;
576 577 578 579 580 581 582 583 584 585 586 587 588 589 590 591 592 593 594 595 596 597 598

	/* clear the context in the HMC */
	ret = i40e_clear_lan_tx_queue_context(hw, pf_queue_id);
	if (ret) {
		dev_err(&pf->pdev->dev,
			"Failed to clear VF LAN Tx queue context %d, error: %d\n",
			pf_queue_id, ret);
		ret = -ENOENT;
		goto error_context;
	}

	/* set the context in the HMC */
	ret = i40e_set_lan_tx_queue_context(hw, pf_queue_id, &tx_ctx);
	if (ret) {
		dev_err(&pf->pdev->dev,
			"Failed to set VF LAN Tx queue context %d error: %d\n",
			pf_queue_id, ret);
		ret = -ENOENT;
		goto error_context;
	}

	/* associate this queue with the PCI VF function */
	qtx_ctl = I40E_QTX_CTL_VF_QUEUE;
599
	qtx_ctl |= ((hw->pf_id << I40E_QTX_CTL_PF_INDX_SHIFT)
600 601 602 603 604 605 606 607 608 609 610 611 612
		    & I40E_QTX_CTL_PF_INDX_MASK);
	qtx_ctl |= (((vf->vf_id + hw->func_caps.vf_base_id)
		     << I40E_QTX_CTL_VFVM_INDX_SHIFT)
		    & I40E_QTX_CTL_VFVM_INDX_MASK);
	wr32(hw, I40E_QTX_CTL(pf_queue_id), qtx_ctl);
	i40e_flush(hw);

error_context:
	return ret;
}

/**
 * i40e_config_vsi_rx_queue
613
 * @vf: pointer to the VF info
614
 * @vsi_id: id of VSI  as provided by the FW
615 616 617 618 619
 * @vsi_queue_id: vsi relative queue index
 * @info: config. info
 *
 * configure rx queue
 **/
620
static int i40e_config_vsi_rx_queue(struct i40e_vf *vf, u16 vsi_id,
621
				    u16 vsi_queue_id,
622
				    struct virtchnl_rxq_info *info)
623 624 625 626 627 628 629
{
	struct i40e_pf *pf = vf->pf;
	struct i40e_hw *hw = &pf->hw;
	struct i40e_hmc_obj_rxq rx_ctx;
	u16 pf_queue_id;
	int ret = 0;

630
	pf_queue_id = i40e_vc_get_pf_queue_id(vf, vsi_id, vsi_queue_id);
631 632 633 634 635 636 637 638 639 640 641 642 643 644 645 646 647 648 649 650

	/* clear the context structure first */
	memset(&rx_ctx, 0, sizeof(struct i40e_hmc_obj_rxq));

	/* only set the required fields */
	rx_ctx.base = info->dma_ring_addr / 128;
	rx_ctx.qlen = info->ring_len;

	if (info->splithdr_enabled) {
		rx_ctx.hsplit_0 = I40E_RX_SPLIT_L2      |
				  I40E_RX_SPLIT_IP      |
				  I40E_RX_SPLIT_TCP_UDP |
				  I40E_RX_SPLIT_SCTP;
		/* header length validation */
		if (info->hdr_size > ((2 * 1024) - 64)) {
			ret = -EINVAL;
			goto error_param;
		}
		rx_ctx.hbuff = info->hdr_size >> I40E_RXQ_CTX_HBUFF_SHIFT;

651
		/* set split mode 10b */
M
Mitch Williams 已提交
652
		rx_ctx.dtype = I40E_RX_DTYPE_HEADER_SPLIT;
653 654 655 656 657 658 659 660 661 662 663 664 665 666 667 668 669 670 671 672
	}

	/* databuffer length validation */
	if (info->databuffer_size > ((16 * 1024) - 128)) {
		ret = -EINVAL;
		goto error_param;
	}
	rx_ctx.dbuff = info->databuffer_size >> I40E_RXQ_CTX_DBUFF_SHIFT;

	/* max pkt. length validation */
	if (info->max_pkt_size >= (16 * 1024) || info->max_pkt_size < 64) {
		ret = -EINVAL;
		goto error_param;
	}
	rx_ctx.rxmax = info->max_pkt_size;

	/* enable 32bytes desc always */
	rx_ctx.dsize = 1;

	/* default values */
J
Jacob Keller 已提交
673
	rx_ctx.lrxqthresh = 1;
674
	rx_ctx.crcstrip = 1;
675
	rx_ctx.prefena = 1;
676
	rx_ctx.l2tsel = 1;
677 678 679 680 681 682 683 684 685 686 687 688 689 690 691 692 693 694 695 696 697 698 699 700 701 702 703

	/* clear the context in the HMC */
	ret = i40e_clear_lan_rx_queue_context(hw, pf_queue_id);
	if (ret) {
		dev_err(&pf->pdev->dev,
			"Failed to clear VF LAN Rx queue context %d, error: %d\n",
			pf_queue_id, ret);
		ret = -ENOENT;
		goto error_param;
	}

	/* set the context in the HMC */
	ret = i40e_set_lan_rx_queue_context(hw, pf_queue_id, &rx_ctx);
	if (ret) {
		dev_err(&pf->pdev->dev,
			"Failed to set VF LAN Rx queue context %d error: %d\n",
			pf_queue_id, ret);
		ret = -ENOENT;
		goto error_param;
	}

error_param:
	return ret;
}

/**
 * i40e_alloc_vsi_res
704
 * @vf: pointer to the VF info
705
 * @idx: VSI index, applies only for ADq mode, zero otherwise
706
 *
707
 * alloc VF vsi context & resources
708
 **/
709
static int i40e_alloc_vsi_res(struct i40e_vf *vf, u8 idx)
710 711 712 713
{
	struct i40e_mac_filter *f = NULL;
	struct i40e_pf *pf = vf->pf;
	struct i40e_vsi *vsi;
714
	u64 max_tx_rate = 0;
715 716
	int ret = 0;

717 718
	vsi = i40e_vsi_setup(pf, I40E_VSI_SRIOV, pf->vsi[pf->lan_vsi]->seid,
			     vf->vf_id);
719 720 721

	if (!vsi) {
		dev_err(&pf->pdev->dev,
722
			"add vsi failed for VF %d, aq_err %d\n",
723 724 725 726
			vf->vf_id, pf->hw.aq.asq_last_status);
		ret = -ENOENT;
		goto error_alloc_vsi_res;
	}
727 728

	if (!idx) {
M
Mitch Williams 已提交
729
		u64 hena = i40e_pf_get_default_rss_hena(pf);
730
		u8 broadcast[ETH_ALEN];
M
Mitch Williams 已提交
731

732
		vf->lan_vsi_idx = vsi->idx;
733
		vf->lan_vsi_id = vsi->id;
G
Greg Rose 已提交
734 735 736 737 738 739 740 741
		/* If the port VLAN has been configured and then the
		 * VF driver was removed then the VSI port VLAN
		 * configuration was destroyed.  Check if there is
		 * a port VLAN and restore the VSI configuration if
		 * needed.
		 */
		if (vf->port_vlan_id)
			i40e_vsi_add_pvid(vsi, vf->port_vlan_id);
K
Kiran Patil 已提交
742

743
		spin_lock_bh(&vsi->mac_filter_hash_lock);
M
Mitch Williams 已提交
744
		if (is_valid_ether_addr(vf->default_lan_addr.addr)) {
745 746
			f = i40e_add_mac_filter(vsi,
						vf->default_lan_addr.addr);
M
Mitch Williams 已提交
747 748 749 750 751
			if (!f)
				dev_info(&pf->pdev->dev,
					 "Could not add MAC filter %pM for VF %d\n",
					vf->default_lan_addr.addr, vf->vf_id);
		}
752
		eth_broadcast_addr(broadcast);
753
		f = i40e_add_mac_filter(vsi, broadcast);
754 755 756
		if (!f)
			dev_info(&pf->pdev->dev,
				 "Could not allocate VF broadcast filter\n");
757
		spin_unlock_bh(&vsi->mac_filter_hash_lock);
758 759
		wr32(&pf->hw, I40E_VFQF_HENA1(0, vf->vf_id), (u32)hena);
		wr32(&pf->hw, I40E_VFQF_HENA1(1, vf->vf_id), (u32)(hena >> 32));
760 761 762 763
		/* program mac filter only for VF VSI */
		ret = i40e_sync_vsi_filters(vsi);
		if (ret)
			dev_err(&pf->pdev->dev, "Unable to program ucast filters\n");
764
	}
765

766 767 768 769 770
	/* storing VSI index and id for ADq and don't apply the mac filter */
	if (vf->adq_enabled) {
		vf->ch[idx].vsi_idx = vsi->idx;
		vf->ch[idx].vsi_id = vsi->id;
	}
771

772 773
	/* Set VF bandwidth if specified */
	if (vf->tx_rate) {
774 775 776 777 778 779 780
		max_tx_rate = vf->tx_rate;
	} else if (vf->ch[idx].max_tx_rate) {
		max_tx_rate = vf->ch[idx].max_tx_rate;
	}

	if (max_tx_rate) {
		max_tx_rate = div_u64(max_tx_rate, I40E_BW_CREDIT_DIVISOR);
781
		ret = i40e_aq_config_vsi_bw_limit(&pf->hw, vsi->seid,
782
						  max_tx_rate, 0, NULL);
783 784 785 786 787
		if (ret)
			dev_err(&pf->pdev->dev, "Unable to set tx rate, VF %d, error code %d.\n",
				vf->vf_id, ret);
	}

788 789 790 791
error_alloc_vsi_res:
	return ret;
}

792 793 794 795 796 797 798 799 800 801 802 803 804 805 806 807 808 809 810 811 812 813 814 815 816 817 818 819 820 821 822 823 824 825 826 827 828 829 830 831 832 833 834 835 836 837 838 839 840 841 842 843 844 845 846 847 848 849 850 851 852 853 854 855 856 857 858 859 860 861 862 863 864 865 866 867 868 869 870 871 872 873 874 875 876 877
/**
 * i40e_map_pf_queues_to_vsi
 * @vf: pointer to the VF info
 *
 * PF maps LQPs to a VF by programming VSILAN_QTABLE & VPLAN_QTABLE. This
 * function takes care of first part VSILAN_QTABLE, mapping pf queues to VSI.
 **/
static void i40e_map_pf_queues_to_vsi(struct i40e_vf *vf)
{
	struct i40e_pf *pf = vf->pf;
	struct i40e_hw *hw = &pf->hw;
	u32 reg, num_tc = 1; /* VF has at least one traffic class */
	u16 vsi_id, qps;
	int i, j;

	if (vf->adq_enabled)
		num_tc = vf->num_tc;

	for (i = 0; i < num_tc; i++) {
		if (vf->adq_enabled) {
			qps = vf->ch[i].num_qps;
			vsi_id =  vf->ch[i].vsi_id;
		} else {
			qps = pf->vsi[vf->lan_vsi_idx]->alloc_queue_pairs;
			vsi_id = vf->lan_vsi_id;
		}

		for (j = 0; j < 7; j++) {
			if (j * 2 >= qps) {
				/* end of list */
				reg = 0x07FF07FF;
			} else {
				u16 qid = i40e_vc_get_pf_queue_id(vf,
								  vsi_id,
								  j * 2);
				reg = qid;
				qid = i40e_vc_get_pf_queue_id(vf, vsi_id,
							      (j * 2) + 1);
				reg |= qid << 16;
			}
			i40e_write_rx_ctl(hw,
					  I40E_VSILAN_QTABLE(j, vsi_id),
					  reg);
		}
	}
}

/**
 * i40e_map_pf_to_vf_queues
 * @vf: pointer to the VF info
 *
 * PF maps LQPs to a VF by programming VSILAN_QTABLE & VPLAN_QTABLE. This
 * function takes care of the second part VPLAN_QTABLE & completes VF mappings.
 **/
static void i40e_map_pf_to_vf_queues(struct i40e_vf *vf)
{
	struct i40e_pf *pf = vf->pf;
	struct i40e_hw *hw = &pf->hw;
	u32 reg, total_qps = 0;
	u32 qps, num_tc = 1; /* VF has at least one traffic class */
	u16 vsi_id, qid;
	int i, j;

	if (vf->adq_enabled)
		num_tc = vf->num_tc;

	for (i = 0; i < num_tc; i++) {
		if (vf->adq_enabled) {
			qps = vf->ch[i].num_qps;
			vsi_id =  vf->ch[i].vsi_id;
		} else {
			qps = pf->vsi[vf->lan_vsi_idx]->alloc_queue_pairs;
			vsi_id = vf->lan_vsi_id;
		}

		for (j = 0; j < qps; j++) {
			qid = i40e_vc_get_pf_queue_id(vf, vsi_id, j);

			reg = (qid & I40E_VPLAN_QTABLE_QINDEX_MASK);
			wr32(hw, I40E_VPLAN_QTABLE(total_qps, vf->vf_id),
			     reg);
			total_qps++;
		}
	}
}

M
Mitch Williams 已提交
878 879
/**
 * i40e_enable_vf_mappings
880
 * @vf: pointer to the VF info
M
Mitch Williams 已提交
881
 *
882
 * enable VF mappings
M
Mitch Williams 已提交
883 884 885 886 887
 **/
static void i40e_enable_vf_mappings(struct i40e_vf *vf)
{
	struct i40e_pf *pf = vf->pf;
	struct i40e_hw *hw = &pf->hw;
888
	u32 reg;
M
Mitch Williams 已提交
889 890 891 892 893

	/* Tell the hardware we're using noncontiguous mapping. HW requires
	 * that VF queues be mapped using this method, even when they are
	 * contiguous in real life
	 */
894 895
	i40e_write_rx_ctl(hw, I40E_VSILAN_QBASE(vf->lan_vsi_id),
			  I40E_VSILAN_QBASE_VSIQTABLE_ENA_MASK);
M
Mitch Williams 已提交
896 897 898 899 900

	/* enable VF vplan_qtable mappings */
	reg = I40E_VPLAN_MAPENA_TXRX_ENA_MASK;
	wr32(hw, I40E_VPLAN_MAPENA(vf->vf_id), reg);

901 902
	i40e_map_pf_to_vf_queues(vf);
	i40e_map_pf_queues_to_vsi(vf);
M
Mitch Williams 已提交
903 904 905 906 907 908

	i40e_flush(hw);
}

/**
 * i40e_disable_vf_mappings
909
 * @vf: pointer to the VF info
M
Mitch Williams 已提交
910
 *
911
 * disable VF mappings
M
Mitch Williams 已提交
912 913 914 915 916 917 918 919 920 921 922 923 924 925 926 927 928
 **/
static void i40e_disable_vf_mappings(struct i40e_vf *vf)
{
	struct i40e_pf *pf = vf->pf;
	struct i40e_hw *hw = &pf->hw;
	int i;

	/* disable qp mappings */
	wr32(hw, I40E_VPLAN_MAPENA(vf->vf_id), 0);
	for (i = 0; i < I40E_MAX_VSI_QP; i++)
		wr32(hw, I40E_VPLAN_QTABLE(i, vf->vf_id),
		     I40E_QUEUE_END_OF_LIST);
	i40e_flush(hw);
}

/**
 * i40e_free_vf_res
929
 * @vf: pointer to the VF info
M
Mitch Williams 已提交
930
 *
931
 * free VF resources
M
Mitch Williams 已提交
932 933 934 935
 **/
static void i40e_free_vf_res(struct i40e_vf *vf)
{
	struct i40e_pf *pf = vf->pf;
M
Mitch Williams 已提交
936 937
	struct i40e_hw *hw = &pf->hw;
	u32 reg_idx, reg;
938
	int i, j, msix_vf;
M
Mitch Williams 已提交
939

940 941 942
	/* Start by disabling VF's configuration API to prevent the OS from
	 * accessing the VF's VSI after it's freed / invalidated.
	 */
943
	clear_bit(I40E_VF_STATE_INIT, &vf->vf_states);
944

945 946 947 948 949 950 951 952
	/* It's possible the VF had requeuested more queues than the default so
	 * do the accounting here when we're about to free them.
	 */
	if (vf->num_queue_pairs > I40E_DEFAULT_QUEUES_PER_VF) {
		pf->queues_left += vf->num_queue_pairs -
				   I40E_DEFAULT_QUEUES_PER_VF;
	}

M
Mitch Williams 已提交
953
	/* free vsi & disconnect it from the parent uplink */
954 955 956
	if (vf->lan_vsi_idx) {
		i40e_vsi_release(pf->vsi[vf->lan_vsi_idx]);
		vf->lan_vsi_idx = 0;
M
Mitch Williams 已提交
957
		vf->lan_vsi_id = 0;
958
		vf->num_mac = 0;
M
Mitch Williams 已提交
959
	}
960 961 962 963 964 965 966 967 968 969 970 971 972 973

	/* do the accounting and remove additional ADq VSI's */
	if (vf->adq_enabled && vf->ch[0].vsi_idx) {
		for (j = 0; j < vf->num_tc; j++) {
			/* At this point VSI0 is already released so don't
			 * release it again and only clear their values in
			 * structure variables
			 */
			if (j)
				i40e_vsi_release(pf->vsi[vf->ch[j].vsi_idx]);
			vf->ch[j].vsi_idx = 0;
			vf->ch[j].vsi_id = 0;
		}
	}
974 975
	msix_vf = pf->hw.func_caps.num_msix_vectors_vf;

M
Mitch Williams 已提交
976 977 978 979 980 981 982 983 984 985 986 987
	/* disable interrupts so the VF starts in a known state */
	for (i = 0; i < msix_vf; i++) {
		/* format is same for both registers */
		if (0 == i)
			reg_idx = I40E_VFINT_DYN_CTL0(vf->vf_id);
		else
			reg_idx = I40E_VFINT_DYN_CTLN(((msix_vf - 1) *
						      (vf->vf_id))
						     + (i - 1));
		wr32(hw, reg_idx, I40E_VFINT_DYN_CTLN_CLEARPBA_MASK);
		i40e_flush(hw);
	}
M
Mitch Williams 已提交
988

M
Mitch Williams 已提交
989 990 991 992 993 994 995 996 997 998 999 1000 1001 1002
	/* clear the irq settings */
	for (i = 0; i < msix_vf; i++) {
		/* format is same for both registers */
		if (0 == i)
			reg_idx = I40E_VPINT_LNKLST0(vf->vf_id);
		else
			reg_idx = I40E_VPINT_LNKLSTN(((msix_vf - 1) *
						      (vf->vf_id))
						     + (i - 1));
		reg = (I40E_VPINT_LNKLSTN_FIRSTQ_TYPE_MASK |
		       I40E_VPINT_LNKLSTN_FIRSTQ_INDX_MASK);
		wr32(hw, reg_idx, reg);
		i40e_flush(hw);
	}
1003
	/* reset some of the state variables keeping track of the resources */
M
Mitch Williams 已提交
1004
	vf->num_queue_pairs = 0;
1005 1006
	clear_bit(I40E_VF_STATE_MC_PROMISC, &vf->vf_states);
	clear_bit(I40E_VF_STATE_UC_PROMISC, &vf->vf_states);
M
Mitch Williams 已提交
1007 1008 1009 1010
}

/**
 * i40e_alloc_vf_res
1011
 * @vf: pointer to the VF info
M
Mitch Williams 已提交
1012
 *
1013
 * allocate VF resources
M
Mitch Williams 已提交
1014 1015 1016 1017 1018
 **/
static int i40e_alloc_vf_res(struct i40e_vf *vf)
{
	struct i40e_pf *pf = vf->pf;
	int total_queue_pairs = 0;
1019
	int ret, idx;
M
Mitch Williams 已提交
1020

1021 1022 1023 1024 1025 1026
	if (vf->num_req_queues &&
	    vf->num_req_queues <= pf->queues_left + I40E_DEFAULT_QUEUES_PER_VF)
		pf->num_vf_qps = vf->num_req_queues;
	else
		pf->num_vf_qps = I40E_DEFAULT_QUEUES_PER_VF;

M
Mitch Williams 已提交
1027
	/* allocate hw vsi context & associated resources */
1028
	ret = i40e_alloc_vsi_res(vf, 0);
M
Mitch Williams 已提交
1029 1030
	if (ret)
		goto error_alloc;
1031
	total_queue_pairs += pf->vsi[vf->lan_vsi_idx]->alloc_queue_pairs;
1032

1033 1034 1035 1036 1037 1038 1039 1040 1041 1042 1043 1044 1045 1046 1047 1048 1049 1050 1051
	/* allocate additional VSIs based on tc information for ADq */
	if (vf->adq_enabled) {
		if (pf->queues_left >=
		    (I40E_MAX_VF_QUEUES - I40E_DEFAULT_QUEUES_PER_VF)) {
			/* TC 0 always belongs to VF VSI */
			for (idx = 1; idx < vf->num_tc; idx++) {
				ret = i40e_alloc_vsi_res(vf, idx);
				if (ret)
					goto error_alloc;
			}
			/* send correct number of queues */
			total_queue_pairs = I40E_MAX_VF_QUEUES;
		} else {
			dev_info(&pf->pdev->dev, "VF %d: Not enough queues to allocate, disabling ADq\n",
				 vf->vf_id);
			vf->adq_enabled = false;
		}
	}

1052 1053 1054 1055 1056 1057 1058 1059 1060
	/* We account for each VF to get a default number of queue pairs.  If
	 * the VF has now requested more, we need to account for that to make
	 * certain we never request more queues than we actually have left in
	 * HW.
	 */
	if (total_queue_pairs > I40E_DEFAULT_QUEUES_PER_VF)
		pf->queues_left -=
			total_queue_pairs - I40E_DEFAULT_QUEUES_PER_VF;

1061 1062 1063 1064
	if (vf->trusted)
		set_bit(I40E_VIRTCHNL_VF_CAP_PRIVILEGE, &vf->vf_caps);
	else
		clear_bit(I40E_VIRTCHNL_VF_CAP_PRIVILEGE, &vf->vf_caps);
M
Mitch Williams 已提交
1065 1066

	/* store the total qps number for the runtime
1067
	 * VF req validation
M
Mitch Williams 已提交
1068 1069 1070
	 */
	vf->num_queue_pairs = total_queue_pairs;

1071
	/* VF is now completely initialized */
1072
	set_bit(I40E_VF_STATE_INIT, &vf->vf_states);
M
Mitch Williams 已提交
1073 1074 1075 1076 1077 1078 1079 1080

error_alloc:
	if (ret)
		i40e_free_vf_res(vf);

	return ret;
}

M
Mitch Williams 已提交
1081 1082 1083 1084
#define VF_DEVICE_STATUS 0xAA
#define VF_TRANS_PENDING_MASK 0x20
/**
 * i40e_quiesce_vf_pci
1085
 * @vf: pointer to the VF structure
M
Mitch Williams 已提交
1086 1087 1088 1089 1090 1091 1092 1093 1094 1095 1096
 *
 * Wait for VF PCI transactions to be cleared after reset. Returns -EIO
 * if the transactions never clear.
 **/
static int i40e_quiesce_vf_pci(struct i40e_vf *vf)
{
	struct i40e_pf *pf = vf->pf;
	struct i40e_hw *hw = &pf->hw;
	int vf_abs_id, i;
	u32 reg;

1097
	vf_abs_id = vf->vf_id + hw->func_caps.vf_base_id;
M
Mitch Williams 已提交
1098 1099 1100 1101 1102 1103 1104 1105 1106 1107 1108 1109

	wr32(hw, I40E_PF_PCI_CIAA,
	     VF_DEVICE_STATUS | (vf_abs_id << I40E_PF_PCI_CIAA_VF_NUM_SHIFT));
	for (i = 0; i < 100; i++) {
		reg = rd32(hw, I40E_PF_PCI_CIAD);
		if ((reg & VF_TRANS_PENDING_MASK) == 0)
			return 0;
		udelay(1);
	}
	return -EIO;
}

1110
/**
1111
 * i40e_trigger_vf_reset
1112
 * @vf: pointer to the VF structure
1113 1114
 * @flr: VFLR was issued or not
 *
1115 1116 1117
 * Trigger hardware to start a reset for a particular VF. Expects the caller
 * to wait the proper amount of time to allow hardware to reset the VF before
 * it cleans up and restores VF functionality.
1118
 **/
1119
static void i40e_trigger_vf_reset(struct i40e_vf *vf, bool flr)
1120 1121 1122
{
	struct i40e_pf *pf = vf->pf;
	struct i40e_hw *hw = &pf->hw;
1123
	u32 reg, reg_idx, bit_idx;
1124

1125
	/* warn the VF */
1126
	clear_bit(I40E_VF_STATE_ACTIVE, &vf->vf_states);
1127

1128 1129 1130 1131 1132 1133
	/* Disable VF's configuration API during reset. The flag is re-enabled
	 * in i40e_alloc_vf_res(), when it's safe again to access VF's VSI.
	 * It's normally disabled in i40e_free_vf_res(), but it's safer
	 * to do it earlier to give some time to finish to any VF config
	 * functions that may still be running at this point.
	 */
1134
	clear_bit(I40E_VF_STATE_INIT, &vf->vf_states);
1135

M
Mitch Williams 已提交
1136 1137
	/* In the case of a VFLR, the HW has already reset the VF and we
	 * just need to clean up, so don't hit the VFRTRIG register.
1138 1139
	 */
	if (!flr) {
1140
		/* reset VF using VPGEN_VFRTRIG reg */
M
Mitch Williams 已提交
1141 1142
		reg = rd32(hw, I40E_VPGEN_VFRTRIG(vf->vf_id));
		reg |= I40E_VPGEN_VFRTRIG_VFSWR_MASK;
1143 1144 1145
		wr32(hw, I40E_VPGEN_VFRTRIG(vf->vf_id), reg);
		i40e_flush(hw);
	}
1146 1147 1148 1149
	/* clear the VFLR bit in GLGEN_VFLRSTAT */
	reg_idx = (hw->func_caps.vf_base_id + vf->vf_id) / 32;
	bit_idx = (hw->func_caps.vf_base_id + vf->vf_id) % 32;
	wr32(hw, I40E_GLGEN_VFLRSTAT(reg_idx), BIT(bit_idx));
A
Akeem G Abodunrin 已提交
1150
	i40e_flush(hw);
1151

M
Mitch Williams 已提交
1152 1153 1154
	if (i40e_quiesce_vf_pci(vf))
		dev_err(&pf->pdev->dev, "VF %d PCI transactions stuck\n",
			vf->vf_id);
1155
}
M
Mitch Williams 已提交
1156

1157 1158 1159 1160 1161 1162 1163 1164 1165 1166 1167 1168 1169
/**
 * i40e_cleanup_reset_vf
 * @vf: pointer to the VF structure
 *
 * Cleanup a VF after the hardware reset is finished. Expects the caller to
 * have verified whether the reset is finished properly, and ensure the
 * minimum amount of wait time has passed.
 **/
static void i40e_cleanup_reset_vf(struct i40e_vf *vf)
{
	struct i40e_pf *pf = vf->pf;
	struct i40e_hw *hw = &pf->hw;
	u32 reg;
M
Mitch Williams 已提交
1170

1171
	/* free VF resources to begin resetting the VSI state */
M
Mitch Williams 已提交
1172
	i40e_free_vf_res(vf);
1173 1174 1175 1176 1177 1178 1179 1180 1181 1182 1183 1184 1185 1186 1187 1188

	/* Enable hardware by clearing the reset bit in the VPGEN_VFRTRIG reg.
	 * By doing this we allow HW to access VF memory at any point. If we
	 * did it any sooner, HW could access memory while it was being freed
	 * in i40e_free_vf_res(), causing an IOMMU fault.
	 *
	 * On the other hand, this needs to be done ASAP, because the VF driver
	 * is waiting for this to happen and may report a timeout. It's
	 * harmless, but it gets logged into Guest OS kernel log, so best avoid
	 * it.
	 */
	reg = rd32(hw, I40E_VPGEN_VFRTRIG(vf->vf_id));
	reg &= ~I40E_VPGEN_VFRTRIG_VFSWR_MASK;
	wr32(hw, I40E_VPGEN_VFRTRIG(vf->vf_id), reg);

	/* reallocate VF resources to finish resetting the VSI state */
1189
	if (!i40e_alloc_vf_res(vf)) {
1190
		int abs_vf_id = vf->vf_id + hw->func_caps.vf_base_id;
1191
		i40e_enable_vf_mappings(vf);
1192 1193
		set_bit(I40E_VF_STATE_ACTIVE, &vf->vf_states);
		clear_bit(I40E_VF_STATE_DISABLED, &vf->vf_states);
1194
		/* Do not notify the client during VF init */
A
Alan Brady 已提交
1195 1196
		if (!test_and_clear_bit(I40E_VF_STATE_PRE_ENABLE,
					&vf->vf_states))
1197
			i40e_notify_client_of_vf_reset(pf, abs_vf_id);
1198
		vf->num_vlan = 0;
1199
	}
1200 1201 1202 1203 1204

	/* Tell the VF driver the reset is done. This needs to be done only
	 * after VF has been fully initialized, because the VF driver may
	 * request resources immediately after setting this flag.
	 */
1205
	wr32(hw, I40E_VFGEN_RSTAT1(vf->vf_id), VIRTCHNL_VFR_VFACTIVE);
1206 1207 1208 1209 1210 1211 1212
}

/**
 * i40e_reset_vf
 * @vf: pointer to the VF structure
 * @flr: VFLR was issued or not
 *
1213
 * Returns true if the VF is reset, false otherwise.
1214
 **/
1215
bool i40e_reset_vf(struct i40e_vf *vf, bool flr)
1216 1217 1218 1219 1220 1221 1222
{
	struct i40e_pf *pf = vf->pf;
	struct i40e_hw *hw = &pf->hw;
	bool rsd = false;
	u32 reg;
	int i;

1223 1224 1225
	/* If the VFs have been disabled, this means something else is
	 * resetting the VF, so we shouldn't continue.
	 */
1226
	if (test_and_set_bit(__I40E_VF_DISABLE, pf->state))
1227
		return false;
1228 1229 1230 1231 1232 1233 1234 1235 1236 1237 1238 1239 1240 1241 1242 1243 1244 1245 1246 1247 1248 1249 1250 1251 1252 1253 1254 1255 1256 1257 1258 1259 1260

	i40e_trigger_vf_reset(vf, flr);

	/* poll VPGEN_VFRSTAT reg to make sure
	 * that reset is complete
	 */
	for (i = 0; i < 10; i++) {
		/* VF reset requires driver to first reset the VF and then
		 * poll the status register to make sure that the reset
		 * completed successfully. Due to internal HW FIFO flushes,
		 * we must wait 10ms before the register will be valid.
		 */
		usleep_range(10000, 20000);
		reg = rd32(hw, I40E_VPGEN_VFRSTAT(vf->vf_id));
		if (reg & I40E_VPGEN_VFRSTAT_VFRD_MASK) {
			rsd = true;
			break;
		}
	}

	if (flr)
		usleep_range(10000, 20000);

	if (!rsd)
		dev_err(&pf->pdev->dev, "VF reset check timeout on VF %d\n",
			vf->vf_id);
	usleep_range(10000, 20000);

	/* On initial reset, we don't have any queues to disable */
	if (vf->lan_vsi_idx != 0)
		i40e_vsi_stop_rings(pf->vsi[vf->lan_vsi_idx]);

	i40e_cleanup_reset_vf(vf);
1261

1262
	i40e_flush(hw);
1263
	clear_bit(__I40E_VF_DISABLE, pf->state);
1264 1265

	return true;
1266
}
1267

1268 1269 1270 1271 1272 1273 1274 1275 1276
/**
 * i40e_reset_all_vfs
 * @pf: pointer to the PF structure
 * @flr: VFLR was issued or not
 *
 * Reset all allocated VFs in one go. First, tell the hardware to reset each
 * VF, then do all the waiting in one chunk, and finally finish restoring each
 * VF after the wait. This is useful during PF routines which need to reset
 * all VFs, as otherwise it must perform these resets in a serialized fashion.
1277 1278
 *
 * Returns true if any VFs were reset, and false otherwise.
1279
 **/
1280
bool i40e_reset_all_vfs(struct i40e_pf *pf, bool flr)
1281 1282 1283 1284 1285 1286 1287 1288
{
	struct i40e_hw *hw = &pf->hw;
	struct i40e_vf *vf;
	int i, v;
	u32 reg;

	/* If we don't have any VFs, then there is nothing to reset */
	if (!pf->num_alloc_vfs)
1289
		return false;
1290 1291

	/* If VFs have been disabled, there is no need to reset */
1292
	if (test_and_set_bit(__I40E_VF_DISABLE, pf->state))
1293
		return false;
1294 1295 1296 1297 1298 1299 1300 1301 1302 1303 1304 1305 1306 1307 1308 1309 1310 1311 1312 1313 1314 1315 1316 1317 1318 1319 1320 1321 1322 1323 1324 1325 1326 1327 1328 1329 1330 1331 1332 1333 1334 1335 1336 1337 1338 1339 1340 1341 1342 1343 1344 1345 1346 1347 1348 1349 1350 1351 1352 1353 1354 1355 1356 1357 1358 1359 1360 1361 1362 1363 1364 1365 1366

	/* Begin reset on all VFs at once */
	for (v = 0; v < pf->num_alloc_vfs; v++)
		i40e_trigger_vf_reset(&pf->vf[v], flr);

	/* HW requires some time to make sure it can flush the FIFO for a VF
	 * when it resets it. Poll the VPGEN_VFRSTAT register for each VF in
	 * sequence to make sure that it has completed. We'll keep track of
	 * the VFs using a simple iterator that increments once that VF has
	 * finished resetting.
	 */
	for (i = 0, v = 0; i < 10 && v < pf->num_alloc_vfs; i++) {
		usleep_range(10000, 20000);

		/* Check each VF in sequence, beginning with the VF to fail
		 * the previous check.
		 */
		while (v < pf->num_alloc_vfs) {
			vf = &pf->vf[v];
			reg = rd32(hw, I40E_VPGEN_VFRSTAT(vf->vf_id));
			if (!(reg & I40E_VPGEN_VFRSTAT_VFRD_MASK))
				break;

			/* If the current VF has finished resetting, move on
			 * to the next VF in sequence.
			 */
			v++;
		}
	}

	if (flr)
		usleep_range(10000, 20000);

	/* Display a warning if at least one VF didn't manage to reset in
	 * time, but continue on with the operation.
	 */
	if (v < pf->num_alloc_vfs)
		dev_err(&pf->pdev->dev, "VF reset check timeout on VF %d\n",
			pf->vf[v].vf_id);
	usleep_range(10000, 20000);

	/* Begin disabling all the rings associated with VFs, but do not wait
	 * between each VF.
	 */
	for (v = 0; v < pf->num_alloc_vfs; v++) {
		/* On initial reset, we don't have any queues to disable */
		if (pf->vf[v].lan_vsi_idx == 0)
			continue;

		i40e_vsi_stop_rings_no_wait(pf->vsi[pf->vf[v].lan_vsi_idx]);
	}

	/* Now that we've notified HW to disable all of the VF rings, wait
	 * until they finish.
	 */
	for (v = 0; v < pf->num_alloc_vfs; v++) {
		/* On initial reset, we don't have any queues to disable */
		if (pf->vf[v].lan_vsi_idx == 0)
			continue;

		i40e_vsi_wait_queues_disabled(pf->vsi[pf->vf[v].lan_vsi_idx]);
	}

	/* Hw may need up to 50ms to finish disabling the RX queues. We
	 * minimize the wait by delaying only once for all VFs.
	 */
	mdelay(50);

	/* Finish the reset on each VF */
	for (v = 0; v < pf->num_alloc_vfs; v++)
		i40e_cleanup_reset_vf(&pf->vf[v]);

	i40e_flush(hw);
1367
	clear_bit(__I40E_VF_DISABLE, pf->state);
1368 1369

	return true;
1370 1371
}

1372 1373
/**
 * i40e_free_vfs
1374
 * @pf: pointer to the PF structure
1375
 *
1376
 * free VF resources
1377 1378 1379
 **/
void i40e_free_vfs(struct i40e_pf *pf)
{
1380 1381 1382
	struct i40e_hw *hw = &pf->hw;
	u32 reg_idx, bit_idx;
	int i, tmp, vf_id;
1383 1384 1385

	if (!pf->vf)
		return;
1386
	while (test_and_set_bit(__I40E_VF_DISABLE, pf->state))
1387
		usleep_range(1000, 2000);
1388

1389
	i40e_notify_client_of_vf_enable(pf, 0);
1390 1391 1392 1393 1394 1395 1396 1397 1398 1399

	/* Amortize wait time by stopping all VFs at the same time */
	for (i = 0; i < pf->num_alloc_vfs; i++) {
		if (test_bit(I40E_VF_STATE_INIT, &pf->vf[i].vf_states))
			continue;

		i40e_vsi_stop_rings_no_wait(pf->vsi[pf->vf[i].lan_vsi_idx]);
	}

	for (i = 0; i < pf->num_alloc_vfs; i++) {
1400
		if (test_bit(I40E_VF_STATE_INIT, &pf->vf[i].vf_states))
1401 1402 1403 1404
			continue;

		i40e_vsi_wait_queues_disabled(pf->vsi[pf->vf[i].lan_vsi_idx]);
	}
M
Mitch Williams 已提交
1405

1406 1407 1408 1409 1410 1411
	/* Disable IOV before freeing resources. This lets any VF drivers
	 * running in the host get themselves cleaned up before we yank
	 * the carpet out from underneath their feet.
	 */
	if (!pci_vfs_assigned(pf->pdev))
		pci_disable_sriov(pf->pdev);
M
Mitch Williams 已提交
1412 1413
	else
		dev_warn(&pf->pdev->dev, "VFs are assigned - not disabling SR-IOV\n");
1414

1415
	/* free up VF resources */
1416 1417 1418
	tmp = pf->num_alloc_vfs;
	pf->num_alloc_vfs = 0;
	for (i = 0; i < tmp; i++) {
1419
		if (test_bit(I40E_VF_STATE_INIT, &pf->vf[i].vf_states))
1420 1421 1422 1423 1424 1425 1426 1427
			i40e_free_vf_res(&pf->vf[i]);
		/* disable qp mappings */
		i40e_disable_vf_mappings(&pf->vf[i]);
	}

	kfree(pf->vf);
	pf->vf = NULL;

1428 1429 1430 1431
	/* This check is for when the driver is unloaded while VFs are
	 * assigned. Setting the number of VFs to 0 through sysfs is caught
	 * before this function ever gets called.
	 */
1432
	if (!pci_vfs_assigned(pf->pdev)) {
1433 1434 1435 1436 1437 1438
		/* Acknowledge VFLR for all VFS. Without this, VFs will fail to
		 * work correctly when SR-IOV gets re-enabled.
		 */
		for (vf_id = 0; vf_id < tmp; vf_id++) {
			reg_idx = (hw->func_caps.vf_base_id + vf_id) / 32;
			bit_idx = (hw->func_caps.vf_base_id + vf_id) % 32;
1439
			wr32(hw, I40E_GLGEN_VFLRSTAT(reg_idx), BIT(bit_idx));
1440
		}
1441
	}
1442
	clear_bit(__I40E_VF_DISABLE, pf->state);
1443 1444 1445 1446 1447
}

#ifdef CONFIG_PCI_IOV
/**
 * i40e_alloc_vfs
1448 1449
 * @pf: pointer to the PF structure
 * @num_alloc_vfs: number of VFs to allocate
1450
 *
1451
 * allocate VF resources
1452
 **/
M
Mitch Williams 已提交
1453
int i40e_alloc_vfs(struct i40e_pf *pf, u16 num_alloc_vfs)
1454 1455 1456 1457
{
	struct i40e_vf *vfs;
	int i, ret = 0;

1458
	/* Disable interrupt 0 so we don't try to handle the VFLR. */
1459 1460
	i40e_irq_dynamic_disable_icr0(pf);

M
Mitch Williams 已提交
1461 1462 1463 1464
	/* Check to see if we're just allocating resources for extant VFs */
	if (pci_num_vf(pf->pdev) != num_alloc_vfs) {
		ret = pci_enable_sriov(pf->pdev, num_alloc_vfs);
		if (ret) {
1465
			pf->flags &= ~I40E_FLAG_VEB_MODE_ENABLED;
M
Mitch Williams 已提交
1466 1467 1468
			pf->num_alloc_vfs = 0;
			goto err_iov;
		}
1469 1470
	}
	/* allocate memory */
1471
	vfs = kcalloc(num_alloc_vfs, sizeof(struct i40e_vf), GFP_KERNEL);
1472 1473 1474 1475
	if (!vfs) {
		ret = -ENOMEM;
		goto err_alloc;
	}
1476
	pf->vf = vfs;
1477 1478 1479 1480 1481 1482 1483 1484 1485

	/* apply default profile */
	for (i = 0; i < num_alloc_vfs; i++) {
		vfs[i].pf = pf;
		vfs[i].parent_type = I40E_SWITCH_ELEMENT_TYPE_VEB;
		vfs[i].vf_id = i;

		/* assign default capabilities */
		set_bit(I40E_VIRTCHNL_VF_CAP_L2, &vfs[i].vf_caps);
1486
		vfs[i].spoofchk = true;
1487 1488

		set_bit(I40E_VF_STATE_PRE_ENABLE, &vfs[i].vf_states);
1489 1490 1491 1492

	}
	pf->num_alloc_vfs = num_alloc_vfs;

1493 1494 1495
	/* VF resources get allocated during reset */
	i40e_reset_all_vfs(pf, false);

1496 1497
	i40e_notify_client_of_vf_enable(pf, num_alloc_vfs);

1498 1499 1500 1501
err_alloc:
	if (ret)
		i40e_free_vfs(pf);
err_iov:
1502
	/* Re-enable interrupt 0. */
1503
	i40e_irq_dynamic_enable_icr0(pf);
1504 1505 1506 1507 1508 1509 1510
	return ret;
}

#endif
/**
 * i40e_pci_sriov_enable
 * @pdev: pointer to a pci_dev structure
1511
 * @num_vfs: number of VFs to allocate
1512 1513 1514 1515 1516 1517 1518 1519 1520 1521
 *
 * Enable or change the number of VFs
 **/
static int i40e_pci_sriov_enable(struct pci_dev *pdev, int num_vfs)
{
#ifdef CONFIG_PCI_IOV
	struct i40e_pf *pf = pci_get_drvdata(pdev);
	int pre_existing_vfs = pci_num_vf(pdev);
	int err = 0;

1522
	if (test_bit(__I40E_TESTING, pf->state)) {
1523 1524 1525 1526 1527 1528
		dev_warn(&pdev->dev,
			 "Cannot enable SR-IOV virtual functions while the device is undergoing diagnostic testing\n");
		err = -EPERM;
		goto err_out;
	}

1529 1530 1531 1532 1533 1534
	if (pre_existing_vfs && pre_existing_vfs != num_vfs)
		i40e_free_vfs(pf);
	else if (pre_existing_vfs && pre_existing_vfs == num_vfs)
		goto out;

	if (num_vfs > pf->num_req_vfs) {
1535 1536
		dev_warn(&pdev->dev, "Unable to enable %d VFs. Limited to %d VFs due to device resource constraints.\n",
			 num_vfs, pf->num_req_vfs);
1537 1538 1539 1540
		err = -EPERM;
		goto err_out;
	}

1541
	dev_info(&pdev->dev, "Allocating %d VFs.\n", num_vfs);
1542 1543 1544 1545 1546 1547 1548 1549 1550 1551 1552 1553 1554 1555 1556 1557 1558 1559
	err = i40e_alloc_vfs(pf, num_vfs);
	if (err) {
		dev_warn(&pdev->dev, "Failed to enable SR-IOV: %d\n", err);
		goto err_out;
	}

out:
	return num_vfs;

err_out:
	return err;
#endif
	return 0;
}

/**
 * i40e_pci_sriov_configure
 * @pdev: pointer to a pci_dev structure
1560
 * @num_vfs: number of VFs to allocate
1561 1562 1563 1564 1565 1566 1567 1568
 *
 * Enable or change the number of VFs. Called when the user updates the number
 * of VFs in sysfs.
 **/
int i40e_pci_sriov_configure(struct pci_dev *pdev, int num_vfs)
{
	struct i40e_pf *pf = pci_get_drvdata(pdev);

1569 1570 1571
	if (num_vfs) {
		if (!(pf->flags & I40E_FLAG_VEB_MODE_ENABLED)) {
			pf->flags |= I40E_FLAG_VEB_MODE_ENABLED;
A
Amritha Nambiar 已提交
1572
			i40e_do_reset_safe(pf, I40E_PF_RESET_FLAG);
1573
		}
1574
		return i40e_pci_sriov_enable(pdev, num_vfs);
1575
	}
1576

1577
	if (!pci_vfs_assigned(pf->pdev)) {
1578
		i40e_free_vfs(pf);
1579
		pf->flags &= ~I40E_FLAG_VEB_MODE_ENABLED;
A
Amritha Nambiar 已提交
1580
		i40e_do_reset_safe(pf, I40E_PF_RESET_FLAG);
1581 1582 1583 1584
	} else {
		dev_warn(&pdev->dev, "Unable to free VFs because some are assigned to VMs.\n");
		return -EINVAL;
	}
1585 1586 1587 1588 1589 1590 1591
	return 0;
}

/***********************virtual channel routines******************/

/**
 * i40e_vc_send_msg_to_vf
1592
 * @vf: pointer to the VF info
1593 1594 1595 1596 1597
 * @v_opcode: virtual channel opcode
 * @v_retval: virtual channel return value
 * @msg: pointer to the msg buffer
 * @msglen: msg length
 *
1598
 * send msg to VF
1599 1600 1601 1602
 **/
static int i40e_vc_send_msg_to_vf(struct i40e_vf *vf, u32 v_opcode,
				  u32 v_retval, u8 *msg, u16 msglen)
{
1603 1604 1605
	struct i40e_pf *pf;
	struct i40e_hw *hw;
	int abs_vf_id;
1606 1607
	i40e_status aq_ret;

1608 1609 1610 1611 1612 1613 1614 1615
	/* validate the request */
	if (!vf || vf->vf_id >= vf->pf->num_alloc_vfs)
		return -EINVAL;

	pf = vf->pf;
	hw = &pf->hw;
	abs_vf_id = vf->vf_id + hw->func_caps.vf_base_id;

1616 1617 1618
	/* single place to detect unsuccessful return values */
	if (v_retval) {
		vf->num_invalid_msgs++;
M
Mitch Williams 已提交
1619 1620
		dev_info(&pf->pdev->dev, "VF %d failed opcode %d, retval: %d\n",
			 vf->vf_id, v_opcode, v_retval);
1621 1622 1623 1624 1625 1626
		if (vf->num_invalid_msgs >
		    I40E_DEFAULT_NUM_INVALID_MSGS_ALLOWED) {
			dev_err(&pf->pdev->dev,
				"Number of invalid messages exceeded for VF %d\n",
				vf->vf_id);
			dev_err(&pf->pdev->dev, "Use PF Control I/F to enable the VF\n");
1627
			set_bit(I40E_VF_STATE_DISABLED, &vf->vf_states);
1628 1629 1630
		}
	} else {
		vf->num_valid_msgs++;
1631 1632
		/* reset the invalid counter, if a valid message is received. */
		vf->num_invalid_msgs = 0;
1633 1634
	}

1635
	aq_ret = i40e_aq_send_msg_to_vf(hw, abs_vf_id,	v_opcode, v_retval,
1636
					msg, msglen, NULL);
1637
	if (aq_ret) {
M
Mitch Williams 已提交
1638 1639 1640
		dev_info(&pf->pdev->dev,
			 "Unable to send the message to VF %d aq_err %d\n",
			 vf->vf_id, pf->hw.aq.asq_last_status);
1641 1642 1643 1644 1645 1646 1647 1648
		return -EIO;
	}

	return 0;
}

/**
 * i40e_vc_send_resp_to_vf
1649
 * @vf: pointer to the VF info
1650 1651 1652
 * @opcode: operation code
 * @retval: return value
 *
1653
 * send resp msg to VF
1654 1655
 **/
static int i40e_vc_send_resp_to_vf(struct i40e_vf *vf,
1656
				   enum virtchnl_ops opcode,
1657 1658 1659 1660 1661 1662 1663
				   i40e_status retval)
{
	return i40e_vc_send_msg_to_vf(vf, opcode, retval, NULL, 0);
}

/**
 * i40e_vc_get_version_msg
1664
 * @vf: pointer to the VF info
1665
 *
1666
 * called from the VF to request the API version used by the PF
1667
 **/
1668
static int i40e_vc_get_version_msg(struct i40e_vf *vf, u8 *msg)
1669
{
1670 1671
	struct virtchnl_version_info info = {
		VIRTCHNL_VERSION_MAJOR, VIRTCHNL_VERSION_MINOR
1672 1673
	};

1674
	vf->vf_ver = *(struct virtchnl_version_info *)msg;
1675
	/* VFs running the 1.0 API expect to get 1.0 back or they will cry. */
1676
	if (VF_IS_V10(&vf->vf_ver))
1677 1678
		info.minor = VIRTCHNL_VERSION_MINOR_NO_VF_CAPS;
	return i40e_vc_send_msg_to_vf(vf, VIRTCHNL_OP_VERSION,
1679
				      I40E_SUCCESS, (u8 *)&info,
1680
				      sizeof(struct virtchnl_version_info));
1681 1682
}

1683 1684 1685 1686 1687 1688 1689 1690 1691 1692 1693 1694 1695 1696 1697 1698 1699 1700 1701 1702 1703
/**
 * i40e_del_qch - delete all the additional VSIs created as a part of ADq
 * @vf: pointer to VF structure
 **/
static void i40e_del_qch(struct i40e_vf *vf)
{
	struct i40e_pf *pf = vf->pf;
	int i;

	/* first element in the array belongs to primary VF VSI and we shouldn't
	 * delete it. We should however delete the rest of the VSIs created
	 */
	for (i = 1; i < vf->num_tc; i++) {
		if (vf->ch[i].vsi_idx) {
			i40e_vsi_release(pf->vsi[vf->ch[i].vsi_idx]);
			vf->ch[i].vsi_idx = 0;
			vf->ch[i].vsi_id = 0;
		}
	}
}

1704 1705
/**
 * i40e_vc_get_vf_resources_msg
1706
 * @vf: pointer to the VF info
1707 1708 1709
 * @msg: pointer to the msg buffer
 * @msglen: msg length
 *
1710
 * called from the VF to request its resources
1711
 **/
1712
static int i40e_vc_get_vf_resources_msg(struct i40e_vf *vf, u8 *msg)
1713
{
1714
	struct virtchnl_vf_resource *vfres = NULL;
1715 1716 1717 1718
	struct i40e_pf *pf = vf->pf;
	i40e_status aq_ret = 0;
	struct i40e_vsi *vsi;
	int num_vsis = 1;
M
Mitch Williams 已提交
1719
	int len = 0;
1720 1721
	int ret;

1722
	if (!test_bit(I40E_VF_STATE_INIT, &vf->vf_states)) {
1723 1724 1725 1726
		aq_ret = I40E_ERR_PARAM;
		goto err;
	}

1727 1728
	len = (sizeof(struct virtchnl_vf_resource) +
	       sizeof(struct virtchnl_vsi_resource) * num_vsis);
1729 1730 1731 1732 1733 1734 1735

	vfres = kzalloc(len, GFP_KERNEL);
	if (!vfres) {
		aq_ret = I40E_ERR_NO_MEMORY;
		len = 0;
		goto err;
	}
1736
	if (VF_IS_V11(&vf->vf_ver))
1737 1738
		vf->driver_caps = *(u32 *)msg;
	else
1739 1740 1741
		vf->driver_caps = VIRTCHNL_VF_OFFLOAD_L2 |
				  VIRTCHNL_VF_OFFLOAD_RSS_REG |
				  VIRTCHNL_VF_OFFLOAD_VLAN;
1742

1743
	vfres->vf_cap_flags = VIRTCHNL_VF_OFFLOAD_L2;
1744
	vsi = pf->vsi[vf->lan_vsi_idx];
1745
	if (!vsi->info.pvid)
1746
		vfres->vf_cap_flags |= VIRTCHNL_VF_OFFLOAD_VLAN;
1747

M
Mitch Williams 已提交
1748
	if (i40e_vf_client_capable(pf, vf->vf_id) &&
1749
	    (vf->driver_caps & VIRTCHNL_VF_OFFLOAD_IWARP)) {
1750
		vfres->vf_cap_flags |= VIRTCHNL_VF_OFFLOAD_IWARP;
1751
		set_bit(I40E_VF_STATE_IWARPENA, &vf->vf_states);
1752 1753
	} else {
		clear_bit(I40E_VF_STATE_IWARPENA, &vf->vf_states);
1754 1755
	}

1756
	if (vf->driver_caps & VIRTCHNL_VF_OFFLOAD_RSS_PF) {
1757
		vfres->vf_cap_flags |= VIRTCHNL_VF_OFFLOAD_RSS_PF;
1758
	} else {
1759
		if ((pf->hw_features & I40E_HW_RSS_AQ_CAPABLE) &&
1760
		    (vf->driver_caps & VIRTCHNL_VF_OFFLOAD_RSS_AQ))
1761
			vfres->vf_cap_flags |= VIRTCHNL_VF_OFFLOAD_RSS_AQ;
1762
		else
1763
			vfres->vf_cap_flags |= VIRTCHNL_VF_OFFLOAD_RSS_REG;
1764
	}
1765

1766
	if (pf->hw_features & I40E_HW_MULTIPLE_TCP_UDP_RSS_PCTYPE) {
1767
		if (vf->driver_caps & VIRTCHNL_VF_OFFLOAD_RSS_PCTYPE_V2)
1768
			vfres->vf_cap_flags |=
1769
				VIRTCHNL_VF_OFFLOAD_RSS_PCTYPE_V2;
1770 1771
	}

1772
	if (vf->driver_caps & VIRTCHNL_VF_OFFLOAD_ENCAP)
1773
		vfres->vf_cap_flags |= VIRTCHNL_VF_OFFLOAD_ENCAP;
1774

1775
	if ((pf->hw_features & I40E_HW_OUTER_UDP_CSUM_CAPABLE) &&
1776
	    (vf->driver_caps & VIRTCHNL_VF_OFFLOAD_ENCAP_CSUM))
1777
		vfres->vf_cap_flags |= VIRTCHNL_VF_OFFLOAD_ENCAP_CSUM;
1778

1779
	if (vf->driver_caps & VIRTCHNL_VF_OFFLOAD_RX_POLLING) {
1780 1781 1782 1783
		if (pf->flags & I40E_FLAG_MFP_ENABLED) {
			dev_err(&pf->pdev->dev,
				"VF %d requested polling mode: this feature is supported only when the device is running in single function per port (SFP) mode\n",
				 vf->vf_id);
1784
			aq_ret = I40E_ERR_PARAM;
1785 1786
			goto err;
		}
1787
		vfres->vf_cap_flags |= VIRTCHNL_VF_OFFLOAD_RX_POLLING;
1788
	}
1789

1790
	if (pf->hw_features & I40E_HW_WB_ON_ITR_CAPABLE) {
1791
		if (vf->driver_caps & VIRTCHNL_VF_OFFLOAD_WB_ON_ITR)
1792
			vfres->vf_cap_flags |=
1793
					VIRTCHNL_VF_OFFLOAD_WB_ON_ITR;
1794 1795
	}

1796 1797 1798
	if (vf->driver_caps & VIRTCHNL_VF_OFFLOAD_REQ_QUEUES)
		vfres->vf_cap_flags |= VIRTCHNL_VF_OFFLOAD_REQ_QUEUES;

1799 1800 1801
	if (vf->driver_caps & VIRTCHNL_VF_OFFLOAD_ADQ)
		vfres->vf_cap_flags |= VIRTCHNL_VF_OFFLOAD_ADQ;

1802 1803 1804
	vfres->num_vsis = num_vsis;
	vfres->num_queue_pairs = vf->num_queue_pairs;
	vfres->max_vectors = pf->hw.func_caps.num_msix_vectors_vf;
1805 1806 1807
	vfres->rss_key_size = I40E_HKEY_ARRAY_SIZE;
	vfres->rss_lut_size = I40E_VF_HLUT_ARRAY_SIZE;

1808
	if (vf->lan_vsi_idx) {
M
Mitch Williams 已提交
1809
		vfres->vsi_res[0].vsi_id = vf->lan_vsi_id;
1810
		vfres->vsi_res[0].vsi_type = VIRTCHNL_VSI_SRIOV;
M
Mitch Williams 已提交
1811
		vfres->vsi_res[0].num_queue_pairs = vsi->alloc_queue_pairs;
1812
		/* VFs only use TC 0 */
M
Mitch Williams 已提交
1813
		vfres->vsi_res[0].qset_handle
1814
					  = le16_to_cpu(vsi->info.qs_handle[0]);
M
Mitch Williams 已提交
1815
		ether_addr_copy(vfres->vsi_res[0].default_mac_addr,
J
Jesse Brandeburg 已提交
1816
				vf->default_lan_addr.addr);
1817
	}
1818
	set_bit(I40E_VF_STATE_ACTIVE, &vf->vf_states);
1819 1820

err:
1821
	/* send the response back to the VF */
1822
	ret = i40e_vc_send_msg_to_vf(vf, VIRTCHNL_OP_GET_VF_RESOURCES,
1823 1824 1825 1826 1827 1828 1829 1830
				     aq_ret, (u8 *)vfres, len);

	kfree(vfres);
	return ret;
}

/**
 * i40e_vc_reset_vf_msg
1831
 * @vf: pointer to the VF info
1832 1833 1834
 * @msg: pointer to the msg buffer
 * @msglen: msg length
 *
1835 1836 1837
 * called from the VF to reset itself,
 * unlike other virtchnl messages, PF driver
 * doesn't send the response back to the VF
1838
 **/
M
Mitch Williams 已提交
1839
static void i40e_vc_reset_vf_msg(struct i40e_vf *vf)
1840
{
1841
	if (test_bit(I40E_VF_STATE_ACTIVE, &vf->vf_states))
M
Mitch Williams 已提交
1842
		i40e_reset_vf(vf, false);
1843 1844
}

1845 1846 1847 1848 1849 1850 1851 1852 1853
/**
 * i40e_getnum_vf_vsi_vlan_filters
 * @vsi: pointer to the vsi
 *
 * called to get the number of VLANs offloaded on this VF
 **/
static inline int i40e_getnum_vf_vsi_vlan_filters(struct i40e_vsi *vsi)
{
	struct i40e_mac_filter *f;
1854
	int num_vlans = 0, bkt;
1855

1856
	hash_for_each(vsi->mac_filter_hash, bkt, f, hlist) {
1857 1858 1859 1860 1861 1862 1863
		if (f->vlan >= 0 && f->vlan <= I40E_MAX_VLANID)
			num_vlans++;
	}

	return num_vlans;
}

1864 1865
/**
 * i40e_vc_config_promiscuous_mode_msg
1866
 * @vf: pointer to the VF info
1867 1868 1869
 * @msg: pointer to the msg buffer
 * @msglen: msg length
 *
1870 1871
 * called from the VF to configure the promiscuous mode of
 * VF vsis
1872 1873 1874 1875
 **/
static int i40e_vc_config_promiscuous_mode_msg(struct i40e_vf *vf,
					       u8 *msg, u16 msglen)
{
1876 1877
	struct virtchnl_promisc_info *info =
	    (struct virtchnl_promisc_info *)msg;
1878 1879
	struct i40e_pf *pf = vf->pf;
	struct i40e_hw *hw = &pf->hw;
1880 1881
	struct i40e_mac_filter *f;
	i40e_status aq_ret = 0;
1882
	bool allmulti = false;
1883 1884 1885
	struct i40e_vsi *vsi;
	bool alluni = false;
	int aq_err = 0;
1886
	int bkt;
1887

1888
	vsi = i40e_find_vsi_from_id(pf, info->vsi_id);
1889
	if (!test_bit(I40E_VF_STATE_ACTIVE, &vf->vf_states) ||
C
Carolyn Wyborny 已提交
1890 1891
	    !i40e_vc_isvalid_vsi_id(vf, info->vsi_id) ||
	    !vsi) {
M
Mitch Williams 已提交
1892 1893 1894 1895
		aq_ret = I40E_ERR_PARAM;
		goto error_param;
	}
	if (!test_bit(I40E_VIRTCHNL_VF_CAP_PRIVILEGE, &vf->vf_caps)) {
1896
		dev_err(&pf->pdev->dev,
M
Mitch Williams 已提交
1897
			"Unprivileged VF %d is attempting to configure promiscuous mode\n",
1898
			vf->vf_id);
M
Mitch Williams 已提交
1899 1900
		/* Lie to the VF on purpose. */
		aq_ret = 0;
1901 1902
		goto error_param;
	}
1903
	/* Multicast promiscuous handling*/
1904
	if (info->flags & FLAG_VF_MULTICAST_PROMISC)
1905
		allmulti = true;
1906 1907 1908 1909 1910 1911 1912

	if (vf->port_vlan_id) {
		aq_ret = i40e_aq_set_vsi_mc_promisc_on_vlan(hw, vsi->seid,
							    allmulti,
							    vf->port_vlan_id,
							    NULL);
	} else if (i40e_getnum_vf_vsi_vlan_filters(vsi)) {
1913
		hash_for_each(vsi->mac_filter_hash, bkt, f, hlist) {
1914 1915 1916 1917 1918 1919 1920
			if (f->vlan < 0 || f->vlan > I40E_MAX_VLANID)
				continue;
			aq_ret = i40e_aq_set_vsi_mc_promisc_on_vlan(hw,
								    vsi->seid,
								    allmulti,
								    f->vlan,
								    NULL);
1921 1922 1923 1924 1925 1926 1927 1928 1929 1930 1931 1932 1933 1934 1935 1936 1937 1938 1939 1940
			aq_err = pf->hw.aq.asq_last_status;
			if (aq_ret) {
				dev_err(&pf->pdev->dev,
					"Could not add VLAN %d to multicast promiscuous domain err %s aq_err %s\n",
					f->vlan,
					i40e_stat_str(&pf->hw, aq_ret),
					i40e_aq_str(&pf->hw, aq_err));
				break;
			}
		}
	} else {
		aq_ret = i40e_aq_set_vsi_multicast_promiscuous(hw, vsi->seid,
							       allmulti, NULL);
		aq_err = pf->hw.aq.asq_last_status;
		if (aq_ret) {
			dev_err(&pf->pdev->dev,
				"VF %d failed to set multicast promiscuous mode err %s aq_err %s\n",
				vf->vf_id,
				i40e_stat_str(&pf->hw, aq_ret),
				i40e_aq_str(&pf->hw, aq_err));
1941
			goto error_param;
1942 1943 1944 1945 1946 1947 1948 1949
		}
	}

	if (!aq_ret) {
		dev_info(&pf->pdev->dev,
			 "VF %d successfully set multicast promiscuous mode\n",
			 vf->vf_id);
		if (allmulti)
1950
			set_bit(I40E_VF_STATE_MC_PROMISC, &vf->vf_states);
1951
		else
1952
			clear_bit(I40E_VF_STATE_MC_PROMISC, &vf->vf_states);
1953 1954
	}

1955
	if (info->flags & FLAG_VF_UNICAST_PROMISC)
1956 1957 1958 1959 1960 1961 1962
		alluni = true;
	if (vf->port_vlan_id) {
		aq_ret = i40e_aq_set_vsi_uc_promisc_on_vlan(hw, vsi->seid,
							    alluni,
							    vf->port_vlan_id,
							    NULL);
	} else if (i40e_getnum_vf_vsi_vlan_filters(vsi)) {
1963
		hash_for_each(vsi->mac_filter_hash, bkt, f, hlist) {
1964 1965 1966 1967 1968 1969 1970 1971
			if (f->vlan < 0 || f->vlan > I40E_MAX_VLANID)
				continue;
			aq_ret = i40e_aq_set_vsi_uc_promisc_on_vlan(hw,
								    vsi->seid,
								    alluni,
								    f->vlan,
								    NULL);
			aq_err = pf->hw.aq.asq_last_status;
1972 1973 1974 1975 1976 1977 1978 1979 1980
			if (aq_ret)
				dev_err(&pf->pdev->dev,
					"Could not add VLAN %d to Unicast promiscuous domain err %s aq_err %s\n",
					f->vlan,
					i40e_stat_str(&pf->hw, aq_ret),
					i40e_aq_str(&pf->hw, aq_err));
		}
	} else {
		aq_ret = i40e_aq_set_vsi_unicast_promiscuous(hw, vsi->seid,
1981
							     alluni, NULL,
1982
							     true);
1983
		aq_err = pf->hw.aq.asq_last_status;
1984
		if (aq_ret) {
1985 1986 1987 1988 1989
			dev_err(&pf->pdev->dev,
				"VF %d failed to set unicast promiscuous mode %8.8x err %s aq_err %s\n",
				vf->vf_id, info->flags,
				i40e_stat_str(&pf->hw, aq_ret),
				i40e_aq_str(&pf->hw, aq_err));
1990 1991
			goto error_param;
		}
1992 1993 1994 1995 1996 1997 1998
	}

	if (!aq_ret) {
		dev_info(&pf->pdev->dev,
			 "VF %d successfully set unicast promiscuous mode\n",
			 vf->vf_id);
		if (alluni)
1999
			set_bit(I40E_VF_STATE_UC_PROMISC, &vf->vf_states);
2000
		else
2001
			clear_bit(I40E_VF_STATE_UC_PROMISC, &vf->vf_states);
2002
	}
2003 2004

error_param:
2005
	/* send the response to the VF */
2006
	return i40e_vc_send_resp_to_vf(vf,
2007
				       VIRTCHNL_OP_CONFIG_PROMISCUOUS_MODE,
2008 2009 2010 2011 2012
				       aq_ret);
}

/**
 * i40e_vc_config_queues_msg
2013
 * @vf: pointer to the VF info
2014 2015 2016
 * @msg: pointer to the msg buffer
 * @msglen: msg length
 *
2017
 * called from the VF to configure the rx/tx
2018 2019 2020 2021
 * queues
 **/
static int i40e_vc_config_queues_msg(struct i40e_vf *vf, u8 *msg, u16 msglen)
{
2022 2023 2024
	struct virtchnl_vsi_queue_config_info *qci =
	    (struct virtchnl_vsi_queue_config_info *)msg;
	struct virtchnl_queue_pair_info *qpi;
2025
	struct i40e_pf *pf = vf->pf;
2026
	u16 vsi_id, vsi_queue_id = 0;
2027
	i40e_status aq_ret = 0;
2028 2029 2030
	int i, j = 0, idx = 0;

	vsi_id = qci->vsi_id;
2031

2032
	if (!test_bit(I40E_VF_STATE_ACTIVE, &vf->vf_states)) {
2033 2034 2035 2036 2037 2038 2039 2040
		aq_ret = I40E_ERR_PARAM;
		goto error_param;
	}

	if (!i40e_vc_isvalid_vsi_id(vf, vsi_id)) {
		aq_ret = I40E_ERR_PARAM;
		goto error_param;
	}
2041

2042 2043
	for (i = 0; i < qci->num_queue_pairs; i++) {
		qpi = &qci->qpair[i];
2044 2045 2046 2047 2048 2049 2050 2051 2052 2053 2054 2055 2056

		if (!vf->adq_enabled) {
			vsi_queue_id = qpi->txq.queue_id;

			if (qpi->txq.vsi_id != qci->vsi_id ||
			    qpi->rxq.vsi_id != qci->vsi_id ||
			    qpi->rxq.queue_id != vsi_queue_id) {
				aq_ret = I40E_ERR_PARAM;
				goto error_param;
			}
		}

		if (!i40e_vc_isvalid_queue_id(vf, vsi_id, vsi_queue_id)) {
2057 2058 2059 2060 2061 2062 2063 2064 2065 2066 2067
			aq_ret = I40E_ERR_PARAM;
			goto error_param;
		}

		if (i40e_config_vsi_rx_queue(vf, vsi_id, vsi_queue_id,
					     &qpi->rxq) ||
		    i40e_config_vsi_tx_queue(vf, vsi_id, vsi_queue_id,
					     &qpi->txq)) {
			aq_ret = I40E_ERR_PARAM;
			goto error_param;
		}
2068 2069 2070 2071 2072 2073 2074 2075 2076 2077 2078 2079 2080 2081 2082 2083 2084

		/* For ADq there can be up to 4 VSIs with max 4 queues each.
		 * VF does not know about these additional VSIs and all
		 * it cares is about its own queues. PF configures these queues
		 * to its appropriate VSIs based on TC mapping
		 **/
		if (vf->adq_enabled) {
			if (j == (vf->ch[idx].num_qps - 1)) {
				idx++;
				j = 0; /* resetting the queue count */
				vsi_queue_id = 0;
			} else {
				j++;
				vsi_queue_id++;
			}
			vsi_id = vf->ch[idx].vsi_id;
		}
2085
	}
2086
	/* set vsi num_queue_pairs in use to num configured by VF */
2087 2088 2089 2090 2091 2092 2093 2094
	if (!vf->adq_enabled) {
		pf->vsi[vf->lan_vsi_idx]->num_queue_pairs =
			qci->num_queue_pairs;
	} else {
		for (i = 0; i < vf->num_tc; i++)
			pf->vsi[vf->ch[i].vsi_idx]->num_queue_pairs =
			       vf->ch[i].num_qps;
	}
2095 2096

error_param:
2097
	/* send the response to the VF */
2098
	return i40e_vc_send_resp_to_vf(vf, VIRTCHNL_OP_CONFIG_VSI_QUEUES,
2099 2100 2101
				       aq_ret);
}

2102 2103 2104 2105 2106 2107 2108 2109 2110 2111 2112 2113 2114 2115 2116 2117 2118 2119 2120 2121 2122 2123 2124 2125 2126 2127 2128
/**
 * i40e_validate_queue_map
 * @vsi_id: vsi id
 * @queuemap: Tx or Rx queue map
 *
 * check if Tx or Rx queue map is valid
 **/
static int i40e_validate_queue_map(struct i40e_vf *vf, u16 vsi_id,
				   unsigned long queuemap)
{
	u16 vsi_queue_id, queue_id;

	for_each_set_bit(vsi_queue_id, &queuemap, I40E_MAX_VSI_QP) {
		if (vf->adq_enabled) {
			vsi_id = vf->ch[vsi_queue_id / I40E_MAX_VF_VSI].vsi_id;
			queue_id = (vsi_queue_id % I40E_DEFAULT_QUEUES_PER_VF);
		} else {
			queue_id = vsi_queue_id;
		}

		if (!i40e_vc_isvalid_queue_id(vf, vsi_id, queue_id))
			return -EINVAL;
	}

	return 0;
}

2129 2130
/**
 * i40e_vc_config_irq_map_msg
2131
 * @vf: pointer to the VF info
2132 2133 2134
 * @msg: pointer to the msg buffer
 * @msglen: msg length
 *
2135
 * called from the VF to configure the irq to
2136 2137 2138 2139
 * queue map
 **/
static int i40e_vc_config_irq_map_msg(struct i40e_vf *vf, u8 *msg, u16 msglen)
{
2140 2141 2142
	struct virtchnl_irq_map_info *irqmap_info =
	    (struct virtchnl_irq_map_info *)msg;
	struct virtchnl_vector_map *map;
2143
	u16 vsi_id, vector_id;
2144 2145 2146
	i40e_status aq_ret = 0;
	int i;

2147
	if (!test_bit(I40E_VF_STATE_ACTIVE, &vf->vf_states)) {
2148 2149 2150 2151 2152 2153 2154 2155 2156 2157 2158 2159 2160 2161 2162
		aq_ret = I40E_ERR_PARAM;
		goto error_param;
	}

	for (i = 0; i < irqmap_info->num_vectors; i++) {
		map = &irqmap_info->vecmap[i];
		vector_id = map->vector_id;
		vsi_id = map->vsi_id;
		/* validate msg params */
		if (!i40e_vc_isvalid_vector_id(vf, vector_id) ||
		    !i40e_vc_isvalid_vsi_id(vf, vsi_id)) {
			aq_ret = I40E_ERR_PARAM;
			goto error_param;
		}

2163 2164 2165
		if (i40e_validate_queue_map(vf, vsi_id, map->rxq_map)) {
			aq_ret = I40E_ERR_PARAM;
			goto error_param;
2166 2167
		}

2168 2169 2170
		if (i40e_validate_queue_map(vf, vsi_id, map->txq_map)) {
			aq_ret = I40E_ERR_PARAM;
			goto error_param;
2171 2172 2173 2174 2175
		}

		i40e_config_irq_link_list(vf, vsi_id, map);
	}
error_param:
2176
	/* send the response to the VF */
2177
	return i40e_vc_send_resp_to_vf(vf, VIRTCHNL_OP_CONFIG_IRQ_MAP,
2178 2179 2180 2181 2182
				       aq_ret);
}

/**
 * i40e_vc_enable_queues_msg
2183
 * @vf: pointer to the VF info
2184 2185 2186
 * @msg: pointer to the msg buffer
 * @msglen: msg length
 *
2187
 * called from the VF to enable all or specific queue(s)
2188 2189 2190
 **/
static int i40e_vc_enable_queues_msg(struct i40e_vf *vf, u8 *msg, u16 msglen)
{
2191 2192
	struct virtchnl_queue_select *vqs =
	    (struct virtchnl_queue_select *)msg;
2193 2194 2195
	struct i40e_pf *pf = vf->pf;
	u16 vsi_id = vqs->vsi_id;
	i40e_status aq_ret = 0;
2196
	int i;
2197

2198
	if (!test_bit(I40E_VF_STATE_ACTIVE, &vf->vf_states)) {
2199 2200 2201 2202 2203 2204 2205 2206 2207 2208 2209 2210 2211
		aq_ret = I40E_ERR_PARAM;
		goto error_param;
	}

	if (!i40e_vc_isvalid_vsi_id(vf, vsi_id)) {
		aq_ret = I40E_ERR_PARAM;
		goto error_param;
	}

	if ((0 == vqs->rx_queues) && (0 == vqs->tx_queues)) {
		aq_ret = I40E_ERR_PARAM;
		goto error_param;
	}
2212

F
Filip Sadowski 已提交
2213
	if (i40e_vsi_start_rings(pf->vsi[vf->lan_vsi_idx]))
M
Mitch Williams 已提交
2214
		aq_ret = I40E_ERR_TIMEOUT;
2215 2216 2217 2218 2219 2220 2221 2222 2223 2224

	/* need to start the rings for additional ADq VSI's as well */
	if (vf->adq_enabled) {
		/* zero belongs to LAN VSI */
		for (i = 1; i < vf->num_tc; i++) {
			if (i40e_vsi_start_rings(pf->vsi[vf->ch[i].vsi_idx]))
				aq_ret = I40E_ERR_TIMEOUT;
		}
	}

2225
error_param:
2226
	/* send the response to the VF */
2227
	return i40e_vc_send_resp_to_vf(vf, VIRTCHNL_OP_ENABLE_QUEUES,
2228 2229 2230 2231 2232
				       aq_ret);
}

/**
 * i40e_vc_disable_queues_msg
2233
 * @vf: pointer to the VF info
2234 2235 2236
 * @msg: pointer to the msg buffer
 * @msglen: msg length
 *
2237
 * called from the VF to disable all or specific
2238 2239 2240 2241
 * queue(s)
 **/
static int i40e_vc_disable_queues_msg(struct i40e_vf *vf, u8 *msg, u16 msglen)
{
2242 2243
	struct virtchnl_queue_select *vqs =
	    (struct virtchnl_queue_select *)msg;
2244 2245 2246
	struct i40e_pf *pf = vf->pf;
	i40e_status aq_ret = 0;

2247
	if (!test_bit(I40E_VF_STATE_ACTIVE, &vf->vf_states)) {
2248 2249 2250 2251 2252 2253 2254 2255 2256 2257 2258 2259 2260
		aq_ret = I40E_ERR_PARAM;
		goto error_param;
	}

	if (!i40e_vc_isvalid_vsi_id(vf, vqs->vsi_id)) {
		aq_ret = I40E_ERR_PARAM;
		goto error_param;
	}

	if ((0 == vqs->rx_queues) && (0 == vqs->tx_queues)) {
		aq_ret = I40E_ERR_PARAM;
		goto error_param;
	}
2261

F
Filip Sadowski 已提交
2262
	i40e_vsi_stop_rings(pf->vsi[vf->lan_vsi_idx]);
2263 2264

error_param:
2265
	/* send the response to the VF */
2266
	return i40e_vc_send_resp_to_vf(vf, VIRTCHNL_OP_DISABLE_QUEUES,
2267 2268 2269
				       aq_ret);
}

2270 2271 2272 2273 2274 2275 2276
/**
 * i40e_vc_request_queues_msg
 * @vf: pointer to the VF info
 * @msg: pointer to the msg buffer
 * @msglen: msg length
 *
 * VFs get a default number of queues but can use this message to request a
2277 2278 2279
 * different number.  If the request is successful, PF will reset the VF and
 * return 0.  If unsuccessful, PF will send message informing VF of number of
 * available queues and return result of sending VF a message.
2280 2281 2282 2283 2284 2285 2286 2287 2288 2289 2290 2291 2292 2293 2294 2295 2296 2297 2298 2299 2300 2301 2302 2303 2304 2305 2306 2307 2308 2309
 **/
static int i40e_vc_request_queues_msg(struct i40e_vf *vf, u8 *msg, int msglen)
{
	struct virtchnl_vf_res_request *vfres =
		(struct virtchnl_vf_res_request *)msg;
	int req_pairs = vfres->num_queue_pairs;
	int cur_pairs = vf->num_queue_pairs;
	struct i40e_pf *pf = vf->pf;

	if (!test_bit(I40E_VF_STATE_ACTIVE, &vf->vf_states))
		return -EINVAL;

	if (req_pairs <= 0) {
		dev_err(&pf->pdev->dev,
			"VF %d tried to request %d queues.  Ignoring.\n",
			vf->vf_id, req_pairs);
	} else if (req_pairs > I40E_MAX_VF_QUEUES) {
		dev_err(&pf->pdev->dev,
			"VF %d tried to request more than %d queues.\n",
			vf->vf_id,
			I40E_MAX_VF_QUEUES);
		vfres->num_queue_pairs = I40E_MAX_VF_QUEUES;
	} else if (req_pairs - cur_pairs > pf->queues_left) {
		dev_warn(&pf->pdev->dev,
			 "VF %d requested %d more queues, but only %d left.\n",
			 vf->vf_id,
			 req_pairs - cur_pairs,
			 pf->queues_left);
		vfres->num_queue_pairs = pf->queues_left + cur_pairs;
	} else {
2310
		/* successful request */
2311
		vf->num_req_queues = req_pairs;
2312 2313 2314
		i40e_vc_notify_vf_reset(vf);
		i40e_reset_vf(vf, false);
		return 0;
2315 2316 2317
	}

	return i40e_vc_send_msg_to_vf(vf, VIRTCHNL_OP_REQUEST_QUEUES, 0,
2318
				      (u8 *)vfres, sizeof(*vfres));
2319 2320
}

2321 2322
/**
 * i40e_vc_get_stats_msg
2323
 * @vf: pointer to the VF info
2324 2325 2326
 * @msg: pointer to the msg buffer
 * @msglen: msg length
 *
2327
 * called from the VF to get vsi stats
2328 2329 2330
 **/
static int i40e_vc_get_stats_msg(struct i40e_vf *vf, u8 *msg, u16 msglen)
{
2331 2332
	struct virtchnl_queue_select *vqs =
	    (struct virtchnl_queue_select *)msg;
2333 2334 2335 2336 2337 2338 2339
	struct i40e_pf *pf = vf->pf;
	struct i40e_eth_stats stats;
	i40e_status aq_ret = 0;
	struct i40e_vsi *vsi;

	memset(&stats, 0, sizeof(struct i40e_eth_stats));

2340
	if (!test_bit(I40E_VF_STATE_ACTIVE, &vf->vf_states)) {
2341 2342 2343 2344 2345 2346 2347 2348 2349
		aq_ret = I40E_ERR_PARAM;
		goto error_param;
	}

	if (!i40e_vc_isvalid_vsi_id(vf, vqs->vsi_id)) {
		aq_ret = I40E_ERR_PARAM;
		goto error_param;
	}

2350
	vsi = pf->vsi[vf->lan_vsi_idx];
2351 2352 2353 2354 2355
	if (!vsi) {
		aq_ret = I40E_ERR_PARAM;
		goto error_param;
	}
	i40e_update_eth_stats(vsi);
2356
	stats = vsi->eth_stats;
2357 2358

error_param:
2359
	/* send the response back to the VF */
2360
	return i40e_vc_send_msg_to_vf(vf, VIRTCHNL_OP_GET_STATS, aq_ret,
2361 2362 2363
				      (u8 *)&stats, sizeof(stats));
}

2364
/* If the VF is not trusted restrict the number of MAC/VLAN it can program */
2365
#define I40E_VC_MAX_MAC_ADDR_PER_VF 12
2366 2367
#define I40E_VC_MAX_VLAN_PER_VF 8

2368 2369
/**
 * i40e_check_vf_permission
2370
 * @vf: pointer to the VF info
2371 2372 2373 2374 2375 2376 2377 2378 2379 2380 2381 2382 2383 2384 2385 2386
 * @macaddr: pointer to the MAC Address being checked
 *
 * Check if the VF has permission to add or delete unicast MAC address
 * filters and return error code -EPERM if not.  Then check if the
 * address filter requested is broadcast or zero and if so return
 * an invalid MAC address error code.
 **/
static inline int i40e_check_vf_permission(struct i40e_vf *vf, u8 *macaddr)
{
	struct i40e_pf *pf = vf->pf;
	int ret = 0;

	if (is_broadcast_ether_addr(macaddr) ||
		   is_zero_ether_addr(macaddr)) {
		dev_err(&pf->pdev->dev, "invalid VF MAC addr %pM\n", macaddr);
		ret = I40E_ERR_INVALID_MAC_ADDR;
2387
	} else if (vf->pf_set_mac && !is_multicast_ether_addr(macaddr) &&
2388
		   !test_bit(I40E_VIRTCHNL_VF_CAP_PRIVILEGE, &vf->vf_caps) &&
2389
		   !ether_addr_equal(macaddr, vf->default_lan_addr.addr)) {
2390 2391 2392
		/* If the host VMM administrator has set the VF MAC address
		 * administratively via the ndo_set_vf_mac command then deny
		 * permission to the VF to add or delete unicast MAC addresses.
2393
		 * Unless the VF is privileged and then it can do whatever.
2394 2395
		 * The VF may request to set the MAC address filter already
		 * assigned to it so do not return an error in that case.
2396 2397
		 */
		dev_err(&pf->pdev->dev,
2398
			"VF attempting to override administratively set MAC address, reload the VF driver to resume normal operation\n");
2399
		ret = -EPERM;
2400 2401 2402 2403 2404
	} else if ((vf->num_mac >= I40E_VC_MAX_MAC_ADDR_PER_VF) &&
		   !test_bit(I40E_VIRTCHNL_VF_CAP_PRIVILEGE, &vf->vf_caps)) {
		dev_err(&pf->pdev->dev,
			"VF is not trusted, switch the VF to trusted to add more functionality\n");
		ret = -EPERM;
2405 2406 2407 2408
	}
	return ret;
}

2409 2410
/**
 * i40e_vc_add_mac_addr_msg
2411
 * @vf: pointer to the VF info
2412 2413 2414 2415 2416 2417 2418
 * @msg: pointer to the msg buffer
 * @msglen: msg length
 *
 * add guest mac address filter
 **/
static int i40e_vc_add_mac_addr_msg(struct i40e_vf *vf, u8 *msg, u16 msglen)
{
2419 2420
	struct virtchnl_ether_addr_list *al =
	    (struct virtchnl_ether_addr_list *)msg;
2421 2422 2423
	struct i40e_pf *pf = vf->pf;
	struct i40e_vsi *vsi = NULL;
	u16 vsi_id = al->vsi_id;
2424
	i40e_status ret = 0;
2425 2426
	int i;

2427
	if (!test_bit(I40E_VF_STATE_ACTIVE, &vf->vf_states) ||
2428
	    !i40e_vc_isvalid_vsi_id(vf, vsi_id)) {
2429
		ret = I40E_ERR_PARAM;
2430 2431 2432 2433
		goto error_param;
	}

	for (i = 0; i < al->num_elements; i++) {
2434 2435
		ret = i40e_check_vf_permission(vf, al->list[i].addr);
		if (ret)
2436 2437
			goto error_param;
	}
2438
	vsi = pf->vsi[vf->lan_vsi_idx];
2439

K
Kiran Patil 已提交
2440 2441 2442
	/* Lock once, because all function inside for loop accesses VSI's
	 * MAC filter list which needs to be protected using same lock.
	 */
2443
	spin_lock_bh(&vsi->mac_filter_hash_lock);
K
Kiran Patil 已提交
2444

2445 2446 2447 2448
	/* add new addresses to the list */
	for (i = 0; i < al->num_elements; i++) {
		struct i40e_mac_filter *f;

2449
		f = i40e_find_mac(vsi, al->list[i].addr);
2450
		if (!f) {
2451
			f = i40e_add_mac_filter(vsi, al->list[i].addr);
2452

2453 2454 2455 2456 2457 2458 2459 2460 2461 2462
			if (!f) {
				dev_err(&pf->pdev->dev,
					"Unable to add MAC filter %pM for VF %d\n",
					al->list[i].addr, vf->vf_id);
				ret = I40E_ERR_PARAM;
				spin_unlock_bh(&vsi->mac_filter_hash_lock);
				goto error_param;
			} else {
				vf->num_mac++;
			}
2463 2464
		}
	}
2465
	spin_unlock_bh(&vsi->mac_filter_hash_lock);
2466 2467

	/* program the updated filter list */
M
Mitch Williams 已提交
2468 2469 2470 2471
	ret = i40e_sync_vsi_filters(vsi);
	if (ret)
		dev_err(&pf->pdev->dev, "Unable to program VF %d MAC filters, error %d\n",
			vf->vf_id, ret);
2472 2473

error_param:
2474
	/* send the response to the VF */
2475
	return i40e_vc_send_resp_to_vf(vf, VIRTCHNL_OP_ADD_ETH_ADDR,
2476
				       ret);
2477 2478 2479 2480
}

/**
 * i40e_vc_del_mac_addr_msg
2481
 * @vf: pointer to the VF info
2482 2483 2484 2485 2486 2487 2488
 * @msg: pointer to the msg buffer
 * @msglen: msg length
 *
 * remove guest mac address filter
 **/
static int i40e_vc_del_mac_addr_msg(struct i40e_vf *vf, u8 *msg, u16 msglen)
{
2489 2490
	struct virtchnl_ether_addr_list *al =
	    (struct virtchnl_ether_addr_list *)msg;
2491 2492 2493
	struct i40e_pf *pf = vf->pf;
	struct i40e_vsi *vsi = NULL;
	u16 vsi_id = al->vsi_id;
2494
	i40e_status ret = 0;
2495 2496
	int i;

2497
	if (!test_bit(I40E_VF_STATE_ACTIVE, &vf->vf_states) ||
2498
	    !i40e_vc_isvalid_vsi_id(vf, vsi_id)) {
2499
		ret = I40E_ERR_PARAM;
2500 2501
		goto error_param;
	}
2502 2503

	for (i = 0; i < al->num_elements; i++) {
2504 2505
		if (is_broadcast_ether_addr(al->list[i].addr) ||
		    is_zero_ether_addr(al->list[i].addr)) {
2506 2507
			dev_err(&pf->pdev->dev, "Invalid MAC addr %pM for VF %d\n",
				al->list[i].addr, vf->vf_id);
2508
			ret = I40E_ERR_INVALID_MAC_ADDR;
2509
			goto error_param;
2510
		}
2511
	}
2512
	vsi = pf->vsi[vf->lan_vsi_idx];
2513

2514
	spin_lock_bh(&vsi->mac_filter_hash_lock);
2515 2516
	/* delete addresses from the list */
	for (i = 0; i < al->num_elements; i++)
2517
		if (i40e_del_mac_filter(vsi, al->list[i].addr)) {
2518
			ret = I40E_ERR_INVALID_MAC_ADDR;
2519
			spin_unlock_bh(&vsi->mac_filter_hash_lock);
2520
			goto error_param;
2521 2522
		} else {
			vf->num_mac--;
2523 2524
		}

2525
	spin_unlock_bh(&vsi->mac_filter_hash_lock);
2526 2527

	/* program the updated filter list */
M
Mitch Williams 已提交
2528 2529 2530 2531
	ret = i40e_sync_vsi_filters(vsi);
	if (ret)
		dev_err(&pf->pdev->dev, "Unable to program VF %d MAC filters, error %d\n",
			vf->vf_id, ret);
2532 2533

error_param:
2534
	/* send the response to the VF */
2535
	return i40e_vc_send_resp_to_vf(vf, VIRTCHNL_OP_DEL_ETH_ADDR,
2536
				       ret);
2537 2538 2539 2540
}

/**
 * i40e_vc_add_vlan_msg
2541
 * @vf: pointer to the VF info
2542 2543 2544 2545 2546 2547 2548
 * @msg: pointer to the msg buffer
 * @msglen: msg length
 *
 * program guest vlan id
 **/
static int i40e_vc_add_vlan_msg(struct i40e_vf *vf, u8 *msg, u16 msglen)
{
2549 2550
	struct virtchnl_vlan_filter_list *vfl =
	    (struct virtchnl_vlan_filter_list *)msg;
2551 2552 2553 2554 2555 2556
	struct i40e_pf *pf = vf->pf;
	struct i40e_vsi *vsi = NULL;
	u16 vsi_id = vfl->vsi_id;
	i40e_status aq_ret = 0;
	int i;

2557 2558 2559 2560 2561 2562
	if ((vf->num_vlan >= I40E_VC_MAX_VLAN_PER_VF) &&
	    !test_bit(I40E_VIRTCHNL_VF_CAP_PRIVILEGE, &vf->vf_caps)) {
		dev_err(&pf->pdev->dev,
			"VF is not trusted, switch the VF to trusted to add more VLAN addresses\n");
		goto error_param;
	}
2563
	if (!test_bit(I40E_VF_STATE_ACTIVE, &vf->vf_states) ||
2564 2565 2566 2567 2568 2569 2570 2571 2572 2573 2574 2575 2576
	    !i40e_vc_isvalid_vsi_id(vf, vsi_id)) {
		aq_ret = I40E_ERR_PARAM;
		goto error_param;
	}

	for (i = 0; i < vfl->num_elements; i++) {
		if (vfl->vlan_id[i] > I40E_MAX_VLANID) {
			aq_ret = I40E_ERR_PARAM;
			dev_err(&pf->pdev->dev,
				"invalid VF VLAN id %d\n", vfl->vlan_id[i]);
			goto error_param;
		}
	}
2577
	vsi = pf->vsi[vf->lan_vsi_idx];
2578 2579 2580 2581 2582 2583 2584 2585 2586
	if (vsi->info.pvid) {
		aq_ret = I40E_ERR_PARAM;
		goto error_param;
	}

	i40e_vlan_stripping_enable(vsi);
	for (i = 0; i < vfl->num_elements; i++) {
		/* add new VLAN filter */
		int ret = i40e_vsi_add_vlan(vsi, vfl->vlan_id[i]);
2587 2588
		if (!ret)
			vf->num_vlan++;
J
Jesse Brandeburg 已提交
2589

2590
		if (test_bit(I40E_VF_STATE_UC_PROMISC, &vf->vf_states))
2591 2592 2593 2594
			i40e_aq_set_vsi_uc_promisc_on_vlan(&pf->hw, vsi->seid,
							   true,
							   vfl->vlan_id[i],
							   NULL);
2595
		if (test_bit(I40E_VF_STATE_MC_PROMISC, &vf->vf_states))
2596 2597 2598 2599 2600
			i40e_aq_set_vsi_mc_promisc_on_vlan(&pf->hw, vsi->seid,
							   true,
							   vfl->vlan_id[i],
							   NULL);

2601 2602
		if (ret)
			dev_err(&pf->pdev->dev,
2603 2604
				"Unable to add VLAN filter %d for VF %d, error %d\n",
				vfl->vlan_id[i], vf->vf_id, ret);
2605 2606 2607
	}

error_param:
2608
	/* send the response to the VF */
2609
	return i40e_vc_send_resp_to_vf(vf, VIRTCHNL_OP_ADD_VLAN, aq_ret);
2610 2611 2612 2613
}

/**
 * i40e_vc_remove_vlan_msg
2614
 * @vf: pointer to the VF info
2615 2616 2617 2618 2619 2620 2621
 * @msg: pointer to the msg buffer
 * @msglen: msg length
 *
 * remove programmed guest vlan id
 **/
static int i40e_vc_remove_vlan_msg(struct i40e_vf *vf, u8 *msg, u16 msglen)
{
2622 2623
	struct virtchnl_vlan_filter_list *vfl =
	    (struct virtchnl_vlan_filter_list *)msg;
2624 2625 2626 2627 2628 2629
	struct i40e_pf *pf = vf->pf;
	struct i40e_vsi *vsi = NULL;
	u16 vsi_id = vfl->vsi_id;
	i40e_status aq_ret = 0;
	int i;

2630
	if (!test_bit(I40E_VF_STATE_ACTIVE, &vf->vf_states) ||
2631 2632 2633 2634 2635 2636 2637 2638 2639 2640 2641 2642
	    !i40e_vc_isvalid_vsi_id(vf, vsi_id)) {
		aq_ret = I40E_ERR_PARAM;
		goto error_param;
	}

	for (i = 0; i < vfl->num_elements; i++) {
		if (vfl->vlan_id[i] > I40E_MAX_VLANID) {
			aq_ret = I40E_ERR_PARAM;
			goto error_param;
		}
	}

2643
	vsi = pf->vsi[vf->lan_vsi_idx];
2644 2645 2646 2647 2648 2649
	if (vsi->info.pvid) {
		aq_ret = I40E_ERR_PARAM;
		goto error_param;
	}

	for (i = 0; i < vfl->num_elements; i++) {
F
Filip Sadowski 已提交
2650 2651
		i40e_vsi_kill_vlan(vsi, vfl->vlan_id[i]);
		vf->num_vlan--;
J
Jesse Brandeburg 已提交
2652

2653
		if (test_bit(I40E_VF_STATE_UC_PROMISC, &vf->vf_states))
2654 2655 2656 2657
			i40e_aq_set_vsi_uc_promisc_on_vlan(&pf->hw, vsi->seid,
							   false,
							   vfl->vlan_id[i],
							   NULL);
2658
		if (test_bit(I40E_VF_STATE_MC_PROMISC, &vf->vf_states))
2659 2660 2661 2662
			i40e_aq_set_vsi_mc_promisc_on_vlan(&pf->hw, vsi->seid,
							   false,
							   vfl->vlan_id[i],
							   NULL);
2663 2664 2665
	}

error_param:
2666
	/* send the response to the VF */
2667
	return i40e_vc_send_resp_to_vf(vf, VIRTCHNL_OP_DEL_VLAN, aq_ret);
2668 2669
}

2670 2671 2672 2673 2674 2675 2676 2677 2678 2679 2680 2681 2682 2683
/**
 * i40e_vc_iwarp_msg
 * @vf: pointer to the VF info
 * @msg: pointer to the msg buffer
 * @msglen: msg length
 *
 * called from the VF for the iwarp msgs
 **/
static int i40e_vc_iwarp_msg(struct i40e_vf *vf, u8 *msg, u16 msglen)
{
	struct i40e_pf *pf = vf->pf;
	int abs_vf_id = vf->vf_id + pf->hw.func_caps.vf_base_id;
	i40e_status aq_ret = 0;

2684 2685
	if (!test_bit(I40E_VF_STATE_ACTIVE, &vf->vf_states) ||
	    !test_bit(I40E_VF_STATE_IWARPENA, &vf->vf_states)) {
2686 2687 2688 2689 2690 2691 2692 2693 2694
		aq_ret = I40E_ERR_PARAM;
		goto error_param;
	}

	i40e_notify_client_of_vf_msg(pf->vsi[pf->lan_vsi], abs_vf_id,
				     msg, msglen);

error_param:
	/* send the response to the VF */
2695
	return i40e_vc_send_resp_to_vf(vf, VIRTCHNL_OP_IWARP,
2696 2697 2698 2699 2700 2701 2702 2703 2704 2705 2706 2707 2708 2709 2710
				       aq_ret);
}

/**
 * i40e_vc_iwarp_qvmap_msg
 * @vf: pointer to the VF info
 * @msg: pointer to the msg buffer
 * @msglen: msg length
 * @config: config qvmap or release it
 *
 * called from the VF for the iwarp msgs
 **/
static int i40e_vc_iwarp_qvmap_msg(struct i40e_vf *vf, u8 *msg, u16 msglen,
				   bool config)
{
2711 2712
	struct virtchnl_iwarp_qvlist_info *qvlist_info =
				(struct virtchnl_iwarp_qvlist_info *)msg;
2713 2714
	i40e_status aq_ret = 0;

2715 2716
	if (!test_bit(I40E_VF_STATE_ACTIVE, &vf->vf_states) ||
	    !test_bit(I40E_VF_STATE_IWARPENA, &vf->vf_states)) {
2717 2718 2719 2720 2721 2722 2723 2724 2725 2726 2727 2728 2729 2730
		aq_ret = I40E_ERR_PARAM;
		goto error_param;
	}

	if (config) {
		if (i40e_config_iwarp_qvlist(vf, qvlist_info))
			aq_ret = I40E_ERR_PARAM;
	} else {
		i40e_release_iwarp_qvlist(vf);
	}

error_param:
	/* send the response to the VF */
	return i40e_vc_send_resp_to_vf(vf,
2731 2732
			       config ? VIRTCHNL_OP_CONFIG_IWARP_IRQ_MAP :
			       VIRTCHNL_OP_RELEASE_IWARP_IRQ_MAP,
2733 2734 2735
			       aq_ret);
}

2736 2737 2738 2739 2740 2741 2742 2743 2744 2745
/**
 * i40e_vc_config_rss_key
 * @vf: pointer to the VF info
 * @msg: pointer to the msg buffer
 * @msglen: msg length
 *
 * Configure the VF's RSS key
 **/
static int i40e_vc_config_rss_key(struct i40e_vf *vf, u8 *msg, u16 msglen)
{
2746 2747
	struct virtchnl_rss_key *vrk =
		(struct virtchnl_rss_key *)msg;
2748 2749 2750 2751 2752
	struct i40e_pf *pf = vf->pf;
	struct i40e_vsi *vsi = NULL;
	u16 vsi_id = vrk->vsi_id;
	i40e_status aq_ret = 0;

2753
	if (!test_bit(I40E_VF_STATE_ACTIVE, &vf->vf_states) ||
2754 2755 2756 2757 2758 2759 2760 2761 2762 2763
	    !i40e_vc_isvalid_vsi_id(vf, vsi_id) ||
	    (vrk->key_len != I40E_HKEY_ARRAY_SIZE)) {
		aq_ret = I40E_ERR_PARAM;
		goto err;
	}

	vsi = pf->vsi[vf->lan_vsi_idx];
	aq_ret = i40e_config_rss(vsi, vrk->key, NULL, 0);
err:
	/* send the response to the VF */
2764
	return i40e_vc_send_resp_to_vf(vf, VIRTCHNL_OP_CONFIG_RSS_KEY,
2765 2766 2767 2768 2769 2770 2771 2772 2773 2774 2775 2776 2777
				       aq_ret);
}

/**
 * i40e_vc_config_rss_lut
 * @vf: pointer to the VF info
 * @msg: pointer to the msg buffer
 * @msglen: msg length
 *
 * Configure the VF's RSS LUT
 **/
static int i40e_vc_config_rss_lut(struct i40e_vf *vf, u8 *msg, u16 msglen)
{
2778 2779
	struct virtchnl_rss_lut *vrl =
		(struct virtchnl_rss_lut *)msg;
2780 2781 2782 2783 2784
	struct i40e_pf *pf = vf->pf;
	struct i40e_vsi *vsi = NULL;
	u16 vsi_id = vrl->vsi_id;
	i40e_status aq_ret = 0;

2785
	if (!test_bit(I40E_VF_STATE_ACTIVE, &vf->vf_states) ||
2786 2787 2788 2789 2790 2791 2792 2793 2794 2795
	    !i40e_vc_isvalid_vsi_id(vf, vsi_id) ||
	    (vrl->lut_entries != I40E_VF_HLUT_ARRAY_SIZE)) {
		aq_ret = I40E_ERR_PARAM;
		goto err;
	}

	vsi = pf->vsi[vf->lan_vsi_idx];
	aq_ret = i40e_config_rss(vsi, NULL, vrl->lut, I40E_VF_HLUT_ARRAY_SIZE);
	/* send the response to the VF */
err:
2796
	return i40e_vc_send_resp_to_vf(vf, VIRTCHNL_OP_CONFIG_RSS_LUT,
2797 2798 2799 2800 2801 2802 2803 2804 2805 2806 2807 2808 2809
				       aq_ret);
}

/**
 * i40e_vc_get_rss_hena
 * @vf: pointer to the VF info
 * @msg: pointer to the msg buffer
 * @msglen: msg length
 *
 * Return the RSS HENA bits allowed by the hardware
 **/
static int i40e_vc_get_rss_hena(struct i40e_vf *vf, u8 *msg, u16 msglen)
{
2810
	struct virtchnl_rss_hena *vrh = NULL;
2811 2812 2813 2814
	struct i40e_pf *pf = vf->pf;
	i40e_status aq_ret = 0;
	int len = 0;

2815
	if (!test_bit(I40E_VF_STATE_ACTIVE, &vf->vf_states)) {
2816 2817 2818
		aq_ret = I40E_ERR_PARAM;
		goto err;
	}
2819
	len = sizeof(struct virtchnl_rss_hena);
2820 2821 2822 2823 2824 2825 2826 2827 2828 2829

	vrh = kzalloc(len, GFP_KERNEL);
	if (!vrh) {
		aq_ret = I40E_ERR_NO_MEMORY;
		len = 0;
		goto err;
	}
	vrh->hena = i40e_pf_get_default_rss_hena(pf);
err:
	/* send the response back to the VF */
2830
	aq_ret = i40e_vc_send_msg_to_vf(vf, VIRTCHNL_OP_GET_RSS_HENA_CAPS,
2831
					aq_ret, (u8 *)vrh, len);
M
Mitch Williams 已提交
2832
	kfree(vrh);
2833 2834 2835 2836 2837 2838 2839 2840 2841 2842 2843 2844 2845
	return aq_ret;
}

/**
 * i40e_vc_set_rss_hena
 * @vf: pointer to the VF info
 * @msg: pointer to the msg buffer
 * @msglen: msg length
 *
 * Set the RSS HENA bits for the VF
 **/
static int i40e_vc_set_rss_hena(struct i40e_vf *vf, u8 *msg, u16 msglen)
{
2846 2847
	struct virtchnl_rss_hena *vrh =
		(struct virtchnl_rss_hena *)msg;
2848 2849 2850 2851
	struct i40e_pf *pf = vf->pf;
	struct i40e_hw *hw = &pf->hw;
	i40e_status aq_ret = 0;

2852
	if (!test_bit(I40E_VF_STATE_ACTIVE, &vf->vf_states)) {
2853 2854 2855 2856 2857 2858 2859 2860 2861
		aq_ret = I40E_ERR_PARAM;
		goto err;
	}
	i40e_write_rx_ctl(hw, I40E_VFQF_HENA1(0, vf->vf_id), (u32)vrh->hena);
	i40e_write_rx_ctl(hw, I40E_VFQF_HENA1(1, vf->vf_id),
			  (u32)(vrh->hena >> 32));

	/* send the response to the VF */
err:
2862
	return i40e_vc_send_resp_to_vf(vf, VIRTCHNL_OP_SET_RSS_HENA, aq_ret);
2863 2864
}

2865 2866 2867 2868 2869 2870 2871 2872 2873 2874 2875 2876 2877 2878 2879 2880 2881 2882 2883 2884 2885 2886 2887 2888 2889 2890 2891 2892 2893 2894 2895 2896 2897 2898 2899 2900 2901 2902 2903 2904 2905 2906 2907 2908 2909 2910 2911 2912 2913 2914 2915 2916 2917 2918
/**
 * i40e_vc_enable_vlan_stripping
 * @vf: pointer to the VF info
 * @msg: pointer to the msg buffer
 * @msglen: msg length
 *
 * Enable vlan header stripping for the VF
 **/
static int i40e_vc_enable_vlan_stripping(struct i40e_vf *vf, u8 *msg,
					 u16 msglen)
{
	struct i40e_vsi *vsi = vf->pf->vsi[vf->lan_vsi_idx];
	i40e_status aq_ret = 0;

	if (!test_bit(I40E_VF_STATE_ACTIVE, &vf->vf_states)) {
		aq_ret = I40E_ERR_PARAM;
		goto err;
	}

	i40e_vlan_stripping_enable(vsi);

	/* send the response to the VF */
err:
	return i40e_vc_send_resp_to_vf(vf, VIRTCHNL_OP_ENABLE_VLAN_STRIPPING,
				       aq_ret);
}

/**
 * i40e_vc_disable_vlan_stripping
 * @vf: pointer to the VF info
 * @msg: pointer to the msg buffer
 * @msglen: msg length
 *
 * Disable vlan header stripping for the VF
 **/
static int i40e_vc_disable_vlan_stripping(struct i40e_vf *vf, u8 *msg,
					  u16 msglen)
{
	struct i40e_vsi *vsi = vf->pf->vsi[vf->lan_vsi_idx];
	i40e_status aq_ret = 0;

	if (!test_bit(I40E_VF_STATE_ACTIVE, &vf->vf_states)) {
		aq_ret = I40E_ERR_PARAM;
		goto err;
	}

	i40e_vlan_stripping_disable(vsi);

	/* send the response to the VF */
err:
	return i40e_vc_send_resp_to_vf(vf, VIRTCHNL_OP_DISABLE_VLAN_STRIPPING,
				       aq_ret);
}

2919 2920 2921 2922 2923 2924 2925 2926 2927 2928 2929 2930 2931 2932 2933 2934 2935 2936 2937 2938 2939 2940 2941 2942 2943 2944 2945 2946 2947 2948 2949 2950 2951 2952 2953 2954 2955 2956 2957 2958 2959 2960 2961 2962 2963 2964 2965 2966 2967 2968 2969 2970 2971 2972 2973 2974 2975 2976 2977 2978 2979 2980 2981 2982 2983 2984 2985 2986 2987 2988 2989 2990 2991 2992 2993 2994 2995 2996 2997 2998 2999 3000 3001 3002 3003 3004 3005 3006 3007 3008 3009 3010 3011 3012 3013 3014 3015 3016 3017 3018 3019 3020 3021 3022 3023 3024 3025 3026 3027 3028 3029 3030 3031 3032 3033 3034 3035 3036 3037 3038 3039 3040 3041 3042 3043 3044 3045 3046 3047 3048 3049 3050 3051 3052 3053 3054 3055 3056 3057 3058 3059 3060 3061 3062 3063 3064
/**
 * i40e_validate_cloud_filter
 * @mask: mask for TC filter
 * @data: data for TC filter
 *
 * This function validates cloud filter programmed as TC filter for ADq
 **/
static int i40e_validate_cloud_filter(struct i40e_vf *vf,
				      struct virtchnl_filter *tc_filter)
{
	struct virtchnl_l4_spec mask = tc_filter->mask.tcp_spec;
	struct virtchnl_l4_spec data = tc_filter->data.tcp_spec;
	struct i40e_pf *pf = vf->pf;
	struct i40e_vsi *vsi = NULL;
	struct i40e_mac_filter *f;
	struct hlist_node *h;
	bool found = false;
	int bkt;

	if (!tc_filter->action) {
		dev_info(&pf->pdev->dev,
			 "VF %d: Currently ADq doesn't support Drop Action\n",
			 vf->vf_id);
		goto err;
	}

	/* action_meta is TC number here to which the filter is applied */
	if (!tc_filter->action_meta ||
	    tc_filter->action_meta > I40E_MAX_VF_VSI) {
		dev_info(&pf->pdev->dev, "VF %d: Invalid TC number %u\n",
			 vf->vf_id, tc_filter->action_meta);
		goto err;
	}

	/* Check filter if it's programmed for advanced mode or basic mode.
	 * There are two ADq modes (for VF only),
	 * 1. Basic mode: intended to allow as many filter options as possible
	 *		  to be added to a VF in Non-trusted mode. Main goal is
	 *		  to add filters to its own MAC and VLAN id.
	 * 2. Advanced mode: is for allowing filters to be applied other than
	 *		  its own MAC or VLAN. This mode requires the VF to be
	 *		  Trusted.
	 */
	if (mask.dst_mac[0] && !mask.dst_ip[0]) {
		vsi = pf->vsi[vf->lan_vsi_idx];
		f = i40e_find_mac(vsi, data.dst_mac);

		if (!f) {
			dev_info(&pf->pdev->dev,
				 "Destination MAC %pM doesn't belong to VF %d\n",
				 data.dst_mac, vf->vf_id);
			goto err;
		}

		if (mask.vlan_id) {
			hash_for_each_safe(vsi->mac_filter_hash, bkt, h, f,
					   hlist) {
				if (f->vlan == ntohs(data.vlan_id)) {
					found = true;
					break;
				}
			}
			if (!found) {
				dev_info(&pf->pdev->dev,
					 "VF %d doesn't have any VLAN id %u\n",
					 vf->vf_id, ntohs(data.vlan_id));
				goto err;
			}
		}
	} else {
		/* Check if VF is trusted */
		if (!test_bit(I40E_VIRTCHNL_VF_CAP_PRIVILEGE, &vf->vf_caps)) {
			dev_err(&pf->pdev->dev,
				"VF %d not trusted, make VF trusted to add advanced mode ADq cloud filters\n",
				vf->vf_id);
			return I40E_ERR_CONFIG;
		}
	}

	if (mask.dst_mac[0] & data.dst_mac[0]) {
		if (is_broadcast_ether_addr(data.dst_mac) ||
		    is_zero_ether_addr(data.dst_mac)) {
			dev_info(&pf->pdev->dev, "VF %d: Invalid Dest MAC addr %pM\n",
				 vf->vf_id, data.dst_mac);
			goto err;
		}
	}

	if (mask.src_mac[0] & data.src_mac[0]) {
		if (is_broadcast_ether_addr(data.src_mac) ||
		    is_zero_ether_addr(data.src_mac)) {
			dev_info(&pf->pdev->dev, "VF %d: Invalid Source MAC addr %pM\n",
				 vf->vf_id, data.src_mac);
			goto err;
		}
	}

	if (mask.dst_port & data.dst_port) {
		if (!data.dst_port || be16_to_cpu(data.dst_port) > 0xFFFF) {
			dev_info(&pf->pdev->dev, "VF %d: Invalid Dest port\n",
				 vf->vf_id);
			goto err;
		}
	}

	if (mask.src_port & data.src_port) {
		if (!data.src_port || be16_to_cpu(data.src_port) > 0xFFFF) {
			dev_info(&pf->pdev->dev, "VF %d: Invalid Source port\n",
				 vf->vf_id);
			goto err;
		}
	}

	if (tc_filter->flow_type != VIRTCHNL_TCP_V6_FLOW &&
	    tc_filter->flow_type != VIRTCHNL_TCP_V4_FLOW) {
		dev_info(&pf->pdev->dev, "VF %d: Invalid Flow type\n",
			 vf->vf_id);
		goto err;
	}

	if (mask.vlan_id & data.vlan_id) {
		if (ntohs(data.vlan_id) > I40E_MAX_VLANID) {
			dev_info(&pf->pdev->dev, "VF %d: invalid VLAN ID\n",
				 vf->vf_id);
			goto err;
		}
	}

	return I40E_SUCCESS;
err:
	return I40E_ERR_CONFIG;
}

/**
 * i40e_find_vsi_from_seid - searches for the vsi with the given seid
 * @vf: pointer to the VF info
 * @seid - seid of the vsi it is searching for
 **/
static struct i40e_vsi *i40e_find_vsi_from_seid(struct i40e_vf *vf, u16 seid)
{
	struct i40e_pf *pf = vf->pf;
	struct i40e_vsi *vsi = NULL;
	int i;

	for (i = 0; i < vf->num_tc ; i++) {
		vsi = i40e_find_vsi_from_id(pf, vf->ch[i].vsi_id);
3065
		if (vsi && vsi->seid == seid)
3066 3067 3068 3069 3070 3071 3072 3073 3074 3075 3076 3077 3078 3079 3080 3081 3082 3083 3084 3085 3086 3087 3088 3089 3090 3091 3092 3093 3094 3095 3096 3097 3098 3099 3100 3101 3102 3103 3104 3105 3106 3107 3108 3109 3110 3111 3112 3113 3114 3115 3116 3117 3118 3119 3120 3121 3122 3123 3124 3125 3126 3127 3128 3129 3130 3131 3132 3133 3134 3135 3136 3137 3138 3139 3140 3141 3142 3143 3144 3145 3146 3147 3148
			return vsi;
	}
	return NULL;
}

/**
 * i40e_del_all_cloud_filters
 * @vf: pointer to the VF info
 *
 * This function deletes all cloud filters
 **/
static void i40e_del_all_cloud_filters(struct i40e_vf *vf)
{
	struct i40e_cloud_filter *cfilter = NULL;
	struct i40e_pf *pf = vf->pf;
	struct i40e_vsi *vsi = NULL;
	struct hlist_node *node;
	int ret;

	hlist_for_each_entry_safe(cfilter, node,
				  &vf->cloud_filter_list, cloud_node) {
		vsi = i40e_find_vsi_from_seid(vf, cfilter->seid);

		if (!vsi) {
			dev_err(&pf->pdev->dev, "VF %d: no VSI found for matching %u seid, can't delete cloud filter\n",
				vf->vf_id, cfilter->seid);
			continue;
		}

		if (cfilter->dst_port)
			ret = i40e_add_del_cloud_filter_big_buf(vsi, cfilter,
								false);
		else
			ret = i40e_add_del_cloud_filter(vsi, cfilter, false);
		if (ret)
			dev_err(&pf->pdev->dev,
				"VF %d: Failed to delete cloud filter, err %s aq_err %s\n",
				vf->vf_id, i40e_stat_str(&pf->hw, ret),
				i40e_aq_str(&pf->hw,
					    pf->hw.aq.asq_last_status));

		hlist_del(&cfilter->cloud_node);
		kfree(cfilter);
		vf->num_cloud_filters--;
	}
}

/**
 * i40e_vc_del_cloud_filter
 * @vf: pointer to the VF info
 * @msg: pointer to the msg buffer
 *
 * This function deletes a cloud filter programmed as TC filter for ADq
 **/
static int i40e_vc_del_cloud_filter(struct i40e_vf *vf, u8 *msg)
{
	struct virtchnl_filter *vcf = (struct virtchnl_filter *)msg;
	struct virtchnl_l4_spec mask = vcf->mask.tcp_spec;
	struct virtchnl_l4_spec tcf = vcf->data.tcp_spec;
	struct i40e_cloud_filter cfilter, *cf = NULL;
	struct i40e_pf *pf = vf->pf;
	struct i40e_vsi *vsi = NULL;
	struct hlist_node *node;
	i40e_status aq_ret = 0;
	int i, ret;

	if (!test_bit(I40E_VF_STATE_ACTIVE, &vf->vf_states)) {
		aq_ret = I40E_ERR_PARAM;
		goto err;
	}

	if (!vf->adq_enabled) {
		dev_info(&pf->pdev->dev,
			 "VF %d: ADq not enabled, can't apply cloud filter\n",
			 vf->vf_id);
		aq_ret = I40E_ERR_PARAM;
		goto err;
	}

	if (i40e_validate_cloud_filter(vf, vcf)) {
		dev_info(&pf->pdev->dev,
			 "VF %d: Invalid input, can't apply cloud filter\n",
			 vf->vf_id);
3149 3150
		aq_ret = I40E_ERR_PARAM;
		goto err;
3151 3152 3153 3154 3155 3156 3157 3158 3159 3160 3161 3162 3163 3164 3165 3166 3167 3168 3169 3170 3171 3172 3173 3174 3175 3176 3177 3178 3179 3180 3181 3182 3183 3184 3185 3186 3187 3188 3189 3190 3191 3192 3193 3194 3195 3196 3197 3198 3199 3200 3201 3202 3203 3204 3205 3206 3207 3208 3209 3210 3211 3212 3213 3214 3215 3216 3217 3218 3219 3220 3221 3222 3223 3224 3225 3226 3227 3228 3229 3230 3231 3232 3233 3234 3235 3236 3237 3238 3239 3240 3241 3242 3243 3244 3245 3246 3247 3248 3249 3250 3251 3252 3253 3254 3255 3256 3257 3258 3259 3260 3261 3262 3263 3264 3265 3266 3267 3268 3269 3270 3271 3272 3273 3274 3275 3276 3277 3278 3279 3280 3281 3282 3283 3284 3285 3286 3287 3288 3289 3290 3291 3292 3293 3294 3295 3296 3297 3298 3299 3300 3301 3302 3303 3304 3305 3306 3307 3308 3309 3310 3311 3312 3313 3314 3315 3316 3317 3318 3319 3320 3321 3322 3323 3324 3325 3326 3327 3328 3329 3330 3331 3332 3333 3334 3335 3336 3337 3338 3339 3340 3341 3342 3343 3344 3345 3346 3347 3348 3349 3350 3351 3352
	}

	memset(&cfilter, 0, sizeof(cfilter));
	/* parse destination mac address */
	for (i = 0; i < ETH_ALEN; i++)
		cfilter.dst_mac[i] = mask.dst_mac[i] & tcf.dst_mac[i];

	/* parse source mac address */
	for (i = 0; i < ETH_ALEN; i++)
		cfilter.src_mac[i] = mask.src_mac[i] & tcf.src_mac[i];

	cfilter.vlan_id = mask.vlan_id & tcf.vlan_id;
	cfilter.dst_port = mask.dst_port & tcf.dst_port;
	cfilter.src_port = mask.src_port & tcf.src_port;

	switch (vcf->flow_type) {
	case VIRTCHNL_TCP_V4_FLOW:
		cfilter.n_proto = ETH_P_IP;
		if (mask.dst_ip[0] & tcf.dst_ip[0])
			memcpy(&cfilter.ip.v4.dst_ip, tcf.dst_ip,
			       ARRAY_SIZE(tcf.dst_ip));
		else if (mask.src_ip[0] & tcf.dst_ip[0])
			memcpy(&cfilter.ip.v4.src_ip, tcf.src_ip,
			       ARRAY_SIZE(tcf.dst_ip));
		break;
	case VIRTCHNL_TCP_V6_FLOW:
		cfilter.n_proto = ETH_P_IPV6;
		if (mask.dst_ip[3] & tcf.dst_ip[3])
			memcpy(&cfilter.ip.v6.dst_ip6, tcf.dst_ip,
			       sizeof(cfilter.ip.v6.dst_ip6));
		if (mask.src_ip[3] & tcf.src_ip[3])
			memcpy(&cfilter.ip.v6.src_ip6, tcf.src_ip,
			       sizeof(cfilter.ip.v6.src_ip6));
		break;
	default:
		/* TC filter can be configured based on different combinations
		 * and in this case IP is not a part of filter config
		 */
		dev_info(&pf->pdev->dev, "VF %d: Flow type not configured\n",
			 vf->vf_id);
	}

	/* get the vsi to which the tc belongs to */
	vsi = pf->vsi[vf->ch[vcf->action_meta].vsi_idx];
	cfilter.seid = vsi->seid;
	cfilter.flags = vcf->field_flags;

	/* Deleting TC filter */
	if (tcf.dst_port)
		ret = i40e_add_del_cloud_filter_big_buf(vsi, &cfilter, false);
	else
		ret = i40e_add_del_cloud_filter(vsi, &cfilter, false);
	if (ret) {
		dev_err(&pf->pdev->dev,
			"VF %d: Failed to delete cloud filter, err %s aq_err %s\n",
			vf->vf_id, i40e_stat_str(&pf->hw, ret),
			i40e_aq_str(&pf->hw, pf->hw.aq.asq_last_status));
		goto err;
	}

	hlist_for_each_entry_safe(cf, node,
				  &vf->cloud_filter_list, cloud_node) {
		if (cf->seid != cfilter.seid)
			continue;
		if (mask.dst_port)
			if (cfilter.dst_port != cf->dst_port)
				continue;
		if (mask.dst_mac[0])
			if (!ether_addr_equal(cf->src_mac, cfilter.src_mac))
				continue;
		/* for ipv4 data to be valid, only first byte of mask is set */
		if (cfilter.n_proto == ETH_P_IP && mask.dst_ip[0])
			if (memcmp(&cfilter.ip.v4.dst_ip, &cf->ip.v4.dst_ip,
				   ARRAY_SIZE(tcf.dst_ip)))
				continue;
		/* for ipv6, mask is set for all sixteen bytes (4 words) */
		if (cfilter.n_proto == ETH_P_IPV6 && mask.dst_ip[3])
			if (memcmp(&cfilter.ip.v6.dst_ip6, &cf->ip.v6.dst_ip6,
				   sizeof(cfilter.ip.v6.src_ip6)))
				continue;
		if (mask.vlan_id)
			if (cfilter.vlan_id != cf->vlan_id)
				continue;

		hlist_del(&cf->cloud_node);
		kfree(cf);
		vf->num_cloud_filters--;
	}

err:
	return i40e_vc_send_resp_to_vf(vf, VIRTCHNL_OP_DEL_CLOUD_FILTER,
				       aq_ret);
}

/**
 * i40e_vc_add_cloud_filter
 * @vf: pointer to the VF info
 * @msg: pointer to the msg buffer
 *
 * This function adds a cloud filter programmed as TC filter for ADq
 **/
static int i40e_vc_add_cloud_filter(struct i40e_vf *vf, u8 *msg)
{
	struct virtchnl_filter *vcf = (struct virtchnl_filter *)msg;
	struct virtchnl_l4_spec mask = vcf->mask.tcp_spec;
	struct virtchnl_l4_spec tcf = vcf->data.tcp_spec;
	struct i40e_cloud_filter *cfilter = NULL;
	struct i40e_pf *pf = vf->pf;
	struct i40e_vsi *vsi = NULL;
	i40e_status aq_ret = 0;
	int i, ret;

	if (!test_bit(I40E_VF_STATE_ACTIVE, &vf->vf_states)) {
		aq_ret = I40E_ERR_PARAM;
		goto err;
	}

	if (!vf->adq_enabled) {
		dev_info(&pf->pdev->dev,
			 "VF %d: ADq is not enabled, can't apply cloud filter\n",
			 vf->vf_id);
		aq_ret = I40E_ERR_PARAM;
		goto err;
	}

	if (i40e_validate_cloud_filter(vf, vcf)) {
		dev_info(&pf->pdev->dev,
			 "VF %d: Invalid input/s, can't apply cloud filter\n",
			 vf->vf_id);
			aq_ret = I40E_ERR_PARAM;
			goto err;
	}

	cfilter = kzalloc(sizeof(*cfilter), GFP_KERNEL);
	if (!cfilter)
		return -ENOMEM;

	/* parse destination mac address */
	for (i = 0; i < ETH_ALEN; i++)
		cfilter->dst_mac[i] = mask.dst_mac[i] & tcf.dst_mac[i];

	/* parse source mac address */
	for (i = 0; i < ETH_ALEN; i++)
		cfilter->src_mac[i] = mask.src_mac[i] & tcf.src_mac[i];

	cfilter->vlan_id = mask.vlan_id & tcf.vlan_id;
	cfilter->dst_port = mask.dst_port & tcf.dst_port;
	cfilter->src_port = mask.src_port & tcf.src_port;

	switch (vcf->flow_type) {
	case VIRTCHNL_TCP_V4_FLOW:
		cfilter->n_proto = ETH_P_IP;
		if (mask.dst_ip[0] & tcf.dst_ip[0])
			memcpy(&cfilter->ip.v4.dst_ip, tcf.dst_ip,
			       ARRAY_SIZE(tcf.dst_ip));
		else if (mask.src_ip[0] & tcf.dst_ip[0])
			memcpy(&cfilter->ip.v4.src_ip, tcf.src_ip,
			       ARRAY_SIZE(tcf.dst_ip));
		break;
	case VIRTCHNL_TCP_V6_FLOW:
		cfilter->n_proto = ETH_P_IPV6;
		if (mask.dst_ip[3] & tcf.dst_ip[3])
			memcpy(&cfilter->ip.v6.dst_ip6, tcf.dst_ip,
			       sizeof(cfilter->ip.v6.dst_ip6));
		if (mask.src_ip[3] & tcf.src_ip[3])
			memcpy(&cfilter->ip.v6.src_ip6, tcf.src_ip,
			       sizeof(cfilter->ip.v6.src_ip6));
		break;
	default:
		/* TC filter can be configured based on different combinations
		 * and in this case IP is not a part of filter config
		 */
		dev_info(&pf->pdev->dev, "VF %d: Flow type not configured\n",
			 vf->vf_id);
	}

	/* get the VSI to which the TC belongs to */
	vsi = pf->vsi[vf->ch[vcf->action_meta].vsi_idx];
	cfilter->seid = vsi->seid;
	cfilter->flags = vcf->field_flags;

	/* Adding cloud filter programmed as TC filter */
	if (tcf.dst_port)
		ret = i40e_add_del_cloud_filter_big_buf(vsi, cfilter, true);
	else
		ret = i40e_add_del_cloud_filter(vsi, cfilter, true);
	if (ret) {
		dev_err(&pf->pdev->dev,
			"VF %d: Failed to add cloud filter, err %s aq_err %s\n",
			vf->vf_id, i40e_stat_str(&pf->hw, ret),
			i40e_aq_str(&pf->hw, pf->hw.aq.asq_last_status));
		goto err;
	}

	INIT_HLIST_NODE(&cfilter->cloud_node);
	hlist_add_head(&cfilter->cloud_node, &vf->cloud_filter_list);
	vf->num_cloud_filters++;
err:
	return i40e_vc_send_resp_to_vf(vf, VIRTCHNL_OP_ADD_CLOUD_FILTER,
				       aq_ret);
}

3353 3354 3355 3356 3357 3358 3359 3360 3361 3362
/**
 * i40e_vc_add_qch_msg: Add queue channel and enable ADq
 * @vf: pointer to the VF info
 * @msg: pointer to the msg buffer
 **/
static int i40e_vc_add_qch_msg(struct i40e_vf *vf, u8 *msg)
{
	struct virtchnl_tc_info *tci =
		(struct virtchnl_tc_info *)msg;
	struct i40e_pf *pf = vf->pf;
3363 3364
	struct i40e_link_status *ls = &pf->hw.phy.link_info;
	int i, adq_request_qps = 0, speed = 0;
3365 3366 3367 3368 3369 3370 3371 3372 3373 3374 3375 3376 3377 3378 3379 3380 3381 3382 3383 3384 3385 3386 3387 3388 3389 3390 3391 3392 3393 3394 3395 3396 3397 3398 3399 3400 3401 3402 3403 3404 3405 3406 3407 3408 3409 3410 3411 3412 3413 3414 3415 3416 3417 3418 3419 3420 3421 3422 3423 3424
	i40e_status aq_ret = 0;

	if (!test_bit(I40E_VF_STATE_ACTIVE, &vf->vf_states)) {
		aq_ret = I40E_ERR_PARAM;
		goto err;
	}

	/* ADq cannot be applied if spoof check is ON */
	if (vf->spoofchk) {
		dev_err(&pf->pdev->dev,
			"Spoof check is ON, turn it OFF to enable ADq\n");
		aq_ret = I40E_ERR_PARAM;
		goto err;
	}

	if (!(vf->driver_caps & VIRTCHNL_VF_OFFLOAD_ADQ)) {
		dev_err(&pf->pdev->dev,
			"VF %d attempting to enable ADq, but hasn't properly negotiated that capability\n",
			vf->vf_id);
		aq_ret = I40E_ERR_PARAM;
		goto err;
	}

	/* max number of traffic classes for VF currently capped at 4 */
	if (!tci->num_tc || tci->num_tc > I40E_MAX_VF_VSI) {
		dev_err(&pf->pdev->dev,
			"VF %d trying to set %u TCs, valid range 1-4 TCs per VF\n",
			vf->vf_id, tci->num_tc);
		aq_ret = I40E_ERR_PARAM;
		goto err;
	}

	/* validate queues for each TC */
	for (i = 0; i < tci->num_tc; i++)
		if (!tci->list[i].count ||
		    tci->list[i].count > I40E_DEFAULT_QUEUES_PER_VF) {
			dev_err(&pf->pdev->dev,
				"VF %d: TC %d trying to set %u queues, valid range 1-4 queues per TC\n",
				vf->vf_id, i, tci->list[i].count);
			aq_ret = I40E_ERR_PARAM;
			goto err;
		}

	/* need Max VF queues but already have default number of queues */
	adq_request_qps = I40E_MAX_VF_QUEUES - I40E_DEFAULT_QUEUES_PER_VF;

	if (pf->queues_left < adq_request_qps) {
		dev_err(&pf->pdev->dev,
			"No queues left to allocate to VF %d\n",
			vf->vf_id);
		aq_ret = I40E_ERR_PARAM;
		goto err;
	} else {
		/* we need to allocate max VF queues to enable ADq so as to
		 * make sure ADq enabled VF always gets back queues when it
		 * goes through a reset.
		 */
		vf->num_queue_pairs = I40E_MAX_VF_QUEUES;
	}

3425 3426 3427 3428 3429 3430 3431 3432 3433 3434 3435 3436 3437 3438 3439 3440 3441 3442 3443 3444 3445 3446 3447 3448 3449 3450 3451
	/* get link speed in MB to validate rate limit */
	switch (ls->link_speed) {
	case VIRTCHNL_LINK_SPEED_100MB:
		speed = SPEED_100;
		break;
	case VIRTCHNL_LINK_SPEED_1GB:
		speed = SPEED_1000;
		break;
	case VIRTCHNL_LINK_SPEED_10GB:
		speed = SPEED_10000;
		break;
	case VIRTCHNL_LINK_SPEED_20GB:
		speed = SPEED_20000;
		break;
	case VIRTCHNL_LINK_SPEED_25GB:
		speed = SPEED_25000;
		break;
	case VIRTCHNL_LINK_SPEED_40GB:
		speed = SPEED_40000;
		break;
	default:
		dev_err(&pf->pdev->dev,
			"Cannot detect link speed\n");
		aq_ret = I40E_ERR_PARAM;
		goto err;
	}

3452 3453
	/* parse data from the queue channel info */
	vf->num_tc = tci->num_tc;
3454 3455 3456 3457 3458 3459 3460 3461 3462 3463 3464 3465 3466 3467
	for (i = 0; i < vf->num_tc; i++) {
		if (tci->list[i].max_tx_rate) {
			if (tci->list[i].max_tx_rate > speed) {
				dev_err(&pf->pdev->dev,
					"Invalid max tx rate %llu specified for VF %d.",
					tci->list[i].max_tx_rate,
					vf->vf_id);
				aq_ret = I40E_ERR_PARAM;
				goto err;
			} else {
				vf->ch[i].max_tx_rate =
					tci->list[i].max_tx_rate;
			}
		}
3468
		vf->ch[i].num_qps = tci->list[i].count;
3469
	}
3470 3471 3472

	/* set this flag only after making sure all inputs are sane */
	vf->adq_enabled = true;
3473 3474 3475 3476 3477
	/* num_req_queues is set when user changes number of queues via ethtool
	 * and this causes issue for default VSI(which depends on this variable)
	 * when ADq is enabled, hence reset it.
	 */
	vf->num_req_queues = 0;
3478 3479 3480 3481 3482 3483 3484 3485 3486 3487 3488 3489 3490

	/* reset the VF in order to allocate resources */
	i40e_vc_notify_vf_reset(vf);
	i40e_reset_vf(vf, false);

	return I40E_SUCCESS;

	/* send the response to the VF */
err:
	return i40e_vc_send_resp_to_vf(vf, VIRTCHNL_OP_ENABLE_CHANNELS,
				       aq_ret);
}

3491 3492 3493 3494 3495 3496 3497 3498 3499 3500 3501 3502 3503 3504 3505 3506
/**
 * i40e_vc_del_qch_msg
 * @vf: pointer to the VF info
 * @msg: pointer to the msg buffer
 **/
static int i40e_vc_del_qch_msg(struct i40e_vf *vf, u8 *msg)
{
	struct i40e_pf *pf = vf->pf;
	i40e_status aq_ret = 0;

	if (!test_bit(I40E_VF_STATE_ACTIVE, &vf->vf_states)) {
		aq_ret = I40E_ERR_PARAM;
		goto err;
	}

	if (vf->adq_enabled) {
3507
		i40e_del_all_cloud_filters(vf);
3508 3509 3510 3511
		i40e_del_qch(vf);
		vf->adq_enabled = false;
		vf->num_tc = 0;
		dev_info(&pf->pdev->dev,
3512
			 "Deleting Queue Channels and cloud filters for ADq on VF %d\n",
3513 3514 3515 3516 3517 3518 3519 3520 3521 3522 3523 3524 3525 3526 3527 3528 3529 3530
			 vf->vf_id);
	} else {
		dev_info(&pf->pdev->dev, "VF %d trying to delete queue channels but ADq isn't enabled\n",
			 vf->vf_id);
		aq_ret = I40E_ERR_PARAM;
	}

	/* reset the VF in order to allocate resources */
	i40e_vc_notify_vf_reset(vf);
	i40e_reset_vf(vf, false);

	return I40E_SUCCESS;

err:
	return i40e_vc_send_resp_to_vf(vf, VIRTCHNL_OP_DISABLE_CHANNELS,
				       aq_ret);
}

3531 3532
/**
 * i40e_vc_process_vf_msg
3533 3534
 * @pf: pointer to the PF structure
 * @vf_id: source VF id
3535 3536 3537 3538 3539
 * @msg: pointer to the msg buffer
 * @msglen: msg length
 * @msghndl: msg handle
 *
 * called from the common aeq/arq handler to
3540
 * process request from VF
3541
 **/
3542
int i40e_vc_process_vf_msg(struct i40e_pf *pf, s16 vf_id, u32 v_opcode,
3543 3544 3545
			   u32 v_retval, u8 *msg, u16 msglen)
{
	struct i40e_hw *hw = &pf->hw;
3546
	int local_vf_id = vf_id - (s16)hw->func_caps.vf_base_id;
3547
	struct i40e_vf *vf;
3548 3549 3550
	int ret;

	pf->vf_aq_requests++;
3551
	if (local_vf_id >= pf->num_alloc_vfs)
3552
		return -EINVAL;
3553
	vf = &(pf->vf[local_vf_id]);
3554 3555 3556 3557 3558

	/* Check if VF is disabled. */
	if (test_bit(I40E_VF_STATE_DISABLED, &vf->vf_states))
		return I40E_ERR_PARAM;

3559
	/* perform basic checks on the msg */
3560
	ret = virtchnl_vc_validate_vf_msg(&vf->vf_ver, v_opcode, msg, msglen);
3561

3562 3563 3564 3565 3566 3567 3568 3569 3570 3571 3572 3573 3574
	/* perform additional checks specific to this driver */
	if (v_opcode == VIRTCHNL_OP_CONFIG_RSS_KEY) {
		struct virtchnl_rss_key *vrk = (struct virtchnl_rss_key *)msg;

		if (vrk->key_len != I40E_HKEY_ARRAY_SIZE)
			ret = -EINVAL;
	} else if (v_opcode == VIRTCHNL_OP_CONFIG_RSS_LUT) {
		struct virtchnl_rss_lut *vrl = (struct virtchnl_rss_lut *)msg;

		if (vrl->lut_entries != I40E_VF_HLUT_ARRAY_SIZE)
			ret = -EINVAL;
	}

3575
	if (ret) {
3576
		i40e_vc_send_resp_to_vf(vf, v_opcode, I40E_ERR_PARAM);
3577
		dev_err(&pf->pdev->dev, "Invalid message from VF %d, opcode %d, len %d\n",
3578
			local_vf_id, v_opcode, msglen);
3579 3580 3581 3582 3583 3584
		switch (ret) {
		case VIRTCHNL_ERR_PARAM:
			return -EPERM;
		default:
			return -EINVAL;
		}
3585
	}
3586

3587
	switch (v_opcode) {
3588
	case VIRTCHNL_OP_VERSION:
3589
		ret = i40e_vc_get_version_msg(vf, msg);
3590
		break;
3591
	case VIRTCHNL_OP_GET_VF_RESOURCES:
3592
		ret = i40e_vc_get_vf_resources_msg(vf, msg);
3593
		i40e_vc_notify_vf_link_state(vf);
3594
		break;
3595
	case VIRTCHNL_OP_RESET_VF:
M
Mitch Williams 已提交
3596 3597
		i40e_vc_reset_vf_msg(vf);
		ret = 0;
3598
		break;
3599
	case VIRTCHNL_OP_CONFIG_PROMISCUOUS_MODE:
3600 3601
		ret = i40e_vc_config_promiscuous_mode_msg(vf, msg, msglen);
		break;
3602
	case VIRTCHNL_OP_CONFIG_VSI_QUEUES:
3603 3604
		ret = i40e_vc_config_queues_msg(vf, msg, msglen);
		break;
3605
	case VIRTCHNL_OP_CONFIG_IRQ_MAP:
3606 3607
		ret = i40e_vc_config_irq_map_msg(vf, msg, msglen);
		break;
3608
	case VIRTCHNL_OP_ENABLE_QUEUES:
3609
		ret = i40e_vc_enable_queues_msg(vf, msg, msglen);
M
Mitch Williams 已提交
3610
		i40e_vc_notify_vf_link_state(vf);
3611
		break;
3612
	case VIRTCHNL_OP_DISABLE_QUEUES:
3613 3614
		ret = i40e_vc_disable_queues_msg(vf, msg, msglen);
		break;
3615
	case VIRTCHNL_OP_ADD_ETH_ADDR:
3616 3617
		ret = i40e_vc_add_mac_addr_msg(vf, msg, msglen);
		break;
3618
	case VIRTCHNL_OP_DEL_ETH_ADDR:
3619 3620
		ret = i40e_vc_del_mac_addr_msg(vf, msg, msglen);
		break;
3621
	case VIRTCHNL_OP_ADD_VLAN:
3622 3623
		ret = i40e_vc_add_vlan_msg(vf, msg, msglen);
		break;
3624
	case VIRTCHNL_OP_DEL_VLAN:
3625 3626
		ret = i40e_vc_remove_vlan_msg(vf, msg, msglen);
		break;
3627
	case VIRTCHNL_OP_GET_STATS:
3628 3629
		ret = i40e_vc_get_stats_msg(vf, msg, msglen);
		break;
3630
	case VIRTCHNL_OP_IWARP:
3631 3632
		ret = i40e_vc_iwarp_msg(vf, msg, msglen);
		break;
3633
	case VIRTCHNL_OP_CONFIG_IWARP_IRQ_MAP:
3634 3635
		ret = i40e_vc_iwarp_qvmap_msg(vf, msg, msglen, true);
		break;
3636
	case VIRTCHNL_OP_RELEASE_IWARP_IRQ_MAP:
3637 3638
		ret = i40e_vc_iwarp_qvmap_msg(vf, msg, msglen, false);
		break;
3639
	case VIRTCHNL_OP_CONFIG_RSS_KEY:
3640 3641
		ret = i40e_vc_config_rss_key(vf, msg, msglen);
		break;
3642
	case VIRTCHNL_OP_CONFIG_RSS_LUT:
3643 3644
		ret = i40e_vc_config_rss_lut(vf, msg, msglen);
		break;
3645
	case VIRTCHNL_OP_GET_RSS_HENA_CAPS:
3646 3647
		ret = i40e_vc_get_rss_hena(vf, msg, msglen);
		break;
3648
	case VIRTCHNL_OP_SET_RSS_HENA:
3649 3650
		ret = i40e_vc_set_rss_hena(vf, msg, msglen);
		break;
3651 3652 3653 3654 3655 3656
	case VIRTCHNL_OP_ENABLE_VLAN_STRIPPING:
		ret = i40e_vc_enable_vlan_stripping(vf, msg, msglen);
		break;
	case VIRTCHNL_OP_DISABLE_VLAN_STRIPPING:
		ret = i40e_vc_disable_vlan_stripping(vf, msg, msglen);
		break;
3657 3658 3659
	case VIRTCHNL_OP_REQUEST_QUEUES:
		ret = i40e_vc_request_queues_msg(vf, msg, msglen);
		break;
3660 3661 3662
	case VIRTCHNL_OP_ENABLE_CHANNELS:
		ret = i40e_vc_add_qch_msg(vf, msg);
		break;
3663 3664 3665
	case VIRTCHNL_OP_DISABLE_CHANNELS:
		ret = i40e_vc_del_qch_msg(vf, msg);
		break;
3666 3667 3668 3669 3670 3671
	case VIRTCHNL_OP_ADD_CLOUD_FILTER:
		ret = i40e_vc_add_cloud_filter(vf, msg);
		break;
	case VIRTCHNL_OP_DEL_CLOUD_FILTER:
		ret = i40e_vc_del_cloud_filter(vf, msg);
		break;
3672
	case VIRTCHNL_OP_UNKNOWN:
3673
	default:
3674
		dev_err(&pf->pdev->dev, "Unsupported opcode %d from VF %d\n",
3675
			v_opcode, local_vf_id);
3676 3677 3678 3679 3680 3681 3682 3683 3684 3685
		ret = i40e_vc_send_resp_to_vf(vf, v_opcode,
					      I40E_ERR_NOT_IMPLEMENTED);
		break;
	}

	return ret;
}

/**
 * i40e_vc_process_vflr_event
3686
 * @pf: pointer to the PF structure
3687 3688
 *
 * called from the vlfr irq handler to
3689
 * free up VF resources and state variables
3690 3691 3692 3693
 **/
int i40e_vc_process_vflr_event(struct i40e_pf *pf)
{
	struct i40e_hw *hw = &pf->hw;
3694
	u32 reg, reg_idx, bit_idx;
3695
	struct i40e_vf *vf;
3696
	int vf_id;
3697

3698
	if (!test_bit(__I40E_VFLR_EVENT_PENDING, pf->state))
3699 3700
		return 0;

M
Mitch Williams 已提交
3701 3702 3703 3704 3705
	/* Re-enable the VFLR interrupt cause here, before looking for which
	 * VF got reset. Otherwise, if another VF gets a reset while the
	 * first one is being processed, that interrupt will be lost, and
	 * that VF will be stuck in reset forever.
	 */
3706 3707 3708 3709 3710
	reg = rd32(hw, I40E_PFINT_ICR0_ENA);
	reg |= I40E_PFINT_ICR0_ENA_VFLR_MASK;
	wr32(hw, I40E_PFINT_ICR0_ENA, reg);
	i40e_flush(hw);

3711
	clear_bit(__I40E_VFLR_EVENT_PENDING, pf->state);
3712 3713 3714
	for (vf_id = 0; vf_id < pf->num_alloc_vfs; vf_id++) {
		reg_idx = (hw->func_caps.vf_base_id + vf_id) / 32;
		bit_idx = (hw->func_caps.vf_base_id + vf_id) % 32;
3715
		/* read GLGEN_VFLRSTAT register to find out the flr VFs */
3716 3717
		vf = &pf->vf[vf_id];
		reg = rd32(hw, I40E_GLGEN_VFLRSTAT(reg_idx));
3718
		if (reg & BIT(bit_idx))
3719
			/* i40e_reset_vf will clear the bit in GLGEN_VFLRSTAT */
3720
			i40e_reset_vf(vf, true);
3721 3722 3723 3724 3725 3726 3727 3728
	}

	return 0;
}

/**
 * i40e_ndo_set_vf_mac
 * @netdev: network interface device structure
3729
 * @vf_id: VF identifier
3730 3731
 * @mac: mac address
 *
3732
 * program VF mac address
3733 3734 3735 3736 3737 3738 3739 3740 3741
 **/
int i40e_ndo_set_vf_mac(struct net_device *netdev, int vf_id, u8 *mac)
{
	struct i40e_netdev_priv *np = netdev_priv(netdev);
	struct i40e_vsi *vsi = np->vsi;
	struct i40e_pf *pf = vsi->back;
	struct i40e_mac_filter *f;
	struct i40e_vf *vf;
	int ret = 0;
3742
	struct hlist_node *h;
3743
	int bkt;
3744 3745 3746 3747 3748 3749 3750 3751 3752 3753

	/* validate the request */
	if (vf_id >= pf->num_alloc_vfs) {
		dev_err(&pf->pdev->dev,
			"Invalid VF Identifier %d\n", vf_id);
		ret = -EINVAL;
		goto error_param;
	}

	vf = &(pf->vf[vf_id]);
3754
	vsi = pf->vsi[vf->lan_vsi_idx];
3755
	if (!test_bit(I40E_VF_STATE_INIT, &vf->vf_states)) {
3756 3757 3758
		dev_err(&pf->pdev->dev, "VF %d still in reset. Try again.\n",
			vf_id);
		ret = -EAGAIN;
3759 3760 3761
		goto error_param;
	}

3762
	if (is_multicast_ether_addr(mac)) {
3763
		dev_err(&pf->pdev->dev,
3764
			"Invalid Ethernet address %pM for VF %d\n", mac, vf_id);
3765 3766 3767 3768
		ret = -EINVAL;
		goto error_param;
	}

K
Kiran Patil 已提交
3769
	/* Lock once because below invoked function add/del_filter requires
3770
	 * mac_filter_hash_lock to be held
K
Kiran Patil 已提交
3771
	 */
3772
	spin_lock_bh(&vsi->mac_filter_hash_lock);
K
Kiran Patil 已提交
3773

3774
	/* delete the temporary mac address */
3775
	if (!is_zero_ether_addr(vf->default_lan_addr.addr))
3776
		i40e_del_mac_filter(vsi, vf->default_lan_addr.addr);
3777

3778 3779 3780
	/* Delete all the filters for this VSI - we're going to kill it
	 * anyway.
	 */
3781
	hash_for_each_safe(vsi->mac_filter_hash, bkt, h, f, hlist)
3782
		__i40e_del_filter(vsi, f);
3783

3784
	spin_unlock_bh(&vsi->mac_filter_hash_lock);
K
Kiran Patil 已提交
3785

3786
	/* program mac filter */
J
Jesse Brandeburg 已提交
3787
	if (i40e_sync_vsi_filters(vsi)) {
3788 3789 3790 3791
		dev_err(&pf->pdev->dev, "Unable to program ucast filters\n");
		ret = -EIO;
		goto error_param;
	}
3792
	ether_addr_copy(vf->default_lan_addr.addr, mac);
3793 3794 3795 3796 3797 3798 3799 3800 3801 3802

	if (is_zero_ether_addr(mac)) {
		vf->pf_set_mac = false;
		dev_info(&pf->pdev->dev, "Removing MAC on VF %d\n", vf_id);
	} else {
		vf->pf_set_mac = true;
		dev_info(&pf->pdev->dev, "Setting MAC %pM on VF %d\n",
			 mac, vf_id);
	}

3803
	/* Force the VF driver stop so it has to reload with new MAC address */
3804
	i40e_vc_disable_vf(vf);
3805 3806 3807 3808 3809 3810
	dev_info(&pf->pdev->dev, "Reload the VF driver to make this change effective.\n");

error_param:
	return ret;
}

3811 3812 3813 3814 3815 3816 3817 3818 3819 3820 3821 3822 3823 3824 3825 3826 3827 3828 3829 3830 3831 3832 3833 3834 3835 3836 3837 3838
/**
 * i40e_vsi_has_vlans - True if VSI has configured VLANs
 * @vsi: pointer to the vsi
 *
 * Check if a VSI has configured any VLANs. False if we have a port VLAN or if
 * we have no configured VLANs. Do not call while holding the
 * mac_filter_hash_lock.
 */
static bool i40e_vsi_has_vlans(struct i40e_vsi *vsi)
{
	bool have_vlans;

	/* If we have a port VLAN, then the VSI cannot have any VLANs
	 * configured, as all MAC/VLAN filters will be assigned to the PVID.
	 */
	if (vsi->info.pvid)
		return false;

	/* Since we don't have a PVID, we know that if the device is in VLAN
	 * mode it must be because of a VLAN filter configured on this VSI.
	 */
	spin_lock_bh(&vsi->mac_filter_hash_lock);
	have_vlans = i40e_is_vsi_in_vlan(vsi);
	spin_unlock_bh(&vsi->mac_filter_hash_lock);

	return have_vlans;
}

3839 3840 3841
/**
 * i40e_ndo_set_vf_port_vlan
 * @netdev: network interface device structure
3842
 * @vf_id: VF identifier
3843 3844
 * @vlan_id: mac address
 * @qos: priority setting
3845
 * @vlan_proto: vlan protocol
3846
 *
3847
 * program VF vlan id and/or qos
3848
 **/
3849 3850
int i40e_ndo_set_vf_port_vlan(struct net_device *netdev, int vf_id,
			      u16 vlan_id, u8 qos, __be16 vlan_proto)
3851
{
3852
	u16 vlanprio = vlan_id | (qos << I40E_VLAN_PRIORITY_SHIFT);
3853 3854 3855 3856 3857 3858 3859 3860 3861 3862 3863 3864 3865 3866 3867 3868 3869 3870 3871
	struct i40e_netdev_priv *np = netdev_priv(netdev);
	struct i40e_pf *pf = np->vsi->back;
	struct i40e_vsi *vsi;
	struct i40e_vf *vf;
	int ret = 0;

	/* validate the request */
	if (vf_id >= pf->num_alloc_vfs) {
		dev_err(&pf->pdev->dev, "Invalid VF Identifier %d\n", vf_id);
		ret = -EINVAL;
		goto error_pvid;
	}

	if ((vlan_id > I40E_MAX_VLANID) || (qos > 7)) {
		dev_err(&pf->pdev->dev, "Invalid VF Parameters\n");
		ret = -EINVAL;
		goto error_pvid;
	}

3872 3873 3874 3875 3876 3877
	if (vlan_proto != htons(ETH_P_8021Q)) {
		dev_err(&pf->pdev->dev, "VF VLAN protocol is not supported\n");
		ret = -EPROTONOSUPPORT;
		goto error_pvid;
	}

3878
	vf = &(pf->vf[vf_id]);
3879
	vsi = pf->vsi[vf->lan_vsi_idx];
3880
	if (!test_bit(I40E_VF_STATE_INIT, &vf->vf_states)) {
3881 3882 3883
		dev_err(&pf->pdev->dev, "VF %d still in reset. Try again.\n",
			vf_id);
		ret = -EAGAIN;
3884 3885 3886
		goto error_pvid;
	}

3887
	if (le16_to_cpu(vsi->info.pvid) == vlanprio)
3888 3889 3890
		/* duplicate request, so just return success */
		goto error_pvid;

3891
	if (i40e_vsi_has_vlans(vsi)) {
3892 3893 3894
		dev_err(&pf->pdev->dev,
			"VF %d has already configured VLAN filters and the administrator is requesting a port VLAN override.\nPlease unload and reload the VF driver for this change to take effect.\n",
			vf_id);
3895 3896 3897 3898
		/* Administrator Error - knock the VF offline until he does
		 * the right thing by reconfiguring his network correctly
		 * and then reloading the VF driver.
		 */
3899
		i40e_vc_disable_vf(vf);
M
Mitch Williams 已提交
3900 3901
		/* During reset the VF got a new VSI, so refresh the pointer. */
		vsi = pf->vsi[vf->lan_vsi_idx];
3902
	}
3903

3904 3905 3906
	/* Locked once because multiple functions below iterate list */
	spin_lock_bh(&vsi->mac_filter_hash_lock);

3907 3908
	/* Check for condition where there was already a port VLAN ID
	 * filter set and now it is being deleted by setting it to zero.
3909 3910
	 * Additionally check for the condition where there was a port
	 * VLAN but now there is a new and different port VLAN being set.
3911 3912 3913 3914
	 * Before deleting all the old VLAN filters we must add new ones
	 * with -1 (I40E_VLAN_ANY) or otherwise we're left with all our
	 * MAC addresses deleted.
	 */
3915
	if ((!(vlan_id || qos) ||
3916
	    vlanprio != le16_to_cpu(vsi->info.pvid)) &&
3917 3918 3919 3920 3921 3922 3923 3924 3925 3926
	    vsi->info.pvid) {
		ret = i40e_add_vlan_all_mac(vsi, I40E_VLAN_ANY);
		if (ret) {
			dev_info(&vsi->back->pdev->dev,
				 "add VF VLAN failed, ret=%d aq_err=%d\n", ret,
				 vsi->back->hw.aq.asq_last_status);
			spin_unlock_bh(&vsi->mac_filter_hash_lock);
			goto error_pvid;
		}
	}
3927

3928
	if (vsi->info.pvid) {
3929 3930 3931
		/* remove all filters on the old VLAN */
		i40e_rm_vlan_all_mac(vsi, (le16_to_cpu(vsi->info.pvid) &
					   VLAN_VID_MASK));
3932
	}
3933

J
Jia-Ju Bai 已提交
3934
	spin_unlock_bh(&vsi->mac_filter_hash_lock);
3935
	if (vlan_id || qos)
3936
		ret = i40e_vsi_add_pvid(vsi, vlanprio);
3937
	else
G
Greg Rose 已提交
3938
		i40e_vsi_remove_pvid(vsi);
J
Jia-Ju Bai 已提交
3939
	spin_lock_bh(&vsi->mac_filter_hash_lock);
3940 3941 3942 3943 3944

	if (vlan_id) {
		dev_info(&pf->pdev->dev, "Setting VLAN %d, QOS 0x%x on VF %d\n",
			 vlan_id, qos, vf_id);

3945 3946
		/* add new VLAN filter for each MAC */
		ret = i40e_add_vlan_all_mac(vsi, vlan_id);
3947 3948 3949 3950
		if (ret) {
			dev_info(&vsi->back->pdev->dev,
				 "add VF VLAN failed, ret=%d aq_err=%d\n", ret,
				 vsi->back->hw.aq.asq_last_status);
3951
			spin_unlock_bh(&vsi->mac_filter_hash_lock);
3952 3953
			goto error_pvid;
		}
3954 3955 3956

		/* remove the previously added non-VLAN MAC filters */
		i40e_rm_vlan_all_mac(vsi, I40E_VLAN_ANY);
3957 3958
	}

3959 3960 3961 3962 3963
	spin_unlock_bh(&vsi->mac_filter_hash_lock);

	/* Schedule the worker thread to take care of applying changes */
	i40e_service_event_schedule(vsi->back);

3964 3965 3966 3967
	if (ret) {
		dev_err(&pf->pdev->dev, "Unable to update VF vsi context\n");
		goto error_pvid;
	}
3968

G
Greg Rose 已提交
3969 3970 3971 3972
	/* The Port VLAN needs to be saved across resets the same as the
	 * default LAN MAC address.
	 */
	vf->port_vlan_id = le16_to_cpu(vsi->info.pvid);
3973 3974 3975 3976 3977 3978 3979 3980 3981
	ret = 0;

error_pvid:
	return ret;
}

/**
 * i40e_ndo_set_vf_bw
 * @netdev: network interface device structure
3982 3983
 * @vf_id: VF identifier
 * @tx_rate: Tx rate
3984
 *
3985
 * configure VF Tx rate
3986
 **/
3987 3988
int i40e_ndo_set_vf_bw(struct net_device *netdev, int vf_id, int min_tx_rate,
		       int max_tx_rate)
3989
{
3990 3991 3992 3993 3994 3995 3996 3997 3998 3999 4000 4001 4002
	struct i40e_netdev_priv *np = netdev_priv(netdev);
	struct i40e_pf *pf = np->vsi->back;
	struct i40e_vsi *vsi;
	struct i40e_vf *vf;
	int ret = 0;

	/* validate the request */
	if (vf_id >= pf->num_alloc_vfs) {
		dev_err(&pf->pdev->dev, "Invalid VF Identifier %d.\n", vf_id);
		ret = -EINVAL;
		goto error;
	}

4003
	if (min_tx_rate) {
4004
		dev_err(&pf->pdev->dev, "Invalid min tx rate (%d) (greater than 0) specified for VF %d.\n",
4005 4006 4007 4008
			min_tx_rate, vf_id);
		return -EINVAL;
	}

4009
	vf = &(pf->vf[vf_id]);
4010
	vsi = pf->vsi[vf->lan_vsi_idx];
4011
	if (!test_bit(I40E_VF_STATE_INIT, &vf->vf_states)) {
4012 4013 4014
		dev_err(&pf->pdev->dev, "VF %d still in reset. Try again.\n",
			vf_id);
		ret = -EAGAIN;
4015 4016 4017
		goto error;
	}

4018 4019
	ret = i40e_set_bw_limit(vsi, vsi->seid, max_tx_rate);
	if (ret)
4020
		goto error;
4021

4022
	vf->tx_rate = max_tx_rate;
4023 4024
error:
	return ret;
4025 4026 4027 4028 4029
}

/**
 * i40e_ndo_get_vf_config
 * @netdev: network interface device structure
4030 4031
 * @vf_id: VF identifier
 * @ivi: VF configuration structure
4032
 *
4033
 * return VF configuration
4034 4035 4036 4037 4038 4039 4040 4041 4042 4043 4044 4045 4046 4047 4048 4049 4050 4051 4052
 **/
int i40e_ndo_get_vf_config(struct net_device *netdev,
			   int vf_id, struct ifla_vf_info *ivi)
{
	struct i40e_netdev_priv *np = netdev_priv(netdev);
	struct i40e_vsi *vsi = np->vsi;
	struct i40e_pf *pf = vsi->back;
	struct i40e_vf *vf;
	int ret = 0;

	/* validate the request */
	if (vf_id >= pf->num_alloc_vfs) {
		dev_err(&pf->pdev->dev, "Invalid VF Identifier %d\n", vf_id);
		ret = -EINVAL;
		goto error_param;
	}

	vf = &(pf->vf[vf_id]);
	/* first vsi is always the LAN vsi */
4053
	vsi = pf->vsi[vf->lan_vsi_idx];
4054
	if (!test_bit(I40E_VF_STATE_INIT, &vf->vf_states)) {
4055 4056 4057
		dev_err(&pf->pdev->dev, "VF %d still in reset. Try again.\n",
			vf_id);
		ret = -EAGAIN;
4058 4059 4060 4061 4062
		goto error_param;
	}

	ivi->vf = vf_id;

J
Jesse Brandeburg 已提交
4063
	ether_addr_copy(ivi->mac, vf->default_lan_addr.addr);
4064

4065 4066
	ivi->max_tx_rate = vf->tx_rate;
	ivi->min_tx_rate = 0;
4067 4068 4069
	ivi->vlan = le16_to_cpu(vsi->info.pvid) & I40E_VLAN_MASK;
	ivi->qos = (le16_to_cpu(vsi->info.pvid) & I40E_PRIORITY_MASK) >>
		   I40E_VLAN_PRIORITY_SHIFT;
4070 4071 4072 4073 4074 4075
	if (vf->link_forced == false)
		ivi->linkstate = IFLA_VF_LINK_STATE_AUTO;
	else if (vf->link_up == true)
		ivi->linkstate = IFLA_VF_LINK_STATE_ENABLE;
	else
		ivi->linkstate = IFLA_VF_LINK_STATE_DISABLE;
4076
	ivi->spoofchk = vf->spoofchk;
4077
	ivi->trusted = vf->trusted;
4078 4079 4080 4081 4082
	ret = 0;

error_param:
	return ret;
}
M
Mitch Williams 已提交
4083 4084 4085 4086

/**
 * i40e_ndo_set_vf_link_state
 * @netdev: network interface device structure
4087
 * @vf_id: VF identifier
M
Mitch Williams 已提交
4088 4089 4090 4091 4092 4093 4094 4095
 * @link: required link state
 *
 * Set the link state of a specified VF, regardless of physical link state
 **/
int i40e_ndo_set_vf_link_state(struct net_device *netdev, int vf_id, int link)
{
	struct i40e_netdev_priv *np = netdev_priv(netdev);
	struct i40e_pf *pf = np->vsi->back;
4096
	struct virtchnl_pf_event pfe;
M
Mitch Williams 已提交
4097 4098
	struct i40e_hw *hw = &pf->hw;
	struct i40e_vf *vf;
4099
	int abs_vf_id;
M
Mitch Williams 已提交
4100 4101 4102 4103 4104 4105 4106 4107 4108 4109
	int ret = 0;

	/* validate the request */
	if (vf_id >= pf->num_alloc_vfs) {
		dev_err(&pf->pdev->dev, "Invalid VF Identifier %d\n", vf_id);
		ret = -EINVAL;
		goto error_out;
	}

	vf = &pf->vf[vf_id];
4110
	abs_vf_id = vf->vf_id + hw->func_caps.vf_base_id;
M
Mitch Williams 已提交
4111

4112
	pfe.event = VIRTCHNL_EVENT_LINK_CHANGE;
4113
	pfe.severity = PF_EVENT_SEVERITY_INFO;
M
Mitch Williams 已提交
4114 4115 4116 4117 4118 4119 4120

	switch (link) {
	case IFLA_VF_LINK_STATE_AUTO:
		vf->link_forced = false;
		pfe.event_data.link_event.link_status =
			pf->hw.phy.link_info.link_info & I40E_AQ_LINK_UP;
		pfe.event_data.link_event.link_speed =
4121
			(enum virtchnl_link_speed)
M
Mitch Williams 已提交
4122 4123 4124 4125 4126 4127 4128 4129 4130 4131 4132 4133 4134 4135 4136 4137 4138 4139 4140
			pf->hw.phy.link_info.link_speed;
		break;
	case IFLA_VF_LINK_STATE_ENABLE:
		vf->link_forced = true;
		vf->link_up = true;
		pfe.event_data.link_event.link_status = true;
		pfe.event_data.link_event.link_speed = I40E_LINK_SPEED_40GB;
		break;
	case IFLA_VF_LINK_STATE_DISABLE:
		vf->link_forced = true;
		vf->link_up = false;
		pfe.event_data.link_event.link_status = false;
		pfe.event_data.link_event.link_speed = 0;
		break;
	default:
		ret = -EINVAL;
		goto error_out;
	}
	/* Notify the VF of its new link state */
4141
	i40e_aq_send_msg_to_vf(hw, abs_vf_id, VIRTCHNL_OP_EVENT,
M
Mitch Williams 已提交
4142 4143 4144 4145 4146
			       0, (u8 *)&pfe, sizeof(pfe), NULL);

error_out:
	return ret;
}
4147 4148 4149 4150

/**
 * i40e_ndo_set_vf_spoofchk
 * @netdev: network interface device structure
4151
 * @vf_id: VF identifier
4152 4153 4154 4155
 * @enable: flag to enable or disable feature
 *
 * Enable or disable VF spoof checking
 **/
4156
int i40e_ndo_set_vf_spoofchk(struct net_device *netdev, int vf_id, bool enable)
4157 4158 4159 4160 4161 4162 4163 4164 4165 4166 4167 4168 4169 4170 4171 4172 4173
{
	struct i40e_netdev_priv *np = netdev_priv(netdev);
	struct i40e_vsi *vsi = np->vsi;
	struct i40e_pf *pf = vsi->back;
	struct i40e_vsi_context ctxt;
	struct i40e_hw *hw = &pf->hw;
	struct i40e_vf *vf;
	int ret = 0;

	/* validate the request */
	if (vf_id >= pf->num_alloc_vfs) {
		dev_err(&pf->pdev->dev, "Invalid VF Identifier %d\n", vf_id);
		ret = -EINVAL;
		goto out;
	}

	vf = &(pf->vf[vf_id]);
4174
	if (!test_bit(I40E_VF_STATE_INIT, &vf->vf_states)) {
4175 4176 4177 4178 4179
		dev_err(&pf->pdev->dev, "VF %d still in reset. Try again.\n",
			vf_id);
		ret = -EAGAIN;
		goto out;
	}
4180 4181 4182 4183 4184 4185

	if (enable == vf->spoofchk)
		goto out;

	vf->spoofchk = enable;
	memset(&ctxt, 0, sizeof(ctxt));
4186
	ctxt.seid = pf->vsi[vf->lan_vsi_idx]->seid;
4187 4188 4189
	ctxt.pf_num = pf->hw.pf_id;
	ctxt.info.valid_sections = cpu_to_le16(I40E_AQ_VSI_PROP_SECURITY_VALID);
	if (enable)
G
Greg Rose 已提交
4190 4191
		ctxt.info.sec_flags |= (I40E_AQ_VSI_SEC_FLAG_ENABLE_VLAN_CHK |
					I40E_AQ_VSI_SEC_FLAG_ENABLE_MAC_CHK);
4192 4193 4194 4195 4196 4197 4198 4199 4200
	ret = i40e_aq_update_vsi_params(hw, &ctxt, NULL);
	if (ret) {
		dev_err(&pf->pdev->dev, "Error %d updating VSI parameters\n",
			ret);
		ret = -EIO;
	}
out:
	return ret;
}
4201 4202 4203 4204 4205 4206 4207 4208 4209 4210 4211 4212 4213 4214 4215 4216 4217 4218 4219 4220 4221 4222 4223 4224 4225 4226 4227 4228 4229 4230 4231 4232 4233

/**
 * i40e_ndo_set_vf_trust
 * @netdev: network interface device structure of the pf
 * @vf_id: VF identifier
 * @setting: trust setting
 *
 * Enable or disable VF trust setting
 **/
int i40e_ndo_set_vf_trust(struct net_device *netdev, int vf_id, bool setting)
{
	struct i40e_netdev_priv *np = netdev_priv(netdev);
	struct i40e_pf *pf = np->vsi->back;
	struct i40e_vf *vf;
	int ret = 0;

	/* validate the request */
	if (vf_id >= pf->num_alloc_vfs) {
		dev_err(&pf->pdev->dev, "Invalid VF Identifier %d\n", vf_id);
		return -EINVAL;
	}

	if (pf->flags & I40E_FLAG_MFP_ENABLED) {
		dev_err(&pf->pdev->dev, "Trusted VF not supported in MFP mode.\n");
		return -EINVAL;
	}

	vf = &pf->vf[vf_id];

	if (setting == vf->trusted)
		goto out;

	vf->trusted = setting;
4234
	i40e_vc_disable_vf(vf);
4235 4236
	dev_info(&pf->pdev->dev, "VF %u is now %strusted\n",
		 vf_id, setting ? "" : "un");
4237 4238 4239 4240 4241 4242 4243 4244 4245 4246

	if (vf->adq_enabled) {
		if (!vf->trusted) {
			dev_info(&pf->pdev->dev,
				 "VF %u no longer Trusted, deleting all cloud filters\n",
				 vf_id);
			i40e_del_all_cloud_filters(vf);
		}
	}

4247 4248 4249
out:
	return ret;
}