964 lines
25 KiB
C
964 lines
25 KiB
C
/* $Id$
|
|
*
|
|
* ISDN lowlevel-module for the IBM ISDN-S0 Active 2000.
|
|
*
|
|
* Copyright 1998 by Fritz Elfert (fritz@isdn4linux.de)
|
|
* Thanks to Friedemann Baitinger and IBM Germany
|
|
*
|
|
* 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, or (at your option)
|
|
* any later version.
|
|
*
|
|
* This program is distributed in the hope that it will be useful,
|
|
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
|
* GNU General Public License for more details.
|
|
*
|
|
* You should have received a copy of the GNU General Public License
|
|
* along with this program; if not, write to the Free Software
|
|
* Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
|
|
*
|
|
* $Log$
|
|
* Revision 1.10 1999/10/24 18:46:05 fritz
|
|
* Changed isa_ prefix to act2000_isa_ to prevent name-clash in latest
|
|
* kernels.
|
|
*
|
|
* Revision 1.9 1999/04/12 13:13:56 fritz
|
|
* Made cards pointer static to avoid name-clash.
|
|
*
|
|
* Revision 1.8 1998/11/05 22:12:51 fritz
|
|
* Changed mail-address.
|
|
*
|
|
* Revision 1.7 1998/02/12 23:06:52 keil
|
|
* change for 2.1.86 (removing FREE_READ/FREE_WRITE from [dev]_kfree_skb()
|
|
*
|
|
* Revision 1.6 1998/01/31 22:10:42 keil
|
|
* changes for 2.1.82
|
|
*
|
|
* Revision 1.5 1997/10/09 22:23:04 fritz
|
|
* New HL<->LL interface:
|
|
* New BSENT callback with nr. of bytes included.
|
|
* Sending without ACK.
|
|
*
|
|
* Revision 1.4 1997/09/25 17:25:43 fritz
|
|
* Support for adding cards at runtime.
|
|
* Support for new Firmware.
|
|
*
|
|
* Revision 1.3 1997/09/24 23:11:45 fritz
|
|
* Optimized IRQ load and polling-mode.
|
|
*
|
|
* Revision 1.2 1997/09/24 19:44:17 fritz
|
|
* Added MSN mapping support, some cleanup.
|
|
*
|
|
* Revision 1.1 1997/09/23 18:00:13 fritz
|
|
* New driver for IBM Active 2000.
|
|
*
|
|
*/
|
|
|
|
#include "act2000.h"
|
|
#include "act2000_isa.h"
|
|
#include "capi.h"
|
|
|
|
static unsigned short act2000_isa_ports[] =
|
|
{
|
|
0x0200, 0x0240, 0x0280, 0x02c0, 0x0300, 0x0340, 0x0380,
|
|
0xcfe0, 0xcfa0, 0xcf60, 0xcf20, 0xcee0, 0xcea0, 0xce60,
|
|
};
|
|
#define ISA_NRPORTS (sizeof(act2000_isa_ports)/sizeof(unsigned short))
|
|
|
|
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; /* -1 = Autoselect */
|
|
static char *act_id = "\0\0\0\0\0\0\0\0\0\0\0\0\0\0\0\0";
|
|
|
|
MODULE_DESCRIPTION( "Driver for IBM Active 2000 ISDN card");
|
|
MODULE_AUTHOR( "Fritz Elfert");
|
|
MODULE_SUPPORTED_DEVICE( "ISDN subsystem");
|
|
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 (-1 = grab next free IRQ)");
|
|
MODULE_PARM_DESC(act_id, "ID-String of first card");
|
|
MODULE_PARM(act_bus, "i");
|
|
MODULE_PARM(act_port, "i");
|
|
MODULE_PARM(act_irq, "i");
|
|
MODULE_PARM(act_id, "s");
|
|
|
|
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;
|
|
|
|
save_flags(flags);
|
|
cli();
|
|
card->msn_list = NULL;
|
|
restore_flags(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]) {
|
|
save_flags(flags);
|
|
cli();
|
|
if (q)
|
|
q->next = p->next;
|
|
else
|
|
card->msn_list = p->next;
|
|
restore_flags(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]) {
|
|
save_flags(flags);
|
|
cli();
|
|
strcpy(p->msn, &eazmsn[1]);
|
|
restore_flags(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;
|
|
save_flags(flags);
|
|
cli();
|
|
card->msn_list = p;
|
|
restore_flags(flags);
|
|
printk(KERN_DEBUG
|
|
"Mapping %c -> %s added\n",
|
|
eazmsn[0],
|
|
&eazmsn[1]);
|
|
return 0;
|
|
}
|
|
|
|
static void
|
|
act2000_transmit(struct act2000_card *card)
|
|
{
|
|
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
|
|
act2000_receive(struct act2000_card *card)
|
|
{
|
|
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;
|
|
|
|
act2000_receive(card);
|
|
save_flags(flags);
|
|
cli();
|
|
del_timer(&card->ptimer);
|
|
card->ptimer.expires = jiffies + 3;
|
|
add_timer(&card->ptimer);
|
|
restore_flags(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;
|
|
|
|
switch (c->command) {
|
|
case ISDN_CMD_IOCTL:
|
|
memcpy(&a, c->parm.num, sizeof(ulong));
|
|
switch (c->arg) {
|
|
case ACT2000_IOCTL_LOADBOOT:
|
|
switch (card->bus) {
|
|
case ACT2000_BUS_ISA:
|
|
ret = act2000_isa_download(card,
|
|
(act2000_ddef *)a);
|
|
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 ((ret = copy_from_user(tmp, (char *)a, sizeof(tmp))))
|
|
return ret;
|
|
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 ((ret = copy_from_user(&cdef, (char *)a, sizeof(cdef))))
|
|
return ret;
|
|
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:
|
|
if (!card->flags & ACT2000_FLAGS_RUNNING)
|
|
return -ENODEV;
|
|
if (!(chan = find_channel(card, c->arg & 0x0f)))
|
|
break;
|
|
save_flags(flags);
|
|
cli();
|
|
if (chan->fsm_state != ACT2000_STATE_NULL) {
|
|
restore_flags(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;
|
|
restore_flags(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:
|
|
if (!card->flags & ACT2000_FLAGS_RUNNING)
|
|
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:
|
|
if (!card->flags & ACT2000_FLAGS_RUNNING)
|
|
return -ENODEV;
|
|
return 0;
|
|
case ISDN_CMD_HANGUP:
|
|
if (!card->flags & ACT2000_FLAGS_RUNNING)
|
|
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:
|
|
if (!card->flags & ACT2000_FLAGS_RUNNING)
|
|
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:
|
|
if (!card->flags & ACT2000_FLAGS_RUNNING)
|
|
return -ENODEV;
|
|
if (!(chan = find_channel(card, c->arg & 0x0f)))
|
|
break;
|
|
chan->eazmask = 0;
|
|
actcapi_listen_req(card);
|
|
return 0;
|
|
case ISDN_CMD_SETL2:
|
|
if (!card->flags & ACT2000_FLAGS_RUNNING)
|
|
return -ENODEV;
|
|
if (!(chan = find_channel(card, c->arg & 0x0f)))
|
|
break;
|
|
chan->l2prot = (c->arg >> 8);
|
|
return 0;
|
|
case ISDN_CMD_GETL2:
|
|
if (!card->flags & ACT2000_FLAGS_RUNNING)
|
|
return -ENODEV;
|
|
if (!(chan = find_channel(card, c->arg & 0x0f)))
|
|
break;
|
|
return chan->l2prot;
|
|
case ISDN_CMD_SETL3:
|
|
if (!card->flags & ACT2000_FLAGS_RUNNING)
|
|
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;
|
|
case ISDN_CMD_GETL3:
|
|
if (!card->flags & ACT2000_FLAGS_RUNNING)
|
|
return -ENODEV;
|
|
if (!(chan = find_channel(card, c->arg & 0x0f)))
|
|
break;
|
|
return chan->l3prot;
|
|
case ISDN_CMD_GETEAZ:
|
|
if (!card->flags & ACT2000_FLAGS_RUNNING)
|
|
return -ENODEV;
|
|
printk(KERN_DEBUG "act2000 CMD_GETEAZ not implemented\n");
|
|
return 0;
|
|
case ISDN_CMD_SETSIL:
|
|
if (!card->flags & ACT2000_FLAGS_RUNNING)
|
|
return -ENODEV;
|
|
printk(KERN_DEBUG "act2000 CMD_SETSIL not implemented\n");
|
|
return 0;
|
|
case ISDN_CMD_GETSIL:
|
|
if (!card->flags & ACT2000_FLAGS_RUNNING)
|
|
return -ENODEV;
|
|
printk(KERN_DEBUG "act2000 CMD_GETSIL not implemented\n");
|
|
return 0;
|
|
case ISDN_CMD_LOCK:
|
|
MOD_INC_USE_COUNT;
|
|
return 0;
|
|
case ISDN_CMD_UNLOCK:
|
|
MOD_DEC_USE_COUNT;
|
|
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);
|
|
memcpy(skb_put(xmit_skb, len), skb->data, len);
|
|
} 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 * buf, int len, int user, act2000_card * card)
|
|
{
|
|
int count;
|
|
u_char *p;
|
|
|
|
for (p = buf, count = 0; count < len; p++, count++) {
|
|
if (card->status_buf_read == card->status_buf_write)
|
|
return count;
|
|
if (user)
|
|
put_user(*card->status_buf_read++, p);
|
|
else
|
|
*p = *card->status_buf_read++;
|
|
if (card->status_buf_read > card->status_buf_end)
|
|
card->status_buf_read = card->status_buf;
|
|
}
|
|
return count;
|
|
}
|
|
|
|
static void
|
|
act2000_putmsg(act2000_card *card, char c)
|
|
{
|
|
ulong flags;
|
|
|
|
save_flags(flags);
|
|
cli();
|
|
*card->status_buf_write++ = c;
|
|
if (card->status_buf_write == card->status_buf_read) {
|
|
if (++card->status_buf_read > card->status_buf_end)
|
|
card->status_buf_read = card->status_buf;
|
|
}
|
|
if (card->status_buf_write > card->status_buf_end)
|
|
card->status_buf_write = card->status_buf;
|
|
restore_flags(flags);
|
|
}
|
|
|
|
static void
|
|
act2000_logstat(struct act2000_card *card, char *str)
|
|
{
|
|
char *p = str;
|
|
isdn_ctrl c;
|
|
|
|
while (*p)
|
|
act2000_putmsg(card, *p++);
|
|
c.command = ISDN_STAT_STAVAIL;
|
|
c.driver = card->myid;
|
|
c.arg = strlen(str);
|
|
card->interface.statcallb(&c);
|
|
}
|
|
|
|
/*
|
|
* 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 * buf, int len, int user, int id, int channel)
|
|
{
|
|
act2000_card *card = act2000_findcard(id);
|
|
|
|
if (card) {
|
|
if (!card->flags & ACT2000_FLAGS_RUNNING)
|
|
return -ENODEV;
|
|
return (len);
|
|
}
|
|
printk(KERN_ERR
|
|
"act2000: if_writecmd called with invalid driverId!\n");
|
|
return -ENODEV;
|
|
}
|
|
|
|
static int
|
|
if_readstatus(u_char * buf, int len, int user, int id, int channel)
|
|
{
|
|
act2000_card *card = act2000_findcard(id);
|
|
|
|
if (card) {
|
|
if (!card->flags & ACT2000_FLAGS_RUNNING)
|
|
return -ENODEV;
|
|
return (act2000_readstatus(buf, len, user, 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) {
|
|
if (!card->flags & ACT2000_FLAGS_RUNNING)
|
|
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;
|
|
if (!(card = (act2000_card *) kmalloc(sizeof(act2000_card), GFP_KERNEL))) {
|
|
printk(KERN_WARNING
|
|
"act2000: (%s) Could not allocate card-struct.\n", id);
|
|
return;
|
|
}
|
|
memset((char *) card, 0, sizeof(act2000_card));
|
|
skb_queue_head_init(&card->sndq);
|
|
skb_queue_head_init(&card->rcvq);
|
|
skb_queue_head_init(&card->ackq);
|
|
card->snd_tq.routine = (void *) (void *) act2000_transmit;
|
|
card->snd_tq.data = card;
|
|
card->rcv_tq.routine = (void *) (void *) actcapi_dispatch;
|
|
card->rcv_tq.data = card;
|
|
card->poll_tq.routine = (void *) (void *) act2000_receive;
|
|
card->poll_tq.data = card;
|
|
init_timer(&card->ptimer);
|
|
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 |
|
|
#if 0
|
|
/* Not yet! New Firmware is on the way ... */
|
|
ISDN_FEATURE_L2_TRANS |
|
|
#endif
|
|
ISDN_FEATURE_L3_TRANS |
|
|
ISDN_FEATURE_P_UNKNOWN;
|
|
card->interface.hl_hdrlen = 20;
|
|
card->ptype = ISDN_PTYPE_EURO;
|
|
strncpy(card->interface.id, id, sizeof(card->interface.id) - 1);
|
|
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) {
|
|
case ACT2000_BUS_ISA:
|
|
for (i = 0; i < ISA_NRPORTS; 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);
|
|
}
|
|
}
|
|
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"
|
|
|
|
#ifdef MODULE
|
|
#define act2000_init init_module
|
|
#endif
|
|
|
|
int
|
|
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");
|
|
/* No symbols to export, hide all symbols */
|
|
EXPORT_NO_SYMBOLS;
|
|
return 0;
|
|
}
|
|
|
|
#ifdef MODULE
|
|
void
|
|
cleanup_module(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);
|
|
}
|
|
|
|
#else
|
|
void
|
|
act2000_setup(char *str, int *ints)
|
|
{
|
|
int i, j, argc, port, irq, bus;
|
|
|
|
argc = ints[0];
|
|
i = 1;
|
|
if (argc)
|
|
while (argc) {
|
|
port = irq = -1;
|
|
bus = 0;
|
|
if (argc) {
|
|
bus = ints[i];
|
|
i++;
|
|
argc--;
|
|
}
|
|
if (argc) {
|
|
port = ints[i];
|
|
i++;
|
|
argc--;
|
|
}
|
|
if (argc) {
|
|
irq = ints[i];
|
|
i++;
|
|
argc--;
|
|
}
|
|
act2000_addcard(bus, port, irq, act_id);
|
|
}
|
|
}
|
|
#endif
|