drivers/isdn/mISDN/layer2.c

   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 (sapi %d tei %d): ", l2->sapi, 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                         if (*debug & DEBUG_L2)
1864                                 printk(KERN_DEBUG "%s: sapi %d/%d mismatch\n",
1865                                         __func__, psapi, l2->sapi);
1866                         dev_kfree_skb(skb);
1867                         return 0;
1868                 }
1869                 if ((ptei != l2->tei) && (ptei != GROUP_TEI)) {
1870                         /* not our bussiness */
1871                         if (*debug & DEBUG_L2)
1872                                 printk(KERN_DEBUG "%s: tei %d/%d mismatch\n",
1873                                         __func__, ptei, l2->tei);
1874                         dev_kfree_skb(skb);
1875                         return 0;
1876                 }
1877         } else
1878                 datap += l;
1879         if (!(*datap & 1)) {    /* I-Frame */
1880                 c = iframe_error(l2, skb);
1881                 if (!c)
1882                         ret = mISDN_FsmEvent(&l2->l2m, EV_L2_I, skb);
1883         } else if (IsSFrame(datap, l2)) {       /* S-Frame */
1884                 c = super_error(l2, skb);
1885                 if (!c)
1886                         ret = mISDN_FsmEvent(&l2->l2m, EV_L2_SUPER, skb);
1887         } else if (IsUI(datap)) {
1888                 c = UI_error(l2, skb);
1889                 if (!c)
1890                         ret = mISDN_FsmEvent(&l2->l2m, EV_L2_UI, skb);
1891         } else if (IsSABME(datap, l2)) {
1892                 c = unnum_error(l2, skb, CMD);
1893                 if (!c)
1894                         ret = mISDN_FsmEvent(&l2->l2m, EV_L2_SABME, skb);
1895         } else if (IsUA(datap)) {
1896                 c = unnum_error(l2, skb, RSP);
1897                 if (!c)
1898                         ret = mISDN_FsmEvent(&l2->l2m, EV_L2_UA, skb);
1899         } else if (IsDISC(datap)) {
1900                 c = unnum_error(l2, skb, CMD);
1901                 if (!c)
1902                         ret = mISDN_FsmEvent(&l2->l2m, EV_L2_DISC, skb);
1903         } else if (IsDM(datap)) {
1904                 c = unnum_error(l2, skb, RSP);
1905                 if (!c)
1906                         ret = mISDN_FsmEvent(&l2->l2m, EV_L2_DM, skb);
1907         } else if (IsFRMR(datap)) {
1908                 c = FRMR_error(l2, skb);
1909                 if (!c)
1910                         ret = mISDN_FsmEvent(&l2->l2m, EV_L2_FRMR, skb);
1911         } else
1912                 c = 'L';
1913         if (c) {
1914                 printk(KERN_WARNING "l2 D-channel frame error %c\n", c);
1915                 mISDN_FsmEvent(&l2->l2m, EV_L2_FRAME_ERROR, (void *)(long)c);
1916         }
1917         return ret;
1918 }
1919
1920 static int
1921 l2_send(struct mISDNchannel *ch, struct sk_buff *skb)
1922 {
1923         struct layer2           *l2 = container_of(ch, struct layer2, ch);
1924         struct mISDNhead        *hh =  mISDN_HEAD_P(skb);
1925         int                     ret = -EINVAL;
1926
1927         if (*debug & DEBUG_L2_RECV)
1928                 printk(KERN_DEBUG "%s: prim(%x) id(%x) sapi(%d) tei(%d)\n",
1929                     __func__, hh->prim, hh->id, l2->sapi, l2->tei);
1930         switch (hh->prim) {
1931         case PH_DATA_IND:
1932                 ret = ph_data_indication(l2, hh, skb);
1933                 break;
1934         case PH_DATA_CNF:
1935                 ret = ph_data_confirm(l2, hh, skb);
1936                 break;
1937         case PH_ACTIVATE_IND:
1938                 test_and_set_bit(FLG_L1_ACTIV, &l2->flag);
1939                 l2up_create(l2, MPH_ACTIVATE_IND, 0, NULL);
1940                 if (test_and_clear_bit(FLG_ESTAB_PEND, &l2->flag))
1941                         ret = mISDN_FsmEvent(&l2->l2m,
1942                                 EV_L2_DL_ESTABLISH_REQ, skb);
1943                 break;
1944         case PH_DEACTIVATE_IND:
1945                 test_and_clear_bit(FLG_L1_ACTIV, &l2->flag);
1946                 l2up_create(l2, MPH_DEACTIVATE_IND, 0, NULL);
1947                 ret = mISDN_FsmEvent(&l2->l2m, EV_L1_DEACTIVATE, skb);
1948                 break;
1949         case MPH_INFORMATION_IND:
1950                 if (!l2->up)
1951                         break;
1952                 ret = l2->up->send(l2->up, skb);
1953                 break;
1954         case DL_DATA_REQ:
1955                 ret = mISDN_FsmEvent(&l2->l2m, EV_L2_DL_DATA, skb);
1956                 break;
1957         case DL_UNITDATA_REQ:
1958                 ret = mISDN_FsmEvent(&l2->l2m, EV_L2_DL_UNITDATA, skb);
1959                 break;
1960         case DL_ESTABLISH_REQ:
1961                 if (test_bit(FLG_LAPB, &l2->flag))
1962                         test_and_set_bit(FLG_ORIG, &l2->flag);
1963                 if (test_bit(FLG_L1_ACTIV, &l2->flag)) {
1964                         if (test_bit(FLG_LAPD, &l2->flag) ||
1965                                 test_bit(FLG_ORIG, &l2->flag))
1966                                 ret = mISDN_FsmEvent(&l2->l2m,
1967                                         EV_L2_DL_ESTABLISH_REQ, skb);
1968                 } else {
1969                         if (test_bit(FLG_LAPD, &l2->flag) ||
1970                                 test_bit(FLG_ORIG, &l2->flag)) {
1971                                 test_and_set_bit(FLG_ESTAB_PEND,
1972                                         &l2->flag);
1973                         }
1974                         ret = l2down(l2, PH_ACTIVATE_REQ, l2_newid(l2),
1975                             skb);
1976                 }
1977                 break;
1978         case DL_RELEASE_REQ:
1979                 if (test_bit(FLG_LAPB, &l2->flag))
1980                         l2down_create(l2, PH_DEACTIVATE_REQ,
1981                                 l2_newid(l2), 0, NULL);
1982                 ret = mISDN_FsmEvent(&l2->l2m, EV_L2_DL_RELEASE_REQ,
1983                     skb);
1984                 break;
1985         default:
1986                 if (*debug & DEBUG_L2)
1987                         l2m_debug(&l2->l2m, "l2 unknown pr %04x",
1988                             hh->prim);
1989         }
1990         if (ret) {
1991                 dev_kfree_skb(skb);
1992                 ret = 0;
1993         }
1994         return ret;
1995 }
1996
1997 int
1998 tei_l2(struct layer2 *l2, u_int cmd, u_long arg)
1999 {
2000         int             ret = -EINVAL;
2001
2002         if (*debug & DEBUG_L2_TEI)
2003                 printk(KERN_DEBUG "%s: cmd(%x)\n", __func__, cmd);
2004         switch (cmd) {
2005         case (MDL_ASSIGN_REQ):
2006                 ret = mISDN_FsmEvent(&l2->l2m, EV_L2_MDL_ASSIGN, (void *)arg);
2007                 break;
2008         case (MDL_REMOVE_REQ):
2009                 ret = mISDN_FsmEvent(&l2->l2m, EV_L2_MDL_REMOVE, NULL);
2010                 break;
2011         case (MDL_ERROR_IND):
2012                 ret = mISDN_FsmEvent(&l2->l2m, EV_L2_MDL_ERROR, NULL);
2013                 break;
2014         case (MDL_ERROR_RSP):
2015                 /* ETS 300-125 5.3.2.1 Test: TC13010 */
2016                 printk(KERN_NOTICE "MDL_ERROR|REQ (tei_l2)\n");
2017                 ret = mISDN_FsmEvent(&l2->l2m, EV_L2_MDL_ERROR, NULL);
2018                 break;
2019         }
2020         return ret;
2021 }
2022
2023 static void
2024 release_l2(struct layer2 *l2)
2025 {
2026         mISDN_FsmDelTimer(&l2->t200, 21);
2027         mISDN_FsmDelTimer(&l2->t203, 16);
2028         skb_queue_purge(&l2->i_queue);
2029         skb_queue_purge(&l2->ui_queue);
2030         skb_queue_purge(&l2->down_queue);
2031         ReleaseWin(l2);
2032         if (test_bit(FLG_LAPD, &l2->flag)) {
2033                 TEIrelease(l2);
2034                 if (l2->ch.st)
2035                         l2->ch.st->dev->D.ctrl(&l2->ch.st->dev->D,
2036                             CLOSE_CHANNEL, NULL);
2037         }
2038         kfree(l2);
2039 }
2040
2041 static int
2042 l2_ctrl(struct mISDNchannel *ch, u_int cmd, void *arg)
2043 {
2044         struct layer2           *l2 = container_of(ch, struct layer2, ch);
2045         u_int                   info;
2046
2047         if (*debug & DEBUG_L2_CTRL)
2048                 printk(KERN_DEBUG "%s:(%x)\n", __func__, cmd);
2049
2050         switch (cmd) {
2051         case OPEN_CHANNEL:
2052                 if (test_bit(FLG_LAPD, &l2->flag)) {
2053                         set_channel_address(&l2->ch, l2->sapi, l2->tei);
2054                         info = DL_INFO_L2_CONNECT;
2055                         l2up_create(l2, DL_INFORMATION_IND,
2056                             sizeof(info), &info);
2057                 }
2058                 break;
2059         case CLOSE_CHANNEL:
2060                 if (l2->ch.peer)
2061                         l2->ch.peer->ctrl(l2->ch.peer, CLOSE_CHANNEL, NULL);
2062                 release_l2(l2);
2063                 break;
2064         }
2065         return 0;
2066 }
2067
2068 struct layer2 *
2069 create_l2(struct mISDNchannel *ch, u_int protocol, u_long options, int tei,
2070                 int sapi)
2071 {
2072         struct layer2           *l2;
2073         struct channel_req      rq;
2074
2075         l2 = kzalloc(sizeof(struct layer2), GFP_KERNEL);
2076         if (!l2) {
2077                 printk(KERN_ERR "kzalloc layer2 failed\n");
2078                 return NULL;
2079         }
2080         l2->next_id = 1;
2081         l2->down_id = MISDN_ID_NONE;
2082         l2->up = ch;
2083         l2->ch.st = ch->st;
2084         l2->ch.send = l2_send;
2085         l2->ch.ctrl = l2_ctrl;
2086         switch (protocol) {
2087         case ISDN_P_LAPD_NT:
2088                 test_and_set_bit(FLG_LAPD, &l2->flag);
2089                 test_and_set_bit(FLG_LAPD_NET, &l2->flag);
2090                 test_and_set_bit(FLG_MOD128, &l2->flag);
2091                 l2->sapi = sapi;
2092                 l2->maxlen = MAX_DFRAME_LEN;
2093                 if (test_bit(OPTION_L2_PMX, &options))
2094                         l2->window = 7;
2095                 else
2096                         l2->window = 1;
2097                 if (test_bit(OPTION_L2_PTP, &options))
2098                         test_and_set_bit(FLG_PTP, &l2->flag);
2099                 if (test_bit(OPTION_L2_FIXEDTEI, &options))
2100                         test_and_set_bit(FLG_FIXED_TEI, &l2->flag);
2101                 l2->tei = tei;
2102                 l2->T200 = 1000;
2103                 l2->N200 = 3;
2104                 l2->T203 = 10000;
2105                 if (test_bit(OPTION_L2_PMX, &options))
2106                         rq.protocol = ISDN_P_NT_E1;
2107                 else
2108                         rq.protocol = ISDN_P_NT_S0;
2109                 rq.adr.channel = 0;
2110                 l2->ch.st->dev->D.ctrl(&l2->ch.st->dev->D, OPEN_CHANNEL, &rq);
2111                 break;
2112         case ISDN_P_LAPD_TE:
2113                 test_and_set_bit(FLG_LAPD, &l2->flag);
2114                 test_and_set_bit(FLG_MOD128, &l2->flag);
2115                 test_and_set_bit(FLG_ORIG, &l2->flag);
2116                 l2->sapi = sapi;
2117                 l2->maxlen = MAX_DFRAME_LEN;
2118                 if (test_bit(OPTION_L2_PMX, &options))
2119                         l2->window = 7;
2120                 else
2121                         l2->window = 1;
2122                 if (test_bit(OPTION_L2_PTP, &options))
2123                         test_and_set_bit(FLG_PTP, &l2->flag);
2124                 if (test_bit(OPTION_L2_FIXEDTEI, &options))
2125                         test_and_set_bit(FLG_FIXED_TEI, &l2->flag);
2126                 l2->tei = tei;
2127                 l2->T200 = 1000;
2128                 l2->N200 = 3;
2129                 l2->T203 = 10000;
2130                 if (test_bit(OPTION_L2_PMX, &options))
2131                         rq.protocol = ISDN_P_TE_E1;
2132                 else
2133                         rq.protocol = ISDN_P_TE_S0;
2134                 rq.adr.channel = 0;
2135                 l2->ch.st->dev->D.ctrl(&l2->ch.st->dev->D, OPEN_CHANNEL, &rq);
2136                 break;
2137         case ISDN_P_B_X75SLP:
2138                 test_and_set_bit(FLG_LAPB, &l2->flag);
2139                 l2->window = 7;
2140                 l2->maxlen = MAX_DATA_SIZE;
2141                 l2->T200 = 1000;
2142                 l2->N200 = 4;
2143                 l2->T203 = 5000;
2144                 l2->addr.A = 3;
2145                 l2->addr.B = 1;
2146                 break;
2147         default:
2148                 printk(KERN_ERR "layer2 create failed prt %x\n",
2149                         protocol);
2150                 kfree(l2);
2151                 return NULL;
2152         }
2153         skb_queue_head_init(&l2->i_queue);
2154         skb_queue_head_init(&l2->ui_queue);
2155         skb_queue_head_init(&l2->down_queue);
2156         skb_queue_head_init(&l2->tmp_queue);
2157         InitWin(l2);
2158         l2->l2m.fsm = &l2fsm;
2159         if (test_bit(FLG_LAPB, &l2->flag) ||
2160                 test_bit(FLG_PTP, &l2->flag) ||
2161                 test_bit(FLG_LAPD_NET, &l2->flag))
2162                 l2->l2m.state = ST_L2_4;
2163         else
2164                 l2->l2m.state = ST_L2_1;
2165         l2->l2m.debug = *debug;
2166         l2->l2m.userdata = l2;
2167         l2->l2m.userint = 0;
2168         l2->l2m.printdebug = l2m_debug;
2169
2170         mISDN_FsmInitTimer(&l2->l2m, &l2->t200);
2171         mISDN_FsmInitTimer(&l2->l2m, &l2->t203);
2172         return l2;
2173 }
2174
2175 static int
2176 x75create(struct channel_req *crq)
2177 {
2178         struct layer2   *l2;
2179
2180         if (crq->protocol != ISDN_P_B_X75SLP)
2181                 return -EPROTONOSUPPORT;
2182         l2 = create_l2(crq->ch, crq->protocol, 0, 0, 0);
2183         if (!l2)
2184                 return -ENOMEM;
2185         crq->ch = &l2->ch;
2186         crq->protocol = ISDN_P_B_HDLC;
2187         return 0;
2188 }
2189
2190 static struct Bprotocol X75SLP = {
2191         .Bprotocols = (1 << (ISDN_P_B_X75SLP & ISDN_P_B_MASK)),
2192         .name = "X75SLP",
2193         .create = x75create
2194 };
2195
2196 int
2197 Isdnl2_Init(u_int *deb)
2198 {
2199         debug = deb;
2200         mISDN_register_Bprotocol(&X75SLP);
2201         l2fsm.state_count = L2_STATE_COUNT;
2202         l2fsm.event_count = L2_EVENT_COUNT;
2203         l2fsm.strEvent = strL2Event;
2204         l2fsm.strState = strL2State;
2205         mISDN_FsmNew(&l2fsm, L2FnList, ARRAY_SIZE(L2FnList));
2206         TEIInit(deb);
2207         return 0;
2208 }
2209
2210 void
2211 Isdnl2_cleanup(void)
2212 {
2213         mISDN_unregister_Bprotocol(&X75SLP);
2214         TEIFree();
2215         mISDN_FsmFree(&l2fsm);
2216 }
2217