1

/*******************************************************************************

     2

     3

  Intel PRO/1000 Linux driver

     4

  Copyright(c) 1999 - 2012 Intel Corporation.

     5

     6

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

     7

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

     8

  version 2, as published by the Free Software Foundation.

     9

    10

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

    11

  ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or

    12

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

    13

  more details.

    14

    15

  You should have received a copy of the GNU General Public License along with

    16

  this program; if not, write to the Free Software Foundation, Inc.,

    17

  51 Franklin St - Fifth Floor, Boston, MA 02110-1301 USA.

    18

    19

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

    20

  the file called "COPYING".

    21

    22

  Contact Information:

    23

  Linux NICS <linux.nics@intel.com>

    24

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

    25

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

    26

    27

*******************************************************************************/

    28

    29

/* ethtool support for e1000 */

    30

    31

#include <linux/netdevice.h>

    32

#include <linux/interrupt.h>

    33

#include <linux/ethtool.h>

    34

#include <linux/pci.h>

    35

#include <linux/slab.h>

    36

#include <linux/delay.h>

    37

#include <linux/vmalloc.h>

    38

    39

#include "e1000-3.4-ethercat.h"

    40

    41

enum {NETDEV_STATS, E1000_STATS};

    42

    43

struct e1000_stats {

    44

	char stat_string[ETH_GSTRING_LEN];

    45

	int type;

    46

	int sizeof_stat;

    47

	int stat_offset;

    48

};

    49

    50

#define E1000_STAT(str, m) { \

    51

		.stat_string = str, \

    52

		.type = E1000_STATS, \

    53

		.sizeof_stat = sizeof(((struct e1000_adapter *)0)->m), \

    54

		.stat_offset = offsetof(struct e1000_adapter, m) }

    55

#define E1000_NETDEV_STAT(str, m) { \

    56

		.stat_string = str, \

    57

		.type = NETDEV_STATS, \

    58

		.sizeof_stat = sizeof(((struct rtnl_link_stats64 *)0)->m), \

    59

		.stat_offset = offsetof(struct rtnl_link_stats64, m) }

    60

    61

static const struct e1000_stats e1000_gstrings_stats[] = {

    62

	E1000_STAT("rx_packets", stats.gprc),

    63

	E1000_STAT("tx_packets", stats.gptc),

    64

	E1000_STAT("rx_bytes", stats.gorc),

    65

	E1000_STAT("tx_bytes", stats.gotc),

    66

	E1000_STAT("rx_broadcast", stats.bprc),

    67

	E1000_STAT("tx_broadcast", stats.bptc),

    68

	E1000_STAT("rx_multicast", stats.mprc),

    69

	E1000_STAT("tx_multicast", stats.mptc),

    70

	E1000_NETDEV_STAT("rx_errors", rx_errors),

    71

	E1000_NETDEV_STAT("tx_errors", tx_errors),

    72

	E1000_NETDEV_STAT("tx_dropped", tx_dropped),

    73

	E1000_STAT("multicast", stats.mprc),

    74

	E1000_STAT("collisions", stats.colc),

    75

	E1000_NETDEV_STAT("rx_length_errors", rx_length_errors),

    76

	E1000_NETDEV_STAT("rx_over_errors", rx_over_errors),

    77

	E1000_STAT("rx_crc_errors", stats.crcerrs),

    78

	E1000_NETDEV_STAT("rx_frame_errors", rx_frame_errors),

    79

	E1000_STAT("rx_no_buffer_count", stats.rnbc),

    80

	E1000_STAT("rx_missed_errors", stats.mpc),

    81

	E1000_STAT("tx_aborted_errors", stats.ecol),

    82

	E1000_STAT("tx_carrier_errors", stats.tncrs),

    83

	E1000_NETDEV_STAT("tx_fifo_errors", tx_fifo_errors),

    84

	E1000_NETDEV_STAT("tx_heartbeat_errors", tx_heartbeat_errors),

    85

	E1000_STAT("tx_window_errors", stats.latecol),

    86

	E1000_STAT("tx_abort_late_coll", stats.latecol),

    87

	E1000_STAT("tx_deferred_ok", stats.dc),

    88

	E1000_STAT("tx_single_coll_ok", stats.scc),

    89

	E1000_STAT("tx_multi_coll_ok", stats.mcc),

    90

	E1000_STAT("tx_timeout_count", tx_timeout_count),

    91

	E1000_STAT("tx_restart_queue", restart_queue),

    92

	E1000_STAT("rx_long_length_errors", stats.roc),

    93

	E1000_STAT("rx_short_length_errors", stats.ruc),

    94

	E1000_STAT("rx_align_errors", stats.algnerrc),

    95

	E1000_STAT("tx_tcp_seg_good", stats.tsctc),

    96

	E1000_STAT("tx_tcp_seg_failed", stats.tsctfc),

    97

	E1000_STAT("rx_flow_control_xon", stats.xonrxc),

    98

	E1000_STAT("rx_flow_control_xoff", stats.xoffrxc),

    99

	E1000_STAT("tx_flow_control_xon", stats.xontxc),

   100

	E1000_STAT("tx_flow_control_xoff", stats.xofftxc),

   101

	E1000_STAT("rx_long_byte_count", stats.gorc),

   102

	E1000_STAT("rx_csum_offload_good", hw_csum_good),

   103

	E1000_STAT("rx_csum_offload_errors", hw_csum_err),

   104

	E1000_STAT("rx_header_split", rx_hdr_split),

   105

	E1000_STAT("alloc_rx_buff_failed", alloc_rx_buff_failed),

   106

	E1000_STAT("tx_smbus", stats.mgptc),

   107

	E1000_STAT("rx_smbus", stats.mgprc),

   108

	E1000_STAT("dropped_smbus", stats.mgpdc),

   109

	E1000_STAT("rx_dma_failed", rx_dma_failed),

   110

	E1000_STAT("tx_dma_failed", tx_dma_failed),

   111

};

   112

   113

#define E1000_GLOBAL_STATS_LEN	ARRAY_SIZE(e1000_gstrings_stats)

   114

#define E1000_STATS_LEN (E1000_GLOBAL_STATS_LEN)

   115

static const char e1000_gstrings_test[][ETH_GSTRING_LEN] = {

   116

	"Register test  (offline)", "Eeprom test    (offline)",

   117

	"Interrupt test (offline)", "Loopback test  (offline)",

   118

	"Link test   (on/offline)"

   119

};

   120

#define E1000_TEST_LEN ARRAY_SIZE(e1000_gstrings_test)

   121

   122

static int e1000_get_settings(struct net_device *netdev,

   123

			      struct ethtool_cmd *ecmd)

   124

{

   125

	struct e1000_adapter *adapter = netdev_priv(netdev);

   126

	struct e1000_hw *hw = &adapter->hw;

   127

	u32 speed;

   128

   129

	if (hw->phy.media_type == e1000_media_type_copper) {

   130

   131

		ecmd->supported = (SUPPORTED_10baseT_Half |

   132

				   SUPPORTED_10baseT_Full |

   133

				   SUPPORTED_100baseT_Half |

   134

				   SUPPORTED_100baseT_Full |

   135

				   SUPPORTED_1000baseT_Full |

   136

				   SUPPORTED_Autoneg |

   137

				   SUPPORTED_TP);

   138

		if (hw->phy.type == e1000_phy_ife)

   139

			ecmd->supported &= ~SUPPORTED_1000baseT_Full;

   140

		ecmd->advertising = ADVERTISED_TP;

   141

   142

		if (hw->mac.autoneg == 1) {

   143

			ecmd->advertising |= ADVERTISED_Autoneg;

   144

			/* the e1000 autoneg seems to match ethtool nicely */

   145

			ecmd->advertising |= hw->phy.autoneg_advertised;

   146

		}

   147

   148

		ecmd->port = PORT_TP;

   149

		ecmd->phy_address = hw->phy.addr;

   150

		ecmd->transceiver = XCVR_INTERNAL;

   151

   152

	} else {

   153

		ecmd->supported   = (SUPPORTED_1000baseT_Full |

   154

				     SUPPORTED_FIBRE |

   155

				     SUPPORTED_Autoneg);

   156

   157

		ecmd->advertising = (ADVERTISED_1000baseT_Full |

   158

				     ADVERTISED_FIBRE |

   159

				     ADVERTISED_Autoneg);

   160

   161

		ecmd->port = PORT_FIBRE;

   162

		ecmd->transceiver = XCVR_EXTERNAL;

   163

	}

   164

   165

	speed = -1;

   166

	ecmd->duplex = -1;

   167

   168

	if (netif_running(netdev)) {

   169

		if (netif_carrier_ok(netdev)) {

   170

			speed = adapter->link_speed;

   171

			ecmd->duplex = adapter->link_duplex - 1;

   172

		}

   173

	} else {

   174

		u32 status = er32(STATUS);

   175

		if (status & E1000_STATUS_LU) {

   176

			if (status & E1000_STATUS_SPEED_1000)

   177

				speed = SPEED_1000;

   178

			else if (status & E1000_STATUS_SPEED_100)

   179

				speed = SPEED_100;

   180

			else

   181

				speed = SPEED_10;

   182

   183

			if (status & E1000_STATUS_FD)

   184

				ecmd->duplex = DUPLEX_FULL;

   185

			else

   186

				ecmd->duplex = DUPLEX_HALF;

   187

		}

   188

	}

   189

   190

	ethtool_cmd_speed_set(ecmd, speed);

   191

	ecmd->autoneg = ((hw->phy.media_type == e1000_media_type_fiber) ||

   192

			 hw->mac.autoneg) ? AUTONEG_ENABLE : AUTONEG_DISABLE;

   193

   194

	/* MDI-X => 2; MDI =>1; Invalid =>0 */

   195

	if ((hw->phy.media_type == e1000_media_type_copper) &&

   196

	    netif_carrier_ok(netdev))

   197

		ecmd->eth_tp_mdix = hw->phy.is_mdix ? ETH_TP_MDI_X :

   198

		                                      ETH_TP_MDI;

   199

	else

   200

		ecmd->eth_tp_mdix = ETH_TP_MDI_INVALID;

   201

   202

	return 0;

   203

}

   204

   205

static int e1000_set_spd_dplx(struct e1000_adapter *adapter, u32 spd, u8 dplx)

   206

{

   207

	struct e1000_mac_info *mac = &adapter->hw.mac;

   208

   209

	mac->autoneg = 0;

   210

   211

	/* Make sure dplx is at most 1 bit and lsb of speed is not set

   212

	 * for the switch() below to work */

   213

	if ((spd & 1) || (dplx & ~1))

   214

		goto err_inval;

   215

   216

	/* Fiber NICs only allow 1000 gbps Full duplex */

   217

	if ((adapter->hw.phy.media_type == e1000_media_type_fiber) &&

   218

	    spd != SPEED_1000 &&

   219

	    dplx != DUPLEX_FULL) {

   220

		goto err_inval;

   221

	}

   222

   223

	switch (spd + dplx) {

   224

	case SPEED_10 + DUPLEX_HALF:

   225

		mac->forced_speed_duplex = ADVERTISE_10_HALF;

   226

		break;

   227

	case SPEED_10 + DUPLEX_FULL:

   228

		mac->forced_speed_duplex = ADVERTISE_10_FULL;

   229

		break;

   230

	case SPEED_100 + DUPLEX_HALF:

   231

		mac->forced_speed_duplex = ADVERTISE_100_HALF;

   232

		break;

   233

	case SPEED_100 + DUPLEX_FULL:

   234

		mac->forced_speed_duplex = ADVERTISE_100_FULL;

   235

		break;

   236

	case SPEED_1000 + DUPLEX_FULL:

   237

		mac->autoneg = 1;

   238

		adapter->hw.phy.autoneg_advertised = ADVERTISE_1000_FULL;

   239

		break;

   240

	case SPEED_1000 + DUPLEX_HALF: /* not supported */

   241

	default:

   242

		goto err_inval;

   243

	}

   244

	return 0;

   245

   246

err_inval:

   247

	e_err("Unsupported Speed/Duplex configuration\n");

   248

	return -EINVAL;

   249

}

   250

   251

static int e1000_set_settings(struct net_device *netdev,

   252

			      struct ethtool_cmd *ecmd)

   253

{

   254

	struct e1000_adapter *adapter = netdev_priv(netdev);

   255

	struct e1000_hw *hw = &adapter->hw;

   256

   257

	/*

   258

	 * When SoL/IDER sessions are active, autoneg/speed/duplex

   259

	 * cannot be changed

   260

	 */

   261

	if (hw->phy.ops.check_reset_block &&

   262

	    hw->phy.ops.check_reset_block(hw)) {

   263

		e_err("Cannot change link characteristics when SoL/IDER is "

   264

		      "active.\n");

   265

		return -EINVAL;

   266

	}

   267

   268

	while (test_and_set_bit(__E1000_RESETTING, &adapter->state))

   269

		usleep_range(1000, 2000);

   270

   271

	if (ecmd->autoneg == AUTONEG_ENABLE) {

   272

		hw->mac.autoneg = 1;

   273

		if (hw->phy.media_type == e1000_media_type_fiber)

   274

			hw->phy.autoneg_advertised = ADVERTISED_1000baseT_Full |

   275

						     ADVERTISED_FIBRE |

   276

						     ADVERTISED_Autoneg;

   277

		else

   278

			hw->phy.autoneg_advertised = ecmd->advertising |

   279

						     ADVERTISED_TP |

   280

						     ADVERTISED_Autoneg;

   281

		ecmd->advertising = hw->phy.autoneg_advertised;

   282

		if (adapter->fc_autoneg)

   283

			hw->fc.requested_mode = e1000_fc_default;

   284

	} else {

   285

		u32 speed = ethtool_cmd_speed(ecmd);

   286

		if (e1000_set_spd_dplx(adapter, speed, ecmd->duplex)) {

   287

			clear_bit(__E1000_RESETTING, &adapter->state);

   288

			return -EINVAL;

   289

		}

   290

	}

   291

   292

	/* reset the link */

   293

   294

	if (netif_running(adapter->netdev)) {

   295

		e1000e_down(adapter);

   296

		e1000e_up(adapter);

   297

	} else {

   298

		e1000e_reset(adapter);

   299

	}

   300

   301

	clear_bit(__E1000_RESETTING, &adapter->state);

   302

	return 0;

   303

}

   304

   305

static void e1000_get_pauseparam(struct net_device *netdev,

   306

				 struct ethtool_pauseparam *pause)

   307

{

   308

	struct e1000_adapter *adapter = netdev_priv(netdev);

   309

	struct e1000_hw *hw = &adapter->hw;

   310

   311

	pause->autoneg =

   312

		(adapter->fc_autoneg ? AUTONEG_ENABLE : AUTONEG_DISABLE);

   313

   314

	if (hw->fc.current_mode == e1000_fc_rx_pause) {

   315

		pause->rx_pause = 1;

   316

	} else if (hw->fc.current_mode == e1000_fc_tx_pause) {

   317

		pause->tx_pause = 1;

   318

	} else if (hw->fc.current_mode == e1000_fc_full) {

   319

		pause->rx_pause = 1;

   320

		pause->tx_pause = 1;

   321

	}

   322

}

   323

   324

static int e1000_set_pauseparam(struct net_device *netdev,

   325

				struct ethtool_pauseparam *pause)

   326

{

   327

	struct e1000_adapter *adapter = netdev_priv(netdev);

   328

	struct e1000_hw *hw = &adapter->hw;

   329

	int retval = 0;

   330

   331

	adapter->fc_autoneg = pause->autoneg;

   332

   333

	while (test_and_set_bit(__E1000_RESETTING, &adapter->state))

   334

		usleep_range(1000, 2000);

   335

   336

	if (adapter->fc_autoneg == AUTONEG_ENABLE) {

   337

		hw->fc.requested_mode = e1000_fc_default;

   338

		if (netif_running(adapter->netdev)) {

   339

			e1000e_down(adapter);

   340

			e1000e_up(adapter);

   341

		} else {

   342

			e1000e_reset(adapter);

   343

		}

   344

	} else {

   345

		if (pause->rx_pause && pause->tx_pause)

   346

			hw->fc.requested_mode = e1000_fc_full;

   347

		else if (pause->rx_pause && !pause->tx_pause)

   348

			hw->fc.requested_mode = e1000_fc_rx_pause;

   349

		else if (!pause->rx_pause && pause->tx_pause)

   350

			hw->fc.requested_mode = e1000_fc_tx_pause;

   351

		else if (!pause->rx_pause && !pause->tx_pause)

   352

			hw->fc.requested_mode = e1000_fc_none;

   353

   354

		hw->fc.current_mode = hw->fc.requested_mode;

   355

   356

		if (hw->phy.media_type == e1000_media_type_fiber) {

   357

			retval = hw->mac.ops.setup_link(hw);

   358

			/* implicit goto out */

   359

		} else {

   360

			retval = e1000e_force_mac_fc(hw);

   361

			if (retval)

   362

				goto out;

   363

			e1000e_set_fc_watermarks(hw);

   364

		}

   365

	}

   366

   367

out:

   368

	clear_bit(__E1000_RESETTING, &adapter->state);

   369

	return retval;

   370

}

   371

   372

static u32 e1000_get_msglevel(struct net_device *netdev)

   373

{

   374

	struct e1000_adapter *adapter = netdev_priv(netdev);

   375

	return adapter->msg_enable;

   376

}

   377

   378

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

   379

{

   380

	struct e1000_adapter *adapter = netdev_priv(netdev);

   381

	adapter->msg_enable = data;

   382

}

   383

   384

static int e1000_get_regs_len(struct net_device *netdev)

   385

{

   386

#define E1000_REGS_LEN 32 /* overestimate */

   387

	return E1000_REGS_LEN * sizeof(u32);

   388

}

   389

   390

static void e1000_get_regs(struct net_device *netdev,

   391

			   struct ethtool_regs *regs, void *p)

   392

{

   393

	struct e1000_adapter *adapter = netdev_priv(netdev);

   394

	struct e1000_hw *hw = &adapter->hw;

   395

	u32 *regs_buff = p;

   396

	u16 phy_data;

   397

   398

	memset(p, 0, E1000_REGS_LEN * sizeof(u32));

   399

   400

	regs->version = (1 << 24) | (adapter->pdev->revision << 16) |

   401

			adapter->pdev->device;

   402

   403

	regs_buff[0]  = er32(CTRL);

   404

	regs_buff[1]  = er32(STATUS);

   405

   406

	regs_buff[2]  = er32(RCTL);

   407

	regs_buff[3]  = er32(RDLEN);

   408

	regs_buff[4]  = er32(RDH);

   409

	regs_buff[5]  = er32(RDT);

   410

	regs_buff[6]  = er32(RDTR);

   411

   412

	regs_buff[7]  = er32(TCTL);

   413

	regs_buff[8]  = er32(TDLEN);

   414

	regs_buff[9]  = er32(TDH);

   415

	regs_buff[10] = er32(TDT);

   416

	regs_buff[11] = er32(TIDV);

   417

   418

	regs_buff[12] = adapter->hw.phy.type;  /* PHY type (IGP=1, M88=0) */

   419

   420

	/* ethtool doesn't use anything past this point, so all this

   421

	 * code is likely legacy junk for apps that may or may not

   422

	 * exist */

   423

	if (hw->phy.type == e1000_phy_m88) {

   424

		e1e_rphy(hw, M88E1000_PHY_SPEC_STATUS, &phy_data);

   425

		regs_buff[13] = (u32)phy_data; /* cable length */

   426

		regs_buff[14] = 0;  /* Dummy (to align w/ IGP phy reg dump) */

   427

		regs_buff[15] = 0;  /* Dummy (to align w/ IGP phy reg dump) */

   428

		regs_buff[16] = 0;  /* Dummy (to align w/ IGP phy reg dump) */

   429

		e1e_rphy(hw, M88E1000_PHY_SPEC_CTRL, &phy_data);

   430

		regs_buff[17] = (u32)phy_data; /* extended 10bt distance */

   431

		regs_buff[18] = regs_buff[13]; /* cable polarity */

   432

		regs_buff[19] = 0;  /* Dummy (to align w/ IGP phy reg dump) */

   433

		regs_buff[20] = regs_buff[17]; /* polarity correction */

   434

		/* phy receive errors */

   435

		regs_buff[22] = adapter->phy_stats.receive_errors;

   436

		regs_buff[23] = regs_buff[13]; /* mdix mode */

   437

	}

   438

	regs_buff[21] = 0; /* was idle_errors */

   439

	e1e_rphy(hw, PHY_1000T_STATUS, &phy_data);

   440

	regs_buff[24] = (u32)phy_data;  /* phy local receiver status */

   441

	regs_buff[25] = regs_buff[24];  /* phy remote receiver status */

   442

}

   443

   444

static int e1000_get_eeprom_len(struct net_device *netdev)

   445

{

   446

	struct e1000_adapter *adapter = netdev_priv(netdev);

   447

	return adapter->hw.nvm.word_size * 2;

   448

}

   449

   450

static int e1000_get_eeprom(struct net_device *netdev,

   451

			    struct ethtool_eeprom *eeprom, u8 *bytes)

   452

{

   453

	struct e1000_adapter *adapter = netdev_priv(netdev);

   454

	struct e1000_hw *hw = &adapter->hw;

   455

	u16 *eeprom_buff;

   456

	int first_word;

   457

	int last_word;

   458

	int ret_val = 0;

   459

	u16 i;

   460

   461

	if (eeprom->len == 0)

   462

		return -EINVAL;

   463

   464

	eeprom->magic = adapter->pdev->vendor | (adapter->pdev->device << 16);

   465

   466

	first_word = eeprom->offset >> 1;

   467

	last_word = (eeprom->offset + eeprom->len - 1) >> 1;

   468

   469

	eeprom_buff = kmalloc(sizeof(u16) *

   470

			(last_word - first_word + 1), GFP_KERNEL);

   471

	if (!eeprom_buff)

   472

		return -ENOMEM;

   473

   474

	if (hw->nvm.type == e1000_nvm_eeprom_spi) {

   475

		ret_val = e1000_read_nvm(hw, first_word,

   476

					 last_word - first_word + 1,

   477

					 eeprom_buff);

   478

	} else {

   479

		for (i = 0; i < last_word - first_word + 1; i++) {

   480

			ret_val = e1000_read_nvm(hw, first_word + i, 1,

   481

						      &eeprom_buff[i]);

   482

			if (ret_val)

   483

				break;

   484

		}

   485

	}

   486

   487

	if (ret_val) {

   488

		/* a read error occurred, throw away the result */

   489

		memset(eeprom_buff, 0xff, sizeof(u16) *

   490

		       (last_word - first_word + 1));

   491

	} else {

   492

		/* Device's eeprom is always little-endian, word addressable */

   493

		for (i = 0; i < last_word - first_word + 1; i++)

   494

			le16_to_cpus(&eeprom_buff[i]);

   495

	}

   496

   497

	memcpy(bytes, (u8 *)eeprom_buff + (eeprom->offset & 1), eeprom->len);

   498

	kfree(eeprom_buff);

   499

   500

	return ret_val;

   501

}

   502

   503

static int e1000_set_eeprom(struct net_device *netdev,

   504

			    struct ethtool_eeprom *eeprom, u8 *bytes)

   505

{

   506

	struct e1000_adapter *adapter = netdev_priv(netdev);

   507

	struct e1000_hw *hw = &adapter->hw;

   508

	u16 *eeprom_buff;

   509

	void *ptr;

   510

	int max_len;

   511

	int first_word;

   512

	int last_word;

   513

	int ret_val = 0;

   514

	u16 i;

   515

   516

	if (eeprom->len == 0)

   517

		return -EOPNOTSUPP;

   518

   519

	if (eeprom->magic != (adapter->pdev->vendor | (adapter->pdev->device << 16)))

   520

		return -EFAULT;

   521

   522

	if (adapter->flags & FLAG_READ_ONLY_NVM)

   523

		return -EINVAL;

   524

   525

	max_len = hw->nvm.word_size * 2;

   526

   527

	first_word = eeprom->offset >> 1;

   528

	last_word = (eeprom->offset + eeprom->len - 1) >> 1;

   529

	eeprom_buff = kmalloc(max_len, GFP_KERNEL);

   530