?  search:
summary | log | graphiclog1 | graphiclog2 | commit | commitdiff | tree | refs | edit | fork
blame | history | raw | HEAD
added 2.6.29.6 aldebaran kernel
[nao-ulib.git] / kernel / 2.6.29.6-aldebaran-rt / drivers / isdn / hisax / l3ni1.c
blobf7041d5ba64e3c08b1ea6ca733b4e22cecdfb66a
1 /* $Id: l3ni1.c,v 2.8.2.3 2004/01/13 14:31:25 keil Exp $
2 *
3 * NI1 D-channel protocol
4 *
5 * Author Matt Henderson & Guy Ellis
6 * Copyright by Traverse Technologies Pty Ltd, www.travers.com.au
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 * 2000.6.6 Initial implementation of routines for US NI1
12 * Layer 3 protocol based on the EURO/DSS1 D-channel protocol
13 * driver written by Karsten Keil et al.
14 * NI-1 Hall of Fame - Thanks to....
15 * Ragnar Paulson - for some handy code fragments
16 * Will Scales - beta tester extraordinaire
17 * Brett Whittacre - beta tester and remote devel system in Vegas
18 *
19 */
20
21 #include "hisax.h"
22 #include "isdnl3.h"
23 #include "l3ni1.h"
24 #include <linux/ctype.h>
25
26 extern char *HiSax_getrev(const char *revision);
27 static const char *ni1_revision = "$Revision: 2.8.2.3 $";
28
29 #define EXT_BEARER_CAPS 1
30
31 #define MsgHead(ptr, cref, mty) \
32 *ptr++ = 0x8; \
33 if (cref == -1) { \
34 *ptr++ = 0x0; \
35 } else { \
36 *ptr++ = 0x1; \
37 *ptr++ = cref^0x80; \
38 } \
39 *ptr++ = mty
40
41
42 /**********************************************/
43 /* get a new invoke id for remote operations. */
44 /* Only a return value != 0 is valid */
45 /**********************************************/
46 static unsigned char new_invoke_id(struct PStack *p)
47 {
48 unsigned char retval;
49 int i;
50
51 i = 32; /* maximum search depth */
52
53 retval = p->prot.ni1.last_invoke_id + 1; /* try new id */
54 while ((i) && (p->prot.ni1.invoke_used[retval >> 3] == 0xFF)) {
55 p->prot.ni1.last_invoke_id = (retval & 0xF8) + 8;
56 i--;
57 }
58 if (i) {
59 while (p->prot.ni1.invoke_used[retval >> 3] & (1 << (retval & 7)))
60 retval++;
61 } else
62 retval = 0;
63 p->prot.ni1.last_invoke_id = retval;
64 p->prot.ni1.invoke_used[retval >> 3] |= (1 << (retval & 7));
65 return(retval);
66 } /* new_invoke_id */
67
68 /*************************/
69 /* free a used invoke id */
70 /*************************/
71 static void free_invoke_id(struct PStack *p, unsigned char id)
72 {
73
74 if (!id) return; /* 0 = invalid value */
75
76 p->prot.ni1.invoke_used[id >> 3] &= ~(1 << (id & 7));
77 } /* free_invoke_id */
78
79
80 /**********************************************************/
81 /* create a new l3 process and fill in ni1 specific data */
82 /**********************************************************/
83 static struct l3_process
84 *ni1_new_l3_process(struct PStack *st, int cr)
85 { struct l3_process *proc;
86
87 if (!(proc = new_l3_process(st, cr)))
88 return(NULL);
89
90 proc->prot.ni1.invoke_id = 0;
91 proc->prot.ni1.remote_operation = 0;
92 proc->prot.ni1.uus1_data[0] = '\0';
93
94 return(proc);
95 } /* ni1_new_l3_process */
96
97 /************************************************/
98 /* free a l3 process and all ni1 specific data */
99 /************************************************/
100 static void
101 ni1_release_l3_process(struct l3_process *p)
102 {
103 free_invoke_id(p->st,p->prot.ni1.invoke_id);
104 release_l3_process(p);
105 } /* ni1_release_l3_process */
106
107 /********************************************************/
108 /* search a process with invoke id id and dummy callref */
109 /********************************************************/
110 static struct l3_process *
111 l3ni1_search_dummy_proc(struct PStack *st, int id)
112 { struct l3_process *pc = st->l3.proc; /* start of processes */
113
114 if (!id) return(NULL);
115
116 while (pc)
117 { if ((pc->callref == -1) && (pc->prot.ni1.invoke_id == id))
118 return(pc);
119 pc = pc->next;
120 }
121 return(NULL);
122 } /* l3ni1_search_dummy_proc */
123
124 /*******************************************************************/
125 /* called when a facility message with a dummy callref is received */
126 /* and a return result is delivered. id specifies the invoke id. */
127 /*******************************************************************/
128 static void
129 l3ni1_dummy_return_result(struct PStack *st, int id, u_char *p, u_char nlen)
130 { isdn_ctrl ic;
131 struct IsdnCardState *cs;
132 struct l3_process *pc = NULL;
133
134 if ((pc = l3ni1_search_dummy_proc(st, id)))
135 { L3DelTimer(&pc->timer); /* remove timer */
136
137 cs = pc->st->l1.hardware;
138 ic.driver = cs->myid;
139 ic.command = ISDN_STAT_PROT;
140 ic.arg = NI1_STAT_INVOKE_RES;
141 ic.parm.ni1_io.hl_id = pc->prot.ni1.invoke_id;
142 ic.parm.ni1_io.ll_id = pc->prot.ni1.ll_id;
143 ic.parm.ni1_io.proc = pc->prot.ni1.proc;
144 ic.parm.ni1_io.timeout= 0;
145 ic.parm.ni1_io.datalen = nlen;
146 ic.parm.ni1_io.data = p;
147 free_invoke_id(pc->st, pc->prot.ni1.invoke_id);
148 pc->prot.ni1.invoke_id = 0; /* reset id */
149
150 cs->iif.statcallb(&ic);
151 ni1_release_l3_process(pc);
152 }
153 else
154 l3_debug(st, "dummy return result id=0x%x result len=%d",id,nlen);
155 } /* l3ni1_dummy_return_result */
156
157 /*******************************************************************/
158 /* called when a facility message with a dummy callref is received */
159 /* and a return error is delivered. id specifies the invoke id. */
160 /*******************************************************************/
161 static void
162 l3ni1_dummy_error_return(struct PStack *st, int id, ulong error)
163 { isdn_ctrl ic;
164 struct IsdnCardState *cs;
165 struct l3_process *pc = NULL;
166
167 if ((pc = l3ni1_search_dummy_proc(st, id)))
168 { L3DelTimer(&pc->timer); /* remove timer */
169
170 cs = pc->st->l1.hardware;
171 ic.driver = cs->myid;
172 ic.command = ISDN_STAT_PROT;
173 ic.arg = NI1_STAT_INVOKE_ERR;
174 ic.parm.ni1_io.hl_id = pc->prot.ni1.invoke_id;
175 ic.parm.ni1_io.ll_id = pc->prot.ni1.ll_id;
176 ic.parm.ni1_io.proc = pc->prot.ni1.proc;
177 ic.parm.ni1_io.timeout= error;
178 ic.parm.ni1_io.datalen = 0;
179 ic.parm.ni1_io.data = NULL;
180 free_invoke_id(pc->st, pc->prot.ni1.invoke_id);
181 pc->prot.ni1.invoke_id = 0; /* reset id */
182
183 cs->iif.statcallb(&ic);
184 ni1_release_l3_process(pc);
185 }
186 else
187 l3_debug(st, "dummy return error id=0x%x error=0x%lx",id,error);
188 } /* l3ni1_error_return */
189
190 /*******************************************************************/
191 /* called when a facility message with a dummy callref is received */
192 /* and a invoke is delivered. id specifies the invoke id. */
193 /*******************************************************************/
194 static void
195 l3ni1_dummy_invoke(struct PStack *st, int cr, int id,
196 int ident, u_char *p, u_char nlen)
197 { isdn_ctrl ic;
198 struct IsdnCardState *cs;
199
200 l3_debug(st, "dummy invoke %s id=0x%x ident=0x%x datalen=%d",
201 (cr == -1) ? "local" : "broadcast",id,ident,nlen);
202 if (cr >= -1) return; /* ignore local data */
203
204 cs = st->l1.hardware;
205 ic.driver = cs->myid;
206 ic.command = ISDN_STAT_PROT;
207 ic.arg = NI1_STAT_INVOKE_BRD;
208 ic.parm.ni1_io.hl_id = id;
209 ic.parm.ni1_io.ll_id = 0;
210 ic.parm.ni1_io.proc = ident;
211 ic.parm.ni1_io.timeout= 0;
212 ic.parm.ni1_io.datalen = nlen;
213 ic.parm.ni1_io.data = p;
214
215 cs->iif.statcallb(&ic);
216 } /* l3ni1_dummy_invoke */
217
218 static void
219 l3ni1_parse_facility(struct PStack *st, struct l3_process *pc,
220 int cr, u_char * p)
221 {
222 int qd_len = 0;
223 unsigned char nlen = 0, ilen, cp_tag;
224 int ident, id;
225 ulong err_ret;
226
227 if (pc)
228 st = pc->st; /* valid Stack */
229 else
230 if ((!st) || (cr >= 0)) return; /* neither pc nor st specified */
231
232 p++;
233 qd_len = *p++;
234 if (qd_len == 0) {
235 l3_debug(st, "qd_len == 0");
236 return;
237 }
238 if ((*p & 0x1F) != 0x11) { /* Service discriminator, supplementary service */
239 l3_debug(st, "supplementary service != 0x11");
240 return;
241 }
242 while (qd_len > 0 && !(*p & 0x80)) { /* extension ? */
243 p++;
244 qd_len--;
245 }
246 if (qd_len < 2) {
247 l3_debug(st, "qd_len < 2");
248 return;
249 }
250 p++;
251 qd_len--;
252 if ((*p & 0xE0) != 0xA0) { /* class and form */
253 l3_debug(st, "class and form != 0xA0");
254 return;
255 }
256
257 cp_tag = *p & 0x1F; /* remember tag value */
258
259 p++;
260 qd_len--;
261 if (qd_len < 1)
262 { l3_debug(st, "qd_len < 1");
263 return;
264 }
265 if (*p & 0x80)
266 { /* length format indefinite or limited */
267 nlen = *p++ & 0x7F; /* number of len bytes or indefinite */
268 if ((qd_len-- < ((!nlen) ? 3 : (1 + nlen))) ||
269 (nlen > 1))
270 { l3_debug(st, "length format error or not implemented");
271 return;
272 }
273 if (nlen == 1)
274 { nlen = *p++; /* complete length */
275 qd_len--;
276 }
277 else
278 { qd_len -= 2; /* trailing null bytes */
279 if ((*(p+qd_len)) || (*(p+qd_len+1)))
280 { l3_debug(st,"length format indefinite error");
281 return;
282 }
283 nlen = qd_len;
284 }
285 }
286 else
287 { nlen = *p++;
288 qd_len--;
289 }
290 if (qd_len < nlen)
291 { l3_debug(st, "qd_len < nlen");
292 return;
293 }
294 qd_len -= nlen;
295
296 if (nlen < 2)
297 { l3_debug(st, "nlen < 2");
298 return;
299 }
300 if (*p != 0x02)
301 { /* invoke identifier tag */
302 l3_debug(st, "invoke identifier tag !=0x02");
303 return;
304 }
305 p++;
306 nlen--;
307 if (*p & 0x80)
308 { /* length format */
309 l3_debug(st, "invoke id length format 2");
310 return;
311 }
312 ilen = *p++;
313 nlen--;
314 if (ilen > nlen || ilen == 0)
315 { l3_debug(st, "ilen > nlen || ilen == 0");
316 return;
317 }
318 nlen -= ilen;
319 id = 0;
320 while (ilen > 0)
321 { id = (id << 8) | (*p++ & 0xFF); /* invoke identifier */
322 ilen--;
323 }
324
325 switch (cp_tag) { /* component tag */
326 case 1: /* invoke */
327 if (nlen < 2) {
328 l3_debug(st, "nlen < 2 22");
329 return;
330 }
331 if (*p != 0x02) { /* operation value */
332 l3_debug(st, "operation value !=0x02");
333 return;
334 }
335 p++;
336 nlen--;
337 ilen = *p++;
338 nlen--;
339 if (ilen > nlen || ilen == 0) {
340 l3_debug(st, "ilen > nlen || ilen == 0 22");
341 return;
342 }
343 nlen -= ilen;
344 ident = 0;
345 while (ilen > 0) {
346 ident = (ident << 8) | (*p++ & 0xFF);
347 ilen--;
348 }
349
350 if (!pc)
351 {
352 l3ni1_dummy_invoke(st, cr, id, ident, p, nlen);
353 return;
354 }
355 l3_debug(st, "invoke break");
356 break;
357 case 2: /* return result */
358 /* if no process available handle separately */
359 if (!pc)
360 { if (cr == -1)
361 l3ni1_dummy_return_result(st, id, p, nlen);
362 return;
363 }
364 if ((pc->prot.ni1.invoke_id) && (pc->prot.ni1.invoke_id == id))
365 { /* Diversion successful */
366 free_invoke_id(st,pc->prot.ni1.invoke_id);
367 pc->prot.ni1.remote_result = 0; /* success */
368 pc->prot.ni1.invoke_id = 0;
369 pc->redir_result = pc->prot.ni1.remote_result;
370 st->l3.l3l4(st, CC_REDIR | INDICATION, pc); } /* Diversion successful */
371 else
372 l3_debug(st,"return error unknown identifier");
373 break;
374 case 3: /* return error */
375 err_ret = 0;
376 if (nlen < 2)
377 { l3_debug(st, "return error nlen < 2");
378 return;
379 }
380 if (*p != 0x02)
381 { /* result tag */
382 l3_debug(st, "invoke error tag !=0x02");
383 return;
384 }
385 p++;
386 nlen--;
387 if (*p > 4)
388 { /* length format */
389 l3_debug(st, "invoke return errlen > 4 ");
390 return;
391 }
392 ilen = *p++;
393 nlen--;
394 if (ilen > nlen || ilen == 0)
395 { l3_debug(st, "error return ilen > nlen || ilen == 0");
396 return;
397 }
398 nlen -= ilen;
399 while (ilen > 0)
400 { err_ret = (err_ret << 8) | (*p++ & 0xFF); /* error value */
401 ilen--;
402 }
403 /* if no process available handle separately */
404 if (!pc)
405 { if (cr == -1)
406 l3ni1_dummy_error_return(st, id, err_ret);
407 return;
408 }
409 if ((pc->prot.ni1.invoke_id) && (pc->prot.ni1.invoke_id == id))
410 { /* Deflection error */
411 free_invoke_id(st,pc->prot.ni1.invoke_id);
412 pc->prot.ni1.remote_result = err_ret; /* result */
413 pc->prot.ni1.invoke_id = 0;
414 pc->redir_result = pc->prot.ni1.remote_result;
415 st->l3.l3l4(st, CC_REDIR | INDICATION, pc);
416 } /* Deflection error */
417 else
418 l3_debug(st,"return result unknown identifier");
419 break;
420 default:
421 l3_debug(st, "facility default break tag=0x%02x",cp_tag);
422 break;
423 }
424 }
425
426 static void
427 l3ni1_message(struct l3_process *pc, u_char mt)
428 {
429 struct sk_buff *skb;
430 u_char *p;
431
432 if (!(skb = l3_alloc_skb(4)))
433 return;
434 p = skb_put(skb, 4);
435 MsgHead(p, pc->callref, mt);
436 l3_msg(pc->st, DL_DATA | REQUEST, skb);
437 }
438
439 static void
440 l3ni1_message_plus_chid(struct l3_process *pc, u_char mt)
441 /* sends an l3 messages plus channel id - added GE 05/09/00 */
442 {
443 struct sk_buff *skb;
444 u_char tmp[16];
445 u_char *p = tmp;
446 u_char chid;
447
448 chid = (u_char)(pc->para.bchannel & 0x03) | 0x88;
449 MsgHead(p, pc->callref, mt);
450 *p++ = IE_CHANNEL_ID;
451 *p++ = 0x01;
452 *p++ = chid;
453
454 if (!(skb = l3_alloc_skb(7)))
455 return;
456 memcpy(skb_put(skb, 7), tmp, 7);
457 l3_msg(pc->st, DL_DATA | REQUEST, skb);
458 }
459
460 static void
461 l3ni1_message_cause(struct l3_process *pc, u_char mt, u_char cause)
462 {
463 struct sk_buff *skb;
464 u_char tmp[16];
465 u_char *p = tmp;
466 int l;
467
468 MsgHead(p, pc->callref, mt);
469 *p++ = IE_CAUSE;
470 *p++ = 0x2;
471 *p++ = 0x80;
472 *p++ = cause | 0x80;
473
474 l = p - tmp;
475 if (!(skb = l3_alloc_skb(l)))
476 return;
477 memcpy(skb_put(skb, l), tmp, l);
478 l3_msg(pc->st, DL_DATA | REQUEST, skb);
479 }
480
481 static void
482 l3ni1_status_send(struct l3_process *pc, u_char pr, void *arg)
483 {
484 u_char tmp[16];
485 u_char *p = tmp;
486 int l;
487 struct sk_buff *skb;
488
489 MsgHead(p, pc->callref, MT_STATUS);
490
491 *p++ = IE_CAUSE;
492 *p++ = 0x2;
493 *p++ = 0x80;
494 *p++ = pc->para.cause | 0x80;
495
496 *p++ = IE_CALL_STATE;
497 *p++ = 0x1;
498 *p++ = pc->state & 0x3f;
499
500 l = p - tmp;
501 if (!(skb = l3_alloc_skb(l)))
502 return;
503 memcpy(skb_put(skb, l), tmp, l);
504 l3_msg(pc->st, DL_DATA | REQUEST, skb);
505 }
506
507 static void
508 l3ni1_msg_without_setup(struct l3_process *pc, u_char pr, void *arg)
509 {
510 /* This routine is called if here was no SETUP made (checks in ni1up and in
511 * l3ni1_setup) and a RELEASE_COMPLETE have to be sent with an error code
512 * MT_STATUS_ENQUIRE in the NULL state is handled too
513 */
514 u_char tmp[16];
515 u_char *p = tmp;
516 int l;
517 struct sk_buff *skb;
518
519 switch (pc->para.cause) {
520 case 81: /* invalid callreference */
521 case 88: /* incomp destination */
522 case 96: /* mandory IE missing */
523 case 100: /* invalid IE contents */
524 case 101: /* incompatible Callstate */
525 MsgHead(p, pc->callref, MT_RELEASE_COMPLETE);
526 *p++ = IE_CAUSE;
527 *p++ = 0x2;
528 *p++ = 0x80;
529 *p++ = pc->para.cause | 0x80;
530 break;
531 default:
532 printk(KERN_ERR "HiSax l3ni1_msg_without_setup wrong cause %d\n",
533 pc->para.cause);
534 return;
535 }
536 l = p - tmp;
537 if (!(skb = l3_alloc_skb(l)))
538 return;
539 memcpy(skb_put(skb, l), tmp, l);
540 l3_msg(pc->st, DL_DATA | REQUEST, skb);
541 ni1_release_l3_process(pc);
542 }
543
544 static int ie_ALERTING[] = {IE_BEARER, IE_CHANNEL_ID | IE_MANDATORY_1,
545 IE_FACILITY, IE_PROGRESS, IE_DISPLAY, IE_SIGNAL, IE_HLC,
546 IE_USER_USER, -1};
547 static int ie_CALL_PROCEEDING[] = {IE_BEARER, IE_CHANNEL_ID | IE_MANDATORY_1,
548 IE_FACILITY, IE_PROGRESS, IE_DISPLAY, IE_HLC, -1};
549 static int ie_CONNECT[] = {IE_BEARER, IE_CHANNEL_ID | IE_MANDATORY_1,
550 IE_FACILITY, IE_PROGRESS, IE_DISPLAY, IE_DATE, IE_SIGNAL,
551 IE_CONNECT_PN, IE_CONNECT_SUB, IE_LLC, IE_HLC, IE_USER_USER, -1};
552 static int ie_CONNECT_ACKNOWLEDGE[] = {IE_CHANNEL_ID, IE_DISPLAY, IE_SIGNAL, -1};
553 static int ie_DISCONNECT[] = {IE_CAUSE | IE_MANDATORY, IE_FACILITY,
554 IE_PROGRESS, IE_DISPLAY, IE_SIGNAL, IE_USER_USER, -1};
555 static int ie_INFORMATION[] = {IE_COMPLETE, IE_DISPLAY, IE_KEYPAD, IE_SIGNAL,
556 IE_CALLED_PN, -1};
557 static int ie_NOTIFY[] = {IE_BEARER, IE_NOTIFY | IE_MANDATORY, IE_DISPLAY, -1};
558 static int ie_PROGRESS[] = {IE_BEARER, IE_CAUSE, IE_FACILITY, IE_PROGRESS |
559 IE_MANDATORY, IE_DISPLAY, IE_HLC, IE_USER_USER, -1};
560 static int ie_RELEASE[] = {IE_CAUSE | IE_MANDATORY_1, IE_FACILITY, IE_DISPLAY,
561 IE_SIGNAL, IE_USER_USER, -1};
562 /* a RELEASE_COMPLETE with errors don't require special actions
563 static int ie_RELEASE_COMPLETE[] = {IE_CAUSE | IE_MANDATORY_1, IE_DISPLAY, IE_SIGNAL, IE_USER_USER, -1};
564 */
565 static int ie_RESUME_ACKNOWLEDGE[] = {IE_CHANNEL_ID| IE_MANDATORY, IE_FACILITY,
566 IE_DISPLAY, -1};
567 static int ie_RESUME_REJECT[] = {IE_CAUSE | IE_MANDATORY, IE_DISPLAY, -1};
568 static int ie_SETUP[] = {IE_COMPLETE, IE_BEARER | IE_MANDATORY,
569 IE_CHANNEL_ID| IE_MANDATORY, IE_FACILITY, IE_PROGRESS,
570 IE_NET_FAC, IE_DISPLAY, IE_KEYPAD, IE_SIGNAL, IE_CALLING_PN,
571 IE_CALLING_SUB, IE_CALLED_PN, IE_CALLED_SUB, IE_REDIR_NR,
572 IE_LLC, IE_HLC, IE_USER_USER, -1};
573 static int ie_SETUP_ACKNOWLEDGE[] = {IE_CHANNEL_ID | IE_MANDATORY, IE_FACILITY,
574 IE_PROGRESS, IE_DISPLAY, IE_SIGNAL, -1};
575 static int ie_STATUS[] = {IE_CAUSE | IE_MANDATORY, IE_CALL_STATE |
576 IE_MANDATORY, IE_DISPLAY, -1};
577 static int ie_STATUS_ENQUIRY[] = {IE_DISPLAY, -1};
578 static int ie_SUSPEND_ACKNOWLEDGE[] = {IE_DISPLAY, IE_FACILITY, -1};
579 static int ie_SUSPEND_REJECT[] = {IE_CAUSE | IE_MANDATORY, IE_DISPLAY, -1};
580 /* not used
581 * static int ie_CONGESTION_CONTROL[] = {IE_CONGESTION | IE_MANDATORY,
582 * IE_CAUSE | IE_MANDATORY, IE_DISPLAY, -1};
583 * static int ie_USER_INFORMATION[] = {IE_MORE_DATA, IE_USER_USER | IE_MANDATORY, -1};
584 * static int ie_RESTART[] = {IE_CHANNEL_ID, IE_DISPLAY, IE_RESTART_IND |
585 * IE_MANDATORY, -1};
586 */
587 static int ie_FACILITY[] = {IE_FACILITY | IE_MANDATORY, IE_DISPLAY, -1};
588 static int comp_required[] = {1,2,3,5,6,7,9,10,11,14,15,-1};
589 static int l3_valid_states[] = {0,1,2,3,4,6,7,8,9,10,11,12,15,17,19,25,-1};
590
591 struct ie_len {
592 int ie;
593 int len;
594 };
595
596 static
597 struct ie_len max_ie_len[] = {
598 {IE_SEGMENT, 4},
599 {IE_BEARER, 12},
600 {IE_CAUSE, 32},
601 {IE_CALL_ID, 10},
602 {IE_CALL_STATE, 3},
603 {IE_CHANNEL_ID, 34},
604 {IE_FACILITY, 255},
605 {IE_PROGRESS, 4},
606 {IE_NET_FAC, 255},
607 {IE_NOTIFY, 3},
608 {IE_DISPLAY, 82},
609 {IE_DATE, 8},
610 {IE_KEYPAD, 34},
611 {IE_SIGNAL, 3},
612 {IE_INFORATE, 6},
613 {IE_E2E_TDELAY, 11},
614 {IE_TDELAY_SEL, 5},
615 {IE_PACK_BINPARA, 3},
616 {IE_PACK_WINSIZE, 4},
617 {IE_PACK_SIZE, 4},
618 {IE_CUG, 7},
619 {IE_REV_CHARGE, 3},
620 {IE_CALLING_PN, 24},
621 {IE_CALLING_SUB, 23},
622 {IE_CALLED_PN, 24},
623 {IE_CALLED_SUB, 23},
624 {IE_REDIR_NR, 255},
625 {IE_TRANS_SEL, 255},
626 {IE_RESTART_IND, 3},
627 {IE_LLC, 18},
628 {IE_HLC, 5},
629 {IE_USER_USER, 131},
630 {-1,0},
631 };
632
633 static int
634 getmax_ie_len(u_char ie) {
635 int i = 0;
636 while (max_ie_len[i].ie != -1) {
637 if (max_ie_len[i].ie == ie)
638 return(max_ie_len[i].len);
639 i++;
640 }
641 return(255);
642 }
643
644 static int
645 ie_in_set(struct l3_process *pc, u_char ie, int *checklist) {
646 int ret = 1;
647
648 while (*checklist != -1) {
649 if ((*checklist & 0xff) == ie) {
650 if (ie & 0x80)
651 return(-ret);
652 else
653 return(ret);
654 }
655 ret++;
656 checklist++;
657 }
658 return(0);
659 }
660
661 static int
662 check_infoelements(struct l3_process *pc, struct sk_buff *skb, int *checklist)
663 {
664 int *cl = checklist;
665 u_char mt;
666 u_char *p, ie;
667 int l, newpos, oldpos;
668 int err_seq = 0, err_len = 0, err_compr = 0, err_ureg = 0;
669 u_char codeset = 0;
670 u_char old_codeset = 0;
671 u_char codelock = 1;
672
673 p = skb->data;
674 /* skip cr */
675 p++;
676 l = (*p++) & 0xf;
677 p += l;
678 mt = *p++;
679 oldpos = 0;
680 while ((p - skb->data) < skb->len) {
681 if ((*p & 0xf0) == 0x90) { /* shift codeset */
682 old_codeset = codeset;
683 codeset = *p & 7;
684 if (*p & 0x08)
685 codelock = 0;
686 else
687 codelock = 1;
688 if (pc->debug & L3_DEB_CHECK)
689 l3_debug(pc->st, "check IE shift%scodeset %d->%d",
690 codelock ? " locking ": " ", old_codeset, codeset);
691 p++;
692 continue;
693 }
694 if (!codeset) { /* only codeset 0 */
695 if ((newpos = ie_in_set(pc, *p, cl))) {
696 if (newpos > 0) {
697 if (newpos < oldpos)
698 err_seq++;
699 else
700 oldpos = newpos;
701 }
702 } else {
703 if (ie_in_set(pc, *p, comp_required))
704 err_compr++;
705 else
706 err_ureg++;
707 }
708 }
709 ie = *p++;
710 if (ie & 0x80) {
711 l = 1;
712 } else {
713 l = *p++;
714 p += l;
715 l += 2;
716 }
717 if (!codeset && (l > getmax_ie_len(ie)))
718 err_len++;
719 if (!codelock) {
720 if (pc->debug & L3_DEB_CHECK)
721 l3_debug(pc->st, "check IE shift back codeset %d->%d",
722 codeset, old_codeset);
723 codeset = old_codeset;
724 codelock = 1;
725 }
726 }
727 if (err_compr | err_ureg | err_len | err_seq) {
728 if (pc->debug & L3_DEB_CHECK)
729 l3_debug(pc->st, "check IE MT(%x) %d/%d/%d/%d",
730 mt, err_compr, err_ureg, err_len, err_seq);
731 if (err_compr)
732 return(ERR_IE_COMPREHENSION);
733 if (err_ureg)
734 return(ERR_IE_UNRECOGNIZED);
735 if (err_len)
736 return(ERR_IE_LENGTH);
737 if (err_seq)
738 return(ERR_IE_SEQUENCE);
739 }
740 return(0);
741 }
742
743 /* verify if a message type exists and contain no IE error */
744 static int
745 l3ni1_check_messagetype_validity(struct l3_process *pc, int mt, void *arg)
746 {
747 switch (mt) {
748 case MT_ALERTING:
749 case MT_CALL_PROCEEDING:
750 case MT_CONNECT:
751 case MT_CONNECT_ACKNOWLEDGE:
752 case MT_DISCONNECT:
753 case MT_INFORMATION:
754 case MT_FACILITY:
755 case MT_NOTIFY:
756 case MT_PROGRESS:
757 case MT_RELEASE:
758 case MT_RELEASE_COMPLETE:
759 case MT_SETUP:
760 case MT_SETUP_ACKNOWLEDGE:
761 case MT_RESUME_ACKNOWLEDGE:
762 case MT_RESUME_REJECT:
763 case MT_SUSPEND_ACKNOWLEDGE:
764 case MT_SUSPEND_REJECT:
765 case MT_USER_INFORMATION:
766 case MT_RESTART:
767 case MT_RESTART_ACKNOWLEDGE:
768 case MT_CONGESTION_CONTROL:
769 case MT_STATUS:
770 case MT_STATUS_ENQUIRY:
771 if (pc->debug & L3_DEB_CHECK)
772 l3_debug(pc->st, "l3ni1_check_messagetype_validity mt(%x) OK", mt);
773 break;
774 case MT_RESUME: /* RESUME only in user->net */
775 case MT_SUSPEND: /* SUSPEND only in user->net */
776 default:
777 if (pc->debug & (L3_DEB_CHECK | L3_DEB_WARN))
778 l3_debug(pc->st, "l3ni1_check_messagetype_validity mt(%x) fail", mt);
779 pc->para.cause = 97;
780 l3ni1_status_send(pc, 0, NULL);
781 return(1);
782 }
783 return(0);
784 }
785
786 static void
787 l3ni1_std_ie_err(struct l3_process *pc, int ret) {
788
789 if (pc->debug & L3_DEB_CHECK)
790 l3_debug(pc->st, "check_infoelements ret %d", ret);
791 switch(ret) {
792 case 0:
793 break;
794 case ERR_IE_COMPREHENSION:
795 pc->para.cause = 96;
796 l3ni1_status_send(pc, 0, NULL);
797 break;
798 case ERR_IE_UNRECOGNIZED:
799 pc->para.cause = 99;
800 l3ni1_status_send(pc, 0, NULL);
801 break;
802 case ERR_IE_LENGTH:
803 pc->para.cause = 100;
804 l3ni1_status_send(pc, 0, NULL);
805 break;
806 case ERR_IE_SEQUENCE:
807 default:
808 break;
809 }
810 }
811
812 static int
813 l3ni1_get_channel_id(struct l3_process *pc, struct sk_buff *skb) {
814 u_char *p;
815
816 p = skb->data;
817 if ((p = findie(p, skb->len, IE_CHANNEL_ID, 0))) {
818 p++;
819 if (*p != 1) { /* len for BRI = 1 */
820 if (pc->debug & L3_DEB_WARN)
821 l3_debug(pc->st, "wrong chid len %d", *p);
822 return (-2);
823 }
824 p++;
825 if (*p & 0x60) { /* only base rate interface */
826 if (pc->debug & L3_DEB_WARN)
827 l3_debug(pc->st, "wrong chid %x", *p);
828 return (-3);
829 }
830 return(*p & 0x3);
831 } else
832 return(-1);
833 }
834
835 static int
836 l3ni1_get_cause(struct l3_process *pc, struct sk_buff *skb) {
837 u_char l, i=0;
838 u_char *p;
839
840 p = skb->data;
841 pc->para.cause = 31;
842 pc->para.loc = 0;
843 if ((p = findie(p, skb->len, IE_CAUSE, 0))) {
844 p++;
845 l = *p++;
846 if (l>30)
847 return(1);
848 if (l) {
849 pc->para.loc = *p++;
850 l--;
851 } else {
852 return(2);
853 }
854 if (l && !(pc->para.loc & 0x80)) {
855 l--;
856 p++; /* skip recommendation */
857 }
858 if (l) {
859 pc->para.cause = *p++;
860 l--;
861 if (!(pc->para.cause & 0x80))
862 return(3);
863 } else
864 return(4);
865 while (l && (i<6)) {
866 pc->para.diag[i++] = *p++;
867 l--;
868 }
869 } else
870 return(-1);
871 return(0);
872 }
873
874 static void
875 l3ni1_msg_with_uus(struct l3_process *pc, u_char cmd)
876 {
877 struct sk_buff *skb;
878 u_char tmp[16+40];
879 u_char *p = tmp;
880 int l;
881
882 MsgHead(p, pc->callref, cmd);
883
884 if (pc->prot.ni1.uus1_data[0])
885 { *p++ = IE_USER_USER; /* UUS info element */
886 *p++ = strlen(pc->prot.ni1.uus1_data) + 1;
887 *p++ = 0x04; /* IA5 chars */
888 strcpy(p,pc->prot.ni1.uus1_data);
889 p += strlen(pc->prot.ni1.uus1_data);
890 pc->prot.ni1.uus1_data[0] = '\0';
891 }
892
893 l = p - tmp;
894 if (!(skb = l3_alloc_skb(l)))
895 return;
896 memcpy(skb_put(skb, l), tmp, l);
897 l3_msg(pc->st, DL_DATA | REQUEST, skb);
898 } /* l3ni1_msg_with_uus */
899
900 static void
901 l3ni1_release_req(struct l3_process *pc, u_char pr, void *arg)
902 {
903 StopAllL3Timer(pc);
904 newl3state(pc, 19);
905 if (!pc->prot.ni1.uus1_data[0])
906 l3ni1_message(pc, MT_RELEASE);
907 else
908 l3ni1_msg_with_uus(pc, MT_RELEASE);
909 L3AddTimer(&pc->timer, T308, CC_T308_1);
910 }
911
912 static void
913 l3ni1_release_cmpl(struct l3_process *pc, u_char pr, void *arg)
914 {
915 struct sk_buff *skb = arg;
916 int ret;
917
918 if ((ret = l3ni1_get_cause(pc, skb))>0) {
919 if (pc->debug & L3_DEB_WARN)
920 l3_debug(pc->st, "RELCMPL get_cause ret(%d)",ret);
921 } else if (ret < 0)
922 pc->para.cause = NO_CAUSE;
923 StopAllL3Timer(pc);
924 newl3state(pc, 0);
925 pc->st->l3.l3l4(pc->st, CC_RELEASE | CONFIRM, pc);
926 ni1_release_l3_process(pc);
927 }
928
929 #if EXT_BEARER_CAPS
930
931 static u_char *
932 EncodeASyncParams(u_char * p, u_char si2)
933 { // 7c 06 88 90 21 42 00 bb
934
935 p[0] = 0;
936 p[1] = 0x40; // Intermediate rate: 16 kbit/s jj 2000.02.19
937 p[2] = 0x80;
938 if (si2 & 32) // 7 data bits
939
940 p[2] += 16;
941 else // 8 data bits
942
943 p[2] += 24;
944
945 if (si2 & 16) // 2 stop bits
946
947 p[2] += 96;
948 else // 1 stop bit
949
950 p[2] += 32;
951
952 if (si2 & 8) // even parity
953
954 p[2] += 2;
955 else // no parity
956
957 p[2] += 3;
958
959 switch (si2 & 0x07) {
960 case 0:
961 p[0] = 66; // 1200 bit/s
962
963 break;
964 case 1:
965 p[0] = 88; // 1200/75 bit/s
966
967 break;
968 case 2:
969 p[0] = 87; // 75/1200 bit/s
970
971 break;
972 case 3:
973 p[0] = 67; // 2400 bit/s
974
975 break;
976 case 4:
977 p[0] = 69; // 4800 bit/s
978
979 break;
980 case 5:
981 p[0] = 72; // 9600 bit/s
982
983 break;
984 case 6:
985 p[0] = 73; // 14400 bit/s
986
987 break;
988 case 7:
989 p[0] = 75; // 19200 bit/s
990
991 break;
992 }
993 return p + 3;
994 }
995
996 static u_char
997 EncodeSyncParams(u_char si2, u_char ai)
998 {
999
1000 switch (si2) {
1001 case 0:
1002 return ai + 2; // 1200 bit/s
1003
1004 case 1:
1005 return ai + 24; // 1200/75 bit/s
1006
1007 case 2:
1008 return ai + 23; // 75/1200 bit/s
1009
1010 case 3:
1011 return ai + 3; // 2400 bit/s
1012
1013 case 4:
1014 return ai + 5; // 4800 bit/s
1015
1016 case 5:
1017 return ai + 8; // 9600 bit/s
1018
1019 case 6:
1020 return ai + 9; // 14400 bit/s
1021
1022 case 7:
1023 return ai + 11; // 19200 bit/s
1024
1025 case 8:
1026 return ai + 14; // 48000 bit/s
1027
1028 case 9:
1029 return ai + 15; // 56000 bit/s
1030
1031 case 15:
1032 return ai + 40; // negotiate bit/s
1033
1034 default:
1035 break;
1036 }
1037 return ai;
1038 }
1039
1040
1041 static u_char
1042 DecodeASyncParams(u_char si2, u_char * p)
1043 {
1044 u_char info;
1045
1046 switch (p[5]) {
1047 case 66: // 1200 bit/s
1048
1049 break; // si2 don't change
1050
1051 case 88: // 1200/75 bit/s
1052
1053 si2 += 1;
1054 break;
1055 case 87: // 75/1200 bit/s
1056
1057 si2 += 2;
1058 break;
1059 case 67: // 2400 bit/s
1060
1061 si2 += 3;
1062 break;
1063 case 69: // 4800 bit/s
1064
1065 si2 += 4;
1066 break;
1067 case 72: // 9600 bit/s
1068
1069 si2 += 5;
1070 break;
1071 case 73: // 14400 bit/s
1072
1073 si2 += 6;
1074 break;
1075 case 75: // 19200 bit/s
1076
1077 si2 += 7;
1078 break;
1079 }
1080
1081 info = p[7] & 0x7f;
1082 if ((info & 16) && (!(info & 8))) // 7 data bits
1083
1084 si2 += 32; // else 8 data bits
1085
1086 if ((info & 96) == 96) // 2 stop bits
1087
1088 si2 += 16; // else 1 stop bit
1089
1090 if ((info & 2) && (!(info & 1))) // even parity
1091
1092 si2 += 8; // else no parity
1093
1094 return si2;
1095 }
1096
1097
1098 static u_char
1099 DecodeSyncParams(u_char si2, u_char info)
1100 {
1101 info &= 0x7f;
1102 switch (info) {
1103 case 40: // bit/s negotiation failed ai := 165 not 175!
1104
1105 return si2 + 15;
1106 case 15: // 56000 bit/s failed, ai := 0 not 169 !
1107
1108 return si2 + 9;
1109 case 14: // 48000 bit/s
1110
1111 return si2 + 8;
1112 case 11: // 19200 bit/s
1113
1114 return si2 + 7;
1115 case 9: // 14400 bit/s
1116
1117 return si2 + 6;
1118 case 8: // 9600 bit/s
1119
1120 return si2 + 5;
1121 case 5: // 4800 bit/s
1122
1123 return si2 + 4;
1124 case 3: // 2400 bit/s
1125
1126 return si2 + 3;
1127 case 23: // 75/1200 bit/s
1128
1129 return si2 + 2;
1130 case 24: // 1200/75 bit/s
1131
1132 return si2 + 1;
1133 default: // 1200 bit/s
1134
1135 return si2;
1136 }
1137 }
1138
1139 static u_char
1140 DecodeSI2(struct sk_buff *skb)
1141 {
1142 u_char *p; //, *pend=skb->data + skb->len;
1143
1144 if ((p = findie(skb->data, skb->len, 0x7c, 0))) {
1145 switch (p[4] & 0x0f) {
1146 case 0x01:
1147 if (p[1] == 0x04) // sync. Bitratenadaption
1148
1149 return DecodeSyncParams(160, p[5]); // V.110/X.30
1150
1151 else if (p[1] == 0x06) // async. Bitratenadaption
1152
1153 return DecodeASyncParams(192, p); // V.110/X.30
1154
1155 break;
1156 case 0x08: // if (p[5] == 0x02) // sync. Bitratenadaption
1157 if (p[1] > 3)
1158 return DecodeSyncParams(176, p[5]); // V.120
1159 break;
1160 }
1161 }
1162 return 0;
1163 }
1164
1165 #endif
1166
1167
1168 static void
1169 l3ni1_setup_req(struct l3_process *pc, u_char pr,
1170 void *arg)
1171 {
1172 struct sk_buff *skb;
1173 u_char tmp[128];
1174 u_char *p = tmp;
1175
1176 u_char *teln;
1177 u_char *sub;
1178 u_char *sp;
1179 int l;
1180
1181 MsgHead(p, pc->callref, MT_SETUP);
1182
1183 teln = pc->para.setup.phone;
1184
1185 *p++ = 0xa1; /* complete indicator */
1186 /*
1187 * Set Bearer Capability, Map info from 1TR6-convention to NI1
1188 */
1189 switch (pc->para.setup.si1) {
1190 case 1: /* Telephony */
1191 *p++ = IE_BEARER;
1192 *p++ = 0x3; /* Length */
1193 *p++ = 0x90; /* 3.1khz Audio */
1194 *p++ = 0x90; /* Circuit-Mode 64kbps */
1195 *p++ = 0xa2; /* u-Law Audio */
1196 break;
1197 case 5: /* Datatransmission 64k, BTX */
1198 case 7: /* Datatransmission 64k */
1199 default:
1200 *p++ = IE_BEARER;
1201 *p++ = 0x2; /* Length */
1202 *p++ = 0x88; /* Coding Std. CCITT, unrestr. dig. Inform. */
1203 *p++ = 0x90; /* Circuit-Mode 64kbps */
1204 break;
1205 }
1206
1207 sub = NULL;
1208 sp = teln;
1209 while (*sp) {
1210 if ('.' == *sp) {
1211 sub = sp;
1212 *sp = 0;
1213 } else
1214 sp++;
1215 }
1216
1217 *p++ = IE_KEYPAD;
1218 *p++ = strlen(teln);
1219 while (*teln)
1220 *p++ = (*teln++) & 0x7F;
1221
1222 if (sub)
1223 *sub++ = '.';
1224
1225 #if EXT_BEARER_CAPS
1226 if ((pc->para.setup.si2 >= 160) && (pc->para.setup.si2 <= 175)) { // sync. Bitratenadaption, V.110/X.30
1227
1228 *p++ = IE_LLC;
1229 *p++ = 0x04;
1230 *p++ = 0x88;
1231 *p++ = 0x90;
1232 *p++ = 0x21;
1233 *p++ = EncodeSyncParams(pc->para.setup.si2 - 160, 0x80);
1234 } else if ((pc->para.setup.si2 >= 176) && (pc->para.setup.si2 <= 191)) { // sync. Bitratenadaption, V.120
1235
1236 *p++ = IE_LLC;
1237 *p++ = 0x05;
1238 *p++ = 0x88;
1239 *p++ = 0x90;
1240 *p++ = 0x28;
1241 *p++ = EncodeSyncParams(pc->para.setup.si2 - 176, 0);
1242 *p++ = 0x82;
1243 } else if (pc->para.setup.si2 >= 192) { // async. Bitratenadaption, V.110/X.30
1244
1245 *p++ = IE_LLC;
1246 *p++ = 0x06;
1247 *p++ = 0x88;
1248 *p++ = 0x90;
1249 *p++ = 0x21;
1250 p = EncodeASyncParams(p, pc->para.setup.si2 - 192);
1251 } else {
1252 switch (pc->para.setup.si1) {
1253 case 1: /* Telephony */
1254 *p++ = IE_LLC;
1255 *p++ = 0x3; /* Length */
1256 *p++ = 0x90; /* Coding Std. CCITT, 3.1 kHz audio */
1257 *p++ = 0x90; /* Circuit-Mode 64kbps */
1258 *p++ = 0xa2; /* u-Law Audio */
1259 break;
1260 case 5: /* Datatransmission 64k, BTX */
1261 case 7: /* Datatransmission 64k */
1262 default:
1263 *p++ = IE_LLC;
1264 *p++ = 0x2; /* Length */
1265 *p++ = 0x88; /* Coding Std. CCITT, unrestr. dig. Inform. */
1266 *p++ = 0x90; /* Circuit-Mode 64kbps */
1267 break;
1268 }
1269 }
1270 #endif
1271 l = p - tmp;
1272 if (!(skb = l3_alloc_skb(l)))
1273 {
1274 return;
1275 }
1276 memcpy(skb_put(skb, l), tmp, l);
1277 L3DelTimer(&pc->timer);
1278 L3AddTimer(&pc->timer, T303, CC_T303);
1279 newl3state(pc, 1);
1280 l3_msg(pc->st, DL_DATA | REQUEST, skb);
1281 }
1282
1283 static void
1284 l3ni1_call_proc(struct l3_process *pc, u_char pr, void *arg)
1285 {
1286 struct sk_buff *skb = arg;
1287 int id, ret;
1288
1289 if ((id = l3ni1_get_channel_id(pc, skb)) >= 0) {
1290 if ((0 == id) || ((3 == id) && (0x10 == pc->para.moderate))) {
1291 if (pc->debug & L3_DEB_WARN)
1292 l3_debug(pc->st, "setup answer with wrong chid %x", id);
1293 pc->para.cause = 100;
1294 l3ni1_status_send(pc, pr, NULL);
1295 return;
1296 }
1297 pc->para.bchannel = id;
1298 } else if (1 == pc->state) {
1299 if (pc->debug & L3_DEB_WARN)
1300 l3_debug(pc->st, "setup answer wrong chid (ret %d)", id);
1301 if (id == -1)
1302 pc->para.cause = 96;
1303 else
1304 pc->para.cause = 100;
1305 l3ni1_status_send(pc, pr, NULL);
1306 return;
1307 }
1308 /* Now we are on none mandatory IEs */
1309 ret = check_infoelements(pc, skb, ie_CALL_PROCEEDING);
1310 if (ERR_IE_COMPREHENSION == ret) {
1311 l3ni1_std_ie_err(pc, ret);
1312 return;
1313 }
1314 L3DelTimer(&pc->timer);
1315 newl3state(pc, 3);
1316 L3AddTimer(&pc->timer, T310, CC_T310);
1317 if (ret) /* STATUS for none mandatory IE errors after actions are taken */
1318 l3ni1_std_ie_err(pc, ret);
1319 pc->st->l3.l3l4(pc->st, CC_PROCEEDING | INDICATION, pc);
1320 }
1321
1322 static void
1323 l3ni1_setup_ack(struct l3_process *pc, u_char pr, void *arg)
1324 {
1325 struct sk_buff *skb = arg;
1326 int id, ret;
1327
1328 if ((id = l3ni1_get_channel_id(pc, skb)) >= 0) {
1329 if ((0 == id) || ((3 == id) && (0x10 == pc->para.moderate))) {
1330 if (pc->debug & L3_DEB_WARN)
1331 l3_debug(pc->st, "setup answer with wrong chid %x", id);
1332 pc->para.cause = 100;
1333 l3ni1_status_send(pc, pr, NULL);
1334 return;
1335 }
1336 pc->para.bchannel = id;
1337 } else {
1338 if (pc->debug & L3_DEB_WARN)
1339 l3_debug(pc->st, "setup answer wrong chid (ret %d)", id);
1340 if (id == -1)
1341 pc->para.cause = 96;
1342 else
1343 pc->para.cause = 100;
1344 l3ni1_status_send(pc, pr, NULL);
1345 return;
1346 }
1347 /* Now we are on none mandatory IEs */
1348 ret = check_infoelements(pc, skb, ie_SETUP_ACKNOWLEDGE);
1349 if (ERR_IE_COMPREHENSION == ret) {
1350 l3ni1_std_ie_err(pc, ret);
1351 return;
1352 }
1353 L3DelTimer(&pc->timer);
1354 newl3state(pc, 2);
1355 L3AddTimer(&pc->timer, T304, CC_T304);
1356 if (ret) /* STATUS for none mandatory IE errors after actions are taken */
1357 l3ni1_std_ie_err(pc, ret);
1358 pc->st->l3.l3l4(pc->st, CC_MORE_INFO | INDICATION, pc);
1359 }
1360
1361 static void
1362 l3ni1_disconnect(struct l3_process *pc, u_char pr, void *arg)
1363 {
1364 struct sk_buff *skb = arg;
1365 u_char *p;
1366 int ret;
1367 u_char cause = 0;
1368
1369 StopAllL3Timer(pc);
1370 if ((ret = l3ni1_get_cause(pc, skb))) {
1371 if (pc->debug & L3_DEB_WARN)
1372 l3_debug(pc->st, "DISC get_cause ret(%d)", ret);
1373 if (ret < 0)
1374 cause = 96;
1375 else if (ret > 0)
1376 cause = 100;
1377 }
1378 if ((p = findie(skb->data, skb->len, IE_FACILITY, 0)))
1379 l3ni1_parse_facility(pc->st, pc, pc->callref, p);
1380 ret = check_infoelements(pc, skb, ie_DISCONNECT);
1381 if (ERR_IE_COMPREHENSION == ret)
1382 cause = 96;
1383 else if ((!cause) && (ERR_IE_UNRECOGNIZED == ret))
1384 cause = 99;
1385 ret = pc->state;
1386 newl3state(pc, 12);
1387 if (cause)
1388 newl3state(pc, 19);
1389 if (11 != ret)
1390 pc->st->l3.l3l4(pc->st, CC_DISCONNECT | INDICATION, pc);
1391 else if (!cause)
1392 l3ni1_release_req(pc, pr, NULL);
1393 if (cause) {
1394 l3ni1_message_cause(pc, MT_RELEASE, cause);
1395 L3AddTimer(&pc->timer, T308, CC_T308_1);
1396 }
1397 }
1398
1399 static void
1400 l3ni1_connect(struct l3_process *pc, u_char pr, void *arg)
1401 {
1402 struct sk_buff *skb = arg;
1403 int ret;
1404
1405 ret = check_infoelements(pc, skb, ie_CONNECT);
1406 if (ERR_IE_COMPREHENSION == ret) {
1407 l3ni1_std_ie_err(pc, ret);
1408 return;
1409 }
1410 L3DelTimer(&pc->timer); /* T310 */
1411 newl3state(pc, 10);
1412 pc->para.chargeinfo = 0;
1413 /* here should inserted COLP handling KKe */
1414 if (ret)
1415 l3ni1_std_ie_err(pc, ret);
1416 pc->st->l3.l3l4(pc->st, CC_SETUP | CONFIRM, pc);
1417 }
1418
1419 static void
1420 l3ni1_alerting(struct l3_process *pc, u_char pr, void *arg)
1421 {
1422 struct sk_buff *skb = arg;
1423 int ret;
1424
1425 ret = check_infoelements(pc, skb, ie_ALERTING);
1426 if (ERR_IE_COMPREHENSION == ret) {
1427 l3ni1_std_ie_err(pc, ret);
1428 return;
1429 }
1430 L3DelTimer(&pc->timer); /* T304 */
1431 newl3state(pc, 4);
1432 if (ret)
1433 l3ni1_std_ie_err(pc, ret);
1434 pc->st->l3.l3l4(pc->st, CC_ALERTING | INDICATION, pc);
1435 }
1436
1437 static void
1438 l3ni1_setup(struct l3_process *pc, u_char pr, void *arg)
1439 {
1440 u_char *p;
1441 int bcfound = 0;
1442 char tmp[80];
1443 struct sk_buff *skb = arg;
1444 int id;
1445 int err = 0;
1446
1447 /*
1448 * Bearer Capabilities
1449 */
1450 p = skb->data;
1451 /* only the first occurence 'll be detected ! */
1452 if ((p = findie(p, skb->len, 0x04, 0))) {
1453 if ((p[1] < 2) || (p[1] > 11))
1454 err = 1;
1455 else {
1456 pc->para.setup.si2 = 0;
1457 switch (p[2] & 0x7f) {
1458 case 0x00: /* Speech */
1459 case 0x10: /* 3.1 Khz audio */
1460 pc->para.setup.si1 = 1;
1461 break;
1462 case 0x08: /* Unrestricted digital information */
1463 pc->para.setup.si1 = 7;
1464 /* JIM, 05.11.97 I wanna set service indicator 2 */
1465 #if EXT_BEARER_CAPS
1466 pc->para.setup.si2 = DecodeSI2(skb);
1467 #endif
1468 break;
1469 case 0x09: /* Restricted digital information */
1470 pc->para.setup.si1 = 2;
1471 break;
1472 case 0x11:
1473 /* Unrestr. digital information with
1474 * tones/announcements ( or 7 kHz audio
1475 */
1476 pc->para.setup.si1 = 3;
1477 break;
1478 case 0x18: /* Video */
1479 pc->para.setup.si1 = 4;
1480 break;
1481 default:
1482 err = 2;
1483 break;
1484 }
1485 switch (p[3] & 0x7f) {
1486 case 0x40: /* packed mode */
1487 pc->para.setup.si1 = 8;
1488 break;
1489 case 0x10: /* 64 kbit */
1490 case 0x11: /* 2*64 kbit */
1491 case 0x13: /* 384 kbit */
1492 case 0x15: /* 1536 kbit */
1493 case 0x17: /* 1920 kbit */
1494 pc->para.moderate = p[3] & 0x7f;
1495 break;
1496 default:
1497 err = 3;
1498 break;
1499 }
1500 }
1501 if (pc->debug & L3_DEB_SI)
1502 l3_debug(pc->st, "SI=%d, AI=%d",
1503 pc->para.setup.si1, pc->para.setup.si2);
1504 if (err) {
1505 if (pc->debug & L3_DEB_WARN)
1506 l3_debug(pc->st, "setup with wrong bearer(l=%d:%x,%x)",
1507 p[1], p[2], p[3]);
1508 pc->para.cause = 100;
1509 l3ni1_msg_without_setup(pc, pr, NULL);
1510 return;
1511 }
1512 } else {
1513 if (pc->debug & L3_DEB_WARN)
1514 l3_debug(pc->st, "setup without bearer capabilities");
1515 /* ETS 300-104 1.3.3 */
1516 pc->para.cause = 96;
1517 l3ni1_msg_without_setup(pc, pr, NULL);
1518 return;
1519 }
1520 /*
1521 * Channel Identification
1522 */
1523 if ((id = l3ni1_get_channel_id(pc, skb)) >= 0) {
1524 if ((pc->para.bchannel = id)) {
1525 if ((3 == id) && (0x10 == pc->para.moderate)) {
1526 if (pc->debug & L3_DEB_WARN)
1527 l3_debug(pc->st, "setup with wrong chid %x",
1528 id);
1529 pc->para.cause = 100;
1530 l3ni1_msg_without_setup(pc, pr, NULL);
1531 return;
1532 }
1533 bcfound++;
1534 } else
1535 { if (pc->debug & L3_DEB_WARN)
1536 l3_debug(pc->st, "setup without bchannel, call waiting");
1537 bcfound++;
1538 }
1539 } else {
1540 if (pc->debug & L3_DEB_WARN)
1541 l3_debug(pc->st, "setup with wrong chid ret %d", id);
1542 if (id == -1)
1543 pc->para.cause = 96;
1544 else
1545 pc->para.cause = 100;
1546 l3ni1_msg_without_setup(pc, pr, NULL);
1547 return;
1548 }
1549 /* Now we are on none mandatory IEs */
1550 err = check_infoelements(pc, skb, ie_SETUP);
1551 if (ERR_IE_COMPREHENSION == err) {
1552 pc->para.cause = 96;
1553 l3ni1_msg_without_setup(pc, pr, NULL);
1554 return;
1555 }
1556 p = skb->data;
1557 if ((p = findie(p, skb->len, 0x70, 0)))
1558 iecpy(pc->para.setup.eazmsn, p, 1);
1559 else
1560 pc->para.setup.eazmsn[0] = 0;
1561
1562 p = skb->data;
1563 if ((p = findie(p, skb->len, 0x71, 0))) {
1564 /* Called party subaddress */
1565 if ((p[1] >= 2) && (p[2] == 0x80) && (p[3] == 0x50)) {
1566 tmp[0] = '.';
1567 iecpy(&tmp[1], p, 2);
1568 strcat(pc->para.setup.eazmsn, tmp);
1569 } else if (pc->debug & L3_DEB_WARN)
1570 l3_debug(pc->st, "wrong called subaddress");
1571 }
1572 p = skb->data;
1573 if ((p = findie(p, skb->len, 0x6c, 0))) {
1574 pc->para.setup.plan = p[2];
1575 if (p[2] & 0x80) {
1576 iecpy(pc->para.setup.phone, p, 1);
1577 pc->para.setup.screen = 0;
1578 } else {
1579 iecpy(pc->para.setup.phone, p, 2);
1580 pc->para.setup.screen = p[3];
1581 }
1582 } else {
1583 pc->para.setup.phone[0] = 0;
1584 pc->para.setup.plan = 0;
1585 pc->para.setup.screen = 0;
1586 }
1587 p = skb->data;
1588 if ((p = findie(p, skb->len, 0x6d, 0))) {
1589 /* Calling party subaddress */
1590 if ((p[1] >= 2) && (p[2] == 0x80) && (p[3] == 0x50)) {
1591 tmp[0] = '.';
1592 iecpy(&tmp[1], p, 2);
1593 strcat(pc->para.setup.phone, tmp);
1594 } else if (pc->debug & L3_DEB_WARN)
1595 l3_debug(pc->st, "wrong calling subaddress");
1596 }
1597 newl3state(pc, 6);
1598 if (err) /* STATUS for none mandatory IE errors after actions are taken */
1599 l3ni1_std_ie_err(pc, err);
1600 pc->st->l3.l3l4(pc->st, CC_SETUP | INDICATION, pc);
1601 }
1602
1603 static void
1604 l3ni1_reset(struct l3_process *pc, u_char pr, void *arg)
1605 {
1606 ni1_release_l3_process(pc);
1607 }
1608
1609 static void
1610 l3ni1_disconnect_req(struct l3_process *pc, u_char pr, void *arg)
1611 {
1612 struct sk_buff *skb;
1613 u_char tmp[16+40];
1614 u_char *p = tmp;
1615 int l;
1616 u_char cause = 16;
1617
1618 if (pc->para.cause != NO_CAUSE)
1619 cause = pc->para.cause;
1620
1621 StopAllL3Timer(pc);
1622
1623 MsgHead(p, pc->callref, MT_DISCONNECT);
1624
1625 *p++ = IE_CAUSE;
1626 *p++ = 0x2;
1627 *p++ = 0x80;
1628 *p++ = cause | 0x80;
1629
1630 if (pc->prot.ni1.uus1_data[0])
1631 { *p++ = IE_USER_USER; /* UUS info element */
1632 *p++ = strlen(pc->prot.ni1.uus1_data) + 1;
1633 *p++ = 0x04; /* IA5 chars */
1634 strcpy(p,pc->prot.ni1.uus1_data);
1635 p += strlen(pc->prot.ni1.uus1_data);
1636 pc->prot.ni1.uus1_data[0] = '\0';
1637 }
1638
1639 l = p - tmp;
1640 if (!(skb = l3_alloc_skb(l)))
1641 return;
1642 memcpy(skb_put(skb, l), tmp, l);
1643 newl3state(pc, 11);
1644 l3_msg(pc->st, DL_DATA | REQUEST, skb);
1645 L3AddTimer(&pc->timer, T305, CC_T305);
1646 }
1647
1648 static void
1649 l3ni1_setup_rsp(struct l3_process *pc, u_char pr,
1650 void *arg)
1651 {
1652 if (!pc->para.bchannel)
1653 { if (pc->debug & L3_DEB_WARN)
1654 l3_debug(pc->st, "D-chan connect for waiting call");
1655 l3ni1_disconnect_req(pc, pr, arg);
1656 return;
1657 }
1658 newl3state(pc, 8);
1659 if (pc->debug & L3_DEB_WARN)
1660 l3_debug(pc->st, "D-chan connect for waiting call");
1661 l3ni1_message_plus_chid(pc, MT_CONNECT); /* GE 05/09/00 */
1662 L3DelTimer(&pc->timer);
1663 L3AddTimer(&pc->timer, T313, CC_T313);
1664 }
1665
1666 static void
1667 l3ni1_connect_ack(struct l3_process *pc, u_char pr, void *arg)
1668 {
1669 struct sk_buff *skb = arg;
1670 int ret;
1671
1672 ret = check_infoelements(pc, skb, ie_CONNECT_ACKNOWLEDGE);
1673 if (ERR_IE_COMPREHENSION == ret) {
1674 l3ni1_std_ie_err(pc, ret);
1675 return;
1676 }
1677 newl3state(pc, 10);
1678 L3DelTimer(&pc->timer);
1679 if (ret)
1680 l3ni1_std_ie_err(pc, ret);
1681 pc->st->l3.l3l4(pc->st, CC_SETUP_COMPL | INDICATION, pc);
1682 }
1683
1684 static void
1685 l3ni1_reject_req(struct l3_process *pc, u_char pr, void *arg)
1686 {
1687 struct sk_buff *skb;
1688 u_char tmp[16];
1689 u_char *p = tmp;
1690 int l;
1691 u_char cause = 21;
1692
1693 if (pc->para.cause != NO_CAUSE)
1694 cause = pc->para.cause;
1695
1696 MsgHead(p, pc->callref, MT_RELEASE_COMPLETE);
1697
1698 *p++ = IE_CAUSE;
1699 *p++ = 0x2;
1700 *p++ = 0x80;
1701 *p++ = cause | 0x80;
1702
1703 l = p - tmp;
1704 if (!(skb = l3_alloc_skb(l)))
1705 return;
1706 memcpy(skb_put(skb, l), tmp, l);
1707 l3_msg(pc->st, DL_DATA | REQUEST, skb);
1708 pc->st->l3.l3l4(pc->st, CC_RELEASE | INDICATION, pc);
1709 newl3state(pc, 0);
1710 ni1_release_l3_process(pc);
1711 }
1712
1713 static void
1714 l3ni1_release(struct l3_process *pc, u_char pr, void *arg)
1715 {
1716 struct sk_buff *skb = arg;
1717 u_char *p;
1718 int ret, cause=0;
1719
1720 StopAllL3Timer(pc);
1721 if ((ret = l3ni1_get_cause(pc, skb))>0) {
1722 if (pc->debug & L3_DEB_WARN)
1723 l3_debug(pc->st, "REL get_cause ret(%d)", ret);
1724 } else if (ret<0)
1725 pc->para.cause = NO_CAUSE;
1726 if ((p = findie(skb->data, skb->len, IE_FACILITY, 0))) {
1727 l3ni1_parse_facility(pc->st, pc, pc->callref, p);
1728 }
1729 if ((ret<0) && (pc->state != 11))
1730 cause = 96;
1731 else if (ret>0)
1732 cause = 100;
1733 ret = check_infoelements(pc, skb, ie_RELEASE);
1734 if (ERR_IE_COMPREHENSION == ret)
1735 cause = 96;
1736 else if ((ERR_IE_UNRECOGNIZED == ret) && (!cause))
1737 cause = 99;
1738 if (cause)
1739 l3ni1_message_cause(pc, MT_RELEASE_COMPLETE, cause);
1740 else
1741 l3ni1_message(pc, MT_RELEASE_COMPLETE);
1742 pc->st->l3.l3l4(pc->st, CC_RELEASE | INDICATION, pc);
1743 newl3state(pc, 0);
1744 ni1_release_l3_process(pc);
1745 }
1746
1747 static void
1748 l3ni1_alert_req(struct l3_process *pc, u_char pr,
1749 void *arg)
1750 {
1751 newl3state(pc, 7);
1752 if (!pc->prot.ni1.uus1_data[0])
1753 l3ni1_message(pc, MT_ALERTING);
1754 else
1755 l3ni1_msg_with_uus(pc, MT_ALERTING);
1756 }
1757
1758 static void
1759 l3ni1_proceed_req(struct l3_process *pc, u_char pr,
1760 void *arg)
1761 {
1762 newl3state(pc, 9);
1763 l3ni1_message(pc, MT_CALL_PROCEEDING);
1764 pc->st->l3.l3l4(pc->st, CC_PROCEED_SEND | INDICATION, pc);
1765 }
1766
1767 static void
1768 l3ni1_setup_ack_req(struct l3_process *pc, u_char pr,
1769 void *arg)
1770 {
1771 newl3state(pc, 25);
1772 L3DelTimer(&pc->timer);
1773 L3AddTimer(&pc->timer, T302, CC_T302);
1774 l3ni1_message(pc, MT_SETUP_ACKNOWLEDGE);
1775 }
1776
1777 /********************************************/
1778 /* deliver a incoming display message to HL */
1779 /********************************************/
1780 static void
1781 l3ni1_deliver_display(struct l3_process *pc, int pr, u_char *infp)
1782 { u_char len;
1783 isdn_ctrl ic;
1784 struct IsdnCardState *cs;
1785 char *p;
1786
1787 if (*infp++ != IE_DISPLAY) return;
1788 if ((len = *infp++) > 80) return; /* total length <= 82 */
1789 if (!pc->chan) return;
1790
1791 p = ic.parm.display;
1792 while (len--)
1793 *p++ = *infp++;
1794 *p = '\0';
1795 ic.command = ISDN_STAT_DISPLAY;
1796 cs = pc->st->l1.hardware;
1797 ic.driver = cs->myid;
1798 ic.arg = pc->chan->chan;
1799 cs->iif.statcallb(&ic);
1800 } /* l3ni1_deliver_display */
1801
1802
1803 static void
1804 l3ni1_progress(struct l3_process *pc, u_char pr, void *arg)
1805 {
1806 struct sk_buff *skb = arg;
1807 int err = 0;
1808 u_char *p;
1809
1810 if ((p = findie(skb->data, skb->len, IE_PROGRESS, 0))) {
1811 if (p[1] != 2) {
1812 err = 1;
1813 pc->para.cause = 100;
1814 } else if (!(p[2] & 0x70)) {
1815 switch (p[2]) {
1816 case 0x80:
1817 case 0x81:
1818 case 0x82:
1819 case 0x84:
1820 case 0x85:
1821 case 0x87:
1822 case 0x8a:
1823 switch (p[3]) {
1824 case 0x81:
1825 case 0x82:
1826 case 0x83:
1827 case 0x84:
1828 case 0x88:
1829 break;
1830 default:
1831 err = 2;
1832 pc->para.cause = 100;
1833 break;
1834 }
1835 break;
1836 default:
1837 err = 3;
1838 pc->para.cause = 100;
1839 break;
1840 }
1841 }
1842 } else {
1843 pc->para.cause = 96;
1844 err = 4;
1845 }
1846 if (err) {
1847 if (pc->debug & L3_DEB_WARN)
1848 l3_debug(pc->st, "progress error %d", err);
1849 l3ni1_status_send(pc, pr, NULL);
1850 return;
1851 }
1852 /* Now we are on none mandatory IEs */
1853 err = check_infoelements(pc, skb, ie_PROGRESS);
1854 if (err)
1855 l3ni1_std_ie_err(pc, err);
1856 if (ERR_IE_COMPREHENSION != err)
1857 pc->st->l3.l3l4(pc->st, CC_PROGRESS | INDICATION, pc);
1858 }
1859
1860 static void
1861 l3ni1_notify(struct l3_process *pc, u_char pr, void *arg)
1862 {
1863 struct sk_buff *skb = arg;
1864 int err = 0;
1865 u_char *p;
1866
1867 if ((p = findie(skb->data, skb->len, IE_NOTIFY, 0))) {
1868 if (p[1] != 1) {
1869 err = 1;
1870 pc->para.cause = 100;
1871 } else {
1872 switch (p[2]) {
1873 case 0x80:
1874 case 0x81:
1875 case 0x82:
1876 break;
1877 default:
1878 pc->para.cause = 100;
1879 err = 2;
1880 break;
1881 }
1882 }
1883 } else {
1884 pc->para.cause = 96;
1885 err = 3;
1886 }
1887 if (err) {
1888 if (pc->debug & L3_DEB_WARN)
1889 l3_debug(pc->st, "notify error %d", err);
1890 l3ni1_status_send(pc, pr, NULL);
1891 return;
1892 }
1893 /* Now we are on none mandatory IEs */
1894 err = check_infoelements(pc, skb, ie_NOTIFY);
1895 if (err)
1896 l3ni1_std_ie_err(pc, err);
1897 if (ERR_IE_COMPREHENSION != err)
1898 pc->st->l3.l3l4(pc->st, CC_NOTIFY | INDICATION, pc);
1899 }
1900
1901 static void
1902 l3ni1_status_enq(struct l3_process *pc, u_char pr, void *arg)
1903 {
1904 int ret;
1905 struct sk_buff *skb = arg;
1906
1907 ret = check_infoelements(pc, skb, ie_STATUS_ENQUIRY);
1908 l3ni1_std_ie_err(pc, ret);
1909 pc->para.cause = 30; /* response to STATUS_ENQUIRY */
1910 l3ni1_status_send(pc, pr, NULL);
1911 }
1912
1913 static void
1914 l3ni1_information(struct l3_process *pc, u_char pr, void *arg)
1915 {
1916 int ret;
1917 struct sk_buff *skb = arg;
1918 u_char *p;
1919 char tmp[32];
1920
1921 ret = check_infoelements(pc, skb, ie_INFORMATION);
1922 if (ret)
1923 l3ni1_std_ie_err(pc, ret);
1924 if (pc->state == 25) { /* overlap receiving */
1925 L3DelTimer(&pc->timer);
1926 p = skb->data;
1927 if ((p = findie(p, skb->len, 0x70, 0))) {
1928 iecpy(tmp, p, 1);
1929 strcat(pc->para.setup.eazmsn, tmp);
1930 pc->st->l3.l3l4(pc->st, CC_MORE_INFO | INDICATION, pc);
1931 }
1932 L3AddTimer(&pc->timer, T302, CC_T302);
1933 }
1934 }
1935
1936 /******************************/
1937 /* handle deflection requests */
1938 /******************************/
1939 static void l3ni1_redir_req(struct l3_process *pc, u_char pr, void *arg)
1940 {
1941 struct sk_buff *skb;
1942 u_char tmp[128];
1943 u_char *p = tmp;
1944 u_char *subp;
1945 u_char len_phone = 0;
1946 u_char len_sub = 0;
1947 int l;
1948
1949
1950 strcpy(pc->prot.ni1.uus1_data,pc->chan->setup.eazmsn); /* copy uus element if available */
1951 if (!pc->chan->setup.phone[0])
1952 { pc->para.cause = -1;
1953 l3ni1_disconnect_req(pc,pr,arg); /* disconnect immediately */
1954 return;
1955 } /* only uus */
1956
1957 if (pc->prot.ni1.invoke_id)
1958 free_invoke_id(pc->st,pc->prot.ni1.invoke_id);
1959
1960 if (!(pc->prot.ni1.invoke_id = new_invoke_id(pc->st)))
1961 return;
1962
1963 MsgHead(p, pc->callref, MT_FACILITY);
1964
1965 for (subp = pc->chan->setup.phone; (*subp) && (*subp != '.'); subp++) len_phone++; /* len of phone number */
1966 if (*subp++ == '.') len_sub = strlen(subp) + 2; /* length including info subaddress element */
1967
1968 *p++ = 0x1c; /* Facility info element */
1969 *p++ = len_phone + len_sub + 2 + 2 + 8 + 3 + 3; /* length of element */
1970 *p++ = 0x91; /* remote operations protocol */
1971 *p++ = 0xa1; /* invoke component */
1972
1973 *p++ = len_phone + len_sub + 2 + 2 + 8 + 3; /* length of data */
1974 *p++ = 0x02; /* invoke id tag, integer */
1975 *p++ = 0x01; /* length */
1976 *p++ = pc->prot.ni1.invoke_id; /* invoke id */
1977 *p++ = 0x02; /* operation value tag, integer */
1978 *p++ = 0x01; /* length */
1979 *p++ = 0x0D; /* Call Deflect */
1980
1981 *p++ = 0x30; /* sequence phone number */
1982 *p++ = len_phone + 2 + 2 + 3 + len_sub; /* length */
1983
1984 *p++ = 0x30; /* Deflected to UserNumber */
1985 *p++ = len_phone+2+len_sub; /* length */
1986 *p++ = 0x80; /* NumberDigits */
1987 *p++ = len_phone; /* length */
1988 for (l = 0; l < len_phone; l++)
1989 *p++ = pc->chan->setup.phone[l];
1990
1991 if (len_sub)
1992 { *p++ = 0x04; /* called party subaddress */
1993 *p++ = len_sub - 2;
1994 while (*subp) *p++ = *subp++;
1995 }
1996
1997 *p++ = 0x01; /* screening identifier */
1998 *p++ = 0x01;
1999 *p++ = pc->chan->setup.screen;
2000
2001 l = p - tmp;
2002 if (!(skb = l3_alloc_skb(l))) return;
2003 memcpy(skb_put(skb, l), tmp, l);
2004
2005 l3_msg(pc->st, DL_DATA | REQUEST, skb);
2006 } /* l3ni1_redir_req */
2007
2008 /********************************************/
2009 /* handle deflection request in early state */
2010 /********************************************/
2011 static void l3ni1_redir_req_early(struct l3_process *pc, u_char pr, void *arg)
2012 {
2013 l3ni1_proceed_req(pc,pr,arg);
2014 l3ni1_redir_req(pc,pr,arg);
2015 } /* l3ni1_redir_req_early */
2016
2017 /***********************************************/
2018 /* handle special commands for this protocol. */
2019 /* Examples are call independant services like */
2020 /* remote operations with dummy callref. */
2021 /***********************************************/
2022 static int l3ni1_cmd_global(struct PStack *st, isdn_ctrl *ic)
2023 { u_char id;
2024 u_char temp[265];
2025 u_char *p = temp;
2026 int i, l, proc_len;
2027 struct sk_buff *skb;
2028 struct l3_process *pc = NULL;
2029
2030 switch (ic->arg)
2031 { case NI1_CMD_INVOKE:
2032 if (ic->parm.ni1_io.datalen < 0) return(-2); /* invalid parameter */
2033
2034 for (proc_len = 1, i = ic->parm.ni1_io.proc >> 8; i; i++)
2035 i = i >> 8; /* add one byte */
2036 l = ic->parm.ni1_io.datalen + proc_len + 8; /* length excluding ie header */
2037 if (l > 255)
2038 return(-2); /* too long */
2039
2040 if (!(id = new_invoke_id(st)))
2041 return(0); /* first get a invoke id -> return if no available */
2042
2043 i = -1;
2044 MsgHead(p, i, MT_FACILITY); /* build message head */
2045 *p++ = 0x1C; /* Facility IE */
2046 *p++ = l; /* length of ie */
2047 *p++ = 0x91; /* remote operations */
2048 *p++ = 0xA1; /* invoke */
2049 *p++ = l - 3; /* length of invoke */
2050 *p++ = 0x02; /* invoke id tag */
2051 *p++ = 0x01; /* length is 1 */
2052 *p++ = id; /* invoke id */
2053 *p++ = 0x02; /* operation */
2054 *p++ = proc_len; /* length of operation */
2055
2056 for (i = proc_len; i; i--)
2057 *p++ = (ic->parm.ni1_io.proc >> (i-1)) & 0xFF;
2058 memcpy(p, ic->parm.ni1_io.data, ic->parm.ni1_io.datalen); /* copy data */
2059 l = (p - temp) + ic->parm.ni1_io.datalen; /* total length */
2060
2061 if (ic->parm.ni1_io.timeout > 0)
2062 if (!(pc = ni1_new_l3_process(st, -1)))
2063 { free_invoke_id(st, id);
2064 return(-2);
2065 }
2066 pc->prot.ni1.ll_id = ic->parm.ni1_io.ll_id; /* remember id */
2067 pc->prot.ni1.proc = ic->parm.ni1_io.proc; /* and procedure */
2068
2069 if (!(skb = l3_alloc_skb(l)))
2070 { free_invoke_id(st, id);
2071 if (pc) ni1_release_l3_process(pc);
2072 return(-2);
2073 }
2074 memcpy(skb_put(skb, l), temp, l);
2075
2076 if (pc)
2077 { pc->prot.ni1.invoke_id = id; /* remember id */
2078 L3AddTimer(&pc->timer, ic->parm.ni1_io.timeout, CC_TNI1_IO | REQUEST);
2079 }
2080
2081 l3_msg(st, DL_DATA | REQUEST, skb);
2082 ic->parm.ni1_io.hl_id = id; /* return id */
2083 return(0);
2084
2085 case NI1_CMD_INVOKE_ABORT:
2086 if ((pc = l3ni1_search_dummy_proc(st, ic->parm.ni1_io.hl_id)))
2087 { L3DelTimer(&pc->timer); /* remove timer */
2088 ni1_release_l3_process(pc);
2089 return(0);
2090 }
2091 else
2092 { l3_debug(st, "l3ni1_cmd_global abort unknown id");
2093 return(-2);
2094 }
2095 break;
2096
2097 default:
2098 l3_debug(st, "l3ni1_cmd_global unknown cmd 0x%lx", ic->arg);
2099 return(-1);
2100 } /* switch ic-> arg */
2101 return(-1);
2102 } /* l3ni1_cmd_global */
2103
2104 static void
2105 l3ni1_io_timer(struct l3_process *pc)
2106 { isdn_ctrl ic;
2107 struct IsdnCardState *cs = pc->st->l1.hardware;
2108
2109 L3DelTimer(&pc->timer); /* remove timer */
2110
2111 ic.driver = cs->myid;
2112 ic.command = ISDN_STAT_PROT;
2113 ic.arg = NI1_STAT_INVOKE_ERR;
2114 ic.parm.ni1_io.hl_id = pc->prot.ni1.invoke_id;
2115 ic.parm.ni1_io.ll_id = pc->prot.ni1.ll_id;
2116 ic.parm.ni1_io.proc = pc->prot.ni1.proc;
2117 ic.parm.ni1_io.timeout= -1;
2118 ic.parm.ni1_io.datalen = 0;
2119 ic.parm.ni1_io.data = NULL;
2120 free_invoke_id(pc->st, pc->prot.ni1.invoke_id);
2121 pc->prot.ni1.invoke_id = 0; /* reset id */
2122
2123 cs->iif.statcallb(&ic);
2124
2125 ni1_release_l3_process(pc);
2126 } /* l3ni1_io_timer */
2127
2128 static void
2129 l3ni1_release_ind(struct l3_process *pc, u_char pr, void *arg)
2130 {
2131 u_char *p;
2132 struct sk_buff *skb = arg;
2133 int callState = 0;
2134 p = skb->data;
2135
2136 if ((p = findie(p, skb->len, IE_CALL_STATE, 0))) {
2137 p++;
2138 if (1 == *p++)
2139 callState = *p;
2140 }
2141 if (callState == 0) {
2142 /* ETS 300-104 7.6.1, 8.6.1, 10.6.1... and 16.1
2143 * set down layer 3 without sending any message
2144 */
2145 pc->st->l3.l3l4(pc->st, CC_RELEASE | INDICATION, pc);
2146 newl3state(pc, 0);
2147 ni1_release_l3_process(pc);
2148 } else {
2149 pc->st->l3.l3l4(pc->st, CC_IGNORE | INDICATION, pc);
2150 }
2151 }
2152
2153 static void
2154 l3ni1_dummy(struct l3_process *pc, u_char pr, void *arg)
2155 {
2156 }
2157
2158 static void
2159 l3ni1_t302(struct l3_process *pc, u_char pr, void *arg)
2160 {
2161 L3DelTimer(&pc->timer);
2162 pc->para.loc = 0;
2163 pc->para.cause = 28; /* invalid number */
2164 l3ni1_disconnect_req(pc, pr, NULL);
2165 pc->st->l3.l3l4(pc->st, CC_SETUP_ERR, pc);
2166 }
2167
2168 static void
2169 l3ni1_t303(struct l3_process *pc, u_char pr, void *arg)
2170 {
2171 if (pc->N303 > 0) {
2172 pc->N303--;
2173 L3DelTimer(&pc->timer);
2174 l3ni1_setup_req(pc, pr, arg);
2175 } else {
2176 L3DelTimer(&pc->timer);
2177 l3ni1_message_cause(pc, MT_RELEASE_COMPLETE, 102);
2178 pc->st->l3.l3l4(pc->st, CC_NOSETUP_RSP, pc);
2179 ni1_release_l3_process(pc);
2180 }
2181 }
2182
2183 static void
2184 l3ni1_t304(struct l3_process *pc, u_char pr, void *arg)
2185 {
2186 L3DelTimer(&pc->timer);
2187 pc->para.loc = 0;
2188 pc->para.cause = 102;
2189 l3ni1_disconnect_req(pc, pr, NULL);
2190 pc->st->l3.l3l4(pc->st, CC_SETUP_ERR, pc);
2191
2192 }
2193
2194 static void
2195 l3ni1_t305(struct l3_process *pc, u_char pr, void *arg)
2196 {
2197 u_char tmp[16];
2198 u_char *p = tmp;
2199 int l;
2200 struct sk_buff *skb;
2201 u_char cause = 16;
2202
2203 L3DelTimer(&pc->timer);
2204 if (pc->para.cause != NO_CAUSE)
2205 cause = pc->para.cause;
2206
2207 MsgHead(p, pc->callref, MT_RELEASE);
2208
2209 *p++ = IE_CAUSE;
2210 *p++ = 0x2;
2211 *p++ = 0x80;
2212 *p++ = cause | 0x80;
2213
2214 l = p - tmp;
2215 if (!(skb = l3_alloc_skb(l)))
2216 return;
2217 memcpy(skb_put(skb, l), tmp, l);
2218 newl3state(pc, 19);
2219 l3_msg(pc->st, DL_DATA | REQUEST, skb);
2220 L3AddTimer(&pc->timer, T308, CC_T308_1);
2221 }
2222
2223 static void
2224 l3ni1_t310(struct l3_process *pc, u_char pr, void *arg)
2225 {
2226 L3DelTimer(&pc->timer);
2227 pc->para.loc = 0;
2228 pc->para.cause = 102;
2229 l3ni1_disconnect_req(pc, pr, NULL);
2230 pc->st->l3.l3l4(pc->st, CC_SETUP_ERR, pc);
2231 }
2232
2233 static void
2234 l3ni1_t313(struct l3_process *pc, u_char pr, void *arg)
2235 {
2236 L3DelTimer(&pc->timer);
2237 pc->para.loc = 0;
2238 pc->para.cause = 102;
2239 l3ni1_disconnect_req(pc, pr, NULL);
2240 pc->st->l3.l3l4(pc->st, CC_CONNECT_ERR, pc);
2241 }
2242
2243 static void
2244 l3ni1_t308_1(struct l3_process *pc, u_char pr, void *arg)
2245 {
2246 newl3state(pc, 19);
2247 L3DelTimer(&pc->timer);
2248 l3ni1_message(pc, MT_RELEASE);
2249 L3AddTimer(&pc->timer, T308, CC_T308_2);
2250 }
2251
2252 static void
2253 l3ni1_t308_2(struct l3_process *pc, u_char pr, void *arg)
2254 {
2255 L3DelTimer(&pc->timer);
2256 pc->st->l3.l3l4(pc->st, CC_RELEASE_ERR, pc);
2257 ni1_release_l3_process(pc);
2258 }
2259
2260 static void
2261 l3ni1_t318(struct l3_process *pc, u_char pr, void *arg)
2262 {
2263 L3DelTimer(&pc->timer);
2264 pc->para.cause = 102; /* Timer expiry */
2265 pc->para.loc = 0; /* local */
2266 pc->st->l3.l3l4(pc->st, CC_RESUME_ERR, pc);
2267 newl3state(pc, 19);
2268 l3ni1_message(pc, MT_RELEASE);
2269 L3AddTimer(&pc->timer, T308, CC_T308_1);
2270 }
2271
2272 static void
2273 l3ni1_t319(struct l3_process *pc, u_char pr, void *arg)
2274 {
2275 L3DelTimer(&pc->timer);
2276 pc->para.cause = 102; /* Timer expiry */
2277 pc->para.loc = 0; /* local */
2278 pc->st->l3.l3l4(pc->st, CC_SUSPEND_ERR, pc);
2279 newl3state(pc, 10);
2280 }
2281
2282 static void
2283 l3ni1_restart(struct l3_process *pc, u_char pr, void *arg)
2284 {
2285 L3DelTimer(&pc->timer);
2286 pc->st->l3.l3l4(pc->st, CC_RELEASE | INDICATION, pc);
2287 ni1_release_l3_process(pc);
2288 }
2289
2290 static void
2291 l3ni1_status(struct l3_process *pc, u_char pr, void *arg)
2292 {
2293 u_char *p;
2294 struct sk_buff *skb = arg;
2295 int ret;
2296 u_char cause = 0, callState = 0;
2297
2298 if ((ret = l3ni1_get_cause(pc, skb))) {
2299 if (pc->debug & L3_DEB_WARN)
2300 l3_debug(pc->st, "STATUS get_cause ret(%d)",ret);
2301 if (ret < 0)
2302 cause = 96;
2303 else if (ret > 0)
2304 cause = 100;
2305 }
2306 if ((p = findie(skb->data, skb->len, IE_CALL_STATE, 0))) {
2307 p++;
2308 if (1 == *p++) {
2309 callState = *p;
2310 if (!ie_in_set(pc, *p, l3_valid_states))
2311 cause = 100;
2312 } else
2313 cause = 100;
2314 } else
2315 cause = 96;
2316 if (!cause) { /* no error before */
2317 ret = check_infoelements(pc, skb, ie_STATUS);
2318 if (ERR_IE_COMPREHENSION == ret)
2319 cause = 96;
2320 else if (ERR_IE_UNRECOGNIZED == ret)
2321 cause = 99;
2322 }
2323 if (cause) {
2324 u_char tmp;
2325
2326 if (pc->debug & L3_DEB_WARN)
2327 l3_debug(pc->st, "STATUS error(%d/%d)",ret,cause);
2328 tmp = pc->para.cause;
2329 pc->para.cause = cause;
2330 l3ni1_status_send(pc, 0, NULL);
2331 if (cause == 99)
2332 pc->para.cause = tmp;
2333 else
2334 return;
2335 }
2336 cause = pc->para.cause;
2337 if (((cause & 0x7f) == 111) && (callState == 0)) {
2338 /* ETS 300-104 7.6.1, 8.6.1, 10.6.1...
2339 * if received MT_STATUS with cause == 111 and call
2340 * state == 0, then we must set down layer 3
2341 */
2342 pc->st->l3.l3l4(pc->st, CC_RELEASE | INDICATION, pc);
2343 newl3state(pc, 0);
2344 ni1_release_l3_process(pc);
2345 }
2346 }
2347
2348 static void
2349 l3ni1_facility(struct l3_process *pc, u_char pr, void *arg)
2350 {
2351 struct sk_buff *skb = arg;
2352 int ret;
2353
2354 ret = check_infoelements(pc, skb, ie_FACILITY);
2355 l3ni1_std_ie_err(pc, ret);
2356 {
2357 u_char *p;
2358 if ((p = findie(skb->data, skb->len, IE_FACILITY, 0)))
2359 l3ni1_parse_facility(pc->st, pc, pc->callref, p);
2360 }
2361 }
2362
2363 static void
2364 l3ni1_suspend_req(struct l3_process *pc, u_char pr, void *arg)
2365 {
2366 struct sk_buff *skb;
2367 u_char tmp[32];
2368 u_char *p = tmp;
2369 u_char i, l;
2370 u_char *msg = pc->chan->setup.phone;
2371
2372 MsgHead(p, pc->callref, MT_SUSPEND);
2373 l = *msg++;
2374 if (l && (l <= 10)) { /* Max length 10 octets */
2375 *p++ = IE_CALL_ID;
2376 *p++ = l;
2377 for (i = 0; i < l; i++)
2378 *p++ = *msg++;
2379 } else if (l) {
2380 l3_debug(pc->st, "SUS wrong CALL_ID len %d", l);
2381 return;
2382 }
2383 l = p - tmp;
2384 if (!(skb = l3_alloc_skb(l)))
2385 return;
2386 memcpy(skb_put(skb, l), tmp, l);
2387 l3_msg(pc->st, DL_DATA | REQUEST, skb);
2388 newl3state(pc, 15);
2389 L3AddTimer(&pc->timer, T319, CC_T319);
2390 }
2391
2392 static void
2393 l3ni1_suspend_ack(struct l3_process *pc, u_char pr, void *arg)
2394 {
2395 struct sk_buff *skb = arg;
2396 int ret;
2397
2398 L3DelTimer(&pc->timer);
2399 newl3state(pc, 0);
2400 pc->para.cause = NO_CAUSE;
2401 pc->st->l3.l3l4(pc->st, CC_SUSPEND | CONFIRM, pc);
2402 /* We don't handle suspend_ack for IE errors now */
2403 if ((ret = check_infoelements(pc, skb, ie_SUSPEND_ACKNOWLEDGE)))
2404 if (pc->debug & L3_DEB_WARN)
2405 l3_debug(pc->st, "SUSPACK check ie(%d)",ret);
2406 ni1_release_l3_process(pc);
2407 }
2408
2409 static void
2410 l3ni1_suspend_rej(struct l3_process *pc, u_char pr, void *arg)
2411 {
2412 struct sk_buff *skb = arg;
2413 int ret;
2414
2415 if ((ret = l3ni1_get_cause(pc, skb))) {
2416 if (pc->debug & L3_DEB_WARN)
2417 l3_debug(pc->st, "SUSP_REJ get_cause ret(%d)",ret);
2418 if (ret < 0)
2419 pc->para.cause = 96;
2420 else
2421 pc->para.cause = 100;
2422 l3ni1_status_send(pc, pr, NULL);
2423 return;
2424 }
2425 ret = check_infoelements(pc, skb, ie_SUSPEND_REJECT);
2426 if (ERR_IE_COMPREHENSION == ret) {
2427 l3ni1_std_ie_err(pc, ret);
2428 return;
2429 }
2430 L3DelTimer(&pc->timer);
2431 pc->st->l3.l3l4(pc->st, CC_SUSPEND_ERR, pc);
2432 newl3state(pc, 10);
2433 if (ret) /* STATUS for none mandatory IE errors after actions are taken */
2434 l3ni1_std_ie_err(pc, ret);
2435 }
2436
2437 static void
2438 l3ni1_resume_req(struct l3_process *pc, u_char pr, void *arg)
2439 {
2440 struct sk_buff *skb;
2441 u_char tmp[32];
2442 u_char *p = tmp;
2443 u_char i, l;
2444 u_char *msg = pc->para.setup.phone;
2445
2446 MsgHead(p, pc->callref, MT_RESUME);
2447
2448 l = *msg++;
2449 if (l && (l <= 10)) { /* Max length 10 octets */
2450 *p++ = IE_CALL_ID;
2451 *p++ = l;
2452 for (i = 0; i < l; i++)
2453 *p++ = *msg++;
2454 } else if (l) {
2455 l3_debug(pc->st, "RES wrong CALL_ID len %d", l);
2456 return;
2457 }
2458 l = p - tmp;
2459 if (!(skb = l3_alloc_skb(l)))
2460 return;
2461 memcpy(skb_put(skb, l), tmp, l);
2462 l3_msg(pc->st, DL_DATA | REQUEST, skb);
2463 newl3state(pc, 17);
2464 L3AddTimer(&pc->timer, T318, CC_T318);
2465 }
2466
2467 static void
2468 l3ni1_resume_ack(struct l3_process *pc, u_char pr, void *arg)
2469 {
2470 struct sk_buff *skb = arg;
2471 int id, ret;
2472
2473 if ((id = l3ni1_get_channel_id(pc, skb)) > 0) {
2474 if ((0 == id) || ((3 == id) && (0x10 == pc->para.moderate))) {
2475 if (pc->debug & L3_DEB_WARN)
2476 l3_debug(pc->st, "resume ack with wrong chid %x", id);
2477 pc->para.cause = 100;
2478 l3ni1_status_send(pc, pr, NULL);
2479 return;
2480 }
2481 pc->para.bchannel = id;
2482 } else if (1 == pc->state) {
2483 if (pc->debug & L3_DEB_WARN)
2484 l3_debug(pc->st, "resume ack without chid (ret %d)", id);
2485 pc->para.cause = 96;
2486 l3ni1_status_send(pc, pr, NULL);
2487 return;
2488 }
2489 ret = check_infoelements(pc, skb, ie_RESUME_ACKNOWLEDGE);
2490 if (ERR_IE_COMPREHENSION == ret) {
2491 l3ni1_std_ie_err(pc, ret);
2492 return;
2493 }
2494 L3DelTimer(&pc->timer);
2495 pc->st->l3.l3l4(pc->st, CC_RESUME | CONFIRM, pc);
2496 newl3state(pc, 10);
2497 if (ret) /* STATUS for none mandatory IE errors after actions are taken */
2498 l3ni1_std_ie_err(pc, ret);
2499 }
2500
2501 static void
2502 l3ni1_resume_rej(struct l3_process *pc, u_char pr, void *arg)
2503 {
2504 struct sk_buff *skb = arg;
2505 int ret;
2506
2507 if ((ret = l3ni1_get_cause(pc, skb))) {
2508 if (pc->debug & L3_DEB_WARN)
2509 l3_debug(pc->st, "RES_REJ get_cause ret(%d)",ret);
2510 if (ret < 0)
2511 pc->para.cause = 96;
2512 else
2513 pc->para.cause = 100;
2514 l3ni1_status_send(pc, pr, NULL);
2515 return;
2516 }
2517 ret = check_infoelements(pc, skb, ie_RESUME_REJECT);
2518 if (ERR_IE_COMPREHENSION == ret) {
2519 l3ni1_std_ie_err(pc, ret);
2520 return;
2521 }
2522 L3DelTimer(&pc->timer);
2523 pc->st->l3.l3l4(pc->st, CC_RESUME_ERR, pc);
2524 newl3state(pc, 0);
2525 if (ret) /* STATUS for none mandatory IE errors after actions are taken */
2526 l3ni1_std_ie_err(pc, ret);
2527 ni1_release_l3_process(pc);
2528 }
2529
2530 static void
2531 l3ni1_global_restart(struct l3_process *pc, u_char pr, void *arg)
2532 {
2533 u_char tmp[32];
2534 u_char *p;
2535 u_char ri, ch = 0, chan = 0;
2536 int l;
2537 struct sk_buff *skb = arg;
2538 struct l3_process *up;
2539
2540 newl3state(pc, 2);
2541 L3DelTimer(&pc->timer);
2542 p = skb->data;
2543 if ((p = findie(p, skb->len, IE_RESTART_IND, 0))) {
2544 ri = p[2];
2545 l3_debug(pc->st, "Restart %x", ri);
2546 } else {
2547 l3_debug(pc->st, "Restart without restart IE");
2548 ri = 0x86;
2549 }
2550 p = skb->data;
2551 if ((p = findie(p, skb->len, IE_CHANNEL_ID, 0))) {
2552 chan = p[2] & 3;
2553 ch = p[2];
2554 if (pc->st->l3.debug)
2555 l3_debug(pc->st, "Restart for channel %d", chan);
2556 }
2557 newl3state(pc, 2);
2558 up = pc->st->l3.proc;
2559 while (up) {
2560 if ((ri & 7) == 7)
2561 up->st->lli.l4l3(up->st, CC_RESTART | REQUEST, up);
2562 else if (up->para.bchannel == chan)
2563 up->st->lli.l4l3(up->st, CC_RESTART | REQUEST, up);
2564
2565 up = up->next;
2566 }
2567 p = tmp;
2568 MsgHead(p, pc->callref, MT_RESTART_ACKNOWLEDGE);
2569 if (chan) {
2570 *p++ = IE_CHANNEL_ID;
2571 *p++ = 1;
2572 *p++ = ch | 0x80;
2573 }
2574 *p++ = 0x79; /* RESTART Ind */
2575 *p++ = 1;
2576 *p++ = ri;
2577 l = p - tmp;
2578 if (!(skb = l3_alloc_skb(l)))
2579 return;
2580 memcpy(skb_put(skb, l), tmp, l);
2581 newl3state(pc, 0);
2582 l3_msg(pc->st, DL_DATA | REQUEST, skb);
2583 }
2584
2585 static void
2586 l3ni1_dl_reset(struct l3_process *pc, u_char pr, void *arg)
2587 {
2588 pc->para.cause = 0x29; /* Temporary failure */
2589 pc->para.loc = 0;
2590 l3ni1_disconnect_req(pc, pr, NULL);
2591 pc->st->l3.l3l4(pc->st, CC_SETUP_ERR, pc);
2592 }
2593
2594 static void
2595 l3ni1_dl_release(struct l3_process *pc, u_char pr, void *arg)
2596 {
2597 newl3state(pc, 0);
2598 pc->para.cause = 0x1b; /* Destination out of order */
2599 pc->para.loc = 0;
2600 pc->st->l3.l3l4(pc->st, CC_RELEASE | INDICATION, pc);
2601 release_l3_process(pc);
2602 }
2603
2604 static void
2605 l3ni1_dl_reestablish(struct l3_process *pc, u_char pr, void *arg)
2606 {
2607 L3DelTimer(&pc->timer);
2608 L3AddTimer(&pc->timer, T309, CC_T309);
2609 l3_msg(pc->st, DL_ESTABLISH | REQUEST, NULL);
2610 }
2611
2612 static void
2613 l3ni1_dl_reest_status(struct l3_process *pc, u_char pr, void *arg)
2614 {
2615 L3DelTimer(&pc->timer);
2616
2617 pc->para.cause = 0x1F; /* normal, unspecified */
2618 l3ni1_status_send(pc, 0, NULL);
2619 }
2620
2621 static void l3ni1_SendSpid( struct l3_process *pc, u_char pr, struct sk_buff *skb, int iNewState )
2622 {
2623 u_char * p;
2624 char * pSPID;
2625 struct Channel * pChan = pc->st->lli.userdata;
2626 int l;
2627
2628 if ( skb )
2629 dev_kfree_skb( skb);
2630
2631 if ( !( pSPID = strchr( pChan->setup.eazmsn, ':' ) ) )
2632 {
2633 printk( KERN_ERR "SPID not supplied in EAZMSN %s\n", pChan->setup.eazmsn );
2634 newl3state( pc, 0 );
2635 pc->st->l3.l3l2( pc->st, DL_RELEASE | REQUEST, NULL );
2636 return;
2637 }
2638
2639 l = strlen( ++pSPID );
2640 if ( !( skb = l3_alloc_skb( 5+l ) ) )
2641 {
2642 printk( KERN_ERR "HiSax can't get memory to send SPID\n" );
2643 return;
2644 }
2645
2646 p = skb_put( skb, 5 );
2647 *p++ = PROTO_DIS_EURO;
2648 *p++ = 0;
2649 *p++ = MT_INFORMATION;
2650 *p++ = IE_SPID;
2651 *p++ = l;
2652
2653 memcpy( skb_put( skb, l ), pSPID, l );
2654
2655 newl3state( pc, iNewState );
2656
2657 L3DelTimer( &pc->timer );
2658 L3AddTimer( &pc->timer, TSPID, CC_TSPID );
2659
2660 pc->st->l3.l3l2( pc->st, DL_DATA | REQUEST, skb );
2661 }
2662
2663 static void l3ni1_spid_send( struct l3_process *pc, u_char pr, void *arg )
2664 {
2665 l3ni1_SendSpid( pc, pr, arg, 20 );
2666 }
2667
2668 static void l3ni1_spid_epid( struct l3_process *pc, u_char pr, void *arg )
2669 {
2670 struct sk_buff *skb = arg;
2671
2672 if ( skb->data[ 1 ] == 0 )
2673 if ( skb->data[ 3 ] == IE_ENDPOINT_ID )
2674 {
2675 L3DelTimer( &pc->timer );
2676 newl3state( pc, 0 );
2677 l3_msg( pc->st, DL_ESTABLISH | CONFIRM, NULL );
2678 }
2679 dev_kfree_skb( skb);
2680 }
2681
2682 static void l3ni1_spid_tout( struct l3_process *pc, u_char pr, void *arg )
2683 {
2684 if ( pc->state < 22 )
2685 l3ni1_SendSpid( pc, pr, arg, pc->state+1 );
2686 else
2687 {
2688 L3DelTimer( &pc->timer );
2689 dev_kfree_skb( arg);
2690
2691 printk( KERN_ERR "SPID not accepted\n" );
2692 newl3state( pc, 0 );
2693 pc->st->l3.l3l2( pc->st, DL_RELEASE | REQUEST, NULL );
2694 }
2695 }
2696
2697 /* *INDENT-OFF* */
2698 static struct stateentry downstatelist[] =
2699 {
2700 {SBIT(0),
2701 CC_SETUP | REQUEST, l3ni1_setup_req},
2702 {SBIT(0),
2703 CC_RESUME | REQUEST, l3ni1_resume_req},
2704 {SBIT(1) | SBIT(2) | SBIT(3) | SBIT(4) | SBIT(6) | SBIT(7) | SBIT(8) | SBIT(9) | SBIT(10) | SBIT(25),
2705 CC_DISCONNECT | REQUEST, l3ni1_disconnect_req},
2706 {SBIT(12),
2707 CC_RELEASE | REQUEST, l3ni1_release_req},
2708 {ALL_STATES,
2709 CC_RESTART | REQUEST, l3ni1_restart},
2710 {SBIT(6) | SBIT(25),
2711 CC_IGNORE | REQUEST, l3ni1_reset},
2712 {SBIT(6) | SBIT(25),
2713 CC_REJECT | REQUEST, l3ni1_reject_req},
2714 {SBIT(6) | SBIT(25),
2715 CC_PROCEED_SEND | REQUEST, l3ni1_proceed_req},
2716 {SBIT(6),
2717 CC_MORE_INFO | REQUEST, l3ni1_setup_ack_req},
2718 {SBIT(25),
2719 CC_MORE_INFO | REQUEST, l3ni1_dummy},
2720 {SBIT(6) | SBIT(9) | SBIT(25),
2721 CC_ALERTING | REQUEST, l3ni1_alert_req},
2722 {SBIT(6) | SBIT(7) | SBIT(9) | SBIT(25),
2723 CC_SETUP | RESPONSE, l3ni1_setup_rsp},
2724 {SBIT(10),
2725 CC_SUSPEND | REQUEST, l3ni1_suspend_req},
2726 {SBIT(7) | SBIT(9) | SBIT(25),
2727 CC_REDIR | REQUEST, l3ni1_redir_req},
2728 {SBIT(6),
2729 CC_REDIR | REQUEST, l3ni1_redir_req_early},
2730 {SBIT(9) | SBIT(25),
2731 CC_DISCONNECT | REQUEST, l3ni1_disconnect_req},
2732 {SBIT(25),
2733 CC_T302, l3ni1_t302},
2734 {SBIT(1),
2735 CC_T303, l3ni1_t303},
2736 {SBIT(2),
2737 CC_T304, l3ni1_t304},
2738 {SBIT(3),
2739 CC_T310, l3ni1_t310},
2740 {SBIT(8),
2741 CC_T313, l3ni1_t313},
2742 {SBIT(11),
2743 CC_T305, l3ni1_t305},
2744 {SBIT(15),
2745 CC_T319, l3ni1_t319},
2746 {SBIT(17),
2747 CC_T318, l3ni1_t318},
2748 {SBIT(19),
2749 CC_T308_1, l3ni1_t308_1},
2750 {SBIT(19),
2751 CC_T308_2, l3ni1_t308_2},
2752 {SBIT(10),
2753 CC_T309, l3ni1_dl_release},
2754 { SBIT( 20 ) | SBIT( 21 ) | SBIT( 22 ),
2755 CC_TSPID, l3ni1_spid_tout },
2756 };
2757
2758 #define DOWNSLLEN \
2759 (sizeof(downstatelist) / sizeof(struct stateentry))
2760
2761 static struct stateentry datastatelist[] =
2762 {
2763 {ALL_STATES,
2764 MT_STATUS_ENQUIRY, l3ni1_status_enq},
2765 {ALL_STATES,
2766 MT_FACILITY, l3ni1_facility},
2767 {SBIT(19),
2768 MT_STATUS, l3ni1_release_ind},
2769 {ALL_STATES,
2770 MT_STATUS, l3ni1_status},
2771 {SBIT(0),
2772 MT_SETUP, l3ni1_setup},
2773 {SBIT(6) | SBIT(7) | SBIT(8) | SBIT(9) | SBIT(10) | SBIT(11) | SBIT(12) |
2774 SBIT(15) | SBIT(17) | SBIT(19) | SBIT(25),
2775 MT_SETUP, l3ni1_dummy},
2776 {SBIT(1) | SBIT(2),
2777 MT_CALL_PROCEEDING, l3ni1_call_proc},
2778 {SBIT(1),
2779 MT_SETUP_ACKNOWLEDGE, l3ni1_setup_ack},
2780 {SBIT(2) | SBIT(3),
2781 MT_ALERTING, l3ni1_alerting},
2782 {SBIT(2) | SBIT(3),
2783 MT_PROGRESS, l3ni1_progress},
2784 {SBIT(2) | SBIT(3) | SBIT(4) | SBIT(7) | SBIT(8) | SBIT(9) | SBIT(10) |
2785 SBIT(11) | SBIT(12) | SBIT(15) | SBIT(17) | SBIT(19) | SBIT(25),
2786 MT_INFORMATION, l3ni1_information},
2787 {SBIT(10) | SBIT(11) | SBIT(15),
2788 MT_NOTIFY, l3ni1_notify},
2789 {SBIT(0) | SBIT(1) | SBIT(2) | SBIT(3) | SBIT(4) | SBIT(7) | SBIT(8) | SBIT(10) |
2790 SBIT(11) | SBIT(12) | SBIT(15) | SBIT(17) | SBIT(19) | SBIT(25),
2791 MT_RELEASE_COMPLETE, l3ni1_release_cmpl},
2792 {SBIT(1) | SBIT(2) | SBIT(3) | SBIT(4) | SBIT(7) | SBIT(8) | SBIT(9) | SBIT(10) | SBIT(11) | SBIT(12) | SBIT(15) | SBIT(17) | SBIT(25),
2793 MT_RELEASE, l3ni1_release},
2794 {SBIT(19), MT_RELEASE, l3ni1_release_ind},
2795 {SBIT(1) | SBIT(2) | SBIT(3) | SBIT(4) | SBIT(7) | SBIT(8) | SBIT(9) | SBIT(10) | SBIT(11) | SBIT(15) | SBIT(17) | SBIT(25),
2796 MT_DISCONNECT, l3ni1_disconnect},
2797 {SBIT(19),
2798 MT_DISCONNECT, l3ni1_dummy},
2799 {SBIT(1) | SBIT(2) | SBIT(3) | SBIT(4),
2800 MT_CONNECT, l3ni1_connect},
2801 {SBIT(8),
2802 MT_CONNECT_ACKNOWLEDGE, l3ni1_connect_ack},
2803 {SBIT(15),
2804 MT_SUSPEND_ACKNOWLEDGE, l3ni1_suspend_ack},
2805 {SBIT(15),
2806 MT_SUSPEND_REJECT, l3ni1_suspend_rej},
2807 {SBIT(17),
2808 MT_RESUME_ACKNOWLEDGE, l3ni1_resume_ack},
2809 {SBIT(17),
2810 MT_RESUME_REJECT, l3ni1_resume_rej},
2811 };
2812
2813 #define DATASLLEN \
2814 (sizeof(datastatelist) / sizeof(struct stateentry))
2815
2816 static struct stateentry globalmes_list[] =
2817 {
2818 {ALL_STATES,
2819 MT_STATUS, l3ni1_status},
2820 {SBIT(0),
2821 MT_RESTART, l3ni1_global_restart},
2822 /* {SBIT(1),
2823 MT_RESTART_ACKNOWLEDGE, l3ni1_restart_ack},
2824 */
2825 { SBIT( 0 ), MT_DL_ESTABLISHED, l3ni1_spid_send },
2826 { SBIT( 20 ) | SBIT( 21 ) | SBIT( 22 ), MT_INFORMATION, l3ni1_spid_epid },
2827 };
2828 #define GLOBALM_LEN \
2829 (sizeof(globalmes_list) / sizeof(struct stateentry))
2830
2831 static struct stateentry manstatelist[] =
2832 {
2833 {SBIT(2),
2834 DL_ESTABLISH | INDICATION, l3ni1_dl_reset},
2835 {SBIT(10),
2836 DL_ESTABLISH | CONFIRM, l3ni1_dl_reest_status},
2837 {SBIT(10),
2838 DL_RELEASE | INDICATION, l3ni1_dl_reestablish},
2839 {ALL_STATES,
2840 DL_RELEASE | INDICATION, l3ni1_dl_release},
2841 };
2842
2843 #define MANSLLEN \
2844 (sizeof(manstatelist) / sizeof(struct stateentry))
2845 /* *INDENT-ON* */
2846
2847
2848 static void
2849 global_handler(struct PStack *st, int mt, struct sk_buff *skb)
2850 {
2851 u_char tmp[16];
2852 u_char *p = tmp;
2853 int l;
2854 int i;
2855 struct l3_process *proc = st->l3.global;
2856
2857 if ( skb )
2858 proc->callref = skb->data[2]; /* cr flag */
2859 else
2860 proc->callref = 0;
2861 for (i = 0; i < GLOBALM_LEN; i++)
2862 if ((mt == globalmes_list[i].primitive) &&
2863 ((1 << proc->state) & globalmes_list[i].state))
2864 break;
2865 if (i == GLOBALM_LEN) {
2866 if (st->l3.debug & L3_DEB_STATE) {
2867 l3_debug(st, "ni1 global state %d mt %x unhandled",
2868 proc->state, mt);
2869 }
2870 MsgHead(p, proc->callref, MT_STATUS);
2871 *p++ = IE_CAUSE;
2872 *p++ = 0x2;
2873 *p++ = 0x80;
2874 *p++ = 81 |0x80; /* invalid cr */
2875 *p++ = 0x14; /* CallState */
2876 *p++ = 0x1;
2877 *p++ = proc->state & 0x3f;
2878 l = p - tmp;
2879 if (!(skb = l3_alloc_skb(l)))
2880 return;
2881 memcpy(skb_put(skb, l), tmp, l);
2882 l3_msg(proc->st, DL_DATA | REQUEST, skb);
2883 } else {
2884 if (st->l3.debug & L3_DEB_STATE) {
2885 l3_debug(st, "ni1 global %d mt %x",
2886 proc->state, mt);
2887 }
2888 globalmes_list[i].rout(proc, mt, skb);
2889 }
2890 }
2891
2892 static void
2893 ni1up(struct PStack *st, int pr, void *arg)
2894 {
2895 int i, mt, cr, cause, callState;
2896 char *ptr;
2897 u_char *p;
2898 struct sk_buff *skb = arg;
2899 struct l3_process *proc;
2900
2901 switch (pr) {
2902 case (DL_DATA | INDICATION):
2903 case (DL_UNIT_DATA | INDICATION):
2904 break;
2905 case (DL_ESTABLISH | INDICATION):
2906 case (DL_RELEASE | INDICATION):
2907 case (DL_RELEASE | CONFIRM):
2908 l3_msg(st, pr, arg);
2909 return;
2910 break;
2911
2912 case (DL_ESTABLISH | CONFIRM):
2913 global_handler( st, MT_DL_ESTABLISHED, NULL );
2914 return;
2915
2916 default:
2917 printk(KERN_ERR "HiSax ni1up unknown pr=%04x\n", pr);
2918 return;
2919 }
2920 if (skb->len < 3) {
2921 l3_debug(st, "ni1up frame too short(%d)", skb->len);
2922 dev_kfree_skb(skb);
2923 return;
2924 }
2925
2926 if (skb->data[0] != PROTO_DIS_EURO) {
2927 if (st->l3.debug & L3_DEB_PROTERR) {
2928 l3_debug(st, "ni1up%sunexpected discriminator %x message len %d",
2929 (pr == (DL_DATA | INDICATION)) ? " " : "(broadcast) ",
2930 skb->data[0], skb->len);
2931 }
2932 dev_kfree_skb(skb);
2933 return;
2934 }
2935 cr = getcallref(skb->data);
2936 if (skb->len < ((skb->data[1] & 0x0f) + 3)) {
2937 l3_debug(st, "ni1up frame too short(%d)", skb->len);
2938 dev_kfree_skb(skb);
2939 return;
2940 }
2941 mt = skb->data[skb->data[1] + 2];
2942 if (st->l3.debug & L3_DEB_STATE)
2943 l3_debug(st, "ni1up cr %d", cr);
2944 if (cr == -2) { /* wrong Callref */
2945 if (st->l3.debug & L3_DEB_WARN)
2946 l3_debug(st, "ni1up wrong Callref");
2947 dev_kfree_skb(skb);
2948 return;
2949 } else if (cr == -1) { /* Dummy Callref */
2950 if (mt == MT_FACILITY)
2951 {
2952 if ((p = findie(skb->data, skb->len, IE_FACILITY, 0))) {
2953 l3ni1_parse_facility(st, NULL,
2954 (pr == (DL_DATA | INDICATION)) ? -1 : -2, p);
2955 dev_kfree_skb(skb);
2956 return;
2957 }
2958 }
2959 else
2960 {
2961 global_handler(st, mt, skb);
2962 return;
2963 }
2964
2965 if (st->l3.debug & L3_DEB_WARN)
2966 l3_debug(st, "ni1up dummy Callref (no facility msg or ie)");
2967 dev_kfree_skb(skb);
2968 return;
2969 } else if ((((skb->data[1] & 0x0f) == 1) && (0==(cr & 0x7f))) ||
2970 (((skb->data[1] & 0x0f) == 2) && (0==(cr & 0x7fff)))) { /* Global CallRef */
2971 if (st->l3.debug & L3_DEB_STATE)
2972 l3_debug(st, "ni1up Global CallRef");
2973 global_handler(st, mt, skb);
2974 dev_kfree_skb(skb);
2975 return;
2976 } else if (!(proc = getl3proc(st, cr))) {
2977 /* No transaction process exist, that means no call with
2978 * this callreference is active
2979 */
2980 if (mt == MT_SETUP) {
2981 /* Setup creates a new transaction process */
2982 if (skb->data[2] & 0x80) {
2983 /* Setup with wrong CREF flag */
2984 if (st->l3.debug & L3_DEB_STATE)
2985 l3_debug(st, "ni1up wrong CRef flag");
2986 dev_kfree_skb(skb);
2987 return;
2988 }
2989 if (!(proc = ni1_new_l3_process(st, cr))) {
2990 /* May be to answer with RELEASE_COMPLETE and
2991 * CAUSE 0x2f "Resource unavailable", but this
2992 * need a new_l3_process too ... arghh
2993 */
2994 dev_kfree_skb(skb);
2995 return;
2996 }
2997 } else if (mt == MT_STATUS) {
2998 cause = 0;
2999 if ((ptr = findie(skb->data, skb->len, IE_CAUSE, 0)) != NULL) {
3000 ptr++;
3001 if (*ptr++ == 2)
3002 ptr++;
3003 cause = *ptr & 0x7f;
3004 }
3005 callState = 0;
3006 if ((ptr = findie(skb->data, skb->len, IE_CALL_STATE, 0)) != NULL) {
3007 ptr++;
3008 if (*ptr++ == 2)
3009 ptr++;
3010 callState = *ptr;
3011 }
3012 /* ETS 300-104 part 2.4.1
3013 * if setup has not been made and a message type
3014 * MT_STATUS is received with call state == 0,
3015 * we must send nothing
3016 */
3017 if (callState != 0) {
3018 /* ETS 300-104 part 2.4.2
3019 * if setup has not been made and a message type
3020 * MT_STATUS is received with call state != 0,
3021 * we must send MT_RELEASE_COMPLETE cause 101
3022 */
3023 if ((proc = ni1_new_l3_process(st, cr))) {
3024 proc->para.cause = 101;
3025 l3ni1_msg_without_setup(proc, 0, NULL);
3026 }
3027 }
3028 dev_kfree_skb(skb);
3029 return;
3030 } else if (mt == MT_RELEASE_COMPLETE) {
3031 dev_kfree_skb(skb);
3032 return;
3033 } else {
3034 /* ETS 300-104 part 2
3035 * if setup has not been made and a message type
3036 * (except MT_SETUP and RELEASE_COMPLETE) is received,
3037 * we must send MT_RELEASE_COMPLETE cause 81 */
3038 dev_kfree_skb(skb);
3039 if ((proc = ni1_new_l3_process(st, cr))) {
3040 proc->para.cause = 81;
3041 l3ni1_msg_without_setup(proc, 0, NULL);
3042 }
3043 return;
3044 }
3045 }
3046 if (l3ni1_check_messagetype_validity(proc, mt, skb)) {
3047 dev_kfree_skb(skb);
3048 return;
3049 }
3050 if ((p = findie(skb->data, skb->len, IE_DISPLAY, 0)) != NULL)
3051 l3ni1_deliver_display(proc, pr, p); /* Display IE included */
3052 for (i = 0; i < DATASLLEN; i++)
3053 if ((mt == datastatelist[i].primitive) &&
3054 ((1 << proc->state) & datastatelist[i].state))
3055 break;
3056 if (i == DATASLLEN) {
3057 if (st->l3.debug & L3_DEB_STATE) {
3058 l3_debug(st, "ni1up%sstate %d mt %#x unhandled",
3059 (pr == (DL_DATA | INDICATION)) ? " " : "(broadcast) ",
3060 proc->state, mt);
3061 }
3062 if ((MT_RELEASE_COMPLETE != mt) && (MT_RELEASE != mt)) {
3063 proc->para.cause = 101;
3064 l3ni1_status_send(proc, pr, skb);
3065 }
3066 } else {
3067 if (st->l3.debug & L3_DEB_STATE) {
3068 l3_debug(st, "ni1up%sstate %d mt %x",
3069 (pr == (DL_DATA | INDICATION)) ? " " : "(broadcast) ",
3070 proc->state, mt);
3071 }
3072 datastatelist[i].rout(proc, pr, skb);
3073 }
3074 dev_kfree_skb(skb);
3075 return;
3076 }
3077
3078 static void
3079 ni1down(struct PStack *st, int pr, void *arg)
3080 {
3081 int i, cr;
3082 struct l3_process *proc;
3083 struct Channel *chan;
3084
3085 if ((DL_ESTABLISH | REQUEST) == pr) {
3086 l3_msg(st, pr, NULL);
3087 return;
3088 } else if (((CC_SETUP | REQUEST) == pr) || ((CC_RESUME | REQUEST) == pr)) {
3089 chan = arg;
3090 cr = newcallref();
3091 cr |= 0x80;
3092 if ((proc = ni1_new_l3_process(st, cr))) {
3093 proc->chan = chan;
3094 chan->proc = proc;
3095 memcpy(&proc->para.setup, &chan->setup, sizeof(setup_parm));
3096 proc->callref = cr;
3097 }
3098 } else {
3099 proc = arg;
3100 }
3101 if (!proc) {
3102 printk(KERN_ERR "HiSax ni1down without proc pr=%04x\n", pr);
3103 return;
3104 }
3105
3106 if ( pr == (CC_TNI1_IO | REQUEST)) {
3107 l3ni1_io_timer(proc); /* timer expires */
3108 return;
3109 }
3110
3111 for (i = 0; i < DOWNSLLEN; i++)
3112 if ((pr == downstatelist[i].primitive) &&
3113 ((1 << proc->state) & downstatelist[i].state))
3114 break;
3115 if (i == DOWNSLLEN) {
3116 if (st->l3.debug & L3_DEB_STATE) {
3117 l3_debug(st, "ni1down state %d prim %#x unhandled",
3118 proc->state, pr);
3119 }
3120 } else {
3121 if (st->l3.debug & L3_DEB_STATE) {
3122 l3_debug(st, "ni1down state %d prim %#x",
3123 proc->state, pr);
3124 }
3125 downstatelist[i].rout(proc, pr, arg);
3126 }
3127 }
3128
3129 static void
3130 ni1man(struct PStack *st, int pr, void *arg)
3131 {
3132 int i;
3133 struct l3_process *proc = arg;
3134
3135 if (!proc) {
3136 printk(KERN_ERR "HiSax ni1man without proc pr=%04x\n", pr);
3137 return;
3138 }
3139 for (i = 0; i < MANSLLEN; i++)
3140 if ((pr == manstatelist[i].primitive) &&
3141 ((1 << proc->state) & manstatelist[i].state))
3142 break;
3143 if (i == MANSLLEN) {
3144 if (st->l3.debug & L3_DEB_STATE) {
3145 l3_debug(st, "cr %d ni1man state %d prim %#x unhandled",
3146 proc->callref & 0x7f, proc->state, pr);
3147 }
3148 } else {
3149 if (st->l3.debug & L3_DEB_STATE) {
3150 l3_debug(st, "cr %d ni1man state %d prim %#x",
3151 proc->callref & 0x7f, proc->state, pr);
3152 }
3153 manstatelist[i].rout(proc, pr, arg);
3154 }
3155 }
3156
3157 void
3158 setstack_ni1(struct PStack *st)
3159 {
3160 char tmp[64];
3161 int i;
3162
3163 st->lli.l4l3 = ni1down;
3164 st->lli.l4l3_proto = l3ni1_cmd_global;
3165 st->l2.l2l3 = ni1up;
3166 st->l3.l3ml3 = ni1man;
3167 st->l3.N303 = 1;
3168 st->prot.ni1.last_invoke_id = 0;
3169 st->prot.ni1.invoke_used[0] = 1; /* Bit 0 must always be set to 1 */
3170 i = 1;
3171 while (i < 32)
3172 st->prot.ni1.invoke_used[i++] = 0;
3173
3174 if (!(st->l3.global = kmalloc(sizeof(struct l3_process), GFP_ATOMIC))) {
3175 printk(KERN_ERR "HiSax can't get memory for ni1 global CR\n");
3176 } else {
3177 st->l3.global->state = 0;
3178 st->l3.global->callref = 0;
3179 st->l3.global->next = NULL;
3180 st->l3.global->debug = L3_DEB_WARN;
3181 st->l3.global->st = st;
3182 st->l3.global->N303 = 1;
3183 st->l3.global->prot.ni1.invoke_id = 0;
3184
3185 L3InitTimer(st->l3.global, &st->l3.global->timer);
3186 }
3187 strcpy(tmp, ni1_revision);
3188 printk(KERN_INFO "HiSax: National ISDN-1 Rev. %s\n", HiSax_getrev(tmp));
3189 }
Nao low-level kernelspace/userspace library that runs on our robots, Nao-Team HTWK