1

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

     2

     3

  Intel PRO/1000 Linux driver

     4

  Copyright(c) 1999 - 2006 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 "e1000.h"

    32

#include <asm/uaccess.h>

    33

    34

enum {NETDEV_STATS, E1000_STATS};

    35

    36

struct e1000_stats {

    37

	char stat_string[ETH_GSTRING_LEN];

    38

	int type;

    39

	int sizeof_stat;

    40

	int stat_offset;

    41

};

    42

    43

#define E1000_STAT(m)		E1000_STATS, \

    44

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

    45

		      		offsetof(struct e1000_adapter, m)

    46

#define E1000_NETDEV_STAT(m)	NETDEV_STATS, \

    47

				sizeof(((struct net_device *)0)->m), \

    48

				offsetof(struct net_device, m)

    49

    50

static const struct e1000_stats e1000_gstrings_stats[] = {

    51

	{ "rx_packets", E1000_STAT(stats.gprc) },

    52

	{ "tx_packets", E1000_STAT(stats.gptc) },

    53

	{ "rx_bytes", E1000_STAT(stats.gorcl) },

    54

	{ "tx_bytes", E1000_STAT(stats.gotcl) },

    55

	{ "rx_broadcast", E1000_STAT(stats.bprc) },

    56

	{ "tx_broadcast", E1000_STAT(stats.bptc) },

    57

	{ "rx_multicast", E1000_STAT(stats.mprc) },

    58

	{ "tx_multicast", E1000_STAT(stats.mptc) },

    59

	{ "rx_errors", E1000_STAT(stats.rxerrc) },

    60

	{ "tx_errors", E1000_STAT(stats.txerrc) },

    61

	{ "tx_dropped", E1000_NETDEV_STAT(stats.tx_dropped) },

    62

	{ "multicast", E1000_STAT(stats.mprc) },

    63

	{ "collisions", E1000_STAT(stats.colc) },

    64

	{ "rx_length_errors", E1000_STAT(stats.rlerrc) },

    65

	{ "rx_over_errors", E1000_NETDEV_STAT(stats.rx_over_errors) },

    66

	{ "rx_crc_errors", E1000_STAT(stats.crcerrs) },

    67

	{ "rx_frame_errors", E1000_NETDEV_STAT(stats.rx_frame_errors) },

    68

	{ "rx_no_buffer_count", E1000_STAT(stats.rnbc) },

    69

	{ "rx_missed_errors", E1000_STAT(stats.mpc) },

    70

	{ "tx_aborted_errors", E1000_STAT(stats.ecol) },

    71

	{ "tx_carrier_errors", E1000_STAT(stats.tncrs) },

    72

	{ "tx_fifo_errors", E1000_NETDEV_STAT(stats.tx_fifo_errors) },

    73

	{ "tx_heartbeat_errors", E1000_NETDEV_STAT(stats.tx_heartbeat_errors) },

    74

	{ "tx_window_errors", E1000_STAT(stats.latecol) },

    75

	{ "tx_abort_late_coll", E1000_STAT(stats.latecol) },

    76

	{ "tx_deferred_ok", E1000_STAT(stats.dc) },

    77

	{ "tx_single_coll_ok", E1000_STAT(stats.scc) },

    78

	{ "tx_multi_coll_ok", E1000_STAT(stats.mcc) },

    79

	{ "tx_timeout_count", E1000_STAT(tx_timeout_count) },

    80

	{ "tx_restart_queue", E1000_STAT(restart_queue) },

    81

	{ "rx_long_length_errors", E1000_STAT(stats.roc) },

    82

	{ "rx_short_length_errors", E1000_STAT(stats.ruc) },

    83

	{ "rx_align_errors", E1000_STAT(stats.algnerrc) },

    84

	{ "tx_tcp_seg_good", E1000_STAT(stats.tsctc) },

    85

	{ "tx_tcp_seg_failed", E1000_STAT(stats.tsctfc) },

    86

	{ "rx_flow_control_xon", E1000_STAT(stats.xonrxc) },

    87

	{ "rx_flow_control_xoff", E1000_STAT(stats.xoffrxc) },

    88

	{ "tx_flow_control_xon", E1000_STAT(stats.xontxc) },

    89

	{ "tx_flow_control_xoff", E1000_STAT(stats.xofftxc) },

    90

	{ "rx_long_byte_count", E1000_STAT(stats.gorcl) },

    91

	{ "rx_csum_offload_good", E1000_STAT(hw_csum_good) },

    92

	{ "rx_csum_offload_errors", E1000_STAT(hw_csum_err) },

    93

	{ "alloc_rx_buff_failed", E1000_STAT(alloc_rx_buff_failed) },

    94

	{ "tx_smbus", E1000_STAT(stats.mgptc) },

    95

	{ "rx_smbus", E1000_STAT(stats.mgprc) },

    96

	{ "dropped_smbus", E1000_STAT(stats.mgpdc) },

    97

};

    98

    99

#define E1000_QUEUE_STATS_LEN 0

   100

#define E1000_GLOBAL_STATS_LEN ARRAY_SIZE(e1000_gstrings_stats)

   101

#define E1000_STATS_LEN (E1000_GLOBAL_STATS_LEN + E1000_QUEUE_STATS_LEN)

   102

static const char e1000_gstrings_test[][ETH_GSTRING_LEN] = {

   103

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

   104

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

   105

	"Link test   (on/offline)"

   106

};

   107

#define E1000_TEST_LEN	ARRAY_SIZE(e1000_gstrings_test)

   108

   109

static int e1000_get_settings(struct net_device *netdev,

   110

			      struct ethtool_cmd *ecmd)

   111

{

   112

	struct e1000_adapter *adapter = netdev_priv(netdev);

   113

	struct e1000_hw *hw = &adapter->hw;

   114

   115

	if (hw->media_type == e1000_media_type_copper) {

   116

   117

		ecmd->supported = (SUPPORTED_10baseT_Half |

   118

		                   SUPPORTED_10baseT_Full |

   119

		                   SUPPORTED_100baseT_Half |

   120

		                   SUPPORTED_100baseT_Full |

   121

		                   SUPPORTED_1000baseT_Full|

   122

		                   SUPPORTED_Autoneg |

   123

		                   SUPPORTED_TP);

   124

		ecmd->advertising = ADVERTISED_TP;

   125

   126

		if (hw->autoneg == 1) {

   127

			ecmd->advertising |= ADVERTISED_Autoneg;

   128

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

   129

			ecmd->advertising |= hw->autoneg_advertised;

   130

		}

   131

   132

		ecmd->port = PORT_TP;

   133

		ecmd->phy_address = hw->phy_addr;

   134

   135

		if (hw->mac_type == e1000_82543)

   136

			ecmd->transceiver = XCVR_EXTERNAL;

   137

		else

   138

			ecmd->transceiver = XCVR_INTERNAL;

   139

   140

	} else {

   141

		ecmd->supported   = (SUPPORTED_1000baseT_Full |

   142

				     SUPPORTED_FIBRE |

   143

				     SUPPORTED_Autoneg);

   144

   145

		ecmd->advertising = (ADVERTISED_1000baseT_Full |

   146

				     ADVERTISED_FIBRE |

   147

				     ADVERTISED_Autoneg);

   148

   149

		ecmd->port = PORT_FIBRE;

   150

   151

		if (hw->mac_type >= e1000_82545)

   152

			ecmd->transceiver = XCVR_INTERNAL;

   153

		else

   154

			ecmd->transceiver = XCVR_EXTERNAL;

   155

	}

   156

   157

	if (er32(STATUS) & E1000_STATUS_LU) {

   158

   159

		e1000_get_speed_and_duplex(hw, &adapter->link_speed,

   160

		                                   &adapter->link_duplex);

   161

		ethtool_cmd_speed_set(ecmd, adapter->link_speed);

   162

   163

		/* unfortunately FULL_DUPLEX != DUPLEX_FULL

   164

		 *          and HALF_DUPLEX != DUPLEX_HALF */

   165

   166

		if (adapter->link_duplex == FULL_DUPLEX)

   167

			ecmd->duplex = DUPLEX_FULL;

   168

		else

   169

			ecmd->duplex = DUPLEX_HALF;

   170

	} else {

   171

		ethtool_cmd_speed_set(ecmd, -1);

   172

		ecmd->duplex = -1;

   173

	}

   174

   175

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

   176

			 hw->autoneg) ? AUTONEG_ENABLE : AUTONEG_DISABLE;

   177

   178

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

   179

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

   180

	    netif_carrier_ok(netdev))

   181

		ecmd->eth_tp_mdix = (!!adapter->phy_info.mdix_mode ?

   182

							ETH_TP_MDI_X :

   183

							ETH_TP_MDI);

   184

	else

   185

		ecmd->eth_tp_mdix = ETH_TP_MDI_INVALID;

   186

   187

	if (hw->mdix == AUTO_ALL_MODES)

   188

		ecmd->eth_tp_mdix_ctrl = ETH_TP_MDI_AUTO;

   189

	else

   190

		ecmd->eth_tp_mdix_ctrl = hw->mdix;

   191

	return 0;

   192

}

   193

   194

static int e1000_set_settings(struct net_device *netdev,

   195

			      struct ethtool_cmd *ecmd)

   196

{

   197

	struct e1000_adapter *adapter = netdev_priv(netdev);

   198

	struct e1000_hw *hw = &adapter->hw;

   199

   200

	/*

   201

	 * MDI setting is only allowed when autoneg enabled because

   202

	 * some hardware doesn't allow MDI setting when speed or

   203

	 * duplex is forced.

   204

	 */

   205

	if (ecmd->eth_tp_mdix_ctrl) {

   206

		if (hw->media_type != e1000_media_type_copper)

   207

			return -EOPNOTSUPP;

   208

   209

		if ((ecmd->eth_tp_mdix_ctrl != ETH_TP_MDI_AUTO) &&

   210

		    (ecmd->autoneg != AUTONEG_ENABLE)) {

   211

			e_err(drv, "forcing MDI/MDI-X state is not supported when link speed and/or duplex are forced\n");

   212

			return -EINVAL;

   213

		}

   214

	}

   215

   216

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

   217

		msleep(1);

   218

   219

	if (ecmd->autoneg == AUTONEG_ENABLE) {

   220

		hw->autoneg = 1;

   221

		if (hw->media_type == e1000_media_type_fiber)

   222

			hw->autoneg_advertised = ADVERTISED_1000baseT_Full |

   223

				     ADVERTISED_FIBRE |

   224

				     ADVERTISED_Autoneg;

   225

		else

   226

			hw->autoneg_advertised = ecmd->advertising |

   227

			                         ADVERTISED_TP |

   228

			                         ADVERTISED_Autoneg;

   229

		ecmd->advertising = hw->autoneg_advertised;

   230

	} else {

   231

		u32 speed = ethtool_cmd_speed(ecmd);

   232

		/* calling this overrides forced MDI setting */

   233

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

   234

			clear_bit(__E1000_RESETTING, &adapter->flags);

   235

			return -EINVAL;

   236

		}

   237

	}

   238

   239

	/* MDI-X => 2; MDI => 1; Auto => 3 */

   240

	if (ecmd->eth_tp_mdix_ctrl) {

   241

		if (ecmd->eth_tp_mdix_ctrl == ETH_TP_MDI_AUTO)

   242

			hw->mdix = AUTO_ALL_MODES;

   243

		else

   244

			hw->mdix = ecmd->eth_tp_mdix_ctrl;

   245

	}

   246

   247

	/* reset the link */

   248

   249

	if (netif_running(adapter->netdev)) {

   250

		e1000_down(adapter);

   251

		e1000_up(adapter);

   252

	} else

   253

		e1000_reset(adapter);

   254

   255

	clear_bit(__E1000_RESETTING, &adapter->flags);

   256

	return 0;

   257

}

   258

   259

static u32 e1000_get_link(struct net_device *netdev)

   260

{

   261

	struct e1000_adapter *adapter = netdev_priv(netdev);

   262

   263

	/*

   264

	 * If the link is not reported up to netdev, interrupts are disabled,

   265

	 * and so the physical link state may have changed since we last

   266

	 * looked. Set get_link_status to make sure that the true link

   267

	 * state is interrogated, rather than pulling a cached and possibly

   268

	 * stale link state from the driver.

   269

	 */

   270

	if (!netif_carrier_ok(netdev))

   271

		adapter->hw.get_link_status = 1;

   272

   273

	return e1000_has_link(adapter);

   274

}

   275

   276

static void e1000_get_pauseparam(struct net_device *netdev,

   277

				 struct ethtool_pauseparam *pause)

   278

{

   279

	struct e1000_adapter *adapter = netdev_priv(netdev);

   280

	struct e1000_hw *hw = &adapter->hw;

   281

   282

	pause->autoneg =

   283

		(adapter->fc_autoneg ? AUTONEG_ENABLE : AUTONEG_DISABLE);

   284

   285

	if (hw->fc == E1000_FC_RX_PAUSE)

   286

		pause->rx_pause = 1;

   287

	else if (hw->fc == E1000_FC_TX_PAUSE)

   288

		pause->tx_pause = 1;

   289

	else if (hw->fc == E1000_FC_FULL) {

   290

		pause->rx_pause = 1;

   291

		pause->tx_pause = 1;

   292

	}

   293

}

   294

   295

static int e1000_set_pauseparam(struct net_device *netdev,

   296

				struct ethtool_pauseparam *pause)

   297

{

   298

	struct e1000_adapter *adapter = netdev_priv(netdev);

   299

	struct e1000_hw *hw = &adapter->hw;

   300

	int retval = 0;

   301

   302

	adapter->fc_autoneg = pause->autoneg;

   303

   304

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

   305

		msleep(1);

   306

   307

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

   308

		hw->fc = E1000_FC_FULL;

   309

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

   310

		hw->fc = E1000_FC_RX_PAUSE;

   311

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

   312

		hw->fc = E1000_FC_TX_PAUSE;

   313

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

   314

		hw->fc = E1000_FC_NONE;

   315

   316

	hw->original_fc = hw->fc;

   317

   318

	if (adapter->fc_autoneg == AUTONEG_ENABLE) {

   319

		if (netif_running(adapter->netdev)) {

   320

			e1000_down(adapter);

   321

			e1000_up(adapter);

   322

		} else

   323

			e1000_reset(adapter);

   324

	} else

   325

		retval = ((hw->media_type == e1000_media_type_fiber) ?

   326

			  e1000_setup_link(hw) : e1000_force_mac_fc(hw));

   327

   328

	clear_bit(__E1000_RESETTING, &adapter->flags);

   329

	return retval;

   330

}

   331

   332

static u32 e1000_get_msglevel(struct net_device *netdev)

   333

{

   334

	struct e1000_adapter *adapter = netdev_priv(netdev);

   335

	return adapter->msg_enable;

   336

}

   337

   338

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

   339

{

   340

	struct e1000_adapter *adapter = netdev_priv(netdev);

   341

	adapter->msg_enable = data;

   342

}

   343

   344

static int e1000_get_regs_len(struct net_device *netdev)

   345

{

   346

#define E1000_REGS_LEN 32

   347

	return E1000_REGS_LEN * sizeof(u32);

   348

}

   349

   350

static void e1000_get_regs(struct net_device *netdev, struct ethtool_regs *regs,

   351

			   void *p)

   352

{

   353

	struct e1000_adapter *adapter = netdev_priv(netdev);

   354

	struct e1000_hw *hw = &adapter->hw;

   355

	u32 *regs_buff = p;

   356

	u16 phy_data;

   357

   358

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

   359

   360

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

   361

   362

	regs_buff[0]  = er32(CTRL);

   363

	regs_buff[1]  = er32(STATUS);

   364

   365

	regs_buff[2]  = er32(RCTL);

   366

	regs_buff[3]  = er32(RDLEN);

   367

	regs_buff[4]  = er32(RDH);

   368

	regs_buff[5]  = er32(RDT);

   369

	regs_buff[6]  = er32(RDTR);

   370

   371

	regs_buff[7]  = er32(TCTL);

   372

	regs_buff[8]  = er32(TDLEN);

   373

	regs_buff[9]  = er32(TDH);

   374

	regs_buff[10] = er32(TDT);

   375

	regs_buff[11] = er32(TIDV);

   376

   377

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

   378

	if (hw->phy_type == e1000_phy_igp) {

   379

		e1000_write_phy_reg(hw, IGP01E1000_PHY_PAGE_SELECT,

   380

				    IGP01E1000_PHY_AGC_A);

   381

		e1000_read_phy_reg(hw, IGP01E1000_PHY_AGC_A &

   382

				   IGP01E1000_PHY_PAGE_SELECT, &phy_data);

   383

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

   384

		e1000_write_phy_reg(hw, IGP01E1000_PHY_PAGE_SELECT,

   385

				    IGP01E1000_PHY_AGC_B);

   386

		e1000_read_phy_reg(hw, IGP01E1000_PHY_AGC_B &

   387

				   IGP01E1000_PHY_PAGE_SELECT, &phy_data);

   388

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

   389

		e1000_write_phy_reg(hw, IGP01E1000_PHY_PAGE_SELECT,

   390

				    IGP01E1000_PHY_AGC_C);

   391

		e1000_read_phy_reg(hw, IGP01E1000_PHY_AGC_C &

   392

				   IGP01E1000_PHY_PAGE_SELECT, &phy_data);

   393

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

   394

		e1000_write_phy_reg(hw, IGP01E1000_PHY_PAGE_SELECT,

   395

				    IGP01E1000_PHY_AGC_D);

   396

		e1000_read_phy_reg(hw, IGP01E1000_PHY_AGC_D &

   397

				   IGP01E1000_PHY_PAGE_SELECT, &phy_data);

   398

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

   399

		regs_buff[17] = 0; /* extended 10bt distance (not needed) */

   400

		e1000_write_phy_reg(hw, IGP01E1000_PHY_PAGE_SELECT, 0x0);

   401

		e1000_read_phy_reg(hw, IGP01E1000_PHY_PORT_STATUS &

   402

				   IGP01E1000_PHY_PAGE_SELECT, &phy_data);

   403

		regs_buff[18] = (u32)phy_data; /* cable polarity */

   404

		e1000_write_phy_reg(hw, IGP01E1000_PHY_PAGE_SELECT,

   405

				    IGP01E1000_PHY_PCS_INIT_REG);

   406

		e1000_read_phy_reg(hw, IGP01E1000_PHY_PCS_INIT_REG &

   407

				   IGP01E1000_PHY_PAGE_SELECT, &phy_data);

   408

		regs_buff[19] = (u32)phy_data; /* cable polarity */

   409

		regs_buff[20] = 0; /* polarity correction enabled (always) */

   410

		regs_buff[22] = 0; /* phy receive errors (unavailable) */

   411

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

   412

		e1000_write_phy_reg(hw, IGP01E1000_PHY_PAGE_SELECT, 0x0);

   413

	} else {

   414

		e1000_read_phy_reg(hw, M88E1000_PHY_SPEC_STATUS, &phy_data);

   415

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

   416

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

   417

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

   418

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

   419

		e1000_read_phy_reg(hw, M88E1000_PHY_SPEC_CTRL, &phy_data);

   420

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

   421

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

   422

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

   423

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

   424

		/* phy receive errors */

   425

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

   426

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

   427

	}

   428

	regs_buff[21] = adapter->phy_stats.idle_errors;  /* phy idle errors */

   429

	e1000_read_phy_reg(hw, PHY_1000T_STATUS, &phy_data);

   430

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

   431

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

   432

	if (hw->mac_type >= e1000_82540 &&

   433

	    hw->media_type == e1000_media_type_copper) {

   434

		regs_buff[26] = er32(MANC);

   435

	}

   436

}

   437

   438

static int e1000_get_eeprom_len(struct net_device *netdev)

   439

{

   440

	struct e1000_adapter *adapter = netdev_priv(netdev);

   441

	struct e1000_hw *hw = &adapter->hw;

   442

   443

	return hw->eeprom.word_size * 2;

   444

}

   445

   446

static int e1000_get_eeprom(struct net_device *netdev,

   447

			    struct ethtool_eeprom *eeprom, u8 *bytes)

   448

{

   449

	struct e1000_adapter *adapter = netdev_priv(netdev);

   450

	struct e1000_hw *hw = &adapter->hw;

   451

	u16 *eeprom_buff;

   452

	int first_word, last_word;

   453

	int ret_val = 0;

   454

	u16 i;

   455

   456

	if (eeprom->len == 0)

   457

		return -EINVAL;

   458

   459

	eeprom->magic = hw->vendor_id | (hw->device_id << 16);

   460

   461

	first_word = eeprom->offset >> 1;

   462

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

   463

   464

	eeprom_buff = kmalloc(sizeof(u16) *

   465

			(last_word - first_word + 1), GFP_KERNEL);

   466

	if (!eeprom_buff)

   467

		return -ENOMEM;

   468

   469

	if (hw->eeprom.type == e1000_eeprom_spi)

   470

		ret_val = e1000_read_eeprom(hw, first_word,

   471

					    last_word - first_word + 1,

   472

					    eeprom_buff);

   473

	else {

   474

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

   475

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

   476

						    &eeprom_buff[i]);

   477

			if (ret_val)

   478

				break;

   479

		}

   480

	}

   481

   482

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

   483

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

   484

		le16_to_cpus(&eeprom_buff[i]);

   485

   486

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

   487

			eeprom->len);

   488

	kfree(eeprom_buff);

   489

   490

	return ret_val;

   491

}

   492

   493

static int e1000_set_eeprom(struct net_device *netdev,

   494

			    struct ethtool_eeprom *eeprom, u8 *bytes)

   495

{

   496

	struct e1000_adapter *adapter = netdev_priv(netdev);

   497

	struct e1000_hw *hw = &adapter->hw;

   498

	u16 *eeprom_buff;

   499

	void *ptr;

   500

	int max_len, first_word, last_word, ret_val = 0;

   501

	u16 i;

   502

   503

	if (eeprom->len == 0)

   504

		return -EOPNOTSUPP;

   505

   506

	if (eeprom->magic != (hw->vendor_id | (hw->device_id << 16)))

   507

		return -EFAULT;

   508

   509

	max_len = hw->eeprom.word_size * 2;

   510

   511

	first_word = eeprom->offset >> 1;

   512

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

   513

	eeprom_buff = kmalloc(max_len, GFP_KERNEL);

   514

	if (!eeprom_buff)

   515

		return -ENOMEM;

   516

   517

	ptr = (void *)eeprom_buff;

   518

   519

	if (eeprom->offset & 1) {

   520

		/* need read/modify/write of first changed EEPROM word */

   521

		/* only the second byte of the word is being modified */

   522

		ret_val = e1000_read_eeprom(hw, first_word, 1,

   523

					    &eeprom_buff[0]);

   524

		ptr++;

   525

	}

   526

	if (((eeprom->offset + eeprom->len) & 1) && (ret_val == 0)) {

   527

		/* need read/modify/write of last changed EEPROM word */

   528

		/* only the first byte of the word is being modified */

   529

		ret_val = e1000_read_eeprom(hw, last_word, 1,

   530