2013-12-21 06:12:51 +00:00
/*******************************************************************************
*
* Intel Ethernet Controller XL710 Family Linux Virtual Function Driver
2016-01-13 16:51:43 -08:00
* Copyright ( c ) 2013 - 2016 Intel Corporation .
2013-12-21 06:12:51 +00:00
*
* 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 .
*
2014-04-05 07:46:11 +00:00
* You should have received a copy of the GNU General Public License along
* with this program . If not , see < http : //www.gnu.org/licenses/>.
*
2013-12-21 06:12:51 +00:00
* 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
*
* * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * */
2014-01-11 04:00:31 +00:00
# include <linux/prefetch.h>
2015-01-24 09:58:35 +00:00
# include <net/busy_poll.h>
2014-01-11 04:00:31 +00:00
2013-12-21 06:12:51 +00:00
# include "i40evf.h"
2014-02-12 01:45:33 +00:00
# include "i40e_prototype.h"
2013-12-21 06:12:51 +00:00
static inline __le64 build_ctob ( u32 td_cmd , u32 td_offset , unsigned int size ,
u32 td_tag )
{
return cpu_to_le64 ( I40E_TX_DESC_DTYPE_DATA |
( ( u64 ) td_cmd < < I40E_TXD_QW1_CMD_SHIFT ) |
( ( u64 ) td_offset < < I40E_TXD_QW1_OFFSET_SHIFT ) |
( ( u64 ) size < < I40E_TXD_QW1_TX_BUF_SZ_SHIFT ) |
( ( u64 ) td_tag < < I40E_TXD_QW1_L2TAG1_SHIFT ) ) ;
}
# define I40E_TXD_CMD (I40E_TX_DESC_CMD_EOP | I40E_TX_DESC_CMD_RS)
/**
* i40e_unmap_and_free_tx_resource - Release a Tx buffer
* @ ring : the ring that owns the buffer
* @ tx_buffer : the buffer to free
* */
static void i40e_unmap_and_free_tx_resource ( struct i40e_ring * ring ,
struct i40e_tx_buffer * tx_buffer )
{
if ( tx_buffer - > skb ) {
2015-11-06 15:26:03 -08:00
dev_kfree_skb_any ( tx_buffer - > skb ) ;
2013-12-21 06:12:51 +00:00
if ( dma_unmap_len ( tx_buffer , len ) )
dma_unmap_single ( ring - > dev ,
dma_unmap_addr ( tx_buffer , dma ) ,
dma_unmap_len ( tx_buffer , len ) ,
DMA_TO_DEVICE ) ;
} else if ( dma_unmap_len ( tx_buffer , len ) ) {
dma_unmap_page ( ring - > dev ,
dma_unmap_addr ( tx_buffer , dma ) ,
dma_unmap_len ( tx_buffer , len ) ,
DMA_TO_DEVICE ) ;
}
2015-11-06 15:26:03 -08:00
if ( tx_buffer - > tx_flags & I40E_TX_FLAGS_FD_SB )
kfree ( tx_buffer - > raw_buf ) ;
2013-12-21 06:12:51 +00:00
tx_buffer - > next_to_watch = NULL ;
tx_buffer - > skb = NULL ;
dma_unmap_len_set ( tx_buffer , len , 0 ) ;
/* tx_buffer must be completely set up in the transmit path */
}
/**
* i40evf_clean_tx_ring - Free any empty Tx buffers
* @ tx_ring : ring to be cleaned
* */
void i40evf_clean_tx_ring ( struct i40e_ring * tx_ring )
{
unsigned long bi_size ;
u16 i ;
/* ring already cleared, nothing to do */
if ( ! tx_ring - > tx_bi )
return ;
/* Free all the Tx ring sk_buffs */
for ( i = 0 ; i < tx_ring - > count ; i + + )
i40e_unmap_and_free_tx_resource ( tx_ring , & tx_ring - > tx_bi [ i ] ) ;
bi_size = sizeof ( struct i40e_tx_buffer ) * tx_ring - > count ;
memset ( tx_ring - > tx_bi , 0 , bi_size ) ;
/* Zero out the descriptor ring */
memset ( tx_ring - > desc , 0 , tx_ring - > size ) ;
tx_ring - > next_to_use = 0 ;
tx_ring - > next_to_clean = 0 ;
if ( ! tx_ring - > netdev )
return ;
/* cleanup Tx queue statistics */
netdev_tx_reset_queue ( netdev_get_tx_queue ( tx_ring - > netdev ,
tx_ring - > queue_index ) ) ;
}
/**
* i40evf_free_tx_resources - Free Tx resources per queue
* @ tx_ring : Tx descriptor ring for a specific queue
*
* Free all transmit software resources
* */
void i40evf_free_tx_resources ( struct i40e_ring * tx_ring )
{
i40evf_clean_tx_ring ( tx_ring ) ;
kfree ( tx_ring - > tx_bi ) ;
tx_ring - > tx_bi = NULL ;
if ( tx_ring - > desc ) {
dma_free_coherent ( tx_ring - > dev , tx_ring - > size ,
tx_ring - > desc , tx_ring - > dma ) ;
tx_ring - > desc = NULL ;
}
}
2015-02-24 05:26:03 +00:00
/**
2015-11-06 15:26:02 -08:00
* i40evf_get_tx_pending - how many Tx descriptors not processed
* @ tx_ring : the ring of descriptors
2016-01-15 14:33:12 -08:00
* @ in_sw : is tx_pending being checked in SW or HW
2015-02-24 05:26:03 +00:00
*
2015-11-06 15:26:02 -08:00
* Since there is no access to the ring head register
* in XL710 , we need to use our local copies
2015-02-24 05:26:03 +00:00
* */
2016-01-15 14:33:12 -08:00
u32 i40evf_get_tx_pending ( struct i40e_ring * ring , bool in_sw )
2015-02-24 05:26:03 +00:00
{
2015-11-06 15:26:02 -08:00
u32 head , tail ;
2015-02-24 05:26:03 +00:00
2016-01-15 14:33:12 -08:00
if ( ! in_sw )
head = i40e_get_head ( ring ) ;
else
head = ring - > next_to_clean ;
2015-11-06 15:26:02 -08:00
tail = readl ( ring - > tail ) ;
if ( head ! = tail )
return ( head < tail ) ?
tail - head : ( tail + ring - > count - head ) ;
return 0 ;
2015-02-24 05:26:03 +00:00
}
2015-01-10 01:07:19 +00:00
# define WB_STRIDE 0x3
2013-12-21 06:12:51 +00:00
/**
* i40e_clean_tx_irq - Reclaim resources after transmit completes
2016-03-07 09:30:03 -08:00
* @ vsi : the VSI we care about
* @ tx_ring : Tx ring to clean
* @ napi_budget : Used to determine if we are in netpoll
2013-12-21 06:12:51 +00:00
*
* Returns true if there ' s any budget left ( e . g . the clean is finished )
* */
2016-03-07 09:30:03 -08:00
static bool i40e_clean_tx_irq ( struct i40e_vsi * vsi ,
struct i40e_ring * tx_ring , int napi_budget )
2013-12-21 06:12:51 +00:00
{
u16 i = tx_ring - > next_to_clean ;
struct i40e_tx_buffer * tx_buf ;
2014-02-14 02:14:40 +00:00
struct i40e_tx_desc * tx_head ;
2013-12-21 06:12:51 +00:00
struct i40e_tx_desc * tx_desc ;
2016-03-07 09:30:03 -08:00
unsigned int total_bytes = 0 , total_packets = 0 ;
unsigned int budget = vsi - > work_limit ;
2013-12-21 06:12:51 +00:00
tx_buf = & tx_ring - > tx_bi [ i ] ;
tx_desc = I40E_TX_DESC ( tx_ring , i ) ;
i - = tx_ring - > count ;
2014-02-14 02:14:40 +00:00
tx_head = I40E_TX_DESC ( tx_ring , i40e_get_head ( tx_ring ) ) ;
2013-12-21 06:12:51 +00:00
do {
struct i40e_tx_desc * eop_desc = tx_buf - > next_to_watch ;
/* if next_to_watch is not set then there is no work pending */
if ( ! eop_desc )
break ;
/* prevent any other reads prior to eop_desc */
read_barrier_depends ( ) ;
2014-02-14 02:14:40 +00:00
/* we have caught up to head, no work left to do */
if ( tx_head = = tx_desc )
2013-12-21 06:12:51 +00:00
break ;
/* clear next_to_watch to prevent false hangs */
tx_buf - > next_to_watch = NULL ;
/* update the statistics for this packet */
total_bytes + = tx_buf - > bytecount ;
total_packets + = tx_buf - > gso_segs ;
/* free the skb */
2016-03-07 09:30:03 -08:00
napi_consume_skb ( tx_buf - > skb , napi_budget ) ;
2013-12-21 06:12:51 +00:00
/* unmap skb header data */
dma_unmap_single ( tx_ring - > dev ,
dma_unmap_addr ( tx_buf , dma ) ,
dma_unmap_len ( tx_buf , len ) ,
DMA_TO_DEVICE ) ;
/* clear tx_buffer data */
tx_buf - > skb = NULL ;
dma_unmap_len_set ( tx_buf , len , 0 ) ;
/* unmap remaining buffers */
while ( tx_desc ! = eop_desc ) {
tx_buf + + ;
tx_desc + + ;
i + + ;
if ( unlikely ( ! i ) ) {
i - = tx_ring - > count ;
tx_buf = tx_ring - > tx_bi ;
tx_desc = I40E_TX_DESC ( tx_ring , 0 ) ;
}
/* unmap any remaining paged data */
if ( dma_unmap_len ( tx_buf , len ) ) {
dma_unmap_page ( tx_ring - > dev ,
dma_unmap_addr ( tx_buf , dma ) ,
dma_unmap_len ( tx_buf , len ) ,
DMA_TO_DEVICE ) ;
dma_unmap_len_set ( tx_buf , len , 0 ) ;
}
}
/* move us one more past the eop_desc for start of next pkt */
tx_buf + + ;
tx_desc + + ;
i + + ;
if ( unlikely ( ! i ) ) {
i - = tx_ring - > count ;
tx_buf = tx_ring - > tx_bi ;
tx_desc = I40E_TX_DESC ( tx_ring , 0 ) ;
}
2015-02-27 09:15:31 +00:00
prefetch ( tx_desc ) ;
2013-12-21 06:12:51 +00:00
/* update budget accounting */
budget - - ;
} while ( likely ( budget ) ) ;
i + = tx_ring - > count ;
tx_ring - > next_to_clean = i ;
u64_stats_update_begin ( & tx_ring - > syncp ) ;
tx_ring - > stats . bytes + = total_bytes ;
tx_ring - > stats . packets + = total_packets ;
u64_stats_update_end ( & tx_ring - > syncp ) ;
tx_ring - > q_vector - > tx . total_bytes + = total_bytes ;
tx_ring - > q_vector - > tx . total_packets + = total_packets ;
2015-12-22 14:25:07 -08:00
if ( tx_ring - > flags & I40E_TXR_FLAGS_WB_ON_ITR ) {
unsigned int j = 0 ;
/* check to see if there are < 4 descriptors
* waiting to be written back , then kick the hardware to force
* them to be written back in case we stay in NAPI .
* In this mode on X722 we do not enable Interrupt .
*/
2016-01-15 14:33:12 -08:00
j = i40evf_get_tx_pending ( tx_ring , false ) ;
2015-12-22 14:25:07 -08:00
if ( budget & &
( ( j / ( WB_STRIDE + 1 ) ) = = 0 ) & & ( j > 0 ) & &
2016-03-07 09:30:03 -08:00
! test_bit ( __I40E_DOWN , & vsi - > state ) & &
2015-12-22 14:25:07 -08:00
( I40E_DESC_UNUSED ( tx_ring ) ! = tx_ring - > count ) )
tx_ring - > arm_wb = true ;
}
2013-12-21 06:12:51 +00:00
netdev_tx_completed_queue ( netdev_get_tx_queue ( tx_ring - > netdev ,
tx_ring - > queue_index ) ,
total_packets , total_bytes ) ;
# define TX_WAKE_THRESHOLD (DESC_NEEDED * 2)
if ( unlikely ( total_packets & & netif_carrier_ok ( tx_ring - > netdev ) & &
( I40E_DESC_UNUSED ( tx_ring ) > = TX_WAKE_THRESHOLD ) ) ) {
/* Make sure that anybody stopping the queue after this
* sees the new next_to_clean .
*/
smp_mb ( ) ;
if ( __netif_subqueue_stopped ( tx_ring - > netdev ,
tx_ring - > queue_index ) & &
2016-03-07 09:30:03 -08:00
! test_bit ( __I40E_DOWN , & vsi - > state ) ) {
2013-12-21 06:12:51 +00:00
netif_wake_subqueue ( tx_ring - > netdev ,
tx_ring - > queue_index ) ;
+ + tx_ring - > tx_stats . restart_queue ;
}
}
2015-09-24 18:13:15 -04:00
return ! ! budget ;
2013-12-21 06:12:51 +00:00
}
2015-01-10 01:07:19 +00:00
/**
2016-01-13 16:51:43 -08:00
* i40evf_enable_wb_on_itr - Arm hardware to do a wb , interrupts are not enabled
2015-01-10 01:07:19 +00:00
* @ vsi : the VSI we care about
2016-01-13 16:51:43 -08:00
* @ q_vector : the vector on which to enable writeback
2015-01-10 01:07:19 +00:00
*
* */
2016-01-13 16:51:43 -08:00
static void i40e_enable_wb_on_itr ( struct i40e_vsi * vsi ,
struct i40e_q_vector * q_vector )
2015-01-10 01:07:19 +00:00
{
2015-06-05 12:20:30 -04:00
u16 flags = q_vector - > tx . ring [ 0 ] . flags ;
2016-01-13 16:51:43 -08:00
u32 val ;
2015-06-05 12:20:30 -04:00
2016-01-13 16:51:43 -08:00
if ( ! ( flags & I40E_TXR_FLAGS_WB_ON_ITR ) )
return ;
if ( q_vector - > arm_wb_state )
return ;
val = I40E_VFINT_DYN_CTLN1_WB_ON_ITR_MASK |
I40E_VFINT_DYN_CTLN1_ITR_INDX_MASK ; /* set noitr */
wr32 ( & vsi - > back - > hw ,
I40E_VFINT_DYN_CTLN1 ( q_vector - > v_idx +
vsi - > base_vector - 1 ) , val ) ;
q_vector - > arm_wb_state = true ;
}
/**
* i40evf_force_wb - Issue SW Interrupt so HW does a wb
* @ vsi : the VSI we care about
* @ q_vector : the vector on which to force writeback
*
* */
void i40evf_force_wb ( struct i40e_vsi * vsi , struct i40e_q_vector * q_vector )
{
u32 val = I40E_VFINT_DYN_CTLN1_INTENA_MASK |
I40E_VFINT_DYN_CTLN1_ITR_INDX_MASK | /* set noitr */
I40E_VFINT_DYN_CTLN1_SWINT_TRIG_MASK |
I40E_VFINT_DYN_CTLN1_SW_ITR_INDX_ENA_MASK
/* allow 00 to be written to the index */ ;
wr32 ( & vsi - > back - > hw ,
I40E_VFINT_DYN_CTLN1 ( q_vector - > v_idx + vsi - > base_vector - 1 ) ,
val ) ;
2015-01-10 01:07:19 +00:00
}
2013-12-21 06:12:51 +00:00
/**
* i40e_set_new_dynamic_itr - Find new ITR level
* @ rc : structure containing ring performance data
*
2015-09-28 14:16:51 -04:00
* Returns true if ITR changed , false if not
*
2013-12-21 06:12:51 +00:00
* Stores a new ITR value based on packets and byte counts during
* the last interrupt . The advantage of per interrupt computation
* is faster updates and more accurate ITR for the current traffic
* pattern . Constants in this function were computed based on
* theoretical maximum wire speed and thresholds were set based on
* testing data as well as attempting to minimize response time
* while increasing bulk throughput .
* */
2015-09-28 14:16:51 -04:00
static bool i40e_set_new_dynamic_itr ( struct i40e_ring_container * rc )
2013-12-21 06:12:51 +00:00
{
enum i40e_latency_range new_latency_range = rc - > latency_range ;
2015-09-28 14:16:53 -04:00
struct i40e_q_vector * qv = rc - > ring - > q_vector ;
2013-12-21 06:12:51 +00:00
u32 new_itr = rc - > itr ;
int bytes_per_int ;
2015-09-28 14:16:52 -04:00
int usecs ;
2013-12-21 06:12:51 +00:00
if ( rc - > total_packets = = 0 | | ! rc - > itr )
2015-09-28 14:16:51 -04:00
return false ;
2013-12-21 06:12:51 +00:00
/* simple throttlerate management
2015-09-28 14:16:53 -04:00
* 0 - 10 MB / s lowest ( 50000 ints / s )
2013-12-21 06:12:51 +00:00
* 10 - 20 MB / s low ( 20000 ints / s )
2015-09-28 14:16:53 -04:00
* 20 - 1249 MB / s bulk ( 18000 ints / s )
* > 40000 Rx packets per second ( 8000 ints / s )
2015-09-28 14:16:52 -04:00
*
* The math works out because the divisor is in 10 ^ ( - 6 ) which
* turns the bytes / us input value into MB / s values , but
* make sure to use usecs , as the register values written
2015-09-28 14:16:54 -04:00
* are in 2 usec increments in the ITR registers , and make sure
* to use the smoothed values that the countdown timer gives us .
2013-12-21 06:12:51 +00:00
*/
2015-09-28 14:16:54 -04:00
usecs = ( rc - > itr < < 1 ) * ITR_COUNTDOWN_START ;
2015-09-28 14:16:52 -04:00
bytes_per_int = rc - > total_bytes / usecs ;
2015-09-28 14:16:54 -04:00
2015-06-10 13:42:07 -04:00
switch ( new_latency_range ) {
2013-12-21 06:12:51 +00:00
case I40E_LOWEST_LATENCY :
if ( bytes_per_int > 10 )
new_latency_range = I40E_LOW_LATENCY ;
break ;
case I40E_LOW_LATENCY :
if ( bytes_per_int > 20 )
new_latency_range = I40E_BULK_LATENCY ;
else if ( bytes_per_int < = 10 )
new_latency_range = I40E_LOWEST_LATENCY ;
break ;
case I40E_BULK_LATENCY :
2015-09-28 14:16:53 -04:00
case I40E_ULTRA_LATENCY :
2015-06-10 13:42:07 -04:00
default :
if ( bytes_per_int < = 20 )
new_latency_range = I40E_LOW_LATENCY ;
2013-12-21 06:12:51 +00:00
break ;
}
2015-09-28 14:16:53 -04:00
/* this is to adjust RX more aggressively when streaming small
* packets . The value of 40000 was picked as it is just beyond
* what the hardware can receive per second if in low latency
* mode .
*/
# define RX_ULTRA_PACKET_RATE 40000
if ( ( ( ( rc - > total_packets * 1000000 ) / usecs ) > RX_ULTRA_PACKET_RATE ) & &
( & qv - > rx = = rc ) )
new_latency_range = I40E_ULTRA_LATENCY ;
2015-06-10 13:42:07 -04:00
rc - > latency_range = new_latency_range ;
2013-12-21 06:12:51 +00:00
switch ( new_latency_range ) {
case I40E_LOWEST_LATENCY :
2015-09-28 14:16:53 -04:00
new_itr = I40E_ITR_50K ;
2013-12-21 06:12:51 +00:00
break ;
case I40E_LOW_LATENCY :
new_itr = I40E_ITR_20K ;
break ;
case I40E_BULK_LATENCY :
2015-09-28 14:16:53 -04:00
new_itr = I40E_ITR_18K ;
break ;
case I40E_ULTRA_LATENCY :
2013-12-21 06:12:51 +00:00
new_itr = I40E_ITR_8K ;
break ;
default :
break ;
}
rc - > total_bytes = 0 ;
rc - > total_packets = 0 ;
2015-09-28 14:16:51 -04:00
if ( new_itr ! = rc - > itr ) {
rc - > itr = new_itr ;
return true ;
}
return false ;
2013-12-21 06:12:51 +00:00
}
2015-11-18 17:35:42 -08:00
/**
2013-12-21 06:12:51 +00:00
* i40evf_setup_tx_descriptors - Allocate the Tx descriptors
* @ tx_ring : the tx ring to set up
*
* Return 0 on success , negative on error
* */
int i40evf_setup_tx_descriptors ( struct i40e_ring * tx_ring )
{
struct device * dev = tx_ring - > dev ;
int bi_size ;
if ( ! dev )
return - ENOMEM ;
2015-06-19 08:56:30 -07:00
/* warn if we are about to overwrite the pointer */
WARN_ON ( tx_ring - > tx_bi ) ;
2013-12-21 06:12:51 +00:00
bi_size = sizeof ( struct i40e_tx_buffer ) * tx_ring - > count ;
tx_ring - > tx_bi = kzalloc ( bi_size , GFP_KERNEL ) ;
if ( ! tx_ring - > tx_bi )
goto err ;
/* round up to nearest 4K */
tx_ring - > size = tx_ring - > count * sizeof ( struct i40e_tx_desc ) ;
2014-02-14 02:14:40 +00:00
/* add u32 for head writeback, align after this takes care of
* guaranteeing this is at least one cache line in size
*/
tx_ring - > size + = sizeof ( u32 ) ;
2013-12-21 06:12:51 +00:00
tx_ring - > size = ALIGN ( tx_ring - > size , 4096 ) ;
tx_ring - > desc = dma_alloc_coherent ( dev , tx_ring - > size ,
& tx_ring - > dma , GFP_KERNEL ) ;
if ( ! tx_ring - > desc ) {
dev_info ( dev , " Unable to allocate memory for the Tx descriptor ring, size=%d \n " ,
tx_ring - > size ) ;
goto err ;
}
tx_ring - > next_to_use = 0 ;
tx_ring - > next_to_clean = 0 ;
return 0 ;
err :
kfree ( tx_ring - > tx_bi ) ;
tx_ring - > tx_bi = NULL ;
return - ENOMEM ;
}
/**
* i40evf_clean_rx_ring - Free Rx buffers
* @ rx_ring : ring to be cleaned
* */
void i40evf_clean_rx_ring ( struct i40e_ring * rx_ring )
{
struct device * dev = rx_ring - > dev ;
struct i40e_rx_buffer * rx_bi ;
unsigned long bi_size ;
u16 i ;
/* ring already cleared, nothing to do */
if ( ! rx_ring - > rx_bi )
return ;
2015-01-24 09:58:35 +00:00
if ( ring_is_ps_enabled ( rx_ring ) ) {
int bufsz = ALIGN ( rx_ring - > rx_hdr_len , 256 ) * rx_ring - > count ;
rx_bi = & rx_ring - > rx_bi [ 0 ] ;
if ( rx_bi - > hdr_buf ) {
dma_free_coherent ( dev ,
bufsz ,
rx_bi - > hdr_buf ,
rx_bi - > dma ) ;
for ( i = 0 ; i < rx_ring - > count ; i + + ) {
rx_bi = & rx_ring - > rx_bi [ i ] ;
rx_bi - > dma = 0 ;
2015-02-27 09:15:19 +00:00
rx_bi - > hdr_buf = NULL ;
2015-01-24 09:58:35 +00:00
}
}
}
2013-12-21 06:12:51 +00:00
/* Free all the Rx ring sk_buffs */
for ( i = 0 ; i < rx_ring - > count ; i + + ) {
rx_bi = & rx_ring - > rx_bi [ i ] ;
if ( rx_bi - > dma ) {
dma_unmap_single ( dev ,
rx_bi - > dma ,
rx_ring - > rx_buf_len ,
DMA_FROM_DEVICE ) ;
rx_bi - > dma = 0 ;
}
if ( rx_bi - > skb ) {
dev_kfree_skb ( rx_bi - > skb ) ;
rx_bi - > skb = NULL ;
}
if ( rx_bi - > page ) {
if ( rx_bi - > page_dma ) {
dma_unmap_page ( dev ,
rx_bi - > page_dma ,
2016-01-13 16:51:49 -08:00
PAGE_SIZE ,
2013-12-21 06:12:51 +00:00
DMA_FROM_DEVICE ) ;
rx_bi - > page_dma = 0 ;
}
__free_page ( rx_bi - > page ) ;
rx_bi - > page = NULL ;
rx_bi - > page_offset = 0 ;
}
}
bi_size = sizeof ( struct i40e_rx_buffer ) * rx_ring - > count ;
memset ( rx_ring - > rx_bi , 0 , bi_size ) ;
/* Zero out the descriptor ring */
memset ( rx_ring - > desc , 0 , rx_ring - > size ) ;
rx_ring - > next_to_clean = 0 ;
rx_ring - > next_to_use = 0 ;
}
/**
* i40evf_free_rx_resources - Free Rx resources
* @ rx_ring : ring to clean the resources from
*
* Free all receive software resources
* */
void i40evf_free_rx_resources ( struct i40e_ring * rx_ring )
{
i40evf_clean_rx_ring ( rx_ring ) ;
kfree ( rx_ring - > rx_bi ) ;
rx_ring - > rx_bi = NULL ;
if ( rx_ring - > desc ) {
dma_free_coherent ( rx_ring - > dev , rx_ring - > size ,
rx_ring - > desc , rx_ring - > dma ) ;
rx_ring - > desc = NULL ;
}
}
2015-01-24 09:58:35 +00:00
/**
* i40evf_alloc_rx_headers - allocate rx header buffers
* @ rx_ring : ring to alloc buffers
*
* Allocate rx header buffers for the entire ring . As these are static ,
* this is only called when setting up a new ring .
* */
void i40evf_alloc_rx_headers ( struct i40e_ring * rx_ring )
{
struct device * dev = rx_ring - > dev ;
struct i40e_rx_buffer * rx_bi ;
dma_addr_t dma ;
void * buffer ;
int buf_size ;
int i ;
if ( rx_ring - > rx_bi [ 0 ] . hdr_buf )
return ;
/* Make sure the buffers don't cross cache line boundaries. */
buf_size = ALIGN ( rx_ring - > rx_hdr_len , 256 ) ;
buffer = dma_alloc_coherent ( dev , buf_size * rx_ring - > count ,
& dma , GFP_KERNEL ) ;
if ( ! buffer )
return ;
for ( i = 0 ; i < rx_ring - > count ; i + + ) {
rx_bi = & rx_ring - > rx_bi [ i ] ;
rx_bi - > dma = dma + ( i * buf_size ) ;
rx_bi - > hdr_buf = buffer + ( i * buf_size ) ;
}
}
2013-12-21 06:12:51 +00:00
/**
* i40evf_setup_rx_descriptors - Allocate Rx descriptors
* @ rx_ring : Rx descriptor ring ( for a specific queue ) to setup
*
* Returns 0 on success , negative on failure
* */
int i40evf_setup_rx_descriptors ( struct i40e_ring * rx_ring )
{
struct device * dev = rx_ring - > dev ;
int bi_size ;
2015-06-19 08:56:30 -07:00
/* warn if we are about to overwrite the pointer */
WARN_ON ( rx_ring - > rx_bi ) ;
2013-12-21 06:12:51 +00:00
bi_size = sizeof ( struct i40e_rx_buffer ) * rx_ring - > count ;
rx_ring - > rx_bi = kzalloc ( bi_size , GFP_KERNEL ) ;
if ( ! rx_ring - > rx_bi )
goto err ;
2015-02-09 17:42:31 -08:00
u64_stats_init ( & rx_ring - > syncp ) ;
2015-01-24 09:58:32 +00:00
2013-12-21 06:12:51 +00:00
/* Round up to nearest 4K */
rx_ring - > size = ring_is_16byte_desc_enabled ( rx_ring )
? rx_ring - > count * sizeof ( union i40e_16byte_rx_desc )
: rx_ring - > count * sizeof ( union i40e_32byte_rx_desc ) ;
rx_ring - > size = ALIGN ( rx_ring - > size , 4096 ) ;
rx_ring - > desc = dma_alloc_coherent ( dev , rx_ring - > size ,
& rx_ring - > dma , GFP_KERNEL ) ;
if ( ! rx_ring - > desc ) {
dev_info ( dev , " Unable to allocate memory for the Rx descriptor ring, size=%d \n " ,
rx_ring - > size ) ;
goto err ;
}
rx_ring - > next_to_clean = 0 ;
rx_ring - > next_to_use = 0 ;
return 0 ;
err :
kfree ( rx_ring - > rx_bi ) ;
rx_ring - > rx_bi = NULL ;
return - ENOMEM ;
}
/**
* i40e_release_rx_desc - Store the new tail and head values
* @ rx_ring : ring to bump
* @ val : new head index
* */
static inline void i40e_release_rx_desc ( struct i40e_ring * rx_ring , u32 val )
{
rx_ring - > next_to_use = val ;
/* Force memory writes to complete before letting h/w
* know there are new descriptors to fetch . ( Only
* applicable for weak - ordered memory model archs ,
* such as IA - 64 ) .
*/
wmb ( ) ;
writel ( val , rx_ring - > tail ) ;
}
/**
2015-01-24 09:58:35 +00:00
* i40evf_alloc_rx_buffers_ps - Replace used receive buffers ; packet split
* @ rx_ring : ring to place buffers on
* @ cleaned_count : number of buffers to replace
2016-01-13 16:51:46 -08:00
*
* Returns true if any errors on allocation
2015-01-24 09:58:35 +00:00
* */
2016-01-13 16:51:46 -08:00
bool i40evf_alloc_rx_buffers_ps ( struct i40e_ring * rx_ring , u16 cleaned_count )
2015-01-24 09:58:35 +00:00
{
u16 i = rx_ring - > next_to_use ;
union i40e_rx_desc * rx_desc ;
struct i40e_rx_buffer * bi ;
2016-01-13 16:51:49 -08:00
const int current_node = numa_node_id ( ) ;
2015-01-24 09:58:35 +00:00
/* do nothing if no valid netdev defined */
if ( ! rx_ring - > netdev | | ! cleaned_count )
2016-01-13 16:51:46 -08:00
return false ;
2015-01-24 09:58:35 +00:00
while ( cleaned_count - - ) {
rx_desc = I40E_RX_DESC ( rx_ring , i ) ;
bi = & rx_ring - > rx_bi [ i ] ;
if ( bi - > skb ) /* desc is in use */
goto no_buffers ;
2016-01-13 16:51:49 -08:00
/* If we've been moved to a different NUMA node, release the
* page so we can get a new one on the current node .
*/
if ( bi - > page & & page_to_nid ( bi - > page ) ! = current_node ) {
dma_unmap_page ( rx_ring - > dev ,
bi - > page_dma ,
PAGE_SIZE ,
DMA_FROM_DEVICE ) ;
__free_page ( bi - > page ) ;
bi - > page = NULL ;
bi - > page_dma = 0 ;
rx_ring - > rx_stats . realloc_count + + ;
} else if ( bi - > page ) {
rx_ring - > rx_stats . page_reuse_count + + ;
}
2015-01-24 09:58:35 +00:00
if ( ! bi - > page ) {
bi - > page = alloc_page ( GFP_ATOMIC ) ;
if ( ! bi - > page ) {
rx_ring - > rx_stats . alloc_page_failed + + ;
goto no_buffers ;
}
bi - > page_dma = dma_map_page ( rx_ring - > dev ,
bi - > page ,
2016-01-13 16:51:49 -08:00
0 ,
PAGE_SIZE ,
2015-01-24 09:58:35 +00:00
DMA_FROM_DEVICE ) ;
2016-01-13 16:51:49 -08:00
if ( dma_mapping_error ( rx_ring - > dev , bi - > page_dma ) ) {
2015-01-24 09:58:35 +00:00
rx_ring - > rx_stats . alloc_page_failed + + ;
2016-01-13 16:51:49 -08:00
__free_page ( bi - > page ) ;
bi - > page = NULL ;
2015-01-24 09:58:35 +00:00
bi - > page_dma = 0 ;
2016-01-13 16:51:49 -08:00
bi - > page_offset = 0 ;
2015-01-24 09:58:35 +00:00
goto no_buffers ;
}
2016-01-13 16:51:49 -08:00
bi - > page_offset = 0 ;
2015-01-24 09:58:35 +00:00
}
/* Refresh the desc even if buffer_addrs didn't change
* because each write - back erases this info .
*/
2016-01-13 16:51:49 -08:00
rx_desc - > read . pkt_addr =
cpu_to_le64 ( bi - > page_dma + bi - > page_offset ) ;
2015-01-24 09:58:35 +00:00
rx_desc - > read . hdr_addr = cpu_to_le64 ( bi - > dma ) ;
i + + ;
if ( i = = rx_ring - > count )
i = 0 ;
}
2016-01-13 16:51:46 -08:00
if ( rx_ring - > next_to_use ! = i )
i40e_release_rx_desc ( rx_ring , i ) ;
return false ;
2015-01-24 09:58:35 +00:00
no_buffers :
if ( rx_ring - > next_to_use ! = i )
i40e_release_rx_desc ( rx_ring , i ) ;
2016-01-13 16:51:46 -08:00
/* make sure to come back via polling to try again after
* allocation failure
*/
return true ;
2015-01-24 09:58:35 +00:00
}
/**
* i40evf_alloc_rx_buffers_1buf - Replace used receive buffers ; single buffer
2013-12-21 06:12:51 +00:00
* @ rx_ring : ring to place buffers on
* @ cleaned_count : number of buffers to replace
2016-01-13 16:51:46 -08:00
*
* Returns true if any errors on allocation
2013-12-21 06:12:51 +00:00
* */
2016-01-13 16:51:46 -08:00
bool i40evf_alloc_rx_buffers_1buf ( struct i40e_ring * rx_ring , u16 cleaned_count )
2013-12-21 06:12:51 +00:00
{
u16 i = rx_ring - > next_to_use ;
union i40e_rx_desc * rx_desc ;
struct i40e_rx_buffer * bi ;
struct sk_buff * skb ;
/* do nothing if no valid netdev defined */
if ( ! rx_ring - > netdev | | ! cleaned_count )
2016-01-13 16:51:46 -08:00
return false ;
2013-12-21 06:12:51 +00:00
while ( cleaned_count - - ) {
rx_desc = I40E_RX_DESC ( rx_ring , i ) ;
bi = & rx_ring - > rx_bi [ i ] ;
skb = bi - > skb ;
if ( ! skb ) {
2016-01-13 16:51:48 -08:00
skb = __netdev_alloc_skb_ip_align ( rx_ring - > netdev ,
rx_ring - > rx_buf_len ,
GFP_ATOMIC |
__GFP_NOWARN ) ;
2013-12-21 06:12:51 +00:00
if ( ! skb ) {
rx_ring - > rx_stats . alloc_buff_failed + + ;
goto no_buffers ;
}
/* initialize queue mapping */
skb_record_rx_queue ( skb , rx_ring - > queue_index ) ;
bi - > skb = skb ;
}
if ( ! bi - > dma ) {
bi - > dma = dma_map_single ( rx_ring - > dev ,
skb - > data ,
rx_ring - > rx_buf_len ,
DMA_FROM_DEVICE ) ;
if ( dma_mapping_error ( rx_ring - > dev , bi - > dma ) ) {
rx_ring - > rx_stats . alloc_buff_failed + + ;
bi - > dma = 0 ;
2016-01-13 16:51:46 -08:00
dev_kfree_skb ( bi - > skb ) ;
bi - > skb = NULL ;
2013-12-21 06:12:51 +00:00
goto no_buffers ;
}
}
2015-01-24 09:58:35 +00:00
rx_desc - > read . pkt_addr = cpu_to_le64 ( bi - > dma ) ;
rx_desc - > read . hdr_addr = 0 ;
2013-12-21 06:12:51 +00:00
i + + ;
if ( i = = rx_ring - > count )
i = 0 ;
}
2016-01-13 16:51:46 -08:00
if ( rx_ring - > next_to_use ! = i )
i40e_release_rx_desc ( rx_ring , i ) ;
return false ;
2013-12-21 06:12:51 +00:00
no_buffers :
if ( rx_ring - > next_to_use ! = i )
i40e_release_rx_desc ( rx_ring , i ) ;
2016-01-13 16:51:46 -08:00
/* make sure to come back via polling to try again after
* allocation failure
*/
return true ;
2013-12-21 06:12:51 +00:00
}
/**
* i40e_receive_skb - Send a completed packet up the stack
* @ rx_ring : rx ring in play
* @ skb : packet to send up
* @ vlan_tag : vlan tag for packet
* */
static void i40e_receive_skb ( struct i40e_ring * rx_ring ,
struct sk_buff * skb , u16 vlan_tag )
{
struct i40e_q_vector * q_vector = rx_ring - > q_vector ;
if ( vlan_tag & VLAN_VID_MASK )
__vlan_hwaccel_put_tag ( skb , htons ( ETH_P_8021Q ) , vlan_tag ) ;
2015-09-24 09:04:32 -07:00
napi_gro_receive ( & q_vector - > napi , skb ) ;
2013-12-21 06:12:51 +00:00
}
/**
* i40e_rx_checksum - Indicate in skb if hw indicated a good cksum
* @ vsi : the VSI we care about
* @ skb : skb currently being received and modified
* @ rx_status : status value of last descriptor in packet
* @ rx_error : error value of last descriptor in packet
* @ rx_ptype : ptype value of last descriptor in packet
* */
static inline void i40e_rx_checksum ( struct i40e_vsi * vsi ,
struct sk_buff * skb ,
u32 rx_status ,
u32 rx_error ,
u16 rx_ptype )
{
2014-05-20 08:01:43 +00:00
struct i40e_rx_ptype_decoded decoded = decode_rx_desc_ptype ( rx_ptype ) ;
2016-01-24 21:17:22 -08:00
bool ipv4 , ipv6 , ipv4_tunnel , ipv6_tunnel ;
2013-12-21 06:12:51 +00:00
skb - > ip_summed = CHECKSUM_NONE ;
/* Rx csum enabled and ip headers found? */
2014-05-20 08:01:43 +00:00
if ( ! ( vsi - > netdev - > features & NETIF_F_RXCSUM ) )
return ;
/* did the hardware decode the packet and checksum? */
2015-06-04 16:24:02 -04:00
if ( ! ( rx_status & BIT ( I40E_RX_DESC_STATUS_L3L4P_SHIFT ) ) )
2014-05-20 08:01:43 +00:00
return ;
/* both known and outer_ip must be set for the below code to work */
if ( ! ( decoded . known & & decoded . outer_ip ) )
2013-12-21 06:12:51 +00:00
return ;
2016-01-24 21:17:22 -08:00
ipv4 = ( decoded . outer_ip = = I40E_RX_PTYPE_OUTER_IP ) & &
( decoded . outer_ip_ver = = I40E_RX_PTYPE_OUTER_IPV4 ) ;
ipv6 = ( decoded . outer_ip = = I40E_RX_PTYPE_OUTER_IP ) & &
( decoded . outer_ip_ver = = I40E_RX_PTYPE_OUTER_IPV6 ) ;
2014-05-20 08:01:43 +00:00
if ( ipv4 & &
2015-06-04 16:24:02 -04:00
( rx_error & ( BIT ( I40E_RX_DESC_ERROR_IPE_SHIFT ) |
BIT ( I40E_RX_DESC_ERROR_EIPE_SHIFT ) ) ) )
2014-05-20 08:01:43 +00:00
goto checksum_fail ;
2014-02-13 03:48:39 -08:00
/* likely incorrect csum if alternate IP extension headers found */
2014-05-20 08:01:43 +00:00
if ( ipv6 & &
2015-06-04 16:24:02 -04:00
rx_status & BIT ( I40E_RX_DESC_STATUS_IPV6EXADD_SHIFT ) )
2014-05-20 08:01:43 +00:00
/* don't increment checksum err here, non-fatal err */
2013-12-21 06:12:51 +00:00
return ;
2014-05-20 08:01:43 +00:00
/* there was some L4 error, count error and punt packet to the stack */
2015-06-04 16:24:02 -04:00
if ( rx_error & BIT ( I40E_RX_DESC_ERROR_L4E_SHIFT ) )
2014-05-20 08:01:43 +00:00
goto checksum_fail ;
/* handle packets that were not able to be checksummed due
* to arrival speed , in this case the stack can compute
* the csum .
*/
2015-06-04 16:24:02 -04:00
if ( rx_error & BIT ( I40E_RX_DESC_ERROR_PPRS_SHIFT ) )
2013-12-21 06:12:51 +00:00
return ;
2016-01-24 21:16:13 -08:00
/* The hardware supported by this driver does not validate outer
* checksums for tunneled VXLAN or GENEVE frames . I don ' t agree
* with it but the specification states that you " MAY validate " , it
* doesn ' t make it a hard requirement so if we have validated the
* inner checksum report CHECKSUM_UNNECESSARY .
2014-05-20 08:01:43 +00:00
*/
2013-12-21 06:12:51 +00:00
2016-01-24 21:17:22 -08:00
ipv4_tunnel = ( rx_ptype > = I40E_RX_PTYPE_GRENAT4_MAC_PAY3 ) & &
( rx_ptype < = I40E_RX_PTYPE_GRENAT4_MACVLAN_IPV6_ICMP_PAY4 ) ;
ipv6_tunnel = ( rx_ptype > = I40E_RX_PTYPE_GRENAT6_MAC_PAY3 ) & &
( rx_ptype < = I40E_RX_PTYPE_GRENAT6_MACVLAN_IPV6_ICMP_PAY4 ) ;
2013-12-21 06:12:51 +00:00
skb - > ip_summed = CHECKSUM_UNNECESSARY ;
2014-08-27 21:27:43 -07:00
skb - > csum_level = ipv4_tunnel | | ipv6_tunnel ;
2014-05-20 08:01:43 +00:00
return ;
checksum_fail :
vsi - > back - > hw_csum_rx_error + + ;
2013-12-21 06:12:51 +00:00
}
/**
2015-12-09 15:50:21 -08:00
* i40e_ptype_to_htype - get a hash type
2014-02-12 01:45:33 +00:00
* @ ptype : the ptype value from the descriptor
*
* Returns a hash type to be used by skb_set_hash
* */
2015-12-09 15:50:21 -08:00
static inline enum pkt_hash_types i40e_ptype_to_htype ( u8 ptype )
2014-02-12 01:45:33 +00:00
{
struct i40e_rx_ptype_decoded decoded = decode_rx_desc_ptype ( ptype ) ;
if ( ! decoded . known )
return PKT_HASH_TYPE_NONE ;
if ( decoded . outer_ip = = I40E_RX_PTYPE_OUTER_IP & &
decoded . payload_layer = = I40E_RX_PTYPE_PAYLOAD_LAYER_PAY4 )
return PKT_HASH_TYPE_L4 ;
else if ( decoded . outer_ip = = I40E_RX_PTYPE_OUTER_IP & &
decoded . payload_layer = = I40E_RX_PTYPE_PAYLOAD_LAYER_PAY3 )
return PKT_HASH_TYPE_L3 ;
else
return PKT_HASH_TYPE_L2 ;
}
2015-12-09 15:50:21 -08:00
/**
* i40e_rx_hash - set the hash value in the skb
* @ ring : descriptor ring
* @ rx_desc : specific descriptor
* */
static inline void i40e_rx_hash ( struct i40e_ring * ring ,
union i40e_rx_desc * rx_desc ,
struct sk_buff * skb ,
u8 rx_ptype )
{
u32 hash ;
const __le64 rss_mask =
cpu_to_le64 ( ( u64 ) I40E_RX_DESC_FLTSTAT_RSS_HASH < <
I40E_RX_DESC_STATUS_FLTSTAT_SHIFT ) ;
if ( ring - > netdev - > features & NETIF_F_RXHASH )
return ;
if ( ( rx_desc - > wb . qword1 . status_error_len & rss_mask ) = = rss_mask ) {
hash = le32_to_cpu ( rx_desc - > wb . qword0 . hi_dword . rss ) ;
skb_set_hash ( skb , hash , i40e_ptype_to_htype ( rx_ptype ) ) ;
}
}
2013-12-21 06:12:51 +00:00
/**
2015-01-24 09:58:35 +00:00
* i40e_clean_rx_irq_ps - Reclaim resources after receive ; packet split
2013-12-21 06:12:51 +00:00
* @ rx_ring : rx ring to clean
* @ budget : how many cleans we ' re allowed
*
* Returns true if there ' s any budget left ( e . g . the clean is finished )
* */
2016-01-13 16:51:46 -08:00
static int i40e_clean_rx_irq_ps ( struct i40e_ring * rx_ring , const int budget )
2013-12-21 06:12:51 +00:00
{
unsigned int total_rx_bytes = 0 , total_rx_packets = 0 ;
u16 rx_packet_len , rx_header_len , rx_sph , rx_hbo ;
u16 cleaned_count = I40E_DESC_UNUSED ( rx_ring ) ;
struct i40e_vsi * vsi = rx_ring - > vsi ;
u16 i = rx_ring - > next_to_clean ;
union i40e_rx_desc * rx_desc ;
u32 rx_error , rx_status ;
2016-01-13 16:51:46 -08:00
bool failure = false ;
2014-02-12 01:45:33 +00:00
u8 rx_ptype ;
2013-12-21 06:12:51 +00:00
u64 qword ;
2016-01-13 16:51:49 -08:00
u32 copysize ;
2013-12-21 06:12:51 +00:00
2015-01-24 09:58:35 +00:00
do {
2013-12-21 06:12:51 +00:00
struct i40e_rx_buffer * rx_bi ;
struct sk_buff * skb ;
u16 vlan_tag ;
2015-01-24 09:58:35 +00:00
/* return some buffers to hardware, one at a time is too slow */
if ( cleaned_count > = I40E_RX_BUFFER_WRITE ) {
2016-01-13 16:51:46 -08:00
failure = failure | |
i40evf_alloc_rx_buffers_ps ( rx_ring ,
cleaned_count ) ;
2015-01-24 09:58:35 +00:00
cleaned_count = 0 ;
}
i = rx_ring - > next_to_clean ;
rx_desc = I40E_RX_DESC ( rx_ring , i ) ;
qword = le64_to_cpu ( rx_desc - > wb . qword1 . status_error_len ) ;
rx_status = ( qword & I40E_RXD_QW1_STATUS_MASK ) > >
I40E_RXD_QW1_STATUS_SHIFT ;
2015-06-04 16:24:02 -04:00
if ( ! ( rx_status & BIT ( I40E_RX_DESC_STATUS_DD_SHIFT ) ) )
2015-01-24 09:58:35 +00:00
break ;
/* This memory barrier is needed to keep us from reading
* any other fields out of the rx_desc until we know the
* DD bit is set .
*/
2015-04-08 18:49:43 -07:00
dma_rmb ( ) ;
2016-01-13 16:51:49 -08:00
/* sync header buffer for reading */
dma_sync_single_range_for_cpu ( rx_ring - > dev ,
rx_ring - > rx_bi [ 0 ] . dma ,
i * rx_ring - > rx_hdr_len ,
rx_ring - > rx_hdr_len ,
DMA_FROM_DEVICE ) ;
2013-12-21 06:12:51 +00:00
rx_bi = & rx_ring - > rx_bi [ i ] ;
skb = rx_bi - > skb ;
2015-01-24 09:58:35 +00:00
if ( likely ( ! skb ) ) {
2016-01-13 16:51:48 -08:00
skb = __netdev_alloc_skb_ip_align ( rx_ring - > netdev ,
rx_ring - > rx_hdr_len ,
GFP_ATOMIC |
__GFP_NOWARN ) ;
2015-03-31 00:45:01 -07:00
if ( ! skb ) {
2015-01-24 09:58:35 +00:00
rx_ring - > rx_stats . alloc_buff_failed + + ;
2016-01-13 16:51:46 -08:00
failure = true ;
2015-03-31 00:45:01 -07:00
break ;
}
2015-01-24 09:58:35 +00:00
/* initialize queue mapping */
skb_record_rx_queue ( skb , rx_ring - > queue_index ) ;
/* we are reusing so sync this buffer for CPU use */
dma_sync_single_range_for_cpu ( rx_ring - > dev ,
2016-01-04 10:33:03 -08:00
rx_ring - > rx_bi [ 0 ] . dma ,
i * rx_ring - > rx_hdr_len ,
2015-01-24 09:58:35 +00:00
rx_ring - > rx_hdr_len ,
DMA_FROM_DEVICE ) ;
}
2013-12-21 06:12:51 +00:00
rx_packet_len = ( qword & I40E_RXD_QW1_LENGTH_PBUF_MASK ) > >
I40E_RXD_QW1_LENGTH_PBUF_SHIFT ;
rx_header_len = ( qword & I40E_RXD_QW1_LENGTH_HBUF_MASK ) > >
I40E_RXD_QW1_LENGTH_HBUF_SHIFT ;
rx_sph = ( qword & I40E_RXD_QW1_LENGTH_SPH_MASK ) > >
I40E_RXD_QW1_LENGTH_SPH_SHIFT ;
rx_error = ( qword & I40E_RXD_QW1_ERROR_MASK ) > >
I40E_RXD_QW1_ERROR_SHIFT ;
2015-06-04 16:24:02 -04:00
rx_hbo = rx_error & BIT ( I40E_RX_DESC_ERROR_HBO_SHIFT ) ;
rx_error & = ~ BIT ( I40E_RX_DESC_ERROR_HBO_SHIFT ) ;
2013-12-21 06:12:51 +00:00
rx_ptype = ( qword & I40E_RXD_QW1_PTYPE_MASK ) > >
I40E_RXD_QW1_PTYPE_SHIFT ;
2016-01-13 16:51:49 -08:00
/* sync half-page for reading */
dma_sync_single_range_for_cpu ( rx_ring - > dev ,
rx_bi - > page_dma ,
rx_bi - > page_offset ,
PAGE_SIZE / 2 ,
DMA_FROM_DEVICE ) ;
prefetch ( page_address ( rx_bi - > page ) + rx_bi - > page_offset ) ;
2013-12-21 06:12:51 +00:00
rx_bi - > skb = NULL ;
2015-01-24 09:58:35 +00:00
cleaned_count + + ;
2016-01-13 16:51:49 -08:00
copysize = 0 ;
2015-01-24 09:58:35 +00:00
if ( rx_hbo | | rx_sph ) {
int len ;
2015-08-28 17:55:54 -04:00
2013-12-21 06:12:51 +00:00
if ( rx_hbo )
len = I40E_RX_HDR_SIZE ;
else
2015-01-24 09:58:35 +00:00
len = rx_header_len ;
memcpy ( __skb_put ( skb , len ) , rx_bi - > hdr_buf , len ) ;
} else if ( skb - > len = = 0 ) {
int len ;
2016-01-13 16:51:49 -08:00
unsigned char * va = page_address ( rx_bi - > page ) +
rx_bi - > page_offset ;
2015-01-24 09:58:35 +00:00
2016-01-13 16:51:49 -08:00
len = min ( rx_packet_len , rx_ring - > rx_hdr_len ) ;
memcpy ( __skb_put ( skb , len ) , va , len ) ;
copysize = len ;
2015-01-24 09:58:35 +00:00
rx_packet_len - = len ;
2013-12-21 06:12:51 +00:00
}
/* Get the rest of the data if this was a header split */
2015-01-24 09:58:35 +00:00
if ( rx_packet_len ) {
2016-01-13 16:51:49 -08:00
skb_add_rx_frag ( skb , skb_shinfo ( skb ) - > nr_frags ,
rx_bi - > page ,
rx_bi - > page_offset + copysize ,
rx_packet_len , I40E_RXBUFFER_2048 ) ;
/* If the page count is more than 2, then both halves
* of the page are used and we need to free it . Do it
* here instead of in the alloc code . Otherwise one
* of the half - pages might be released between now and
* then , and we wouldn ' t know which one to use .
2016-01-15 14:33:15 -08:00
* Don ' t call get_page and free_page since those are
* both expensive atomic operations that just change
* the refcount in opposite directions . Just give the
* page to the stack ; he can have our refcount .
2016-01-13 16:51:49 -08:00
*/
if ( page_count ( rx_bi - > page ) > 2 ) {
dma_unmap_page ( rx_ring - > dev ,
rx_bi - > page_dma ,
PAGE_SIZE ,
DMA_FROM_DEVICE ) ;
2013-12-21 06:12:51 +00:00
rx_bi - > page = NULL ;
2016-01-13 16:51:49 -08:00
rx_bi - > page_dma = 0 ;
rx_ring - > rx_stats . realloc_count + + ;
2016-01-15 14:33:15 -08:00
} else {
get_page ( rx_bi - > page ) ;
/* switch to the other half-page here; the
* allocation code programs the right addr
* into HW . If we haven ' t used this half - page ,
* the address won ' t be changed , and HW can
* just use it next time through .
*/
rx_bi - > page_offset ^ = PAGE_SIZE / 2 ;
2016-01-13 16:51:49 -08:00
}
2013-12-21 06:12:51 +00:00
}
2015-01-24 09:58:35 +00:00
I40E_RX_INCREMENT ( rx_ring , i ) ;
2013-12-21 06:12:51 +00:00
if ( unlikely (
2015-06-04 16:24:02 -04:00
! ( rx_status & BIT ( I40E_RX_DESC_STATUS_EOF_SHIFT ) ) ) ) {
2013-12-21 06:12:51 +00:00
struct i40e_rx_buffer * next_buffer ;
next_buffer = & rx_ring - > rx_bi [ i ] ;
2015-01-24 09:58:35 +00:00
next_buffer - > skb = skb ;
2013-12-21 06:12:51 +00:00
rx_ring - > rx_stats . non_eop_descs + + ;
2015-01-24 09:58:35 +00:00
continue ;
2013-12-21 06:12:51 +00:00
}
/* ERR_MASK will only have valid bits if EOP set */
2015-06-04 16:24:02 -04:00
if ( unlikely ( rx_error & BIT ( I40E_RX_DESC_ERROR_RXE_SHIFT ) ) ) {
2013-12-21 06:12:51 +00:00
dev_kfree_skb_any ( skb ) ;
2015-01-24 09:58:35 +00:00
continue ;
2013-12-21 06:12:51 +00:00
}
2015-12-09 15:50:21 -08:00
i40e_rx_hash ( rx_ring , rx_desc , skb , rx_ptype ) ;
2013-12-21 06:12:51 +00:00
/* probably a little skewed due to removing CRC */
total_rx_bytes + = skb - > len ;
total_rx_packets + + ;
skb - > protocol = eth_type_trans ( skb , rx_ring - > netdev ) ;
i40e_rx_checksum ( vsi , skb , rx_status , rx_error , rx_ptype ) ;
2015-06-04 16:24:02 -04:00
vlan_tag = rx_status & BIT ( I40E_RX_DESC_STATUS_L2TAG1P_SHIFT )
2013-12-21 06:12:51 +00:00
? le16_to_cpu ( rx_desc - > wb . qword0 . lo_dword . l2tag1 )
: 0 ;
2015-01-24 09:58:35 +00:00
# ifdef I40E_FCOE
2016-04-01 03:56:06 -07:00
if ( unlikely (
i40e_rx_is_fcoe ( rx_ptype ) & &
! i40e_fcoe_handle_offload ( rx_ring , rx_desc , skb ) ) ) {
2015-01-24 09:58:35 +00:00
dev_kfree_skb_any ( skb ) ;
continue ;
}
# endif
2013-12-21 06:12:51 +00:00
i40e_receive_skb ( rx_ring , skb , vlan_tag ) ;
rx_desc - > wb . qword1 . status_error_len = 0 ;
2015-01-24 09:58:35 +00:00
} while ( likely ( total_rx_packets < budget ) ) ;
u64_stats_update_begin ( & rx_ring - > syncp ) ;
rx_ring - > stats . packets + = total_rx_packets ;
rx_ring - > stats . bytes + = total_rx_bytes ;
u64_stats_update_end ( & rx_ring - > syncp ) ;
rx_ring - > q_vector - > rx . total_packets + = total_rx_packets ;
rx_ring - > q_vector - > rx . total_bytes + = total_rx_bytes ;
2016-01-13 16:51:46 -08:00
return failure ? budget : total_rx_packets ;
2015-01-24 09:58:35 +00:00
}
/**
* i40e_clean_rx_irq_1buf - Reclaim resources after receive ; single buffer
* @ rx_ring : rx ring to clean
* @ budget : how many cleans we ' re allowed
*
* Returns number of packets cleaned
* */
static int i40e_clean_rx_irq_1buf ( struct i40e_ring * rx_ring , int budget )
{
unsigned int total_rx_bytes = 0 , total_rx_packets = 0 ;
u16 cleaned_count = I40E_DESC_UNUSED ( rx_ring ) ;
struct i40e_vsi * vsi = rx_ring - > vsi ;
union i40e_rx_desc * rx_desc ;
u32 rx_error , rx_status ;
u16 rx_packet_len ;
2016-01-13 16:51:46 -08:00
bool failure = false ;
2015-01-24 09:58:35 +00:00
u8 rx_ptype ;
u64 qword ;
u16 i ;
do {
struct i40e_rx_buffer * rx_bi ;
struct sk_buff * skb ;
u16 vlan_tag ;
2013-12-21 06:12:51 +00:00
/* return some buffers to hardware, one at a time is too slow */
if ( cleaned_count > = I40E_RX_BUFFER_WRITE ) {
2016-01-13 16:51:46 -08:00
failure = failure | |
i40evf_alloc_rx_buffers_1buf ( rx_ring ,
cleaned_count ) ;
2013-12-21 06:12:51 +00:00
cleaned_count = 0 ;
}
2015-01-24 09:58:35 +00:00
i = rx_ring - > next_to_clean ;
rx_desc = I40E_RX_DESC ( rx_ring , i ) ;
2013-12-21 06:12:51 +00:00
qword = le64_to_cpu ( rx_desc - > wb . qword1 . status_error_len ) ;
rx_status = ( qword & I40E_RXD_QW1_STATUS_MASK ) > >
2015-01-24 09:58:35 +00:00
I40E_RXD_QW1_STATUS_SHIFT ;
2015-06-04 16:24:02 -04:00
if ( ! ( rx_status & BIT ( I40E_RX_DESC_STATUS_DD_SHIFT ) ) )
2015-01-24 09:58:35 +00:00
break ;
/* This memory barrier is needed to keep us from reading
* any other fields out of the rx_desc until we know the
* DD bit is set .
*/
2015-04-08 18:49:43 -07:00
dma_rmb ( ) ;
2015-01-24 09:58:35 +00:00
rx_bi = & rx_ring - > rx_bi [ i ] ;
skb = rx_bi - > skb ;
prefetch ( skb - > data ) ;
rx_packet_len = ( qword & I40E_RXD_QW1_LENGTH_PBUF_MASK ) > >
I40E_RXD_QW1_LENGTH_PBUF_SHIFT ;
rx_error = ( qword & I40E_RXD_QW1_ERROR_MASK ) > >
I40E_RXD_QW1_ERROR_SHIFT ;
2015-06-04 16:24:02 -04:00
rx_error & = ~ BIT ( I40E_RX_DESC_ERROR_HBO_SHIFT ) ;
2015-01-24 09:58:35 +00:00
rx_ptype = ( qword & I40E_RXD_QW1_PTYPE_MASK ) > >
I40E_RXD_QW1_PTYPE_SHIFT ;
rx_bi - > skb = NULL ;
cleaned_count + + ;
/* Get the header and possibly the whole packet
* If this is an skb from previous receive dma will be 0
*/
skb_put ( skb , rx_packet_len ) ;
dma_unmap_single ( rx_ring - > dev , rx_bi - > dma , rx_ring - > rx_buf_len ,
DMA_FROM_DEVICE ) ;
rx_bi - > dma = 0 ;
I40E_RX_INCREMENT ( rx_ring , i ) ;
if ( unlikely (
2015-06-04 16:24:02 -04:00
! ( rx_status & BIT ( I40E_RX_DESC_STATUS_EOF_SHIFT ) ) ) ) {
2015-01-24 09:58:35 +00:00
rx_ring - > rx_stats . non_eop_descs + + ;
continue ;
}
/* ERR_MASK will only have valid bits if EOP set */
2015-06-04 16:24:02 -04:00
if ( unlikely ( rx_error & BIT ( I40E_RX_DESC_ERROR_RXE_SHIFT ) ) ) {
2015-01-24 09:58:35 +00:00
dev_kfree_skb_any ( skb ) ;
continue ;
}
2015-12-09 15:50:21 -08:00
i40e_rx_hash ( rx_ring , rx_desc , skb , rx_ptype ) ;
2015-01-24 09:58:35 +00:00
/* probably a little skewed due to removing CRC */
total_rx_bytes + = skb - > len ;
total_rx_packets + + ;
skb - > protocol = eth_type_trans ( skb , rx_ring - > netdev ) ;
i40e_rx_checksum ( vsi , skb , rx_status , rx_error , rx_ptype ) ;
2015-06-04 16:24:02 -04:00
vlan_tag = rx_status & BIT ( I40E_RX_DESC_STATUS_L2TAG1P_SHIFT )
2015-01-24 09:58:35 +00:00
? le16_to_cpu ( rx_desc - > wb . qword0 . lo_dword . l2tag1 )
: 0 ;
i40e_receive_skb ( rx_ring , skb , vlan_tag ) ;
rx_desc - > wb . qword1 . status_error_len = 0 ;
} while ( likely ( total_rx_packets < budget ) ) ;
2013-12-21 06:12:51 +00:00
u64_stats_update_begin ( & rx_ring - > syncp ) ;
rx_ring - > stats . packets + = total_rx_packets ;
rx_ring - > stats . bytes + = total_rx_bytes ;
u64_stats_update_end ( & rx_ring - > syncp ) ;
rx_ring - > q_vector - > rx . total_packets + = total_rx_packets ;
rx_ring - > q_vector - > rx . total_bytes + = total_rx_bytes ;
2016-01-13 16:51:46 -08:00
return failure ? budget : total_rx_packets ;
2013-12-21 06:12:51 +00:00
}
2015-09-28 14:16:51 -04:00
static u32 i40e_buildreg_itr ( const int type , const u16 itr )
{
u32 val ;
val = I40E_VFINT_DYN_CTLN1_INTENA_MASK |
2016-01-13 16:51:45 -08:00
/* Don't clear PBA because that can cause lost interrupts that
* came in while we were cleaning / polling
*/
2015-09-28 14:16:51 -04:00
( type < < I40E_VFINT_DYN_CTLN1_ITR_INDX_SHIFT ) |
( itr < < I40E_VFINT_DYN_CTLN1_INTERVAL_SHIFT ) ;
return val ;
}
/* a small macro to shorten up some long lines */
# define INTREG I40E_VFINT_DYN_CTLN1
2015-06-10 13:42:07 -04:00
/**
* i40e_update_enable_itr - Update itr and re - enable MSIX interrupt
* @ vsi : the VSI we care about
* @ q_vector : q_vector for which itr is being updated and interrupt enabled
*
* */
static inline void i40e_update_enable_itr ( struct i40e_vsi * vsi ,
struct i40e_q_vector * q_vector )
{
struct i40e_hw * hw = & vsi - > back - > hw ;
2015-09-28 14:16:51 -04:00
bool rx = false , tx = false ;
u32 rxval , txval ;
2015-06-10 13:42:07 -04:00
int vector ;
vector = ( q_vector - > v_idx + vsi - > base_vector ) ;
2015-09-28 14:16:54 -04:00
/* avoid dynamic calculation if in countdown mode OR if
* all dynamic is disabled
*/
2015-09-28 14:16:51 -04:00
rxval = txval = i40e_buildreg_itr ( I40E_ITR_NONE , 0 ) ;
2015-09-28 14:16:54 -04:00
if ( q_vector - > itr_countdown > 0 | |
( ! ITR_IS_DYNAMIC ( vsi - > rx_itr_setting ) & &
! ITR_IS_DYNAMIC ( vsi - > tx_itr_setting ) ) ) {
goto enable_int ;
}
2015-06-10 13:42:07 -04:00
if ( ITR_IS_DYNAMIC ( vsi - > rx_itr_setting ) ) {
2015-09-28 14:16:51 -04:00
rx = i40e_set_new_dynamic_itr ( & q_vector - > rx ) ;
rxval = i40e_buildreg_itr ( I40E_RX_ITR , q_vector - > rx . itr ) ;
2015-06-10 13:42:07 -04:00
}
2015-11-18 17:35:42 -08:00
2015-06-10 13:42:07 -04:00
if ( ITR_IS_DYNAMIC ( vsi - > tx_itr_setting ) ) {
2015-09-28 14:16:51 -04:00
tx = i40e_set_new_dynamic_itr ( & q_vector - > tx ) ;
txval = i40e_buildreg_itr ( I40E_TX_ITR , q_vector - > tx . itr ) ;
}
2015-11-18 17:35:42 -08:00
2015-09-28 14:16:51 -04:00
if ( rx | | tx ) {
/* get the higher of the two ITR adjustments and
* use the same value for both ITR registers
* when in adaptive mode ( Rx and / or Tx )
*/
u16 itr = max ( q_vector - > tx . itr , q_vector - > rx . itr ) ;
q_vector - > tx . itr = q_vector - > rx . itr = itr ;
txval = i40e_buildreg_itr ( I40E_TX_ITR , itr ) ;
tx = true ;
rxval = i40e_buildreg_itr ( I40E_RX_ITR , itr ) ;
rx = true ;
2015-06-10 13:42:07 -04:00
}
2015-09-28 14:16:51 -04:00
/* only need to enable the interrupt once, but need
* to possibly update both ITR values
*/
if ( rx ) {
/* set the INTENA_MSK_MASK so that this first write
* won ' t actually enable the interrupt , instead just
* updating the ITR ( it ' s bit 31 PF and VF )
*/
rxval | = BIT ( 31 ) ;
/* don't check _DOWN because interrupt isn't being enabled */
wr32 ( hw , INTREG ( vector - 1 ) , rxval ) ;
}
2015-09-28 14:16:54 -04:00
enable_int :
2015-09-28 14:16:51 -04:00
if ( ! test_bit ( __I40E_DOWN , & vsi - > state ) )
wr32 ( hw , INTREG ( vector - 1 ) , txval ) ;
2015-09-28 14:16:54 -04:00
if ( q_vector - > itr_countdown )
q_vector - > itr_countdown - - ;
else
q_vector - > itr_countdown = ITR_COUNTDOWN_START ;
2015-06-10 13:42:07 -04:00
}
2013-12-21 06:12:51 +00:00
/**
* i40evf_napi_poll - NAPI polling Rx / Tx cleanup routine
* @ napi : napi struct with our devices info in it
* @ budget : amount of work driver is allowed to do this pass , in packets
*
* This function will clean all queues associated with a q_vector .
*
* Returns the amount of work done
* */
int i40evf_napi_poll ( struct napi_struct * napi , int budget )
{
struct i40e_q_vector * q_vector =
container_of ( napi , struct i40e_q_vector , napi ) ;
struct i40e_vsi * vsi = q_vector - > vsi ;
struct i40e_ring * ring ;
bool clean_complete = true ;
2015-01-10 01:07:19 +00:00
bool arm_wb = false ;
2013-12-21 06:12:51 +00:00
int budget_per_ring ;
2015-09-24 16:35:47 -07:00
int work_done = 0 ;
2013-12-21 06:12:51 +00:00
if ( test_bit ( __I40E_DOWN , & vsi - > state ) ) {
napi_complete ( napi ) ;
return 0 ;
}
/* Since the actual Tx work is minimal, we can give the Tx a larger
* budget and be more aggressive about cleaning up the Tx descriptors .
*/
2015-01-10 01:07:19 +00:00
i40e_for_each_ring ( ring , q_vector - > tx ) {
2016-03-07 09:30:03 -08:00
if ( ! i40e_clean_tx_irq ( vsi , ring , budget ) ) {
2016-03-07 09:29:57 -08:00
clean_complete = false ;
continue ;
}
arm_wb | = ring - > arm_wb ;
2015-07-23 16:54:34 -04:00
ring - > arm_wb = false ;
2015-01-10 01:07:19 +00:00
}
2013-12-21 06:12:51 +00:00
2015-09-24 09:04:26 -07:00
/* Handle case where we are called by netpoll with a budget of 0 */
if ( budget < = 0 )
goto tx_only ;
2013-12-21 06:12:51 +00:00
/* We attempt to distribute budget to each Rx queue fairly, but don't
* allow the budget to go below 1 because that would exit polling early .
*/
budget_per_ring = max ( budget / q_vector - > num_ringpairs , 1 ) ;
2015-01-24 09:58:35 +00:00
i40e_for_each_ring ( ring , q_vector - > rx ) {
2015-09-24 16:35:47 -07:00
int cleaned ;
2015-01-24 09:58:35 +00:00
if ( ring_is_ps_enabled ( ring ) )
cleaned = i40e_clean_rx_irq_ps ( ring , budget_per_ring ) ;
else
cleaned = i40e_clean_rx_irq_1buf ( ring , budget_per_ring ) ;
2015-09-24 16:35:47 -07:00
work_done + = cleaned ;
2016-03-07 09:29:57 -08:00
/* if we clean as many as budgeted, we must not be done */
if ( cleaned > = budget_per_ring )
clean_complete = false ;
2015-01-24 09:58:35 +00:00
}
2013-12-21 06:12:51 +00:00
/* If work not completed, return budget and polling will return */
2015-01-10 01:07:19 +00:00
if ( ! clean_complete ) {
2015-09-24 09:04:26 -07:00
tx_only :
2015-10-21 19:47:08 -04:00
if ( arm_wb ) {
q_vector - > tx . ring [ 0 ] . tx_stats . tx_force_wb + + ;
2016-01-13 16:51:43 -08:00
i40e_enable_wb_on_itr ( vsi , q_vector ) ;
2015-10-21 19:47:08 -04:00
}
2013-12-21 06:12:51 +00:00
return budget ;
2015-01-10 01:07:19 +00:00
}
2013-12-21 06:12:51 +00:00
2015-06-05 12:20:30 -04:00
if ( vsi - > back - > flags & I40E_TXR_FLAGS_WB_ON_ITR )
q_vector - > arm_wb_state = false ;
2013-12-21 06:12:51 +00:00
/* Work is done so exit the polling mode and re-enable the interrupt */
2015-09-24 16:35:47 -07:00
napi_complete_done ( napi , work_done ) ;
2015-06-10 13:42:07 -04:00
i40e_update_enable_itr ( vsi , q_vector ) ;
2013-12-21 06:12:51 +00:00
return 0 ;
}
/**
2015-04-16 20:06:10 -04:00
* i40evf_tx_prepare_vlan_flags - prepare generic TX VLAN tagging flags for HW
2013-12-21 06:12:51 +00:00
* @ skb : send buffer
* @ tx_ring : ring to send buffer on
* @ flags : the tx flags to be set
*
* Checks the skb and set up correspondingly several generic transmit flags
* related to VLAN tagging for the HW , such as VLAN , DCB , etc .
*
* Returns error code indicate the frame should be dropped upon error and the
* otherwise returns 0 to indicate the flags has been set properly .
* */
2015-04-16 20:06:10 -04:00
static inline int i40evf_tx_prepare_vlan_flags ( struct sk_buff * skb ,
struct i40e_ring * tx_ring ,
u32 * flags )
2013-12-21 06:12:51 +00:00
{
__be16 protocol = skb - > protocol ;
u32 tx_flags = 0 ;
2015-03-31 00:45:03 -07:00
if ( protocol = = htons ( ETH_P_8021Q ) & &
! ( tx_ring - > netdev - > features & NETIF_F_HW_VLAN_CTAG_TX ) ) {
/* When HW VLAN acceleration is turned off by the user the
* stack sets the protocol to 8021 q so that the driver
* can take any steps required to support the SW only
* VLAN handling . In our case the driver doesn ' t need
* to take any further steps so just set the protocol
* to the encapsulated ethertype .
*/
skb - > protocol = vlan_get_protocol ( skb ) ;
goto out ;
}
2013-12-21 06:12:51 +00:00
/* if we have a HW VLAN tag being added, default to the HW one */
2015-01-13 17:13:44 +01:00
if ( skb_vlan_tag_present ( skb ) ) {
tx_flags | = skb_vlan_tag_get ( skb ) < < I40E_TX_FLAGS_VLAN_SHIFT ;
2013-12-21 06:12:51 +00:00
tx_flags | = I40E_TX_FLAGS_HW_VLAN ;
/* else if it is a SW VLAN, check the next protocol and store the tag */
} else if ( protocol = = htons ( ETH_P_8021Q ) ) {
struct vlan_hdr * vhdr , _vhdr ;
2015-08-28 17:55:54 -04:00
2013-12-21 06:12:51 +00:00
vhdr = skb_header_pointer ( skb , ETH_HLEN , sizeof ( _vhdr ) , & _vhdr ) ;
if ( ! vhdr )
return - EINVAL ;
protocol = vhdr - > h_vlan_encapsulated_proto ;
tx_flags | = ntohs ( vhdr - > h_vlan_TCI ) < < I40E_TX_FLAGS_VLAN_SHIFT ;
tx_flags | = I40E_TX_FLAGS_SW_VLAN ;
}
2015-03-31 00:45:03 -07:00
out :
2013-12-21 06:12:51 +00:00
* flags = tx_flags ;
return 0 ;
}
/**
* i40e_tso - set up the tso context descriptor
* @ skb : ptr to the skb we ' re sending
* @ hdr_len : ptr to the size of the packet header
2015-10-21 19:47:02 -04:00
* @ cd_type_cmd_tso_mss : Quad Word 1
2013-12-21 06:12:51 +00:00
*
* Returns 0 if no TSO can happen , 1 if tso is going , or error
* */
2016-04-01 03:56:05 -07:00
static int i40e_tso ( struct sk_buff * skb , u8 * hdr_len , u64 * cd_type_cmd_tso_mss )
2013-12-21 06:12:51 +00:00
{
2016-01-24 21:16:20 -08:00
u64 cd_cmd , cd_tso_len , cd_mss ;
2016-01-24 21:16:35 -08:00
union {
struct iphdr * v4 ;
struct ipv6hdr * v6 ;
unsigned char * hdr ;
} ip ;
2016-01-24 21:16:28 -08:00
union {
struct tcphdr * tcp ;
2016-01-24 21:17:29 -08:00
struct udphdr * udp ;
2016-01-24 21:16:28 -08:00
unsigned char * hdr ;
} l4 ;
u32 paylen , l4_offset ;
2013-12-21 06:12:51 +00:00
int err ;
2016-01-04 10:33:04 -08:00
if ( skb - > ip_summed ! = CHECKSUM_PARTIAL )
return 0 ;
2013-12-21 06:12:51 +00:00
if ( ! skb_is_gso ( skb ) )
return 0 ;
2014-03-30 03:14:53 +00:00
err = skb_cow_head ( skb , 0 ) ;
if ( err < 0 )
return err ;
2013-12-21 06:12:51 +00:00
2016-01-24 21:16:35 -08:00
ip . hdr = skb_network_header ( skb ) ;
l4 . hdr = skb_transport_header ( skb ) ;
2015-02-21 06:44:16 +00:00
2016-01-24 21:16:35 -08:00
/* initialize outer IP header fields */
if ( ip . v4 - > version = = 4 ) {
ip . v4 - > tot_len = 0 ;
ip . v4 - > check = 0 ;
2016-01-24 21:16:28 -08:00
} else {
2016-01-24 21:16:35 -08:00
ip . v6 - > payload_len = 0 ;
}
2016-01-24 21:17:29 -08:00
if ( skb_shinfo ( skb ) - > gso_type & ( SKB_GSO_UDP_TUNNEL | SKB_GSO_GRE |
SKB_GSO_UDP_TUNNEL_CSUM ) ) {
if ( skb_shinfo ( skb ) - > gso_type & SKB_GSO_UDP_TUNNEL_CSUM ) {
/* determine offset of outer transport header */
l4_offset = l4 . hdr - skb - > data ;
/* remove payload length from outer checksum */
2016-03-18 16:06:47 -07:00
paylen = skb - > len - l4_offset ;
csum_replace_by_diff ( & l4 . udp - > check , htonl ( paylen ) ) ;
2016-01-24 21:17:29 -08:00
}
2016-01-24 21:16:35 -08:00
/* reset pointers to inner headers */
ip . hdr = skb_inner_network_header ( skb ) ;
l4 . hdr = skb_inner_transport_header ( skb ) ;
/* initialize inner IP header fields */
if ( ip . v4 - > version = = 4 ) {
ip . v4 - > tot_len = 0 ;
ip . v4 - > check = 0 ;
} else {
ip . v6 - > payload_len = 0 ;
}
2013-12-21 06:12:51 +00:00
}
2016-01-24 21:16:28 -08:00
/* determine offset of inner transport header */
l4_offset = l4 . hdr - skb - > data ;
/* remove payload length from inner checksum */
2016-03-18 16:06:47 -07:00
paylen = skb - > len - l4_offset ;
csum_replace_by_diff ( & l4 . tcp - > check , htonl ( paylen ) ) ;
2016-01-24 21:16:28 -08:00
/* compute length of segmentation header */
* hdr_len = ( l4 . tcp - > doff * 4 ) + l4_offset ;
2013-12-21 06:12:51 +00:00
/* find the field values */
cd_cmd = I40E_TX_CTX_DESC_TSO ;
cd_tso_len = skb - > len - * hdr_len ;
cd_mss = skb_shinfo ( skb ) - > gso_size ;
2016-01-24 21:16:20 -08:00
* cd_type_cmd_tso_mss | = ( cd_cmd < < I40E_TXD_CTX_QW1_CMD_SHIFT ) |
( cd_tso_len < < I40E_TXD_CTX_QW1_TSO_LEN_SHIFT ) |
( cd_mss < < I40E_TXD_CTX_QW1_MSS_SHIFT ) ;
2013-12-21 06:12:51 +00:00
return 1 ;
}
/**
* i40e_tx_enable_csum - Enable Tx checksum offloads
* @ skb : send buffer
2015-04-16 20:06:00 -04:00
* @ tx_flags : pointer to Tx flags currently set
2013-12-21 06:12:51 +00:00
* @ td_cmd : Tx descriptor command bits to set
* @ td_offset : Tx descriptor header offsets to set
2016-01-24 21:17:10 -08:00
* @ tx_ring : Tx descriptor ring
2013-12-21 06:12:51 +00:00
* @ cd_tunneling : ptr to context desc bits
* */
2016-01-24 21:17:10 -08:00
static int i40e_tx_enable_csum ( struct sk_buff * skb , u32 * tx_flags ,
u32 * td_cmd , u32 * td_offset ,
struct i40e_ring * tx_ring ,
u32 * cd_tunneling )
2013-12-21 06:12:51 +00:00
{
2016-01-24 21:16:42 -08:00
union {
struct iphdr * v4 ;
struct ipv6hdr * v6 ;
unsigned char * hdr ;
} ip ;
union {
struct tcphdr * tcp ;
struct udphdr * udp ;
unsigned char * hdr ;
} l4 ;
2016-01-24 21:16:54 -08:00
unsigned char * exthdr ;
2016-04-01 03:56:04 -07:00
u32 offset , cmd = 0 ;
2016-01-24 21:16:54 -08:00
__be16 frag_off ;
2016-01-24 21:16:42 -08:00
u8 l4_proto = 0 ;
2016-01-24 21:17:10 -08:00
if ( skb - > ip_summed ! = CHECKSUM_PARTIAL )
return 0 ;
2016-01-24 21:16:42 -08:00
ip . hdr = skb_network_header ( skb ) ;
l4 . hdr = skb_transport_header ( skb ) ;
2013-12-21 06:12:51 +00:00
2016-01-24 21:17:01 -08:00
/* compute outer L2 header size */
offset = ( ( ip . hdr - skb - > data ) / 2 ) < < I40E_TX_DESC_LENGTH_MACLEN_SHIFT ;
2013-12-21 06:12:51 +00:00
if ( skb - > encapsulation ) {
2016-04-01 03:56:04 -07:00
u32 tunnel = 0 ;
2016-01-24 21:16:48 -08:00
/* define outer network header type */
if ( * tx_flags & I40E_TX_FLAGS_IPV4 ) {
2016-01-24 21:17:01 -08:00
tunnel | = ( * tx_flags & I40E_TX_FLAGS_TSO ) ?
I40E_TX_CTX_EXT_IP_IPV4 :
I40E_TX_CTX_EXT_IP_IPV4_NO_CSUM ;
2016-01-24 21:16:48 -08:00
l4_proto = ip . v4 - > protocol ;
} else if ( * tx_flags & I40E_TX_FLAGS_IPV6 ) {
2016-01-24 21:17:01 -08:00
tunnel | = I40E_TX_CTX_EXT_IP_IPV6 ;
2016-01-24 21:16:54 -08:00
exthdr = ip . hdr + sizeof ( * ip . v6 ) ;
2016-01-24 21:16:48 -08:00
l4_proto = ip . v6 - > nexthdr ;
2016-01-24 21:16:54 -08:00
if ( l4 . hdr ! = exthdr )
ipv6_skip_exthdr ( skb , exthdr - skb - > data ,
& l4_proto , & frag_off ) ;
2016-01-24 21:16:48 -08:00
}
2016-01-24 21:17:01 -08:00
/* compute outer L3 header size */
tunnel | = ( ( l4 . hdr - ip . hdr ) / 4 ) < <
I40E_TXD_CTX_QW0_EXT_IPLEN_SHIFT ;
/* switch IP header pointer from outer to inner header */
ip . hdr = skb_inner_network_header ( skb ) ;
2016-01-24 21:16:48 -08:00
/* define outer transport */
switch ( l4_proto ) {
2015-02-27 09:15:29 +00:00
case IPPROTO_UDP :
2016-01-24 21:17:01 -08:00
tunnel | = I40E_TXD_CTX_UDP_TUNNELING ;
2015-04-16 20:06:00 -04:00
* tx_flags | = I40E_TX_FLAGS_VXLAN_TUNNEL ;
2015-02-27 09:15:29 +00:00
break ;
2016-01-24 21:16:48 -08:00
case IPPROTO_GRE :
2016-01-24 21:17:01 -08:00
tunnel | = I40E_TXD_CTX_GRE_TUNNELING ;
2016-01-24 21:16:48 -08:00
* tx_flags | = I40E_TX_FLAGS_VXLAN_TUNNEL ;
break ;
2015-02-27 09:15:29 +00:00
default :
2016-01-24 21:17:10 -08:00
if ( * tx_flags & I40E_TX_FLAGS_TSO )
return - 1 ;
skb_checksum_help ( skb ) ;
return 0 ;
2015-02-27 09:15:29 +00:00
}
2016-01-24 21:16:42 -08:00
2016-01-24 21:17:01 -08:00
/* compute tunnel header size */
tunnel | = ( ( ip . hdr - l4 . hdr ) / 2 ) < <
I40E_TXD_CTX_QW0_NATLEN_SHIFT ;
2016-01-24 21:17:29 -08:00
/* indicate if we need to offload outer UDP header */
if ( ( * tx_flags & I40E_TX_FLAGS_TSO ) & &
( skb_shinfo ( skb ) - > gso_type & SKB_GSO_UDP_TUNNEL_CSUM ) )
tunnel | = I40E_TXD_CTX_QW0_L4T_CS_MASK ;
2016-01-24 21:17:01 -08:00
/* record tunnel offload values */
* cd_tunneling | = tunnel ;
2016-01-24 21:16:42 -08:00
/* switch L4 header pointer from outer to inner */
l4 . hdr = skb_inner_transport_header ( skb ) ;
2016-01-24 21:16:48 -08:00
l4_proto = 0 ;
2013-12-21 06:12:51 +00:00
2016-01-24 21:16:48 -08:00
/* reset type as we transition from outer to inner headers */
* tx_flags & = ~ ( I40E_TX_FLAGS_IPV4 | I40E_TX_FLAGS_IPV6 ) ;
if ( ip . v4 - > version = = 4 )
* tx_flags | = I40E_TX_FLAGS_IPV4 ;
if ( ip . v6 - > version = = 6 )
2015-04-16 20:06:00 -04:00
* tx_flags | = I40E_TX_FLAGS_IPV6 ;
2013-12-21 06:12:51 +00:00
}
/* Enable IP checksum offloads */
2015-04-16 20:06:00 -04:00
if ( * tx_flags & I40E_TX_FLAGS_IPV4 ) {
2016-01-24 21:16:42 -08:00
l4_proto = ip . v4 - > protocol ;
2013-12-21 06:12:51 +00:00
/* the stack computes the IP header already, the only time we
* need the hardware to recompute it is in the case of TSO .
*/
2016-01-24 21:17:01 -08:00
cmd | = ( * tx_flags & I40E_TX_FLAGS_TSO ) ?
I40E_TX_DESC_CMD_IIPT_IPV4_CSUM :
I40E_TX_DESC_CMD_IIPT_IPV4 ;
2015-04-16 20:06:00 -04:00
} else if ( * tx_flags & I40E_TX_FLAGS_IPV6 ) {
2016-01-24 21:17:01 -08:00
cmd | = I40E_TX_DESC_CMD_IIPT_IPV6 ;
2016-01-24 21:16:54 -08:00
exthdr = ip . hdr + sizeof ( * ip . v6 ) ;
l4_proto = ip . v6 - > nexthdr ;
if ( l4 . hdr ! = exthdr )
ipv6_skip_exthdr ( skb , exthdr - skb - > data ,
& l4_proto , & frag_off ) ;
2013-12-21 06:12:51 +00:00
}
2016-01-24 21:16:42 -08:00
2016-01-24 21:17:01 -08:00
/* compute inner L3 header size */
offset | = ( ( l4 . hdr - ip . hdr ) / 4 ) < < I40E_TX_DESC_LENGTH_IPLEN_SHIFT ;
2013-12-21 06:12:51 +00:00
/* Enable L4 checksum offloads */
2016-01-24 21:16:42 -08:00
switch ( l4_proto ) {
2013-12-21 06:12:51 +00:00
case IPPROTO_TCP :
/* enable checksum offloads */
2016-01-24 21:17:01 -08:00
cmd | = I40E_TX_DESC_CMD_L4T_EOFT_TCP ;
offset | = l4 . tcp - > doff < < I40E_TX_DESC_LENGTH_L4_FC_LEN_SHIFT ;
2013-12-21 06:12:51 +00:00
break ;
case IPPROTO_SCTP :
/* enable SCTP checksum offload */
2016-01-24 21:17:01 -08:00
cmd | = I40E_TX_DESC_CMD_L4T_EOFT_SCTP ;
offset | = ( sizeof ( struct sctphdr ) > > 2 ) < <
I40E_TX_DESC_LENGTH_L4_FC_LEN_SHIFT ;
2013-12-21 06:12:51 +00:00
break ;
case IPPROTO_UDP :
/* enable UDP checksum offload */
2016-01-24 21:17:01 -08:00
cmd | = I40E_TX_DESC_CMD_L4T_EOFT_UDP ;
offset | = ( sizeof ( struct udphdr ) > > 2 ) < <
I40E_TX_DESC_LENGTH_L4_FC_LEN_SHIFT ;
2013-12-21 06:12:51 +00:00
break ;
default :
2016-01-24 21:17:10 -08:00
if ( * tx_flags & I40E_TX_FLAGS_TSO )
return - 1 ;
skb_checksum_help ( skb ) ;
return 0 ;
2013-12-21 06:12:51 +00:00
}
2016-01-24 21:17:01 -08:00
* td_cmd | = cmd ;
* td_offset | = offset ;
2016-01-24 21:17:10 -08:00
return 1 ;
2013-12-21 06:12:51 +00:00
}
/**
* i40e_create_tx_ctx Build the Tx context descriptor
* @ tx_ring : ring to create the descriptor on
* @ cd_type_cmd_tso_mss : Quad Word 1
* @ cd_tunneling : Quad Word 0 - bits 0 - 31
* @ cd_l2tag2 : Quad Word 0 - bits 32 - 63
* */
static void i40e_create_tx_ctx ( struct i40e_ring * tx_ring ,
const u64 cd_type_cmd_tso_mss ,
const u32 cd_tunneling , const u32 cd_l2tag2 )
{
struct i40e_tx_context_desc * context_desc ;
int i = tx_ring - > next_to_use ;
2014-02-14 02:14:41 +00:00
if ( ( cd_type_cmd_tso_mss = = I40E_TX_DESC_DTYPE_CONTEXT ) & &
! cd_tunneling & & ! cd_l2tag2 )
2013-12-21 06:12:51 +00:00
return ;
/* grab the next descriptor */
context_desc = I40E_TX_CTXTDESC ( tx_ring , i ) ;
i + + ;
tx_ring - > next_to_use = ( i < tx_ring - > count ) ? i : 0 ;
/* cpu_to_le32 and assign to struct fields */
context_desc - > tunneling_params = cpu_to_le32 ( cd_tunneling ) ;
context_desc - > l2tag2 = cpu_to_le16 ( cd_l2tag2 ) ;
2014-06-04 20:41:54 +00:00
context_desc - > rsvd = cpu_to_le16 ( 0 ) ;
2013-12-21 06:12:51 +00:00
context_desc - > type_cmd_tso_mss = cpu_to_le64 ( cd_type_cmd_tso_mss ) ;
}
2015-11-18 17:35:42 -08:00
/**
2016-03-30 16:15:37 -07:00
* __i40evf_chk_linearize - Check if there are more than 8 buffers per packet
2015-02-21 06:42:35 +00:00
* @ skb : send buffer
*
2016-03-30 16:15:37 -07:00
* Note : Our HW can ' t DMA more than 8 buffers to build a packet on the wire
* and so we need to figure out the cases where we need to linearize the skb .
*
* For TSO we need to count the TSO header and segment payload separately .
* As such we need to check cases where we have 7 fragments or more as we
* can potentially require 9 DMA transactions , 1 for the TSO header , 1 for
* the segment payload in the first descriptor , and another 7 for the
* fragments .
2015-02-21 06:42:35 +00:00
* */
2016-02-17 11:02:50 -08:00
bool __i40evf_chk_linearize ( struct sk_buff * skb )
2015-02-21 06:42:35 +00:00
{
2016-02-17 11:02:50 -08:00
const struct skb_frag_struct * frag , * stale ;
2016-03-30 16:15:37 -07:00
int nr_frags , sum ;
2015-02-21 06:42:35 +00:00
2016-03-30 16:15:37 -07:00
/* no need to check if number of frags is less than 7 */
2016-02-17 11:02:50 -08:00
nr_frags = skb_shinfo ( skb ) - > nr_frags ;
2016-03-30 16:15:37 -07:00
if ( nr_frags < ( I40E_MAX_BUFFER_TXD - 1 ) )
2016-02-17 11:02:50 -08:00
return false ;
2015-02-21 06:42:35 +00:00
2016-02-17 11:02:50 -08:00
/* We need to walk through the list and validate that each group
* of 6 fragments totals at least gso_size . However we don ' t need
2016-03-30 16:15:37 -07:00
* to perform such validation on the last 6 since the last 6 cannot
* inherit any data from a descriptor after them .
2016-02-17 11:02:50 -08:00
*/
2016-03-30 16:15:37 -07:00
nr_frags - = I40E_MAX_BUFFER_TXD - 2 ;
2016-02-17 11:02:50 -08:00
frag = & skb_shinfo ( skb ) - > frags [ 0 ] ;
/* Initialize size to the negative value of gso_size minus 1. We
* use this as the worst case scenerio in which the frag ahead
* of us only provides one byte which is why we are limited to 6
* descriptors for a single transmit as the header and previous
* fragment are already consuming 2 descriptors .
*/
2016-03-30 16:15:37 -07:00
sum = 1 - skb_shinfo ( skb ) - > gso_size ;
2016-02-17 11:02:50 -08:00
2016-03-30 16:15:37 -07:00
/* Add size of frags 0 through 4 to create our initial sum */
sum + = skb_frag_size ( frag + + ) ;
sum + = skb_frag_size ( frag + + ) ;
sum + = skb_frag_size ( frag + + ) ;
sum + = skb_frag_size ( frag + + ) ;
sum + = skb_frag_size ( frag + + ) ;
2016-02-17 11:02:50 -08:00
/* Walk through fragments adding latest fragment, testing it, and
* then removing stale fragments from the sum .
*/
stale = & skb_shinfo ( skb ) - > frags [ 0 ] ;
for ( ; ; ) {
2016-03-30 16:15:37 -07:00
sum + = skb_frag_size ( frag + + ) ;
2016-02-17 11:02:50 -08:00
/* if sum is negative we failed to make sufficient progress */
if ( sum < 0 )
return true ;
/* use pre-decrement to avoid processing last fragment */
if ( ! - - nr_frags )
break ;
2016-03-30 16:15:37 -07:00
sum - = skb_frag_size ( stale + + ) ;
2015-02-21 06:42:35 +00:00
}
2016-02-17 11:02:50 -08:00
return false ;
2015-02-21 06:42:35 +00:00
}
2015-04-16 20:06:09 -04:00
/**
* __i40evf_maybe_stop_tx - 2 nd level check for tx stop conditions
* @ tx_ring : the ring to be checked
* @ size : the size buffer we want to assure is available
*
* Returns - EBUSY if a stop is needed , else 0
* */
2016-02-17 11:02:43 -08:00
int __i40evf_maybe_stop_tx ( struct i40e_ring * tx_ring , int size )
2015-04-16 20:06:09 -04:00
{
netif_stop_subqueue ( tx_ring - > netdev , tx_ring - > queue_index ) ;
/* Memory barrier before checking head and tail */
smp_mb ( ) ;
/* Check again in a case another CPU has just made room available. */
if ( likely ( I40E_DESC_UNUSED ( tx_ring ) < size ) )
return - EBUSY ;
/* A reprieve! - use start_queue because it doesn't call schedule */
netif_start_subqueue ( tx_ring - > netdev , tx_ring - > queue_index ) ;
+ + tx_ring - > tx_stats . restart_queue ;
return 0 ;
}
2013-12-21 06:12:51 +00:00
/**
2015-04-16 20:06:10 -04:00
* i40evf_tx_map - Build the Tx descriptor
2013-12-21 06:12:51 +00:00
* @ tx_ring : ring to send buffer on
* @ skb : send buffer
* @ first : first buffer info buffer to use
* @ tx_flags : collected send information
* @ hdr_len : size of the packet header
* @ td_cmd : the command field in the descriptor
* @ td_offset : offset for checksum or crc
* */
2015-04-16 20:06:10 -04:00
static inline void i40evf_tx_map ( struct i40e_ring * tx_ring , struct sk_buff * skb ,
struct i40e_tx_buffer * first , u32 tx_flags ,
const u8 hdr_len , u32 td_cmd , u32 td_offset )
2013-12-21 06:12:51 +00:00
{
unsigned int data_len = skb - > data_len ;
unsigned int size = skb_headlen ( skb ) ;
struct skb_frag_struct * frag ;
struct i40e_tx_buffer * tx_bi ;
struct i40e_tx_desc * tx_desc ;
u16 i = tx_ring - > next_to_use ;
u32 td_tag = 0 ;
dma_addr_t dma ;
u16 gso_segs ;
2015-10-26 19:44:29 -04:00
u16 desc_count = 0 ;
bool tail_bump = true ;
bool do_rs = false ;
2013-12-21 06:12:51 +00:00
if ( tx_flags & I40E_TX_FLAGS_HW_VLAN ) {
td_cmd | = I40E_TX_DESC_CMD_IL2TAG1 ;
td_tag = ( tx_flags & I40E_TX_FLAGS_VLAN_MASK ) > >
I40E_TX_FLAGS_VLAN_SHIFT ;
}
if ( tx_flags & ( I40E_TX_FLAGS_TSO | I40E_TX_FLAGS_FSO ) )
gso_segs = skb_shinfo ( skb ) - > gso_segs ;
else
gso_segs = 1 ;
/* multiply data chunks by size of headers */
first - > bytecount = skb - > len - hdr_len + ( gso_segs * hdr_len ) ;
first - > gso_segs = gso_segs ;
first - > skb = skb ;
first - > tx_flags = tx_flags ;
dma = dma_map_single ( tx_ring - > dev , skb - > data , size , DMA_TO_DEVICE ) ;
tx_desc = I40E_TX_DESC ( tx_ring , i ) ;
tx_bi = first ;
for ( frag = & skb_shinfo ( skb ) - > frags [ 0 ] ; ; frag + + ) {
2016-02-19 12:17:08 -08:00
unsigned int max_data = I40E_MAX_DATA_PER_TXD_ALIGNED ;
2013-12-21 06:12:51 +00:00
if ( dma_mapping_error ( tx_ring - > dev , dma ) )
goto dma_error ;
/* record length, and DMA address */
dma_unmap_len_set ( tx_bi , len , size ) ;
dma_unmap_addr_set ( tx_bi , dma , dma ) ;
2016-02-19 12:17:08 -08:00
/* align size to end of page */
max_data + = - dma & ( I40E_MAX_READ_REQ_SIZE - 1 ) ;
2013-12-21 06:12:51 +00:00
tx_desc - > buffer_addr = cpu_to_le64 ( dma ) ;
while ( unlikely ( size > I40E_MAX_DATA_PER_TXD ) ) {
tx_desc - > cmd_type_offset_bsz =
build_ctob ( td_cmd , td_offset ,
2016-02-19 12:17:08 -08:00
max_data , td_tag ) ;
2013-12-21 06:12:51 +00:00
tx_desc + + ;
i + + ;
2015-10-26 19:44:29 -04:00
desc_count + + ;
2013-12-21 06:12:51 +00:00
if ( i = = tx_ring - > count ) {
tx_desc = I40E_TX_DESC ( tx_ring , 0 ) ;
i = 0 ;
}
2016-02-19 12:17:08 -08:00
dma + = max_data ;
size - = max_data ;
2013-12-21 06:12:51 +00:00
2016-02-19 12:17:08 -08:00
max_data = I40E_MAX_DATA_PER_TXD_ALIGNED ;
2013-12-21 06:12:51 +00:00
tx_desc - > buffer_addr = cpu_to_le64 ( dma ) ;
}
if ( likely ( ! data_len ) )
break ;
tx_desc - > cmd_type_offset_bsz = build_ctob ( td_cmd , td_offset ,
size , td_tag ) ;
tx_desc + + ;
i + + ;
2015-10-26 19:44:29 -04:00
desc_count + + ;
2013-12-21 06:12:51 +00:00
if ( i = = tx_ring - > count ) {
tx_desc = I40E_TX_DESC ( tx_ring , 0 ) ;
i = 0 ;
}
size = skb_frag_size ( frag ) ;
data_len - = size ;
dma = skb_frag_dma_map ( tx_ring - > dev , frag , 0 , size ,
DMA_TO_DEVICE ) ;
tx_bi = & tx_ring - > tx_bi [ i ] ;
}
/* set next_to_watch value indicating a packet is present */
first - > next_to_watch = tx_desc ;
i + + ;
if ( i = = tx_ring - > count )
i = 0 ;
tx_ring - > next_to_use = i ;
2015-10-26 19:44:29 -04:00
netdev_tx_sent_queue ( netdev_get_tx_queue ( tx_ring - > netdev ,
tx_ring - > queue_index ) ,
first - > bytecount ) ;
2016-02-17 11:02:43 -08:00
i40e_maybe_stop_tx ( tx_ring , DESC_NEEDED ) ;
2015-10-26 19:44:29 -04:00
/* Algorithm to optimize tail and RS bit setting:
* if xmit_more is supported
* if xmit_more is true
* do not update tail and do not mark RS bit .
* if xmit_more is false and last xmit_more was false
* if every packet spanned less than 4 desc
* then set RS bit on 4 th packet and update tail
* on every packet
* else
* update tail and set RS bit on every packet .
* if xmit_more is false and last_xmit_more was true
* update tail and set RS bit .
*
* Optimization : wmb to be issued only in case of tail update .
* Also optimize the Descriptor WB path for RS bit with the same
* algorithm .
*
* Note : If there are less than 4 packets
* pending and interrupts were disabled the service task will
* trigger a force WB .
*/
if ( skb - > xmit_more & &
! netif_xmit_stopped ( netdev_get_tx_queue ( tx_ring - > netdev ,
tx_ring - > queue_index ) ) ) {
tx_ring - > flags | = I40E_TXR_FLAGS_LAST_XMIT_MORE_SET ;
tail_bump = false ;
} else if ( ! skb - > xmit_more & &
! netif_xmit_stopped ( netdev_get_tx_queue ( tx_ring - > netdev ,
tx_ring - > queue_index ) ) & &
( ! ( tx_ring - > flags & I40E_TXR_FLAGS_LAST_XMIT_MORE_SET ) ) & &
( tx_ring - > packet_stride < WB_STRIDE ) & &
( desc_count < WB_STRIDE ) ) {
tx_ring - > packet_stride + + ;
} else {
tx_ring - > packet_stride = 0 ;
tx_ring - > flags & = ~ I40E_TXR_FLAGS_LAST_XMIT_MORE_SET ;
do_rs = true ;
}
if ( do_rs )
tx_ring - > packet_stride = 0 ;
tx_desc - > cmd_type_offset_bsz =
build_ctob ( td_cmd , td_offset , size , td_tag ) |
cpu_to_le64 ( ( u64 ) ( do_rs ? I40E_TXD_CMD :
I40E_TX_DESC_CMD_EOP ) < <
I40E_TXD_QW1_CMD_SHIFT ) ;
2013-12-21 06:12:51 +00:00
/* notify HW of packet */
2015-10-26 19:44:29 -04:00
if ( ! tail_bump )
2015-04-27 14:57:08 -04:00
prefetchw ( tx_desc + 1 ) ;
2013-12-21 06:12:51 +00:00
2015-10-26 19:44:29 -04:00
if ( tail_bump ) {
/* Force memory writes to complete before letting h/w
* know there are new descriptors to fetch . ( Only
* applicable for weak - ordered memory model archs ,
* such as IA - 64 ) .
*/
wmb ( ) ;
writel ( i , tx_ring - > tail ) ;
}
2013-12-21 06:12:51 +00:00
return ;
dma_error :
dev_info ( tx_ring - > dev , " TX DMA map failed \n " ) ;
/* clear dma mappings for failed tx_bi map */
for ( ; ; ) {
tx_bi = & tx_ring - > tx_bi [ i ] ;
i40e_unmap_and_free_tx_resource ( tx_ring , tx_bi ) ;
if ( tx_bi = = first )
break ;
if ( i = = 0 )
i = tx_ring - > count ;
i - - ;
}
tx_ring - > next_to_use = i ;
}
/**
* i40e_xmit_frame_ring - Sends buffer on Tx ring
* @ skb : send buffer
* @ tx_ring : ring to send buffer on
*
* Returns NETDEV_TX_OK if sent , else an error code
* */
static netdev_tx_t i40e_xmit_frame_ring ( struct sk_buff * skb ,
struct i40e_ring * tx_ring )
{
u64 cd_type_cmd_tso_mss = I40E_TX_DESC_DTYPE_CONTEXT ;
u32 cd_tunneling = 0 , cd_l2tag2 = 0 ;
struct i40e_tx_buffer * first ;
u32 td_offset = 0 ;
u32 tx_flags = 0 ;
__be16 protocol ;
u32 td_cmd = 0 ;
u8 hdr_len = 0 ;
2016-02-17 11:02:43 -08:00
int tso , count ;
2015-08-28 17:55:54 -04:00
2015-10-26 19:44:30 -04:00
/* prefetch the data, we'll need it later */
prefetch ( skb - > data ) ;
2016-02-17 11:02:43 -08:00
count = i40e_xmit_descriptor_count ( skb ) ;
2016-02-17 11:02:50 -08:00
if ( i40e_chk_linearize ( skb , count ) ) {
if ( __skb_linearize ( skb ) )
goto out_drop ;
2016-02-19 12:17:08 -08:00
count = i40e_txd_use_count ( skb - > len ) ;
2016-02-17 11:02:50 -08:00
tx_ring - > tx_stats . tx_linearize + + ;
}
2016-02-17 11:02:43 -08:00
/* need: 1 descriptor per page * PAGE_SIZE/I40E_MAX_DATA_PER_TXD,
* + 1 desc for skb_head_len / I40E_MAX_DATA_PER_TXD ,
* + 4 desc gap to avoid the cache line where head is ,
* + 1 desc for context descriptor ,
* otherwise try next time
*/
if ( i40e_maybe_stop_tx ( tx_ring , count + 4 + 1 ) ) {
tx_ring - > tx_stats . tx_busy + + ;
2013-12-21 06:12:51 +00:00
return NETDEV_TX_BUSY ;
2016-02-17 11:02:43 -08:00
}
2013-12-21 06:12:51 +00:00
/* prepare the xmit flags */
2015-04-16 20:06:10 -04:00
if ( i40evf_tx_prepare_vlan_flags ( skb , tx_ring , & tx_flags ) )
2013-12-21 06:12:51 +00:00
goto out_drop ;
/* obtain protocol of skb */
2014-08-25 10:34:53 -04:00
protocol = vlan_get_protocol ( skb ) ;
2013-12-21 06:12:51 +00:00
/* record the location of the first descriptor for this packet */
first = & tx_ring - > tx_bi [ tx_ring - > next_to_use ] ;
/* setup IPv4/IPv6 offloads */
if ( protocol = = htons ( ETH_P_IP ) )
tx_flags | = I40E_TX_FLAGS_IPV4 ;
else if ( protocol = = htons ( ETH_P_IPV6 ) )
tx_flags | = I40E_TX_FLAGS_IPV6 ;
2016-04-01 03:56:05 -07:00
tso = i40e_tso ( skb , & hdr_len , & cd_type_cmd_tso_mss ) ;
2013-12-21 06:12:51 +00:00
if ( tso < 0 )
goto out_drop ;
else if ( tso )
tx_flags | = I40E_TX_FLAGS_TSO ;
/* Always offload the checksum, since it's in the data descriptor */
2016-01-24 21:17:10 -08:00
tso = i40e_tx_enable_csum ( skb , & tx_flags , & td_cmd , & td_offset ,
tx_ring , & cd_tunneling ) ;
if ( tso < 0 )
goto out_drop ;
2013-12-21 06:12:51 +00:00
2016-02-17 11:02:56 -08:00
skb_tx_timestamp ( skb ) ;
/* always enable CRC insertion offload */
td_cmd | = I40E_TX_DESC_CMD_ICRC ;
2013-12-21 06:12:51 +00:00
i40e_create_tx_ctx ( tx_ring , cd_type_cmd_tso_mss ,
cd_tunneling , cd_l2tag2 ) ;
2015-04-16 20:06:10 -04:00
i40evf_tx_map ( tx_ring , skb , first , tx_flags , hdr_len ,
td_cmd , td_offset ) ;
2013-12-21 06:12:51 +00:00
return NETDEV_TX_OK ;
out_drop :
dev_kfree_skb_any ( skb ) ;
return NETDEV_TX_OK ;
}
/**
* i40evf_xmit_frame - Selects the correct VSI and Tx queue to send buffer
* @ skb : send buffer
* @ netdev : network interface device structure
*
* Returns NETDEV_TX_OK if sent , else an error code
* */
netdev_tx_t i40evf_xmit_frame ( struct sk_buff * skb , struct net_device * netdev )
{
struct i40evf_adapter * adapter = netdev_priv ( netdev ) ;
2015-10-26 19:44:40 -04:00
struct i40e_ring * tx_ring = & adapter - > tx_rings [ skb - > queue_mapping ] ;
2013-12-21 06:12:51 +00:00
/* hardware can't handle really short frames, hardware padding works
* beyond this point
*/
if ( unlikely ( skb - > len < I40E_MIN_TX_LEN ) ) {
if ( skb_pad ( skb , I40E_MIN_TX_LEN - skb - > len ) )
return NETDEV_TX_OK ;
skb - > len = I40E_MIN_TX_LEN ;
skb_set_tail_pointer ( skb , I40E_MIN_TX_LEN ) ;
}
return i40e_xmit_frame_ring ( skb , tx_ring ) ;
}