| // SPDX-License-Identifier: GPL-2.0+ | |
| /* | |
| * (C) Copyright 2002 | |
| * Wolfgang Denk, DENX Software Engineering, wd@denx.de. | |
| */ | |
| #include <config.h> | |
| #include <asm/io.h> | |
| #include <cpu_func.h> | |
| #include <malloc.h> | |
| #include <miiphy.h> | |
| #include <net.h> | |
| #include <netdev.h> | |
| #include <pci.h> | |
| #include <linux/delay.h> | |
| /* Ethernet chip registers. */ | |
| #define SCB_STATUS 0 /* Rx/Command Unit Status *Word* */ | |
| #define SCB_INT_ACK_BYTE 1 /* Rx/Command Unit STAT/ACK byte */ | |
| #define SCB_CMD 2 /* Rx/Command Unit Command *Word* */ | |
| #define SCB_INTR_CTL_BYTE 3 /* Rx/Command Unit Intr.Control Byte */ | |
| #define SCB_POINTER 4 /* General purpose pointer. */ | |
| #define SCB_PORT 8 /* Misc. commands and operands. */ | |
| #define SCB_FLASH 12 /* Flash memory control. */ | |
| #define SCB_EEPROM 14 /* EEPROM memory control. */ | |
| #define SCB_CTRL_MDI 16 /* MDI interface control. */ | |
| #define SCB_EARLY_RX 20 /* Early receive byte count. */ | |
| #define SCB_GEN_CONTROL 28 /* 82559 General Control Register */ | |
| #define SCB_GEN_STATUS 29 /* 82559 General Status register */ | |
| /* 82559 SCB status word defnitions */ | |
| #define SCB_STATUS_CX 0x8000 /* CU finished command (transmit) */ | |
| #define SCB_STATUS_FR 0x4000 /* frame received */ | |
| #define SCB_STATUS_CNA 0x2000 /* CU left active state */ | |
| #define SCB_STATUS_RNR 0x1000 /* receiver left ready state */ | |
| #define SCB_STATUS_MDI 0x0800 /* MDI read/write cycle done */ | |
| #define SCB_STATUS_SWI 0x0400 /* software generated interrupt */ | |
| #define SCB_STATUS_FCP 0x0100 /* flow control pause interrupt */ | |
| #define SCB_INTACK_MASK 0xFD00 /* all the above */ | |
| #define SCB_INTACK_TX (SCB_STATUS_CX | SCB_STATUS_CNA) | |
| #define SCB_INTACK_RX (SCB_STATUS_FR | SCB_STATUS_RNR) | |
| /* System control block commands */ | |
| /* CU Commands */ | |
| #define CU_NOP 0x0000 | |
| #define CU_START 0x0010 | |
| #define CU_RESUME 0x0020 | |
| #define CU_STATSADDR 0x0040 /* Load Dump Statistics ctrs addr */ | |
| #define CU_SHOWSTATS 0x0050 /* Dump statistics counters. */ | |
| #define CU_ADDR_LOAD 0x0060 /* Base address to add to CU commands */ | |
| #define CU_DUMPSTATS 0x0070 /* Dump then reset stats counters. */ | |
| /* RUC Commands */ | |
| #define RUC_NOP 0x0000 | |
| #define RUC_START 0x0001 | |
| #define RUC_RESUME 0x0002 | |
| #define RUC_ABORT 0x0004 | |
| #define RUC_ADDR_LOAD 0x0006 /* (seems not to clear on acceptance) */ | |
| #define RUC_RESUMENR 0x0007 | |
| #define CU_CMD_MASK 0x00f0 | |
| #define RU_CMD_MASK 0x0007 | |
| #define SCB_M 0x0100 /* 0 = enable interrupt, 1 = disable */ | |
| #define SCB_SWI 0x0200 /* 1 - cause device to interrupt */ | |
| #define CU_STATUS_MASK 0x00C0 | |
| #define RU_STATUS_MASK 0x003C | |
| #define RU_STATUS_IDLE (0 << 2) | |
| #define RU_STATUS_SUS (1 << 2) | |
| #define RU_STATUS_NORES (2 << 2) | |
| #define RU_STATUS_READY (4 << 2) | |
| #define RU_STATUS_NO_RBDS_SUS ((1 << 2) | (8 << 2)) | |
| #define RU_STATUS_NO_RBDS_NORES ((2 << 2) | (8 << 2)) | |
| #define RU_STATUS_NO_RBDS_READY ((4 << 2) | (8 << 2)) | |
| /* 82559 Port interface commands. */ | |
| #define I82559_RESET 0x00000000 /* Software reset */ | |
| #define I82559_SELFTEST 0x00000001 /* 82559 Selftest command */ | |
| #define I82559_SELECTIVE_RESET 0x00000002 | |
| #define I82559_DUMP 0x00000003 | |
| #define I82559_DUMP_WAKEUP 0x00000007 | |
| /* 82559 Eeprom interface. */ | |
| #define EE_SHIFT_CLK 0x01 /* EEPROM shift clock. */ | |
| #define EE_CS 0x02 /* EEPROM chip select. */ | |
| #define EE_DATA_WRITE 0x04 /* EEPROM chip data in. */ | |
| #define EE_WRITE_0 0x01 | |
| #define EE_WRITE_1 0x05 | |
| #define EE_DATA_READ 0x08 /* EEPROM chip data out. */ | |
| #define EE_ENB (0x4800 | EE_CS) | |
| #define EE_CMD_BITS 3 | |
| #define EE_DATA_BITS 16 | |
| /* The EEPROM commands include the alway-set leading bit. */ | |
| #define EE_EWENB_CMD(addr_len) (4 << (addr_len)) | |
| #define EE_WRITE_CMD(addr_len) (5 << (addr_len)) | |
| #define EE_READ_CMD(addr_len) (6 << (addr_len)) | |
| #define EE_ERASE_CMD(addr_len) (7 << (addr_len)) | |
| /* Receive frame descriptors. */ | |
| struct eepro100_rxfd { | |
| u16 status; | |
| u16 control; | |
| u32 link; /* struct eepro100_rxfd * */ | |
| u32 rx_buf_addr; /* void * */ | |
| u32 count; | |
| u8 data[PKTSIZE_ALIGN]; | |
| }; | |
| #define RFD_STATUS_C 0x8000 /* completion of received frame */ | |
| #define RFD_STATUS_OK 0x2000 /* frame received with no errors */ | |
| #define RFD_CONTROL_EL 0x8000 /* 1=last RFD in RFA */ | |
| #define RFD_CONTROL_S 0x4000 /* 1=suspend RU after receiving frame */ | |
| #define RFD_CONTROL_H 0x0010 /* 1=RFD is a header RFD */ | |
| #define RFD_CONTROL_SF 0x0008 /* 0=simplified, 1=flexible mode */ | |
| #define RFD_COUNT_MASK 0x3fff | |
| #define RFD_COUNT_F 0x4000 | |
| #define RFD_COUNT_EOF 0x8000 | |
| #define RFD_RX_CRC 0x0800 /* crc error */ | |
| #define RFD_RX_ALIGNMENT 0x0400 /* alignment error */ | |
| #define RFD_RX_RESOURCE 0x0200 /* out of space, no resources */ | |
| #define RFD_RX_DMA_OVER 0x0100 /* DMA overrun */ | |
| #define RFD_RX_SHORT 0x0080 /* short frame error */ | |
| #define RFD_RX_LENGTH 0x0020 | |
| #define RFD_RX_ERROR 0x0010 /* receive error */ | |
| #define RFD_RX_NO_ADR_MATCH 0x0004 /* no address match */ | |
| #define RFD_RX_IA_MATCH 0x0002 /* individual address does not match */ | |
| #define RFD_RX_TCO 0x0001 /* TCO indication */ | |
| /* Transmit frame descriptors */ | |
| struct eepro100_txfd { /* Transmit frame descriptor set. */ | |
| u16 status; | |
| u16 command; | |
| u32 link; /* void * */ | |
| u32 tx_desc_addr; /* Always points to the tx_buf_addr element. */ | |
| s32 count; | |
| u32 tx_buf_addr0; /* void *, frame to be transmitted. */ | |
| s32 tx_buf_size0; /* Length of Tx frame. */ | |
| u32 tx_buf_addr1; /* void *, frame to be transmitted. */ | |
| s32 tx_buf_size1; /* Length of Tx frame. */ | |
| }; | |
| #define TXCB_CMD_TRANSMIT 0x0004 /* transmit command */ | |
| #define TXCB_CMD_SF 0x0008 /* 0=simplified, 1=flexible mode */ | |
| #define TXCB_CMD_NC 0x0010 /* 0=CRC insert by controller */ | |
| #define TXCB_CMD_I 0x2000 /* generate interrupt on completion */ | |
| #define TXCB_CMD_S 0x4000 /* suspend on completion */ | |
| #define TXCB_CMD_EL 0x8000 /* last command block in CBL */ | |
| #define TXCB_COUNT_MASK 0x3fff | |
| #define TXCB_COUNT_EOF 0x8000 | |
| /* The Speedo3 Rx and Tx frame/buffer descriptors. */ | |
| struct descriptor { /* A generic descriptor. */ | |
| u16 status; | |
| u16 command; | |
| u32 link; /* struct descriptor * */ | |
| unsigned char params[0]; | |
| }; | |
| #define CFG_SYS_CMD_SUSPEND 0x4000 | |
| #define CFG_SYS_CMD_IAS 0x0001 /* individual address setup */ | |
| #define CFG_SYS_CMD_CONFIGURE 0x0002 /* configure */ | |
| #define CFG_SYS_STATUS_C 0x8000 | |
| #define CFG_SYS_STATUS_OK 0x2000 | |
| /* Misc. */ | |
| #define NUM_RX_DESC PKTBUFSRX | |
| #define NUM_TX_DESC 1 /* Number of TX descriptors */ | |
| #define TOUT_LOOP 1000000 | |
| /* | |
| * The parameters for a CmdConfigure operation. | |
| * There are so many options that it would be difficult to document | |
| * each bit. We mostly use the default or recommended settings. | |
| */ | |
| static const char i82558_config_cmd[] = { | |
| 22, 0x08, 0, 1, 0, 0, 0x22, 0x03, 1, /* 1=Use MII 0=Use AUI */ | |
| 0, 0x2E, 0, 0x60, 0x08, 0x88, | |
| 0x68, 0, 0x40, 0xf2, 0x84, /* Disable FC */ | |
| 0x31, 0x05, | |
| }; | |
| struct eepro100_priv { | |
| /* RX descriptor ring */ | |
| struct eepro100_rxfd rx_ring[NUM_RX_DESC]; | |
| /* TX descriptor ring */ | |
| struct eepro100_txfd tx_ring[NUM_TX_DESC]; | |
| /* RX descriptor ring pointer */ | |
| int rx_next; | |
| u16 rx_stat; | |
| /* TX descriptor ring pointer */ | |
| int tx_next; | |
| int tx_threshold; | |
| struct udevice *devno; | |
| char *name; | |
| void __iomem *iobase; | |
| u8 *enetaddr; | |
| }; | |
| #define bus_to_phys(dev, a) dm_pci_mem_to_phys((dev), (a)) | |
| #define phys_to_bus(dev, a) dm_pci_phys_to_mem((dev), (a)) | |
| static int INW(struct eepro100_priv *priv, u_long addr) | |
| { | |
| return le16_to_cpu(readw(addr + priv->iobase)); | |
| } | |
| static void OUTW(struct eepro100_priv *priv, int command, u_long addr) | |
| { | |
| writew(cpu_to_le16(command), addr + priv->iobase); | |
| } | |
| static void OUTL(struct eepro100_priv *priv, int command, u_long addr) | |
| { | |
| writel(cpu_to_le32(command), addr + priv->iobase); | |
| } | |
| #if defined(CONFIG_MII) || defined(CONFIG_CMD_MII) | |
| static int INL(struct eepro100_priv *priv, u_long addr) | |
| { | |
| return le32_to_cpu(readl(addr + priv->iobase)); | |
| } | |
| static int get_phyreg(struct eepro100_priv *priv, unsigned char addr, | |
| unsigned char reg, unsigned short *value) | |
| { | |
| int timeout = 50; | |
| int cmd; | |
| /* read requested data */ | |
| cmd = (2 << 26) | ((addr & 0x1f) << 21) | ((reg & 0x1f) << 16); | |
| OUTL(priv, cmd, SCB_CTRL_MDI); | |
| do { | |
| udelay(1000); | |
| cmd = INL(priv, SCB_CTRL_MDI); | |
| } while (!(cmd & (1 << 28)) && (--timeout)); | |
| if (timeout == 0) | |
| return -1; | |
| *value = (unsigned short)(cmd & 0xffff); | |
| return 0; | |
| } | |
| static int set_phyreg(struct eepro100_priv *priv, unsigned char addr, | |
| unsigned char reg, unsigned short value) | |
| { | |
| int timeout = 50; | |
| int cmd; | |
| /* write requested data */ | |
| cmd = (1 << 26) | ((addr & 0x1f) << 21) | ((reg & 0x1f) << 16); | |
| OUTL(priv, cmd | value, SCB_CTRL_MDI); | |
| while (!(INL(priv, SCB_CTRL_MDI) & (1 << 28)) && (--timeout)) | |
| udelay(1000); | |
| if (timeout == 0) | |
| return -1; | |
| return 0; | |
| } | |
| /* | |
| * Check if given phyaddr is valid, i.e. there is a PHY connected. | |
| * Do this by checking model value field from ID2 register. | |
| */ | |
| static int verify_phyaddr(struct eepro100_priv *priv, unsigned char addr) | |
| { | |
| unsigned short value, model; | |
| int ret; | |
| /* read id2 register */ | |
| ret = get_phyreg(priv, addr, MII_PHYSID2, &value); | |
| if (ret) { | |
| printf("%s: mii read timeout!\n", priv->name); | |
| return ret; | |
| } | |
| /* get model */ | |
| model = (value >> 4) & 0x003f; | |
| if (!model) { | |
| printf("%s: no PHY at address %d\n", priv->name, addr); | |
| return -EINVAL; | |
| } | |
| return 0; | |
| } | |
| static int eepro100_miiphy_read(struct mii_dev *bus, int addr, int devad, | |
| int reg) | |
| { | |
| struct eepro100_priv *priv = bus->priv; | |
| unsigned short value = 0; | |
| int ret; | |
| ret = verify_phyaddr(priv, addr); | |
| if (ret) | |
| return ret; | |
| ret = get_phyreg(priv, addr, reg, &value); | |
| if (ret) { | |
| printf("%s: mii read timeout!\n", bus->name); | |
| return ret; | |
| } | |
| return value; | |
| } | |
| static int eepro100_miiphy_write(struct mii_dev *bus, int addr, int devad, | |
| int reg, u16 value) | |
| { | |
| struct eepro100_priv *priv = bus->priv; | |
| int ret; | |
| ret = verify_phyaddr(priv, addr); | |
| if (ret) | |
| return ret; | |
| ret = set_phyreg(priv, addr, reg, value); | |
| if (ret) { | |
| printf("%s: mii write timeout!\n", bus->name); | |
| return ret; | |
| } | |
| return 0; | |
| } | |
| #endif | |
| static void init_rx_ring(struct eepro100_priv *priv) | |
| { | |
| struct eepro100_rxfd *rx_ring = priv->rx_ring; | |
| int i; | |
| for (i = 0; i < NUM_RX_DESC; i++) { | |
| rx_ring[i].status = 0; | |
| rx_ring[i].control = (i == NUM_RX_DESC - 1) ? | |
| cpu_to_le16 (RFD_CONTROL_S) : 0; | |
| rx_ring[i].link = | |
| cpu_to_le32(phys_to_bus(priv->devno, | |
| (u32)&rx_ring[(i + 1) % | |
| NUM_RX_DESC])); | |
| rx_ring[i].rx_buf_addr = 0xffffffff; | |
| rx_ring[i].count = cpu_to_le32(PKTSIZE_ALIGN << 16); | |
| } | |
| flush_dcache_range((unsigned long)rx_ring, | |
| (unsigned long)rx_ring + | |
| (sizeof(*rx_ring) * NUM_RX_DESC)); | |
| priv->rx_next = 0; | |
| } | |
| static void purge_tx_ring(struct eepro100_priv *priv) | |
| { | |
| struct eepro100_txfd *tx_ring = priv->tx_ring; | |
| priv->tx_next = 0; | |
| priv->tx_threshold = 0x01208000; | |
| memset(tx_ring, 0, sizeof(*tx_ring) * NUM_TX_DESC); | |
| flush_dcache_range((unsigned long)tx_ring, | |
| (unsigned long)tx_ring + | |
| (sizeof(*tx_ring) * NUM_TX_DESC)); | |
| } | |
| /* Wait for the chip get the command. */ | |
| static int wait_for_eepro100(struct eepro100_priv *priv) | |
| { | |
| int i; | |
| for (i = 0; INW(priv, SCB_CMD) & (CU_CMD_MASK | RU_CMD_MASK); i++) { | |
| if (i >= TOUT_LOOP) | |
| return 0; | |
| } | |
| return 1; | |
| } | |
| static int eepro100_txcmd_send(struct eepro100_priv *priv, | |
| struct eepro100_txfd *desc) | |
| { | |
| u16 rstat; | |
| int i = 0; | |
| flush_dcache_range((unsigned long)desc, | |
| (unsigned long)desc + sizeof(*desc)); | |
| if (!wait_for_eepro100(priv)) | |
| return -ETIMEDOUT; | |
| OUTL(priv, phys_to_bus(priv->devno, (u32)desc), SCB_POINTER); | |
| OUTW(priv, SCB_M | CU_START, SCB_CMD); | |
| while (true) { | |
| invalidate_dcache_range((unsigned long)desc, | |
| (unsigned long)desc + sizeof(*desc)); | |
| rstat = le16_to_cpu(desc->status); | |
| if (rstat & CFG_SYS_STATUS_C) | |
| break; | |
| if (i++ >= TOUT_LOOP) { | |
| printf("%s: Tx error buffer not ready\n", priv->name); | |
| return -EINVAL; | |
| } | |
| } | |
| invalidate_dcache_range((unsigned long)desc, | |
| (unsigned long)desc + sizeof(*desc)); | |
| rstat = le16_to_cpu(desc->status); | |
| if (!(rstat & CFG_SYS_STATUS_OK)) { | |
| printf("TX error status = 0x%08X\n", rstat); | |
| return -EIO; | |
| } | |
| return 0; | |
| } | |
| /* SROM Read. */ | |
| static int read_eeprom(struct eepro100_priv *priv, int location, int addr_len) | |
| { | |
| unsigned short retval = 0; | |
| int read_cmd = location | EE_READ_CMD(addr_len); | |
| int i; | |
| OUTW(priv, EE_ENB & ~EE_CS, SCB_EEPROM); | |
| OUTW(priv, EE_ENB, SCB_EEPROM); | |
| /* Shift the read command bits out. */ | |
| for (i = 12; i >= 0; i--) { | |
| short dataval = (read_cmd & (1 << i)) ? EE_DATA_WRITE : 0; | |
| OUTW(priv, EE_ENB | dataval, SCB_EEPROM); | |
| udelay(1); | |
| OUTW(priv, EE_ENB | dataval | EE_SHIFT_CLK, SCB_EEPROM); | |
| udelay(1); | |
| } | |
| OUTW(priv, EE_ENB, SCB_EEPROM); | |
| for (i = 15; i >= 0; i--) { | |
| OUTW(priv, EE_ENB | EE_SHIFT_CLK, SCB_EEPROM); | |
| udelay(1); | |
| retval = (retval << 1) | | |
| !!(INW(priv, SCB_EEPROM) & EE_DATA_READ); | |
| OUTW(priv, EE_ENB, SCB_EEPROM); | |
| udelay(1); | |
| } | |
| /* Terminate the EEPROM access. */ | |
| OUTW(priv, EE_ENB & ~EE_CS, SCB_EEPROM); | |
| return retval; | |
| } | |
| #if defined(CONFIG_MII) || defined(CONFIG_CMD_MII) | |
| static int eepro100_initialize_mii(struct eepro100_priv *priv) | |
| { | |
| /* register mii command access routines */ | |
| struct mii_dev *mdiodev; | |
| int ret; | |
| mdiodev = mdio_alloc(); | |
| if (!mdiodev) | |
| return -ENOMEM; | |
| strlcpy(mdiodev->name, priv->name, MDIO_NAME_LEN); | |
| mdiodev->read = eepro100_miiphy_read; | |
| mdiodev->write = eepro100_miiphy_write; | |
| mdiodev->priv = priv; | |
| ret = mdio_register(mdiodev); | |
| if (ret < 0) { | |
| mdio_free(mdiodev); | |
| return ret; | |
| } | |
| return 0; | |
| } | |
| #else | |
| static int eepro100_initialize_mii(struct eepro100_priv *priv) | |
| { | |
| return 0; | |
| } | |
| #endif | |
| static struct pci_device_id supported[] = { | |
| { PCI_DEVICE(PCI_VENDOR_ID_INTEL, PCI_DEVICE_ID_INTEL_82557) }, | |
| { PCI_DEVICE(PCI_VENDOR_ID_INTEL, PCI_DEVICE_ID_INTEL_82559) }, | |
| { PCI_DEVICE(PCI_VENDOR_ID_INTEL, PCI_DEVICE_ID_INTEL_82559ER) }, | |
| { } | |
| }; | |
| static void eepro100_get_hwaddr(struct eepro100_priv *priv) | |
| { | |
| u16 sum = 0; | |
| int i, j; | |
| int addr_len = read_eeprom(priv, 0, 6) == 0xffff ? 8 : 6; | |
| for (j = 0, i = 0; i < 0x40; i++) { | |
| u16 value = read_eeprom(priv, i, addr_len); | |
| sum += value; | |
| if (i < 3) { | |
| priv->enetaddr[j++] = value; | |
| priv->enetaddr[j++] = value >> 8; | |
| } | |
| } | |
| if (sum != 0xBABA) { | |
| memset(priv->enetaddr, 0, ETH_ALEN); | |
| debug("%s: Invalid EEPROM checksum %#4.4x, check settings before activating this device!\n", | |
| priv->name, sum); | |
| } | |
| } | |
| static int eepro100_init_common(struct eepro100_priv *priv) | |
| { | |
| struct eepro100_rxfd *rx_ring = priv->rx_ring; | |
| struct eepro100_txfd *tx_ring = priv->tx_ring; | |
| struct eepro100_txfd *ias_cmd, *cfg_cmd; | |
| int ret, status = -1; | |
| int tx_cur; | |
| /* Reset the ethernet controller */ | |
| OUTL(priv, I82559_SELECTIVE_RESET, SCB_PORT); | |
| udelay(20); | |
| OUTL(priv, I82559_RESET, SCB_PORT); | |
| udelay(20); | |
| if (!wait_for_eepro100(priv)) { | |
| printf("Error: Can not reset ethernet controller.\n"); | |
| goto done; | |
| } | |
| OUTL(priv, 0, SCB_POINTER); | |
| OUTW(priv, SCB_M | RUC_ADDR_LOAD, SCB_CMD); | |
| if (!wait_for_eepro100(priv)) { | |
| printf("Error: Can not reset ethernet controller.\n"); | |
| goto done; | |
| } | |
| OUTL(priv, 0, SCB_POINTER); | |
| OUTW(priv, SCB_M | CU_ADDR_LOAD, SCB_CMD); | |
| /* Initialize Rx and Tx rings. */ | |
| init_rx_ring(priv); | |
| purge_tx_ring(priv); | |
| /* Tell the adapter where the RX ring is located. */ | |
| if (!wait_for_eepro100(priv)) { | |
| printf("Error: Can not reset ethernet controller.\n"); | |
| goto done; | |
| } | |
| /* RX ring cache was already flushed in init_rx_ring() */ | |
| OUTL(priv, phys_to_bus(priv->devno, (u32)&rx_ring[priv->rx_next]), | |
| SCB_POINTER); | |
| OUTW(priv, SCB_M | RUC_START, SCB_CMD); | |
| /* Send the Configure frame */ | |
| tx_cur = priv->tx_next; | |
| priv->tx_next = ((priv->tx_next + 1) % NUM_TX_DESC); | |
| cfg_cmd = &tx_ring[tx_cur]; | |
| cfg_cmd->command = cpu_to_le16(CFG_SYS_CMD_SUSPEND | | |
| CFG_SYS_CMD_CONFIGURE); | |
| cfg_cmd->status = 0; | |
| cfg_cmd->link = cpu_to_le32(phys_to_bus(priv->devno, | |
| (u32)&tx_ring[priv->tx_next])); | |
| memcpy(((struct descriptor *)cfg_cmd)->params, i82558_config_cmd, | |
| sizeof(i82558_config_cmd)); | |
| ret = eepro100_txcmd_send(priv, cfg_cmd); | |
| if (ret) { | |
| if (ret == -ETIMEDOUT) | |
| printf("Error---CFG_SYS_CMD_CONFIGURE: Can not reset ethernet controller.\n"); | |
| goto done; | |
| } | |
| /* Send the Individual Address Setup frame */ | |
| tx_cur = priv->tx_next; | |
| priv->tx_next = ((priv->tx_next + 1) % NUM_TX_DESC); | |
| ias_cmd = &tx_ring[tx_cur]; | |
| ias_cmd->command = cpu_to_le16(CFG_SYS_CMD_SUSPEND | | |
| CFG_SYS_CMD_IAS); | |
| ias_cmd->status = 0; | |
| ias_cmd->link = cpu_to_le32(phys_to_bus(priv->devno, | |
| (u32)&tx_ring[priv->tx_next])); | |
| memcpy(((struct descriptor *)ias_cmd)->params, priv->enetaddr, 6); | |
| ret = eepro100_txcmd_send(priv, ias_cmd); | |
| if (ret) { | |
| if (ret == -ETIMEDOUT) | |
| printf("Error: Can not reset ethernet controller.\n"); | |
| goto done; | |
| } | |
| status = 0; | |
| done: | |
| return status; | |
| } | |
| static int eepro100_send_common(struct eepro100_priv *priv, | |
| void *packet, int length) | |
| { | |
| struct eepro100_txfd *tx_ring = priv->tx_ring; | |
| struct eepro100_txfd *desc; | |
| int ret, status = -1; | |
| int tx_cur; | |
| if (length <= 0) { | |
| printf("%s: bad packet size: %d\n", priv->name, length); | |
| goto done; | |
| } | |
| tx_cur = priv->tx_next; | |
| priv->tx_next = (priv->tx_next + 1) % NUM_TX_DESC; | |
| desc = &tx_ring[tx_cur]; | |
| desc->command = cpu_to_le16(TXCB_CMD_TRANSMIT | TXCB_CMD_SF | | |
| TXCB_CMD_S | TXCB_CMD_EL); | |
| desc->status = 0; | |
| desc->count = cpu_to_le32(priv->tx_threshold); | |
| desc->link = cpu_to_le32(phys_to_bus(priv->devno, | |
| (u32)&tx_ring[priv->tx_next])); | |
| desc->tx_desc_addr = cpu_to_le32(phys_to_bus(priv->devno, | |
| (u32)&desc->tx_buf_addr0)); | |
| desc->tx_buf_addr0 = cpu_to_le32(phys_to_bus(priv->devno, | |
| (u_long)packet)); | |
| desc->tx_buf_size0 = cpu_to_le32(length); | |
| ret = eepro100_txcmd_send(priv, &tx_ring[tx_cur]); | |
| if (ret) { | |
| if (ret == -ETIMEDOUT) | |
| printf("%s: Tx error ethernet controller not ready.\n", | |
| priv->name); | |
| goto done; | |
| } | |
| status = length; | |
| done: | |
| return status; | |
| } | |
| static int eepro100_recv_common(struct eepro100_priv *priv, uchar **packetp) | |
| { | |
| struct eepro100_rxfd *rx_ring = priv->rx_ring; | |
| struct eepro100_rxfd *desc; | |
| int length; | |
| u16 status; | |
| priv->rx_stat = INW(priv, SCB_STATUS); | |
| OUTW(priv, priv->rx_stat & SCB_STATUS_RNR, SCB_STATUS); | |
| desc = &rx_ring[priv->rx_next]; | |
| invalidate_dcache_range((unsigned long)desc, | |
| (unsigned long)desc + sizeof(*desc)); | |
| status = le16_to_cpu(desc->status); | |
| if (!(status & RFD_STATUS_C)) | |
| return 0; | |
| /* Valid frame status. */ | |
| if (status & RFD_STATUS_OK) { | |
| /* A valid frame received. */ | |
| length = le32_to_cpu(desc->count) & 0x3fff; | |
| /* Pass the packet up to the protocol layers. */ | |
| *packetp = desc->data; | |
| return length; | |
| } | |
| /* There was an error. */ | |
| printf("RX error status = 0x%08X\n", status); | |
| return -EINVAL; | |
| } | |
| static void eepro100_free_pkt_common(struct eepro100_priv *priv) | |
| { | |
| struct eepro100_rxfd *rx_ring = priv->rx_ring; | |
| struct eepro100_rxfd *desc; | |
| int rx_prev; | |
| desc = &rx_ring[priv->rx_next]; | |
| desc->control = cpu_to_le16(RFD_CONTROL_S); | |
| desc->status = 0; | |
| desc->count = cpu_to_le32(PKTSIZE_ALIGN << 16); | |
| flush_dcache_range((unsigned long)desc, | |
| (unsigned long)desc + sizeof(*desc)); | |
| rx_prev = (priv->rx_next + NUM_RX_DESC - 1) % NUM_RX_DESC; | |
| desc = &rx_ring[rx_prev]; | |
| desc->control = 0; | |
| flush_dcache_range((unsigned long)desc, | |
| (unsigned long)desc + sizeof(*desc)); | |
| /* Update entry information. */ | |
| priv->rx_next = (priv->rx_next + 1) % NUM_RX_DESC; | |
| if (!(priv->rx_stat & SCB_STATUS_RNR)) | |
| return; | |
| printf("%s: Receiver is not ready, restart it !\n", priv->name); | |
| /* Reinitialize Rx ring. */ | |
| init_rx_ring(priv); | |
| if (!wait_for_eepro100(priv)) { | |
| printf("Error: Can not restart ethernet controller.\n"); | |
| return; | |
| } | |
| /* RX ring cache was already flushed in init_rx_ring() */ | |
| OUTL(priv, phys_to_bus(priv->devno, (u32)&rx_ring[priv->rx_next]), | |
| SCB_POINTER); | |
| OUTW(priv, SCB_M | RUC_START, SCB_CMD); | |
| } | |
| static void eepro100_halt_common(struct eepro100_priv *priv) | |
| { | |
| /* Reset the ethernet controller */ | |
| OUTL(priv, I82559_SELECTIVE_RESET, SCB_PORT); | |
| udelay(20); | |
| OUTL(priv, I82559_RESET, SCB_PORT); | |
| udelay(20); | |
| if (!wait_for_eepro100(priv)) { | |
| printf("Error: Can not reset ethernet controller.\n"); | |
| goto done; | |
| } | |
| OUTL(priv, 0, SCB_POINTER); | |
| OUTW(priv, SCB_M | RUC_ADDR_LOAD, SCB_CMD); | |
| if (!wait_for_eepro100(priv)) { | |
| printf("Error: Can not reset ethernet controller.\n"); | |
| goto done; | |
| } | |
| OUTL(priv, 0, SCB_POINTER); | |
| OUTW(priv, SCB_M | CU_ADDR_LOAD, SCB_CMD); | |
| done: | |
| return; | |
| } | |
| static int eepro100_start(struct udevice *dev) | |
| { | |
| struct eth_pdata *plat = dev_get_plat(dev); | |
| struct eepro100_priv *priv = dev_get_priv(dev); | |
| memcpy(priv->enetaddr, plat->enetaddr, sizeof(plat->enetaddr)); | |
| return eepro100_init_common(priv); | |
| } | |
| static void eepro100_stop(struct udevice *dev) | |
| { | |
| struct eepro100_priv *priv = dev_get_priv(dev); | |
| eepro100_halt_common(priv); | |
| } | |
| static int eepro100_send(struct udevice *dev, void *packet, int length) | |
| { | |
| struct eepro100_priv *priv = dev_get_priv(dev); | |
| int ret; | |
| ret = eepro100_send_common(priv, packet, length); | |
| return ret ? 0 : -ETIMEDOUT; | |
| } | |
| static int eepro100_recv(struct udevice *dev, int flags, uchar **packetp) | |
| { | |
| struct eepro100_priv *priv = dev_get_priv(dev); | |
| return eepro100_recv_common(priv, packetp); | |
| } | |
| static int eepro100_free_pkt(struct udevice *dev, uchar *packet, int length) | |
| { | |
| struct eepro100_priv *priv = dev_get_priv(dev); | |
| eepro100_free_pkt_common(priv); | |
| return 0; | |
| } | |
| static int eepro100_read_rom_hwaddr(struct udevice *dev) | |
| { | |
| struct eepro100_priv *priv = dev_get_priv(dev); | |
| eepro100_get_hwaddr(priv); | |
| return 0; | |
| } | |
| static int eepro100_bind(struct udevice *dev) | |
| { | |
| static int card_number; | |
| char name[16]; | |
| sprintf(name, "eepro100#%u", card_number++); | |
| return device_set_name(dev, name); | |
| } | |
| static int eepro100_probe(struct udevice *dev) | |
| { | |
| struct eth_pdata *plat = dev_get_plat(dev); | |
| struct eepro100_priv *priv = dev_get_priv(dev); | |
| u16 command, status; | |
| u32 iobase; | |
| int ret; | |
| dm_pci_read_config32(dev, PCI_BASE_ADDRESS_0, &iobase); | |
| iobase &= ~0xf; | |
| debug("eepro100: Intel i82559 PCI EtherExpressPro @0x%x\n", iobase); | |
| priv->devno = dev; | |
| priv->enetaddr = plat->enetaddr; | |
| priv->iobase = (void __iomem *)bus_to_phys(dev, iobase); | |
| command = PCI_COMMAND_MEMORY | PCI_COMMAND_MASTER; | |
| dm_pci_write_config16(dev, PCI_COMMAND, command); | |
| dm_pci_read_config16(dev, PCI_COMMAND, &status); | |
| if ((status & command) != command) { | |
| printf("eepro100: Couldn't enable IO access or Bus Mastering\n"); | |
| return -EINVAL; | |
| } | |
| ret = eepro100_initialize_mii(priv); | |
| if (ret) | |
| return ret; | |
| dm_pci_write_config8(dev, PCI_LATENCY_TIMER, 0x20); | |
| return 0; | |
| } | |
| static const struct eth_ops eepro100_ops = { | |
| .start = eepro100_start, | |
| .send = eepro100_send, | |
| .recv = eepro100_recv, | |
| .stop = eepro100_stop, | |
| .free_pkt = eepro100_free_pkt, | |
| .read_rom_hwaddr = eepro100_read_rom_hwaddr, | |
| }; | |
| U_BOOT_DRIVER(eth_eepro100) = { | |
| .name = "eth_eepro100", | |
| .id = UCLASS_ETH, | |
| .bind = eepro100_bind, | |
| .probe = eepro100_probe, | |
| .ops = &eepro100_ops, | |
| .priv_auto = sizeof(struct eepro100_priv), | |
| .plat_auto = sizeof(struct eth_pdata), | |
| }; | |
| U_BOOT_PCI_DEVICE(eth_eepro100, supported); |