1

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

     2

     3

  Intel PRO/1000 Linux driver

     4

  Copyright(c) 1999 - 2011 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

    38

#include "e1000-3.2-ethercat.h"

    39

    40

enum {NETDEV_STATS, E1000_STATS};

    41

    42

struct e1000_stats {

    43

	char stat_string[ETH_GSTRING_LEN];

    44

	int type;

    45

	int sizeof_stat;

    46

	int stat_offset;

    47

};

    48

    49

#define E1000_STAT(str, m) { \

    50

		.stat_string = str, \

    51

		.type = E1000_STATS, \

    52

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

    53

		.stat_offset = offsetof(struct e1000_adapter, m) }

    54

#define E1000_NETDEV_STAT(str, m) { \

    55

		.stat_string = str, \

    56

		.type = NETDEV_STATS, \

    57

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

    58

		.stat_offset = offsetof(struct rtnl_link_stats64, m) }

    59

    60

static const struct e1000_stats e1000_gstrings_stats[] = {

    61

	E1000_STAT("rx_packets", stats.gprc),

    62

	E1000_STAT("tx_packets", stats.gptc),

    63

	E1000_STAT("rx_bytes", stats.gorc),

    64

	E1000_STAT("tx_bytes", stats.gotc),

    65

	E1000_STAT("rx_broadcast", stats.bprc),

    66

	E1000_STAT("tx_broadcast", stats.bptc),

    67

	E1000_STAT("rx_multicast", stats.mprc),

    68

	E1000_STAT("tx_multicast", stats.mptc),

    69

	E1000_NETDEV_STAT("rx_errors", rx_errors),

    70

	E1000_NETDEV_STAT("tx_errors", tx_errors),

    71

	E1000_NETDEV_STAT("tx_dropped", tx_dropped),

    72

	E1000_STAT("multicast", stats.mprc),

    73

	E1000_STAT("collisions", stats.colc),

    74

	E1000_NETDEV_STAT("rx_length_errors", rx_length_errors),

    75

	E1000_NETDEV_STAT("rx_over_errors", rx_over_errors),

    76

	E1000_STAT("rx_crc_errors", stats.crcerrs),

    77

	E1000_NETDEV_STAT("rx_frame_errors", rx_frame_errors),

    78

	E1000_STAT("rx_no_buffer_count", stats.rnbc),

    79

	E1000_STAT("rx_missed_errors", stats.mpc),

    80

	E1000_STAT("tx_aborted_errors", stats.ecol),

    81

	E1000_STAT("tx_carrier_errors", stats.tncrs),

    82

	E1000_NETDEV_STAT("tx_fifo_errors", tx_fifo_errors),

    83

	E1000_NETDEV_STAT("tx_heartbeat_errors", tx_heartbeat_errors),

    84

	E1000_STAT("tx_window_errors", stats.latecol),

    85

	E1000_STAT("tx_abort_late_coll", stats.latecol),

    86

	E1000_STAT("tx_deferred_ok", stats.dc),

    87

	E1000_STAT("tx_single_coll_ok", stats.scc),

    88

	E1000_STAT("tx_multi_coll_ok", stats.mcc),

    89

	E1000_STAT("tx_timeout_count", tx_timeout_count),

    90

	E1000_STAT("tx_restart_queue", restart_queue),

    91

	E1000_STAT("rx_long_length_errors", stats.roc),

    92

	E1000_STAT("rx_short_length_errors", stats.ruc),

    93

	E1000_STAT("rx_align_errors", stats.algnerrc),

    94

	E1000_STAT("tx_tcp_seg_good", stats.tsctc),

    95

	E1000_STAT("tx_tcp_seg_failed", stats.tsctfc),

    96

	E1000_STAT("rx_flow_control_xon", stats.xonrxc),

    97

	E1000_STAT("rx_flow_control_xoff", stats.xoffrxc),

    98

	E1000_STAT("tx_flow_control_xon", stats.xontxc),

    99

	E1000_STAT("tx_flow_control_xoff", stats.xofftxc),

   100

	E1000_STAT("rx_long_byte_count", stats.gorc),

   101

	E1000_STAT("rx_csum_offload_good", hw_csum_good),

   102

	E1000_STAT("rx_csum_offload_errors", hw_csum_err),

   103

	E1000_STAT("rx_header_split", rx_hdr_split),

   104

	E1000_STAT("alloc_rx_buff_failed", alloc_rx_buff_failed),

   105

	E1000_STAT("tx_smbus", stats.mgptc),

   106

	E1000_STAT("rx_smbus", stats.mgprc),

   107

	E1000_STAT("dropped_smbus", stats.mgpdc),

   108

	E1000_STAT("rx_dma_failed", rx_dma_failed),

   109

	E1000_STAT("tx_dma_failed", tx_dma_failed),

   110

};

   111

   112

#define E1000_GLOBAL_STATS_LEN	ARRAY_SIZE(e1000_gstrings_stats)

   113

#define E1000_STATS_LEN (E1000_GLOBAL_STATS_LEN)

   114

static const char e1000_gstrings_test[][ETH_GSTRING_LEN] = {

   115

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

   116

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

   117

	"Link test   (on/offline)"

   118

};

   119

#define E1000_TEST_LEN ARRAY_SIZE(e1000_gstrings_test)

   120

   121

static int e1000_get_settings(struct net_device *netdev,

   122

			      struct ethtool_cmd *ecmd)

   123

{

   124

	struct e1000_adapter *adapter = netdev_priv(netdev);

   125

	struct e1000_hw *hw = &adapter->hw;

   126

	u32 speed;

   127

   128

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

   129

   130

		ecmd->supported = (SUPPORTED_10baseT_Half |

   131

				   SUPPORTED_10baseT_Full |

   132

				   SUPPORTED_100baseT_Half |

   133

				   SUPPORTED_100baseT_Full |

   134

				   SUPPORTED_1000baseT_Full |

   135

				   SUPPORTED_Autoneg |

   136

				   SUPPORTED_TP);

   137

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

   138

			ecmd->supported &= ~SUPPORTED_1000baseT_Full;

   139

		ecmd->advertising = ADVERTISED_TP;

   140

   141

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

   142

			ecmd->advertising |= ADVERTISED_Autoneg;

   143

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

   144

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

   145

		}

   146

   147

		ecmd->port = PORT_TP;

   148

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

   149

		ecmd->transceiver = XCVR_INTERNAL;

   150

   151

	} else {

   152

		ecmd->supported   = (SUPPORTED_1000baseT_Full |

   153

				     SUPPORTED_FIBRE |

   154

				     SUPPORTED_Autoneg);

   155

   156

		ecmd->advertising = (ADVERTISED_1000baseT_Full |

   157

				     ADVERTISED_FIBRE |

   158

				     ADVERTISED_Autoneg);

   159

   160

		ecmd->port = PORT_FIBRE;

   161

		ecmd->transceiver = XCVR_EXTERNAL;

   162

	}

   163

   164

	speed = -1;

   165

	ecmd->duplex = -1;

   166

   167

	if (netif_running(netdev)) {

   168

		if (netif_carrier_ok(netdev)) {

   169

			speed = adapter->link_speed;

   170

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

   171

		}

   172

	} else {

   173

		u32 status = er32(STATUS);

   174

		if (status & E1000_STATUS_LU) {

   175

			if (status & E1000_STATUS_SPEED_1000)

   176

				speed = SPEED_1000;

   177

			else if (status & E1000_STATUS_SPEED_100)

   178

				speed = SPEED_100;

   179

			else

   180

				speed = SPEED_10;

   181

   182

			if (status & E1000_STATUS_FD)

   183

				ecmd->duplex = DUPLEX_FULL;

   184

			else

   185

				ecmd->duplex = DUPLEX_HALF;

   186

		}

   187

	}

   188

   189

	ethtool_cmd_speed_set(ecmd, speed);

   190

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

   191

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

   192

   193

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

   194

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

   195

	    netif_carrier_ok(netdev))

   196

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

   197

		                                      ETH_TP_MDI;

   198

	else

   199

		ecmd->eth_tp_mdix = ETH_TP_MDI_INVALID;

   200

   201

	return 0;

   202

}

   203

   204

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

   205

{

   206

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

   207

   208

	mac->autoneg = 0;

   209

   210

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

   211

	 * for the switch() below to work */

   212

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

   213

		goto err_inval;

   214

   215

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

   216

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

   217

	    spd != SPEED_1000 &&

   218

	    dplx != DUPLEX_FULL) {

   219

		goto err_inval;

   220

	}

   221

   222

	switch (spd + dplx) {

   223

	case SPEED_10 + DUPLEX_HALF:

   224

		mac->forced_speed_duplex = ADVERTISE_10_HALF;

   225

		break;

   226

	case SPEED_10 + DUPLEX_FULL:

   227

		mac->forced_speed_duplex = ADVERTISE_10_FULL;

   228

		break;

   229

	case SPEED_100 + DUPLEX_HALF:

   230

		mac->forced_speed_duplex = ADVERTISE_100_HALF;

   231

		break;

   232

	case SPEED_100 + DUPLEX_FULL:

   233

		mac->forced_speed_duplex = ADVERTISE_100_FULL;

   234

		break;

   235

	case SPEED_1000 + DUPLEX_FULL:

   236

		mac->autoneg = 1;

   237

		adapter->hw.phy.autoneg_advertised = ADVERTISE_1000_FULL;

   238

		break;

   239

	case SPEED_1000 + DUPLEX_HALF: /* not supported */

   240

	default:

   241

		goto err_inval;

   242

	}

   243

	return 0;

   244

   245

err_inval:

   246

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

   247

	return -EINVAL;

   248

}

   249

   250

static int e1000_set_settings(struct net_device *netdev,

   251

			      struct ethtool_cmd *ecmd)

   252

{

   253

	struct e1000_adapter *adapter = netdev_priv(netdev);

   254

	struct e1000_hw *hw = &adapter->hw;

   255

   256

	/*

   257

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

   258

	 * cannot be changed

   259

	 */

   260

	if (e1000_check_reset_block(hw)) {

   261

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

   262

		      "active.\n");

   263

		return -EINVAL;

   264

	}

   265

   266

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

   267

		usleep_range(1000, 2000);

   268

   269

	if (ecmd->autoneg == AUTONEG_ENABLE) {

   270

		hw->mac.autoneg = 1;

   271

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

   272

			hw->phy.autoneg_advertised = ADVERTISED_1000baseT_Full |

   273

						     ADVERTISED_FIBRE |

   274

						     ADVERTISED_Autoneg;

   275

		else

   276

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

   277

						     ADVERTISED_TP |

   278

						     ADVERTISED_Autoneg;

   279

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

   280

		if (adapter->fc_autoneg)

   281

			hw->fc.requested_mode = e1000_fc_default;

   282

	} else {

   283

		u32 speed = ethtool_cmd_speed(ecmd);

   284

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

   285

			clear_bit(__E1000_RESETTING, &adapter->state);

   286

			return -EINVAL;

   287

		}

   288

	}

   289

   290

	/* reset the link */

   291

   292

	if (netif_running(adapter->netdev)) {

   293

		e1000e_down(adapter);

   294

		e1000e_up(adapter);

   295

	} else {

   296

		e1000e_reset(adapter);

   297

	}

   298

   299

	clear_bit(__E1000_RESETTING, &adapter->state);

   300

	return 0;

   301

}

   302

   303

static void e1000_get_pauseparam(struct net_device *netdev,

   304

				 struct ethtool_pauseparam *pause)

   305

{

   306

	struct e1000_adapter *adapter = netdev_priv(netdev);

   307

	struct e1000_hw *hw = &adapter->hw;

   308

   309

	pause->autoneg =

   310

		(adapter->fc_autoneg ? AUTONEG_ENABLE : AUTONEG_DISABLE);

   311

   312

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

   313

		pause->rx_pause = 1;

   314

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

   315

		pause->tx_pause = 1;

   316

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

   317

		pause->rx_pause = 1;

   318

		pause->tx_pause = 1;

   319

	}

   320

}

   321

   322

static int e1000_set_pauseparam(struct net_device *netdev,

   323

				struct ethtool_pauseparam *pause)

   324

{

   325

	struct e1000_adapter *adapter = netdev_priv(netdev);

   326

	struct e1000_hw *hw = &adapter->hw;

   327

	int retval = 0;

   328

   329

	adapter->fc_autoneg = pause->autoneg;

   330

   331

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

   332

		usleep_range(1000, 2000);

   333

   334

	if (adapter->fc_autoneg == AUTONEG_ENABLE) {

   335

		hw->fc.requested_mode = e1000_fc_default;

   336

		if (netif_running(adapter->netdev)) {

   337

			e1000e_down(adapter);

   338

			e1000e_up(adapter);

   339

		} else {

   340

			e1000e_reset(adapter);

   341

		}

   342

	} else {

   343

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

   344

			hw->fc.requested_mode = e1000_fc_full;

   345

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

   346

			hw->fc.requested_mode = e1000_fc_rx_pause;

   347

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

   348

			hw->fc.requested_mode = e1000_fc_tx_pause;

   349

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

   350

			hw->fc.requested_mode = e1000_fc_none;

   351

   352

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

   353

   354

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

   355

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

   356

			/* implicit goto out */

   357

		} else {

   358

			retval = e1000e_force_mac_fc(hw);

   359

			if (retval)

   360

				goto out;

   361

			e1000e_set_fc_watermarks(hw);

   362

		}

   363

	}

   364

   365

out:

   366

	clear_bit(__E1000_RESETTING, &adapter->state);

   367

	return retval;

   368

}

   369

   370

static u32 e1000_get_msglevel(struct net_device *netdev)

   371

{

   372

	struct e1000_adapter *adapter = netdev_priv(netdev);

   373

	return adapter->msg_enable;

   374

}

   375

   376

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

   377

{

   378

	struct e1000_adapter *adapter = netdev_priv(netdev);

   379

	adapter->msg_enable = data;

   380

}

   381

   382

static int e1000_get_regs_len(struct net_device *netdev)

   383

{

   384

#define E1000_REGS_LEN 32 /* overestimate */

   385

	return E1000_REGS_LEN * sizeof(u32);

   386

}

   387

   388

static void e1000_get_regs(struct net_device *netdev,

   389

			   struct ethtool_regs *regs, void *p)

   390

{

   391

	struct e1000_adapter *adapter = netdev_priv(netdev);

   392

	struct e1000_hw *hw = &adapter->hw;

   393

	u32 *regs_buff = p;

   394

	u16 phy_data;

   395

   396

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

   397

   398

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

   399

			adapter->pdev->device;

   400

   401

	regs_buff[0]  = er32(CTRL);

   402

	regs_buff[1]  = er32(STATUS);

   403

   404

	regs_buff[2]  = er32(RCTL);

   405

	regs_buff[3]  = er32(RDLEN);

   406

	regs_buff[4]  = er32(RDH);

   407

	regs_buff[5]  = er32(RDT);

   408

	regs_buff[6]  = er32(RDTR);

   409

   410

	regs_buff[7]  = er32(TCTL);

   411

	regs_buff[8]  = er32(TDLEN);

   412

	regs_buff[9]  = er32(TDH);

   413

	regs_buff[10] = er32(TDT);

   414

	regs_buff[11] = er32(TIDV);

   415

   416

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

   417

   418

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

   419

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

   420

	 * exist */

   421

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

   422

		e1e_rphy(hw, M88E1000_PHY_SPEC_STATUS, &phy_data);

   423

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

   424

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

   425

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

   426

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

   427

		e1e_rphy(hw, M88E1000_PHY_SPEC_CTRL, &phy_data);

   428

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

   429

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

   430

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

   431

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

   432

		/* phy receive errors */

   433

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

   434

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

   435

	}

   436

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

   437

	e1e_rphy(hw, PHY_1000T_STATUS, &phy_data);

   438

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

   439

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

   440

}

   441

   442

static int e1000_get_eeprom_len(struct net_device *netdev)

   443

{

   444

	struct e1000_adapter *adapter = netdev_priv(netdev);

   445

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

   446

}

   447

   448

static int e1000_get_eeprom(struct net_device *netdev,

   449

			    struct ethtool_eeprom *eeprom, u8 *bytes)

   450

{

   451

	struct e1000_adapter *adapter = netdev_priv(netdev);

   452

	struct e1000_hw *hw = &adapter->hw;

   453

	u16 *eeprom_buff;

   454

	int first_word;

   455

	int last_word;

   456

	int ret_val = 0;

   457

	u16 i;

   458

   459

	if (eeprom->len == 0)

   460

		return -EINVAL;

   461

   462

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

   463

   464

	first_word = eeprom->offset >> 1;

   465

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

   466

   467

	eeprom_buff = kmalloc(sizeof(u16) *

   468

			(last_word - first_word + 1), GFP_KERNEL);

   469

	if (!eeprom_buff)

   470

		return -ENOMEM;

   471

   472

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

   473

		ret_val = e1000_read_nvm(hw, first_word,

   474

					 last_word - first_word + 1,

   475

					 eeprom_buff);

   476

	} else {

   477

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

   478

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

   479

						      &eeprom_buff[i]);

   480

			if (ret_val)

   481

				break;

   482

		}

   483

	}

   484

   485

	if (ret_val) {

   486

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

   487

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

   488

		       (last_word - first_word + 1));

   489

	} else {

   490

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

   491

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

   492

			le16_to_cpus(&eeprom_buff[i]);

   493

	}

   494

   495

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

   496

	kfree(eeprom_buff);

   497

   498

	return ret_val;

   499

}

   500

   501

static int e1000_set_eeprom(struct net_device *netdev,

   502

			    struct ethtool_eeprom *eeprom, u8 *bytes)

   503

{

   504

	struct e1000_adapter *adapter = netdev_priv(netdev);

   505

	struct e1000_hw *hw = &adapter->hw;

   506

	u16 *eeprom_buff;

   507

	void *ptr;

   508

	int max_len;

   509

	int first_word;

   510

	int last_word;

   511

	int ret_val = 0;

   512

	u16 i;

   513

   514

	if (eeprom->len == 0)

   515

		return -EOPNOTSUPP;

   516

   517

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

   518

		return -EFAULT;

   519

   520

	if (adapter->flags & FLAG_READ_ONLY_NVM)

   521

		return -EINVAL;

   522

   523

	max_len = hw->nvm.word_size * 2;

   524

   525

	first_word = eeprom->offset >> 1;

   526

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

   527

	eeprom_buff = kmalloc(max_len, GFP_KERNEL);

   528

	if (!eeprom_buff)

   529

		return -ENOMEM;

   530