Linux Audio

Check our new training course

Loading...
v3.15
 
   1/****************************************************************************
   2 * Driver for Solarflare network controllers and boards
   3 * Copyright 2005-2006 Fen Systems Ltd.
   4 * Copyright 2006-2013 Solarflare Communications Inc.
   5 *
   6 * This program is free software; you can redistribute it and/or modify it
   7 * under the terms of the GNU General Public License version 2 as published
   8 * by the Free Software Foundation, incorporated herein by reference.
   9 */
  10
  11#include <linux/netdevice.h>
  12#include <linux/ethtool.h>
  13#include <linux/rtnetlink.h>
  14#include <linux/in.h>
  15#include "net_driver.h"
  16#include "workarounds.h"
  17#include "selftest.h"
  18#include "efx.h"
 
 
 
 
  19#include "filter.h"
  20#include "nic.h"
  21
  22struct efx_sw_stat_desc {
  23	const char *name;
  24	enum {
  25		EFX_ETHTOOL_STAT_SOURCE_nic,
  26		EFX_ETHTOOL_STAT_SOURCE_channel,
  27		EFX_ETHTOOL_STAT_SOURCE_tx_queue
  28	} source;
  29	unsigned offset;
  30	u64(*get_stat) (void *field); /* Reader function */
  31};
  32
  33/* Initialiser for a struct efx_sw_stat_desc with type-checking */
  34#define EFX_ETHTOOL_STAT(stat_name, source_name, field, field_type, \
  35				get_stat_function) {			\
  36	.name = #stat_name,						\
  37	.source = EFX_ETHTOOL_STAT_SOURCE_##source_name,		\
  38	.offset = ((((field_type *) 0) ==				\
  39		      &((struct efx_##source_name *)0)->field) ?	\
  40		    offsetof(struct efx_##source_name, field) :		\
  41		    offsetof(struct efx_##source_name, field)),		\
  42	.get_stat = get_stat_function,					\
  43}
  44
  45static u64 efx_get_uint_stat(void *field)
  46{
  47	return *(unsigned int *)field;
  48}
  49
  50static u64 efx_get_atomic_stat(void *field)
  51{
  52	return atomic_read((atomic_t *) field);
  53}
  54
  55#define EFX_ETHTOOL_ATOMIC_NIC_ERROR_STAT(field)		\
  56	EFX_ETHTOOL_STAT(field, nic, field,			\
  57			 atomic_t, efx_get_atomic_stat)
  58
  59#define EFX_ETHTOOL_UINT_CHANNEL_STAT(field)			\
  60	EFX_ETHTOOL_STAT(field, channel, n_##field,		\
  61			 unsigned int, efx_get_uint_stat)
  62
  63#define EFX_ETHTOOL_UINT_TXQ_STAT(field)			\
  64	EFX_ETHTOOL_STAT(tx_##field, tx_queue, field,		\
  65			 unsigned int, efx_get_uint_stat)
  66
  67static const struct efx_sw_stat_desc efx_sw_stat_desc[] = {
  68	EFX_ETHTOOL_UINT_TXQ_STAT(merge_events),
  69	EFX_ETHTOOL_UINT_TXQ_STAT(tso_bursts),
  70	EFX_ETHTOOL_UINT_TXQ_STAT(tso_long_headers),
  71	EFX_ETHTOOL_UINT_TXQ_STAT(tso_packets),
  72	EFX_ETHTOOL_UINT_TXQ_STAT(pushes),
  73	EFX_ETHTOOL_UINT_TXQ_STAT(pio_packets),
  74	EFX_ETHTOOL_ATOMIC_NIC_ERROR_STAT(rx_reset),
  75	EFX_ETHTOOL_UINT_CHANNEL_STAT(rx_tobe_disc),
  76	EFX_ETHTOOL_UINT_CHANNEL_STAT(rx_ip_hdr_chksum_err),
  77	EFX_ETHTOOL_UINT_CHANNEL_STAT(rx_tcp_udp_chksum_err),
  78	EFX_ETHTOOL_UINT_CHANNEL_STAT(rx_mcast_mismatch),
  79	EFX_ETHTOOL_UINT_CHANNEL_STAT(rx_frm_trunc),
  80	EFX_ETHTOOL_UINT_CHANNEL_STAT(rx_nodesc_trunc),
  81	EFX_ETHTOOL_UINT_CHANNEL_STAT(rx_merge_events),
  82	EFX_ETHTOOL_UINT_CHANNEL_STAT(rx_merge_packets),
  83};
  84
  85#define EFX_ETHTOOL_SW_STAT_COUNT ARRAY_SIZE(efx_sw_stat_desc)
  86
  87#define EFX_ETHTOOL_EEPROM_MAGIC 0xEFAB
  88
  89/**************************************************************************
  90 *
  91 * Ethtool operations
  92 *
  93 **************************************************************************
  94 */
  95
  96/* Identify device by flashing LEDs */
  97static int efx_ethtool_phys_id(struct net_device *net_dev,
  98			       enum ethtool_phys_id_state state)
  99{
 100	struct efx_nic *efx = netdev_priv(net_dev);
 101	enum efx_led_mode mode = EFX_LED_DEFAULT;
 102
 103	switch (state) {
 104	case ETHTOOL_ID_ON:
 105		mode = EFX_LED_ON;
 106		break;
 107	case ETHTOOL_ID_OFF:
 108		mode = EFX_LED_OFF;
 109		break;
 110	case ETHTOOL_ID_INACTIVE:
 111		mode = EFX_LED_DEFAULT;
 112		break;
 113	case ETHTOOL_ID_ACTIVE:
 114		return 1;	/* cycle on/off once per second */
 115	}
 116
 117	efx->type->set_id_led(efx, mode);
 118	return 0;
 119}
 120
 121/* This must be called with rtnl_lock held. */
 122static int efx_ethtool_get_settings(struct net_device *net_dev,
 123				    struct ethtool_cmd *ecmd)
 124{
 125	struct efx_nic *efx = netdev_priv(net_dev);
 126	struct efx_link_state *link_state = &efx->link_state;
 127
 128	mutex_lock(&efx->mac_lock);
 129	efx->phy_op->get_settings(efx, ecmd);
 130	mutex_unlock(&efx->mac_lock);
 131
 132	/* Both MACs support pause frames (bidirectional and respond-only) */
 133	ecmd->supported |= SUPPORTED_Pause | SUPPORTED_Asym_Pause;
 134
 135	if (LOOPBACK_INTERNAL(efx)) {
 136		ethtool_cmd_speed_set(ecmd, link_state->speed);
 137		ecmd->duplex = link_state->fd ? DUPLEX_FULL : DUPLEX_HALF;
 138	}
 139
 140	return 0;
 141}
 142
 143/* This must be called with rtnl_lock held. */
 144static int efx_ethtool_set_settings(struct net_device *net_dev,
 145				    struct ethtool_cmd *ecmd)
 146{
 147	struct efx_nic *efx = netdev_priv(net_dev);
 148	int rc;
 149
 150	/* GMAC does not support 1000Mbps HD */
 151	if ((ethtool_cmd_speed(ecmd) == SPEED_1000) &&
 152	    (ecmd->duplex != DUPLEX_FULL)) {
 153		netif_dbg(efx, drv, efx->net_dev,
 154			  "rejecting unsupported 1000Mbps HD setting\n");
 155		return -EINVAL;
 156	}
 157
 158	mutex_lock(&efx->mac_lock);
 159	rc = efx->phy_op->set_settings(efx, ecmd);
 160	mutex_unlock(&efx->mac_lock);
 161	return rc;
 162}
 163
 164static void efx_ethtool_get_drvinfo(struct net_device *net_dev,
 165				    struct ethtool_drvinfo *info)
 166{
 167	struct efx_nic *efx = netdev_priv(net_dev);
 168
 169	strlcpy(info->driver, KBUILD_MODNAME, sizeof(info->driver));
 170	strlcpy(info->version, EFX_DRIVER_VERSION, sizeof(info->version));
 171	if (efx_nic_rev(efx) >= EFX_REV_SIENA_A0)
 172		efx_mcdi_print_fwver(efx, info->fw_version,
 173				     sizeof(info->fw_version));
 174	strlcpy(info->bus_info, pci_name(efx->pci_dev), sizeof(info->bus_info));
 175}
 176
 177static int efx_ethtool_get_regs_len(struct net_device *net_dev)
 178{
 179	return efx_nic_get_regs_len(netdev_priv(net_dev));
 180}
 181
 182static void efx_ethtool_get_regs(struct net_device *net_dev,
 183				 struct ethtool_regs *regs, void *buf)
 184{
 185	struct efx_nic *efx = netdev_priv(net_dev);
 186
 187	regs->version = efx->type->revision;
 188	efx_nic_get_regs(efx, buf);
 189}
 190
 191static u32 efx_ethtool_get_msglevel(struct net_device *net_dev)
 192{
 193	struct efx_nic *efx = netdev_priv(net_dev);
 194	return efx->msg_enable;
 195}
 196
 197static void efx_ethtool_set_msglevel(struct net_device *net_dev, u32 msg_enable)
 198{
 199	struct efx_nic *efx = netdev_priv(net_dev);
 200	efx->msg_enable = msg_enable;
 201}
 202
 203/**
 204 * efx_fill_test - fill in an individual self-test entry
 205 * @test_index:		Index of the test
 206 * @strings:		Ethtool strings, or %NULL
 207 * @data:		Ethtool test results, or %NULL
 208 * @test:		Pointer to test result (used only if data != %NULL)
 209 * @unit_format:	Unit name format (e.g. "chan\%d")
 210 * @unit_id:		Unit id (e.g. 0 for "chan0")
 211 * @test_format:	Test name format (e.g. "loopback.\%s.tx.sent")
 212 * @test_id:		Test id (e.g. "PHYXS" for "loopback.PHYXS.tx_sent")
 213 *
 214 * Fill in an individual self-test entry.
 215 */
 216static void efx_fill_test(unsigned int test_index, u8 *strings, u64 *data,
 217			  int *test, const char *unit_format, int unit_id,
 218			  const char *test_format, const char *test_id)
 219{
 220	char unit_str[ETH_GSTRING_LEN], test_str[ETH_GSTRING_LEN];
 221
 222	/* Fill data value, if applicable */
 223	if (data)
 224		data[test_index] = *test;
 225
 226	/* Fill string, if applicable */
 227	if (strings) {
 228		if (strchr(unit_format, '%'))
 229			snprintf(unit_str, sizeof(unit_str),
 230				 unit_format, unit_id);
 231		else
 232			strcpy(unit_str, unit_format);
 233		snprintf(test_str, sizeof(test_str), test_format, test_id);
 234		snprintf(strings + test_index * ETH_GSTRING_LEN,
 235			 ETH_GSTRING_LEN,
 236			 "%-6s %-24s", unit_str, test_str);
 237	}
 238}
 239
 240#define EFX_CHANNEL_NAME(_channel) "chan%d", _channel->channel
 241#define EFX_TX_QUEUE_NAME(_tx_queue) "txq%d", _tx_queue->queue
 242#define EFX_RX_QUEUE_NAME(_rx_queue) "rxq%d", _rx_queue->queue
 243#define EFX_LOOPBACK_NAME(_mode, _counter)			\
 244	"loopback.%s." _counter, STRING_TABLE_LOOKUP(_mode, efx_loopback_mode)
 245
 246/**
 247 * efx_fill_loopback_test - fill in a block of loopback self-test entries
 248 * @efx:		Efx NIC
 249 * @lb_tests:		Efx loopback self-test results structure
 250 * @mode:		Loopback test mode
 251 * @test_index:		Starting index of the test
 252 * @strings:		Ethtool strings, or %NULL
 253 * @data:		Ethtool test results, or %NULL
 254 *
 255 * Fill in a block of loopback self-test entries.  Return new test
 256 * index.
 257 */
 258static int efx_fill_loopback_test(struct efx_nic *efx,
 259				  struct efx_loopback_self_tests *lb_tests,
 260				  enum efx_loopback_mode mode,
 261				  unsigned int test_index,
 262				  u8 *strings, u64 *data)
 263{
 264	struct efx_channel *channel =
 265		efx_get_channel(efx, efx->tx_channel_offset);
 266	struct efx_tx_queue *tx_queue;
 267
 268	efx_for_each_channel_tx_queue(tx_queue, channel) {
 269		efx_fill_test(test_index++, strings, data,
 270			      &lb_tests->tx_sent[tx_queue->queue],
 271			      EFX_TX_QUEUE_NAME(tx_queue),
 272			      EFX_LOOPBACK_NAME(mode, "tx_sent"));
 273		efx_fill_test(test_index++, strings, data,
 274			      &lb_tests->tx_done[tx_queue->queue],
 275			      EFX_TX_QUEUE_NAME(tx_queue),
 276			      EFX_LOOPBACK_NAME(mode, "tx_done"));
 277	}
 278	efx_fill_test(test_index++, strings, data,
 279		      &lb_tests->rx_good,
 280		      "rx", 0,
 281		      EFX_LOOPBACK_NAME(mode, "rx_good"));
 282	efx_fill_test(test_index++, strings, data,
 283		      &lb_tests->rx_bad,
 284		      "rx", 0,
 285		      EFX_LOOPBACK_NAME(mode, "rx_bad"));
 286
 287	return test_index;
 288}
 289
 290/**
 291 * efx_ethtool_fill_self_tests - get self-test details
 292 * @efx:		Efx NIC
 293 * @tests:		Efx self-test results structure, or %NULL
 294 * @strings:		Ethtool strings, or %NULL
 295 * @data:		Ethtool test results, or %NULL
 296 *
 297 * Get self-test number of strings, strings, and/or test results.
 298 * Return number of strings (== number of test results).
 299 *
 300 * The reason for merging these three functions is to make sure that
 301 * they can never be inconsistent.
 302 */
 303static int efx_ethtool_fill_self_tests(struct efx_nic *efx,
 304				       struct efx_self_tests *tests,
 305				       u8 *strings, u64 *data)
 306{
 307	struct efx_channel *channel;
 308	unsigned int n = 0, i;
 309	enum efx_loopback_mode mode;
 310
 311	efx_fill_test(n++, strings, data, &tests->phy_alive,
 312		      "phy", 0, "alive", NULL);
 313	efx_fill_test(n++, strings, data, &tests->nvram,
 314		      "core", 0, "nvram", NULL);
 315	efx_fill_test(n++, strings, data, &tests->interrupt,
 316		      "core", 0, "interrupt", NULL);
 317
 318	/* Event queues */
 319	efx_for_each_channel(channel, efx) {
 320		efx_fill_test(n++, strings, data,
 321			      &tests->eventq_dma[channel->channel],
 322			      EFX_CHANNEL_NAME(channel),
 323			      "eventq.dma", NULL);
 324		efx_fill_test(n++, strings, data,
 325			      &tests->eventq_int[channel->channel],
 326			      EFX_CHANNEL_NAME(channel),
 327			      "eventq.int", NULL);
 328	}
 329
 330	efx_fill_test(n++, strings, data, &tests->memory,
 331		      "core", 0, "memory", NULL);
 332	efx_fill_test(n++, strings, data, &tests->registers,
 333		      "core", 0, "registers", NULL);
 334
 335	if (efx->phy_op->run_tests != NULL) {
 336		EFX_BUG_ON_PARANOID(efx->phy_op->test_name == NULL);
 337
 338		for (i = 0; true; ++i) {
 339			const char *name;
 340
 341			EFX_BUG_ON_PARANOID(i >= EFX_MAX_PHY_TESTS);
 342			name = efx->phy_op->test_name(efx, i);
 343			if (name == NULL)
 344				break;
 345
 346			efx_fill_test(n++, strings, data, &tests->phy_ext[i],
 347				      "phy", 0, name, NULL);
 348		}
 349	}
 350
 351	/* Loopback tests */
 352	for (mode = LOOPBACK_NONE; mode <= LOOPBACK_TEST_MAX; mode++) {
 353		if (!(efx->loopback_modes & (1 << mode)))
 354			continue;
 355		n = efx_fill_loopback_test(efx,
 356					   &tests->loopback[mode], mode, n,
 357					   strings, data);
 358	}
 359
 360	return n;
 361}
 362
 363static int efx_ethtool_get_sset_count(struct net_device *net_dev,
 364				      int string_set)
 365{
 366	struct efx_nic *efx = netdev_priv(net_dev);
 367
 368	switch (string_set) {
 369	case ETH_SS_STATS:
 370		return efx->type->describe_stats(efx, NULL) +
 371			EFX_ETHTOOL_SW_STAT_COUNT +
 372			efx_ptp_describe_stats(efx, NULL);
 373	case ETH_SS_TEST:
 374		return efx_ethtool_fill_self_tests(efx, NULL, NULL, NULL);
 375	default:
 376		return -EINVAL;
 377	}
 378}
 379
 380static void efx_ethtool_get_strings(struct net_device *net_dev,
 381				    u32 string_set, u8 *strings)
 382{
 383	struct efx_nic *efx = netdev_priv(net_dev);
 384	int i;
 385
 386	switch (string_set) {
 387	case ETH_SS_STATS:
 388		strings += (efx->type->describe_stats(efx, strings) *
 389			    ETH_GSTRING_LEN);
 390		for (i = 0; i < EFX_ETHTOOL_SW_STAT_COUNT; i++)
 391			strlcpy(strings + i * ETH_GSTRING_LEN,
 392				efx_sw_stat_desc[i].name, ETH_GSTRING_LEN);
 393		strings += EFX_ETHTOOL_SW_STAT_COUNT * ETH_GSTRING_LEN;
 394		efx_ptp_describe_stats(efx, strings);
 395		break;
 396	case ETH_SS_TEST:
 397		efx_ethtool_fill_self_tests(efx, NULL, strings, NULL);
 398		break;
 399	default:
 400		/* No other string sets */
 401		break;
 402	}
 403}
 404
 405static void efx_ethtool_get_stats(struct net_device *net_dev,
 406				  struct ethtool_stats *stats,
 407				  u64 *data)
 408{
 409	struct efx_nic *efx = netdev_priv(net_dev);
 410	const struct efx_sw_stat_desc *stat;
 411	struct efx_channel *channel;
 412	struct efx_tx_queue *tx_queue;
 413	int i;
 414
 415	spin_lock_bh(&efx->stats_lock);
 416
 417	/* Get NIC statistics */
 418	data += efx->type->update_stats(efx, data, NULL);
 419
 420	/* Get software statistics */
 421	for (i = 0; i < EFX_ETHTOOL_SW_STAT_COUNT; i++) {
 422		stat = &efx_sw_stat_desc[i];
 423		switch (stat->source) {
 424		case EFX_ETHTOOL_STAT_SOURCE_nic:
 425			data[i] = stat->get_stat((void *)efx + stat->offset);
 426			break;
 427		case EFX_ETHTOOL_STAT_SOURCE_channel:
 428			data[i] = 0;
 429			efx_for_each_channel(channel, efx)
 430				data[i] += stat->get_stat((void *)channel +
 431							  stat->offset);
 432			break;
 433		case EFX_ETHTOOL_STAT_SOURCE_tx_queue:
 434			data[i] = 0;
 435			efx_for_each_channel(channel, efx) {
 436				efx_for_each_channel_tx_queue(tx_queue, channel)
 437					data[i] +=
 438						stat->get_stat((void *)tx_queue
 439							       + stat->offset);
 440			}
 441			break;
 442		}
 443	}
 444	data += EFX_ETHTOOL_SW_STAT_COUNT;
 445
 446	spin_unlock_bh(&efx->stats_lock);
 447
 448	efx_ptp_update_stats(efx, data);
 449}
 450
 451static void efx_ethtool_self_test(struct net_device *net_dev,
 452				  struct ethtool_test *test, u64 *data)
 453{
 454	struct efx_nic *efx = netdev_priv(net_dev);
 455	struct efx_self_tests *efx_tests;
 456	bool already_up;
 457	int rc = -ENOMEM;
 458
 459	efx_tests = kzalloc(sizeof(*efx_tests), GFP_KERNEL);
 460	if (!efx_tests)
 461		goto fail;
 462
 463	if (efx->state != STATE_READY) {
 464		rc = -EBUSY;
 465		goto out;
 466	}
 467
 468	netif_info(efx, drv, efx->net_dev, "starting %sline testing\n",
 469		   (test->flags & ETH_TEST_FL_OFFLINE) ? "off" : "on");
 470
 471	/* We need rx buffers and interrupts. */
 472	already_up = (efx->net_dev->flags & IFF_UP);
 473	if (!already_up) {
 474		rc = dev_open(efx->net_dev);
 475		if (rc) {
 476			netif_err(efx, drv, efx->net_dev,
 477				  "failed opening device.\n");
 478			goto out;
 479		}
 480	}
 481
 482	rc = efx_selftest(efx, efx_tests, test->flags);
 483
 484	if (!already_up)
 485		dev_close(efx->net_dev);
 486
 487	netif_info(efx, drv, efx->net_dev, "%s %sline self-tests\n",
 488		   rc == 0 ? "passed" : "failed",
 489		   (test->flags & ETH_TEST_FL_OFFLINE) ? "off" : "on");
 490
 491out:
 492	efx_ethtool_fill_self_tests(efx, efx_tests, NULL, data);
 493	kfree(efx_tests);
 494fail:
 495	if (rc)
 496		test->flags |= ETH_TEST_FL_FAILED;
 497}
 498
 499/* Restart autonegotiation */
 500static int efx_ethtool_nway_reset(struct net_device *net_dev)
 501{
 502	struct efx_nic *efx = netdev_priv(net_dev);
 503
 504	return mdio45_nway_restart(&efx->mdio);
 505}
 506
 507/*
 508 * Each channel has a single IRQ and moderation timer, started by any
 509 * completion (or other event).  Unless the module parameter
 510 * separate_tx_channels is set, IRQs and moderation are therefore
 511 * shared between RX and TX completions.  In this case, when RX IRQ
 512 * moderation is explicitly changed then TX IRQ moderation is
 513 * automatically changed too, but otherwise we fail if the two values
 514 * are requested to be different.
 515 *
 516 * The hardware does not support a limit on the number of completions
 517 * before an IRQ, so we do not use the max_frames fields.  We should
 518 * report and require that max_frames == (usecs != 0), but this would
 519 * invalidate existing user documentation.
 520 *
 521 * The hardware does not have distinct settings for interrupt
 522 * moderation while the previous IRQ is being handled, so we should
 523 * not use the 'irq' fields.  However, an earlier developer
 524 * misunderstood the meaning of the 'irq' fields and the driver did
 525 * not support the standard fields.  To avoid invalidating existing
 526 * user documentation, we report and accept changes through either the
 527 * standard or 'irq' fields.  If both are changed at the same time, we
 528 * prefer the standard field.
 529 *
 530 * We implement adaptive IRQ moderation, but use a different algorithm
 531 * from that assumed in the definition of struct ethtool_coalesce.
 532 * Therefore we do not use any of the adaptive moderation parameters
 533 * in it.
 534 */
 535
 536static int efx_ethtool_get_coalesce(struct net_device *net_dev,
 537				    struct ethtool_coalesce *coalesce)
 
 
 538{
 539	struct efx_nic *efx = netdev_priv(net_dev);
 540	unsigned int tx_usecs, rx_usecs;
 541	bool rx_adaptive;
 542
 543	efx_get_irq_moderation(efx, &tx_usecs, &rx_usecs, &rx_adaptive);
 544
 545	coalesce->tx_coalesce_usecs = tx_usecs;
 546	coalesce->tx_coalesce_usecs_irq = tx_usecs;
 547	coalesce->rx_coalesce_usecs = rx_usecs;
 548	coalesce->rx_coalesce_usecs_irq = rx_usecs;
 549	coalesce->use_adaptive_rx_coalesce = rx_adaptive;
 550
 551	return 0;
 552}
 553
 554static int efx_ethtool_set_coalesce(struct net_device *net_dev,
 555				    struct ethtool_coalesce *coalesce)
 
 
 556{
 557	struct efx_nic *efx = netdev_priv(net_dev);
 558	struct efx_channel *channel;
 559	unsigned int tx_usecs, rx_usecs;
 560	bool adaptive, rx_may_override_tx;
 561	int rc;
 562
 563	if (coalesce->use_adaptive_tx_coalesce)
 564		return -EINVAL;
 565
 566	efx_get_irq_moderation(efx, &tx_usecs, &rx_usecs, &adaptive);
 567
 568	if (coalesce->rx_coalesce_usecs != rx_usecs)
 569		rx_usecs = coalesce->rx_coalesce_usecs;
 570	else
 571		rx_usecs = coalesce->rx_coalesce_usecs_irq;
 572
 573	adaptive = coalesce->use_adaptive_rx_coalesce;
 574
 575	/* If channels are shared, TX IRQ moderation can be quietly
 576	 * overridden unless it is changed from its old value.
 577	 */
 578	rx_may_override_tx = (coalesce->tx_coalesce_usecs == tx_usecs &&
 579			      coalesce->tx_coalesce_usecs_irq == tx_usecs);
 580	if (coalesce->tx_coalesce_usecs != tx_usecs)
 581		tx_usecs = coalesce->tx_coalesce_usecs;
 582	else
 583		tx_usecs = coalesce->tx_coalesce_usecs_irq;
 584
 585	rc = efx_init_irq_moderation(efx, tx_usecs, rx_usecs, adaptive,
 586				     rx_may_override_tx);
 587	if (rc != 0)
 588		return rc;
 589
 590	efx_for_each_channel(channel, efx)
 591		efx->type->push_irq_moderation(channel);
 592
 593	return 0;
 594}
 595
 596static void efx_ethtool_get_ringparam(struct net_device *net_dev,
 597				      struct ethtool_ringparam *ring)
 
 
 
 598{
 599	struct efx_nic *efx = netdev_priv(net_dev);
 600
 601	ring->rx_max_pending = EFX_MAX_DMAQ_SIZE;
 602	ring->tx_max_pending = EFX_TXQ_MAX_ENT(efx);
 603	ring->rx_pending = efx->rxq_entries;
 604	ring->tx_pending = efx->txq_entries;
 605}
 606
 607static int efx_ethtool_set_ringparam(struct net_device *net_dev,
 608				     struct ethtool_ringparam *ring)
 
 
 
 609{
 610	struct efx_nic *efx = netdev_priv(net_dev);
 611	u32 txq_entries;
 612
 613	if (ring->rx_mini_pending || ring->rx_jumbo_pending ||
 614	    ring->rx_pending > EFX_MAX_DMAQ_SIZE ||
 615	    ring->tx_pending > EFX_TXQ_MAX_ENT(efx))
 616		return -EINVAL;
 617
 618	if (ring->rx_pending < EFX_RXQ_MIN_ENT) {
 619		netif_err(efx, drv, efx->net_dev,
 620			  "RX queues cannot be smaller than %u\n",
 621			  EFX_RXQ_MIN_ENT);
 622		return -EINVAL;
 623	}
 624
 625	txq_entries = max(ring->tx_pending, EFX_TXQ_MIN_ENT(efx));
 626	if (txq_entries != ring->tx_pending)
 627		netif_warn(efx, drv, efx->net_dev,
 628			   "increasing TX queue size to minimum of %u\n",
 629			   txq_entries);
 630
 631	return efx_realloc_channels(efx, ring->rx_pending, txq_entries);
 632}
 633
 634static int efx_ethtool_set_pauseparam(struct net_device *net_dev,
 635				      struct ethtool_pauseparam *pause)
 636{
 637	struct efx_nic *efx = netdev_priv(net_dev);
 638	u8 wanted_fc, old_fc;
 639	u32 old_adv;
 640	int rc = 0;
 641
 642	mutex_lock(&efx->mac_lock);
 643
 644	wanted_fc = ((pause->rx_pause ? EFX_FC_RX : 0) |
 645		     (pause->tx_pause ? EFX_FC_TX : 0) |
 646		     (pause->autoneg ? EFX_FC_AUTO : 0));
 647
 648	if ((wanted_fc & EFX_FC_TX) && !(wanted_fc & EFX_FC_RX)) {
 649		netif_dbg(efx, drv, efx->net_dev,
 650			  "Flow control unsupported: tx ON rx OFF\n");
 651		rc = -EINVAL;
 652		goto out;
 653	}
 654
 655	if ((wanted_fc & EFX_FC_AUTO) && !efx->link_advertising) {
 656		netif_dbg(efx, drv, efx->net_dev,
 657			  "Autonegotiation is disabled\n");
 658		rc = -EINVAL;
 659		goto out;
 660	}
 661
 662	/* Hook for Falcon bug 11482 workaround */
 663	if (efx->type->prepare_enable_fc_tx &&
 664	    (wanted_fc & EFX_FC_TX) && !(efx->wanted_fc & EFX_FC_TX))
 665		efx->type->prepare_enable_fc_tx(efx);
 666
 667	old_adv = efx->link_advertising;
 668	old_fc = efx->wanted_fc;
 669	efx_link_set_wanted_fc(efx, wanted_fc);
 670	if (efx->link_advertising != old_adv ||
 671	    (efx->wanted_fc ^ old_fc) & EFX_FC_AUTO) {
 672		rc = efx->phy_op->reconfigure(efx);
 673		if (rc) {
 674			netif_err(efx, drv, efx->net_dev,
 675				  "Unable to advertise requested flow "
 676				  "control setting\n");
 677			goto out;
 678		}
 679	}
 680
 681	/* Reconfigure the MAC. The PHY *may* generate a link state change event
 682	 * if the user just changed the advertised capabilities, but there's no
 683	 * harm doing this twice */
 684	efx->type->reconfigure_mac(efx);
 685
 686out:
 687	mutex_unlock(&efx->mac_lock);
 688
 689	return rc;
 690}
 691
 692static void efx_ethtool_get_pauseparam(struct net_device *net_dev,
 693				       struct ethtool_pauseparam *pause)
 694{
 695	struct efx_nic *efx = netdev_priv(net_dev);
 696
 697	pause->rx_pause = !!(efx->wanted_fc & EFX_FC_RX);
 698	pause->tx_pause = !!(efx->wanted_fc & EFX_FC_TX);
 699	pause->autoneg = !!(efx->wanted_fc & EFX_FC_AUTO);
 700}
 701
 702static void efx_ethtool_get_wol(struct net_device *net_dev,
 703				struct ethtool_wolinfo *wol)
 704{
 705	struct efx_nic *efx = netdev_priv(net_dev);
 706	return efx->type->get_wol(efx, wol);
 707}
 708
 709
 710static int efx_ethtool_set_wol(struct net_device *net_dev,
 711			       struct ethtool_wolinfo *wol)
 712{
 713	struct efx_nic *efx = netdev_priv(net_dev);
 714	return efx->type->set_wol(efx, wol->wolopts);
 715}
 716
 717static int efx_ethtool_reset(struct net_device *net_dev, u32 *flags)
 718{
 719	struct efx_nic *efx = netdev_priv(net_dev);
 720	int rc;
 721
 722	rc = efx->type->map_reset_flags(flags);
 723	if (rc < 0)
 724		return rc;
 725
 726	return efx_reset(efx, rc);
 727}
 728
 729/* MAC address mask including only I/G bit */
 730static const u8 mac_addr_ig_mask[ETH_ALEN] __aligned(2) = {0x01, 0, 0, 0, 0, 0};
 731
 732#define IP4_ADDR_FULL_MASK	((__force __be32)~0)
 733#define PORT_FULL_MASK		((__force __be16)~0)
 734#define ETHER_TYPE_FULL_MASK	((__force __be16)~0)
 735
 736static int efx_ethtool_get_class_rule(struct efx_nic *efx,
 737				      struct ethtool_rx_flow_spec *rule)
 738{
 739	struct ethtool_tcpip4_spec *ip_entry = &rule->h_u.tcp_ip4_spec;
 740	struct ethtool_tcpip4_spec *ip_mask = &rule->m_u.tcp_ip4_spec;
 741	struct ethhdr *mac_entry = &rule->h_u.ether_spec;
 742	struct ethhdr *mac_mask = &rule->m_u.ether_spec;
 743	struct efx_filter_spec spec;
 744	int rc;
 745
 746	rc = efx_filter_get_filter_safe(efx, EFX_FILTER_PRI_MANUAL,
 747					rule->location, &spec);
 748	if (rc)
 749		return rc;
 750
 751	if (spec.dmaq_id == EFX_FILTER_RX_DMAQ_ID_DROP)
 752		rule->ring_cookie = RX_CLS_FLOW_DISC;
 753	else
 754		rule->ring_cookie = spec.dmaq_id;
 755
 756	if ((spec.match_flags & EFX_FILTER_MATCH_ETHER_TYPE) &&
 757	    spec.ether_type == htons(ETH_P_IP) &&
 758	    (spec.match_flags & EFX_FILTER_MATCH_IP_PROTO) &&
 759	    (spec.ip_proto == IPPROTO_TCP || spec.ip_proto == IPPROTO_UDP) &&
 760	    !(spec.match_flags &
 761	      ~(EFX_FILTER_MATCH_ETHER_TYPE | EFX_FILTER_MATCH_OUTER_VID |
 762		EFX_FILTER_MATCH_LOC_HOST | EFX_FILTER_MATCH_REM_HOST |
 763		EFX_FILTER_MATCH_IP_PROTO |
 764		EFX_FILTER_MATCH_LOC_PORT | EFX_FILTER_MATCH_REM_PORT))) {
 765		rule->flow_type = ((spec.ip_proto == IPPROTO_TCP) ?
 766				   TCP_V4_FLOW : UDP_V4_FLOW);
 767		if (spec.match_flags & EFX_FILTER_MATCH_LOC_HOST) {
 768			ip_entry->ip4dst = spec.loc_host[0];
 769			ip_mask->ip4dst = IP4_ADDR_FULL_MASK;
 770		}
 771		if (spec.match_flags & EFX_FILTER_MATCH_REM_HOST) {
 772			ip_entry->ip4src = spec.rem_host[0];
 773			ip_mask->ip4src = IP4_ADDR_FULL_MASK;
 774		}
 775		if (spec.match_flags & EFX_FILTER_MATCH_LOC_PORT) {
 776			ip_entry->pdst = spec.loc_port;
 777			ip_mask->pdst = PORT_FULL_MASK;
 778		}
 779		if (spec.match_flags & EFX_FILTER_MATCH_REM_PORT) {
 780			ip_entry->psrc = spec.rem_port;
 781			ip_mask->psrc = PORT_FULL_MASK;
 782		}
 783	} else if (!(spec.match_flags &
 784		     ~(EFX_FILTER_MATCH_LOC_MAC | EFX_FILTER_MATCH_LOC_MAC_IG |
 785		       EFX_FILTER_MATCH_REM_MAC | EFX_FILTER_MATCH_ETHER_TYPE |
 786		       EFX_FILTER_MATCH_OUTER_VID))) {
 787		rule->flow_type = ETHER_FLOW;
 788		if (spec.match_flags &
 789		    (EFX_FILTER_MATCH_LOC_MAC | EFX_FILTER_MATCH_LOC_MAC_IG)) {
 790			ether_addr_copy(mac_entry->h_dest, spec.loc_mac);
 791			if (spec.match_flags & EFX_FILTER_MATCH_LOC_MAC)
 792				eth_broadcast_addr(mac_mask->h_dest);
 793			else
 794				ether_addr_copy(mac_mask->h_dest,
 795						mac_addr_ig_mask);
 796		}
 797		if (spec.match_flags & EFX_FILTER_MATCH_REM_MAC) {
 798			ether_addr_copy(mac_entry->h_source, spec.rem_mac);
 799			eth_broadcast_addr(mac_mask->h_source);
 800		}
 801		if (spec.match_flags & EFX_FILTER_MATCH_ETHER_TYPE) {
 802			mac_entry->h_proto = spec.ether_type;
 803			mac_mask->h_proto = ETHER_TYPE_FULL_MASK;
 804		}
 805	} else {
 806		/* The above should handle all filters that we insert */
 807		WARN_ON(1);
 808		return -EINVAL;
 809	}
 810
 811	if (spec.match_flags & EFX_FILTER_MATCH_OUTER_VID) {
 812		rule->flow_type |= FLOW_EXT;
 813		rule->h_ext.vlan_tci = spec.outer_vid;
 814		rule->m_ext.vlan_tci = htons(0xfff);
 815	}
 816
 817	return rc;
 818}
 819
 820static int
 821efx_ethtool_get_rxnfc(struct net_device *net_dev,
 822		      struct ethtool_rxnfc *info, u32 *rule_locs)
 823{
 824	struct efx_nic *efx = netdev_priv(net_dev);
 825
 826	switch (info->cmd) {
 827	case ETHTOOL_GRXRINGS:
 828		info->data = efx->n_rx_channels;
 829		return 0;
 830
 831	case ETHTOOL_GRXFH: {
 832		unsigned min_revision = 0;
 833
 834		info->data = 0;
 835		switch (info->flow_type) {
 836		case TCP_V4_FLOW:
 837			info->data |= RXH_L4_B_0_1 | RXH_L4_B_2_3;
 838			/* fall through */
 839		case UDP_V4_FLOW:
 840		case SCTP_V4_FLOW:
 841		case AH_ESP_V4_FLOW:
 842		case IPV4_FLOW:
 843			info->data |= RXH_IP_SRC | RXH_IP_DST;
 844			min_revision = EFX_REV_FALCON_B0;
 845			break;
 846		case TCP_V6_FLOW:
 847			info->data |= RXH_L4_B_0_1 | RXH_L4_B_2_3;
 848			/* fall through */
 849		case UDP_V6_FLOW:
 850		case SCTP_V6_FLOW:
 851		case AH_ESP_V6_FLOW:
 852		case IPV6_FLOW:
 853			info->data |= RXH_IP_SRC | RXH_IP_DST;
 854			min_revision = EFX_REV_SIENA_A0;
 855			break;
 856		default:
 857			break;
 858		}
 859		if (efx_nic_rev(efx) < min_revision)
 860			info->data = 0;
 861		return 0;
 862	}
 863
 864	case ETHTOOL_GRXCLSRLCNT:
 865		info->data = efx_filter_get_rx_id_limit(efx);
 866		if (info->data == 0)
 867			return -EOPNOTSUPP;
 868		info->data |= RX_CLS_LOC_SPECIAL;
 869		info->rule_cnt =
 870			efx_filter_count_rx_used(efx, EFX_FILTER_PRI_MANUAL);
 871		return 0;
 872
 873	case ETHTOOL_GRXCLSRULE:
 874		if (efx_filter_get_rx_id_limit(efx) == 0)
 875			return -EOPNOTSUPP;
 876		return efx_ethtool_get_class_rule(efx, &info->fs);
 877
 878	case ETHTOOL_GRXCLSRLALL: {
 879		s32 rc;
 880		info->data = efx_filter_get_rx_id_limit(efx);
 881		if (info->data == 0)
 882			return -EOPNOTSUPP;
 883		rc = efx_filter_get_rx_ids(efx, EFX_FILTER_PRI_MANUAL,
 884					   rule_locs, info->rule_cnt);
 885		if (rc < 0)
 886			return rc;
 887		info->rule_cnt = rc;
 888		return 0;
 889	}
 890
 891	default:
 892		return -EOPNOTSUPP;
 893	}
 894}
 895
 896static int efx_ethtool_set_class_rule(struct efx_nic *efx,
 897				      struct ethtool_rx_flow_spec *rule)
 898{
 899	struct ethtool_tcpip4_spec *ip_entry = &rule->h_u.tcp_ip4_spec;
 900	struct ethtool_tcpip4_spec *ip_mask = &rule->m_u.tcp_ip4_spec;
 901	struct ethhdr *mac_entry = &rule->h_u.ether_spec;
 902	struct ethhdr *mac_mask = &rule->m_u.ether_spec;
 903	struct efx_filter_spec spec;
 904	int rc;
 905
 906	/* Check that user wants us to choose the location */
 907	if (rule->location != RX_CLS_LOC_ANY)
 908		return -EINVAL;
 909
 910	/* Range-check ring_cookie */
 911	if (rule->ring_cookie >= efx->n_rx_channels &&
 912	    rule->ring_cookie != RX_CLS_FLOW_DISC)
 913		return -EINVAL;
 914
 915	/* Check for unsupported extensions */
 916	if ((rule->flow_type & FLOW_EXT) &&
 917	    (rule->m_ext.vlan_etype || rule->m_ext.data[0] ||
 918	     rule->m_ext.data[1]))
 919		return -EINVAL;
 920
 921	efx_filter_init_rx(&spec, EFX_FILTER_PRI_MANUAL,
 922			   efx->rx_scatter ? EFX_FILTER_FLAG_RX_SCATTER : 0,
 923			   (rule->ring_cookie == RX_CLS_FLOW_DISC) ?
 924			   EFX_FILTER_RX_DMAQ_ID_DROP : rule->ring_cookie);
 925
 926	switch (rule->flow_type & ~FLOW_EXT) {
 927	case TCP_V4_FLOW:
 928	case UDP_V4_FLOW:
 929		spec.match_flags = (EFX_FILTER_MATCH_ETHER_TYPE |
 930				    EFX_FILTER_MATCH_IP_PROTO);
 931		spec.ether_type = htons(ETH_P_IP);
 932		spec.ip_proto = ((rule->flow_type & ~FLOW_EXT) == TCP_V4_FLOW ?
 933				 IPPROTO_TCP : IPPROTO_UDP);
 934		if (ip_mask->ip4dst) {
 935			if (ip_mask->ip4dst != IP4_ADDR_FULL_MASK)
 936				return -EINVAL;
 937			spec.match_flags |= EFX_FILTER_MATCH_LOC_HOST;
 938			spec.loc_host[0] = ip_entry->ip4dst;
 939		}
 940		if (ip_mask->ip4src) {
 941			if (ip_mask->ip4src != IP4_ADDR_FULL_MASK)
 942				return -EINVAL;
 943			spec.match_flags |= EFX_FILTER_MATCH_REM_HOST;
 944			spec.rem_host[0] = ip_entry->ip4src;
 945		}
 946		if (ip_mask->pdst) {
 947			if (ip_mask->pdst != PORT_FULL_MASK)
 948				return -EINVAL;
 949			spec.match_flags |= EFX_FILTER_MATCH_LOC_PORT;
 950			spec.loc_port = ip_entry->pdst;
 951		}
 952		if (ip_mask->psrc) {
 953			if (ip_mask->psrc != PORT_FULL_MASK)
 954				return -EINVAL;
 955			spec.match_flags |= EFX_FILTER_MATCH_REM_PORT;
 956			spec.rem_port = ip_entry->psrc;
 957		}
 958		if (ip_mask->tos)
 959			return -EINVAL;
 960		break;
 961
 962	case ETHER_FLOW:
 963		if (!is_zero_ether_addr(mac_mask->h_dest)) {
 964			if (ether_addr_equal(mac_mask->h_dest,
 965					     mac_addr_ig_mask))
 966				spec.match_flags |= EFX_FILTER_MATCH_LOC_MAC_IG;
 967			else if (is_broadcast_ether_addr(mac_mask->h_dest))
 968				spec.match_flags |= EFX_FILTER_MATCH_LOC_MAC;
 969			else
 970				return -EINVAL;
 971			ether_addr_copy(spec.loc_mac, mac_entry->h_dest);
 972		}
 973		if (!is_zero_ether_addr(mac_mask->h_source)) {
 974			if (!is_broadcast_ether_addr(mac_mask->h_source))
 975				return -EINVAL;
 976			spec.match_flags |= EFX_FILTER_MATCH_REM_MAC;
 977			ether_addr_copy(spec.rem_mac, mac_entry->h_source);
 978		}
 979		if (mac_mask->h_proto) {
 980			if (mac_mask->h_proto != ETHER_TYPE_FULL_MASK)
 981				return -EINVAL;
 982			spec.match_flags |= EFX_FILTER_MATCH_ETHER_TYPE;
 983			spec.ether_type = mac_entry->h_proto;
 984		}
 985		break;
 986
 987	default:
 988		return -EINVAL;
 989	}
 990
 991	if ((rule->flow_type & FLOW_EXT) && rule->m_ext.vlan_tci) {
 992		if (rule->m_ext.vlan_tci != htons(0xfff))
 993			return -EINVAL;
 994		spec.match_flags |= EFX_FILTER_MATCH_OUTER_VID;
 995		spec.outer_vid = rule->h_ext.vlan_tci;
 996	}
 997
 998	rc = efx_filter_insert_filter(efx, &spec, true);
 999	if (rc < 0)
1000		return rc;
1001
1002	rule->location = rc;
1003	return 0;
1004}
1005
1006static int efx_ethtool_set_rxnfc(struct net_device *net_dev,
1007				 struct ethtool_rxnfc *info)
1008{
1009	struct efx_nic *efx = netdev_priv(net_dev);
1010
1011	if (efx_filter_get_rx_id_limit(efx) == 0)
1012		return -EOPNOTSUPP;
1013
1014	switch (info->cmd) {
1015	case ETHTOOL_SRXCLSRLINS:
1016		return efx_ethtool_set_class_rule(efx, &info->fs);
1017
1018	case ETHTOOL_SRXCLSRLDEL:
1019		return efx_filter_remove_id_safe(efx, EFX_FILTER_PRI_MANUAL,
1020						 info->fs.location);
1021
1022	default:
1023		return -EOPNOTSUPP;
1024	}
1025}
1026
1027static u32 efx_ethtool_get_rxfh_indir_size(struct net_device *net_dev)
1028{
1029	struct efx_nic *efx = netdev_priv(net_dev);
1030
1031	return ((efx_nic_rev(efx) < EFX_REV_FALCON_B0 ||
1032		 efx->n_rx_channels == 1) ?
1033		0 : ARRAY_SIZE(efx->rx_indir_table));
1034}
1035
1036static int efx_ethtool_get_rxfh_indir(struct net_device *net_dev, u32 *indir)
1037{
1038	struct efx_nic *efx = netdev_priv(net_dev);
1039
1040	memcpy(indir, efx->rx_indir_table, sizeof(efx->rx_indir_table));
1041	return 0;
1042}
1043
1044static int efx_ethtool_set_rxfh_indir(struct net_device *net_dev,
1045				      const u32 *indir)
1046{
1047	struct efx_nic *efx = netdev_priv(net_dev);
1048
1049	memcpy(efx->rx_indir_table, indir, sizeof(efx->rx_indir_table));
1050	efx->type->rx_push_rss_config(efx);
1051	return 0;
1052}
1053
1054static int efx_ethtool_get_ts_info(struct net_device *net_dev,
1055				   struct ethtool_ts_info *ts_info)
1056{
1057	struct efx_nic *efx = netdev_priv(net_dev);
1058
1059	/* Software capabilities */
1060	ts_info->so_timestamping = (SOF_TIMESTAMPING_RX_SOFTWARE |
1061				    SOF_TIMESTAMPING_SOFTWARE);
1062	ts_info->phc_index = -1;
1063
1064	efx_ptp_get_ts_info(efx, ts_info);
1065	return 0;
1066}
1067
1068static int efx_ethtool_get_module_eeprom(struct net_device *net_dev,
1069					 struct ethtool_eeprom *ee,
1070					 u8 *data)
1071{
1072	struct efx_nic *efx = netdev_priv(net_dev);
1073	int ret;
1074
1075	if (!efx->phy_op || !efx->phy_op->get_module_eeprom)
1076		return -EOPNOTSUPP;
1077
1078	mutex_lock(&efx->mac_lock);
1079	ret = efx->phy_op->get_module_eeprom(efx, ee, data);
1080	mutex_unlock(&efx->mac_lock);
1081
1082	return ret;
1083}
1084
1085static int efx_ethtool_get_module_info(struct net_device *net_dev,
1086				       struct ethtool_modinfo *modinfo)
1087{
1088	struct efx_nic *efx = netdev_priv(net_dev);
1089	int ret;
1090
1091	if (!efx->phy_op || !efx->phy_op->get_module_info)
1092		return -EOPNOTSUPP;
1093
1094	mutex_lock(&efx->mac_lock);
1095	ret = efx->phy_op->get_module_info(efx, modinfo);
1096	mutex_unlock(&efx->mac_lock);
1097
1098	return ret;
1099}
1100
1101const struct ethtool_ops efx_ethtool_ops = {
1102	.get_settings		= efx_ethtool_get_settings,
1103	.set_settings		= efx_ethtool_set_settings,
 
1104	.get_drvinfo		= efx_ethtool_get_drvinfo,
1105	.get_regs_len		= efx_ethtool_get_regs_len,
1106	.get_regs		= efx_ethtool_get_regs,
1107	.get_msglevel		= efx_ethtool_get_msglevel,
1108	.set_msglevel		= efx_ethtool_set_msglevel,
1109	.nway_reset		= efx_ethtool_nway_reset,
1110	.get_link		= ethtool_op_get_link,
1111	.get_coalesce		= efx_ethtool_get_coalesce,
1112	.set_coalesce		= efx_ethtool_set_coalesce,
1113	.get_ringparam		= efx_ethtool_get_ringparam,
1114	.set_ringparam		= efx_ethtool_set_ringparam,
1115	.get_pauseparam         = efx_ethtool_get_pauseparam,
1116	.set_pauseparam         = efx_ethtool_set_pauseparam,
1117	.get_sset_count		= efx_ethtool_get_sset_count,
1118	.self_test		= efx_ethtool_self_test,
1119	.get_strings		= efx_ethtool_get_strings,
1120	.set_phys_id		= efx_ethtool_phys_id,
1121	.get_ethtool_stats	= efx_ethtool_get_stats,
1122	.get_wol                = efx_ethtool_get_wol,
1123	.set_wol                = efx_ethtool_set_wol,
1124	.reset			= efx_ethtool_reset,
1125	.get_rxnfc		= efx_ethtool_get_rxnfc,
1126	.set_rxnfc		= efx_ethtool_set_rxnfc,
1127	.get_rxfh_indir_size	= efx_ethtool_get_rxfh_indir_size,
1128	.get_rxfh_indir		= efx_ethtool_get_rxfh_indir,
1129	.set_rxfh_indir		= efx_ethtool_set_rxfh_indir,
 
 
 
 
 
 
 
1130	.get_ts_info		= efx_ethtool_get_ts_info,
1131	.get_module_info	= efx_ethtool_get_module_info,
1132	.get_module_eeprom	= efx_ethtool_get_module_eeprom,
 
 
 
 
 
1133};
v6.13.7
  1// SPDX-License-Identifier: GPL-2.0-only
  2/****************************************************************************
  3 * Driver for Solarflare network controllers and boards
  4 * Copyright 2005-2006 Fen Systems Ltd.
  5 * Copyright 2006-2013 Solarflare Communications Inc.
 
 
 
 
  6 */
  7
  8#include <linux/netdevice.h>
  9#include <linux/ethtool.h>
 10#include <linux/rtnetlink.h>
 11#include <linux/in.h>
 12#include "net_driver.h"
 13#include "workarounds.h"
 14#include "selftest.h"
 15#include "efx.h"
 16#include "efx_channels.h"
 17#include "rx_common.h"
 18#include "tx_common.h"
 19#include "ethtool_common.h"
 20#include "filter.h"
 21#include "nic.h"
 22
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 23#define EFX_ETHTOOL_EEPROM_MAGIC 0xEFAB
 24
 25/**************************************************************************
 26 *
 27 * Ethtool operations
 28 *
 29 **************************************************************************
 30 */
 31
 32/* Identify device by flashing LEDs */
 33static int efx_ethtool_phys_id(struct net_device *net_dev,
 34			       enum ethtool_phys_id_state state)
 35{
 36	struct efx_nic *efx = efx_netdev_priv(net_dev);
 37	enum efx_led_mode mode = EFX_LED_DEFAULT;
 38
 39	switch (state) {
 40	case ETHTOOL_ID_ON:
 41		mode = EFX_LED_ON;
 42		break;
 43	case ETHTOOL_ID_OFF:
 44		mode = EFX_LED_OFF;
 45		break;
 46	case ETHTOOL_ID_INACTIVE:
 47		mode = EFX_LED_DEFAULT;
 48		break;
 49	case ETHTOOL_ID_ACTIVE:
 50		return 1;	/* cycle on/off once per second */
 51	}
 52
 53	return efx_mcdi_set_id_led(efx, mode);
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 54}
 55
 56static int efx_ethtool_get_regs_len(struct net_device *net_dev)
 57{
 58	return efx_nic_get_regs_len(efx_netdev_priv(net_dev));
 59}
 60
 61static void efx_ethtool_get_regs(struct net_device *net_dev,
 62				 struct ethtool_regs *regs, void *buf)
 63{
 64	struct efx_nic *efx = efx_netdev_priv(net_dev);
 65
 66	regs->version = efx->type->revision;
 67	efx_nic_get_regs(efx, buf);
 68}
 69
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 70/*
 71 * Each channel has a single IRQ and moderation timer, started by any
 72 * completion (or other event).  Unless the module parameter
 73 * separate_tx_channels is set, IRQs and moderation are therefore
 74 * shared between RX and TX completions.  In this case, when RX IRQ
 75 * moderation is explicitly changed then TX IRQ moderation is
 76 * automatically changed too, but otherwise we fail if the two values
 77 * are requested to be different.
 78 *
 79 * The hardware does not support a limit on the number of completions
 80 * before an IRQ, so we do not use the max_frames fields.  We should
 81 * report and require that max_frames == (usecs != 0), but this would
 82 * invalidate existing user documentation.
 83 *
 84 * The hardware does not have distinct settings for interrupt
 85 * moderation while the previous IRQ is being handled, so we should
 86 * not use the 'irq' fields.  However, an earlier developer
 87 * misunderstood the meaning of the 'irq' fields and the driver did
 88 * not support the standard fields.  To avoid invalidating existing
 89 * user documentation, we report and accept changes through either the
 90 * standard or 'irq' fields.  If both are changed at the same time, we
 91 * prefer the standard field.
 92 *
 93 * We implement adaptive IRQ moderation, but use a different algorithm
 94 * from that assumed in the definition of struct ethtool_coalesce.
 95 * Therefore we do not use any of the adaptive moderation parameters
 96 * in it.
 97 */
 98
 99static int efx_ethtool_get_coalesce(struct net_device *net_dev,
100				    struct ethtool_coalesce *coalesce,
101				    struct kernel_ethtool_coalesce *kernel_coal,
102				    struct netlink_ext_ack *extack)
103{
104	struct efx_nic *efx = efx_netdev_priv(net_dev);
105	unsigned int tx_usecs, rx_usecs;
106	bool rx_adaptive;
107
108	efx_get_irq_moderation(efx, &tx_usecs, &rx_usecs, &rx_adaptive);
109
110	coalesce->tx_coalesce_usecs = tx_usecs;
111	coalesce->tx_coalesce_usecs_irq = tx_usecs;
112	coalesce->rx_coalesce_usecs = rx_usecs;
113	coalesce->rx_coalesce_usecs_irq = rx_usecs;
114	coalesce->use_adaptive_rx_coalesce = rx_adaptive;
115
116	return 0;
117}
118
119static int efx_ethtool_set_coalesce(struct net_device *net_dev,
120				    struct ethtool_coalesce *coalesce,
121				    struct kernel_ethtool_coalesce *kernel_coal,
122				    struct netlink_ext_ack *extack)
123{
124	struct efx_nic *efx = efx_netdev_priv(net_dev);
125	struct efx_channel *channel;
126	unsigned int tx_usecs, rx_usecs;
127	bool adaptive, rx_may_override_tx;
128	int rc;
129
 
 
 
130	efx_get_irq_moderation(efx, &tx_usecs, &rx_usecs, &adaptive);
131
132	if (coalesce->rx_coalesce_usecs != rx_usecs)
133		rx_usecs = coalesce->rx_coalesce_usecs;
134	else
135		rx_usecs = coalesce->rx_coalesce_usecs_irq;
136
137	adaptive = coalesce->use_adaptive_rx_coalesce;
138
139	/* If channels are shared, TX IRQ moderation can be quietly
140	 * overridden unless it is changed from its old value.
141	 */
142	rx_may_override_tx = (coalesce->tx_coalesce_usecs == tx_usecs &&
143			      coalesce->tx_coalesce_usecs_irq == tx_usecs);
144	if (coalesce->tx_coalesce_usecs != tx_usecs)
145		tx_usecs = coalesce->tx_coalesce_usecs;
146	else
147		tx_usecs = coalesce->tx_coalesce_usecs_irq;
148
149	rc = efx_init_irq_moderation(efx, tx_usecs, rx_usecs, adaptive,
150				     rx_may_override_tx);
151	if (rc != 0)
152		return rc;
153
154	efx_for_each_channel(channel, efx)
155		efx->type->push_irq_moderation(channel);
156
157	return 0;
158}
159
160static void
161efx_ethtool_get_ringparam(struct net_device *net_dev,
162			  struct ethtool_ringparam *ring,
163			  struct kernel_ethtool_ringparam *kernel_ring,
164			  struct netlink_ext_ack *extack)
165{
166	struct efx_nic *efx = efx_netdev_priv(net_dev);
167
168	ring->rx_max_pending = EFX_MAX_DMAQ_SIZE;
169	ring->tx_max_pending = EFX_TXQ_MAX_ENT(efx);
170	ring->rx_pending = efx->rxq_entries;
171	ring->tx_pending = efx->txq_entries;
172}
173
174static int
175efx_ethtool_set_ringparam(struct net_device *net_dev,
176			  struct ethtool_ringparam *ring,
177			  struct kernel_ethtool_ringparam *kernel_ring,
178			  struct netlink_ext_ack *extack)
179{
180	struct efx_nic *efx = efx_netdev_priv(net_dev);
181	u32 txq_entries;
182
183	if (ring->rx_mini_pending || ring->rx_jumbo_pending ||
184	    ring->rx_pending > EFX_MAX_DMAQ_SIZE ||
185	    ring->tx_pending > EFX_TXQ_MAX_ENT(efx))
186		return -EINVAL;
187
188	if (ring->rx_pending < EFX_RXQ_MIN_ENT) {
189		netif_err(efx, drv, efx->net_dev,
190			  "RX queues cannot be smaller than %u\n",
191			  EFX_RXQ_MIN_ENT);
192		return -EINVAL;
193	}
194
195	txq_entries = max(ring->tx_pending, EFX_TXQ_MIN_ENT(efx));
196	if (txq_entries != ring->tx_pending)
197		netif_warn(efx, drv, efx->net_dev,
198			   "increasing TX queue size to minimum of %u\n",
199			   txq_entries);
200
201	return efx_realloc_channels(efx, ring->rx_pending, txq_entries);
202}
203
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
204static void efx_ethtool_get_wol(struct net_device *net_dev,
205				struct ethtool_wolinfo *wol)
206{
207	struct efx_nic *efx = efx_netdev_priv(net_dev);
208	return efx->type->get_wol(efx, wol);
209}
210
211
212static int efx_ethtool_set_wol(struct net_device *net_dev,
213			       struct ethtool_wolinfo *wol)
214{
215	struct efx_nic *efx = efx_netdev_priv(net_dev);
216	return efx->type->set_wol(efx, wol->wolopts);
217}
218
219static void efx_ethtool_get_fec_stats(struct net_device *net_dev,
220				      struct ethtool_fec_stats *fec_stats)
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
221{
222	struct efx_nic *efx = efx_netdev_priv(net_dev);
223
224	if (efx->type->get_fec_stats)
225		efx->type->get_fec_stats(efx, fec_stats);
 
 
 
 
 
 
 
 
 
 
226}
227
228static int efx_ethtool_get_ts_info(struct net_device *net_dev,
229				   struct kernel_ethtool_ts_info *ts_info)
230{
231	struct efx_nic *efx = efx_netdev_priv(net_dev);
 
 
 
 
 
232
233	efx_ptp_get_ts_info(efx, ts_info);
234	return 0;
235}
236
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
237const struct ethtool_ops efx_ethtool_ops = {
238	.supported_coalesce_params = ETHTOOL_COALESCE_USECS |
239				     ETHTOOL_COALESCE_USECS_IRQ |
240				     ETHTOOL_COALESCE_USE_ADAPTIVE_RX,
241	.get_drvinfo		= efx_ethtool_get_drvinfo,
242	.get_regs_len		= efx_ethtool_get_regs_len,
243	.get_regs		= efx_ethtool_get_regs,
244	.get_msglevel		= efx_ethtool_get_msglevel,
245	.set_msglevel		= efx_ethtool_set_msglevel,
 
246	.get_link		= ethtool_op_get_link,
247	.get_coalesce		= efx_ethtool_get_coalesce,
248	.set_coalesce		= efx_ethtool_set_coalesce,
249	.get_ringparam		= efx_ethtool_get_ringparam,
250	.set_ringparam		= efx_ethtool_set_ringparam,
251	.get_pauseparam         = efx_ethtool_get_pauseparam,
252	.set_pauseparam         = efx_ethtool_set_pauseparam,
253	.get_sset_count		= efx_ethtool_get_sset_count,
254	.self_test		= efx_ethtool_self_test,
255	.get_strings		= efx_ethtool_get_strings,
256	.set_phys_id		= efx_ethtool_phys_id,
257	.get_ethtool_stats	= efx_ethtool_get_stats,
258	.get_wol                = efx_ethtool_get_wol,
259	.set_wol                = efx_ethtool_set_wol,
260	.reset			= efx_ethtool_reset,
261	.get_rxnfc		= efx_ethtool_get_rxnfc,
262	.set_rxnfc		= efx_ethtool_set_rxnfc,
263	.get_rxfh_indir_size	= efx_ethtool_get_rxfh_indir_size,
264	.get_rxfh_key_size	= efx_ethtool_get_rxfh_key_size,
265	.rxfh_per_ctx_key	= true,
266	.cap_rss_rxnfc_adds	= true,
267	.rxfh_priv_size		= sizeof(struct efx_rss_context_priv),
268	.get_rxfh		= efx_ethtool_get_rxfh,
269	.set_rxfh		= efx_ethtool_set_rxfh,
270	.create_rxfh_context	= efx_ethtool_create_rxfh_context,
271	.modify_rxfh_context	= efx_ethtool_modify_rxfh_context,
272	.remove_rxfh_context	= efx_ethtool_remove_rxfh_context,
273	.get_ts_info		= efx_ethtool_get_ts_info,
274	.get_module_info	= efx_ethtool_get_module_info,
275	.get_module_eeprom	= efx_ethtool_get_module_eeprom,
276	.get_link_ksettings	= efx_ethtool_get_link_ksettings,
277	.set_link_ksettings	= efx_ethtool_set_link_ksettings,
278	.get_fec_stats		= efx_ethtool_get_fec_stats,
279	.get_fecparam		= efx_ethtool_get_fecparam,
280	.set_fecparam		= efx_ethtool_set_fecparam,
281};