2005-04-16 15:20:36 -07:00
|
|
|
/* $Id: module.c,v 1.14.6.4 2001/09/23 22:24:32 kai Exp $
|
|
|
|
*
|
|
|
|
* ISDN lowlevel-module for the IBM ISDN-S0 Active 2000.
|
|
|
|
*
|
|
|
|
* Author Fritz Elfert
|
|
|
|
* Copyright by Fritz Elfert <fritz@isdn4linux.de>
|
|
|
|
*
|
|
|
|
* This software may be used and distributed according to the terms
|
|
|
|
* of the GNU General Public License, incorporated herein by reference.
|
|
|
|
*
|
|
|
|
* Thanks to Friedemann Baitinger and IBM Germany
|
|
|
|
*
|
|
|
|
*/
|
|
|
|
|
|
|
|
#include "act2000.h"
|
|
|
|
#include "act2000_isa.h"
|
|
|
|
#include "capi.h"
|
|
|
|
#include <linux/module.h>
|
include cleanup: Update gfp.h and slab.h includes to prepare for breaking implicit slab.h inclusion from percpu.h
percpu.h is included by sched.h and module.h and thus ends up being
included when building most .c files. percpu.h includes slab.h which
in turn includes gfp.h making everything defined by the two files
universally available and complicating inclusion dependencies.
percpu.h -> slab.h dependency is about to be removed. Prepare for
this change by updating users of gfp and slab facilities include those
headers directly instead of assuming availability. As this conversion
needs to touch large number of source files, the following script is
used as the basis of conversion.
http://userweb.kernel.org/~tj/misc/slabh-sweep.py
The script does the followings.
* Scan files for gfp and slab usages and update includes such that
only the necessary includes are there. ie. if only gfp is used,
gfp.h, if slab is used, slab.h.
* When the script inserts a new include, it looks at the include
blocks and try to put the new include such that its order conforms
to its surrounding. It's put in the include block which contains
core kernel includes, in the same order that the rest are ordered -
alphabetical, Christmas tree, rev-Xmas-tree or at the end if there
doesn't seem to be any matching order.
* If the script can't find a place to put a new include (mostly
because the file doesn't have fitting include block), it prints out
an error message indicating which .h file needs to be added to the
file.
The conversion was done in the following steps.
1. The initial automatic conversion of all .c files updated slightly
over 4000 files, deleting around 700 includes and adding ~480 gfp.h
and ~3000 slab.h inclusions. The script emitted errors for ~400
files.
2. Each error was manually checked. Some didn't need the inclusion,
some needed manual addition while adding it to implementation .h or
embedding .c file was more appropriate for others. This step added
inclusions to around 150 files.
3. The script was run again and the output was compared to the edits
from #2 to make sure no file was left behind.
4. Several build tests were done and a couple of problems were fixed.
e.g. lib/decompress_*.c used malloc/free() wrappers around slab
APIs requiring slab.h to be added manually.
5. The script was run on all .h files but without automatically
editing them as sprinkling gfp.h and slab.h inclusions around .h
files could easily lead to inclusion dependency hell. Most gfp.h
inclusion directives were ignored as stuff from gfp.h was usually
wildly available and often used in preprocessor macros. Each
slab.h inclusion directive was examined and added manually as
necessary.
6. percpu.h was updated not to include slab.h.
7. Build test were done on the following configurations and failures
were fixed. CONFIG_GCOV_KERNEL was turned off for all tests (as my
distributed build env didn't work with gcov compiles) and a few
more options had to be turned off depending on archs to make things
build (like ipr on powerpc/64 which failed due to missing writeq).
* x86 and x86_64 UP and SMP allmodconfig and a custom test config.
* powerpc and powerpc64 SMP allmodconfig
* sparc and sparc64 SMP allmodconfig
* ia64 SMP allmodconfig
* s390 SMP allmodconfig
* alpha SMP allmodconfig
* um on x86_64 SMP allmodconfig
8. percpu.h modifications were reverted so that it could be applied as
a separate patch and serve as bisection point.
Given the fact that I had only a couple of failures from tests on step
6, I'm fairly confident about the coverage of this conversion patch.
If there is a breakage, it's likely to be something in one of the arch
headers which should be easily discoverable easily on most builds of
the specific arch.
Signed-off-by: Tejun Heo <tj@kernel.org>
Guess-its-ok-by: Christoph Lameter <cl@linux-foundation.org>
Cc: Ingo Molnar <mingo@redhat.com>
Cc: Lee Schermerhorn <Lee.Schermerhorn@hp.com>
2010-03-24 01:04:11 -07:00
|
|
|
#include <linux/slab.h>
|
2005-04-16 15:20:36 -07:00
|
|
|
#include <linux/init.h>
|
|
|
|
|
|
|
|
static unsigned short act2000_isa_ports[] =
|
|
|
|
{
|
|
|
|
0x0200, 0x0240, 0x0280, 0x02c0, 0x0300, 0x0340, 0x0380,
|
|
|
|
0xcfe0, 0xcfa0, 0xcf60, 0xcf20, 0xcee0, 0xcea0, 0xce60,
|
|
|
|
};
|
|
|
|
|
|
|
|
static act2000_card *cards = (act2000_card *) NULL;
|
|
|
|
|
|
|
|
/* Parameters to be set by insmod */
|
|
|
|
static int act_bus = 0;
|
|
|
|
static int act_port = -1; /* -1 = Autoprobe */
|
|
|
|
static int act_irq = -1;
|
|
|
|
static char *act_id = "\0\0\0\0\0\0\0\0\0\0\0\0\0\0\0\0";
|
|
|
|
|
|
|
|
MODULE_DESCRIPTION( "ISDN4Linux: Driver for IBM Active 2000 ISDN card");
|
|
|
|
MODULE_AUTHOR( "Fritz Elfert");
|
|
|
|
MODULE_LICENSE( "GPL");
|
|
|
|
MODULE_PARM_DESC(act_bus, "BusType of first card, 1=ISA, 2=MCA, 3=PCMCIA, currently only ISA");
|
|
|
|
MODULE_PARM_DESC(membase, "Base port address of first card");
|
|
|
|
MODULE_PARM_DESC(act_irq, "IRQ of first card");
|
|
|
|
MODULE_PARM_DESC(act_id, "ID-String of first card");
|
|
|
|
module_param(act_bus, int, 0);
|
|
|
|
module_param(act_port, int, 0);
|
|
|
|
module_param(act_irq, int, 0);
|
|
|
|
module_param(act_id, charp, 0);
|
|
|
|
|
|
|
|
static int act2000_addcard(int, int, int, char *);
|
|
|
|
|
|
|
|
static act2000_chan *
|
|
|
|
find_channel(act2000_card *card, int channel)
|
|
|
|
{
|
|
|
|
if ((channel >= 0) && (channel < ACT2000_BCH))
|
|
|
|
return &(card->bch[channel]);
|
|
|
|
printk(KERN_WARNING "act2000: Invalid channel %d\n", channel);
|
|
|
|
return NULL;
|
|
|
|
}
|
|
|
|
|
|
|
|
/*
|
|
|
|
* Free MSN list
|
|
|
|
*/
|
|
|
|
static void
|
|
|
|
act2000_clear_msn(act2000_card *card)
|
|
|
|
{
|
|
|
|
struct msn_entry *p = card->msn_list;
|
|
|
|
struct msn_entry *q;
|
|
|
|
unsigned long flags;
|
|
|
|
|
|
|
|
spin_lock_irqsave(&card->lock, flags);
|
|
|
|
card->msn_list = NULL;
|
|
|
|
spin_unlock_irqrestore(&card->lock, flags);
|
|
|
|
while (p) {
|
|
|
|
q = p->next;
|
|
|
|
kfree(p);
|
|
|
|
p = q;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
/*
|
|
|
|
* Find an MSN entry in the list.
|
|
|
|
* If ia5 != 0, return IA5-encoded EAZ, else
|
|
|
|
* return a bitmask with corresponding bit set.
|
|
|
|
*/
|
|
|
|
static __u16
|
|
|
|
act2000_find_msn(act2000_card *card, char *msn, int ia5)
|
|
|
|
{
|
|
|
|
struct msn_entry *p = card->msn_list;
|
|
|
|
__u8 eaz = '0';
|
|
|
|
|
|
|
|
while (p) {
|
|
|
|
if (!strcmp(p->msn, msn)) {
|
|
|
|
eaz = p->eaz;
|
|
|
|
break;
|
|
|
|
}
|
|
|
|
p = p->next;
|
|
|
|
}
|
|
|
|
if (!ia5)
|
|
|
|
return (1 << (eaz - '0'));
|
|
|
|
else
|
|
|
|
return eaz;
|
|
|
|
}
|
|
|
|
|
|
|
|
/*
|
|
|
|
* Find an EAZ entry in the list.
|
|
|
|
* return a string with corresponding msn.
|
|
|
|
*/
|
|
|
|
char *
|
|
|
|
act2000_find_eaz(act2000_card *card, char eaz)
|
|
|
|
{
|
|
|
|
struct msn_entry *p = card->msn_list;
|
|
|
|
|
|
|
|
while (p) {
|
|
|
|
if (p->eaz == eaz)
|
|
|
|
return(p->msn);
|
|
|
|
p = p->next;
|
|
|
|
}
|
|
|
|
return("\0");
|
|
|
|
}
|
|
|
|
|
|
|
|
/*
|
|
|
|
* Add or delete an MSN to the MSN list
|
|
|
|
*
|
|
|
|
* First character of msneaz is EAZ, rest is MSN.
|
|
|
|
* If length of eazmsn is 1, delete that entry.
|
|
|
|
*/
|
|
|
|
static int
|
|
|
|
act2000_set_msn(act2000_card *card, char *eazmsn)
|
|
|
|
{
|
|
|
|
struct msn_entry *p = card->msn_list;
|
|
|
|
struct msn_entry *q = NULL;
|
|
|
|
unsigned long flags;
|
|
|
|
int i;
|
|
|
|
|
|
|
|
if (!strlen(eazmsn))
|
|
|
|
return 0;
|
|
|
|
if (strlen(eazmsn) > 16)
|
|
|
|
return -EINVAL;
|
|
|
|
for (i = 0; i < strlen(eazmsn); i++)
|
|
|
|
if (!isdigit(eazmsn[i]))
|
|
|
|
return -EINVAL;
|
|
|
|
if (strlen(eazmsn) == 1) {
|
|
|
|
/* Delete a single MSN */
|
|
|
|
while (p) {
|
|
|
|
if (p->eaz == eazmsn[0]) {
|
|
|
|
spin_lock_irqsave(&card->lock, flags);
|
|
|
|
if (q)
|
|
|
|
q->next = p->next;
|
|
|
|
else
|
|
|
|
card->msn_list = p->next;
|
|
|
|
spin_unlock_irqrestore(&card->lock, flags);
|
|
|
|
kfree(p);
|
|
|
|
printk(KERN_DEBUG
|
|
|
|
"Mapping for EAZ %c deleted\n",
|
|
|
|
eazmsn[0]);
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
q = p;
|
|
|
|
p = p->next;
|
|
|
|
}
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
/* Add a single MSN */
|
|
|
|
while (p) {
|
|
|
|
/* Found in list, replace MSN */
|
|
|
|
if (p->eaz == eazmsn[0]) {
|
|
|
|
spin_lock_irqsave(&card->lock, flags);
|
|
|
|
strcpy(p->msn, &eazmsn[1]);
|
|
|
|
spin_unlock_irqrestore(&card->lock, flags);
|
|
|
|
printk(KERN_DEBUG
|
|
|
|
"Mapping for EAZ %c changed to %s\n",
|
|
|
|
eazmsn[0],
|
|
|
|
&eazmsn[1]);
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
p = p->next;
|
|
|
|
}
|
|
|
|
/* Not found in list, add new entry */
|
|
|
|
p = kmalloc(sizeof(msn_entry), GFP_KERNEL);
|
|
|
|
if (!p)
|
|
|
|
return -ENOMEM;
|
|
|
|
p->eaz = eazmsn[0];
|
|
|
|
strcpy(p->msn, &eazmsn[1]);
|
|
|
|
p->next = card->msn_list;
|
|
|
|
spin_lock_irqsave(&card->lock, flags);
|
|
|
|
card->msn_list = p;
|
|
|
|
spin_unlock_irqrestore(&card->lock, flags);
|
|
|
|
printk(KERN_DEBUG
|
|
|
|
"Mapping %c -> %s added\n",
|
|
|
|
eazmsn[0],
|
|
|
|
&eazmsn[1]);
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
static void
|
2006-11-22 07:57:56 -07:00
|
|
|
act2000_transmit(struct work_struct *work)
|
2005-04-16 15:20:36 -07:00
|
|
|
{
|
2006-11-22 07:57:56 -07:00
|
|
|
struct act2000_card *card =
|
|
|
|
container_of(work, struct act2000_card, snd_tq);
|
|
|
|
|
2005-04-16 15:20:36 -07:00
|
|
|
switch (card->bus) {
|
|
|
|
case ACT2000_BUS_ISA:
|
|
|
|
act2000_isa_send(card);
|
|
|
|
break;
|
|
|
|
case ACT2000_BUS_PCMCIA:
|
|
|
|
case ACT2000_BUS_MCA:
|
|
|
|
default:
|
|
|
|
printk(KERN_WARNING
|
|
|
|
"act2000_transmit: Illegal bustype %d\n", card->bus);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
static void
|
2006-11-22 07:57:56 -07:00
|
|
|
act2000_receive(struct work_struct *work)
|
2005-04-16 15:20:36 -07:00
|
|
|
{
|
2006-11-22 07:57:56 -07:00
|
|
|
struct act2000_card *card =
|
|
|
|
container_of(work, struct act2000_card, poll_tq);
|
|
|
|
|
2005-04-16 15:20:36 -07:00
|
|
|
switch (card->bus) {
|
|
|
|
case ACT2000_BUS_ISA:
|
|
|
|
act2000_isa_receive(card);
|
|
|
|
break;
|
|
|
|
case ACT2000_BUS_PCMCIA:
|
|
|
|
case ACT2000_BUS_MCA:
|
|
|
|
default:
|
|
|
|
printk(KERN_WARNING
|
|
|
|
"act2000_receive: Illegal bustype %d\n", card->bus);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
static void
|
|
|
|
act2000_poll(unsigned long data)
|
|
|
|
{
|
|
|
|
act2000_card * card = (act2000_card *)data;
|
|
|
|
unsigned long flags;
|
|
|
|
|
2006-11-22 07:57:56 -07:00
|
|
|
act2000_receive(&card->poll_tq);
|
2005-04-16 15:20:36 -07:00
|
|
|
spin_lock_irqsave(&card->lock, flags);
|
|
|
|
mod_timer(&card->ptimer, jiffies+3);
|
|
|
|
spin_unlock_irqrestore(&card->lock, flags);
|
|
|
|
}
|
|
|
|
|
|
|
|
static int
|
|
|
|
act2000_command(act2000_card * card, isdn_ctrl * c)
|
|
|
|
{
|
|
|
|
ulong a;
|
|
|
|
act2000_chan *chan;
|
|
|
|
act2000_cdef cdef;
|
|
|
|
isdn_ctrl cmd;
|
|
|
|
char tmp[17];
|
|
|
|
int ret;
|
|
|
|
unsigned long flags;
|
|
|
|
void __user *arg;
|
|
|
|
|
|
|
|
switch (c->command) {
|
|
|
|
case ISDN_CMD_IOCTL:
|
|
|
|
memcpy(&a, c->parm.num, sizeof(ulong));
|
|
|
|
arg = (void __user *)a;
|
|
|
|
switch (c->arg) {
|
|
|
|
case ACT2000_IOCTL_LOADBOOT:
|
|
|
|
switch (card->bus) {
|
|
|
|
case ACT2000_BUS_ISA:
|
|
|
|
ret = act2000_isa_download(card,
|
|
|
|
arg);
|
|
|
|
if (!ret) {
|
|
|
|
card->flags |= ACT2000_FLAGS_LOADED;
|
|
|
|
if (!(card->flags & ACT2000_FLAGS_IVALID)) {
|
|
|
|
card->ptimer.expires = jiffies + 3;
|
|
|
|
card->ptimer.function = act2000_poll;
|
|
|
|
card->ptimer.data = (unsigned long)card;
|
|
|
|
add_timer(&card->ptimer);
|
|
|
|
}
|
|
|
|
actcapi_manufacturer_req_errh(card);
|
|
|
|
}
|
|
|
|
break;
|
|
|
|
default:
|
|
|
|
printk(KERN_WARNING
|
|
|
|
"act2000: Illegal BUS type %d\n",
|
|
|
|
card->bus);
|
|
|
|
ret = -EIO;
|
|
|
|
}
|
|
|
|
return ret;
|
|
|
|
case ACT2000_IOCTL_SETPROTO:
|
|
|
|
card->ptype = a?ISDN_PTYPE_EURO:ISDN_PTYPE_1TR6;
|
|
|
|
if (!(card->flags & ACT2000_FLAGS_RUNNING))
|
|
|
|
return 0;
|
|
|
|
actcapi_manufacturer_req_net(card);
|
|
|
|
return 0;
|
|
|
|
case ACT2000_IOCTL_SETMSN:
|
|
|
|
if (copy_from_user(tmp, arg,
|
|
|
|
sizeof(tmp)))
|
|
|
|
return -EFAULT;
|
|
|
|
if ((ret = act2000_set_msn(card, tmp)))
|
|
|
|
return ret;
|
|
|
|
if (card->flags & ACT2000_FLAGS_RUNNING)
|
|
|
|
return(actcapi_manufacturer_req_msn(card));
|
|
|
|
return 0;
|
|
|
|
case ACT2000_IOCTL_ADDCARD:
|
|
|
|
if (copy_from_user(&cdef, arg,
|
|
|
|
sizeof(cdef)))
|
|
|
|
return -EFAULT;
|
|
|
|
if (act2000_addcard(cdef.bus, cdef.port, cdef.irq, cdef.id))
|
|
|
|
return -EIO;
|
|
|
|
return 0;
|
|
|
|
case ACT2000_IOCTL_TEST:
|
|
|
|
if (!(card->flags & ACT2000_FLAGS_RUNNING))
|
|
|
|
return -ENODEV;
|
|
|
|
return 0;
|
|
|
|
default:
|
|
|
|
return -EINVAL;
|
|
|
|
}
|
|
|
|
break;
|
|
|
|
case ISDN_CMD_DIAL:
|
2008-02-06 02:36:06 -07:00
|
|
|
if (!(card->flags & ACT2000_FLAGS_RUNNING))
|
2005-04-16 15:20:36 -07:00
|
|
|
return -ENODEV;
|
|
|
|
if (!(chan = find_channel(card, c->arg & 0x0f)))
|
|
|
|
break;
|
|
|
|
spin_lock_irqsave(&card->lock, flags);
|
|
|
|
if (chan->fsm_state != ACT2000_STATE_NULL) {
|
|
|
|
spin_unlock_irqrestore(&card->lock, flags);
|
|
|
|
printk(KERN_WARNING "Dial on channel with state %d\n",
|
|
|
|
chan->fsm_state);
|
|
|
|
return -EBUSY;
|
|
|
|
}
|
|
|
|
if (card->ptype == ISDN_PTYPE_EURO)
|
|
|
|
tmp[0] = act2000_find_msn(card, c->parm.setup.eazmsn, 1);
|
|
|
|
else
|
|
|
|
tmp[0] = c->parm.setup.eazmsn[0];
|
|
|
|
chan->fsm_state = ACT2000_STATE_OCALL;
|
|
|
|
chan->callref = 0xffff;
|
|
|
|
spin_unlock_irqrestore(&card->lock, flags);
|
|
|
|
ret = actcapi_connect_req(card, chan, c->parm.setup.phone,
|
|
|
|
tmp[0], c->parm.setup.si1,
|
|
|
|
c->parm.setup.si2);
|
|
|
|
if (ret) {
|
|
|
|
cmd.driver = card->myid;
|
|
|
|
cmd.command = ISDN_STAT_DHUP;
|
|
|
|
cmd.arg &= 0x0f;
|
|
|
|
card->interface.statcallb(&cmd);
|
|
|
|
}
|
|
|
|
return ret;
|
|
|
|
case ISDN_CMD_ACCEPTD:
|
2008-02-06 02:36:06 -07:00
|
|
|
if (!(card->flags & ACT2000_FLAGS_RUNNING))
|
2005-04-16 15:20:36 -07:00
|
|
|
return -ENODEV;
|
|
|
|
if (!(chan = find_channel(card, c->arg & 0x0f)))
|
|
|
|
break;
|
|
|
|
if (chan->fsm_state == ACT2000_STATE_ICALL)
|
|
|
|
actcapi_select_b2_protocol_req(card, chan);
|
|
|
|
return 0;
|
|
|
|
case ISDN_CMD_ACCEPTB:
|
2008-02-06 02:36:06 -07:00
|
|
|
if (!(card->flags & ACT2000_FLAGS_RUNNING))
|
2005-04-16 15:20:36 -07:00
|
|
|
return -ENODEV;
|
|
|
|
return 0;
|
|
|
|
case ISDN_CMD_HANGUP:
|
2008-02-06 02:36:06 -07:00
|
|
|
if (!(card->flags & ACT2000_FLAGS_RUNNING))
|
2005-04-16 15:20:36 -07:00
|
|
|
return -ENODEV;
|
|
|
|
if (!(chan = find_channel(card, c->arg & 0x0f)))
|
|
|
|
break;
|
|
|
|
switch (chan->fsm_state) {
|
|
|
|
case ACT2000_STATE_ICALL:
|
|
|
|
case ACT2000_STATE_BSETUP:
|
|
|
|
actcapi_connect_resp(card, chan, 0x15);
|
|
|
|
break;
|
|
|
|
case ACT2000_STATE_ACTIVE:
|
|
|
|
actcapi_disconnect_b3_req(card, chan);
|
|
|
|
break;
|
|
|
|
}
|
|
|
|
return 0;
|
|
|
|
case ISDN_CMD_SETEAZ:
|
2008-02-06 02:36:06 -07:00
|
|
|
if (!(card->flags & ACT2000_FLAGS_RUNNING))
|
2005-04-16 15:20:36 -07:00
|
|
|
return -ENODEV;
|
|
|
|
if (!(chan = find_channel(card, c->arg & 0x0f)))
|
|
|
|
break;
|
|
|
|
if (strlen(c->parm.num)) {
|
|
|
|
if (card->ptype == ISDN_PTYPE_EURO) {
|
|
|
|
chan->eazmask = act2000_find_msn(card, c->parm.num, 0);
|
|
|
|
}
|
|
|
|
if (card->ptype == ISDN_PTYPE_1TR6) {
|
|
|
|
int i;
|
|
|
|
chan->eazmask = 0;
|
|
|
|
for (i = 0; i < strlen(c->parm.num); i++)
|
|
|
|
if (isdigit(c->parm.num[i]))
|
|
|
|
chan->eazmask |= (1 << (c->parm.num[i] - '0'));
|
|
|
|
}
|
|
|
|
} else
|
|
|
|
chan->eazmask = 0x3ff;
|
|
|
|
actcapi_listen_req(card);
|
|
|
|
return 0;
|
|
|
|
case ISDN_CMD_CLREAZ:
|
2008-02-06 02:36:06 -07:00
|
|
|
if (!(card->flags & ACT2000_FLAGS_RUNNING))
|
2005-04-16 15:20:36 -07:00
|
|
|
return -ENODEV;
|
|
|
|
if (!(chan = find_channel(card, c->arg & 0x0f)))
|
|
|
|
break;
|
|
|
|
chan->eazmask = 0;
|
|
|
|
actcapi_listen_req(card);
|
|
|
|
return 0;
|
|
|
|
case ISDN_CMD_SETL2:
|
2008-02-06 02:36:06 -07:00
|
|
|
if (!(card->flags & ACT2000_FLAGS_RUNNING))
|
2005-04-16 15:20:36 -07:00
|
|
|
return -ENODEV;
|
|
|
|
if (!(chan = find_channel(card, c->arg & 0x0f)))
|
|
|
|
break;
|
|
|
|
chan->l2prot = (c->arg >> 8);
|
|
|
|
return 0;
|
|
|
|
case ISDN_CMD_SETL3:
|
2008-02-06 02:36:06 -07:00
|
|
|
if (!(card->flags & ACT2000_FLAGS_RUNNING))
|
2005-04-16 15:20:36 -07:00
|
|
|
return -ENODEV;
|
|
|
|
if ((c->arg >> 8) != ISDN_PROTO_L3_TRANS) {
|
|
|
|
printk(KERN_WARNING "L3 protocol unknown\n");
|
|
|
|
return -1;
|
|
|
|
}
|
|
|
|
if (!(chan = find_channel(card, c->arg & 0x0f)))
|
|
|
|
break;
|
|
|
|
chan->l3prot = (c->arg >> 8);
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
return -EINVAL;
|
|
|
|
}
|
|
|
|
|
|
|
|
static int
|
|
|
|
act2000_sendbuf(act2000_card *card, int channel, int ack, struct sk_buff *skb)
|
|
|
|
{
|
|
|
|
struct sk_buff *xmit_skb;
|
|
|
|
int len;
|
|
|
|
act2000_chan *chan;
|
|
|
|
actcapi_msg *msg;
|
|
|
|
|
|
|
|
if (!(chan = find_channel(card, channel)))
|
|
|
|
return -1;
|
|
|
|
if (chan->fsm_state != ACT2000_STATE_ACTIVE)
|
|
|
|
return -1;
|
|
|
|
len = skb->len;
|
|
|
|
if ((chan->queued + len) >= ACT2000_MAX_QUEUED)
|
|
|
|
return 0;
|
|
|
|
if (!len)
|
|
|
|
return 0;
|
|
|
|
if (skb_headroom(skb) < 19) {
|
|
|
|
printk(KERN_WARNING "act2000_sendbuf: Headroom only %d\n",
|
|
|
|
skb_headroom(skb));
|
|
|
|
xmit_skb = alloc_skb(len + 19, GFP_ATOMIC);
|
|
|
|
if (!xmit_skb) {
|
|
|
|
printk(KERN_WARNING "act2000_sendbuf: Out of memory\n");
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
skb_reserve(xmit_skb, 19);
|
2007-03-27 14:55:52 -07:00
|
|
|
skb_copy_from_linear_data(skb, skb_put(xmit_skb, len), len);
|
2005-04-16 15:20:36 -07:00
|
|
|
} else {
|
|
|
|
xmit_skb = skb_clone(skb, GFP_ATOMIC);
|
|
|
|
if (!xmit_skb) {
|
|
|
|
printk(KERN_WARNING "act2000_sendbuf: Out of memory\n");
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
dev_kfree_skb(skb);
|
|
|
|
msg = (actcapi_msg *)skb_push(xmit_skb, 19);
|
|
|
|
msg->hdr.len = 19 + len;
|
|
|
|
msg->hdr.applicationID = 1;
|
|
|
|
msg->hdr.cmd.cmd = 0x86;
|
|
|
|
msg->hdr.cmd.subcmd = 0x00;
|
|
|
|
msg->hdr.msgnum = actcapi_nextsmsg(card);
|
|
|
|
msg->msg.data_b3_req.datalen = len;
|
|
|
|
msg->msg.data_b3_req.blocknr = (msg->hdr.msgnum & 0xff);
|
|
|
|
msg->msg.data_b3_req.fakencci = MAKE_NCCI(chan->plci, 0, chan->ncci);
|
|
|
|
msg->msg.data_b3_req.flags = ack; /* Will be set to 0 on actual sending */
|
|
|
|
actcapi_debug_msg(xmit_skb, 1);
|
|
|
|
chan->queued += len;
|
|
|
|
skb_queue_tail(&card->sndq, xmit_skb);
|
|
|
|
act2000_schedule_tx(card);
|
|
|
|
return len;
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
/* Read the Status-replies from the Interface */
|
|
|
|
static int
|
|
|
|
act2000_readstatus(u_char __user * buf, int len, act2000_card * card)
|
|
|
|
{
|
|
|
|
int count;
|
|
|
|
u_char __user *p;
|
|
|
|
|
|
|
|
for (p = buf, count = 0; count < len; p++, count++) {
|
|
|
|
if (card->status_buf_read == card->status_buf_write)
|
|
|
|
return count;
|
|
|
|
put_user(*card->status_buf_read++, p);
|
|
|
|
if (card->status_buf_read > card->status_buf_end)
|
|
|
|
card->status_buf_read = card->status_buf;
|
|
|
|
}
|
|
|
|
return count;
|
|
|
|
}
|
|
|
|
|
|
|
|
/*
|
|
|
|
* Find card with given driverId
|
|
|
|
*/
|
|
|
|
static inline act2000_card *
|
|
|
|
act2000_findcard(int driverid)
|
|
|
|
{
|
|
|
|
act2000_card *p = cards;
|
|
|
|
|
|
|
|
while (p) {
|
|
|
|
if (p->myid == driverid)
|
|
|
|
return p;
|
|
|
|
p = p->next;
|
|
|
|
}
|
|
|
|
return (act2000_card *) 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
/*
|
|
|
|
* Wrapper functions for interface to linklevel
|
|
|
|
*/
|
|
|
|
static int
|
|
|
|
if_command(isdn_ctrl * c)
|
|
|
|
{
|
|
|
|
act2000_card *card = act2000_findcard(c->driver);
|
|
|
|
|
|
|
|
if (card)
|
|
|
|
return (act2000_command(card, c));
|
|
|
|
printk(KERN_ERR
|
|
|
|
"act2000: if_command %d called with invalid driverId %d!\n",
|
|
|
|
c->command, c->driver);
|
|
|
|
return -ENODEV;
|
|
|
|
}
|
|
|
|
|
|
|
|
static int
|
|
|
|
if_writecmd(const u_char __user *buf, int len, int id, int channel)
|
|
|
|
{
|
|
|
|
act2000_card *card = act2000_findcard(id);
|
|
|
|
|
|
|
|
if (card) {
|
2008-02-06 02:36:06 -07:00
|
|
|
if (!(card->flags & ACT2000_FLAGS_RUNNING))
|
2005-04-16 15:20:36 -07:00
|
|
|
return -ENODEV;
|
|
|
|
return (len);
|
|
|
|
}
|
|
|
|
printk(KERN_ERR
|
|
|
|
"act2000: if_writecmd called with invalid driverId!\n");
|
|
|
|
return -ENODEV;
|
|
|
|
}
|
|
|
|
|
|
|
|
static int
|
|
|
|
if_readstatus(u_char __user * buf, int len, int id, int channel)
|
|
|
|
{
|
|
|
|
act2000_card *card = act2000_findcard(id);
|
|
|
|
|
|
|
|
if (card) {
|
2008-02-06 02:36:06 -07:00
|
|
|
if (!(card->flags & ACT2000_FLAGS_RUNNING))
|
2005-04-16 15:20:36 -07:00
|
|
|
return -ENODEV;
|
|
|
|
return (act2000_readstatus(buf, len, card));
|
|
|
|
}
|
|
|
|
printk(KERN_ERR
|
|
|
|
"act2000: if_readstatus called with invalid driverId!\n");
|
|
|
|
return -ENODEV;
|
|
|
|
}
|
|
|
|
|
|
|
|
static int
|
|
|
|
if_sendbuf(int id, int channel, int ack, struct sk_buff *skb)
|
|
|
|
{
|
|
|
|
act2000_card *card = act2000_findcard(id);
|
|
|
|
|
|
|
|
if (card) {
|
2008-02-06 02:36:06 -07:00
|
|
|
if (!(card->flags & ACT2000_FLAGS_RUNNING))
|
2005-04-16 15:20:36 -07:00
|
|
|
return -ENODEV;
|
|
|
|
return (act2000_sendbuf(card, channel, ack, skb));
|
|
|
|
}
|
|
|
|
printk(KERN_ERR
|
|
|
|
"act2000: if_sendbuf called with invalid driverId!\n");
|
|
|
|
return -ENODEV;
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
/*
|
|
|
|
* Allocate a new card-struct, initialize it
|
|
|
|
* link it into cards-list.
|
|
|
|
*/
|
|
|
|
static void
|
|
|
|
act2000_alloccard(int bus, int port, int irq, char *id)
|
|
|
|
{
|
|
|
|
int i;
|
|
|
|
act2000_card *card;
|
2006-12-08 03:39:35 -07:00
|
|
|
if (!(card = kzalloc(sizeof(act2000_card), GFP_KERNEL))) {
|
2005-04-16 15:20:36 -07:00
|
|
|
printk(KERN_WARNING
|
|
|
|
"act2000: (%s) Could not allocate card-struct.\n", id);
|
|
|
|
return;
|
|
|
|
}
|
|
|
|
spin_lock_init(&card->lock);
|
|
|
|
spin_lock_init(&card->mnlock);
|
|
|
|
skb_queue_head_init(&card->sndq);
|
|
|
|
skb_queue_head_init(&card->rcvq);
|
|
|
|
skb_queue_head_init(&card->ackq);
|
2006-11-22 07:57:56 -07:00
|
|
|
INIT_WORK(&card->snd_tq, act2000_transmit);
|
|
|
|
INIT_WORK(&card->rcv_tq, actcapi_dispatch);
|
|
|
|
INIT_WORK(&card->poll_tq, act2000_receive);
|
2005-04-16 15:20:36 -07:00
|
|
|
init_timer(&card->ptimer);
|
|
|
|
card->interface.owner = THIS_MODULE;
|
|
|
|
card->interface.channels = ACT2000_BCH;
|
|
|
|
card->interface.maxbufsize = 4000;
|
|
|
|
card->interface.command = if_command;
|
|
|
|
card->interface.writebuf_skb = if_sendbuf;
|
|
|
|
card->interface.writecmd = if_writecmd;
|
|
|
|
card->interface.readstat = if_readstatus;
|
|
|
|
card->interface.features =
|
|
|
|
ISDN_FEATURE_L2_X75I |
|
|
|
|
ISDN_FEATURE_L2_HDLC |
|
|
|
|
ISDN_FEATURE_L3_TRANS |
|
|
|
|
ISDN_FEATURE_P_UNKNOWN;
|
|
|
|
card->interface.hl_hdrlen = 20;
|
|
|
|
card->ptype = ISDN_PTYPE_EURO;
|
|
|
|
strlcpy(card->interface.id, id, sizeof(card->interface.id));
|
|
|
|
for (i=0; i<ACT2000_BCH; i++) {
|
|
|
|
card->bch[i].plci = 0x8000;
|
|
|
|
card->bch[i].ncci = 0x8000;
|
|
|
|
card->bch[i].l2prot = ISDN_PROTO_L2_X75I;
|
|
|
|
card->bch[i].l3prot = ISDN_PROTO_L3_TRANS;
|
|
|
|
}
|
|
|
|
card->myid = -1;
|
|
|
|
card->bus = bus;
|
|
|
|
card->port = port;
|
|
|
|
card->irq = irq;
|
|
|
|
card->next = cards;
|
|
|
|
cards = card;
|
|
|
|
}
|
|
|
|
|
|
|
|
/*
|
|
|
|
* register card at linklevel
|
|
|
|
*/
|
|
|
|
static int
|
|
|
|
act2000_registercard(act2000_card * card)
|
|
|
|
{
|
|
|
|
switch (card->bus) {
|
|
|
|
case ACT2000_BUS_ISA:
|
|
|
|
break;
|
|
|
|
case ACT2000_BUS_MCA:
|
|
|
|
case ACT2000_BUS_PCMCIA:
|
|
|
|
default:
|
|
|
|
printk(KERN_WARNING
|
|
|
|
"act2000: Illegal BUS type %d\n",
|
|
|
|
card->bus);
|
|
|
|
return -1;
|
|
|
|
}
|
|
|
|
if (!register_isdn(&card->interface)) {
|
|
|
|
printk(KERN_WARNING
|
|
|
|
"act2000: Unable to register %s\n",
|
|
|
|
card->interface.id);
|
|
|
|
return -1;
|
|
|
|
}
|
|
|
|
card->myid = card->interface.channels;
|
|
|
|
sprintf(card->regname, "act2000-isdn (%s)", card->interface.id);
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
static void
|
|
|
|
unregister_card(act2000_card * card)
|
|
|
|
{
|
|
|
|
isdn_ctrl cmd;
|
|
|
|
|
|
|
|
cmd.command = ISDN_STAT_UNLOAD;
|
|
|
|
cmd.driver = card->myid;
|
|
|
|
card->interface.statcallb(&cmd);
|
|
|
|
switch (card->bus) {
|
|
|
|
case ACT2000_BUS_ISA:
|
|
|
|
act2000_isa_release(card);
|
|
|
|
break;
|
|
|
|
case ACT2000_BUS_MCA:
|
|
|
|
case ACT2000_BUS_PCMCIA:
|
|
|
|
default:
|
|
|
|
printk(KERN_WARNING
|
|
|
|
"act2000: Invalid BUS type %d\n",
|
|
|
|
card->bus);
|
|
|
|
break;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
static int
|
|
|
|
act2000_addcard(int bus, int port, int irq, char *id)
|
|
|
|
{
|
|
|
|
act2000_card *p;
|
|
|
|
act2000_card *q = NULL;
|
|
|
|
int initialized;
|
|
|
|
int added = 0;
|
|
|
|
int failed = 0;
|
|
|
|
int i;
|
|
|
|
|
|
|
|
if (!bus)
|
|
|
|
bus = ACT2000_BUS_ISA;
|
|
|
|
if (port != -1) {
|
|
|
|
/* Port defined, do fixed setup */
|
|
|
|
act2000_alloccard(bus, port, irq, id);
|
|
|
|
} else {
|
|
|
|
/* No port defined, perform autoprobing.
|
|
|
|
* This may result in more than one card detected.
|
|
|
|
*/
|
|
|
|
switch (bus) {
|
2009-07-24 09:26:08 -07:00
|
|
|
case ACT2000_BUS_ISA:
|
|
|
|
for (i = 0; i < ARRAY_SIZE(act2000_isa_ports); i++)
|
|
|
|
if (act2000_isa_detect(act2000_isa_ports[i])) {
|
|
|
|
printk(KERN_INFO "act2000: Detected "
|
|
|
|
"ISA card at port 0x%x\n",
|
|
|
|
act2000_isa_ports[i]);
|
|
|
|
act2000_alloccard(bus,
|
|
|
|
act2000_isa_ports[i], irq, id);
|
|
|
|
}
|
|
|
|
break;
|
|
|
|
case ACT2000_BUS_MCA:
|
|
|
|
case ACT2000_BUS_PCMCIA:
|
|
|
|
default:
|
|
|
|
printk(KERN_WARNING
|
|
|
|
"act2000: addcard: Invalid BUS type %d\n", bus);
|
2005-04-16 15:20:36 -07:00
|
|
|
}
|
|
|
|
}
|
|
|
|
if (!cards)
|
|
|
|
return 1;
|
|
|
|
p = cards;
|
|
|
|
while (p) {
|
|
|
|
initialized = 0;
|
|
|
|
if (!p->interface.statcallb) {
|
|
|
|
/* Not yet registered.
|
|
|
|
* Try to register and activate it.
|
|
|
|
*/
|
|
|
|
added++;
|
|
|
|
switch (p->bus) {
|
|
|
|
case ACT2000_BUS_ISA:
|
|
|
|
if (act2000_isa_detect(p->port)) {
|
|
|
|
if (act2000_registercard(p))
|
|
|
|
break;
|
|
|
|
if (act2000_isa_config_port(p, p->port)) {
|
|
|
|
printk(KERN_WARNING
|
|
|
|
"act2000: Could not request port 0x%04x\n",
|
|
|
|
p->port);
|
|
|
|
unregister_card(p);
|
|
|
|
p->interface.statcallb = NULL;
|
|
|
|
break;
|
|
|
|
}
|
|
|
|
if (act2000_isa_config_irq(p, p->irq)) {
|
|
|
|
printk(KERN_INFO
|
|
|
|
"act2000: No IRQ available, fallback to polling\n");
|
|
|
|
/* Fall back to polled operation */
|
|
|
|
p->irq = 0;
|
|
|
|
}
|
|
|
|
printk(KERN_INFO
|
|
|
|
"act2000: ISA"
|
|
|
|
"-type card at port "
|
|
|
|
"0x%04x ",
|
|
|
|
p->port);
|
|
|
|
if (p->irq)
|
|
|
|
printk("irq %d\n", p->irq);
|
|
|
|
else
|
|
|
|
printk("polled\n");
|
|
|
|
initialized = 1;
|
|
|
|
}
|
|
|
|
break;
|
|
|
|
case ACT2000_BUS_MCA:
|
|
|
|
case ACT2000_BUS_PCMCIA:
|
|
|
|
default:
|
|
|
|
printk(KERN_WARNING
|
|
|
|
"act2000: addcard: Invalid BUS type %d\n",
|
|
|
|
p->bus);
|
|
|
|
}
|
|
|
|
} else
|
|
|
|
/* Card already initialized */
|
|
|
|
initialized = 1;
|
|
|
|
if (initialized) {
|
|
|
|
/* Init OK, next card ... */
|
|
|
|
q = p;
|
|
|
|
p = p->next;
|
|
|
|
} else {
|
|
|
|
/* Init failed, remove card from list, free memory */
|
|
|
|
printk(KERN_WARNING
|
|
|
|
"act2000: Initialization of %s failed\n",
|
|
|
|
p->interface.id);
|
|
|
|
if (q) {
|
|
|
|
q->next = p->next;
|
|
|
|
kfree(p);
|
|
|
|
p = q->next;
|
|
|
|
} else {
|
|
|
|
cards = p->next;
|
|
|
|
kfree(p);
|
|
|
|
p = cards;
|
|
|
|
}
|
|
|
|
failed++;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
return (added - failed);
|
|
|
|
}
|
|
|
|
|
|
|
|
#define DRIVERNAME "IBM Active 2000 ISDN driver"
|
|
|
|
|
|
|
|
static int __init act2000_init(void)
|
|
|
|
{
|
|
|
|
printk(KERN_INFO "%s\n", DRIVERNAME);
|
|
|
|
if (!cards)
|
|
|
|
act2000_addcard(act_bus, act_port, act_irq, act_id);
|
|
|
|
if (!cards)
|
|
|
|
printk(KERN_INFO "act2000: No cards defined yet\n");
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
static void __exit act2000_exit(void)
|
|
|
|
{
|
|
|
|
act2000_card *card = cards;
|
|
|
|
act2000_card *last;
|
|
|
|
while (card) {
|
|
|
|
unregister_card(card);
|
|
|
|
del_timer(&card->ptimer);
|
|
|
|
card = card->next;
|
|
|
|
}
|
|
|
|
card = cards;
|
|
|
|
while (card) {
|
|
|
|
last = card;
|
|
|
|
card = card->next;
|
|
|
|
act2000_clear_msn(last);
|
|
|
|
kfree(last);
|
|
|
|
}
|
|
|
|
printk(KERN_INFO "%s unloaded\n", DRIVERNAME);
|
|
|
|
}
|
|
|
|
|
|
|
|
module_init(act2000_init);
|
|
|
|
module_exit(act2000_exit);
|