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 #include "layer2.h" 18 #include <linux/random.h> 19 #include "core.h" 20 21 #define ID_REQUEST 1 22 #define ID_ASSIGNED 2 23 #define ID_DENIED 3 24 #define ID_CHK_REQ 4 25 #define ID_CHK_RES 5 26 #define ID_REMOVE 6 27 #define ID_VERIFY 7 28 29 #define TEI_ENTITY_ID 0xf 30 31 #define MGR_PH_ACTIVE 16 32 #define MGR_PH_NOTREADY 17 33 34 #define DATIMER_VAL 10000 35 36 static u_int *debug; 37 38 static struct Fsm deactfsm = {NULL, 0, 0, NULL, NULL}; 39 static struct Fsm teifsmu = {NULL, 0, 0, NULL, NULL}; 40 static struct Fsm teifsmn = {NULL, 0, 0, NULL, NULL}; 41 42 enum { 43 ST_L1_DEACT, 44 ST_L1_DEACT_PENDING, 45 ST_L1_ACTIV, 46 }; 47 #define DEACT_STATE_COUNT (ST_L1_ACTIV+1) 48 49 static char *strDeactState[] = 50 { 51 "ST_L1_DEACT", 52 "ST_L1_DEACT_PENDING", 53 "ST_L1_ACTIV", 54 }; 55 56 enum { 57 EV_ACTIVATE, 58 EV_ACTIVATE_IND, 59 EV_DEACTIVATE, 60 EV_DEACTIVATE_IND, 61 EV_UI, 62 EV_DATIMER, 63 }; 64 65 #define DEACT_EVENT_COUNT (EV_DATIMER+1) 66 67 static char *strDeactEvent[] = 68 { 69 "EV_ACTIVATE", 70 "EV_ACTIVATE_IND", 71 "EV_DEACTIVATE", 72 "EV_DEACTIVATE_IND", 73 "EV_UI", 74 "EV_DATIMER", 75 }; 76 77 static void 78 da_debug(struct FsmInst *fi, char *fmt, ...) 79 { 80 struct manager *mgr = fi->userdata; 81 va_list va; 82 83 if (!(*debug & DEBUG_L2_TEIFSM)) 84 return; 85 va_start(va, fmt); 86 printk(KERN_DEBUG "mgr(%d): ", mgr->ch.st->dev->id); 87 vprintk(fmt, va); 88 printk("\n"); 89 va_end(va); 90 } 91 92 static void 93 da_activate(struct FsmInst *fi, int event, void *arg) 94 { 95 struct manager *mgr = fi->userdata; 96 97 if (fi->state == ST_L1_DEACT_PENDING) 98 mISDN_FsmDelTimer(&mgr->datimer, 1); 99 mISDN_FsmChangeState(fi, ST_L1_ACTIV); 100 } 101 102 static void 103 da_deactivate_ind(struct FsmInst *fi, int event, void *arg) 104 { 105 mISDN_FsmChangeState(fi, ST_L1_DEACT); 106 } 107 108 static void 109 da_deactivate(struct FsmInst *fi, int event, void *arg) 110 { 111 struct manager *mgr = fi->userdata; 112 struct layer2 *l2; 113 u_long flags; 114 115 read_lock_irqsave(&mgr->lock, flags); 116 list_for_each_entry(l2, &mgr->layer2, list) { 117 if (l2->l2m.state > ST_L2_4) { 118 /* have still activ TEI */ 119 read_unlock_irqrestore(&mgr->lock, flags); 120 return; 121 } 122 } 123 read_unlock_irqrestore(&mgr->lock, flags); 124 /* All TEI are inactiv */ 125 mISDN_FsmAddTimer(&mgr->datimer, DATIMER_VAL, EV_DATIMER, NULL, 1); 126 mISDN_FsmChangeState(fi, ST_L1_DEACT_PENDING); 127 } 128 129 static void 130 da_ui(struct FsmInst *fi, int event, void *arg) 131 { 132 struct manager *mgr = fi->userdata; 133 134 /* restart da timer */ 135 mISDN_FsmDelTimer(&mgr->datimer, 2); 136 mISDN_FsmAddTimer(&mgr->datimer, DATIMER_VAL, EV_DATIMER, NULL, 2); 137 138 } 139 140 static void 141 da_timer(struct FsmInst *fi, int event, void *arg) 142 { 143 struct manager *mgr = fi->userdata; 144 struct layer2 *l2; 145 u_long flags; 146 147 /* check again */ 148 read_lock_irqsave(&mgr->lock, flags); 149 list_for_each_entry(l2, &mgr->layer2, list) { 150 if (l2->l2m.state > ST_L2_4) { 151 /* have still activ TEI */ 152 read_unlock_irqrestore(&mgr->lock, flags); 153 mISDN_FsmChangeState(fi, ST_L1_ACTIV); 154 return; 155 } 156 } 157 read_unlock_irqrestore(&mgr->lock, flags); 158 /* All TEI are inactiv */ 159 mISDN_FsmChangeState(fi, ST_L1_DEACT); 160 _queue_data(&mgr->ch, PH_DEACTIVATE_REQ, MISDN_ID_ANY, 0, NULL, 161 GFP_ATOMIC); 162 } 163 164 static struct FsmNode DeactFnList[] = 165 { 166 {ST_L1_DEACT, EV_ACTIVATE_IND, da_activate}, 167 {ST_L1_ACTIV, EV_DEACTIVATE_IND, da_deactivate_ind}, 168 {ST_L1_ACTIV, EV_DEACTIVATE, da_deactivate}, 169 {ST_L1_DEACT_PENDING, EV_ACTIVATE, da_activate}, 170 {ST_L1_DEACT_PENDING, EV_UI, da_ui}, 171 {ST_L1_DEACT_PENDING, EV_DATIMER, da_timer}, 172 }; 173 174 enum { 175 ST_TEI_NOP, 176 ST_TEI_IDREQ, 177 ST_TEI_IDVERIFY, 178 }; 179 180 #define TEI_STATE_COUNT (ST_TEI_IDVERIFY+1) 181 182 static char *strTeiState[] = 183 { 184 "ST_TEI_NOP", 185 "ST_TEI_IDREQ", 186 "ST_TEI_IDVERIFY", 187 }; 188 189 enum { 190 EV_IDREQ, 191 EV_ASSIGN, 192 EV_ASSIGN_REQ, 193 EV_DENIED, 194 EV_CHKREQ, 195 EV_CHKRESP, 196 EV_REMOVE, 197 EV_VERIFY, 198 EV_TIMER, 199 }; 200 201 #define TEI_EVENT_COUNT (EV_TIMER+1) 202 203 static char *strTeiEvent[] = 204 { 205 "EV_IDREQ", 206 "EV_ASSIGN", 207 "EV_ASSIGN_REQ", 208 "EV_DENIED", 209 "EV_CHKREQ", 210 "EV_CHKRESP", 211 "EV_REMOVE", 212 "EV_VERIFY", 213 "EV_TIMER", 214 }; 215 216 static void 217 tei_debug(struct FsmInst *fi, char *fmt, ...) 218 { 219 struct teimgr *tm = fi->userdata; 220 va_list va; 221 222 if (!(*debug & DEBUG_L2_TEIFSM)) 223 return; 224 va_start(va, fmt); 225 printk(KERN_DEBUG "tei(%d): ", tm->l2->tei); 226 vprintk(fmt, va); 227 printk("\n"); 228 va_end(va); 229 } 230 231 232 233 static int 234 get_free_id(struct manager *mgr) 235 { 236 u64 ids = 0; 237 int i; 238 struct layer2 *l2; 239 240 list_for_each_entry(l2, &mgr->layer2, list) { 241 if (l2->ch.nr > 63) { 242 printk(KERN_WARNING 243 "%s: more as 63 layer2 for one device\n", 244 __func__); 245 return -EBUSY; 246 } 247 test_and_set_bit(l2->ch.nr, (u_long *)&ids); 248 } 249 for (i = 1; i < 64; i++) 250 if (!test_bit(i, (u_long *)&ids)) 251 return i; 252 printk(KERN_WARNING "%s: more as 63 layer2 for one device\n", 253 __func__); 254 return -EBUSY; 255 } 256 257 static int 258 get_free_tei(struct manager *mgr) 259 { 260 u64 ids = 0; 261 int i; 262 struct layer2 *l2; 263 264 list_for_each_entry(l2, &mgr->layer2, list) { 265 if (l2->ch.nr == 0) 266 continue; 267 if ((l2->ch.addr & 0xff) != 0) 268 continue; 269 i = l2->ch.addr >> 8; 270 if (i < 64) 271 continue; 272 i -= 64; 273 274 test_and_set_bit(i, (u_long *)&ids); 275 } 276 for (i = 0; i < 64; i++) 277 if (!test_bit(i, (u_long *)&ids)) 278 return i + 64; 279 printk(KERN_WARNING "%s: more as 63 dynamic tei for one device\n", 280 __func__); 281 return -1; 282 } 283 284 static void 285 teiup_create(struct manager *mgr, u_int prim, int len, void *arg) 286 { 287 struct sk_buff *skb; 288 struct mISDNhead *hh; 289 int err; 290 291 skb = mI_alloc_skb(len, GFP_ATOMIC); 292 if (!skb) 293 return; 294 hh = mISDN_HEAD_P(skb); 295 hh->prim = prim; 296 hh->id = (mgr->ch.nr << 16) | mgr->ch.addr; 297 if (len) 298 memcpy(skb_put(skb, len), arg, len); 299 err = mgr->up->send(mgr->up, skb); 300 if (err) { 301 printk(KERN_WARNING "%s: err=%d\n", __func__, err); 302 dev_kfree_skb(skb); 303 } 304 } 305 306 static u_int 307 new_id(struct manager *mgr) 308 { 309 u_int id; 310 311 id = mgr->nextid++; 312 if (id == 0x7fff) 313 mgr->nextid = 1; 314 id <<= 16; 315 id |= GROUP_TEI << 8; 316 id |= TEI_SAPI; 317 return id; 318 } 319 320 static void 321 do_send(struct manager *mgr) 322 { 323 if (!test_bit(MGR_PH_ACTIVE, &mgr->options)) 324 return; 325 326 if (!test_and_set_bit(MGR_PH_NOTREADY, &mgr->options)) { 327 struct sk_buff *skb = skb_dequeue(&mgr->sendq); 328 329 if (!skb) { 330 test_and_clear_bit(MGR_PH_NOTREADY, &mgr->options); 331 return; 332 } 333 mgr->lastid = mISDN_HEAD_ID(skb); 334 mISDN_FsmEvent(&mgr->deact, EV_UI, NULL); 335 if (mgr->ch.recv(mgr->ch.peer, skb)) { 336 dev_kfree_skb(skb); 337 test_and_clear_bit(MGR_PH_NOTREADY, &mgr->options); 338 mgr->lastid = MISDN_ID_NONE; 339 } 340 } 341 } 342 343 static void 344 do_ack(struct manager *mgr, u_int id) 345 { 346 if (test_bit(MGR_PH_NOTREADY, &mgr->options)) { 347 if (id == mgr->lastid) { 348 if (test_bit(MGR_PH_ACTIVE, &mgr->options)) { 349 struct sk_buff *skb; 350 351 skb = skb_dequeue(&mgr->sendq); 352 if (skb) { 353 mgr->lastid = mISDN_HEAD_ID(skb); 354 if (!mgr->ch.recv(mgr->ch.peer, skb)) 355 return; 356 dev_kfree_skb(skb); 357 } 358 } 359 mgr->lastid = MISDN_ID_NONE; 360 test_and_clear_bit(MGR_PH_NOTREADY, &mgr->options); 361 } 362 } 363 } 364 365 static void 366 mgr_send_down(struct manager *mgr, struct sk_buff *skb) 367 { 368 skb_queue_tail(&mgr->sendq, skb); 369 if (!test_bit(MGR_PH_ACTIVE, &mgr->options)) { 370 _queue_data(&mgr->ch, PH_ACTIVATE_REQ, MISDN_ID_ANY, 0, 371 NULL, GFP_KERNEL); 372 } else { 373 do_send(mgr); 374 } 375 } 376 377 static int 378 dl_unit_data(struct manager *mgr, struct sk_buff *skb) 379 { 380 if (!test_bit(MGR_OPT_NETWORK, &mgr->options)) /* only net send UI */ 381 return -EINVAL; 382 if (!test_bit(MGR_PH_ACTIVE, &mgr->options)) 383 _queue_data(&mgr->ch, PH_ACTIVATE_REQ, MISDN_ID_ANY, 0, 384 NULL, GFP_KERNEL); 385 skb_push(skb, 3); 386 skb->data[0] = 0x02; /* SAPI 0 C/R = 1 */ 387 skb->data[1] = 0xff; /* TEI 127 */ 388 skb->data[2] = UI; /* UI frame */ 389 mISDN_HEAD_PRIM(skb) = PH_DATA_REQ; 390 mISDN_HEAD_ID(skb) = new_id(mgr); 391 skb_queue_tail(&mgr->sendq, skb); 392 do_send(mgr); 393 return 0; 394 } 395 396 static unsigned int 397 random_ri(void) 398 { 399 u16 x; 400 401 get_random_bytes(&x, sizeof(x)); 402 return x; 403 } 404 405 static struct layer2 * 406 findtei(struct manager *mgr, int tei) 407 { 408 struct layer2 *l2; 409 u_long flags; 410 411 read_lock_irqsave(&mgr->lock, flags); 412 list_for_each_entry(l2, &mgr->layer2, list) { 413 if ((l2->sapi == 0) && (l2->tei > 0) && 414 (l2->tei != GROUP_TEI) && (l2->tei == tei)) 415 goto done; 416 } 417 l2 = NULL; 418 done: 419 read_unlock_irqrestore(&mgr->lock, flags); 420 return l2; 421 } 422 423 static void 424 put_tei_msg(struct manager *mgr, u_char m_id, unsigned int ri, u_char tei) 425 { 426 struct sk_buff *skb; 427 u_char bp[8]; 428 429 bp[0] = (TEI_SAPI << 2); 430 if (test_bit(MGR_OPT_NETWORK, &mgr->options)) 431 bp[0] |= 2; /* CR:=1 for net command */ 432 bp[1] = (GROUP_TEI << 1) | 0x1; 433 bp[2] = UI; 434 bp[3] = TEI_ENTITY_ID; 435 bp[4] = ri >> 8; 436 bp[5] = ri & 0xff; 437 bp[6] = m_id; 438 bp[7] = (tei << 1) | 1; 439 skb = _alloc_mISDN_skb(PH_DATA_REQ, new_id(mgr), 440 8, bp, GFP_ATOMIC); 441 if (!skb) { 442 printk(KERN_WARNING "%s: no skb for tei msg\n", __func__); 443 return; 444 } 445 mgr_send_down(mgr, skb); 446 } 447 448 static void 449 tei_id_request(struct FsmInst *fi, int event, void *arg) 450 { 451 struct teimgr *tm = fi->userdata; 452 453 if (tm->l2->tei != GROUP_TEI) { 454 tm->tei_m.printdebug(&tm->tei_m, 455 "assign request for allready assigned tei %d", 456 tm->l2->tei); 457 return; 458 } 459 tm->ri = random_ri(); 460 if (*debug & DEBUG_L2_TEI) 461 tm->tei_m.printdebug(&tm->tei_m, 462 "assign request ri %d", tm->ri); 463 put_tei_msg(tm->mgr, ID_REQUEST, tm->ri, GROUP_TEI); 464 mISDN_FsmChangeState(fi, ST_TEI_IDREQ); 465 mISDN_FsmAddTimer(&tm->timer, tm->tval, EV_TIMER, NULL, 1); 466 tm->nval = 3; 467 } 468 469 static void 470 tei_id_assign(struct FsmInst *fi, int event, void *arg) 471 { 472 struct teimgr *tm = fi->userdata; 473 struct layer2 *l2; 474 u_char *dp = arg; 475 int ri, tei; 476 477 ri = ((unsigned int) *dp++ << 8); 478 ri += *dp++; 479 dp++; 480 tei = *dp >> 1; 481 if (*debug & DEBUG_L2_TEI) 482 tm->tei_m.printdebug(fi, "identity assign ri %d tei %d", 483 ri, tei); 484 l2 = findtei(tm->mgr, tei); 485 if (l2) { /* same tei is in use */ 486 if (ri != l2->tm->ri) { 487 tm->tei_m.printdebug(fi, 488 "possible duplicate assignment tei %d", tei); 489 tei_l2(l2, MDL_ERROR_RSP, 0); 490 } 491 } else if (ri == tm->ri) { 492 mISDN_FsmDelTimer(&tm->timer, 1); 493 mISDN_FsmChangeState(fi, ST_TEI_NOP); 494 tei_l2(tm->l2, MDL_ASSIGN_REQ, tei); 495 } 496 } 497 498 static void 499 tei_id_test_dup(struct FsmInst *fi, int event, void *arg) 500 { 501 struct teimgr *tm = fi->userdata; 502 struct layer2 *l2; 503 u_char *dp = arg; 504 int tei, ri; 505 506 ri = ((unsigned int) *dp++ << 8); 507 ri += *dp++; 508 dp++; 509 tei = *dp >> 1; 510 if (*debug & DEBUG_L2_TEI) 511 tm->tei_m.printdebug(fi, "foreign identity assign ri %d tei %d", 512 ri, tei); 513 l2 = findtei(tm->mgr, tei); 514 if (l2) { /* same tei is in use */ 515 if (ri != l2->tm->ri) { /* and it wasn't our request */ 516 tm->tei_m.printdebug(fi, 517 "possible duplicate assignment tei %d", tei); 518 mISDN_FsmEvent(&l2->tm->tei_m, EV_VERIFY, NULL); 519 } 520 } 521 } 522 523 static void 524 tei_id_denied(struct FsmInst *fi, int event, void *arg) 525 { 526 struct teimgr *tm = fi->userdata; 527 u_char *dp = arg; 528 int ri, tei; 529 530 ri = ((unsigned int) *dp++ << 8); 531 ri += *dp++; 532 dp++; 533 tei = *dp >> 1; 534 if (*debug & DEBUG_L2_TEI) 535 tm->tei_m.printdebug(fi, "identity denied ri %d tei %d", 536 ri, tei); 537 } 538 539 static void 540 tei_id_chk_req(struct FsmInst *fi, int event, void *arg) 541 { 542 struct teimgr *tm = fi->userdata; 543 u_char *dp = arg; 544 int tei; 545 546 tei = *(dp+3) >> 1; 547 if (*debug & DEBUG_L2_TEI) 548 tm->tei_m.printdebug(fi, "identity check req tei %d", tei); 549 if ((tm->l2->tei != GROUP_TEI) && ((tei == GROUP_TEI) || 550 (tei == tm->l2->tei))) { 551 mISDN_FsmDelTimer(&tm->timer, 4); 552 mISDN_FsmChangeState(&tm->tei_m, ST_TEI_NOP); 553 put_tei_msg(tm->mgr, ID_CHK_RES, random_ri(), tm->l2->tei); 554 } 555 } 556 557 static void 558 tei_id_remove(struct FsmInst *fi, int event, void *arg) 559 { 560 struct teimgr *tm = fi->userdata; 561 u_char *dp = arg; 562 int tei; 563 564 tei = *(dp+3) >> 1; 565 if (*debug & DEBUG_L2_TEI) 566 tm->tei_m.printdebug(fi, "identity remove tei %d", tei); 567 if ((tm->l2->tei != GROUP_TEI) && 568 ((tei == GROUP_TEI) || (tei == tm->l2->tei))) { 569 mISDN_FsmDelTimer(&tm->timer, 5); 570 mISDN_FsmChangeState(&tm->tei_m, ST_TEI_NOP); 571 tei_l2(tm->l2, MDL_REMOVE_REQ, 0); 572 } 573 } 574 575 static void 576 tei_id_verify(struct FsmInst *fi, int event, void *arg) 577 { 578 struct teimgr *tm = fi->userdata; 579 580 if (*debug & DEBUG_L2_TEI) 581 tm->tei_m.printdebug(fi, "id verify request for tei %d", 582 tm->l2->tei); 583 put_tei_msg(tm->mgr, ID_VERIFY, 0, tm->l2->tei); 584 mISDN_FsmChangeState(&tm->tei_m, ST_TEI_IDVERIFY); 585 mISDN_FsmAddTimer(&tm->timer, tm->tval, EV_TIMER, NULL, 2); 586 tm->nval = 2; 587 } 588 589 static void 590 tei_id_req_tout(struct FsmInst *fi, int event, void *arg) 591 { 592 struct teimgr *tm = fi->userdata; 593 594 if (--tm->nval) { 595 tm->ri = random_ri(); 596 if (*debug & DEBUG_L2_TEI) 597 tm->tei_m.printdebug(fi, "assign req(%d) ri %d", 598 4 - tm->nval, tm->ri); 599 put_tei_msg(tm->mgr, ID_REQUEST, tm->ri, GROUP_TEI); 600 mISDN_FsmAddTimer(&tm->timer, tm->tval, EV_TIMER, NULL, 3); 601 } else { 602 tm->tei_m.printdebug(fi, "assign req failed"); 603 tei_l2(tm->l2, MDL_ERROR_RSP, 0); 604 mISDN_FsmChangeState(fi, ST_TEI_NOP); 605 } 606 } 607 608 static void 609 tei_id_ver_tout(struct FsmInst *fi, int event, void *arg) 610 { 611 struct teimgr *tm = fi->userdata; 612 613 if (--tm->nval) { 614 if (*debug & DEBUG_L2_TEI) 615 tm->tei_m.printdebug(fi, 616 "id verify req(%d) for tei %d", 617 3 - tm->nval, tm->l2->tei); 618 put_tei_msg(tm->mgr, ID_VERIFY, 0, tm->l2->tei); 619 mISDN_FsmAddTimer(&tm->timer, tm->tval, EV_TIMER, NULL, 4); 620 } else { 621 tm->tei_m.printdebug(fi, "verify req for tei %d failed", 622 tm->l2->tei); 623 tei_l2(tm->l2, MDL_REMOVE_REQ, 0); 624 mISDN_FsmChangeState(fi, ST_TEI_NOP); 625 } 626 } 627 628 static struct FsmNode TeiFnListUser[] = 629 { 630 {ST_TEI_NOP, EV_IDREQ, tei_id_request}, 631 {ST_TEI_NOP, EV_ASSIGN, tei_id_test_dup}, 632 {ST_TEI_NOP, EV_VERIFY, tei_id_verify}, 633 {ST_TEI_NOP, EV_REMOVE, tei_id_remove}, 634 {ST_TEI_NOP, EV_CHKREQ, tei_id_chk_req}, 635 {ST_TEI_IDREQ, EV_TIMER, tei_id_req_tout}, 636 {ST_TEI_IDREQ, EV_ASSIGN, tei_id_assign}, 637 {ST_TEI_IDREQ, EV_DENIED, tei_id_denied}, 638 {ST_TEI_IDVERIFY, EV_TIMER, tei_id_ver_tout}, 639 {ST_TEI_IDVERIFY, EV_REMOVE, tei_id_remove}, 640 {ST_TEI_IDVERIFY, EV_CHKREQ, tei_id_chk_req}, 641 }; 642 643 static void 644 tei_l2remove(struct layer2 *l2) 645 { 646 put_tei_msg(l2->tm->mgr, ID_REMOVE, 0, l2->tei); 647 tei_l2(l2, MDL_REMOVE_REQ, 0); 648 list_del(&l2->ch.list); 649 l2->ch.ctrl(&l2->ch, CLOSE_CHANNEL, NULL); 650 } 651 652 static void 653 tei_assign_req(struct FsmInst *fi, int event, void *arg) 654 { 655 struct teimgr *tm = fi->userdata; 656 u_char *dp = arg; 657 658 if (tm->l2->tei == GROUP_TEI) { 659 tm->tei_m.printdebug(&tm->tei_m, 660 "net tei assign request without tei"); 661 return; 662 } 663 tm->ri = ((unsigned int) *dp++ << 8); 664 tm->ri += *dp++; 665 if (*debug & DEBUG_L2_TEI) 666 tm->tei_m.printdebug(&tm->tei_m, 667 "net assign request ri %d teim %d", tm->ri, *dp); 668 put_tei_msg(tm->mgr, ID_ASSIGNED, tm->ri, tm->l2->tei); 669 mISDN_FsmChangeState(fi, ST_TEI_NOP); 670 } 671 672 static void 673 tei_id_chk_req_net(struct FsmInst *fi, int event, void *arg) 674 { 675 struct teimgr *tm = fi->userdata; 676 677 if (*debug & DEBUG_L2_TEI) 678 tm->tei_m.printdebug(fi, "id check request for tei %d", 679 tm->l2->tei); 680 tm->rcnt = 0; 681 put_tei_msg(tm->mgr, ID_CHK_REQ, 0, tm->l2->tei); 682 mISDN_FsmChangeState(&tm->tei_m, ST_TEI_IDVERIFY); 683 mISDN_FsmAddTimer(&tm->timer, tm->tval, EV_TIMER, NULL, 2); 684 tm->nval = 2; 685 } 686 687 static void 688 tei_id_chk_resp(struct FsmInst *fi, int event, void *arg) 689 { 690 struct teimgr *tm = fi->userdata; 691 u_char *dp = arg; 692 int tei; 693 694 tei = dp[3] >> 1; 695 if (*debug & DEBUG_L2_TEI) 696 tm->tei_m.printdebug(fi, "identity check resp tei %d", tei); 697 if (tei == tm->l2->tei) 698 tm->rcnt++; 699 } 700 701 static void 702 tei_id_verify_net(struct FsmInst *fi, int event, void *arg) 703 { 704 struct teimgr *tm = fi->userdata; 705 u_char *dp = arg; 706 int tei; 707 708 tei = dp[3] >> 1; 709 if (*debug & DEBUG_L2_TEI) 710 tm->tei_m.printdebug(fi, "identity verify req tei %d/%d", 711 tei, tm->l2->tei); 712 if (tei == tm->l2->tei) 713 tei_id_chk_req_net(fi, event, arg); 714 } 715 716 static void 717 tei_id_ver_tout_net(struct FsmInst *fi, int event, void *arg) 718 { 719 struct teimgr *tm = fi->userdata; 720 721 if (tm->rcnt == 1) { 722 if (*debug & DEBUG_L2_TEI) 723 tm->tei_m.printdebug(fi, 724 "check req for tei %d sucessful\n", tm->l2->tei); 725 mISDN_FsmChangeState(fi, ST_TEI_NOP); 726 } else if (tm->rcnt > 1) { 727 /* duplicate assignment; remove */ 728 tei_l2remove(tm->l2); 729 } else if (--tm->nval) { 730 if (*debug & DEBUG_L2_TEI) 731 tm->tei_m.printdebug(fi, 732 "id check req(%d) for tei %d", 733 3 - tm->nval, tm->l2->tei); 734 put_tei_msg(tm->mgr, ID_CHK_REQ, 0, tm->l2->tei); 735 mISDN_FsmAddTimer(&tm->timer, tm->tval, EV_TIMER, NULL, 4); 736 } else { 737 tm->tei_m.printdebug(fi, "check req for tei %d failed", 738 tm->l2->tei); 739 mISDN_FsmChangeState(fi, ST_TEI_NOP); 740 tei_l2remove(tm->l2); 741 } 742 } 743 744 static struct FsmNode TeiFnListNet[] = 745 { 746 {ST_TEI_NOP, EV_ASSIGN_REQ, tei_assign_req}, 747 {ST_TEI_NOP, EV_VERIFY, tei_id_verify_net}, 748 {ST_TEI_NOP, EV_CHKREQ, tei_id_chk_req_net}, 749 {ST_TEI_IDVERIFY, EV_TIMER, tei_id_ver_tout_net}, 750 {ST_TEI_IDVERIFY, EV_CHKRESP, tei_id_chk_resp}, 751 }; 752 753 static void 754 tei_ph_data_ind(struct teimgr *tm, u_int mt, u_char *dp, int len) 755 { 756 if (test_bit(FLG_FIXED_TEI, &tm->l2->flag)) 757 return; 758 if (*debug & DEBUG_L2_TEI) 759 tm->tei_m.printdebug(&tm->tei_m, "tei handler mt %x", mt); 760 if (mt == ID_ASSIGNED) 761 mISDN_FsmEvent(&tm->tei_m, EV_ASSIGN, dp); 762 else if (mt == ID_DENIED) 763 mISDN_FsmEvent(&tm->tei_m, EV_DENIED, dp); 764 else if (mt == ID_CHK_REQ) 765 mISDN_FsmEvent(&tm->tei_m, EV_CHKREQ, dp); 766 else if (mt == ID_REMOVE) 767 mISDN_FsmEvent(&tm->tei_m, EV_REMOVE, dp); 768 else if (mt == ID_VERIFY) 769 mISDN_FsmEvent(&tm->tei_m, EV_VERIFY, dp); 770 else if (mt == ID_CHK_RES) 771 mISDN_FsmEvent(&tm->tei_m, EV_CHKRESP, dp); 772 } 773 774 static struct layer2 * 775 create_new_tei(struct manager *mgr, int tei) 776 { 777 u_long opt = 0; 778 u_long flags; 779 int id; 780 struct layer2 *l2; 781 782 if (!mgr->up) 783 return NULL; 784 if (tei < 64) 785 test_and_set_bit(OPTION_L2_FIXEDTEI, &opt); 786 if (mgr->ch.st->dev->Dprotocols 787 & ((1 << ISDN_P_TE_E1) | (1 << ISDN_P_NT_E1))) 788 test_and_set_bit(OPTION_L2_PMX, &opt); 789 l2 = create_l2(mgr->up, ISDN_P_LAPD_NT, (u_int)opt, (u_long)tei); 790 if (!l2) { 791 printk(KERN_WARNING "%s:no memory for layer2\n", __func__); 792 return NULL; 793 } 794 l2->tm = kzalloc(sizeof(struct teimgr), GFP_KERNEL); 795 if (!l2->tm) { 796 kfree(l2); 797 printk(KERN_WARNING "%s:no memory for teimgr\n", __func__); 798 return NULL; 799 } 800 l2->tm->mgr = mgr; 801 l2->tm->l2 = l2; 802 l2->tm->tei_m.debug = *debug & DEBUG_L2_TEIFSM; 803 l2->tm->tei_m.userdata = l2->tm; 804 l2->tm->tei_m.printdebug = tei_debug; 805 l2->tm->tei_m.fsm = &teifsmn; 806 l2->tm->tei_m.state = ST_TEI_NOP; 807 l2->tm->tval = 2000; /* T202 2 sec */ 808 mISDN_FsmInitTimer(&l2->tm->tei_m, &l2->tm->timer); 809 write_lock_irqsave(&mgr->lock, flags); 810 id = get_free_id(mgr); 811 list_add_tail(&l2->list, &mgr->layer2); 812 write_unlock_irqrestore(&mgr->lock, flags); 813 if (id < 0) { 814 l2->ch.ctrl(&l2->ch, CLOSE_CHANNEL, NULL); 815 printk(KERN_WARNING "%s:no free id\n", __func__); 816 return NULL; 817 } else { 818 l2->ch.nr = id; 819 __add_layer2(&l2->ch, mgr->ch.st); 820 l2->ch.recv = mgr->ch.recv; 821 l2->ch.peer = mgr->ch.peer; 822 l2->ch.ctrl(&l2->ch, OPEN_CHANNEL, NULL); 823 } 824 return l2; 825 } 826 827 static void 828 new_tei_req(struct manager *mgr, u_char *dp) 829 { 830 int tei, ri; 831 struct layer2 *l2; 832 833 ri = dp[0] << 8; 834 ri += dp[1]; 835 if (!mgr->up) 836 goto denied; 837 tei = get_free_tei(mgr); 838 if (tei < 0) { 839 printk(KERN_WARNING "%s:No free tei\n", __func__); 840 goto denied; 841 } 842 l2 = create_new_tei(mgr, tei); 843 if (!l2) 844 goto denied; 845 else 846 mISDN_FsmEvent(&l2->tm->tei_m, EV_ASSIGN_REQ, dp); 847 return; 848 denied: 849 put_tei_msg(mgr, ID_DENIED, ri, GROUP_TEI); 850 } 851 852 static int 853 ph_data_ind(struct manager *mgr, struct sk_buff *skb) 854 { 855 int ret = -EINVAL; 856 struct layer2 *l2; 857 u_long flags; 858 u_char mt; 859 860 if (skb->len < 8) { 861 if (*debug & DEBUG_L2_TEI) 862 printk(KERN_DEBUG "%s: short mgr frame %d/8\n", 863 __func__, skb->len); 864 goto done; 865 } 866 if (*debug & DEBUG_L2_TEI) 867 868 if ((skb->data[0] >> 2) != TEI_SAPI) /* not for us */ 869 goto done; 870 if (skb->data[0] & 1) /* EA0 formal error */ 871 goto done; 872 if (!(skb->data[1] & 1)) /* EA1 formal error */ 873 goto done; 874 if ((skb->data[1] >> 1) != GROUP_TEI) /* not for us */ 875 goto done; 876 if ((skb->data[2] & 0xef) != UI) /* not UI */ 877 goto done; 878 if (skb->data[3] != TEI_ENTITY_ID) /* not tei entity */ 879 goto done; 880 mt = skb->data[6]; 881 switch (mt) { 882 case ID_REQUEST: 883 case ID_CHK_RES: 884 case ID_VERIFY: 885 if (!test_bit(MGR_OPT_NETWORK, &mgr->options)) 886 goto done; 887 break; 888 case ID_ASSIGNED: 889 case ID_DENIED: 890 case ID_CHK_REQ: 891 case ID_REMOVE: 892 if (test_bit(MGR_OPT_NETWORK, &mgr->options)) 893 goto done; 894 break; 895 default: 896 goto done; 897 } 898 ret = 0; 899 if (mt == ID_REQUEST) { 900 new_tei_req(mgr, &skb->data[4]); 901 goto done; 902 } 903 read_lock_irqsave(&mgr->lock, flags); 904 list_for_each_entry(l2, &mgr->layer2, list) { 905 tei_ph_data_ind(l2->tm, mt, &skb->data[4], skb->len - 4); 906 } 907 read_unlock_irqrestore(&mgr->lock, flags); 908 done: 909 return ret; 910 } 911 912 int 913 l2_tei(struct layer2 *l2, u_int cmd, u_long arg) 914 { 915 struct teimgr *tm = l2->tm; 916 917 if (test_bit(FLG_FIXED_TEI, &l2->flag)) 918 return 0; 919 if (*debug & DEBUG_L2_TEI) 920 printk(KERN_DEBUG "%s: cmd(%x)\n", __func__, cmd); 921 switch (cmd) { 922 case MDL_ASSIGN_IND: 923 mISDN_FsmEvent(&tm->tei_m, EV_IDREQ, NULL); 924 break; 925 case MDL_ERROR_IND: 926 if (test_bit(MGR_OPT_NETWORK, &tm->mgr->options)) 927 mISDN_FsmEvent(&tm->tei_m, EV_CHKREQ, &l2->tei); 928 if (test_bit(MGR_OPT_USER, &tm->mgr->options)) 929 mISDN_FsmEvent(&tm->tei_m, EV_VERIFY, NULL); 930 break; 931 case MDL_STATUS_UP_IND: 932 if (test_bit(MGR_OPT_NETWORK, &tm->mgr->options)) 933 mISDN_FsmEvent(&tm->mgr->deact, EV_ACTIVATE, NULL); 934 break; 935 case MDL_STATUS_DOWN_IND: 936 if (test_bit(MGR_OPT_NETWORK, &tm->mgr->options)) 937 mISDN_FsmEvent(&tm->mgr->deact, EV_DEACTIVATE, NULL); 938 break; 939 case MDL_STATUS_UI_IND: 940 if (test_bit(MGR_OPT_NETWORK, &tm->mgr->options)) 941 mISDN_FsmEvent(&tm->mgr->deact, EV_UI, NULL); 942 break; 943 } 944 return 0; 945 } 946 947 void 948 TEIrelease(struct layer2 *l2) 949 { 950 struct teimgr *tm = l2->tm; 951 u_long flags; 952 953 mISDN_FsmDelTimer(&tm->timer, 1); 954 write_lock_irqsave(&tm->mgr->lock, flags); 955 list_del(&l2->list); 956 write_unlock_irqrestore(&tm->mgr->lock, flags); 957 l2->tm = NULL; 958 kfree(tm); 959 } 960 961 static int 962 create_teimgr(struct manager *mgr, struct channel_req *crq) 963 { 964 struct layer2 *l2; 965 u_long opt = 0; 966 u_long flags; 967 int id; 968 969 if (*debug & DEBUG_L2_TEI) 970 printk(KERN_DEBUG "%s: %s proto(%x) adr(%d %d %d %d)\n", 971 __func__, dev_name(&mgr->ch.st->dev->dev), 972 crq->protocol, crq->adr.dev, crq->adr.channel, 973 crq->adr.sapi, crq->adr.tei); 974 if (crq->adr.sapi != 0) /* not supported yet */ 975 return -EINVAL; 976 if (crq->adr.tei > GROUP_TEI) 977 return -EINVAL; 978 if (crq->adr.tei < 64) 979 test_and_set_bit(OPTION_L2_FIXEDTEI, &opt); 980 if (crq->adr.tei == 0) 981 test_and_set_bit(OPTION_L2_PTP, &opt); 982 if (test_bit(MGR_OPT_NETWORK, &mgr->options)) { 983 if (crq->protocol == ISDN_P_LAPD_TE) 984 return -EPROTONOSUPPORT; 985 if ((crq->adr.tei != 0) && (crq->adr.tei != 127)) 986 return -EINVAL; 987 if (mgr->up) { 988 printk(KERN_WARNING 989 "%s: only one network manager is allowed\n", 990 __func__); 991 return -EBUSY; 992 } 993 } else if (test_bit(MGR_OPT_USER, &mgr->options)) { 994 if (crq->protocol == ISDN_P_LAPD_NT) 995 return -EPROTONOSUPPORT; 996 if ((crq->adr.tei >= 64) && (crq->adr.tei < GROUP_TEI)) 997 return -EINVAL; /* dyn tei */ 998 } else { 999 if (crq->protocol == ISDN_P_LAPD_NT) 1000 test_and_set_bit(MGR_OPT_NETWORK, &mgr->options); 1001 if (crq->protocol == ISDN_P_LAPD_TE) 1002 test_and_set_bit(MGR_OPT_USER, &mgr->options); 1003 } 1004 if (mgr->ch.st->dev->Dprotocols 1005 & ((1 << ISDN_P_TE_E1) | (1 << ISDN_P_NT_E1))) 1006 test_and_set_bit(OPTION_L2_PMX, &opt); 1007 if ((crq->protocol == ISDN_P_LAPD_NT) && (crq->adr.tei == 127)) { 1008 mgr->up = crq->ch; 1009 id = DL_INFO_L2_CONNECT; 1010 teiup_create(mgr, DL_INFORMATION_IND, sizeof(id), &id); 1011 crq->ch = NULL; 1012 if (!list_empty(&mgr->layer2)) { 1013 read_lock_irqsave(&mgr->lock, flags); 1014 list_for_each_entry(l2, &mgr->layer2, list) { 1015 l2->up = mgr->up; 1016 l2->ch.ctrl(&l2->ch, OPEN_CHANNEL, NULL); 1017 } 1018 read_unlock_irqrestore(&mgr->lock, flags); 1019 } 1020 return 0; 1021 } 1022 l2 = create_l2(crq->ch, crq->protocol, (u_int)opt, 1023 (u_long)crq->adr.tei); 1024 if (!l2) 1025 return -ENOMEM; 1026 l2->tm = kzalloc(sizeof(struct teimgr), GFP_KERNEL); 1027 if (!l2->tm) { 1028 kfree(l2); 1029 printk(KERN_ERR "kmalloc teimgr failed\n"); 1030 return -ENOMEM; 1031 } 1032 l2->tm->mgr = mgr; 1033 l2->tm->l2 = l2; 1034 l2->tm->tei_m.debug = *debug & DEBUG_L2_TEIFSM; 1035 l2->tm->tei_m.userdata = l2->tm; 1036 l2->tm->tei_m.printdebug = tei_debug; 1037 if (crq->protocol == ISDN_P_LAPD_TE) { 1038 l2->tm->tei_m.fsm = &teifsmu; 1039 l2->tm->tei_m.state = ST_TEI_NOP; 1040 l2->tm->tval = 1000; /* T201 1 sec */ 1041 } else { 1042 l2->tm->tei_m.fsm = &teifsmn; 1043 l2->tm->tei_m.state = ST_TEI_NOP; 1044 l2->tm->tval = 2000; /* T202 2 sec */ 1045 } 1046 mISDN_FsmInitTimer(&l2->tm->tei_m, &l2->tm->timer); 1047 write_lock_irqsave(&mgr->lock, flags); 1048 id = get_free_id(mgr); 1049 list_add_tail(&l2->list, &mgr->layer2); 1050 write_unlock_irqrestore(&mgr->lock, flags); 1051 if (id < 0) { 1052 l2->ch.ctrl(&l2->ch, CLOSE_CHANNEL, NULL); 1053 } else { 1054 l2->ch.nr = id; 1055 l2->up->nr = id; 1056 crq->ch = &l2->ch; 1057 id = 0; 1058 } 1059 return id; 1060 } 1061 1062 static int 1063 mgr_send(struct mISDNchannel *ch, struct sk_buff *skb) 1064 { 1065 struct manager *mgr; 1066 struct mISDNhead *hh = mISDN_HEAD_P(skb); 1067 int ret = -EINVAL; 1068 1069 mgr = container_of(ch, struct manager, ch); 1070 if (*debug & DEBUG_L2_RECV) 1071 printk(KERN_DEBUG "%s: prim(%x) id(%x)\n", 1072 __func__, hh->prim, hh->id); 1073 switch (hh->prim) { 1074 case PH_DATA_IND: 1075 mISDN_FsmEvent(&mgr->deact, EV_UI, NULL); 1076 ret = ph_data_ind(mgr, skb); 1077 break; 1078 case PH_DATA_CNF: 1079 do_ack(mgr, hh->id); 1080 ret = 0; 1081 break; 1082 case PH_ACTIVATE_IND: 1083 test_and_set_bit(MGR_PH_ACTIVE, &mgr->options); 1084 mISDN_FsmEvent(&mgr->deact, EV_ACTIVATE_IND, NULL); 1085 do_send(mgr); 1086 ret = 0; 1087 break; 1088 case PH_DEACTIVATE_IND: 1089 test_and_clear_bit(MGR_PH_ACTIVE, &mgr->options); 1090 mISDN_FsmEvent(&mgr->deact, EV_DEACTIVATE_IND, NULL); 1091 ret = 0; 1092 break; 1093 case DL_UNITDATA_REQ: 1094 return dl_unit_data(mgr, skb); 1095 } 1096 if (!ret) 1097 dev_kfree_skb(skb); 1098 return ret; 1099 } 1100 1101 static int 1102 free_teimanager(struct manager *mgr) 1103 { 1104 struct layer2 *l2, *nl2; 1105 1106 if (test_bit(MGR_OPT_NETWORK, &mgr->options)) { 1107 /* not locked lock is taken in release tei */ 1108 mgr->up = NULL; 1109 if (test_bit(OPTION_L2_CLEANUP, &mgr->options)) { 1110 list_for_each_entry_safe(l2, nl2, &mgr->layer2, list) { 1111 put_tei_msg(mgr, ID_REMOVE, 0, l2->tei); 1112 mutex_lock(&mgr->ch.st->lmutex); 1113 list_del(&l2->ch.list); 1114 mutex_unlock(&mgr->ch.st->lmutex); 1115 l2->ch.ctrl(&l2->ch, CLOSE_CHANNEL, NULL); 1116 } 1117 test_and_clear_bit(MGR_OPT_NETWORK, &mgr->options); 1118 } else { 1119 list_for_each_entry_safe(l2, nl2, &mgr->layer2, list) { 1120 l2->up = NULL; 1121 } 1122 } 1123 } 1124 if (test_bit(MGR_OPT_USER, &mgr->options)) { 1125 if (list_empty(&mgr->layer2)) 1126 test_and_clear_bit(MGR_OPT_USER, &mgr->options); 1127 } 1128 mgr->ch.st->dev->D.ctrl(&mgr->ch.st->dev->D, CLOSE_CHANNEL, NULL); 1129 return 0; 1130 } 1131 1132 static int 1133 ctrl_teimanager(struct manager *mgr, void *arg) 1134 { 1135 /* currently we only have one option */ 1136 int clean = *((int *)arg); 1137 1138 if (clean) 1139 test_and_set_bit(OPTION_L2_CLEANUP, &mgr->options); 1140 else 1141 test_and_clear_bit(OPTION_L2_CLEANUP, &mgr->options); 1142 return 0; 1143 } 1144 1145 /* This function does create a L2 for fixed TEI in NT Mode */ 1146 static int 1147 check_data(struct manager *mgr, struct sk_buff *skb) 1148 { 1149 struct mISDNhead *hh = mISDN_HEAD_P(skb); 1150 int ret, tei; 1151 struct layer2 *l2; 1152 1153 if (*debug & DEBUG_L2_CTRL) 1154 printk(KERN_DEBUG "%s: prim(%x) id(%x)\n", 1155 __func__, hh->prim, hh->id); 1156 if (test_bit(MGR_OPT_USER, &mgr->options)) 1157 return -ENOTCONN; 1158 if (hh->prim != PH_DATA_IND) 1159 return -ENOTCONN; 1160 if (skb->len != 3) 1161 return -ENOTCONN; 1162 if (skb->data[0] != 0) 1163 /* only SAPI 0 command */ 1164 return -ENOTCONN; 1165 if (!(skb->data[1] & 1)) /* invalid EA1 */ 1166 return -EINVAL; 1167 tei = skb->data[1] >> 0; 1168 if (tei > 63) /* not a fixed tei */ 1169 return -ENOTCONN; 1170 if ((skb->data[2] & ~0x10) != SABME) 1171 return -ENOTCONN; 1172 /* We got a SABME for a fixed TEI */ 1173 l2 = create_new_tei(mgr, tei); 1174 if (!l2) 1175 return -ENOMEM; 1176 ret = l2->ch.send(&l2->ch, skb); 1177 return ret; 1178 } 1179 1180 void 1181 delete_teimanager(struct mISDNchannel *ch) 1182 { 1183 struct manager *mgr; 1184 struct layer2 *l2, *nl2; 1185 1186 mgr = container_of(ch, struct manager, ch); 1187 /* not locked lock is taken in release tei */ 1188 list_for_each_entry_safe(l2, nl2, &mgr->layer2, list) { 1189 mutex_lock(&mgr->ch.st->lmutex); 1190 list_del(&l2->ch.list); 1191 mutex_unlock(&mgr->ch.st->lmutex); 1192 l2->ch.ctrl(&l2->ch, CLOSE_CHANNEL, NULL); 1193 } 1194 list_del(&mgr->ch.list); 1195 list_del(&mgr->bcast.list); 1196 skb_queue_purge(&mgr->sendq); 1197 kfree(mgr); 1198 } 1199 1200 static int 1201 mgr_ctrl(struct mISDNchannel *ch, u_int cmd, void *arg) 1202 { 1203 struct manager *mgr; 1204 int ret = -EINVAL; 1205 1206 mgr = container_of(ch, struct manager, ch); 1207 if (*debug & DEBUG_L2_CTRL) 1208 printk(KERN_DEBUG "%s(%x, %p)\n", __func__, cmd, arg); 1209 switch (cmd) { 1210 case OPEN_CHANNEL: 1211 ret = create_teimgr(mgr, arg); 1212 break; 1213 case CLOSE_CHANNEL: 1214 ret = free_teimanager(mgr); 1215 break; 1216 case CONTROL_CHANNEL: 1217 ret = ctrl_teimanager(mgr, arg); 1218 break; 1219 case CHECK_DATA: 1220 ret = check_data(mgr, arg); 1221 break; 1222 } 1223 return ret; 1224 } 1225 1226 static int 1227 mgr_bcast(struct mISDNchannel *ch, struct sk_buff *skb) 1228 { 1229 struct manager *mgr = container_of(ch, struct manager, bcast); 1230 struct mISDNhead *hh = mISDN_HEAD_P(skb); 1231 struct sk_buff *cskb = NULL; 1232 struct layer2 *l2; 1233 u_long flags; 1234 int ret; 1235 1236 read_lock_irqsave(&mgr->lock, flags); 1237 list_for_each_entry(l2, &mgr->layer2, list) { 1238 if ((hh->id & MISDN_ID_SAPI_MASK) == 1239 (l2->ch.addr & MISDN_ID_SAPI_MASK)) { 1240 if (list_is_last(&l2->list, &mgr->layer2)) { 1241 cskb = skb; 1242 skb = NULL; 1243 } else { 1244 if (!cskb) 1245 cskb = skb_copy(skb, GFP_KERNEL); 1246 } 1247 if (cskb) { 1248 ret = l2->ch.send(&l2->ch, cskb); 1249 if (ret) { 1250 if (*debug & DEBUG_SEND_ERR) 1251 printk(KERN_DEBUG 1252 "%s ch%d prim(%x) addr(%x)" 1253 " err %d\n", 1254 __func__, l2->ch.nr, 1255 hh->prim, l2->ch.addr, ret); 1256 } else 1257 cskb = NULL; 1258 } else { 1259 printk(KERN_WARNING "%s ch%d addr %x no mem\n", 1260 __func__, ch->nr, ch->addr); 1261 goto out; 1262 } 1263 } 1264 } 1265 out: 1266 read_unlock_irqrestore(&mgr->lock, flags); 1267 if (cskb) 1268 dev_kfree_skb(cskb); 1269 if (skb) 1270 dev_kfree_skb(skb); 1271 return 0; 1272 } 1273 1274 static int 1275 mgr_bcast_ctrl(struct mISDNchannel *ch, u_int cmd, void *arg) 1276 { 1277 1278 return -EINVAL; 1279 } 1280 1281 int 1282 create_teimanager(struct mISDNdevice *dev) 1283 { 1284 struct manager *mgr; 1285 1286 mgr = kzalloc(sizeof(struct manager), GFP_KERNEL); 1287 if (!mgr) 1288 return -ENOMEM; 1289 INIT_LIST_HEAD(&mgr->layer2); 1290 rwlock_init(&mgr->lock); 1291 skb_queue_head_init(&mgr->sendq); 1292 mgr->nextid = 1; 1293 mgr->lastid = MISDN_ID_NONE; 1294 mgr->ch.send = mgr_send; 1295 mgr->ch.ctrl = mgr_ctrl; 1296 mgr->ch.st = dev->D.st; 1297 set_channel_address(&mgr->ch, TEI_SAPI, GROUP_TEI); 1298 add_layer2(&mgr->ch, dev->D.st); 1299 mgr->bcast.send = mgr_bcast; 1300 mgr->bcast.ctrl = mgr_bcast_ctrl; 1301 mgr->bcast.st = dev->D.st; 1302 set_channel_address(&mgr->bcast, 0, GROUP_TEI); 1303 add_layer2(&mgr->bcast, dev->D.st); 1304 mgr->deact.debug = *debug & DEBUG_MANAGER; 1305 mgr->deact.userdata = mgr; 1306 mgr->deact.printdebug = da_debug; 1307 mgr->deact.fsm = &deactfsm; 1308 mgr->deact.state = ST_L1_DEACT; 1309 mISDN_FsmInitTimer(&mgr->deact, &mgr->datimer); 1310 dev->teimgr = &mgr->ch; 1311 return 0; 1312 } 1313 1314 int TEIInit(u_int *deb) 1315 { 1316 debug = deb; 1317 teifsmu.state_count = TEI_STATE_COUNT; 1318 teifsmu.event_count = TEI_EVENT_COUNT; 1319 teifsmu.strEvent = strTeiEvent; 1320 teifsmu.strState = strTeiState; 1321 mISDN_FsmNew(&teifsmu, TeiFnListUser, ARRAY_SIZE(TeiFnListUser)); 1322 teifsmn.state_count = TEI_STATE_COUNT; 1323 teifsmn.event_count = TEI_EVENT_COUNT; 1324 teifsmn.strEvent = strTeiEvent; 1325 teifsmn.strState = strTeiState; 1326 mISDN_FsmNew(&teifsmn, TeiFnListNet, ARRAY_SIZE(TeiFnListNet)); 1327 deactfsm.state_count = DEACT_STATE_COUNT; 1328 deactfsm.event_count = DEACT_EVENT_COUNT; 1329 deactfsm.strEvent = strDeactEvent; 1330 deactfsm.strState = strDeactState; 1331 mISDN_FsmNew(&deactfsm, DeactFnList, ARRAY_SIZE(DeactFnList)); 1332 return 0; 1333 } 1334 1335 void TEIFree(void) 1336 { 1337 mISDN_FsmFree(&teifsmu); 1338 mISDN_FsmFree(&teifsmn); 1339 mISDN_FsmFree(&deactfsm); 1340 } 1341