| /******************************************************************************* |
| * |
| * Intel Ethernet Controller XL710 Family Linux Virtual Function Driver |
| * Copyright(c) 2013 - 2014 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; |
| |
| if (adapter->flags & I40EVF_FLAG_PF_COMMS_FAILED) |
| return 0; /* nothing to see here, move along */ |
| |
| 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_request_reset |
| * @adapter: adapter structure |
| * |
| * Request that the PF reset this VF. No response is expected. |
| **/ |
| void i40evf_request_reset(struct i40evf_adapter *adapter) |
| { |
| /* Don't check CURRENT_OP - this is always higher priority */ |
| i40evf_send_pf_msg(adapter, I40E_VIRTCHNL_OP_RESET_VF, NULL, 0); |
| 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: |
| dev_info(&adapter->pdev->dev, "PF reset warning received\n"); |
| if (!(adapter->flags & I40EVF_FLAG_RESET_PENDING)) { |
| adapter->flags |= I40EVF_FLAG_RESET_PENDING; |
| dev_info(&adapter->pdev->dev, "Scheduling reset task\n"); |
| schedule_work(&adapter->reset_task); |
| } |
| 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; |
| } |