module.c 21 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812
  1. /* $Id: module.c,v 1.14.6.4 2001/09/23 22:24:32 kai Exp $
  2. *
  3. * ISDN lowlevel-module for the IBM ISDN-S0 Active 2000.
  4. *
  5. * Author Fritz Elfert
  6. * Copyright by Fritz Elfert <fritz@isdn4linux.de>
  7. *
  8. * This software may be used and distributed according to the terms
  9. * of the GNU General Public License, incorporated herein by reference.
  10. *
  11. * Thanks to Friedemann Baitinger and IBM Germany
  12. *
  13. */
  14. #include "act2000.h"
  15. #include "act2000_isa.h"
  16. #include "capi.h"
  17. #include <linux/module.h>
  18. #include <linux/init.h>
  19. static unsigned short act2000_isa_ports[] =
  20. {
  21. 0x0200, 0x0240, 0x0280, 0x02c0, 0x0300, 0x0340, 0x0380,
  22. 0xcfe0, 0xcfa0, 0xcf60, 0xcf20, 0xcee0, 0xcea0, 0xce60,
  23. };
  24. static act2000_card *cards = (act2000_card *) NULL;
  25. /* Parameters to be set by insmod */
  26. static int act_bus = 0;
  27. static int act_port = -1; /* -1 = Autoprobe */
  28. static int act_irq = -1;
  29. static char *act_id = "\0\0\0\0\0\0\0\0\0\0\0\0\0\0\0\0";
  30. MODULE_DESCRIPTION( "ISDN4Linux: Driver for IBM Active 2000 ISDN card");
  31. MODULE_AUTHOR( "Fritz Elfert");
  32. MODULE_LICENSE( "GPL");
  33. MODULE_PARM_DESC(act_bus, "BusType of first card, 1=ISA, 2=MCA, 3=PCMCIA, currently only ISA");
  34. MODULE_PARM_DESC(membase, "Base port address of first card");
  35. MODULE_PARM_DESC(act_irq, "IRQ of first card");
  36. MODULE_PARM_DESC(act_id, "ID-String of first card");
  37. module_param(act_bus, int, 0);
  38. module_param(act_port, int, 0);
  39. module_param(act_irq, int, 0);
  40. module_param(act_id, charp, 0);
  41. static int act2000_addcard(int, int, int, char *);
  42. static act2000_chan *
  43. find_channel(act2000_card *card, int channel)
  44. {
  45. if ((channel >= 0) && (channel < ACT2000_BCH))
  46. return &(card->bch[channel]);
  47. printk(KERN_WARNING "act2000: Invalid channel %d\n", channel);
  48. return NULL;
  49. }
  50. /*
  51. * Free MSN list
  52. */
  53. static void
  54. act2000_clear_msn(act2000_card *card)
  55. {
  56. struct msn_entry *p = card->msn_list;
  57. struct msn_entry *q;
  58. unsigned long flags;
  59. spin_lock_irqsave(&card->lock, flags);
  60. card->msn_list = NULL;
  61. spin_unlock_irqrestore(&card->lock, flags);
  62. while (p) {
  63. q = p->next;
  64. kfree(p);
  65. p = q;
  66. }
  67. }
  68. /*
  69. * Find an MSN entry in the list.
  70. * If ia5 != 0, return IA5-encoded EAZ, else
  71. * return a bitmask with corresponding bit set.
  72. */
  73. static __u16
  74. act2000_find_msn(act2000_card *card, char *msn, int ia5)
  75. {
  76. struct msn_entry *p = card->msn_list;
  77. __u8 eaz = '0';
  78. while (p) {
  79. if (!strcmp(p->msn, msn)) {
  80. eaz = p->eaz;
  81. break;
  82. }
  83. p = p->next;
  84. }
  85. if (!ia5)
  86. return (1 << (eaz - '0'));
  87. else
  88. return eaz;
  89. }
  90. /*
  91. * Find an EAZ entry in the list.
  92. * return a string with corresponding msn.
  93. */
  94. char *
  95. act2000_find_eaz(act2000_card *card, char eaz)
  96. {
  97. struct msn_entry *p = card->msn_list;
  98. while (p) {
  99. if (p->eaz == eaz)
  100. return(p->msn);
  101. p = p->next;
  102. }
  103. return("\0");
  104. }
  105. /*
  106. * Add or delete an MSN to the MSN list
  107. *
  108. * First character of msneaz is EAZ, rest is MSN.
  109. * If length of eazmsn is 1, delete that entry.
  110. */
  111. static int
  112. act2000_set_msn(act2000_card *card, char *eazmsn)
  113. {
  114. struct msn_entry *p = card->msn_list;
  115. struct msn_entry *q = NULL;
  116. unsigned long flags;
  117. int i;
  118. if (!strlen(eazmsn))
  119. return 0;
  120. if (strlen(eazmsn) > 16)
  121. return -EINVAL;
  122. for (i = 0; i < strlen(eazmsn); i++)
  123. if (!isdigit(eazmsn[i]))
  124. return -EINVAL;
  125. if (strlen(eazmsn) == 1) {
  126. /* Delete a single MSN */
  127. while (p) {
  128. if (p->eaz == eazmsn[0]) {
  129. spin_lock_irqsave(&card->lock, flags);
  130. if (q)
  131. q->next = p->next;
  132. else
  133. card->msn_list = p->next;
  134. spin_unlock_irqrestore(&card->lock, flags);
  135. kfree(p);
  136. printk(KERN_DEBUG
  137. "Mapping for EAZ %c deleted\n",
  138. eazmsn[0]);
  139. return 0;
  140. }
  141. q = p;
  142. p = p->next;
  143. }
  144. return 0;
  145. }
  146. /* Add a single MSN */
  147. while (p) {
  148. /* Found in list, replace MSN */
  149. if (p->eaz == eazmsn[0]) {
  150. spin_lock_irqsave(&card->lock, flags);
  151. strcpy(p->msn, &eazmsn[1]);
  152. spin_unlock_irqrestore(&card->lock, flags);
  153. printk(KERN_DEBUG
  154. "Mapping for EAZ %c changed to %s\n",
  155. eazmsn[0],
  156. &eazmsn[1]);
  157. return 0;
  158. }
  159. p = p->next;
  160. }
  161. /* Not found in list, add new entry */
  162. p = kmalloc(sizeof(msn_entry), GFP_KERNEL);
  163. if (!p)
  164. return -ENOMEM;
  165. p->eaz = eazmsn[0];
  166. strcpy(p->msn, &eazmsn[1]);
  167. p->next = card->msn_list;
  168. spin_lock_irqsave(&card->lock, flags);
  169. card->msn_list = p;
  170. spin_unlock_irqrestore(&card->lock, flags);
  171. printk(KERN_DEBUG
  172. "Mapping %c -> %s added\n",
  173. eazmsn[0],
  174. &eazmsn[1]);
  175. return 0;
  176. }
  177. static void
  178. act2000_transmit(struct work_struct *work)
  179. {
  180. struct act2000_card *card =
  181. container_of(work, struct act2000_card, snd_tq);
  182. switch (card->bus) {
  183. case ACT2000_BUS_ISA:
  184. act2000_isa_send(card);
  185. break;
  186. case ACT2000_BUS_PCMCIA:
  187. case ACT2000_BUS_MCA:
  188. default:
  189. printk(KERN_WARNING
  190. "act2000_transmit: Illegal bustype %d\n", card->bus);
  191. }
  192. }
  193. static void
  194. act2000_receive(struct work_struct *work)
  195. {
  196. struct act2000_card *card =
  197. container_of(work, struct act2000_card, poll_tq);
  198. switch (card->bus) {
  199. case ACT2000_BUS_ISA:
  200. act2000_isa_receive(card);
  201. break;
  202. case ACT2000_BUS_PCMCIA:
  203. case ACT2000_BUS_MCA:
  204. default:
  205. printk(KERN_WARNING
  206. "act2000_receive: Illegal bustype %d\n", card->bus);
  207. }
  208. }
  209. static void
  210. act2000_poll(unsigned long data)
  211. {
  212. act2000_card * card = (act2000_card *)data;
  213. unsigned long flags;
  214. act2000_receive(&card->poll_tq);
  215. spin_lock_irqsave(&card->lock, flags);
  216. mod_timer(&card->ptimer, jiffies+3);
  217. spin_unlock_irqrestore(&card->lock, flags);
  218. }
  219. static int
  220. act2000_command(act2000_card * card, isdn_ctrl * c)
  221. {
  222. ulong a;
  223. act2000_chan *chan;
  224. act2000_cdef cdef;
  225. isdn_ctrl cmd;
  226. char tmp[17];
  227. int ret;
  228. unsigned long flags;
  229. void __user *arg;
  230. switch (c->command) {
  231. case ISDN_CMD_IOCTL:
  232. memcpy(&a, c->parm.num, sizeof(ulong));
  233. arg = (void __user *)a;
  234. switch (c->arg) {
  235. case ACT2000_IOCTL_LOADBOOT:
  236. switch (card->bus) {
  237. case ACT2000_BUS_ISA:
  238. ret = act2000_isa_download(card,
  239. arg);
  240. if (!ret) {
  241. card->flags |= ACT2000_FLAGS_LOADED;
  242. if (!(card->flags & ACT2000_FLAGS_IVALID)) {
  243. card->ptimer.expires = jiffies + 3;
  244. card->ptimer.function = act2000_poll;
  245. card->ptimer.data = (unsigned long)card;
  246. add_timer(&card->ptimer);
  247. }
  248. actcapi_manufacturer_req_errh(card);
  249. }
  250. break;
  251. default:
  252. printk(KERN_WARNING
  253. "act2000: Illegal BUS type %d\n",
  254. card->bus);
  255. ret = -EIO;
  256. }
  257. return ret;
  258. case ACT2000_IOCTL_SETPROTO:
  259. card->ptype = a?ISDN_PTYPE_EURO:ISDN_PTYPE_1TR6;
  260. if (!(card->flags & ACT2000_FLAGS_RUNNING))
  261. return 0;
  262. actcapi_manufacturer_req_net(card);
  263. return 0;
  264. case ACT2000_IOCTL_SETMSN:
  265. if (copy_from_user(tmp, arg,
  266. sizeof(tmp)))
  267. return -EFAULT;
  268. if ((ret = act2000_set_msn(card, tmp)))
  269. return ret;
  270. if (card->flags & ACT2000_FLAGS_RUNNING)
  271. return(actcapi_manufacturer_req_msn(card));
  272. return 0;
  273. case ACT2000_IOCTL_ADDCARD:
  274. if (copy_from_user(&cdef, arg,
  275. sizeof(cdef)))
  276. return -EFAULT;
  277. if (act2000_addcard(cdef.bus, cdef.port, cdef.irq, cdef.id))
  278. return -EIO;
  279. return 0;
  280. case ACT2000_IOCTL_TEST:
  281. if (!(card->flags & ACT2000_FLAGS_RUNNING))
  282. return -ENODEV;
  283. return 0;
  284. default:
  285. return -EINVAL;
  286. }
  287. break;
  288. case ISDN_CMD_DIAL:
  289. if (!(card->flags & ACT2000_FLAGS_RUNNING))
  290. return -ENODEV;
  291. if (!(chan = find_channel(card, c->arg & 0x0f)))
  292. break;
  293. spin_lock_irqsave(&card->lock, flags);
  294. if (chan->fsm_state != ACT2000_STATE_NULL) {
  295. spin_unlock_irqrestore(&card->lock, flags);
  296. printk(KERN_WARNING "Dial on channel with state %d\n",
  297. chan->fsm_state);
  298. return -EBUSY;
  299. }
  300. if (card->ptype == ISDN_PTYPE_EURO)
  301. tmp[0] = act2000_find_msn(card, c->parm.setup.eazmsn, 1);
  302. else
  303. tmp[0] = c->parm.setup.eazmsn[0];
  304. chan->fsm_state = ACT2000_STATE_OCALL;
  305. chan->callref = 0xffff;
  306. spin_unlock_irqrestore(&card->lock, flags);
  307. ret = actcapi_connect_req(card, chan, c->parm.setup.phone,
  308. tmp[0], c->parm.setup.si1,
  309. c->parm.setup.si2);
  310. if (ret) {
  311. cmd.driver = card->myid;
  312. cmd.command = ISDN_STAT_DHUP;
  313. cmd.arg &= 0x0f;
  314. card->interface.statcallb(&cmd);
  315. }
  316. return ret;
  317. case ISDN_CMD_ACCEPTD:
  318. if (!(card->flags & ACT2000_FLAGS_RUNNING))
  319. return -ENODEV;
  320. if (!(chan = find_channel(card, c->arg & 0x0f)))
  321. break;
  322. if (chan->fsm_state == ACT2000_STATE_ICALL)
  323. actcapi_select_b2_protocol_req(card, chan);
  324. return 0;
  325. case ISDN_CMD_ACCEPTB:
  326. if (!(card->flags & ACT2000_FLAGS_RUNNING))
  327. return -ENODEV;
  328. return 0;
  329. case ISDN_CMD_HANGUP:
  330. if (!(card->flags & ACT2000_FLAGS_RUNNING))
  331. return -ENODEV;
  332. if (!(chan = find_channel(card, c->arg & 0x0f)))
  333. break;
  334. switch (chan->fsm_state) {
  335. case ACT2000_STATE_ICALL:
  336. case ACT2000_STATE_BSETUP:
  337. actcapi_connect_resp(card, chan, 0x15);
  338. break;
  339. case ACT2000_STATE_ACTIVE:
  340. actcapi_disconnect_b3_req(card, chan);
  341. break;
  342. }
  343. return 0;
  344. case ISDN_CMD_SETEAZ:
  345. if (!(card->flags & ACT2000_FLAGS_RUNNING))
  346. return -ENODEV;
  347. if (!(chan = find_channel(card, c->arg & 0x0f)))
  348. break;
  349. if (strlen(c->parm.num)) {
  350. if (card->ptype == ISDN_PTYPE_EURO) {
  351. chan->eazmask = act2000_find_msn(card, c->parm.num, 0);
  352. }
  353. if (card->ptype == ISDN_PTYPE_1TR6) {
  354. int i;
  355. chan->eazmask = 0;
  356. for (i = 0; i < strlen(c->parm.num); i++)
  357. if (isdigit(c->parm.num[i]))
  358. chan->eazmask |= (1 << (c->parm.num[i] - '0'));
  359. }
  360. } else
  361. chan->eazmask = 0x3ff;
  362. actcapi_listen_req(card);
  363. return 0;
  364. case ISDN_CMD_CLREAZ:
  365. if (!(card->flags & ACT2000_FLAGS_RUNNING))
  366. return -ENODEV;
  367. if (!(chan = find_channel(card, c->arg & 0x0f)))
  368. break;
  369. chan->eazmask = 0;
  370. actcapi_listen_req(card);
  371. return 0;
  372. case ISDN_CMD_SETL2:
  373. if (!(card->flags & ACT2000_FLAGS_RUNNING))
  374. return -ENODEV;
  375. if (!(chan = find_channel(card, c->arg & 0x0f)))
  376. break;
  377. chan->l2prot = (c->arg >> 8);
  378. return 0;
  379. case ISDN_CMD_SETL3:
  380. if (!(card->flags & ACT2000_FLAGS_RUNNING))
  381. return -ENODEV;
  382. if ((c->arg >> 8) != ISDN_PROTO_L3_TRANS) {
  383. printk(KERN_WARNING "L3 protocol unknown\n");
  384. return -1;
  385. }
  386. if (!(chan = find_channel(card, c->arg & 0x0f)))
  387. break;
  388. chan->l3prot = (c->arg >> 8);
  389. return 0;
  390. }
  391. return -EINVAL;
  392. }
  393. static int
  394. act2000_sendbuf(act2000_card *card, int channel, int ack, struct sk_buff *skb)
  395. {
  396. struct sk_buff *xmit_skb;
  397. int len;
  398. act2000_chan *chan;
  399. actcapi_msg *msg;
  400. if (!(chan = find_channel(card, channel)))
  401. return -1;
  402. if (chan->fsm_state != ACT2000_STATE_ACTIVE)
  403. return -1;
  404. len = skb->len;
  405. if ((chan->queued + len) >= ACT2000_MAX_QUEUED)
  406. return 0;
  407. if (!len)
  408. return 0;
  409. if (skb_headroom(skb) < 19) {
  410. printk(KERN_WARNING "act2000_sendbuf: Headroom only %d\n",
  411. skb_headroom(skb));
  412. xmit_skb = alloc_skb(len + 19, GFP_ATOMIC);
  413. if (!xmit_skb) {
  414. printk(KERN_WARNING "act2000_sendbuf: Out of memory\n");
  415. return 0;
  416. }
  417. skb_reserve(xmit_skb, 19);
  418. skb_copy_from_linear_data(skb, skb_put(xmit_skb, len), len);
  419. } else {
  420. xmit_skb = skb_clone(skb, GFP_ATOMIC);
  421. if (!xmit_skb) {
  422. printk(KERN_WARNING "act2000_sendbuf: Out of memory\n");
  423. return 0;
  424. }
  425. }
  426. dev_kfree_skb(skb);
  427. msg = (actcapi_msg *)skb_push(xmit_skb, 19);
  428. msg->hdr.len = 19 + len;
  429. msg->hdr.applicationID = 1;
  430. msg->hdr.cmd.cmd = 0x86;
  431. msg->hdr.cmd.subcmd = 0x00;
  432. msg->hdr.msgnum = actcapi_nextsmsg(card);
  433. msg->msg.data_b3_req.datalen = len;
  434. msg->msg.data_b3_req.blocknr = (msg->hdr.msgnum & 0xff);
  435. msg->msg.data_b3_req.fakencci = MAKE_NCCI(chan->plci, 0, chan->ncci);
  436. msg->msg.data_b3_req.flags = ack; /* Will be set to 0 on actual sending */
  437. actcapi_debug_msg(xmit_skb, 1);
  438. chan->queued += len;
  439. skb_queue_tail(&card->sndq, xmit_skb);
  440. act2000_schedule_tx(card);
  441. return len;
  442. }
  443. /* Read the Status-replies from the Interface */
  444. static int
  445. act2000_readstatus(u_char __user * buf, int len, act2000_card * card)
  446. {
  447. int count;
  448. u_char __user *p;
  449. for (p = buf, count = 0; count < len; p++, count++) {
  450. if (card->status_buf_read == card->status_buf_write)
  451. return count;
  452. put_user(*card->status_buf_read++, p);
  453. if (card->status_buf_read > card->status_buf_end)
  454. card->status_buf_read = card->status_buf;
  455. }
  456. return count;
  457. }
  458. /*
  459. * Find card with given driverId
  460. */
  461. static inline act2000_card *
  462. act2000_findcard(int driverid)
  463. {
  464. act2000_card *p = cards;
  465. while (p) {
  466. if (p->myid == driverid)
  467. return p;
  468. p = p->next;
  469. }
  470. return (act2000_card *) 0;
  471. }
  472. /*
  473. * Wrapper functions for interface to linklevel
  474. */
  475. static int
  476. if_command(isdn_ctrl * c)
  477. {
  478. act2000_card *card = act2000_findcard(c->driver);
  479. if (card)
  480. return (act2000_command(card, c));
  481. printk(KERN_ERR
  482. "act2000: if_command %d called with invalid driverId %d!\n",
  483. c->command, c->driver);
  484. return -ENODEV;
  485. }
  486. static int
  487. if_writecmd(const u_char __user *buf, int len, int id, int channel)
  488. {
  489. act2000_card *card = act2000_findcard(id);
  490. if (card) {
  491. if (!(card->flags & ACT2000_FLAGS_RUNNING))
  492. return -ENODEV;
  493. return (len);
  494. }
  495. printk(KERN_ERR
  496. "act2000: if_writecmd called with invalid driverId!\n");
  497. return -ENODEV;
  498. }
  499. static int
  500. if_readstatus(u_char __user * buf, int len, int id, int channel)
  501. {
  502. act2000_card *card = act2000_findcard(id);
  503. if (card) {
  504. if (!(card->flags & ACT2000_FLAGS_RUNNING))
  505. return -ENODEV;
  506. return (act2000_readstatus(buf, len, card));
  507. }
  508. printk(KERN_ERR
  509. "act2000: if_readstatus called with invalid driverId!\n");
  510. return -ENODEV;
  511. }
  512. static int
  513. if_sendbuf(int id, int channel, int ack, struct sk_buff *skb)
  514. {
  515. act2000_card *card = act2000_findcard(id);
  516. if (card) {
  517. if (!(card->flags & ACT2000_FLAGS_RUNNING))
  518. return -ENODEV;
  519. return (act2000_sendbuf(card, channel, ack, skb));
  520. }
  521. printk(KERN_ERR
  522. "act2000: if_sendbuf called with invalid driverId!\n");
  523. return -ENODEV;
  524. }
  525. /*
  526. * Allocate a new card-struct, initialize it
  527. * link it into cards-list.
  528. */
  529. static void
  530. act2000_alloccard(int bus, int port, int irq, char *id)
  531. {
  532. int i;
  533. act2000_card *card;
  534. if (!(card = kzalloc(sizeof(act2000_card), GFP_KERNEL))) {
  535. printk(KERN_WARNING
  536. "act2000: (%s) Could not allocate card-struct.\n", id);
  537. return;
  538. }
  539. spin_lock_init(&card->lock);
  540. spin_lock_init(&card->mnlock);
  541. skb_queue_head_init(&card->sndq);
  542. skb_queue_head_init(&card->rcvq);
  543. skb_queue_head_init(&card->ackq);
  544. INIT_WORK(&card->snd_tq, act2000_transmit);
  545. INIT_WORK(&card->rcv_tq, actcapi_dispatch);
  546. INIT_WORK(&card->poll_tq, act2000_receive);
  547. init_timer(&card->ptimer);
  548. card->interface.owner = THIS_MODULE;
  549. card->interface.channels = ACT2000_BCH;
  550. card->interface.maxbufsize = 4000;
  551. card->interface.command = if_command;
  552. card->interface.writebuf_skb = if_sendbuf;
  553. card->interface.writecmd = if_writecmd;
  554. card->interface.readstat = if_readstatus;
  555. card->interface.features =
  556. ISDN_FEATURE_L2_X75I |
  557. ISDN_FEATURE_L2_HDLC |
  558. ISDN_FEATURE_L3_TRANS |
  559. ISDN_FEATURE_P_UNKNOWN;
  560. card->interface.hl_hdrlen = 20;
  561. card->ptype = ISDN_PTYPE_EURO;
  562. strlcpy(card->interface.id, id, sizeof(card->interface.id));
  563. for (i=0; i<ACT2000_BCH; i++) {
  564. card->bch[i].plci = 0x8000;
  565. card->bch[i].ncci = 0x8000;
  566. card->bch[i].l2prot = ISDN_PROTO_L2_X75I;
  567. card->bch[i].l3prot = ISDN_PROTO_L3_TRANS;
  568. }
  569. card->myid = -1;
  570. card->bus = bus;
  571. card->port = port;
  572. card->irq = irq;
  573. card->next = cards;
  574. cards = card;
  575. }
  576. /*
  577. * register card at linklevel
  578. */
  579. static int
  580. act2000_registercard(act2000_card * card)
  581. {
  582. switch (card->bus) {
  583. case ACT2000_BUS_ISA:
  584. break;
  585. case ACT2000_BUS_MCA:
  586. case ACT2000_BUS_PCMCIA:
  587. default:
  588. printk(KERN_WARNING
  589. "act2000: Illegal BUS type %d\n",
  590. card->bus);
  591. return -1;
  592. }
  593. if (!register_isdn(&card->interface)) {
  594. printk(KERN_WARNING
  595. "act2000: Unable to register %s\n",
  596. card->interface.id);
  597. return -1;
  598. }
  599. card->myid = card->interface.channels;
  600. sprintf(card->regname, "act2000-isdn (%s)", card->interface.id);
  601. return 0;
  602. }
  603. static void
  604. unregister_card(act2000_card * card)
  605. {
  606. isdn_ctrl cmd;
  607. cmd.command = ISDN_STAT_UNLOAD;
  608. cmd.driver = card->myid;
  609. card->interface.statcallb(&cmd);
  610. switch (card->bus) {
  611. case ACT2000_BUS_ISA:
  612. act2000_isa_release(card);
  613. break;
  614. case ACT2000_BUS_MCA:
  615. case ACT2000_BUS_PCMCIA:
  616. default:
  617. printk(KERN_WARNING
  618. "act2000: Invalid BUS type %d\n",
  619. card->bus);
  620. break;
  621. }
  622. }
  623. static int
  624. act2000_addcard(int bus, int port, int irq, char *id)
  625. {
  626. act2000_card *p;
  627. act2000_card *q = NULL;
  628. int initialized;
  629. int added = 0;
  630. int failed = 0;
  631. int i;
  632. if (!bus)
  633. bus = ACT2000_BUS_ISA;
  634. if (port != -1) {
  635. /* Port defined, do fixed setup */
  636. act2000_alloccard(bus, port, irq, id);
  637. } else {
  638. /* No port defined, perform autoprobing.
  639. * This may result in more than one card detected.
  640. */
  641. switch (bus) {
  642. case ACT2000_BUS_ISA:
  643. for (i = 0; i < ARRAY_SIZE(act2000_isa_ports); i++)
  644. if (act2000_isa_detect(act2000_isa_ports[i])) {
  645. printk(KERN_INFO "act2000: Detected "
  646. "ISA card at port 0x%x\n",
  647. act2000_isa_ports[i]);
  648. act2000_alloccard(bus,
  649. act2000_isa_ports[i], irq, id);
  650. }
  651. break;
  652. case ACT2000_BUS_MCA:
  653. case ACT2000_BUS_PCMCIA:
  654. default:
  655. printk(KERN_WARNING
  656. "act2000: addcard: Invalid BUS type %d\n", bus);
  657. }
  658. }
  659. if (!cards)
  660. return 1;
  661. p = cards;
  662. while (p) {
  663. initialized = 0;
  664. if (!p->interface.statcallb) {
  665. /* Not yet registered.
  666. * Try to register and activate it.
  667. */
  668. added++;
  669. switch (p->bus) {
  670. case ACT2000_BUS_ISA:
  671. if (act2000_isa_detect(p->port)) {
  672. if (act2000_registercard(p))
  673. break;
  674. if (act2000_isa_config_port(p, p->port)) {
  675. printk(KERN_WARNING
  676. "act2000: Could not request port 0x%04x\n",
  677. p->port);
  678. unregister_card(p);
  679. p->interface.statcallb = NULL;
  680. break;
  681. }
  682. if (act2000_isa_config_irq(p, p->irq)) {
  683. printk(KERN_INFO
  684. "act2000: No IRQ available, fallback to polling\n");
  685. /* Fall back to polled operation */
  686. p->irq = 0;
  687. }
  688. printk(KERN_INFO
  689. "act2000: ISA"
  690. "-type card at port "
  691. "0x%04x ",
  692. p->port);
  693. if (p->irq)
  694. printk("irq %d\n", p->irq);
  695. else
  696. printk("polled\n");
  697. initialized = 1;
  698. }
  699. break;
  700. case ACT2000_BUS_MCA:
  701. case ACT2000_BUS_PCMCIA:
  702. default:
  703. printk(KERN_WARNING
  704. "act2000: addcard: Invalid BUS type %d\n",
  705. p->bus);
  706. }
  707. } else
  708. /* Card already initialized */
  709. initialized = 1;
  710. if (initialized) {
  711. /* Init OK, next card ... */
  712. q = p;
  713. p = p->next;
  714. } else {
  715. /* Init failed, remove card from list, free memory */
  716. printk(KERN_WARNING
  717. "act2000: Initialization of %s failed\n",
  718. p->interface.id);
  719. if (q) {
  720. q->next = p->next;
  721. kfree(p);
  722. p = q->next;
  723. } else {
  724. cards = p->next;
  725. kfree(p);
  726. p = cards;
  727. }
  728. failed++;
  729. }
  730. }
  731. return (added - failed);
  732. }
  733. #define DRIVERNAME "IBM Active 2000 ISDN driver"
  734. static int __init act2000_init(void)
  735. {
  736. printk(KERN_INFO "%s\n", DRIVERNAME);
  737. if (!cards)
  738. act2000_addcard(act_bus, act_port, act_irq, act_id);
  739. if (!cards)
  740. printk(KERN_INFO "act2000: No cards defined yet\n");
  741. return 0;
  742. }
  743. static void __exit act2000_exit(void)
  744. {
  745. act2000_card *card = cards;
  746. act2000_card *last;
  747. while (card) {
  748. unregister_card(card);
  749. del_timer(&card->ptimer);
  750. card = card->next;
  751. }
  752. card = cards;
  753. while (card) {
  754. last = card;
  755. card = card->next;
  756. act2000_clear_msn(last);
  757. kfree(last);
  758. }
  759. printk(KERN_INFO "%s unloaded\n", DRIVERNAME);
  760. }
  761. module_init(act2000_init);
  762. module_exit(act2000_exit);