patch-2.3.21 linux/drivers/net/wan/sdlamain.c

• Lines: 629
• Date: Mon Oct 11 10:13:25 1999
• Orig file: v2.3.20/linux/drivers/net/wan/sdlamain.c
• Orig date: Wed Dec 31 16:00:00 1969

diff -u --recursive --new-file v2.3.20/linux/drivers/net/wan/sdlamain.c linux/drivers/net/wan/sdlamain.c
@@ -0,0 +1,628 @@
+/*****************************************************************************
+* sdlamain.c	WANPIPE(tm) Multiprotocol WAN Link Driver.  Main module.
+*
+* Author:	Gene Kozin	<genek@compuserve.com>
+*		Jaspreet Singh	<jaspreet@sangoma.com>
+* Fixes:	Arnaldo Carvalho de Melo <acme@conectiva.com.br>
+*
+* Copyright:	(c) 1995-1997 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.
+* ============================================================================
+* May 19, 1999  Arnaldo Melo    __init for wanpipe_init
+* Nov 28, 1997	Jaspreet Singh	Changed DRV_RELEASE to 1
+* Nov 10, 1997	Jaspreet Singh	Changed sti() to restore_flags();
+* Nov 06, 1997 	Jaspreet Singh	Changed DRV_VERSION to 4 and DRV_RELEASE to 0
+* Oct 20, 1997 	Jaspreet Singh	Modified sdla_isr routine so that card->in_isr
+*				assignments are taken out and placed in the
+*				sdla_ppp.c, sdla_fr.c and sdla_x25.c isr
+*				routines. Took out 'wandev->tx_int_enabled' and
+*				replaced it with 'wandev->enable_tx_int'. 
+* May 29, 1997	Jaspreet Singh	Flow Control Problem
+*				added "wandev->tx_int_enabled=1" line in the
+*				init module. This line intializes the flag for 
+*				preventing Interrupt disabled with device set to
+*				busy
+* Jan 15, 1997	Gene Kozin	Version 3.1.0
+*				 o added UDP management stuff
+* Jan 02, 1997	Gene Kozin	Initial version.
+*****************************************************************************/
+
+#include <linux/config.h>	/* OS configuration options */
+#include <linux/stddef.h>	/* offsetof(), etc. */
+#include <linux/errno.h>	/* return codes */
+#include <linux/string.h>	/* inline memset(), etc. */
+#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 <asm/io.h>		/* phys_to_virt() */
+#include <linux/init.h>         /* __init (when not using as a module) */
+
+
+/****** Defines & Macros ****************************************************/
+
+#ifdef	_DEBUG_
+#define	STATIC
+#else
+#define	STATIC		static
+#endif
+
+#define	DRV_VERSION	4		/* version number */
+#define	DRV_RELEASE	1		/* release (minor version) number */
+#define	MAX_CARDS	8		/* max number of adapters */
+
+#ifndef	CONFIG_WANPIPE_CARDS		/* configurable option */
+#define	CONFIG_WANPIPE_CARDS 1
+#endif
+
+#define	CMD_OK		0		/* normal firmware return code */
+#define	CMD_TIMEOUT	0xFF		/* firmware command timed out */
+#define	MAX_CMD_RETRY	10		/* max number of firmware retries */
+
+/****** Function Prototypes *************************************************/
+
+/* Module entry points */
+int init_module (void);
+void cleanup_module (void);
+
+/* WAN link driver entry points */
+static int setup    (wan_device_t* wandev, wandev_conf_t* conf);
+static int shutdown (wan_device_t* wandev);
+static int ioctl    (wan_device_t* wandev, unsigned cmd, unsigned long arg);
+
+/* IOCTL hanlers */
+static int ioctl_dump	(sdla_t* card, sdla_dump_t* u_dump);
+static int ioctl_exec	(sdla_t* card, sdla_exec_t* u_exec);
+
+/* Miscellaneous functions */
+STATIC void sdla_isr	(int irq, void* dev_id, struct pt_regs *regs);
+STATIC void sdla_poll	(void* data);
+
+/****** Global Data **********************************************************
+ * Note: All data must be explicitly initialized!!!
+ */
+
+/* private data */
+static char drvname[]	= "wanpipe";
+static char fullname[]	= "WANPIPE(tm) Multiprotocol Driver";
+static char copyright[]	= "(c) 1995-1996 Sangoma Technologies Inc.";
+static int ncards = CONFIG_WANPIPE_CARDS;
+static int active = 0;			/* number of active cards */
+static sdla_t* card_array = NULL;	/* adapter data space */
+
+/* Task queue element for creating a 'thread' */
+static struct tq_struct sdla_tq =
+{
+	NULL,		/* .next */
+	0,		/* .sync */
+	&sdla_poll,	/* .routine */
+	NULL		/* .data */
+}; 
+
+/******* Kernel Loadable Module Entry Points ********************************/
+
+/*============================================================================
+ * Module 'insert' entry point.
+ * o print announcement
+ * o allocate adapter data space
+ * o initialize static data
+ * o register all cards with WAN router
+ * o calibrate SDLA shared memory access delay.
+ *
+ * Return:	0	Ok
+ *		< 0	error.
+ * Context:	process
+ */
+ 
+#ifdef MODULE
+int init_module (void)
+#else
+int __init wanpipe_init(void)
+#endif
+{
+	int cnt, err = 0;
+
+	printk(KERN_INFO "%s v%u.%u %s\n",
+		fullname, DRV_VERSION, DRV_RELEASE, copyright)
+	;
+
+	/* 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
+	;
+	memset(card_array, 0, sizeof(sdla_t) * ncards);
+
+	/* Register adapters with WAN router */
+	for (cnt = 0; cnt < ncards; ++cnt)
+	{
+		sdla_t* card = &card_array[cnt];
+		wan_device_t* wandev = &card->wandev;
+
+		sprintf(card->devname, "%s%d", drvname, cnt + 1);
+		wandev->magic    = ROUTER_MAGIC;
+		wandev->name     = card->devname;
+		wandev->private  = card;
+		wandev->enable_tx_int = 0;
+		wandev->setup    = &setup;
+		wandev->shutdown = &shutdown;
+		wandev->ioctl    = &ioctl;
+		err = register_wan_device(wandev);
+		if (err)
+		{
+			printk(KERN_ERR
+				"%s: %s registration failed with error %d!\n",
+				drvname, card->devname, err)
+			;
+			break;
+		}
+	}
+	if (cnt)
+		ncards = cnt;	/* adjust actual number of cards */
+	else
+	{
+		kfree(card_array);
+		err = -ENODEV;
+	}
+	return err;
+}
+
+#ifdef MODULE
+/*============================================================================
+ * Module 'remove' entry point.
+ * o unregister all adapters from the WAN router
+ * o release all remaining system resources
+ */
+void cleanup_module (void)
+{
+	int i;
+
+	for (i = 0; i < ncards; ++i)
+	{
+		sdla_t* card = &card_array[i];
+		unregister_wan_device(card->devname);
+	}
+	kfree(card_array);
+}
+
+#endif
+
+/******* WAN Device Driver Entry Points *************************************/
+
+/*============================================================================
+ * Setup/confugure WAN link driver.
+ * o check adapter state
+ * o make sure firmware is present in configuration
+ * o make sure I/O port and IRQ are specified
+ * o make sure I/O region is available
+ * o allocate interrupt vector
+ * o setup SDLA hardware
+ * o call appropriate routine to perform protocol-specific initialization
+ * o mark I/O region as used
+ * o if this is the first active card, then schedule background task
+ *
+ * This function is called when router handles ROUTER_SETUP IOCTL. The
+ * configuration structure is in kernel memory (including extended data, if
+ * any).
+ */
+ 
+static int setup (wan_device_t* wandev, wandev_conf_t* conf)
+{
+	sdla_t* card;
+	int err = 0;
+	int irq;
+
+	/* Sanity checks */
+	if ((wandev == NULL) || (wandev->private == NULL) || (conf == NULL))
+		return -EFAULT;
+		
+	card = wandev->private;
+	if (wandev->state != WAN_UNCONFIGURED)
+		return -EBUSY;		/* already configured */
+
+	if (!conf->data_size || (conf->data == NULL))
+	{
+		printk(KERN_ERR
+			"%s: firmware not found in configuration data!\n",
+			wandev->name);
+		return -EINVAL;
+	}
+	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;
+	}
+
+	/* Make sure I/O port region is available */
+	if (check_region(conf->ioport, SDLA_MAXIORANGE))
+	{
+		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;
+	}
+
+	/* Allocate IRQ */
+	irq = (conf->irq == 2) ? 9 : conf->irq;	/* IRQ2 -> IRQ9 */
+	if (request_irq(irq, sdla_isr, 0, wandev->name, card))
+	{
+		printk(KERN_ERR "%s: can't reserve IRQ %d!\n",
+			wandev->name, irq);
+		return -EINVAL;
+	}
+
+	/* Configure hardware, load firmware, etc. */
+	memset(&card->hw, 0, sizeof(sdlahw_t));
+	card->hw.port    = conf->ioport;
+	card->hw.irq     = (conf->irq == 9) ? 2 : conf->irq;
+	/* Compute the virtual address of the card in kernel space */
+	if(conf->maddr)
+		card->hw.dpmbase = phys_to_virt(conf->maddr);
+	else	/* But 0 means NULL */
+		card->hw.dpmbase = (void *)conf->maddr;
+
+	card->hw.dpmsize = SDLA_WINDOWSIZE;
+	card->hw.type    = conf->hw_opt[0];
+	card->hw.pclk    = conf->hw_opt[1];
+	err = sdla_setup(&card->hw, conf->data, conf->data_size);
+	if (err)
+	{
+		free_irq(irq, card);
+		return err;
+	}
+
+	/* Intialize WAN device data space */
+	wandev->irq       = irq;
+	wandev->dma       = 0;
+	wandev->ioport    = card->hw.port;
+	wandev->maddr     = card->hw.dpmbase;
+	wandev->msize     = card->hw.dpmsize;
+	wandev->hw_opt[0] = card->hw.type;
+	wandev->hw_opt[1] = card->hw.pclk;
+	wandev->hw_opt[2] = card->hw.memory;
+	wandev->hw_opt[3] = card->hw.fwid;
+
+	/* Protocol-specific initialization */
+	switch (card->hw.fwid)
+	{
+#ifdef	CONFIG_WANPIPE_X25
+	case SFID_X25_502:
+	case SFID_X25_508:
+		err = wpx_init(card, conf);
+		break;
+#endif
+
+#ifdef	CONFIG_WANPIPE_FR
+	case SFID_FR502:
+	case SFID_FR508:
+		err = wpf_init(card, conf);
+		break;
+#endif
+
+#ifdef	CONFIG_WANPIPE_PPP
+	case SFID_PPP502:
+	case SFID_PPP508:
+		err = wpp_init(card, conf);
+		break;
+#endif
+
+	default:
+		printk(KERN_ERR "%s: this firmware is not supported!\n",
+			wandev->name)
+		;
+		err = -EINVAL;
+	}
+	if (err)
+	{
+		sdla_down(&card->hw);
+		free_irq(irq, card);
+		return err;
+	}
+  	/* Reserve I/O region and schedule background task */
+/*	printk(KERN_INFO "about to request\n");*/
+	request_region(card->hw.port, card->hw.io_range, wandev->name);
+/*	printk(KERN_INFO "request done\n");*/
+	if (++active == 1)
+		queue_task(&sdla_tq, &tq_scheduler);
+		
+	wandev->critical = 0;
+	return 0;
+}
+
+/*============================================================================
+ * Shut down WAN link driver. 
+ * o shut down adapter hardware
+ * o release system resources.
+ *
+ * This function is called by the router when device is being unregistered or
+ * when it handles ROUTER_DOWN IOCTL.
+ */
+static int shutdown (wan_device_t* wandev)
+{
+	sdla_t* card;
+
+	/* sanity checks */
+	if ((wandev == NULL) || (wandev->private == NULL))
+		return -EFAULT;
+		
+	if (wandev->state == WAN_UNCONFIGURED)
+		return 0;
+		
+	/* If wee are in a critical section we lose */
+	if (test_and_set_bit(0, (void*)&wandev->critical))
+		return -EAGAIN;
+		
+	card = wandev->private;
+	wandev->state = WAN_UNCONFIGURED;
+
+	if (--active == 0)
+		schedule();	/* stop background thread */
+	
+/*	printk(KERN_INFO "active now %d\n", active);
+
+	printk(KERN_INFO "About to call sdla_down\n");*/
+	sdla_down(&card->hw);
+/*	printk(KERN_INFO "sdla_down done\n");
+	printk(KERN_INFO "About to call free_irq\n");*/
+	free_irq(wandev->irq, card);
+/*	printk(KERN_INFO "free_irq done\n");
+	printk(KERN_INFO "About to call release_region\n");*/
+	release_region(card->hw.port, card->hw.io_range);
+/*	printk(KERN_INFO "release_region done\n");*/
+	wandev->critical = 0;
+	return 0;
+}
+
+/*============================================================================
+ * Driver I/O control. 
+ * o verify arguments
+ * o perform requested action
+ *
+ * This function is called when router handles one of the reserved user
+ * IOCTLs.  Note that 'arg' stil points to user address space.
+ */
+static int ioctl (wan_device_t* wandev, unsigned cmd, unsigned long arg)
+{
+	int err;
+
+	/* sanity checks */
+	if ((wandev == NULL) || (wandev->private == NULL))
+		return -EFAULT
+	;
+	if (wandev->state == WAN_UNCONFIGURED)
+		return -ENODEV
+	;
+	if (test_and_set_bit(0, (void*)&wandev->critical))
+		return -EAGAIN
+	;
+	switch (cmd)
+	{
+	case WANPIPE_DUMP:
+		err = ioctl_dump(wandev->private, (void*)arg);
+		break;
+
+	case WANPIPE_EXEC:
+		err = ioctl_exec(wandev->private, (void*)arg);
+		break;
+
+	default:
+		err = -EINVAL;
+	}
+	wandev->critical = 0;
+	return err;
+}
+
+/****** Driver IOCTL Hanlers ************************************************/
+
+/*============================================================================
+ * Dump adapter memory to user buffer.
+ * o verify request structure
+ * o copy request structure to kernel data space
+ * o verify length/offset
+ * o verify user buffer
+ * o copy adapter memory image to user buffer
+ *
+ * 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)
+{
+	sdla_dump_t dump;
+	unsigned winsize;
+	unsigned long oldvec;	/* DPM window vector */
+	unsigned long flags;
+	int err = 0;
+
+	if(copy_from_user((void*)&dump, (void*)u_dump, sizeof(sdla_dump_t)))
+		return -EFAULT;
+		
+	if ((dump.magic != WANPIPE_MAGIC) ||
+	    (dump.offset + dump.length > card->hw.memory))
+		return -EINVAL;
+		
+	winsize = card->hw.dpmsize;
+	save_flags(flags);
+        cli();				/* >>> critical section start <<< */
+	oldvec = card->hw.vector;
+	while (dump.length)
+	{
+		unsigned pos = dump.offset % winsize;	/* current offset */
+		unsigned long vec = dump.offset - pos;	/* current vector */
+		unsigned len = (dump.length > (winsize - pos)) ?
+			(winsize - pos) : dump.length
+		;
+		if (sdla_mapmem(&card->hw, vec) != 0)	/* relocate window */
+		{
+			err = -EIO;
+			break;
+		}
+		/* FIXME::: COPY TO KERNEL BUFFER FIRST ?? */
+		sti();	/* Not ideal but tough we have to do this */
+		if(copy_to_user((void *)dump.ptr,
+			(u8 *)card->hw.dpmbase + pos, len))	
+			return -EFAULT;
+		cli();
+		dump.length     -= len;
+		dump.offset     += len;
+		(char*)dump.ptr += len;
+	}
+	sdla_mapmem(&card->hw, oldvec);	/* restore DPM window position */
+	restore_flags(flags);		/* >>> critical section end <<< */
+	return err;
+}
+
+/*============================================================================
+ * Execute adapter firmware command.
+ * o verify request structure
+ * 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)
+{
+	sdla_exec_t exec;
+
+	if (card->exec == NULL)
+		return -ENODEV;
+		
+	if(copy_from_user((void*)&exec, (void*)u_exec, sizeof(sdla_exec_t)))
+		return -EFAULT;
+	if ((exec.magic != WANPIPE_MAGIC) || (exec.cmd == NULL))
+		return -EINVAL;
+	return card->exec(card, exec.cmd, exec.data);
+}
+
+/******* Miscellaneous ******************************************************/
+
+/*============================================================================
+ * SDLA Interrupt Service Routine.
+ * o acknowledge SDLA hardware interrupt.
+ * o call protocol-specific interrupt service routine, if any.
+ */
+STATIC void sdla_isr (int irq, void* dev_id, struct pt_regs *regs)
+{
+#define	card	((sdla_t*)dev_id)
+
+	if (!card || (card->wandev.state == WAN_UNCONFIGURED))
+		return
+	;
+	if (card->in_isr)
+	{
+		printk(KERN_WARNING "%s: interrupt re-entrancy on IRQ %d!\n",
+			card->devname, card->wandev.irq)
+		;
+		return;
+	}
+
+	sdla_intack(&card->hw);
+	if (card->isr) 
+		card->isr(card);
+
+#undef	card
+}
+
+/*============================================================================
+ * 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)
+		queue_task(&sdla_tq, &tq_scheduler);
+}
+
+/*============================================================================
+ * 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
+ * defined more than once into the same kernel module.
+ */
+void wanpipe_open (sdla_t* card)
+{
+	++card->open_cnt;
+	MOD_INC_USE_COUNT;
+}
+
+/*============================================================================
+ * This routine is called by the protocol-specific modules when network
+ * interface is being closed.  The only reason we need this, is because we
+ * have to call MOD_DEC_USE_COUNT, but cannot include 'module.h' where it's
+ * defined more than once into the same kernel module.
+ */
+void wanpipe_close (sdla_t* card)
+{
+	--card->open_cnt;
+	MOD_DEC_USE_COUNT;
+}
+
+/*============================================================================
+ * Set WAN device state.
+ */
+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:
+			printk (KERN_INFO "%s: link connected!\n",
+				card->devname)
+			;
+			break;
+
+		case WAN_CONNECTING:
+			printk (KERN_INFO "%s: link connecting...\n",
+				card->devname)
+			;
+			break;
+
+		case WAN_DISCONNECTED:
+			printk (KERN_INFO "%s: link disconnected!\n",
+				card->devname)
+			;
+			break;
+		}
+		card->wandev.state = state;
+	}
+	card->state_tick = jiffies;
+	restore_flags(flags);
+}
+
+/****** End *****************************************************************/