1458 lines
40 KiB
C
1458 lines
40 KiB
C
|
// SPDX-License-Identifier: GPL-2.0
|
||
|
/* Copyright(c) 2013 - 2018 Intel Corporation. */
|
||
|
|
||
|
#include "iavf.h"
|
||
|
#include "iavf_prototype.h"
|
||
|
#include "iavf_client.h"
|
||
|
|
||
|
/* busy wait delay in msec */
|
||
|
#define IAVF_BUSY_WAIT_DELAY 10
|
||
|
#define IAVF_BUSY_WAIT_COUNT 50
|
||
|
|
||
|
/**
|
||
|
* iavf_send_pf_msg
|
||
|
* @adapter: adapter structure
|
||
|
* @op: virtual channel opcode
|
||
|
* @msg: pointer to message buffer
|
||
|
* @len: message length
|
||
|
*
|
||
|
* Send message to PF and print status if failure.
|
||
|
**/
|
||
|
static int iavf_send_pf_msg(struct iavf_adapter *adapter,
|
||
|
enum virtchnl_ops op, u8 *msg, u16 len)
|
||
|
{
|
||
|
struct iavf_hw *hw = &adapter->hw;
|
||
|
enum iavf_status err;
|
||
|
|
||
|
if (adapter->flags & IAVF_FLAG_PF_COMMS_FAILED)
|
||
|
return 0; /* nothing to see here, move along */
|
||
|
|
||
|
err = iavf_aq_send_msg_to_pf(hw, op, 0, msg, len, NULL);
|
||
|
if (err)
|
||
|
dev_dbg(&adapter->pdev->dev, "Unable to send opcode %d to PF, err %s, aq_err %s\n",
|
||
|
op, iavf_stat_str(hw, err),
|
||
|
iavf_aq_str(hw, hw->aq.asq_last_status));
|
||
|
return err;
|
||
|
}
|
||
|
|
||
|
/**
|
||
|
* iavf_send_api_ver
|
||
|
* @adapter: adapter structure
|
||
|
*
|
||
|
* Send API version admin queue message to the PF. The reply is not checked
|
||
|
* in this function. Returns 0 if the message was successfully
|
||
|
* sent, or one of the IAVF_ADMIN_QUEUE_ERROR_ statuses if not.
|
||
|
**/
|
||
|
int iavf_send_api_ver(struct iavf_adapter *adapter)
|
||
|
{
|
||
|
struct virtchnl_version_info vvi;
|
||
|
|
||
|
vvi.major = VIRTCHNL_VERSION_MAJOR;
|
||
|
vvi.minor = VIRTCHNL_VERSION_MINOR;
|
||
|
|
||
|
return iavf_send_pf_msg(adapter, VIRTCHNL_OP_VERSION, (u8 *)&vvi,
|
||
|
sizeof(vvi));
|
||
|
}
|
||
|
|
||
|
/**
|
||
|
* iavf_verify_api_ver
|
||
|
* @adapter: adapter structure
|
||
|
*
|
||
|
* Compare API versions with the PF. Must be called after admin queue is
|
||
|
* initialized. Returns 0 if API versions match, -EIO if they do not,
|
||
|
* IAVF_ERR_ADMIN_QUEUE_NO_WORK if the admin queue is empty, and any errors
|
||
|
* from the firmware are propagated.
|
||
|
**/
|
||
|
int iavf_verify_api_ver(struct iavf_adapter *adapter)
|
||
|
{
|
||
|
struct virtchnl_version_info *pf_vvi;
|
||
|
struct iavf_hw *hw = &adapter->hw;
|
||
|
struct iavf_arq_event_info event;
|
||
|
enum virtchnl_ops op;
|
||
|
enum iavf_status err;
|
||
|
|
||
|
event.buf_len = IAVF_MAX_AQ_BUF_SIZE;
|
||
|
event.msg_buf = kzalloc(event.buf_len, GFP_KERNEL);
|
||
|
if (!event.msg_buf) {
|
||
|
err = -ENOMEM;
|
||
|
goto out;
|
||
|
}
|
||
|
|
||
|
while (1) {
|
||
|
err = iavf_clean_arq_element(hw, &event, NULL);
|
||
|
/* When the AQ is empty, iavf_clean_arq_element will return
|
||
|
* nonzero and this loop will terminate.
|
||
|
*/
|
||
|
if (err)
|
||
|
goto out_alloc;
|
||
|
op =
|
||
|
(enum virtchnl_ops)le32_to_cpu(event.desc.cookie_high);
|
||
|
if (op == VIRTCHNL_OP_VERSION)
|
||
|
break;
|
||
|
}
|
||
|
|
||
|
|
||
|
err = (enum iavf_status)le32_to_cpu(event.desc.cookie_low);
|
||
|
if (err)
|
||
|
goto out_alloc;
|
||
|
|
||
|
if (op != VIRTCHNL_OP_VERSION) {
|
||
|
dev_info(&adapter->pdev->dev, "Invalid reply type %d from PF\n",
|
||
|
op);
|
||
|
err = -EIO;
|
||
|
goto out_alloc;
|
||
|
}
|
||
|
|
||
|
pf_vvi = (struct virtchnl_version_info *)event.msg_buf;
|
||
|
adapter->pf_version = *pf_vvi;
|
||
|
|
||
|
if ((pf_vvi->major > VIRTCHNL_VERSION_MAJOR) ||
|
||
|
((pf_vvi->major == VIRTCHNL_VERSION_MAJOR) &&
|
||
|
(pf_vvi->minor > VIRTCHNL_VERSION_MINOR)))
|
||
|
err = -EIO;
|
||
|
|
||
|
out_alloc:
|
||
|
kfree(event.msg_buf);
|
||
|
out:
|
||
|
return err;
|
||
|
}
|
||
|
|
||
|
/**
|
||
|
* iavf_send_vf_config_msg
|
||
|
* @adapter: adapter structure
|
||
|
*
|
||
|
* Send VF configuration request admin queue message to the PF. The reply
|
||
|
* is not checked in this function. Returns 0 if the message was
|
||
|
* successfully sent, or one of the IAVF_ADMIN_QUEUE_ERROR_ statuses if not.
|
||
|
**/
|
||
|
int iavf_send_vf_config_msg(struct iavf_adapter *adapter)
|
||
|
{
|
||
|
u32 caps;
|
||
|
|
||
|
caps = VIRTCHNL_VF_OFFLOAD_L2 |
|
||
|
VIRTCHNL_VF_OFFLOAD_RSS_PF |
|
||
|
VIRTCHNL_VF_OFFLOAD_RSS_AQ |
|
||
|
VIRTCHNL_VF_OFFLOAD_RSS_REG |
|
||
|
VIRTCHNL_VF_OFFLOAD_VLAN |
|
||
|
VIRTCHNL_VF_OFFLOAD_WB_ON_ITR |
|
||
|
VIRTCHNL_VF_OFFLOAD_RSS_PCTYPE_V2 |
|
||
|
VIRTCHNL_VF_OFFLOAD_ENCAP |
|
||
|
VIRTCHNL_VF_OFFLOAD_ENCAP_CSUM |
|
||
|
VIRTCHNL_VF_OFFLOAD_REQ_QUEUES |
|
||
|
VIRTCHNL_VF_OFFLOAD_ADQ;
|
||
|
|
||
|
adapter->current_op = VIRTCHNL_OP_GET_VF_RESOURCES;
|
||
|
adapter->aq_required &= ~IAVF_FLAG_AQ_GET_CONFIG;
|
||
|
if (PF_IS_V11(adapter))
|
||
|
return iavf_send_pf_msg(adapter, VIRTCHNL_OP_GET_VF_RESOURCES,
|
||
|
(u8 *)&caps, sizeof(caps));
|
||
|
else
|
||
|
return iavf_send_pf_msg(adapter, VIRTCHNL_OP_GET_VF_RESOURCES,
|
||
|
NULL, 0);
|
||
|
}
|
||
|
|
||
|
/**
|
||
|
* iavf_validate_num_queues
|
||
|
* @adapter: adapter structure
|
||
|
*
|
||
|
* Validate that the number of queues the PF has sent in
|
||
|
* VIRTCHNL_OP_GET_VF_RESOURCES is not larger than the VF can handle.
|
||
|
**/
|
||
|
static void iavf_validate_num_queues(struct iavf_adapter *adapter)
|
||
|
{
|
||
|
if (adapter->vf_res->num_queue_pairs > IAVF_MAX_REQ_QUEUES) {
|
||
|
struct virtchnl_vsi_resource *vsi_res;
|
||
|
int i;
|
||
|
|
||
|
dev_info(&adapter->pdev->dev, "Received %d queues, but can only have a max of %d\n",
|
||
|
adapter->vf_res->num_queue_pairs,
|
||
|
IAVF_MAX_REQ_QUEUES);
|
||
|
dev_info(&adapter->pdev->dev, "Fixing by reducing queues to %d\n",
|
||
|
IAVF_MAX_REQ_QUEUES);
|
||
|
adapter->vf_res->num_queue_pairs = IAVF_MAX_REQ_QUEUES;
|
||
|
for (i = 0; i < adapter->vf_res->num_vsis; i++) {
|
||
|
vsi_res = &adapter->vf_res->vsi_res[i];
|
||
|
vsi_res->num_queue_pairs = IAVF_MAX_REQ_QUEUES;
|
||
|
}
|
||
|
}
|
||
|
}
|
||
|
|
||
|
/**
|
||
|
* iavf_get_vf_config
|
||
|
* @adapter: private adapter structure
|
||
|
*
|
||
|
* Get VF configuration from PF and populate hw structure. Must be called after
|
||
|
* admin queue is initialized. Busy waits until response is received from PF,
|
||
|
* with maximum timeout. Response from PF is returned in the buffer for further
|
||
|
* processing by the caller.
|
||
|
**/
|
||
|
int iavf_get_vf_config(struct iavf_adapter *adapter)
|
||
|
{
|
||
|
struct iavf_hw *hw = &adapter->hw;
|
||
|
struct iavf_arq_event_info event;
|
||
|
enum virtchnl_ops op;
|
||
|
enum iavf_status err;
|
||
|
u16 len;
|
||
|
|
||
|
len = sizeof(struct virtchnl_vf_resource) +
|
||
|
IAVF_MAX_VF_VSI * sizeof(struct virtchnl_vsi_resource);
|
||
|
event.buf_len = len;
|
||
|
event.msg_buf = kzalloc(event.buf_len, GFP_KERNEL);
|
||
|
if (!event.msg_buf) {
|
||
|
err = -ENOMEM;
|
||
|
goto out;
|
||
|
}
|
||
|
|
||
|
while (1) {
|
||
|
/* When the AQ is empty, iavf_clean_arq_element will return
|
||
|
* nonzero and this loop will terminate.
|
||
|
*/
|
||
|
err = iavf_clean_arq_element(hw, &event, NULL);
|
||
|
if (err)
|
||
|
goto out_alloc;
|
||
|
op =
|
||
|
(enum virtchnl_ops)le32_to_cpu(event.desc.cookie_high);
|
||
|
if (op == VIRTCHNL_OP_GET_VF_RESOURCES)
|
||
|
break;
|
||
|
}
|
||
|
|
||
|
err = (enum iavf_status)le32_to_cpu(event.desc.cookie_low);
|
||
|
memcpy(adapter->vf_res, event.msg_buf, min(event.msg_len, len));
|
||
|
|
||
|
/* some PFs send more queues than we should have so validate that
|
||
|
* we aren't getting too many queues
|
||
|
*/
|
||
|
if (!err)
|
||
|
iavf_validate_num_queues(adapter);
|
||
|
iavf_vf_parse_hw_config(hw, adapter->vf_res);
|
||
|
out_alloc:
|
||
|
kfree(event.msg_buf);
|
||
|
out:
|
||
|
return err;
|
||
|
}
|
||
|
|
||
|
/**
|
||
|
* iavf_configure_queues
|
||
|
* @adapter: adapter structure
|
||
|
*
|
||
|
* Request that the PF set up our (previously allocated) queues.
|
||
|
**/
|
||
|
void iavf_configure_queues(struct iavf_adapter *adapter)
|
||
|
{
|
||
|
struct virtchnl_vsi_queue_config_info *vqci;
|
||
|
struct virtchnl_queue_pair_info *vqpi;
|
||
|
int pairs = adapter->num_active_queues;
|
||
|
int i, max_frame = IAVF_MAX_RXBUFFER;
|
||
|
size_t len;
|
||
|
|
||
|
if (adapter->current_op != VIRTCHNL_OP_UNKNOWN) {
|
||
|
/* bail because we already have a command pending */
|
||
|
dev_err(&adapter->pdev->dev, "Cannot configure queues, command %d pending\n",
|
||
|
adapter->current_op);
|
||
|
return;
|
||
|
}
|
||
|
adapter->current_op = VIRTCHNL_OP_CONFIG_VSI_QUEUES;
|
||
|
len = struct_size(vqci, qpair, pairs);
|
||
|
vqci = kzalloc(len, GFP_KERNEL);
|
||
|
if (!vqci)
|
||
|
return;
|
||
|
|
||
|
/* Limit maximum frame size when jumbo frames is not enabled */
|
||
|
if (!(adapter->flags & IAVF_FLAG_LEGACY_RX) &&
|
||
|
(adapter->netdev->mtu <= ETH_DATA_LEN))
|
||
|
max_frame = IAVF_RXBUFFER_1536 - NET_IP_ALIGN;
|
||
|
|
||
|
vqci->vsi_id = adapter->vsi_res->vsi_id;
|
||
|
vqci->num_queue_pairs = pairs;
|
||
|
vqpi = vqci->qpair;
|
||
|
/* Size check is not needed here - HW max is 16 queue pairs, and we
|
||
|
* can fit info for 31 of them into the AQ buffer before it overflows.
|
||
|
*/
|
||
|
for (i = 0; i < pairs; i++) {
|
||
|
vqpi->txq.vsi_id = vqci->vsi_id;
|
||
|
vqpi->txq.queue_id = i;
|
||
|
vqpi->txq.ring_len = adapter->tx_rings[i].count;
|
||
|
vqpi->txq.dma_ring_addr = adapter->tx_rings[i].dma;
|
||
|
vqpi->rxq.vsi_id = vqci->vsi_id;
|
||
|
vqpi->rxq.queue_id = i;
|
||
|
vqpi->rxq.ring_len = adapter->rx_rings[i].count;
|
||
|
vqpi->rxq.dma_ring_addr = adapter->rx_rings[i].dma;
|
||
|
vqpi->rxq.max_pkt_size = max_frame;
|
||
|
vqpi->rxq.databuffer_size =
|
||
|
ALIGN(adapter->rx_rings[i].rx_buf_len,
|
||
|
BIT_ULL(IAVF_RXQ_CTX_DBUFF_SHIFT));
|
||
|
vqpi++;
|
||
|
}
|
||
|
|
||
|
adapter->aq_required &= ~IAVF_FLAG_AQ_CONFIGURE_QUEUES;
|
||
|
iavf_send_pf_msg(adapter, VIRTCHNL_OP_CONFIG_VSI_QUEUES,
|
||
|
(u8 *)vqci, len);
|
||
|
kfree(vqci);
|
||
|
}
|
||
|
|
||
|
/**
|
||
|
* iavf_enable_queues
|
||
|
* @adapter: adapter structure
|
||
|
*
|
||
|
* Request that the PF enable all of our queues.
|
||
|
**/
|
||
|
void iavf_enable_queues(struct iavf_adapter *adapter)
|
||
|
{
|
||
|
struct virtchnl_queue_select vqs;
|
||
|
|
||
|
if (adapter->current_op != VIRTCHNL_OP_UNKNOWN) {
|
||
|
/* bail because we already have a command pending */
|
||
|
dev_err(&adapter->pdev->dev, "Cannot enable queues, command %d pending\n",
|
||
|
adapter->current_op);
|
||
|
return;
|
||
|
}
|
||
|
adapter->current_op = VIRTCHNL_OP_ENABLE_QUEUES;
|
||
|
vqs.vsi_id = adapter->vsi_res->vsi_id;
|
||
|
vqs.tx_queues = BIT(adapter->num_active_queues) - 1;
|
||
|
vqs.rx_queues = vqs.tx_queues;
|
||
|
adapter->aq_required &= ~IAVF_FLAG_AQ_ENABLE_QUEUES;
|
||
|
iavf_send_pf_msg(adapter, VIRTCHNL_OP_ENABLE_QUEUES,
|
||
|
(u8 *)&vqs, sizeof(vqs));
|
||
|
}
|
||
|
|
||
|
/**
|
||
|
* iavf_disable_queues
|
||
|
* @adapter: adapter structure
|
||
|
*
|
||
|
* Request that the PF disable all of our queues.
|
||
|
**/
|
||
|
void iavf_disable_queues(struct iavf_adapter *adapter)
|
||
|
{
|
||
|
struct virtchnl_queue_select vqs;
|
||
|
|
||
|
if (adapter->current_op != VIRTCHNL_OP_UNKNOWN) {
|
||
|
/* bail because we already have a command pending */
|
||
|
dev_err(&adapter->pdev->dev, "Cannot disable queues, command %d pending\n",
|
||
|
adapter->current_op);
|
||
|
return;
|
||
|
}
|
||
|
adapter->current_op = VIRTCHNL_OP_DISABLE_QUEUES;
|
||
|
vqs.vsi_id = adapter->vsi_res->vsi_id;
|
||
|
vqs.tx_queues = BIT(adapter->num_active_queues) - 1;
|
||
|
vqs.rx_queues = vqs.tx_queues;
|
||
|
adapter->aq_required &= ~IAVF_FLAG_AQ_DISABLE_QUEUES;
|
||
|
iavf_send_pf_msg(adapter, VIRTCHNL_OP_DISABLE_QUEUES,
|
||
|
(u8 *)&vqs, sizeof(vqs));
|
||
|
}
|
||
|
|
||
|
/**
|
||
|
* iavf_map_queues
|
||
|
* @adapter: adapter structure
|
||
|
*
|
||
|
* Request that the PF map queues to interrupt vectors. Misc causes, including
|
||
|
* admin queue, are always mapped to vector 0.
|
||
|
**/
|
||
|
void iavf_map_queues(struct iavf_adapter *adapter)
|
||
|
{
|
||
|
struct virtchnl_irq_map_info *vimi;
|
||
|
struct virtchnl_vector_map *vecmap;
|
||
|
struct iavf_q_vector *q_vector;
|
||
|
int v_idx, q_vectors;
|
||
|
size_t len;
|
||
|
|
||
|
if (adapter->current_op != VIRTCHNL_OP_UNKNOWN) {
|
||
|
/* bail because we already have a command pending */
|
||
|
dev_err(&adapter->pdev->dev, "Cannot map queues to vectors, command %d pending\n",
|
||
|
adapter->current_op);
|
||
|
return;
|
||
|
}
|
||
|
adapter->current_op = VIRTCHNL_OP_CONFIG_IRQ_MAP;
|
||
|
|
||
|
q_vectors = adapter->num_msix_vectors - NONQ_VECS;
|
||
|
|
||
|
len = struct_size(vimi, vecmap, adapter->num_msix_vectors);
|
||
|
vimi = kzalloc(len, GFP_KERNEL);
|
||
|
if (!vimi)
|
||
|
return;
|
||
|
|
||
|
vimi->num_vectors = adapter->num_msix_vectors;
|
||
|
/* Queue vectors first */
|
||
|
for (v_idx = 0; v_idx < q_vectors; v_idx++) {
|
||
|
q_vector = &adapter->q_vectors[v_idx];
|
||
|
vecmap = &vimi->vecmap[v_idx];
|
||
|
|
||
|
vecmap->vsi_id = adapter->vsi_res->vsi_id;
|
||
|
vecmap->vector_id = v_idx + NONQ_VECS;
|
||
|
vecmap->txq_map = q_vector->ring_mask;
|
||
|
vecmap->rxq_map = q_vector->ring_mask;
|
||
|
vecmap->rxitr_idx = IAVF_RX_ITR;
|
||
|
vecmap->txitr_idx = IAVF_TX_ITR;
|
||
|
}
|
||
|
/* Misc vector last - this is only for AdminQ messages */
|
||
|
vecmap = &vimi->vecmap[v_idx];
|
||
|
vecmap->vsi_id = adapter->vsi_res->vsi_id;
|
||
|
vecmap->vector_id = 0;
|
||
|
vecmap->txq_map = 0;
|
||
|
vecmap->rxq_map = 0;
|
||
|
|
||
|
adapter->aq_required &= ~IAVF_FLAG_AQ_MAP_VECTORS;
|
||
|
iavf_send_pf_msg(adapter, VIRTCHNL_OP_CONFIG_IRQ_MAP,
|
||
|
(u8 *)vimi, len);
|
||
|
kfree(vimi);
|
||
|
}
|
||
|
|
||
|
/**
|
||
|
* iavf_request_queues
|
||
|
* @adapter: adapter structure
|
||
|
* @num: number of requested queues
|
||
|
*
|
||
|
* We get a default number of queues from the PF. This enables us to request a
|
||
|
* different number. Returns 0 on success, negative on failure
|
||
|
**/
|
||
|
int iavf_request_queues(struct iavf_adapter *adapter, int num)
|
||
|
{
|
||
|
struct virtchnl_vf_res_request vfres;
|
||
|
|
||
|
if (adapter->current_op != VIRTCHNL_OP_UNKNOWN) {
|
||
|
/* bail because we already have a command pending */
|
||
|
dev_err(&adapter->pdev->dev, "Cannot request queues, command %d pending\n",
|
||
|
adapter->current_op);
|
||
|
return -EBUSY;
|
||
|
}
|
||
|
|
||
|
vfres.num_queue_pairs = min_t(int, num, num_online_cpus());
|
||
|
|
||
|
adapter->current_op = VIRTCHNL_OP_REQUEST_QUEUES;
|
||
|
adapter->flags |= IAVF_FLAG_REINIT_ITR_NEEDED;
|
||
|
return iavf_send_pf_msg(adapter, VIRTCHNL_OP_REQUEST_QUEUES,
|
||
|
(u8 *)&vfres, sizeof(vfres));
|
||
|
}
|
||
|
|
||
|
/**
|
||
|
* iavf_add_ether_addrs
|
||
|
* @adapter: adapter structure
|
||
|
*
|
||
|
* Request that the PF add one or more addresses to our filters.
|
||
|
**/
|
||
|
void iavf_add_ether_addrs(struct iavf_adapter *adapter)
|
||
|
{
|
||
|
struct virtchnl_ether_addr_list *veal;
|
||
|
struct iavf_mac_filter *f;
|
||
|
int i = 0, count = 0;
|
||
|
bool more = false;
|
||
|
size_t len;
|
||
|
|
||
|
if (adapter->current_op != VIRTCHNL_OP_UNKNOWN) {
|
||
|
/* bail because we already have a command pending */
|
||
|
dev_err(&adapter->pdev->dev, "Cannot add filters, command %d pending\n",
|
||
|
adapter->current_op);
|
||
|
return;
|
||
|
}
|
||
|
|
||
|
spin_lock_bh(&adapter->mac_vlan_list_lock);
|
||
|
|
||
|
list_for_each_entry(f, &adapter->mac_filter_list, list) {
|
||
|
if (f->add)
|
||
|
count++;
|
||
|
}
|
||
|
if (!count) {
|
||
|
adapter->aq_required &= ~IAVF_FLAG_AQ_ADD_MAC_FILTER;
|
||
|
spin_unlock_bh(&adapter->mac_vlan_list_lock);
|
||
|
return;
|
||
|
}
|
||
|
adapter->current_op = VIRTCHNL_OP_ADD_ETH_ADDR;
|
||
|
|
||
|
len = struct_size(veal, list, count);
|
||
|
if (len > IAVF_MAX_AQ_BUF_SIZE) {
|
||
|
dev_warn(&adapter->pdev->dev, "Too many add MAC changes in one request\n");
|
||
|
count = (IAVF_MAX_AQ_BUF_SIZE -
|
||
|
sizeof(struct virtchnl_ether_addr_list)) /
|
||
|
sizeof(struct virtchnl_ether_addr);
|
||
|
len = struct_size(veal, list, count);
|
||
|
more = true;
|
||
|
}
|
||
|
|
||
|
veal = kzalloc(len, GFP_ATOMIC);
|
||
|
if (!veal) {
|
||
|
spin_unlock_bh(&adapter->mac_vlan_list_lock);
|
||
|
return;
|
||
|
}
|
||
|
|
||
|
veal->vsi_id = adapter->vsi_res->vsi_id;
|
||
|
veal->num_elements = count;
|
||
|
list_for_each_entry(f, &adapter->mac_filter_list, list) {
|
||
|
if (f->add) {
|
||
|
ether_addr_copy(veal->list[i].addr, f->macaddr);
|
||
|
i++;
|
||
|
f->add = false;
|
||
|
if (i == count)
|
||
|
break;
|
||
|
}
|
||
|
}
|
||
|
if (!more)
|
||
|
adapter->aq_required &= ~IAVF_FLAG_AQ_ADD_MAC_FILTER;
|
||
|
|
||
|
spin_unlock_bh(&adapter->mac_vlan_list_lock);
|
||
|
|
||
|
iavf_send_pf_msg(adapter, VIRTCHNL_OP_ADD_ETH_ADDR, (u8 *)veal, len);
|
||
|
kfree(veal);
|
||
|
}
|
||
|
|
||
|
/**
|
||
|
* iavf_del_ether_addrs
|
||
|
* @adapter: adapter structure
|
||
|
*
|
||
|
* Request that the PF remove one or more addresses from our filters.
|
||
|
**/
|
||
|
void iavf_del_ether_addrs(struct iavf_adapter *adapter)
|
||
|
{
|
||
|
struct virtchnl_ether_addr_list *veal;
|
||
|
struct iavf_mac_filter *f, *ftmp;
|
||
|
int i = 0, count = 0;
|
||
|
bool more = false;
|
||
|
size_t len;
|
||
|
|
||
|
if (adapter->current_op != VIRTCHNL_OP_UNKNOWN) {
|
||
|
/* bail because we already have a command pending */
|
||
|
dev_err(&adapter->pdev->dev, "Cannot remove filters, command %d pending\n",
|
||
|
adapter->current_op);
|
||
|
return;
|
||
|
}
|
||
|
|
||
|
spin_lock_bh(&adapter->mac_vlan_list_lock);
|
||
|
|
||
|
list_for_each_entry(f, &adapter->mac_filter_list, list) {
|
||
|
if (f->remove)
|
||
|
count++;
|
||
|
}
|
||
|
if (!count) {
|
||
|
adapter->aq_required &= ~IAVF_FLAG_AQ_DEL_MAC_FILTER;
|
||
|
spin_unlock_bh(&adapter->mac_vlan_list_lock);
|
||
|
return;
|
||
|
}
|
||
|
adapter->current_op = VIRTCHNL_OP_DEL_ETH_ADDR;
|
||
|
|
||
|
len = struct_size(veal, list, count);
|
||
|
if (len > IAVF_MAX_AQ_BUF_SIZE) {
|
||
|
dev_warn(&adapter->pdev->dev, "Too many delete MAC changes in one request\n");
|
||
|
count = (IAVF_MAX_AQ_BUF_SIZE -
|
||
|
sizeof(struct virtchnl_ether_addr_list)) /
|
||
|
sizeof(struct virtchnl_ether_addr);
|
||
|
len = struct_size(veal, list, count);
|
||
|
more = true;
|
||
|
}
|
||
|
veal = kzalloc(len, GFP_ATOMIC);
|
||
|
if (!veal) {
|
||
|
spin_unlock_bh(&adapter->mac_vlan_list_lock);
|
||
|
return;
|
||
|
}
|
||
|
|
||
|
veal->vsi_id = adapter->vsi_res->vsi_id;
|
||
|
veal->num_elements = count;
|
||
|
list_for_each_entry_safe(f, ftmp, &adapter->mac_filter_list, list) {
|
||
|
if (f->remove) {
|
||
|
ether_addr_copy(veal->list[i].addr, f->macaddr);
|
||
|
i++;
|
||
|
list_del(&f->list);
|
||
|
kfree(f);
|
||
|
if (i == count)
|
||
|
break;
|
||
|
}
|
||
|
}
|
||
|
if (!more)
|
||
|
adapter->aq_required &= ~IAVF_FLAG_AQ_DEL_MAC_FILTER;
|
||
|
|
||
|
spin_unlock_bh(&adapter->mac_vlan_list_lock);
|
||
|
|
||
|
iavf_send_pf_msg(adapter, VIRTCHNL_OP_DEL_ETH_ADDR, (u8 *)veal, len);
|
||
|
kfree(veal);
|
||
|
}
|
||
|
|
||
|
/**
|
||
|
* iavf_add_vlans
|
||
|
* @adapter: adapter structure
|
||
|
*
|
||
|
* Request that the PF add one or more VLAN filters to our VSI.
|
||
|
**/
|
||
|
void iavf_add_vlans(struct iavf_adapter *adapter)
|
||
|
{
|
||
|
struct virtchnl_vlan_filter_list *vvfl;
|
||
|
int len, i = 0, count = 0;
|
||
|
struct iavf_vlan_filter *f;
|
||
|
bool more = false;
|
||
|
|
||
|
if (adapter->current_op != VIRTCHNL_OP_UNKNOWN) {
|
||
|
/* bail because we already have a command pending */
|
||
|
dev_err(&adapter->pdev->dev, "Cannot add VLANs, command %d pending\n",
|
||
|
adapter->current_op);
|
||
|
return;
|
||
|
}
|
||
|
|
||
|
spin_lock_bh(&adapter->mac_vlan_list_lock);
|
||
|
|
||
|
list_for_each_entry(f, &adapter->vlan_filter_list, list) {
|
||
|
if (f->add)
|
||
|
count++;
|
||
|
}
|
||
|
if (!count) {
|
||
|
adapter->aq_required &= ~IAVF_FLAG_AQ_ADD_VLAN_FILTER;
|
||
|
spin_unlock_bh(&adapter->mac_vlan_list_lock);
|
||
|
return;
|
||
|
}
|
||
|
adapter->current_op = VIRTCHNL_OP_ADD_VLAN;
|
||
|
|
||
|
len = sizeof(struct virtchnl_vlan_filter_list) +
|
||
|
(count * sizeof(u16));
|
||
|
if (len > IAVF_MAX_AQ_BUF_SIZE) {
|
||
|
dev_warn(&adapter->pdev->dev, "Too many add VLAN changes in one request\n");
|
||
|
count = (IAVF_MAX_AQ_BUF_SIZE -
|
||
|
sizeof(struct virtchnl_vlan_filter_list)) /
|
||
|
sizeof(u16);
|
||
|
len = sizeof(struct virtchnl_vlan_filter_list) +
|
||
|
(count * sizeof(u16));
|
||
|
more = true;
|
||
|
}
|
||
|
vvfl = kzalloc(len, GFP_ATOMIC);
|
||
|
if (!vvfl) {
|
||
|
spin_unlock_bh(&adapter->mac_vlan_list_lock);
|
||
|
return;
|
||
|
}
|
||
|
|
||
|
vvfl->vsi_id = adapter->vsi_res->vsi_id;
|
||
|
vvfl->num_elements = count;
|
||
|
list_for_each_entry(f, &adapter->vlan_filter_list, list) {
|
||
|
if (f->add) {
|
||
|
vvfl->vlan_id[i] = f->vlan;
|
||
|
i++;
|
||
|
f->add = false;
|
||
|
if (i == count)
|
||
|
break;
|
||
|
}
|
||
|
}
|
||
|
if (!more)
|
||
|
adapter->aq_required &= ~IAVF_FLAG_AQ_ADD_VLAN_FILTER;
|
||
|
|
||
|
spin_unlock_bh(&adapter->mac_vlan_list_lock);
|
||
|
|
||
|
iavf_send_pf_msg(adapter, VIRTCHNL_OP_ADD_VLAN, (u8 *)vvfl, len);
|
||
|
kfree(vvfl);
|
||
|
}
|
||
|
|
||
|
/**
|
||
|
* iavf_del_vlans
|
||
|
* @adapter: adapter structure
|
||
|
*
|
||
|
* Request that the PF remove one or more VLAN filters from our VSI.
|
||
|
**/
|
||
|
void iavf_del_vlans(struct iavf_adapter *adapter)
|
||
|
{
|
||
|
struct virtchnl_vlan_filter_list *vvfl;
|
||
|
struct iavf_vlan_filter *f, *ftmp;
|
||
|
int len, i = 0, count = 0;
|
||
|
bool more = false;
|
||
|
|
||
|
if (adapter->current_op != VIRTCHNL_OP_UNKNOWN) {
|
||
|
/* bail because we already have a command pending */
|
||
|
dev_err(&adapter->pdev->dev, "Cannot remove VLANs, command %d pending\n",
|
||
|
adapter->current_op);
|
||
|
return;
|
||
|
}
|
||
|
|
||
|
spin_lock_bh(&adapter->mac_vlan_list_lock);
|
||
|
|
||
|
list_for_each_entry(f, &adapter->vlan_filter_list, list) {
|
||
|
if (f->remove)
|
||
|
count++;
|
||
|
}
|
||
|
if (!count) {
|
||
|
adapter->aq_required &= ~IAVF_FLAG_AQ_DEL_VLAN_FILTER;
|
||
|
spin_unlock_bh(&adapter->mac_vlan_list_lock);
|
||
|
return;
|
||
|
}
|
||
|
adapter->current_op = VIRTCHNL_OP_DEL_VLAN;
|
||
|
|
||
|
len = sizeof(struct virtchnl_vlan_filter_list) +
|
||
|
(count * sizeof(u16));
|
||
|
if (len > IAVF_MAX_AQ_BUF_SIZE) {
|
||
|
dev_warn(&adapter->pdev->dev, "Too many delete VLAN changes in one request\n");
|
||
|
count = (IAVF_MAX_AQ_BUF_SIZE -
|
||
|
sizeof(struct virtchnl_vlan_filter_list)) /
|
||
|
sizeof(u16);
|
||
|
len = sizeof(struct virtchnl_vlan_filter_list) +
|
||
|
(count * sizeof(u16));
|
||
|
more = true;
|
||
|
}
|
||
|
vvfl = kzalloc(len, GFP_ATOMIC);
|
||
|
if (!vvfl) {
|
||
|
spin_unlock_bh(&adapter->mac_vlan_list_lock);
|
||
|
return;
|
||
|
}
|
||
|
|
||
|
vvfl->vsi_id = adapter->vsi_res->vsi_id;
|
||
|
vvfl->num_elements = count;
|
||
|
list_for_each_entry_safe(f, ftmp, &adapter->vlan_filter_list, list) {
|
||
|
if (f->remove) {
|
||
|
vvfl->vlan_id[i] = f->vlan;
|
||
|
i++;
|
||
|
list_del(&f->list);
|
||
|
kfree(f);
|
||
|
if (i == count)
|
||
|
break;
|
||
|
}
|
||
|
}
|
||
|
if (!more)
|
||
|
adapter->aq_required &= ~IAVF_FLAG_AQ_DEL_VLAN_FILTER;
|
||
|
|
||
|
spin_unlock_bh(&adapter->mac_vlan_list_lock);
|
||
|
|
||
|
iavf_send_pf_msg(adapter, VIRTCHNL_OP_DEL_VLAN, (u8 *)vvfl, len);
|
||
|
kfree(vvfl);
|
||
|
}
|
||
|
|
||
|
/**
|
||
|
* iavf_set_promiscuous
|
||
|
* @adapter: adapter structure
|
||
|
* @flags: bitmask to control unicast/multicast promiscuous.
|
||
|
*
|
||
|
* Request that the PF enable promiscuous mode for our VSI.
|
||
|
**/
|
||
|
void iavf_set_promiscuous(struct iavf_adapter *adapter, int flags)
|
||
|
{
|
||
|
struct virtchnl_promisc_info vpi;
|
||
|
int promisc_all;
|
||
|
|
||
|
if (adapter->current_op != VIRTCHNL_OP_UNKNOWN) {
|
||
|
/* bail because we already have a command pending */
|
||
|
dev_err(&adapter->pdev->dev, "Cannot set promiscuous mode, command %d pending\n",
|
||
|
adapter->current_op);
|
||
|
return;
|
||
|
}
|
||
|
|
||
|
promisc_all = FLAG_VF_UNICAST_PROMISC |
|
||
|
FLAG_VF_MULTICAST_PROMISC;
|
||
|
if ((flags & promisc_all) == promisc_all) {
|
||
|
adapter->flags |= IAVF_FLAG_PROMISC_ON;
|
||
|
adapter->aq_required &= ~IAVF_FLAG_AQ_REQUEST_PROMISC;
|
||
|
dev_info(&adapter->pdev->dev, "Entering promiscuous mode\n");
|
||
|
}
|
||
|
|
||
|
if (flags & FLAG_VF_MULTICAST_PROMISC) {
|
||
|
adapter->flags |= IAVF_FLAG_ALLMULTI_ON;
|
||
|
adapter->aq_required &= ~IAVF_FLAG_AQ_REQUEST_ALLMULTI;
|
||
|
dev_info(&adapter->pdev->dev, "Entering multicast promiscuous mode\n");
|
||
|
}
|
||
|
|
||
|
if (!flags) {
|
||
|
adapter->flags &= ~(IAVF_FLAG_PROMISC_ON |
|
||
|
IAVF_FLAG_ALLMULTI_ON);
|
||
|
adapter->aq_required &= ~(IAVF_FLAG_AQ_RELEASE_PROMISC |
|
||
|
IAVF_FLAG_AQ_RELEASE_ALLMULTI);
|
||
|
dev_info(&adapter->pdev->dev, "Leaving promiscuous mode\n");
|
||
|
}
|
||
|
|
||
|
adapter->current_op = VIRTCHNL_OP_CONFIG_PROMISCUOUS_MODE;
|
||
|
vpi.vsi_id = adapter->vsi_res->vsi_id;
|
||
|
vpi.flags = flags;
|
||
|
iavf_send_pf_msg(adapter, VIRTCHNL_OP_CONFIG_PROMISCUOUS_MODE,
|
||
|
(u8 *)&vpi, sizeof(vpi));
|
||
|
}
|
||
|
|
||
|
/**
|
||
|
* iavf_request_stats
|
||
|
* @adapter: adapter structure
|
||
|
*
|
||
|
* Request VSI statistics from PF.
|
||
|
**/
|
||
|
void iavf_request_stats(struct iavf_adapter *adapter)
|
||
|
{
|
||
|
struct virtchnl_queue_select vqs;
|
||
|
|
||
|
if (adapter->current_op != VIRTCHNL_OP_UNKNOWN) {
|
||
|
/* no error message, this isn't crucial */
|
||
|
return;
|
||
|
}
|
||
|
adapter->current_op = VIRTCHNL_OP_GET_STATS;
|
||
|
vqs.vsi_id = adapter->vsi_res->vsi_id;
|
||
|
/* queue maps are ignored for this message - only the vsi is used */
|
||
|
if (iavf_send_pf_msg(adapter, VIRTCHNL_OP_GET_STATS, (u8 *)&vqs,
|
||
|
sizeof(vqs)))
|
||
|
/* if the request failed, don't lock out others */
|
||
|
adapter->current_op = VIRTCHNL_OP_UNKNOWN;
|
||
|
}
|
||
|
|
||
|
/**
|
||
|
* iavf_get_hena
|
||
|
* @adapter: adapter structure
|
||
|
*
|
||
|
* Request hash enable capabilities from PF
|
||
|
**/
|
||
|
void iavf_get_hena(struct iavf_adapter *adapter)
|
||
|
{
|
||
|
if (adapter->current_op != VIRTCHNL_OP_UNKNOWN) {
|
||
|
/* bail because we already have a command pending */
|
||
|
dev_err(&adapter->pdev->dev, "Cannot get RSS hash capabilities, command %d pending\n",
|
||
|
adapter->current_op);
|
||
|
return;
|
||
|
}
|
||
|
adapter->current_op = VIRTCHNL_OP_GET_RSS_HENA_CAPS;
|
||
|
adapter->aq_required &= ~IAVF_FLAG_AQ_GET_HENA;
|
||
|
iavf_send_pf_msg(adapter, VIRTCHNL_OP_GET_RSS_HENA_CAPS, NULL, 0);
|
||
|
}
|
||
|
|
||
|
/**
|
||
|
* iavf_set_hena
|
||
|
* @adapter: adapter structure
|
||
|
*
|
||
|
* Request the PF to set our RSS hash capabilities
|
||
|
**/
|
||
|
void iavf_set_hena(struct iavf_adapter *adapter)
|
||
|
{
|
||
|
struct virtchnl_rss_hena vrh;
|
||
|
|
||
|
if (adapter->current_op != VIRTCHNL_OP_UNKNOWN) {
|
||
|
/* bail because we already have a command pending */
|
||
|
dev_err(&adapter->pdev->dev, "Cannot set RSS hash enable, command %d pending\n",
|
||
|
adapter->current_op);
|
||
|
return;
|
||
|
}
|
||
|
vrh.hena = adapter->hena;
|
||
|
adapter->current_op = VIRTCHNL_OP_SET_RSS_HENA;
|
||
|
adapter->aq_required &= ~IAVF_FLAG_AQ_SET_HENA;
|
||
|
iavf_send_pf_msg(adapter, VIRTCHNL_OP_SET_RSS_HENA, (u8 *)&vrh,
|
||
|
sizeof(vrh));
|
||
|
}
|
||
|
|
||
|
/**
|
||
|
* iavf_set_rss_key
|
||
|
* @adapter: adapter structure
|
||
|
*
|
||
|
* Request the PF to set our RSS hash key
|
||
|
**/
|
||
|
void iavf_set_rss_key(struct iavf_adapter *adapter)
|
||
|
{
|
||
|
struct virtchnl_rss_key *vrk;
|
||
|
int len;
|
||
|
|
||
|
if (adapter->current_op != VIRTCHNL_OP_UNKNOWN) {
|
||
|
/* bail because we already have a command pending */
|
||
|
dev_err(&adapter->pdev->dev, "Cannot set RSS key, command %d pending\n",
|
||
|
adapter->current_op);
|
||
|
return;
|
||
|
}
|
||
|
len = sizeof(struct virtchnl_rss_key) +
|
||
|
(adapter->rss_key_size * sizeof(u8)) - 1;
|
||
|
vrk = kzalloc(len, GFP_KERNEL);
|
||
|
if (!vrk)
|
||
|
return;
|
||
|
vrk->vsi_id = adapter->vsi.id;
|
||
|
vrk->key_len = adapter->rss_key_size;
|
||
|
memcpy(vrk->key, adapter->rss_key, adapter->rss_key_size);
|
||
|
|
||
|
adapter->current_op = VIRTCHNL_OP_CONFIG_RSS_KEY;
|
||
|
adapter->aq_required &= ~IAVF_FLAG_AQ_SET_RSS_KEY;
|
||
|
iavf_send_pf_msg(adapter, VIRTCHNL_OP_CONFIG_RSS_KEY, (u8 *)vrk, len);
|
||
|
kfree(vrk);
|
||
|
}
|
||
|
|
||
|
/**
|
||
|
* iavf_set_rss_lut
|
||
|
* @adapter: adapter structure
|
||
|
*
|
||
|
* Request the PF to set our RSS lookup table
|
||
|
**/
|
||
|
void iavf_set_rss_lut(struct iavf_adapter *adapter)
|
||
|
{
|
||
|
struct virtchnl_rss_lut *vrl;
|
||
|
int len;
|
||
|
|
||
|
if (adapter->current_op != VIRTCHNL_OP_UNKNOWN) {
|
||
|
/* bail because we already have a command pending */
|
||
|
dev_err(&adapter->pdev->dev, "Cannot set RSS LUT, command %d pending\n",
|
||
|
adapter->current_op);
|
||
|
return;
|
||
|
}
|
||
|
len = sizeof(struct virtchnl_rss_lut) +
|
||
|
(adapter->rss_lut_size * sizeof(u8)) - 1;
|
||
|
vrl = kzalloc(len, GFP_KERNEL);
|
||
|
if (!vrl)
|
||
|
return;
|
||
|
vrl->vsi_id = adapter->vsi.id;
|
||
|
vrl->lut_entries = adapter->rss_lut_size;
|
||
|
memcpy(vrl->lut, adapter->rss_lut, adapter->rss_lut_size);
|
||
|
adapter->current_op = VIRTCHNL_OP_CONFIG_RSS_LUT;
|
||
|
adapter->aq_required &= ~IAVF_FLAG_AQ_SET_RSS_LUT;
|
||
|
iavf_send_pf_msg(adapter, VIRTCHNL_OP_CONFIG_RSS_LUT, (u8 *)vrl, len);
|
||
|
kfree(vrl);
|
||
|
}
|
||
|
|
||
|
/**
|
||
|
* iavf_enable_vlan_stripping
|
||
|
* @adapter: adapter structure
|
||
|
*
|
||
|
* Request VLAN header stripping to be enabled
|
||
|
**/
|
||
|
void iavf_enable_vlan_stripping(struct iavf_adapter *adapter)
|
||
|
{
|
||
|
if (adapter->current_op != VIRTCHNL_OP_UNKNOWN) {
|
||
|
/* bail because we already have a command pending */
|
||
|
dev_err(&adapter->pdev->dev, "Cannot enable stripping, command %d pending\n",
|
||
|
adapter->current_op);
|
||
|
return;
|
||
|
}
|
||
|
adapter->current_op = VIRTCHNL_OP_ENABLE_VLAN_STRIPPING;
|
||
|
adapter->aq_required &= ~IAVF_FLAG_AQ_ENABLE_VLAN_STRIPPING;
|
||
|
iavf_send_pf_msg(adapter, VIRTCHNL_OP_ENABLE_VLAN_STRIPPING, NULL, 0);
|
||
|
}
|
||
|
|
||
|
/**
|
||
|
* iavf_disable_vlan_stripping
|
||
|
* @adapter: adapter structure
|
||
|
*
|
||
|
* Request VLAN header stripping to be disabled
|
||
|
**/
|
||
|
void iavf_disable_vlan_stripping(struct iavf_adapter *adapter)
|
||
|
{
|
||
|
if (adapter->current_op != VIRTCHNL_OP_UNKNOWN) {
|
||
|
/* bail because we already have a command pending */
|
||
|
dev_err(&adapter->pdev->dev, "Cannot disable stripping, command %d pending\n",
|
||
|
adapter->current_op);
|
||
|
return;
|
||
|
}
|
||
|
adapter->current_op = VIRTCHNL_OP_DISABLE_VLAN_STRIPPING;
|
||
|
adapter->aq_required &= ~IAVF_FLAG_AQ_DISABLE_VLAN_STRIPPING;
|
||
|
iavf_send_pf_msg(adapter, VIRTCHNL_OP_DISABLE_VLAN_STRIPPING, NULL, 0);
|
||
|
}
|
||
|
|
||
|
/**
|
||
|
* iavf_print_link_message - print link up or down
|
||
|
* @adapter: adapter structure
|
||
|
*
|
||
|
* Log a message telling the world of our wonderous link status
|
||
|
*/
|
||
|
static void iavf_print_link_message(struct iavf_adapter *adapter)
|
||
|
{
|
||
|
struct net_device *netdev = adapter->netdev;
|
||
|
char *speed = "Unknown ";
|
||
|
|
||
|
if (!adapter->link_up) {
|
||
|
netdev_info(netdev, "NIC Link is Down\n");
|
||
|
return;
|
||
|
}
|
||
|
|
||
|
switch (adapter->link_speed) {
|
||
|
case IAVF_LINK_SPEED_40GB:
|
||
|
speed = "40 G";
|
||
|
break;
|
||
|
case IAVF_LINK_SPEED_25GB:
|
||
|
speed = "25 G";
|
||
|
break;
|
||
|
case IAVF_LINK_SPEED_20GB:
|
||
|
speed = "20 G";
|
||
|
break;
|
||
|
case IAVF_LINK_SPEED_10GB:
|
||
|
speed = "10 G";
|
||
|
break;
|
||
|
case IAVF_LINK_SPEED_1GB:
|
||
|
speed = "1000 M";
|
||
|
break;
|
||
|
case IAVF_LINK_SPEED_100MB:
|
||
|
speed = "100 M";
|
||
|
break;
|
||
|
default:
|
||
|
break;
|
||
|
}
|
||
|
|
||
|
netdev_info(netdev, "NIC Link is Up %sbps Full Duplex\n", speed);
|
||
|
}
|
||
|
|
||
|
/**
|
||
|
* iavf_enable_channel
|
||
|
* @adapter: adapter structure
|
||
|
*
|
||
|
* Request that the PF enable channels as specified by
|
||
|
* the user via tc tool.
|
||
|
**/
|
||
|
void iavf_enable_channels(struct iavf_adapter *adapter)
|
||
|
{
|
||
|
struct virtchnl_tc_info *vti = NULL;
|
||
|
size_t len;
|
||
|
int i;
|
||
|
|
||
|
if (adapter->current_op != VIRTCHNL_OP_UNKNOWN) {
|
||
|
/* bail because we already have a command pending */
|
||
|
dev_err(&adapter->pdev->dev, "Cannot configure mqprio, command %d pending\n",
|
||
|
adapter->current_op);
|
||
|
return;
|
||
|
}
|
||
|
|
||
|
len = struct_size(vti, list, adapter->num_tc - 1);
|
||
|
vti = kzalloc(len, GFP_KERNEL);
|
||
|
if (!vti)
|
||
|
return;
|
||
|
vti->num_tc = adapter->num_tc;
|
||
|
for (i = 0; i < vti->num_tc; i++) {
|
||
|
vti->list[i].count = adapter->ch_config.ch_info[i].count;
|
||
|
vti->list[i].offset = adapter->ch_config.ch_info[i].offset;
|
||
|
vti->list[i].pad = 0;
|
||
|
vti->list[i].max_tx_rate =
|
||
|
adapter->ch_config.ch_info[i].max_tx_rate;
|
||
|
}
|
||
|
|
||
|
adapter->ch_config.state = __IAVF_TC_RUNNING;
|
||
|
adapter->flags |= IAVF_FLAG_REINIT_ITR_NEEDED;
|
||
|
adapter->current_op = VIRTCHNL_OP_ENABLE_CHANNELS;
|
||
|
adapter->aq_required &= ~IAVF_FLAG_AQ_ENABLE_CHANNELS;
|
||
|
iavf_send_pf_msg(adapter, VIRTCHNL_OP_ENABLE_CHANNELS, (u8 *)vti, len);
|
||
|
kfree(vti);
|
||
|
}
|
||
|
|
||
|
/**
|
||
|
* iavf_disable_channel
|
||
|
* @adapter: adapter structure
|
||
|
*
|
||
|
* Request that the PF disable channels that are configured
|
||
|
**/
|
||
|
void iavf_disable_channels(struct iavf_adapter *adapter)
|
||
|
{
|
||
|
if (adapter->current_op != VIRTCHNL_OP_UNKNOWN) {
|
||
|
/* bail because we already have a command pending */
|
||
|
dev_err(&adapter->pdev->dev, "Cannot configure mqprio, command %d pending\n",
|
||
|
adapter->current_op);
|
||
|
return;
|
||
|
}
|
||
|
|
||
|
adapter->ch_config.state = __IAVF_TC_INVALID;
|
||
|
adapter->flags |= IAVF_FLAG_REINIT_ITR_NEEDED;
|
||
|
adapter->current_op = VIRTCHNL_OP_DISABLE_CHANNELS;
|
||
|
adapter->aq_required &= ~IAVF_FLAG_AQ_DISABLE_CHANNELS;
|
||
|
iavf_send_pf_msg(adapter, VIRTCHNL_OP_DISABLE_CHANNELS, NULL, 0);
|
||
|
}
|
||
|
|
||
|
/**
|
||
|
* iavf_print_cloud_filter
|
||
|
* @adapter: adapter structure
|
||
|
* @f: cloud filter to print
|
||
|
*
|
||
|
* Print the cloud filter
|
||
|
**/
|
||
|
static void iavf_print_cloud_filter(struct iavf_adapter *adapter,
|
||
|
struct virtchnl_filter *f)
|
||
|
{
|
||
|
switch (f->flow_type) {
|
||
|
case VIRTCHNL_TCP_V4_FLOW:
|
||
|
dev_info(&adapter->pdev->dev, "dst_mac: %pM src_mac: %pM vlan_id: %hu dst_ip: %pI4 src_ip %pI4 dst_port %hu src_port %hu\n",
|
||
|
&f->data.tcp_spec.dst_mac,
|
||
|
&f->data.tcp_spec.src_mac,
|
||
|
ntohs(f->data.tcp_spec.vlan_id),
|
||
|
&f->data.tcp_spec.dst_ip[0],
|
||
|
&f->data.tcp_spec.src_ip[0],
|
||
|
ntohs(f->data.tcp_spec.dst_port),
|
||
|
ntohs(f->data.tcp_spec.src_port));
|
||
|
break;
|
||
|
case VIRTCHNL_TCP_V6_FLOW:
|
||
|
dev_info(&adapter->pdev->dev, "dst_mac: %pM src_mac: %pM vlan_id: %hu dst_ip: %pI6 src_ip %pI6 dst_port %hu src_port %hu\n",
|
||
|
&f->data.tcp_spec.dst_mac,
|
||
|
&f->data.tcp_spec.src_mac,
|
||
|
ntohs(f->data.tcp_spec.vlan_id),
|
||
|
&f->data.tcp_spec.dst_ip,
|
||
|
&f->data.tcp_spec.src_ip,
|
||
|
ntohs(f->data.tcp_spec.dst_port),
|
||
|
ntohs(f->data.tcp_spec.src_port));
|
||
|
break;
|
||
|
}
|
||
|
}
|
||
|
|
||
|
/**
|
||
|
* iavf_add_cloud_filter
|
||
|
* @adapter: adapter structure
|
||
|
*
|
||
|
* Request that the PF add cloud filters as specified
|
||
|
* by the user via tc tool.
|
||
|
**/
|
||
|
void iavf_add_cloud_filter(struct iavf_adapter *adapter)
|
||
|
{
|
||
|
struct iavf_cloud_filter *cf;
|
||
|
struct virtchnl_filter *f;
|
||
|
int len = 0, count = 0;
|
||
|
|
||
|
if (adapter->current_op != VIRTCHNL_OP_UNKNOWN) {
|
||
|
/* bail because we already have a command pending */
|
||
|
dev_err(&adapter->pdev->dev, "Cannot add cloud filter, command %d pending\n",
|
||
|
adapter->current_op);
|
||
|
return;
|
||
|
}
|
||
|
list_for_each_entry(cf, &adapter->cloud_filter_list, list) {
|
||
|
if (cf->add) {
|
||
|
count++;
|
||
|
break;
|
||
|
}
|
||
|
}
|
||
|
if (!count) {
|
||
|
adapter->aq_required &= ~IAVF_FLAG_AQ_ADD_CLOUD_FILTER;
|
||
|
return;
|
||
|
}
|
||
|
adapter->current_op = VIRTCHNL_OP_ADD_CLOUD_FILTER;
|
||
|
|
||
|
len = sizeof(struct virtchnl_filter);
|
||
|
f = kzalloc(len, GFP_KERNEL);
|
||
|
if (!f)
|
||
|
return;
|
||
|
|
||
|
list_for_each_entry(cf, &adapter->cloud_filter_list, list) {
|
||
|
if (cf->add) {
|
||
|
memcpy(f, &cf->f, sizeof(struct virtchnl_filter));
|
||
|
cf->add = false;
|
||
|
cf->state = __IAVF_CF_ADD_PENDING;
|
||
|
iavf_send_pf_msg(adapter, VIRTCHNL_OP_ADD_CLOUD_FILTER,
|
||
|
(u8 *)f, len);
|
||
|
}
|
||
|
}
|
||
|
kfree(f);
|
||
|
}
|
||
|
|
||
|
/**
|
||
|
* iavf_del_cloud_filter
|
||
|
* @adapter: adapter structure
|
||
|
*
|
||
|
* Request that the PF delete cloud filters as specified
|
||
|
* by the user via tc tool.
|
||
|
**/
|
||
|
void iavf_del_cloud_filter(struct iavf_adapter *adapter)
|
||
|
{
|
||
|
struct iavf_cloud_filter *cf, *cftmp;
|
||
|
struct virtchnl_filter *f;
|
||
|
int len = 0, count = 0;
|
||
|
|
||
|
if (adapter->current_op != VIRTCHNL_OP_UNKNOWN) {
|
||
|
/* bail because we already have a command pending */
|
||
|
dev_err(&adapter->pdev->dev, "Cannot remove cloud filter, command %d pending\n",
|
||
|
adapter->current_op);
|
||
|
return;
|
||
|
}
|
||
|
list_for_each_entry(cf, &adapter->cloud_filter_list, list) {
|
||
|
if (cf->del) {
|
||
|
count++;
|
||
|
break;
|
||
|
}
|
||
|
}
|
||
|
if (!count) {
|
||
|
adapter->aq_required &= ~IAVF_FLAG_AQ_DEL_CLOUD_FILTER;
|
||
|
return;
|
||
|
}
|
||
|
adapter->current_op = VIRTCHNL_OP_DEL_CLOUD_FILTER;
|
||
|
|
||
|
len = sizeof(struct virtchnl_filter);
|
||
|
f = kzalloc(len, GFP_KERNEL);
|
||
|
if (!f)
|
||
|
return;
|
||
|
|
||
|
list_for_each_entry_safe(cf, cftmp, &adapter->cloud_filter_list, list) {
|
||
|
if (cf->del) {
|
||
|
memcpy(f, &cf->f, sizeof(struct virtchnl_filter));
|
||
|
cf->del = false;
|
||
|
cf->state = __IAVF_CF_DEL_PENDING;
|
||
|
iavf_send_pf_msg(adapter, VIRTCHNL_OP_DEL_CLOUD_FILTER,
|
||
|
(u8 *)f, len);
|
||
|
}
|
||
|
}
|
||
|
kfree(f);
|
||
|
}
|
||
|
|
||
|
/**
|
||
|
* iavf_request_reset
|
||
|
* @adapter: adapter structure
|
||
|
*
|
||
|
* Request that the PF reset this VF. No response is expected.
|
||
|
**/
|
||
|
void iavf_request_reset(struct iavf_adapter *adapter)
|
||
|
{
|
||
|
/* Don't check CURRENT_OP - this is always higher priority */
|
||
|
iavf_send_pf_msg(adapter, VIRTCHNL_OP_RESET_VF, NULL, 0);
|
||
|
adapter->current_op = VIRTCHNL_OP_UNKNOWN;
|
||
|
}
|
||
|
|
||
|
/**
|
||
|
* iavf_virtchnl_completion
|
||
|
* @adapter: adapter structure
|
||
|
* @v_opcode: opcode sent by PF
|
||
|
* @v_retval: retval sent by PF
|
||
|
* @msg: message sent by PF
|
||
|
* @msglen: message length
|
||
|
*
|
||
|
* Asynchronous completion function for admin queue messages. Rather than busy
|
||
|
* wait, we fire off our requests and assume that no errors will be returned.
|
||
|
* This function handles the reply messages.
|
||
|
**/
|
||
|
void iavf_virtchnl_completion(struct iavf_adapter *adapter,
|
||
|
enum virtchnl_ops v_opcode,
|
||
|
enum iavf_status v_retval, u8 *msg, u16 msglen)
|
||
|
{
|
||
|
struct net_device *netdev = adapter->netdev;
|
||
|
|
||
|
if (v_opcode == VIRTCHNL_OP_EVENT) {
|
||
|
struct virtchnl_pf_event *vpe =
|
||
|
(struct virtchnl_pf_event *)msg;
|
||
|
bool link_up = vpe->event_data.link_event.link_status;
|
||
|
|
||
|
switch (vpe->event) {
|
||
|
case VIRTCHNL_EVENT_LINK_CHANGE:
|
||
|
adapter->link_speed =
|
||
|
vpe->event_data.link_event.link_speed;
|
||
|
|
||
|
/* we've already got the right link status, bail */
|
||
|
if (adapter->link_up == link_up)
|
||
|
break;
|
||
|
|
||
|
if (link_up) {
|
||
|
/* If we get link up message and start queues
|
||
|
* before our queues are configured it will
|
||
|
* trigger a TX hang. In that case, just ignore
|
||
|
* the link status message,we'll get another one
|
||
|
* after we enable queues and actually prepared
|
||
|
* to send traffic.
|
||
|
*/
|
||
|
if (adapter->state != __IAVF_RUNNING)
|
||
|
break;
|
||
|
|
||
|
/* For ADq enabled VF, we reconfigure VSIs and
|
||
|
* re-allocate queues. Hence wait till all
|
||
|
* queues are enabled.
|
||
|
*/
|
||
|
if (adapter->flags &
|
||
|
IAVF_FLAG_QUEUES_DISABLED)
|
||
|
break;
|
||
|
}
|
||
|
|
||
|
adapter->link_up = link_up;
|
||
|
if (link_up) {
|
||
|
netif_tx_start_all_queues(netdev);
|
||
|
netif_carrier_on(netdev);
|
||
|
} else {
|
||
|
netif_tx_stop_all_queues(netdev);
|
||
|
netif_carrier_off(netdev);
|
||
|
}
|
||
|
iavf_print_link_message(adapter);
|
||
|
break;
|
||
|
case VIRTCHNL_EVENT_RESET_IMPENDING:
|
||
|
dev_info(&adapter->pdev->dev, "Reset warning received from the PF\n");
|
||
|
if (!(adapter->flags & IAVF_FLAG_RESET_PENDING)) {
|
||
|
adapter->flags |= IAVF_FLAG_RESET_PENDING;
|
||
|
dev_info(&adapter->pdev->dev, "Scheduling reset task\n");
|
||
|
queue_work(iavf_wq, &adapter->reset_task);
|
||
|
}
|
||
|
break;
|
||
|
default:
|
||
|
dev_err(&adapter->pdev->dev, "Unknown event %d from PF\n",
|
||
|
vpe->event);
|
||
|
break;
|
||
|
}
|
||
|
return;
|
||
|
}
|
||
|
if (v_retval) {
|
||
|
switch (v_opcode) {
|
||
|
case VIRTCHNL_OP_ADD_VLAN:
|
||
|
dev_err(&adapter->pdev->dev, "Failed to add VLAN filter, error %s\n",
|
||
|
iavf_stat_str(&adapter->hw, v_retval));
|
||
|
break;
|
||
|
case VIRTCHNL_OP_ADD_ETH_ADDR:
|
||
|
dev_err(&adapter->pdev->dev, "Failed to add MAC filter, error %s\n",
|
||
|
iavf_stat_str(&adapter->hw, v_retval));
|
||
|
/* restore administratively set MAC address */
|
||
|
ether_addr_copy(adapter->hw.mac.addr, netdev->dev_addr);
|
||
|
break;
|
||
|
case VIRTCHNL_OP_DEL_VLAN:
|
||
|
dev_err(&adapter->pdev->dev, "Failed to delete VLAN filter, error %s\n",
|
||
|
iavf_stat_str(&adapter->hw, v_retval));
|
||
|
break;
|
||
|
case VIRTCHNL_OP_DEL_ETH_ADDR:
|
||
|
dev_err(&adapter->pdev->dev, "Failed to delete MAC filter, error %s\n",
|
||
|
iavf_stat_str(&adapter->hw, v_retval));
|
||
|
break;
|
||
|
case VIRTCHNL_OP_ENABLE_CHANNELS:
|
||
|
dev_err(&adapter->pdev->dev, "Failed to configure queue channels, error %s\n",
|
||
|
iavf_stat_str(&adapter->hw, v_retval));
|
||
|
adapter->flags &= ~IAVF_FLAG_REINIT_ITR_NEEDED;
|
||
|
adapter->ch_config.state = __IAVF_TC_INVALID;
|
||
|
netdev_reset_tc(netdev);
|
||
|
netif_tx_start_all_queues(netdev);
|
||
|
break;
|
||
|
case VIRTCHNL_OP_DISABLE_CHANNELS:
|
||
|
dev_err(&adapter->pdev->dev, "Failed to disable queue channels, error %s\n",
|
||
|
iavf_stat_str(&adapter->hw, v_retval));
|
||
|
adapter->flags &= ~IAVF_FLAG_REINIT_ITR_NEEDED;
|
||
|
adapter->ch_config.state = __IAVF_TC_RUNNING;
|
||
|
netif_tx_start_all_queues(netdev);
|
||
|
break;
|
||
|
case VIRTCHNL_OP_ADD_CLOUD_FILTER: {
|
||
|
struct iavf_cloud_filter *cf, *cftmp;
|
||
|
|
||
|
list_for_each_entry_safe(cf, cftmp,
|
||
|
&adapter->cloud_filter_list,
|
||
|
list) {
|
||
|
if (cf->state == __IAVF_CF_ADD_PENDING) {
|
||
|
cf->state = __IAVF_CF_INVALID;
|
||
|
dev_info(&adapter->pdev->dev, "Failed to add cloud filter, error %s\n",
|
||
|
iavf_stat_str(&adapter->hw,
|
||
|
v_retval));
|
||
|
iavf_print_cloud_filter(adapter,
|
||
|
&cf->f);
|
||
|
list_del(&cf->list);
|
||
|
kfree(cf);
|
||
|
adapter->num_cloud_filters--;
|
||
|
}
|
||
|
}
|
||
|
}
|
||
|
break;
|
||
|
case VIRTCHNL_OP_DEL_CLOUD_FILTER: {
|
||
|
struct iavf_cloud_filter *cf;
|
||
|
|
||
|
list_for_each_entry(cf, &adapter->cloud_filter_list,
|
||
|
list) {
|
||
|
if (cf->state == __IAVF_CF_DEL_PENDING) {
|
||
|
cf->state = __IAVF_CF_ACTIVE;
|
||
|
dev_info(&adapter->pdev->dev, "Failed to del cloud filter, error %s\n",
|
||
|
iavf_stat_str(&adapter->hw,
|
||
|
v_retval));
|
||
|
iavf_print_cloud_filter(adapter,
|
||
|
&cf->f);
|
||
|
}
|
||
|
}
|
||
|
}
|
||
|
break;
|
||
|
default:
|
||
|
dev_err(&adapter->pdev->dev, "PF returned error %d (%s) to our request %d\n",
|
||
|
v_retval, iavf_stat_str(&adapter->hw, v_retval),
|
||
|
v_opcode);
|
||
|
}
|
||
|
}
|
||
|
switch (v_opcode) {
|
||
|
case VIRTCHNL_OP_ADD_ETH_ADDR: {
|
||
|
if (!ether_addr_equal(netdev->dev_addr, adapter->hw.mac.addr))
|
||
|
ether_addr_copy(netdev->dev_addr, adapter->hw.mac.addr);
|
||
|
}
|
||
|
break;
|
||
|
case VIRTCHNL_OP_GET_STATS: {
|
||
|
struct iavf_eth_stats *stats =
|
||
|
(struct iavf_eth_stats *)msg;
|
||
|
netdev->stats.rx_packets = stats->rx_unicast +
|
||
|
stats->rx_multicast +
|
||
|
stats->rx_broadcast;
|
||
|
netdev->stats.tx_packets = stats->tx_unicast +
|
||
|
stats->tx_multicast +
|
||
|
stats->tx_broadcast;
|
||
|
netdev->stats.rx_bytes = stats->rx_bytes;
|
||
|
netdev->stats.tx_bytes = stats->tx_bytes;
|
||
|
netdev->stats.tx_errors = stats->tx_errors;
|
||
|
netdev->stats.rx_dropped = stats->rx_discards;
|
||
|
netdev->stats.tx_dropped = stats->tx_discards;
|
||
|
adapter->current_stats = *stats;
|
||
|
}
|
||
|
break;
|
||
|
case VIRTCHNL_OP_GET_VF_RESOURCES: {
|
||
|
u16 len = sizeof(struct virtchnl_vf_resource) +
|
||
|
IAVF_MAX_VF_VSI *
|
||
|
sizeof(struct virtchnl_vsi_resource);
|
||
|
memcpy(adapter->vf_res, msg, min(msglen, len));
|
||
|
iavf_validate_num_queues(adapter);
|
||
|
iavf_vf_parse_hw_config(&adapter->hw, adapter->vf_res);
|
||
|
if (is_zero_ether_addr(adapter->hw.mac.addr)) {
|
||
|
/* restore current mac address */
|
||
|
ether_addr_copy(adapter->hw.mac.addr, netdev->dev_addr);
|
||
|
} else {
|
||
|
/* refresh current mac address if changed */
|
||
|
ether_addr_copy(netdev->dev_addr, adapter->hw.mac.addr);
|
||
|
ether_addr_copy(netdev->perm_addr,
|
||
|
adapter->hw.mac.addr);
|
||
|
}
|
||
|
spin_lock_bh(&adapter->mac_vlan_list_lock);
|
||
|
iavf_add_filter(adapter, adapter->hw.mac.addr);
|
||
|
spin_unlock_bh(&adapter->mac_vlan_list_lock);
|
||
|
iavf_process_config(adapter);
|
||
|
}
|
||
|
break;
|
||
|
case VIRTCHNL_OP_ENABLE_QUEUES:
|
||
|
/* enable transmits */
|
||
|
iavf_irq_enable(adapter, true);
|
||
|
adapter->flags &= ~IAVF_FLAG_QUEUES_DISABLED;
|
||
|
break;
|
||
|
case VIRTCHNL_OP_DISABLE_QUEUES:
|
||
|
iavf_free_all_tx_resources(adapter);
|
||
|
iavf_free_all_rx_resources(adapter);
|
||
|
if (adapter->state == __IAVF_DOWN_PENDING) {
|
||
|
adapter->state = __IAVF_DOWN;
|
||
|
wake_up(&adapter->down_waitqueue);
|
||
|
}
|
||
|
break;
|
||
|
case VIRTCHNL_OP_VERSION:
|
||
|
case VIRTCHNL_OP_CONFIG_IRQ_MAP:
|
||
|
/* Don't display an error if we get these out of sequence.
|
||
|
* If the firmware needed to get kicked, we'll get these and
|
||
|
* it's no problem.
|
||
|
*/
|
||
|
if (v_opcode != adapter->current_op)
|
||
|
return;
|
||
|
break;
|
||
|
case VIRTCHNL_OP_IWARP:
|
||
|
/* Gobble zero-length replies from the PF. They indicate that
|
||
|
* a previous message was received OK, and the client doesn't
|
||
|
* care about that.
|
||
|
*/
|
||
|
if (msglen && CLIENT_ENABLED(adapter))
|
||
|
iavf_notify_client_message(&adapter->vsi, msg, msglen);
|
||
|
break;
|
||
|
|
||
|
case VIRTCHNL_OP_CONFIG_IWARP_IRQ_MAP:
|
||
|
adapter->client_pending &=
|
||
|
~(BIT(VIRTCHNL_OP_CONFIG_IWARP_IRQ_MAP));
|
||
|
break;
|
||
|
case VIRTCHNL_OP_GET_RSS_HENA_CAPS: {
|
||
|
struct virtchnl_rss_hena *vrh = (struct virtchnl_rss_hena *)msg;
|
||
|
|
||
|
if (msglen == sizeof(*vrh))
|
||
|
adapter->hena = vrh->hena;
|
||
|
else
|
||
|
dev_warn(&adapter->pdev->dev,
|
||
|
"Invalid message %d from PF\n", v_opcode);
|
||
|
}
|
||
|
break;
|
||
|
case VIRTCHNL_OP_REQUEST_QUEUES: {
|
||
|
struct virtchnl_vf_res_request *vfres =
|
||
|
(struct virtchnl_vf_res_request *)msg;
|
||
|
|
||
|
if (vfres->num_queue_pairs != adapter->num_req_queues) {
|
||
|
dev_info(&adapter->pdev->dev,
|
||
|
"Requested %d queues, PF can support %d\n",
|
||
|
adapter->num_req_queues,
|
||
|
vfres->num_queue_pairs);
|
||
|
adapter->num_req_queues = 0;
|
||
|
adapter->flags &= ~IAVF_FLAG_REINIT_ITR_NEEDED;
|
||
|
}
|
||
|
}
|
||
|
break;
|
||
|
case VIRTCHNL_OP_ADD_CLOUD_FILTER: {
|
||
|
struct iavf_cloud_filter *cf;
|
||
|
|
||
|
list_for_each_entry(cf, &adapter->cloud_filter_list, list) {
|
||
|
if (cf->state == __IAVF_CF_ADD_PENDING)
|
||
|
cf->state = __IAVF_CF_ACTIVE;
|
||
|
}
|
||
|
}
|
||
|
break;
|
||
|
case VIRTCHNL_OP_DEL_CLOUD_FILTER: {
|
||
|
struct iavf_cloud_filter *cf, *cftmp;
|
||
|
|
||
|
list_for_each_entry_safe(cf, cftmp, &adapter->cloud_filter_list,
|
||
|
list) {
|
||
|
if (cf->state == __IAVF_CF_DEL_PENDING) {
|
||
|
cf->state = __IAVF_CF_INVALID;
|
||
|
list_del(&cf->list);
|
||
|
kfree(cf);
|
||
|
adapter->num_cloud_filters--;
|
||
|
}
|
||
|
}
|
||
|
}
|
||
|
break;
|
||
|
default:
|
||
|
if (adapter->current_op && (v_opcode != adapter->current_op))
|
||
|
dev_warn(&adapter->pdev->dev, "Expected response %d from PF, received %d\n",
|
||
|
adapter->current_op, v_opcode);
|
||
|
break;
|
||
|
} /* switch v_opcode */
|
||
|
adapter->current_op = VIRTCHNL_OP_UNKNOWN;
|
||
|
}
|