|
@@ -0,0 +1,772 @@
|
|
|
+/*******************************************************************************
|
|
|
+ *
|
|
|
+ * Intel Ethernet Controller XL710 Family Linux Virtual Function Driver
|
|
|
+ * Copyright(c) 2013 Intel Corporation.
|
|
|
+ *
|
|
|
+ * 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.
|
|
|
+ *
|
|
|
+ * 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 "i40evf.h"
|
|
|
+#include "i40e_prototype.h"
|
|
|
+
|
|
|
+/* busy wait delay in msec */
|
|
|
+#define I40EVF_BUSY_WAIT_DELAY 10
|
|
|
+#define I40EVF_BUSY_WAIT_COUNT 50
|
|
|
+
|
|
|
+/**
|
|
|
+ * i40evf_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 i40evf_send_pf_msg(struct i40evf_adapter *adapter,
|
|
|
+ enum i40e_virtchnl_ops op, u8 *msg, u16 len)
|
|
|
+{
|
|
|
+ struct i40e_hw *hw = &adapter->hw;
|
|
|
+ i40e_status err;
|
|
|
+
|
|
|
+ err = i40e_aq_send_msg_to_pf(hw, op, 0, msg, len, NULL);
|
|
|
+ if (err)
|
|
|
+ dev_err(&adapter->pdev->dev, "Unable to send opcode %d to PF, error %d, aq status %d\n",
|
|
|
+ op, err, hw->aq.asq_last_status);
|
|
|
+ return err;
|
|
|
+}
|
|
|
+
|
|
|
+/**
|
|
|
+ * i40evf_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 I40E_ADMIN_QUEUE_ERROR_ statuses if not.
|
|
|
+ **/
|
|
|
+int i40evf_send_api_ver(struct i40evf_adapter *adapter)
|
|
|
+{
|
|
|
+ struct i40e_virtchnl_version_info vvi;
|
|
|
+
|
|
|
+ vvi.major = I40E_VIRTCHNL_VERSION_MAJOR;
|
|
|
+ vvi.minor = I40E_VIRTCHNL_VERSION_MINOR;
|
|
|
+
|
|
|
+ return i40evf_send_pf_msg(adapter, I40E_VIRTCHNL_OP_VERSION, (u8 *)&vvi,
|
|
|
+ sizeof(vvi));
|
|
|
+}
|
|
|
+
|
|
|
+/**
|
|
|
+ * i40evf_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, or I40E_ERR_ADMIN_QUEUE_NO_WORK if the admin queue is empty.
|
|
|
+ **/
|
|
|
+int i40evf_verify_api_ver(struct i40evf_adapter *adapter)
|
|
|
+{
|
|
|
+ struct i40e_virtchnl_version_info *pf_vvi;
|
|
|
+ struct i40e_hw *hw = &adapter->hw;
|
|
|
+ struct i40e_arq_event_info event;
|
|
|
+ i40e_status err;
|
|
|
+
|
|
|
+ event.msg_size = I40EVF_MAX_AQ_BUF_SIZE;
|
|
|
+ event.msg_buf = kzalloc(event.msg_size, GFP_KERNEL);
|
|
|
+ if (!event.msg_buf) {
|
|
|
+ err = -ENOMEM;
|
|
|
+ goto out;
|
|
|
+ }
|
|
|
+
|
|
|
+ err = i40evf_clean_arq_element(hw, &event, NULL);
|
|
|
+ if (err == I40E_ERR_ADMIN_QUEUE_NO_WORK)
|
|
|
+ goto out_alloc;
|
|
|
+
|
|
|
+ err = (i40e_status)le32_to_cpu(event.desc.cookie_low);
|
|
|
+ if (err) {
|
|
|
+ err = -EIO;
|
|
|
+ goto out_alloc;
|
|
|
+ }
|
|
|
+
|
|
|
+ if ((enum i40e_virtchnl_ops)le32_to_cpu(event.desc.cookie_high) !=
|
|
|
+ I40E_VIRTCHNL_OP_VERSION) {
|
|
|
+ err = -EIO;
|
|
|
+ goto out_alloc;
|
|
|
+ }
|
|
|
+
|
|
|
+ pf_vvi = (struct i40e_virtchnl_version_info *)event.msg_buf;
|
|
|
+ if ((pf_vvi->major != I40E_VIRTCHNL_VERSION_MAJOR) ||
|
|
|
+ (pf_vvi->minor != I40E_VIRTCHNL_VERSION_MINOR))
|
|
|
+ err = -EIO;
|
|
|
+
|
|
|
+out_alloc:
|
|
|
+ kfree(event.msg_buf);
|
|
|
+out:
|
|
|
+ return err;
|
|
|
+}
|
|
|
+
|
|
|
+/**
|
|
|
+ * i40evf_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 I40E_ADMIN_QUEUE_ERROR_ statuses if not.
|
|
|
+ **/
|
|
|
+int i40evf_send_vf_config_msg(struct i40evf_adapter *adapter)
|
|
|
+{
|
|
|
+ return i40evf_send_pf_msg(adapter, I40E_VIRTCHNL_OP_GET_VF_RESOURCES,
|
|
|
+ NULL, 0);
|
|
|
+}
|
|
|
+
|
|
|
+/**
|
|
|
+ * i40evf_get_vf_config
|
|
|
+ * @hw: pointer to the hardware structure
|
|
|
+ * @len: length of buffer
|
|
|
+ *
|
|
|
+ * 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 i40evf_get_vf_config(struct i40evf_adapter *adapter)
|
|
|
+{
|
|
|
+ struct i40e_hw *hw = &adapter->hw;
|
|
|
+ struct i40e_arq_event_info event;
|
|
|
+ u16 len;
|
|
|
+ i40e_status err;
|
|
|
+
|
|
|
+ len = sizeof(struct i40e_virtchnl_vf_resource) +
|
|
|
+ I40E_MAX_VF_VSI * sizeof(struct i40e_virtchnl_vsi_resource);
|
|
|
+ event.msg_size = len;
|
|
|
+ event.msg_buf = kzalloc(event.msg_size, GFP_KERNEL);
|
|
|
+ if (!event.msg_buf) {
|
|
|
+ err = -ENOMEM;
|
|
|
+ goto out;
|
|
|
+ }
|
|
|
+
|
|
|
+ err = i40evf_clean_arq_element(hw, &event, NULL);
|
|
|
+ if (err == I40E_ERR_ADMIN_QUEUE_NO_WORK)
|
|
|
+ goto out_alloc;
|
|
|
+
|
|
|
+ err = (i40e_status)le32_to_cpu(event.desc.cookie_low);
|
|
|
+ if (err) {
|
|
|
+ dev_err(&adapter->pdev->dev,
|
|
|
+ "%s: Error returned from PF, %d, %d\n", __func__,
|
|
|
+ le32_to_cpu(event.desc.cookie_high),
|
|
|
+ le32_to_cpu(event.desc.cookie_low));
|
|
|
+ err = -EIO;
|
|
|
+ goto out_alloc;
|
|
|
+ }
|
|
|
+
|
|
|
+ if ((enum i40e_virtchnl_ops)le32_to_cpu(event.desc.cookie_high) !=
|
|
|
+ I40E_VIRTCHNL_OP_GET_VF_RESOURCES) {
|
|
|
+ dev_err(&adapter->pdev->dev,
|
|
|
+ "%s: Invalid response from PF, %d, %d\n", __func__,
|
|
|
+ le32_to_cpu(event.desc.cookie_high),
|
|
|
+ le32_to_cpu(event.desc.cookie_low));
|
|
|
+ err = -EIO;
|
|
|
+ goto out_alloc;
|
|
|
+ }
|
|
|
+ memcpy(adapter->vf_res, event.msg_buf, min(event.msg_size, len));
|
|
|
+
|
|
|
+ i40e_vf_parse_hw_config(hw, adapter->vf_res);
|
|
|
+out_alloc:
|
|
|
+ kfree(event.msg_buf);
|
|
|
+out:
|
|
|
+ return err;
|
|
|
+}
|
|
|
+
|
|
|
+/**
|
|
|
+ * i40evf_configure_queues
|
|
|
+ * @adapter: adapter structure
|
|
|
+ *
|
|
|
+ * Request that the PF set up our (previously allocated) queues.
|
|
|
+ **/
|
|
|
+void i40evf_configure_queues(struct i40evf_adapter *adapter)
|
|
|
+{
|
|
|
+ struct i40e_virtchnl_vsi_queue_config_info *vqci;
|
|
|
+ struct i40e_virtchnl_queue_pair_info *vqpi;
|
|
|
+ int pairs = adapter->vsi_res->num_queue_pairs;
|
|
|
+ int i, len;
|
|
|
+
|
|
|
+ if (adapter->current_op != I40E_VIRTCHNL_OP_UNKNOWN) {
|
|
|
+ /* bail because we already have a command pending */
|
|
|
+ dev_err(&adapter->pdev->dev, "%s: command %d pending\n",
|
|
|
+ __func__, adapter->current_op);
|
|
|
+ return;
|
|
|
+ }
|
|
|
+ adapter->current_op = I40E_VIRTCHNL_OP_CONFIG_VSI_QUEUES;
|
|
|
+ len = sizeof(struct i40e_virtchnl_vsi_queue_config_info) +
|
|
|
+ (sizeof(struct i40e_virtchnl_queue_pair_info) * pairs);
|
|
|
+ vqci = kzalloc(len, GFP_ATOMIC);
|
|
|
+ if (!vqci) {
|
|
|
+ dev_err(&adapter->pdev->dev, "%s: unable to allocate memory\n",
|
|
|
+ __func__);
|
|
|
+ return;
|
|
|
+ }
|
|
|
+ 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 = adapter->netdev->mtu
|
|
|
+ + ETH_HLEN + VLAN_HLEN + ETH_FCS_LEN;
|
|
|
+ vqpi->rxq.databuffer_size = adapter->rx_rings[i]->rx_buf_len;
|
|
|
+ vqpi++;
|
|
|
+ }
|
|
|
+
|
|
|
+ i40evf_send_pf_msg(adapter, I40E_VIRTCHNL_OP_CONFIG_VSI_QUEUES,
|
|
|
+ (u8 *)vqci, len);
|
|
|
+ kfree(vqci);
|
|
|
+ adapter->aq_pending |= I40EVF_FLAG_AQ_CONFIGURE_QUEUES;
|
|
|
+ adapter->aq_required &= ~I40EVF_FLAG_AQ_CONFIGURE_QUEUES;
|
|
|
+}
|
|
|
+
|
|
|
+/**
|
|
|
+ * i40evf_enable_queues
|
|
|
+ * @adapter: adapter structure
|
|
|
+ *
|
|
|
+ * Request that the PF enable all of our queues.
|
|
|
+ **/
|
|
|
+void i40evf_enable_queues(struct i40evf_adapter *adapter)
|
|
|
+{
|
|
|
+ struct i40e_virtchnl_queue_select vqs;
|
|
|
+
|
|
|
+ if (adapter->current_op != I40E_VIRTCHNL_OP_UNKNOWN) {
|
|
|
+ /* bail because we already have a command pending */
|
|
|
+ dev_err(&adapter->pdev->dev, "%s: command %d pending\n",
|
|
|
+ __func__, adapter->current_op);
|
|
|
+ return;
|
|
|
+ }
|
|
|
+ adapter->current_op = I40E_VIRTCHNL_OP_ENABLE_QUEUES;
|
|
|
+ vqs.vsi_id = adapter->vsi_res->vsi_id;
|
|
|
+ vqs.tx_queues = (1 << adapter->vsi_res->num_queue_pairs) - 1;
|
|
|
+ vqs.rx_queues = vqs.tx_queues;
|
|
|
+ i40evf_send_pf_msg(adapter, I40E_VIRTCHNL_OP_ENABLE_QUEUES,
|
|
|
+ (u8 *)&vqs, sizeof(vqs));
|
|
|
+ adapter->aq_pending |= I40EVF_FLAG_AQ_ENABLE_QUEUES;
|
|
|
+ adapter->aq_required &= ~I40EVF_FLAG_AQ_ENABLE_QUEUES;
|
|
|
+}
|
|
|
+
|
|
|
+/**
|
|
|
+ * i40evf_disable_queues
|
|
|
+ * @adapter: adapter structure
|
|
|
+ *
|
|
|
+ * Request that the PF disable all of our queues.
|
|
|
+ **/
|
|
|
+void i40evf_disable_queues(struct i40evf_adapter *adapter)
|
|
|
+{
|
|
|
+ struct i40e_virtchnl_queue_select vqs;
|
|
|
+
|
|
|
+ if (adapter->current_op != I40E_VIRTCHNL_OP_UNKNOWN) {
|
|
|
+ /* bail because we already have a command pending */
|
|
|
+ dev_err(&adapter->pdev->dev, "%s: command %d pending\n",
|
|
|
+ __func__, adapter->current_op);
|
|
|
+ return;
|
|
|
+ }
|
|
|
+ adapter->current_op = I40E_VIRTCHNL_OP_DISABLE_QUEUES;
|
|
|
+ vqs.vsi_id = adapter->vsi_res->vsi_id;
|
|
|
+ vqs.tx_queues = (1 << adapter->vsi_res->num_queue_pairs) - 1;
|
|
|
+ vqs.rx_queues = vqs.tx_queues;
|
|
|
+ i40evf_send_pf_msg(adapter, I40E_VIRTCHNL_OP_DISABLE_QUEUES,
|
|
|
+ (u8 *)&vqs, sizeof(vqs));
|
|
|
+ adapter->aq_pending |= I40EVF_FLAG_AQ_DISABLE_QUEUES;
|
|
|
+ adapter->aq_required &= ~I40EVF_FLAG_AQ_DISABLE_QUEUES;
|
|
|
+}
|
|
|
+
|
|
|
+/**
|
|
|
+ * i40evf_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 i40evf_map_queues(struct i40evf_adapter *adapter)
|
|
|
+{
|
|
|
+ struct i40e_virtchnl_irq_map_info *vimi;
|
|
|
+ int v_idx, q_vectors, len;
|
|
|
+ struct i40e_q_vector *q_vector;
|
|
|
+
|
|
|
+ if (adapter->current_op != I40E_VIRTCHNL_OP_UNKNOWN) {
|
|
|
+ /* bail because we already have a command pending */
|
|
|
+ dev_err(&adapter->pdev->dev, "%s: command %d pending\n",
|
|
|
+ __func__, adapter->current_op);
|
|
|
+ return;
|
|
|
+ }
|
|
|
+ adapter->current_op = I40E_VIRTCHNL_OP_CONFIG_IRQ_MAP;
|
|
|
+
|
|
|
+ q_vectors = adapter->num_msix_vectors - NONQ_VECS;
|
|
|
+
|
|
|
+ len = sizeof(struct i40e_virtchnl_irq_map_info) +
|
|
|
+ (adapter->num_msix_vectors *
|
|
|
+ sizeof(struct i40e_virtchnl_vector_map));
|
|
|
+ vimi = kzalloc(len, GFP_ATOMIC);
|
|
|
+ if (!vimi) {
|
|
|
+ dev_err(&adapter->pdev->dev, "%s: unable to allocate memory\n",
|
|
|
+ __func__);
|
|
|
+ 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_vector[v_idx];
|
|
|
+ vimi->vecmap[v_idx].vsi_id = adapter->vsi_res->vsi_id;
|
|
|
+ vimi->vecmap[v_idx].vector_id = v_idx + NONQ_VECS;
|
|
|
+ vimi->vecmap[v_idx].txq_map = q_vector->ring_mask;
|
|
|
+ vimi->vecmap[v_idx].rxq_map = q_vector->ring_mask;
|
|
|
+ }
|
|
|
+ /* Misc vector last - this is only for AdminQ messages */
|
|
|
+ vimi->vecmap[v_idx].vsi_id = adapter->vsi_res->vsi_id;
|
|
|
+ vimi->vecmap[v_idx].vector_id = 0;
|
|
|
+ vimi->vecmap[v_idx].txq_map = 0;
|
|
|
+ vimi->vecmap[v_idx].rxq_map = 0;
|
|
|
+
|
|
|
+ i40evf_send_pf_msg(adapter, I40E_VIRTCHNL_OP_CONFIG_IRQ_MAP,
|
|
|
+ (u8 *)vimi, len);
|
|
|
+ kfree(vimi);
|
|
|
+ adapter->aq_pending |= I40EVF_FLAG_AQ_MAP_VECTORS;
|
|
|
+ adapter->aq_required &= ~I40EVF_FLAG_AQ_MAP_VECTORS;
|
|
|
+}
|
|
|
+
|
|
|
+/**
|
|
|
+ * i40evf_add_ether_addrs
|
|
|
+ * @adapter: adapter structure
|
|
|
+ * @addrs: the MAC address filters to add (contiguous)
|
|
|
+ * @count: number of filters
|
|
|
+ *
|
|
|
+ * Request that the PF add one or more addresses to our filters.
|
|
|
+ **/
|
|
|
+void i40evf_add_ether_addrs(struct i40evf_adapter *adapter)
|
|
|
+{
|
|
|
+ struct i40e_virtchnl_ether_addr_list *veal;
|
|
|
+ int len, i = 0, count = 0;
|
|
|
+ struct i40evf_mac_filter *f;
|
|
|
+
|
|
|
+ if (adapter->current_op != I40E_VIRTCHNL_OP_UNKNOWN) {
|
|
|
+ /* bail because we already have a command pending */
|
|
|
+ dev_err(&adapter->pdev->dev, "%s: command %d pending\n",
|
|
|
+ __func__, adapter->current_op);
|
|
|
+ return;
|
|
|
+ }
|
|
|
+ list_for_each_entry(f, &adapter->mac_filter_list, list) {
|
|
|
+ if (f->add)
|
|
|
+ count++;
|
|
|
+ }
|
|
|
+ if (!count) {
|
|
|
+ adapter->aq_required &= ~I40EVF_FLAG_AQ_ADD_MAC_FILTER;
|
|
|
+ return;
|
|
|
+ }
|
|
|
+ adapter->current_op = I40E_VIRTCHNL_OP_ADD_ETHER_ADDRESS;
|
|
|
+
|
|
|
+ len = sizeof(struct i40e_virtchnl_ether_addr_list) +
|
|
|
+ (count * sizeof(struct i40e_virtchnl_ether_addr));
|
|
|
+ if (len > I40EVF_MAX_AQ_BUF_SIZE) {
|
|
|
+ dev_warn(&adapter->pdev->dev, "%s: Too many MAC address changes in one request.\n",
|
|
|
+ __func__);
|
|
|
+ count = (I40EVF_MAX_AQ_BUF_SIZE -
|
|
|
+ sizeof(struct i40e_virtchnl_ether_addr_list)) /
|
|
|
+ sizeof(struct i40e_virtchnl_ether_addr);
|
|
|
+ len = I40EVF_MAX_AQ_BUF_SIZE;
|
|
|
+ }
|
|
|
+
|
|
|
+ veal = kzalloc(len, GFP_ATOMIC);
|
|
|
+ if (!veal) {
|
|
|
+ dev_err(&adapter->pdev->dev, "%s: unable to allocate memory\n",
|
|
|
+ __func__);
|
|
|
+ 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) {
|
|
|
+ memcpy(veal->list[i].addr, f->macaddr, ETH_ALEN);
|
|
|
+ i++;
|
|
|
+ f->add = false;
|
|
|
+ }
|
|
|
+ }
|
|
|
+ i40evf_send_pf_msg(adapter, I40E_VIRTCHNL_OP_ADD_ETHER_ADDRESS,
|
|
|
+ (u8 *)veal, len);
|
|
|
+ kfree(veal);
|
|
|
+ adapter->aq_pending |= I40EVF_FLAG_AQ_ADD_MAC_FILTER;
|
|
|
+ adapter->aq_required &= ~I40EVF_FLAG_AQ_ADD_MAC_FILTER;
|
|
|
+
|
|
|
+}
|
|
|
+
|
|
|
+/**
|
|
|
+ * i40evf_del_ether_addrs
|
|
|
+ * @adapter: adapter structure
|
|
|
+ * @addrs: the MAC address filters to remove (contiguous)
|
|
|
+ * @count: number of filtes
|
|
|
+ *
|
|
|
+ * Request that the PF remove one or more addresses from our filters.
|
|
|
+ **/
|
|
|
+void i40evf_del_ether_addrs(struct i40evf_adapter *adapter)
|
|
|
+{
|
|
|
+ struct i40e_virtchnl_ether_addr_list *veal;
|
|
|
+ struct i40evf_mac_filter *f, *ftmp;
|
|
|
+ int len, i = 0, count = 0;
|
|
|
+
|
|
|
+ if (adapter->current_op != I40E_VIRTCHNL_OP_UNKNOWN) {
|
|
|
+ /* bail because we already have a command pending */
|
|
|
+ dev_err(&adapter->pdev->dev, "%s: command %d pending\n",
|
|
|
+ __func__, adapter->current_op);
|
|
|
+ return;
|
|
|
+ }
|
|
|
+ list_for_each_entry(f, &adapter->mac_filter_list, list) {
|
|
|
+ if (f->remove)
|
|
|
+ count++;
|
|
|
+ }
|
|
|
+ if (!count) {
|
|
|
+ adapter->aq_required &= ~I40EVF_FLAG_AQ_DEL_MAC_FILTER;
|
|
|
+ return;
|
|
|
+ }
|
|
|
+ adapter->current_op = I40E_VIRTCHNL_OP_DEL_ETHER_ADDRESS;
|
|
|
+
|
|
|
+ len = sizeof(struct i40e_virtchnl_ether_addr_list) +
|
|
|
+ (count * sizeof(struct i40e_virtchnl_ether_addr));
|
|
|
+ if (len > I40EVF_MAX_AQ_BUF_SIZE) {
|
|
|
+ dev_warn(&adapter->pdev->dev, "%s: Too many MAC address changes in one request.\n",
|
|
|
+ __func__);
|
|
|
+ count = (I40EVF_MAX_AQ_BUF_SIZE -
|
|
|
+ sizeof(struct i40e_virtchnl_ether_addr_list)) /
|
|
|
+ sizeof(struct i40e_virtchnl_ether_addr);
|
|
|
+ len = I40EVF_MAX_AQ_BUF_SIZE;
|
|
|
+ }
|
|
|
+ veal = kzalloc(len, GFP_ATOMIC);
|
|
|
+ if (!veal) {
|
|
|
+ dev_err(&adapter->pdev->dev, "%s: unable to allocate memory\n",
|
|
|
+ __func__);
|
|
|
+ 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) {
|
|
|
+ memcpy(veal->list[i].addr, f->macaddr, ETH_ALEN);
|
|
|
+ i++;
|
|
|
+ list_del(&f->list);
|
|
|
+ kfree(f);
|
|
|
+ }
|
|
|
+ }
|
|
|
+ i40evf_send_pf_msg(adapter, I40E_VIRTCHNL_OP_DEL_ETHER_ADDRESS,
|
|
|
+ (u8 *)veal, len);
|
|
|
+ kfree(veal);
|
|
|
+ adapter->aq_pending |= I40EVF_FLAG_AQ_DEL_MAC_FILTER;
|
|
|
+ adapter->aq_required &= ~I40EVF_FLAG_AQ_DEL_MAC_FILTER;
|
|
|
+}
|
|
|
+
|
|
|
+/**
|
|
|
+ * i40evf_add_vlans
|
|
|
+ * @adapter: adapter structure
|
|
|
+ * @vlans: the VLANs to add
|
|
|
+ * @count: number of VLANs
|
|
|
+ *
|
|
|
+ * Request that the PF add one or more VLAN filters to our VSI.
|
|
|
+ **/
|
|
|
+void i40evf_add_vlans(struct i40evf_adapter *adapter)
|
|
|
+{
|
|
|
+ struct i40e_virtchnl_vlan_filter_list *vvfl;
|
|
|
+ int len, i = 0, count = 0;
|
|
|
+ struct i40evf_vlan_filter *f;
|
|
|
+
|
|
|
+ if (adapter->current_op != I40E_VIRTCHNL_OP_UNKNOWN) {
|
|
|
+ /* bail because we already have a command pending */
|
|
|
+ dev_err(&adapter->pdev->dev, "%s: command %d pending\n",
|
|
|
+ __func__, adapter->current_op);
|
|
|
+ return;
|
|
|
+ }
|
|
|
+
|
|
|
+ list_for_each_entry(f, &adapter->vlan_filter_list, list) {
|
|
|
+ if (f->add)
|
|
|
+ count++;
|
|
|
+ }
|
|
|
+ if (!count) {
|
|
|
+ adapter->aq_required &= ~I40EVF_FLAG_AQ_ADD_VLAN_FILTER;
|
|
|
+ return;
|
|
|
+ }
|
|
|
+ adapter->current_op = I40E_VIRTCHNL_OP_ADD_VLAN;
|
|
|
+
|
|
|
+ len = sizeof(struct i40e_virtchnl_vlan_filter_list) +
|
|
|
+ (count * sizeof(u16));
|
|
|
+ if (len > I40EVF_MAX_AQ_BUF_SIZE) {
|
|
|
+ dev_warn(&adapter->pdev->dev, "%s: Too many VLAN changes in one request.\n",
|
|
|
+ __func__);
|
|
|
+ count = (I40EVF_MAX_AQ_BUF_SIZE -
|
|
|
+ sizeof(struct i40e_virtchnl_vlan_filter_list)) /
|
|
|
+ sizeof(u16);
|
|
|
+ len = I40EVF_MAX_AQ_BUF_SIZE;
|
|
|
+ }
|
|
|
+ vvfl = kzalloc(len, GFP_ATOMIC);
|
|
|
+ if (!vvfl) {
|
|
|
+ dev_err(&adapter->pdev->dev, "%s: unable to allocate memory\n",
|
|
|
+ __func__);
|
|
|
+ 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;
|
|
|
+ }
|
|
|
+ }
|
|
|
+ i40evf_send_pf_msg(adapter, I40E_VIRTCHNL_OP_ADD_VLAN, (u8 *)vvfl, len);
|
|
|
+ kfree(vvfl);
|
|
|
+ adapter->aq_pending |= I40EVF_FLAG_AQ_ADD_VLAN_FILTER;
|
|
|
+ adapter->aq_required &= ~I40EVF_FLAG_AQ_ADD_VLAN_FILTER;
|
|
|
+}
|
|
|
+
|
|
|
+/**
|
|
|
+ * i40evf_del_vlans
|
|
|
+ * @adapter: adapter structure
|
|
|
+ * @vlans: the VLANs to remove
|
|
|
+ * @count: number of VLANs
|
|
|
+ *
|
|
|
+ * Request that the PF remove one or more VLAN filters from our VSI.
|
|
|
+ **/
|
|
|
+void i40evf_del_vlans(struct i40evf_adapter *adapter)
|
|
|
+{
|
|
|
+ struct i40e_virtchnl_vlan_filter_list *vvfl;
|
|
|
+ struct i40evf_vlan_filter *f, *ftmp;
|
|
|
+ int len, i = 0, count = 0;
|
|
|
+
|
|
|
+ if (adapter->current_op != I40E_VIRTCHNL_OP_UNKNOWN) {
|
|
|
+ /* bail because we already have a command pending */
|
|
|
+ dev_err(&adapter->pdev->dev, "%s: command %d pending\n",
|
|
|
+ __func__, adapter->current_op);
|
|
|
+ return;
|
|
|
+ }
|
|
|
+
|
|
|
+ list_for_each_entry(f, &adapter->vlan_filter_list, list) {
|
|
|
+ if (f->remove)
|
|
|
+ count++;
|
|
|
+ }
|
|
|
+ if (!count) {
|
|
|
+ adapter->aq_required &= ~I40EVF_FLAG_AQ_DEL_VLAN_FILTER;
|
|
|
+ return;
|
|
|
+ }
|
|
|
+ adapter->current_op = I40E_VIRTCHNL_OP_DEL_VLAN;
|
|
|
+
|
|
|
+ len = sizeof(struct i40e_virtchnl_vlan_filter_list) +
|
|
|
+ (count * sizeof(u16));
|
|
|
+ if (len > I40EVF_MAX_AQ_BUF_SIZE) {
|
|
|
+ dev_warn(&adapter->pdev->dev, "%s: Too many VLAN changes in one request.\n",
|
|
|
+ __func__);
|
|
|
+ count = (I40EVF_MAX_AQ_BUF_SIZE -
|
|
|
+ sizeof(struct i40e_virtchnl_vlan_filter_list)) /
|
|
|
+ sizeof(u16);
|
|
|
+ len = I40EVF_MAX_AQ_BUF_SIZE;
|
|
|
+ }
|
|
|
+ vvfl = kzalloc(len, GFP_ATOMIC);
|
|
|
+ if (!vvfl) {
|
|
|
+ dev_err(&adapter->pdev->dev, "%s: unable to allocate memory\n",
|
|
|
+ __func__);
|
|
|
+ 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);
|
|
|
+ }
|
|
|
+ }
|
|
|
+ i40evf_send_pf_msg(adapter, I40E_VIRTCHNL_OP_DEL_VLAN, (u8 *)vvfl, len);
|
|
|
+ kfree(vvfl);
|
|
|
+ adapter->aq_pending |= I40EVF_FLAG_AQ_DEL_VLAN_FILTER;
|
|
|
+ adapter->aq_required &= ~I40EVF_FLAG_AQ_DEL_VLAN_FILTER;
|
|
|
+}
|
|
|
+
|
|
|
+/**
|
|
|
+ * i40evf_set_promiscuous
|
|
|
+ * @adapter: adapter structure
|
|
|
+ * @flags: bitmask to control unicast/multicast promiscuous.
|
|
|
+ *
|
|
|
+ * Request that the PF enable promiscuous mode for our VSI.
|
|
|
+ **/
|
|
|
+void i40evf_set_promiscuous(struct i40evf_adapter *adapter, int flags)
|
|
|
+{
|
|
|
+ struct i40e_virtchnl_promisc_info vpi;
|
|
|
+
|
|
|
+ if (adapter->current_op != I40E_VIRTCHNL_OP_UNKNOWN) {
|
|
|
+ /* bail because we already have a command pending */
|
|
|
+ dev_err(&adapter->pdev->dev, "%s: command %d pending\n",
|
|
|
+ __func__, adapter->current_op);
|
|
|
+ return;
|
|
|
+ }
|
|
|
+ adapter->current_op = I40E_VIRTCHNL_OP_CONFIG_PROMISCUOUS_MODE;
|
|
|
+ vpi.vsi_id = adapter->vsi_res->vsi_id;
|
|
|
+ vpi.flags = flags;
|
|
|
+ i40evf_send_pf_msg(adapter, I40E_VIRTCHNL_OP_CONFIG_PROMISCUOUS_MODE,
|
|
|
+ (u8 *)&vpi, sizeof(vpi));
|
|
|
+}
|
|
|
+
|
|
|
+/**
|
|
|
+ * i40evf_request_stats
|
|
|
+ * @adapter: adapter structure
|
|
|
+ *
|
|
|
+ * Request VSI statistics from PF.
|
|
|
+ **/
|
|
|
+void i40evf_request_stats(struct i40evf_adapter *adapter)
|
|
|
+{
|
|
|
+ struct i40e_virtchnl_queue_select vqs;
|
|
|
+ if (adapter->current_op != I40E_VIRTCHNL_OP_UNKNOWN) {
|
|
|
+ /* no error message, this isn't crucial */
|
|
|
+ return;
|
|
|
+ }
|
|
|
+ adapter->current_op = I40E_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 (i40evf_send_pf_msg(adapter, I40E_VIRTCHNL_OP_GET_STATS,
|
|
|
+ (u8 *)&vqs, sizeof(vqs)))
|
|
|
+ /* if the request failed, don't lock out others */
|
|
|
+ adapter->current_op = I40E_VIRTCHNL_OP_UNKNOWN;
|
|
|
+}
|
|
|
+
|
|
|
+/**
|
|
|
+ * i40evf_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 i40evf_virtchnl_completion(struct i40evf_adapter *adapter,
|
|
|
+ enum i40e_virtchnl_ops v_opcode,
|
|
|
+ i40e_status v_retval,
|
|
|
+ u8 *msg, u16 msglen)
|
|
|
+{
|
|
|
+ struct net_device *netdev = adapter->netdev;
|
|
|
+
|
|
|
+ if (v_opcode == I40E_VIRTCHNL_OP_EVENT) {
|
|
|
+ struct i40e_virtchnl_pf_event *vpe =
|
|
|
+ (struct i40e_virtchnl_pf_event *)msg;
|
|
|
+ switch (vpe->event) {
|
|
|
+ case I40E_VIRTCHNL_EVENT_LINK_CHANGE:
|
|
|
+ adapter->link_up =
|
|
|
+ vpe->event_data.link_event.link_status;
|
|
|
+ if (adapter->link_up && !netif_carrier_ok(netdev)) {
|
|
|
+ dev_info(&adapter->pdev->dev, "NIC Link is Up\n");
|
|
|
+ netif_carrier_on(netdev);
|
|
|
+ netif_tx_wake_all_queues(netdev);
|
|
|
+ } else if (!adapter->link_up) {
|
|
|
+ dev_info(&adapter->pdev->dev, "NIC Link is Down\n");
|
|
|
+ netif_carrier_off(netdev);
|
|
|
+ netif_tx_stop_all_queues(netdev);
|
|
|
+ }
|
|
|
+ break;
|
|
|
+ case I40E_VIRTCHNL_EVENT_RESET_IMPENDING:
|
|
|
+ adapter->state = __I40EVF_RESETTING;
|
|
|
+ schedule_work(&adapter->reset_task);
|
|
|
+ dev_info(&adapter->pdev->dev,
|
|
|
+ "%s: hardware reset pending\n", __func__);
|
|
|
+ break;
|
|
|
+ default:
|
|
|
+ dev_err(&adapter->pdev->dev,
|
|
|
+ "%s: Unknown event %d from pf\n",
|
|
|
+ __func__, vpe->event);
|
|
|
+ break;
|
|
|
+
|
|
|
+ }
|
|
|
+ return;
|
|
|
+ }
|
|
|
+ if (v_opcode != adapter->current_op) {
|
|
|
+ dev_err(&adapter->pdev->dev, "%s: Pending op is %d, received %d.\n",
|
|
|
+ __func__, adapter->current_op, v_opcode);
|
|
|
+ /* We're probably completely screwed at this point, but clear
|
|
|
+ * the current op and try to carry on....
|
|
|
+ */
|
|
|
+ adapter->current_op = I40E_VIRTCHNL_OP_UNKNOWN;
|
|
|
+ return;
|
|
|
+ }
|
|
|
+ if (v_retval) {
|
|
|
+ dev_err(&adapter->pdev->dev, "%s: PF returned error %d to our request %d!\n",
|
|
|
+ __func__, v_retval, v_opcode);
|
|
|
+ }
|
|
|
+ switch (v_opcode) {
|
|
|
+ case I40E_VIRTCHNL_OP_GET_STATS: {
|
|
|
+ struct i40e_eth_stats *stats =
|
|
|
+ (struct i40e_eth_stats *)msg;
|
|
|
+ adapter->net_stats.rx_packets = stats->rx_unicast +
|
|
|
+ stats->rx_multicast +
|
|
|
+ stats->rx_broadcast;
|
|
|
+ adapter->net_stats.tx_packets = stats->tx_unicast +
|
|
|
+ stats->tx_multicast +
|
|
|
+ stats->tx_broadcast;
|
|
|
+ adapter->net_stats.rx_bytes = stats->rx_bytes;
|
|
|
+ adapter->net_stats.tx_bytes = stats->tx_bytes;
|
|
|
+ adapter->net_stats.rx_errors = stats->rx_errors;
|
|
|
+ adapter->net_stats.tx_errors = stats->tx_errors;
|
|
|
+ adapter->net_stats.rx_dropped = stats->rx_missed;
|
|
|
+ adapter->net_stats.tx_dropped = stats->tx_discards;
|
|
|
+ adapter->current_stats = *stats;
|
|
|
+ }
|
|
|
+ break;
|
|
|
+ case I40E_VIRTCHNL_OP_ADD_ETHER_ADDRESS:
|
|
|
+ adapter->aq_pending &= ~(I40EVF_FLAG_AQ_ADD_MAC_FILTER);
|
|
|
+ break;
|
|
|
+ case I40E_VIRTCHNL_OP_DEL_ETHER_ADDRESS:
|
|
|
+ adapter->aq_pending &= ~(I40EVF_FLAG_AQ_DEL_MAC_FILTER);
|
|
|
+ break;
|
|
|
+ case I40E_VIRTCHNL_OP_ADD_VLAN:
|
|
|
+ adapter->aq_pending &= ~(I40EVF_FLAG_AQ_ADD_VLAN_FILTER);
|
|
|
+ break;
|
|
|
+ case I40E_VIRTCHNL_OP_DEL_VLAN:
|
|
|
+ adapter->aq_pending &= ~(I40EVF_FLAG_AQ_DEL_VLAN_FILTER);
|
|
|
+ break;
|
|
|
+ case I40E_VIRTCHNL_OP_ENABLE_QUEUES:
|
|
|
+ adapter->aq_pending &= ~(I40EVF_FLAG_AQ_ENABLE_QUEUES);
|
|
|
+ /* enable transmits */
|
|
|
+ i40evf_irq_enable(adapter, true);
|
|
|
+ netif_tx_start_all_queues(adapter->netdev);
|
|
|
+ netif_carrier_on(adapter->netdev);
|
|
|
+ break;
|
|
|
+ case I40E_VIRTCHNL_OP_DISABLE_QUEUES:
|
|
|
+ adapter->aq_pending &= ~(I40EVF_FLAG_AQ_DISABLE_QUEUES);
|
|
|
+ break;
|
|
|
+ case I40E_VIRTCHNL_OP_CONFIG_VSI_QUEUES:
|
|
|
+ adapter->aq_pending &= ~(I40EVF_FLAG_AQ_CONFIGURE_QUEUES);
|
|
|
+ break;
|
|
|
+ case I40E_VIRTCHNL_OP_CONFIG_IRQ_MAP:
|
|
|
+ adapter->aq_pending &= ~(I40EVF_FLAG_AQ_MAP_VECTORS);
|
|
|
+ break;
|
|
|
+ default:
|
|
|
+ dev_warn(&adapter->pdev->dev, "%s: Received unexpected message %d from PF.\n",
|
|
|
+ __func__, v_opcode);
|
|
|
+ break;
|
|
|
+ } /* switch v_opcode */
|
|
|
+ adapter->current_op = I40E_VIRTCHNL_OP_UNKNOWN;
|
|
|
+}
|