?  search:
summary | log | graphiclog1 | graphiclog2 | commit | commitdiff | tree | refs | edit | fork
blame | history | raw | HEAD
drm/i915: refleak along pin() error path.
[linux-2.6/linux-2.6-openrd.git] / drivers / isdn / mISDN / layer2.c
blobd6e2863f224a4aa6c0f76adac0681bf173ec81f9
1 /*
2 *
3 * Author Karsten Keil <kkeil@novell.com>
4 *
5 * Copyright 2008 by Karsten Keil <kkeil@novell.com>
6 *
7 * This program is free software; you can redistribute it and/or modify
8 * it under the terms of the GNU General Public License version 2 as
9 * published by the Free Software Foundation.
10 *
11 * This program is distributed in the hope that it will be useful,
12 * but WITHOUT ANY WARRANTY; without even the implied warranty of
13 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
14 * GNU General Public License for more details.
15 *
16 */
17
18 #include <linux/mISDNif.h>
19 #include "core.h"
20 #include "fsm.h"
21 #include "layer2.h"
22
23 static u_int *debug;
24
25 static
26 struct Fsm l2fsm = {NULL, 0, 0, NULL, NULL};
27
28 static char *strL2State[] =
29 {
30 "ST_L2_1",
31 "ST_L2_2",
32 "ST_L2_3",
33 "ST_L2_4",
34 "ST_L2_5",
35 "ST_L2_6",
36 "ST_L2_7",
37 "ST_L2_8",
38 };
39
40 enum {
41 EV_L2_UI,
42 EV_L2_SABME,
43 EV_L2_DISC,
44 EV_L2_DM,
45 EV_L2_UA,
46 EV_L2_FRMR,
47 EV_L2_SUPER,
48 EV_L2_I,
49 EV_L2_DL_DATA,
50 EV_L2_ACK_PULL,
51 EV_L2_DL_UNITDATA,
52 EV_L2_DL_ESTABLISH_REQ,
53 EV_L2_DL_RELEASE_REQ,
54 EV_L2_MDL_ASSIGN,
55 EV_L2_MDL_REMOVE,
56 EV_L2_MDL_ERROR,
57 EV_L1_DEACTIVATE,
58 EV_L2_T200,
59 EV_L2_T203,
60 EV_L2_SET_OWN_BUSY,
61 EV_L2_CLEAR_OWN_BUSY,
62 EV_L2_FRAME_ERROR,
63 };
64
65 #define L2_EVENT_COUNT (EV_L2_FRAME_ERROR+1)
66
67 static char *strL2Event[] =
68 {
69 "EV_L2_UI",
70 "EV_L2_SABME",
71 "EV_L2_DISC",
72 "EV_L2_DM",
73 "EV_L2_UA",
74 "EV_L2_FRMR",
75 "EV_L2_SUPER",
76 "EV_L2_I",
77 "EV_L2_DL_DATA",
78 "EV_L2_ACK_PULL",
79 "EV_L2_DL_UNITDATA",
80 "EV_L2_DL_ESTABLISH_REQ",
81 "EV_L2_DL_RELEASE_REQ",
82 "EV_L2_MDL_ASSIGN",
83 "EV_L2_MDL_REMOVE",
84 "EV_L2_MDL_ERROR",
85 "EV_L1_DEACTIVATE",
86 "EV_L2_T200",
87 "EV_L2_T203",
88 "EV_L2_SET_OWN_BUSY",
89 "EV_L2_CLEAR_OWN_BUSY",
90 "EV_L2_FRAME_ERROR",
91 };
92
93 static void
94 l2m_debug(struct FsmInst *fi, char *fmt, ...)
95 {
96 struct layer2 *l2 = fi->userdata;
97 va_list va;
98
99 if (!(*debug & DEBUG_L2_FSM))
100 return;
101 va_start(va, fmt);
102 printk(KERN_DEBUG "l2 (tei %d): ", l2->tei);
103 vprintk(fmt, va);
104 printk("\n");
105 va_end(va);
106 }
107
108 inline u_int
109 l2headersize(struct layer2 *l2, int ui)
110 {
111 return ((test_bit(FLG_MOD128, &l2->flag) && (!ui)) ? 2 : 1) +
112 (test_bit(FLG_LAPD, &l2->flag) ? 2 : 1);
113 }
114
115 inline u_int
116 l2addrsize(struct layer2 *l2)
117 {
118 return test_bit(FLG_LAPD, &l2->flag) ? 2 : 1;
119 }
120
121 static u_int
122 l2_newid(struct layer2 *l2)
123 {
124 u_int id;
125
126 id = l2->next_id++;
127 if (id == 0x7fff)
128 l2->next_id = 1;
129 id <<= 16;
130 id |= l2->tei << 8;
131 id |= l2->sapi;
132 return id;
133 }
134
135 static void
136 l2up(struct layer2 *l2, u_int prim, struct sk_buff *skb)
137 {
138 int err;
139
140 if (!l2->up)
141 return;
142 mISDN_HEAD_PRIM(skb) = prim;
143 mISDN_HEAD_ID(skb) = (l2->ch.nr << 16) | l2->ch.addr;
144 err = l2->up->send(l2->up, skb);
145 if (err) {
146 printk(KERN_WARNING "%s: err=%d\n", __func__, err);
147 dev_kfree_skb(skb);
148 }
149 }
150
151 static void
152 l2up_create(struct layer2 *l2, u_int prim, int len, void *arg)
153 {
154 struct sk_buff *skb;
155 struct mISDNhead *hh;
156 int err;
157
158 if (!l2->up)
159 return;
160 skb = mI_alloc_skb(len, GFP_ATOMIC);
161 if (!skb)
162 return;
163 hh = mISDN_HEAD_P(skb);
164 hh->prim = prim;
165 hh->id = (l2->ch.nr << 16) | l2->ch.addr;
166 if (len)
167 memcpy(skb_put(skb, len), arg, len);
168 err = l2->up->send(l2->up, skb);
169 if (err) {
170 printk(KERN_WARNING "%s: err=%d\n", __func__, err);
171 dev_kfree_skb(skb);
172 }
173 }
174
175 static int
176 l2down_skb(struct layer2 *l2, struct sk_buff *skb) {
177 int ret;
178
179 ret = l2->ch.recv(l2->ch.peer, skb);
180 if (ret && (*debug & DEBUG_L2_RECV))
181 printk(KERN_DEBUG "l2down_skb: ret(%d)\n", ret);
182 return ret;
183 }
184
185 static int
186 l2down_raw(struct layer2 *l2, struct sk_buff *skb)
187 {
188 struct mISDNhead *hh = mISDN_HEAD_P(skb);
189
190 if (hh->prim == PH_DATA_REQ) {
191 if (test_and_set_bit(FLG_L1_NOTREADY, &l2->flag)) {
192 skb_queue_tail(&l2->down_queue, skb);
193 return 0;
194 }
195 l2->down_id = mISDN_HEAD_ID(skb);
196 }
197 return l2down_skb(l2, skb);
198 }
199
200 static int
201 l2down(struct layer2 *l2, u_int prim, u_int id, struct sk_buff *skb)
202 {
203 struct mISDNhead *hh = mISDN_HEAD_P(skb);
204
205 hh->prim = prim;
206 hh->id = id;
207 return l2down_raw(l2, skb);
208 }
209
210 static int
211 l2down_create(struct layer2 *l2, u_int prim, u_int id, int len, void *arg)
212 {
213 struct sk_buff *skb;
214 int err;
215 struct mISDNhead *hh;
216
217 skb = mI_alloc_skb(len, GFP_ATOMIC);
218 if (!skb)
219 return -ENOMEM;
220 hh = mISDN_HEAD_P(skb);
221 hh->prim = prim;
222 hh->id = id;
223 if (len)
224 memcpy(skb_put(skb, len), arg, len);
225 err = l2down_raw(l2, skb);
226 if (err)
227 dev_kfree_skb(skb);
228 return err;
229 }
230
231 static int
232 ph_data_confirm(struct layer2 *l2, struct mISDNhead *hh, struct sk_buff *skb) {
233 struct sk_buff *nskb = skb;
234 int ret = -EAGAIN;
235
236 if (test_bit(FLG_L1_NOTREADY, &l2->flag)) {
237 if (hh->id == l2->down_id) {
238 nskb = skb_dequeue(&l2->down_queue);
239 if (nskb) {
240 l2->down_id = mISDN_HEAD_ID(nskb);
241 if (l2down_skb(l2, nskb)) {
242 dev_kfree_skb(nskb);
243 l2->down_id = MISDN_ID_NONE;
244 }
245 } else
246 l2->down_id = MISDN_ID_NONE;
247 if (ret) {
248 dev_kfree_skb(skb);
249 ret = 0;
250 }
251 if (l2->down_id == MISDN_ID_NONE) {
252 test_and_clear_bit(FLG_L1_NOTREADY, &l2->flag);
253 mISDN_FsmEvent(&l2->l2m, EV_L2_ACK_PULL, NULL);
254 }
255 }
256 }
257 if (!test_and_set_bit(FLG_L1_NOTREADY, &l2->flag)) {
258 nskb = skb_dequeue(&l2->down_queue);
259 if (nskb) {
260 l2->down_id = mISDN_HEAD_ID(nskb);
261 if (l2down_skb(l2, nskb)) {
262 dev_kfree_skb(nskb);
263 l2->down_id = MISDN_ID_NONE;
264 test_and_clear_bit(FLG_L1_NOTREADY, &l2->flag);
265 }
266 } else
267 test_and_clear_bit(FLG_L1_NOTREADY, &l2->flag);
268 }
269 return ret;
270 }
271
272 static int
273 l2mgr(struct layer2 *l2, u_int prim, void *arg) {
274 long c = (long)arg;
275
276 printk(KERN_WARNING
277 "l2mgr: addr:%x prim %x %c\n", l2->id, prim, (char)c);
278 if (test_bit(FLG_LAPD, &l2->flag) &&
279 !test_bit(FLG_FIXED_TEI, &l2->flag)) {
280 switch (c) {
281 case 'C':
282 case 'D':
283 case 'G':
284 case 'H':
285 l2_tei(l2, prim, (u_long)arg);
286 break;
287 }
288 }
289 return 0;
290 }
291
292 static void
293 set_peer_busy(struct layer2 *l2) {
294 test_and_set_bit(FLG_PEER_BUSY, &l2->flag);
295 if (skb_queue_len(&l2->i_queue) || skb_queue_len(&l2->ui_queue))
296 test_and_set_bit(FLG_L2BLOCK, &l2->flag);
297 }
298
299 static void
300 clear_peer_busy(struct layer2 *l2) {
301 if (test_and_clear_bit(FLG_PEER_BUSY, &l2->flag))
302 test_and_clear_bit(FLG_L2BLOCK, &l2->flag);
303 }
304
305 static void
306 InitWin(struct layer2 *l2)
307 {
308 int i;
309
310 for (i = 0; i < MAX_WINDOW; i++)
311 l2->windowar[i] = NULL;
312 }
313
314 static int
315 freewin(struct layer2 *l2)
316 {
317 int i, cnt = 0;
318
319 for (i = 0; i < MAX_WINDOW; i++) {
320 if (l2->windowar[i]) {
321 cnt++;
322 dev_kfree_skb(l2->windowar[i]);
323 l2->windowar[i] = NULL;
324 }
325 }
326 return cnt;
327 }
328
329 static void
330 ReleaseWin(struct layer2 *l2)
331 {
332 int cnt = freewin(l2);
333
334 if (cnt)
335 printk(KERN_WARNING
336 "isdnl2 freed %d skbuffs in release\n", cnt);
337 }
338
339 inline unsigned int
340 cansend(struct layer2 *l2)
341 {
342 unsigned int p1;
343
344 if (test_bit(FLG_MOD128, &l2->flag))
345 p1 = (l2->vs - l2->va) % 128;
346 else
347 p1 = (l2->vs - l2->va) % 8;
348 return (p1 < l2->window) && !test_bit(FLG_PEER_BUSY, &l2->flag);
349 }
350
351 inline void
352 clear_exception(struct layer2 *l2)
353 {
354 test_and_clear_bit(FLG_ACK_PEND, &l2->flag);
355 test_and_clear_bit(FLG_REJEXC, &l2->flag);
356 test_and_clear_bit(FLG_OWN_BUSY, &l2->flag);
357 clear_peer_busy(l2);
358 }
359
360 static int
361 sethdraddr(struct layer2 *l2, u_char *header, int rsp)
362 {
363 u_char *ptr = header;
364 int crbit = rsp;
365
366 if (test_bit(FLG_LAPD, &l2->flag)) {
367 if (test_bit(FLG_LAPD_NET, &l2->flag))
368 crbit = !crbit;
369 *ptr++ = (l2->sapi << 2) | (crbit ? 2 : 0);
370 *ptr++ = (l2->tei << 1) | 1;
371 return 2;
372 } else {
373 if (test_bit(FLG_ORIG, &l2->flag))
374 crbit = !crbit;
375 if (crbit)
376 *ptr++ = l2->addr.B;
377 else
378 *ptr++ = l2->addr.A;
379 return 1;
380 }
381 }
382
383 static inline void
384 enqueue_super(struct layer2 *l2, struct sk_buff *skb)
385 {
386 if (l2down(l2, PH_DATA_REQ, l2_newid(l2), skb))
387 dev_kfree_skb(skb);
388 }
389
390 static inline void
391 enqueue_ui(struct layer2 *l2, struct sk_buff *skb)
392 {
393 if (l2->tm)
394 l2_tei(l2, MDL_STATUS_UI_IND, 0);
395 if (l2down(l2, PH_DATA_REQ, l2_newid(l2), skb))
396 dev_kfree_skb(skb);
397 }
398
399 inline int
400 IsUI(u_char *data)
401 {
402 return (data[0] & 0xef) == UI;
403 }
404
405 inline int
406 IsUA(u_char *data)
407 {
408 return (data[0] & 0xef) == UA;
409 }
410
411 inline int
412 IsDM(u_char *data)
413 {
414 return (data[0] & 0xef) == DM;
415 }
416
417 inline int
418 IsDISC(u_char *data)
419 {
420 return (data[0] & 0xef) == DISC;
421 }
422
423 inline int
424 IsRR(u_char *data, struct layer2 *l2)
425 {
426 if (test_bit(FLG_MOD128, &l2->flag))
427 return data[0] == RR;
428 else
429 return (data[0] & 0xf) == 1;
430 }
431
432 inline int
433 IsSFrame(u_char *data, struct layer2 *l2)
434 {
435 register u_char d = *data;
436
437 if (!test_bit(FLG_MOD128, &l2->flag))
438 d &= 0xf;
439 return ((d & 0xf3) == 1) && ((d & 0x0c) != 0x0c);
440 }
441
442 inline int
443 IsSABME(u_char *data, struct layer2 *l2)
444 {
445 u_char d = data[0] & ~0x10;
446
447 return test_bit(FLG_MOD128, &l2->flag) ? d == SABME : d == SABM;
448 }
449
450 inline int
451 IsREJ(u_char *data, struct layer2 *l2)
452 {
453 return test_bit(FLG_MOD128, &l2->flag) ?
454 data[0] == REJ : (data[0] & 0xf) == REJ;
455 }
456
457 inline int
458 IsFRMR(u_char *data)
459 {
460 return (data[0] & 0xef) == FRMR;
461 }
462
463 inline int
464 IsRNR(u_char *data, struct layer2 *l2)
465 {
466 return test_bit(FLG_MOD128, &l2->flag) ?
467 data[0] == RNR : (data[0] & 0xf) == RNR;
468 }
469
470 static int
471 iframe_error(struct layer2 *l2, struct sk_buff *skb)
472 {
473 u_int i;
474 int rsp = *skb->data & 0x2;
475
476 i = l2addrsize(l2) + (test_bit(FLG_MOD128, &l2->flag) ? 2 : 1);
477 if (test_bit(FLG_ORIG, &l2->flag))
478 rsp = !rsp;
479 if (rsp)
480 return 'L';
481 if (skb->len < i)
482 return 'N';
483 if ((skb->len - i) > l2->maxlen)
484 return 'O';
485 return 0;
486 }
487
488 static int
489 super_error(struct layer2 *l2, struct sk_buff *skb)
490 {
491 if (skb->len != l2addrsize(l2) +
492 (test_bit(FLG_MOD128, &l2->flag) ? 2 : 1))
493 return 'N';
494 return 0;
495 }
496
497 static int
498 unnum_error(struct layer2 *l2, struct sk_buff *skb, int wantrsp)
499 {
500 int rsp = (*skb->data & 0x2) >> 1;
501 if (test_bit(FLG_ORIG, &l2->flag))
502 rsp = !rsp;
503 if (rsp != wantrsp)
504 return 'L';
505 if (skb->len != l2addrsize(l2) + 1)
506 return 'N';
507 return 0;
508 }
509
510 static int
511 UI_error(struct layer2 *l2, struct sk_buff *skb)
512 {
513 int rsp = *skb->data & 0x2;
514 if (test_bit(FLG_ORIG, &l2->flag))
515 rsp = !rsp;
516 if (rsp)
517 return 'L';
518 if (skb->len > l2->maxlen + l2addrsize(l2) + 1)
519 return 'O';
520 return 0;
521 }
522
523 static int
524 FRMR_error(struct layer2 *l2, struct sk_buff *skb)
525 {
526 u_int headers = l2addrsize(l2) + 1;
527 u_char *datap = skb->data + headers;
528 int rsp = *skb->data & 0x2;
529
530 if (test_bit(FLG_ORIG, &l2->flag))
531 rsp = !rsp;
532 if (!rsp)
533 return 'L';
534 if (test_bit(FLG_MOD128, &l2->flag)) {
535 if (skb->len < headers + 5)
536 return 'N';
537 else if (*debug & DEBUG_L2)
538 l2m_debug(&l2->l2m,
539 "FRMR information %2x %2x %2x %2x %2x",
540 datap[0], datap[1], datap[2], datap[3], datap[4]);
541 } else {
542 if (skb->len < headers + 3)
543 return 'N';
544 else if (*debug & DEBUG_L2)
545 l2m_debug(&l2->l2m,
546 "FRMR information %2x %2x %2x",
547 datap[0], datap[1], datap[2]);
548 }
549 return 0;
550 }
551
552 static unsigned int
553 legalnr(struct layer2 *l2, unsigned int nr)
554 {
555 if (test_bit(FLG_MOD128, &l2->flag))
556 return ((nr - l2->va) % 128) <= ((l2->vs - l2->va) % 128);
557 else
558 return ((nr - l2->va) % 8) <= ((l2->vs - l2->va) % 8);
559 }
560
561 static void
562 setva(struct layer2 *l2, unsigned int nr)
563 {
564 struct sk_buff *skb;
565
566 while (l2->va != nr) {
567 l2->va++;
568 if (test_bit(FLG_MOD128, &l2->flag))
569 l2->va %= 128;
570 else
571 l2->va %= 8;
572 if (l2->windowar[l2->sow]) {
573 skb_trim(l2->windowar[l2->sow], 0);
574 skb_queue_tail(&l2->tmp_queue, l2->windowar[l2->sow]);
575 l2->windowar[l2->sow] = NULL;
576 }
577 l2->sow = (l2->sow + 1) % l2->window;
578 }
579 skb = skb_dequeue(&l2->tmp_queue);
580 while (skb) {
581 dev_kfree_skb(skb);
582 skb = skb_dequeue(&l2->tmp_queue);
583 }
584 }
585
586 static void
587 send_uframe(struct layer2 *l2, struct sk_buff *skb, u_char cmd, u_char cr)
588 {
589 u_char tmp[MAX_L2HEADER_LEN];
590 int i;
591
592 i = sethdraddr(l2, tmp, cr);
593 tmp[i++] = cmd;
594 if (skb)
595 skb_trim(skb, 0);
596 else {
597 skb = mI_alloc_skb(i, GFP_ATOMIC);
598 if (!skb) {
599 printk(KERN_WARNING "%s: can't alloc skbuff\n",
600 __func__);
601 return;
602 }
603 }
604 memcpy(skb_put(skb, i), tmp, i);
605 enqueue_super(l2, skb);
606 }
607
608
609 inline u_char
610 get_PollFlag(struct layer2 *l2, struct sk_buff *skb)
611 {
612 return skb->data[l2addrsize(l2)] & 0x10;
613 }
614
615 inline u_char
616 get_PollFlagFree(struct layer2 *l2, struct sk_buff *skb)
617 {
618 u_char PF;
619
620 PF = get_PollFlag(l2, skb);
621 dev_kfree_skb(skb);
622 return PF;
623 }
624
625 inline void
626 start_t200(struct layer2 *l2, int i)
627 {
628 mISDN_FsmAddTimer(&l2->t200, l2->T200, EV_L2_T200, NULL, i);
629 test_and_set_bit(FLG_T200_RUN, &l2->flag);
630 }
631
632 inline void
633 restart_t200(struct layer2 *l2, int i)
634 {
635 mISDN_FsmRestartTimer(&l2->t200, l2->T200, EV_L2_T200, NULL, i);
636 test_and_set_bit(FLG_T200_RUN, &l2->flag);
637 }
638
639 inline void
640 stop_t200(struct layer2 *l2, int i)
641 {
642 if (test_and_clear_bit(FLG_T200_RUN, &l2->flag))
643 mISDN_FsmDelTimer(&l2->t200, i);
644 }
645
646 inline void
647 st5_dl_release_l2l3(struct layer2 *l2)
648 {
649 int pr;
650
651 if (test_and_clear_bit(FLG_PEND_REL, &l2->flag))
652 pr = DL_RELEASE_CNF;
653 else
654 pr = DL_RELEASE_IND;
655 l2up_create(l2, pr, 0, NULL);
656 }
657
658 inline void
659 lapb_dl_release_l2l3(struct layer2 *l2, int f)
660 {
661 if (test_bit(FLG_LAPB, &l2->flag))
662 l2down_create(l2, PH_DEACTIVATE_REQ, l2_newid(l2), 0, NULL);
663 l2up_create(l2, f, 0, NULL);
664 }
665
666 static void
667 establishlink(struct FsmInst *fi)
668 {
669 struct layer2 *l2 = fi->userdata;
670 u_char cmd;
671
672 clear_exception(l2);
673 l2->rc = 0;
674 cmd = (test_bit(FLG_MOD128, &l2->flag) ? SABME : SABM) | 0x10;
675 send_uframe(l2, NULL, cmd, CMD);
676 mISDN_FsmDelTimer(&l2->t203, 1);
677 restart_t200(l2, 1);
678 test_and_clear_bit(FLG_PEND_REL, &l2->flag);
679 freewin(l2);
680 mISDN_FsmChangeState(fi, ST_L2_5);
681 }
682
683 static void
684 l2_mdl_error_ua(struct FsmInst *fi, int event, void *arg)
685 {
686 struct sk_buff *skb = arg;
687 struct layer2 *l2 = fi->userdata;
688
689 if (get_PollFlagFree(l2, skb))
690 l2mgr(l2, MDL_ERROR_IND, (void *) 'C');
691 else
692 l2mgr(l2, MDL_ERROR_IND, (void *) 'D');
693
694 }
695
696 static void
697 l2_mdl_error_dm(struct FsmInst *fi, int event, void *arg)
698 {
699 struct sk_buff *skb = arg;
700 struct layer2 *l2 = fi->userdata;
701
702 if (get_PollFlagFree(l2, skb))
703 l2mgr(l2, MDL_ERROR_IND, (void *) 'B');
704 else {
705 l2mgr(l2, MDL_ERROR_IND, (void *) 'E');
706 establishlink(fi);
707 test_and_clear_bit(FLG_L3_INIT, &l2->flag);
708 }
709 }
710
711 static void
712 l2_st8_mdl_error_dm(struct FsmInst *fi, int event, void *arg)
713 {
714 struct sk_buff *skb = arg;
715 struct layer2 *l2 = fi->userdata;
716
717 if (get_PollFlagFree(l2, skb))
718 l2mgr(l2, MDL_ERROR_IND, (void *) 'B');
719 else
720 l2mgr(l2, MDL_ERROR_IND, (void *) 'E');
721 establishlink(fi);
722 test_and_clear_bit(FLG_L3_INIT, &l2->flag);
723 }
724
725 static void
726 l2_go_st3(struct FsmInst *fi, int event, void *arg)
727 {
728 dev_kfree_skb((struct sk_buff *)arg);
729 mISDN_FsmChangeState(fi, ST_L2_3);
730 }
731
732 static void
733 l2_mdl_assign(struct FsmInst *fi, int event, void *arg)
734 {
735 struct layer2 *l2 = fi->userdata;
736
737 mISDN_FsmChangeState(fi, ST_L2_3);
738 dev_kfree_skb((struct sk_buff *)arg);
739 l2_tei(l2, MDL_ASSIGN_IND, 0);
740 }
741
742 static void
743 l2_queue_ui_assign(struct FsmInst *fi, int event, void *arg)
744 {
745 struct layer2 *l2 = fi->userdata;
746 struct sk_buff *skb = arg;
747
748 skb_queue_tail(&l2->ui_queue, skb);
749 mISDN_FsmChangeState(fi, ST_L2_2);
750 l2_tei(l2, MDL_ASSIGN_IND, 0);
751 }
752
753 static void
754 l2_queue_ui(struct FsmInst *fi, int event, void *arg)
755 {
756 struct layer2 *l2 = fi->userdata;
757 struct sk_buff *skb = arg;
758
759 skb_queue_tail(&l2->ui_queue, skb);
760 }
761
762 static void
763 tx_ui(struct layer2 *l2)
764 {
765 struct sk_buff *skb;
766 u_char header[MAX_L2HEADER_LEN];
767 int i;
768
769 i = sethdraddr(l2, header, CMD);
770 if (test_bit(FLG_LAPD_NET, &l2->flag))
771 header[1] = 0xff; /* tei 127 */
772 header[i++] = UI;
773 while ((skb = skb_dequeue(&l2->ui_queue))) {
774 memcpy(skb_push(skb, i), header, i);
775 enqueue_ui(l2, skb);
776 }
777 }
778
779 static void
780 l2_send_ui(struct FsmInst *fi, int event, void *arg)
781 {
782 struct layer2 *l2 = fi->userdata;
783 struct sk_buff *skb = arg;
784
785 skb_queue_tail(&l2->ui_queue, skb);
786 tx_ui(l2);
787 }
788
789 static void
790 l2_got_ui(struct FsmInst *fi, int event, void *arg)
791 {
792 struct layer2 *l2 = fi->userdata;
793 struct sk_buff *skb = arg;
794
795 skb_pull(skb, l2headersize(l2, 1));
796 /*
797 * in states 1-3 for broadcast
798 */
799
800 if (l2->tm)
801 l2_tei(l2, MDL_STATUS_UI_IND, 0);
802 l2up(l2, DL_UNITDATA_IND, skb);
803 }
804
805 static void
806 l2_establish(struct FsmInst *fi, int event, void *arg)
807 {
808 struct sk_buff *skb = arg;
809 struct layer2 *l2 = fi->userdata;
810
811 establishlink(fi);
812 test_and_set_bit(FLG_L3_INIT, &l2->flag);
813 dev_kfree_skb(skb);
814 }
815
816 static void
817 l2_discard_i_setl3(struct FsmInst *fi, int event, void *arg)
818 {
819 struct sk_buff *skb = arg;
820 struct layer2 *l2 = fi->userdata;
821
822 skb_queue_purge(&l2->i_queue);
823 test_and_set_bit(FLG_L3_INIT, &l2->flag);
824 test_and_clear_bit(FLG_PEND_REL, &l2->flag);
825 dev_kfree_skb(skb);
826 }
827
828 static void
829 l2_l3_reestablish(struct FsmInst *fi, int event, void *arg)
830 {
831 struct sk_buff *skb = arg;
832 struct layer2 *l2 = fi->userdata;
833
834 skb_queue_purge(&l2->i_queue);
835 establishlink(fi);
836 test_and_set_bit(FLG_L3_INIT, &l2->flag);
837 dev_kfree_skb(skb);
838 }
839
840 static void
841 l2_release(struct FsmInst *fi, int event, void *arg)
842 {
843 struct layer2 *l2 = fi->userdata;
844 struct sk_buff *skb = arg;
845
846 skb_trim(skb, 0);
847 l2up(l2, DL_RELEASE_CNF, skb);
848 }
849
850 static void
851 l2_pend_rel(struct FsmInst *fi, int event, void *arg)
852 {
853 struct sk_buff *skb = arg;
854 struct layer2 *l2 = fi->userdata;
855
856 test_and_set_bit(FLG_PEND_REL, &l2->flag);
857 dev_kfree_skb(skb);
858 }
859
860 static void
861 l2_disconnect(struct FsmInst *fi, int event, void *arg)
862 {
863 struct layer2 *l2 = fi->userdata;
864 struct sk_buff *skb = arg;
865
866 skb_queue_purge(&l2->i_queue);
867 freewin(l2);
868 mISDN_FsmChangeState(fi, ST_L2_6);
869 l2->rc = 0;
870 send_uframe(l2, NULL, DISC | 0x10, CMD);
871 mISDN_FsmDelTimer(&l2->t203, 1);
872 restart_t200(l2, 2);
873 if (skb)
874 dev_kfree_skb(skb);
875 }
876
877 static void
878 l2_start_multi(struct FsmInst *fi, int event, void *arg)
879 {
880 struct layer2 *l2 = fi->userdata;
881 struct sk_buff *skb = arg;
882
883 l2->vs = 0;
884 l2->va = 0;
885 l2->vr = 0;
886 l2->sow = 0;
887 clear_exception(l2);
888 send_uframe(l2, NULL, UA | get_PollFlag(l2, skb), RSP);
889 mISDN_FsmChangeState(fi, ST_L2_7);
890 mISDN_FsmAddTimer(&l2->t203, l2->T203, EV_L2_T203, NULL, 3);
891 skb_trim(skb, 0);
892 l2up(l2, DL_ESTABLISH_IND, skb);
893 if (l2->tm)
894 l2_tei(l2, MDL_STATUS_UP_IND, 0);
895 }
896
897 static void
898 l2_send_UA(struct FsmInst *fi, int event, void *arg)
899 {
900 struct layer2 *l2 = fi->userdata;
901 struct sk_buff *skb = arg;
902
903 send_uframe(l2, skb, UA | get_PollFlag(l2, skb), RSP);
904 }
905
906 static void
907 l2_send_DM(struct FsmInst *fi, int event, void *arg)
908 {
909 struct layer2 *l2 = fi->userdata;
910 struct sk_buff *skb = arg;
911
912 send_uframe(l2, skb, DM | get_PollFlag(l2, skb), RSP);
913 }
914
915 static void
916 l2_restart_multi(struct FsmInst *fi, int event, void *arg)
917 {
918 struct layer2 *l2 = fi->userdata;
919 struct sk_buff *skb = arg;
920 int est = 0;
921
922 send_uframe(l2, skb, UA | get_PollFlag(l2, skb), RSP);
923
924 l2mgr(l2, MDL_ERROR_IND, (void *) 'F');
925
926 if (l2->vs != l2->va) {
927 skb_queue_purge(&l2->i_queue);
928 est = 1;
929 }
930
931 clear_exception(l2);
932 l2->vs = 0;
933 l2->va = 0;
934 l2->vr = 0;
935 l2->sow = 0;
936 mISDN_FsmChangeState(fi, ST_L2_7);
937 stop_t200(l2, 3);
938 mISDN_FsmRestartTimer(&l2->t203, l2->T203, EV_L2_T203, NULL, 3);
939
940 if (est)
941 l2up_create(l2, DL_ESTABLISH_IND, 0, NULL);
942 /* mISDN_queue_data(&l2->inst, l2->inst.id | MSG_BROADCAST,
943 * MGR_SHORTSTATUS | INDICATION, SSTATUS_L2_ESTABLISHED,
944 * 0, NULL, 0);
945 */
946 if (skb_queue_len(&l2->i_queue) && cansend(l2))
947 mISDN_FsmEvent(fi, EV_L2_ACK_PULL, NULL);
948 }
949
950 static void
951 l2_stop_multi(struct FsmInst *fi, int event, void *arg)
952 {
953 struct layer2 *l2 = fi->userdata;
954 struct sk_buff *skb = arg;
955
956 mISDN_FsmChangeState(fi, ST_L2_4);
957 mISDN_FsmDelTimer(&l2->t203, 3);
958 stop_t200(l2, 4);
959
960 send_uframe(l2, skb, UA | get_PollFlag(l2, skb), RSP);
961 skb_queue_purge(&l2->i_queue);
962 freewin(l2);
963 lapb_dl_release_l2l3(l2, DL_RELEASE_IND);
964 if (l2->tm)
965 l2_tei(l2, MDL_STATUS_DOWN_IND, 0);
966 }
967
968 static void
969 l2_connected(struct FsmInst *fi, int event, void *arg)
970 {
971 struct layer2 *l2 = fi->userdata;
972 struct sk_buff *skb = arg;
973 int pr = -1;
974
975 if (!get_PollFlag(l2, skb)) {
976 l2_mdl_error_ua(fi, event, arg);
977 return;
978 }
979 dev_kfree_skb(skb);
980 if (test_and_clear_bit(FLG_PEND_REL, &l2->flag))
981 l2_disconnect(fi, event, NULL);
982 if (test_and_clear_bit(FLG_L3_INIT, &l2->flag)) {
983 pr = DL_ESTABLISH_CNF;
984 } else if (l2->vs != l2->va) {
985 skb_queue_purge(&l2->i_queue);
986 pr = DL_ESTABLISH_IND;
987 }
988 stop_t200(l2, 5);
989 l2->vr = 0;
990 l2->vs = 0;
991 l2->va = 0;
992 l2->sow = 0;
993 mISDN_FsmChangeState(fi, ST_L2_7);
994 mISDN_FsmAddTimer(&l2->t203, l2->T203, EV_L2_T203, NULL, 4);
995 if (pr != -1)
996 l2up_create(l2, pr, 0, NULL);
997
998 if (skb_queue_len(&l2->i_queue) && cansend(l2))
999 mISDN_FsmEvent(fi, EV_L2_ACK_PULL, NULL);
1000
1001 if (l2->tm)
1002 l2_tei(l2, MDL_STATUS_UP_IND, 0);
1003 }
1004
1005 static void
1006 l2_released(struct FsmInst *fi, int event, void *arg)
1007 {
1008 struct layer2 *l2 = fi->userdata;
1009 struct sk_buff *skb = arg;
1010
1011 if (!get_PollFlag(l2, skb)) {
1012 l2_mdl_error_ua(fi, event, arg);
1013 return;
1014 }
1015 dev_kfree_skb(skb);
1016 stop_t200(l2, 6);
1017 lapb_dl_release_l2l3(l2, DL_RELEASE_CNF);
1018 mISDN_FsmChangeState(fi, ST_L2_4);
1019 if (l2->tm)
1020 l2_tei(l2, MDL_STATUS_DOWN_IND, 0);
1021 }
1022
1023 static void
1024 l2_reestablish(struct FsmInst *fi, int event, void *arg)
1025 {
1026 struct layer2 *l2 = fi->userdata;
1027 struct sk_buff *skb = arg;
1028
1029 if (!get_PollFlagFree(l2, skb)) {
1030 establishlink(fi);
1031 test_and_set_bit(FLG_L3_INIT, &l2->flag);
1032 }
1033 }
1034
1035 static void
1036 l2_st5_dm_release(struct FsmInst *fi, int event, void *arg)
1037 {
1038 struct layer2 *l2 = fi->userdata;
1039 struct sk_buff *skb = arg;
1040
1041 if (get_PollFlagFree(l2, skb)) {
1042 stop_t200(l2, 7);
1043 if (!test_bit(FLG_L3_INIT, &l2->flag))
1044 skb_queue_purge(&l2->i_queue);
1045 if (test_bit(FLG_LAPB, &l2->flag))
1046 l2down_create(l2, PH_DEACTIVATE_REQ,
1047 l2_newid(l2), 0, NULL);
1048 st5_dl_release_l2l3(l2);
1049 mISDN_FsmChangeState(fi, ST_L2_4);
1050 if (l2->tm)
1051 l2_tei(l2, MDL_STATUS_DOWN_IND, 0);
1052 }
1053 }
1054
1055 static void
1056 l2_st6_dm_release(struct FsmInst *fi, int event, void *arg)
1057 {
1058 struct layer2 *l2 = fi->userdata;
1059 struct sk_buff *skb = arg;
1060
1061 if (get_PollFlagFree(l2, skb)) {
1062 stop_t200(l2, 8);
1063 lapb_dl_release_l2l3(l2, DL_RELEASE_CNF);
1064 mISDN_FsmChangeState(fi, ST_L2_4);
1065 if (l2->tm)
1066 l2_tei(l2, MDL_STATUS_DOWN_IND, 0);
1067 }
1068 }
1069
1070 static void
1071 enquiry_cr(struct layer2 *l2, u_char typ, u_char cr, u_char pf)
1072 {
1073 struct sk_buff *skb;
1074 u_char tmp[MAX_L2HEADER_LEN];
1075 int i;
1076
1077 i = sethdraddr(l2, tmp, cr);
1078 if (test_bit(FLG_MOD128, &l2->flag)) {
1079 tmp[i++] = typ;
1080 tmp[i++] = (l2->vr << 1) | (pf ? 1 : 0);
1081 } else
1082 tmp[i++] = (l2->vr << 5) | typ | (pf ? 0x10 : 0);
1083 skb = mI_alloc_skb(i, GFP_ATOMIC);
1084 if (!skb) {
1085 printk(KERN_WARNING
1086 "isdnl2 can't alloc sbbuff for enquiry_cr\n");
1087 return;
1088 }
1089 memcpy(skb_put(skb, i), tmp, i);
1090 enqueue_super(l2, skb);
1091 }
1092
1093 inline void
1094 enquiry_response(struct layer2 *l2)
1095 {
1096 if (test_bit(FLG_OWN_BUSY, &l2->flag))
1097 enquiry_cr(l2, RNR, RSP, 1);
1098 else
1099 enquiry_cr(l2, RR, RSP, 1);
1100 test_and_clear_bit(FLG_ACK_PEND, &l2->flag);
1101 }
1102
1103 inline void
1104 transmit_enquiry(struct layer2 *l2)
1105 {
1106 if (test_bit(FLG_OWN_BUSY, &l2->flag))
1107 enquiry_cr(l2, RNR, CMD, 1);
1108 else
1109 enquiry_cr(l2, RR, CMD, 1);
1110 test_and_clear_bit(FLG_ACK_PEND, &l2->flag);
1111 start_t200(l2, 9);
1112 }
1113
1114
1115 static void
1116 nrerrorrecovery(struct FsmInst *fi)
1117 {
1118 struct layer2 *l2 = fi->userdata;
1119
1120 l2mgr(l2, MDL_ERROR_IND, (void *) 'J');
1121 establishlink(fi);
1122 test_and_clear_bit(FLG_L3_INIT, &l2->flag);
1123 }
1124
1125 static void
1126 invoke_retransmission(struct layer2 *l2, unsigned int nr)
1127 {
1128 u_int p1;
1129
1130 if (l2->vs != nr) {
1131 while (l2->vs != nr) {
1132 (l2->vs)--;
1133 if (test_bit(FLG_MOD128, &l2->flag)) {
1134 l2->vs %= 128;
1135 p1 = (l2->vs - l2->va) % 128;
1136 } else {
1137 l2->vs %= 8;
1138 p1 = (l2->vs - l2->va) % 8;
1139 }
1140 p1 = (p1 + l2->sow) % l2->window;
1141 if (l2->windowar[p1])
1142 skb_queue_head(&l2->i_queue, l2->windowar[p1]);
1143 else
1144 printk(KERN_WARNING
1145 "%s: windowar[%d] is NULL\n",
1146 __func__, p1);
1147 l2->windowar[p1] = NULL;
1148 }
1149 mISDN_FsmEvent(&l2->l2m, EV_L2_ACK_PULL, NULL);
1150 }
1151 }
1152
1153 static void
1154 l2_st7_got_super(struct FsmInst *fi, int event, void *arg)
1155 {
1156 struct layer2 *l2 = fi->userdata;
1157 struct sk_buff *skb = arg;
1158 int PollFlag, rsp, typ = RR;
1159 unsigned int nr;
1160
1161 rsp = *skb->data & 0x2;
1162 if (test_bit(FLG_ORIG, &l2->flag))
1163 rsp = !rsp;
1164
1165 skb_pull(skb, l2addrsize(l2));
1166 if (IsRNR(skb->data, l2)) {
1167 set_peer_busy(l2);
1168 typ = RNR;
1169 } else
1170 clear_peer_busy(l2);
1171 if (IsREJ(skb->data, l2))
1172 typ = REJ;
1173
1174 if (test_bit(FLG_MOD128, &l2->flag)) {
1175 PollFlag = (skb->data[1] & 0x1) == 0x1;
1176 nr = skb->data[1] >> 1;
1177 } else {
1178 PollFlag = (skb->data[0] & 0x10);
1179 nr = (skb->data[0] >> 5) & 0x7;
1180 }
1181 dev_kfree_skb(skb);
1182
1183 if (PollFlag) {
1184 if (rsp)
1185 l2mgr(l2, MDL_ERROR_IND, (void *) 'A');
1186 else
1187 enquiry_response(l2);
1188 }
1189 if (legalnr(l2, nr)) {
1190 if (typ == REJ) {
1191 setva(l2, nr);
1192 invoke_retransmission(l2, nr);
1193 stop_t200(l2, 10);
1194 if (mISDN_FsmAddTimer(&l2->t203, l2->T203,
1195 EV_L2_T203, NULL, 6))
1196 l2m_debug(&l2->l2m, "Restart T203 ST7 REJ");
1197 } else if ((nr == l2->vs) && (typ == RR)) {
1198 setva(l2, nr);
1199 stop_t200(l2, 11);
1200 mISDN_FsmRestartTimer(&l2->t203, l2->T203,
1201 EV_L2_T203, NULL, 7);
1202 } else if ((l2->va != nr) || (typ == RNR)) {
1203 setva(l2, nr);
1204 if (typ != RR)
1205 mISDN_FsmDelTimer(&l2->t203, 9);
1206 restart_t200(l2, 12);
1207 }
1208 if (skb_queue_len(&l2->i_queue) && (typ == RR))
1209 mISDN_FsmEvent(fi, EV_L2_ACK_PULL, NULL);
1210 } else
1211 nrerrorrecovery(fi);
1212 }
1213
1214 static void
1215 l2_feed_i_if_reest(struct FsmInst *fi, int event, void *arg)
1216 {
1217 struct layer2 *l2 = fi->userdata;
1218 struct sk_buff *skb = arg;
1219
1220 if (!test_bit(FLG_L3_INIT, &l2->flag))
1221 skb_queue_tail(&l2->i_queue, skb);
1222 else
1223 dev_kfree_skb(skb);
1224 }
1225
1226 static void
1227 l2_feed_i_pull(struct FsmInst *fi, int event, void *arg)
1228 {
1229 struct layer2 *l2 = fi->userdata;
1230 struct sk_buff *skb = arg;
1231
1232 skb_queue_tail(&l2->i_queue, skb);
1233 mISDN_FsmEvent(fi, EV_L2_ACK_PULL, NULL);
1234 }
1235
1236 static void
1237 l2_feed_iqueue(struct FsmInst *fi, int event, void *arg)
1238 {
1239 struct layer2 *l2 = fi->userdata;
1240 struct sk_buff *skb = arg;
1241
1242 skb_queue_tail(&l2->i_queue, skb);
1243 }
1244
1245 static void
1246 l2_got_iframe(struct FsmInst *fi, int event, void *arg)
1247 {
1248 struct layer2 *l2 = fi->userdata;
1249 struct sk_buff *skb = arg;
1250 int PollFlag, i;
1251 u_int ns, nr;
1252
1253 i = l2addrsize(l2);
1254 if (test_bit(FLG_MOD128, &l2->flag)) {
1255 PollFlag = ((skb->data[i + 1] & 0x1) == 0x1);
1256 ns = skb->data[i] >> 1;
1257 nr = (skb->data[i + 1] >> 1) & 0x7f;
1258 } else {
1259 PollFlag = (skb->data[i] & 0x10);
1260 ns = (skb->data[i] >> 1) & 0x7;
1261 nr = (skb->data[i] >> 5) & 0x7;
1262 }
1263 if (test_bit(FLG_OWN_BUSY, &l2->flag)) {
1264 dev_kfree_skb(skb);
1265 if (PollFlag)
1266 enquiry_response(l2);
1267 } else {
1268 if (l2->vr == ns) {
1269 l2->vr++;
1270 if (test_bit(FLG_MOD128, &l2->flag))
1271 l2->vr %= 128;
1272 else
1273 l2->vr %= 8;
1274 test_and_clear_bit(FLG_REJEXC, &l2->flag);
1275 if (PollFlag)
1276 enquiry_response(l2);
1277 else
1278 test_and_set_bit(FLG_ACK_PEND, &l2->flag);
1279 skb_pull(skb, l2headersize(l2, 0));
1280 l2up(l2, DL_DATA_IND, skb);
1281 } else {
1282 /* n(s)!=v(r) */
1283 dev_kfree_skb(skb);
1284 if (test_and_set_bit(FLG_REJEXC, &l2->flag)) {
1285 if (PollFlag)
1286 enquiry_response(l2);
1287 } else {
1288 enquiry_cr(l2, REJ, RSP, PollFlag);
1289 test_and_clear_bit(FLG_ACK_PEND, &l2->flag);
1290 }
1291 }
1292 }
1293 if (legalnr(l2, nr)) {
1294 if (!test_bit(FLG_PEER_BUSY, &l2->flag) &&
1295 (fi->state == ST_L2_7)) {
1296 if (nr == l2->vs) {
1297 stop_t200(l2, 13);
1298 mISDN_FsmRestartTimer(&l2->t203, l2->T203,
1299 EV_L2_T203, NULL, 7);
1300 } else if (nr != l2->va)
1301 restart_t200(l2, 14);
1302 }
1303 setva(l2, nr);
1304 } else {
1305 nrerrorrecovery(fi);
1306 return;
1307 }
1308 if (skb_queue_len(&l2->i_queue) && (fi->state == ST_L2_7))
1309 mISDN_FsmEvent(fi, EV_L2_ACK_PULL, NULL);
1310 if (test_and_clear_bit(FLG_ACK_PEND, &l2->flag))
1311 enquiry_cr(l2, RR, RSP, 0);
1312 }
1313
1314 static void
1315 l2_got_tei(struct FsmInst *fi, int event, void *arg)
1316 {
1317 struct layer2 *l2 = fi->userdata;
1318 u_int info;
1319
1320 l2->tei = (signed char)(long)arg;
1321 set_channel_address(&l2->ch, l2->sapi, l2->tei);
1322 info = DL_INFO_L2_CONNECT;
1323 l2up_create(l2, DL_INFORMATION_IND, sizeof(info), &info);
1324 if (fi->state == ST_L2_3) {
1325 establishlink(fi);
1326 test_and_set_bit(FLG_L3_INIT, &l2->flag);
1327 } else
1328 mISDN_FsmChangeState(fi, ST_L2_4);
1329 if (skb_queue_len(&l2->ui_queue))
1330 tx_ui(l2);
1331 }
1332
1333 static void
1334 l2_st5_tout_200(struct FsmInst *fi, int event, void *arg)
1335 {
1336 struct layer2 *l2 = fi->userdata;
1337
1338 if (test_bit(FLG_LAPD, &l2->flag) &&
1339 test_bit(FLG_DCHAN_BUSY, &l2->flag)) {
1340 mISDN_FsmAddTimer(&l2->t200, l2->T200, EV_L2_T200, NULL, 9);
1341 } else if (l2->rc == l2->N200) {
1342 mISDN_FsmChangeState(fi, ST_L2_4);
1343 test_and_clear_bit(FLG_T200_RUN, &l2->flag);
1344 skb_queue_purge(&l2->i_queue);
1345 l2mgr(l2, MDL_ERROR_IND, (void *) 'G');
1346 if (test_bit(FLG_LAPB, &l2->flag))
1347 l2down_create(l2, PH_DEACTIVATE_REQ,
1348 l2_newid(l2), 0, NULL);
1349 st5_dl_release_l2l3(l2);
1350 if (l2->tm)
1351 l2_tei(l2, MDL_STATUS_DOWN_IND, 0);
1352 } else {
1353 l2->rc++;
1354 mISDN_FsmAddTimer(&l2->t200, l2->T200, EV_L2_T200, NULL, 9);
1355 send_uframe(l2, NULL, (test_bit(FLG_MOD128, &l2->flag) ?
1356 SABME : SABM) | 0x10, CMD);
1357 }
1358 }
1359
1360 static void
1361 l2_st6_tout_200(struct FsmInst *fi, int event, void *arg)
1362 {
1363 struct layer2 *l2 = fi->userdata;
1364
1365 if (test_bit(FLG_LAPD, &l2->flag) &&
1366 test_bit(FLG_DCHAN_BUSY, &l2->flag)) {
1367 mISDN_FsmAddTimer(&l2->t200, l2->T200, EV_L2_T200, NULL, 9);
1368 } else if (l2->rc == l2->N200) {
1369 mISDN_FsmChangeState(fi, ST_L2_4);
1370 test_and_clear_bit(FLG_T200_RUN, &l2->flag);
1371 l2mgr(l2, MDL_ERROR_IND, (void *) 'H');
1372 lapb_dl_release_l2l3(l2, DL_RELEASE_CNF);
1373 if (l2->tm)
1374 l2_tei(l2, MDL_STATUS_DOWN_IND, 0);
1375 } else {
1376 l2->rc++;
1377 mISDN_FsmAddTimer(&l2->t200, l2->T200, EV_L2_T200,
1378 NULL, 9);
1379 send_uframe(l2, NULL, DISC | 0x10, CMD);
1380 }
1381 }
1382
1383 static void
1384 l2_st7_tout_200(struct FsmInst *fi, int event, void *arg)
1385 {
1386 struct layer2 *l2 = fi->userdata;
1387
1388 if (test_bit(FLG_LAPD, &l2->flag) &&
1389 test_bit(FLG_DCHAN_BUSY, &l2->flag)) {
1390 mISDN_FsmAddTimer(&l2->t200, l2->T200, EV_L2_T200, NULL, 9);
1391 return;
1392 }
1393 test_and_clear_bit(FLG_T200_RUN, &l2->flag);
1394 l2->rc = 0;
1395 mISDN_FsmChangeState(fi, ST_L2_8);
1396 transmit_enquiry(l2);
1397 l2->rc++;
1398 }
1399
1400 static void
1401 l2_st8_tout_200(struct FsmInst *fi, int event, void *arg)
1402 {
1403 struct layer2 *l2 = fi->userdata;
1404
1405 if (test_bit(FLG_LAPD, &l2->flag) &&
1406 test_bit(FLG_DCHAN_BUSY, &l2->flag)) {
1407 mISDN_FsmAddTimer(&l2->t200, l2->T200, EV_L2_T200, NULL, 9);
1408 return;
1409 }
1410 test_and_clear_bit(FLG_T200_RUN, &l2->flag);
1411 if (l2->rc == l2->N200) {
1412 l2mgr(l2, MDL_ERROR_IND, (void *) 'I');
1413 establishlink(fi);
1414 test_and_clear_bit(FLG_L3_INIT, &l2->flag);
1415 } else {
1416 transmit_enquiry(l2);
1417 l2->rc++;
1418 }
1419 }
1420
1421 static void
1422 l2_st7_tout_203(struct FsmInst *fi, int event, void *arg)
1423 {
1424 struct layer2 *l2 = fi->userdata;
1425
1426 if (test_bit(FLG_LAPD, &l2->flag) &&
1427 test_bit(FLG_DCHAN_BUSY, &l2->flag)) {
1428 mISDN_FsmAddTimer(&l2->t203, l2->T203, EV_L2_T203, NULL, 9);
1429 return;
1430 }
1431 mISDN_FsmChangeState(fi, ST_L2_8);
1432 transmit_enquiry(l2);
1433 l2->rc = 0;
1434 }
1435
1436 static void
1437 l2_pull_iqueue(struct FsmInst *fi, int event, void *arg)
1438 {
1439 struct layer2 *l2 = fi->userdata;
1440 struct sk_buff *skb, *nskb, *oskb;
1441 u_char header[MAX_L2HEADER_LEN];
1442 u_int i, p1;
1443
1444 if (!cansend(l2))
1445 return;
1446
1447 skb = skb_dequeue(&l2->i_queue);
1448 if (!skb)
1449 return;
1450
1451 if (test_bit(FLG_MOD128, &l2->flag))
1452 p1 = (l2->vs - l2->va) % 128;
1453 else
1454 p1 = (l2->vs - l2->va) % 8;
1455 p1 = (p1 + l2->sow) % l2->window;
1456 if (l2->windowar[p1]) {
1457 printk(KERN_WARNING "isdnl2 try overwrite ack queue entry %d\n",
1458 p1);
1459 dev_kfree_skb(l2->windowar[p1]);
1460 }
1461 l2->windowar[p1] = skb;
1462 i = sethdraddr(l2, header, CMD);
1463 if (test_bit(FLG_MOD128, &l2->flag)) {
1464 header[i++] = l2->vs << 1;
1465 header[i++] = l2->vr << 1;
1466 l2->vs = (l2->vs + 1) % 128;
1467 } else {
1468 header[i++] = (l2->vr << 5) | (l2->vs << 1);
1469 l2->vs = (l2->vs + 1) % 8;
1470 }
1471
1472 nskb = skb_clone(skb, GFP_ATOMIC);
1473 p1 = skb_headroom(nskb);
1474 if (p1 >= i)
1475 memcpy(skb_push(nskb, i), header, i);
1476 else {
1477 printk(KERN_WARNING
1478 "isdnl2 pull_iqueue skb header(%d/%d) too short\n", i, p1);
1479 oskb = nskb;
1480 nskb = mI_alloc_skb(oskb->len + i, GFP_ATOMIC);
1481 if (!nskb) {
1482 dev_kfree_skb(oskb);
1483 printk(KERN_WARNING "%s: no skb mem\n", __func__);
1484 return;
1485 }
1486 memcpy(skb_put(nskb, i), header, i);
1487 memcpy(skb_put(nskb, oskb->len), oskb->data, oskb->len);
1488 dev_kfree_skb(oskb);
1489 }
1490 l2down(l2, PH_DATA_REQ, l2_newid(l2), nskb);
1491 test_and_clear_bit(FLG_ACK_PEND, &l2->flag);
1492 if (!test_and_set_bit(FLG_T200_RUN, &l2->flag)) {
1493 mISDN_FsmDelTimer(&l2->t203, 13);
1494 mISDN_FsmAddTimer(&l2->t200, l2->T200, EV_L2_T200, NULL, 11);
1495 }
1496 }
1497
1498 static void
1499 l2_st8_got_super(struct FsmInst *fi, int event, void *arg)
1500 {
1501 struct layer2 *l2 = fi->userdata;
1502 struct sk_buff *skb = arg;
1503 int PollFlag, rsp, rnr = 0;
1504 unsigned int nr;
1505
1506 rsp = *skb->data & 0x2;
1507 if (test_bit(FLG_ORIG, &l2->flag))
1508 rsp = !rsp;
1509
1510 skb_pull(skb, l2addrsize(l2));
1511
1512 if (IsRNR(skb->data, l2)) {
1513 set_peer_busy(l2);
1514 rnr = 1;
1515 } else
1516 clear_peer_busy(l2);
1517
1518 if (test_bit(FLG_MOD128, &l2->flag)) {
1519 PollFlag = (skb->data[1] & 0x1) == 0x1;
1520 nr = skb->data[1] >> 1;
1521 } else {
1522 PollFlag = (skb->data[0] & 0x10);
1523 nr = (skb->data[0] >> 5) & 0x7;
1524 }
1525 dev_kfree_skb(skb);
1526 if (rsp && PollFlag) {
1527 if (legalnr(l2, nr)) {
1528 if (rnr) {
1529 restart_t200(l2, 15);
1530 } else {
1531 stop_t200(l2, 16);
1532 mISDN_FsmAddTimer(&l2->t203, l2->T203,
1533 EV_L2_T203, NULL, 5);
1534 setva(l2, nr);
1535 }
1536 invoke_retransmission(l2, nr);
1537 mISDN_FsmChangeState(fi, ST_L2_7);
1538 if (skb_queue_len(&l2->i_queue) && cansend(l2))
1539 mISDN_FsmEvent(fi, EV_L2_ACK_PULL, NULL);
1540 } else
1541 nrerrorrecovery(fi);
1542 } else {
1543 if (!rsp && PollFlag)
1544 enquiry_response(l2);
1545 if (legalnr(l2, nr))
1546 setva(l2, nr);
1547 else
1548 nrerrorrecovery(fi);
1549 }
1550 }
1551
1552 static void
1553 l2_got_FRMR(struct FsmInst *fi, int event, void *arg)
1554 {
1555 struct layer2 *l2 = fi->userdata;
1556 struct sk_buff *skb = arg;
1557
1558 skb_pull(skb, l2addrsize(l2) + 1);
1559
1560 if (!(skb->data[0] & 1) || ((skb->data[0] & 3) == 1) || /* I or S */
1561 (IsUA(skb->data) && (fi->state == ST_L2_7))) {
1562 l2mgr(l2, MDL_ERROR_IND, (void *) 'K');
1563 establishlink(fi);
1564 test_and_clear_bit(FLG_L3_INIT, &l2->flag);
1565 }
1566 dev_kfree_skb(skb);
1567 }
1568
1569 static void
1570 l2_st24_tei_remove(struct FsmInst *fi, int event, void *arg)
1571 {
1572 struct layer2 *l2 = fi->userdata;
1573
1574 skb_queue_purge(&l2->ui_queue);
1575 l2->tei = GROUP_TEI;
1576 mISDN_FsmChangeState(fi, ST_L2_1);
1577 }
1578
1579 static void
1580 l2_st3_tei_remove(struct FsmInst *fi, int event, void *arg)
1581 {
1582 struct layer2 *l2 = fi->userdata;
1583
1584 skb_queue_purge(&l2->ui_queue);
1585 l2->tei = GROUP_TEI;
1586 l2up_create(l2, DL_RELEASE_IND, 0, NULL);
1587 mISDN_FsmChangeState(fi, ST_L2_1);
1588 }
1589
1590 static void
1591 l2_st5_tei_remove(struct FsmInst *fi, int event, void *arg)
1592 {
1593 struct layer2 *l2 = fi->userdata;
1594
1595 skb_queue_purge(&l2->i_queue);
1596 skb_queue_purge(&l2->ui_queue);
1597 freewin(l2);
1598 l2->tei = GROUP_TEI;
1599 stop_t200(l2, 17);
1600 st5_dl_release_l2l3(l2);
1601 mISDN_FsmChangeState(fi, ST_L2_1);
1602 }
1603
1604 static void
1605 l2_st6_tei_remove(struct FsmInst *fi, int event, void *arg)
1606 {
1607 struct layer2 *l2 = fi->userdata;
1608
1609 skb_queue_purge(&l2->ui_queue);
1610 l2->tei = GROUP_TEI;
1611 stop_t200(l2, 18);
1612 l2up_create(l2, DL_RELEASE_IND, 0, NULL);
1613 mISDN_FsmChangeState(fi, ST_L2_1);
1614 }
1615
1616 static void
1617 l2_tei_remove(struct FsmInst *fi, int event, void *arg)
1618 {
1619 struct layer2 *l2 = fi->userdata;
1620
1621 skb_queue_purge(&l2->i_queue);
1622 skb_queue_purge(&l2->ui_queue);
1623 freewin(l2);
1624 l2->tei = GROUP_TEI;
1625 stop_t200(l2, 17);
1626 mISDN_FsmDelTimer(&l2->t203, 19);
1627 l2up_create(l2, DL_RELEASE_IND, 0, NULL);
1628 /* mISDN_queue_data(&l2->inst, l2->inst.id | MSG_BROADCAST,
1629 * MGR_SHORTSTATUS_IND, SSTATUS_L2_RELEASED,
1630 * 0, NULL, 0);
1631 */
1632 mISDN_FsmChangeState(fi, ST_L2_1);
1633 }
1634
1635 static void
1636 l2_st14_persistant_da(struct FsmInst *fi, int event, void *arg)
1637 {
1638 struct layer2 *l2 = fi->userdata;
1639 struct sk_buff *skb = arg;
1640
1641 skb_queue_purge(&l2->i_queue);
1642 skb_queue_purge(&l2->ui_queue);
1643 if (test_and_clear_bit(FLG_ESTAB_PEND, &l2->flag))
1644 l2up(l2, DL_RELEASE_IND, skb);
1645 else
1646 dev_kfree_skb(skb);
1647 }
1648
1649 static void
1650 l2_st5_persistant_da(struct FsmInst *fi, int event, void *arg)
1651 {
1652 struct layer2 *l2 = fi->userdata;
1653 struct sk_buff *skb = arg;
1654
1655 skb_queue_purge(&l2->i_queue);
1656 skb_queue_purge(&l2->ui_queue);
1657 freewin(l2);
1658 stop_t200(l2, 19);
1659 st5_dl_release_l2l3(l2);
1660 mISDN_FsmChangeState(fi, ST_L2_4);
1661 if (l2->tm)
1662 l2_tei(l2, MDL_STATUS_DOWN_IND, 0);
1663 dev_kfree_skb(skb);
1664 }
1665
1666 static void
1667 l2_st6_persistant_da(struct FsmInst *fi, int event, void *arg)
1668 {
1669 struct layer2 *l2 = fi->userdata;
1670 struct sk_buff *skb = arg;
1671
1672 skb_queue_purge(&l2->ui_queue);
1673 stop_t200(l2, 20);
1674 l2up(l2, DL_RELEASE_CNF, skb);
1675 mISDN_FsmChangeState(fi, ST_L2_4);
1676 if (l2->tm)
1677 l2_tei(l2, MDL_STATUS_DOWN_IND, 0);
1678 }
1679
1680 static void
1681 l2_persistant_da(struct FsmInst *fi, int event, void *arg)
1682 {
1683 struct layer2 *l2 = fi->userdata;
1684 struct sk_buff *skb = arg;
1685
1686 skb_queue_purge(&l2->i_queue);
1687 skb_queue_purge(&l2->ui_queue);
1688 freewin(l2);
1689 stop_t200(l2, 19);
1690 mISDN_FsmDelTimer(&l2->t203, 19);
1691 l2up(l2, DL_RELEASE_IND, skb);
1692 mISDN_FsmChangeState(fi, ST_L2_4);
1693 if (l2->tm)
1694 l2_tei(l2, MDL_STATUS_DOWN_IND, 0);
1695 }
1696
1697 static void
1698 l2_set_own_busy(struct FsmInst *fi, int event, void *arg)
1699 {
1700 struct layer2 *l2 = fi->userdata;
1701 struct sk_buff *skb = arg;
1702
1703 if (!test_and_set_bit(FLG_OWN_BUSY, &l2->flag)) {
1704 enquiry_cr(l2, RNR, RSP, 0);
1705 test_and_clear_bit(FLG_ACK_PEND, &l2->flag);
1706 }
1707 if (skb)
1708 dev_kfree_skb(skb);
1709 }
1710
1711 static void
1712 l2_clear_own_busy(struct FsmInst *fi, int event, void *arg)
1713 {
1714 struct layer2 *l2 = fi->userdata;
1715 struct sk_buff *skb = arg;
1716
1717 if (!test_and_clear_bit(FLG_OWN_BUSY, &l2->flag)) {
1718 enquiry_cr(l2, RR, RSP, 0);
1719 test_and_clear_bit(FLG_ACK_PEND, &l2->flag);
1720 }
1721 if (skb)
1722 dev_kfree_skb(skb);
1723 }
1724
1725 static void
1726 l2_frame_error(struct FsmInst *fi, int event, void *arg)
1727 {
1728 struct layer2 *l2 = fi->userdata;
1729
1730 l2mgr(l2, MDL_ERROR_IND, arg);
1731 }
1732
1733 static void
1734 l2_frame_error_reest(struct FsmInst *fi, int event, void *arg)
1735 {
1736 struct layer2 *l2 = fi->userdata;
1737
1738 l2mgr(l2, MDL_ERROR_IND, arg);
1739 establishlink(fi);
1740 test_and_clear_bit(FLG_L3_INIT, &l2->flag);
1741 }
1742
1743 static struct FsmNode L2FnList[] =
1744 {
1745 {ST_L2_1, EV_L2_DL_ESTABLISH_REQ, l2_mdl_assign},
1746 {ST_L2_2, EV_L2_DL_ESTABLISH_REQ, l2_go_st3},
1747 {ST_L2_4, EV_L2_DL_ESTABLISH_REQ, l2_establish},
1748 {ST_L2_5, EV_L2_DL_ESTABLISH_REQ, l2_discard_i_setl3},
1749 {ST_L2_7, EV_L2_DL_ESTABLISH_REQ, l2_l3_reestablish},
1750 {ST_L2_8, EV_L2_DL_ESTABLISH_REQ, l2_l3_reestablish},
1751 {ST_L2_4, EV_L2_DL_RELEASE_REQ, l2_release},
1752 {ST_L2_5, EV_L2_DL_RELEASE_REQ, l2_pend_rel},
1753 {ST_L2_7, EV_L2_DL_RELEASE_REQ, l2_disconnect},
1754 {ST_L2_8, EV_L2_DL_RELEASE_REQ, l2_disconnect},
1755 {ST_L2_5, EV_L2_DL_DATA, l2_feed_i_if_reest},
1756 {ST_L2_7, EV_L2_DL_DATA, l2_feed_i_pull},
1757 {ST_L2_8, EV_L2_DL_DATA, l2_feed_iqueue},
1758 {ST_L2_1, EV_L2_DL_UNITDATA, l2_queue_ui_assign},
1759 {ST_L2_2, EV_L2_DL_UNITDATA, l2_queue_ui},
1760 {ST_L2_3, EV_L2_DL_UNITDATA, l2_queue_ui},
1761 {ST_L2_4, EV_L2_DL_UNITDATA, l2_send_ui},
1762 {ST_L2_5, EV_L2_DL_UNITDATA, l2_send_ui},
1763 {ST_L2_6, EV_L2_DL_UNITDATA, l2_send_ui},
1764 {ST_L2_7, EV_L2_DL_UNITDATA, l2_send_ui},
1765 {ST_L2_8, EV_L2_DL_UNITDATA, l2_send_ui},
1766 {ST_L2_1, EV_L2_MDL_ASSIGN, l2_got_tei},
1767 {ST_L2_2, EV_L2_MDL_ASSIGN, l2_got_tei},
1768 {ST_L2_3, EV_L2_MDL_ASSIGN, l2_got_tei},
1769 {ST_L2_2, EV_L2_MDL_ERROR, l2_st24_tei_remove},
1770 {ST_L2_3, EV_L2_MDL_ERROR, l2_st3_tei_remove},
1771 {ST_L2_4, EV_L2_MDL_REMOVE, l2_st24_tei_remove},
1772 {ST_L2_5, EV_L2_MDL_REMOVE, l2_st5_tei_remove},
1773 {ST_L2_6, EV_L2_MDL_REMOVE, l2_st6_tei_remove},
1774 {ST_L2_7, EV_L2_MDL_REMOVE, l2_tei_remove},
1775 {ST_L2_8, EV_L2_MDL_REMOVE, l2_tei_remove},
1776 {ST_L2_4, EV_L2_SABME, l2_start_multi},
1777 {ST_L2_5, EV_L2_SABME, l2_send_UA},
1778 {ST_L2_6, EV_L2_SABME, l2_send_DM},
1779 {ST_L2_7, EV_L2_SABME, l2_restart_multi},
1780 {ST_L2_8, EV_L2_SABME, l2_restart_multi},
1781 {ST_L2_4, EV_L2_DISC, l2_send_DM},
1782 {ST_L2_5, EV_L2_DISC, l2_send_DM},
1783 {ST_L2_6, EV_L2_DISC, l2_send_UA},
1784 {ST_L2_7, EV_L2_DISC, l2_stop_multi},
1785 {ST_L2_8, EV_L2_DISC, l2_stop_multi},
1786 {ST_L2_4, EV_L2_UA, l2_mdl_error_ua},
1787 {ST_L2_5, EV_L2_UA, l2_connected},
1788 {ST_L2_6, EV_L2_UA, l2_released},
1789 {ST_L2_7, EV_L2_UA, l2_mdl_error_ua},
1790 {ST_L2_8, EV_L2_UA, l2_mdl_error_ua},
1791 {ST_L2_4, EV_L2_DM, l2_reestablish},
1792 {ST_L2_5, EV_L2_DM, l2_st5_dm_release},
1793 {ST_L2_6, EV_L2_DM, l2_st6_dm_release},
1794 {ST_L2_7, EV_L2_DM, l2_mdl_error_dm},
1795 {ST_L2_8, EV_L2_DM, l2_st8_mdl_error_dm},
1796 {ST_L2_1, EV_L2_UI, l2_got_ui},
1797 {ST_L2_2, EV_L2_UI, l2_got_ui},
1798 {ST_L2_3, EV_L2_UI, l2_got_ui},
1799 {ST_L2_4, EV_L2_UI, l2_got_ui},
1800 {ST_L2_5, EV_L2_UI, l2_got_ui},
1801 {ST_L2_6, EV_L2_UI, l2_got_ui},
1802 {ST_L2_7, EV_L2_UI, l2_got_ui},
1803 {ST_L2_8, EV_L2_UI, l2_got_ui},
1804 {ST_L2_7, EV_L2_FRMR, l2_got_FRMR},
1805 {ST_L2_8, EV_L2_FRMR, l2_got_FRMR},
1806 {ST_L2_7, EV_L2_SUPER, l2_st7_got_super},
1807 {ST_L2_8, EV_L2_SUPER, l2_st8_got_super},
1808 {ST_L2_7, EV_L2_I, l2_got_iframe},
1809 {ST_L2_8, EV_L2_I, l2_got_iframe},
1810 {ST_L2_5, EV_L2_T200, l2_st5_tout_200},
1811 {ST_L2_6, EV_L2_T200, l2_st6_tout_200},
1812 {ST_L2_7, EV_L2_T200, l2_st7_tout_200},
1813 {ST_L2_8, EV_L2_T200, l2_st8_tout_200},
1814 {ST_L2_7, EV_L2_T203, l2_st7_tout_203},
1815 {ST_L2_7, EV_L2_ACK_PULL, l2_pull_iqueue},
1816 {ST_L2_7, EV_L2_SET_OWN_BUSY, l2_set_own_busy},
1817 {ST_L2_8, EV_L2_SET_OWN_BUSY, l2_set_own_busy},
1818 {ST_L2_7, EV_L2_CLEAR_OWN_BUSY, l2_clear_own_busy},
1819 {ST_L2_8, EV_L2_CLEAR_OWN_BUSY, l2_clear_own_busy},
1820 {ST_L2_4, EV_L2_FRAME_ERROR, l2_frame_error},
1821 {ST_L2_5, EV_L2_FRAME_ERROR, l2_frame_error},
1822 {ST_L2_6, EV_L2_FRAME_ERROR, l2_frame_error},
1823 {ST_L2_7, EV_L2_FRAME_ERROR, l2_frame_error_reest},
1824 {ST_L2_8, EV_L2_FRAME_ERROR, l2_frame_error_reest},
1825 {ST_L2_1, EV_L1_DEACTIVATE, l2_st14_persistant_da},
1826 {ST_L2_2, EV_L1_DEACTIVATE, l2_st24_tei_remove},
1827 {ST_L2_3, EV_L1_DEACTIVATE, l2_st3_tei_remove},
1828 {ST_L2_4, EV_L1_DEACTIVATE, l2_st14_persistant_da},
1829 {ST_L2_5, EV_L1_DEACTIVATE, l2_st5_persistant_da},
1830 {ST_L2_6, EV_L1_DEACTIVATE, l2_st6_persistant_da},
1831 {ST_L2_7, EV_L1_DEACTIVATE, l2_persistant_da},
1832 {ST_L2_8, EV_L1_DEACTIVATE, l2_persistant_da},
1833 };
1834
1835 #define L2_FN_COUNT (sizeof(L2FnList)/sizeof(struct FsmNode))
1836
1837 static int
1838 ph_data_indication(struct layer2 *l2, struct mISDNhead *hh, struct sk_buff *skb)
1839 {
1840 u_char *datap = skb->data;
1841 int ret = -EINVAL;
1842 int psapi, ptei;
1843 u_int l;
1844 int c = 0;
1845
1846 l = l2addrsize(l2);
1847 if (skb->len <= l) {
1848 mISDN_FsmEvent(&l2->l2m, EV_L2_FRAME_ERROR, (void *) 'N');
1849 return ret;
1850 }
1851 if (test_bit(FLG_LAPD, &l2->flag)) { /* Maybe not needed */
1852 psapi = *datap++;
1853 ptei = *datap++;
1854 if ((psapi & 1) || !(ptei & 1)) {
1855 printk(KERN_WARNING
1856 "l2 D-channel frame wrong EA0/EA1\n");
1857 return ret;
1858 }
1859 psapi >>= 2;
1860 ptei >>= 1;
1861 if (psapi != l2->sapi) {
1862 /* not our bussiness
1863 * printk(KERN_DEBUG "%s: sapi %d/%d sapi mismatch\n",
1864 * __func__,
1865 * psapi, l2->sapi);
1866 */
1867 dev_kfree_skb(skb);
1868 return 0;
1869 }
1870 if ((ptei != l2->tei) && (ptei != GROUP_TEI)) {
1871 /* not our bussiness
1872 * printk(KERN_DEBUG "%s: tei %d/%d sapi %d mismatch\n",
1873 * __func__,
1874 * ptei, l2->tei, psapi);
1875 */
1876 dev_kfree_skb(skb);
1877 return 0;
1878 }
1879 } else
1880 datap += l;
1881 if (!(*datap & 1)) { /* I-Frame */
1882 c = iframe_error(l2, skb);
1883 if (!c)
1884 ret = mISDN_FsmEvent(&l2->l2m, EV_L2_I, skb);
1885 } else if (IsSFrame(datap, l2)) { /* S-Frame */
1886 c = super_error(l2, skb);
1887 if (!c)
1888 ret = mISDN_FsmEvent(&l2->l2m, EV_L2_SUPER, skb);
1889 } else if (IsUI(datap)) {
1890 c = UI_error(l2, skb);
1891 if (!c)
1892 ret = mISDN_FsmEvent(&l2->l2m, EV_L2_UI, skb);
1893 } else if (IsSABME(datap, l2)) {
1894 c = unnum_error(l2, skb, CMD);
1895 if (!c)
1896 ret = mISDN_FsmEvent(&l2->l2m, EV_L2_SABME, skb);
1897 } else if (IsUA(datap)) {
1898 c = unnum_error(l2, skb, RSP);
1899 if (!c)
1900 ret = mISDN_FsmEvent(&l2->l2m, EV_L2_UA, skb);
1901 } else if (IsDISC(datap)) {
1902 c = unnum_error(l2, skb, CMD);
1903 if (!c)
1904 ret = mISDN_FsmEvent(&l2->l2m, EV_L2_DISC, skb);
1905 } else if (IsDM(datap)) {
1906 c = unnum_error(l2, skb, RSP);
1907 if (!c)
1908 ret = mISDN_FsmEvent(&l2->l2m, EV_L2_DM, skb);
1909 } else if (IsFRMR(datap)) {
1910 c = FRMR_error(l2, skb);
1911 if (!c)
1912 ret = mISDN_FsmEvent(&l2->l2m, EV_L2_FRMR, skb);
1913 } else
1914 c = 'L';
1915 if (c) {
1916 printk(KERN_WARNING "l2 D-channel frame error %c\n", c);
1917 mISDN_FsmEvent(&l2->l2m, EV_L2_FRAME_ERROR, (void *)(long)c);
1918 }
1919 return ret;
1920 }
1921
1922 static int
1923 l2_send(struct mISDNchannel *ch, struct sk_buff *skb)
1924 {
1925 struct layer2 *l2 = container_of(ch, struct layer2, ch);
1926 struct mISDNhead *hh = mISDN_HEAD_P(skb);
1927 int ret = -EINVAL;
1928
1929 if (*debug & DEBUG_L2_RECV)
1930 printk(KERN_DEBUG "%s: prim(%x) id(%x) tei(%d)\n",
1931 __func__, hh->prim, hh->id, l2->tei);
1932 switch (hh->prim) {
1933 case PH_DATA_IND:
1934 ret = ph_data_indication(l2, hh, skb);
1935 break;
1936 case PH_DATA_CNF:
1937 ret = ph_data_confirm(l2, hh, skb);
1938 break;
1939 case PH_ACTIVATE_IND:
1940 test_and_set_bit(FLG_L1_ACTIV, &l2->flag);
1941 l2up_create(l2, MPH_ACTIVATE_IND, 0, NULL);
1942 if (test_and_clear_bit(FLG_ESTAB_PEND, &l2->flag))
1943 ret = mISDN_FsmEvent(&l2->l2m,
1944 EV_L2_DL_ESTABLISH_REQ, skb);
1945 break;
1946 case PH_DEACTIVATE_IND:
1947 test_and_clear_bit(FLG_L1_ACTIV, &l2->flag);
1948 l2up_create(l2, MPH_DEACTIVATE_IND, 0, NULL);
1949 ret = mISDN_FsmEvent(&l2->l2m, EV_L1_DEACTIVATE, skb);
1950 break;
1951 case MPH_INFORMATION_IND:
1952 if (!l2->up)
1953 break;
1954 ret = l2->up->send(l2->up, skb);
1955 break;
1956 case DL_DATA_REQ:
1957 ret = mISDN_FsmEvent(&l2->l2m, EV_L2_DL_DATA, skb);
1958 break;
1959 case DL_UNITDATA_REQ:
1960 ret = mISDN_FsmEvent(&l2->l2m, EV_L2_DL_UNITDATA, skb);
1961 break;
1962 case DL_ESTABLISH_REQ:
1963 if (test_bit(FLG_LAPB, &l2->flag))
1964 test_and_set_bit(FLG_ORIG, &l2->flag);
1965 if (test_bit(FLG_L1_ACTIV, &l2->flag)) {
1966 if (test_bit(FLG_LAPD, &l2->flag) ||
1967 test_bit(FLG_ORIG, &l2->flag))
1968 ret = mISDN_FsmEvent(&l2->l2m,
1969 EV_L2_DL_ESTABLISH_REQ, skb);
1970 } else {
1971 if (test_bit(FLG_LAPD, &l2->flag) ||
1972 test_bit(FLG_ORIG, &l2->flag)) {
1973 test_and_set_bit(FLG_ESTAB_PEND,
1974 &l2->flag);
1975 }
1976 ret = l2down(l2, PH_ACTIVATE_REQ, l2_newid(l2),
1977 skb);
1978 }
1979 break;
1980 case DL_RELEASE_REQ:
1981 if (test_bit(FLG_LAPB, &l2->flag))
1982 l2down_create(l2, PH_DEACTIVATE_REQ,
1983 l2_newid(l2), 0, NULL);
1984 ret = mISDN_FsmEvent(&l2->l2m, EV_L2_DL_RELEASE_REQ,
1985 skb);
1986 break;
1987 default:
1988 if (*debug & DEBUG_L2)
1989 l2m_debug(&l2->l2m, "l2 unknown pr %04x",
1990 hh->prim);
1991 }
1992 if (ret) {
1993 dev_kfree_skb(skb);
1994 ret = 0;
1995 }
1996 return ret;
1997 }
1998
1999 int
2000 tei_l2(struct layer2 *l2, u_int cmd, u_long arg)
2001 {
2002 int ret = -EINVAL;
2003
2004 if (*debug & DEBUG_L2_TEI)
2005 printk(KERN_DEBUG "%s: cmd(%x)\n", __func__, cmd);
2006 switch (cmd) {
2007 case (MDL_ASSIGN_REQ):
2008 ret = mISDN_FsmEvent(&l2->l2m, EV_L2_MDL_ASSIGN, (void *)arg);
2009 break;
2010 case (MDL_REMOVE_REQ):
2011 ret = mISDN_FsmEvent(&l2->l2m, EV_L2_MDL_REMOVE, NULL);
2012 break;
2013 case (MDL_ERROR_IND):
2014 ret = mISDN_FsmEvent(&l2->l2m, EV_L2_MDL_ERROR, NULL);
2015 break;
2016 case (MDL_ERROR_RSP):
2017 /* ETS 300-125 5.3.2.1 Test: TC13010 */
2018 printk(KERN_NOTICE "MDL_ERROR|REQ (tei_l2)\n");
2019 ret = mISDN_FsmEvent(&l2->l2m, EV_L2_MDL_ERROR, NULL);
2020 break;
2021 }
2022 return ret;
2023 }
2024
2025 static void
2026 release_l2(struct layer2 *l2)
2027 {
2028 mISDN_FsmDelTimer(&l2->t200, 21);
2029 mISDN_FsmDelTimer(&l2->t203, 16);
2030 skb_queue_purge(&l2->i_queue);
2031 skb_queue_purge(&l2->ui_queue);
2032 skb_queue_purge(&l2->down_queue);
2033 ReleaseWin(l2);
2034 if (test_bit(FLG_LAPD, &l2->flag)) {
2035 TEIrelease(l2);
2036 if (l2->ch.st)
2037 l2->ch.st->dev->D.ctrl(&l2->ch.st->dev->D,
2038 CLOSE_CHANNEL, NULL);
2039 }
2040 kfree(l2);
2041 }
2042
2043 static int
2044 l2_ctrl(struct mISDNchannel *ch, u_int cmd, void *arg)
2045 {
2046 struct layer2 *l2 = container_of(ch, struct layer2, ch);
2047 u_int info;
2048
2049 if (*debug & DEBUG_L2_CTRL)
2050 printk(KERN_DEBUG "%s:(%x)\n", __func__, cmd);
2051
2052 switch (cmd) {
2053 case OPEN_CHANNEL:
2054 if (test_bit(FLG_LAPD, &l2->flag)) {
2055 set_channel_address(&l2->ch, l2->sapi, l2->tei);
2056 info = DL_INFO_L2_CONNECT;
2057 l2up_create(l2, DL_INFORMATION_IND,
2058 sizeof(info), &info);
2059 }
2060 break;
2061 case CLOSE_CHANNEL:
2062 if (l2->ch.peer)
2063 l2->ch.peer->ctrl(l2->ch.peer, CLOSE_CHANNEL, NULL);
2064 release_l2(l2);
2065 break;
2066 }
2067 return 0;
2068 }
2069
2070 struct layer2 *
2071 create_l2(struct mISDNchannel *ch, u_int protocol, u_long options, u_long arg)
2072 {
2073 struct layer2 *l2;
2074 struct channel_req rq;
2075
2076 l2 = kzalloc(sizeof(struct layer2), GFP_KERNEL);
2077 if (!l2) {
2078 printk(KERN_ERR "kzalloc layer2 failed\n");
2079 return NULL;
2080 }
2081 l2->next_id = 1;
2082 l2->down_id = MISDN_ID_NONE;
2083 l2->up = ch;
2084 l2->ch.st = ch->st;
2085 l2->ch.send = l2_send;
2086 l2->ch.ctrl = l2_ctrl;
2087 switch (protocol) {
2088 case ISDN_P_LAPD_NT:
2089 test_and_set_bit(FLG_LAPD, &l2->flag);
2090 test_and_set_bit(FLG_LAPD_NET, &l2->flag);
2091 test_and_set_bit(FLG_MOD128, &l2->flag);
2092 l2->sapi = 0;
2093 l2->maxlen = MAX_DFRAME_LEN;
2094 if (test_bit(OPTION_L2_PMX, &options))
2095 l2->window = 7;
2096 else
2097 l2->window = 1;
2098 if (test_bit(OPTION_L2_PTP, &options))
2099 test_and_set_bit(FLG_PTP, &l2->flag);
2100 if (test_bit(OPTION_L2_FIXEDTEI, &options))
2101 test_and_set_bit(FLG_FIXED_TEI, &l2->flag);
2102 l2->tei = (u_int)arg;
2103 l2->T200 = 1000;
2104 l2->N200 = 3;
2105 l2->T203 = 10000;
2106 if (test_bit(OPTION_L2_PMX, &options))
2107 rq.protocol = ISDN_P_NT_E1;
2108 else
2109 rq.protocol = ISDN_P_NT_S0;
2110 rq.adr.channel = 0;
2111 l2->ch.st->dev->D.ctrl(&l2->ch.st->dev->D, OPEN_CHANNEL, &rq);
2112 break;
2113 case ISDN_P_LAPD_TE:
2114 test_and_set_bit(FLG_LAPD, &l2->flag);
2115 test_and_set_bit(FLG_MOD128, &l2->flag);
2116 test_and_set_bit(FLG_ORIG, &l2->flag);
2117 l2->sapi = 0;
2118 l2->maxlen = MAX_DFRAME_LEN;
2119 if (test_bit(OPTION_L2_PMX, &options))
2120 l2->window = 7;
2121 else
2122 l2->window = 1;
2123 if (test_bit(OPTION_L2_PTP, &options))
2124 test_and_set_bit(FLG_PTP, &l2->flag);
2125 if (test_bit(OPTION_L2_FIXEDTEI, &options))
2126 test_and_set_bit(FLG_FIXED_TEI, &l2->flag);
2127 l2->tei = (u_int)arg;
2128 l2->T200 = 1000;
2129 l2->N200 = 3;
2130 l2->T203 = 10000;
2131 if (test_bit(OPTION_L2_PMX, &options))
2132 rq.protocol = ISDN_P_TE_E1;
2133 else
2134 rq.protocol = ISDN_P_TE_S0;
2135 rq.adr.channel = 0;
2136 l2->ch.st->dev->D.ctrl(&l2->ch.st->dev->D, OPEN_CHANNEL, &rq);
2137 break;
2138 case ISDN_P_B_X75SLP:
2139 test_and_set_bit(FLG_LAPB, &l2->flag);
2140 l2->window = 7;
2141 l2->maxlen = MAX_DATA_SIZE;
2142 l2->T200 = 1000;
2143 l2->N200 = 4;
2144 l2->T203 = 5000;
2145 l2->addr.A = 3;
2146 l2->addr.B = 1;
2147 break;
2148 default:
2149 printk(KERN_ERR "layer2 create failed prt %x\n",
2150 protocol);
2151 kfree(l2);
2152 return NULL;
2153 }
2154 skb_queue_head_init(&l2->i_queue);
2155 skb_queue_head_init(&l2->ui_queue);
2156 skb_queue_head_init(&l2->down_queue);
2157 skb_queue_head_init(&l2->tmp_queue);
2158 InitWin(l2);
2159 l2->l2m.fsm = &l2fsm;
2160 if (test_bit(FLG_LAPB, &l2->flag) ||
2161 test_bit(FLG_PTP, &l2->flag) ||
2162 test_bit(FLG_LAPD_NET, &l2->flag))
2163 l2->l2m.state = ST_L2_4;
2164 else
2165 l2->l2m.state = ST_L2_1;
2166 l2->l2m.debug = *debug;
2167 l2->l2m.userdata = l2;
2168 l2->l2m.userint = 0;
2169 l2->l2m.printdebug = l2m_debug;
2170
2171 mISDN_FsmInitTimer(&l2->l2m, &l2->t200);
2172 mISDN_FsmInitTimer(&l2->l2m, &l2->t203);
2173 return l2;
2174 }
2175
2176 static int
2177 x75create(struct channel_req *crq)
2178 {
2179 struct layer2 *l2;
2180
2181 if (crq->protocol != ISDN_P_B_X75SLP)
2182 return -EPROTONOSUPPORT;
2183 l2 = create_l2(crq->ch, crq->protocol, 0, 0);
2184 if (!l2)
2185 return -ENOMEM;
2186 crq->ch = &l2->ch;
2187 crq->protocol = ISDN_P_B_HDLC;
2188 return 0;
2189 }
2190
2191 static struct Bprotocol X75SLP = {
2192 .Bprotocols = (1 << (ISDN_P_B_X75SLP & ISDN_P_B_MASK)),
2193 .name = "X75SLP",
2194 .create = x75create
2195 };
2196
2197 int
2198 Isdnl2_Init(u_int *deb)
2199 {
2200 debug = deb;
2201 mISDN_register_Bprotocol(&X75SLP);
2202 l2fsm.state_count = L2_STATE_COUNT;
2203 l2fsm.event_count = L2_EVENT_COUNT;
2204 l2fsm.strEvent = strL2Event;
2205 l2fsm.strState = strL2State;
2206 mISDN_FsmNew(&l2fsm, L2FnList, ARRAY_SIZE(L2FnList));
2207 TEIInit(deb);
2208 return 0;
2209 }
2210
2211 void
2212 Isdnl2_cleanup(void)
2213 {
2214 mISDN_unregister_Bprotocol(&X75SLP);
2215 TEIFree();
2216 mISDN_FsmFree(&l2fsm);
2217 }
2218
linux 2.6 git repository for openrd