drivers/net/pcnet.c: Coding Style cleanup.

Signed-off-by: Wolfgang Denk <wd@denx.de>
This commit is contained in:
Wolfgang Denk 2008-04-24 23:44:26 +02:00
parent 899ef7b845
commit 11ea26fd1c

View file

@ -30,7 +30,7 @@
#include <pci.h> #include <pci.h>
#if 0 #if 0
#define PCNET_DEBUG_LEVEL 0 /* 0=off, 1=init, 2=rx/tx */ #define PCNET_DEBUG_LEVEL 0 /* 0=off, 1=init, 2=rx/tx */
#endif #endif
#if PCNET_DEBUG_LEVEL > 0 #if PCNET_DEBUG_LEVEL > 0
@ -70,42 +70,42 @@
/* The PCNET Rx and Tx ring descriptors. */ /* The PCNET Rx and Tx ring descriptors. */
struct pcnet_rx_head { struct pcnet_rx_head {
u32 base; u32 base;
s16 buf_length; s16 buf_length;
s16 status; s16 status;
u32 msg_length; u32 msg_length;
u32 reserved; u32 reserved;
}; };
struct pcnet_tx_head { struct pcnet_tx_head {
u32 base; u32 base;
s16 length; s16 length;
s16 status; s16 status;
u32 misc; u32 misc;
u32 reserved; u32 reserved;
}; };
/* The PCNET 32-Bit initialization block, described in databook. */ /* The PCNET 32-Bit initialization block, described in databook. */
struct pcnet_init_block { struct pcnet_init_block {
u16 mode; u16 mode;
u16 tlen_rlen; u16 tlen_rlen;
u8 phys_addr[6]; u8 phys_addr[6];
u16 reserved; u16 reserved;
u32 filter[2]; u32 filter[2];
/* Receive and transmit ring base, along with extra bits. */ /* Receive and transmit ring base, along with extra bits. */
u32 rx_ring; u32 rx_ring;
u32 tx_ring; u32 tx_ring;
u32 reserved2; u32 reserved2;
}; };
typedef struct pcnet_priv { typedef struct pcnet_priv {
struct pcnet_rx_head rx_ring[RX_RING_SIZE]; struct pcnet_rx_head rx_ring[RX_RING_SIZE];
struct pcnet_tx_head tx_ring[TX_RING_SIZE]; struct pcnet_tx_head tx_ring[TX_RING_SIZE];
struct pcnet_init_block init_block; struct pcnet_init_block init_block;
/* Receive Buffer space */ /* Receive Buffer space */
unsigned char rx_buf[RX_RING_SIZE][PKT_BUF_SZ + 4]; unsigned char rx_buf[RX_RING_SIZE][PKT_BUF_SZ + 4];
int cur_rx; int cur_rx;
int cur_tx; int cur_tx;
} pcnet_priv_t; } pcnet_priv_t;
static pcnet_priv_t *lp; static pcnet_priv_t *lp;
@ -118,412 +118,422 @@ static pcnet_priv_t *lp;
static u16 pcnet_read_csr (struct eth_device *dev, int index) static u16 pcnet_read_csr (struct eth_device *dev, int index)
{ {
outw (index, dev->iobase+PCNET_RAP); outw (index, dev->iobase + PCNET_RAP);
return inw (dev->iobase+PCNET_RDP); return inw (dev->iobase + PCNET_RDP);
} }
static void pcnet_write_csr (struct eth_device *dev, int index, u16 val) static void pcnet_write_csr (struct eth_device *dev, int index, u16 val)
{ {
outw (index, dev->iobase+PCNET_RAP); outw (index, dev->iobase + PCNET_RAP);
outw (val, dev->iobase+PCNET_RDP); outw (val, dev->iobase + PCNET_RDP);
} }
static u16 pcnet_read_bcr (struct eth_device *dev, int index) static u16 pcnet_read_bcr (struct eth_device *dev, int index)
{ {
outw (index, dev->iobase+PCNET_RAP); outw (index, dev->iobase + PCNET_RAP);
return inw (dev->iobase+PCNET_BDP); return inw (dev->iobase + PCNET_BDP);
} }
static void pcnet_write_bcr (struct eth_device *dev, int index, u16 val) static void pcnet_write_bcr (struct eth_device *dev, int index, u16 val)
{ {
outw (index, dev->iobase+PCNET_RAP); outw (index, dev->iobase + PCNET_RAP);
outw (val, dev->iobase+PCNET_BDP); outw (val, dev->iobase + PCNET_BDP);
} }
static void pcnet_reset (struct eth_device *dev) static void pcnet_reset (struct eth_device *dev)
{ {
inw (dev->iobase+PCNET_RESET); inw (dev->iobase + PCNET_RESET);
} }
static int pcnet_check (struct eth_device *dev) static int pcnet_check (struct eth_device *dev)
{ {
outw (88, dev->iobase+PCNET_RAP); outw (88, dev->iobase + PCNET_RAP);
return (inw (dev->iobase+PCNET_RAP) == 88); return (inw (dev->iobase + PCNET_RAP) == 88);
} }
static int pcnet_init( struct eth_device* dev, bd_t *bis); static int pcnet_init (struct eth_device *dev, bd_t * bis);
static int pcnet_send (struct eth_device* dev, volatile void *packet, static int pcnet_send (struct eth_device *dev, volatile void *packet,
int length); int length);
static int pcnet_recv (struct eth_device* dev); static int pcnet_recv (struct eth_device *dev);
static void pcnet_halt (struct eth_device* dev); static void pcnet_halt (struct eth_device *dev);
static int pcnet_probe(struct eth_device* dev, bd_t *bis, int dev_num); static int pcnet_probe (struct eth_device *dev, bd_t * bis, int dev_num);
#define PCI_TO_MEM(d,a) pci_phys_to_mem((pci_dev_t)d->priv, (u_long)(a)) #define PCI_TO_MEM(d,a) pci_phys_to_mem((pci_dev_t)d->priv, (u_long)(a))
#define PCI_TO_MEM_LE(d,a) (u32)(cpu_to_le32(PCI_TO_MEM(d,a))) #define PCI_TO_MEM_LE(d,a) (u32)(cpu_to_le32(PCI_TO_MEM(d,a)))
static struct pci_device_id supported[] = { static struct pci_device_id supported[] = {
{ PCI_VENDOR_ID_AMD, PCI_DEVICE_ID_AMD_LANCE }, {PCI_VENDOR_ID_AMD, PCI_DEVICE_ID_AMD_LANCE},
{ } {}
}; };
int pcnet_initialize(bd_t *bis) int pcnet_initialize (bd_t * bis)
{ {
pci_dev_t devbusfn; pci_dev_t devbusfn;
struct eth_device* dev; struct eth_device *dev;
u16 command, status; u16 command, status;
int dev_nr = 0; int dev_nr = 0;
PCNET_DEBUG1("\npcnet_initialize...\n"); PCNET_DEBUG1 ("\npcnet_initialize...\n");
for (dev_nr = 0; ; dev_nr++) { for (dev_nr = 0;; dev_nr++) {
/* /*
* Find the PCnet PCI device(s). * Find the PCnet PCI device(s).
*/ */
if ((devbusfn = pci_find_devices(supported, dev_nr)) < 0) { if ((devbusfn = pci_find_devices (supported, dev_nr)) < 0) {
break; break;
}
/*
* Allocate and pre-fill the device structure.
*/
dev = (struct eth_device *) malloc (sizeof *dev);
dev->priv = (void *) devbusfn;
sprintf (dev->name, "pcnet#%d", dev_nr);
/*
* Setup the PCI device.
*/
pci_read_config_dword (devbusfn, PCI_BASE_ADDRESS_0,
(unsigned int *) &dev->iobase);
dev->iobase &= ~0xf;
PCNET_DEBUG1 ("%s: devbusfn=0x%x iobase=0x%x: ",
dev->name, devbusfn, dev->iobase);
command = PCI_COMMAND_IO | PCI_COMMAND_MASTER;
pci_write_config_word (devbusfn, PCI_COMMAND, command);
pci_read_config_word (devbusfn, PCI_COMMAND, &status);
if ((status & command) != command) {
printf ("%s: Couldn't enable IO access or Bus Mastering\n", dev->name);
free (dev);
continue;
}
pci_write_config_byte (devbusfn, PCI_LATENCY_TIMER, 0x40);
/*
* Probe the PCnet chip.
*/
if (pcnet_probe (dev, bis, dev_nr) < 0) {
free (dev);
continue;
}
/*
* Setup device structure and register the driver.
*/
dev->init = pcnet_init;
dev->halt = pcnet_halt;
dev->send = pcnet_send;
dev->recv = pcnet_recv;
eth_register (dev);
} }
/* udelay (10 * 1000);
* Allocate and pre-fill the device structure.
*/
dev = (struct eth_device*) malloc(sizeof *dev);
dev->priv = (void *)devbusfn;
sprintf(dev->name, "pcnet#%d", dev_nr);
/* return dev_nr;
* Setup the PCI device.
*/
pci_read_config_dword(devbusfn, PCI_BASE_ADDRESS_0, (unsigned int *)&dev->iobase);
dev->iobase &= ~0xf;
PCNET_DEBUG1("%s: devbusfn=0x%x iobase=0x%x: ",
dev->name, devbusfn, dev->iobase);
command = PCI_COMMAND_IO | PCI_COMMAND_MASTER;
pci_write_config_word(devbusfn, PCI_COMMAND, command);
pci_read_config_word(devbusfn, PCI_COMMAND, &status);
if ((status & command) != command) {
printf("%s: Couldn't enable IO access or Bus Mastering\n",
dev->name);
free(dev);
continue;
}
pci_write_config_byte(devbusfn, PCI_LATENCY_TIMER, 0x40);
/*
* Probe the PCnet chip.
*/
if (pcnet_probe(dev, bis, dev_nr) < 0) {
free(dev);
continue;
}
/*
* Setup device structure and register the driver.
*/
dev->init = pcnet_init;
dev->halt = pcnet_halt;
dev->send = pcnet_send;
dev->recv = pcnet_recv;
eth_register(dev);
}
udelay(10 * 1000);
return dev_nr;
} }
static int pcnet_probe(struct eth_device* dev, bd_t *bis, int dev_nr) static int pcnet_probe (struct eth_device *dev, bd_t * bis, int dev_nr)
{ {
int chip_version; int chip_version;
char *chipname; char *chipname;
#ifdef PCNET_HAS_PROM #ifdef PCNET_HAS_PROM
int i; int i;
#endif #endif
/* Reset the PCnet controller */ /* Reset the PCnet controller */
pcnet_reset(dev); pcnet_reset (dev);
/* Check if register access is working */ /* Check if register access is working */
if (pcnet_read_csr(dev, 0) != 4 || !pcnet_check(dev)) { if (pcnet_read_csr (dev, 0) != 4 || !pcnet_check (dev)) {
printf("%s: CSR register access check failed\n", dev->name); printf ("%s: CSR register access check failed\n", dev->name);
return -1; return -1;
} }
/* Identify the chip */ /* Identify the chip */
chip_version = pcnet_read_csr(dev, 88) | (pcnet_read_csr(dev,89) << 16); chip_version =
if ((chip_version & 0xfff) != 0x003) pcnet_read_csr (dev, 88) | (pcnet_read_csr (dev, 89) << 16);
return -1; if ((chip_version & 0xfff) != 0x003)
chip_version = (chip_version >> 12) & 0xffff; return -1;
switch (chip_version) { chip_version = (chip_version >> 12) & 0xffff;
case 0x2621: switch (chip_version) {
chipname = "PCnet/PCI II 79C970A"; /* PCI */ case 0x2621:
break; chipname = "PCnet/PCI II 79C970A"; /* PCI */
break;
#ifdef CONFIG_PCNET_79C973 #ifdef CONFIG_PCNET_79C973
case 0x2625: case 0x2625:
chipname = "PCnet/FAST III 79C973"; /* PCI */ chipname = "PCnet/FAST III 79C973"; /* PCI */
break; break;
#endif #endif
#ifdef CONFIG_PCNET_79C975 #ifdef CONFIG_PCNET_79C975
case 0x2627: case 0x2627:
chipname = "PCnet/FAST III 79C975"; /* PCI */ chipname = "PCnet/FAST III 79C975"; /* PCI */
break; break;
#endif #endif
default: default:
printf("%s: PCnet version %#x not supported\n", printf ("%s: PCnet version %#x not supported\n",
dev->name, chip_version); dev->name, chip_version);
return -1; return -1;
} }
PCNET_DEBUG1("AMD %s\n", chipname); PCNET_DEBUG1 ("AMD %s\n", chipname);
#ifdef PCNET_HAS_PROM #ifdef PCNET_HAS_PROM
/* /*
* In most chips, after a chip reset, the ethernet address is read from * In most chips, after a chip reset, the ethernet address is read from
* the station address PROM at the base address and programmed into the * the station address PROM at the base address and programmed into the
* "Physical Address Registers" CSR12-14. * "Physical Address Registers" CSR12-14.
*/ */
for (i = 0; i < 3; i++) { for (i = 0; i < 3; i++) {
unsigned int val; unsigned int val;
val = pcnet_read_csr(dev, i+12) & 0x0ffff;
/* There may be endianness issues here. */ val = pcnet_read_csr (dev, i + 12) & 0x0ffff;
dev->enetaddr[2*i ] = val & 0x0ff; /* There may be endianness issues here. */
dev->enetaddr[2*i+1] = (val >> 8) & 0x0ff; dev->enetaddr[2 * i] = val & 0x0ff;
} dev->enetaddr[2 * i + 1] = (val >> 8) & 0x0ff;
}
#endif /* PCNET_HAS_PROM */ #endif /* PCNET_HAS_PROM */
return 0; return 0;
} }
static int pcnet_init(struct eth_device* dev, bd_t *bis) static int pcnet_init (struct eth_device *dev, bd_t * bis)
{ {
int i, val; int i, val;
u32 addr; u32 addr;
PCNET_DEBUG1("%s: pcnet_init...\n", dev->name); PCNET_DEBUG1 ("%s: pcnet_init...\n", dev->name);
/* Switch pcnet to 32bit mode */ /* Switch pcnet to 32bit mode */
pcnet_write_bcr (dev, 20, 2); pcnet_write_bcr (dev, 20, 2);
#ifdef CONFIG_PN62 #ifdef CONFIG_PN62
/* Setup LED registers */ /* Setup LED registers */
val = pcnet_read_bcr (dev, 2) | 0x1000; val = pcnet_read_bcr (dev, 2) | 0x1000;
pcnet_write_bcr (dev, 2, val); /* enable LEDPE */ pcnet_write_bcr (dev, 2, val); /* enable LEDPE */
pcnet_write_bcr (dev, 4, 0x5080); /* 100MBit */ pcnet_write_bcr (dev, 4, 0x5080); /* 100MBit */
pcnet_write_bcr (dev, 5, 0x40c0); /* LNKSE */ pcnet_write_bcr (dev, 5, 0x40c0); /* LNKSE */
pcnet_write_bcr (dev, 6, 0x4090); /* TX Activity */ pcnet_write_bcr (dev, 6, 0x4090); /* TX Activity */
pcnet_write_bcr (dev, 7, 0x4084); /* RX Activity */ pcnet_write_bcr (dev, 7, 0x4084); /* RX Activity */
#endif #endif
/* Set/reset autoselect bit */ /* Set/reset autoselect bit */
val = pcnet_read_bcr (dev, 2) & ~2; val = pcnet_read_bcr (dev, 2) & ~2;
val |= 2; val |= 2;
pcnet_write_bcr (dev, 2, val); pcnet_write_bcr (dev, 2, val);
/* Enable auto negotiate, setup, disable fd */ /* Enable auto negotiate, setup, disable fd */
val = pcnet_read_bcr(dev, 32) & ~0x98; val = pcnet_read_bcr (dev, 32) & ~0x98;
val |= 0x20; val |= 0x20;
pcnet_write_bcr(dev, 32, val); pcnet_write_bcr (dev, 32, val);
/*
* We only maintain one structure because the drivers will never
* be used concurrently. In 32bit mode the RX and TX ring entries
* must be aligned on 16-byte boundaries.
*/
if (lp == NULL) {
addr = (u32)malloc(sizeof(pcnet_priv_t) + 0x10);
addr = (addr + 0xf) & ~0xf;
lp = (pcnet_priv_t *)addr;
}
lp->init_block.mode = cpu_to_le16(0x0000);
lp->init_block.filter[0] = 0x00000000;
lp->init_block.filter[1] = 0x00000000;
/*
* Initialize the Rx ring.
*/
lp->cur_rx = 0;
for (i = 0; i < RX_RING_SIZE; i++) {
lp->rx_ring[i].base = PCI_TO_MEM_LE(dev, lp->rx_buf[i]);
lp->rx_ring[i].buf_length = cpu_to_le16(-PKT_BUF_SZ);
lp->rx_ring[i].status = cpu_to_le16(0x8000);
PCNET_DEBUG1("Rx%d: base=0x%x buf_length=0x%hx status=0x%hx\n",
i, lp->rx_ring[i].base, lp->rx_ring[i].buf_length,
lp->rx_ring[i].status);
}
/*
* Initialize the Tx ring. The Tx buffer address is filled in as
* needed, but we do need to clear the upper ownership bit.
*/
lp->cur_tx = 0;
for (i = 0; i < TX_RING_SIZE; i++) {
lp->tx_ring[i].base = 0;
lp->tx_ring[i].status = 0;
}
/*
* Setup Init Block.
*/
PCNET_DEBUG1("Init block at 0x%p: MAC", &lp->init_block);
for (i = 0; i < 6; i++) {
lp->init_block.phys_addr[i] = dev->enetaddr[i];
PCNET_DEBUG1(" %02x", lp->init_block.phys_addr[i]);
}
lp->init_block.tlen_rlen = cpu_to_le16(TX_RING_LEN_BITS |
RX_RING_LEN_BITS);
lp->init_block.rx_ring = PCI_TO_MEM_LE(dev, lp->rx_ring);
lp->init_block.tx_ring = PCI_TO_MEM_LE(dev, lp->tx_ring);
PCNET_DEBUG1("\ntlen_rlen=0x%x rx_ring=0x%x tx_ring=0x%x\n",
lp->init_block.tlen_rlen,
lp->init_block.rx_ring, lp->init_block.tx_ring);
/*
* Tell the controller where the Init Block is located.
*/
addr = PCI_TO_MEM(dev, &lp->init_block);
pcnet_write_csr(dev, 1, addr & 0xffff);
pcnet_write_csr(dev, 2, (addr >> 16) & 0xffff);
pcnet_write_csr (dev, 4, 0x0915);
pcnet_write_csr (dev, 0, 0x0001); /* start */
/* Wait for Init Done bit */
for (i = 10000; i > 0; i--) {
if (pcnet_read_csr (dev, 0) & 0x0100)
break;
udelay(10);
}
if (i <= 0) {
printf("%s: TIMEOUT: controller init failed\n", dev->name);
pcnet_reset (dev);
return -1;
}
/*
* Finally start network controller operation.
*/
pcnet_write_csr (dev, 0, 0x0002);
return 0;
}
static int pcnet_send(struct eth_device* dev, volatile void *packet, int pkt_len)
{
int i, status;
struct pcnet_tx_head *entry = &lp->tx_ring[lp->cur_tx];
PCNET_DEBUG2("Tx%d: %d bytes from 0x%p ", lp->cur_tx, pkt_len, packet);
/* Wait for completion by testing the OWN bit */
for (i = 1000; i > 0; i--) {
status = le16_to_cpu(entry->status);
if ((status & 0x8000) == 0)
break;
udelay(100);
PCNET_DEBUG2(".");
}
if (i <= 0) {
printf("%s: TIMEOUT: Tx%d failed (status = 0x%x)\n",
dev->name, lp->cur_tx, status);
pkt_len = 0;
goto failure;
}
/*
* Setup Tx ring. Caution: the write order is important here,
* set the status with the "ownership" bits last.
*/
status = 0x8300;
entry->length = le16_to_cpu(-pkt_len);
entry->misc = 0x00000000;
entry->base = PCI_TO_MEM_LE(dev, packet);
entry->status = le16_to_cpu(status);
/* Trigger an immediate send poll. */
pcnet_write_csr (dev, 0, 0x0008);
failure:
if (++lp->cur_tx >= TX_RING_SIZE)
lp->cur_tx = 0;
PCNET_DEBUG2("done\n");
return pkt_len;
}
static int pcnet_recv(struct eth_device* dev)
{
struct pcnet_rx_head *entry;
int pkt_len = 0;
u16 status;
while (1) {
entry = &lp->rx_ring[lp->cur_rx];
/* /*
* If we own the next entry, it's a new packet. Send it up. * We only maintain one structure because the drivers will never
* be used concurrently. In 32bit mode the RX and TX ring entries
* must be aligned on 16-byte boundaries.
*/ */
if (((status = le16_to_cpu(entry->status)) & 0x8000) != 0) { if (lp == NULL) {
break; addr = (u32) malloc (sizeof (pcnet_priv_t) + 0x10);
addr = (addr + 0xf) & ~0xf;
lp = (pcnet_priv_t *) addr;
} }
status >>= 8;
if (status != 0x03) { /* There was an error. */ lp->init_block.mode = cpu_to_le16 (0x0000);
lp->init_block.filter[0] = 0x00000000;
lp->init_block.filter[1] = 0x00000000;
printf("%s: Rx%d", dev->name, lp->cur_rx); /*
PCNET_DEBUG1(" (status=0x%x)", status); * Initialize the Rx ring.
if (status & 0x20) printf(" Frame"); */
if (status & 0x10) printf(" Overflow"); lp->cur_rx = 0;
if (status & 0x08) printf(" CRC"); for (i = 0; i < RX_RING_SIZE; i++) {
if (status & 0x04) printf(" Fifo"); lp->rx_ring[i].base = PCI_TO_MEM_LE (dev, lp->rx_buf[i]);
printf(" Error\n"); lp->rx_ring[i].buf_length = cpu_to_le16 (-PKT_BUF_SZ);
entry->status &= le16_to_cpu(0x03ff); lp->rx_ring[i].status = cpu_to_le16 (0x8000);
PCNET_DEBUG1
} else { ("Rx%d: base=0x%x buf_length=0x%hx status=0x%hx\n", i,
lp->rx_ring[i].base, lp->rx_ring[i].buf_length,
pkt_len = (le32_to_cpu(entry->msg_length) & 0xfff) - 4; lp->rx_ring[i].status);
if (pkt_len < 60) {
printf("%s: Rx%d: invalid packet length %d\n",
dev->name, lp->cur_rx, pkt_len);
} else {
NetReceive(lp->rx_buf[lp->cur_rx], pkt_len);
PCNET_DEBUG2("Rx%d: %d bytes from 0x%p\n",
lp->cur_rx, pkt_len, lp->rx_buf[lp->cur_rx]);
}
} }
entry->status |= cpu_to_le16(0x8000);
if (++lp->cur_rx >= RX_RING_SIZE) /*
lp->cur_rx = 0; * Initialize the Tx ring. The Tx buffer address is filled in as
} * needed, but we do need to clear the upper ownership bit.
return pkt_len; */
lp->cur_tx = 0;
for (i = 0; i < TX_RING_SIZE; i++) {
lp->tx_ring[i].base = 0;
lp->tx_ring[i].status = 0;
}
/*
* Setup Init Block.
*/
PCNET_DEBUG1 ("Init block at 0x%p: MAC", &lp->init_block);
for (i = 0; i < 6; i++) {
lp->init_block.phys_addr[i] = dev->enetaddr[i];
PCNET_DEBUG1 (" %02x", lp->init_block.phys_addr[i]);
}
lp->init_block.tlen_rlen = cpu_to_le16 (TX_RING_LEN_BITS |
RX_RING_LEN_BITS);
lp->init_block.rx_ring = PCI_TO_MEM_LE (dev, lp->rx_ring);
lp->init_block.tx_ring = PCI_TO_MEM_LE (dev, lp->tx_ring);
PCNET_DEBUG1 ("\ntlen_rlen=0x%x rx_ring=0x%x tx_ring=0x%x\n",
lp->init_block.tlen_rlen,
lp->init_block.rx_ring, lp->init_block.tx_ring);
/*
* Tell the controller where the Init Block is located.
*/
addr = PCI_TO_MEM (dev, &lp->init_block);
pcnet_write_csr (dev, 1, addr & 0xffff);
pcnet_write_csr (dev, 2, (addr >> 16) & 0xffff);
pcnet_write_csr (dev, 4, 0x0915);
pcnet_write_csr (dev, 0, 0x0001); /* start */
/* Wait for Init Done bit */
for (i = 10000; i > 0; i--) {
if (pcnet_read_csr (dev, 0) & 0x0100)
break;
udelay (10);
}
if (i <= 0) {
printf ("%s: TIMEOUT: controller init failed\n", dev->name);
pcnet_reset (dev);
return -1;
}
/*
* Finally start network controller operation.
*/
pcnet_write_csr (dev, 0, 0x0002);
return 0;
} }
static void pcnet_halt(struct eth_device* dev) static int pcnet_send (struct eth_device *dev, volatile void *packet,
int pkt_len)
{ {
int i; int i, status;
struct pcnet_tx_head *entry = &lp->tx_ring[lp->cur_tx];
PCNET_DEBUG1("%s: pcnet_halt...\n", dev->name); PCNET_DEBUG2 ("Tx%d: %d bytes from 0x%p ", lp->cur_tx, pkt_len,
packet);
/* Reset the PCnet controller */ /* Wait for completion by testing the OWN bit */
pcnet_reset (dev); for (i = 1000; i > 0; i--) {
status = le16_to_cpu (entry->status);
if ((status & 0x8000) == 0)
break;
udelay (100);
PCNET_DEBUG2 (".");
}
if (i <= 0) {
printf ("%s: TIMEOUT: Tx%d failed (status = 0x%x)\n",
dev->name, lp->cur_tx, status);
pkt_len = 0;
goto failure;
}
/* Wait for Stop bit */ /*
for (i = 1000; i > 0; i--) { * Setup Tx ring. Caution: the write order is important here,
if (pcnet_read_csr (dev, 0) & 0x4) * set the status with the "ownership" bits last.
break; */
udelay(10); status = 0x8300;
} entry->length = le16_to_cpu (-pkt_len);
if (i <= 0) { entry->misc = 0x00000000;
printf("%s: TIMEOUT: controller reset failed\n", dev->name); entry->base = PCI_TO_MEM_LE (dev, packet);
} entry->status = le16_to_cpu (status);
/* Trigger an immediate send poll. */
pcnet_write_csr (dev, 0, 0x0008);
failure:
if (++lp->cur_tx >= TX_RING_SIZE)
lp->cur_tx = 0;
PCNET_DEBUG2 ("done\n");
return pkt_len;
} }
static int pcnet_recv (struct eth_device *dev)
{
struct pcnet_rx_head *entry;
int pkt_len = 0;
u16 status;
while (1) {
entry = &lp->rx_ring[lp->cur_rx];
/*
* If we own the next entry, it's a new packet. Send it up.
*/
if (((status = le16_to_cpu (entry->status)) & 0x8000) != 0) {
break;
}
status >>= 8;
if (status != 0x03) { /* There was an error. */
printf ("%s: Rx%d", dev->name, lp->cur_rx);
PCNET_DEBUG1 (" (status=0x%x)", status);
if (status & 0x20)
printf (" Frame");
if (status & 0x10)
printf (" Overflow");
if (status & 0x08)
printf (" CRC");
if (status & 0x04)
printf (" Fifo");
printf (" Error\n");
entry->status &= le16_to_cpu (0x03ff);
} else {
pkt_len =
(le32_to_cpu (entry->msg_length) & 0xfff) - 4;
if (pkt_len < 60) {
printf ("%s: Rx%d: invalid packet length %d\n", dev->name, lp->cur_rx, pkt_len);
} else {
NetReceive (lp->rx_buf[lp->cur_rx], pkt_len);
PCNET_DEBUG2 ("Rx%d: %d bytes from 0x%p\n",
lp->cur_rx, pkt_len,
lp->rx_buf[lp->cur_rx]);
}
}
entry->status |= cpu_to_le16 (0x8000);
if (++lp->cur_rx >= RX_RING_SIZE)
lp->cur_rx = 0;
}
return pkt_len;
}
static void pcnet_halt (struct eth_device *dev)
{
int i;
PCNET_DEBUG1 ("%s: pcnet_halt...\n", dev->name);
/* Reset the PCnet controller */
pcnet_reset (dev);
/* Wait for Stop bit */
for (i = 1000; i > 0; i--) {
if (pcnet_read_csr (dev, 0) & 0x4)
break;
udelay (10);
}
if (i <= 0) {
printf ("%s: TIMEOUT: controller reset failed\n", dev->name);
}
}
#endif #endif