Committer: Michael Beasley <mike@snafu.setup>
[mikesnafu-overlay.git] / drivers / isdn / act2000 / capi.c
blob946c38cf6f8a66322923cb4104d5ebc268fd62cf
1 /* $Id: capi.c,v 1.9.6.2 2001/09/23 22:24:32 kai Exp $
3 * ISDN lowlevel-module for the IBM ISDN-S0 Active 2000.
4 * CAPI encoder/decoder
6 * Author Fritz Elfert
7 * Copyright by Fritz Elfert <fritz@isdn4linux.de>
8 *
9 * This software may be used and distributed according to the terms
10 * of the GNU General Public License, incorporated herein by reference.
12 * Thanks to Friedemann Baitinger and IBM Germany
16 #include "act2000.h"
17 #include "capi.h"
19 static actcapi_msgdsc valid_msg[] = {
20 {{ 0x86, 0x02}, "DATA_B3_IND"}, /* DATA_B3_IND/CONF must be first because of speed!!! */
21 {{ 0x86, 0x01}, "DATA_B3_CONF"},
22 {{ 0x02, 0x01}, "CONNECT_CONF"},
23 {{ 0x02, 0x02}, "CONNECT_IND"},
24 {{ 0x09, 0x01}, "CONNECT_INFO_CONF"},
25 {{ 0x03, 0x02}, "CONNECT_ACTIVE_IND"},
26 {{ 0x04, 0x01}, "DISCONNECT_CONF"},
27 {{ 0x04, 0x02}, "DISCONNECT_IND"},
28 {{ 0x05, 0x01}, "LISTEN_CONF"},
29 {{ 0x06, 0x01}, "GET_PARAMS_CONF"},
30 {{ 0x07, 0x01}, "INFO_CONF"},
31 {{ 0x07, 0x02}, "INFO_IND"},
32 {{ 0x08, 0x01}, "DATA_CONF"},
33 {{ 0x08, 0x02}, "DATA_IND"},
34 {{ 0x40, 0x01}, "SELECT_B2_PROTOCOL_CONF"},
35 {{ 0x80, 0x01}, "SELECT_B3_PROTOCOL_CONF"},
36 {{ 0x81, 0x01}, "LISTEN_B3_CONF"},
37 {{ 0x82, 0x01}, "CONNECT_B3_CONF"},
38 {{ 0x82, 0x02}, "CONNECT_B3_IND"},
39 {{ 0x83, 0x02}, "CONNECT_B3_ACTIVE_IND"},
40 {{ 0x84, 0x01}, "DISCONNECT_B3_CONF"},
41 {{ 0x84, 0x02}, "DISCONNECT_B3_IND"},
42 {{ 0x85, 0x01}, "GET_B3_PARAMS_CONF"},
43 {{ 0x01, 0x01}, "RESET_B3_CONF"},
44 {{ 0x01, 0x02}, "RESET_B3_IND"},
45 /* {{ 0x87, 0x02, "HANDSET_IND"}, not implemented */
46 {{ 0xff, 0x01}, "MANUFACTURER_CONF"},
47 {{ 0xff, 0x02}, "MANUFACTURER_IND"},
48 #ifdef DEBUG_MSG
49 /* Requests */
50 {{ 0x01, 0x00}, "RESET_B3_REQ"},
51 {{ 0x02, 0x00}, "CONNECT_REQ"},
52 {{ 0x04, 0x00}, "DISCONNECT_REQ"},
53 {{ 0x05, 0x00}, "LISTEN_REQ"},
54 {{ 0x06, 0x00}, "GET_PARAMS_REQ"},
55 {{ 0x07, 0x00}, "INFO_REQ"},
56 {{ 0x08, 0x00}, "DATA_REQ"},
57 {{ 0x09, 0x00}, "CONNECT_INFO_REQ"},
58 {{ 0x40, 0x00}, "SELECT_B2_PROTOCOL_REQ"},
59 {{ 0x80, 0x00}, "SELECT_B3_PROTOCOL_REQ"},
60 {{ 0x81, 0x00}, "LISTEN_B3_REQ"},
61 {{ 0x82, 0x00}, "CONNECT_B3_REQ"},
62 {{ 0x84, 0x00}, "DISCONNECT_B3_REQ"},
63 {{ 0x85, 0x00}, "GET_B3_PARAMS_REQ"},
64 {{ 0x86, 0x00}, "DATA_B3_REQ"},
65 {{ 0xff, 0x00}, "MANUFACTURER_REQ"},
66 /* Responses */
67 {{ 0x01, 0x03}, "RESET_B3_RESP"},
68 {{ 0x02, 0x03}, "CONNECT_RESP"},
69 {{ 0x03, 0x03}, "CONNECT_ACTIVE_RESP"},
70 {{ 0x04, 0x03}, "DISCONNECT_RESP"},
71 {{ 0x07, 0x03}, "INFO_RESP"},
72 {{ 0x08, 0x03}, "DATA_RESP"},
73 {{ 0x82, 0x03}, "CONNECT_B3_RESP"},
74 {{ 0x83, 0x03}, "CONNECT_B3_ACTIVE_RESP"},
75 {{ 0x84, 0x03}, "DISCONNECT_B3_RESP"},
76 {{ 0x86, 0x03}, "DATA_B3_RESP"},
77 {{ 0xff, 0x03}, "MANUFACTURER_RESP"},
78 #endif
79 {{ 0x00, 0x00}, NULL},
81 #define num_valid_msg (sizeof(valid_msg)/sizeof(actcapi_msgdsc))
82 #define num_valid_imsg 27 /* MANUFACTURER_IND */
85 * Check for a valid incoming CAPI message.
86 * Return:
87 * 0 = Invalid message
88 * 1 = Valid message, no B-Channel-data
89 * 2 = Valid message, B-Channel-data
91 int
92 actcapi_chkhdr(act2000_card * card, actcapi_msghdr *hdr)
94 int i;
96 if (hdr->applicationID != 1)
97 return 0;
98 if (hdr->len < 9)
99 return 0;
100 for (i = 0; i < num_valid_imsg; i++)
101 if ((hdr->cmd.cmd == valid_msg[i].cmd.cmd) &&
102 (hdr->cmd.subcmd == valid_msg[i].cmd.subcmd)) {
103 return (i?1:2);
105 return 0;
108 #define ACTCAPI_MKHDR(l, c, s) { \
109 skb = alloc_skb(l + 8, GFP_ATOMIC); \
110 if (skb) { \
111 m = (actcapi_msg *)skb_put(skb, l + 8); \
112 m->hdr.len = l + 8; \
113 m->hdr.applicationID = 1; \
114 m->hdr.cmd.cmd = c; \
115 m->hdr.cmd.subcmd = s; \
116 m->hdr.msgnum = actcapi_nextsmsg(card); \
117 } else m = NULL;\
120 #define ACTCAPI_CHKSKB if (!skb) { \
121 printk(KERN_WARNING "actcapi: alloc_skb failed\n"); \
122 return; \
125 #define ACTCAPI_QUEUE_TX { \
126 actcapi_debug_msg(skb, 1); \
127 skb_queue_tail(&card->sndq, skb); \
128 act2000_schedule_tx(card); \
132 actcapi_listen_req(act2000_card *card)
134 __u16 eazmask = 0;
135 int i;
136 actcapi_msg *m;
137 struct sk_buff *skb;
139 for (i = 0; i < ACT2000_BCH; i++)
140 eazmask |= card->bch[i].eazmask;
141 ACTCAPI_MKHDR(9, 0x05, 0x00);
142 if (!skb) {
143 printk(KERN_WARNING "actcapi: alloc_skb failed\n");
144 return -ENOMEM;
146 m->msg.listen_req.controller = 0;
147 m->msg.listen_req.infomask = 0x3f; /* All information */
148 m->msg.listen_req.eazmask = eazmask;
149 m->msg.listen_req.simask = (eazmask)?0x86:0; /* All SI's */
150 ACTCAPI_QUEUE_TX;
151 return 0;
155 actcapi_connect_req(act2000_card *card, act2000_chan *chan, char *phone,
156 char eaz, int si1, int si2)
158 actcapi_msg *m;
159 struct sk_buff *skb;
161 ACTCAPI_MKHDR((11 + strlen(phone)), 0x02, 0x00);
162 if (!skb) {
163 printk(KERN_WARNING "actcapi: alloc_skb failed\n");
164 chan->fsm_state = ACT2000_STATE_NULL;
165 return -ENOMEM;
167 m->msg.connect_req.controller = 0;
168 m->msg.connect_req.bchan = 0x83;
169 m->msg.connect_req.infomask = 0x3f;
170 m->msg.connect_req.si1 = si1;
171 m->msg.connect_req.si2 = si2;
172 m->msg.connect_req.eaz = eaz?eaz:'0';
173 m->msg.connect_req.addr.len = strlen(phone) + 1;
174 m->msg.connect_req.addr.tnp = 0x81;
175 memcpy(m->msg.connect_req.addr.num, phone, strlen(phone));
176 chan->callref = m->hdr.msgnum;
177 ACTCAPI_QUEUE_TX;
178 return 0;
181 static void
182 actcapi_connect_b3_req(act2000_card *card, act2000_chan *chan)
184 actcapi_msg *m;
185 struct sk_buff *skb;
187 ACTCAPI_MKHDR(17, 0x82, 0x00);
188 ACTCAPI_CHKSKB;
189 m->msg.connect_b3_req.plci = chan->plci;
190 memset(&m->msg.connect_b3_req.ncpi, 0,
191 sizeof(m->msg.connect_b3_req.ncpi));
192 m->msg.connect_b3_req.ncpi.len = 13;
193 m->msg.connect_b3_req.ncpi.modulo = 8;
194 ACTCAPI_QUEUE_TX;
198 * Set net type (1TR6) or (EDSS1)
201 actcapi_manufacturer_req_net(act2000_card *card)
203 actcapi_msg *m;
204 struct sk_buff *skb;
206 ACTCAPI_MKHDR(5, 0xff, 0x00);
207 if (!skb) {
208 printk(KERN_WARNING "actcapi: alloc_skb failed\n");
209 return -ENOMEM;
211 m->msg.manufacturer_req_net.manuf_msg = 0x11;
212 m->msg.manufacturer_req_net.controller = 1;
213 m->msg.manufacturer_req_net.nettype = (card->ptype == ISDN_PTYPE_EURO)?1:0;
214 ACTCAPI_QUEUE_TX;
215 printk(KERN_INFO "act2000 %s: D-channel protocol now %s\n",
216 card->interface.id, (card->ptype == ISDN_PTYPE_EURO)?"euro":"1tr6");
217 card->interface.features &=
218 ~(ISDN_FEATURE_P_UNKNOWN | ISDN_FEATURE_P_EURO | ISDN_FEATURE_P_1TR6);
219 card->interface.features |=
220 ((card->ptype == ISDN_PTYPE_EURO)?ISDN_FEATURE_P_EURO:ISDN_FEATURE_P_1TR6);
221 return 0;
225 * Switch V.42 on or off
227 #if 0
229 actcapi_manufacturer_req_v42(act2000_card *card, ulong arg)
231 actcapi_msg *m;
232 struct sk_buff *skb;
234 ACTCAPI_MKHDR(8, 0xff, 0x00);
235 if (!skb) {
237 printk(KERN_WARNING "actcapi: alloc_skb failed\n");
238 return -ENOMEM;
240 m->msg.manufacturer_req_v42.manuf_msg = 0x10;
241 m->msg.manufacturer_req_v42.controller = 0;
242 m->msg.manufacturer_req_v42.v42control = (arg?1:0);
243 ACTCAPI_QUEUE_TX;
244 return 0;
246 #endif /* 0 */
249 * Set error-handler
252 actcapi_manufacturer_req_errh(act2000_card *card)
254 actcapi_msg *m;
255 struct sk_buff *skb;
257 ACTCAPI_MKHDR(4, 0xff, 0x00);
258 if (!skb) {
260 printk(KERN_WARNING "actcapi: alloc_skb failed\n");
261 return -ENOMEM;
263 m->msg.manufacturer_req_err.manuf_msg = 0x03;
264 m->msg.manufacturer_req_err.controller = 0;
265 ACTCAPI_QUEUE_TX;
266 return 0;
270 * Set MSN-Mapping.
273 actcapi_manufacturer_req_msn(act2000_card *card)
275 msn_entry *p = card->msn_list;
276 actcapi_msg *m;
277 struct sk_buff *skb;
278 int len;
280 while (p) {
281 int i;
283 len = strlen(p->msn);
284 for (i = 0; i < 2; i++) {
285 ACTCAPI_MKHDR(6 + len, 0xff, 0x00);
286 if (!skb) {
287 printk(KERN_WARNING "actcapi: alloc_skb failed\n");
288 return -ENOMEM;
290 m->msg.manufacturer_req_msn.manuf_msg = 0x13 + i;
291 m->msg.manufacturer_req_msn.controller = 0;
292 m->msg.manufacturer_req_msn.msnmap.eaz = p->eaz;
293 m->msg.manufacturer_req_msn.msnmap.len = len;
294 memcpy(m->msg.manufacturer_req_msn.msnmap.msn, p->msn, len);
295 ACTCAPI_QUEUE_TX;
297 p = p->next;
299 return 0;
302 void
303 actcapi_select_b2_protocol_req(act2000_card *card, act2000_chan *chan)
305 actcapi_msg *m;
306 struct sk_buff *skb;
308 ACTCAPI_MKHDR(10, 0x40, 0x00);
309 ACTCAPI_CHKSKB;
310 m->msg.select_b2_protocol_req.plci = chan->plci;
311 memset(&m->msg.select_b2_protocol_req.dlpd, 0,
312 sizeof(m->msg.select_b2_protocol_req.dlpd));
313 m->msg.select_b2_protocol_req.dlpd.len = 6;
314 switch (chan->l2prot) {
315 case ISDN_PROTO_L2_TRANS:
316 m->msg.select_b2_protocol_req.protocol = 0x03;
317 m->msg.select_b2_protocol_req.dlpd.dlen = 4000;
318 break;
319 case ISDN_PROTO_L2_HDLC:
320 m->msg.select_b2_protocol_req.protocol = 0x02;
321 m->msg.select_b2_protocol_req.dlpd.dlen = 4000;
322 break;
323 case ISDN_PROTO_L2_X75I:
324 case ISDN_PROTO_L2_X75UI:
325 case ISDN_PROTO_L2_X75BUI:
326 m->msg.select_b2_protocol_req.protocol = 0x01;
327 m->msg.select_b2_protocol_req.dlpd.dlen = 4000;
328 m->msg.select_b2_protocol_req.dlpd.laa = 3;
329 m->msg.select_b2_protocol_req.dlpd.lab = 1;
330 m->msg.select_b2_protocol_req.dlpd.win = 7;
331 m->msg.select_b2_protocol_req.dlpd.modulo = 8;
332 break;
334 ACTCAPI_QUEUE_TX;
337 static void
338 actcapi_select_b3_protocol_req(act2000_card *card, act2000_chan *chan)
340 actcapi_msg *m;
341 struct sk_buff *skb;
343 ACTCAPI_MKHDR(17, 0x80, 0x00);
344 ACTCAPI_CHKSKB;
345 m->msg.select_b3_protocol_req.plci = chan->plci;
346 memset(&m->msg.select_b3_protocol_req.ncpd, 0,
347 sizeof(m->msg.select_b3_protocol_req.ncpd));
348 switch (chan->l3prot) {
349 case ISDN_PROTO_L3_TRANS:
350 m->msg.select_b3_protocol_req.protocol = 0x04;
351 m->msg.select_b3_protocol_req.ncpd.len = 13;
352 m->msg.select_b3_protocol_req.ncpd.modulo = 8;
353 break;
355 ACTCAPI_QUEUE_TX;
358 static void
359 actcapi_listen_b3_req(act2000_card *card, act2000_chan *chan)
361 actcapi_msg *m;
362 struct sk_buff *skb;
364 ACTCAPI_MKHDR(2, 0x81, 0x00);
365 ACTCAPI_CHKSKB;
366 m->msg.listen_b3_req.plci = chan->plci;
367 ACTCAPI_QUEUE_TX;
370 static void
371 actcapi_disconnect_req(act2000_card *card, act2000_chan *chan)
373 actcapi_msg *m;
374 struct sk_buff *skb;
376 ACTCAPI_MKHDR(3, 0x04, 0x00);
377 ACTCAPI_CHKSKB;
378 m->msg.disconnect_req.plci = chan->plci;
379 m->msg.disconnect_req.cause = 0;
380 ACTCAPI_QUEUE_TX;
383 void
384 actcapi_disconnect_b3_req(act2000_card *card, act2000_chan *chan)
386 actcapi_msg *m;
387 struct sk_buff *skb;
389 ACTCAPI_MKHDR(17, 0x84, 0x00);
390 ACTCAPI_CHKSKB;
391 m->msg.disconnect_b3_req.ncci = chan->ncci;
392 memset(&m->msg.disconnect_b3_req.ncpi, 0,
393 sizeof(m->msg.disconnect_b3_req.ncpi));
394 m->msg.disconnect_b3_req.ncpi.len = 13;
395 m->msg.disconnect_b3_req.ncpi.modulo = 8;
396 chan->fsm_state = ACT2000_STATE_BHWAIT;
397 ACTCAPI_QUEUE_TX;
400 void
401 actcapi_connect_resp(act2000_card *card, act2000_chan *chan, __u8 cause)
403 actcapi_msg *m;
404 struct sk_buff *skb;
406 ACTCAPI_MKHDR(3, 0x02, 0x03);
407 ACTCAPI_CHKSKB;
408 m->msg.connect_resp.plci = chan->plci;
409 m->msg.connect_resp.rejectcause = cause;
410 if (cause) {
411 chan->fsm_state = ACT2000_STATE_NULL;
412 chan->plci = 0x8000;
413 } else
414 chan->fsm_state = ACT2000_STATE_IWAIT;
415 ACTCAPI_QUEUE_TX;
418 static void
419 actcapi_connect_active_resp(act2000_card *card, act2000_chan *chan)
421 actcapi_msg *m;
422 struct sk_buff *skb;
424 ACTCAPI_MKHDR(2, 0x03, 0x03);
425 ACTCAPI_CHKSKB;
426 m->msg.connect_resp.plci = chan->plci;
427 if (chan->fsm_state == ACT2000_STATE_IWAIT)
428 chan->fsm_state = ACT2000_STATE_IBWAIT;
429 ACTCAPI_QUEUE_TX;
432 static void
433 actcapi_connect_b3_resp(act2000_card *card, act2000_chan *chan, __u8 rejectcause)
435 actcapi_msg *m;
436 struct sk_buff *skb;
438 ACTCAPI_MKHDR((rejectcause?3:17), 0x82, 0x03);
439 ACTCAPI_CHKSKB;
440 m->msg.connect_b3_resp.ncci = chan->ncci;
441 m->msg.connect_b3_resp.rejectcause = rejectcause;
442 if (!rejectcause) {
443 memset(&m->msg.connect_b3_resp.ncpi, 0,
444 sizeof(m->msg.connect_b3_resp.ncpi));
445 m->msg.connect_b3_resp.ncpi.len = 13;
446 m->msg.connect_b3_resp.ncpi.modulo = 8;
447 chan->fsm_state = ACT2000_STATE_BWAIT;
449 ACTCAPI_QUEUE_TX;
452 static void
453 actcapi_connect_b3_active_resp(act2000_card *card, act2000_chan *chan)
455 actcapi_msg *m;
456 struct sk_buff *skb;
458 ACTCAPI_MKHDR(2, 0x83, 0x03);
459 ACTCAPI_CHKSKB;
460 m->msg.connect_b3_active_resp.ncci = chan->ncci;
461 chan->fsm_state = ACT2000_STATE_ACTIVE;
462 ACTCAPI_QUEUE_TX;
465 static void
466 actcapi_info_resp(act2000_card *card, act2000_chan *chan)
468 actcapi_msg *m;
469 struct sk_buff *skb;
471 ACTCAPI_MKHDR(2, 0x07, 0x03);
472 ACTCAPI_CHKSKB;
473 m->msg.info_resp.plci = chan->plci;
474 ACTCAPI_QUEUE_TX;
477 static void
478 actcapi_disconnect_b3_resp(act2000_card *card, act2000_chan *chan)
480 actcapi_msg *m;
481 struct sk_buff *skb;
483 ACTCAPI_MKHDR(2, 0x84, 0x03);
484 ACTCAPI_CHKSKB;
485 m->msg.disconnect_b3_resp.ncci = chan->ncci;
486 chan->ncci = 0x8000;
487 chan->queued = 0;
488 ACTCAPI_QUEUE_TX;
491 static void
492 actcapi_disconnect_resp(act2000_card *card, act2000_chan *chan)
494 actcapi_msg *m;
495 struct sk_buff *skb;
497 ACTCAPI_MKHDR(2, 0x04, 0x03);
498 ACTCAPI_CHKSKB;
499 m->msg.disconnect_resp.plci = chan->plci;
500 chan->plci = 0x8000;
501 ACTCAPI_QUEUE_TX;
504 static int
505 new_plci(act2000_card *card, __u16 plci)
507 int i;
508 for (i = 0; i < ACT2000_BCH; i++)
509 if (card->bch[i].plci == 0x8000) {
510 card->bch[i].plci = plci;
511 return i;
513 return -1;
516 static int
517 find_plci(act2000_card *card, __u16 plci)
519 int i;
520 for (i = 0; i < ACT2000_BCH; i++)
521 if (card->bch[i].plci == plci)
522 return i;
523 return -1;
526 static int
527 find_ncci(act2000_card *card, __u16 ncci)
529 int i;
530 for (i = 0; i < ACT2000_BCH; i++)
531 if (card->bch[i].ncci == ncci)
532 return i;
533 return -1;
536 static int
537 find_dialing(act2000_card *card, __u16 callref)
539 int i;
540 for (i = 0; i < ACT2000_BCH; i++)
541 if ((card->bch[i].callref == callref) &&
542 (card->bch[i].fsm_state == ACT2000_STATE_OCALL))
543 return i;
544 return -1;
547 static int
548 actcapi_data_b3_ind(act2000_card *card, struct sk_buff *skb) {
549 __u16 plci;
550 __u16 ncci;
551 __u16 controller;
552 __u8 blocknr;
553 int chan;
554 actcapi_msg *msg = (actcapi_msg *)skb->data;
556 EVAL_NCCI(msg->msg.data_b3_ind.fakencci, plci, controller, ncci);
557 chan = find_ncci(card, ncci);
558 if (chan < 0)
559 return 0;
560 if (card->bch[chan].fsm_state != ACT2000_STATE_ACTIVE)
561 return 0;
562 if (card->bch[chan].plci != plci)
563 return 0;
564 blocknr = msg->msg.data_b3_ind.blocknr;
565 skb_pull(skb, 19);
566 card->interface.rcvcallb_skb(card->myid, chan, skb);
567 if (!(skb = alloc_skb(11, GFP_ATOMIC))) {
568 printk(KERN_WARNING "actcapi: alloc_skb failed\n");
569 return 1;
571 msg = (actcapi_msg *)skb_put(skb, 11);
572 msg->hdr.len = 11;
573 msg->hdr.applicationID = 1;
574 msg->hdr.cmd.cmd = 0x86;
575 msg->hdr.cmd.subcmd = 0x03;
576 msg->hdr.msgnum = actcapi_nextsmsg(card);
577 msg->msg.data_b3_resp.ncci = ncci;
578 msg->msg.data_b3_resp.blocknr = blocknr;
579 ACTCAPI_QUEUE_TX;
580 return 1;
584 * Walk over ackq, unlink DATA_B3_REQ from it, if
585 * ncci and blocknr are matching.
586 * Decrement queued-bytes counter.
588 static int
589 handle_ack(act2000_card *card, act2000_chan *chan, __u8 blocknr) {
590 unsigned long flags;
591 struct sk_buff *skb;
592 struct sk_buff *tmp;
593 struct actcapi_msg *m;
594 int ret = 0;
596 spin_lock_irqsave(&card->lock, flags);
597 skb = skb_peek(&card->ackq);
598 spin_unlock_irqrestore(&card->lock, flags);
599 if (!skb) {
600 printk(KERN_WARNING "act2000: handle_ack nothing found!\n");
601 return 0;
603 tmp = skb;
604 while (1) {
605 m = (actcapi_msg *)tmp->data;
606 if ((((m->msg.data_b3_req.fakencci >> 8) & 0xff) == chan->ncci) &&
607 (m->msg.data_b3_req.blocknr == blocknr)) {
608 /* found corresponding DATA_B3_REQ */
609 skb_unlink(tmp, &card->ackq);
610 chan->queued -= m->msg.data_b3_req.datalen;
611 if (m->msg.data_b3_req.flags)
612 ret = m->msg.data_b3_req.datalen;
613 dev_kfree_skb(tmp);
614 if (chan->queued < 0)
615 chan->queued = 0;
616 return ret;
618 spin_lock_irqsave(&card->lock, flags);
619 tmp = skb_peek((struct sk_buff_head *)tmp);
620 spin_unlock_irqrestore(&card->lock, flags);
621 if ((tmp == skb) || (tmp == NULL)) {
622 /* reached end of queue */
623 printk(KERN_WARNING "act2000: handle_ack nothing found!\n");
624 return 0;
629 void
630 actcapi_dispatch(struct work_struct *work)
632 struct act2000_card *card =
633 container_of(work, struct act2000_card, rcv_tq);
634 struct sk_buff *skb;
635 actcapi_msg *msg;
636 __u16 ccmd;
637 int chan;
638 int len;
639 act2000_chan *ctmp;
640 isdn_ctrl cmd;
641 char tmp[170];
643 while ((skb = skb_dequeue(&card->rcvq))) {
644 actcapi_debug_msg(skb, 0);
645 msg = (actcapi_msg *)skb->data;
646 ccmd = ((msg->hdr.cmd.cmd << 8) | msg->hdr.cmd.subcmd);
647 switch (ccmd) {
648 case 0x8602:
649 /* DATA_B3_IND */
650 if (actcapi_data_b3_ind(card, skb))
651 return;
652 break;
653 case 0x8601:
654 /* DATA_B3_CONF */
655 chan = find_ncci(card, msg->msg.data_b3_conf.ncci);
656 if ((chan >= 0) && (card->bch[chan].fsm_state == ACT2000_STATE_ACTIVE)) {
657 if (msg->msg.data_b3_conf.info != 0)
658 printk(KERN_WARNING "act2000: DATA_B3_CONF: %04x\n",
659 msg->msg.data_b3_conf.info);
660 len = handle_ack(card, &card->bch[chan],
661 msg->msg.data_b3_conf.blocknr);
662 if (len) {
663 cmd.driver = card->myid;
664 cmd.command = ISDN_STAT_BSENT;
665 cmd.arg = chan;
666 cmd.parm.length = len;
667 card->interface.statcallb(&cmd);
670 break;
671 case 0x0201:
672 /* CONNECT_CONF */
673 chan = find_dialing(card, msg->hdr.msgnum);
674 if (chan >= 0) {
675 if (msg->msg.connect_conf.info) {
676 card->bch[chan].fsm_state = ACT2000_STATE_NULL;
677 cmd.driver = card->myid;
678 cmd.command = ISDN_STAT_DHUP;
679 cmd.arg = chan;
680 card->interface.statcallb(&cmd);
681 } else {
682 card->bch[chan].fsm_state = ACT2000_STATE_OWAIT;
683 card->bch[chan].plci = msg->msg.connect_conf.plci;
686 break;
687 case 0x0202:
688 /* CONNECT_IND */
689 chan = new_plci(card, msg->msg.connect_ind.plci);
690 if (chan < 0) {
691 ctmp = (act2000_chan *)tmp;
692 ctmp->plci = msg->msg.connect_ind.plci;
693 actcapi_connect_resp(card, ctmp, 0x11); /* All Card-Cannels busy */
694 } else {
695 card->bch[chan].fsm_state = ACT2000_STATE_ICALL;
696 cmd.driver = card->myid;
697 cmd.command = ISDN_STAT_ICALL;
698 cmd.arg = chan;
699 cmd.parm.setup.si1 = msg->msg.connect_ind.si1;
700 cmd.parm.setup.si2 = msg->msg.connect_ind.si2;
701 if (card->ptype == ISDN_PTYPE_EURO)
702 strcpy(cmd.parm.setup.eazmsn,
703 act2000_find_eaz(card, msg->msg.connect_ind.eaz));
704 else {
705 cmd.parm.setup.eazmsn[0] = msg->msg.connect_ind.eaz;
706 cmd.parm.setup.eazmsn[1] = 0;
708 memset(cmd.parm.setup.phone, 0, sizeof(cmd.parm.setup.phone));
709 memcpy(cmd.parm.setup.phone, msg->msg.connect_ind.addr.num,
710 msg->msg.connect_ind.addr.len - 1);
711 cmd.parm.setup.plan = msg->msg.connect_ind.addr.tnp;
712 cmd.parm.setup.screen = 0;
713 if (card->interface.statcallb(&cmd) == 2)
714 actcapi_connect_resp(card, &card->bch[chan], 0x15); /* Reject Call */
716 break;
717 case 0x0302:
718 /* CONNECT_ACTIVE_IND */
719 chan = find_plci(card, msg->msg.connect_active_ind.plci);
720 if (chan >= 0)
721 switch (card->bch[chan].fsm_state) {
722 case ACT2000_STATE_IWAIT:
723 actcapi_connect_active_resp(card, &card->bch[chan]);
724 break;
725 case ACT2000_STATE_OWAIT:
726 actcapi_connect_active_resp(card, &card->bch[chan]);
727 actcapi_select_b2_protocol_req(card, &card->bch[chan]);
728 break;
730 break;
731 case 0x8202:
732 /* CONNECT_B3_IND */
733 chan = find_plci(card, msg->msg.connect_b3_ind.plci);
734 if ((chan >= 0) && (card->bch[chan].fsm_state == ACT2000_STATE_IBWAIT)) {
735 card->bch[chan].ncci = msg->msg.connect_b3_ind.ncci;
736 actcapi_connect_b3_resp(card, &card->bch[chan], 0);
737 } else {
738 ctmp = (act2000_chan *)tmp;
739 ctmp->ncci = msg->msg.connect_b3_ind.ncci;
740 actcapi_connect_b3_resp(card, ctmp, 0x11); /* All Card-Cannels busy */
742 break;
743 case 0x8302:
744 /* CONNECT_B3_ACTIVE_IND */
745 chan = find_ncci(card, msg->msg.connect_b3_active_ind.ncci);
746 if ((chan >= 0) && (card->bch[chan].fsm_state == ACT2000_STATE_BWAIT)) {
747 actcapi_connect_b3_active_resp(card, &card->bch[chan]);
748 cmd.driver = card->myid;
749 cmd.command = ISDN_STAT_BCONN;
750 cmd.arg = chan;
751 card->interface.statcallb(&cmd);
753 break;
754 case 0x8402:
755 /* DISCONNECT_B3_IND */
756 chan = find_ncci(card, msg->msg.disconnect_b3_ind.ncci);
757 if (chan >= 0) {
758 ctmp = &card->bch[chan];
759 actcapi_disconnect_b3_resp(card, ctmp);
760 switch (ctmp->fsm_state) {
761 case ACT2000_STATE_ACTIVE:
762 ctmp->fsm_state = ACT2000_STATE_DHWAIT2;
763 cmd.driver = card->myid;
764 cmd.command = ISDN_STAT_BHUP;
765 cmd.arg = chan;
766 card->interface.statcallb(&cmd);
767 break;
768 case ACT2000_STATE_BHWAIT2:
769 actcapi_disconnect_req(card, ctmp);
770 ctmp->fsm_state = ACT2000_STATE_DHWAIT;
771 cmd.driver = card->myid;
772 cmd.command = ISDN_STAT_BHUP;
773 cmd.arg = chan;
774 card->interface.statcallb(&cmd);
775 break;
778 break;
779 case 0x0402:
780 /* DISCONNECT_IND */
781 chan = find_plci(card, msg->msg.disconnect_ind.plci);
782 if (chan >= 0) {
783 ctmp = &card->bch[chan];
784 actcapi_disconnect_resp(card, ctmp);
785 ctmp->fsm_state = ACT2000_STATE_NULL;
786 cmd.driver = card->myid;
787 cmd.command = ISDN_STAT_DHUP;
788 cmd.arg = chan;
789 card->interface.statcallb(&cmd);
790 } else {
791 ctmp = (act2000_chan *)tmp;
792 ctmp->plci = msg->msg.disconnect_ind.plci;
793 actcapi_disconnect_resp(card, ctmp);
795 break;
796 case 0x4001:
797 /* SELECT_B2_PROTOCOL_CONF */
798 chan = find_plci(card, msg->msg.select_b2_protocol_conf.plci);
799 if (chan >= 0)
800 switch (card->bch[chan].fsm_state) {
801 case ACT2000_STATE_ICALL:
802 case ACT2000_STATE_OWAIT:
803 ctmp = &card->bch[chan];
804 if (msg->msg.select_b2_protocol_conf.info == 0)
805 actcapi_select_b3_protocol_req(card, ctmp);
806 else {
807 ctmp->fsm_state = ACT2000_STATE_NULL;
808 cmd.driver = card->myid;
809 cmd.command = ISDN_STAT_DHUP;
810 cmd.arg = chan;
811 card->interface.statcallb(&cmd);
813 break;
815 break;
816 case 0x8001:
817 /* SELECT_B3_PROTOCOL_CONF */
818 chan = find_plci(card, msg->msg.select_b3_protocol_conf.plci);
819 if (chan >= 0)
820 switch (card->bch[chan].fsm_state) {
821 case ACT2000_STATE_ICALL:
822 case ACT2000_STATE_OWAIT:
823 ctmp = &card->bch[chan];
824 if (msg->msg.select_b3_protocol_conf.info == 0)
825 actcapi_listen_b3_req(card, ctmp);
826 else {
827 ctmp->fsm_state = ACT2000_STATE_NULL;
828 cmd.driver = card->myid;
829 cmd.command = ISDN_STAT_DHUP;
830 cmd.arg = chan;
831 card->interface.statcallb(&cmd);
834 break;
835 case 0x8101:
836 /* LISTEN_B3_CONF */
837 chan = find_plci(card, msg->msg.listen_b3_conf.plci);
838 if (chan >= 0)
839 switch (card->bch[chan].fsm_state) {
840 case ACT2000_STATE_ICALL:
841 ctmp = &card->bch[chan];
842 if (msg->msg.listen_b3_conf.info == 0)
843 actcapi_connect_resp(card, ctmp, 0);
844 else {
845 ctmp->fsm_state = ACT2000_STATE_NULL;
846 cmd.driver = card->myid;
847 cmd.command = ISDN_STAT_DHUP;
848 cmd.arg = chan;
849 card->interface.statcallb(&cmd);
851 break;
852 case ACT2000_STATE_OWAIT:
853 ctmp = &card->bch[chan];
854 if (msg->msg.listen_b3_conf.info == 0) {
855 actcapi_connect_b3_req(card, ctmp);
856 ctmp->fsm_state = ACT2000_STATE_OBWAIT;
857 cmd.driver = card->myid;
858 cmd.command = ISDN_STAT_DCONN;
859 cmd.arg = chan;
860 card->interface.statcallb(&cmd);
861 } else {
862 ctmp->fsm_state = ACT2000_STATE_NULL;
863 cmd.driver = card->myid;
864 cmd.command = ISDN_STAT_DHUP;
865 cmd.arg = chan;
866 card->interface.statcallb(&cmd);
868 break;
870 break;
871 case 0x8201:
872 /* CONNECT_B3_CONF */
873 chan = find_plci(card, msg->msg.connect_b3_conf.plci);
874 if ((chan >= 0) && (card->bch[chan].fsm_state == ACT2000_STATE_OBWAIT)) {
875 ctmp = &card->bch[chan];
876 if (msg->msg.connect_b3_conf.info) {
877 ctmp->fsm_state = ACT2000_STATE_NULL;
878 cmd.driver = card->myid;
879 cmd.command = ISDN_STAT_DHUP;
880 cmd.arg = chan;
881 card->interface.statcallb(&cmd);
882 } else {
883 ctmp->ncci = msg->msg.connect_b3_conf.ncci;
884 ctmp->fsm_state = ACT2000_STATE_BWAIT;
887 break;
888 case 0x8401:
889 /* DISCONNECT_B3_CONF */
890 chan = find_ncci(card, msg->msg.disconnect_b3_conf.ncci);
891 if ((chan >= 0) && (card->bch[chan].fsm_state == ACT2000_STATE_BHWAIT))
892 card->bch[chan].fsm_state = ACT2000_STATE_BHWAIT2;
893 break;
894 case 0x0702:
895 /* INFO_IND */
896 chan = find_plci(card, msg->msg.info_ind.plci);
897 if (chan >= 0)
898 /* TODO: Eval Charging info / cause */
899 actcapi_info_resp(card, &card->bch[chan]);
900 break;
901 case 0x0401:
902 /* LISTEN_CONF */
903 case 0x0501:
904 /* LISTEN_CONF */
905 case 0xff01:
906 /* MANUFACTURER_CONF */
907 break;
908 case 0xff02:
909 /* MANUFACTURER_IND */
910 if (msg->msg.manuf_msg == 3) {
911 memset(tmp, 0, sizeof(tmp));
912 strncpy(tmp,
913 &msg->msg.manufacturer_ind_err.errstring,
914 msg->hdr.len - 16);
915 if (msg->msg.manufacturer_ind_err.errcode)
916 printk(KERN_WARNING "act2000: %s\n", tmp);
917 else {
918 printk(KERN_DEBUG "act2000: %s\n", tmp);
919 if ((!strncmp(tmp, "INFO: Trace buffer con", 22)) ||
920 (!strncmp(tmp, "INFO: Compile Date/Tim", 22))) {
921 card->flags |= ACT2000_FLAGS_RUNNING;
922 cmd.command = ISDN_STAT_RUN;
923 cmd.driver = card->myid;
924 cmd.arg = 0;
925 actcapi_manufacturer_req_net(card);
926 actcapi_manufacturer_req_msn(card);
927 actcapi_listen_req(card);
928 card->interface.statcallb(&cmd);
932 break;
933 default:
934 printk(KERN_WARNING "act2000: UNHANDLED Message %04x\n", ccmd);
935 break;
937 dev_kfree_skb(skb);
941 #ifdef DEBUG_MSG
942 static void
943 actcapi_debug_caddr(actcapi_addr *addr)
945 char tmp[30];
947 printk(KERN_DEBUG " Alen = %d\n", addr->len);
948 if (addr->len > 0)
949 printk(KERN_DEBUG " Atnp = 0x%02x\n", addr->tnp);
950 if (addr->len > 1) {
951 memset(tmp, 0, 30);
952 memcpy(tmp, addr->num, addr->len - 1);
953 printk(KERN_DEBUG " Anum = '%s'\n", tmp);
957 static void
958 actcapi_debug_ncpi(actcapi_ncpi *ncpi)
960 printk(KERN_DEBUG " ncpi.len = %d\n", ncpi->len);
961 if (ncpi->len >= 2)
962 printk(KERN_DEBUG " ncpi.lic = 0x%04x\n", ncpi->lic);
963 if (ncpi->len >= 4)
964 printk(KERN_DEBUG " ncpi.hic = 0x%04x\n", ncpi->hic);
965 if (ncpi->len >= 6)
966 printk(KERN_DEBUG " ncpi.ltc = 0x%04x\n", ncpi->ltc);
967 if (ncpi->len >= 8)
968 printk(KERN_DEBUG " ncpi.htc = 0x%04x\n", ncpi->htc);
969 if (ncpi->len >= 10)
970 printk(KERN_DEBUG " ncpi.loc = 0x%04x\n", ncpi->loc);
971 if (ncpi->len >= 12)
972 printk(KERN_DEBUG " ncpi.hoc = 0x%04x\n", ncpi->hoc);
973 if (ncpi->len >= 13)
974 printk(KERN_DEBUG " ncpi.mod = %d\n", ncpi->modulo);
977 static void
978 actcapi_debug_dlpd(actcapi_dlpd *dlpd)
980 printk(KERN_DEBUG " dlpd.len = %d\n", dlpd->len);
981 if (dlpd->len >= 2)
982 printk(KERN_DEBUG " dlpd.dlen = 0x%04x\n", dlpd->dlen);
983 if (dlpd->len >= 3)
984 printk(KERN_DEBUG " dlpd.laa = 0x%02x\n", dlpd->laa);
985 if (dlpd->len >= 4)
986 printk(KERN_DEBUG " dlpd.lab = 0x%02x\n", dlpd->lab);
987 if (dlpd->len >= 5)
988 printk(KERN_DEBUG " dlpd.modulo = %d\n", dlpd->modulo);
989 if (dlpd->len >= 6)
990 printk(KERN_DEBUG " dlpd.win = %d\n", dlpd->win);
993 #ifdef DEBUG_DUMP_SKB
994 static void dump_skb(struct sk_buff *skb) {
995 char tmp[80];
996 char *p = skb->data;
997 char *t = tmp;
998 int i;
1000 for (i = 0; i < skb->len; i++) {
1001 t += sprintf(t, "%02x ", *p++ & 0xff);
1002 if ((i & 0x0f) == 8) {
1003 printk(KERN_DEBUG "dump: %s\n", tmp);
1004 t = tmp;
1007 if (i & 0x07)
1008 printk(KERN_DEBUG "dump: %s\n", tmp);
1010 #endif
1012 void
1013 actcapi_debug_msg(struct sk_buff *skb, int direction)
1015 actcapi_msg *msg = (actcapi_msg *)skb->data;
1016 char *descr;
1017 int i;
1018 char tmp[170];
1020 #ifndef DEBUG_DATA_MSG
1021 if (msg->hdr.cmd.cmd == 0x86)
1022 return;
1023 #endif
1024 descr = "INVALID";
1025 #ifdef DEBUG_DUMP_SKB
1026 dump_skb(skb);
1027 #endif
1028 for (i = 0; i < num_valid_msg; i++)
1029 if ((msg->hdr.cmd.cmd == valid_msg[i].cmd.cmd) &&
1030 (msg->hdr.cmd.subcmd == valid_msg[i].cmd.subcmd)) {
1031 descr = valid_msg[i].description;
1032 break;
1034 printk(KERN_DEBUG "%s %s msg\n", direction?"Outgoing":"Incoming", descr);
1035 printk(KERN_DEBUG " ApplID = %d\n", msg->hdr.applicationID);
1036 printk(KERN_DEBUG " Len = %d\n", msg->hdr.len);
1037 printk(KERN_DEBUG " MsgNum = 0x%04x\n", msg->hdr.msgnum);
1038 printk(KERN_DEBUG " Cmd = 0x%02x\n", msg->hdr.cmd.cmd);
1039 printk(KERN_DEBUG " SubCmd = 0x%02x\n", msg->hdr.cmd.subcmd);
1040 switch (i) {
1041 case 0:
1042 /* DATA B3 IND */
1043 printk(KERN_DEBUG " BLOCK = 0x%02x\n",
1044 msg->msg.data_b3_ind.blocknr);
1045 break;
1046 case 2:
1047 /* CONNECT CONF */
1048 printk(KERN_DEBUG " PLCI = 0x%04x\n",
1049 msg->msg.connect_conf.plci);
1050 printk(KERN_DEBUG " Info = 0x%04x\n",
1051 msg->msg.connect_conf.info);
1052 break;
1053 case 3:
1054 /* CONNECT IND */
1055 printk(KERN_DEBUG " PLCI = 0x%04x\n",
1056 msg->msg.connect_ind.plci);
1057 printk(KERN_DEBUG " Contr = %d\n",
1058 msg->msg.connect_ind.controller);
1059 printk(KERN_DEBUG " SI1 = %d\n",
1060 msg->msg.connect_ind.si1);
1061 printk(KERN_DEBUG " SI2 = %d\n",
1062 msg->msg.connect_ind.si2);
1063 printk(KERN_DEBUG " EAZ = '%c'\n",
1064 msg->msg.connect_ind.eaz);
1065 actcapi_debug_caddr(&msg->msg.connect_ind.addr);
1066 break;
1067 case 5:
1068 /* CONNECT ACTIVE IND */
1069 printk(KERN_DEBUG " PLCI = 0x%04x\n",
1070 msg->msg.connect_active_ind.plci);
1071 actcapi_debug_caddr(&msg->msg.connect_active_ind.addr);
1072 break;
1073 case 8:
1074 /* LISTEN CONF */
1075 printk(KERN_DEBUG " Contr = %d\n",
1076 msg->msg.listen_conf.controller);
1077 printk(KERN_DEBUG " Info = 0x%04x\n",
1078 msg->msg.listen_conf.info);
1079 break;
1080 case 11:
1081 /* INFO IND */
1082 printk(KERN_DEBUG " PLCI = 0x%04x\n",
1083 msg->msg.info_ind.plci);
1084 printk(KERN_DEBUG " Imsk = 0x%04x\n",
1085 msg->msg.info_ind.nr.mask);
1086 if (msg->hdr.len > 12) {
1087 int l = msg->hdr.len - 12;
1088 int j;
1089 char *p = tmp;
1090 for (j = 0; j < l ; j++)
1091 p += sprintf(p, "%02x ", msg->msg.info_ind.el.display[j]);
1092 printk(KERN_DEBUG " D = '%s'\n", tmp);
1094 break;
1095 case 14:
1096 /* SELECT B2 PROTOCOL CONF */
1097 printk(KERN_DEBUG " PLCI = 0x%04x\n",
1098 msg->msg.select_b2_protocol_conf.plci);
1099 printk(KERN_DEBUG " Info = 0x%04x\n",
1100 msg->msg.select_b2_protocol_conf.info);
1101 break;
1102 case 15:
1103 /* SELECT B3 PROTOCOL CONF */
1104 printk(KERN_DEBUG " PLCI = 0x%04x\n",
1105 msg->msg.select_b3_protocol_conf.plci);
1106 printk(KERN_DEBUG " Info = 0x%04x\n",
1107 msg->msg.select_b3_protocol_conf.info);
1108 break;
1109 case 16:
1110 /* LISTEN B3 CONF */
1111 printk(KERN_DEBUG " PLCI = 0x%04x\n",
1112 msg->msg.listen_b3_conf.plci);
1113 printk(KERN_DEBUG " Info = 0x%04x\n",
1114 msg->msg.listen_b3_conf.info);
1115 break;
1116 case 18:
1117 /* CONNECT B3 IND */
1118 printk(KERN_DEBUG " NCCI = 0x%04x\n",
1119 msg->msg.connect_b3_ind.ncci);
1120 printk(KERN_DEBUG " PLCI = 0x%04x\n",
1121 msg->msg.connect_b3_ind.plci);
1122 actcapi_debug_ncpi(&msg->msg.connect_b3_ind.ncpi);
1123 break;
1124 case 19:
1125 /* CONNECT B3 ACTIVE IND */
1126 printk(KERN_DEBUG " NCCI = 0x%04x\n",
1127 msg->msg.connect_b3_active_ind.ncci);
1128 actcapi_debug_ncpi(&msg->msg.connect_b3_active_ind.ncpi);
1129 break;
1130 case 26:
1131 /* MANUFACTURER IND */
1132 printk(KERN_DEBUG " Mmsg = 0x%02x\n",
1133 msg->msg.manufacturer_ind_err.manuf_msg);
1134 switch (msg->msg.manufacturer_ind_err.manuf_msg) {
1135 case 3:
1136 printk(KERN_DEBUG " Contr = %d\n",
1137 msg->msg.manufacturer_ind_err.controller);
1138 printk(KERN_DEBUG " Code = 0x%08x\n",
1139 msg->msg.manufacturer_ind_err.errcode);
1140 memset(tmp, 0, sizeof(tmp));
1141 strncpy(tmp, &msg->msg.manufacturer_ind_err.errstring,
1142 msg->hdr.len - 16);
1143 printk(KERN_DEBUG " Emsg = '%s'\n", tmp);
1144 break;
1146 break;
1147 case 30:
1148 /* LISTEN REQ */
1149 printk(KERN_DEBUG " Imsk = 0x%08x\n",
1150 msg->msg.listen_req.infomask);
1151 printk(KERN_DEBUG " Emsk = 0x%04x\n",
1152 msg->msg.listen_req.eazmask);
1153 printk(KERN_DEBUG " Smsk = 0x%04x\n",
1154 msg->msg.listen_req.simask);
1155 break;
1156 case 35:
1157 /* SELECT_B2_PROTOCOL_REQ */
1158 printk(KERN_DEBUG " PLCI = 0x%04x\n",
1159 msg->msg.select_b2_protocol_req.plci);
1160 printk(KERN_DEBUG " prot = 0x%02x\n",
1161 msg->msg.select_b2_protocol_req.protocol);
1162 if (msg->hdr.len >= 11)
1163 printk(KERN_DEBUG "No dlpd\n");
1164 else
1165 actcapi_debug_dlpd(&msg->msg.select_b2_protocol_req.dlpd);
1166 break;
1167 case 44:
1168 /* CONNECT RESP */
1169 printk(KERN_DEBUG " PLCI = 0x%04x\n",
1170 msg->msg.connect_resp.plci);
1171 printk(KERN_DEBUG " CAUSE = 0x%02x\n",
1172 msg->msg.connect_resp.rejectcause);
1173 break;
1174 case 45:
1175 /* CONNECT ACTIVE RESP */
1176 printk(KERN_DEBUG " PLCI = 0x%04x\n",
1177 msg->msg.connect_active_resp.plci);
1178 break;
1181 #endif