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-2.6.33-ethercat.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

		ecmd->speed = adapter->link_speed;

   162

   163

		/* unfortunatly 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

		ecmd->speed = -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

	return 0;

   178

}

   179

   180

static int e1000_set_settings(struct net_device *netdev,

   181

			      struct ethtool_cmd *ecmd)

   182

{

   183

	struct e1000_adapter *adapter = netdev_priv(netdev);

   184

	struct e1000_hw *hw = &adapter->hw;

   185

   186

	if (adapter->ecdev)

   187

		return -EBUSY;

   188

   189

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

   190

		msleep(1);

   191

   192

	if (ecmd->autoneg == AUTONEG_ENABLE) {

   193

		hw->autoneg = 1;

   194

		if (hw->media_type == e1000_media_type_fiber)

   195

			hw->autoneg_advertised = ADVERTISED_1000baseT_Full |

   196

				     ADVERTISED_FIBRE |

   197

				     ADVERTISED_Autoneg;

   198

		else

   199

			hw->autoneg_advertised = ecmd->advertising |

   200

			                         ADVERTISED_TP |

   201

			                         ADVERTISED_Autoneg;

   202

		ecmd->advertising = hw->autoneg_advertised;

   203

	} else

   204

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

   205

			clear_bit(__E1000_RESETTING, &adapter->flags);

   206

			return -EINVAL;

   207

		}

   208

   209

	/* reset the link */

   210

   211

	if (netif_running(adapter->netdev)) {

   212

		e1000_down(adapter);

   213

		e1000_up(adapter);

   214

	} else

   215

		e1000_reset(adapter);

   216

   217

	clear_bit(__E1000_RESETTING, &adapter->flags);

   218

	return 0;

   219

}

   220

   221

static void e1000_get_pauseparam(struct net_device *netdev,

   222

				 struct ethtool_pauseparam *pause)

   223

{

   224

	struct e1000_adapter *adapter = netdev_priv(netdev);

   225

	struct e1000_hw *hw = &adapter->hw;

   226

   227

	pause->autoneg =

   228

		(adapter->fc_autoneg ? AUTONEG_ENABLE : AUTONEG_DISABLE);

   229

   230

	if (hw->fc == E1000_FC_RX_PAUSE)

   231

		pause->rx_pause = 1;

   232

	else if (hw->fc == E1000_FC_TX_PAUSE)

   233

		pause->tx_pause = 1;

   234

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

   235

		pause->rx_pause = 1;

   236

		pause->tx_pause = 1;

   237

	}

   238

}

   239

   240

static int e1000_set_pauseparam(struct net_device *netdev,

   241

				struct ethtool_pauseparam *pause)

   242

{

   243

	struct e1000_adapter *adapter = netdev_priv(netdev);

   244

	struct e1000_hw *hw = &adapter->hw;

   245

	int retval = 0;

   246

   247

	if (adapter->ecdev)

   248

		return -EBUSY;

   249

   250

	adapter->fc_autoneg = pause->autoneg;

   251

   252

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

   253

		msleep(1);

   254

   255

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

   256

		hw->fc = E1000_FC_FULL;

   257

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

   258

		hw->fc = E1000_FC_RX_PAUSE;

   259

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

   260

		hw->fc = E1000_FC_TX_PAUSE;

   261

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

   262

		hw->fc = E1000_FC_NONE;

   263

   264

	hw->original_fc = hw->fc;

   265

   266

	if (adapter->fc_autoneg == AUTONEG_ENABLE) {

   267

		if (netif_running(adapter->netdev)) {

   268

			e1000_down(adapter);

   269

			e1000_up(adapter);

   270

		} else

   271

			e1000_reset(adapter);

   272

	} else

   273

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

   274

			  e1000_setup_link(hw) : e1000_force_mac_fc(hw));

   275

   276

	clear_bit(__E1000_RESETTING, &adapter->flags);

   277

	return retval;

   278

}

   279

   280

static u32 e1000_get_rx_csum(struct net_device *netdev)

   281

{

   282

	struct e1000_adapter *adapter = netdev_priv(netdev);

   283

	return adapter->rx_csum;

   284

}

   285

   286

static int e1000_set_rx_csum(struct net_device *netdev, u32 data)

   287

{

   288

	struct e1000_adapter *adapter = netdev_priv(netdev);

   289

   290

	if (adapter->ecdev)

   291

		return -EBUSY;

   292

   293

	adapter->rx_csum = data;

   294

   295

	if (netif_running(netdev))

   296

		e1000_reinit_locked(adapter);

   297

	else

   298

		e1000_reset(adapter);

   299

	return 0;

   300

}

   301

   302

static u32 e1000_get_tx_csum(struct net_device *netdev)

   303

{

   304

	return (netdev->features & NETIF_F_HW_CSUM) != 0;

   305

}

   306

   307

static int e1000_set_tx_csum(struct net_device *netdev, u32 data)

   308

{

   309

	struct e1000_adapter *adapter = netdev_priv(netdev);

   310

	struct e1000_hw *hw = &adapter->hw;

   311

   312

	if (hw->mac_type < e1000_82543) {

   313

		if (!data)

   314

			return -EINVAL;

   315

		return 0;

   316

	}

   317

   318

	if (data)

   319

		netdev->features |= NETIF_F_HW_CSUM;

   320

	else

   321

		netdev->features &= ~NETIF_F_HW_CSUM;

   322

   323

	return 0;

   324

}

   325

   326

static int e1000_set_tso(struct net_device *netdev, u32 data)

   327

{

   328

	struct e1000_adapter *adapter = netdev_priv(netdev);

   329

	struct e1000_hw *hw = &adapter->hw;

   330

   331

	if ((hw->mac_type < e1000_82544) ||

   332

	    (hw->mac_type == e1000_82547))

   333

		return data ? -EINVAL : 0;

   334

   335

	if (data)

   336

		netdev->features |= NETIF_F_TSO;

   337

	else

   338

		netdev->features &= ~NETIF_F_TSO;

   339

   340

	netdev->features &= ~NETIF_F_TSO6;

   341

   342

	DPRINTK(PROBE, INFO, "TSO is %s\n", data ? "Enabled" : "Disabled");

   343

	adapter->tso_force = true;

   344

	return 0;

   345

}

   346

   347

static u32 e1000_get_msglevel(struct net_device *netdev)

   348

{

   349

	struct e1000_adapter *adapter = netdev_priv(netdev);

   350

	return adapter->msg_enable;

   351

}

   352

   353

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

   354

{

   355

	struct e1000_adapter *adapter = netdev_priv(netdev);

   356

	adapter->msg_enable = data;

   357

}

   358

   359

static int e1000_get_regs_len(struct net_device *netdev)

   360

{

   361

#define E1000_REGS_LEN 32

   362

	return E1000_REGS_LEN * sizeof(u32);

   363

}

   364

   365

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

   366

			   void *p)

   367

{

   368

	struct e1000_adapter *adapter = netdev_priv(netdev);

   369

	struct e1000_hw *hw = &adapter->hw;

   370

	u32 *regs_buff = p;

   371

	u16 phy_data;

   372

   373

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

   374

   375

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

   376

   377

	regs_buff[0]  = er32(CTRL);

   378

	regs_buff[1]  = er32(STATUS);

   379

   380

	regs_buff[2]  = er32(RCTL);

   381

	regs_buff[3]  = er32(RDLEN);

   382

	regs_buff[4]  = er32(RDH);

   383

	regs_buff[5]  = er32(RDT);

   384

	regs_buff[6]  = er32(RDTR);

   385

   386

	regs_buff[7]  = er32(TCTL);

   387

	regs_buff[8]  = er32(TDLEN);

   388

	regs_buff[9]  = er32(TDH);

   389

	regs_buff[10] = er32(TDT);

   390

	regs_buff[11] = er32(TIDV);

   391

   392

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

   393

	if (hw->phy_type == e1000_phy_igp) {

   394

		e1000_write_phy_reg(hw, IGP01E1000_PHY_PAGE_SELECT,

   395

				    IGP01E1000_PHY_AGC_A);

   396

		e1000_read_phy_reg(hw, IGP01E1000_PHY_AGC_A &

   397

				   IGP01E1000_PHY_PAGE_SELECT, &phy_data);

   398

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

   399

		e1000_write_phy_reg(hw, IGP01E1000_PHY_PAGE_SELECT,

   400

				    IGP01E1000_PHY_AGC_B);

   401

		e1000_read_phy_reg(hw, IGP01E1000_PHY_AGC_B &

   402

				   IGP01E1000_PHY_PAGE_SELECT, &phy_data);

   403

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

   404

		e1000_write_phy_reg(hw, IGP01E1000_PHY_PAGE_SELECT,

   405

				    IGP01E1000_PHY_AGC_C);

   406

		e1000_read_phy_reg(hw, IGP01E1000_PHY_AGC_C &

   407

				   IGP01E1000_PHY_PAGE_SELECT, &phy_data);

   408

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

   409

		e1000_write_phy_reg(hw, IGP01E1000_PHY_PAGE_SELECT,

   410

				    IGP01E1000_PHY_AGC_D);

   411

		e1000_read_phy_reg(hw, IGP01E1000_PHY_AGC_D &

   412

				   IGP01E1000_PHY_PAGE_SELECT, &phy_data);

   413

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

   414

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

   415

		e1000_write_phy_reg(hw, IGP01E1000_PHY_PAGE_SELECT, 0x0);

   416

		e1000_read_phy_reg(hw, IGP01E1000_PHY_PORT_STATUS &

   417

				   IGP01E1000_PHY_PAGE_SELECT, &phy_data);

   418

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

   419

		e1000_write_phy_reg(hw, IGP01E1000_PHY_PAGE_SELECT,

   420

				    IGP01E1000_PHY_PCS_INIT_REG);

   421

		e1000_read_phy_reg(hw, IGP01E1000_PHY_PCS_INIT_REG &

   422

				   IGP01E1000_PHY_PAGE_SELECT, &phy_data);

   423

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

   424

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

   425

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

   426

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

   427

		e1000_write_phy_reg(hw, IGP01E1000_PHY_PAGE_SELECT, 0x0);

   428

	} else {

   429

		e1000_read_phy_reg(hw, M88E1000_PHY_SPEC_STATUS, &phy_data);

   430

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

   431

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

   432

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

   433

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

   434

		e1000_read_phy_reg(hw, M88E1000_PHY_SPEC_CTRL, &phy_data);

   435

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

   436

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

   437

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

   438

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

   439

		/* phy receive errors */

   440

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

   441

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

   442

	}

   443

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

   444

	e1000_read_phy_reg(hw, PHY_1000T_STATUS, &phy_data);

   445

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

   446

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

   447

	if (hw->mac_type >= e1000_82540 &&

   448

	    hw->media_type == e1000_media_type_copper) {

   449

		regs_buff[26] = er32(MANC);

   450

	}

   451

}

   452

   453

static int e1000_get_eeprom_len(struct net_device *netdev)

   454

{

   455

	struct e1000_adapter *adapter = netdev_priv(netdev);

   456

	struct e1000_hw *hw = &adapter->hw;

   457

   458

	return hw->eeprom.word_size * 2;

   459

}

   460

   461

static int e1000_get_eeprom(struct net_device *netdev,

   462

			    struct ethtool_eeprom *eeprom, u8 *bytes)

   463

{

   464

	struct e1000_adapter *adapter = netdev_priv(netdev);

   465

	struct e1000_hw *hw = &adapter->hw;

   466

	u16 *eeprom_buff;

   467

	int first_word, last_word;

   468

	int ret_val = 0;

   469

	u16 i;

   470

   471

	if (eeprom->len == 0)

   472

		return -EINVAL;

   473

   474

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

   475

   476

	first_word = eeprom->offset >> 1;

   477

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

   478

   479

	eeprom_buff = kmalloc(sizeof(u16) *

   480

			(last_word - first_word + 1), GFP_KERNEL);

   481

	if (!eeprom_buff)

   482

		return -ENOMEM;

   483

   484

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

   485

		ret_val = e1000_read_eeprom(hw, first_word,

   486

					    last_word - first_word + 1,

   487

					    eeprom_buff);

   488

	else {

   489

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

   490

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

   491

						    &eeprom_buff[i]);

   492

			if (ret_val)

   493

				break;

   494

		}

   495

	}

   496

   497

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

   498

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

   499

		le16_to_cpus(&eeprom_buff[i]);

   500

   501

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

   502

			eeprom->len);

   503

	kfree(eeprom_buff);

   504

   505

	return ret_val;

   506

}

   507

   508

static int e1000_set_eeprom(struct net_device *netdev,

   509

			    struct ethtool_eeprom *eeprom, u8 *bytes)

   510

{

   511

	struct e1000_adapter *adapter = netdev_priv(netdev);

   512

	struct e1000_hw *hw = &adapter->hw;

   513

	u16 *eeprom_buff;

   514

	void *ptr;

   515

	int max_len, first_word, last_word, ret_val = 0;

   516

	u16 i;

   517

   518

	if (eeprom->len == 0)

   519

		return -EOPNOTSUPP;

   520

   521

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

   522

		return -EFAULT;

   523

   524

	max_len = hw->eeprom.word_size * 2;

   525

   526

	first_word = eeprom->offset >> 1;

   527

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

   528

	eeprom_buff = kmalloc(max_len, GFP_KERNEL);

   529

	if (!eeprom_buff)

   530

		return -ENOMEM;