| /* $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 <linux/slab.h> | |
| #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 | |
| act2000_transmit(struct work_struct *work) | |
| { | |
| struct act2000_card *card = | |
| container_of(work, struct act2000_card, snd_tq); | |
| 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 work_struct *work) | |
| { | |
| struct act2000_card *card = | |
| container_of(work, struct act2000_card, poll_tq); | |
| 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->poll_tq); | |
| 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: | |
| if (!(card->flags & ACT2000_FLAGS_RUNNING)) | |
| 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: | |
| 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_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; | |
| } | |
| 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); | |
| skb_copy_from_linear_data(skb, skb_put(xmit_skb, len), 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 __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) { | |
| 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 __user *buf, int len, 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, 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 = kzalloc(sizeof(act2000_card), GFP_KERNEL))) { | |
| 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); | |
| INIT_WORK(&card->snd_tq, act2000_transmit); | |
| INIT_WORK(&card->rcv_tq, actcapi_dispatch); | |
| INIT_WORK(&card->poll_tq, act2000_receive); | |
| 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) { | |
| 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); | |
| } | |
| } | |
| 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); |