kernel/drivers/isdn/mISDN/stack.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/slab.h>
  19 #include <linux/mISDNif.h>
  20 #include <linux/kthread.h>
  21 #include <linux/sched.h>
  22 #include "core.h"
  23
  24 static u_int    *debug;
  25
  26 static inline void
  27 _queue_message(struct mISDNstack *st, struct sk_buff *skb)
  28 {
  29         struct mISDNhead        *hh = mISDN_HEAD_P(skb);
  30
  31         if (*debug & DEBUG_QUEUE_FUNC)
  32                 printk(KERN_DEBUG "%s prim(%x) id(%x) %p\n",
  33                        __func__, hh->prim, hh->id, skb);
  34         skb_queue_tail(&st->msgq, skb);
  35         if (likely(!test_bit(mISDN_STACK_STOPPED, &st->status))) {
  36                 test_and_set_bit(mISDN_STACK_WORK, &st->status);
  37                 wake_up_interruptible(&st->workq);
  38         }
  39 }
  40
  41 static int
  42 mISDN_queue_message(struct mISDNchannel *ch, struct sk_buff *skb)
  43 {
  44         _queue_message(ch->st, skb);
  45         return 0;
  46 }
  47
  48 static struct mISDNchannel *
  49 get_channel4id(struct mISDNstack *st, u_int id)
  50 {
  51         struct mISDNchannel     *ch;
  52
  53         mutex_lock(&st->lmutex);
  54         list_for_each_entry(ch, &st->layer2, list) {
  55                 if (id == ch->nr)
  56                         goto unlock;
  57         }
  58         ch = NULL;
  59 unlock:
  60         mutex_unlock(&st->lmutex);
  61         return ch;
  62 }
  63
  64 static void
  65 send_socklist(struct mISDN_sock_list *sl, struct sk_buff *skb)
  66 {
  67         struct sock             *sk;
  68         struct sk_buff          *cskb = NULL;
  69
  70         read_lock(&sl->lock);
  71         sk_for_each(sk, &sl->head) {
  72                 if (sk->sk_state != MISDN_BOUND)
  73                         continue;
  74                 if (!cskb)
  75                         cskb = skb_copy(skb, GFP_KERNEL);
  76                 if (!cskb) {
  77                         printk(KERN_WARNING "%s no skb\n", __func__);
  78                         break;
  79                 }
  80                 if (!sock_queue_rcv_skb(sk, cskb))
  81                         cskb = NULL;
  82         }
  83         read_unlock(&sl->lock);
  84         if (cskb)
  85                 dev_kfree_skb(cskb);
  86 }
  87
  88 static void
  89 send_layer2(struct mISDNstack *st, struct sk_buff *skb)
  90 {
  91         struct sk_buff          *cskb;
  92         struct mISDNhead        *hh = mISDN_HEAD_P(skb);
  93         struct mISDNchannel     *ch;
  94         int                     ret;
  95
  96         if (!st)
  97                 return;
  98         mutex_lock(&st->lmutex);
  99         if ((hh->id & MISDN_ID_ADDR_MASK) == MISDN_ID_ANY) { /* L2 for all */
 100                 list_for_each_entry(ch, &st->layer2, list) {
 101                         if (list_is_last(&ch->list, &st->layer2)) {
 102                                 cskb = skb;
 103                                 skb = NULL;
 104                         } else {
 105                                 cskb = skb_copy(skb, GFP_KERNEL);
 106                         }
 107                         if (cskb) {
 108                                 ret = ch->send(ch, cskb);
 109                                 if (ret) {
 110                                         if (*debug & DEBUG_SEND_ERR)
 111                                                 printk(KERN_DEBUG
 112                                                        "%s ch%d prim(%x) addr(%x)"
 113                                                        " err %d\n",
 114                                                        __func__, ch->nr,
 115                                                        hh->prim, ch->addr, ret);
 116                                         dev_kfree_skb(cskb);
 117                                 }
 118                         } else {
 119                                 printk(KERN_WARNING "%s ch%d addr %x no mem\n",
 120                                        __func__, ch->nr, ch->addr);
 121                                 goto out;
 122                         }
 123                 }
 124         } else {
 125                 list_for_each_entry(ch, &st->layer2, list) {
 126                         if ((hh->id & MISDN_ID_ADDR_MASK) == ch->addr) {
 127                                 ret = ch->send(ch, skb);
 128                                 if (!ret)
 129                                         skb = NULL;
 130                                 goto out;
 131                         }
 132                 }
 133                 ret = st->dev->teimgr->ctrl(st->dev->teimgr, CHECK_DATA, skb);
 134                 if (!ret)
 135                         skb = NULL;
 136                 else if (*debug & DEBUG_SEND_ERR)
 137                         printk(KERN_DEBUG
 138                                "%s mgr prim(%x) err %d\n",
 139                                __func__, hh->prim, ret);
 140         }
 141 out:
 142         mutex_unlock(&st->lmutex);
 143         if (skb)
 144                 dev_kfree_skb(skb);
 145 }
 146
 147 static inline int
 148 send_msg_to_layer(struct mISDNstack *st, struct sk_buff *skb)
 149 {
 150         struct mISDNhead        *hh = mISDN_HEAD_P(skb);
 151         struct mISDNchannel     *ch;
 152         int     lm;
 153
 154         lm = hh->prim & MISDN_LAYERMASK;
 155         if (*debug & DEBUG_QUEUE_FUNC)
 156                 printk(KERN_DEBUG "%s prim(%x) id(%x) %p\n",
 157                        __func__, hh->prim, hh->id, skb);
 158         if (lm == 0x1) {
 159                 if (!hlist_empty(&st->l1sock.head)) {
 160                         __net_timestamp(skb);
 161                         send_socklist(&st->l1sock, skb);
 162                 }
 163                 return st->layer1->send(st->layer1, skb);
 164         } else if (lm == 0x2) {
 165                 if (!hlist_empty(&st->l1sock.head))
 166                         send_socklist(&st->l1sock, skb);
 167                 send_layer2(st, skb);
 168                 return 0;
 169         } else if (lm == 0x4) {
 170                 ch = get_channel4id(st, hh->id);
 171                 if (ch)
 172                         return ch->send(ch, skb);
 173                 else
 174                         printk(KERN_WARNING
 175                                "%s: dev(%s) prim(%x) id(%x) no channel\n",
 176                                __func__, dev_name(&st->dev->dev), hh->prim,
 177                                hh->id);
 178         } else if (lm == 0x8) {
 179                 WARN_ON(lm == 0x8);
 180                 ch = get_channel4id(st, hh->id);
 181                 if (ch)
 182                         return ch->send(ch, skb);
 183                 else
 184                         printk(KERN_WARNING
 185                                "%s: dev(%s) prim(%x) id(%x) no channel\n",
 186                                __func__, dev_name(&st->dev->dev), hh->prim,
 187                                hh->id);
 188         } else {
 189                 /* broadcast not handled yet */
 190                 printk(KERN_WARNING "%s: dev(%s) prim %x not delivered\n",
 191                        __func__, dev_name(&st->dev->dev), hh->prim);
 192         }
 193         return -ESRCH;
 194 }
 195
 196 static void
 197 do_clear_stack(struct mISDNstack *st)
 198 {
 199 }
 200
 201 static int
 202 mISDNStackd(void *data)
 203 {
 204         struct mISDNstack *st = data;
 205 #ifdef MISDN_MSG_STATS
 206         cputime_t utime, stime;
 207 #endif
 208         int err = 0;
 209
 210         sigfillset(&current->blocked);
 211         if (*debug & DEBUG_MSG_THREAD)
 212                 printk(KERN_DEBUG "mISDNStackd %s started\n",
 213                        dev_name(&st->dev->dev));
 214
 215         if (st->notify != NULL) {
 216                 complete(st->notify);
 217                 st->notify = NULL;
 218         }
 219
 220         for (;;) {
 221                 struct sk_buff  *skb;
 222
 223                 if (unlikely(test_bit(mISDN_STACK_STOPPED, &st->status))) {
 224                         test_and_clear_bit(mISDN_STACK_WORK, &st->status);
 225                         test_and_clear_bit(mISDN_STACK_RUNNING, &st->status);
 226                 } else
 227                         test_and_set_bit(mISDN_STACK_RUNNING, &st->status);
 228                 while (test_bit(mISDN_STACK_WORK, &st->status)) {
 229                         skb = skb_dequeue(&st->msgq);
 230                         if (!skb) {
 231                                 test_and_clear_bit(mISDN_STACK_WORK,
 232                                                    &st->status);
 233                                 /* test if a race happens */
 234                                 skb = skb_dequeue(&st->msgq);
 235                                 if (!skb)
 236                                         continue;
 237                                 test_and_set_bit(mISDN_STACK_WORK,
 238                                                  &st->status);
 239                         }
 240 #ifdef MISDN_MSG_STATS
 241                         st->msg_cnt++;
 242 #endif
 243                         err = send_msg_to_layer(st, skb);
 244                         if (unlikely(err)) {
 245                                 if (*debug & DEBUG_SEND_ERR)
 246                                         printk(KERN_DEBUG
 247                                                "%s: %s prim(%x) id(%x) "
 248                                                "send call(%d)\n",
 249                                                __func__, dev_name(&st->dev->dev),
 250                                                mISDN_HEAD_PRIM(skb),
 251                                                mISDN_HEAD_ID(skb), err);
 252                                 dev_kfree_skb(skb);
 253                                 continue;
 254                         }
 255                         if (unlikely(test_bit(mISDN_STACK_STOPPED,
 256                                               &st->status))) {
 257                                 test_and_clear_bit(mISDN_STACK_WORK,
 258                                                    &st->status);
 259                                 test_and_clear_bit(mISDN_STACK_RUNNING,
 260                                                    &st->status);
 261                                 break;
 262                         }
 263                 }
 264                 if (test_bit(mISDN_STACK_CLEARING, &st->status)) {
 265                         test_and_set_bit(mISDN_STACK_STOPPED, &st->status);
 266                         test_and_clear_bit(mISDN_STACK_RUNNING, &st->status);
 267                         do_clear_stack(st);
 268                         test_and_clear_bit(mISDN_STACK_CLEARING, &st->status);
 269                         test_and_set_bit(mISDN_STACK_RESTART, &st->status);
 270                 }
 271                 if (test_and_clear_bit(mISDN_STACK_RESTART, &st->status)) {
 272                         test_and_clear_bit(mISDN_STACK_STOPPED, &st->status);
 273                         test_and_set_bit(mISDN_STACK_RUNNING, &st->status);
 274                         if (!skb_queue_empty(&st->msgq))
 275                                 test_and_set_bit(mISDN_STACK_WORK,
 276                                                  &st->status);
 277                 }
 278                 if (test_bit(mISDN_STACK_ABORT, &st->status))
 279                         break;
 280                 if (st->notify != NULL) {
 281                         complete(st->notify);
 282                         st->notify = NULL;
 283                 }
 284 #ifdef MISDN_MSG_STATS
 285                 st->sleep_cnt++;
 286 #endif
 287                 test_and_clear_bit(mISDN_STACK_ACTIVE, &st->status);
 288                 wait_event_interruptible(st->workq, (st->status &
 289                                                      mISDN_STACK_ACTION_MASK));
 290                 if (*debug & DEBUG_MSG_THREAD)
 291                         printk(KERN_DEBUG "%s: %s wake status %08lx\n",
 292                                __func__, dev_name(&st->dev->dev), st->status);
 293                 test_and_set_bit(mISDN_STACK_ACTIVE, &st->status);
 294
 295                 test_and_clear_bit(mISDN_STACK_WAKEUP, &st->status);
 296
 297                 if (test_bit(mISDN_STACK_STOPPED, &st->status)) {
 298                         test_and_clear_bit(mISDN_STACK_RUNNING, &st->status);
 299 #ifdef MISDN_MSG_STATS
 300                         st->stopped_cnt++;
 301 #endif
 302                 }
 303         }
 304 #ifdef MISDN_MSG_STATS
 305         printk(KERN_DEBUG "mISDNStackd daemon for %s proceed %d "
 306                "msg %d sleep %d stopped\n",
 307                dev_name(&st->dev->dev), st->msg_cnt, st->sleep_cnt,
 308                st->stopped_cnt);
 309         task_cputime(st->thread, &utime, &stime);
 310         printk(KERN_DEBUG
 311                "mISDNStackd daemon for %s utime(%ld) stime(%ld)\n",
 312                dev_name(&st->dev->dev), utime, stime);
 313         printk(KERN_DEBUG
 314                "mISDNStackd daemon for %s nvcsw(%ld) nivcsw(%ld)\n",
 315                dev_name(&st->dev->dev), st->thread->nvcsw, st->thread->nivcsw);
 316         printk(KERN_DEBUG "mISDNStackd daemon for %s killed now\n",
 317                dev_name(&st->dev->dev));
 318 #endif
 319         test_and_set_bit(mISDN_STACK_KILLED, &st->status);
 320         test_and_clear_bit(mISDN_STACK_RUNNING, &st->status);
 321         test_and_clear_bit(mISDN_STACK_ACTIVE, &st->status);
 322         test_and_clear_bit(mISDN_STACK_ABORT, &st->status);
 323         skb_queue_purge(&st->msgq);
 324         st->thread = NULL;
 325         if (st->notify != NULL) {
 326                 complete(st->notify);
 327                 st->notify = NULL;
 328         }
 329         return 0;
 330 }
 331
 332 static int
 333 l1_receive(struct mISDNchannel *ch, struct sk_buff *skb)
 334 {
 335         if (!ch->st)
 336                 return -ENODEV;
 337         __net_timestamp(skb);
 338         _queue_message(ch->st, skb);
 339         return 0;
 340 }
 341
 342 void
 343 set_channel_address(struct mISDNchannel *ch, u_int sapi, u_int tei)
 344 {
 345         ch->addr = sapi | (tei << 8);
 346 }
 347
 348 void
 349 __add_layer2(struct mISDNchannel *ch, struct mISDNstack *st)
 350 {
 351         list_add_tail(&ch->list, &st->layer2);
 352 }
 353
 354 void
 355 add_layer2(struct mISDNchannel *ch, struct mISDNstack *st)
 356 {
 357         mutex_lock(&st->lmutex);
 358         __add_layer2(ch, st);
 359         mutex_unlock(&st->lmutex);
 360 }
 361
 362 static int
 363 st_own_ctrl(struct mISDNchannel *ch, u_int cmd, void *arg)
 364 {
 365         if (!ch->st || !ch->st->layer1)
 366                 return -EINVAL;
 367         return ch->st->layer1->ctrl(ch->st->layer1, cmd, arg);
 368 }
 369
 370 int
 371 create_stack(struct mISDNdevice *dev)
 372 {
 373         struct mISDNstack       *newst;
 374         int                     err;
 375         DECLARE_COMPLETION_ONSTACK(done);
 376
 377         newst = kzalloc(sizeof(struct mISDNstack), GFP_KERNEL);
 378         if (!newst) {
 379                 printk(KERN_ERR "kmalloc mISDN_stack failed\n");
 380                 return -ENOMEM;
 381         }
 382         newst->dev = dev;
 383         INIT_LIST_HEAD(&newst->layer2);
 384         INIT_HLIST_HEAD(&newst->l1sock.head);
 385         rwlock_init(&newst->l1sock.lock);
 386         init_waitqueue_head(&newst->workq);
 387         skb_queue_head_init(&newst->msgq);
 388         mutex_init(&newst->lmutex);
 389         dev->D.st = newst;
 390         err = create_teimanager(dev);
 391         if (err) {
 392                 printk(KERN_ERR "kmalloc teimanager failed\n");
 393                 kfree(newst);
 394                 return err;
 395         }
 396         dev->teimgr->peer = &newst->own;
 397         dev->teimgr->recv = mISDN_queue_message;
 398         dev->teimgr->st = newst;
 399         newst->layer1 = &dev->D;
 400         dev->D.recv = l1_receive;
 401         dev->D.peer = &newst->own;
 402         newst->own.st = newst;
 403         newst->own.ctrl = st_own_ctrl;
 404         newst->own.send = mISDN_queue_message;
 405         newst->own.recv = mISDN_queue_message;
 406         if (*debug & DEBUG_CORE_FUNC)
 407                 printk(KERN_DEBUG "%s: st(%s)\n", __func__,
 408                        dev_name(&newst->dev->dev));
 409         newst->notify = &done;
 410         newst->thread = kthread_run(mISDNStackd, (void *)newst, "mISDN_%s",
 411                                     dev_name(&newst->dev->dev));
 412         if (IS_ERR(newst->thread)) {
 413                 err = PTR_ERR(newst->thread);
 414                 printk(KERN_ERR
 415                        "mISDN:cannot create kernel thread for %s (%d)\n",
 416                        dev_name(&newst->dev->dev), err);
 417                 delete_teimanager(dev->teimgr);
 418                 kfree(newst);
 419         } else
 420                 wait_for_completion(&done);
 421         return err;
 422 }
 423
 424 int
 425 connect_layer1(struct mISDNdevice *dev, struct mISDNchannel *ch,
 426                u_int protocol, struct sockaddr_mISDN *adr)
 427 {
 428         struct mISDN_sock       *msk = container_of(ch, struct mISDN_sock, ch);
 429         struct channel_req      rq;
 430         int                     err;
 431
 432
 433         if (*debug &  DEBUG_CORE_FUNC)
 434                 printk(KERN_DEBUG "%s: %s proto(%x) adr(%d %d %d %d)\n",
 435                        __func__, dev_name(&dev->dev), protocol, adr->dev,
 436                        adr->channel, adr->sapi, adr->tei);
 437         switch (protocol) {
 438         case ISDN_P_NT_S0:
 439         case ISDN_P_NT_E1:
 440         case ISDN_P_TE_S0:
 441         case ISDN_P_TE_E1:
 442                 ch->recv = mISDN_queue_message;
 443                 ch->peer = &dev->D.st->own;
 444                 ch->st = dev->D.st;
 445                 rq.protocol = protocol;
 446                 rq.adr.channel = adr->channel;
 447                 err = dev->D.ctrl(&dev->D, OPEN_CHANNEL, &rq);
 448                 printk(KERN_DEBUG "%s: ret %d (dev %d)\n", __func__, err,
 449                        dev->id);
 450                 if (err)
 451                         return err;
 452                 write_lock_bh(&dev->D.st->l1sock.lock);
 453                 sk_add_node(&msk->sk, &dev->D.st->l1sock.head);
 454                 write_unlock_bh(&dev->D.st->l1sock.lock);
 455                 break;
 456         default:
 457                 return -ENOPROTOOPT;
 458         }
 459         return 0;
 460 }
 461
 462 int
 463 connect_Bstack(struct mISDNdevice *dev, struct mISDNchannel *ch,
 464                u_int protocol, struct sockaddr_mISDN *adr)
 465 {
 466         struct channel_req      rq, rq2;
 467         int                     pmask, err;
 468         struct Bprotocol        *bp;
 469
 470         if (*debug &  DEBUG_CORE_FUNC)
 471                 printk(KERN_DEBUG "%s: %s proto(%x) adr(%d %d %d %d)\n",
 472                        __func__, dev_name(&dev->dev), protocol,
 473                        adr->dev, adr->channel, adr->sapi,
 474                        adr->tei);
 475         ch->st = dev->D.st;
 476         pmask = 1 << (protocol & ISDN_P_B_MASK);
 477         if (pmask & dev->Bprotocols) {
 478                 rq.protocol = protocol;
 479                 rq.adr = *adr;
 480                 err = dev->D.ctrl(&dev->D, OPEN_CHANNEL, &rq);
 481                 if (err)
 482                         return err;
 483                 ch->recv = rq.ch->send;
 484                 ch->peer = rq.ch;
 485                 rq.ch->recv = ch->send;
 486                 rq.ch->peer = ch;
 487                 rq.ch->st = dev->D.st;
 488         } else {
 489                 bp = get_Bprotocol4mask(pmask);
 490                 if (!bp)
 491                         return -ENOPROTOOPT;
 492                 rq2.protocol = protocol;
 493                 rq2.adr = *adr;
 494                 rq2.ch = ch;
 495                 err = bp->create(&rq2);
 496                 if (err)
 497                         return err;
 498                 ch->recv = rq2.ch->send;
 499                 ch->peer = rq2.ch;
 500                 rq2.ch->st = dev->D.st;
 501                 rq.protocol = rq2.protocol;
 502                 rq.adr = *adr;
 503                 err = dev->D.ctrl(&dev->D, OPEN_CHANNEL, &rq);
 504                 if (err) {
 505                         rq2.ch->ctrl(rq2.ch, CLOSE_CHANNEL, NULL);
 506                         return err;
 507                 }
 508                 rq2.ch->recv = rq.ch->send;
 509                 rq2.ch->peer = rq.ch;
 510                 rq.ch->recv = rq2.ch->send;
 511                 rq.ch->peer = rq2.ch;
 512                 rq.ch->st = dev->D.st;
 513         }
 514         ch->protocol = protocol;
 515         ch->nr = rq.ch->nr;
 516         return 0;
 517 }
 518
 519 int
 520 create_l2entity(struct mISDNdevice *dev, struct mISDNchannel *ch,
 521                 u_int protocol, struct sockaddr_mISDN *adr)
 522 {
 523         struct channel_req      rq;
 524         int                     err;
 525
 526         if (*debug &  DEBUG_CORE_FUNC)
 527                 printk(KERN_DEBUG "%s: %s proto(%x) adr(%d %d %d %d)\n",
 528                        __func__, dev_name(&dev->dev), protocol,
 529                        adr->dev, adr->channel, adr->sapi,
 530                        adr->tei);
 531         rq.protocol = ISDN_P_TE_S0;
 532         if (dev->Dprotocols & (1 << ISDN_P_TE_E1))
 533                 rq.protocol = ISDN_P_TE_E1;
 534         switch (protocol) {
 535         case ISDN_P_LAPD_NT:
 536                 rq.protocol = ISDN_P_NT_S0;
 537                 if (dev->Dprotocols & (1 << ISDN_P_NT_E1))
 538                         rq.protocol = ISDN_P_NT_E1;
 539         case ISDN_P_LAPD_TE:
 540                 ch->recv = mISDN_queue_message;
 541                 ch->peer = &dev->D.st->own;
 542                 ch->st = dev->D.st;
 543                 rq.adr.channel = 0;
 544                 err = dev->D.ctrl(&dev->D, OPEN_CHANNEL, &rq);
 545                 printk(KERN_DEBUG "%s: ret 1 %d\n", __func__, err);
 546                 if (err)
 547                         break;
 548                 rq.protocol = protocol;
 549                 rq.adr = *adr;
 550                 rq.ch = ch;
 551                 err = dev->teimgr->ctrl(dev->teimgr, OPEN_CHANNEL, &rq);
 552                 printk(KERN_DEBUG "%s: ret 2 %d\n", __func__, err);
 553                 if (!err) {
 554                         if ((protocol == ISDN_P_LAPD_NT) && !rq.ch)
 555                                 break;
 556                         add_layer2(rq.ch, dev->D.st);
 557                         rq.ch->recv = mISDN_queue_message;
 558                         rq.ch->peer = &dev->D.st->own;
 559                         rq.ch->ctrl(rq.ch, OPEN_CHANNEL, NULL); /* can't fail */
 560                 }
 561                 break;
 562         default:
 563                 err = -EPROTONOSUPPORT;
 564         }
 565         return err;
 566 }
 567
 568 void
 569 delete_channel(struct mISDNchannel *ch)
 570 {
 571         struct mISDN_sock       *msk = container_of(ch, struct mISDN_sock, ch);
 572         struct mISDNchannel     *pch;
 573
 574         if (!ch->st) {
 575                 printk(KERN_WARNING "%s: no stack\n", __func__);
 576                 return;
 577         }
 578         if (*debug & DEBUG_CORE_FUNC)
 579                 printk(KERN_DEBUG "%s: st(%s) protocol(%x)\n", __func__,
 580                        dev_name(&ch->st->dev->dev), ch->protocol);
 581         if (ch->protocol >= ISDN_P_B_START) {
 582                 if (ch->peer) {
 583                         ch->peer->ctrl(ch->peer, CLOSE_CHANNEL, NULL);
 584                         ch->peer = NULL;
 585                 }
 586                 return;
 587         }
 588         switch (ch->protocol) {
 589         case ISDN_P_NT_S0:
 590         case ISDN_P_TE_S0:
 591         case ISDN_P_NT_E1:
 592         case ISDN_P_TE_E1:
 593                 write_lock_bh(&ch->st->l1sock.lock);
 594                 sk_del_node_init(&msk->sk);
 595                 write_unlock_bh(&ch->st->l1sock.lock);
 596                 ch->st->dev->D.ctrl(&ch->st->dev->D, CLOSE_CHANNEL, NULL);
 597                 break;
 598         case ISDN_P_LAPD_TE:
 599                 pch = get_channel4id(ch->st, ch->nr);
 600                 if (pch) {
 601                         mutex_lock(&ch->st->lmutex);
 602                         list_del(&pch->list);
 603                         mutex_unlock(&ch->st->lmutex);
 604                         pch->ctrl(pch, CLOSE_CHANNEL, NULL);
 605                         pch = ch->st->dev->teimgr;
 606                         pch->ctrl(pch, CLOSE_CHANNEL, NULL);
 607                 } else
 608                         printk(KERN_WARNING "%s: no l2 channel\n",
 609                                __func__);
 610                 break;
 611         case ISDN_P_LAPD_NT:
 612                 pch = ch->st->dev->teimgr;
 613                 if (pch) {
 614                         pch->ctrl(pch, CLOSE_CHANNEL, NULL);
 615                 } else
 616                         printk(KERN_WARNING "%s: no l2 channel\n",
 617                                __func__);
 618                 break;
 619         default:
 620                 break;
 621         }
 622         return;
 623 }
 624
 625 void
 626 delete_stack(struct mISDNdevice *dev)
 627 {
 628         struct mISDNstack       *st = dev->D.st;
 629         DECLARE_COMPLETION_ONSTACK(done);
 630
 631         if (*debug & DEBUG_CORE_FUNC)
 632                 printk(KERN_DEBUG "%s: st(%s)\n", __func__,
 633                        dev_name(&st->dev->dev));
 634         if (dev->teimgr)
 635                 delete_teimanager(dev->teimgr);
 636         if (st->thread) {
 637                 if (st->notify) {
 638                         printk(KERN_WARNING "%s: notifier in use\n",
 639                                __func__);
 640                         complete(st->notify);
 641                 }
 642                 st->notify = &done;
 643                 test_and_set_bit(mISDN_STACK_ABORT, &st->status);
 644                 test_and_set_bit(mISDN_STACK_WAKEUP, &st->status);
 645                 wake_up_interruptible(&st->workq);
 646                 wait_for_completion(&done);
 647         }
 648         if (!list_empty(&st->layer2))
 649                 printk(KERN_WARNING "%s: layer2 list not empty\n",
 650                        __func__);
 651         if (!hlist_empty(&st->l1sock.head))
 652                 printk(KERN_WARNING "%s: layer1 list not empty\n",
 653                        __func__);
 654         kfree(st);
 655 }
 656
 657 void
 658 mISDN_initstack(u_int *dp)
 659 {
 660         debug = dp;
 661 }