diff options
author | Jeff Kirsher <jeffrey.t.kirsher@intel.com> | 2011-07-13 15:38:08 -0700 |
---|---|---|
committer | Jeff Kirsher <jeffrey.t.kirsher@intel.com> | 2011-08-10 20:04:12 -0700 |
commit | 115978859272b958366d4a08c99a24f9625fa663 (patch) | |
tree | e3eb08a76c0180bd5efa36985306878cbea5845f /drivers/net/lib82596.c | |
parent | ae150435b59e68de00546330241727f2fec54517 (diff) | |
download | op-kernel-dev-115978859272b958366d4a08c99a24f9625fa663.zip op-kernel-dev-115978859272b958366d4a08c99a24f9625fa663.tar.gz |
i825xx: Move the Intel 82586/82593/82596 based drivers
Move the drivers that use the i82586/i82593/i82596 chipsets into
drivers/net/ethernet/i825xx/ and make the necessary Kconfig and
Makefile changes. There were 4 3Com drivers which were initially
moved into 3com/, which now reside in i825xx since they all used
the i82586 chip.
CC: Philip Blundell <philb@gnu.org>
CC: Russell King <linux@arm.linux.org.uk>
CC: <aris@cathedrallabs.org>
CC: Donald Becker <becker@scyld.com>
CC: Chris Beauregard <cpbeaure@undergrad.math.uwaterloo.ca>
CC: Richard Procter <rnp@paradise.net.nz>
CC: Andries Brouwer <aeb@cwi.nl>
CC: "M.Hipp" <hippm@informatik.uni-tuebingen.de>
CC: Richard Hirst <richard@sleepie.demon.co.uk>
CC: Sam Creasey <sammy@oh.verio.com>
CC: Thomas Bogendoerfer <tsbogend@alpha.franken.de>
Signed-off-by: Jeff Kirsher <jeffrey.t.kirsher@intel.com>
Diffstat (limited to 'drivers/net/lib82596.c')
-rw-r--r-- | drivers/net/lib82596.c | 1412 |
1 files changed, 0 insertions, 1412 deletions
diff --git a/drivers/net/lib82596.c b/drivers/net/lib82596.c deleted file mode 100644 index 9e04289..0000000 --- a/drivers/net/lib82596.c +++ /dev/null @@ -1,1412 +0,0 @@ -/* lasi_82596.c -- driver for the intel 82596 ethernet controller, as - munged into HPPA boxen . - - This driver is based upon 82596.c, original credits are below... - but there were too many hoops which HP wants jumped through to - keep this code in there in a sane manner. - - 3 primary sources of the mess -- - 1) hppa needs *lots* of cacheline flushing to keep this kind of - MMIO running. - - 2) The 82596 needs to see all of its pointers as their physical - address. Thus virt_to_bus/bus_to_virt are *everywhere*. - - 3) The implementation HP is using seems to be significantly pickier - about when and how the command and RX units are started. some - command ordering was changed. - - Examination of the mach driver leads one to believe that there - might be a saner way to pull this off... anyone who feels like a - full rewrite can be my guest. - - Split 02/13/2000 Sam Creasey (sammy@oh.verio.com) - - 02/01/2000 Initial modifications for parisc by Helge Deller (deller@gmx.de) - 03/02/2000 changes for better/correct(?) cache-flushing (deller) -*/ - -/* 82596.c: A generic 82596 ethernet driver for linux. */ -/* - Based on Apricot.c - Written 1994 by Mark Evans. - This driver is for the Apricot 82596 bus-master interface - - Modularised 12/94 Mark Evans - - - Modified to support the 82596 ethernet chips on 680x0 VME boards. - by Richard Hirst <richard@sleepie.demon.co.uk> - Renamed to be 82596.c - - 980825: Changed to receive directly in to sk_buffs which are - allocated at open() time. Eliminates copy on incoming frames - (small ones are still copied). Shared data now held in a - non-cached page, so we can run on 68060 in copyback mode. - - TBD: - * look at deferring rx frames rather than discarding (as per tulip) - * handle tx ring full as per tulip - * performance test to tune rx_copybreak - - Most of my modifications relate to the braindead big-endian - implementation by Intel. When the i596 is operating in - 'big-endian' mode, it thinks a 32 bit value of 0x12345678 - should be stored as 0x56781234. This is a real pain, when - you have linked lists which are shared by the 680x0 and the - i596. - - Driver skeleton - Written 1993 by Donald Becker. - Copyright 1993 United States Government as represented by the Director, - National Security Agency. This software may only be used and distributed - according to the terms of the GNU General Public License as modified by SRC, - incorporated herein by reference. - - The author may be reached as becker@scyld.com, or C/O - Scyld Computing Corporation, 410 Severn Ave., Suite 210, Annapolis MD 21403 - - */ - -#include <linux/module.h> -#include <linux/kernel.h> -#include <linux/string.h> -#include <linux/errno.h> -#include <linux/ioport.h> -#include <linux/interrupt.h> -#include <linux/delay.h> -#include <linux/netdevice.h> -#include <linux/etherdevice.h> -#include <linux/skbuff.h> -#include <linux/init.h> -#include <linux/types.h> -#include <linux/bitops.h> -#include <linux/dma-mapping.h> -#include <linux/io.h> -#include <linux/irq.h> -#include <linux/gfp.h> - -/* DEBUG flags - */ - -#define DEB_INIT 0x0001 -#define DEB_PROBE 0x0002 -#define DEB_SERIOUS 0x0004 -#define DEB_ERRORS 0x0008 -#define DEB_MULTI 0x0010 -#define DEB_TDR 0x0020 -#define DEB_OPEN 0x0040 -#define DEB_RESET 0x0080 -#define DEB_ADDCMD 0x0100 -#define DEB_STATUS 0x0200 -#define DEB_STARTTX 0x0400 -#define DEB_RXADDR 0x0800 -#define DEB_TXADDR 0x1000 -#define DEB_RXFRAME 0x2000 -#define DEB_INTS 0x4000 -#define DEB_STRUCT 0x8000 -#define DEB_ANY 0xffff - - -#define DEB(x, y) if (i596_debug & (x)) { y; } - - -/* - * The MPU_PORT command allows direct access to the 82596. With PORT access - * the following commands are available (p5-18). The 32-bit port command - * must be word-swapped with the most significant word written first. - * This only applies to VME boards. - */ -#define PORT_RESET 0x00 /* reset 82596 */ -#define PORT_SELFTEST 0x01 /* selftest */ -#define PORT_ALTSCP 0x02 /* alternate SCB address */ -#define PORT_ALTDUMP 0x03 /* Alternate DUMP address */ - -static int i596_debug = (DEB_SERIOUS|DEB_PROBE); - -/* Copy frames shorter than rx_copybreak, otherwise pass on up in - * a full sized sk_buff. Value of 100 stolen from tulip.c (!alpha). - */ -static int rx_copybreak = 100; - -#define PKT_BUF_SZ 1536 -#define MAX_MC_CNT 64 - -#define ISCP_BUSY 0x0001 - -#define I596_NULL ((u32)0xffffffff) - -#define CMD_EOL 0x8000 /* The last command of the list, stop. */ -#define CMD_SUSP 0x4000 /* Suspend after doing cmd. */ -#define CMD_INTR 0x2000 /* Interrupt after doing cmd. */ - -#define CMD_FLEX 0x0008 /* Enable flexible memory model */ - -enum commands { - CmdNOp = 0, CmdSASetup = 1, CmdConfigure = 2, CmdMulticastList = 3, - CmdTx = 4, CmdTDR = 5, CmdDump = 6, CmdDiagnose = 7 -}; - -#define STAT_C 0x8000 /* Set to 0 after execution */ -#define STAT_B 0x4000 /* Command being executed */ -#define STAT_OK 0x2000 /* Command executed ok */ -#define STAT_A 0x1000 /* Command aborted */ - -#define CUC_START 0x0100 -#define CUC_RESUME 0x0200 -#define CUC_SUSPEND 0x0300 -#define CUC_ABORT 0x0400 -#define RX_START 0x0010 -#define RX_RESUME 0x0020 -#define RX_SUSPEND 0x0030 -#define RX_ABORT 0x0040 - -#define TX_TIMEOUT (HZ/20) - - -struct i596_reg { - unsigned short porthi; - unsigned short portlo; - u32 ca; -}; - -#define EOF 0x8000 -#define SIZE_MASK 0x3fff - -struct i596_tbd { - unsigned short size; - unsigned short pad; - u32 next; - u32 data; - u32 cache_pad[5]; /* Total 32 bytes... */ -}; - -/* The command structure has two 'next' pointers; v_next is the address of - * the next command as seen by the CPU, b_next is the address of the next - * command as seen by the 82596. The b_next pointer, as used by the 82596 - * always references the status field of the next command, rather than the - * v_next field, because the 82596 is unaware of v_next. It may seem more - * logical to put v_next at the end of the structure, but we cannot do that - * because the 82596 expects other fields to be there, depending on command - * type. - */ - -struct i596_cmd { - struct i596_cmd *v_next; /* Address from CPUs viewpoint */ - unsigned short status; - unsigned short command; - u32 b_next; /* Address from i596 viewpoint */ -}; - -struct tx_cmd { - struct i596_cmd cmd; - u32 tbd; - unsigned short size; - unsigned short pad; - struct sk_buff *skb; /* So we can free it after tx */ - dma_addr_t dma_addr; -#ifdef __LP64__ - u32 cache_pad[6]; /* Total 64 bytes... */ -#else - u32 cache_pad[1]; /* Total 32 bytes... */ -#endif -}; - -struct tdr_cmd { - struct i596_cmd cmd; - unsigned short status; - unsigned short pad; -}; - -struct mc_cmd { - struct i596_cmd cmd; - short mc_cnt; - char mc_addrs[MAX_MC_CNT*6]; -}; - -struct sa_cmd { - struct i596_cmd cmd; - char eth_addr[8]; -}; - -struct cf_cmd { - struct i596_cmd cmd; - char i596_config[16]; -}; - -struct i596_rfd { - unsigned short stat; - unsigned short cmd; - u32 b_next; /* Address from i596 viewpoint */ - u32 rbd; - unsigned short count; - unsigned short size; - struct i596_rfd *v_next; /* Address from CPUs viewpoint */ - struct i596_rfd *v_prev; -#ifndef __LP64__ - u32 cache_pad[2]; /* Total 32 bytes... */ -#endif -}; - -struct i596_rbd { - /* hardware data */ - unsigned short count; - unsigned short zero1; - u32 b_next; - u32 b_data; /* Address from i596 viewpoint */ - unsigned short size; - unsigned short zero2; - /* driver data */ - struct sk_buff *skb; - struct i596_rbd *v_next; - u32 b_addr; /* This rbd addr from i596 view */ - unsigned char *v_data; /* Address from CPUs viewpoint */ - /* Total 32 bytes... */ -#ifdef __LP64__ - u32 cache_pad[4]; -#endif -}; - -/* These values as chosen so struct i596_dma fits in one page... */ - -#define TX_RING_SIZE 32 -#define RX_RING_SIZE 16 - -struct i596_scb { - unsigned short status; - unsigned short command; - u32 cmd; - u32 rfd; - u32 crc_err; - u32 align_err; - u32 resource_err; - u32 over_err; - u32 rcvdt_err; - u32 short_err; - unsigned short t_on; - unsigned short t_off; -}; - -struct i596_iscp { - u32 stat; - u32 scb; -}; - -struct i596_scp { - u32 sysbus; - u32 pad; - u32 iscp; -}; - -struct i596_dma { - struct i596_scp scp __attribute__((aligned(32))); - volatile struct i596_iscp iscp __attribute__((aligned(32))); - volatile struct i596_scb scb __attribute__((aligned(32))); - struct sa_cmd sa_cmd __attribute__((aligned(32))); - struct cf_cmd cf_cmd __attribute__((aligned(32))); - struct tdr_cmd tdr_cmd __attribute__((aligned(32))); - struct mc_cmd mc_cmd __attribute__((aligned(32))); - struct i596_rfd rfds[RX_RING_SIZE] __attribute__((aligned(32))); - struct i596_rbd rbds[RX_RING_SIZE] __attribute__((aligned(32))); - struct tx_cmd tx_cmds[TX_RING_SIZE] __attribute__((aligned(32))); - struct i596_tbd tbds[TX_RING_SIZE] __attribute__((aligned(32))); -}; - -struct i596_private { - struct i596_dma *dma; - u32 stat; - int last_restart; - struct i596_rfd *rfd_head; - struct i596_rbd *rbd_head; - struct i596_cmd *cmd_tail; - struct i596_cmd *cmd_head; - int cmd_backlog; - u32 last_cmd; - int next_tx_cmd; - int options; - spinlock_t lock; /* serialize access to chip */ - dma_addr_t dma_addr; - void __iomem *mpu_port; - void __iomem *ca; -}; - -static const char init_setup[] = -{ - 0x8E, /* length, prefetch on */ - 0xC8, /* fifo to 8, monitor off */ - 0x80, /* don't save bad frames */ - 0x2E, /* No source address insertion, 8 byte preamble */ - 0x00, /* priority and backoff defaults */ - 0x60, /* interframe spacing */ - 0x00, /* slot time LSB */ - 0xf2, /* slot time and retries */ - 0x00, /* promiscuous mode */ - 0x00, /* collision detect */ - 0x40, /* minimum frame length */ - 0xff, - 0x00, - 0x7f /* *multi IA */ }; - -static int i596_open(struct net_device *dev); -static int i596_start_xmit(struct sk_buff *skb, struct net_device *dev); -static irqreturn_t i596_interrupt(int irq, void *dev_id); -static int i596_close(struct net_device *dev); -static void i596_add_cmd(struct net_device *dev, struct i596_cmd *cmd); -static void i596_tx_timeout (struct net_device *dev); -static void print_eth(unsigned char *buf, char *str); -static void set_multicast_list(struct net_device *dev); -static inline void ca(struct net_device *dev); -static void mpu_port(struct net_device *dev, int c, dma_addr_t x); - -static int rx_ring_size = RX_RING_SIZE; -static int ticks_limit = 100; -static int max_cmd_backlog = TX_RING_SIZE-1; - -#ifdef CONFIG_NET_POLL_CONTROLLER -static void i596_poll_controller(struct net_device *dev); -#endif - - -static inline int wait_istat(struct net_device *dev, struct i596_dma *dma, int delcnt, char *str) -{ - DMA_INV(dev, &(dma->iscp), sizeof(struct i596_iscp)); - while (--delcnt && dma->iscp.stat) { - udelay(10); - DMA_INV(dev, &(dma->iscp), sizeof(struct i596_iscp)); - } - if (!delcnt) { - printk(KERN_ERR "%s: %s, iscp.stat %04x, didn't clear\n", - dev->name, str, SWAP16(dma->iscp.stat)); - return -1; - } else - return 0; -} - - -static inline int wait_cmd(struct net_device *dev, struct i596_dma *dma, int delcnt, char *str) -{ - DMA_INV(dev, &(dma->scb), sizeof(struct i596_scb)); - while (--delcnt && dma->scb.command) { - udelay(10); - DMA_INV(dev, &(dma->scb), sizeof(struct i596_scb)); - } - if (!delcnt) { - printk(KERN_ERR "%s: %s, status %4.4x, cmd %4.4x.\n", - dev->name, str, - SWAP16(dma->scb.status), - SWAP16(dma->scb.command)); - return -1; - } else - return 0; -} - - -static void i596_display_data(struct net_device *dev) -{ - struct i596_private *lp = netdev_priv(dev); - struct i596_dma *dma = lp->dma; - struct i596_cmd *cmd; - struct i596_rfd *rfd; - struct i596_rbd *rbd; - - printk(KERN_DEBUG "lp and scp at %p, .sysbus = %08x, .iscp = %08x\n", - &dma->scp, dma->scp.sysbus, SWAP32(dma->scp.iscp)); - printk(KERN_DEBUG "iscp at %p, iscp.stat = %08x, .scb = %08x\n", - &dma->iscp, SWAP32(dma->iscp.stat), SWAP32(dma->iscp.scb)); - printk(KERN_DEBUG "scb at %p, scb.status = %04x, .command = %04x," - " .cmd = %08x, .rfd = %08x\n", - &dma->scb, SWAP16(dma->scb.status), SWAP16(dma->scb.command), - SWAP16(dma->scb.cmd), SWAP32(dma->scb.rfd)); - printk(KERN_DEBUG " errors: crc %x, align %x, resource %x," - " over %x, rcvdt %x, short %x\n", - SWAP32(dma->scb.crc_err), SWAP32(dma->scb.align_err), - SWAP32(dma->scb.resource_err), SWAP32(dma->scb.over_err), - SWAP32(dma->scb.rcvdt_err), SWAP32(dma->scb.short_err)); - cmd = lp->cmd_head; - while (cmd != NULL) { - printk(KERN_DEBUG - "cmd at %p, .status = %04x, .command = %04x," - " .b_next = %08x\n", - cmd, SWAP16(cmd->status), SWAP16(cmd->command), - SWAP32(cmd->b_next)); - cmd = cmd->v_next; - } - rfd = lp->rfd_head; - printk(KERN_DEBUG "rfd_head = %p\n", rfd); - do { - printk(KERN_DEBUG - " %p .stat %04x, .cmd %04x, b_next %08x, rbd %08x," - " count %04x\n", - rfd, SWAP16(rfd->stat), SWAP16(rfd->cmd), - SWAP32(rfd->b_next), SWAP32(rfd->rbd), - SWAP16(rfd->count)); - rfd = rfd->v_next; - } while (rfd != lp->rfd_head); - rbd = lp->rbd_head; - printk(KERN_DEBUG "rbd_head = %p\n", rbd); - do { - printk(KERN_DEBUG - " %p .count %04x, b_next %08x, b_data %08x," - " size %04x\n", - rbd, SWAP16(rbd->count), SWAP32(rbd->b_next), - SWAP32(rbd->b_data), SWAP16(rbd->size)); - rbd = rbd->v_next; - } while (rbd != lp->rbd_head); - DMA_INV(dev, dma, sizeof(struct i596_dma)); -} - - -#define virt_to_dma(lp, v) ((lp)->dma_addr + (dma_addr_t)((unsigned long)(v)-(unsigned long)((lp)->dma))) - -static inline int init_rx_bufs(struct net_device *dev) -{ - struct i596_private *lp = netdev_priv(dev); - struct i596_dma *dma = lp->dma; - int i; - struct i596_rfd *rfd; - struct i596_rbd *rbd; - - /* First build the Receive Buffer Descriptor List */ - - for (i = 0, rbd = dma->rbds; i < rx_ring_size; i++, rbd++) { - dma_addr_t dma_addr; - struct sk_buff *skb; - - skb = netdev_alloc_skb_ip_align(dev, PKT_BUF_SZ); - if (skb == NULL) - return -1; - dma_addr = dma_map_single(dev->dev.parent, skb->data, - PKT_BUF_SZ, DMA_FROM_DEVICE); - rbd->v_next = rbd+1; - rbd->b_next = SWAP32(virt_to_dma(lp, rbd+1)); - rbd->b_addr = SWAP32(virt_to_dma(lp, rbd)); - rbd->skb = skb; - rbd->v_data = skb->data; - rbd->b_data = SWAP32(dma_addr); - rbd->size = SWAP16(PKT_BUF_SZ); - } - lp->rbd_head = dma->rbds; - rbd = dma->rbds + rx_ring_size - 1; - rbd->v_next = dma->rbds; - rbd->b_next = SWAP32(virt_to_dma(lp, dma->rbds)); - - /* Now build the Receive Frame Descriptor List */ - - for (i = 0, rfd = dma->rfds; i < rx_ring_size; i++, rfd++) { - rfd->rbd = I596_NULL; - rfd->v_next = rfd+1; - rfd->v_prev = rfd-1; - rfd->b_next = SWAP32(virt_to_dma(lp, rfd+1)); - rfd->cmd = SWAP16(CMD_FLEX); - } - lp->rfd_head = dma->rfds; - dma->scb.rfd = SWAP32(virt_to_dma(lp, dma->rfds)); - rfd = dma->rfds; - rfd->rbd = SWAP32(virt_to_dma(lp, lp->rbd_head)); - rfd->v_prev = dma->rfds + rx_ring_size - 1; - rfd = dma->rfds + rx_ring_size - 1; - rfd->v_next = dma->rfds; - rfd->b_next = SWAP32(virt_to_dma(lp, dma->rfds)); - rfd->cmd = SWAP16(CMD_EOL|CMD_FLEX); - - DMA_WBACK_INV(dev, dma, sizeof(struct i596_dma)); - return 0; -} - -static inline void remove_rx_bufs(struct net_device *dev) -{ - struct i596_private *lp = netdev_priv(dev); - struct i596_rbd *rbd; - int i; - - for (i = 0, rbd = lp->dma->rbds; i < rx_ring_size; i++, rbd++) { - if (rbd->skb == NULL) - break; - dma_unmap_single(dev->dev.parent, - (dma_addr_t)SWAP32(rbd->b_data), - PKT_BUF_SZ, DMA_FROM_DEVICE); - dev_kfree_skb(rbd->skb); - } -} - - -static void rebuild_rx_bufs(struct net_device *dev) -{ - struct i596_private *lp = netdev_priv(dev); - struct i596_dma *dma = lp->dma; - int i; - - /* Ensure rx frame/buffer descriptors are tidy */ - - for (i = 0; i < rx_ring_size; i++) { - dma->rfds[i].rbd = I596_NULL; - dma->rfds[i].cmd = SWAP16(CMD_FLEX); - } - dma->rfds[rx_ring_size-1].cmd = SWAP16(CMD_EOL|CMD_FLEX); - lp->rfd_head = dma->rfds; - dma->scb.rfd = SWAP32(virt_to_dma(lp, dma->rfds)); - lp->rbd_head = dma->rbds; - dma->rfds[0].rbd = SWAP32(virt_to_dma(lp, dma->rbds)); - - DMA_WBACK_INV(dev, dma, sizeof(struct i596_dma)); -} - - -static int init_i596_mem(struct net_device *dev) -{ - struct i596_private *lp = netdev_priv(dev); - struct i596_dma *dma = lp->dma; - unsigned long flags; - - mpu_port(dev, PORT_RESET, 0); - udelay(100); /* Wait 100us - seems to help */ - - /* change the scp address */ - - lp->last_cmd = jiffies; - - dma->scp.sysbus = SYSBUS; - dma->scp.iscp = SWAP32(virt_to_dma(lp, &(dma->iscp))); - dma->iscp.scb = SWAP32(virt_to_dma(lp, &(dma->scb))); - dma->iscp.stat = SWAP32(ISCP_BUSY); - lp->cmd_backlog = 0; - - lp->cmd_head = NULL; - dma->scb.cmd = I596_NULL; - - DEB(DEB_INIT, printk(KERN_DEBUG "%s: starting i82596.\n", dev->name)); - - DMA_WBACK(dev, &(dma->scp), sizeof(struct i596_scp)); - DMA_WBACK(dev, &(dma->iscp), sizeof(struct i596_iscp)); - DMA_WBACK(dev, &(dma->scb), sizeof(struct i596_scb)); - - mpu_port(dev, PORT_ALTSCP, virt_to_dma(lp, &dma->scp)); - ca(dev); - if (wait_istat(dev, dma, 1000, "initialization timed out")) - goto failed; - DEB(DEB_INIT, printk(KERN_DEBUG - "%s: i82596 initialization successful\n", - dev->name)); - - if (request_irq(dev->irq, i596_interrupt, 0, "i82596", dev)) { - printk(KERN_ERR "%s: IRQ %d not free\n", dev->name, dev->irq); - goto failed; - } - - /* Ensure rx frame/buffer descriptors are tidy */ - rebuild_rx_bufs(dev); - - dma->scb.command = 0; - DMA_WBACK(dev, &(dma->scb), sizeof(struct i596_scb)); - - DEB(DEB_INIT, printk(KERN_DEBUG - "%s: queuing CmdConfigure\n", dev->name)); - memcpy(dma->cf_cmd.i596_config, init_setup, 14); - dma->cf_cmd.cmd.command = SWAP16(CmdConfigure); - DMA_WBACK(dev, &(dma->cf_cmd), sizeof(struct cf_cmd)); - i596_add_cmd(dev, &dma->cf_cmd.cmd); - - DEB(DEB_INIT, printk(KERN_DEBUG "%s: queuing CmdSASetup\n", dev->name)); - memcpy(dma->sa_cmd.eth_addr, dev->dev_addr, 6); - dma->sa_cmd.cmd.command = SWAP16(CmdSASetup); - DMA_WBACK(dev, &(dma->sa_cmd), sizeof(struct sa_cmd)); - i596_add_cmd(dev, &dma->sa_cmd.cmd); - - DEB(DEB_INIT, printk(KERN_DEBUG "%s: queuing CmdTDR\n", dev->name)); - dma->tdr_cmd.cmd.command = SWAP16(CmdTDR); - DMA_WBACK(dev, &(dma->tdr_cmd), sizeof(struct tdr_cmd)); - i596_add_cmd(dev, &dma->tdr_cmd.cmd); - - spin_lock_irqsave (&lp->lock, flags); - - if (wait_cmd(dev, dma, 1000, "timed out waiting to issue RX_START")) { - spin_unlock_irqrestore (&lp->lock, flags); - goto failed_free_irq; - } - DEB(DEB_INIT, printk(KERN_DEBUG "%s: Issuing RX_START\n", dev->name)); - dma->scb.command = SWAP16(RX_START); - dma->scb.rfd = SWAP32(virt_to_dma(lp, dma->rfds)); - DMA_WBACK(dev, &(dma->scb), sizeof(struct i596_scb)); - - ca(dev); - - spin_unlock_irqrestore (&lp->lock, flags); - if (wait_cmd(dev, dma, 1000, "RX_START not processed")) - goto failed_free_irq; - DEB(DEB_INIT, printk(KERN_DEBUG - "%s: Receive unit started OK\n", dev->name)); - return 0; - -failed_free_irq: - free_irq(dev->irq, dev); -failed: - printk(KERN_ERR "%s: Failed to initialise 82596\n", dev->name); - mpu_port(dev, PORT_RESET, 0); - return -1; -} - - -static inline int i596_rx(struct net_device *dev) -{ - struct i596_private *lp = netdev_priv(dev); - struct i596_rfd *rfd; - struct i596_rbd *rbd; - int frames = 0; - - DEB(DEB_RXFRAME, printk(KERN_DEBUG - "i596_rx(), rfd_head %p, rbd_head %p\n", - lp->rfd_head, lp->rbd_head)); - - - rfd = lp->rfd_head; /* Ref next frame to check */ - - DMA_INV(dev, rfd, sizeof(struct i596_rfd)); - while (rfd->stat & SWAP16(STAT_C)) { /* Loop while complete frames */ - if (rfd->rbd == I596_NULL) - rbd = NULL; - else if (rfd->rbd == lp->rbd_head->b_addr) { - rbd = lp->rbd_head; - DMA_INV(dev, rbd, sizeof(struct i596_rbd)); - } else { - printk(KERN_ERR "%s: rbd chain broken!\n", dev->name); - /* XXX Now what? */ - rbd = NULL; - } - DEB(DEB_RXFRAME, printk(KERN_DEBUG - " rfd %p, rfd.rbd %08x, rfd.stat %04x\n", - rfd, rfd->rbd, rfd->stat)); - - if (rbd != NULL && (rfd->stat & SWAP16(STAT_OK))) { - /* a good frame */ - int pkt_len = SWAP16(rbd->count) & 0x3fff; - struct sk_buff *skb = rbd->skb; - int rx_in_place = 0; - - DEB(DEB_RXADDR, print_eth(rbd->v_data, "received")); - frames++; - - /* Check if the packet is long enough to just accept - * without copying to a properly sized skbuff. - */ - - if (pkt_len > rx_copybreak) { - struct sk_buff *newskb; - dma_addr_t dma_addr; - - dma_unmap_single(dev->dev.parent, - (dma_addr_t)SWAP32(rbd->b_data), - PKT_BUF_SZ, DMA_FROM_DEVICE); - /* Get fresh skbuff to replace filled one. */ - newskb = netdev_alloc_skb_ip_align(dev, - PKT_BUF_SZ); - if (newskb == NULL) { - skb = NULL; /* drop pkt */ - goto memory_squeeze; - } - - /* Pass up the skb already on the Rx ring. */ - skb_put(skb, pkt_len); - rx_in_place = 1; - rbd->skb = newskb; - dma_addr = dma_map_single(dev->dev.parent, - newskb->data, - PKT_BUF_SZ, - DMA_FROM_DEVICE); - rbd->v_data = newskb->data; - rbd->b_data = SWAP32(dma_addr); - DMA_WBACK_INV(dev, rbd, sizeof(struct i596_rbd)); - } else - skb = netdev_alloc_skb_ip_align(dev, pkt_len); -memory_squeeze: - if (skb == NULL) { - /* XXX tulip.c can defer packets here!! */ - printk(KERN_ERR - "%s: i596_rx Memory squeeze, dropping packet.\n", - dev->name); - dev->stats.rx_dropped++; - } else { - if (!rx_in_place) { - /* 16 byte align the data fields */ - dma_sync_single_for_cpu(dev->dev.parent, - (dma_addr_t)SWAP32(rbd->b_data), - PKT_BUF_SZ, DMA_FROM_DEVICE); - memcpy(skb_put(skb, pkt_len), rbd->v_data, pkt_len); - dma_sync_single_for_device(dev->dev.parent, - (dma_addr_t)SWAP32(rbd->b_data), - PKT_BUF_SZ, DMA_FROM_DEVICE); - } - skb->len = pkt_len; - skb->protocol = eth_type_trans(skb, dev); - netif_rx(skb); - dev->stats.rx_packets++; - dev->stats.rx_bytes += pkt_len; - } - } else { - DEB(DEB_ERRORS, printk(KERN_DEBUG - "%s: Error, rfd.stat = 0x%04x\n", - dev->name, rfd->stat)); - dev->stats.rx_errors++; - if (rfd->stat & SWAP16(0x0100)) - dev->stats.collisions++; - if (rfd->stat & SWAP16(0x8000)) - dev->stats.rx_length_errors++; - if (rfd->stat & SWAP16(0x0001)) - dev->stats.rx_over_errors++; - if (rfd->stat & SWAP16(0x0002)) - dev->stats.rx_fifo_errors++; - if (rfd->stat & SWAP16(0x0004)) - dev->stats.rx_frame_errors++; - if (rfd->stat & SWAP16(0x0008)) - dev->stats.rx_crc_errors++; - if (rfd->stat & SWAP16(0x0010)) - dev->stats.rx_length_errors++; - } - - /* Clear the buffer descriptor count and EOF + F flags */ - - if (rbd != NULL && (rbd->count & SWAP16(0x4000))) { - rbd->count = 0; - lp->rbd_head = rbd->v_next; - DMA_WBACK_INV(dev, rbd, sizeof(struct i596_rbd)); - } - - /* Tidy the frame descriptor, marking it as end of list */ - - rfd->rbd = I596_NULL; - rfd->stat = 0; - rfd->cmd = SWAP16(CMD_EOL|CMD_FLEX); - rfd->count = 0; - - /* Update record of next frame descriptor to process */ - - lp->dma->scb.rfd = rfd->b_next; - lp->rfd_head = rfd->v_next; - DMA_WBACK_INV(dev, rfd, sizeof(struct i596_rfd)); - - /* Remove end-of-list from old end descriptor */ - - rfd->v_prev->cmd = SWAP16(CMD_FLEX); - DMA_WBACK_INV(dev, rfd->v_prev, sizeof(struct i596_rfd)); - rfd = lp->rfd_head; - DMA_INV(dev, rfd, sizeof(struct i596_rfd)); - } - - DEB(DEB_RXFRAME, printk(KERN_DEBUG "frames %d\n", frames)); - - return 0; -} - - -static inline void i596_cleanup_cmd(struct net_device *dev, struct i596_private *lp) -{ - struct i596_cmd *ptr; - - while (lp->cmd_head != NULL) { - ptr = lp->cmd_head; - lp->cmd_head = ptr->v_next; - lp->cmd_backlog--; - - switch (SWAP16(ptr->command) & 0x7) { - case CmdTx: - { - struct tx_cmd *tx_cmd = (struct tx_cmd *) ptr; - struct sk_buff *skb = tx_cmd->skb; - dma_unmap_single(dev->dev.parent, - tx_cmd->dma_addr, - skb->len, DMA_TO_DEVICE); - - dev_kfree_skb(skb); - - dev->stats.tx_errors++; - dev->stats.tx_aborted_errors++; - - ptr->v_next = NULL; - ptr->b_next = I596_NULL; - tx_cmd->cmd.command = 0; /* Mark as free */ - break; - } - default: - ptr->v_next = NULL; - ptr->b_next = I596_NULL; - } - DMA_WBACK_INV(dev, ptr, sizeof(struct i596_cmd)); - } - - wait_cmd(dev, lp->dma, 100, "i596_cleanup_cmd timed out"); - lp->dma->scb.cmd = I596_NULL; - DMA_WBACK(dev, &(lp->dma->scb), sizeof(struct i596_scb)); -} - - -static inline void i596_reset(struct net_device *dev, struct i596_private *lp) -{ - unsigned long flags; - - DEB(DEB_RESET, printk(KERN_DEBUG "i596_reset\n")); - - spin_lock_irqsave (&lp->lock, flags); - - wait_cmd(dev, lp->dma, 100, "i596_reset timed out"); - - netif_stop_queue(dev); - - /* FIXME: this command might cause an lpmc */ - lp->dma->scb.command = SWAP16(CUC_ABORT | RX_ABORT); - DMA_WBACK(dev, &(lp->dma->scb), sizeof(struct i596_scb)); - ca(dev); - - /* wait for shutdown */ - wait_cmd(dev, lp->dma, 1000, "i596_reset 2 timed out"); - spin_unlock_irqrestore (&lp->lock, flags); - - i596_cleanup_cmd(dev, lp); - i596_rx(dev); - - netif_start_queue(dev); - init_i596_mem(dev); -} - - -static void i596_add_cmd(struct net_device *dev, struct i596_cmd *cmd) -{ - struct i596_private *lp = netdev_priv(dev); - struct i596_dma *dma = lp->dma; - unsigned long flags; - - DEB(DEB_ADDCMD, printk(KERN_DEBUG "i596_add_cmd cmd_head %p\n", - lp->cmd_head)); - - cmd->status = 0; - cmd->command |= SWAP16(CMD_EOL | CMD_INTR); - cmd->v_next = NULL; - cmd->b_next = I596_NULL; - DMA_WBACK(dev, cmd, sizeof(struct i596_cmd)); - - spin_lock_irqsave (&lp->lock, flags); - - if (lp->cmd_head != NULL) { - lp->cmd_tail->v_next = cmd; - lp->cmd_tail->b_next = SWAP32(virt_to_dma(lp, &cmd->status)); - DMA_WBACK(dev, lp->cmd_tail, sizeof(struct i596_cmd)); - } else { - lp->cmd_head = cmd; - wait_cmd(dev, dma, 100, "i596_add_cmd timed out"); - dma->scb.cmd = SWAP32(virt_to_dma(lp, &cmd->status)); - dma->scb.command = SWAP16(CUC_START); - DMA_WBACK(dev, &(dma->scb), sizeof(struct i596_scb)); - ca(dev); - } - lp->cmd_tail = cmd; - lp->cmd_backlog++; - - spin_unlock_irqrestore (&lp->lock, flags); - - if (lp->cmd_backlog > max_cmd_backlog) { - unsigned long tickssofar = jiffies - lp->last_cmd; - - if (tickssofar < ticks_limit) - return; - - printk(KERN_ERR - "%s: command unit timed out, status resetting.\n", - dev->name); -#if 1 - i596_reset(dev, lp); -#endif - } -} - -static int i596_open(struct net_device *dev) -{ - DEB(DEB_OPEN, printk(KERN_DEBUG - "%s: i596_open() irq %d.\n", dev->name, dev->irq)); - - if (init_rx_bufs(dev)) { - printk(KERN_ERR "%s: Failed to init rx bufs\n", dev->name); - return -EAGAIN; - } - if (init_i596_mem(dev)) { - printk(KERN_ERR "%s: Failed to init memory\n", dev->name); - goto out_remove_rx_bufs; - } - netif_start_queue(dev); - - return 0; - -out_remove_rx_bufs: - remove_rx_bufs(dev); - return -EAGAIN; -} - -static void i596_tx_timeout (struct net_device *dev) -{ - struct i596_private *lp = netdev_priv(dev); - - /* Transmitter timeout, serious problems. */ - DEB(DEB_ERRORS, printk(KERN_DEBUG - "%s: transmit timed out, status resetting.\n", - dev->name)); - - dev->stats.tx_errors++; - - /* Try to restart the adaptor */ - if (lp->last_restart == dev->stats.tx_packets) { - DEB(DEB_ERRORS, printk(KERN_DEBUG "Resetting board.\n")); - /* Shutdown and restart */ - i596_reset (dev, lp); - } else { - /* Issue a channel attention signal */ - DEB(DEB_ERRORS, printk(KERN_DEBUG "Kicking board.\n")); - lp->dma->scb.command = SWAP16(CUC_START | RX_START); - DMA_WBACK_INV(dev, &(lp->dma->scb), sizeof(struct i596_scb)); - ca (dev); - lp->last_restart = dev->stats.tx_packets; - } - - dev->trans_start = jiffies; /* prevent tx timeout */ - netif_wake_queue (dev); -} - - -static int i596_start_xmit(struct sk_buff *skb, struct net_device *dev) -{ - struct i596_private *lp = netdev_priv(dev); - struct tx_cmd *tx_cmd; - struct i596_tbd *tbd; - short length = skb->len; - - DEB(DEB_STARTTX, printk(KERN_DEBUG - "%s: i596_start_xmit(%x,%p) called\n", - dev->name, skb->len, skb->data)); - - if (length < ETH_ZLEN) { - if (skb_padto(skb, ETH_ZLEN)) - return NETDEV_TX_OK; - length = ETH_ZLEN; - } - - netif_stop_queue(dev); - - tx_cmd = lp->dma->tx_cmds + lp->next_tx_cmd; - tbd = lp->dma->tbds + lp->next_tx_cmd; - - if (tx_cmd->cmd.command) { - DEB(DEB_ERRORS, printk(KERN_DEBUG - "%s: xmit ring full, dropping packet.\n", - dev->name)); - dev->stats.tx_dropped++; - - dev_kfree_skb(skb); - } else { - if (++lp->next_tx_cmd == TX_RING_SIZE) - lp->next_tx_cmd = 0; - tx_cmd->tbd = SWAP32(virt_to_dma(lp, tbd)); - tbd->next = I596_NULL; - - tx_cmd->cmd.command = SWAP16(CMD_FLEX | CmdTx); - tx_cmd->skb = skb; - - tx_cmd->pad = 0; - tx_cmd->size = 0; - tbd->pad = 0; - tbd->size = SWAP16(EOF | length); - - tx_cmd->dma_addr = dma_map_single(dev->dev.parent, skb->data, - skb->len, DMA_TO_DEVICE); - tbd->data = SWAP32(tx_cmd->dma_addr); - - DEB(DEB_TXADDR, print_eth(skb->data, "tx-queued")); - DMA_WBACK_INV(dev, tx_cmd, sizeof(struct tx_cmd)); - DMA_WBACK_INV(dev, tbd, sizeof(struct i596_tbd)); - i596_add_cmd(dev, &tx_cmd->cmd); - - dev->stats.tx_packets++; - dev->stats.tx_bytes += length; - } - - netif_start_queue(dev); - - return NETDEV_TX_OK; -} - -static void print_eth(unsigned char *add, char *str) -{ - printk(KERN_DEBUG "i596 0x%p, %pM --> %pM %02X%02X, %s\n", - add, add + 6, add, add[12], add[13], str); -} -static const struct net_device_ops i596_netdev_ops = { - .ndo_open = i596_open, - .ndo_stop = i596_close, - .ndo_start_xmit = i596_start_xmit, - .ndo_set_multicast_list = set_multicast_list, - .ndo_tx_timeout = i596_tx_timeout, - .ndo_change_mtu = eth_change_mtu, - .ndo_validate_addr = eth_validate_addr, - .ndo_set_mac_address = eth_mac_addr, -#ifdef CONFIG_NET_POLL_CONTROLLER - .ndo_poll_controller = i596_poll_controller, -#endif -}; - -static int __devinit i82596_probe(struct net_device *dev) -{ - int i; - struct i596_private *lp = netdev_priv(dev); - struct i596_dma *dma; - - /* This lot is ensure things have been cache line aligned. */ - BUILD_BUG_ON(sizeof(struct i596_rfd) != 32); - BUILD_BUG_ON(sizeof(struct i596_rbd) & 31); - BUILD_BUG_ON(sizeof(struct tx_cmd) & 31); - BUILD_BUG_ON(sizeof(struct i596_tbd) != 32); -#ifndef __LP64__ - BUILD_BUG_ON(sizeof(struct i596_dma) > 4096); -#endif - - if (!dev->base_addr || !dev->irq) - return -ENODEV; - - dma = (struct i596_dma *) DMA_ALLOC(dev->dev.parent, - sizeof(struct i596_dma), &lp->dma_addr, GFP_KERNEL); - if (!dma) { - printk(KERN_ERR "%s: Couldn't get shared memory\n", __FILE__); - return -ENOMEM; - } - - dev->netdev_ops = &i596_netdev_ops; - dev->watchdog_timeo = TX_TIMEOUT; - - memset(dma, 0, sizeof(struct i596_dma)); - lp->dma = dma; - - dma->scb.command = 0; - dma->scb.cmd = I596_NULL; - dma->scb.rfd = I596_NULL; - spin_lock_init(&lp->lock); - - DMA_WBACK_INV(dev, dma, sizeof(struct i596_dma)); - - i = register_netdev(dev); - if (i) { - DMA_FREE(dev->dev.parent, sizeof(struct i596_dma), - (void *)dma, lp->dma_addr); - return i; - } - - DEB(DEB_PROBE, printk(KERN_INFO "%s: 82596 at %#3lx, %pM IRQ %d.\n", - dev->name, dev->base_addr, dev->dev_addr, - dev->irq)); - DEB(DEB_INIT, printk(KERN_INFO - "%s: dma at 0x%p (%d bytes), lp->scb at 0x%p\n", - dev->name, dma, (int)sizeof(struct i596_dma), - &dma->scb)); - - return 0; -} - -#ifdef CONFIG_NET_POLL_CONTROLLER -static void i596_poll_controller(struct net_device *dev) -{ - disable_irq(dev->irq); - i596_interrupt(dev->irq, dev); - enable_irq(dev->irq); -} -#endif - -static irqreturn_t i596_interrupt(int irq, void *dev_id) -{ - struct net_device *dev = dev_id; - struct i596_private *lp; - struct i596_dma *dma; - unsigned short status, ack_cmd = 0; - - lp = netdev_priv(dev); - dma = lp->dma; - - spin_lock (&lp->lock); - - wait_cmd(dev, dma, 100, "i596 interrupt, timeout"); - status = SWAP16(dma->scb.status); - - DEB(DEB_INTS, printk(KERN_DEBUG - "%s: i596 interrupt, IRQ %d, status %4.4x.\n", - dev->name, dev->irq, status)); - - ack_cmd = status & 0xf000; - - if (!ack_cmd) { - DEB(DEB_ERRORS, printk(KERN_DEBUG - "%s: interrupt with no events\n", - dev->name)); - spin_unlock (&lp->lock); - return IRQ_NONE; - } - - if ((status & 0x8000) || (status & 0x2000)) { - struct i596_cmd *ptr; - - if ((status & 0x8000)) - DEB(DEB_INTS, - printk(KERN_DEBUG - "%s: i596 interrupt completed command.\n", - dev->name)); - if ((status & 0x2000)) - DEB(DEB_INTS, - printk(KERN_DEBUG - "%s: i596 interrupt command unit inactive %x.\n", - dev->name, status & 0x0700)); - - while (lp->cmd_head != NULL) { - DMA_INV(dev, lp->cmd_head, sizeof(struct i596_cmd)); - if (!(lp->cmd_head->status & SWAP16(STAT_C))) - break; - - ptr = lp->cmd_head; - - DEB(DEB_STATUS, - printk(KERN_DEBUG - "cmd_head->status = %04x, ->command = %04x\n", - SWAP16(lp->cmd_head->status), - SWAP16(lp->cmd_head->command))); - lp->cmd_head = ptr->v_next; - lp->cmd_backlog--; - - switch (SWAP16(ptr->command) & 0x7) { - case CmdTx: - { - struct tx_cmd *tx_cmd = (struct tx_cmd *) ptr; - struct sk_buff *skb = tx_cmd->skb; - - if (ptr->status & SWAP16(STAT_OK)) { - DEB(DEB_TXADDR, - print_eth(skb->data, "tx-done")); - } else { - dev->stats.tx_errors++; - if (ptr->status & SWAP16(0x0020)) - dev->stats.collisions++; - if (!(ptr->status & SWAP16(0x0040))) - dev->stats.tx_heartbeat_errors++; - if (ptr->status & SWAP16(0x0400)) - dev->stats.tx_carrier_errors++; - if (ptr->status & SWAP16(0x0800)) - dev->stats.collisions++; - if (ptr->status & SWAP16(0x1000)) - dev->stats.tx_aborted_errors++; - } - dma_unmap_single(dev->dev.parent, - tx_cmd->dma_addr, - skb->len, DMA_TO_DEVICE); - dev_kfree_skb_irq(skb); - - tx_cmd->cmd.command = 0; /* Mark free */ - break; - } - case CmdTDR: - { - unsigned short status = SWAP16(((struct tdr_cmd *)ptr)->status); - - if (status & 0x8000) { - DEB(DEB_ANY, - printk(KERN_DEBUG "%s: link ok.\n", - dev->name)); - } else { - if (status & 0x4000) - printk(KERN_ERR - "%s: Transceiver problem.\n", - dev->name); - if (status & 0x2000) - printk(KERN_ERR - "%s: Termination problem.\n", - dev->name); - if (status & 0x1000) - printk(KERN_ERR - "%s: Short circuit.\n", - dev->name); - - DEB(DEB_TDR, - printk(KERN_DEBUG "%s: Time %d.\n", - dev->name, status & 0x07ff)); - } - break; - } - case CmdConfigure: - /* - * Zap command so set_multicast_list() know - * it is free - */ - ptr->command = 0; - break; - } - ptr->v_next = NULL; - ptr->b_next = I596_NULL; - DMA_WBACK(dev, ptr, sizeof(struct i596_cmd)); - lp->last_cmd = jiffies; - } - - /* This mess is arranging that only the last of any outstanding - * commands has the interrupt bit set. Should probably really - * only add to the cmd queue when the CU is stopped. - */ - ptr = lp->cmd_head; - while ((ptr != NULL) && (ptr != lp->cmd_tail)) { - struct i596_cmd *prev = ptr; - - ptr->command &= SWAP16(0x1fff); - ptr = ptr->v_next; - DMA_WBACK_INV(dev, prev, sizeof(struct i596_cmd)); - } - - if (lp->cmd_head != NULL) - ack_cmd |= CUC_START; - dma->scb.cmd = SWAP32(virt_to_dma(lp, &lp->cmd_head->status)); - DMA_WBACK_INV(dev, &dma->scb, sizeof(struct i596_scb)); - } - if ((status & 0x1000) || (status & 0x4000)) { - if ((status & 0x4000)) - DEB(DEB_INTS, - printk(KERN_DEBUG - "%s: i596 interrupt received a frame.\n", - dev->name)); - i596_rx(dev); - /* Only RX_START if stopped - RGH 07-07-96 */ - if (status & 0x1000) { - if (netif_running(dev)) { - DEB(DEB_ERRORS, - printk(KERN_DEBUG - "%s: i596 interrupt receive unit inactive, status 0x%x\n", - dev->name, status)); - ack_cmd |= RX_START; - dev->stats.rx_errors++; - dev->stats.rx_fifo_errors++; - rebuild_rx_bufs(dev); - } - } - } - wait_cmd(dev, dma, 100, "i596 interrupt, timeout"); - dma->scb.command = SWAP16(ack_cmd); - DMA_WBACK(dev, &dma->scb, sizeof(struct i596_scb)); - - /* DANGER: I suspect that some kind of interrupt - acknowledgement aside from acking the 82596 might be needed - here... but it's running acceptably without */ - - ca(dev); - - wait_cmd(dev, dma, 100, "i596 interrupt, exit timeout"); - DEB(DEB_INTS, printk(KERN_DEBUG "%s: exiting interrupt.\n", dev->name)); - - spin_unlock (&lp->lock); - return IRQ_HANDLED; -} - -static int i596_close(struct net_device *dev) -{ - struct i596_private *lp = netdev_priv(dev); - unsigned long flags; - - netif_stop_queue(dev); - - DEB(DEB_INIT, - printk(KERN_DEBUG - "%s: Shutting down ethercard, status was %4.4x.\n", - dev->name, SWAP16(lp->dma->scb.status))); - - spin_lock_irqsave(&lp->lock, flags); - - wait_cmd(dev, lp->dma, 100, "close1 timed out"); - lp->dma->scb.command = SWAP16(CUC_ABORT | RX_ABORT); - DMA_WBACK(dev, &lp->dma->scb, sizeof(struct i596_scb)); - - ca(dev); - - wait_cmd(dev, lp->dma, 100, "close2 timed out"); - spin_unlock_irqrestore(&lp->lock, flags); - DEB(DEB_STRUCT, i596_display_data(dev)); - i596_cleanup_cmd(dev, lp); - - free_irq(dev->irq, dev); - remove_rx_bufs(dev); - - return 0; -} - -/* - * Set or clear the multicast filter for this adaptor. - */ - -static void set_multicast_list(struct net_device *dev) -{ - struct i596_private *lp = netdev_priv(dev); - struct i596_dma *dma = lp->dma; - int config = 0, cnt; - - DEB(DEB_MULTI, - printk(KERN_DEBUG - "%s: set multicast list, %d entries, promisc %s, allmulti %s\n", - dev->name, netdev_mc_count(dev), - dev->flags & IFF_PROMISC ? "ON" : "OFF", - dev->flags & IFF_ALLMULTI ? "ON" : "OFF")); - - if ((dev->flags & IFF_PROMISC) && - !(dma->cf_cmd.i596_config[8] & 0x01)) { - dma->cf_cmd.i596_config[8] |= 0x01; - config = 1; - } - if (!(dev->flags & IFF_PROMISC) && - (dma->cf_cmd.i596_config[8] & 0x01)) { - dma->cf_cmd.i596_config[8] &= ~0x01; - config = 1; - } - if ((dev->flags & IFF_ALLMULTI) && - (dma->cf_cmd.i596_config[11] & 0x20)) { - dma->cf_cmd.i596_config[11] &= ~0x20; - config = 1; - } - if (!(dev->flags & IFF_ALLMULTI) && - !(dma->cf_cmd.i596_config[11] & 0x20)) { - dma->cf_cmd.i596_config[11] |= 0x20; - config = 1; - } - if (config) { - if (dma->cf_cmd.cmd.command) - printk(KERN_INFO - "%s: config change request already queued\n", - dev->name); - else { - dma->cf_cmd.cmd.command = SWAP16(CmdConfigure); - DMA_WBACK_INV(dev, &dma->cf_cmd, sizeof(struct cf_cmd)); - i596_add_cmd(dev, &dma->cf_cmd.cmd); - } - } - - cnt = netdev_mc_count(dev); - if (cnt > MAX_MC_CNT) { - cnt = MAX_MC_CNT; - printk(KERN_NOTICE "%s: Only %d multicast addresses supported", - dev->name, cnt); - } - - if (!netdev_mc_empty(dev)) { - struct netdev_hw_addr *ha; - unsigned char *cp; - struct mc_cmd *cmd; - - cmd = &dma->mc_cmd; - cmd->cmd.command = SWAP16(CmdMulticastList); - cmd->mc_cnt = SWAP16(netdev_mc_count(dev) * 6); - cp = cmd->mc_addrs; - netdev_for_each_mc_addr(ha, dev) { - if (!cnt--) - break; - memcpy(cp, ha->addr, 6); - if (i596_debug > 1) - DEB(DEB_MULTI, - printk(KERN_DEBUG - "%s: Adding address %pM\n", - dev->name, cp)); - cp += 6; - } - DMA_WBACK_INV(dev, &dma->mc_cmd, sizeof(struct mc_cmd)); - i596_add_cmd(dev, &cmd->cmd); - } -} |