3017 lines
92 KiB
C
3017 lines
92 KiB
C
|
/**************************************************************************
|
||
|
Inter Pro 1000 for ppcboot/das-u-boot
|
||
|
Drivers are port from Intel's Linux driver e1000-4.3.15
|
||
|
and from Etherboot pro 1000 driver by mrakes at vivato dot net
|
||
|
tested on both gig copper and gig fiber boards
|
||
|
***************************************************************************/
|
||
|
/*******************************************************************************
|
||
|
|
||
|
|
||
|
Copyright(c) 1999 - 2002 Intel Corporation. All rights reserved.
|
||
|
|
||
|
This program is free software; you can redistribute it and/or modify it
|
||
|
under the terms of the GNU General Public License as published by the Free
|
||
|
Software Foundation; either version 2 of the License, or (at your option)
|
||
|
any later version.
|
||
|
|
||
|
This program is distributed in the hope that it will be useful, but WITHOUT
|
||
|
ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
|
||
|
FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
|
||
|
more details.
|
||
|
|
||
|
You should have received a copy of the GNU General Public License along with
|
||
|
this program; if not, write to the Free Software Foundation, Inc., 59
|
||
|
Temple Place - Suite 330, Boston, MA 02111-1307, USA.
|
||
|
|
||
|
The full GNU General Public License is included in this distribution in the
|
||
|
file called LICENSE.
|
||
|
|
||
|
Contact Information:
|
||
|
Linux NICS <linux.nics@intel.com>
|
||
|
Intel Corporation, 5200 N.E. Elam Young Parkway, Hillsboro, OR 97124-6497
|
||
|
|
||
|
*******************************************************************************/
|
||
|
/*
|
||
|
* Copyright (C) Archway Digital Solutions.
|
||
|
*
|
||
|
* written by Chrsitopher Li <cli at arcyway dot com> or <chrisl at gnuchina dot org>
|
||
|
* 2/9/2002
|
||
|
*
|
||
|
* Copyright (C) Linux Networx.
|
||
|
* Massive upgrade to work with the new intel gigabit NICs.
|
||
|
* <ebiederman at lnxi dot com>
|
||
|
*/
|
||
|
|
||
|
#include "e1000.h"
|
||
|
|
||
|
#if (CONFIG_COMMANDS & CFG_CMD_NET) && defined(CONFIG_NET_MULTI) && \
|
||
|
defined(CONFIG_E1000)
|
||
|
|
||
|
#define TOUT_LOOP 100000
|
||
|
|
||
|
#undef virt_to_bus
|
||
|
#define virt_to_bus(x) ((unsigned long)x)
|
||
|
#define bus_to_phys(devno, a) pci_mem_to_phys(devno, a)
|
||
|
#define mdelay(n) udelay((n)*1000)
|
||
|
|
||
|
#define E1000_DEFAULT_PBA 0x00000030
|
||
|
|
||
|
/* NIC specific static variables go here */
|
||
|
|
||
|
static char tx_pool[128 + 16];
|
||
|
static char rx_pool[128 + 16];
|
||
|
static char packet[2096];
|
||
|
|
||
|
static struct e1000_tx_desc *tx_base;
|
||
|
static struct e1000_rx_desc *rx_base;
|
||
|
|
||
|
static int tx_tail;
|
||
|
static int rx_tail, rx_last;
|
||
|
|
||
|
static struct pci_device_id supported[] = {
|
||
|
{PCI_VENDOR_ID_INTEL, PCI_DEVICE_ID_INTEL_82542},
|
||
|
{PCI_VENDOR_ID_INTEL, PCI_DEVICE_ID_INTEL_82543GC_FIBER},
|
||
|
{PCI_VENDOR_ID_INTEL, PCI_DEVICE_ID_INTEL_82543GC_COPPER},
|
||
|
{PCI_VENDOR_ID_INTEL, PCI_DEVICE_ID_INTEL_82544EI_COPPER},
|
||
|
{PCI_VENDOR_ID_INTEL, PCI_DEVICE_ID_INTEL_82544EI_FIBER},
|
||
|
{PCI_VENDOR_ID_INTEL, PCI_DEVICE_ID_INTEL_82544GC_COPPER},
|
||
|
{PCI_VENDOR_ID_INTEL, PCI_DEVICE_ID_INTEL_82544GC_LOM},
|
||
|
{PCI_VENDOR_ID_INTEL, PCI_DEVICE_ID_INTEL_82540EM},
|
||
|
{PCI_VENDOR_ID_INTEL, PCI_DEVICE_ID_INTEL_82545EM_COPPER},
|
||
|
{PCI_VENDOR_ID_INTEL, PCI_DEVICE_ID_INTEL_82546EB_COPPER},
|
||
|
{PCI_VENDOR_ID_INTEL, PCI_DEVICE_ID_INTEL_82545EM_FIBER},
|
||
|
{PCI_VENDOR_ID_INTEL, PCI_DEVICE_ID_INTEL_82546EB_FIBER},
|
||
|
{PCI_VENDOR_ID_INTEL, PCI_DEVICE_ID_INTEL_82540EM_LOM},
|
||
|
};
|
||
|
|
||
|
/* Function forward declarations */
|
||
|
static int e1000_setup_link(struct eth_device *nic);
|
||
|
static int e1000_setup_fiber_link(struct eth_device *nic);
|
||
|
static int e1000_setup_copper_link(struct eth_device *nic);
|
||
|
static int e1000_phy_setup_autoneg(struct e1000_hw *hw);
|
||
|
static void e1000_config_collision_dist(struct e1000_hw *hw);
|
||
|
static int e1000_config_mac_to_phy(struct e1000_hw *hw);
|
||
|
static int e1000_config_fc_after_link_up(struct e1000_hw *hw);
|
||
|
static int e1000_check_for_link(struct eth_device *nic);
|
||
|
static int e1000_wait_autoneg(struct e1000_hw *hw);
|
||
|
static void e1000_get_speed_and_duplex(struct e1000_hw *hw, uint16_t * speed,
|
||
|
uint16_t * duplex);
|
||
|
static int e1000_read_phy_reg(struct e1000_hw *hw, uint32_t reg_addr,
|
||
|
uint16_t * phy_data);
|
||
|
static int e1000_write_phy_reg(struct e1000_hw *hw, uint32_t reg_addr,
|
||
|
uint16_t phy_data);
|
||
|
static void e1000_phy_hw_reset(struct e1000_hw *hw);
|
||
|
static int e1000_phy_reset(struct e1000_hw *hw);
|
||
|
static int e1000_detect_gig_phy(struct e1000_hw *hw);
|
||
|
|
||
|
#define E1000_WRITE_REG(a, reg, value) (writel((value), ((a)->hw_addr + E1000_##reg)))
|
||
|
#define E1000_READ_REG(a, reg) (readl((a)->hw_addr + E1000_##reg))
|
||
|
#define E1000_WRITE_REG_ARRAY(a, reg, offset, value) (\
|
||
|
writel((value), ((a)->hw_addr + E1000_##reg + ((offset) << 2))))
|
||
|
#define E1000_READ_REG_ARRAY(a, reg, offset) ( \
|
||
|
readl((a)->hw_addr + E1000_##reg + ((offset) << 2)))
|
||
|
#define E1000_WRITE_FLUSH(a) {uint32_t x; x = E1000_READ_REG(a, STATUS);}
|
||
|
|
||
|
#ifndef CONFIG_AP1000 /* remove for warnings */
|
||
|
/******************************************************************************
|
||
|
* Raises the EEPROM's clock input.
|
||
|
*
|
||
|
* hw - Struct containing variables accessed by shared code
|
||
|
* eecd - EECD's current value
|
||
|
*****************************************************************************/
|
||
|
static void
|
||
|
e1000_raise_ee_clk(struct e1000_hw *hw, uint32_t * eecd)
|
||
|
{
|
||
|
/* Raise the clock input to the EEPROM (by setting the SK bit), and then
|
||
|
* wait 50 microseconds.
|
||
|
*/
|
||
|
*eecd = *eecd | E1000_EECD_SK;
|
||
|
E1000_WRITE_REG(hw, EECD, *eecd);
|
||
|
E1000_WRITE_FLUSH(hw);
|
||
|
udelay(50);
|
||
|
}
|
||
|
|
||
|
/******************************************************************************
|
||
|
* Lowers the EEPROM's clock input.
|
||
|
*
|
||
|
* hw - Struct containing variables accessed by shared code
|
||
|
* eecd - EECD's current value
|
||
|
*****************************************************************************/
|
||
|
static void
|
||
|
e1000_lower_ee_clk(struct e1000_hw *hw, uint32_t * eecd)
|
||
|
{
|
||
|
/* Lower the clock input to the EEPROM (by clearing the SK bit), and then
|
||
|
* wait 50 microseconds.
|
||
|
*/
|
||
|
*eecd = *eecd & ~E1000_EECD_SK;
|
||
|
E1000_WRITE_REG(hw, EECD, *eecd);
|
||
|
E1000_WRITE_FLUSH(hw);
|
||
|
udelay(50);
|
||
|
}
|
||
|
|
||
|
/******************************************************************************
|
||
|
* Shift data bits out to the EEPROM.
|
||
|
*
|
||
|
* hw - Struct containing variables accessed by shared code
|
||
|
* data - data to send to the EEPROM
|
||
|
* count - number of bits to shift out
|
||
|
*****************************************************************************/
|
||
|
static void
|
||
|
e1000_shift_out_ee_bits(struct e1000_hw *hw, uint16_t data, uint16_t count)
|
||
|
{
|
||
|
uint32_t eecd;
|
||
|
uint32_t mask;
|
||
|
|
||
|
/* We need to shift "count" bits out to the EEPROM. So, value in the
|
||
|
* "data" parameter will be shifted out to the EEPROM one bit at a time.
|
||
|
* In order to do this, "data" must be broken down into bits.
|
||
|
*/
|
||
|
mask = 0x01 << (count - 1);
|
||
|
eecd = E1000_READ_REG(hw, EECD);
|
||
|
eecd &= ~(E1000_EECD_DO | E1000_EECD_DI);
|
||
|
do {
|
||
|
/* A "1" is shifted out to the EEPROM by setting bit "DI" to a "1",
|
||
|
* and then raising and then lowering the clock (the SK bit controls
|
||
|
* the clock input to the EEPROM). A "0" is shifted out to the EEPROM
|
||
|
* by setting "DI" to "0" and then raising and then lowering the clock.
|
||
|
*/
|
||
|
eecd &= ~E1000_EECD_DI;
|
||
|
|
||
|
if (data & mask)
|
||
|
eecd |= E1000_EECD_DI;
|
||
|
|
||
|
E1000_WRITE_REG(hw, EECD, eecd);
|
||
|
E1000_WRITE_FLUSH(hw);
|
||
|
|
||
|
udelay(50);
|
||
|
|
||
|
e1000_raise_ee_clk(hw, &eecd);
|
||
|
e1000_lower_ee_clk(hw, &eecd);
|
||
|
|
||
|
mask = mask >> 1;
|
||
|
|
||
|
} while (mask);
|
||
|
|
||
|
/* We leave the "DI" bit set to "0" when we leave this routine. */
|
||
|
eecd &= ~E1000_EECD_DI;
|
||
|
E1000_WRITE_REG(hw, EECD, eecd);
|
||
|
}
|
||
|
|
||
|
/******************************************************************************
|
||
|
* Shift data bits in from the EEPROM
|
||
|
*
|
||
|
* hw - Struct containing variables accessed by shared code
|
||
|
*****************************************************************************/
|
||
|
static uint16_t
|
||
|
e1000_shift_in_ee_bits(struct e1000_hw *hw)
|
||
|
{
|
||
|
uint32_t eecd;
|
||
|
uint32_t i;
|
||
|
uint16_t data;
|
||
|
|
||
|
/* In order to read a register from the EEPROM, we need to shift 16 bits
|
||
|
* in from the EEPROM. Bits are "shifted in" by raising the clock input to
|
||
|
* the EEPROM (setting the SK bit), and then reading the value of the "DO"
|
||
|
* bit. During this "shifting in" process the "DI" bit should always be
|
||
|
* clear..
|
||
|
*/
|
||
|
|
||
|
eecd = E1000_READ_REG(hw, EECD);
|
||
|
|
||
|
eecd &= ~(E1000_EECD_DO | E1000_EECD_DI);
|
||
|
data = 0;
|
||
|
|
||
|
for (i = 0; i < 16; i++) {
|
||
|
data = data << 1;
|
||
|
e1000_raise_ee_clk(hw, &eecd);
|
||
|
|
||
|
eecd = E1000_READ_REG(hw, EECD);
|
||
|
|
||
|
eecd &= ~(E1000_EECD_DI);
|
||
|
if (eecd & E1000_EECD_DO)
|
||
|
data |= 1;
|
||
|
|
||
|
e1000_lower_ee_clk(hw, &eecd);
|
||
|
}
|
||
|
|
||
|
return data;
|
||
|
}
|
||
|
|
||
|
/******************************************************************************
|
||
|
* Prepares EEPROM for access
|
||
|
*
|
||
|
* hw - Struct containing variables accessed by shared code
|
||
|
*
|
||
|
* Lowers EEPROM clock. Clears input pin. Sets the chip select pin. This
|
||
|
* function should be called before issuing a command to the EEPROM.
|
||
|
*****************************************************************************/
|
||
|
static void
|
||
|
e1000_setup_eeprom(struct e1000_hw *hw)
|
||
|
{
|
||
|
uint32_t eecd;
|
||
|
|
||
|
eecd = E1000_READ_REG(hw, EECD);
|
||
|
|
||
|
/* Clear SK and DI */
|
||
|
eecd &= ~(E1000_EECD_SK | E1000_EECD_DI);
|
||
|
E1000_WRITE_REG(hw, EECD, eecd);
|
||
|
|
||
|
/* Set CS */
|
||
|
eecd |= E1000_EECD_CS;
|
||
|
E1000_WRITE_REG(hw, EECD, eecd);
|
||
|
}
|
||
|
|
||
|
/******************************************************************************
|
||
|
* Returns EEPROM to a "standby" state
|
||
|
*
|
||
|
* hw - Struct containing variables accessed by shared code
|
||
|
*****************************************************************************/
|
||
|
static void
|
||
|
e1000_standby_eeprom(struct e1000_hw *hw)
|
||
|
{
|
||
|
uint32_t eecd;
|
||
|
|
||
|
eecd = E1000_READ_REG(hw, EECD);
|
||
|
|
||
|
/* Deselct EEPROM */
|
||
|
eecd &= ~(E1000_EECD_CS | E1000_EECD_SK);
|
||
|
E1000_WRITE_REG(hw, EECD, eecd);
|
||
|
E1000_WRITE_FLUSH(hw);
|
||
|
udelay(50);
|
||
|
|
||
|
/* Clock high */
|
||
|
eecd |= E1000_EECD_SK;
|
||
|
E1000_WRITE_REG(hw, EECD, eecd);
|
||
|
E1000_WRITE_FLUSH(hw);
|
||
|
udelay(50);
|
||
|
|
||
|
/* Select EEPROM */
|
||
|
eecd |= E1000_EECD_CS;
|
||
|
E1000_WRITE_REG(hw, EECD, eecd);
|
||
|
E1000_WRITE_FLUSH(hw);
|
||
|
udelay(50);
|
||
|
|
||
|
/* Clock low */
|
||
|
eecd &= ~E1000_EECD_SK;
|
||
|
E1000_WRITE_REG(hw, EECD, eecd);
|
||
|
E1000_WRITE_FLUSH(hw);
|
||
|
udelay(50);
|
||
|
}
|
||
|
|
||
|
/******************************************************************************
|
||
|
* Reads a 16 bit word from the EEPROM.
|
||
|
*
|
||
|
* hw - Struct containing variables accessed by shared code
|
||
|
* offset - offset of word in the EEPROM to read
|
||
|
* data - word read from the EEPROM
|
||
|
*****************************************************************************/
|
||
|
static int
|
||
|
e1000_read_eeprom(struct e1000_hw *hw, uint16_t offset, uint16_t * data)
|
||
|
{
|
||
|
uint32_t eecd;
|
||
|
uint32_t i = 0;
|
||
|
int large_eeprom = FALSE;
|
||
|
|
||
|
/* Request EEPROM Access */
|
||
|
if (hw->mac_type > e1000_82544) {
|
||
|
eecd = E1000_READ_REG(hw, EECD);
|
||
|
if (eecd & E1000_EECD_SIZE)
|
||
|
large_eeprom = TRUE;
|
||
|
eecd |= E1000_EECD_REQ;
|
||
|
E1000_WRITE_REG(hw, EECD, eecd);
|
||
|
eecd = E1000_READ_REG(hw, EECD);
|
||
|
while ((!(eecd & E1000_EECD_GNT)) && (i < 100)) {
|
||
|
i++;
|
||
|
udelay(10);
|
||
|
eecd = E1000_READ_REG(hw, EECD);
|
||
|
}
|
||
|
if (!(eecd & E1000_EECD_GNT)) {
|
||
|
eecd &= ~E1000_EECD_REQ;
|
||
|
E1000_WRITE_REG(hw, EECD, eecd);
|
||
|
DEBUGOUT("Could not acquire EEPROM grant\n");
|
||
|
return -E1000_ERR_EEPROM;
|
||
|
}
|
||
|
}
|
||
|
|
||
|
/* Prepare the EEPROM for reading */
|
||
|
e1000_setup_eeprom(hw);
|
||
|
|
||
|
/* Send the READ command (opcode + addr) */
|
||
|
e1000_shift_out_ee_bits(hw, EEPROM_READ_OPCODE, 3);
|
||
|
e1000_shift_out_ee_bits(hw, offset, (large_eeprom) ? 8 : 6);
|
||
|
|
||
|
/* Read the data */
|
||
|
*data = e1000_shift_in_ee_bits(hw);
|
||
|
|
||
|
/* End this read operation */
|
||
|
e1000_standby_eeprom(hw);
|
||
|
|
||
|
/* Stop requesting EEPROM access */
|
||
|
if (hw->mac_type > e1000_82544) {
|
||
|
eecd = E1000_READ_REG(hw, EECD);
|
||
|
eecd &= ~E1000_EECD_REQ;
|
||
|
E1000_WRITE_REG(hw, EECD, eecd);
|
||
|
}
|
||
|
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
#if 0
|
||
|
static void
|
||
|
e1000_eeprom_cleanup(struct e1000_hw *hw)
|
||
|
{
|
||
|
uint32_t eecd;
|
||
|
|
||
|
eecd = E1000_READ_REG(hw, EECD);
|
||
|
eecd &= ~(E1000_EECD_CS | E1000_EECD_DI);
|
||
|
E1000_WRITE_REG(hw, EECD, eecd);
|
||
|
e1000_raise_ee_clk(hw, &eecd);
|
||
|
e1000_lower_ee_clk(hw, &eecd);
|
||
|
}
|
||
|
|
||
|
static uint16_t
|
||
|
e1000_wait_eeprom_done(struct e1000_hw *hw)
|
||
|
{
|
||
|
uint32_t eecd;
|
||
|
uint32_t i;
|
||
|
|
||
|
e1000_standby_eeprom(hw);
|
||
|
for (i = 0; i < 200; i++) {
|
||
|
eecd = E1000_READ_REG(hw, EECD);
|
||
|
if (eecd & E1000_EECD_DO)
|
||
|
return (TRUE);
|
||
|
udelay(5);
|
||
|
}
|
||
|
return (FALSE);
|
||
|
}
|
||
|
|
||
|
static int
|
||
|
e1000_write_eeprom(struct e1000_hw *hw, uint16_t Reg, uint16_t Data)
|
||
|
{
|
||
|
uint32_t eecd;
|
||
|
int large_eeprom = FALSE;
|
||
|
int i = 0;
|
||
|
|
||
|
/* Request EEPROM Access */
|
||
|
if (hw->mac_type > e1000_82544) {
|
||
|
eecd = E1000_READ_REG(hw, EECD);
|
||
|
if (eecd & E1000_EECD_SIZE)
|
||
|
large_eeprom = TRUE;
|
||
|
eecd |= E1000_EECD_REQ;
|
||
|
E1000_WRITE_REG(hw, EECD, eecd);
|
||
|
eecd = E1000_READ_REG(hw, EECD);
|
||
|
while ((!(eecd & E1000_EECD_GNT)) && (i < 100)) {
|
||
|
i++;
|
||
|
udelay(5);
|
||
|
eecd = E1000_READ_REG(hw, EECD);
|
||
|
}
|
||
|
if (!(eecd & E1000_EECD_GNT)) {
|
||
|
eecd &= ~E1000_EECD_REQ;
|
||
|
E1000_WRITE_REG(hw, EECD, eecd);
|
||
|
DEBUGOUT("Could not acquire EEPROM grant\n");
|
||
|
return FALSE;
|
||
|
}
|
||
|
}
|
||
|
e1000_setup_eeprom(hw);
|
||
|
e1000_shift_out_ee_bits(hw, EEPROM_EWEN_OPCODE, 5);
|
||
|
e1000_shift_out_ee_bits(hw, Reg, (large_eeprom) ? 6 : 4);
|
||
|
e1000_standby_eeprom(hw);
|
||
|
e1000_shift_out_ee_bits(hw, EEPROM_WRITE_OPCODE, 3);
|
||
|
e1000_shift_out_ee_bits(hw, Reg, (large_eeprom) ? 8 : 6);
|
||
|
e1000_shift_out_ee_bits(hw, Data, 16);
|
||
|
if (!e1000_wait_eeprom_done(hw)) {
|
||
|
return FALSE;
|
||
|
}
|
||
|
e1000_shift_out_ee_bits(hw, EEPROM_EWDS_OPCODE, 5);
|
||
|
e1000_shift_out_ee_bits(hw, Reg, (large_eeprom) ? 6 : 4);
|
||
|
e1000_eeprom_cleanup(hw);
|
||
|
|
||
|
/* Stop requesting EEPROM access */
|
||
|
if (hw->mac_type > e1000_82544) {
|
||
|
eecd = E1000_READ_REG(hw, EECD);
|
||
|
eecd &= ~E1000_EECD_REQ;
|
||
|
E1000_WRITE_REG(hw, EECD, eecd);
|
||
|
}
|
||
|
i = 0;
|
||
|
eecd = E1000_READ_REG(hw, EECD);
|
||
|
while (((eecd & E1000_EECD_GNT)) && (i < 500)) {
|
||
|
i++;
|
||
|
udelay(10);
|
||
|
eecd = E1000_READ_REG(hw, EECD);
|
||
|
}
|
||
|
if ((eecd & E1000_EECD_GNT)) {
|
||
|
DEBUGOUT("Could not release EEPROM grant\n");
|
||
|
}
|
||
|
return TRUE;
|
||
|
}
|
||
|
#endif
|
||
|
|
||
|
/******************************************************************************
|
||
|
* Verifies that the EEPROM has a valid checksum
|
||
|
*
|
||
|
* hw - Struct containing variables accessed by shared code
|
||
|
*
|
||
|
* Reads the first 64 16 bit words of the EEPROM and sums the values read.
|
||
|
* If the the sum of the 64 16 bit words is 0xBABA, the EEPROM's checksum is
|
||
|
* valid.
|
||
|
*****************************************************************************/
|
||
|
static int
|
||
|
e1000_validate_eeprom_checksum(struct eth_device *nic)
|
||
|
{
|
||
|
struct e1000_hw *hw = nic->priv;
|
||
|
uint16_t checksum = 0;
|
||
|
uint16_t i, eeprom_data;
|
||
|
|
||
|
DEBUGFUNC();
|
||
|
|
||
|
for (i = 0; i < (EEPROM_CHECKSUM_REG + 1); i++) {
|
||
|
if (e1000_read_eeprom(hw, i, &eeprom_data) < 0) {
|
||
|
DEBUGOUT("EEPROM Read Error\n");
|
||
|
return -E1000_ERR_EEPROM;
|
||
|
}
|
||
|
checksum += eeprom_data;
|
||
|
}
|
||
|
|
||
|
if (checksum == (uint16_t) EEPROM_SUM) {
|
||
|
return 0;
|
||
|
} else {
|
||
|
DEBUGOUT("EEPROM Checksum Invalid\n");
|
||
|
return -E1000_ERR_EEPROM;
|
||
|
}
|
||
|
}
|
||
|
#endif /* #ifndef CONFIG_AP1000 */
|
||
|
|
||
|
/******************************************************************************
|
||
|
* Reads the adapter's MAC address from the EEPROM and inverts the LSB for the
|
||
|
* second function of dual function devices
|
||
|
*
|
||
|
* nic - Struct containing variables accessed by shared code
|
||
|
*****************************************************************************/
|
||
|
static int
|
||
|
e1000_read_mac_addr(struct eth_device *nic)
|
||
|
{
|
||
|
#ifndef CONFIG_AP1000
|
||
|
struct e1000_hw *hw = nic->priv;
|
||
|
uint16_t offset;
|
||
|
uint16_t eeprom_data;
|
||
|
int i;
|
||
|
|
||
|
DEBUGFUNC();
|
||
|
|
||
|
for (i = 0; i < NODE_ADDRESS_SIZE; i += 2) {
|
||
|
offset = i >> 1;
|
||
|
if (e1000_read_eeprom(hw, offset, &eeprom_data) < 0) {
|
||
|
DEBUGOUT("EEPROM Read Error\n");
|
||
|
return -E1000_ERR_EEPROM;
|
||
|
}
|
||
|
nic->enetaddr[i] = eeprom_data & 0xff;
|
||
|
nic->enetaddr[i + 1] = (eeprom_data >> 8) & 0xff;
|
||
|
}
|
||
|
if ((hw->mac_type == e1000_82546) &&
|
||
|
(E1000_READ_REG(hw, STATUS) & E1000_STATUS_FUNC_1)) {
|
||
|
/* Invert the last bit if this is the second device */
|
||
|
nic->enetaddr[5] += 1;
|
||
|
}
|
||
|
#else
|
||
|
/*
|
||
|
* The AP1000's e1000 has no eeprom; the MAC address is stored in the
|
||
|
* environment variables. Currently this does not support the addition
|
||
|
* of a PMC e1000 card, which is certainly a possibility, so this should
|
||
|
* be updated to properly use the env variable only for the onboard e1000
|
||
|
*/
|
||
|
|
||
|
int ii;
|
||
|
char *s, *e;
|
||
|
|
||
|
DEBUGFUNC();
|
||
|
|
||
|
s = getenv ("ethaddr");
|
||
|
if (s == NULL){
|
||
|
return -E1000_ERR_EEPROM;
|
||
|
}
|
||
|
else{
|
||
|
for(ii = 0; ii < 6; ii++) {
|
||
|
nic->enetaddr[ii] = s ? simple_strtoul (s, &e, 16) : 0;
|
||
|
if (s){
|
||
|
s = (*e) ? e + 1 : e;
|
||
|
}
|
||
|
}
|
||
|
}
|
||
|
#endif
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
/******************************************************************************
|
||
|
* Initializes receive address filters.
|
||
|
*
|
||
|
* hw - Struct containing variables accessed by shared code
|
||
|
*
|
||
|
* Places the MAC address in receive address register 0 and clears the rest
|
||
|
* of the receive addresss registers. Clears the multicast table. Assumes
|
||
|
* the receiver is in reset when the routine is called.
|
||
|
*****************************************************************************/
|
||
|
static void
|
||
|
e1000_init_rx_addrs(struct eth_device *nic)
|
||
|
{
|
||
|
struct e1000_hw *hw = nic->priv;
|
||
|
uint32_t i;
|
||
|
uint32_t addr_low;
|
||
|
uint32_t addr_high;
|
||
|
|
||
|
DEBUGFUNC();
|
||
|
|
||
|
/* Setup the receive address. */
|
||
|
DEBUGOUT("Programming MAC Address into RAR[0]\n");
|
||
|
addr_low = (nic->enetaddr[0] |
|
||
|
(nic->enetaddr[1] << 8) |
|
||
|
(nic->enetaddr[2] << 16) | (nic->enetaddr[3] << 24));
|
||
|
|
||
|
addr_high = (nic->enetaddr[4] | (nic->enetaddr[5] << 8) | E1000_RAH_AV);
|
||
|
|
||
|
E1000_WRITE_REG_ARRAY(hw, RA, 0, addr_low);
|
||
|
E1000_WRITE_REG_ARRAY(hw, RA, 1, addr_high);
|
||
|
|
||
|
/* Zero out the other 15 receive addresses. */
|
||
|
DEBUGOUT("Clearing RAR[1-15]\n");
|
||
|
for (i = 1; i < E1000_RAR_ENTRIES; i++) {
|
||
|
E1000_WRITE_REG_ARRAY(hw, RA, (i << 1), 0);
|
||
|
E1000_WRITE_REG_ARRAY(hw, RA, ((i << 1) + 1), 0);
|
||
|
}
|
||
|
}
|
||
|
|
||
|
/******************************************************************************
|
||
|
* Clears the VLAN filer table
|
||
|
*
|
||
|
* hw - Struct containing variables accessed by shared code
|
||
|
*****************************************************************************/
|
||
|
static void
|
||
|
e1000_clear_vfta(struct e1000_hw *hw)
|
||
|
{
|
||
|
uint32_t offset;
|
||
|
|
||
|
for (offset = 0; offset < E1000_VLAN_FILTER_TBL_SIZE; offset++)
|
||
|
E1000_WRITE_REG_ARRAY(hw, VFTA, offset, 0);
|
||
|
}
|
||
|
|
||
|
/******************************************************************************
|
||
|
* Set the mac type member in the hw struct.
|
||
|
*
|
||
|
* hw - Struct containing variables accessed by shared code
|
||
|
*****************************************************************************/
|
||
|
static int
|
||
|
e1000_set_mac_type(struct e1000_hw *hw)
|
||
|
{
|
||
|
DEBUGFUNC();
|
||
|
|
||
|
switch (hw->device_id) {
|
||
|
case E1000_DEV_ID_82542:
|
||
|
switch (hw->revision_id) {
|
||
|
case E1000_82542_2_0_REV_ID:
|
||
|
hw->mac_type = e1000_82542_rev2_0;
|
||
|
break;
|
||
|
case E1000_82542_2_1_REV_ID:
|
||
|
hw->mac_type = e1000_82542_rev2_1;
|
||
|
break;
|
||
|
default:
|
||
|
/* Invalid 82542 revision ID */
|
||
|
return -E1000_ERR_MAC_TYPE;
|
||
|
}
|
||
|
break;
|
||
|
case E1000_DEV_ID_82543GC_FIBER:
|
||
|
case E1000_DEV_ID_82543GC_COPPER:
|
||
|
hw->mac_type = e1000_82543;
|
||
|
break;
|
||
|
case E1000_DEV_ID_82544EI_COPPER:
|
||
|
case E1000_DEV_ID_82544EI_FIBER:
|
||
|
case E1000_DEV_ID_82544GC_COPPER:
|
||
|
case E1000_DEV_ID_82544GC_LOM:
|
||
|
hw->mac_type = e1000_82544;
|
||
|
break;
|
||
|
case E1000_DEV_ID_82540EM:
|
||
|
case E1000_DEV_ID_82540EM_LOM:
|
||
|
hw->mac_type = e1000_82540;
|
||
|
break;
|
||
|
case E1000_DEV_ID_82545EM_COPPER:
|
||
|
case E1000_DEV_ID_82545EM_FIBER:
|
||
|
hw->mac_type = e1000_82545;
|
||
|
break;
|
||
|
case E1000_DEV_ID_82546EB_COPPER:
|
||
|
case E1000_DEV_ID_82546EB_FIBER:
|
||
|
hw->mac_type = e1000_82546;
|
||
|
break;
|
||
|
default:
|
||
|
/* Should never have loaded on this device */
|
||
|
return -E1000_ERR_MAC_TYPE;
|
||
|
}
|
||
|
return E1000_SUCCESS;
|
||
|
}
|
||
|
|
||
|
/******************************************************************************
|
||
|
* Reset the transmit and receive units; mask and clear all interrupts.
|
||
|
*
|
||
|
* hw - Struct containing variables accessed by shared code
|
||
|
*****************************************************************************/
|
||
|
void
|
||
|
e1000_reset_hw(struct e1000_hw *hw)
|
||
|
{
|
||
|
uint32_t ctrl;
|
||
|
uint32_t ctrl_ext;
|
||
|
uint32_t icr;
|
||
|
uint32_t manc;
|
||
|
|
||
|
DEBUGFUNC();
|
||
|
|
||
|
/* For 82542 (rev 2.0), disable MWI before issuing a device reset */
|
||
|
if (hw->mac_type == e1000_82542_rev2_0) {
|
||
|
DEBUGOUT("Disabling MWI on 82542 rev 2.0\n");
|
||
|
pci_write_config_word(hw->pdev, PCI_COMMAND,
|
||
|
hw->
|
||
|
pci_cmd_word & ~PCI_COMMAND_INVALIDATE);
|
||
|
}
|
||
|
|
||
|
/* Clear interrupt mask to stop board from generating interrupts */
|
||
|
DEBUGOUT("Masking off all interrupts\n");
|
||
|
E1000_WRITE_REG(hw, IMC, 0xffffffff);
|
||
|
|
||
|
/* Disable the Transmit and Receive units. Then delay to allow
|
||
|
* any pending transactions to complete before we hit the MAC with
|
||
|
* the global reset.
|
||
|
*/
|
||
|
E1000_WRITE_REG(hw, RCTL, 0);
|
||
|
E1000_WRITE_REG(hw, TCTL, E1000_TCTL_PSP);
|
||
|
E1000_WRITE_FLUSH(hw);
|
||
|
|
||
|
/* The tbi_compatibility_on Flag must be cleared when Rctl is cleared. */
|
||
|
hw->tbi_compatibility_on = FALSE;
|
||
|
|
||
|
/* Delay to allow any outstanding PCI transactions to complete before
|
||
|
* resetting the device
|
||
|
*/
|
||
|
mdelay(10);
|
||
|
|
||
|
/* Issue a global reset to the MAC. This will reset the chip's
|
||
|
* transmit, receive, DMA, and link units. It will not effect
|
||
|
* the current PCI configuration. The global reset bit is self-
|
||
|
* clearing, and should clear within a microsecond.
|
||
|
*/
|
||
|
DEBUGOUT("Issuing a global reset to MAC\n");
|
||
|
ctrl = E1000_READ_REG(hw, CTRL);
|
||
|
|
||
|
#if 0
|
||
|
if (hw->mac_type > e1000_82543)
|
||
|
E1000_WRITE_REG_IO(hw, CTRL, (ctrl | E1000_CTRL_RST));
|
||
|
else
|
||
|
#endif
|
||
|
E1000_WRITE_REG(hw, CTRL, (ctrl | E1000_CTRL_RST));
|
||
|
|
||
|
/* Force a reload from the EEPROM if necessary */
|
||
|
if (hw->mac_type < e1000_82540) {
|
||
|
/* Wait for reset to complete */
|
||
|
udelay(10);
|
||
|
ctrl_ext = E1000_READ_REG(hw, CTRL_EXT);
|
||
|
ctrl_ext |= E1000_CTRL_EXT_EE_RST;
|
||
|
E1000_WRITE_REG(hw, CTRL_EXT, ctrl_ext);
|
||
|
E1000_WRITE_FLUSH(hw);
|
||
|
/* Wait for EEPROM reload */
|
||
|
mdelay(2);
|
||
|
} else {
|
||
|
/* Wait for EEPROM reload (it happens automatically) */
|
||
|
mdelay(4);
|
||
|
/* Dissable HW ARPs on ASF enabled adapters */
|
||
|
manc = E1000_READ_REG(hw, MANC);
|
||
|
manc &= ~(E1000_MANC_ARP_EN);
|
||
|
E1000_WRITE_REG(hw, MANC, manc);
|
||
|
}
|
||
|
|
||
|
/* Clear interrupt mask to stop board from generating interrupts */
|
||
|
DEBUGOUT("Masking off all interrupts\n");
|
||
|
E1000_WRITE_REG(hw, IMC, 0xffffffff);
|
||
|
|
||
|
/* Clear any pending interrupt events. */
|
||
|
icr = E1000_READ_REG(hw, ICR);
|
||
|
|
||
|
/* If MWI was previously enabled, reenable it. */
|
||
|
if (hw->mac_type == e1000_82542_rev2_0) {
|
||
|
pci_write_config_word(hw->pdev, PCI_COMMAND, hw->pci_cmd_word);
|
||
|
}
|
||
|
}
|
||
|
|
||
|
/******************************************************************************
|
||
|
* Performs basic configuration of the adapter.
|
||
|
*
|
||
|
* hw - Struct containing variables accessed by shared code
|
||
|
*
|
||
|
* Assumes that the controller has previously been reset and is in a
|
||
|
* post-reset uninitialized state. Initializes the receive address registers,
|
||
|
* multicast table, and VLAN filter table. Calls routines to setup link
|
||
|
* configuration and flow control settings. Clears all on-chip counters. Leaves
|
||
|
* the transmit and receive units disabled and uninitialized.
|
||
|
*****************************************************************************/
|
||
|
static int
|
||
|
e1000_init_hw(struct eth_device *nic)
|
||
|
{
|
||
|
struct e1000_hw *hw = nic->priv;
|
||
|
uint32_t ctrl, status;
|
||
|
uint32_t i;
|
||
|
int32_t ret_val;
|
||
|
uint16_t pcix_cmd_word;
|
||
|
uint16_t pcix_stat_hi_word;
|
||
|
uint16_t cmd_mmrbc;
|
||
|
uint16_t stat_mmrbc;
|
||
|
e1000_bus_type bus_type = e1000_bus_type_unknown;
|
||
|
|
||
|
DEBUGFUNC();
|
||
|
#if 0
|
||
|
/* Initialize Identification LED */
|
||
|
ret_val = e1000_id_led_init(hw);
|
||
|
if (ret_val < 0) {
|
||
|
DEBUGOUT("Error Initializing Identification LED\n");
|
||
|
return ret_val;
|
||
|
}
|
||
|
#endif
|
||
|
/* Set the Media Type and exit with error if it is not valid. */
|
||
|
if (hw->mac_type != e1000_82543) {
|
||
|
/* tbi_compatibility is only valid on 82543 */
|
||
|
hw->tbi_compatibility_en = FALSE;
|
||
|
}
|
||
|
|
||
|
if (hw->mac_type >= e1000_82543) {
|
||
|
status = E1000_READ_REG(hw, STATUS);
|
||
|
if (status & E1000_STATUS_TBIMODE) {
|
||
|
hw->media_type = e1000_media_type_fiber;
|
||
|
/* tbi_compatibility not valid on fiber */
|
||
|
hw->tbi_compatibility_en = FALSE;
|
||
|
} else {
|
||
|
hw->media_type = e1000_media_type_copper;
|
||
|
}
|
||
|
} else {
|
||
|
/* This is an 82542 (fiber only) */
|
||
|
hw->media_type = e1000_media_type_fiber;
|
||
|
}
|
||
|
|
||
|
/* Disabling VLAN filtering. */
|
||
|
DEBUGOUT("Initializing the IEEE VLAN\n");
|
||
|
E1000_WRITE_REG(hw, VET, 0);
|
||
|
|
||
|
e1000_clear_vfta(hw);
|
||
|
|
||
|
/* For 82542 (rev 2.0), disable MWI and put the receiver into reset */
|
||
|
if (hw->mac_type == e1000_82542_rev2_0) {
|
||
|
DEBUGOUT("Disabling MWI on 82542 rev 2.0\n");
|
||
|
pci_write_config_word(hw->pdev, PCI_COMMAND,
|
||
|
hw->
|
||
|
pci_cmd_word & ~PCI_COMMAND_INVALIDATE);
|
||
|
E1000_WRITE_REG(hw, RCTL, E1000_RCTL_RST);
|
||
|
E1000_WRITE_FLUSH(hw);
|
||
|
mdelay(5);
|
||
|
}
|
||
|
|
||
|
/* Setup the receive address. This involves initializing all of the Receive
|
||
|
* Address Registers (RARs 0 - 15).
|
||
|
*/
|
||
|
e1000_init_rx_addrs(nic);
|
||
|
|
||
|
/* For 82542 (rev 2.0), take the receiver out of reset and enable MWI */
|
||
|
if (hw->mac_type == e1000_82542_rev2_0) {
|
||
|
E1000_WRITE_REG(hw, RCTL, 0);
|
||
|
E1000_WRITE_FLUSH(hw);
|
||
|
mdelay(1);
|
||
|
pci_write_config_word(hw->pdev, PCI_COMMAND, hw->pci_cmd_word);
|
||
|
}
|
||
|
|
||
|
/* Zero out the Multicast HASH table */
|
||
|
DEBUGOUT("Zeroing the MTA\n");
|
||
|
for (i = 0; i < E1000_MC_TBL_SIZE; i++)
|
||
|
E1000_WRITE_REG_ARRAY(hw, MTA, i, 0);
|
||
|
|
||
|
#if 0
|
||
|
/* Set the PCI priority bit correctly in the CTRL register. This
|
||
|
* determines if the adapter gives priority to receives, or if it
|
||
|
* gives equal priority to transmits and receives.
|
||
|
*/
|
||
|
if (hw->dma_fairness) {
|
||
|
ctrl = E1000_READ_REG(hw, CTRL);
|
||
|
E1000_WRITE_REG(hw, CTRL, ctrl | E1000_CTRL_PRIOR);
|
||
|
}
|
||
|
#endif
|
||
|
if (hw->mac_type >= e1000_82543) {
|
||
|
status = E1000_READ_REG(hw, STATUS);
|
||
|
bus_type = (status & E1000_STATUS_PCIX_MODE) ?
|
||
|
e1000_bus_type_pcix : e1000_bus_type_pci;
|
||
|
}
|
||
|
/* Workaround for PCI-X problem when BIOS sets MMRBC incorrectly. */
|
||
|
if (bus_type == e1000_bus_type_pcix) {
|
||
|
pci_read_config_word(hw->pdev, PCIX_COMMAND_REGISTER,
|
||
|
&pcix_cmd_word);
|
||
|
pci_read_config_word(hw->pdev, PCIX_STATUS_REGISTER_HI,
|
||
|
&pcix_stat_hi_word);
|
||
|
cmd_mmrbc =
|
||
|
(pcix_cmd_word & PCIX_COMMAND_MMRBC_MASK) >>
|
||
|
PCIX_COMMAND_MMRBC_SHIFT;
|
||
|
stat_mmrbc =
|
||
|
(pcix_stat_hi_word & PCIX_STATUS_HI_MMRBC_MASK) >>
|
||
|
PCIX_STATUS_HI_MMRBC_SHIFT;
|
||
|
if (stat_mmrbc == PCIX_STATUS_HI_MMRBC_4K)
|
||
|
stat_mmrbc = PCIX_STATUS_HI_MMRBC_2K;
|
||
|
if (cmd_mmrbc > stat_mmrbc) {
|
||
|
pcix_cmd_word &= ~PCIX_COMMAND_MMRBC_MASK;
|
||
|
pcix_cmd_word |= stat_mmrbc << PCIX_COMMAND_MMRBC_SHIFT;
|
||
|
pci_write_config_word(hw->pdev, PCIX_COMMAND_REGISTER,
|
||
|
pcix_cmd_word);
|
||
|
}
|
||
|
}
|
||
|
|
||
|
/* Call a subroutine to configure the link and setup flow control. */
|
||
|
ret_val = e1000_setup_link(nic);
|
||
|
|
||
|
/* Set the transmit descriptor write-back policy */
|
||
|
if (hw->mac_type > e1000_82544) {
|
||
|
ctrl = E1000_READ_REG(hw, TXDCTL);
|
||
|
ctrl =
|
||
|
(ctrl & ~E1000_TXDCTL_WTHRESH) |
|
||
|
E1000_TXDCTL_FULL_TX_DESC_WB;
|
||
|
E1000_WRITE_REG(hw, TXDCTL, ctrl);
|
||
|
}
|
||
|
#if 0
|
||
|
/* Clear all of the statistics registers (clear on read). It is
|
||
|
* important that we do this after we have tried to establish link
|
||
|
* because the symbol error count will increment wildly if there
|
||
|
* is no link.
|
||
|
*/
|
||
|
e1000_clear_hw_cntrs(hw);
|
||
|
#endif
|
||
|
|
||
|
return ret_val;
|
||
|
}
|
||
|
|
||
|
/******************************************************************************
|
||
|
* Configures flow control and link settings.
|
||
|
*
|
||
|
* hw - Struct containing variables accessed by shared code
|
||
|
*
|
||
|
* Determines which flow control settings to use. Calls the apropriate media-
|
||
|
* specific link configuration function. Configures the flow control settings.
|
||
|
* Assuming the adapter has a valid link partner, a valid link should be
|
||
|
* established. Assumes the hardware has previously been reset and the
|
||
|
* transmitter and receiver are not enabled.
|
||
|
*****************************************************************************/
|
||
|
static int
|
||
|
e1000_setup_link(struct eth_device *nic)
|
||
|
{
|
||
|
struct e1000_hw *hw = nic->priv;
|
||
|
uint32_t ctrl_ext;
|
||
|
int32_t ret_val;
|
||
|
uint16_t eeprom_data;
|
||
|
|
||
|
DEBUGFUNC();
|
||
|
|
||
|
#ifndef CONFIG_AP1000
|
||
|
/* Read and store word 0x0F of the EEPROM. This word contains bits
|
||
|
* that determine the hardware's default PAUSE (flow control) mode,
|
||
|
* a bit that determines whether the HW defaults to enabling or
|
||
|
* disabling auto-negotiation, and the direction of the
|
||
|
* SW defined pins. If there is no SW over-ride of the flow
|
||
|
* control setting, then the variable hw->fc will
|
||
|
* be initialized based on a value in the EEPROM.
|
||
|
*/
|
||
|
if (e1000_read_eeprom(hw, EEPROM_INIT_CONTROL2_REG, &eeprom_data) < 0) {
|
||
|
DEBUGOUT("EEPROM Read Error\n");
|
||
|
return -E1000_ERR_EEPROM;
|
||
|
}
|
||
|
#else
|
||
|
/* we have to hardcode the proper value for our hardware. */
|
||
|
/* this value is for the 82540EM pci card used for prototyping, and it works. */
|
||
|
eeprom_data = 0xb220;
|
||
|
#endif
|
||
|
|
||
|
if (hw->fc == e1000_fc_default) {
|
||
|
if ((eeprom_data & EEPROM_WORD0F_PAUSE_MASK) == 0)
|
||
|
hw->fc = e1000_fc_none;
|
||
|
else if ((eeprom_data & EEPROM_WORD0F_PAUSE_MASK) ==
|
||
|
EEPROM_WORD0F_ASM_DIR)
|
||
|
hw->fc = e1000_fc_tx_pause;
|
||
|
else
|
||
|
hw->fc = e1000_fc_full;
|
||
|
}
|
||
|
|
||
|
/* We want to save off the original Flow Control configuration just
|
||
|
* in case we get disconnected and then reconnected into a different
|
||
|
* hub or switch with different Flow Control capabilities.
|
||
|
*/
|
||
|
if (hw->mac_type == e1000_82542_rev2_0)
|
||
|
hw->fc &= (~e1000_fc_tx_pause);
|
||
|
|
||
|
if ((hw->mac_type < e1000_82543) && (hw->report_tx_early == 1))
|
||
|
hw->fc &= (~e1000_fc_rx_pause);
|
||
|
|
||
|
hw->original_fc = hw->fc;
|
||
|
|
||
|
DEBUGOUT("After fix-ups FlowControl is now = %x\n", hw->fc);
|
||
|
|
||
|
/* Take the 4 bits from EEPROM word 0x0F that determine the initial
|
||
|
* polarity value for the SW controlled pins, and setup the
|
||
|
* Extended Device Control reg with that info.
|
||
|
* This is needed because one of the SW controlled pins is used for
|
||
|
* signal detection. So this should be done before e1000_setup_pcs_link()
|
||
|
* or e1000_phy_setup() is called.
|
||
|
*/
|
||
|
if (hw->mac_type == e1000_82543) {
|
||
|
ctrl_ext = ((eeprom_data & EEPROM_WORD0F_SWPDIO_EXT) <<
|
||
|
SWDPIO__EXT_SHIFT);
|
||
|
E1000_WRITE_REG(hw, CTRL_EXT, ctrl_ext);
|
||
|
}
|
||
|
|
||
|
/* Call the necessary subroutine to configure the link. */
|
||
|
ret_val = (hw->media_type == e1000_media_type_fiber) ?
|
||
|
e1000_setup_fiber_link(nic) : e1000_setup_copper_link(nic);
|
||
|
if (ret_val < 0) {
|
||
|
return ret_val;
|
||
|
}
|
||
|
|
||
|
/* Initialize the flow control address, type, and PAUSE timer
|
||
|
* registers to their default values. This is done even if flow
|
||
|
* control is disabled, because it does not hurt anything to
|
||
|
* initialize these registers.
|
||
|
*/
|
||
|
DEBUGOUT
|
||
|
("Initializing the Flow Control address, type and timer regs\n");
|
||
|
|
||
|
E1000_WRITE_REG(hw, FCAL, FLOW_CONTROL_ADDRESS_LOW);
|
||
|
E1000_WRITE_REG(hw, FCAH, FLOW_CONTROL_ADDRESS_HIGH);
|
||
|
E1000_WRITE_REG(hw, FCT, FLOW_CONTROL_TYPE);
|
||
|
E1000_WRITE_REG(hw, FCTTV, hw->fc_pause_time);
|
||
|
|
||
|
/* Set the flow control receive threshold registers. Normally,
|
||
|
* these registers will be set to a default threshold that may be
|
||
|
* adjusted later by the driver's runtime code. However, if the
|
||
|
* ability to transmit pause frames in not enabled, then these
|
||
|
* registers will be set to 0.
|
||
|
*/
|
||
|
if (!(hw->fc & e1000_fc_tx_pause)) {
|
||
|
E1000_WRITE_REG(hw, FCRTL, 0);
|
||
|
E1000_WRITE_REG(hw, FCRTH, 0);
|
||
|
} else {
|
||
|
/* We need to set up the Receive Threshold high and low water marks
|
||
|
* as well as (optionally) enabling the transmission of XON frames.
|
||
|
*/
|
||
|
if (hw->fc_send_xon) {
|
||
|
E1000_WRITE_REG(hw, FCRTL,
|
||
|
(hw->fc_low_water | E1000_FCRTL_XONE));
|
||
|
E1000_WRITE_REG(hw, FCRTH, hw->fc_high_water);
|
||
|
} else {
|
||
|
E1000_WRITE_REG(hw, FCRTL, hw->fc_low_water);
|
||
|
E1000_WRITE_REG(hw, FCRTH, hw->fc_high_water);
|
||
|
}
|
||
|
}
|
||
|
return ret_val;
|
||
|
}
|
||
|
|
||
|
/******************************************************************************
|
||
|
* Sets up link for a fiber based adapter
|
||
|
*
|
||
|
* hw - Struct containing variables accessed by shared code
|
||
|
*
|
||
|
* Manipulates Physical Coding Sublayer functions in order to configure
|
||
|
* link. Assumes the hardware has been previously reset and the transmitter
|
||
|
* and receiver are not enabled.
|
||
|
*****************************************************************************/
|
||
|
static int
|
||
|
e1000_setup_fiber_link(struct eth_device *nic)
|
||
|
{
|
||
|
struct e1000_hw *hw = nic->priv;
|
||
|
uint32_t ctrl;
|
||
|
uint32_t status;
|
||
|
uint32_t txcw = 0;
|
||
|
uint32_t i;
|
||
|
uint32_t signal;
|
||
|
int32_t ret_val;
|
||
|
|
||
|
DEBUGFUNC();
|
||
|
/* On adapters with a MAC newer that 82544, SW Defineable pin 1 will be
|
||
|
* set when the optics detect a signal. On older adapters, it will be
|
||
|
* cleared when there is a signal
|
||
|
*/
|
||
|
ctrl = E1000_READ_REG(hw, CTRL);
|
||
|
if ((hw->mac_type > e1000_82544) && !(ctrl & E1000_CTRL_ILOS))
|
||
|
signal = E1000_CTRL_SWDPIN1;
|
||
|
else
|
||
|
signal = 0;
|
||
|
|
||
|
printf("signal for %s is %x (ctrl %08x)!!!!\n", nic->name, signal,
|
||
|
ctrl);
|
||
|
/* Take the link out of reset */
|
||
|
ctrl &= ~(E1000_CTRL_LRST);
|
||
|
|
||
|
e1000_config_collision_dist(hw);
|
||
|
|
||
|
/* Check for a software override of the flow control settings, and setup
|
||
|
* the device accordingly. If auto-negotiation is enabled, then software
|
||
|
* will have to set the "PAUSE" bits to the correct value in the Tranmsit
|
||
|
* Config Word Register (TXCW) and re-start auto-negotiation. However, if
|
||
|
* auto-negotiation is disabled, then software will have to manually
|
||
|
* configure the two flow control enable bits in the CTRL register.
|
||
|
*
|
||
|
* The possible values of the "fc" parameter are:
|
||
|
* 0: Flow control is completely disabled
|
||
|
* 1: Rx flow control is enabled (we can receive pause frames, but
|
||
|
* not send pause frames).
|
||
|
* 2: Tx flow control is enabled (we can send pause frames but we do
|
||
|
* not support receiving pause frames).
|
||
|
* 3: Both Rx and TX flow control (symmetric) are enabled.
|
||
|
*/
|
||
|
switch (hw->fc) {
|
||
|
case e1000_fc_none:
|
||
|
/* Flow control is completely disabled by a software over-ride. */
|
||
|
txcw = (E1000_TXCW_ANE | E1000_TXCW_FD);
|
||
|
break;
|
||
|
case e1000_fc_rx_pause:
|
||
|
/* RX Flow control is enabled and TX Flow control is disabled by a
|
||
|
* software over-ride. Since there really isn't a way to advertise
|
||
|
* that we are capable of RX Pause ONLY, we will advertise that we
|
||
|
* support both symmetric and asymmetric RX PAUSE. Later, we will
|
||
|
* disable the adapter's ability to send PAUSE frames.
|
||
|
*/
|
||
|
txcw = (E1000_TXCW_ANE | E1000_TXCW_FD | E1000_TXCW_PAUSE_MASK);
|
||
|
break;
|
||
|
case e1000_fc_tx_pause:
|
||
|
/* TX Flow control is enabled, and RX Flow control is disabled, by a
|
||
|
* software over-ride.
|
||
|
*/
|
||
|
txcw = (E1000_TXCW_ANE | E1000_TXCW_FD | E1000_TXCW_ASM_DIR);
|
||
|
break;
|
||
|
case e1000_fc_full:
|
||
|
/* Flow control (both RX and TX) is enabled by a software over-ride. */
|
||
|
txcw = (E1000_TXCW_ANE | E1000_TXCW_FD | E1000_TXCW_PAUSE_MASK);
|
||
|
break;
|
||
|
default:
|
||
|
DEBUGOUT("Flow control param set incorrectly\n");
|
||
|
return -E1000_ERR_CONFIG;
|
||
|
break;
|
||
|
}
|
||
|
|
||
|
/* Since auto-negotiation is enabled, take the link out of reset (the link
|
||
|
* will be in reset, because we previously reset the chip). This will
|
||
|
* restart auto-negotiation. If auto-neogtiation is successful then the
|
||
|
* link-up status bit will be set and the flow control enable bits (RFCE
|
||
|
* and TFCE) will be set according to their negotiated value.
|
||
|
*/
|
||
|
DEBUGOUT("Auto-negotiation enabled (%#x)\n", txcw);
|
||
|
|
||
|
E1000_WRITE_REG(hw, TXCW, txcw);
|
||
|
E1000_WRITE_REG(hw, CTRL, ctrl);
|
||
|
E1000_WRITE_FLUSH(hw);
|
||
|
|
||
|
hw->txcw = txcw;
|
||
|
mdelay(1);
|
||
|
|
||
|
/* If we have a signal (the cable is plugged in) then poll for a "Link-Up"
|
||
|
* indication in the Device Status Register. Time-out if a link isn't
|
||
|
* seen in 500 milliseconds seconds (Auto-negotiation should complete in
|
||
|
* less than 500 milliseconds even if the other end is doing it in SW).
|
||
|
*/
|
||
|
if ((E1000_READ_REG(hw, CTRL) & E1000_CTRL_SWDPIN1) == signal) {
|
||
|
DEBUGOUT("Looking for Link\n");
|
||
|
for (i = 0; i < (LINK_UP_TIMEOUT / 10); i++) {
|
||
|
mdelay(10);
|
||
|
status = E1000_READ_REG(hw, STATUS);
|
||
|
if (status & E1000_STATUS_LU)
|
||
|
break;
|
||
|
}
|
||
|
if (i == (LINK_UP_TIMEOUT / 10)) {
|
||
|
/* AutoNeg failed to achieve a link, so we'll call
|
||
|
* e1000_check_for_link. This routine will force the link up if we
|
||
|
* detect a signal. This will allow us to communicate with
|
||
|
* non-autonegotiating link partners.
|
||
|
*/
|
||
|
DEBUGOUT("Never got a valid link from auto-neg!!!\n");
|
||
|
hw->autoneg_failed = 1;
|
||
|
ret_val = e1000_check_for_link(nic);
|
||
|
if (ret_val < 0) {
|
||
|
DEBUGOUT("Error while checking for link\n");
|
||
|
return ret_val;
|
||
|
}
|
||
|
hw->autoneg_failed = 0;
|
||
|
} else {
|
||
|
hw->autoneg_failed = 0;
|
||
|
DEBUGOUT("Valid Link Found\n");
|
||
|
}
|
||
|
} else {
|
||
|
DEBUGOUT("No Signal Detected\n");
|
||
|
return -E1000_ERR_NOLINK;
|
||
|
}
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
/******************************************************************************
|
||
|
* Detects which PHY is present and the speed and duplex
|
||
|
*
|
||
|
* hw - Struct containing variables accessed by shared code
|
||
|
******************************************************************************/
|
||
|
static int
|
||
|
e1000_setup_copper_link(struct eth_device *nic)
|
||
|
{
|
||
|
struct e1000_hw *hw = nic->priv;
|
||
|
uint32_t ctrl;
|
||
|
int32_t ret_val;
|
||
|
uint16_t i;
|
||
|
uint16_t phy_data;
|
||
|
|
||
|
DEBUGFUNC();
|
||
|
|
||
|
ctrl = E1000_READ_REG(hw, CTRL);
|
||
|
/* With 82543, we need to force speed and duplex on the MAC equal to what
|
||
|
* the PHY speed and duplex configuration is. In addition, we need to
|
||
|
* perform a hardware reset on the PHY to take it out of reset.
|
||
|
*/
|
||
|
if (hw->mac_type > e1000_82543) {
|
||
|
ctrl |= E1000_CTRL_SLU;
|
||
|
ctrl &= ~(E1000_CTRL_FRCSPD | E1000_CTRL_FRCDPX);
|
||
|
E1000_WRITE_REG(hw, CTRL, ctrl);
|
||
|
} else {
|
||
|
ctrl |=
|
||
|
(E1000_CTRL_FRCSPD | E1000_CTRL_FRCDPX | E1000_CTRL_SLU);
|
||
|
E1000_WRITE_REG(hw, CTRL, ctrl);
|
||
|
e1000_phy_hw_reset(hw);
|
||
|
}
|
||
|
|
||
|
/* Make sure we have a valid PHY */
|
||
|
ret_val = e1000_detect_gig_phy(hw);
|
||
|
if (ret_val < 0) {
|
||
|
DEBUGOUT("Error, did not detect valid phy.\n");
|
||
|
return ret_val;
|
||
|
}
|
||
|
DEBUGOUT("Phy ID = %x \n", hw->phy_id);
|
||
|
|
||
|
/* Enable CRS on TX. This must be set for half-duplex operation. */
|
||
|
if (e1000_read_phy_reg(hw, M88E1000_PHY_SPEC_CTRL, &phy_data) < 0) {
|
||
|
DEBUGOUT("PHY Read Error\n");
|
||
|
return -E1000_ERR_PHY;
|
||
|
}
|
||
|
phy_data |= M88E1000_PSCR_ASSERT_CRS_ON_TX;
|
||
|
|
||
|
#if 0
|
||
|
/* Options:
|
||
|
* MDI/MDI-X = 0 (default)
|
||
|
* 0 - Auto for all speeds
|
||
|
* 1 - MDI mode
|
||
|
* 2 - MDI-X mode
|
||
|
* 3 - Auto for 1000Base-T only (MDI-X for 10/100Base-T modes)
|
||
|
*/
|
||
|
phy_data &= ~M88E1000_PSCR_AUTO_X_MODE;
|
||
|
switch (hw->mdix) {
|
||
|
case 1:
|
||
|
phy_data |= M88E1000_PSCR_MDI_MANUAL_MODE;
|
||
|
break;
|
||
|
case 2:
|
||
|
phy_data |= M88E1000_PSCR_MDIX_MANUAL_MODE;
|
||
|
break;
|
||
|
case 3:
|
||
|
phy_data |= M88E1000_PSCR_AUTO_X_1000T;
|
||
|
break;
|
||
|
case 0:
|
||
|
default:
|
||
|
phy_data |= M88E1000_PSCR_AUTO_X_MODE;
|
||
|
break;
|
||
|
}
|
||
|
#else
|
||
|
phy_data |= M88E1000_PSCR_AUTO_X_MODE;
|
||
|
#endif
|
||
|
|
||
|
#if 0
|
||
|
/* Options:
|
||
|
* disable_polarity_correction = 0 (default)
|
||
|
* Automatic Correction for Reversed Cable Polarity
|
||
|
* 0 - Disabled
|
||
|
* 1 - Enabled
|
||
|
*/
|
||
|
phy_data &= ~M88E1000_PSCR_POLARITY_REVERSAL;
|
||
|
if (hw->disable_polarity_correction == 1)
|
||
|
phy_data |= M88E1000_PSCR_POLARITY_REVERSAL;
|
||
|
#else
|
||
|
phy_data &= ~M88E1000_PSCR_POLARITY_REVERSAL;
|
||
|
#endif
|
||
|
if (e1000_write_phy_reg(hw, M88E1000_PHY_SPEC_CTRL, phy_data) < 0) {
|
||
|
DEBUGOUT("PHY Write Error\n");
|
||
|
return -E1000_ERR_PHY;
|
||
|
}
|
||
|
|
||
|
/* Force TX_CLK in the Extended PHY Specific Control Register
|
||
|
* to 25MHz clock.
|
||
|
*/
|
||
|
if (e1000_read_phy_reg(hw, M88E1000_EXT_PHY_SPEC_CTRL, &phy_data) < 0) {
|
||
|
DEBUGOUT("PHY Read Error\n");
|
||
|
return -E1000_ERR_PHY;
|
||
|
}
|
||
|
phy_data |= M88E1000_EPSCR_TX_CLK_25;
|
||
|
/* Configure Master and Slave downshift values */
|
||
|
phy_data &= ~(M88E1000_EPSCR_MASTER_DOWNSHIFT_MASK |
|
||
|
M88E1000_EPSCR_SLAVE_DOWNSHIFT_MASK);
|
||
|
phy_data |= (M88E1000_EPSCR_MASTER_DOWNSHIFT_1X |
|
||
|
M88E1000_EPSCR_SLAVE_DOWNSHIFT_1X);
|
||
|
if (e1000_write_phy_reg(hw, M88E1000_EXT_PHY_SPEC_CTRL, phy_data) < 0) {
|
||
|
DEBUGOUT("PHY Write Error\n");
|
||
|
return -E1000_ERR_PHY;
|
||
|
}
|
||
|
|
||
|
/* SW Reset the PHY so all changes take effect */
|
||
|
ret_val = e1000_phy_reset(hw);
|
||
|
if (ret_val < 0) {
|
||
|
DEBUGOUT("Error Resetting the PHY\n");
|
||
|
return ret_val;
|
||
|
}
|
||
|
|
||
|
/* Options:
|
||
|
* autoneg = 1 (default)
|
||
|
* PHY will advertise value(s) parsed from
|
||
|
* autoneg_advertised and fc
|
||
|
* autoneg = 0
|
||
|
* PHY will be set to 10H, 10F, 100H, or 100F
|
||
|
* depending on value parsed from forced_speed_duplex.
|
||
|
*/
|
||
|
|
||
|
/* Is autoneg enabled? This is enabled by default or by software override.
|
||
|
* If so, call e1000_phy_setup_autoneg routine to parse the
|
||
|
* autoneg_advertised and fc options. If autoneg is NOT enabled, then the
|
||
|
* user should have provided a speed/duplex override. If so, then call
|
||
|
* e1000_phy_force_speed_duplex to parse and set this up.
|
||
|
*/
|
||
|
/* Perform some bounds checking on the hw->autoneg_advertised
|
||
|
* parameter. If this variable is zero, then set it to the default.
|
||
|
*/
|
||
|
hw->autoneg_advertised &= AUTONEG_ADVERTISE_SPEED_DEFAULT;
|
||
|
|
||
|
/* If autoneg_advertised is zero, we assume it was not defaulted
|
||
|
* by the calling code so we set to advertise full capability.
|
||
|
*/
|
||
|
if (hw->autoneg_advertised == 0)
|
||
|
hw->autoneg_advertised = AUTONEG_ADVERTISE_SPEED_DEFAULT;
|
||
|
|
||
|
DEBUGOUT("Reconfiguring auto-neg advertisement params\n");
|
||
|
ret_val = e1000_phy_setup_autoneg(hw);
|
||
|
if (ret_val < 0) {
|
||
|
DEBUGOUT("Error Setting up Auto-Negotiation\n");
|
||
|
return ret_val;
|
||
|
}
|
||
|
DEBUGOUT("Restarting Auto-Neg\n");
|
||
|
|
||
|
/* Restart auto-negotiation by setting the Auto Neg Enable bit and
|
||
|
* the Auto Neg Restart bit in the PHY control register.
|
||
|
*/
|
||
|
if (e1000_read_phy_reg(hw, PHY_CTRL, &phy_data) < 0) {
|
||
|
DEBUGOUT("PHY Read Error\n");
|
||
|
return -E1000_ERR_PHY;
|
||
|
}
|
||
|
phy_data |= (MII_CR_AUTO_NEG_EN | MII_CR_RESTART_AUTO_NEG);
|
||
|
if (e1000_write_phy_reg(hw, PHY_CTRL, phy_data) < 0) {
|
||
|
DEBUGOUT("PHY Write Error\n");
|
||
|
return -E1000_ERR_PHY;
|
||
|
}
|
||
|
#if 0
|
||
|
/* Does the user want to wait for Auto-Neg to complete here, or
|
||
|
* check at a later time (for example, callback routine).
|
||
|
*/
|
||
|
if (hw->wait_autoneg_complete) {
|
||
|
ret_val = e1000_wait_autoneg(hw);
|
||
|
if (ret_val < 0) {
|
||
|
DEBUGOUT
|
||
|
("Error while waiting for autoneg to complete\n");
|
||
|
return ret_val;
|
||
|
}
|
||
|
}
|
||
|
#else
|
||
|
/* If we do not wait for autonegtation to complete I
|
||
|
* do not see a valid link status.
|
||
|
*/
|
||
|
ret_val = e1000_wait_autoneg(hw);
|
||
|
if (ret_val < 0) {
|
||
|
DEBUGOUT("Error while waiting for autoneg to complete\n");
|
||
|
return ret_val;
|
||
|
}
|
||
|
#endif
|
||
|
|
||
|
/* Check link status. Wait up to 100 microseconds for link to become
|
||
|
* valid.
|
||
|
*/
|
||
|
for (i = 0; i < 10; i++) {
|
||
|
if (e1000_read_phy_reg(hw, PHY_STATUS, &phy_data) < 0) {
|
||
|
DEBUGOUT("PHY Read Error\n");
|
||
|
return -E1000_ERR_PHY;
|
||
|
}
|
||
|
if (e1000_read_phy_reg(hw, PHY_STATUS, &phy_data) < 0) {
|
||
|
DEBUGOUT("PHY Read Error\n");
|
||
|
return -E1000_ERR_PHY;
|
||
|
}
|
||
|
if (phy_data & MII_SR_LINK_STATUS) {
|
||
|
/* We have link, so we need to finish the config process:
|
||
|
* 1) Set up the MAC to the current PHY speed/duplex
|
||
|
* if we are on 82543. If we
|
||
|
* are on newer silicon, we only need to configure
|
||
|
* collision distance in the Transmit Control Register.
|
||
|
* 2) Set up flow control on the MAC to that established with
|
||
|
* the link partner.
|
||
|
*/
|
||
|
if (hw->mac_type >= e1000_82544) {
|
||
|
e1000_config_collision_dist(hw);
|
||
|
} else {
|
||
|
ret_val = e1000_config_mac_to_phy(hw);
|
||
|
if (ret_val < 0) {
|
||
|
DEBUGOUT
|
||
|
("Error configuring MAC to PHY settings\n");
|
||
|
return ret_val;
|
||
|
}
|
||
|
}
|
||
|
ret_val = e1000_config_fc_after_link_up(hw);
|
||
|
if (ret_val < 0) {
|
||
|
DEBUGOUT("Error Configuring Flow Control\n");
|
||
|
return ret_val;
|
||
|
}
|
||
|
DEBUGOUT("Valid link established!!!\n");
|
||
|
return 0;
|
||
|
}
|
||
|
udelay(10);
|
||
|
}
|
||
|
|
||
|
DEBUGOUT("Unable to establish link!!!\n");
|
||
|
return -E1000_ERR_NOLINK;
|
||
|
}
|
||
|
|
||
|
/******************************************************************************
|
||
|
* Configures PHY autoneg and flow control advertisement settings
|
||
|
*
|
||
|
* hw - Struct containing variables accessed by shared code
|
||
|
******************************************************************************/
|
||
|
static int
|
||
|
e1000_phy_setup_autoneg(struct e1000_hw *hw)
|
||
|
{
|
||
|
uint16_t mii_autoneg_adv_reg;
|
||
|
uint16_t mii_1000t_ctrl_reg;
|
||
|
|
||
|
DEBUGFUNC();
|
||
|
|
||
|
/* Read the MII Auto-Neg Advertisement Register (Address 4). */
|
||
|
if (e1000_read_phy_reg(hw, PHY_AUTONEG_ADV, &mii_autoneg_adv_reg) < 0) {
|
||
|
DEBUGOUT("PHY Read Error\n");
|
||
|
return -E1000_ERR_PHY;
|
||
|
}
|
||
|
|
||
|
/* Read the MII 1000Base-T Control Register (Address 9). */
|
||
|
if (e1000_read_phy_reg(hw, PHY_1000T_CTRL, &mii_1000t_ctrl_reg) < 0) {
|
||
|
DEBUGOUT("PHY Read Error\n");
|
||
|
return -E1000_ERR_PHY;
|
||
|
}
|
||
|
|
||
|
/* Need to parse both autoneg_advertised and fc and set up
|
||
|
* the appropriate PHY registers. First we will parse for
|
||
|
* autoneg_advertised software override. Since we can advertise
|
||
|
* a plethora of combinations, we need to check each bit
|
||
|
* individually.
|
||
|
*/
|
||
|
|
||
|
/* First we clear all the 10/100 mb speed bits in the Auto-Neg
|
||
|
* Advertisement Register (Address 4) and the 1000 mb speed bits in
|
||
|
* the 1000Base-T Control Register (Address 9).
|
||
|
*/
|
||
|
mii_autoneg_adv_reg &= ~REG4_SPEED_MASK;
|
||
|
mii_1000t_ctrl_reg &= ~REG9_SPEED_MASK;
|
||
|
|
||
|
DEBUGOUT("autoneg_advertised %x\n", hw->autoneg_advertised);
|
||
|
|
||
|
/* Do we want to advertise 10 Mb Half Duplex? */
|
||
|
if (hw->autoneg_advertised & ADVERTISE_10_HALF) {
|
||
|
DEBUGOUT("Advertise 10mb Half duplex\n");
|
||
|
mii_autoneg_adv_reg |= NWAY_AR_10T_HD_CAPS;
|
||
|
}
|
||
|
|
||
|
/* Do we want to advertise 10 Mb Full Duplex? */
|
||
|
if (hw->autoneg_advertised & ADVERTISE_10_FULL) {
|
||
|
DEBUGOUT("Advertise 10mb Full duplex\n");
|
||
|
mii_autoneg_adv_reg |= NWAY_AR_10T_FD_CAPS;
|
||
|
}
|
||
|
|
||
|
/* Do we want to advertise 100 Mb Half Duplex? */
|
||
|
if (hw->autoneg_advertised & ADVERTISE_100_HALF) {
|
||
|
DEBUGOUT("Advertise 100mb Half duplex\n");
|
||
|
mii_autoneg_adv_reg |= NWAY_AR_100TX_HD_CAPS;
|
||
|
}
|
||
|
|
||
|
/* Do we want to advertise 100 Mb Full Duplex? */
|
||
|
if (hw->autoneg_advertised & ADVERTISE_100_FULL) {
|
||
|
DEBUGOUT("Advertise 100mb Full duplex\n");
|
||
|
mii_autoneg_adv_reg |= NWAY_AR_100TX_FD_CAPS;
|
||
|
}
|
||
|
|
||
|
/* We do not allow the Phy to advertise 1000 Mb Half Duplex */
|
||
|
if (hw->autoneg_advertised & ADVERTISE_1000_HALF) {
|
||
|
DEBUGOUT
|
||
|
("Advertise 1000mb Half duplex requested, request denied!\n");
|
||
|
}
|
||
|
|
||
|
/* Do we want to advertise 1000 Mb Full Duplex? */
|
||
|
if (hw->autoneg_advertised & ADVERTISE_1000_FULL) {
|
||
|
DEBUGOUT("Advertise 1000mb Full duplex\n");
|
||
|
mii_1000t_ctrl_reg |= CR_1000T_FD_CAPS;
|
||
|
}
|
||
|
|
||
|
/* Check for a software override of the flow control settings, and
|
||
|
* setup the PHY advertisement registers accordingly. If
|
||
|
* auto-negotiation is enabled, then software will have to set the
|
||
|
* "PAUSE" bits to the correct value in the Auto-Negotiation
|
||
|
* Advertisement Register (PHY_AUTONEG_ADV) and re-start auto-negotiation.
|
||
|
*
|
||
|
* The possible values of the "fc" parameter are:
|
||
|
* 0: Flow control is completely disabled
|
||
|
* 1: Rx flow control is enabled (we can receive pause frames
|
||
|
* but not send pause frames).
|
||
|
* 2: Tx flow control is enabled (we can send pause frames
|
||
|
* but we do not support receiving pause frames).
|
||
|
* 3: Both Rx and TX flow control (symmetric) are enabled.
|
||
|
* other: No software override. The flow control configuration
|
||
|
* in the EEPROM is used.
|
||
|
*/
|
||
|
switch (hw->fc) {
|
||
|
case e1000_fc_none: /* 0 */
|
||
|
/* Flow control (RX & TX) is completely disabled by a
|
||
|
* software over-ride.
|
||
|
*/
|
||
|
mii_autoneg_adv_reg &= ~(NWAY_AR_ASM_DIR | NWAY_AR_PAUSE);
|
||
|
break;
|
||
|
case e1000_fc_rx_pause: /* 1 */
|
||
|
/* RX Flow control is enabled, and TX Flow control is
|
||
|
* disabled, by a software over-ride.
|
||
|
*/
|
||
|
/* Since there really isn't a way to advertise that we are
|
||
|
* capable of RX Pause ONLY, we will advertise that we
|
||
|
* support both symmetric and asymmetric RX PAUSE. Later
|
||
|
* (in e1000_config_fc_after_link_up) we will disable the
|
||
|
*hw's ability to send PAUSE frames.
|
||
|
*/
|
||
|
mii_autoneg_adv_reg |= (NWAY_AR_ASM_DIR | NWAY_AR_PAUSE);
|
||
|
break;
|
||
|
case e1000_fc_tx_pause: /* 2 */
|
||
|
/* TX Flow control is enabled, and RX Flow control is
|
||
|
* disabled, by a software over-ride.
|
||
|
*/
|
||
|
mii_autoneg_adv_reg |= NWAY_AR_ASM_DIR;
|
||
|
mii_autoneg_adv_reg &= ~NWAY_AR_PAUSE;
|
||
|
break;
|
||
|
case e1000_fc_full: /* 3 */
|
||
|
/* Flow control (both RX and TX) is enabled by a software
|
||
|
* over-ride.
|
||
|
*/
|
||
|
mii_autoneg_adv_reg |= (NWAY_AR_ASM_DIR | NWAY_AR_PAUSE);
|
||
|
break;
|
||
|
default:
|
||
|
DEBUGOUT("Flow control param set incorrectly\n");
|
||
|
return -E1000_ERR_CONFIG;
|
||
|
}
|
||
|
|
||
|
if (e1000_write_phy_reg(hw, PHY_AUTONEG_ADV, mii_autoneg_adv_reg) < 0) {
|
||
|
DEBUGOUT("PHY Write Error\n");
|
||
|
return -E1000_ERR_PHY;
|
||
|
}
|
||
|
|
||
|
DEBUGOUT("Auto-Neg Advertising %x\n", mii_autoneg_adv_reg);
|
||
|
|
||
|
if (e1000_write_phy_reg(hw, PHY_1000T_CTRL, mii_1000t_ctrl_reg) < 0) {
|
||
|
DEBUGOUT("PHY Write Error\n");
|
||
|
return -E1000_ERR_PHY;
|
||
|
}
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
/******************************************************************************
|
||
|
* Sets the collision distance in the Transmit Control register
|
||
|
*
|
||
|
* hw - Struct containing variables accessed by shared code
|
||
|
*
|
||
|
* Link should have been established previously. Reads the speed and duplex
|
||
|
* information from the Device Status register.
|
||
|
******************************************************************************/
|
||
|
static void
|
||
|
e1000_config_collision_dist(struct e1000_hw *hw)
|
||
|
{
|
||
|
uint32_t tctl;
|
||
|
|
||
|
tctl = E1000_READ_REG(hw, TCTL);
|
||
|
|
||
|
tctl &= ~E1000_TCTL_COLD;
|
||
|
tctl |= E1000_COLLISION_DISTANCE << E1000_COLD_SHIFT;
|
||
|
|
||
|
E1000_WRITE_REG(hw, TCTL, tctl);
|
||
|
E1000_WRITE_FLUSH(hw);
|
||
|
}
|
||
|
|
||
|
/******************************************************************************
|
||
|
* Sets MAC speed and duplex settings to reflect the those in the PHY
|
||
|
*
|
||
|
* hw - Struct containing variables accessed by shared code
|
||
|
* mii_reg - data to write to the MII control register
|
||
|
*
|
||
|
* The contents of the PHY register containing the needed information need to
|
||
|
* be passed in.
|
||
|
******************************************************************************/
|
||
|
static int
|
||
|
e1000_config_mac_to_phy(struct e1000_hw *hw)
|
||
|
{
|
||
|
uint32_t ctrl;
|
||
|
uint16_t phy_data;
|
||
|
|
||
|
DEBUGFUNC();
|
||
|
|
||
|
/* Read the Device Control Register and set the bits to Force Speed
|
||
|
* and Duplex.
|
||
|
*/
|
||
|
ctrl = E1000_READ_REG(hw, CTRL);
|
||
|
ctrl |= (E1000_CTRL_FRCSPD | E1000_CTRL_FRCDPX);
|
||
|
ctrl &= ~(E1000_CTRL_SPD_SEL | E1000_CTRL_ILOS);
|
||
|
|
||
|
/* Set up duplex in the Device Control and Transmit Control
|
||
|
* registers depending on negotiated values.
|
||
|
*/
|
||
|
if (e1000_read_phy_reg(hw, M88E1000_PHY_SPEC_STATUS, &phy_data) < 0) {
|
||
|
DEBUGOUT("PHY Read Error\n");
|
||
|
return -E1000_ERR_PHY;
|
||
|
}
|
||
|
if (phy_data & M88E1000_PSSR_DPLX)
|
||
|
ctrl |= E1000_CTRL_FD;
|
||
|
else
|
||
|
ctrl &= ~E1000_CTRL_FD;
|
||
|
|
||
|
e1000_config_collision_dist(hw);
|
||
|
|
||
|
/* Set up speed in the Device Control register depending on
|
||
|
* negotiated values.
|
||
|
*/
|
||
|
if ((phy_data & M88E1000_PSSR_SPEED) == M88E1000_PSSR_1000MBS)
|
||
|
ctrl |= E1000_CTRL_SPD_1000;
|
||
|
else if ((phy_data & M88E1000_PSSR_SPEED) == M88E1000_PSSR_100MBS)
|
||
|
ctrl |= E1000_CTRL_SPD_100;
|
||
|
/* Write the configured values back to the Device Control Reg. */
|
||
|
E1000_WRITE_REG(hw, CTRL, ctrl);
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
/******************************************************************************
|
||
|
* Forces the MAC's flow control settings.
|
||
|
*
|
||
|
* hw - Struct containing variables accessed by shared code
|
||
|
*
|
||
|
* Sets the TFCE and RFCE bits in the device control register to reflect
|
||
|
* the adapter settings. TFCE and RFCE need to be explicitly set by
|
||
|
* software when a Copper PHY is used because autonegotiation is managed
|
||
|
* by the PHY rather than the MAC. Software must also configure these
|
||
|
* bits when link is forced on a fiber connection.
|
||
|
*****************************************************************************/
|
||
|
static int
|
||
|
e1000_force_mac_fc(struct e1000_hw *hw)
|
||
|
{
|
||
|
uint32_t ctrl;
|
||
|
|
||
|
DEBUGFUNC();
|
||
|
|
||
|
/* Get the current configuration of the Device Control Register */
|
||
|
ctrl = E1000_READ_REG(hw, CTRL);
|
||
|
|
||
|
/* Because we didn't get link via the internal auto-negotiation
|
||
|
* mechanism (we either forced link or we got link via PHY
|
||
|
* auto-neg), we have to manually enable/disable transmit an
|
||
|
* receive flow control.
|
||
|
*
|
||
|
* The "Case" statement below enables/disable flow control
|
||
|
* according to the "hw->fc" parameter.
|
||
|
*
|
||
|
* The possible values of the "fc" parameter are:
|
||
|
* 0: Flow control is completely disabled
|
||
|
* 1: Rx flow control is enabled (we can receive pause
|
||
|
* frames but not send pause frames).
|
||
|
* 2: Tx flow control is enabled (we can send pause frames
|
||
|
* frames but we do not receive pause frames).
|
||
|
* 3: Both Rx and TX flow control (symmetric) is enabled.
|
||
|
* other: No other values should be possible at this point.
|
||
|
*/
|
||
|
|
||
|
switch (hw->fc) {
|
||
|
case e1000_fc_none:
|
||
|
ctrl &= (~(E1000_CTRL_TFCE | E1000_CTRL_RFCE));
|
||
|
break;
|
||
|
case e1000_fc_rx_pause:
|
||
|
ctrl &= (~E1000_CTRL_TFCE);
|
||
|
ctrl |= E1000_CTRL_RFCE;
|
||
|
break;
|
||
|
case e1000_fc_tx_pause:
|
||
|
ctrl &= (~E1000_CTRL_RFCE);
|
||
|
ctrl |= E1000_CTRL_TFCE;
|
||
|
break;
|
||
|
case e1000_fc_full:
|
||
|
ctrl |= (E1000_CTRL_TFCE | E1000_CTRL_RFCE);
|
||
|
break;
|
||
|
default:
|
||
|
DEBUGOUT("Flow control param set incorrectly\n");
|
||
|
return -E1000_ERR_CONFIG;
|
||
|
}
|
||
|
|
||
|
/* Disable TX Flow Control for 82542 (rev 2.0) */
|
||
|
if (hw->mac_type == e1000_82542_rev2_0)
|
||
|
ctrl &= (~E1000_CTRL_TFCE);
|
||
|
|
||
|
E1000_WRITE_REG(hw, CTRL, ctrl);
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
/******************************************************************************
|
||
|
* Configures flow control settings after link is established
|
||
|
*
|
||
|
* hw - Struct containing variables accessed by shared code
|
||
|
*
|
||
|
* Should be called immediately after a valid link has been established.
|
||
|
* Forces MAC flow control settings if link was forced. When in MII/GMII mode
|
||
|
* and autonegotiation is enabled, the MAC flow control settings will be set
|
||
|
* based on the flow control negotiated by the PHY. In TBI mode, the TFCE
|
||
|
* and RFCE bits will be automaticaly set to the negotiated flow control mode.
|
||
|
*****************************************************************************/
|
||
|
static int
|
||
|
e1000_config_fc_after_link_up(struct e1000_hw *hw)
|
||
|
{
|
||
|
int32_t ret_val;
|
||
|
uint16_t mii_status_reg;
|
||
|
uint16_t mii_nway_adv_reg;
|
||
|
uint16_t mii_nway_lp_ability_reg;
|
||
|
uint16_t speed;
|
||
|
uint16_t duplex;
|
||
|
|
||
|
DEBUGFUNC();
|
||
|
|
||
|
/* Check for the case where we have fiber media and auto-neg failed
|
||
|
* so we had to force link. In this case, we need to force the
|
||
|
* configuration of the MAC to match the "fc" parameter.
|
||
|
*/
|
||
|
if ((hw->media_type == e1000_media_type_fiber) && (hw->autoneg_failed)) {
|
||
|
ret_val = e1000_force_mac_fc(hw);
|
||
|
if (ret_val < 0) {
|
||
|
DEBUGOUT("Error forcing flow control settings\n");
|
||
|
return ret_val;
|
||
|
}
|
||
|
}
|
||
|
|
||
|
/* Check for the case where we have copper media and auto-neg is
|
||
|
* enabled. In this case, we need to check and see if Auto-Neg
|
||
|
* has completed, and if so, how the PHY and link partner has
|
||
|
* flow control configured.
|
||
|
*/
|
||
|
if (hw->media_type == e1000_media_type_copper) {
|
||
|
/* Read the MII Status Register and check to see if AutoNeg
|
||
|
* has completed. We read this twice because this reg has
|
||
|
* some "sticky" (latched) bits.
|
||
|
*/
|
||
|
if (e1000_read_phy_reg(hw, PHY_STATUS, &mii_status_reg) < 0) {
|
||
|
DEBUGOUT("PHY Read Error \n");
|
||
|
return -E1000_ERR_PHY;
|
||
|
}
|
||
|
if (e1000_read_phy_reg(hw, PHY_STATUS, &mii_status_reg) < 0) {
|
||
|
DEBUGOUT("PHY Read Error \n");
|
||
|
return -E1000_ERR_PHY;
|
||
|
}
|
||
|
|
||
|
if (mii_status_reg & MII_SR_AUTONEG_COMPLETE) {
|
||
|
/* The AutoNeg process has completed, so we now need to
|
||
|
* read both the Auto Negotiation Advertisement Register
|
||
|
* (Address 4) and the Auto_Negotiation Base Page Ability
|
||
|
* Register (Address 5) to determine how flow control was
|
||
|
* negotiated.
|
||
|
*/
|
||
|
if (e1000_read_phy_reg
|
||
|
(hw, PHY_AUTONEG_ADV, &mii_nway_adv_reg) < 0) {
|
||
|
DEBUGOUT("PHY Read Error\n");
|
||
|
return -E1000_ERR_PHY;
|
||
|
}
|
||
|
if (e1000_read_phy_reg
|
||
|
(hw, PHY_LP_ABILITY,
|
||
|
&mii_nway_lp_ability_reg) < 0) {
|
||
|
DEBUGOUT("PHY Read Error\n");
|
||
|
return -E1000_ERR_PHY;
|
||
|
}
|
||
|
|
||
|
/* Two bits in the Auto Negotiation Advertisement Register
|
||
|
* (Address 4) and two bits in the Auto Negotiation Base
|
||
|
* Page Ability Register (Address 5) determine flow control
|
||
|
* for both the PHY and the link partner. The following
|
||
|
* table, taken out of the IEEE 802.3ab/D6.0 dated March 25,
|
||
|
* 1999, describes these PAUSE resolution bits and how flow
|
||
|
* control is determined based upon these settings.
|
||
|
* NOTE: DC = Don't Care
|
||
|
*
|
||
|
* LOCAL DEVICE | LINK PARTNER
|
||
|
* PAUSE | ASM_DIR | PAUSE | ASM_DIR | NIC Resolution
|
||
|
*-------|---------|-------|---------|--------------------
|
||
|
* 0 | 0 | DC | DC | e1000_fc_none
|
||
|
* 0 | 1 | 0 | DC | e1000_fc_none
|
||
|
* 0 | 1 | 1 | 0 | e1000_fc_none
|
||
|
* 0 | 1 | 1 | 1 | e1000_fc_tx_pause
|
||
|
* 1 | 0 | 0 | DC | e1000_fc_none
|
||
|
* 1 | DC | 1 | DC | e1000_fc_full
|
||
|
* 1 | 1 | 0 | 0 | e1000_fc_none
|
||
|
* 1 | 1 | 0 | 1 | e1000_fc_rx_pause
|
||
|
*
|
||
|
*/
|
||
|
/* Are both PAUSE bits set to 1? If so, this implies
|
||
|
* Symmetric Flow Control is enabled at both ends. The
|
||
|
* ASM_DIR bits are irrelevant per the spec.
|
||
|
*
|
||
|
* For Symmetric Flow Control:
|
||
|
*
|
||
|
* LOCAL DEVICE | LINK PARTNER
|
||
|
* PAUSE | ASM_DIR | PAUSE | ASM_DIR | Result
|
||
|
*-------|---------|-------|---------|--------------------
|
||
|
* 1 | DC | 1 | DC | e1000_fc_full
|
||
|
*
|
||
|
*/
|
||
|
if ((mii_nway_adv_reg & NWAY_AR_PAUSE) &&
|
||
|
(mii_nway_lp_ability_reg & NWAY_LPAR_PAUSE)) {
|
||
|
/* Now we need to check if the user selected RX ONLY
|
||
|
* of pause frames. In this case, we had to advertise
|
||
|
* FULL flow control because we could not advertise RX
|
||
|
* ONLY. Hence, we must now check to see if we need to
|
||
|
* turn OFF the TRANSMISSION of PAUSE frames.
|
||
|
*/
|
||
|
if (hw->original_fc == e1000_fc_full) {
|
||
|
hw->fc = e1000_fc_full;
|
||
|
DEBUGOUT("Flow Control = FULL.\r\n");
|
||
|
} else {
|
||
|
hw->fc = e1000_fc_rx_pause;
|
||
|
DEBUGOUT
|
||
|
("Flow Control = RX PAUSE frames only.\r\n");
|
||
|
}
|
||
|
}
|
||
|
/* For receiving PAUSE frames ONLY.
|
||
|
*
|
||
|
* LOCAL DEVICE | LINK PARTNER
|
||
|
* PAUSE | ASM_DIR | PAUSE | ASM_DIR | Result
|
||
|
*-------|---------|-------|---------|--------------------
|
||
|
* 0 | 1 | 1 | 1 | e1000_fc_tx_pause
|
||
|
*
|
||
|
*/
|
||
|
else if (!(mii_nway_adv_reg & NWAY_AR_PAUSE) &&
|
||
|
(mii_nway_adv_reg & NWAY_AR_ASM_DIR) &&
|
||
|
(mii_nway_lp_ability_reg & NWAY_LPAR_PAUSE) &&
|
||
|
(mii_nway_lp_ability_reg & NWAY_LPAR_ASM_DIR))
|
||
|
{
|
||
|
hw->fc = e1000_fc_tx_pause;
|
||
|
DEBUGOUT
|
||
|
("Flow Control = TX PAUSE frames only.\r\n");
|
||
|
}
|
||
|
/* For transmitting PAUSE frames ONLY.
|
||
|
*
|
||
|
* LOCAL DEVICE | LINK PARTNER
|
||
|
* PAUSE | ASM_DIR | PAUSE | ASM_DIR | Result
|
||
|
*-------|---------|-------|---------|--------------------
|
||
|
* 1 | 1 | 0 | 1 | e1000_fc_rx_pause
|
||
|
*
|
||
|
*/
|
||
|
else if ((mii_nway_adv_reg & NWAY_AR_PAUSE) &&
|
||
|
(mii_nway_adv_reg & NWAY_AR_ASM_DIR) &&
|
||
|
!(mii_nway_lp_ability_reg & NWAY_LPAR_PAUSE) &&
|
||
|
(mii_nway_lp_ability_reg & NWAY_LPAR_ASM_DIR))
|
||
|
{
|
||
|
hw->fc = e1000_fc_rx_pause;
|
||
|
DEBUGOUT
|
||
|
("Flow Control = RX PAUSE frames only.\r\n");
|
||
|
}
|
||
|
/* Per the IEEE spec, at this point flow control should be
|
||
|
* disabled. However, we want to consider that we could
|
||
|
* be connected to a legacy switch that doesn't advertise
|
||
|
* desired flow control, but can be forced on the link
|
||
|
* partner. So if we advertised no flow control, that is
|
||
|
* what we will resolve to. If we advertised some kind of
|
||
|
* receive capability (Rx Pause Only or Full Flow Control)
|
||
|
* and the link partner advertised none, we will configure
|
||
|
* ourselves to enable Rx Flow Control only. We can do
|
||
|
* this safely for two reasons: If the link partner really
|
||
|
* didn't want flow control enabled, and we enable Rx, no
|
||
|
* harm done since we won't be receiving any PAUSE frames
|
||
|
* anyway. If the intent on the link partner was to have
|
||
|
* flow control enabled, then by us enabling RX only, we
|
||
|
* can at least receive pause frames and process them.
|
||
|
* This is a good idea because in most cases, since we are
|
||
|
* predominantly a server NIC, more times than not we will
|
||
|
* be asked to delay transmission of packets than asking
|
||
|
* our link partner to pause transmission of frames.
|
||
|
*/
|
||
|
else if (hw->original_fc == e1000_fc_none ||
|
||
|
hw->original_fc == e1000_fc_tx_pause) {
|
||
|
hw->fc = e1000_fc_none;
|
||
|
DEBUGOUT("Flow Control = NONE.\r\n");
|
||
|
} else {
|
||
|
hw->fc = e1000_fc_rx_pause;
|
||
|
DEBUGOUT
|
||
|
("Flow Control = RX PAUSE frames only.\r\n");
|
||
|
}
|
||
|
|
||
|
/* Now we need to do one last check... If we auto-
|
||
|
* negotiated to HALF DUPLEX, flow control should not be
|
||
|
* enabled per IEEE 802.3 spec.
|
||
|
*/
|
||
|
e1000_get_speed_and_duplex(hw, &speed, &duplex);
|
||
|
|
||
|
if (duplex == HALF_DUPLEX)
|
||
|
hw->fc = e1000_fc_none;
|
||
|
|
||
|
/* Now we call a subroutine to actually force the MAC
|
||
|
* controller to use the correct flow control settings.
|
||
|
*/
|
||
|
ret_val = e1000_force_mac_fc(hw);
|
||
|
if (ret_val < 0) {
|
||
|
DEBUGOUT
|
||
|
("Error forcing flow control settings\n");
|
||
|
return ret_val;
|
||
|
}
|
||
|
} else {
|
||
|
DEBUGOUT
|
||
|
("Copper PHY and Auto Neg has not completed.\r\n");
|
||
|
}
|
||
|
}
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
/******************************************************************************
|
||
|
* Checks to see if the link status of the hardware has changed.
|
||
|
*
|
||
|
* hw - Struct containing variables accessed by shared code
|
||
|
*
|
||
|
* Called by any function that needs to check the link status of the adapter.
|
||
|
*****************************************************************************/
|
||
|
static int
|
||
|
e1000_check_for_link(struct eth_device *nic)
|
||
|
{
|
||
|
struct e1000_hw *hw = nic->priv;
|
||
|
uint32_t rxcw;
|
||
|
uint32_t ctrl;
|
||
|
uint32_t status;
|
||
|
uint32_t rctl;
|
||
|
uint32_t signal;
|
||
|
int32_t ret_val;
|
||
|
uint16_t phy_data;
|
||
|
uint16_t lp_capability;
|
||
|
|
||
|
DEBUGFUNC();
|
||
|
|
||
|
/* On adapters with a MAC newer that 82544, SW Defineable pin 1 will be
|
||
|
* set when the optics detect a signal. On older adapters, it will be
|
||
|
* cleared when there is a signal
|
||
|
*/
|
||
|
ctrl = E1000_READ_REG(hw, CTRL);
|
||
|
if ((hw->mac_type > e1000_82544) && !(ctrl & E1000_CTRL_ILOS))
|
||
|
signal = E1000_CTRL_SWDPIN1;
|
||
|
else
|
||
|
signal = 0;
|
||
|
|
||
|
status = E1000_READ_REG(hw, STATUS);
|
||
|
rxcw = E1000_READ_REG(hw, RXCW);
|
||
|
DEBUGOUT("ctrl: %#08x status %#08x rxcw %#08x\n", ctrl, status, rxcw);
|
||
|
|
||
|
/* If we have a copper PHY then we only want to go out to the PHY
|
||
|
* registers to see if Auto-Neg has completed and/or if our link
|
||
|
* status has changed. The get_link_status flag will be set if we
|
||
|
* receive a Link Status Change interrupt or we have Rx Sequence
|
||
|
* Errors.
|
||
|
*/
|
||
|
if ((hw->media_type == e1000_media_type_copper) && hw->get_link_status) {
|
||
|
/* First we want to see if the MII Status Register reports
|
||
|
* link. If so, then we want to get the current speed/duplex
|
||
|
* of the PHY.
|
||
|
* Read the register twice since the link bit is sticky.
|
||
|
*/
|
||
|
if (e1000_read_phy_reg(hw, PHY_STATUS, &phy_data) < 0) {
|
||
|
DEBUGOUT("PHY Read Error\n");
|
||
|
return -E1000_ERR_PHY;
|
||
|
}
|
||
|
if (e1000_read_phy_reg(hw, PHY_STATUS, &phy_data) < 0) {
|
||
|
DEBUGOUT("PHY Read Error\n");
|
||
|
return -E1000_ERR_PHY;
|
||
|
}
|
||
|
|
||
|
if (phy_data & MII_SR_LINK_STATUS) {
|
||
|
hw->get_link_status = FALSE;
|
||
|
} else {
|
||
|
/* No link detected */
|
||
|
return -E1000_ERR_NOLINK;
|
||
|
}
|
||
|
|
||
|
/* We have a M88E1000 PHY and Auto-Neg is enabled. If we
|
||
|
* have Si on board that is 82544 or newer, Auto
|
||
|
* Speed Detection takes care of MAC speed/duplex
|
||
|
* configuration. So we only need to configure Collision
|
||
|
* Distance in the MAC. Otherwise, we need to force
|
||
|
* speed/duplex on the MAC to the current PHY speed/duplex
|
||
|
* settings.
|
||
|
*/
|
||
|
if (hw->mac_type >= e1000_82544)
|
||
|
e1000_config_collision_dist(hw);
|
||
|
else {
|
||
|
ret_val = e1000_config_mac_to_phy(hw);
|
||
|
if (ret_val < 0) {
|
||
|
DEBUGOUT
|
||
|
("Error configuring MAC to PHY settings\n");
|
||
|
return ret_val;
|
||
|
}
|
||
|
}
|
||
|
|
||
|
/* Configure Flow Control now that Auto-Neg has completed. First, we
|
||
|
* need to restore the desired flow control settings because we may
|
||
|
* have had to re-autoneg with a different link partner.
|
||
|
*/
|
||
|
ret_val = e1000_config_fc_after_link_up(hw);
|
||
|
if (ret_val < 0) {
|
||
|
DEBUGOUT("Error configuring flow control\n");
|
||
|
return ret_val;
|
||
|
}
|
||
|
|
||
|
/* At this point we know that we are on copper and we have
|
||
|
* auto-negotiated link. These are conditions for checking the link
|
||
|
* parter capability register. We use the link partner capability to
|
||
|
* determine if TBI Compatibility needs to be turned on or off. If
|
||
|
* the link partner advertises any speed in addition to Gigabit, then
|
||
|
* we assume that they are GMII-based, and TBI compatibility is not
|
||
|
* needed. If no other speeds are advertised, we assume the link
|
||
|
* partner is TBI-based, and we turn on TBI Compatibility.
|
||
|
*/
|
||
|
if (hw->tbi_compatibility_en) {
|
||
|
if (e1000_read_phy_reg
|
||
|
(hw, PHY_LP_ABILITY, &lp_capability) < 0) {
|
||
|
DEBUGOUT("PHY Read Error\n");
|
||
|
return -E1000_ERR_PHY;
|
||
|
}
|
||
|
if (lp_capability & (NWAY_LPAR_10T_HD_CAPS |
|
||
|
NWAY_LPAR_10T_FD_CAPS |
|
||
|
NWAY_LPAR_100TX_HD_CAPS |
|
||
|
NWAY_LPAR_100TX_FD_CAPS |
|
||
|
NWAY_LPAR_100T4_CAPS)) {
|
||
|
/* If our link partner advertises anything in addition to
|
||
|
* gigabit, we do not need to enable TBI compatibility.
|
||
|
*/
|
||
|
if (hw->tbi_compatibility_on) {
|
||
|
/* If we previously were in the mode, turn it off. */
|
||
|
rctl = E1000_READ_REG(hw, RCTL);
|
||
|
rctl &= ~E1000_RCTL_SBP;
|
||
|
E1000_WRITE_REG(hw, RCTL, rctl);
|
||
|
hw->tbi_compatibility_on = FALSE;
|
||
|
}
|
||
|
} else {
|
||
|
/* If TBI compatibility is was previously off, turn it on. For
|
||
|
* compatibility with a TBI link partner, we will store bad
|
||
|
* packets. Some frames have an additional byte on the end and
|
||
|
* will look like CRC errors to to the hardware.
|
||
|
*/
|
||
|
if (!hw->tbi_compatibility_on) {
|
||
|
hw->tbi_compatibility_on = TRUE;
|
||
|
rctl = E1000_READ_REG(hw, RCTL);
|
||
|
rctl |= E1000_RCTL_SBP;
|
||
|
E1000_WRITE_REG(hw, RCTL, rctl);
|
||
|
}
|
||
|
}
|
||
|
}
|
||
|
}
|
||
|
/* If we don't have link (auto-negotiation failed or link partner cannot
|
||
|
* auto-negotiate), the cable is plugged in (we have signal), and our
|
||
|
* link partner is not trying to auto-negotiate with us (we are receiving
|
||
|
* idles or data), we need to force link up. We also need to give
|
||
|
* auto-negotiation time to complete, in case the cable was just plugged
|
||
|
* in. The autoneg_failed flag does this.
|
||
|
*/
|
||
|
else if ((hw->media_type == e1000_media_type_fiber) &&
|
||
|
(!(status & E1000_STATUS_LU)) &&
|
||
|
((ctrl & E1000_CTRL_SWDPIN1) == signal) &&
|
||
|
(!(rxcw & E1000_RXCW_C))) {
|
||
|
if (hw->autoneg_failed == 0) {
|
||
|
hw->autoneg_failed = 1;
|
||
|
return 0;
|
||
|
}
|
||
|
DEBUGOUT("NOT RXing /C/, disable AutoNeg and force link.\r\n");
|
||
|
|
||
|
/* Disable auto-negotiation in the TXCW register */
|
||
|
E1000_WRITE_REG(hw, TXCW, (hw->txcw & ~E1000_TXCW_ANE));
|
||
|
|
||
|
/* Force link-up and also force full-duplex. */
|
||
|
ctrl = E1000_READ_REG(hw, CTRL);
|
||
|
ctrl |= (E1000_CTRL_SLU | E1000_CTRL_FD);
|
||
|
E1000_WRITE_REG(hw, CTRL, ctrl);
|
||
|
|
||
|
/* Configure Flow Control after forcing link up. */
|
||
|
ret_val = e1000_config_fc_after_link_up(hw);
|
||
|
if (ret_val < 0) {
|
||
|
DEBUGOUT("Error configuring flow control\n");
|
||
|
return ret_val;
|
||
|
}
|
||
|
}
|
||
|
/* If we are forcing link and we are receiving /C/ ordered sets, re-enable
|
||
|
* auto-negotiation in the TXCW register and disable forced link in the
|
||
|
* Device Control register in an attempt to auto-negotiate with our link
|
||
|
* partner.
|
||
|
*/
|
||
|
else if ((hw->media_type == e1000_media_type_fiber) &&
|
||
|
(ctrl & E1000_CTRL_SLU) && (rxcw & E1000_RXCW_C)) {
|
||
|
DEBUGOUT
|
||
|
("RXing /C/, enable AutoNeg and stop forcing link.\r\n");
|
||
|
E1000_WRITE_REG(hw, TXCW, hw->txcw);
|
||
|
E1000_WRITE_REG(hw, CTRL, (ctrl & ~E1000_CTRL_SLU));
|
||
|
}
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
/******************************************************************************
|
||
|
* Detects the current speed and duplex settings of the hardware.
|
||
|
*
|
||
|
* hw - Struct containing variables accessed by shared code
|
||
|
* speed - Speed of the connection
|
||
|
* duplex - Duplex setting of the connection
|
||
|
*****************************************************************************/
|
||
|
static void
|
||
|
e1000_get_speed_and_duplex(struct e1000_hw *hw,
|
||
|
uint16_t * speed, uint16_t * duplex)
|
||
|
{
|
||
|
uint32_t status;
|
||
|
|
||
|
DEBUGFUNC();
|
||
|
|
||
|
if (hw->mac_type >= e1000_82543) {
|
||
|
status = E1000_READ_REG(hw, STATUS);
|
||
|
if (status & E1000_STATUS_SPEED_1000) {
|
||
|
*speed = SPEED_1000;
|
||
|
DEBUGOUT("1000 Mbs, ");
|
||
|
} else if (status & E1000_STATUS_SPEED_100) {
|
||
|
*speed = SPEED_100;
|
||
|
DEBUGOUT("100 Mbs, ");
|
||
|
} else {
|
||
|
*speed = SPEED_10;
|
||
|
DEBUGOUT("10 Mbs, ");
|
||
|
}
|
||
|
|
||
|
if (status & E1000_STATUS_FD) {
|
||
|
*duplex = FULL_DUPLEX;
|
||
|
DEBUGOUT("Full Duplex\r\n");
|
||
|
} else {
|
||
|
*duplex = HALF_DUPLEX;
|
||
|
DEBUGOUT(" Half Duplex\r\n");
|
||
|
}
|
||
|
} else {
|
||
|
DEBUGOUT("1000 Mbs, Full Duplex\r\n");
|
||
|
*speed = SPEED_1000;
|
||
|
*duplex = FULL_DUPLEX;
|
||
|
}
|
||
|
}
|
||
|
|
||
|
/******************************************************************************
|
||
|
* Blocks until autoneg completes or times out (~4.5 seconds)
|
||
|
*
|
||
|
* hw - Struct containing variables accessed by shared code
|
||
|
******************************************************************************/
|
||
|
static int
|
||
|
e1000_wait_autoneg(struct e1000_hw *hw)
|
||
|
{
|
||
|
uint16_t i;
|
||
|
uint16_t phy_data;
|
||
|
|
||
|
DEBUGFUNC();
|
||
|
DEBUGOUT("Waiting for Auto-Neg to complete.\n");
|
||
|
|
||
|
/* We will wait for autoneg to complete or 4.5 seconds to expire. */
|
||
|
for (i = PHY_AUTO_NEG_TIME; i > 0; i--) {
|
||
|
/* Read the MII Status Register and wait for Auto-Neg
|
||
|
* Complete bit to be set.
|
||
|
*/
|
||
|
if (e1000_read_phy_reg(hw, PHY_STATUS, &phy_data) < 0) {
|
||
|
DEBUGOUT("PHY Read Error\n");
|
||
|
return -E1000_ERR_PHY;
|
||
|
}
|
||
|
if (e1000_read_phy_reg(hw, PHY_STATUS, &phy_data) < 0) {
|
||
|
DEBUGOUT("PHY Read Error\n");
|
||
|
return -E1000_ERR_PHY;
|
||
|
}
|
||
|
if (phy_data & MII_SR_AUTONEG_COMPLETE) {
|
||
|
DEBUGOUT("Auto-Neg complete.\n");
|
||
|
return 0;
|
||
|
}
|
||
|
mdelay(100);
|
||
|
}
|
||
|
DEBUGOUT("Auto-Neg timedout.\n");
|
||
|
return -E1000_ERR_TIMEOUT;
|
||
|
}
|
||
|
|
||
|
/******************************************************************************
|
||
|
* Raises the Management Data Clock
|
||
|
*
|
||
|
* hw - Struct containing variables accessed by shared code
|
||
|
* ctrl - Device control register's current value
|
||
|
******************************************************************************/
|
||
|
static void
|
||
|
e1000_raise_mdi_clk(struct e1000_hw *hw, uint32_t * ctrl)
|
||
|
{
|
||
|
/* Raise the clock input to the Management Data Clock (by setting the MDC
|
||
|
* bit), and then delay 2 microseconds.
|
||
|
*/
|
||
|
E1000_WRITE_REG(hw, CTRL, (*ctrl | E1000_CTRL_MDC));
|
||
|
E1000_WRITE_FLUSH(hw);
|
||
|
udelay(2);
|
||
|
}
|
||
|
|
||
|
/******************************************************************************
|
||
|
* Lowers the Management Data Clock
|
||
|
*
|
||
|
* hw - Struct containing variables accessed by shared code
|
||
|
* ctrl - Device control register's current value
|
||
|
******************************************************************************/
|
||
|
static void
|
||
|
e1000_lower_mdi_clk(struct e1000_hw *hw, uint32_t * ctrl)
|
||
|
{
|
||
|
/* Lower the clock input to the Management Data Clock (by clearing the MDC
|
||
|
* bit), and then delay 2 microseconds.
|
||
|
*/
|
||
|
E1000_WRITE_REG(hw, CTRL, (*ctrl & ~E1000_CTRL_MDC));
|
||
|
E1000_WRITE_FLUSH(hw);
|
||
|
udelay(2);
|
||
|
}
|
||
|
|
||
|
/******************************************************************************
|
||
|
* Shifts data bits out to the PHY
|
||
|
*
|
||
|
* hw - Struct containing variables accessed by shared code
|
||
|
* data - Data to send out to the PHY
|
||
|
* count - Number of bits to shift out
|
||
|
*
|
||
|
* Bits are shifted out in MSB to LSB order.
|
||
|
******************************************************************************/
|
||
|
static void
|
||
|
e1000_shift_out_mdi_bits(struct e1000_hw *hw, uint32_t data, uint16_t count)
|
||
|
{
|
||
|
uint32_t ctrl;
|
||
|
uint32_t mask;
|
||
|
|
||
|
/* We need to shift "count" number of bits out to the PHY. So, the value
|
||
|
* in the "data" parameter will be shifted out to the PHY one bit at a
|
||
|
* time. In order to do this, "data" must be broken down into bits.
|
||
|
*/
|
||
|
mask = 0x01;
|
||
|
mask <<= (count - 1);
|
||
|
|
||
|
ctrl = E1000_READ_REG(hw, CTRL);
|
||
|
|
||
|
/* Set MDIO_DIR and MDC_DIR direction bits to be used as output pins. */
|
||
|
ctrl |= (E1000_CTRL_MDIO_DIR | E1000_CTRL_MDC_DIR);
|
||
|
|
||
|
while (mask) {
|
||
|
/* A "1" is shifted out to the PHY by setting the MDIO bit to "1" and
|
||
|
* then raising and lowering the Management Data Clock. A "0" is
|
||
|
* shifted out to the PHY by setting the MDIO bit to "0" and then
|
||
|
* raising and lowering the clock.
|
||
|
*/
|
||
|
if (data & mask)
|
||
|
ctrl |= E1000_CTRL_MDIO;
|
||
|
else
|
||
|
ctrl &= ~E1000_CTRL_MDIO;
|
||
|
|
||
|
E1000_WRITE_REG(hw, CTRL, ctrl);
|
||
|
E1000_WRITE_FLUSH(hw);
|
||
|
|
||
|
udelay(2);
|
||
|
|
||
|
e1000_raise_mdi_clk(hw, &ctrl);
|
||
|
e1000_lower_mdi_clk(hw, &ctrl);
|
||
|
|
||
|
mask = mask >> 1;
|
||
|
}
|
||
|
}
|
||
|
|
||
|
/******************************************************************************
|
||
|
* Shifts data bits in from the PHY
|
||
|
*
|
||
|
* hw - Struct containing variables accessed by shared code
|
||
|
*
|
||
|
* Bits are shifted in in MSB to LSB order.
|
||
|
******************************************************************************/
|
||
|
static uint16_t
|
||
|
e1000_shift_in_mdi_bits(struct e1000_hw *hw)
|
||
|
{
|
||
|
uint32_t ctrl;
|
||
|
uint16_t data = 0;
|
||
|
uint8_t i;
|
||
|
|
||
|
/* In order to read a register from the PHY, we need to shift in a total
|
||
|
* of 18 bits from the PHY. The first two bit (turnaround) times are used
|
||
|
* to avoid contention on the MDIO pin when a read operation is performed.
|
||
|
* These two bits are ignored by us and thrown away. Bits are "shifted in"
|
||
|
* by raising the input to the Management Data Clock (setting the MDC bit),
|
||
|
* and then reading the value of the MDIO bit.
|
||
|
*/
|
||
|
ctrl = E1000_READ_REG(hw, CTRL);
|
||
|
|
||
|
/* Clear MDIO_DIR (SWDPIO1) to indicate this bit is to be used as input. */
|
||
|
ctrl &= ~E1000_CTRL_MDIO_DIR;
|
||
|
ctrl &= ~E1000_CTRL_MDIO;
|
||
|
|
||
|
E1000_WRITE_REG(hw, CTRL, ctrl);
|
||
|
E1000_WRITE_FLUSH(hw);
|
||
|
|
||
|
/* Raise and Lower the clock before reading in the data. This accounts for
|
||
|
* the turnaround bits. The first clock occurred when we clocked out the
|
||
|
* last bit of the Register Address.
|
||
|
*/
|
||
|
e1000_raise_mdi_clk(hw, &ctrl);
|
||
|
e1000_lower_mdi_clk(hw, &ctrl);
|
||
|
|
||
|
for (data = 0, i = 0; i < 16; i++) {
|
||
|
data = data << 1;
|
||
|
e1000_raise_mdi_clk(hw, &ctrl);
|
||
|
ctrl = E1000_READ_REG(hw, CTRL);
|
||
|
/* Check to see if we shifted in a "1". */
|
||
|
if (ctrl & E1000_CTRL_MDIO)
|
||
|
data |= 1;
|
||
|
e1000_lower_mdi_clk(hw, &ctrl);
|
||
|
}
|
||
|
|
||
|
e1000_raise_mdi_clk(hw, &ctrl);
|
||
|
e1000_lower_mdi_clk(hw, &ctrl);
|
||
|
|
||
|
return data;
|
||
|
}
|
||
|
|
||
|
/*****************************************************************************
|
||
|
* Reads the value from a PHY register
|
||
|
*
|
||
|
* hw - Struct containing variables accessed by shared code
|
||
|
* reg_addr - address of the PHY register to read
|
||
|
******************************************************************************/
|
||
|
static int
|
||
|
e1000_read_phy_reg(struct e1000_hw *hw, uint32_t reg_addr, uint16_t * phy_data)
|
||
|
{
|
||
|
uint32_t i;
|
||
|
uint32_t mdic = 0;
|
||
|
const uint32_t phy_addr = 1;
|
||
|
|
||
|
if (reg_addr > MAX_PHY_REG_ADDRESS) {
|
||
|
DEBUGOUT("PHY Address %d is out of range\n", reg_addr);
|
||
|
return -E1000_ERR_PARAM;
|
||
|
}
|
||
|
|
||
|
if (hw->mac_type > e1000_82543) {
|
||
|
/* Set up Op-code, Phy Address, and register address in the MDI
|
||
|
* Control register. The MAC will take care of interfacing with the
|
||
|
* PHY to retrieve the desired data.
|
||
|
*/
|
||
|
mdic = ((reg_addr << E1000_MDIC_REG_SHIFT) |
|
||
|
(phy_addr << E1000_MDIC_PHY_SHIFT) |
|
||
|
(E1000_MDIC_OP_READ));
|
||
|
|
||
|
E1000_WRITE_REG(hw, MDIC, mdic);
|
||
|
|
||
|
/* Poll the ready bit to see if the MDI read completed */
|
||
|
for (i = 0; i < 64; i++) {
|
||
|
udelay(10);
|
||
|
mdic = E1000_READ_REG(hw, MDIC);
|
||
|
if (mdic & E1000_MDIC_READY)
|
||
|
break;
|
||
|
}
|
||
|
if (!(mdic & E1000_MDIC_READY)) {
|
||
|
DEBUGOUT("MDI Read did not complete\n");
|
||
|
return -E1000_ERR_PHY;
|
||
|
}
|
||
|
if (mdic & E1000_MDIC_ERROR) {
|
||
|
DEBUGOUT("MDI Error\n");
|
||
|
return -E1000_ERR_PHY;
|
||
|
}
|
||
|
*phy_data = (uint16_t) mdic;
|
||
|
} else {
|
||
|
/* We must first send a preamble through the MDIO pin to signal the
|
||
|
* beginning of an MII instruction. This is done by sending 32
|
||
|
* consecutive "1" bits.
|
||
|
*/
|
||
|
e1000_shift_out_mdi_bits(hw, PHY_PREAMBLE, PHY_PREAMBLE_SIZE);
|
||
|
|
||
|
/* Now combine the next few fields that are required for a read
|
||
|
* operation. We use this method instead of calling the
|
||
|
* e1000_shift_out_mdi_bits routine five different times. The format of
|
||
|
* a MII read instruction consists of a shift out of 14 bits and is
|
||
|
* defined as follows:
|
||
|
* <Preamble><SOF><Op Code><Phy Addr><Reg Addr>
|
||
|
* followed by a shift in of 18 bits. This first two bits shifted in
|
||
|
* are TurnAround bits used to avoid contention on the MDIO pin when a
|
||
|
* READ operation is performed. These two bits are thrown away
|
||
|
* followed by a shift in of 16 bits which contains the desired data.
|
||
|
*/
|
||
|
mdic = ((reg_addr) | (phy_addr << 5) |
|
||
|
(PHY_OP_READ << 10) | (PHY_SOF << 12));
|
||
|
|
||
|
e1000_shift_out_mdi_bits(hw, mdic, 14);
|
||
|
|
||
|
/* Now that we've shifted out the read command to the MII, we need to
|
||
|
* "shift in" the 16-bit value (18 total bits) of the requested PHY
|
||
|
* register address.
|
||
|
*/
|
||
|
*phy_data = e1000_shift_in_mdi_bits(hw);
|
||
|
}
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
/******************************************************************************
|
||
|
* Writes a value to a PHY register
|
||
|
*
|
||
|
* hw - Struct containing variables accessed by shared code
|
||
|
* reg_addr - address of the PHY register to write
|
||
|
* data - data to write to the PHY
|
||
|
******************************************************************************/
|
||
|
static int
|
||
|
e1000_write_phy_reg(struct e1000_hw *hw, uint32_t reg_addr, uint16_t phy_data)
|
||
|
{
|
||
|
uint32_t i;
|
||
|
uint32_t mdic = 0;
|
||
|
const uint32_t phy_addr = 1;
|
||
|
|
||
|
if (reg_addr > MAX_PHY_REG_ADDRESS) {
|
||
|
DEBUGOUT("PHY Address %d is out of range\n", reg_addr);
|
||
|
return -E1000_ERR_PARAM;
|
||
|
}
|
||
|
|
||
|
if (hw->mac_type > e1000_82543) {
|
||
|
/* Set up Op-code, Phy Address, register address, and data intended
|
||
|
* for the PHY register in the MDI Control register. The MAC will take
|
||
|
* care of interfacing with the PHY to send the desired data.
|
||
|
*/
|
||
|
mdic = (((uint32_t) phy_data) |
|
||
|
(reg_addr << E1000_MDIC_REG_SHIFT) |
|
||
|
(phy_addr << E1000_MDIC_PHY_SHIFT) |
|
||
|
(E1000_MDIC_OP_WRITE));
|
||
|
|
||
|
E1000_WRITE_REG(hw, MDIC, mdic);
|
||
|
|
||
|
/* Poll the ready bit to see if the MDI read completed */
|
||
|
for (i = 0; i < 64; i++) {
|
||
|
udelay(10);
|
||
|
mdic = E1000_READ_REG(hw, MDIC);
|
||
|
if (mdic & E1000_MDIC_READY)
|
||
|
break;
|
||
|
}
|
||
|
if (!(mdic & E1000_MDIC_READY)) {
|
||
|
DEBUGOUT("MDI Write did not complete\n");
|
||
|
return -E1000_ERR_PHY;
|
||
|
}
|
||
|
} else {
|
||
|
/* We'll need to use the SW defined pins to shift the write command
|
||
|
* out to the PHY. We first send a preamble to the PHY to signal the
|
||
|
* beginning of the MII instruction. This is done by sending 32
|
||
|
* consecutive "1" bits.
|
||
|
*/
|
||
|
e1000_shift_out_mdi_bits(hw, PHY_PREAMBLE, PHY_PREAMBLE_SIZE);
|
||
|
|
||
|
/* Now combine the remaining required fields that will indicate a
|
||
|
* write operation. We use this method instead of calling the
|
||
|
* e1000_shift_out_mdi_bits routine for each field in the command. The
|
||
|
* format of a MII write instruction is as follows:
|
||
|
* <Preamble><SOF><Op Code><Phy Addr><Reg Addr><Turnaround><Data>.
|
||
|
*/
|
||
|
mdic = ((PHY_TURNAROUND) | (reg_addr << 2) | (phy_addr << 7) |
|
||
|
(PHY_OP_WRITE << 12) | (PHY_SOF << 14));
|
||
|
mdic <<= 16;
|
||
|
mdic |= (uint32_t) phy_data;
|
||
|
|
||
|
e1000_shift_out_mdi_bits(hw, mdic, 32);
|
||
|
}
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
/******************************************************************************
|
||
|
* Returns the PHY to the power-on reset state
|
||
|
*
|
||
|
* hw - Struct containing variables accessed by shared code
|
||
|
******************************************************************************/
|
||
|
static void
|
||
|
e1000_phy_hw_reset(struct e1000_hw *hw)
|
||
|
{
|
||
|
uint32_t ctrl;
|
||
|
uint32_t ctrl_ext;
|
||
|
|
||
|
DEBUGFUNC();
|
||
|
|
||
|
DEBUGOUT("Resetting Phy...\n");
|
||
|
|
||
|
if (hw->mac_type > e1000_82543) {
|
||
|
/* Read the device control register and assert the E1000_CTRL_PHY_RST
|
||
|
* bit. Then, take it out of reset.
|
||
|
*/
|
||
|
ctrl = E1000_READ_REG(hw, CTRL);
|
||
|
E1000_WRITE_REG(hw, CTRL, ctrl | E1000_CTRL_PHY_RST);
|
||
|
E1000_WRITE_FLUSH(hw);
|
||
|
mdelay(10);
|
||
|
E1000_WRITE_REG(hw, CTRL, ctrl);
|
||
|
E1000_WRITE_FLUSH(hw);
|
||
|
} else {
|
||
|
/* Read the Extended Device Control Register, assert the PHY_RESET_DIR
|
||
|
* bit to put the PHY into reset. Then, take it out of reset.
|
||
|
*/
|
||
|
ctrl_ext = E1000_READ_REG(hw, CTRL_EXT);
|
||
|
ctrl_ext |= E1000_CTRL_EXT_SDP4_DIR;
|
||
|
ctrl_ext &= ~E1000_CTRL_EXT_SDP4_DATA;
|
||
|
E1000_WRITE_REG(hw, CTRL_EXT, ctrl_ext);
|
||
|
E1000_WRITE_FLUSH(hw);
|
||
|
mdelay(10);
|
||
|
ctrl_ext |= E1000_CTRL_EXT_SDP4_DATA;
|
||
|
E1000_WRITE_REG(hw, CTRL_EXT, ctrl_ext);
|
||
|
E1000_WRITE_FLUSH(hw);
|
||
|
}
|
||
|
udelay(150);
|
||
|
}
|
||
|
|
||
|
/******************************************************************************
|
||
|
* Resets the PHY
|
||
|
*
|
||
|
* hw - Struct containing variables accessed by shared code
|
||
|
*
|
||
|
* Sets bit 15 of the MII Control regiser
|
||
|
******************************************************************************/
|
||
|
static int
|
||
|
e1000_phy_reset(struct e1000_hw *hw)
|
||
|
{
|
||
|
uint16_t phy_data;
|
||
|
|
||
|
DEBUGFUNC();
|
||
|
|
||
|
if (e1000_read_phy_reg(hw, PHY_CTRL, &phy_data) < 0) {
|
||
|
DEBUGOUT("PHY Read Error\n");
|
||
|
return -E1000_ERR_PHY;
|
||
|
}
|
||
|
phy_data |= MII_CR_RESET;
|
||
|
if (e1000_write_phy_reg(hw, PHY_CTRL, phy_data) < 0) {
|
||
|
DEBUGOUT("PHY Write Error\n");
|
||
|
return -E1000_ERR_PHY;
|
||
|
}
|
||
|
udelay(1);
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
/******************************************************************************
|
||
|
* Probes the expected PHY address for known PHY IDs
|
||
|
*
|
||
|
* hw - Struct containing variables accessed by shared code
|
||
|
******************************************************************************/
|
||
|
static int
|
||
|
e1000_detect_gig_phy(struct e1000_hw *hw)
|
||
|
{
|
||
|
uint16_t phy_id_high, phy_id_low;
|
||
|
int match = FALSE;
|
||
|
|
||
|
DEBUGFUNC();
|
||
|
|
||
|
/* Read the PHY ID Registers to identify which PHY is onboard. */
|
||
|
if (e1000_read_phy_reg(hw, PHY_ID1, &phy_id_high) < 0) {
|
||
|
DEBUGOUT("PHY Read Error\n");
|
||
|
return -E1000_ERR_PHY;
|
||
|
}
|
||
|
hw->phy_id = (uint32_t) (phy_id_high << 16);
|
||
|
udelay(2);
|
||
|
if (e1000_read_phy_reg(hw, PHY_ID2, &phy_id_low) < 0) {
|
||
|
DEBUGOUT("PHY Read Error\n");
|
||
|
return -E1000_ERR_PHY;
|
||
|
}
|
||
|
hw->phy_id |= (uint32_t) (phy_id_low & PHY_REVISION_MASK);
|
||
|
|
||
|
switch (hw->mac_type) {
|
||
|
case e1000_82543:
|
||
|
if (hw->phy_id == M88E1000_E_PHY_ID)
|
||
|
match = TRUE;
|
||
|
break;
|
||
|
case e1000_82544:
|
||
|
if (hw->phy_id == M88E1000_I_PHY_ID)
|
||
|
match = TRUE;
|
||
|
break;
|
||
|
case e1000_82540:
|
||
|
case e1000_82545:
|
||
|
case e1000_82546:
|
||
|
if (hw->phy_id == M88E1011_I_PHY_ID)
|
||
|
match = TRUE;
|
||
|
break;
|
||
|
default:
|
||
|
DEBUGOUT("Invalid MAC type %d\n", hw->mac_type);
|
||
|
return -E1000_ERR_CONFIG;
|
||
|
}
|
||
|
if (match) {
|
||
|
DEBUGOUT("PHY ID 0x%X detected\n", hw->phy_id);
|
||
|
return 0;
|
||
|
}
|
||
|
DEBUGOUT("Invalid PHY ID 0x%X\n", hw->phy_id);
|
||
|
return -E1000_ERR_PHY;
|
||
|
}
|
||
|
|
||
|
/**
|
||
|
* e1000_sw_init - Initialize general software structures (struct e1000_adapter)
|
||
|
*
|
||
|
* e1000_sw_init initializes the Adapter private data structure.
|
||
|
* Fields are initialized based on PCI device information and
|
||
|
* OS network device settings (MTU size).
|
||
|
**/
|
||
|
|
||
|
static int
|
||
|
e1000_sw_init(struct eth_device *nic, int cardnum)
|
||
|
{
|
||
|
struct e1000_hw *hw = (typeof(hw)) nic->priv;
|
||
|
int result;
|
||
|
|
||
|
/* PCI config space info */
|
||
|
pci_read_config_word(hw->pdev, PCI_VENDOR_ID, &hw->vendor_id);
|
||
|
pci_read_config_word(hw->pdev, PCI_DEVICE_ID, &hw->device_id);
|
||
|
pci_read_config_word(hw->pdev, PCI_SUBSYSTEM_VENDOR_ID,
|
||
|
&hw->subsystem_vendor_id);
|
||
|
pci_read_config_word(hw->pdev, PCI_SUBSYSTEM_ID, &hw->subsystem_id);
|
||
|
|
||
|
pci_read_config_byte(hw->pdev, PCI_REVISION_ID, &hw->revision_id);
|
||
|
pci_read_config_word(hw->pdev, PCI_COMMAND, &hw->pci_cmd_word);
|
||
|
|
||
|
/* identify the MAC */
|
||
|
result = e1000_set_mac_type(hw);
|
||
|
if (result) {
|
||
|
E1000_ERR("Unknown MAC Type\n");
|
||
|
return result;
|
||
|
}
|
||
|
|
||
|
/* lan a vs. lan b settings */
|
||
|
if (hw->mac_type == e1000_82546)
|
||
|
/*this also works w/ multiple 82546 cards */
|
||
|
/*but not if they're intermingled /w other e1000s */
|
||
|
hw->lan_loc = (cardnum % 2) ? e1000_lan_b : e1000_lan_a;
|
||
|
else
|
||
|
hw->lan_loc = e1000_lan_a;
|
||
|
|
||
|
/* flow control settings */
|
||
|
hw->fc_high_water = E1000_FC_HIGH_THRESH;
|
||
|
hw->fc_low_water = E1000_FC_LOW_THRESH;
|
||
|
hw->fc_pause_time = E1000_FC_PAUSE_TIME;
|
||
|
hw->fc_send_xon = 1;
|
||
|
|
||
|
/* Media type - copper or fiber */
|
||
|
|
||
|
if (hw->mac_type >= e1000_82543) {
|
||
|
uint32_t status = E1000_READ_REG(hw, STATUS);
|
||
|
|
||
|
if (status & E1000_STATUS_TBIMODE) {
|
||
|
DEBUGOUT("fiber interface\n");
|
||
|
hw->media_type = e1000_media_type_fiber;
|
||
|
} else {
|
||
|
DEBUGOUT("copper interface\n");
|
||
|
hw->media_type = e1000_media_type_copper;
|
||
|
}
|
||
|
} else {
|
||
|
hw->media_type = e1000_media_type_fiber;
|
||
|
}
|
||
|
|
||
|
if (hw->mac_type < e1000_82543)
|
||
|
hw->report_tx_early = 0;
|
||
|
else
|
||
|
hw->report_tx_early = 1;
|
||
|
|
||
|
hw->tbi_compatibility_en = TRUE;
|
||
|
#if 0
|
||
|
hw->wait_autoneg_complete = FALSE;
|
||
|
hw->adaptive_ifs = TRUE;
|
||
|
|
||
|
/* Copper options */
|
||
|
if (hw->media_type == e1000_media_type_copper) {
|
||
|
hw->mdix = AUTO_ALL_MODES;
|
||
|
hw->disable_polarity_correction = FALSE;
|
||
|
}
|
||
|
#endif
|
||
|
return E1000_SUCCESS;
|
||
|
}
|
||
|
|
||
|
void
|
||
|
fill_rx(struct e1000_hw *hw)
|
||
|
{
|
||
|
struct e1000_rx_desc *rd;
|
||
|
|
||
|
rx_last = rx_tail;
|
||
|
rd = rx_base + rx_tail;
|
||
|
rx_tail = (rx_tail + 1) % 8;
|
||
|
memset(rd, 0, 16);
|
||
|
rd->buffer_addr = cpu_to_le64((u32) & packet);
|
||
|
E1000_WRITE_REG(hw, RDT, rx_tail);
|
||
|
}
|
||
|
|
||
|
/**
|
||
|
* e1000_configure_tx - Configure 8254x Transmit Unit after Reset
|
||
|
* @adapter: board private structure
|
||
|
*
|
||
|
* Configure the Tx unit of the MAC after a reset.
|
||
|
**/
|
||
|
|
||
|
static void
|
||
|
e1000_configure_tx(struct e1000_hw *hw)
|
||
|
{
|
||
|
unsigned long ptr;
|
||
|
unsigned long tctl;
|
||
|
unsigned long tipg;
|
||
|
|
||
|
ptr = (u32) tx_pool;
|
||
|
if (ptr & 0xf)
|
||
|
ptr = (ptr + 0x10) & (~0xf);
|
||
|
|
||
|
tx_base = (typeof(tx_base)) ptr;
|
||
|
|
||
|
E1000_WRITE_REG(hw, TDBAL, (u32) tx_base);
|
||
|
E1000_WRITE_REG(hw, TDBAH, 0);
|
||
|
|
||
|
E1000_WRITE_REG(hw, TDLEN, 128);
|
||
|
|
||
|
/* Setup the HW Tx Head and Tail descriptor pointers */
|
||
|
E1000_WRITE_REG(hw, TDH, 0);
|
||
|
E1000_WRITE_REG(hw, TDT, 0);
|
||
|
tx_tail = 0;
|
||
|
|
||
|
/* Set the default values for the Tx Inter Packet Gap timer */
|
||
|
switch (hw->mac_type) {
|
||
|
case e1000_82542_rev2_0:
|
||
|
case e1000_82542_rev2_1:
|
||
|
tipg = DEFAULT_82542_TIPG_IPGT;
|
||
|
tipg |= DEFAULT_82542_TIPG_IPGR1 << E1000_TIPG_IPGR1_SHIFT;
|
||
|
tipg |= DEFAULT_82542_TIPG_IPGR2 << E1000_TIPG_IPGR2_SHIFT;
|
||
|
break;
|
||
|
default:
|
||
|
if (hw->media_type == e1000_media_type_fiber)
|
||
|
tipg = DEFAULT_82543_TIPG_IPGT_FIBER;
|
||
|
else
|
||
|
tipg = DEFAULT_82543_TIPG_IPGT_COPPER;
|
||
|
tipg |= DEFAULT_82543_TIPG_IPGR1 << E1000_TIPG_IPGR1_SHIFT;
|
||
|
tipg |= DEFAULT_82543_TIPG_IPGR2 << E1000_TIPG_IPGR2_SHIFT;
|
||
|
}
|
||
|
E1000_WRITE_REG(hw, TIPG, tipg);
|
||
|
#if 0
|
||
|
/* Set the Tx Interrupt Delay register */
|
||
|
E1000_WRITE_REG(hw, TIDV, adapter->tx_int_delay);
|
||
|
if (hw->mac_type >= e1000_82540)
|
||
|
E1000_WRITE_REG(hw, TADV, adapter->tx_abs_int_delay);
|
||
|
#endif
|
||
|
/* Program the Transmit Control Register */
|
||
|
tctl = E1000_READ_REG(hw, TCTL);
|
||
|
tctl &= ~E1000_TCTL_CT;
|
||
|
tctl |= E1000_TCTL_EN | E1000_TCTL_PSP |
|
||
|
(E1000_COLLISION_THRESHOLD << E1000_CT_SHIFT);
|
||
|
E1000_WRITE_REG(hw, TCTL, tctl);
|
||
|
|
||
|
e1000_config_collision_dist(hw);
|
||
|
#if 0
|
||
|
/* Setup Transmit Descriptor Settings for this adapter */
|
||
|
adapter->txd_cmd = E1000_TXD_CMD_IFCS | E1000_TXD_CMD_IDE;
|
||
|
|
||
|
if (adapter->hw.report_tx_early == 1)
|
||
|
adapter->txd_cmd |= E1000_TXD_CMD_RS;
|
||
|
else
|
||
|
adapter->txd_cmd |= E1000_TXD_CMD_RPS;
|
||
|
#endif
|
||
|
}
|
||
|
|
||
|
/**
|
||
|
* e1000_setup_rctl - configure the receive control register
|
||
|
* @adapter: Board private structure
|
||
|
**/
|
||
|
static void
|
||
|
e1000_setup_rctl(struct e1000_hw *hw)
|
||
|
{
|
||
|
uint32_t rctl;
|
||
|
|
||
|
rctl = E1000_READ_REG(hw, RCTL);
|
||
|
|
||
|
rctl &= ~(3 << E1000_RCTL_MO_SHIFT);
|
||
|
|
||
|
rctl |= E1000_RCTL_EN | E1000_RCTL_BAM | E1000_RCTL_LBM_NO | E1000_RCTL_RDMTS_HALF; /* |
|
||
|
(hw.mc_filter_type << E1000_RCTL_MO_SHIFT); */
|
||
|
|
||
|
if (hw->tbi_compatibility_on == 1)
|
||
|
rctl |= E1000_RCTL_SBP;
|
||
|
else
|
||
|
rctl &= ~E1000_RCTL_SBP;
|
||
|
|
||
|
rctl &= ~(E1000_RCTL_SZ_4096);
|
||
|
#if 0
|
||
|
switch (adapter->rx_buffer_len) {
|
||
|
case E1000_RXBUFFER_2048:
|
||
|
default:
|
||
|
#endif
|
||
|
rctl |= E1000_RCTL_SZ_2048;
|
||
|
rctl &= ~(E1000_RCTL_BSEX | E1000_RCTL_LPE);
|
||
|
#if 0
|
||
|
break;
|
||
|
case E1000_RXBUFFER_4096:
|
||
|
rctl |= E1000_RCTL_SZ_4096 | E1000_RCTL_BSEX | E1000_RCTL_LPE;
|
||
|
break;
|
||
|
case E1000_RXBUFFER_8192:
|
||
|
rctl |= E1000_RCTL_SZ_8192 | E1000_RCTL_BSEX | E1000_RCTL_LPE;
|
||
|
break;
|
||
|
case E1000_RXBUFFER_16384:
|
||
|
rctl |= E1000_RCTL_SZ_16384 | E1000_RCTL_BSEX | E1000_RCTL_LPE;
|
||
|
break;
|
||
|
}
|
||
|
#endif
|
||
|
E1000_WRITE_REG(hw, RCTL, rctl);
|
||
|
}
|
||
|
|
||
|
/**
|
||
|
* e1000_configure_rx - Configure 8254x Receive Unit after Reset
|
||
|
* @adapter: board private structure
|
||
|
*
|
||
|
* Configure the Rx unit of the MAC after a reset.
|
||
|
**/
|
||
|
static void
|
||
|
e1000_configure_rx(struct e1000_hw *hw)
|
||
|
{
|
||
|
unsigned long ptr;
|
||
|
unsigned long rctl;
|
||
|
#if 0
|
||
|
unsigned long rxcsum;
|
||
|
#endif
|
||
|
rx_tail = 0;
|
||
|
/* make sure receives are disabled while setting up the descriptors */
|
||
|
rctl = E1000_READ_REG(hw, RCTL);
|
||
|
E1000_WRITE_REG(hw, RCTL, rctl & ~E1000_RCTL_EN);
|
||
|
#if 0
|
||
|
/* set the Receive Delay Timer Register */
|
||
|
|
||
|
E1000_WRITE_REG(hw, RDTR, adapter->rx_int_delay);
|
||
|
#endif
|
||
|
if (hw->mac_type >= e1000_82540) {
|
||
|
#if 0
|
||
|
E1000_WRITE_REG(hw, RADV, adapter->rx_abs_int_delay);
|
||
|
#endif
|
||
|
/* Set the interrupt throttling rate. Value is calculated
|
||
|
* as DEFAULT_ITR = 1/(MAX_INTS_PER_SEC * 256ns) */
|
||
|
#define MAX_INTS_PER_SEC 8000
|
||
|
#define DEFAULT_ITR 1000000000/(MAX_INTS_PER_SEC * 256)
|
||
|
E1000_WRITE_REG(hw, ITR, DEFAULT_ITR);
|
||
|
}
|
||
|
|
||
|
/* Setup the Base and Length of the Rx Descriptor Ring */
|
||
|
ptr = (u32) rx_pool;
|
||
|
if (ptr & 0xf)
|
||
|
ptr = (ptr + 0x10) & (~0xf);
|
||
|
rx_base = (typeof(rx_base)) ptr;
|
||
|
E1000_WRITE_REG(hw, RDBAL, (u32) rx_base);
|
||
|
E1000_WRITE_REG(hw, RDBAH, 0);
|
||
|
|
||
|
E1000_WRITE_REG(hw, RDLEN, 128);
|
||
|
|
||
|
/* Setup the HW Rx Head and Tail Descriptor Pointers */
|
||
|
E1000_WRITE_REG(hw, RDH, 0);
|
||
|
E1000_WRITE_REG(hw, RDT, 0);
|
||
|
#if 0
|
||
|
/* Enable 82543 Receive Checksum Offload for TCP and UDP */
|
||
|
if ((adapter->hw.mac_type >= e1000_82543) && (adapter->rx_csum == TRUE)) {
|
||
|
rxcsum = E1000_READ_REG(hw, RXCSUM);
|
||
|
rxcsum |= E1000_RXCSUM_TUOFL;
|
||
|
E1000_WRITE_REG(hw, RXCSUM, rxcsum);
|
||
|
}
|
||
|
#endif
|
||
|
/* Enable Receives */
|
||
|
|
||
|
E1000_WRITE_REG(hw, RCTL, rctl);
|
||
|
fill_rx(hw);
|
||
|
}
|
||
|
|
||
|
/**************************************************************************
|
||
|
POLL - Wait for a frame
|
||
|
***************************************************************************/
|
||
|
static int
|
||
|
e1000_poll(struct eth_device *nic)
|
||
|
{
|
||
|
struct e1000_hw *hw = nic->priv;
|
||
|
struct e1000_rx_desc *rd;
|
||
|
/* return true if there's an ethernet packet ready to read */
|
||
|
rd = rx_base + rx_last;
|
||
|
if (!(le32_to_cpu(rd->status)) & E1000_RXD_STAT_DD)
|
||
|
return 0;
|
||
|
/*DEBUGOUT("recv: packet len=%d \n", rd->length); */
|
||
|
NetReceive((uchar *)packet, le32_to_cpu(rd->length));
|
||
|
fill_rx(hw);
|
||
|
return 1;
|
||
|
}
|
||
|
|
||
|
/**************************************************************************
|
||
|
TRANSMIT - Transmit a frame
|
||
|
***************************************************************************/
|
||
|
static int
|
||
|
e1000_transmit(struct eth_device *nic, volatile void *packet, int length)
|
||
|
{
|
||
|
struct e1000_hw *hw = nic->priv;
|
||
|
struct e1000_tx_desc *txp;
|
||
|
int i = 0;
|
||
|
|
||
|
txp = tx_base + tx_tail;
|
||
|
tx_tail = (tx_tail + 1) % 8;
|
||
|
|
||
|
txp->buffer_addr = cpu_to_le64(virt_to_bus(packet));
|
||
|
txp->lower.data = cpu_to_le32(E1000_TXD_CMD_RPS | E1000_TXD_CMD_EOP |
|
||
|
E1000_TXD_CMD_IFCS | length);
|
||
|
txp->upper.data = 0;
|
||
|
E1000_WRITE_REG(hw, TDT, tx_tail);
|
||
|
|
||
|
while (!(le32_to_cpu(txp->upper.data) & E1000_TXD_STAT_DD)) {
|
||
|
if (i++ > TOUT_LOOP) {
|
||
|
DEBUGOUT("e1000: tx timeout\n");
|
||
|
return 0;
|
||
|
}
|
||
|
udelay(10); /* give the nic a chance to write to the register */
|
||
|
}
|
||
|
return 1;
|
||
|
}
|
||
|
|
||
|
/*reset function*/
|
||
|
static inline int
|
||
|
e1000_reset(struct eth_device *nic)
|
||
|
{
|
||
|
struct e1000_hw *hw = nic->priv;
|
||
|
|
||
|
e1000_reset_hw(hw);
|
||
|
if (hw->mac_type >= e1000_82544) {
|
||
|
E1000_WRITE_REG(hw, WUC, 0);
|
||
|
}
|
||
|
return e1000_init_hw(nic);
|
||
|
}
|
||
|
|
||
|
/**************************************************************************
|
||
|
DISABLE - Turn off ethernet interface
|
||
|
***************************************************************************/
|
||
|
static void
|
||
|
e1000_disable(struct eth_device *nic)
|
||
|
{
|
||
|
struct e1000_hw *hw = nic->priv;
|
||
|
|
||
|
/* Turn off the ethernet interface */
|
||
|
E1000_WRITE_REG(hw, RCTL, 0);
|
||
|
E1000_WRITE_REG(hw, TCTL, 0);
|
||
|
|
||
|
/* Clear the transmit ring */
|
||
|
E1000_WRITE_REG(hw, TDH, 0);
|
||
|
E1000_WRITE_REG(hw, TDT, 0);
|
||
|
|
||
|
/* Clear the receive ring */
|
||
|
E1000_WRITE_REG(hw, RDH, 0);
|
||
|
E1000_WRITE_REG(hw, RDT, 0);
|
||
|
|
||
|
/* put the card in its initial state */
|
||
|
#if 0
|
||
|
E1000_WRITE_REG(hw, CTRL, E1000_CTRL_RST);
|
||
|
#endif
|
||
|
mdelay(10);
|
||
|
|
||
|
}
|
||
|
|
||
|
/**************************************************************************
|
||
|
INIT - set up ethernet interface(s)
|
||
|
***************************************************************************/
|
||
|
static int
|
||
|
e1000_init(struct eth_device *nic, bd_t * bis)
|
||
|
{
|
||
|
struct e1000_hw *hw = nic->priv;
|
||
|
int ret_val = 0;
|
||
|
|
||
|
ret_val = e1000_reset(nic);
|
||
|
if (ret_val < 0) {
|
||
|
if ((ret_val == -E1000_ERR_NOLINK) ||
|
||
|
(ret_val == -E1000_ERR_TIMEOUT)) {
|
||
|
E1000_ERR("Valid Link not detected\n");
|
||
|
} else {
|
||
|
E1000_ERR("Hardware Initialization Failed\n");
|
||
|
}
|
||
|
return 0;
|
||
|
}
|
||
|
e1000_configure_tx(hw);
|
||
|
e1000_setup_rctl(hw);
|
||
|
e1000_configure_rx(hw);
|
||
|
return 1;
|
||
|
}
|
||
|
|
||
|
/**************************************************************************
|
||
|
PROBE - Look for an adapter, this routine's visible to the outside
|
||
|
You should omit the last argument struct pci_device * for a non-PCI NIC
|
||
|
***************************************************************************/
|
||
|
int
|
||
|
e1000_initialize(bd_t * bis)
|
||
|
{
|
||
|
pci_dev_t devno;
|
||
|
int card_number = 0;
|
||
|
struct eth_device *nic = NULL;
|
||
|
struct e1000_hw *hw = NULL;
|
||
|
u32 iobase;
|
||
|
int idx = 0;
|
||
|
u32 PciCommandWord;
|
||
|
|
||
|
while (1) { /* Find PCI device(s) */
|
||
|
if ((devno = pci_find_devices(supported, idx++)) < 0) {
|
||
|
break;
|
||
|
}
|
||
|
|
||
|
pci_read_config_dword(devno, PCI_BASE_ADDRESS_0, &iobase);
|
||
|
iobase &= ~0xf; /* Mask the bits that say "this is an io addr" */
|
||
|
DEBUGOUT("e1000#%d: iobase 0x%08x\n", card_number, iobase);
|
||
|
|
||
|
pci_write_config_dword(devno, PCI_COMMAND,
|
||
|
PCI_COMMAND_MEMORY | PCI_COMMAND_MASTER);
|
||
|
/* Check if I/O accesses and Bus Mastering are enabled. */
|
||
|
pci_read_config_dword(devno, PCI_COMMAND, &PciCommandWord);
|
||
|
if (!(PciCommandWord & PCI_COMMAND_MEMORY)) {
|
||
|
printf("Error: Can not enable MEM access.\n");
|
||
|
continue;
|
||
|
} else if (!(PciCommandWord & PCI_COMMAND_MASTER)) {
|
||
|
printf("Error: Can not enable Bus Mastering.\n");
|
||
|
continue;
|
||
|
}
|
||
|
|
||
|
nic = (struct eth_device *) malloc(sizeof (*nic));
|
||
|
hw = (struct e1000_hw *) malloc(sizeof (*hw));
|
||
|
hw->pdev = devno;
|
||
|
nic->priv = hw;
|
||
|
nic->iobase = bus_to_phys(devno, iobase);
|
||
|
|
||
|
sprintf(nic->name, "e1000#%d", card_number);
|
||
|
|
||
|
/* Are these variables needed? */
|
||
|
#if 0
|
||
|
hw->fc = e1000_fc_none;
|
||
|
hw->original_fc = e1000_fc_none;
|
||
|
#else
|
||
|
hw->fc = e1000_fc_default;
|
||
|
hw->original_fc = e1000_fc_default;
|
||
|
#endif
|
||
|
hw->autoneg_failed = 0;
|
||
|
hw->get_link_status = TRUE;
|
||
|
hw->hw_addr = (typeof(hw->hw_addr)) iobase;
|
||
|
hw->mac_type = e1000_undefined;
|
||
|
|
||
|
/* MAC and Phy settings */
|
||
|
if (e1000_sw_init(nic, card_number) < 0) {
|
||
|
free(hw);
|
||
|
free(nic);
|
||
|
return 0;
|
||
|
}
|
||
|
#ifndef CONFIG_AP1000
|
||
|
if (e1000_validate_eeprom_checksum(nic) < 0) {
|
||
|
printf("The EEPROM Checksum Is Not Valid\n");
|
||
|
free(hw);
|
||
|
free(nic);
|
||
|
return 0;
|
||
|
}
|
||
|
#endif
|
||
|
e1000_read_mac_addr(nic);
|
||
|
|
||
|
E1000_WRITE_REG(hw, PBA, E1000_DEFAULT_PBA);
|
||
|
|
||
|
printf("e1000: %02x:%02x:%02x:%02x:%02x:%02x\n",
|
||
|
nic->enetaddr[0], nic->enetaddr[1], nic->enetaddr[2],
|
||
|
nic->enetaddr[3], nic->enetaddr[4], nic->enetaddr[5]);
|
||
|
|
||
|
nic->init = e1000_init;
|
||
|
nic->recv = e1000_poll;
|
||
|
nic->send = e1000_transmit;
|
||
|
nic->halt = e1000_disable;
|
||
|
|
||
|
eth_register(nic);
|
||
|
|
||
|
card_number++;
|
||
|
}
|
||
|
return 1;
|
||
|
}
|
||
|
|
||
|
#endif
|