patch-2.4.4 linux/drivers/net/wan/sdlamain.c
Next file: linux/drivers/net/wan/sealevel.c
Previous file: linux/drivers/net/wan/sdladrv.c
Back to the patch index
Back to the overall index
- Lines: 1352
- Date:
Wed Apr 18 11:49:14 2001
- Orig file:
v2.4.3/linux/drivers/net/wan/sdlamain.c
- Orig date:
Tue Mar 6 19:44:36 2001
diff -u --recursive --new-file v2.4.3/linux/drivers/net/wan/sdlamain.c linux/drivers/net/wan/sdlamain.c
@@ -1,16 +1,28 @@
-/*****************************************************************************
+/****************************************************************************
* sdlamain.c WANPIPE(tm) Multiprotocol WAN Link Driver. Main module.
*
* Author: Nenad Corbic <ncorbic@sangoma.com>
* Gideon Hack
*
-* Copyright: (c) 1995-1999 Sangoma Technologies Inc.
+* Copyright: (c) 1995-2000 Sangoma Technologies Inc.
*
* This program is free software; you can redistribute it and/or
* modify it under the terms of the GNU General Public License
* as published by the Free Software Foundation; either version
* 2 of the License, or (at your option) any later version.
* ============================================================================
+* Dec 22, 2000 Nenad Corbic Updated for 2.4.X kernels.
+* Removed the polling routine.
+* Nov 13, 2000 Nenad Corbic Added hw probing on module load and dynamic
+* device allocation.
+* Nov 7, 2000 Nenad Corbic Fixed the Multi-Port PPP for kernels
+* 2.2.16 and above.
+* Aug 2, 2000 Nenad Corbic Block the Multi-Port PPP from running on
+* kernels 2.2.16 or greater. The SyncPPP
+* has changed.
+* Jul 25, 2000 Nenad Corbic Updated the Piggiback support for MultPPPP.
+* Jul 13, 2000 Nenad Corbic Added Multi-PPP support.
+* Feb 02, 2000 Nenad Corbic Fixed up piggyback probing and selection.
* Sep 23, 1999 Nenad Corbic Added support for SMP
* Sep 13, 1999 Nenad Corbic Each port is treated as a separate device.
* Jun 02, 1999 Gideon Hack Added support for the S514 adapter.
@@ -39,17 +51,125 @@
#include <linux/stddef.h> /* offsetof(), etc. */
#include <linux/errno.h> /* return codes */
#include <linux/string.h> /* inline memset(), etc. */
-#include <linux/slab.h> /* kmalloc(), kfree() */
+#include <linux/malloc.h> /* kmalloc(), kfree() */
#include <linux/kernel.h> /* printk(), and other useful stuff */
#include <linux/module.h> /* support for loadable modules */
#include <linux/ioport.h> /* request_region(), release_region() */
-#include <linux/tqueue.h> /* for kernel task queues */
#include <linux/wanrouter.h> /* WAN router definitions */
#include <linux/wanpipe.h> /* WANPIPE common user API definitions */
-#include <asm/uaccess.h> /* kernel <-> user copy */
+
+#include <linux/in.h>
#include <asm/io.h> /* phys_to_virt() */
#include <linux/pci.h>
#include <linux/sdlapci.h>
+#include <linux/if_wanpipe_common.h>
+
+#if defined(LINUX_2_4)
+
+ #include <asm/uaccess.h> /* kernel <-> user copy */
+ #include <linux/inetdevice.h>
+ #define netdevice_t struct net_device
+
+#elif defined(LINUX_2_1)
+
+ #include <asm/uaccess.h> /* kernel <-> user copy */
+ #include <linux/inetdevice.h>
+ #define netdevice_t struct device
+
+#else
+
+ #include <asm/segment.h>
+ #define devinet_ioctl(x,y) dev_ioctl(x,y)
+ #define netdevice_t struct device
+ #define test_and_set_bit set_bit
+ typedef unsigned long mm_segment_t;
+#endif
+
+#include <linux/ip.h>
+#include <net/route.h>
+
+#define KMEM_SAFETYZONE 8
+
+
+#ifndef CONFIG_WANPIPE_FR
+ #define wpf_init(a,b) (-EPROTONOSUPPORT)
+#endif
+
+#ifndef CONFIG_WANPIPE_CHDLC
+ #define wpc_init(a,b) (-EPROTONOSUPPORT)
+#endif
+
+#ifndef CONFIG_WANPIPE_X25
+ #define wpx_init(a,b) (-EPROTONOSUPPORT)
+#endif
+
+#ifndef CONFIG_WANPIPE_PPP
+ #define wpp_init(a,b) (-EPROTONOSUPPORT)
+#endif
+
+#ifndef CONFIG_WANPIPE_MULTPPP
+ #define wsppp_init(a,b) (-EPROTONOSUPPORT)
+#endif
+
+
+/***********FOR DEBUGGING PURPOSES*********************************************
+static void * dbg_kmalloc(unsigned int size, int prio, int line) {
+ int i = 0;
+ void * v = kmalloc(size+sizeof(unsigned int)+2*KMEM_SAFETYZONE*8,prio);
+ char * c1 = v;
+ c1 += sizeof(unsigned int);
+ *((unsigned int *)v) = size;
+
+ for (i = 0; i < KMEM_SAFETYZONE; i++) {
+ c1[0] = 'D'; c1[1] = 'E'; c1[2] = 'A'; c1[3] = 'D';
+ c1[4] = 'B'; c1[5] = 'E'; c1[6] = 'E'; c1[7] = 'F';
+ c1 += 8;
+ }
+ c1 += size;
+ for (i = 0; i < KMEM_SAFETYZONE; i++) {
+ c1[0] = 'M'; c1[1] = 'U'; c1[2] = 'N'; c1[3] = 'G';
+ c1[4] = 'W'; c1[5] = 'A'; c1[6] = 'L'; c1[7] = 'L';
+ c1 += 8;
+ }
+ v = ((char *)v) + sizeof(unsigned int) + KMEM_SAFETYZONE*8;
+ printk(KERN_INFO "line %d kmalloc(%d,%d) = %p\n",line,size,prio,v);
+ return v;
+}
+static void dbg_kfree(void * v, int line) {
+ unsigned int * sp = (unsigned int *)(((char *)v) - (sizeof(unsigned int) + KMEM_SAFETYZONE*8));
+ unsigned int size = *sp;
+ char * c1 = ((char *)v) - KMEM_SAFETYZONE*8;
+ int i = 0;
+ for (i = 0; i < KMEM_SAFETYZONE; i++) {
+ if ( c1[0] != 'D' || c1[1] != 'E' || c1[2] != 'A' || c1[3] != 'D'
+ || c1[4] != 'B' || c1[5] != 'E' || c1[6] != 'E' || c1[7] != 'F') {
+ printk(KERN_INFO "kmalloced block at %p has been corrupted (underrun)!\n",v);
+ printk(KERN_INFO " %4x: %2x %2x %2x %2x %2x %2x %2x %2x\n", i*8,
+ c1[0],c1[1],c1[2],c1[3],c1[4],c1[5],c1[6],c1[7] );
+ }
+ c1 += 8;
+ }
+ c1 += size;
+ for (i = 0; i < KMEM_SAFETYZONE; i++) {
+ if ( c1[0] != 'M' || c1[1] != 'U' || c1[2] != 'N' || c1[3] != 'G'
+ || c1[4] != 'W' || c1[5] != 'A' || c1[6] != 'L' || c1[7] != 'L'
+ ) {
+ printk(KERN_INFO "kmalloced block at %p has been corrupted (overrun):\n",v);
+ printk(KERN_INFO " %4x: %2x %2x %2x %2x %2x %2x %2x %2x\n", i*8,
+ c1[0],c1[1],c1[2],c1[3],c1[4],c1[5],c1[6],c1[7] );
+ }
+ c1 += 8;
+ }
+ printk(KERN_INFO "line %d kfree(%p)\n",line,v);
+ v = ((char *)v) - (sizeof(unsigned int) + KMEM_SAFETYZONE*8);
+ kfree(v);
+}
+
+#define kmalloc(x,y) dbg_kmalloc(x,y,__LINE__)
+#define kfree(x) dbg_kfree(x,__LINE__)
+******************************************************************************/
+
+
/****** Defines & Macros ****************************************************/
@@ -61,7 +181,7 @@
#define DRV_VERSION 5 /* version number */
#define DRV_RELEASE 0 /* release (minor version) number */
-#define MAX_CARDS 8 /* max number of adapters */
+#define MAX_CARDS 16 /* max number of adapters */
#ifndef CONFIG_WANPIPE_CARDS /* configurable option */
#define CONFIG_WANPIPE_CARDS 1
@@ -86,12 +206,16 @@
/* IOCTL handlers */
static int ioctl_dump (sdla_t* card, sdla_dump_t* u_dump);
-static int ioctl_exec (sdla_t* card, sdla_exec_t* u_exec);
+static int ioctl_exec (sdla_t* card, sdla_exec_t* u_exec, int);
/* Miscellaneous functions */
STATIC void sdla_isr (int irq, void* dev_id, struct pt_regs *regs);
-STATIC void sdla_poll (void* data);
static void release_hw (sdla_t *card);
+static void run_wanpipe_tq (unsigned long);
+
+static int check_s508_conflicts (sdla_t* card,wandev_conf_t* conf, int*);
+static int check_s514_conflicts (sdla_t* card,wandev_conf_t* conf, int*);
+
/****** Global Data **********************************************************
* Note: All data must be explicitly initialized!!!
@@ -100,13 +224,41 @@
/* private data */
static char drvname[] = "wanpipe";
static char fullname[] = "WANPIPE(tm) Multiprotocol Driver";
-static char copyright[] = "(c) 1995-1999 Sangoma Technologies Inc.";
-static int ncards = CONFIG_WANPIPE_CARDS;
-static int active; /* number of active cards */
-static sdla_t* card_array; /* adapter data space */
+static char copyright[] = "(c) 1995-2000 Sangoma Technologies Inc.";
+static int ncards = 0;
+static sdla_t* card_array = NULL; /* adapter data space */
+
+/* Wanpipe's own task queue, used for all API's.
+ * All protocol specific tasks will be instered
+ * into "wanpipe_tq_custom" task_queue.
+
+ * On each rx_interrupt, the whole task queue
+ * (wanpipe_tq_custom) will be queued into
+ * IMMEDIATE_BH via wanpipe_mark_bh() call.
+
+ * The IMMEDIATE_BH will execute run_wanpipe_tq()
+ * function, which will execute all pending,
+ * tasks in wanpipe_tq_custom queue */
+
+#ifdef LINUX_2_4
+DECLARE_TASK_QUEUE(wanpipe_tq_custom);
+static struct tq_struct wanpipe_tq_task =
+{
+ routine: (void (*)(void *)) run_wanpipe_tq,
+ data: &wanpipe_tq_custom
+};
+#else
+static struct tq_struct *wanpipe_tq_custom = NULL;
+static struct tq_struct wanpipe_tq_task =
+{
+ NULL,
+ 0,
+ (void *)(void *) run_wanpipe_tq,
+ &wanpipe_tq_custom
+};
+#endif
-/* Task queue element for creating a 'thread' */
-static struct tq_struct sdla_tq = { routine: sdla_poll };
+static int wanpipe_bh_critical=0;
/******* Kernel Loadable Module Entry Points ********************************/
@@ -126,7 +278,7 @@
#ifdef MODULE
int init_module (void)
#else
-int wanpipe_init2(void)
+int wanpipe_init(void)
#endif
{
int cnt, err = 0;
@@ -134,9 +286,17 @@
printk(KERN_INFO "%s v%u.%u %s\n",
fullname, DRV_VERSION, DRV_RELEASE, copyright);
+ /* Probe for wanpipe cards and return the number found */
+ printk(KERN_INFO "wanpipe: Probing for WANPIPE hardware.\n");
+ ncards = wanpipe_hw_probe();
+ if (ncards){
+ printk(KERN_INFO "wanpipe: Allocating maximum %i devices: wanpipe%i - wanpipe%i.\n",ncards,1,ncards);
+ }else{
+ printk(KERN_INFO "wanpipe: No S514/S508 cards found, unloading modules!\n");
+ return -ENODEV;
+ }
+
/* Verify number of cards and allocate adapter data space */
- ncards = min(ncards, MAX_CARDS);
- ncards = max(ncards, 1);
card_array = kmalloc(sizeof(sdla_t) * ncards, GFP_KERNEL);
if (card_array == NULL)
return -ENOMEM;
@@ -159,7 +319,7 @@
wandev->ioctl = &ioctl;
err = register_wan_device(wandev);
if (err) {
- printk(KERN_ERR
+ printk(KERN_INFO
"%s: %s registration failed with error %d!\n",
drvname, card->devname, err);
break;
@@ -172,6 +332,7 @@
printk(KERN_INFO "IN Init Module: NO Cards registered\n");
err = -ENODEV;
}
+
return err;
}
@@ -185,11 +346,16 @@
{
int i;
+ if (!ncards)
+ return;
+
for (i = 0; i < ncards; ++i) {
sdla_t* card = &card_array[i];
unregister_wan_device(card->devname);
}
kfree(card_array);
+
+ printk(KERN_INFO "\nwanpipe: WANPIPE Modules Unloaded.\n");
}
#endif
@@ -218,15 +384,25 @@
sdla_t* card;
int err = 0;
int irq=0;
- int i;
/* Sanity checks */
- if ((wandev == NULL) || (wandev->private == NULL) || (conf == NULL))
+ if ((wandev == NULL) || (wandev->private == NULL) || (conf == NULL)){
+ printk(KERN_INFO
+ "%s: Failed Sdlamain Setup wandev %u, card %u, conf %u !\n",
+ wandev->name,
+ (unsigned int)wandev,(unsigned int)wandev->private,
+ (unsigned int)conf);
return -EFAULT;
-
+ }
+
+ printk(KERN_INFO "%s: Starting WAN Setup\n", wandev->name);
+
card = wandev->private;
- if (wandev->state != WAN_UNCONFIGURED)
+ if (wandev->state != WAN_UNCONFIGURED){
+ printk(KERN_INFO "%s: failed sdlamain setup, busy!\n",
+ wandev->name);
return -EBUSY; /* already configured */
+ }
printk(KERN_INFO "\nProcessing WAN device %s...\n", wandev->name);
@@ -239,84 +415,21 @@
wandev->config_id = conf->config_id;
if (!conf->data_size || (conf->data == NULL)) {
- printk(KERN_ERR
+ printk(KERN_INFO
"%s: firmware not found in configuration data!\n",
wandev->name);
return -EINVAL;
}
- /* only check I/O port and IRQ if not an S514 adapter */
+ /* Check for resource conflicts and setup the
+ * card for piggibacking if necessary */
if(!conf->S514_CPU_no[0]) {
-
- if (conf->ioport <= 0) {
- printk(KERN_ERR
- "%s: can't configure without I/O port address!\n",
- wandev->name);
- return -EINVAL;
- }
-
- if (conf->irq <= 0) {
- printk(KERN_ERR "%s: can't configure without IRQ!\n",
- wandev->name);
- return -EINVAL;
- }
-
- /* Check for already loaded card with the same IO port and IRQ
- * If found, copy its hardware configuration and use its
- * resources (i.e. piggybacking)
- */
- if (!card->configured){
- for (i = 0; i < ncards; i ++) {
- sdla_t *nxt_card = &card_array[i];
- if (nxt_card->hw.port == conf->ioport &&
- nxt_card != card &&
- conf->config_id == WANCONFIG_CHDLC &&
- nxt_card->wandev.config_id == WANCONFIG_CHDLC){
- irq = nxt_card->hw.irq;
- memcpy(&card->hw, &nxt_card->hw, sizeof(sdlahw_t));
- nxt_card->next = card;
- card->next = nxt_card;
- card->wandev.piggyback = WANOPT_YES;
- }
- }
-
-
- /* Make sure I/O port region is available */
- if (check_region(conf->ioport, SDLA_MAXIORANGE) &&
- !card->wandev.piggyback) {
- printk(KERN_ERR
- "%s: I/O region 0x%X - 0x%X is in use!\n",
- wandev->name, conf->ioport,
- conf->ioport + SDLA_MAXIORANGE);
- return -EINVAL;
- }
+ if ((err=check_s508_conflicts(card,conf,&irq)) != 0){
+ return err;
}
- }
-
- /*
- For a S514 adapter, check for a possible configuration error in that
- we are loading an adapter in the same slot as a previously loaded S514
- card.
- */
- else {
- if (!card->configured){
- for (i = 0; i < ncards; i ++) {
- sdla_t* nxt_card = &card_array[i];
- if(nxt_card == card)
- continue;
- if((nxt_card->hw.type == SDLA_S514) &&
- (nxt_card->hw.S514_slot_no == conf->PCI_slot_no) &&
- (nxt_card->hw.S514_cpu_no[0] == conf->S514_CPU_no[0])&&
- (conf->config_id == WANCONFIG_CHDLC)&&
- (nxt_card->wandev.config_id == WANCONFIG_CHDLC)){
-
- irq = nxt_card->hw.irq;
- memcpy(&card->hw, &nxt_card->hw, sizeof(sdlahw_t));
- nxt_card->next = card;
- card->next = nxt_card;
- card->wandev.piggyback = WANOPT_YES;
- }
- }
+ }else {
+ if ((err=check_s514_conflicts(card,conf,&irq)) != 0){
+ return err;
}
}
@@ -336,8 +449,15 @@
card->hw.S514_cpu_no[0] = conf->S514_CPU_no[0];
card->hw.S514_slot_no = conf->PCI_slot_no;
- printk(KERN_INFO "Setting CPU to %c and Slot to %i\n",
- card->hw.S514_cpu_no[0], card->hw.S514_slot_no);
+ card->hw.auto_pci_cfg = conf->auto_pci_cfg;
+
+ if (card->hw.auto_pci_cfg == WANOPT_YES){
+ printk(KERN_INFO "%s: Setting CPU to %c and Slot to Auto\n",
+ card->devname, card->hw.S514_cpu_no[0]);
+ }else{
+ printk(KERN_INFO "%s: Setting CPU to %c and Slot to %i\n",
+ card->devname, card->hw.S514_cpu_no[0], card->hw.S514_slot_no);
+ }
}else{
/* 508 Card io port and irq initialization */
@@ -347,18 +467,22 @@
/* Compute the virtual address of the card in kernel space */
- if(conf->maddr)
+ if(conf->maddr){
card->hw.dpmbase = phys_to_virt(conf->maddr);
- else /* But 0 means NULL */
+ }else{
card->hw.dpmbase = (void *)conf->maddr;
-
+ }
+
card->hw.dpmsize = SDLA_WINDOWSIZE;
+
/* set the adapter type if using an S514 adapter */
card->hw.type = (conf->S514_CPU_no[0]) ? SDLA_S514 : conf->hw_opt[0];
card->hw.pclk = conf->hw_opt[1];
err = sdla_setup(&card->hw, conf->data, conf->data_size);
if (err){
+ printk(KERN_INFO "%s: Hardware setup Failed %i\n",
+ card->devname,err);
return err;
}
@@ -369,10 +493,12 @@
/* request an interrupt vector - note that interrupts may be shared */
/* when using the S514 PCI adapter */
+
if(request_irq(irq, sdla_isr,
- (card->hw.type == SDLA_S514) ? SA_SHIRQ : 0, wandev->name, card)){
+ (card->hw.type == SDLA_S514) ? SA_SHIRQ : 0,
+ wandev->name, card)){
- printk(KERN_ERR "%s: Can't reserve IRQ %d!\n", wandev->name, irq);
+ printk(KERN_INFO "%s: Can't reserve IRQ %d!\n", wandev->name, irq);
return -EINVAL;
}
@@ -384,11 +510,16 @@
if (!card->configured){
- #ifdef CONFIG_SMP
/* Initialize the Spin lock */
- printk(KERN_INFO "%s: Initializing SMP\n",wandev->name);
- spin_lock_init(&card->lock);
- #endif
+#if defined(__SMP__) || defined(LINUX_2_4)
+ printk(KERN_INFO "%s: Initializing for SMP\n",wandev->name);
+#endif
+
+ /* Piggyback spin lock has already been initialized,
+ * in check_s514/s508_conflicts() */
+ if (!card->wandev.piggyback){
+ spin_lock_init(&card->wandev.lock);
+ }
/* Intialize WAN device data space */
wandev->irq = irq;
@@ -409,63 +540,65 @@
/* Protocol-specific initialization */
switch (card->hw.fwid) {
-#ifdef CONFIG_WANPIPE_X25
+
case SFID_X25_502:
case SFID_X25_508:
+ printk(KERN_INFO "%s: Starting X.25 Protocol Init.\n",
+ card->devname);
err = wpx_init(card, conf);
break;
-#endif
-
-#ifdef CONFIG_WANPIPE_FR
case SFID_FR502:
case SFID_FR508:
+ printk(KERN_INFO "%s: Starting Frame Relay Protocol Init.\n",
+ card->devname);
err = wpf_init(card, conf);
break;
-#endif
-
-#ifdef CONFIG_WANPIPE_PPP
case SFID_PPP502:
case SFID_PPP508:
+ printk(KERN_INFO "%s: Starting PPP Protocol Init.\n",
+ card->devname);
err = wpp_init(card, conf);
break;
-#endif
-
-#ifdef CONFIG_WANPIPE_CHDLC
+
case SFID_CHDLC508:
case SFID_CHDLC514:
-// if (conf->ft1){
-// printk(KERN_INFO "%s: Starting FT1 Configurator\n",
-// card->devname);
-// err = wpft1_init(card, conf);
-// }else{
- err = wpc_init(card, conf);
-// }
- break;
-#endif
-
-#ifdef CONFIG_WANPIPE_BSTRM
- case SFID_BSC502:
- err = bsc_init(card, conf);
- break;
-#endif
-
-#ifdef CONFIG_WANPIPE_HDLC
- case SFID_HDLC508:
- err = hdlc_init(card, conf);
- break;
-#endif
+ if (conf->ft1){
+ printk(KERN_INFO "%s: Starting FT1 CSU/DSU Config Driver.\n",
+ card->devname);
+ err = wpft1_init(card, conf);
+ break;
+
+ }else if (conf->config_id == WANCONFIG_MPPP){
+ printk(KERN_INFO "%s: Starting Multi-Port PPP Protocol Init.\n",
+ card->devname);
+ err = wsppp_init(card,conf);
+ break;
+ }else{
+ printk(KERN_INFO "%s: Starting CHDLC Protocol Init.\n",
+ card->devname);
+ err = wpc_init(card, conf);
+ break;
+ }
default:
- printk(KERN_ERR "%s: this firmware is not supported %X %X!\n",
+ printk(KERN_INFO "%s: Error, Firmware is not supported %X %X!\n",
wandev->name,card->hw.fwid,SFID_CHDLC508);
- err = -EINVAL;
+ err = -EPROTONOSUPPORT;
}
-
- if (err){
+ if (err != 0){
+ if (err == -EPROTONOSUPPORT){
+ printk(KERN_INFO
+ "%s: Error, Protocol selected has not been compiled!\n",
+ card->devname);
+ printk(KERN_INFO
+ "%s: Re-configure the kernel and re-build the modules!\n",
+ card->devname);
+ }
+
release_hw(card);
+ wandev->state = WAN_UNCONFIGURED;
return err;
-
}
@@ -473,16 +606,194 @@
if(card->hw.type != SDLA_S514 && !card->wandev.piggyback)
request_region(card->hw.port, card->hw.io_range, wandev->name);
- if (++active == 1) {
- MOD_INC_USE_COUNT;
- if (schedule_task(&sdla_tq) == 0)
- MOD_DEC_USE_COUNT;
+ /* Only use the polling routine for the X25 protocol */
+
+ card->wandev.critical=0;
+ return 0;
+}
+
+/*==================================================================
+ * configure_s508_card
+ *
+ * For a S508 adapter, check for a possible configuration error in that
+ * we are loading an adapter in the same IO port as a previously loaded S508
+ * card.
+ */
+
+static int check_s508_conflicts (sdla_t* card,wandev_conf_t* conf, int *irq)
+{
+ unsigned long smp_flags;
+ int i;
+
+ if (conf->ioport <= 0) {
+ printk(KERN_INFO
+ "%s: can't configure without I/O port address!\n",
+ card->wandev.name);
+ return -EINVAL;
+ }
+
+ if (conf->irq <= 0) {
+ printk(KERN_INFO "%s: can't configure without IRQ!\n",
+ card->wandev.name);
+ return -EINVAL;
}
+
+ if (test_bit(0,&card->configured))
+ return 0;
+
+
+ /* Check for already loaded card with the same IO port and IRQ
+ * If found, copy its hardware configuration and use its
+ * resources (i.e. piggybacking)
+ */
+
+ for (i = 0; i < ncards; i++) {
+ sdla_t *nxt_card = &card_array[i];
+
+ /* Skip the current card ptr */
+ if (nxt_card == card)
+ continue;
+
+
+ /* Find a card that is already configured with the
+ * same IO Port */
+ if ((nxt_card->hw.type == SDLA_S508) &&
+ (nxt_card->hw.port == conf->ioport) &&
+ (nxt_card->next == NULL)){
+
+ /* We found a card the card that has same configuration
+ * as us. This means, that we must setup this card in
+ * piggibacking mode. However, only CHDLC and MPPP protocol
+ * support this setup */
+
+ if ((conf->config_id == WANCONFIG_CHDLC ||
+ conf->config_id == WANCONFIG_MPPP) &&
+ (nxt_card->wandev.config_id == WANCONFIG_CHDLC ||
+ nxt_card->wandev.config_id == WANCONFIG_MPPP)){
+
+ *irq = nxt_card->hw.irq;
+ memcpy(&card->hw, &nxt_card->hw, sizeof(sdlahw_t));
+
+ /* The master could already be running, we must
+ * set this as a critical area */
+ lock_adapter_irq(&nxt_card->wandev.lock, &smp_flags);
+
+ nxt_card->next = card;
+ card->next = nxt_card;
+
+ card->wandev.piggyback = WANOPT_YES;
+
+ /* We must initialise the piggiback spin lock here
+ * since isr will try to lock card->next if it
+ * exists */
+ spin_lock_init(&card->wandev.lock);
+
+ unlock_adapter_irq(&nxt_card->wandev.lock, &smp_flags);
+ break;
+ }else{
+ /* Trying to run piggibacking with a wrong protocol */
+ printk(KERN_INFO "%s: ERROR: Resource busy, ioport: 0x%x\n"
+ "%s: This protocol doesn't support\n"
+ "%s: multi-port operation!\n",
+ card->devname,nxt_card->hw.port,
+ card->devname,card->devname);
+ return -EEXIST;
+ }
+ }
+ }
+
+
+ /* Make sure I/O port region is available only if we are the
+ * master device. If we are running in piggibacking mode,
+ * we will use the resources of the master card */
+ if (check_region(conf->ioport, SDLA_MAXIORANGE) &&
+ !card->wandev.piggyback) {
+ printk(KERN_INFO
+ "%s: I/O region 0x%X - 0x%X is in use!\n",
+ card->wandev.name, conf->ioport,
+ conf->ioport + SDLA_MAXIORANGE);
+ return -EINVAL;
+ }
+
+ return 0;
+}
+
+/*==================================================================
+ * configure_s514_card
+ *
+ * For a S514 adapter, check for a possible configuration error in that
+ * we are loading an adapter in the same slot as a previously loaded S514
+ * card.
+ */
+
+
+static int check_s514_conflicts(sdla_t* card,wandev_conf_t* conf, int *irq)
+{
+ unsigned long smp_flags;
+ int i;
+
+ if (test_bit(0,&card->configured))
+ return 0;
+
+
+ /* Check for already loaded card with the same IO port and IRQ
+ * If found, copy its hardware configuration and use its
+ * resources (i.e. piggybacking)
+ */
+
+ for (i = 0; i < ncards; i ++) {
+
+ sdla_t* nxt_card = &card_array[i];
+ if(nxt_card == card)
+ continue;
- wandev->critical = 0;
+ if((nxt_card->hw.type == SDLA_S514) &&
+ (nxt_card->hw.S514_slot_no == conf->PCI_slot_no) &&
+ (nxt_card->hw.S514_cpu_no[0] == conf->S514_CPU_no[0])&&
+ (nxt_card->next == NULL)){
+
+
+ if ((conf->config_id == WANCONFIG_CHDLC ||
+ conf->config_id == WANCONFIG_MPPP) &&
+ (nxt_card->wandev.config_id == WANCONFIG_CHDLC ||
+ nxt_card->wandev.config_id == WANCONFIG_MPPP)){
+
+ *irq = nxt_card->hw.irq;
+ memcpy(&card->hw, &nxt_card->hw, sizeof(sdlahw_t));
+
+ /* The master could already be running, we must
+ * set this as a critical area */
+ lock_adapter_irq(&nxt_card->wandev.lock,&smp_flags);
+ nxt_card->next = card;
+ card->next = nxt_card;
+
+ card->wandev.piggyback = WANOPT_YES;
+
+ /* We must initialise the piggiback spin lock here
+ * since isr will try to lock card->next if it
+ * exists */
+ spin_lock_init(&card->wandev.lock);
+
+ unlock_adapter_irq(&nxt_card->wandev.lock,&smp_flags);
+
+ }else{
+ /* Trying to run piggibacking with a wrong protocol */
+ printk(KERN_INFO "%s: ERROR: Resource busy: CPU %c PCISLOT %i\n"
+ "%s: This protocol doesn't support\n"
+ "%s: multi-port operation!\n",
+ card->devname,
+ conf->S514_CPU_no[0],conf->PCI_slot_no,
+ card->devname,card->devname);
+ return -EEXIST;
+ }
+ }
+ }
+
return 0;
}
+
+
/*============================================================================
* Shut down WAN link driver.
* o shut down adapter hardware
@@ -494,23 +805,39 @@
static int shutdown (wan_device_t* wandev)
{
sdla_t *card;
-
+ int err=0;
+
/* sanity checks */
- if ((wandev == NULL) || (wandev->private == NULL))
+ if ((wandev == NULL) || (wandev->private == NULL)){
return -EFAULT;
+ }
- if (wandev->state == WAN_UNCONFIGURED)
+ if (wandev->state == WAN_UNCONFIGURED){
return 0;
-
- /* If we are in a critical section we lose */
- if (test_and_set_bit(0, (void*)&wandev->critical))
- return -EAGAIN;
-
+ }
+
card = wandev->private;
+
+ if (card->tty_opt){
+ if (card->tty_open){
+ printk(KERN_INFO
+ "%s: Shutdown Failed: TTY is still open\n",
+ card->devname);
+ return -EBUSY;
+ }
+ }
+
wandev->state = WAN_UNCONFIGURED;
- if (--active == 0)
- schedule(); /* stop background thread */
+ set_bit(PERI_CRIT,(void*)&wandev->critical);
+
+ /* In case of piggibacking, make sure that
+ * we never try to shutdown both devices at the same
+ * time, because they depend on one another */
+
+ if (card->disable_comm){
+ card->disable_comm(card);
+ }
/* Release Resources */
release_hw(card);
@@ -526,15 +853,17 @@
memset(&card->next->hw, 0, sizeof(sdlahw_t));
}
}
+
- wandev->critical = 0;
- return 0;
+ clear_bit(PERI_CRIT,(void*)&wandev->critical);
+ return err;
}
static void release_hw (sdla_t *card)
{
sdla_t *nxt_card;
+
/* Check if next device exists */
if (card->next){
nxt_card = card->next;
@@ -559,8 +888,9 @@
card->next->configured = 0;
}
}else{
- printk(KERN_INFO "%s: Device still running\n",
- nxt_card->devname);
+ printk(KERN_INFO "%s: Device still running %i\n",
+ nxt_card->devname,nxt_card->wandev.state);
+
card->configured = 1;
}
}else{
@@ -569,6 +899,7 @@
free_irq(card->wandev.irq, card);
card->configured = 0;
}
+ return;
}
@@ -597,10 +928,7 @@
disable_irq(card->hw.irq);
}
- if (test_and_set_bit(0, (void*)&wandev->critical)) {
- if(card->hw.type != SDLA_S514){
- enable_irq(card->hw.irq);
- }
+ if (test_bit(SEND_CRIT, (void*)&wandev->critical)) {
return -EAGAIN;
}
@@ -610,18 +938,12 @@
break;
case WANPIPE_EXEC:
- err = ioctl_exec(wandev->private, (void*)arg);
+ err = ioctl_exec(wandev->private, (void*)arg, cmd);
break;
-
default:
err = -EINVAL;
}
- clear_bit(0, (void*)&wandev->critical);
- if(card->hw.type != SDLA_S514){
- enable_irq(card->hw.irq);
- }
-
return err;
}
@@ -635,7 +957,7 @@
* o verify user buffer
* o copy adapter memory image to user buffer
*
- * Note: when dumping memory, this routine switches current dual-port memory
+ * Note: when dumping memory, this routine switches curent dual-port memory
* vector, so care must be taken to avoid racing conditions.
*/
static int ioctl_dump (sdla_t* card, sdla_dump_t* u_dump)
@@ -643,21 +965,35 @@
sdla_dump_t dump;
unsigned winsize;
unsigned long oldvec; /* DPM window vector */
- unsigned long flags;
+ unsigned long smp_flags;
int err = 0;
+ #if defined(LINUX_2_1) || defined(LINUX_2_4)
if(copy_from_user((void*)&dump, (void*)u_dump, sizeof(sdla_dump_t)))
return -EFAULT;
+ #else
+ if ((u_dump == NULL) ||
+ verify_area(VERIFY_READ, u_dump, sizeof(sdla_dump_t)))
+ return -EFAULT;
+ memcpy_fromfs((void*)&dump, (void*)u_dump, sizeof(sdla_dump_t));
+ #endif
if ((dump.magic != WANPIPE_MAGIC) ||
(dump.offset + dump.length > card->hw.memory))
return -EINVAL;
+ #ifdef LINUX_2_0
+ if ((dump.ptr == NULL) ||
+ verify_area(VERIFY_WRITE, dump.ptr, dump.length))
+ return -EFAULT;
+ #endif
+
winsize = card->hw.dpmsize;
- save_flags(flags);
- cli(); /* >>> critical section start <<< */
if(card->hw.type != SDLA_S514) {
+
+ lock_adapter_irq(&card->wandev.lock, &smp_flags);
+
oldvec = card->hw.vector;
while (dump.length) {
/* current offset */
@@ -671,29 +1007,39 @@
err = -EIO;
break;
}
- /* FIXME::: COPY TO KERNEL BUFFER FIRST ?? */
- sti(); /* Not ideal but tough we have to do this */
+
+ #if defined(LINUX_2_1) || defined(LINUX_2_4)
if(copy_to_user((void *)dump.ptr,
- (u8 *)card->hw.dpmbase + pos, len))
- return -EFAULT;
- cli();
+ (u8 *)card->hw.dpmbase + pos, len)){
+
+ unlock_adapter_irq(&card->wandev.lock, &smp_flags);
+ return -EFAULT;
+ }
+ #else
+ memcpy_tofs((void*)(dump.ptr),
+ (void*)(card->hw.dpmbase + pos), len);
+ #endif
dump.length -= len;
dump.offset += len;
(char*)dump.ptr += len;
}
+
sdla_mapmem(&card->hw, oldvec);/* restore DPM window position */
- }
-
- else {
- /* FIXME::: COPY TO KERNEL BUFFER FIRST ?? */
- sti(); /* Not ideal but tough we have to do this */
+ unlock_adapter_irq(&card->wandev.lock, &smp_flags);
+
+ }else {
+
+ #if defined(LINUX_2_1) || defined(LINUX_2_4)
if(copy_to_user((void *)dump.ptr,
- (u8 *)card->hw.dpmbase + dump.offset, dump.length))
- return -EFAULT;
- cli();
+ (u8 *)card->hw.dpmbase + dump.offset, dump.length)){
+ return -EFAULT;
+ }
+ #else
+ memcpy_tofs((void*)(dump.ptr),
+ (void*)(card->hw.dpmbase + dump.offset), dump.length);
+ #endif
}
- restore_flags(flags); /* >>> critical section end <<< */
return err;
}
@@ -703,19 +1049,34 @@
* o copy request structure to kernel data space
* o call protocol-specific 'exec' function
*/
-static int ioctl_exec (sdla_t* card, sdla_exec_t* u_exec)
+static int ioctl_exec (sdla_t* card, sdla_exec_t* u_exec, int cmd)
{
sdla_exec_t exec;
+ int err=0;
- if (card->exec == NULL)
+ if (card->exec == NULL && cmd == WANPIPE_EXEC){
return -ENODEV;
-
+ }
+
+ #if defined(LINUX_2_1) || defined(LINUX_2_4)
if(copy_from_user((void*)&exec, (void*)u_exec, sizeof(sdla_exec_t)))
return -EFAULT;
+ #else
+ if ((u_exec == NULL) ||
+ verify_area(VERIFY_READ, u_exec, sizeof(sdla_exec_t)))
+ return -EFAULT;
+ memcpy_fromfs((void*)&exec, (void*)u_exec, sizeof(sdla_exec_t));
+ #endif
if ((exec.magic != WANPIPE_MAGIC) || (exec.cmd == NULL))
return -EINVAL;
- return card->exec(card, exec.cmd, exec.data);
+
+ switch (cmd) {
+ case WANPIPE_EXEC:
+ err = card->exec(card, exec.cmd, exec.data);
+ break;
+ }
+ return err;
}
/******* Miscellaneous ******************************************************/
@@ -795,11 +1156,20 @@
return;
}
+ spin_lock(&card->wandev.lock);
+ if (card->next){
+ spin_lock(&card->next->wandev.lock);
+ }
+
S514_intack(&card->hw, int_status);
-
if (card->isr)
card->isr(card);
+ if (card->next){
+ spin_unlock(&card->next->wandev.lock);
+ }
+ spin_unlock(&card->wandev.lock);
+
/* handle a maximum of two interrupts (one for each */
/* CPU on the adapter) before returning */
if((++ IRQ_count) == 2)
@@ -819,17 +1189,19 @@
return;
}
- /* Use spin lock only for S508 */
-
-#ifdef CONFIG_SMP
- spin_lock(&card->lock);
-#endif
+ spin_lock(&card->wandev.lock);
+ if (card->next){
+ spin_lock(&card->next->wandev.lock);
+ }
+
sdla_intack(&card->hw);
if (card->isr)
card->isr(card);
-#ifdef CONFIG_SMP
- spin_unlock(&card->lock);
-#endif
+
+ if (card->next){
+ spin_unlock(&card->next->wandev.lock);
+ }
+ spin_unlock(&card->wandev.lock);
}
@@ -837,33 +1209,6 @@
}
/*============================================================================
- * SDLA polling routine.
- * This routine simulates kernel thread to perform various housekeeping job.
- *
- * o for each configured device call its poll() routine
- * o if there is at least one active card, then reschedule itself once again
- */
-STATIC void sdla_poll (void* data)
-{
- int i;
-
- for (i = 0; i < ncards; ++i) {
- sdla_t* card = &card_array[i];
-
- if ((card->wandev.state != WAN_UNCONFIGURED) && card->poll &&
- !card->wandev.critical) {
- card->poll(card);
- }
- }
- if (active) {
- MOD_INC_USE_COUNT;
- if (schedule_task(&sdla_tq) == 0) /* Surely not? */
- MOD_DEC_USE_COUNT;
- }
- MOD_DEC_USE_COUNT;
-}
-
-/*============================================================================
* This routine is called by the protocol-specific modules when network
* interface is being open. The only reason we need this, is because we
* have to call MOD_INC_USE_COUNT, but cannot include 'module.h' where it's
@@ -892,10 +1237,6 @@
*/
void wanpipe_set_state (sdla_t* card, int state)
{
- unsigned long flags;
-
- save_flags(flags);
- cli();
if (card->wandev.state != state) {
switch (state) {
case WAN_CONNECTED:
@@ -916,7 +1257,187 @@
card->wandev.state = state;
}
card->state_tick = jiffies;
- restore_flags(flags);
}
-/****** End *****************************************************************/
+sdla_t * wanpipe_find_card (char *name)
+{
+ int cnt;
+ for (cnt = 0; cnt < ncards; ++ cnt) {
+ sdla_t* card = &card_array[cnt];
+ if (!strcmp(card->devname,name))
+ return card;
+ }
+ return NULL;
+}
+sdla_t * wanpipe_find_card_num (int num)
+{
+ if (num < 1 || num > ncards)
+ return NULL;
+ num--;
+ return &card_array[num];
+}
+
+
+static void run_wanpipe_tq (unsigned long data)
+{
+ task_queue *tq_queue = (task_queue *)data;
+ if (test_and_set_bit(2,(void*)&wanpipe_bh_critical))
+ printk(KERN_INFO "CRITICAL IN RUNNING TASK QUEUE\n");
+ run_task_queue (tq_queue);
+ clear_bit(2,(void*)&wanpipe_bh_critical);
+
+}
+
+void wanpipe_queue_tq (struct tq_struct *bh_pointer)
+{
+ if (test_and_set_bit(1,(void*)&wanpipe_bh_critical))
+ printk(KERN_INFO "CRITICAL IN QUEUING TASK\n");
+
+ queue_task(bh_pointer,&wanpipe_tq_custom);
+ clear_bit(1,(void*)&wanpipe_bh_critical);
+}
+
+void wanpipe_mark_bh (void)
+{
+ if (!test_and_set_bit(0,(void*)&wanpipe_bh_critical)){
+ queue_task(&wanpipe_tq_task,&tq_immediate);
+ mark_bh(IMMEDIATE_BH);
+ clear_bit(0,(void*)&wanpipe_bh_critical);
+ }
+}
+
+void wakeup_sk_bh (netdevice_t *dev)
+{
+ wanpipe_common_t *chan = dev->priv;
+
+ if (test_bit(0,&chan->common_critical))
+ return;
+
+ if (chan->sk && chan->tx_timer){
+ chan->tx_timer->expires=jiffies+1;
+ add_timer(chan->tx_timer);
+ }
+}
+
+int change_dev_flags (netdevice_t *dev, unsigned flags)
+{
+ struct ifreq if_info;
+ mm_segment_t fs = get_fs();
+ int err;
+
+ memset(&if_info, 0, sizeof(if_info));
+ strcpy(if_info.ifr_name, dev->name);
+ if_info.ifr_flags = flags;
+
+ set_fs(get_ds()); /* get user space block */
+ err = devinet_ioctl(SIOCSIFFLAGS, &if_info);
+ set_fs(fs);
+
+ return err;
+}
+
+unsigned long get_ip_address (netdevice_t *dev, int option)
+{
+
+ #ifdef LINUX_2_4
+ struct in_ifaddr *ifaddr;
+ struct in_device *in_dev;
+
+ if ((in_dev = __in_dev_get(dev)) == NULL){
+ return 0;
+ }
+ #elif defined(LINUX_2_1)
+ struct in_ifaddr *ifaddr;
+ struct in_device *in_dev;
+
+ if ((in_dev = dev->ip_ptr) == NULL){
+ return 0;
+ }
+ #endif
+
+ #if defined(LINUX_2_1) || defined(LINUX_2_4)
+ if ((ifaddr = in_dev->ifa_list)== NULL ){
+ return 0;
+ }
+ #endif
+
+ switch (option){
+
+ case WAN_LOCAL_IP:
+ #ifdef LINUX_2_0
+ return dev->pa_addr;
+ #else
+ return ifaddr->ifa_local;
+ #endif
+ break;
+
+ case WAN_POINTOPOINT_IP:
+ #ifdef LINUX_2_0
+ return dev->pa_dstaddr;
+ #else
+ return ifaddr->ifa_address;
+ #endif
+ break;
+
+ case WAN_NETMASK_IP:
+ #ifdef LINUX_2_0
+ return dev->pa_mask;
+ #else
+ return ifaddr->ifa_mask;
+ #endif
+ break;
+
+ case WAN_BROADCAST_IP:
+ #ifdef LINUX_2_0
+ return dev->pa_brdaddr;
+ #else
+ return ifaddr->ifa_broadcast;
+ #endif
+ break;
+ default:
+ return 0;
+ }
+
+ return 0;
+}
+
+void add_gateway(sdla_t *card, netdevice_t *dev)
+{
+ mm_segment_t oldfs;
+ struct rtentry route;
+ int res;
+
+ memset((char*)&route,0,sizeof(struct rtentry));
+
+ ((struct sockaddr_in *)
+ &(route.rt_dst))->sin_addr.s_addr = 0;
+ ((struct sockaddr_in *)
+ &(route.rt_dst))->sin_family = AF_INET;
+
+ ((struct sockaddr_in *)
+ &(route.rt_genmask))->sin_addr.s_addr = 0;
+ ((struct sockaddr_in *)
+ &(route.rt_genmask)) ->sin_family = AF_INET;
+
+
+ route.rt_flags = 0;
+ route.rt_dev = dev->name;
+
+ oldfs = get_fs();
+ set_fs(get_ds());
+ #if defined(LINUX_2_1) || defined(LINUX_2_4)
+ res = ip_rt_ioctl(SIOCADDRT,&route);
+ #else
+ res = ip_rt_new(&route);
+ #endif
+ set_fs(oldfs);
+
+ if (res == 0){
+ printk(KERN_INFO "%s: Gateway added for %s\n",
+ card->devname,dev->name);
+ }
+
+ return;
+}
+
+/****** End *********************************************************/
FUNET's LINUX-ADM group, linux-adm@nic.funet.fi
TCL-scripts by Sam Shen (who was at: slshen@lbl.gov)