Donate to e Foundation | Murena handsets with /e/OS | Own a part of Murena! Learn more

Commit 82dd0f7e authored by Alexander Duyck's avatar Alexander Duyck Committed by Jeff Kirsher
Browse files

fm10k: Add ethtool support 



This patch adds basic ethtool support to the device to allow for configuration.

Signed-off-by: default avatarAlexander Duyck <alexander.h.duyck@intel.com>
Signed-off-by: default avatarJeff Kirsher <jeffrey.t.kirsher@intel.com>
parent b101c962

drivers/net/ethernet/intel/fm10k/Makefile

+1 −1
Original line number Diff line number Diff line
@@ -28,5 +28,5 @@ 
obj-$(CONFIG_FM10K) += fm10k.o



fm10k-objs := fm10k_main.o fm10k_common.o fm10k_pci.o \

	      fm10k_netdev.o fm10k_pf.o \

	      fm10k_netdev.o fm10k_ethtool.o fm10k_pf.o \

	      fm10k_mbx.o fm10k_tlv.o

drivers/net/ethernet/intel/fm10k/fm10k.h

+3 −0
Original line number Diff line number Diff line
@@ -424,4 +424,7 @@ void fm10k_restore_rx_state(struct fm10k_intfc *); 
void fm10k_reset_rx_state(struct fm10k_intfc *);

int fm10k_open(struct net_device *netdev);

int fm10k_close(struct net_device *netdev);



/* Ethtool */

void fm10k_set_ethtool_ops(struct net_device *dev);

#endif /* _FM10K_H_ */

drivers/net/ethernet/intel/fm10k/fm10k_ethtool.c

0 → 100644
+868 −0
Original line number Diff line number Diff line 
/* Intel Ethernet Switch Host Interface Driver

 * Copyright(c) 2013 - 2014 Intel Corporation.

 *

 * This program is free software; you can redistribute it and/or modify it

 * under the terms and conditions of the GNU General Public License,

 * version 2, as published by the Free Software Foundation.

 *

 * This program is distributed in the hope it will be useful, but WITHOUT

 * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or

 * FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License for

 * more details.

 *

 * The full GNU General Public License is included in this distribution in

 * the file called "COPYING".

 *

 * Contact Information:

 * e1000-devel Mailing List <e1000-devel@lists.sourceforge.net>

 * Intel Corporation, 5200 N.E. Elam Young Parkway, Hillsboro, OR 97124-6497

 */



#include "fm10k.h"



struct fm10k_stats {

	char stat_string[ETH_GSTRING_LEN];

	int sizeof_stat;

	int stat_offset;

};



#define FM10K_NETDEV_STAT(_net_stat) { \

	.stat_string = #_net_stat, \

	.sizeof_stat = FIELD_SIZEOF(struct net_device_stats, _net_stat), \

	.stat_offset = offsetof(struct net_device_stats, _net_stat) \

}



static const struct fm10k_stats fm10k_gstrings_net_stats[] = {

	FM10K_NETDEV_STAT(tx_packets),

	FM10K_NETDEV_STAT(tx_bytes),

	FM10K_NETDEV_STAT(tx_errors),

	FM10K_NETDEV_STAT(rx_packets),

	FM10K_NETDEV_STAT(rx_bytes),

	FM10K_NETDEV_STAT(rx_errors),

	FM10K_NETDEV_STAT(rx_dropped),



	/* detailed Rx errors */

	FM10K_NETDEV_STAT(rx_length_errors),

	FM10K_NETDEV_STAT(rx_crc_errors),

	FM10K_NETDEV_STAT(rx_fifo_errors),

};



#define FM10K_NETDEV_STATS_LEN	ARRAY_SIZE(fm10k_gstrings_net_stats)



#define FM10K_STAT(_name, _stat) { \

	.stat_string = _name, \

	.sizeof_stat = FIELD_SIZEOF(struct fm10k_intfc, _stat), \

	.stat_offset = offsetof(struct fm10k_intfc, _stat) \

}



static const struct fm10k_stats fm10k_gstrings_stats[] = {

	FM10K_STAT("tx_restart_queue", restart_queue),

	FM10K_STAT("tx_busy", tx_busy),

	FM10K_STAT("tx_csum_errors", tx_csum_errors),

	FM10K_STAT("rx_alloc_failed", alloc_failed),

	FM10K_STAT("rx_csum_errors", rx_csum_errors),

	FM10K_STAT("rx_errors", rx_errors),



	FM10K_STAT("tx_packets_nic", tx_packets_nic),

	FM10K_STAT("tx_bytes_nic", tx_bytes_nic),

	FM10K_STAT("rx_packets_nic", rx_packets_nic),

	FM10K_STAT("rx_bytes_nic", rx_bytes_nic),

	FM10K_STAT("rx_drops_nic", rx_drops_nic),

	FM10K_STAT("rx_overrun_pf", rx_overrun_pf),

	FM10K_STAT("rx_overrun_vf", rx_overrun_vf),



	FM10K_STAT("timeout", stats.timeout.count),

	FM10K_STAT("ur", stats.ur.count),

	FM10K_STAT("ca", stats.ca.count),

	FM10K_STAT("um", stats.um.count),

	FM10K_STAT("xec", stats.xec.count),

	FM10K_STAT("vlan_drop", stats.vlan_drop.count),

	FM10K_STAT("loopback_drop", stats.loopback_drop.count),

	FM10K_STAT("nodesc_drop", stats.nodesc_drop.count),



	FM10K_STAT("swapi_status", hw.swapi.status),

	FM10K_STAT("mac_rules_used", hw.swapi.mac.used),

	FM10K_STAT("mac_rules_avail", hw.swapi.mac.avail),



	FM10K_STAT("mbx_tx_busy", hw.mbx.tx_busy),

	FM10K_STAT("mbx_tx_dropped", hw.mbx.tx_dropped),

	FM10K_STAT("mbx_tx_messages", hw.mbx.tx_messages),

	FM10K_STAT("mbx_tx_dwords", hw.mbx.tx_dwords),

	FM10K_STAT("mbx_rx_messages", hw.mbx.rx_messages),

	FM10K_STAT("mbx_rx_dwords", hw.mbx.rx_dwords),

	FM10K_STAT("mbx_rx_parse_err", hw.mbx.rx_parse_err),

};



#define FM10K_GLOBAL_STATS_LEN ARRAY_SIZE(fm10k_gstrings_stats)



#define FM10K_QUEUE_STATS_LEN \

	  (MAX_QUEUES * 2 * (sizeof(struct fm10k_queue_stats) / sizeof(u64)))



#define FM10K_STATS_LEN (FM10K_GLOBAL_STATS_LEN + \

			 FM10K_NETDEV_STATS_LEN + \

			 FM10K_QUEUE_STATS_LEN)



static void fm10k_get_strings(struct net_device *dev, u32 stringset,

			      u8 *data)

{

	char *p = (char *)data;

	int i;



	switch (stringset) {

	case ETH_SS_STATS:

		for (i = 0; i < FM10K_NETDEV_STATS_LEN; i++) {

			memcpy(p, fm10k_gstrings_net_stats[i].stat_string,

			       ETH_GSTRING_LEN);

			p += ETH_GSTRING_LEN;

		}

		for (i = 0; i < FM10K_GLOBAL_STATS_LEN; i++) {

			memcpy(p, fm10k_gstrings_stats[i].stat_string,

			       ETH_GSTRING_LEN);

			p += ETH_GSTRING_LEN;

		}



		for (i = 0; i < MAX_QUEUES; i++) {

			sprintf(p, "tx_queue_%u_packets", i);

			p += ETH_GSTRING_LEN;

			sprintf(p, "tx_queue_%u_bytes", i);

			p += ETH_GSTRING_LEN;

			sprintf(p, "rx_queue_%u_packets", i);

			p += ETH_GSTRING_LEN;

			sprintf(p, "rx_queue_%u_bytes", i);

			p += ETH_GSTRING_LEN;

		}

		break;

	}

}



static int fm10k_get_sset_count(struct net_device *dev, int sset)

{

	switch (sset) {

	case ETH_SS_STATS:

		return FM10K_STATS_LEN;

	default:

		return -EOPNOTSUPP;

	}

}



static void fm10k_get_ethtool_stats(struct net_device *netdev,

				    struct ethtool_stats *stats, u64 *data)

{

	const int stat_count = sizeof(struct fm10k_queue_stats) / sizeof(u64);

	struct fm10k_intfc *interface = netdev_priv(netdev);

	struct net_device_stats *net_stats = &netdev->stats;

	char *p;

	int i, j;



	fm10k_update_stats(interface);



	for (i = 0; i < FM10K_NETDEV_STATS_LEN; i++) {

		p = (char *)net_stats + fm10k_gstrings_net_stats[i].stat_offset;

		*(data++) = (fm10k_gstrings_net_stats[i].sizeof_stat ==

			sizeof(u64)) ? *(u64 *)p : *(u32 *)p;

	}



	for (i = 0; i < FM10K_GLOBAL_STATS_LEN; i++) {

		p = (char *)interface + fm10k_gstrings_stats[i].stat_offset;

		*(data++) = (fm10k_gstrings_stats[i].sizeof_stat ==

			sizeof(u64)) ? *(u64 *)p : *(u32 *)p;

	}



	for (i = 0; i < MAX_QUEUES; i++) {

		struct fm10k_ring *ring;

		u64 *queue_stat;



		ring = interface->tx_ring[i];

		if (ring)

			queue_stat = (u64 *)&ring->stats;

		for (j = 0; j < stat_count; j++)

			*(data++) = ring ? queue_stat[j] : 0;



		ring = interface->rx_ring[i];

		if (ring)

			queue_stat = (u64 *)&ring->stats;

		for (j = 0; j < stat_count; j++)

			*(data++) = ring ? queue_stat[j] : 0;

	}

}



/* If function below adds more registers this define needs to be updated */

#define FM10K_REGS_LEN_Q 29



static void fm10k_get_reg_q(struct fm10k_hw *hw, u32 *buff, int i)

{

	int idx = 0;



	buff[idx++] = fm10k_read_reg(hw, FM10K_RDBAL(i));

	buff[idx++] = fm10k_read_reg(hw, FM10K_RDBAH(i));

	buff[idx++] = fm10k_read_reg(hw, FM10K_RDLEN(i));

	buff[idx++] = fm10k_read_reg(hw, FM10K_TPH_RXCTRL(i));

	buff[idx++] = fm10k_read_reg(hw, FM10K_RDH(i));

	buff[idx++] = fm10k_read_reg(hw, FM10K_RDT(i));

	buff[idx++] = fm10k_read_reg(hw, FM10K_RXQCTL(i));

	buff[idx++] = fm10k_read_reg(hw, FM10K_RXDCTL(i));

	buff[idx++] = fm10k_read_reg(hw, FM10K_RXINT(i));

	buff[idx++] = fm10k_read_reg(hw, FM10K_SRRCTL(i));

	buff[idx++] = fm10k_read_reg(hw, FM10K_QPRC(i));

	buff[idx++] = fm10k_read_reg(hw, FM10K_QPRDC(i));

	buff[idx++] = fm10k_read_reg(hw, FM10K_QBRC_L(i));

	buff[idx++] = fm10k_read_reg(hw, FM10K_QBRC_H(i));

	buff[idx++] = fm10k_read_reg(hw, FM10K_TDBAL(i));

	buff[idx++] = fm10k_read_reg(hw, FM10K_TDBAH(i));

	buff[idx++] = fm10k_read_reg(hw, FM10K_TDLEN(i));

	buff[idx++] = fm10k_read_reg(hw, FM10K_TPH_TXCTRL(i));

	buff[idx++] = fm10k_read_reg(hw, FM10K_TDH(i));

	buff[idx++] = fm10k_read_reg(hw, FM10K_TDT(i));

	buff[idx++] = fm10k_read_reg(hw, FM10K_TXDCTL(i));

	buff[idx++] = fm10k_read_reg(hw, FM10K_TXQCTL(i));

	buff[idx++] = fm10k_read_reg(hw, FM10K_TXINT(i));

	buff[idx++] = fm10k_read_reg(hw, FM10K_QPTC(i));

	buff[idx++] = fm10k_read_reg(hw, FM10K_QBTC_L(i));

	buff[idx++] = fm10k_read_reg(hw, FM10K_QBTC_H(i));

	buff[idx++] = fm10k_read_reg(hw, FM10K_TQDLOC(i));

	buff[idx++] = fm10k_read_reg(hw, FM10K_TX_SGLORT(i));

	buff[idx++] = fm10k_read_reg(hw, FM10K_PFVTCTL(i));



	BUG_ON(idx != FM10K_REGS_LEN_Q);

}



/* If function above adds more registers this define needs to be updated */

#define FM10K_REGS_LEN_VSI 43



static void fm10k_get_reg_vsi(struct fm10k_hw *hw, u32 *buff, int i)

{

	int idx = 0, j;



	buff[idx++] = fm10k_read_reg(hw, FM10K_MRQC(i));

	for (j = 0; j < 10; j++)

		buff[idx++] = fm10k_read_reg(hw, FM10K_RSSRK(i, j));

	for (j = 0; j < 32; j++)

		buff[idx++] = fm10k_read_reg(hw, FM10K_RETA(i, j));



	BUG_ON(idx != FM10K_REGS_LEN_VSI);

}



static void fm10k_get_regs(struct net_device *netdev,

			   struct ethtool_regs *regs, void *p)

{

	struct fm10k_intfc *interface = netdev_priv(netdev);

	struct fm10k_hw *hw = &interface->hw;

	u32 *buff = p;

	u16 i;



	regs->version = (1 << 24) | (hw->revision_id << 16) | hw->device_id;



	switch (hw->mac.type) {

	case fm10k_mac_pf:

		/* General PF Registers */

		*(buff++) = fm10k_read_reg(hw, FM10K_CTRL);

		*(buff++) = fm10k_read_reg(hw, FM10K_CTRL_EXT);

		*(buff++) = fm10k_read_reg(hw, FM10K_GCR);

		*(buff++) = fm10k_read_reg(hw, FM10K_GCR_EXT);



		for (i = 0; i < 8; i++) {

			*(buff++) = fm10k_read_reg(hw, FM10K_DGLORTMAP(i));

			*(buff++) = fm10k_read_reg(hw, FM10K_DGLORTDEC(i));

		}



		for (i = 0; i < 65; i++) {

			fm10k_get_reg_vsi(hw, buff, i);

			buff += FM10K_REGS_LEN_VSI;

		}



		*(buff++) = fm10k_read_reg(hw, FM10K_DMA_CTRL);

		*(buff++) = fm10k_read_reg(hw, FM10K_DMA_CTRL2);



		for (i = 0; i < FM10K_MAX_QUEUES_PF; i++) {

			fm10k_get_reg_q(hw, buff, i);

			buff += FM10K_REGS_LEN_Q;

		}



		*(buff++) = fm10k_read_reg(hw, FM10K_TPH_CTRL);



		for (i = 0; i < 8; i++)

			*(buff++) = fm10k_read_reg(hw, FM10K_INT_MAP(i));



		/* Interrupt Throttling Registers */

		for (i = 0; i < 130; i++)

			*(buff++) = fm10k_read_reg(hw, FM10K_ITR(i));



		break;

	default:

		return;

	}

}



/* If function above adds more registers these define need to be updated */

#define FM10K_REGS_LEN_PF \

(162 + (65 * FM10K_REGS_LEN_VSI) + (FM10K_MAX_QUEUES_PF * FM10K_REGS_LEN_Q))



static int fm10k_get_regs_len(struct net_device *netdev)

{

	struct fm10k_intfc *interface = netdev_priv(netdev);

	struct fm10k_hw *hw = &interface->hw;



	switch (hw->mac.type) {

	case fm10k_mac_pf:

		return FM10K_REGS_LEN_PF * sizeof(u32);

	default:

		return 0;

	}

}



static void fm10k_get_drvinfo(struct net_device *dev,

			      struct ethtool_drvinfo *info)

{

	struct fm10k_intfc *interface = netdev_priv(dev);



	strncpy(info->driver, fm10k_driver_name,

		sizeof(info->driver) - 1);

	strncpy(info->version, fm10k_driver_version,

		sizeof(info->version) - 1);

	strncpy(info->bus_info, pci_name(interface->pdev),

		sizeof(info->bus_info) - 1);



	info->n_stats = FM10K_STATS_LEN;



	info->regdump_len = fm10k_get_regs_len(dev);

}



static void fm10k_get_pauseparam(struct net_device *dev,

				 struct ethtool_pauseparam *pause)

{

	struct fm10k_intfc *interface = netdev_priv(dev);



	/* record fixed values for autoneg and tx pause */

	pause->autoneg = 0;

	pause->tx_pause = 1;



	pause->rx_pause = interface->rx_pause ? 1 : 0;

}



static int fm10k_set_pauseparam(struct net_device *dev,

				struct ethtool_pauseparam *pause)

{

	struct fm10k_intfc *interface = netdev_priv(dev);

	struct fm10k_hw *hw = &interface->hw;



	if (pause->autoneg || !pause->tx_pause)

		return -EINVAL;



	/* we can only support pause on the PF to avoid head-of-line blocking */

	if (hw->mac.type == fm10k_mac_pf)

		interface->rx_pause = pause->rx_pause ? ~0 : 0;

	else if (pause->rx_pause)

		return -EINVAL;



	if (netif_running(dev))

		fm10k_update_rx_drop_en(interface);



	return 0;

}



static u32 fm10k_get_msglevel(struct net_device *netdev)

{

	struct fm10k_intfc *interface = netdev_priv(netdev);



	return interface->msg_enable;

}



static void fm10k_set_msglevel(struct net_device *netdev, u32 data)

{

	struct fm10k_intfc *interface = netdev_priv(netdev);



	interface->msg_enable = data;

}



static void fm10k_get_ringparam(struct net_device *netdev,

				struct ethtool_ringparam *ring)

{

	struct fm10k_intfc *interface = netdev_priv(netdev);



	ring->rx_max_pending = FM10K_MAX_RXD;

	ring->tx_max_pending = FM10K_MAX_TXD;

	ring->rx_mini_max_pending = 0;

	ring->rx_jumbo_max_pending = 0;

	ring->rx_pending = interface->rx_ring_count;

	ring->tx_pending = interface->tx_ring_count;

	ring->rx_mini_pending = 0;

	ring->rx_jumbo_pending = 0;

}



static int fm10k_set_ringparam(struct net_device *netdev,

			       struct ethtool_ringparam *ring)

{

	struct fm10k_intfc *interface = netdev_priv(netdev);

	struct fm10k_ring *temp_ring;

	int i, err = 0;

	u32 new_rx_count, new_tx_count;



	if ((ring->rx_mini_pending) || (ring->rx_jumbo_pending))

		return -EINVAL;



	new_tx_count = clamp_t(u32, ring->tx_pending,

			       FM10K_MIN_TXD, FM10K_MAX_TXD);

	new_tx_count = ALIGN(new_tx_count, FM10K_REQ_TX_DESCRIPTOR_MULTIPLE);



	new_rx_count = clamp_t(u32, ring->rx_pending,

			       FM10K_MIN_RXD, FM10K_MAX_RXD);

	new_rx_count = ALIGN(new_rx_count, FM10K_REQ_RX_DESCRIPTOR_MULTIPLE);



	if ((new_tx_count == interface->tx_ring_count) &&

	    (new_rx_count == interface->rx_ring_count)) {

		/* nothing to do */

		return 0;

	}



	while (test_and_set_bit(__FM10K_RESETTING, &interface->state))

		usleep_range(1000, 2000);



	if (!netif_running(interface->netdev)) {

		for (i = 0; i < interface->num_tx_queues; i++)

			interface->tx_ring[i]->count = new_tx_count;

		for (i = 0; i < interface->num_rx_queues; i++)

			interface->rx_ring[i]->count = new_rx_count;

		interface->tx_ring_count = new_tx_count;

		interface->rx_ring_count = new_rx_count;

		goto clear_reset;

	}



	/* allocate temporary buffer to store rings in */

	i = max_t(int, interface->num_tx_queues, interface->num_rx_queues);

	temp_ring = vmalloc(i * sizeof(struct fm10k_ring));



	if (!temp_ring) {

		err = -ENOMEM;

		goto clear_reset;

	}



	fm10k_down(interface);



	/* Setup new Tx resources and free the old Tx resources in that order.

	 * We can then assign the new resources to the rings via a memcpy.

	 * The advantage to this approach is that we are guaranteed to still

	 * have resources even in the case of an allocation failure.

	 */

	if (new_tx_count != interface->tx_ring_count) {

		for (i = 0; i < interface->num_tx_queues; i++) {

			memcpy(&temp_ring[i], interface->tx_ring[i],

			       sizeof(struct fm10k_ring));



			temp_ring[i].count = new_tx_count;

			err = fm10k_setup_tx_resources(&temp_ring[i]);

			if (err) {

				while (i) {

					i--;

					fm10k_free_tx_resources(&temp_ring[i]);

				}

				goto err_setup;

			}

		}



		for (i = 0; i < interface->num_tx_queues; i++) {

			fm10k_free_tx_resources(interface->tx_ring[i]);



			memcpy(interface->tx_ring[i], &temp_ring[i],

			       sizeof(struct fm10k_ring));

		}



		interface->tx_ring_count = new_tx_count;

	}



	/* Repeat the process for the Rx rings if needed */

	if (new_rx_count != interface->rx_ring_count) {

		for (i = 0; i < interface->num_rx_queues; i++) {

			memcpy(&temp_ring[i], interface->rx_ring[i],

			       sizeof(struct fm10k_ring));



			temp_ring[i].count = new_rx_count;

			err = fm10k_setup_rx_resources(&temp_ring[i]);

			if (err) {

				while (i) {

					i--;

					fm10k_free_rx_resources(&temp_ring[i]);

				}

				goto err_setup;

			}

		}



		for (i = 0; i < interface->num_rx_queues; i++) {

			fm10k_free_rx_resources(interface->rx_ring[i]);



			memcpy(interface->rx_ring[i], &temp_ring[i],

			       sizeof(struct fm10k_ring));

		}



		interface->rx_ring_count = new_rx_count;

	}



err_setup:

	fm10k_up(interface);

	vfree(temp_ring);

clear_reset:

	clear_bit(__FM10K_RESETTING, &interface->state);

	return err;

}



static int fm10k_get_coalesce(struct net_device *dev,

			      struct ethtool_coalesce *ec)

{

	struct fm10k_intfc *interface = netdev_priv(dev);



	ec->use_adaptive_tx_coalesce =

		!!(interface->tx_itr & FM10K_ITR_ADAPTIVE);

	ec->tx_coalesce_usecs = interface->tx_itr & ~FM10K_ITR_ADAPTIVE;



	ec->use_adaptive_rx_coalesce =

		!!(interface->rx_itr & FM10K_ITR_ADAPTIVE);

	ec->rx_coalesce_usecs = interface->rx_itr & ~FM10K_ITR_ADAPTIVE;



	return 0;

}



static int fm10k_set_coalesce(struct net_device *dev,

			      struct ethtool_coalesce *ec)

{

	struct fm10k_intfc *interface = netdev_priv(dev);

	struct fm10k_q_vector *qv;

	u16 tx_itr, rx_itr;

	int i;



	/* verify limits */

	if ((ec->rx_coalesce_usecs > FM10K_ITR_MAX) ||

	    (ec->tx_coalesce_usecs > FM10K_ITR_MAX))

		return -EINVAL;



	/* record settings */

	tx_itr = ec->tx_coalesce_usecs;

	rx_itr = ec->rx_coalesce_usecs;



	/* set initial values for adaptive ITR */

	if (ec->use_adaptive_tx_coalesce)

		tx_itr = FM10K_ITR_ADAPTIVE | FM10K_ITR_10K;



	if (ec->use_adaptive_rx_coalesce)

		rx_itr = FM10K_ITR_ADAPTIVE | FM10K_ITR_20K;



	/* update interface */

	interface->tx_itr = tx_itr;

	interface->rx_itr = rx_itr;



	/* update q_vectors */

	for (i = 0; i < interface->num_q_vectors; i++) {

		qv = interface->q_vector[i];

		qv->tx.itr = tx_itr;

		qv->rx.itr = rx_itr;

	}



	return 0;

}



static int fm10k_get_rss_hash_opts(struct fm10k_intfc *interface,

				   struct ethtool_rxnfc *cmd)

{

	cmd->data = 0;



	/* Report default options for RSS on fm10k */

	switch (cmd->flow_type) {

	case TCP_V4_FLOW:

	case TCP_V6_FLOW:

		cmd->data |= RXH_L4_B_0_1 | RXH_L4_B_2_3;

		/* fall through */

	case UDP_V4_FLOW:

		if (interface->flags & FM10K_FLAG_RSS_FIELD_IPV4_UDP)

			cmd->data |= RXH_L4_B_0_1 | RXH_L4_B_2_3;

		/* fall through */

	case SCTP_V4_FLOW:

	case SCTP_V6_FLOW:

	case AH_ESP_V4_FLOW:

	case AH_ESP_V6_FLOW:

	case AH_V4_FLOW:

	case AH_V6_FLOW:

	case ESP_V4_FLOW:

	case ESP_V6_FLOW:

	case IPV4_FLOW:

	case IPV6_FLOW:

		cmd->data |= RXH_IP_SRC | RXH_IP_DST;

		break;

	case UDP_V6_FLOW:

		if (interface->flags & FM10K_FLAG_RSS_FIELD_IPV6_UDP)

			cmd->data |= RXH_L4_B_0_1 | RXH_L4_B_2_3;

		cmd->data |= RXH_IP_SRC | RXH_IP_DST;

		break;

	default:

		return -EINVAL;

	}



	return 0;

}



static int fm10k_get_rxnfc(struct net_device *dev, struct ethtool_rxnfc *cmd,

			   u32 *rule_locs)

{

	struct fm10k_intfc *interface = netdev_priv(dev);

	int ret = -EOPNOTSUPP;



	switch (cmd->cmd) {

	case ETHTOOL_GRXRINGS:

		cmd->data = interface->num_rx_queues;

		ret = 0;

		break;

	case ETHTOOL_GRXFH:

		ret = fm10k_get_rss_hash_opts(interface, cmd);

		break;

	default:

		break;

	}



	return ret;

}



#define UDP_RSS_FLAGS (FM10K_FLAG_RSS_FIELD_IPV4_UDP | \

		       FM10K_FLAG_RSS_FIELD_IPV6_UDP)

static int fm10k_set_rss_hash_opt(struct fm10k_intfc *interface,

				  struct ethtool_rxnfc *nfc)

{

	u32 flags = interface->flags;



	/* RSS does not support anything other than hashing

	 * to queues on src and dst IPs and ports

	 */

	if (nfc->data & ~(RXH_IP_SRC | RXH_IP_DST |

			  RXH_L4_B_0_1 | RXH_L4_B_2_3))

		return -EINVAL;



	switch (nfc->flow_type) {

	case TCP_V4_FLOW:

	case TCP_V6_FLOW:

		if (!(nfc->data & RXH_IP_SRC) ||

		    !(nfc->data & RXH_IP_DST) ||

		    !(nfc->data & RXH_L4_B_0_1) ||

		    !(nfc->data & RXH_L4_B_2_3))

			return -EINVAL;

		break;

	case UDP_V4_FLOW:

		if (!(nfc->data & RXH_IP_SRC) ||

		    !(nfc->data & RXH_IP_DST))

			return -EINVAL;

		switch (nfc->data & (RXH_L4_B_0_1 | RXH_L4_B_2_3)) {

		case 0:

			flags &= ~FM10K_FLAG_RSS_FIELD_IPV4_UDP;

			break;

		case (RXH_L4_B_0_1 | RXH_L4_B_2_3):

			flags |= FM10K_FLAG_RSS_FIELD_IPV4_UDP;

			break;

		default:

			return -EINVAL;

		}

		break;

	case UDP_V6_FLOW:

		if (!(nfc->data & RXH_IP_SRC) ||

		    !(nfc->data & RXH_IP_DST))

			return -EINVAL;

		switch (nfc->data & (RXH_L4_B_0_1 | RXH_L4_B_2_3)) {

		case 0:

			flags &= ~FM10K_FLAG_RSS_FIELD_IPV6_UDP;

			break;

		case (RXH_L4_B_0_1 | RXH_L4_B_2_3):

			flags |= FM10K_FLAG_RSS_FIELD_IPV6_UDP;

			break;

		default:

			return -EINVAL;

		}

		break;

	case AH_ESP_V4_FLOW:

	case AH_V4_FLOW:

	case ESP_V4_FLOW:

	case SCTP_V4_FLOW:

	case AH_ESP_V6_FLOW:

	case AH_V6_FLOW:

	case ESP_V6_FLOW:

	case SCTP_V6_FLOW:

		if (!(nfc->data & RXH_IP_SRC) ||

		    !(nfc->data & RXH_IP_DST) ||

		    (nfc->data & RXH_L4_B_0_1) ||

		    (nfc->data & RXH_L4_B_2_3))

			return -EINVAL;

		break;

	default:

		return -EINVAL;

	}



	/* if we changed something we need to update flags */

	if (flags != interface->flags) {

		struct fm10k_hw *hw = &interface->hw;

		u32 mrqc;



		if ((flags & UDP_RSS_FLAGS) &&

		    !(interface->flags & UDP_RSS_FLAGS))

			netif_warn(interface, drv, interface->netdev,

				   "enabling UDP RSS: fragmented packets may arrive out of order to the stack above\n");



		interface->flags = flags;



		/* Perform hash on these packet types */

		mrqc = FM10K_MRQC_IPV4 |

		       FM10K_MRQC_TCP_IPV4 |

		       FM10K_MRQC_IPV6 |

		       FM10K_MRQC_TCP_IPV6;



		if (flags & FM10K_FLAG_RSS_FIELD_IPV4_UDP)

			mrqc |= FM10K_MRQC_UDP_IPV4;

		if (flags & FM10K_FLAG_RSS_FIELD_IPV6_UDP)

			mrqc |= FM10K_MRQC_UDP_IPV6;



		fm10k_write_reg(hw, FM10K_MRQC(0), mrqc);

	}



	return 0;

}



static int fm10k_set_rxnfc(struct net_device *dev, struct ethtool_rxnfc *cmd)

{

	struct fm10k_intfc *interface = netdev_priv(dev);

	int ret = -EOPNOTSUPP;



	switch (cmd->cmd) {

	case ETHTOOL_SRXFH:

		ret = fm10k_set_rss_hash_opt(interface, cmd);

		break;

	default:

		break;

	}



	return ret;

}



static u32 fm10k_get_reta_size(struct net_device *netdev)

{

	return FM10K_RETA_SIZE * FM10K_RETA_ENTRIES_PER_REG;

}



static int fm10k_get_reta(struct net_device *netdev, u32 *indir)

{

	struct fm10k_intfc *interface = netdev_priv(netdev);

	int i;



	if (!indir)

		return 0;



	for (i = 0; i < FM10K_RETA_SIZE; i++, indir += 4) {

		u32 reta = interface->reta[i];



		indir[0] = (reta << 24) >> 24;

		indir[1] = (reta << 16) >> 24;

		indir[2] = (reta <<  8) >> 24;

		indir[3] = (reta) >> 24;

	}



	return 0;

}



static int fm10k_set_reta(struct net_device *netdev, const u32 *indir)

{

	struct fm10k_intfc *interface = netdev_priv(netdev);

	struct fm10k_hw *hw = &interface->hw;

	int i;

	u16 rss_i;



	if (!indir)

		return 0;



	/* Verify user input. */

	rss_i = interface->ring_feature[RING_F_RSS].indices;

	for (i = fm10k_get_reta_size(netdev); i--;) {

		if (indir[i] < rss_i)

			continue;

		return -EINVAL;

	}



	/* record entries to reta table */

	for (i = 0; i < FM10K_RETA_SIZE; i++, indir += 4) {

		u32 reta = indir[0] |

			   (indir[1] << 8) |

			   (indir[2] << 16) |

			   (indir[3] << 24);



		if (interface->reta[i] == reta)

			continue;



		interface->reta[i] = reta;

		fm10k_write_reg(hw, FM10K_RETA(0, i), reta);

	}



	return 0;

}



static u32 fm10k_get_rssrk_size(struct net_device *netdev)

{

	return FM10K_RSSRK_SIZE * FM10K_RSSRK_ENTRIES_PER_REG;

}



static int fm10k_get_rssh(struct net_device *netdev, u32 *indir, u8 *key)

{

	struct fm10k_intfc *interface = netdev_priv(netdev);

	int i, err;



	err = fm10k_get_reta(netdev, indir);

	if (err || !key)

		return err;



	for (i = 0; i < FM10K_RSSRK_SIZE; i++, key += 4)

		*(__le32 *)key = cpu_to_le32(interface->rssrk[i]);



	return 0;

}



static int fm10k_set_rssh(struct net_device *netdev, const u32 *indir,

			  const u8 *key)

{

	struct fm10k_intfc *interface = netdev_priv(netdev);

	struct fm10k_hw *hw = &interface->hw;

	int i, err;



	err = fm10k_set_reta(netdev, indir);

	if (err || !key)

		return err;



	for (i = 0; i < FM10K_RSSRK_SIZE; i++, key += 4) {

		u32 rssrk = le32_to_cpu(*(__le32 *)key);



		if (interface->rssrk[i] == rssrk)

			continue;



		interface->rssrk[i] = rssrk;

		fm10k_write_reg(hw, FM10K_RSSRK(0, i), rssrk);

	}



	return 0;

}



static const struct ethtool_ops fm10k_ethtool_ops = {

	.get_strings		= fm10k_get_strings,

	.get_sset_count		= fm10k_get_sset_count,

	.get_ethtool_stats      = fm10k_get_ethtool_stats,

	.get_drvinfo		= fm10k_get_drvinfo,

	.get_link		= ethtool_op_get_link,

	.get_pauseparam		= fm10k_get_pauseparam,

	.set_pauseparam		= fm10k_set_pauseparam,

	.get_msglevel		= fm10k_get_msglevel,

	.set_msglevel		= fm10k_set_msglevel,

	.get_ringparam		= fm10k_get_ringparam,

	.set_ringparam		= fm10k_set_ringparam,

	.get_coalesce		= fm10k_get_coalesce,

	.set_coalesce		= fm10k_set_coalesce,

	.get_rxnfc		= fm10k_get_rxnfc,

	.set_rxnfc		= fm10k_set_rxnfc,

	.get_regs               = fm10k_get_regs,

	.get_regs_len           = fm10k_get_regs_len,

	.get_rxfh_indir_size	= fm10k_get_reta_size,

	.get_rxfh_key_size	= fm10k_get_rssrk_size,

	.get_rxfh		= fm10k_get_rssh,

	.set_rxfh		= fm10k_set_rssh,

};



void fm10k_set_ethtool_ops(struct net_device *dev)

{

	dev->ethtool_ops = &fm10k_ethtool_ops;

}

drivers/net/ethernet/intel/fm10k/fm10k_netdev.c

+1 −0
Original line number Diff line number Diff line
@@ -1000,6 +1000,7 @@ struct net_device *fm10k_alloc_netdev(void) 


	/* set net device and ethtool ops */

	dev->netdev_ops = &fm10k_netdev_ops;

	fm10k_set_ethtool_ops(dev);



	/* configure default debug level */

	interface = netdev_priv(dev);