net/igb: fix add/delete of flex filters
[dpdk.git] / drivers / net / e1000 / igb_pf.c
index 6a4d210..6809d30 100644 (file)
@@ -1,7 +1,7 @@
 /*-
  *   BSD LICENSE
  *
- *   Copyright(c) 2010-2015 Intel Corporation. All rights reserved.
+ *   Copyright(c) 2010-2016 Intel Corporation. All rights reserved.
  *   All rights reserved.
  *
  *   Redistribution and use in source and binary forms, with or without
@@ -57,7 +57,9 @@
 static inline uint16_t
 dev_num_vf(struct rte_eth_dev *eth_dev)
 {
-       return eth_dev->pci_dev->max_vfs;
+       struct rte_pci_device *pci_dev = RTE_ETH_DEV_TO_PCI(eth_dev);
+
+       return pci_dev->max_vfs;
 }
 
 static inline
@@ -127,6 +129,28 @@ void igb_pf_host_init(struct rte_eth_dev *eth_dev)
        return;
 }
 
+void igb_pf_host_uninit(struct rte_eth_dev *dev)
+{
+       struct e1000_vf_info **vfinfo;
+       uint16_t vf_num;
+
+       PMD_INIT_FUNC_TRACE();
+
+       vfinfo = E1000_DEV_PRIVATE_TO_P_VFDATA(dev->data->dev_private);
+
+       RTE_ETH_DEV_SRIOV(dev).active = 0;
+       RTE_ETH_DEV_SRIOV(dev).nb_q_per_pool = 0;
+       RTE_ETH_DEV_SRIOV(dev).def_vmdq_idx = 0;
+       RTE_ETH_DEV_SRIOV(dev).def_pool_q_idx = 0;
+
+       vf_num = dev_num_vf(dev);
+       if (vf_num == 0)
+               return;
+
+       rte_free(*vfinfo);
+       *vfinfo = NULL;
+}
+
 #define E1000_RAH_POOLSEL_SHIFT    (18)
 int igb_pf_host_configure(struct rte_eth_dev *eth_dev)
 {
@@ -150,8 +174,8 @@ int igb_pf_host_configure(struct rte_eth_dev *eth_dev)
        E1000_WRITE_REG(hw, E1000_VT_CTL, vtctl);
 
        /* Enable pools reserved to PF only */
-       E1000_WRITE_REG(hw, E1000_VFRE, (~0) << vf_num);
-       E1000_WRITE_REG(hw, E1000_VFTE, (~0) << vf_num);
+       E1000_WRITE_REG(hw, E1000_VFRE, (~0U) << vf_num);
+       E1000_WRITE_REG(hw, E1000_VFTE, (~0U) << vf_num);
 
        /* PFDMA Tx General Switch Control Enables VMDQ loopback */
        if (hw->mac.type == e1000_i350)
@@ -196,8 +220,7 @@ int igb_pf_host_configure(struct rte_eth_dev *eth_dev)
 static void
 set_rx_mode(struct rte_eth_dev *dev)
 {
-       struct rte_eth_dev_data *dev_data =
-               (struct rte_eth_dev_data*)dev->data->dev_private;
+       struct rte_eth_dev_data *dev_data = dev->data;
        struct e1000_hw *hw = E1000_DEV_PRIVATE_TO_HW(dev->data->dev_private);
        uint32_t fctrl, vmolr = E1000_VMOLR_BAM | E1000_VMOLR_AUPE;
        uint16_t vfn = dev_num_vf(dev);
@@ -207,7 +230,7 @@ set_rx_mode(struct rte_eth_dev *dev)
 
        /* set all bits that we expect to always be set */
        fctrl &= ~E1000_RCTL_SBP; /* disable store-bad-packets */
-       fctrl |= E1000_RCTL_BAM;;
+       fctrl |= E1000_RCTL_BAM;
 
        /* clear the bits we are changing the status of */
        fctrl &= ~(E1000_RCTL_UPE | E1000_RCTL_MPE);
@@ -309,10 +332,16 @@ igb_vf_set_mac_addr(struct rte_eth_dev *dev, uint32_t vf, uint32_t *msgbuf)
                *(E1000_DEV_PRIVATE_TO_P_VFDATA(dev->data->dev_private));
        int rar_entry = hw->mac.rar_entry_count - (vf + 1);
        uint8_t *new_mac = (uint8_t *)(&msgbuf[1]);
+       int rah;
 
-       if (is_valid_assigned_ether_addr((struct ether_addr*)new_mac)) {
-               rte_memcpy(vfinfo[vf].vf_mac_addresses, new_mac, 6);
+       if (is_unicast_ether_addr((struct ether_addr *)new_mac)) {
+               if (!is_zero_ether_addr((struct ether_addr *)new_mac))
+                       rte_memcpy(vfinfo[vf].vf_mac_addresses, new_mac,
+                               sizeof(vfinfo[vf].vf_mac_addresses));
                hw->mac.ops.rar_set(hw, new_mac, rar_entry);
+               rah = E1000_READ_REG(hw, E1000_RAH(rar_entry));
+               rah |= (0x1 << (E1000_RAH_POOLSEL_SHIFT + vf));
+               E1000_WRITE_REG(hw, E1000_RAH(rar_entry), rah);
                return 0;
        }
        return -1;