OpenCloudOS-Kernel/drivers/net/wireless/arlan-main.c

1892 lines
51 KiB
C
Raw Normal View History

/*
* Copyright (C) 1997 Cullen Jennings
* Copyright (C) 1998 Elmer Joandiu, elmer@ylenurme.ee
* GNU General Public License applies
* This module provides support for the Arlan 655 card made by Aironet
*/
#include "arlan.h"
#if BITS_PER_LONG != 32
# error FIXME: this driver requires a 32-bit platform
#endif
static const char *arlan_version = "C.Jennigs 97 & Elmer.Joandi@ut.ee Oct'98, http://www.ylenurme.ee/~elmer/655/";
struct net_device *arlan_device[MAX_ARLANS];
static int SID = SIDUNKNOWN;
static int radioNodeId = radioNodeIdUNKNOWN;
static char encryptionKey[12] = {'a', 'b', 'c', 'd', 'e', 'f', 'g', 'h'};
int arlan_debug = debugUNKNOWN;
static int spreadingCode = spreadingCodeUNKNOWN;
static int channelNumber = channelNumberUNKNOWN;
static int channelSet = channelSetUNKNOWN;
static int systemId = systemIdUNKNOWN;
static int registrationMode = registrationModeUNKNOWN;
static int keyStart;
static int tx_delay_ms;
static int retries = 5;
static int tx_queue_len = 1;
static int arlan_EEPROM_bad;
#ifdef ARLAN_DEBUGGING
static int testMemory = testMemoryUNKNOWN;
static int irq = irqUNKNOWN;
static int txScrambled = 1;
static int mdebug;
module_param(irq, int, 0);
module_param(mdebug, int, 0);
module_param(testMemory, int, 0);
module_param(txScrambled, int, 0);
MODULE_PARM_DESC(irq, "(unused)");
MODULE_PARM_DESC(testMemory, "(unused)");
MODULE_PARM_DESC(mdebug, "Arlan multicast debugging (0-1)");
#endif
module_param_named(debug, arlan_debug, int, 0);
module_param(spreadingCode, int, 0);
module_param(channelNumber, int, 0);
module_param(channelSet, int, 0);
module_param(systemId, int, 0);
module_param(registrationMode, int, 0);
module_param(radioNodeId, int, 0);
module_param(SID, int, 0);
module_param(keyStart, int, 0);
module_param(tx_delay_ms, int, 0);
module_param(retries, int, 0);
module_param(tx_queue_len, int, 0);
module_param_named(EEPROM_bad, arlan_EEPROM_bad, int, 0);
MODULE_PARM_DESC(debug, "Arlan debug enable (0-1)");
MODULE_PARM_DESC(retries, "Arlan maximum packet retransmisions");
#ifdef ARLAN_ENTRY_EXIT_DEBUGGING
static int arlan_entry_debug;
static int arlan_exit_debug;
static int arlan_entry_and_exit_debug;
module_param_named(entry_debug, arlan_entry_debug, int, 0);
module_param_named(exit_debug, arlan_exit_debug, int, 0);
module_param_named(entry_and_exit_debug, arlan_entry_and_exit_debug, int, 0);
MODULE_PARM_DESC(entry_debug, "Arlan driver function entry debugging");
MODULE_PARM_DESC(exit_debug, "Arlan driver function exit debugging");
MODULE_PARM_DESC(entry_and_exit_debug, "Arlan driver function entry and exit debugging");
#endif
struct arlan_conf_stru arlan_conf[MAX_ARLANS];
static int arlans_found;
static int arlan_open(struct net_device *dev);
static int arlan_tx(struct sk_buff *skb, struct net_device *dev);
IRQ: Maintain regs pointer globally rather than passing to IRQ handlers Maintain a per-CPU global "struct pt_regs *" variable which can be used instead of passing regs around manually through all ~1800 interrupt handlers in the Linux kernel. The regs pointer is used in few places, but it potentially costs both stack space and code to pass it around. On the FRV arch, removing the regs parameter from all the genirq function results in a 20% speed up of the IRQ exit path (ie: from leaving timer_interrupt() to leaving do_IRQ()). Where appropriate, an arch may override the generic storage facility and do something different with the variable. On FRV, for instance, the address is maintained in GR28 at all times inside the kernel as part of general exception handling. Having looked over the code, it appears that the parameter may be handed down through up to twenty or so layers of functions. Consider a USB character device attached to a USB hub, attached to a USB controller that posts its interrupts through a cascaded auxiliary interrupt controller. A character device driver may want to pass regs to the sysrq handler through the input layer which adds another few layers of parameter passing. I've build this code with allyesconfig for x86_64 and i386. I've runtested the main part of the code on FRV and i386, though I can't test most of the drivers. I've also done partial conversion for powerpc and MIPS - these at least compile with minimal configurations. This will affect all archs. Mostly the changes should be relatively easy. Take do_IRQ(), store the regs pointer at the beginning, saving the old one: struct pt_regs *old_regs = set_irq_regs(regs); And put the old one back at the end: set_irq_regs(old_regs); Don't pass regs through to generic_handle_irq() or __do_IRQ(). In timer_interrupt(), this sort of change will be necessary: - update_process_times(user_mode(regs)); - profile_tick(CPU_PROFILING, regs); + update_process_times(user_mode(get_irq_regs())); + profile_tick(CPU_PROFILING); I'd like to move update_process_times()'s use of get_irq_regs() into itself, except that i386, alone of the archs, uses something other than user_mode(). Some notes on the interrupt handling in the drivers: (*) input_dev() is now gone entirely. The regs pointer is no longer stored in the input_dev struct. (*) finish_unlinks() in drivers/usb/host/ohci-q.c needs checking. It does something different depending on whether it's been supplied with a regs pointer or not. (*) Various IRQ handler function pointers have been moved to type irq_handler_t. Signed-Off-By: David Howells <dhowells@redhat.com> (cherry picked from 1b16e7ac850969f38b375e511e3fa2f474a33867 commit)
2006-10-05 21:55:46 +08:00
static irqreturn_t arlan_interrupt(int irq, void *dev_id);
static int arlan_close(struct net_device *dev);
static struct net_device_stats *
arlan_statistics (struct net_device *dev);
static void arlan_set_multicast (struct net_device *dev);
static int arlan_hw_tx (struct net_device* dev, char *buf, int length );
static int arlan_hw_config (struct net_device * dev);
static void arlan_tx_done_interrupt (struct net_device * dev, int status);
static void arlan_rx_interrupt (struct net_device * dev, u_char rxStatus, u_short, u_short);
static void arlan_process_interrupt (struct net_device * dev);
static void arlan_tx_timeout (struct net_device *dev);
static inline long us2ticks(int us)
{
return us * (1000000 / HZ);
}
#ifdef ARLAN_ENTRY_EXIT_DEBUGGING
#define ARLAN_DEBUG_ENTRY(name) \
{\
struct timeval timev;\
do_gettimeofday(&timev);\
if (arlan_entry_debug || arlan_entry_and_exit_debug)\
printk("--->>>" name " %ld " "\n",((long int) timev.tv_sec * 1000000 + timev.tv_usec));\
}
#define ARLAN_DEBUG_EXIT(name) \
{\
struct timeval timev;\
do_gettimeofday(&timev);\
if (arlan_exit_debug || arlan_entry_and_exit_debug)\
printk("<<<---" name " %ld " "\n",((long int) timev.tv_sec * 1000000 + timev.tv_usec) );\
}
#else
#define ARLAN_DEBUG_ENTRY(name)
#define ARLAN_DEBUG_EXIT(name)
#endif
#define arlan_interrupt_ack(dev)\
clearClearInterrupt(dev);\
setClearInterrupt(dev);
static inline int arlan_drop_tx(struct net_device *dev)
{
struct arlan_private *priv = netdev_priv(dev);
priv->stats.tx_errors++;
if (priv->Conf->tx_delay_ms)
{
priv->tx_done_delayed = jiffies + priv->Conf->tx_delay_ms * HZ / 1000 + 1;
}
else
{
priv->waiting_command_mask &= ~ARLAN_COMMAND_TX;
TXHEAD(dev).offset = 0;
TXTAIL(dev).offset = 0;
priv->txLast = 0;
priv->bad = 0;
if (!priv->under_reset && !priv->under_config)
netif_wake_queue (dev);
}
return 1;
}
int arlan_command(struct net_device *dev, int command_p)
{
struct arlan_private *priv = netdev_priv(dev);
volatile struct arlan_shmem __iomem *arlan = priv->card;
struct arlan_conf_stru *conf = priv->Conf;
int udelayed = 0;
int i = 0;
unsigned long flags;
ARLAN_DEBUG_ENTRY("arlan_command");
if (priv->card_polling_interval)
priv->card_polling_interval = 1;
if (arlan_debug & ARLAN_DEBUG_CHAIN_LOCKS)
printk(KERN_DEBUG "arlan_command, %lx commandByte %x waiting %lx incoming %x \n",
jiffies, READSHMB(arlan->commandByte),
priv->waiting_command_mask, command_p);
priv->waiting_command_mask |= command_p;
if (priv->waiting_command_mask & ARLAN_COMMAND_RESET)
if (time_after(jiffies, priv->lastReset + 5 * HZ))
priv->waiting_command_mask &= ~ARLAN_COMMAND_RESET;
if (priv->waiting_command_mask & ARLAN_COMMAND_INT_ACK)
{
arlan_interrupt_ack(dev);
priv->waiting_command_mask &= ~ARLAN_COMMAND_INT_ACK;
}
if (priv->waiting_command_mask & ARLAN_COMMAND_INT_ENABLE)
{
setInterruptEnable(dev);
priv->waiting_command_mask &= ~ARLAN_COMMAND_INT_ENABLE;
}
/* Card access serializing lock */
spin_lock_irqsave(&priv->lock, flags);
/* Check cards status and waiting */
if (priv->waiting_command_mask & (ARLAN_COMMAND_LONG_WAIT_NOW | ARLAN_COMMAND_WAIT_NOW))
{
while (priv->waiting_command_mask & (ARLAN_COMMAND_LONG_WAIT_NOW | ARLAN_COMMAND_WAIT_NOW))
{
if (READSHMB(arlan->resetFlag) ||
READSHMB(arlan->commandByte)) /* ||
(readControlRegister(dev) & ARLAN_ACCESS))
*/
udelay(40);
else
priv->waiting_command_mask &= ~(ARLAN_COMMAND_LONG_WAIT_NOW | ARLAN_COMMAND_WAIT_NOW);
udelayed++;
if (priv->waiting_command_mask & ARLAN_COMMAND_LONG_WAIT_NOW)
{
if (udelayed * 40 > 1000000)
{
printk(KERN_ERR "%s long wait too long \n", dev->name);
priv->waiting_command_mask |= ARLAN_COMMAND_RESET;
break;
}
}
else if (priv->waiting_command_mask & ARLAN_COMMAND_WAIT_NOW)
{
if (udelayed * 40 > 1000)
{
printk(KERN_ERR "%s short wait too long \n", dev->name);
goto bad_end;
}
}
}
}
else
{
i = 0;
while ((READSHMB(arlan->resetFlag) ||
READSHMB(arlan->commandByte)) &&
conf->pre_Command_Wait > (i++) * 10)
udelay(10);
if ((READSHMB(arlan->resetFlag) ||
READSHMB(arlan->commandByte)) &&
!(priv->waiting_command_mask & ARLAN_COMMAND_RESET))
{
goto card_busy_end;
}
}
if (priv->waiting_command_mask & ARLAN_COMMAND_RESET)
priv->under_reset = 1;
if (priv->waiting_command_mask & ARLAN_COMMAND_CONF)
priv->under_config = 1;
/* Issuing command */
arlan_lock_card_access(dev);
if (priv->waiting_command_mask & ARLAN_COMMAND_POWERUP)
{
// if (readControlRegister(dev) & (ARLAN_ACCESS && ARLAN_POWER))
setPowerOn(dev);
arlan_interrupt_lancpu(dev);
priv->waiting_command_mask &= ~ARLAN_COMMAND_POWERUP;
priv->waiting_command_mask |= ARLAN_COMMAND_RESET;
priv->card_polling_interval = HZ / 10;
}
else if (priv->waiting_command_mask & ARLAN_COMMAND_ACTIVATE)
{
WRITESHMB(arlan->commandByte, ARLAN_COM_ACTIVATE);
arlan_interrupt_lancpu(dev);
priv->waiting_command_mask &= ~ARLAN_COMMAND_ACTIVATE;
priv->card_polling_interval = HZ / 10;
}
else if (priv->waiting_command_mask & ARLAN_COMMAND_RX_ABORT)
{
if (priv->rx_command_given)
{
WRITESHMB(arlan->commandByte, ARLAN_COM_RX_ABORT);
arlan_interrupt_lancpu(dev);
priv->rx_command_given = 0;
}
priv->waiting_command_mask &= ~ARLAN_COMMAND_RX_ABORT;
priv->card_polling_interval = 1;
}
else if (priv->waiting_command_mask & ARLAN_COMMAND_TX_ABORT)
{
if (priv->tx_command_given)
{
WRITESHMB(arlan->commandByte, ARLAN_COM_TX_ABORT);
arlan_interrupt_lancpu(dev);
priv->tx_command_given = 0;
}
priv->waiting_command_mask &= ~ARLAN_COMMAND_TX_ABORT;
priv->card_polling_interval = 1;
}
else if (priv->waiting_command_mask & ARLAN_COMMAND_RESET)
{
priv->under_reset=1;
netif_stop_queue (dev);
arlan_drop_tx(dev);
if (priv->tx_command_given || priv->rx_command_given)
{
printk(KERN_ERR "%s: Reset under tx or rx command \n", dev->name);
}
netif_stop_queue (dev);
if (arlan_debug & ARLAN_DEBUG_RESET)
printk(KERN_ERR "%s: Doing chip reset\n", dev->name);
priv->lastReset = jiffies;
WRITESHM(arlan->commandByte, 0, u_char);
/* hold card in reset state */
setHardwareReset(dev);
/* set reset flag and then release reset */
WRITESHM(arlan->resetFlag, 0xff, u_char);
clearChannelAttention(dev);
clearHardwareReset(dev);
priv->card_polling_interval = HZ / 4;
priv->waiting_command_mask &= ~ARLAN_COMMAND_RESET;
priv->waiting_command_mask |= ARLAN_COMMAND_INT_RACK;
// priv->waiting_command_mask |= ARLAN_COMMAND_INT_RENABLE;
// priv->waiting_command_mask |= ARLAN_COMMAND_RX;
}
else if (priv->waiting_command_mask & ARLAN_COMMAND_INT_RACK)
{
clearHardwareReset(dev);
clearClearInterrupt(dev);
setClearInterrupt(dev);
setInterruptEnable(dev);
priv->waiting_command_mask &= ~ARLAN_COMMAND_INT_RACK;
priv->waiting_command_mask |= ARLAN_COMMAND_CONF;
priv->under_config = 1;
priv->under_reset = 0;
}
else if (priv->waiting_command_mask & ARLAN_COMMAND_INT_RENABLE)
{
setInterruptEnable(dev);
priv->waiting_command_mask &= ~ARLAN_COMMAND_INT_RENABLE;
}
else if (priv->waiting_command_mask & ARLAN_COMMAND_CONF)
{
if (priv->tx_command_given || priv->rx_command_given)
{
printk(KERN_ERR "%s: Reset under tx or rx command \n", dev->name);
}
arlan_drop_tx(dev);
setInterruptEnable(dev);
arlan_hw_config(dev);
arlan_interrupt_lancpu(dev);
priv->waiting_command_mask &= ~ARLAN_COMMAND_CONF;
priv->card_polling_interval = HZ / 10;
// priv->waiting_command_mask |= ARLAN_COMMAND_INT_RACK;
// priv->waiting_command_mask |= ARLAN_COMMAND_INT_ENABLE;
priv->waiting_command_mask |= ARLAN_COMMAND_CONF_WAIT;
}
else if (priv->waiting_command_mask & ARLAN_COMMAND_CONF_WAIT)
{
if (READSHMB(arlan->configuredStatusFlag) != 0 &&
READSHMB(arlan->diagnosticInfo) == 0xff)
{
priv->waiting_command_mask &= ~ARLAN_COMMAND_CONF_WAIT;
priv->waiting_command_mask |= ARLAN_COMMAND_RX;
priv->waiting_command_mask |= ARLAN_COMMAND_TBUSY_CLEAR;
priv->card_polling_interval = HZ / 10;
priv->tx_command_given = 0;
priv->under_config = 0;
}
else
{
priv->card_polling_interval = 1;
if (arlan_debug & ARLAN_DEBUG_TIMING)
printk(KERN_ERR "configure delayed \n");
}
}
else if (priv->waiting_command_mask & ARLAN_COMMAND_RX)
{
if (!registrationBad(dev))
{
setInterruptEnable(dev);
memset_io(arlan->commandParameter, 0, 0xf);
WRITESHMB(arlan->commandByte, ARLAN_COM_INT | ARLAN_COM_RX_ENABLE);
WRITESHMB(arlan->commandParameter[0], conf->rxParameter);
arlan_interrupt_lancpu(dev);
priv->rx_command_given = 0; // mnjah, bad
priv->waiting_command_mask &= ~ARLAN_COMMAND_RX;
priv->card_polling_interval = 1;
}
else
priv->card_polling_interval = 2;
}
else if (priv->waiting_command_mask & ARLAN_COMMAND_TBUSY_CLEAR)
{
if ( !registrationBad(dev) &&
(netif_queue_stopped(dev) || !netif_running(dev)) )
{
priv->waiting_command_mask &= ~ARLAN_COMMAND_TBUSY_CLEAR;
netif_wake_queue (dev);
}
}
else if (priv->waiting_command_mask & ARLAN_COMMAND_TX)
{
if (!test_and_set_bit(0, (void *) &priv->tx_command_given))
{
if (time_after(jiffies,
priv->tx_last_sent + us2ticks(conf->rx_tweak1))
|| time_before(jiffies,
priv->last_rx_int_ack_time + us2ticks(conf->rx_tweak2)))
{
setInterruptEnable(dev);
memset_io(arlan->commandParameter, 0, 0xf);
WRITESHMB(arlan->commandByte, ARLAN_COM_TX_ENABLE | ARLAN_COM_INT);
memcpy_toio(arlan->commandParameter, &TXLAST(dev), 14);
// for ( i=1 ; i < 15 ; i++) printk("%02x:",READSHMB(arlan->commandParameter[i]));
priv->tx_last_sent = jiffies;
arlan_interrupt_lancpu(dev);
priv->tx_command_given = 1;
priv->waiting_command_mask &= ~ARLAN_COMMAND_TX;
priv->card_polling_interval = 1;
}
else
{
priv->tx_command_given = 0;
priv->card_polling_interval = 1;
}
}
else if (arlan_debug & ARLAN_DEBUG_CHAIN_LOCKS)
printk(KERN_ERR "tx command when tx chain locked \n");
}
else if (priv->waiting_command_mask & ARLAN_COMMAND_NOOPINT)
{
{
WRITESHMB(arlan->commandByte, ARLAN_COM_NOP | ARLAN_COM_INT);
}
arlan_interrupt_lancpu(dev);
priv->waiting_command_mask &= ~ARLAN_COMMAND_NOOPINT;
priv->card_polling_interval = HZ / 3;
}
else if (priv->waiting_command_mask & ARLAN_COMMAND_NOOP)
{
WRITESHMB(arlan->commandByte, ARLAN_COM_NOP);
arlan_interrupt_lancpu(dev);
priv->waiting_command_mask &= ~ARLAN_COMMAND_NOOP;
priv->card_polling_interval = HZ / 3;
}
else if (priv->waiting_command_mask & ARLAN_COMMAND_SLOW_POLL)
{
WRITESHMB(arlan->commandByte, ARLAN_COM_GOTO_SLOW_POLL);
arlan_interrupt_lancpu(dev);
priv->waiting_command_mask &= ~ARLAN_COMMAND_SLOW_POLL;
priv->card_polling_interval = HZ / 3;
}
else if (priv->waiting_command_mask & ARLAN_COMMAND_POWERDOWN)
{
setPowerOff(dev);
if (arlan_debug & ARLAN_DEBUG_CARD_STATE)
printk(KERN_WARNING "%s: Arlan Going Standby\n", dev->name);
priv->waiting_command_mask &= ~ARLAN_COMMAND_POWERDOWN;
priv->card_polling_interval = 3 * HZ;
}
arlan_unlock_card_access(dev);
for (i = 0; READSHMB(arlan->commandByte) && i < 20; i++)
udelay(10);
if (READSHMB(arlan->commandByte))
if (arlan_debug & ARLAN_DEBUG_CARD_STATE)
printk(KERN_ERR "card busy leaving command %lx\n", priv->waiting_command_mask);
spin_unlock_irqrestore(&priv->lock, flags);
ARLAN_DEBUG_EXIT("arlan_command");
priv->last_command_buff_free_time = jiffies;
return 0;
card_busy_end:
if (time_after(jiffies, priv->last_command_buff_free_time + HZ))
priv->waiting_command_mask |= ARLAN_COMMAND_CLEAN_AND_RESET;
if (arlan_debug & ARLAN_DEBUG_CARD_STATE)
printk(KERN_ERR "%s arlan_command card busy end \n", dev->name);
spin_unlock_irqrestore(&priv->lock, flags);
ARLAN_DEBUG_EXIT("arlan_command");
return 1;
bad_end:
printk(KERN_ERR "%s arlan_command bad end \n", dev->name);
spin_unlock_irqrestore(&priv->lock, flags);
ARLAN_DEBUG_EXIT("arlan_command");
return -1;
}
static inline void arlan_command_process(struct net_device *dev)
{
struct arlan_private *priv = netdev_priv(dev);
int times = 0;
while (priv->waiting_command_mask && times < 8)
{
if (priv->waiting_command_mask)
{
if (arlan_command(dev, 0))
break;
times++;
}
/* if long command, we won't repeat trying */ ;
if (priv->card_polling_interval > 1)
break;
times++;
}
}
static inline void arlan_retransmit_now(struct net_device *dev)
{
struct arlan_private *priv = netdev_priv(dev);
ARLAN_DEBUG_ENTRY("arlan_retransmit_now");
if (TXLAST(dev).offset == 0)
{
if (TXHEAD(dev).offset)
{
priv->txLast = 0;
IFDEBUG(ARLAN_DEBUG_TX_CHAIN) printk(KERN_DEBUG "TX buff switch to head \n");
}
else if (TXTAIL(dev).offset)
{
IFDEBUG(ARLAN_DEBUG_TX_CHAIN) printk(KERN_DEBUG "TX buff switch to tail \n");
priv->txLast = 1;
}
else
IFDEBUG(ARLAN_DEBUG_TX_CHAIN) printk(KERN_ERR "ReTransmit buff empty");
netif_wake_queue (dev);
return;
}
arlan_command(dev, ARLAN_COMMAND_TX);
priv->Conf->driverRetransmissions++;
priv->retransmissions++;
IFDEBUG(ARLAN_DEBUG_TX_CHAIN) printk("Retransmit %d bytes \n", TXLAST(dev).length);
ARLAN_DEBUG_EXIT("arlan_retransmit_now");
}
static void arlan_registration_timer(unsigned long data)
{
struct net_device *dev = (struct net_device *) data;
struct arlan_private *priv = netdev_priv(dev);
int bh_mark_needed = 0;
int next_tick = 1;
long lostTime = ((long)jiffies - (long)priv->registrationLastSeen)
* (1000/HZ);
if (registrationBad(dev))
{
priv->registrationLostCount++;
if (lostTime > 7000 && lostTime < 7200)
{
printk(KERN_NOTICE "%s registration Lost \n", dev->name);
}
if (lostTime / priv->reRegisterExp > 2000)
arlan_command(dev, ARLAN_COMMAND_CLEAN_AND_CONF);
if (lostTime / (priv->reRegisterExp) > 3500)
arlan_command(dev, ARLAN_COMMAND_CLEAN_AND_RESET);
if (priv->reRegisterExp < 400)
priv->reRegisterExp += 2;
if (lostTime > 7200)
{
next_tick = HZ;
arlan_command(dev, ARLAN_COMMAND_CLEAN_AND_RESET);
}
}
else
{
if (priv->Conf->registrationMode && lostTime > 10000 &&
priv->registrationLostCount)
{
printk(KERN_NOTICE "%s registration is back after %ld milliseconds\n",
dev->name, lostTime);
}
priv->registrationLastSeen = jiffies;
priv->registrationLostCount = 0;
priv->reRegisterExp = 1;
if (!netif_running(dev) )
netif_wake_queue(dev);
if (time_after(priv->tx_last_sent,priv->tx_last_cleared) &&
time_after(jiffies, priv->tx_last_sent * 5*HZ) ){
arlan_command(dev, ARLAN_COMMAND_CLEAN_AND_RESET);
priv->tx_last_cleared = jiffies;
}
}
if (!registrationBad(dev) && priv->ReTransmitRequested)
{
IFDEBUG(ARLAN_DEBUG_TX_CHAIN)
printk(KERN_ERR "Retransmit from timer \n");
priv->ReTransmitRequested = 0;
arlan_retransmit_now(dev);
}
if (!registrationBad(dev) &&
time_after(jiffies, priv->tx_done_delayed) &&
priv->tx_done_delayed != 0)
{
TXLAST(dev).offset = 0;
if (priv->txLast)
priv->txLast = 0;
else if (TXTAIL(dev).offset)
priv->txLast = 1;
if (TXLAST(dev).offset)
{
arlan_retransmit_now(dev);
dev->trans_start = jiffies;
}
if (!(TXHEAD(dev).offset && TXTAIL(dev).offset))
{
netif_wake_queue (dev);
}
priv->tx_done_delayed = 0;
bh_mark_needed = 1;
}
if (bh_mark_needed)
{
netif_wake_queue (dev);
}
arlan_process_interrupt(dev);
if (next_tick < priv->card_polling_interval)
next_tick = priv->card_polling_interval;
priv->timer.expires = jiffies + next_tick;
add_timer(&priv->timer);
}
#ifdef ARLAN_DEBUGGING
static void arlan_print_registers(struct net_device *dev, int line)
{
struct arlan_private *priv = netdev_priv(dev);
volatile struct arlan_shmem *arlan = priv->card;
u_char hostcpuLock, lancpuLock, controlRegister, cntrlRegImage,
txStatus, rxStatus, interruptInProgress, commandByte;
ARLAN_DEBUG_ENTRY("arlan_print_registers");
READSHM(interruptInProgress, arlan->interruptInProgress, u_char);
READSHM(hostcpuLock, arlan->hostcpuLock, u_char);
READSHM(lancpuLock, arlan->lancpuLock, u_char);
READSHM(controlRegister, arlan->controlRegister, u_char);
READSHM(cntrlRegImage, arlan->cntrlRegImage, u_char);
READSHM(txStatus, arlan->txStatus, u_char);
READSHM(rxStatus, arlan->rxStatus, u_char);
READSHM(commandByte, arlan->commandByte, u_char);
printk(KERN_WARNING "line %04d IP %02x HL %02x LL %02x CB %02x CR %02x CRI %02x TX %02x RX %02x\n",
line, interruptInProgress, hostcpuLock, lancpuLock, commandByte,
controlRegister, cntrlRegImage, txStatus, rxStatus);
ARLAN_DEBUG_EXIT("arlan_print_registers");
}
#endif
static int arlan_hw_tx(struct net_device *dev, char *buf, int length)
{
int i;
struct arlan_private *priv = netdev_priv(dev);
volatile struct arlan_shmem __iomem *arlan = priv->card;
struct arlan_conf_stru *conf = priv->Conf;
int tailStarts = 0x800;
int headEnds = 0x0;
ARLAN_DEBUG_ENTRY("arlan_hw_tx");
if (TXHEAD(dev).offset)
headEnds = (((TXHEAD(dev).offset + TXHEAD(dev).length - offsetof(struct arlan_shmem, txBuffer)) / 64) + 1) * 64;
if (TXTAIL(dev).offset)
tailStarts = 0x800 - (((TXTAIL(dev).offset - offsetof(struct arlan_shmem, txBuffer)) / 64) + 2) * 64;
if (!TXHEAD(dev).offset && length < tailStarts)
{
IFDEBUG(ARLAN_DEBUG_TX_CHAIN)
printk(KERN_ERR "TXHEAD insert, tailStart %d\n", tailStarts);
TXHEAD(dev).offset =
offsetof(struct arlan_shmem, txBuffer);
TXHEAD(dev).length = length - ARLAN_FAKE_HDR_LEN;
for (i = 0; i < 6; i++)
TXHEAD(dev).dest[i] = buf[i];
TXHEAD(dev).clear = conf->txClear;
TXHEAD(dev).retries = conf->txRetries; /* 0 is use default */
TXHEAD(dev).routing = conf->txRouting;
TXHEAD(dev).scrambled = conf->txScrambled;
memcpy_toio((char __iomem *)arlan + TXHEAD(dev).offset, buf + ARLAN_FAKE_HDR_LEN, TXHEAD(dev).length);
}
else if (!TXTAIL(dev).offset && length < (0x800 - headEnds))
{
IFDEBUG(ARLAN_DEBUG_TX_CHAIN)
printk(KERN_ERR "TXTAIL insert, headEnd %d\n", headEnds);
TXTAIL(dev).offset =
offsetof(struct arlan_shmem, txBuffer) + 0x800 - (length / 64 + 2) * 64;
TXTAIL(dev).length = length - ARLAN_FAKE_HDR_LEN;
for (i = 0; i < 6; i++)
TXTAIL(dev).dest[i] = buf[i];
TXTAIL(dev).clear = conf->txClear;
TXTAIL(dev).retries = conf->txRetries;
TXTAIL(dev).routing = conf->txRouting;
TXTAIL(dev).scrambled = conf->txScrambled;
memcpy_toio(((char __iomem *)arlan + TXTAIL(dev).offset), buf + ARLAN_FAKE_HDR_LEN, TXTAIL(dev).length);
}
else
{
netif_stop_queue (dev);
IFDEBUG(ARLAN_DEBUG_TX_CHAIN)
printk(KERN_ERR "TX TAIL & HEAD full, return, tailStart %d headEnd %d\n", tailStarts, headEnds);
return -1;
}
priv->out_bytes += length;
priv->out_bytes10 += length;
if (conf->measure_rate < 1)
conf->measure_rate = 1;
if (time_after(jiffies, priv->out_time + conf->measure_rate * HZ))
{
conf->out_speed = priv->out_bytes / conf->measure_rate;
priv->out_bytes = 0;
priv->out_time = jiffies;
}
if (time_after(jiffies, priv->out_time10 + conf->measure_rate * 10*HZ))
{
conf->out_speed10 = priv->out_bytes10 / (10 * conf->measure_rate);
priv->out_bytes10 = 0;
priv->out_time10 = jiffies;
}
if (TXHEAD(dev).offset && TXTAIL(dev).offset)
{
netif_stop_queue (dev);
return 0;
}
else
netif_start_queue (dev);
IFDEBUG(ARLAN_DEBUG_HEADER_DUMP)
printk(KERN_WARNING "%s Transmit t %2x:%2x:%2x:%2x:%2x:%2x f %2x:%2x:%2x:%2x:%2x:%2x \n", dev->name,
(unsigned char) buf[0], (unsigned char) buf[1], (unsigned char) buf[2], (unsigned char) buf[3],
(unsigned char) buf[4], (unsigned char) buf[5], (unsigned char) buf[6], (unsigned char) buf[7],
(unsigned char) buf[8], (unsigned char) buf[9], (unsigned char) buf[10], (unsigned char) buf[11]);
IFDEBUG(ARLAN_DEBUG_TX_CHAIN) printk(KERN_ERR "TX command prepare for buffer %d\n", priv->txLast);
arlan_command(dev, ARLAN_COMMAND_TX);
priv->tx_last_sent = jiffies;
IFDEBUG(ARLAN_DEBUG_TX_CHAIN) printk("%s TX Qued %d bytes \n", dev->name, length);
ARLAN_DEBUG_EXIT("arlan_hw_tx");
return 0;
}
static int arlan_hw_config(struct net_device *dev)
{
struct arlan_private *priv = netdev_priv(dev);
volatile struct arlan_shmem __iomem *arlan = priv->card;
struct arlan_conf_stru *conf = priv->Conf;
ARLAN_DEBUG_ENTRY("arlan_hw_config");
printk(KERN_NOTICE "%s arlan configure called \n", dev->name);
if (arlan_EEPROM_bad)
printk(KERN_NOTICE "arlan configure with eeprom bad option \n");
WRITESHM(arlan->spreadingCode, conf->spreadingCode, u_char);
WRITESHM(arlan->channelSet, conf->channelSet, u_char);
if (arlan_EEPROM_bad)
WRITESHM(arlan->defaultChannelSet, conf->channelSet, u_char);
WRITESHM(arlan->channelNumber, conf->channelNumber, u_char);
WRITESHM(arlan->scramblingDisable, conf->scramblingDisable, u_char);
WRITESHM(arlan->txAttenuation, conf->txAttenuation, u_char);
WRITESHM(arlan->systemId, conf->systemId, u_int);
WRITESHM(arlan->maxRetries, conf->maxRetries, u_char);
WRITESHM(arlan->receiveMode, conf->receiveMode, u_char);
WRITESHM(arlan->priority, conf->priority, u_char);
WRITESHM(arlan->rootOrRepeater, conf->rootOrRepeater, u_char);
WRITESHM(arlan->SID, conf->SID, u_int);
WRITESHM(arlan->registrationMode, conf->registrationMode, u_char);
WRITESHM(arlan->registrationFill, conf->registrationFill, u_char);
WRITESHM(arlan->localTalkAddress, conf->localTalkAddress, u_char);
WRITESHM(arlan->codeFormat, conf->codeFormat, u_char);
WRITESHM(arlan->numChannels, conf->numChannels, u_char);
WRITESHM(arlan->channel1, conf->channel1, u_char);
WRITESHM(arlan->channel2, conf->channel2, u_char);
WRITESHM(arlan->channel3, conf->channel3, u_char);
WRITESHM(arlan->channel4, conf->channel4, u_char);
WRITESHM(arlan->radioNodeId, conf->radioNodeId, u_short);
WRITESHM(arlan->SID, conf->SID, u_int);
WRITESHM(arlan->waitTime, conf->waitTime, u_short);
WRITESHM(arlan->lParameter, conf->lParameter, u_short);
memcpy_toio(&(arlan->_15), &(conf->_15), 3);
WRITESHM(arlan->_15, conf->_15, u_short);
WRITESHM(arlan->headerSize, conf->headerSize, u_short);
if (arlan_EEPROM_bad)
WRITESHM(arlan->hardwareType, conf->hardwareType, u_char);
WRITESHM(arlan->radioType, conf->radioType, u_char);
if (arlan_EEPROM_bad)
WRITESHM(arlan->radioModule, conf->radioType, u_char);
memcpy_toio(arlan->encryptionKey + keyStart, encryptionKey, 8);
memcpy_toio(arlan->name, conf->siteName, 16);
WRITESHMB(arlan->commandByte, ARLAN_COM_INT | ARLAN_COM_CONF); /* do configure */
memset_io(arlan->commandParameter, 0, 0xf); /* 0xf */
memset_io(arlan->commandParameter + 1, 0, 2);
if (conf->writeEEPROM)
{
memset_io(arlan->commandParameter, conf->writeEEPROM, 1);
// conf->writeEEPROM=0;
}
if (conf->registrationMode && conf->registrationInterrupts)
memset_io(arlan->commandParameter + 3, 1, 1);
else
memset_io(arlan->commandParameter + 3, 0, 1);
priv->irq_test_done = 0;
if (conf->tx_queue_len)
dev->tx_queue_len = conf->tx_queue_len;
udelay(100);
ARLAN_DEBUG_EXIT("arlan_hw_config");
return 0;
}
static int arlan_read_card_configuration(struct net_device *dev)
{
u_char tlx415;
struct arlan_private *priv = netdev_priv(dev);
volatile struct arlan_shmem __iomem *arlan = priv->card;
struct arlan_conf_stru *conf = priv->Conf;
ARLAN_DEBUG_ENTRY("arlan_read_card_configuration");
if (radioNodeId == radioNodeIdUNKNOWN)
{
READSHM(conf->radioNodeId, arlan->radioNodeId, u_short);
}
else
conf->radioNodeId = radioNodeId;
if (SID == SIDUNKNOWN)
{
READSHM(conf->SID, arlan->SID, u_int);
}
else conf->SID = SID;
if (spreadingCode == spreadingCodeUNKNOWN)
{
READSHM(conf->spreadingCode, arlan->spreadingCode, u_char);
}
else
conf->spreadingCode = spreadingCode;
if (channelSet == channelSetUNKNOWN)
{
READSHM(conf->channelSet, arlan->channelSet, u_char);
}
else conf->channelSet = channelSet;
if (channelNumber == channelNumberUNKNOWN)
{
READSHM(conf->channelNumber, arlan->channelNumber, u_char);
}
else conf->channelNumber = channelNumber;
READSHM(conf->scramblingDisable, arlan->scramblingDisable, u_char);
READSHM(conf->txAttenuation, arlan->txAttenuation, u_char);
if (systemId == systemIdUNKNOWN)
{
READSHM(conf->systemId, arlan->systemId, u_int);
}
else conf->systemId = systemId;
READSHM(conf->maxDatagramSize, arlan->maxDatagramSize, u_short);
READSHM(conf->maxFrameSize, arlan->maxFrameSize, u_short);
READSHM(conf->maxRetries, arlan->maxRetries, u_char);
READSHM(conf->receiveMode, arlan->receiveMode, u_char);
READSHM(conf->priority, arlan->priority, u_char);
READSHM(conf->rootOrRepeater, arlan->rootOrRepeater, u_char);
if (SID == SIDUNKNOWN)
{
READSHM(conf->SID, arlan->SID, u_int);
}
else conf->SID = SID;
if (registrationMode == registrationModeUNKNOWN)
{
READSHM(conf->registrationMode, arlan->registrationMode, u_char);
}
else conf->registrationMode = registrationMode;
READSHM(conf->registrationFill, arlan->registrationFill, u_char);
READSHM(conf->localTalkAddress, arlan->localTalkAddress, u_char);
READSHM(conf->codeFormat, arlan->codeFormat, u_char);
READSHM(conf->numChannels, arlan->numChannels, u_char);
READSHM(conf->channel1, arlan->channel1, u_char);
READSHM(conf->channel2, arlan->channel2, u_char);
READSHM(conf->channel3, arlan->channel3, u_char);
READSHM(conf->channel4, arlan->channel4, u_char);
READSHM(conf->waitTime, arlan->waitTime, u_short);
READSHM(conf->lParameter, arlan->lParameter, u_short);
READSHM(conf->_15, arlan->_15, u_short);
READSHM(conf->headerSize, arlan->headerSize, u_short);
READSHM(conf->hardwareType, arlan->hardwareType, u_char);
READSHM(conf->radioType, arlan->radioModule, u_char);
if (conf->radioType == 0)
conf->radioType = 0xc;
WRITESHM(arlan->configStatus, 0xA5, u_char);
READSHM(tlx415, arlan->configStatus, u_char);
if (tlx415 != 0xA5)
printk(KERN_INFO "%s tlx415 chip \n", dev->name);
conf->txClear = 0;
conf->txRetries = 1;
conf->txRouting = 1;
conf->txScrambled = 0;
conf->rxParameter = 1;
conf->txTimeoutMs = 4000;
conf->waitCardTimeout = 100000;
conf->receiveMode = ARLAN_RCV_CLEAN;
memcpy_fromio(conf->siteName, arlan->name, 16);
conf->siteName[16] = '\0';
conf->retries = retries;
conf->tx_delay_ms = tx_delay_ms;
conf->ReTransmitPacketMaxSize = 200;
conf->waitReTransmitPacketMaxSize = 200;
conf->txAckTimeoutMs = 900;
conf->fastReTransCount = 3;
ARLAN_DEBUG_EXIT("arlan_read_card_configuration");
return 0;
}
static int lastFoundAt = 0xbe000;
/*
* This is the real probe routine. Linux has a history of friendly device
* probes on the ISA bus. A good device probes avoids doing writes, and
* verifies that the correct device exists and functions.
*/
#define ARLAN_SHMEM_SIZE 0x2000
static int __init arlan_check_fingerprint(unsigned long memaddr)
{
static const char probeText[] = "TELESYSTEM SLW INC. ARLAN \0";
volatile struct arlan_shmem __iomem *arlan = (struct arlan_shmem *) memaddr;
unsigned long paddr = virt_to_phys((void *) memaddr);
char tempBuf[49];
ARLAN_DEBUG_ENTRY("arlan_check_fingerprint");
if (!request_mem_region(paddr, ARLAN_SHMEM_SIZE, "arlan")) {
// printk(KERN_WARNING "arlan: memory region %lx excluded from probing \n",paddr);
return -ENODEV;
}
memcpy_fromio(tempBuf, arlan->textRegion, 29);
tempBuf[30] = 0;
/* check for card at this address */
if (0 != strncmp(tempBuf, probeText, 29)){
release_mem_region(paddr, ARLAN_SHMEM_SIZE);
return -ENODEV;
}
// printk(KERN_INFO "arlan found at 0x%x \n",memaddr);
ARLAN_DEBUG_EXIT("arlan_check_fingerprint");
return 0;
}
static int arlan_change_mtu(struct net_device *dev, int new_mtu)
{
struct arlan_private *priv = netdev_priv(dev);
struct arlan_conf_stru *conf = priv->Conf;
ARLAN_DEBUG_ENTRY("arlan_change_mtu");
if (new_mtu > 2032)
return -EINVAL;
dev->mtu = new_mtu;
if (new_mtu < 256)
new_mtu = 256; /* cards book suggests 1600 */
conf->maxDatagramSize = new_mtu;
conf->maxFrameSize = new_mtu + 48;
arlan_command(dev, ARLAN_COMMAND_CLEAN_AND_CONF);
printk(KERN_NOTICE "%s mtu changed to %d \n", dev->name, new_mtu);
ARLAN_DEBUG_EXIT("arlan_change_mtu");
return 0;
}
static int arlan_mac_addr(struct net_device *dev, void *p)
{
struct sockaddr *addr = p;
ARLAN_DEBUG_ENTRY("arlan_mac_addr");
return -EINVAL;
if (!netif_running(dev))
return -EBUSY;
memcpy(dev->dev_addr, addr->sa_data, dev->addr_len);
ARLAN_DEBUG_EXIT("arlan_mac_addr");
return 0;
}
static int __init arlan_setup_device(struct net_device *dev, int num)
{
struct arlan_private *ap = netdev_priv(dev);
int err;
ARLAN_DEBUG_ENTRY("arlan_setup_device");
ap->conf = (struct arlan_shmem *)(ap+1);
dev->tx_queue_len = tx_queue_len;
dev->open = arlan_open;
dev->stop = arlan_close;
dev->hard_start_xmit = arlan_tx;
dev->get_stats = arlan_statistics;
dev->set_multicast_list = arlan_set_multicast;
dev->change_mtu = arlan_change_mtu;
dev->set_mac_address = arlan_mac_addr;
dev->tx_timeout = arlan_tx_timeout;
dev->watchdog_timeo = 3*HZ;
ap->irq_test_done = 0;
ap->Conf = &arlan_conf[num];
ap->Conf->pre_Command_Wait = 40;
ap->Conf->rx_tweak1 = 30;
ap->Conf->rx_tweak2 = 0;
err = register_netdev(dev);
if (err) {
release_mem_region(virt_to_phys((void *) dev->mem_start),
ARLAN_SHMEM_SIZE);
free_netdev(dev);
return err;
}
arlan_device[num] = dev;
ARLAN_DEBUG_EXIT("arlan_setup_device");
return 0;
}
static int __init arlan_probe_here(struct net_device *dev,
unsigned long memaddr)
{
struct arlan_private *ap = netdev_priv(dev);
ARLAN_DEBUG_ENTRY("arlan_probe_here");
if (arlan_check_fingerprint(memaddr))
return -ENODEV;
printk(KERN_NOTICE "%s: Arlan found at %x, \n ", dev->name,
(int) virt_to_phys((void*)memaddr));
ap->card = (void *) memaddr;
dev->mem_start = memaddr;
dev->mem_end = memaddr + ARLAN_SHMEM_SIZE-1;
if (dev->irq < 2)
{
READSHM(dev->irq, ap->card->irqLevel, u_char);
} else if (dev->irq == 2)
dev->irq = 9;
arlan_read_card_configuration(dev);
ARLAN_DEBUG_EXIT("arlan_probe_here");
return 0;
}
static int arlan_open(struct net_device *dev)
{
struct arlan_private *priv = netdev_priv(dev);
volatile struct arlan_shmem __iomem *arlan = priv->card;
int ret = 0;
ARLAN_DEBUG_ENTRY("arlan_open");
ret = request_irq(dev->irq, &arlan_interrupt, 0, dev->name, dev);
if (ret)
{
printk(KERN_ERR "%s: unable to get IRQ %d .\n",
dev->name, dev->irq);
return ret;
}
priv->bad = 0;
priv->lastReset = 0;
priv->reset = 0;
memcpy_fromio(dev->dev_addr, arlan->lanCardNodeId, 6);
memset(dev->broadcast, 0xff, 6);
dev->tx_queue_len = tx_queue_len;
priv->interrupt_processing_active = 0;
spin_lock_init(&priv->lock);
netif_start_queue (dev);
priv->registrationLostCount = 0;
priv->registrationLastSeen = jiffies;
priv->txLast = 0;
priv->tx_command_given = 0;
priv->rx_command_given = 0;
priv->reRegisterExp = 1;
priv->tx_last_sent = jiffies - 1;
priv->tx_last_cleared = jiffies;
priv->Conf->writeEEPROM = 0;
priv->Conf->registrationInterrupts = 1;
init_timer(&priv->timer);
priv->timer.expires = jiffies + HZ / 10;
priv->timer.data = (unsigned long) dev;
priv->timer.function = &arlan_registration_timer; /* timer handler */
arlan_command(dev, ARLAN_COMMAND_POWERUP | ARLAN_COMMAND_LONG_WAIT_NOW);
mdelay(200);
add_timer(&priv->timer);
ARLAN_DEBUG_EXIT("arlan_open");
return 0;
}
static void arlan_tx_timeout (struct net_device *dev)
{
printk(KERN_ERR "%s: arlan transmit timed out, kernel decided\n", dev->name);
/* Try to restart the adaptor. */
arlan_command(dev, ARLAN_COMMAND_CLEAN_AND_RESET);
// dev->trans_start = jiffies;
// netif_start_queue (dev);
}
static int arlan_tx(struct sk_buff *skb, struct net_device *dev)
{
short length;
unsigned char *buf;
ARLAN_DEBUG_ENTRY("arlan_tx");
length = ETH_ZLEN < skb->len ? skb->len : ETH_ZLEN;
buf = skb->data;
if (length + 0x12 > 0x800) {
printk(KERN_ERR "TX RING overflow \n");
netif_stop_queue (dev);
}
if (arlan_hw_tx(dev, buf, length) == -1)
goto bad_end;
dev->trans_start = jiffies;
dev_kfree_skb(skb);
arlan_process_interrupt(dev);
ARLAN_DEBUG_EXIT("arlan_tx");
return 0;
bad_end:
arlan_process_interrupt(dev);
netif_stop_queue (dev);
ARLAN_DEBUG_EXIT("arlan_tx");
return 1;
}
static inline int DoNotReTransmitCrap(struct net_device *dev)
{
struct arlan_private *priv = netdev_priv(dev);
if (TXLAST(dev).length < priv->Conf->ReTransmitPacketMaxSize)
return 1;
return 0;
}
static inline int DoNotWaitReTransmitCrap(struct net_device *dev)
{
struct arlan_private *priv = netdev_priv(dev);
if (TXLAST(dev).length < priv->Conf->waitReTransmitPacketMaxSize)
return 1;
return 0;
}
static inline void arlan_queue_retransmit(struct net_device *dev)
{
struct arlan_private *priv = netdev_priv(dev);
ARLAN_DEBUG_ENTRY("arlan_queue_retransmit");
if (DoNotWaitReTransmitCrap(dev))
{
arlan_drop_tx(dev);
} else
priv->ReTransmitRequested++;
ARLAN_DEBUG_EXIT("arlan_queue_retransmit");
}
static inline void RetryOrFail(struct net_device *dev)
{
struct arlan_private *priv = netdev_priv(dev);
ARLAN_DEBUG_ENTRY("RetryOrFail");
if (priv->retransmissions > priv->Conf->retries ||
DoNotReTransmitCrap(dev))
{
arlan_drop_tx(dev);
}
else if (priv->bad <= priv->Conf->fastReTransCount)
{
arlan_retransmit_now(dev);
}
else arlan_queue_retransmit(dev);
ARLAN_DEBUG_EXIT("RetryOrFail");
}
static void arlan_tx_done_interrupt(struct net_device *dev, int status)
{
struct arlan_private *priv = netdev_priv(dev);
ARLAN_DEBUG_ENTRY("arlan_tx_done_interrupt");
priv->tx_last_cleared = jiffies;
priv->tx_command_given = 0;
switch (status)
{
case 1:
{
IFDEBUG(ARLAN_DEBUG_TX_CHAIN)
printk("arlan intr: transmit OK\n");
priv->stats.tx_packets++;
priv->bad = 0;
priv->reset = 0;
priv->retransmissions = 0;
if (priv->Conf->tx_delay_ms)
{
priv->tx_done_delayed = jiffies + (priv->Conf->tx_delay_ms * HZ) / 1000 + 1;
}
else
{
TXLAST(dev).offset = 0;
if (priv->txLast)
priv->txLast = 0;
else if (TXTAIL(dev).offset)
priv->txLast = 1;
if (TXLAST(dev).offset)
{
arlan_retransmit_now(dev);
dev->trans_start = jiffies;
}
if (!TXHEAD(dev).offset || !TXTAIL(dev).offset)
{
netif_wake_queue (dev);
}
}
}
break;
case 2:
{
IFDEBUG(ARLAN_DEBUG_TX_CHAIN)
printk("arlan intr: transmit timed out\n");
priv->bad += 1;
//arlan_queue_retransmit(dev);
RetryOrFail(dev);
}
break;
case 3:
{
IFDEBUG(ARLAN_DEBUG_TX_CHAIN)
printk("arlan intr: transmit max retries\n");
priv->bad += 1;
priv->reset = 0;
//arlan_queue_retransmit(dev);
RetryOrFail(dev);
}
break;
case 4:
{
IFDEBUG(ARLAN_DEBUG_TX_CHAIN)
printk("arlan intr: transmit aborted\n");
priv->bad += 1;
arlan_queue_retransmit(dev);
//RetryOrFail(dev);
}
break;
case 5:
{
IFDEBUG(ARLAN_DEBUG_TX_CHAIN)
printk("arlan intr: transmit not registered\n");
priv->bad += 1;
//debug=101;
arlan_queue_retransmit(dev);
}
break;
case 6:
{
IFDEBUG(ARLAN_DEBUG_TX_CHAIN)
printk("arlan intr: transmit destination full\n");
priv->bad += 1;
priv->reset = 0;
//arlan_drop_tx(dev);
arlan_queue_retransmit(dev);
}
break;
case 7:
{
IFDEBUG(ARLAN_DEBUG_TX_CHAIN)
printk("arlan intr: transmit unknown ack\n");
priv->bad += 1;
priv->reset = 0;
arlan_queue_retransmit(dev);
}
break;
case 8:
{
IFDEBUG(ARLAN_DEBUG_TX_CHAIN)
printk("arlan intr: transmit dest mail box full\n");
priv->bad += 1;
priv->reset = 0;
//arlan_drop_tx(dev);
arlan_queue_retransmit(dev);
}
break;
case 9:
{
IFDEBUG(ARLAN_DEBUG_TX_CHAIN)
printk("arlan intr: transmit root dest not reg.\n");
priv->bad += 1;
priv->reset = 1;
//arlan_drop_tx(dev);
arlan_queue_retransmit(dev);
}
break;
default:
{
printk(KERN_ERR "arlan intr: transmit status unknown\n");
priv->bad += 1;
priv->reset = 1;
arlan_drop_tx(dev);
}
}
ARLAN_DEBUG_EXIT("arlan_tx_done_interrupt");
}
static void arlan_rx_interrupt(struct net_device *dev, u_char rxStatus, u_short rxOffset, u_short pkt_len)
{
char *skbtmp;
int i = 0;
struct arlan_private *priv = netdev_priv(dev);
volatile struct arlan_shmem __iomem *arlan = priv->card;
struct arlan_conf_stru *conf = priv->Conf;
ARLAN_DEBUG_ENTRY("arlan_rx_interrupt");
// by spec, not WRITESHMB(arlan->rxStatus,0x00);
// prohibited here arlan_command(dev, ARLAN_COMMAND_RX);
if (pkt_len < 10 || pkt_len > 2048)
{
printk(KERN_WARNING "%s: got too short or long packet, len %d \n", dev->name, pkt_len);
return;
}
if (rxOffset + pkt_len > 0x2000)
{
printk("%s: got too long packet, len %d offset %x\n", dev->name, pkt_len, rxOffset);
return;
}
priv->in_bytes += pkt_len;
priv->in_bytes10 += pkt_len;
if (conf->measure_rate < 1)
conf->measure_rate = 1;
if (time_after(jiffies, priv->in_time + conf->measure_rate * HZ))
{
conf->in_speed = priv->in_bytes / conf->measure_rate;
priv->in_bytes = 0;
priv->in_time = jiffies;
}
if (time_after(jiffies, priv->in_time10 + conf->measure_rate * 10*HZ))
{
conf->in_speed10 = priv->in_bytes10 / (10 * conf->measure_rate);
priv->in_bytes10 = 0;
priv->in_time10 = jiffies;
}
DEBUGSHM(1, "arlan rcv pkt rxStatus= %d ", arlan->rxStatus, u_char);
switch (rxStatus)
{
case 1:
case 2:
case 3:
{
/* Malloc up new buffer. */
struct sk_buff *skb;
DEBUGSHM(50, "arlan recv pkt offs=%d\n", arlan->rxOffset, u_short);
DEBUGSHM(1, "arlan rxFrmType = %d \n", arlan->rxFrmType, u_char);
DEBUGSHM(1, KERN_INFO "arlan rx scrambled = %d \n", arlan->scrambled, u_char);
/* here we do multicast filtering to avoid slow 8-bit memcopy */
#ifdef ARLAN_MULTICAST
if (!(dev->flags & IFF_ALLMULTI) &&
!(dev->flags & IFF_PROMISC) &&
dev->mc_list)
{
char hw_dst_addr[6];
struct dev_mc_list *dmi = dev->mc_list;
int i;
memcpy_fromio(hw_dst_addr, arlan->ultimateDestAddress, 6);
if (hw_dst_addr[0] == 0x01)
{
if (mdebug)
if (hw_dst_addr[1] == 0x00)
printk(KERN_ERR "%s mcast 0x0100 \n", dev->name);
else if (hw_dst_addr[1] == 0x40)
printk(KERN_ERR "%s m/bcast 0x0140 \n", dev->name);
while (dmi)
{ if (dmi->dmi_addrlen == 6)
{
DECLARE_MAC_BUF(mac);
if (arlan_debug & ARLAN_DEBUG_HEADER_DUMP)
printk(KERN_ERR "%s mcl %s\n",
dev->name, print_mac(mac, dmi->dmi_addr));
for (i = 0; i < 6; i++)
if (dmi->dmi_addr[i] != hw_dst_addr[i])
break;
if (i == 6)
break;
}
else
printk(KERN_ERR "%s: invalid multicast address length given.\n", dev->name);
dmi = dmi->next;
}
/* we reach here if multicast filtering is on and packet
* is multicast and not for receive */
goto end_of_interrupt;
}
}
#endif // ARLAN_MULTICAST
/* multicast filtering ends here */
pkt_len += ARLAN_FAKE_HDR_LEN;
skb = dev_alloc_skb(pkt_len + 4);
if (skb == NULL)
{
printk(KERN_ERR "%s: Memory squeeze, dropping packet.\n", dev->name);
priv->stats.rx_dropped++;
break;
}
skb_reserve(skb, 2);
skbtmp = skb_put(skb, pkt_len);
memcpy_fromio(skbtmp + ARLAN_FAKE_HDR_LEN, ((char __iomem *) arlan) + rxOffset, pkt_len - ARLAN_FAKE_HDR_LEN);
memcpy_fromio(skbtmp, arlan->ultimateDestAddress, 6);
memcpy_fromio(skbtmp + 6, arlan->rxSrc, 6);
WRITESHMB(arlan->rxStatus, 0x00);
arlan_command(dev, ARLAN_COMMAND_RX);
IFDEBUG(ARLAN_DEBUG_HEADER_DUMP)
{
char immedDestAddress[6];
char immedSrcAddress[6];
DECLARE_MAC_BUF(mac);
DECLARE_MAC_BUF(mac2);
DECLARE_MAC_BUF(mac3);
DECLARE_MAC_BUF(mac4);
memcpy_fromio(immedDestAddress, arlan->immedDestAddress, 6);
memcpy_fromio(immedSrcAddress, arlan->immedSrcAddress, 6);
printk(KERN_WARNING "%s t %s f %s imd %s ims %s\n",
dev->name, print_mac(mac, skbtmp),
print_mac(mac2, &skbtmp[6]),
print_mac(mac3, immedDestAddress),
print_mac(mac4, immedSrcAddress));
}
skb->protocol = eth_type_trans(skb, dev);
IFDEBUG(ARLAN_DEBUG_HEADER_DUMP)
if (skb->protocol != 0x608 && skb->protocol != 0x8)
{
for (i = 0; i <= 22; i++)
printk("%02x:", (u_char) skbtmp[i + 12]);
printk(KERN_ERR "\n");
printk(KERN_WARNING "arlan kernel pkt type trans %x \n", skb->protocol);
}
netif_rx(skb);
dev->last_rx = jiffies;
priv->stats.rx_packets++;
priv->stats.rx_bytes += pkt_len;
}
break;
default:
printk(KERN_ERR "arlan intr: received unknown status\n");
priv->stats.rx_crc_errors++;
break;
}
ARLAN_DEBUG_EXIT("arlan_rx_interrupt");
}
static void arlan_process_interrupt(struct net_device *dev)
{
struct arlan_private *priv = netdev_priv(dev);
volatile struct arlan_shmem __iomem *arlan = priv->card;
u_char rxStatus = READSHMB(arlan->rxStatus);
u_char txStatus = READSHMB(arlan->txStatus);
u_short rxOffset = READSHMS(arlan->rxOffset);
u_short pkt_len = READSHMS(arlan->rxLength);
int interrupt_count = 0;
ARLAN_DEBUG_ENTRY("arlan_process_interrupt");
if (test_and_set_bit(0, (void *) &priv->interrupt_processing_active))
{
if (arlan_debug & ARLAN_DEBUG_CHAIN_LOCKS)
printk(KERN_ERR "interrupt chain reentering \n");
goto end_int_process;
}
while ((rxStatus || txStatus || priv->interrupt_ack_requested)
&& (interrupt_count < 5))
{
if (rxStatus)
priv->last_rx_int_ack_time = jiffies;
arlan_command(dev, ARLAN_COMMAND_INT_ACK);
arlan_command(dev, ARLAN_COMMAND_INT_ENABLE);
IFDEBUG(ARLAN_DEBUG_INTERRUPT)
printk(KERN_ERR "%s: got IRQ rx %x tx %x comm %x rxOff %x rxLen %x \n",
dev->name, rxStatus, txStatus, READSHMB(arlan->commandByte),
rxOffset, pkt_len);
if (rxStatus == 0 && txStatus == 0)
{
if (priv->irq_test_done)
{
if (!registrationBad(dev))
IFDEBUG(ARLAN_DEBUG_INTERRUPT) printk(KERN_ERR "%s unknown interrupt(nop? regLost ?) reason tx %d rx %d ",
dev->name, txStatus, rxStatus);
} else {
IFDEBUG(ARLAN_DEBUG_INTERRUPT)
printk(KERN_INFO "%s irq $%d test OK \n", dev->name, dev->irq);
}
priv->interrupt_ack_requested = 0;
goto ends;
}
if (txStatus != 0)
{
WRITESHMB(arlan->txStatus, 0x00);
arlan_tx_done_interrupt(dev, txStatus);
goto ends;
}
if (rxStatus == 1 || rxStatus == 2)
{ /* a packet waiting */
arlan_rx_interrupt(dev, rxStatus, rxOffset, pkt_len);
goto ends;
}
if (rxStatus > 2 && rxStatus < 0xff)
{
WRITESHMB(arlan->rxStatus, 0x00);
printk(KERN_ERR "%s unknown rxStatus reason tx %d rx %d ",
dev->name, txStatus, rxStatus);
goto ends;
}
if (rxStatus == 0xff)
{
WRITESHMB(arlan->rxStatus, 0x00);
arlan_command(dev, ARLAN_COMMAND_RX);
if (registrationBad(dev))
netif_device_detach(dev);
if (!registrationBad(dev))
{
priv->registrationLastSeen = jiffies;
if (!netif_queue_stopped(dev) && !priv->under_reset && !priv->under_config)
netif_wake_queue (dev);
}
goto ends;
}
ends:
arlan_command_process(dev);
rxStatus = READSHMB(arlan->rxStatus);
txStatus = READSHMB(arlan->txStatus);
rxOffset = READSHMS(arlan->rxOffset);
pkt_len = READSHMS(arlan->rxLength);
priv->irq_test_done = 1;
interrupt_count++;
}
priv->interrupt_processing_active = 0;
end_int_process:
arlan_command_process(dev);
ARLAN_DEBUG_EXIT("arlan_process_interrupt");
return;
}
IRQ: Maintain regs pointer globally rather than passing to IRQ handlers Maintain a per-CPU global "struct pt_regs *" variable which can be used instead of passing regs around manually through all ~1800 interrupt handlers in the Linux kernel. The regs pointer is used in few places, but it potentially costs both stack space and code to pass it around. On the FRV arch, removing the regs parameter from all the genirq function results in a 20% speed up of the IRQ exit path (ie: from leaving timer_interrupt() to leaving do_IRQ()). Where appropriate, an arch may override the generic storage facility and do something different with the variable. On FRV, for instance, the address is maintained in GR28 at all times inside the kernel as part of general exception handling. Having looked over the code, it appears that the parameter may be handed down through up to twenty or so layers of functions. Consider a USB character device attached to a USB hub, attached to a USB controller that posts its interrupts through a cascaded auxiliary interrupt controller. A character device driver may want to pass regs to the sysrq handler through the input layer which adds another few layers of parameter passing. I've build this code with allyesconfig for x86_64 and i386. I've runtested the main part of the code on FRV and i386, though I can't test most of the drivers. I've also done partial conversion for powerpc and MIPS - these at least compile with minimal configurations. This will affect all archs. Mostly the changes should be relatively easy. Take do_IRQ(), store the regs pointer at the beginning, saving the old one: struct pt_regs *old_regs = set_irq_regs(regs); And put the old one back at the end: set_irq_regs(old_regs); Don't pass regs through to generic_handle_irq() or __do_IRQ(). In timer_interrupt(), this sort of change will be necessary: - update_process_times(user_mode(regs)); - profile_tick(CPU_PROFILING, regs); + update_process_times(user_mode(get_irq_regs())); + profile_tick(CPU_PROFILING); I'd like to move update_process_times()'s use of get_irq_regs() into itself, except that i386, alone of the archs, uses something other than user_mode(). Some notes on the interrupt handling in the drivers: (*) input_dev() is now gone entirely. The regs pointer is no longer stored in the input_dev struct. (*) finish_unlinks() in drivers/usb/host/ohci-q.c needs checking. It does something different depending on whether it's been supplied with a regs pointer or not. (*) Various IRQ handler function pointers have been moved to type irq_handler_t. Signed-Off-By: David Howells <dhowells@redhat.com> (cherry picked from 1b16e7ac850969f38b375e511e3fa2f474a33867 commit)
2006-10-05 21:55:46 +08:00
static irqreturn_t arlan_interrupt(int irq, void *dev_id)
{
struct net_device *dev = dev_id;
struct arlan_private *priv = netdev_priv(dev);
volatile struct arlan_shmem __iomem *arlan = priv->card;
u_char rxStatus = READSHMB(arlan->rxStatus);
u_char txStatus = READSHMB(arlan->txStatus);
ARLAN_DEBUG_ENTRY("arlan_interrupt");
if (!rxStatus && !txStatus)
priv->interrupt_ack_requested++;
arlan_process_interrupt(dev);
priv->irq_test_done = 1;
ARLAN_DEBUG_EXIT("arlan_interrupt");
return IRQ_HANDLED;
}
static int arlan_close(struct net_device *dev)
{
struct arlan_private *priv = netdev_priv(dev);
ARLAN_DEBUG_ENTRY("arlan_close");
del_timer_sync(&priv->timer);
arlan_command(dev, ARLAN_COMMAND_POWERDOWN);
IFDEBUG(ARLAN_DEBUG_STARTUP)
printk(KERN_NOTICE "%s: Closing device\n", dev->name);
netif_stop_queue(dev);
free_irq(dev->irq, dev);
ARLAN_DEBUG_EXIT("arlan_close");
return 0;
}
#ifdef ARLAN_DEBUGGING
static long alignLong(volatile u_char * ptr)
{
long ret;
memcpy_fromio(&ret, (void *) ptr, 4);
return ret;
}
#endif
/*
* Get the current statistics.
* This may be called with the card open or closed.
*/
static struct net_device_stats *arlan_statistics(struct net_device *dev)
{
struct arlan_private *priv = netdev_priv(dev);
volatile struct arlan_shmem __iomem *arlan = priv->card;
ARLAN_DEBUG_ENTRY("arlan_statistics");
/* Update the statistics from the device registers. */
READSHM(priv->stats.collisions, arlan->numReTransmissions, u_int);
READSHM(priv->stats.rx_crc_errors, arlan->numCRCErrors, u_int);
READSHM(priv->stats.rx_dropped, arlan->numFramesDiscarded, u_int);
READSHM(priv->stats.rx_fifo_errors, arlan->numRXBufferOverflows, u_int);
READSHM(priv->stats.rx_frame_errors, arlan->numReceiveFramesLost, u_int);
READSHM(priv->stats.rx_over_errors, arlan->numRXOverruns, u_int);
READSHM(priv->stats.rx_packets, arlan->numDatagramsReceived, u_int);
READSHM(priv->stats.tx_aborted_errors, arlan->numAbortErrors, u_int);
READSHM(priv->stats.tx_carrier_errors, arlan->numStatusTimeouts, u_int);
READSHM(priv->stats.tx_dropped, arlan->numDatagramsDiscarded, u_int);
READSHM(priv->stats.tx_fifo_errors, arlan->numTXUnderruns, u_int);
READSHM(priv->stats.tx_packets, arlan->numDatagramsTransmitted, u_int);
READSHM(priv->stats.tx_window_errors, arlan->numHoldOffs, u_int);
ARLAN_DEBUG_EXIT("arlan_statistics");
return &priv->stats;
}
static void arlan_set_multicast(struct net_device *dev)
{
struct arlan_private *priv = netdev_priv(dev);
volatile struct arlan_shmem __iomem *arlan = priv->card;
struct arlan_conf_stru *conf = priv->Conf;
int board_conf_needed = 0;
ARLAN_DEBUG_ENTRY("arlan_set_multicast");
if (dev->flags & IFF_PROMISC)
{
unsigned char recMode;
READSHM(recMode, arlan->receiveMode, u_char);
conf->receiveMode = (ARLAN_RCV_PROMISC | ARLAN_RCV_CONTROL);
if (conf->receiveMode != recMode)
board_conf_needed = 1;
}
else
{
/* turn off promiscuous mode */
unsigned char recMode;
READSHM(recMode, arlan->receiveMode, u_char);
conf->receiveMode = ARLAN_RCV_CLEAN | ARLAN_RCV_CONTROL;
if (conf->receiveMode != recMode)
board_conf_needed = 1;
}
if (board_conf_needed)
arlan_command(dev, ARLAN_COMMAND_CONF);
ARLAN_DEBUG_EXIT("arlan_set_multicast");
}
struct net_device * __init arlan_probe(int unit)
{
struct net_device *dev;
int err;
int m;
ARLAN_DEBUG_ENTRY("arlan_probe");
if (arlans_found == MAX_ARLANS)
return ERR_PTR(-ENODEV);
/*
* Reserve space for local data and a copy of the shared memory
* that is used by the /proc interface.
*/
dev = alloc_etherdev(sizeof(struct arlan_private)
+ sizeof(struct arlan_shmem));
if (!dev)
return ERR_PTR(-ENOMEM);
if (unit >= 0) {
sprintf(dev->name, "eth%d", unit);
netdev_boot_setup_check(dev);
if (dev->mem_start) {
if (arlan_probe_here(dev, dev->mem_start) == 0)
goto found;
goto not_found;
}
}
for (m = (int)phys_to_virt(lastFoundAt) + ARLAN_SHMEM_SIZE;
m <= (int)phys_to_virt(0xDE000);
m += ARLAN_SHMEM_SIZE)
{
if (arlan_probe_here(dev, m) == 0)
{
lastFoundAt = (int)virt_to_phys((void*)m);
goto found;
}
}
if (lastFoundAt == 0xbe000)
printk(KERN_ERR "arlan: No Arlan devices found \n");
not_found:
free_netdev(dev);
return ERR_PTR(-ENODEV);
found:
err = arlan_setup_device(dev, arlans_found);
if (err)
dev = ERR_PTR(err);
else if (!arlans_found++)
printk(KERN_INFO "Arlan driver %s\n", arlan_version);
return dev;
}
#ifdef MODULE
int __init init_module(void)
{
int i = 0;
ARLAN_DEBUG_ENTRY("init_module");
if (channelSet != channelSetUNKNOWN || channelNumber != channelNumberUNKNOWN || systemId != systemIdUNKNOWN)
return -EINVAL;
for (i = 0; i < MAX_ARLANS; i++) {
struct net_device *dev = arlan_probe(i);
if (IS_ERR(dev))
return PTR_ERR(dev);
}
init_arlan_proc();
printk(KERN_INFO "Arlan driver %s\n", arlan_version);
ARLAN_DEBUG_EXIT("init_module");
return 0;
}
void __exit cleanup_module(void)
{
int i = 0;
struct net_device *dev;
ARLAN_DEBUG_ENTRY("cleanup_module");
IFDEBUG(ARLAN_DEBUG_SHUTDOWN)
printk(KERN_INFO "arlan: unloading module\n");
cleanup_arlan_proc();
for (i = 0; i < MAX_ARLANS; i++)
{
dev = arlan_device[i];
if (dev) {
arlan_command(dev, ARLAN_COMMAND_POWERDOWN );
unregister_netdev(dev);
release_mem_region(virt_to_phys((void *) dev->mem_start),
ARLAN_SHMEM_SIZE);
free_netdev(dev);
arlan_device[i] = NULL;
}
}
ARLAN_DEBUG_EXIT("cleanup_module");
}
#endif
MODULE_LICENSE("GPL");