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