hollalinux
/
linux-sg2042
mirror of https://github.com/sophgo/linux-riscv.git
1
0
Fork 0
Code Issues Packages Projects Releases Wiki Activity
linux-sg2042/drivers/net/sk_mca.c

1217 lines
28 KiB
C
Raw Blame History

/*
net-3-driver for the SKNET MCA-based cards
This is an extension to the Linux operating system, and is covered by the
same GNU General Public License that covers that work.
Copyright 1999 by Alfred Arnold (alfred@ccac.rwth-aachen.de,
alfred.arnold@lancom.de)
This driver is based both on the 3C523 driver and the SK_G16 driver.
paper sources:
'PC Hardware: Aufbau, Funktionsweise, Programmierung' by
Hans-Peter Messmer for the basic Microchannel stuff
'Linux Geraetetreiber' by Allesandro Rubini, Kalle Dalheimer
for help on Ethernet driver programming
'Ethernet/IEEE 802.3 Family 1992 World Network Data Book/Handbook' by AMD
for documentation on the AM7990 LANCE
'SKNET Personal Technisches Manual', Version 1.2 by Schneider&Koch
for documentation on the Junior board
'SK-NET MC2+ Technical Manual", Version 1.1 by Schneider&Koch for
documentation on the MC2 bord
A big thank you to the S&K support for providing me so quickly with
documentation!
Also see http://www.syskonnect.com/
Missing things:
-> set debug level via ioctl instead of compile-time switches
-> I didn't follow the development of the 2.1.x kernels, so my
assumptions about which things changed with which kernel version
are probably nonsense
History:
May 16th, 1999
startup
May 22st, 1999
added private structure, methods
begun building data structures in RAM
May 23nd, 1999
can receive frames, send frames
May 24th, 1999
modularized initialization of LANCE
loadable as module
still Tx problem :-(
May 26th, 1999
MC2 works
support for multiple devices
display media type for MC2+
May 28th, 1999
fixed problem in GetLANCE leaving interrupts turned off
increase TX queue to 4 packets to improve send performance
May 29th, 1999
a few corrections in statistics, caught rcvr overruns
reinitialization of LANCE/board in critical situations
MCA info implemented
implemented LANCE multicast filter
Jun 6th, 1999
additions for Linux 2.2
Dec 25th, 1999
unfortunately there seem to be newer MC2+ boards that react
on IRQ 3/5/9/10 instead of 3/5/10/11, so we have to autoprobe
in questionable cases...
Dec 28th, 1999
integrated patches from David Weinehall & Bill Wendling for 2.3
kernels (isa_...functions). Things are defined in a way that
it still works with 2.0.x 8-)
Dec 30th, 1999
added handling of the remaining interrupt conditions. That
should cure the spurious hangs.
Jan 30th, 2000
newer kernels automatically probe more than one board, so the
'startslot' as a variable is also needed here
June 1st, 2000
added changes for recent 2.3 kernels
*************************************************************************/
#include <linux/kernel.h>
#include <linux/string.h>
#include <linux/errno.h>
#include <linux/ioport.h>
#include <linux/slab.h>
#include <linux/interrupt.h>
#include <linux/delay.h>
#include <linux/time.h>
#include <linux/mca-legacy.h>
#include <linux/init.h>
#include <linux/module.h>
#include <linux/netdevice.h>
#include <linux/etherdevice.h>
#include <linux/skbuff.h>
#include <linux/bitops.h>
#include <asm/processor.h>
#include <asm/io.h>
#define _SK_MCA_DRIVER_
#include "sk_mca.h"
/* ------------------------------------------------------------------------
* global static data - not more since we can handle multiple boards and
* have to pack all state info into the device struct!
* ------------------------------------------------------------------------ */
static char *MediaNames[Media_Count] =
{ "10Base2", "10BaseT", "10Base5", "Unknown" };
static unsigned char poly[] =
{ 1, 1, 1, 0, 1, 1, 0, 1, 1, 0, 1, 1, 1, 0, 0, 0,
1, 0, 0, 0, 0, 0, 1, 1, 0, 0, 1, 0, 0, 0, 0, 0
};
/* ------------------------------------------------------------------------
* private subfunctions
* ------------------------------------------------------------------------ */
/* dump parts of shared memory - only needed during debugging */
#ifdef DEBUG
static void dumpmem(struct net_device *dev, u32 start, u32 len)
{
skmca_priv *priv = netdev_priv(dev);
int z;
for (z = 0; z < len; z++) {
if ((z & 15) == 0)
printk("%04x:", z);
printk(" %02x", readb(priv->base + start + z));
if ((z & 15) == 15)
printk("\n");
}
}
/* print exact time - ditto */
static void PrTime(void)
{
struct timeval tv;
do_gettimeofday(&tv);
printk("%9d:%06d: ", tv.tv_sec, tv.tv_usec);
}
#endif
/* deduce resources out of POS registers */
static void __init getaddrs(int slot, int junior, int *base, int *irq,
skmca_medium * medium)
{
u_char pos0, pos1, pos2;
if (junior) {
pos0 = mca_read_stored_pos(slot, 2);
*base = ((pos0 & 0x0e) << 13) + 0xc0000;
*irq = ((pos0 & 0x10) >> 4) + 10;
*medium = Media_Unknown;
} else {
/* reset POS 104 Bits 0+1 so the shared memory region goes to the
configured area between 640K and 1M. Afterwards, enable the MC2.
I really don't know what rode SK to do this... */
mca_write_pos(slot, 4,
mca_read_stored_pos(slot, 4) & 0xfc);
mca_write_pos(slot, 2,
mca_read_stored_pos(slot, 2) | 0x01);
pos1 = mca_read_stored_pos(slot, 3);
pos2 = mca_read_stored_pos(slot, 4);
*base = ((pos1 & 0x07) << 14) + 0xc0000;
switch (pos2 & 0x0c) {
case 0:
*irq = 3;
break;
case 4:
*irq = 5;
break;
case 8:
*irq = -10;
break;
case 12:
*irq = -11;
break;
}
*medium = (pos2 >> 6) & 3;
}
}
/* check for both cards:
When the MC2 is turned off, it was configured for more than 15MB RAM,
is disabled and won't get detected using the standard probe. We
therefore have to scan the slots manually :-( */
static int __init dofind(int *junior, int firstslot)
{
int slot;
unsigned int id;
for (slot = firstslot; slot < MCA_MAX_SLOT_NR; slot++) {
id = mca_read_stored_pos(slot, 0)
+ (((unsigned int) mca_read_stored_pos(slot, 1)) << 8);
*junior = 0;
if (id == SKNET_MCA_ID)
return slot;
*junior = 1;
if (id == SKNET_JUNIOR_MCA_ID)
return slot;
}
return MCA_NOTFOUND;
}
/* reset the whole board */
static void ResetBoard(struct net_device *dev)
{
skmca_priv *priv = netdev_priv(dev);
writeb(CTRL_RESET_ON, priv->ctrladdr);
udelay(10);
writeb(CTRL_RESET_OFF, priv->ctrladdr);
}
/* wait for LANCE interface to become not busy */
static int WaitLANCE(struct net_device *dev)
{
skmca_priv *priv = netdev_priv(dev);
int t = 0;
while ((readb(priv->ctrladdr) & STAT_IO_BUSY) ==
STAT_IO_BUSY) {
udelay(1);
if (++t > 1000) {
printk("%s: LANCE access timeout", dev->name);
return 0;
}
}
return 1;
}
/* set LANCE register - must be atomic */
static void SetLANCE(struct net_device *dev, u16 addr, u16 value)
{
skmca_priv *priv = netdev_priv(dev);
unsigned long flags;
/* disable interrupts */
spin_lock_irqsave(&priv->lock, flags);
/* wait until no transfer is pending */
WaitLANCE(dev);
/* transfer register address to RAP */
writeb(CTRL_RESET_OFF | CTRL_RW_WRITE | CTRL_ADR_RAP, priv->ctrladdr);
writew(addr, priv->ioregaddr);
writeb(IOCMD_GO, priv->cmdaddr);
udelay(1);
WaitLANCE(dev);
/* transfer data to register */
writeb(CTRL_RESET_OFF | CTRL_RW_WRITE | CTRL_ADR_DATA, priv->ctrladdr);
writew(value, priv->ioregaddr);
writeb(IOCMD_GO, priv->cmdaddr);
udelay(1);
WaitLANCE(dev);
/* reenable interrupts */
spin_unlock_irqrestore(&priv->lock, flags);
}
/* get LANCE register */
static u16 GetLANCE(struct net_device *dev, u16 addr)
{
skmca_priv *priv = netdev_priv(dev);
unsigned long flags;
unsigned int res;
/* disable interrupts */
spin_lock_irqsave(&priv->lock, flags);
/* wait until no transfer is pending */
WaitLANCE(dev);
/* transfer register address to RAP */
writeb(CTRL_RESET_OFF | CTRL_RW_WRITE | CTRL_ADR_RAP, priv->ctrladdr);
writew(addr, priv->ioregaddr);
writeb(IOCMD_GO, priv->cmdaddr);
udelay(1);
WaitLANCE(dev);
/* transfer data from register */
writeb(CTRL_RESET_OFF | CTRL_RW_READ | CTRL_ADR_DATA, priv->ctrladdr);
writeb(IOCMD_GO, priv->cmdaddr);
udelay(1);
WaitLANCE(dev);
res = readw(priv->ioregaddr);
/* reenable interrupts */
spin_unlock_irqrestore(&priv->lock, flags);
return res;
}
/* build up descriptors in shared RAM */
static void InitDscrs(struct net_device *dev)
{
skmca_priv *priv = netdev_priv(dev);
u32 bufaddr;
/* Set up Tx descriptors. The board has only 16K RAM so bits 16..23
are always 0. */
bufaddr = RAM_DATABASE;
{
LANCE_TxDescr descr;
int z;
for (z = 0; z < TXCOUNT; z++) {
descr.LowAddr = bufaddr;
descr.Flags = 0;
descr.Len = 0xf000;
descr.Status = 0;
memcpy_toio(priv->base + RAM_TXBASE +
(z * sizeof(LANCE_TxDescr)), &descr,
sizeof(LANCE_TxDescr));
memset_io(priv->base + bufaddr, 0, RAM_BUFSIZE);
bufaddr += RAM_BUFSIZE;
}
}
/* do the same for the Rx descriptors */
{
LANCE_RxDescr descr;
int z;
for (z = 0; z < RXCOUNT; z++) {
descr.LowAddr = bufaddr;
descr.Flags = RXDSCR_FLAGS_OWN;
descr.MaxLen = -RAM_BUFSIZE;
descr.Len = 0;
memcpy_toio(priv->base + RAM_RXBASE +
(z * sizeof(LANCE_RxDescr)), &descr,
sizeof(LANCE_RxDescr));
memset_io(priv->base + bufaddr, 0, RAM_BUFSIZE);
bufaddr += RAM_BUFSIZE;
}
}
}
/* calculate the hash bit position for a given multicast address
taken more or less directly from the AMD datasheet... */
static void UpdateCRC(unsigned char *CRC, int bit)
{
int j;
/* shift CRC one bit */
memmove(CRC + 1, CRC, 32 * sizeof(unsigned char));
CRC[0] = 0;
/* if bit XOR controlbit = 1, set CRC = CRC XOR polynomial */
if (bit ^ CRC[32])
for (j = 0; j < 32; j++)
CRC[j] ^= poly[j];
}
static unsigned int GetHash(char *address)
{
unsigned char CRC[33];
int i, byte, hashcode;
/* a multicast address has bit 0 in the first byte set */
if ((address[0] & 1) == 0)
return -1;
/* initialize CRC */
memset(CRC, 1, sizeof(CRC));
/* loop through address bits */
for (byte = 0; byte < 6; byte++)
for (i = 0; i < 8; i++)
UpdateCRC(CRC, (address[byte] >> i) & 1);
/* hashcode is the 6 least significant bits of the CRC */
hashcode = 0;
for (i = 0; i < 6; i++)
hashcode = (hashcode << 1) + CRC[i];
return hashcode;
}
/* feed ready-built initialization block into LANCE */
static void InitLANCE(struct net_device *dev)
{
skmca_priv *priv = netdev_priv(dev);
/* build up descriptors. */
InitDscrs(dev);
/* next RX descriptor to be read is the first one. Since the LANCE
will start from the beginning after initialization, we have to
reset out pointers too. */
priv->nextrx = 0;
/* no TX descriptors active */
priv->nexttxput = priv->nexttxdone = priv->txbusy = 0;
/* set up the LANCE bus control register - constant for SKnet boards */
SetLANCE(dev, LANCE_CSR3,
CSR3_BSWAP_OFF | CSR3_ALE_LOW | CSR3_BCON_HOLD);
/* write address of initialization block into LANCE */
SetLANCE(dev, LANCE_CSR1, RAM_INITBASE & 0xffff);
SetLANCE(dev, LANCE_CSR2, (RAM_INITBASE >> 16) & 0xff);
/* we don't get ready until the LANCE has read the init block */
netif_stop_queue(dev);
/* let LANCE read the initialization block. LANCE is ready
when we receive the corresponding interrupt. */
SetLANCE(dev, LANCE_CSR0, CSR0_INEA | CSR0_INIT);
}
/* stop the LANCE so we can reinitialize it */
static void StopLANCE(struct net_device *dev)
{
/* can't take frames any more */
netif_stop_queue(dev);
/* disable interrupts, stop it */
SetLANCE(dev, LANCE_CSR0, CSR0_STOP);
}
/* initialize card and LANCE for proper operation */
static void InitBoard(struct net_device *dev)
{
skmca_priv *priv = netdev_priv(dev);
LANCE_InitBlock block;
/* Lay out the shared RAM - first we create the init block for the LANCE.
We do not overwrite it later because we need it again when we switch
promiscous mode on/off. */
block.Mode = 0;
if (dev->flags & IFF_PROMISC)
block.Mode |= LANCE_INIT_PROM;
memcpy(block.PAdr, dev->dev_addr, 6);
memset(block.LAdrF, 0, sizeof(block.LAdrF));
block.RdrP = (RAM_RXBASE & 0xffffff) | (LRXCOUNT << 29);
block.TdrP = (RAM_TXBASE & 0xffffff) | (LTXCOUNT << 29);
memcpy_toio(priv->base + RAM_INITBASE, &block, sizeof(block));
/* initialize LANCE. Implicitly sets up other structures in RAM. */
InitLANCE(dev);
}
/* deinitialize card and LANCE */
static void DeinitBoard(struct net_device *dev)
{
/* stop LANCE */
StopLANCE(dev);
/* reset board */
ResetBoard(dev);
}
/* probe for device's irq */
static int __init ProbeIRQ(struct net_device *dev)
{
unsigned long imaskval, njiffies, irq;
u16 csr0val;
/* enable all interrupts */
imaskval = probe_irq_on();
/* initialize the board. Wait for interrupt 'Initialization done'. */
ResetBoard(dev);
InitBoard(dev);
njiffies = jiffies + HZ;
do {
csr0val = GetLANCE(dev, LANCE_CSR0);
}
while (((csr0val & CSR0_IDON) == 0) && (jiffies != njiffies));
/* turn of interrupts again */
irq = probe_irq_off(imaskval);
/* if we found something, ack the interrupt */
if (irq)
SetLANCE(dev, LANCE_CSR0, csr0val | CSR0_IDON);
/* back to idle state */
DeinitBoard(dev);
return irq;
}
/* ------------------------------------------------------------------------
* interrupt handler(s)
* ------------------------------------------------------------------------ */
/* LANCE has read initialization block -> start it */
static u16 irqstart_handler(struct net_device *dev, u16 oldcsr0)
{
/* now we're ready to transmit */
netif_wake_queue(dev);
/* reset IDON bit, start LANCE */
SetLANCE(dev, LANCE_CSR0, oldcsr0 | CSR0_IDON | CSR0_STRT);
return GetLANCE(dev, LANCE_CSR0);
}
/* did we lose blocks due to a FIFO overrun ? */
static u16 irqmiss_handler(struct net_device *dev, u16 oldcsr0)
{
skmca_priv *priv = netdev_priv(dev);
/* update statistics */
priv->stat.rx_fifo_errors++;
/* reset MISS bit */
SetLANCE(dev, LANCE_CSR0, oldcsr0 | CSR0_MISS);
return GetLANCE(dev, LANCE_CSR0);
}
/* receive interrupt */
static u16 irqrx_handler(struct net_device *dev, u16 oldcsr0)
{
skmca_priv *priv = netdev_priv(dev);
LANCE_RxDescr descr;
unsigned int descraddr;
/* run through queue until we reach a descriptor we do not own */
descraddr = RAM_RXBASE + (priv->nextrx * sizeof(LANCE_RxDescr));
while (1) {
/* read descriptor */
memcpy_fromio(&descr, priv->base + descraddr,
sizeof(LANCE_RxDescr));
/* if we reach a descriptor we do not own, we're done */
if ((descr.Flags & RXDSCR_FLAGS_OWN) != 0)
break;
#ifdef DEBUG
PrTime();
printk("Receive packet on descr %d len %d\n", priv->nextrx,
descr.Len);
#endif
/* erroneous packet ? */
if ((descr.Flags & RXDSCR_FLAGS_ERR) != 0) {
priv->stat.rx_errors++;
if ((descr.Flags & RXDSCR_FLAGS_CRC) != 0)
priv->stat.rx_crc_errors++;
else if ((descr.Flags & RXDSCR_FLAGS_CRC) != 0)
priv->stat.rx_frame_errors++;
else if ((descr.Flags & RXDSCR_FLAGS_OFLO) != 0)
priv->stat.rx_fifo_errors++;
}
/* good packet ? */
else {
struct sk_buff *skb;
skb = dev_alloc_skb(descr.Len + 2);
if (skb == NULL)
priv->stat.rx_dropped++;
else {
memcpy_fromio(skb_put(skb, descr.Len),
priv->base +
descr.LowAddr, descr.Len);
skb->dev = dev;
skb->protocol = eth_type_trans(skb, dev);
skb->ip_summed = CHECKSUM_NONE;
priv->stat.rx_packets++;
priv->stat.rx_bytes += descr.Len;
netif_rx(skb);
dev->last_rx = jiffies;
}
}
/* give descriptor back to LANCE */
descr.Len = 0;
descr.Flags |= RXDSCR_FLAGS_OWN;
/* update descriptor in shared RAM */
memcpy_toio(priv->base + descraddr, &descr,
sizeof(LANCE_RxDescr));
/* go to next descriptor */
priv->nextrx++;
descraddr += sizeof(LANCE_RxDescr);
if (priv->nextrx >= RXCOUNT) {
priv->nextrx = 0;
descraddr = RAM_RXBASE;
}
}
/* reset RINT bit */
SetLANCE(dev, LANCE_CSR0, oldcsr0 | CSR0_RINT);
return GetLANCE(dev, LANCE_CSR0);
}
/* transmit interrupt */
static u16 irqtx_handler(struct net_device *dev, u16 oldcsr0)
{
skmca_priv *priv = netdev_priv(dev);
LANCE_TxDescr descr;
unsigned int descraddr;
/* check descriptors at most until no busy one is left */
descraddr =
RAM_TXBASE + (priv->nexttxdone * sizeof(LANCE_TxDescr));
while (priv->txbusy > 0) {
/* read descriptor */
memcpy_fromio(&descr, priv->base + descraddr,
sizeof(LANCE_TxDescr));
/* if the LANCE still owns this one, we've worked out all sent packets */
if ((descr.Flags & TXDSCR_FLAGS_OWN) != 0)
break;
#ifdef DEBUG
PrTime();
printk("Send packet done on descr %d\n", priv->nexttxdone);
#endif
/* update statistics */
if ((descr.Flags & TXDSCR_FLAGS_ERR) == 0) {
priv->stat.tx_packets++;
priv->stat.tx_bytes++;
} else {
priv->stat.tx_errors++;
if ((descr.Status & TXDSCR_STATUS_UFLO) != 0) {
priv->stat.tx_fifo_errors++;
InitLANCE(dev);
}
else
if ((descr.Status & TXDSCR_STATUS_LCOL) !=
0) priv->stat.tx_window_errors++;
else if ((descr.Status & TXDSCR_STATUS_LCAR) != 0)
priv->stat.tx_carrier_errors++;
else if ((descr.Status & TXDSCR_STATUS_RTRY) != 0)
priv->stat.tx_aborted_errors++;
}
/* go to next descriptor */
priv->nexttxdone++;
descraddr += sizeof(LANCE_TxDescr);
if (priv->nexttxdone >= TXCOUNT) {
priv->nexttxdone = 0;
descraddr = RAM_TXBASE;
}
priv->txbusy--;
}
/* reset TX interrupt bit */
SetLANCE(dev, LANCE_CSR0, oldcsr0 | CSR0_TINT);
oldcsr0 = GetLANCE(dev, LANCE_CSR0);
/* at least one descriptor is freed. Therefore we can accept
a new one */
/* inform upper layers we're in business again */
netif_wake_queue(dev);
return oldcsr0;
}
/* general interrupt entry */
static irqreturn_t irq_handler(int irq, void *device, struct pt_regs *regs)
{
struct net_device *dev = (struct net_device *) device;
u16 csr0val;
/* read CSR0 to get interrupt cause */
csr0val = GetLANCE(dev, LANCE_CSR0);
/* in case we're not meant... */
if ((csr0val & CSR0_INTR) == 0)
return IRQ_NONE;
#if 0
set_bit(LINK_STATE_RXSEM, &dev->state);
#endif
/* loop through the interrupt bits until everything is clear */
do {
if ((csr0val & CSR0_IDON) != 0)
csr0val = irqstart_handler(dev, csr0val);
if ((csr0val & CSR0_RINT) != 0)
csr0val = irqrx_handler(dev, csr0val);
if ((csr0val & CSR0_MISS) != 0)
csr0val = irqmiss_handler(dev, csr0val);
if ((csr0val & CSR0_TINT) != 0)
csr0val = irqtx_handler(dev, csr0val);
if ((csr0val & CSR0_MERR) != 0) {
SetLANCE(dev, LANCE_CSR0, csr0val | CSR0_MERR);
csr0val = GetLANCE(dev, LANCE_CSR0);
}
if ((csr0val & CSR0_BABL) != 0) {
SetLANCE(dev, LANCE_CSR0, csr0val | CSR0_BABL);
csr0val = GetLANCE(dev, LANCE_CSR0);
}
}
while ((csr0val & CSR0_INTR) != 0);
#if 0
clear_bit(LINK_STATE_RXSEM, &dev->state);
#endif
return IRQ_HANDLED;
}
/* ------------------------------------------------------------------------
* driver methods
* ------------------------------------------------------------------------ */
/* MCA info */
static int skmca_getinfo(char *buf, int slot, void *d)
{
int len = 0, i;
struct net_device *dev = (struct net_device *) d;
skmca_priv *priv;
/* can't say anything about an uninitialized device... */
if (dev == NULL)
return len;
priv = netdev_priv(dev);
/* print info */
len += sprintf(buf + len, "IRQ: %d\n", priv->realirq);
len += sprintf(buf + len, "Memory: %#lx-%#lx\n", dev->mem_start,
dev->mem_end - 1);
len +=
sprintf(buf + len, "Transceiver: %s\n",
MediaNames[priv->medium]);
len += sprintf(buf + len, "Device: %s\n", dev->name);
len += sprintf(buf + len, "MAC address:");
for (i = 0; i < 6; i++)
len += sprintf(buf + len, " %02x", dev->dev_addr[i]);
buf[len++] = '\n';
buf[len] = 0;
return len;
}
/* open driver. Means also initialization and start of LANCE */
static int skmca_open(struct net_device *dev)
{
int result;
skmca_priv *priv = netdev_priv(dev);
/* register resources - only necessary for IRQ */
result =
request_irq(priv->realirq, irq_handler,
SA_SHIRQ | SA_SAMPLE_RANDOM, "sk_mca", dev);
if (result != 0) {
printk("%s: failed to register irq %d\n", dev->name,
dev->irq);
return result;
}
dev->irq = priv->realirq;
/* set up the card and LANCE */
InitBoard(dev);
/* set up flags */
netif_start_queue(dev);
return 0;
}
/* close driver. Shut down board and free allocated resources */
static int skmca_close(struct net_device *dev)
{
/* turn off board */
DeinitBoard(dev);
/* release resources */
if (dev->irq != 0)
free_irq(dev->irq, dev);
dev->irq = 0;
return 0;
}
/* transmit a block. */
static int skmca_tx(struct sk_buff *skb, struct net_device *dev)
{
skmca_priv *priv = netdev_priv(dev);
LANCE_TxDescr descr;
unsigned int address;
int tmplen, retval = 0;
unsigned long flags;
/* if we get called with a NULL descriptor, the Ethernet layer thinks
our card is stuck an we should reset it. We'll do this completely: */
if (skb == NULL) {
DeinitBoard(dev);
InitBoard(dev);
return 0; /* don't try to free the block here ;-) */
}
/* is there space in the Tx queue ? If no, the upper layer gave us a
packet in spite of us not being ready and is really in trouble.
We'll do the dropping for him: */
if (priv->txbusy >= TXCOUNT) {
priv->stat.tx_dropped++;
retval = -EIO;
goto tx_done;
}
/* get TX descriptor */
address = RAM_TXBASE + (priv->nexttxput * sizeof(LANCE_TxDescr));
memcpy_fromio(&descr, priv->base + address, sizeof(LANCE_TxDescr));
/* enter packet length as 2s complement - assure minimum length */
tmplen = skb->len;
if (tmplen < 60)
tmplen = 60;
descr.Len = 65536 - tmplen;
/* copy filler into RAM - in case we're filling up...
we're filling a bit more than necessary, but that doesn't harm
since the buffer is far larger... */
if (tmplen > skb->len) {
char *fill = "NetBSD is a nice OS too! ";
unsigned int destoffs = 0, l = strlen(fill);
while (destoffs < tmplen) {
memcpy_toio(priv->base + descr.LowAddr +
destoffs, fill, l);
destoffs += l;
}
}
/* do the real data copying */
memcpy_toio(priv->base + descr.LowAddr, skb->data, skb->len);
/* hand descriptor over to LANCE - this is the first and last chunk */
descr.Flags =
TXDSCR_FLAGS_OWN | TXDSCR_FLAGS_STP | TXDSCR_FLAGS_ENP;
#ifdef DEBUG
PrTime();
printk("Send packet on descr %d len %d\n", priv->nexttxput,
skb->len);
#endif
/* one more descriptor busy */
spin_lock_irqsave(&priv->lock, flags);
priv->nexttxput++;
if (priv->nexttxput >= TXCOUNT)
priv->nexttxput = 0;
priv->txbusy++;
/* are we saturated ? */
if (priv->txbusy >= TXCOUNT)
netif_stop_queue(dev);
/* write descriptor back to RAM */
memcpy_toio(priv->base + address, &descr, sizeof(LANCE_TxDescr));
/* if no descriptors were active, give the LANCE a hint to read it
immediately */
if (priv->txbusy == 0)
SetLANCE(dev, LANCE_CSR0, CSR0_INEA | CSR0_TDMD);
spin_unlock_irqrestore(&priv->lock, flags);
tx_done:
dev_kfree_skb(skb);
return retval;
}
/* return pointer to Ethernet statistics */
static struct net_device_stats *skmca_stats(struct net_device *dev)
{
skmca_priv *priv = netdev_priv(dev);
return &(priv->stat);
}
/* switch receiver mode. We use the LANCE's multicast filter to prefilter
multicast addresses. */
static void skmca_set_multicast_list(struct net_device *dev)
{
skmca_priv *priv = netdev_priv(dev);
LANCE_InitBlock block;
/* first stop the LANCE... */
StopLANCE(dev);
/* ...then modify the initialization block... */
memcpy_fromio(&block, priv->base + RAM_INITBASE, sizeof(block));
if (dev->flags & IFF_PROMISC)
block.Mode |= LANCE_INIT_PROM;
else
block.Mode &= ~LANCE_INIT_PROM;
if (dev->flags & IFF_ALLMULTI) { /* get all multicasts */
memset(block.LAdrF, 0xff, sizeof(block.LAdrF));
} else { /* get selected/no multicasts */
struct dev_mc_list *mptr;
int code;
memset(block.LAdrF, 0, sizeof(block.LAdrF));
for (mptr = dev->mc_list; mptr != NULL; mptr = mptr->next) {
code = GetHash(mptr->dmi_addr);
block.LAdrF[(code >> 3) & 7] |= 1 << (code & 7);
}
}
memcpy_toio(priv->base + RAM_INITBASE, &block, sizeof(block));
/* ...then reinit LANCE with the correct flags */
InitLANCE(dev);
}
/* ------------------------------------------------------------------------
* hardware check
* ------------------------------------------------------------------------ */
static int startslot; /* counts through slots when probing multiple devices */
static void cleanup_card(struct net_device *dev)
{
skmca_priv *priv = netdev_priv(dev);
DeinitBoard(dev);
if (dev->irq != 0)
free_irq(dev->irq, dev);
iounmap(priv->base);
mca_mark_as_unused(priv->slot);
mca_set_adapter_procfn(priv->slot, NULL, NULL);
}
struct net_device * __init skmca_probe(int unit)
{
struct net_device *dev;
int force_detect = 0;
int junior, slot, i;
int base = 0, irq = 0;
skmca_priv *priv;
skmca_medium medium;
int err;
/* can't work without an MCA bus ;-) */
if (MCA_bus == 0)
return ERR_PTR(-ENODEV);
dev = alloc_etherdev(sizeof(skmca_priv));
if (!dev)
return ERR_PTR(-ENOMEM);
if (unit >= 0) {
sprintf(dev->name, "eth%d", unit);
netdev_boot_setup_check(dev);
}
SET_MODULE_OWNER(dev);
/* start address of 1 --> forced detection */
if (dev->mem_start == 1)
force_detect = 1;
/* search through slots */
base = dev->mem_start;
irq = dev->base_addr;
for (slot = startslot; (slot = dofind(&junior, slot)) != -1; slot++) {
/* deduce card addresses */
getaddrs(slot, junior, &base, &irq, &medium);
/* slot already in use ? */
if (mca_is_adapter_used(slot))
continue;
/* were we looking for something different ? */
if (dev->irq && dev->irq != irq)
continue;
if (dev->mem_start && dev->mem_start != base)
continue;
/* found something that matches */
break;
}
/* nothing found ? */
if (slot == -1) {
free_netdev(dev);
return (base || irq) ? ERR_PTR(-ENXIO) : ERR_PTR(-ENODEV);
}
/* make procfs entries */
if (junior)
mca_set_adapter_name(slot,
"SKNET junior MC2 Ethernet Adapter");
else
mca_set_adapter_name(slot, "SKNET MC2+ Ethernet Adapter");
mca_set_adapter_procfn(slot, (MCA_ProcFn) skmca_getinfo, dev);
mca_mark_as_used(slot);
/* announce success */
printk("%s: SKNet %s adapter found in slot %d\n", dev->name,
junior ? "Junior MC2" : "MC2+", slot + 1);
priv = netdev_priv(dev);
priv->base = ioremap(base, 0x4000);
if (!priv->base) {
mca_set_adapter_procfn(slot, NULL, NULL);
mca_mark_as_unused(slot);
free_netdev(dev);
return ERR_PTR(-ENOMEM);
}
priv->slot = slot;
priv->macbase = priv->base + 0x3fc0;
priv->ioregaddr = priv->base + 0x3ff0;
priv->ctrladdr = priv->base + 0x3ff2;
priv->cmdaddr = priv->base + 0x3ff3;
priv->medium = medium;
memset(&priv->stat, 0, sizeof(struct net_device_stats));
spin_lock_init(&priv->lock);
/* set base + irq for this device (irq not allocated so far) */
dev->irq = 0;
dev->mem_start = base;
dev->mem_end = base + 0x4000;
/* autoprobe ? */
if (irq < 0) {
int nirq;
printk
("%s: ambigous POS bit combination, must probe for IRQ...\n",
dev->name);
nirq = ProbeIRQ(dev);
if (nirq <= 0)
printk("%s: IRQ probe failed, assuming IRQ %d",
dev->name, priv->realirq = -irq);
else
priv->realirq = nirq;
} else
priv->realirq = irq;
/* set methods */
dev->open = skmca_open;
dev->stop = skmca_close;
dev->hard_start_xmit = skmca_tx;
dev->do_ioctl = NULL;
dev->get_stats = skmca_stats;
dev->set_multicast_list = skmca_set_multicast_list;
dev->flags |= IFF_MULTICAST;
/* copy out MAC address */
for (i = 0; i < 6; i++)
dev->dev_addr[i] = readb(priv->macbase + (i << 1));
/* print config */
printk("%s: IRQ %d, memory %#lx-%#lx, "
"MAC address %02x:%02x:%02x:%02x:%02x:%02x.\n",
dev->name, priv->realirq, dev->mem_start, dev->mem_end - 1,
dev->dev_addr[0], dev->dev_addr[1], dev->dev_addr[2],
dev->dev_addr[3], dev->dev_addr[4], dev->dev_addr[5]);
printk("%s: %s medium\n", dev->name, MediaNames[priv->medium]);
/* reset board */
ResetBoard(dev);
startslot = slot + 1;
err = register_netdev(dev);
if (err) {
cleanup_card(dev);
free_netdev(dev);
dev = ERR_PTR(err);
}
return dev;
}
/* ------------------------------------------------------------------------
* modularization support
* ------------------------------------------------------------------------ */
#ifdef MODULE
MODULE_LICENSE("GPL");
#define DEVMAX 5
static struct net_device *moddevs[DEVMAX];
int init_module(void)
{
int z;
startslot = 0;
for (z = 0; z < DEVMAX; z++) {
struct net_device *dev = skmca_probe(-1);
if (IS_ERR(dev))
break;
moddevs[z] = dev;
}
if (!z)
return -EIO;
return 0;
}
void cleanup_module(void)
{
int z;
for (z = 0; z < DEVMAX; z++) {
struct net_device *dev = moddevs[z];
if (dev) {
unregister_netdev(dev);
cleanup_card(dev);
free_netdev(dev);
}
}
}
#endif /* MODULE */
Reference in New Issue View Git Blame Copy Permalink