Merge branch 'for-linus' of git://git.kernel.org/pub/scm/linux/kernel/git/broonie...
[pandora-kernel.git] / drivers / net / ixgbe / ixgbe_82599.c
index 8ee6612..34f30ec 100644 (file)
@@ -213,6 +213,7 @@ static s32 ixgbe_init_phy_ops_82599(struct ixgbe_hw *hw)
        switch (hw->phy.type) {
        case ixgbe_phy_tn:
                phy->ops.check_link = &ixgbe_check_phy_link_tnx;
+               phy->ops.setup_link = &ixgbe_setup_phy_link_tnx;
                phy->ops.get_firmware_version =
                             &ixgbe_get_phy_firmware_version_tnx;
                break;
@@ -1107,153 +1108,87 @@ s32 ixgbe_reinit_fdir_tables_82599(struct ixgbe_hw *hw)
 }
 
 /**
- *  ixgbe_init_fdir_signature_82599 - Initialize Flow Director signature filters
+ *  ixgbe_set_fdir_rxpba_82599 - Initialize Flow Director Rx packet buffer
  *  @hw: pointer to hardware structure
  *  @pballoc: which mode to allocate filters with
  **/
-s32 ixgbe_init_fdir_signature_82599(struct ixgbe_hw *hw, u32 pballoc)
+static s32 ixgbe_set_fdir_rxpba_82599(struct ixgbe_hw *hw, const u32 pballoc)
 {
-       u32 fdirctrl = 0;
-       u32 pbsize;
+       u32 fdir_pbsize = hw->mac.rx_pb_size << IXGBE_RXPBSIZE_SHIFT;
+       u32 current_rxpbsize = 0;
        int i;
 
-       /*
-        * Before enabling Flow Director, the Rx Packet Buffer size
-        * must be reduced.  The new value is the current size minus
-        * flow director memory usage size.
-        */
-       pbsize = (1 << (IXGBE_FDIR_PBALLOC_SIZE_SHIFT + pballoc));
-       IXGBE_WRITE_REG(hw, IXGBE_RXPBSIZE(0),
-           (IXGBE_READ_REG(hw, IXGBE_RXPBSIZE(0)) - pbsize));
-
-       /*
-        * The defaults in the HW for RX PB 1-7 are not zero and so should be
-        * initialized to zero for non DCB mode otherwise actual total RX PB
-        * would be bigger than programmed and filter space would run into
-        * the PB 0 region.
-        */
-       for (i = 1; i < 8; i++)
-               IXGBE_WRITE_REG(hw, IXGBE_RXPBSIZE(i), 0);
-
-       /* Send interrupt when 64 filters are left */
-       fdirctrl |= 4 << IXGBE_FDIRCTRL_FULL_THRESH_SHIFT;
-
-       /* Set the maximum length per hash bucket to 0xA filters */
-       fdirctrl |= 0xA << IXGBE_FDIRCTRL_MAX_LENGTH_SHIFT;
-
+       /* reserve space for Flow Director filters */
        switch (pballoc) {
-       case IXGBE_FDIR_PBALLOC_64K:
-               /* 8k - 1 signature filters */
-               fdirctrl |= IXGBE_FDIRCTRL_PBALLOC_64K;
+       case IXGBE_FDIR_PBALLOC_256K:
+               fdir_pbsize -= 256 << IXGBE_RXPBSIZE_SHIFT;
                break;
        case IXGBE_FDIR_PBALLOC_128K:
-               /* 16k - 1 signature filters */
-               fdirctrl |= IXGBE_FDIRCTRL_PBALLOC_128K;
+               fdir_pbsize -= 128 << IXGBE_RXPBSIZE_SHIFT;
                break;
-       case IXGBE_FDIR_PBALLOC_256K:
-               /* 32k - 1 signature filters */
-               fdirctrl |= IXGBE_FDIRCTRL_PBALLOC_256K;
+       case IXGBE_FDIR_PBALLOC_64K:
+               fdir_pbsize -= 64 << IXGBE_RXPBSIZE_SHIFT;
                break;
+       case IXGBE_FDIR_PBALLOC_NONE:
        default:
-               /* bad value */
-               return IXGBE_ERR_CONFIG;
-       };
-
-       /* Move the flexible bytes to use the ethertype - shift 6 words */
-       fdirctrl |= (0x6 << IXGBE_FDIRCTRL_FLEX_SHIFT);
+               return IXGBE_ERR_PARAM;
+       }
 
+       /* determine current RX packet buffer size */
+       for (i = 0; i < 8; i++)
+               current_rxpbsize += IXGBE_READ_REG(hw, IXGBE_RXPBSIZE(i));
 
-       /* Prime the keys for hashing */
-       IXGBE_WRITE_REG(hw, IXGBE_FDIRHKEY, IXGBE_ATR_BUCKET_HASH_KEY);
-       IXGBE_WRITE_REG(hw, IXGBE_FDIRSKEY, IXGBE_ATR_SIGNATURE_HASH_KEY);
+       /* if there is already room for the filters do nothing */
+       if (current_rxpbsize <= fdir_pbsize)
+               return 0;
 
-       /*
-        * Poll init-done after we write the register.  Estimated times:
-        *      10G: PBALLOC = 11b, timing is 60us
-        *       1G: PBALLOC = 11b, timing is 600us
-        *     100M: PBALLOC = 11b, timing is 6ms
-        *
-        *     Multiple these timings by 4 if under full Rx load
-        *
-        * So we'll poll for IXGBE_FDIR_INIT_DONE_POLL times, sleeping for
-        * 1 msec per poll time.  If we're at line rate and drop to 100M, then
-        * this might not finish in our poll time, but we can live with that
-        * for now.
-        */
-       IXGBE_WRITE_REG(hw, IXGBE_FDIRCTRL, fdirctrl);
-       IXGBE_WRITE_FLUSH(hw);
-       for (i = 0; i < IXGBE_FDIR_INIT_DONE_POLL; i++) {
-               if (IXGBE_READ_REG(hw, IXGBE_FDIRCTRL) &
-                                  IXGBE_FDIRCTRL_INIT_DONE)
-                       break;
-               usleep_range(1000, 2000);
+       if (current_rxpbsize > hw->mac.rx_pb_size) {
+               /*
+                * if rxpbsize is greater than max then HW max the Rx buffer
+                * sizes are unconfigured or misconfigured since HW default is
+                * to give the full buffer to each traffic class resulting in
+                * the total size being buffer size 8x actual size
+                *
+                * This assumes no DCB since the RXPBSIZE registers appear to
+                * be unconfigured.
+                */
+               IXGBE_WRITE_REG(hw, IXGBE_RXPBSIZE(0), fdir_pbsize);
+               for (i = 1; i < 8; i++)
+                       IXGBE_WRITE_REG(hw, IXGBE_RXPBSIZE(i), 0);
+       } else {
+               /*
+                * Since the Rx packet buffer appears to have already been
+                * configured we need to shrink each packet buffer by enough
+                * to make room for the filters.  As such we take each rxpbsize
+                * value and multiply it by a fraction representing the size
+                * needed over the size we currently have.
+                *
+                * We need to reduce fdir_pbsize and current_rxpbsize to
+                * 1/1024 of their original values in order to avoid
+                * overflowing the u32 being used to store rxpbsize.
+                */
+               fdir_pbsize >>= IXGBE_RXPBSIZE_SHIFT;
+               current_rxpbsize >>= IXGBE_RXPBSIZE_SHIFT;
+               for (i = 0; i < 8; i++) {
+                       u32 rxpbsize = IXGBE_READ_REG(hw, IXGBE_RXPBSIZE(i));
+                       rxpbsize *= fdir_pbsize;
+                       rxpbsize /= current_rxpbsize;
+                       IXGBE_WRITE_REG(hw, IXGBE_RXPBSIZE(i), rxpbsize);
+               }
        }
-       if (i >= IXGBE_FDIR_INIT_DONE_POLL)
-               hw_dbg(hw, "Flow Director Signature poll time exceeded!\n");
 
        return 0;
 }
 
 /**
- *  ixgbe_init_fdir_perfect_82599 - Initialize Flow Director perfect filters
+ *  ixgbe_fdir_enable_82599 - Initialize Flow Director control registers
  *  @hw: pointer to hardware structure
- *  @pballoc: which mode to allocate filters with
+ *  @fdirctrl: value to write to flow director control register
  **/
-s32 ixgbe_init_fdir_perfect_82599(struct ixgbe_hw *hw, u32 pballoc)
+static void ixgbe_fdir_enable_82599(struct ixgbe_hw *hw, u32 fdirctrl)
 {
-       u32 fdirctrl = 0;
-       u32 pbsize;
        int i;
 
-       /*
-        * Before enabling Flow Director, the Rx Packet Buffer size
-        * must be reduced.  The new value is the current size minus
-        * flow director memory usage size.
-        */
-       pbsize = (1 << (IXGBE_FDIR_PBALLOC_SIZE_SHIFT + pballoc));
-       IXGBE_WRITE_REG(hw, IXGBE_RXPBSIZE(0),
-           (IXGBE_READ_REG(hw, IXGBE_RXPBSIZE(0)) - pbsize));
-
-       /*
-        * The defaults in the HW for RX PB 1-7 are not zero and so should be
-        * initialized to zero for non DCB mode otherwise actual total RX PB
-        * would be bigger than programmed and filter space would run into
-        * the PB 0 region.
-        */
-       for (i = 1; i < 8; i++)
-               IXGBE_WRITE_REG(hw, IXGBE_RXPBSIZE(i), 0);
-
-       /* Send interrupt when 64 filters are left */
-       fdirctrl |= 4 << IXGBE_FDIRCTRL_FULL_THRESH_SHIFT;
-
-       /* Initialize the drop queue to Rx queue 127 */
-       fdirctrl |= (127 << IXGBE_FDIRCTRL_DROP_Q_SHIFT);
-
-       switch (pballoc) {
-       case IXGBE_FDIR_PBALLOC_64K:
-               /* 2k - 1 perfect filters */
-               fdirctrl |= IXGBE_FDIRCTRL_PBALLOC_64K;
-               break;
-       case IXGBE_FDIR_PBALLOC_128K:
-               /* 4k - 1 perfect filters */
-               fdirctrl |= IXGBE_FDIRCTRL_PBALLOC_128K;
-               break;
-       case IXGBE_FDIR_PBALLOC_256K:
-               /* 8k - 1 perfect filters */
-               fdirctrl |= IXGBE_FDIRCTRL_PBALLOC_256K;
-               break;
-       default:
-               /* bad value */
-               return IXGBE_ERR_CONFIG;
-       };
-
-       /* Turn perfect match filtering on */
-       fdirctrl |= IXGBE_FDIRCTRL_PERFECT_MATCH;
-       fdirctrl |= IXGBE_FDIRCTRL_REPORT_STATUS;
-
-       /* Move the flexible bytes to use the ethertype - shift 6 words */
-       fdirctrl |= (0x6 << IXGBE_FDIRCTRL_FLEX_SHIFT);
-
        /* Prime the keys for hashing */
        IXGBE_WRITE_REG(hw, IXGBE_FDIRHKEY, IXGBE_ATR_BUCKET_HASH_KEY);
        IXGBE_WRITE_REG(hw, IXGBE_FDIRSKEY, IXGBE_ATR_SIGNATURE_HASH_KEY);
@@ -1271,10 +1206,6 @@ s32 ixgbe_init_fdir_perfect_82599(struct ixgbe_hw *hw, u32 pballoc)
         * this might not finish in our poll time, but we can live with that
         * for now.
         */
-
-       /* Set the maximum length per hash bucket to 0xA filters */
-       fdirctrl |= (0xA << IXGBE_FDIRCTRL_MAX_LENGTH_SHIFT);
-
        IXGBE_WRITE_REG(hw, IXGBE_FDIRCTRL, fdirctrl);
        IXGBE_WRITE_FLUSH(hw);
        for (i = 0; i < IXGBE_FDIR_INIT_DONE_POLL; i++) {
@@ -1283,101 +1214,77 @@ s32 ixgbe_init_fdir_perfect_82599(struct ixgbe_hw *hw, u32 pballoc)
                        break;
                usleep_range(1000, 2000);
        }
-       if (i >= IXGBE_FDIR_INIT_DONE_POLL)
-               hw_dbg(hw, "Flow Director Perfect poll time exceeded!\n");
 
-       return 0;
+       if (i >= IXGBE_FDIR_INIT_DONE_POLL)
+               hw_dbg(hw, "Flow Director poll time exceeded!\n");
 }
 
-
 /**
- *  ixgbe_atr_compute_hash_82599 - Compute the hashes for SW ATR
- *  @stream: input bitstream to compute the hash on
- *  @key: 32-bit hash key
+ *  ixgbe_init_fdir_signature_82599 - Initialize Flow Director signature filters
+ *  @hw: pointer to hardware structure
+ *  @fdirctrl: value to write to flow director control register, initially
+ *             contains just the value of the Rx packet buffer allocation
  **/
-static u32 ixgbe_atr_compute_hash_82599(union ixgbe_atr_input *atr_input,
-                                       u32 key)
+s32 ixgbe_init_fdir_signature_82599(struct ixgbe_hw *hw, u32 fdirctrl)
 {
-       /*
-        * The algorithm is as follows:
-        *    Hash[15:0] = Sum { S[n] x K[n+16] }, n = 0...350
-        *    where Sum {A[n]}, n = 0...n is bitwise XOR of A[0], A[1]...A[n]
-        *    and A[n] x B[n] is bitwise AND between same length strings
-        *
-        *    K[n] is 16 bits, defined as:
-        *       for n modulo 32 >= 15, K[n] = K[n % 32 : (n % 32) - 15]
-        *       for n modulo 32 < 15, K[n] =
-        *             K[(n % 32:0) | (31:31 - (14 - (n % 32)))]
-        *
-        *    S[n] is 16 bits, defined as:
-        *       for n >= 15, S[n] = S[n:n - 15]
-        *       for n < 15, S[n] = S[(n:0) | (350:350 - (14 - n))]
-        *
-        *    To simplify for programming, the algorithm is implemented
-        *    in software this way:
-        *
-        *    key[31:0], hi_hash_dword[31:0], lo_hash_dword[31:0], hash[15:0]
-        *
-        *    for (i = 0; i < 352; i+=32)
-        *        hi_hash_dword[31:0] ^= Stream[(i+31):i];
-        *
-        *    lo_hash_dword[15:0]  ^= Stream[15:0];
-        *    lo_hash_dword[15:0]  ^= hi_hash_dword[31:16];
-        *    lo_hash_dword[31:16] ^= hi_hash_dword[15:0];
-        *
-        *    hi_hash_dword[31:0]  ^= Stream[351:320];
-        *
-        *    if(key[0])
-        *        hash[15:0] ^= Stream[15:0];
-        *
-        *    for (i = 0; i < 16; i++) {
-        *        if (key[i])
-        *            hash[15:0] ^= lo_hash_dword[(i+15):i];
-        *        if (key[i + 16])
-        *            hash[15:0] ^= hi_hash_dword[(i+15):i];
-        *    }
-        *
-        */
-       __be32 common_hash_dword = 0;
-       u32 hi_hash_dword, lo_hash_dword, flow_vm_vlan;
-       u32 hash_result = 0;
-       u8 i;
+       s32 err;
 
-       /* record the flow_vm_vlan bits as they are a key part to the hash */
-       flow_vm_vlan = ntohl(atr_input->dword_stream[0]);
+       /* Before enabling Flow Director, verify the Rx Packet Buffer size */
+       err = ixgbe_set_fdir_rxpba_82599(hw, fdirctrl);
+       if (err)
+               return err;
 
-       /* generate common hash dword */
-       for (i = 10; i; i -= 2)
-               common_hash_dword ^= atr_input->dword_stream[i] ^
-                                    atr_input->dword_stream[i - 1];
+       /*
+        * Continue setup of fdirctrl register bits:
+        *  Move the flexible bytes to use the ethertype - shift 6 words
+        *  Set the maximum length per hash bucket to 0xA filters
+        *  Send interrupt when 64 filters are left
+        */
+       fdirctrl |= (0x6 << IXGBE_FDIRCTRL_FLEX_SHIFT) |
+                   (0xA << IXGBE_FDIRCTRL_MAX_LENGTH_SHIFT) |
+                   (4 << IXGBE_FDIRCTRL_FULL_THRESH_SHIFT);
 
-       hi_hash_dword = ntohl(common_hash_dword);
+       /* write hashes and fdirctrl register, poll for completion */
+       ixgbe_fdir_enable_82599(hw, fdirctrl);
 
-       /* low dword is word swapped version of common */
-       lo_hash_dword = (hi_hash_dword >> 16) | (hi_hash_dword << 16);
+       return 0;
+}
 
-       /* apply flow ID/VM pool/VLAN ID bits to hash words */
-       hi_hash_dword ^= flow_vm_vlan ^ (flow_vm_vlan >> 16);
+/**
+ *  ixgbe_init_fdir_perfect_82599 - Initialize Flow Director perfect filters
+ *  @hw: pointer to hardware structure
+ *  @fdirctrl: value to write to flow director control register, initially
+ *             contains just the value of the Rx packet buffer allocation
+ **/
+s32 ixgbe_init_fdir_perfect_82599(struct ixgbe_hw *hw, u32 fdirctrl)
+{
+       s32 err;
 
-       /* Process bits 0 and 16 */
-       if (key & 0x0001) hash_result ^= lo_hash_dword;
-       if (key & 0x00010000) hash_result ^= hi_hash_dword;
+       /* Before enabling Flow Director, verify the Rx Packet Buffer size */
+       err = ixgbe_set_fdir_rxpba_82599(hw, fdirctrl);
+       if (err)
+               return err;
 
        /*
-        * apply flow ID/VM pool/VLAN ID bits to lo hash dword, we had to
-        * delay this because bit 0 of the stream should not be processed
-        * so we do not add the vlan until after bit 0 was processed
+        * Continue setup of fdirctrl register bits:
+        *  Turn perfect match filtering on
+        *  Report hash in RSS field of Rx wb descriptor
+        *  Initialize the drop queue
+        *  Move the flexible bytes to use the ethertype - shift 6 words
+        *  Set the maximum length per hash bucket to 0xA filters
+        *  Send interrupt when 64 (0x4 * 16) filters are left
         */
-       lo_hash_dword ^= flow_vm_vlan ^ (flow_vm_vlan << 16);
+       fdirctrl |= IXGBE_FDIRCTRL_PERFECT_MATCH |
+                   IXGBE_FDIRCTRL_REPORT_STATUS |
+                   (IXGBE_FDIR_DROP_QUEUE << IXGBE_FDIRCTRL_DROP_Q_SHIFT) |
+                   (0x6 << IXGBE_FDIRCTRL_FLEX_SHIFT) |
+                   (0xA << IXGBE_FDIRCTRL_MAX_LENGTH_SHIFT) |
+                   (4 << IXGBE_FDIRCTRL_FULL_THRESH_SHIFT);
 
+       /* write hashes and fdirctrl register, poll for completion */
+       ixgbe_fdir_enable_82599(hw, fdirctrl);
 
-       /* process the remaining 30 bits in the key 2 bits at a time */
-       for (i = 15; i; i-- ) {
-               if (key & (0x0001 << i)) hash_result ^= lo_hash_dword >> i;
-               if (key & (0x00010000 << i)) hash_result ^= hi_hash_dword >> i;
-       }
-
-       return hash_result & IXGBE_ATR_HASH_MASK;
+       return 0;
 }
 
 /*
@@ -1514,7 +1421,6 @@ s32 ixgbe_fdir_add_signature_filter_82599(struct ixgbe_hw *hw,
         */
        fdirhashcmd = (u64)fdircmd << 32;
        fdirhashcmd |= ixgbe_atr_compute_sig_hash_82599(input, common);
-
        IXGBE_WRITE_REG64(hw, IXGBE_FDIRHASH, fdirhashcmd);
 
        hw_dbg(hw, "Tx Queue=%x hash=%x\n", queue, (u32)fdirhashcmd);
@@ -1522,6 +1428,101 @@ s32 ixgbe_fdir_add_signature_filter_82599(struct ixgbe_hw *hw,
        return 0;
 }
 
+#define IXGBE_COMPUTE_BKT_HASH_ITERATION(_n) \
+do { \
+       u32 n = (_n); \
+       if (IXGBE_ATR_BUCKET_HASH_KEY & (0x01 << n)) \
+               bucket_hash ^= lo_hash_dword >> n; \
+       if (IXGBE_ATR_BUCKET_HASH_KEY & (0x01 << (n + 16))) \
+               bucket_hash ^= hi_hash_dword >> n; \
+} while (0);
+
+/**
+ *  ixgbe_atr_compute_perfect_hash_82599 - Compute the perfect filter hash
+ *  @atr_input: input bitstream to compute the hash on
+ *  @input_mask: mask for the input bitstream
+ *
+ *  This function serves two main purposes.  First it applys the input_mask
+ *  to the atr_input resulting in a cleaned up atr_input data stream.
+ *  Secondly it computes the hash and stores it in the bkt_hash field at
+ *  the end of the input byte stream.  This way it will be available for
+ *  future use without needing to recompute the hash.
+ **/
+void ixgbe_atr_compute_perfect_hash_82599(union ixgbe_atr_input *input,
+                                         union ixgbe_atr_input *input_mask)
+{
+
+       u32 hi_hash_dword, lo_hash_dword, flow_vm_vlan;
+       u32 bucket_hash = 0;
+
+       /* Apply masks to input data */
+       input->dword_stream[0]  &= input_mask->dword_stream[0];
+       input->dword_stream[1]  &= input_mask->dword_stream[1];
+       input->dword_stream[2]  &= input_mask->dword_stream[2];
+       input->dword_stream[3]  &= input_mask->dword_stream[3];
+       input->dword_stream[4]  &= input_mask->dword_stream[4];
+       input->dword_stream[5]  &= input_mask->dword_stream[5];
+       input->dword_stream[6]  &= input_mask->dword_stream[6];
+       input->dword_stream[7]  &= input_mask->dword_stream[7];
+       input->dword_stream[8]  &= input_mask->dword_stream[8];
+       input->dword_stream[9]  &= input_mask->dword_stream[9];
+       input->dword_stream[10] &= input_mask->dword_stream[10];
+
+       /* record the flow_vm_vlan bits as they are a key part to the hash */
+       flow_vm_vlan = ntohl(input->dword_stream[0]);
+
+       /* generate common hash dword */
+       hi_hash_dword = ntohl(input->dword_stream[1] ^
+                                   input->dword_stream[2] ^
+                                   input->dword_stream[3] ^
+                                   input->dword_stream[4] ^
+                                   input->dword_stream[5] ^
+                                   input->dword_stream[6] ^
+                                   input->dword_stream[7] ^
+                                   input->dword_stream[8] ^
+                                   input->dword_stream[9] ^
+                                   input->dword_stream[10]);
+
+       /* low dword is word swapped version of common */
+       lo_hash_dword = (hi_hash_dword >> 16) | (hi_hash_dword << 16);
+
+       /* apply flow ID/VM pool/VLAN ID bits to hash words */
+       hi_hash_dword ^= flow_vm_vlan ^ (flow_vm_vlan >> 16);
+
+       /* Process bits 0 and 16 */
+       IXGBE_COMPUTE_BKT_HASH_ITERATION(0);
+
+       /*
+        * apply flow ID/VM pool/VLAN ID bits to lo hash dword, we had to
+        * delay this because bit 0 of the stream should not be processed
+        * so we do not add the vlan until after bit 0 was processed
+        */
+       lo_hash_dword ^= flow_vm_vlan ^ (flow_vm_vlan << 16);
+
+       /* Process remaining 30 bit of the key */
+       IXGBE_COMPUTE_BKT_HASH_ITERATION(1);
+       IXGBE_COMPUTE_BKT_HASH_ITERATION(2);
+       IXGBE_COMPUTE_BKT_HASH_ITERATION(3);
+       IXGBE_COMPUTE_BKT_HASH_ITERATION(4);
+       IXGBE_COMPUTE_BKT_HASH_ITERATION(5);
+       IXGBE_COMPUTE_BKT_HASH_ITERATION(6);
+       IXGBE_COMPUTE_BKT_HASH_ITERATION(7);
+       IXGBE_COMPUTE_BKT_HASH_ITERATION(8);
+       IXGBE_COMPUTE_BKT_HASH_ITERATION(9);
+       IXGBE_COMPUTE_BKT_HASH_ITERATION(10);
+       IXGBE_COMPUTE_BKT_HASH_ITERATION(11);
+       IXGBE_COMPUTE_BKT_HASH_ITERATION(12);
+       IXGBE_COMPUTE_BKT_HASH_ITERATION(13);
+       IXGBE_COMPUTE_BKT_HASH_ITERATION(14);
+       IXGBE_COMPUTE_BKT_HASH_ITERATION(15);
+
+       /*
+        * Limit hash to 13 bits since max bucket count is 8K.
+        * Store result at the end of the input stream.
+        */
+       input->formatted.bkt_hash = bucket_hash & 0x1FFF;
+}
+
 /**
  *  ixgbe_get_fdirtcpm_82599 - generate a tcp port from atr_input_masks
  *  @input_mask: mask to be bit swapped
@@ -1531,11 +1532,11 @@ s32 ixgbe_fdir_add_signature_filter_82599(struct ixgbe_hw *hw,
  *  generate a correctly swapped value we need to bit swap the mask and that
  *  is what is accomplished by this function.
  **/
-static u32 ixgbe_get_fdirtcpm_82599(struct ixgbe_atr_input_masks *input_masks)
+static u32 ixgbe_get_fdirtcpm_82599(union ixgbe_atr_input *input_mask)
 {
-       u32 mask = ntohs(input_masks->dst_port_mask);
+       u32 mask = ntohs(input_mask->formatted.dst_port);
        mask <<= IXGBE_FDIRTCPM_DPORTM_SHIFT;
-       mask |= ntohs(input_masks->src_port_mask);
+       mask |= ntohs(input_mask->formatted.src_port);
        mask = ((mask & 0x55555555) << 1) | ((mask & 0xAAAAAAAA) >> 1);
        mask = ((mask & 0x33333333) << 2) | ((mask & 0xCCCCCCCC) >> 2);
        mask = ((mask & 0x0F0F0F0F) << 4) | ((mask & 0xF0F0F0F0) >> 4);
@@ -1557,52 +1558,14 @@ static u32 ixgbe_get_fdirtcpm_82599(struct ixgbe_atr_input_masks *input_masks)
        IXGBE_WRITE_REG((a), (reg), IXGBE_STORE_AS_BE32(ntohl(value)))
 
 #define IXGBE_STORE_AS_BE16(_value) \
-       (((u16)(_value) >> 8) | ((u16)(_value) << 8))
+       ntohs(((u16)(_value) >> 8) | ((u16)(_value) << 8))
 
-/**
- *  ixgbe_fdir_add_perfect_filter_82599 - Adds a perfect filter
- *  @hw: pointer to hardware structure
- *  @input: input bitstream
- *  @input_masks: bitwise masks for relevant fields
- *  @soft_id: software index into the silicon hash tables for filter storage
- *  @queue: queue index to direct traffic to
- *
- *  Note that the caller to this function must lock before calling, since the
- *  hardware writes must be protected from one another.
- **/
-s32 ixgbe_fdir_add_perfect_filter_82599(struct ixgbe_hw *hw,
-                                      union ixgbe_atr_input *input,
-                                      struct ixgbe_atr_input_masks *input_masks,
-                                      u16 soft_id, u8 queue)
+s32 ixgbe_fdir_set_input_mask_82599(struct ixgbe_hw *hw,
+                                   union ixgbe_atr_input *input_mask)
 {
-       u32 fdirhash;
-       u32 fdircmd;
-       u32 fdirport, fdirtcpm;
-       u32 fdirvlan;
-       /* start with VLAN, flex bytes, VM pool, and IPv6 destination masked */
-       u32 fdirm = IXGBE_FDIRM_VLANID | IXGBE_FDIRM_VLANP | IXGBE_FDIRM_FLEX |
-                   IXGBE_FDIRM_POOL | IXGBE_FDIRM_DIPv6;
-
-       /*
-        * Check flow_type formatting, and bail out before we touch the hardware
-        * if there's a configuration issue
-        */
-       switch (input->formatted.flow_type) {
-       case IXGBE_ATR_FLOW_TYPE_IPV4:
-               /* use the L4 protocol mask for raw IPv4/IPv6 traffic */
-               fdirm |= IXGBE_FDIRM_L4P;
-       case IXGBE_ATR_FLOW_TYPE_SCTPV4:
-               if (input_masks->dst_port_mask || input_masks->src_port_mask) {
-                       hw_dbg(hw, " Error on src/dst port mask\n");
-                       return IXGBE_ERR_CONFIG;
-               }
-       case IXGBE_ATR_FLOW_TYPE_TCPV4:
-       case IXGBE_ATR_FLOW_TYPE_UDPV4:
-               break;
-       default:
-               hw_dbg(hw, " Error on flow type input\n");
-               return IXGBE_ERR_CONFIG;
-       }
+       /* mask IPv6 since it is currently not supported */
+       u32 fdirm = IXGBE_FDIRM_DIPv6;
+       u32 fdirtcpm;
 
        /*
         * Program the relevant mask registers.  If src/dst_port or src/dst_addr
@@ -1614,41 +1577,71 @@ s32 ixgbe_fdir_add_perfect_filter_82599(struct ixgbe_hw *hw,
         * point in time.
         */
 
-       /* Program FDIRM */
-       switch (ntohs(input_masks->vlan_id_mask) & 0xEFFF) {
-       case 0xEFFF:
-               /* Unmask VLAN ID - bit 0 and fall through to unmask prio */
-               fdirm &= ~IXGBE_FDIRM_VLANID;
-       case 0xE000:
-               /* Unmask VLAN prio - bit 1 */
-               fdirm &= ~IXGBE_FDIRM_VLANP;
+       /* verify bucket hash is cleared on hash generation */
+       if (input_mask->formatted.bkt_hash)
+               hw_dbg(hw, " bucket hash should always be 0 in mask\n");
+
+       /* Program FDIRM and verify partial masks */
+       switch (input_mask->formatted.vm_pool & 0x7F) {
+       case 0x0:
+               fdirm |= IXGBE_FDIRM_POOL;
+       case 0x7F:
                break;
-       case 0x0FFF:
-               /* Unmask VLAN ID - bit 0 */
-               fdirm &= ~IXGBE_FDIRM_VLANID;
+       default:
+               hw_dbg(hw, " Error on vm pool mask\n");
+               return IXGBE_ERR_CONFIG;
+       }
+
+       switch (input_mask->formatted.flow_type & IXGBE_ATR_L4TYPE_MASK) {
+       case 0x0:
+               fdirm |= IXGBE_FDIRM_L4P;
+               if (input_mask->formatted.dst_port ||
+                   input_mask->formatted.src_port) {
+                       hw_dbg(hw, " Error on src/dst port mask\n");
+                       return IXGBE_ERR_CONFIG;
+               }
+       case IXGBE_ATR_L4TYPE_MASK:
                break;
+       default:
+               hw_dbg(hw, " Error on flow type mask\n");
+               return IXGBE_ERR_CONFIG;
+       }
+
+       switch (ntohs(input_mask->formatted.vlan_id) & 0xEFFF) {
        case 0x0000:
-               /* do nothing, vlans already masked */
+               /* mask VLAN ID, fall through to mask VLAN priority */
+               fdirm |= IXGBE_FDIRM_VLANID;
+       case 0x0FFF:
+               /* mask VLAN priority */
+               fdirm |= IXGBE_FDIRM_VLANP;
+               break;
+       case 0xE000:
+               /* mask VLAN ID only, fall through */
+               fdirm |= IXGBE_FDIRM_VLANID;
+       case 0xEFFF:
+               /* no VLAN fields masked */
                break;
        default:
                hw_dbg(hw, " Error on VLAN mask\n");
                return IXGBE_ERR_CONFIG;
        }
 
-       if (input_masks->flex_mask & 0xFFFF) {
-               if ((input_masks->flex_mask & 0xFFFF) != 0xFFFF) {
-                       hw_dbg(hw, " Error on flexible byte mask\n");
-                       return IXGBE_ERR_CONFIG;
-               }
-               /* Unmask Flex Bytes - bit 4 */
-               fdirm &= ~IXGBE_FDIRM_FLEX;
+       switch (input_mask->formatted.flex_bytes & 0xFFFF) {
+       case 0x0000:
+               /* Mask Flex Bytes, fall through */
+               fdirm |= IXGBE_FDIRM_FLEX;
+       case 0xFFFF:
+               break;
+       default:
+               hw_dbg(hw, " Error on flexible byte mask\n");
+               return IXGBE_ERR_CONFIG;
        }
 
        /* Now mask VM pool and destination IPv6 - bits 5 and 2 */
        IXGBE_WRITE_REG(hw, IXGBE_FDIRM, fdirm);
 
        /* store the TCP/UDP port masks, bit reversed from port layout */
-       fdirtcpm = ixgbe_get_fdirtcpm_82599(input_masks);
+       fdirtcpm = ixgbe_get_fdirtcpm_82599(input_mask);
 
        /* write both the same so that UDP and TCP use the same mask */
        IXGBE_WRITE_REG(hw, IXGBE_FDIRTCPM, ~fdirtcpm);
@@ -1656,24 +1649,32 @@ s32 ixgbe_fdir_add_perfect_filter_82599(struct ixgbe_hw *hw,
 
        /* store source and destination IP masks (big-enian) */
        IXGBE_WRITE_REG_BE32(hw, IXGBE_FDIRSIP4M,
-                            ~input_masks->src_ip_mask[0]);
+                            ~input_mask->formatted.src_ip[0]);
        IXGBE_WRITE_REG_BE32(hw, IXGBE_FDIRDIP4M,
-                            ~input_masks->dst_ip_mask[0]);
+                            ~input_mask->formatted.dst_ip[0]);
 
-       /* Apply masks to input data */
-       input->formatted.vlan_id &= input_masks->vlan_id_mask;
-       input->formatted.flex_bytes &= input_masks->flex_mask;
-       input->formatted.src_port &= input_masks->src_port_mask;
-       input->formatted.dst_port &= input_masks->dst_port_mask;
-       input->formatted.src_ip[0] &= input_masks->src_ip_mask[0];
-       input->formatted.dst_ip[0] &= input_masks->dst_ip_mask[0];
+       return 0;
+}
 
-       /* record vlan (little-endian) and flex_bytes(big-endian) */
-       fdirvlan =
-               IXGBE_STORE_AS_BE16(ntohs(input->formatted.flex_bytes));
-       fdirvlan <<= IXGBE_FDIRVLAN_FLEX_SHIFT;
-       fdirvlan |= ntohs(input->formatted.vlan_id);
-       IXGBE_WRITE_REG(hw, IXGBE_FDIRVLAN, fdirvlan);
+s32 ixgbe_fdir_write_perfect_filter_82599(struct ixgbe_hw *hw,
+                                         union ixgbe_atr_input *input,
+                                         u16 soft_id, u8 queue)
+{
+       u32 fdirport, fdirvlan, fdirhash, fdircmd;
+
+       /* currently IPv6 is not supported, must be programmed with 0 */
+       IXGBE_WRITE_REG_BE32(hw, IXGBE_FDIRSIPv6(0),
+                            input->formatted.src_ip[0]);
+       IXGBE_WRITE_REG_BE32(hw, IXGBE_FDIRSIPv6(1),
+                            input->formatted.src_ip[1]);
+       IXGBE_WRITE_REG_BE32(hw, IXGBE_FDIRSIPv6(2),
+                            input->formatted.src_ip[2]);
+
+       /* record the source address (big-endian) */
+       IXGBE_WRITE_REG_BE32(hw, IXGBE_FDIRIPSA, input->formatted.src_ip[0]);
+
+       /* record the first 32 bits of the destination address (big-endian) */
+       IXGBE_WRITE_REG_BE32(hw, IXGBE_FDIRIPDA, input->formatted.dst_ip[0]);
 
        /* record source and destination port (little-endian)*/
        fdirport = ntohs(input->formatted.dst_port);
@@ -1681,29 +1682,80 @@ s32 ixgbe_fdir_add_perfect_filter_82599(struct ixgbe_hw *hw,
        fdirport |= ntohs(input->formatted.src_port);
        IXGBE_WRITE_REG(hw, IXGBE_FDIRPORT, fdirport);
 
-       /* record the first 32 bits of the destination address (big-endian) */
-       IXGBE_WRITE_REG_BE32(hw, IXGBE_FDIRIPDA, input->formatted.dst_ip[0]);
+       /* record vlan (little-endian) and flex_bytes(big-endian) */
+       fdirvlan = IXGBE_STORE_AS_BE16(input->formatted.flex_bytes);
+       fdirvlan <<= IXGBE_FDIRVLAN_FLEX_SHIFT;
+       fdirvlan |= ntohs(input->formatted.vlan_id);
+       IXGBE_WRITE_REG(hw, IXGBE_FDIRVLAN, fdirvlan);
 
-       /* record the source address (big-endian) */
-       IXGBE_WRITE_REG_BE32(hw, IXGBE_FDIRIPSA, input->formatted.src_ip[0]);
+       /* configure FDIRHASH register */
+       fdirhash = input->formatted.bkt_hash;
+       fdirhash |= soft_id << IXGBE_FDIRHASH_SIG_SW_INDEX_SHIFT;
+       IXGBE_WRITE_REG(hw, IXGBE_FDIRHASH, fdirhash);
+
+       /*
+        * flush all previous writes to make certain registers are
+        * programmed prior to issuing the command
+        */
+       IXGBE_WRITE_FLUSH(hw);
 
        /* configure FDIRCMD register */
        fdircmd = IXGBE_FDIRCMD_CMD_ADD_FLOW | IXGBE_FDIRCMD_FILTER_UPDATE |
                  IXGBE_FDIRCMD_LAST | IXGBE_FDIRCMD_QUEUE_EN;
+       if (queue == IXGBE_FDIR_DROP_QUEUE)
+               fdircmd |= IXGBE_FDIRCMD_DROP;
        fdircmd |= input->formatted.flow_type << IXGBE_FDIRCMD_FLOW_TYPE_SHIFT;
        fdircmd |= (u32)queue << IXGBE_FDIRCMD_RX_QUEUE_SHIFT;
+       fdircmd |= (u32)input->formatted.vm_pool << IXGBE_FDIRCMD_VT_POOL_SHIFT;
 
-       /* we only want the bucket hash so drop the upper 16 bits */
-       fdirhash = ixgbe_atr_compute_hash_82599(input,
-                                               IXGBE_ATR_BUCKET_HASH_KEY);
-       fdirhash |= soft_id << IXGBE_FDIRHASH_SIG_SW_INDEX_SHIFT;
-
-       IXGBE_WRITE_REG(hw, IXGBE_FDIRHASH, fdirhash);
        IXGBE_WRITE_REG(hw, IXGBE_FDIRCMD, fdircmd);
 
        return 0;
 }
 
+s32 ixgbe_fdir_erase_perfect_filter_82599(struct ixgbe_hw *hw,
+                                         union ixgbe_atr_input *input,
+                                         u16 soft_id)
+{
+       u32 fdirhash;
+       u32 fdircmd = 0;
+       u32 retry_count;
+       s32 err = 0;
+
+       /* configure FDIRHASH register */
+       fdirhash = input->formatted.bkt_hash;
+       fdirhash |= soft_id << IXGBE_FDIRHASH_SIG_SW_INDEX_SHIFT;
+       IXGBE_WRITE_REG(hw, IXGBE_FDIRHASH, fdirhash);
+
+       /* flush hash to HW */
+       IXGBE_WRITE_FLUSH(hw);
+
+       /* Query if filter is present */
+       IXGBE_WRITE_REG(hw, IXGBE_FDIRCMD, IXGBE_FDIRCMD_CMD_QUERY_REM_FILT);
+
+       for (retry_count = 10; retry_count; retry_count--) {
+               /* allow 10us for query to process */
+               udelay(10);
+               /* verify query completed successfully */
+               fdircmd = IXGBE_READ_REG(hw, IXGBE_FDIRCMD);
+               if (!(fdircmd & IXGBE_FDIRCMD_CMD_MASK))
+                       break;
+       }
+
+       if (!retry_count)
+               err = IXGBE_ERR_FDIR_REINIT_FAILED;
+
+       /* if filter exists in hardware then remove it */
+       if (fdircmd & IXGBE_FDIRCMD_FILTER_VALID) {
+               IXGBE_WRITE_REG(hw, IXGBE_FDIRHASH, fdirhash);
+               IXGBE_WRITE_FLUSH(hw);
+               IXGBE_WRITE_REG(hw, IXGBE_FDIRCMD,
+                               IXGBE_FDIRCMD_CMD_REMOVE_FLOW);
+       }
+
+       return err;
+}
+
 /**
  *  ixgbe_read_analog_reg8_82599 - Reads 8 bit Omer analog register
  *  @hw: pointer to hardware structure
@@ -2146,6 +2198,7 @@ static struct ixgbe_mac_operations mac_ops_82599 = {
        .read_analog_reg8       = &ixgbe_read_analog_reg8_82599,
        .write_analog_reg8      = &ixgbe_write_analog_reg8_82599,
        .setup_link             = &ixgbe_setup_mac_link_82599,
+       .set_rxpba              = &ixgbe_set_rxpba_generic,
        .check_link             = &ixgbe_check_mac_link_generic,
        .get_link_capabilities  = &ixgbe_get_link_capabilities_82599,
        .led_on                 = &ixgbe_led_on_generic,
@@ -2163,6 +2216,7 @@ static struct ixgbe_mac_operations mac_ops_82599 = {
        .clear_vfta             = &ixgbe_clear_vfta_generic,
        .set_vfta               = &ixgbe_set_vfta_generic,
        .fc_enable              = &ixgbe_fc_enable_generic,
+       .set_fw_drv_ver         = &ixgbe_set_fw_drv_ver_generic,
        .init_uta_tables        = &ixgbe_init_uta_tables_generic,
        .setup_sfp              = &ixgbe_setup_sfp_modules_82599,
        .set_mac_anti_spoofing  = &ixgbe_set_mac_anti_spoofing,