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.24-ethercat.h"

    32

    33

#include <asm/uaccess.h>

    34

    35

extern int e1000_up(struct e1000_adapter *adapter);

    36

extern void e1000_down(struct e1000_adapter *adapter);

    37

extern void e1000_reinit_locked(struct e1000_adapter *adapter);

    38

extern void e1000_reset(struct e1000_adapter *adapter);

    39

extern int e1000_set_spd_dplx(struct e1000_adapter *adapter, uint16_t spddplx);

    40

extern int e1000_setup_all_rx_resources(struct e1000_adapter *adapter);

    41

extern int e1000_setup_all_tx_resources(struct e1000_adapter *adapter);

    42

extern void e1000_free_all_rx_resources(struct e1000_adapter *adapter);

    43

extern void e1000_free_all_tx_resources(struct e1000_adapter *adapter);

    44

extern void e1000_update_stats(struct e1000_adapter *adapter);

    45

    46

    47

struct e1000_stats {

    48

	char stat_string[ETH_GSTRING_LEN];

    49

	int sizeof_stat;

    50

	int stat_offset;

    51

};

    52

    53

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

    54

		      offsetof(struct e1000_adapter, m)

    55

static const struct e1000_stats e1000_gstrings_stats[] = {

    56

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

    57

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

    58

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

    59

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

    60

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

    61

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

    62

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

    63

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

    64

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

    65

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

    66

	{ "tx_dropped", E1000_STAT(net_stats.tx_dropped) },

    67

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

    68

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

    69

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

    70

	{ "rx_over_errors", E1000_STAT(net_stats.rx_over_errors) },

    71

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

    72

	{ "rx_frame_errors", E1000_STAT(net_stats.rx_frame_errors) },

    73

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

    74

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

    75

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

    76

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

    77

	{ "tx_fifo_errors", E1000_STAT(net_stats.tx_fifo_errors) },

    78

	{ "tx_heartbeat_errors", E1000_STAT(net_stats.tx_heartbeat_errors) },

    79

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

    80

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

    81

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

    82

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

    83

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

    84

	{ "tx_timeout_count", E1000_STAT(tx_timeout_count) },

    85

	{ "tx_restart_queue", E1000_STAT(restart_queue) },

    86

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

    87

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

    88

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

    89

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

    90

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

    91

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

    92

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

    93

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

    94

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

    95

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

    96

	{ "rx_csum_offload_good", E1000_STAT(hw_csum_good) },

    97

	{ "rx_csum_offload_errors", E1000_STAT(hw_csum_err) },

    98

	{ "rx_header_split", E1000_STAT(rx_hdr_split) },

    99

	{ "alloc_rx_buff_failed", E1000_STAT(alloc_rx_buff_failed) },

   100

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

   101

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

   102

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

   103

};

   104

   105

#define E1000_QUEUE_STATS_LEN 0

   106

#define E1000_GLOBAL_STATS_LEN ARRAY_SIZE(e1000_gstrings_stats)

   107

#define E1000_STATS_LEN (E1000_GLOBAL_STATS_LEN + E1000_QUEUE_STATS_LEN)

   108

static const char e1000_gstrings_test[][ETH_GSTRING_LEN] = {

   109

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

   110

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

   111

	"Link test   (on/offline)"

   112

};

   113

#define E1000_TEST_LEN sizeof(e1000_gstrings_test) / ETH_GSTRING_LEN

   114

   115

static int

   116

e1000_get_settings(struct net_device *netdev, struct ethtool_cmd *ecmd)

   117

{

   118

	struct e1000_adapter *adapter = netdev_priv(netdev);

   119

	struct e1000_hw *hw = &adapter->hw;

   120

   121

	if (hw->media_type == e1000_media_type_copper) {

   122

   123

		ecmd->supported = (SUPPORTED_10baseT_Half |

   124

		                   SUPPORTED_10baseT_Full |

   125

		                   SUPPORTED_100baseT_Half |

   126

		                   SUPPORTED_100baseT_Full |

   127

		                   SUPPORTED_1000baseT_Full|

   128

		                   SUPPORTED_Autoneg |

   129

		                   SUPPORTED_TP);

   130

		if (hw->phy_type == e1000_phy_ife)

   131

			ecmd->supported &= ~SUPPORTED_1000baseT_Full;

   132

		ecmd->advertising = ADVERTISED_TP;

   133

   134

		if (hw->autoneg == 1) {

   135

			ecmd->advertising |= ADVERTISED_Autoneg;

   136

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

   137

			ecmd->advertising |= hw->autoneg_advertised;

   138

		}

   139

   140

		ecmd->port = PORT_TP;

   141

		ecmd->phy_address = hw->phy_addr;

   142

   143

		if (hw->mac_type == e1000_82543)

   144

			ecmd->transceiver = XCVR_EXTERNAL;

   145

		else

   146

			ecmd->transceiver = XCVR_INTERNAL;

   147

   148

	} else {

   149

		ecmd->supported   = (SUPPORTED_1000baseT_Full |

   150

				     SUPPORTED_FIBRE |

   151

				     SUPPORTED_Autoneg);

   152

   153

		ecmd->advertising = (ADVERTISED_1000baseT_Full |

   154

				     ADVERTISED_FIBRE |

   155

				     ADVERTISED_Autoneg);

   156

   157

		ecmd->port = PORT_FIBRE;

   158

   159

		if (hw->mac_type >= e1000_82545)

   160

			ecmd->transceiver = XCVR_INTERNAL;

   161

		else

   162

			ecmd->transceiver = XCVR_EXTERNAL;

   163

	}

   164

   165

	if ((adapter->ecdev && ecdev_get_link(adapter->ecdev))

   166

            || (!adapter->ecdev && (E1000_READ_REG(&adapter->hw, STATUS) & E1000_STATUS_LU))) {

   167

   168

		e1000_get_speed_and_duplex(hw, &adapter->link_speed,

   169

		                                   &adapter->link_duplex);

   170

		ecmd->speed = adapter->link_speed;

   171

   172

		/* unfortunatly FULL_DUPLEX != DUPLEX_FULL

   173

		 *          and HALF_DUPLEX != DUPLEX_HALF */

   174

   175

		if (adapter->link_duplex == FULL_DUPLEX)

   176

			ecmd->duplex = DUPLEX_FULL;

   177

		else

   178

			ecmd->duplex = DUPLEX_HALF;

   179

	} else {

   180

		ecmd->speed = -1;

   181

		ecmd->duplex = -1;

   182

	}

   183

   184

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

   185

			 hw->autoneg) ? AUTONEG_ENABLE : AUTONEG_DISABLE;

   186

	return 0;

   187

}

   188

   189

static int

   190

e1000_set_settings(struct net_device *netdev, struct ethtool_cmd *ecmd)

   191

{

   192

	struct e1000_adapter *adapter = netdev_priv(netdev);

   193

	struct e1000_hw *hw = &adapter->hw;

   194

   195

	if (adapter->ecdev)

   196

		return -EBUSY;

   197

   198

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

   199

	 * cannot be changed */

   200

	if (e1000_check_phy_reset_block(hw)) {

   201

		DPRINTK(DRV, ERR, "Cannot change link characteristics "

   202

		        "when SoL/IDER is active.\n");

   203

		return -EINVAL;

   204

	}

   205

   206

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

   207

		msleep(1);

   208

   209

	if (ecmd->autoneg == AUTONEG_ENABLE) {

   210

		hw->autoneg = 1;

   211

		if (hw->media_type == e1000_media_type_fiber)

   212

			hw->autoneg_advertised = ADVERTISED_1000baseT_Full |

   213

				     ADVERTISED_FIBRE |

   214

				     ADVERTISED_Autoneg;

   215

		else

   216

			hw->autoneg_advertised = ecmd->advertising |

   217

			                         ADVERTISED_TP |

   218

			                         ADVERTISED_Autoneg;

   219

		ecmd->advertising = hw->autoneg_advertised;

   220

	} else

   221

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

   222

			clear_bit(__E1000_RESETTING, &adapter->flags);

   223

			return -EINVAL;

   224

		}

   225

   226

	/* reset the link */

   227

   228

	if (netif_running(adapter->netdev)) {

   229

		e1000_down(adapter);

   230

		e1000_up(adapter);

   231

	} else

   232

		e1000_reset(adapter);

   233

   234

	clear_bit(__E1000_RESETTING, &adapter->flags);

   235

	return 0;

   236

}

   237

   238

static void

   239

e1000_get_pauseparam(struct net_device *netdev,

   240

                     struct ethtool_pauseparam *pause)

   241

{

   242

	struct e1000_adapter *adapter = netdev_priv(netdev);

   243

	struct e1000_hw *hw = &adapter->hw;

   244

   245

	pause->autoneg =

   246

		(adapter->fc_autoneg ? AUTONEG_ENABLE : AUTONEG_DISABLE);

   247

   248

	if (hw->fc == E1000_FC_RX_PAUSE)

   249

		pause->rx_pause = 1;

   250

	else if (hw->fc == E1000_FC_TX_PAUSE)

   251

		pause->tx_pause = 1;

   252

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

   253

		pause->rx_pause = 1;

   254

		pause->tx_pause = 1;

   255

	}

   256

}

   257

   258

static int

   259

e1000_set_pauseparam(struct net_device *netdev,

   260

                     struct ethtool_pauseparam *pause)

   261

{

   262

	struct e1000_adapter *adapter = netdev_priv(netdev);

   263

	struct e1000_hw *hw = &adapter->hw;

   264

	int retval = 0;

   265

   266

	if (adapter->ecdev)

   267

		return -EBUSY;

   268

   269

	adapter->fc_autoneg = pause->autoneg;

   270

   271

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

   272

		msleep(1);

   273

   274

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

   275

		hw->fc = E1000_FC_FULL;

   276

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

   277

		hw->fc = E1000_FC_RX_PAUSE;

   278

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

   279

		hw->fc = E1000_FC_TX_PAUSE;

   280

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

   281

		hw->fc = E1000_FC_NONE;

   282

   283

	hw->original_fc = hw->fc;

   284

   285

	if (adapter->fc_autoneg == AUTONEG_ENABLE) {

   286

		if (netif_running(adapter->netdev)) {

   287

			e1000_down(adapter);

   288

			e1000_up(adapter);

   289

		} else

   290

			e1000_reset(adapter);

   291

	} else

   292

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

   293

			  e1000_setup_link(hw) : e1000_force_mac_fc(hw));

   294

   295

	clear_bit(__E1000_RESETTING, &adapter->flags);

   296

	return retval;

   297

}

   298

   299

static uint32_t

   300

e1000_get_rx_csum(struct net_device *netdev)

   301

{

   302

	struct e1000_adapter *adapter = netdev_priv(netdev);

   303

	return adapter->rx_csum;

   304

}

   305

   306

static int

   307

e1000_set_rx_csum(struct net_device *netdev, uint32_t data)

   308

{

   309

	struct e1000_adapter *adapter = netdev_priv(netdev);

   310

   311

	if (adapter->ecdev)

   312

		return -EBUSY;

   313

   314

	adapter->rx_csum = data;

   315

   316

	if (netif_running(netdev))

   317

		e1000_reinit_locked(adapter);

   318

	else

   319

		e1000_reset(adapter);

   320

	return 0;

   321

}

   322

   323

static uint32_t

   324

e1000_get_tx_csum(struct net_device *netdev)

   325

{

   326

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

   327

}

   328

   329

static int

   330

e1000_set_tx_csum(struct net_device *netdev, uint32_t data)

   331

{

   332

	struct e1000_adapter *adapter = netdev_priv(netdev);

   333

   334

	if (adapter->hw.mac_type < e1000_82543) {

   335

		if (!data)

   336

			return -EINVAL;

   337

		return 0;

   338

	}

   339

   340

	if (data)

   341

		netdev->features |= NETIF_F_HW_CSUM;

   342

	else

   343

		netdev->features &= ~NETIF_F_HW_CSUM;

   344

   345

	return 0;

   346

}

   347

   348

static int

   349

e1000_set_tso(struct net_device *netdev, uint32_t data)

   350

{

   351

	struct e1000_adapter *adapter = netdev_priv(netdev);

   352

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

   353

	    (adapter->hw.mac_type == e1000_82547))

   354

		return data ? -EINVAL : 0;

   355

   356

	if (data)

   357

		netdev->features |= NETIF_F_TSO;

   358

	else

   359

		netdev->features &= ~NETIF_F_TSO;

   360

   361

	if (data)

   362

		netdev->features |= NETIF_F_TSO6;

   363

	else

   364

		netdev->features &= ~NETIF_F_TSO6;

   365

   366

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

   367

	adapter->tso_force = TRUE;

   368

	return 0;

   369

}

   370

   371

static uint32_t

   372

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

   379

e1000_set_msglevel(struct net_device *netdev, uint32_t data)

   380

{

   381

	struct e1000_adapter *adapter = netdev_priv(netdev);

   382

	adapter->msg_enable = data;

   383

}

   384

   385

static int

   386

e1000_get_regs_len(struct net_device *netdev)

   387

{

   388

#define E1000_REGS_LEN 32

   389

	return E1000_REGS_LEN * sizeof(uint32_t);

   390

}

   391

   392

static void

   393

e1000_get_regs(struct net_device *netdev,

   394

	       struct ethtool_regs *regs, void *p)

   395

{

   396

	struct e1000_adapter *adapter = netdev_priv(netdev);

   397

	struct e1000_hw *hw = &adapter->hw;

   398

	uint32_t *regs_buff = p;

   399

	uint16_t phy_data;

   400

   401

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

   402

   403

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

   404

   405

	regs_buff[0]  = E1000_READ_REG(hw, CTRL);

   406

	regs_buff[1]  = E1000_READ_REG(hw, STATUS);

   407

   408

	regs_buff[2]  = E1000_READ_REG(hw, RCTL);

   409

	regs_buff[3]  = E1000_READ_REG(hw, RDLEN);

   410

	regs_buff[4]  = E1000_READ_REG(hw, RDH);

   411

	regs_buff[5]  = E1000_READ_REG(hw, RDT);

   412

	regs_buff[6]  = E1000_READ_REG(hw, RDTR);

   413

   414

	regs_buff[7]  = E1000_READ_REG(hw, TCTL);

   415

	regs_buff[8]  = E1000_READ_REG(hw, TDLEN);

   416

	regs_buff[9]  = E1000_READ_REG(hw, TDH);

   417

	regs_buff[10] = E1000_READ_REG(hw, TDT);

   418

	regs_buff[11] = E1000_READ_REG(hw, TIDV);

   419

   420

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

   421

	if (hw->phy_type == e1000_phy_igp) {

   422

		e1000_write_phy_reg(hw, IGP01E1000_PHY_PAGE_SELECT,

   423

				    IGP01E1000_PHY_AGC_A);

   424

		e1000_read_phy_reg(hw, IGP01E1000_PHY_AGC_A &

   425

				   IGP01E1000_PHY_PAGE_SELECT, &phy_data);

   426

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

   427

		e1000_write_phy_reg(hw, IGP01E1000_PHY_PAGE_SELECT,

   428

				    IGP01E1000_PHY_AGC_B);

   429

		e1000_read_phy_reg(hw, IGP01E1000_PHY_AGC_B &

   430

				   IGP01E1000_PHY_PAGE_SELECT, &phy_data);

   431

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

   432

		e1000_write_phy_reg(hw, IGP01E1000_PHY_PAGE_SELECT,

   433

				    IGP01E1000_PHY_AGC_C);

   434

		e1000_read_phy_reg(hw, IGP01E1000_PHY_AGC_C &

   435

				   IGP01E1000_PHY_PAGE_SELECT, &phy_data);

   436

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

   437

		e1000_write_phy_reg(hw, IGP01E1000_PHY_PAGE_SELECT,

   438

				    IGP01E1000_PHY_AGC_D);

   439

		e1000_read_phy_reg(hw, IGP01E1000_PHY_AGC_D &

   440

				   IGP01E1000_PHY_PAGE_SELECT, &phy_data);

   441

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

   442

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

   443

		e1000_write_phy_reg(hw, IGP01E1000_PHY_PAGE_SELECT, 0x0);

   444

		e1000_read_phy_reg(hw, IGP01E1000_PHY_PORT_STATUS &

   445

				   IGP01E1000_PHY_PAGE_SELECT, &phy_data);

   446

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

   447

		e1000_write_phy_reg(hw, IGP01E1000_PHY_PAGE_SELECT,

   448

				    IGP01E1000_PHY_PCS_INIT_REG);

   449

		e1000_read_phy_reg(hw, IGP01E1000_PHY_PCS_INIT_REG &

   450

				   IGP01E1000_PHY_PAGE_SELECT, &phy_data);

   451

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

   452

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

   453

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

   454

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

   455

		e1000_write_phy_reg(hw, IGP01E1000_PHY_PAGE_SELECT, 0x0);

   456

	} else {

   457

		e1000_read_phy_reg(hw, M88E1000_PHY_SPEC_STATUS, &phy_data);

   458

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

   459

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

   460

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

   461

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

   462

		e1000_read_phy_reg(hw, M88E1000_PHY_SPEC_CTRL, &phy_data);

   463

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

   464

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

   465

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

   466

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

   467

		/* phy receive errors */

   468

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

   469

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

   470

	}

   471

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

   472

	e1000_read_phy_reg(hw, PHY_1000T_STATUS, &phy_data);

   473

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

   474

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

   475

	if (hw->mac_type >= e1000_82540 &&

   476

	    hw->mac_type < e1000_82571 &&

   477

	    hw->media_type == e1000_media_type_copper) {

   478

		regs_buff[26] = E1000_READ_REG(hw, MANC);

   479

	}

   480

}

   481

   482

static int

   483

e1000_get_eeprom_len(struct net_device *netdev)

   484

{

   485

	struct e1000_adapter *adapter = netdev_priv(netdev);

   486

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

   487

}

   488

   489

static int

   490

e1000_get_eeprom(struct net_device *netdev,

   491

                      struct ethtool_eeprom *eeprom, uint8_t *bytes)

   492

{

   493

	struct e1000_adapter *adapter = netdev_priv(netdev);

   494

	struct e1000_hw *hw = &adapter->hw;

   495

	uint16_t *eeprom_buff;

   496

	int first_word, last_word;

   497

	int ret_val = 0;

   498

	uint16_t i;

   499

   500

	if (eeprom->len == 0)

   501

		return -EINVAL;

   502

   503

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

   504

   505

	first_word = eeprom->offset >> 1;

   506

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

   507

   508

	eeprom_buff = kmalloc(sizeof(uint16_t) *

   509

			(last_word - first_word + 1), GFP_KERNEL);

   510

	if (!eeprom_buff)

   511

		return -ENOMEM;

   512

   513

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

   514

		ret_val = e1000_read_eeprom(hw, first_word,

   515

					    last_word - first_word + 1,

   516

					    eeprom_buff);

   517

	else {

   518

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

   519

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

   520

							&eeprom_buff[i])))

   521

				break;

   522

	}

   523

   524

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

   525

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

   526

		le16_to_cpus(&eeprom_buff[i]);

   527

   528

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

   529

			eeprom->len);

   530

	kfree(eeprom_buff);