drivers/isdn/act2000/capi.c

   1 /* $Id: capi.c,v 1.8 1998/11/05 22:12:46 fritz Exp $
   2  *
   3  * ISDN lowlevel-module for the IBM ISDN-S0 Active 2000.
   4  *        CAPI encoder/decoder
   5  *
   6  * Copyright 1998 by Fritz Elfert (fritz@isdn4linux.de)
   7  * Thanks to Friedemann Baitinger and IBM Germany
   8  *
   9  * This program is free software; you can redistribute it and/or modify
  10  * it under the terms of the GNU General Public License as published by
  11  * the Free Software Foundation; either version 2, or (at your option)
  12  * any later version.
  13  *
  14  * This program is distributed in the hope that it will be useful,
  15  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  16  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  17  * GNU General Public License for more details.
  18  *
  19  * You should have received a copy of the GNU General Public License
  20  * along with this program; if not, write to the Free Software
  21  * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
  22  *
  23  * $Log: capi.c,v $
  24  * Revision 1.8  1998/11/05 22:12:46  fritz
  25  * Changed mail-address.
  26  *
  27  * Revision 1.7  1998/02/23 23:35:41  fritz
  28  * Eliminated some compiler warnings.
  29  *
  30  * Revision 1.6  1998/02/12 23:06:50  keil
  31  * change for 2.1.86 (removing FREE_READ/FREE_WRITE from [dev]_kfree_skb()
  32  *
  33  * Revision 1.5  1997/10/09 22:23:02  fritz
  34  * New HL<->LL interface:
  35  *   New BSENT callback with nr. of bytes included.
  36  *   Sending without ACK.
  37  *
  38  * Revision 1.4  1997/09/25 17:25:39  fritz
  39  * Support for adding cards at runtime.
  40  * Support for new Firmware.
  41  *
  42  * Revision 1.3  1997/09/24 19:44:14  fritz
  43  * Added MSN mapping support, some cleanup.
  44  *
  45  * Revision 1.2  1997/09/23 19:41:24  fritz
  46  * Disabled Logging of DATA_B3_IND/RESP/REQ/CONF Messages.
  47  *
  48  * Revision 1.1  1997/09/23 18:00:08  fritz
  49  * New driver for IBM Active 2000.
  50  *
  51  */
  52
  53 #define __NO_VERSION__
  54 #include "act2000.h"
  55 #include "capi.h"
  56
  57 static actcapi_msgdsc valid_msg[] = {
  58         {{ 0x86, 0x02}, "DATA_B3_IND"},       /* DATA_B3_IND/CONF must be first because of speed!!! */
  59         {{ 0x86, 0x01}, "DATA_B3_CONF"},
  60         {{ 0x02, 0x01}, "CONNECT_CONF"},
  61         {{ 0x02, 0x02}, "CONNECT_IND"},
  62         {{ 0x09, 0x01}, "CONNECT_INFO_CONF"},
  63         {{ 0x03, 0x02}, "CONNECT_ACTIVE_IND"},
  64         {{ 0x04, 0x01}, "DISCONNECT_CONF"},
  65         {{ 0x04, 0x02}, "DISCONNECT_IND"},
  66         {{ 0x05, 0x01}, "LISTEN_CONF"},
  67         {{ 0x06, 0x01}, "GET_PARAMS_CONF"},
  68         {{ 0x07, 0x01}, "INFO_CONF"},
  69         {{ 0x07, 0x02}, "INFO_IND"},
  70         {{ 0x08, 0x01}, "DATA_CONF"},
  71         {{ 0x08, 0x02}, "DATA_IND"},
  72         {{ 0x40, 0x01}, "SELECT_B2_PROTOCOL_CONF"},
  73         {{ 0x80, 0x01}, "SELECT_B3_PROTOCOL_CONF"},
  74         {{ 0x81, 0x01}, "LISTEN_B3_CONF"},
  75         {{ 0x82, 0x01}, "CONNECT_B3_CONF"},
  76         {{ 0x82, 0x02}, "CONNECT_B3_IND"},
  77         {{ 0x83, 0x02}, "CONNECT_B3_ACTIVE_IND"},
  78         {{ 0x84, 0x01}, "DISCONNECT_B3_CONF"},
  79         {{ 0x84, 0x02}, "DISCONNECT_B3_IND"},
  80         {{ 0x85, 0x01}, "GET_B3_PARAMS_CONF"},
  81         {{ 0x01, 0x01}, "RESET_B3_CONF"},
  82         {{ 0x01, 0x02}, "RESET_B3_IND"},
  83         /* {{ 0x87, 0x02, "HANDSET_IND"}, not implemented */
  84         {{ 0xff, 0x01}, "MANUFACTURER_CONF"},
  85         {{ 0xff, 0x02}, "MANUFACTURER_IND"},
  86 #ifdef DEBUG_MSG
  87         /* Requests */
  88         {{ 0x01, 0x00}, "RESET_B3_REQ"},
  89         {{ 0x02, 0x00}, "CONNECT_REQ"},
  90         {{ 0x04, 0x00}, "DISCONNECT_REQ"},
  91         {{ 0x05, 0x00}, "LISTEN_REQ"},
  92         {{ 0x06, 0x00}, "GET_PARAMS_REQ"},
  93         {{ 0x07, 0x00}, "INFO_REQ"},
  94         {{ 0x08, 0x00}, "DATA_REQ"},
  95         {{ 0x09, 0x00}, "CONNECT_INFO_REQ"},
  96         {{ 0x40, 0x00}, "SELECT_B2_PROTOCOL_REQ"},
  97         {{ 0x80, 0x00}, "SELECT_B3_PROTOCOL_REQ"},
  98         {{ 0x81, 0x00}, "LISTEN_B3_REQ"},
  99         {{ 0x82, 0x00}, "CONNECT_B3_REQ"},
 100         {{ 0x84, 0x00}, "DISCONNECT_B3_REQ"},
 101         {{ 0x85, 0x00}, "GET_B3_PARAMS_REQ"},
 102         {{ 0x86, 0x00}, "DATA_B3_REQ"},
 103         {{ 0xff, 0x00}, "MANUFACTURER_REQ"},
 104         /* Responses */
 105         {{ 0x01, 0x03}, "RESET_B3_RESP"},
 106         {{ 0x02, 0x03}, "CONNECT_RESP"},
 107         {{ 0x03, 0x03}, "CONNECT_ACTIVE_RESP"},
 108         {{ 0x04, 0x03}, "DISCONNECT_RESP"},
 109         {{ 0x07, 0x03}, "INFO_RESP"},
 110         {{ 0x08, 0x03}, "DATA_RESP"},
 111         {{ 0x82, 0x03}, "CONNECT_B3_RESP"},
 112         {{ 0x83, 0x03}, "CONNECT_B3_ACTIVE_RESP"},
 113         {{ 0x84, 0x03}, "DISCONNECT_B3_RESP"},
 114         {{ 0x86, 0x03}, "DATA_B3_RESP"},
 115         {{ 0xff, 0x03}, "MANUFACTURER_RESP"},
 116 #if 0
 117 /* CAPI 2.0 */
 118         {{ 0x05, 0x80}, "LISTEN_REQ (CAPI 2.0)"},
 119 #endif
 120 #endif
 121         {{ 0x00, 0x00}, NULL},
 122 };
 123 #define num_valid_msg (sizeof(valid_msg)/sizeof(actcapi_msgdsc))
 124 #define num_valid_imsg 27 /* MANUFACTURER_IND */
 125
 126 /*
 127  * Check for a valid incoming CAPI message.
 128  * Return:
 129  *   0 = Invalid message
 130  *   1 = Valid message, no B-Channel-data
 131  *   2 = Valid message, B-Channel-data
 132  */
 133 int
 134 actcapi_chkhdr(act2000_card * card, actcapi_msghdr *hdr)
 135 {
 136         int i;
 137
 138         if (hdr->applicationID != 1)
 139                 return 0;
 140         if (hdr->len < 9)
 141                 return 0;
 142         for (i = 0; i < num_valid_imsg; i++)
 143                 if ((hdr->cmd.cmd == valid_msg[i].cmd.cmd) &&
 144                     (hdr->cmd.subcmd == valid_msg[i].cmd.subcmd)) {
 145                         return (i?1:2);
 146                 }
 147         return 0;
 148 }
 149
 150 #define ACTCAPI_MKHDR(l, c, s) { \
 151         skb = alloc_skb(l + 8, GFP_ATOMIC); \
 152         if (skb) { \
 153                 m = (actcapi_msg *)skb_put(skb, l + 8); \
 154                 m->hdr.len = l + 8; \
 155                 m->hdr.applicationID = 1; \
 156                 m->hdr.cmd.cmd = c; \
 157                 m->hdr.cmd.subcmd = s; \
 158                 m->hdr.msgnum = actcapi_nextsmsg(card); \
 159         } \
 160 }
 161
 162 #define ACTCAPI_CHKSKB if (!skb) { \
 163         printk(KERN_WARNING "actcapi: alloc_skb failed\n"); \
 164         return; \
 165 }
 166
 167 #define ACTCAPI_QUEUE_TX { \
 168         actcapi_debug_msg(skb, 1); \
 169         skb_queue_tail(&card->sndq, skb); \
 170         act2000_schedule_tx(card); \
 171 }
 172
 173 int
 174 actcapi_listen_req(act2000_card *card)
 175 {
 176         __u16 eazmask = 0;
 177         int i;
 178         actcapi_msg *m;
 179         struct sk_buff *skb;
 180
 181         for (i = 0; i < ACT2000_BCH; i++)
 182                 eazmask |= card->bch[i].eazmask;
 183         ACTCAPI_MKHDR(9, 0x05, 0x00);
 184         if (!skb) {
 185                 printk(KERN_WARNING "actcapi: alloc_skb failed\n");
 186                 return -ENOMEM;
 187         }
 188         m->msg.listen_req.controller = 0;
 189         m->msg.listen_req.infomask = 0x3f; /* All information */
 190         m->msg.listen_req.eazmask = eazmask;
 191         m->msg.listen_req.simask = (eazmask)?0x86:0; /* All SI's  */
 192         ACTCAPI_QUEUE_TX;
 193         return 0;
 194 }
 195
 196 int
 197 actcapi_connect_req(act2000_card *card, act2000_chan *chan, char *phone,
 198                     char eaz, int si1, int si2)
 199 {
 200         actcapi_msg *m;
 201         struct sk_buff *skb;
 202
 203         ACTCAPI_MKHDR((11 + strlen(phone)), 0x02, 0x00);
 204         if (!skb) {
 205                 printk(KERN_WARNING "actcapi: alloc_skb failed\n");
 206                 chan->fsm_state = ACT2000_STATE_NULL;
 207                 return -ENOMEM;
 208         }
 209         m->msg.connect_req.controller = 0;
 210         m->msg.connect_req.bchan = 0x83;
 211         m->msg.connect_req.infomask = 0x3f;
 212         m->msg.connect_req.si1 = si1;
 213         m->msg.connect_req.si2 = si2;
 214         m->msg.connect_req.eaz = eaz?eaz:'0';
 215         m->msg.connect_req.addr.len = strlen(phone) + 1;
 216         m->msg.connect_req.addr.tnp = 0x81;
 217         memcpy(m->msg.connect_req.addr.num, phone, strlen(phone));
 218         chan->callref = m->hdr.msgnum;
 219         ACTCAPI_QUEUE_TX;
 220         return 0;
 221 }
 222
 223 static void
 224 actcapi_connect_b3_req(act2000_card *card, act2000_chan *chan)
 225 {
 226         actcapi_msg *m;
 227         struct sk_buff *skb;
 228
 229         ACTCAPI_MKHDR(17, 0x82, 0x00);
 230         ACTCAPI_CHKSKB;
 231         m->msg.connect_b3_req.plci = chan->plci;
 232         memset(&m->msg.connect_b3_req.ncpi, 0,
 233                sizeof(m->msg.connect_b3_req.ncpi));
 234         m->msg.connect_b3_req.ncpi.len = 13;
 235         m->msg.connect_b3_req.ncpi.modulo = 8;
 236         ACTCAPI_QUEUE_TX;
 237 }
 238
 239 /*
 240  * Set net type (1TR6) or (EDSS1)
 241  */
 242 int
 243 actcapi_manufacturer_req_net(act2000_card *card)
 244 {
 245         actcapi_msg *m;
 246         struct sk_buff *skb;
 247
 248         ACTCAPI_MKHDR(5, 0xff, 0x00);
 249         if (!skb) {
 250                 printk(KERN_WARNING "actcapi: alloc_skb failed\n");
 251                 return -ENOMEM;
 252         }
 253         m->msg.manufacturer_req_net.manuf_msg = 0x11;
 254         m->msg.manufacturer_req_net.controller = 1;
 255         m->msg.manufacturer_req_net.nettype = (card->ptype == ISDN_PTYPE_EURO)?1:0;
 256         ACTCAPI_QUEUE_TX;
 257         printk(KERN_INFO "act2000 %s: D-channel protocol now %s\n",
 258                card->interface.id, (card->ptype == ISDN_PTYPE_EURO)?"euro":"1tr6");
 259         card->interface.features &=
 260                 ~(ISDN_FEATURE_P_UNKNOWN | ISDN_FEATURE_P_EURO | ISDN_FEATURE_P_1TR6);
 261         card->interface.features |=
 262                 ((card->ptype == ISDN_PTYPE_EURO)?ISDN_FEATURE_P_EURO:ISDN_FEATURE_P_1TR6);
 263         return 0;
 264 }
 265
 266 /*
 267  * Switch V.42 on or off
 268  */
 269 int
 270 actcapi_manufacturer_req_v42(act2000_card *card, ulong arg)
 271 {
 272         actcapi_msg *m;
 273         struct sk_buff *skb;
 274
 275         ACTCAPI_MKHDR(8, 0xff, 0x00);
 276         if (!skb) {
 277
 278                 printk(KERN_WARNING "actcapi: alloc_skb failed\n");
 279                 return -ENOMEM;
 280         }
 281         m->msg.manufacturer_req_v42.manuf_msg = 0x10;
 282         m->msg.manufacturer_req_v42.controller = 0;
 283         m->msg.manufacturer_req_v42.v42control = (arg?1:0);
 284         ACTCAPI_QUEUE_TX;
 285         return 0;
 286 }
 287
 288 /*
 289  * Set error-handler
 290  */
 291 int
 292 actcapi_manufacturer_req_errh(act2000_card *card)
 293 {
 294         actcapi_msg *m;
 295         struct sk_buff *skb;
 296
 297         ACTCAPI_MKHDR(4, 0xff, 0x00);
 298         if (!skb) {
 299
 300                 printk(KERN_WARNING "actcapi: alloc_skb failed\n");
 301                 return -ENOMEM;
 302         }
 303         m->msg.manufacturer_req_err.manuf_msg = 0x03;
 304         m->msg.manufacturer_req_err.controller = 0;
 305         ACTCAPI_QUEUE_TX;
 306         return 0;
 307 }
 308
 309 /*
 310  * Set MSN-Mapping.
 311  */
 312 int
 313 actcapi_manufacturer_req_msn(act2000_card *card)
 314 {
 315         msn_entry *p = card->msn_list;
 316         actcapi_msg *m;
 317         struct sk_buff *skb;
 318         int len;
 319
 320         while (p) {
 321                 int i;
 322
 323                 len = strlen(p->msn);
 324                 for (i = 0; i < 2; i++) {
 325                         ACTCAPI_MKHDR(6 + len, 0xff, 0x00);
 326                         if (!skb) {
 327                                 printk(KERN_WARNING "actcapi: alloc_skb failed\n");
 328                                 return -ENOMEM;
 329                         }
 330                         m->msg.manufacturer_req_msn.manuf_msg = 0x13 + i;
 331                         m->msg.manufacturer_req_msn.controller = 0;
 332                         m->msg.manufacturer_req_msn.msnmap.eaz = p->eaz;
 333                         m->msg.manufacturer_req_msn.msnmap.len = len;
 334                         memcpy(m->msg.manufacturer_req_msn.msnmap.msn, p->msn, len);
 335                         ACTCAPI_QUEUE_TX;
 336                 }
 337                 p = p->next;
 338         }
 339         return 0;
 340 }
 341
 342 void
 343 actcapi_select_b2_protocol_req(act2000_card *card, act2000_chan *chan)
 344 {
 345         actcapi_msg *m;
 346         struct sk_buff *skb;
 347
 348         ACTCAPI_MKHDR(10, 0x40, 0x00);
 349         ACTCAPI_CHKSKB;
 350         m->msg.select_b2_protocol_req.plci = chan->plci;
 351         memset(&m->msg.select_b2_protocol_req.dlpd, 0,
 352                sizeof(m->msg.select_b2_protocol_req.dlpd));
 353         m->msg.select_b2_protocol_req.dlpd.len = 6;
 354         switch (chan->l2prot) {
 355                 case ISDN_PROTO_L2_TRANS:
 356                         m->msg.select_b2_protocol_req.protocol = 0x03;
 357                         m->msg.select_b2_protocol_req.dlpd.dlen = 4000;
 358                         break;
 359                 case ISDN_PROTO_L2_HDLC:
 360                         m->msg.select_b2_protocol_req.protocol = 0x02;
 361                         m->msg.select_b2_protocol_req.dlpd.dlen = 4000;
 362                         break;
 363                 case ISDN_PROTO_L2_X75I:
 364                 case ISDN_PROTO_L2_X75UI:
 365                 case ISDN_PROTO_L2_X75BUI:
 366                         m->msg.select_b2_protocol_req.protocol = 0x01;
 367                         m->msg.select_b2_protocol_req.dlpd.dlen = 4000;
 368                         m->msg.select_b2_protocol_req.dlpd.laa = 3;
 369                         m->msg.select_b2_protocol_req.dlpd.lab = 1;
 370                         m->msg.select_b2_protocol_req.dlpd.win = 7;
 371                         m->msg.select_b2_protocol_req.dlpd.modulo = 8;
 372                         break;
 373         }
 374         ACTCAPI_QUEUE_TX;
 375 }
 376
 377 static void
 378 actcapi_select_b3_protocol_req(act2000_card *card, act2000_chan *chan)
 379 {
 380         actcapi_msg *m;
 381         struct sk_buff *skb;
 382
 383         ACTCAPI_MKHDR(17, 0x80, 0x00);
 384         ACTCAPI_CHKSKB;
 385         m->msg.select_b3_protocol_req.plci = chan->plci;
 386         memset(&m->msg.select_b3_protocol_req.ncpd, 0,
 387                sizeof(m->msg.select_b3_protocol_req.ncpd));
 388         switch (chan->l3prot) {
 389                 case ISDN_PROTO_L3_TRANS:
 390                         m->msg.select_b3_protocol_req.protocol = 0x04;
 391                         m->msg.select_b3_protocol_req.ncpd.len = 13;
 392                         m->msg.select_b3_protocol_req.ncpd.modulo = 8;
 393                         break;
 394         }
 395         ACTCAPI_QUEUE_TX;
 396 }
 397
 398 static void
 399 actcapi_listen_b3_req(act2000_card *card, act2000_chan *chan)
 400 {
 401         actcapi_msg *m;
 402         struct sk_buff *skb;
 403
 404         ACTCAPI_MKHDR(2, 0x81, 0x00);
 405         ACTCAPI_CHKSKB;
 406         m->msg.listen_b3_req.plci = chan->plci;
 407         ACTCAPI_QUEUE_TX;
 408 }
 409
 410 static void
 411 actcapi_disconnect_req(act2000_card *card, act2000_chan *chan)
 412 {
 413         actcapi_msg *m;
 414         struct sk_buff *skb;
 415
 416         ACTCAPI_MKHDR(3, 0x04, 0x00);
 417         ACTCAPI_CHKSKB;
 418         m->msg.disconnect_req.plci = chan->plci;
 419         m->msg.disconnect_req.cause = 0;
 420         ACTCAPI_QUEUE_TX;
 421 }
 422
 423 void
 424 actcapi_disconnect_b3_req(act2000_card *card, act2000_chan *chan)
 425 {
 426         actcapi_msg *m;
 427         struct sk_buff *skb;
 428
 429         ACTCAPI_MKHDR(17, 0x84, 0x00);
 430         ACTCAPI_CHKSKB;
 431         m->msg.disconnect_b3_req.ncci = chan->ncci;
 432         memset(&m->msg.disconnect_b3_req.ncpi, 0,
 433                sizeof(m->msg.disconnect_b3_req.ncpi));
 434         m->msg.disconnect_b3_req.ncpi.len = 13;
 435         m->msg.disconnect_b3_req.ncpi.modulo = 8;
 436         chan->fsm_state = ACT2000_STATE_BHWAIT;
 437         ACTCAPI_QUEUE_TX;
 438 }
 439
 440 void
 441 actcapi_connect_resp(act2000_card *card, act2000_chan *chan, __u8 cause)
 442 {
 443         actcapi_msg *m;
 444         struct sk_buff *skb;
 445
 446         ACTCAPI_MKHDR(3, 0x02, 0x03);
 447         ACTCAPI_CHKSKB;
 448         m->msg.connect_resp.plci = chan->plci;
 449         m->msg.connect_resp.rejectcause = cause;
 450         if (cause) {
 451                 chan->fsm_state = ACT2000_STATE_NULL;
 452                 chan->plci = 0x8000;
 453         } else
 454                 chan->fsm_state = ACT2000_STATE_IWAIT;
 455         ACTCAPI_QUEUE_TX;
 456 }
 457
 458 static void
 459 actcapi_connect_active_resp(act2000_card *card, act2000_chan *chan)
 460 {
 461         actcapi_msg *m;
 462         struct sk_buff *skb;
 463
 464         ACTCAPI_MKHDR(2, 0x03, 0x03);
 465         ACTCAPI_CHKSKB;
 466         m->msg.connect_resp.plci = chan->plci;
 467         if (chan->fsm_state == ACT2000_STATE_IWAIT)
 468                 chan->fsm_state = ACT2000_STATE_IBWAIT;
 469         ACTCAPI_QUEUE_TX;
 470 }
 471
 472 static void
 473 actcapi_connect_b3_resp(act2000_card *card, act2000_chan *chan, __u8 rejectcause)
 474 {
 475         actcapi_msg *m;
 476         struct sk_buff *skb;
 477
 478         ACTCAPI_MKHDR((rejectcause?3:17), 0x82, 0x03);
 479         ACTCAPI_CHKSKB;
 480         m->msg.connect_b3_resp.ncci = chan->ncci;
 481         m->msg.connect_b3_resp.rejectcause = rejectcause;
 482         if (!rejectcause) {
 483                 memset(&m->msg.connect_b3_resp.ncpi, 0,
 484                        sizeof(m->msg.connect_b3_resp.ncpi));
 485                 m->msg.connect_b3_resp.ncpi.len = 13;
 486                 m->msg.connect_b3_resp.ncpi.modulo = 8;
 487                 chan->fsm_state = ACT2000_STATE_BWAIT;
 488         }
 489         ACTCAPI_QUEUE_TX;
 490 }
 491
 492 static void
 493 actcapi_connect_b3_active_resp(act2000_card *card, act2000_chan *chan)
 494 {
 495         actcapi_msg *m;
 496         struct sk_buff *skb;
 497
 498         ACTCAPI_MKHDR(2, 0x83, 0x03);
 499         ACTCAPI_CHKSKB;
 500         m->msg.connect_b3_active_resp.ncci = chan->ncci;
 501         chan->fsm_state = ACT2000_STATE_ACTIVE;
 502         ACTCAPI_QUEUE_TX;
 503 }
 504
 505 static void
 506 actcapi_info_resp(act2000_card *card, act2000_chan *chan)
 507 {
 508         actcapi_msg *m;
 509         struct sk_buff *skb;
 510
 511         ACTCAPI_MKHDR(2, 0x07, 0x03);
 512         ACTCAPI_CHKSKB;
 513         m->msg.info_resp.plci = chan->plci;
 514         ACTCAPI_QUEUE_TX;
 515 }
 516
 517 static void
 518 actcapi_disconnect_b3_resp(act2000_card *card, act2000_chan *chan)
 519 {
 520         actcapi_msg *m;
 521         struct sk_buff *skb;
 522
 523         ACTCAPI_MKHDR(2, 0x84, 0x03);
 524         ACTCAPI_CHKSKB;
 525         m->msg.disconnect_b3_resp.ncci = chan->ncci;
 526         chan->ncci = 0x8000;
 527         chan->queued = 0;
 528         ACTCAPI_QUEUE_TX;
 529 }
 530
 531 static void
 532 actcapi_disconnect_resp(act2000_card *card, act2000_chan *chan)
 533 {
 534         actcapi_msg *m;
 535         struct sk_buff *skb;
 536
 537         ACTCAPI_MKHDR(2, 0x04, 0x03);
 538         ACTCAPI_CHKSKB;
 539         m->msg.disconnect_resp.plci = chan->plci;
 540         chan->plci = 0x8000;
 541         ACTCAPI_QUEUE_TX;
 542 }
 543
 544 static int
 545 new_plci(act2000_card *card, __u16 plci)
 546 {
 547         int i;
 548         for (i = 0; i < ACT2000_BCH; i++)
 549                 if (card->bch[i].plci == 0x8000) {
 550                         card->bch[i].plci = plci;
 551                         return i;
 552                 }
 553         return -1;
 554 }
 555
 556 static int
 557 find_plci(act2000_card *card, __u16 plci)
 558 {
 559         int i;
 560         for (i = 0; i < ACT2000_BCH; i++)
 561                 if (card->bch[i].plci == plci)
 562                         return i;
 563         return -1;
 564 }
 565
 566 static int
 567 find_ncci(act2000_card *card, __u16 ncci)
 568 {
 569         int i;
 570         for (i = 0; i < ACT2000_BCH; i++)
 571                 if (card->bch[i].ncci == ncci)
 572                         return i;
 573         return -1;
 574 }
 575
 576 static int
 577 find_dialing(act2000_card *card, __u16 callref)
 578 {
 579         int i;
 580         for (i = 0; i < ACT2000_BCH; i++)
 581                 if ((card->bch[i].callref == callref) &&
 582                     (card->bch[i].fsm_state == ACT2000_STATE_OCALL))
 583                         return i;
 584         return -1;
 585 }
 586
 587 static int
 588 actcapi_data_b3_ind(act2000_card *card, struct sk_buff *skb) {
 589         __u16 plci;
 590         __u16 ncci;
 591         __u16 controller;
 592         __u8  blocknr;
 593         int chan;
 594         actcapi_msg *msg = (actcapi_msg *)skb->data;
 595
 596         EVAL_NCCI(msg->msg.data_b3_ind.fakencci, plci, controller, ncci);
 597         chan = find_ncci(card, ncci);
 598         if (chan < 0)
 599                 return 0;
 600         if (card->bch[chan].fsm_state != ACT2000_STATE_ACTIVE)
 601                 return 0;
 602         if (card->bch[chan].plci != plci)
 603                 return 0;
 604         blocknr = msg->msg.data_b3_ind.blocknr;
 605         skb_pull(skb, 19);
 606         card->interface.rcvcallb_skb(card->myid, chan, skb);
 607         if (!(skb = alloc_skb(11, GFP_ATOMIC))) {
 608                 printk(KERN_WARNING "actcapi: alloc_skb failed\n");
 609                 return 1;
 610         }
 611         msg = (actcapi_msg *)skb_put(skb, 11);
 612         msg->hdr.len = 11;
 613         msg->hdr.applicationID = 1;
 614         msg->hdr.cmd.cmd = 0x86;
 615         msg->hdr.cmd.subcmd = 0x03;
 616         msg->hdr.msgnum = actcapi_nextsmsg(card);
 617         msg->msg.data_b3_resp.ncci = ncci;
 618         msg->msg.data_b3_resp.blocknr = blocknr;
 619         ACTCAPI_QUEUE_TX;
 620         return 1;
 621 }
 622
 623 /*
 624  * Walk over ackq, unlink DATA_B3_REQ from it, if
 625  * ncci and blocknr are matching.
 626  * Decrement queued-bytes counter.
 627  */
 628 static int
 629 handle_ack(act2000_card *card, act2000_chan *chan, __u8 blocknr) {
 630         unsigned long flags;
 631         struct sk_buff *skb;
 632         struct sk_buff *tmp;
 633         struct actcapi_msg *m;
 634         int ret = 0;
 635
 636         save_flags(flags);
 637         cli();
 638         skb = skb_peek(&card->ackq);
 639         restore_flags(flags);
 640         if (!skb) {
 641                 printk(KERN_WARNING "act2000: handle_ack nothing found!\n");
 642                 return 0;
 643         }
 644         tmp = skb;
 645         while (1) {
 646                 m = (actcapi_msg *)tmp->data;
 647                 if ((((m->msg.data_b3_req.fakencci >> 8) & 0xff) == chan->ncci) &&
 648                     (m->msg.data_b3_req.blocknr == blocknr)) {
 649                         /* found corresponding DATA_B3_REQ */
 650                         skb_unlink(tmp);
 651                         chan->queued -= m->msg.data_b3_req.datalen;
 652                         if (m->msg.data_b3_req.flags)
 653                                 ret = m->msg.data_b3_req.datalen;
 654                         dev_kfree_skb(tmp);
 655                         if (chan->queued < 0)
 656                                 chan->queued = 0;
 657                         return ret;
 658                 }
 659                 save_flags(flags);
 660                 cli();
 661                 tmp = skb_peek((struct sk_buff_head *)tmp);
 662                 restore_flags(flags);
 663                 if ((tmp == skb) || (tmp == NULL)) {
 664                         /* reached end of queue */
 665                         printk(KERN_WARNING "act2000: handle_ack nothing found!\n");
 666                         return 0;
 667                 }
 668         }
 669 }
 670
 671 void
 672 actcapi_dispatch(act2000_card *card)
 673 {
 674         struct sk_buff *skb;
 675         actcapi_msg *msg;
 676         __u16 ccmd;
 677         int chan;
 678         int len;
 679         act2000_chan *ctmp;
 680         isdn_ctrl cmd;
 681         char tmp[170];
 682
 683         while ((skb = skb_dequeue(&card->rcvq))) {
 684                 actcapi_debug_msg(skb, 0);
 685                 msg = (actcapi_msg *)skb->data;
 686                 ccmd = ((msg->hdr.cmd.cmd << 8) | msg->hdr.cmd.subcmd);
 687                 switch (ccmd) {
 688                         case 0x8602:
 689                                 /* DATA_B3_IND */
 690                                 if (actcapi_data_b3_ind(card, skb))
 691                                         return;
 692                                 break;
 693                         case 0x8601:
 694                                 /* DATA_B3_CONF */
 695                                 chan = find_ncci(card, msg->msg.data_b3_conf.ncci);
 696                                 if ((chan >= 0) && (card->bch[chan].fsm_state == ACT2000_STATE_ACTIVE)) {
 697                                         if (msg->msg.data_b3_conf.info != 0)
 698                                                 printk(KERN_WARNING "act2000: DATA_B3_CONF: %04x\n",
 699                                                        msg->msg.data_b3_conf.info);
 700                                         len = handle_ack(card, &card->bch[chan],
 701                                                          msg->msg.data_b3_conf.blocknr);
 702                                         if (len) {
 703                                                 cmd.driver = card->myid;
 704                                                 cmd.command = ISDN_STAT_BSENT;
 705                                                 cmd.arg = chan;
 706                                                 cmd.parm.length = len;
 707                                                 card->interface.statcallb(&cmd);
 708                                         }
 709                                 }
 710                                 break;
 711                         case 0x0201:
 712                                 /* CONNECT_CONF */
 713                                 chan = find_dialing(card, msg->hdr.msgnum);
 714                                 if (chan >= 0) {
 715                                         if (msg->msg.connect_conf.info) {
 716                                                 card->bch[chan].fsm_state = ACT2000_STATE_NULL;
 717                                                 cmd.driver = card->myid;
 718                                                 cmd.command = ISDN_STAT_DHUP;
 719                                                 cmd.arg = chan;
 720                                                 card->interface.statcallb(&cmd);
 721                                         } else {
 722                                                 card->bch[chan].fsm_state = ACT2000_STATE_OWAIT;
 723                                                 card->bch[chan].plci = msg->msg.connect_conf.plci;
 724                                         }
 725                                 }
 726                                 break;
 727                         case 0x0202:
 728                                 /* CONNECT_IND */
 729                                 chan = new_plci(card, msg->msg.connect_ind.plci);
 730                                 if (chan < 0) {
 731                                         ctmp = (act2000_chan *)tmp;
 732                                         ctmp->plci = msg->msg.connect_ind.plci;
 733                                         actcapi_connect_resp(card, ctmp, 0x11); /* All Card-Cannels busy */
 734                                 } else {
 735                                         card->bch[chan].fsm_state = ACT2000_STATE_ICALL;
 736                                         cmd.driver = card->myid;
 737                                         cmd.command = ISDN_STAT_ICALL;
 738                                         cmd.arg = chan;
 739                                         cmd.parm.setup.si1 = msg->msg.connect_ind.si1;
 740                                         cmd.parm.setup.si2 = msg->msg.connect_ind.si2;
 741                                         if (card->ptype == ISDN_PTYPE_EURO)
 742                                                 strcpy(cmd.parm.setup.eazmsn,
 743                                                        act2000_find_eaz(card, msg->msg.connect_ind.eaz));
 744                                         else {
 745                                                 cmd.parm.setup.eazmsn[0] = msg->msg.connect_ind.eaz;
 746                                                 cmd.parm.setup.eazmsn[1] = 0;
 747                                         }
 748                                         memset(cmd.parm.setup.phone, 0, sizeof(cmd.parm.setup.phone));
 749                                         memcpy(cmd.parm.setup.phone, msg->msg.connect_ind.addr.num,
 750                                                msg->msg.connect_ind.addr.len - 1);
 751                                         cmd.parm.setup.plan = msg->msg.connect_ind.addr.tnp;
 752                                         cmd.parm.setup.screen = 0;
 753                                         if (card->interface.statcallb(&cmd) == 2)
 754                                                 actcapi_connect_resp(card, &card->bch[chan], 0x15); /* Reject Call */
 755                                 }
 756                                 break;
 757                         case 0x0302:
 758                                 /* CONNECT_ACTIVE_IND */
 759                                 chan = find_plci(card, msg->msg.connect_active_ind.plci);
 760                                 if (chan >= 0)
 761                                         switch (card->bch[chan].fsm_state) {
 762                                                 case ACT2000_STATE_IWAIT:
 763                                                         actcapi_connect_active_resp(card, &card->bch[chan]);
 764                                                         break;
 765                                                 case ACT2000_STATE_OWAIT:
 766                                                         actcapi_connect_active_resp(card, &card->bch[chan]);
 767                                                         actcapi_select_b2_protocol_req(card, &card->bch[chan]);
 768                                                         break;
 769                                         }
 770                                 break;
 771                         case 0x8202:
 772                                 /* CONNECT_B3_IND */
 773                                 chan = find_plci(card, msg->msg.connect_b3_ind.plci);
 774                                 if ((chan >= 0) && (card->bch[chan].fsm_state == ACT2000_STATE_IBWAIT)) {
 775                                         card->bch[chan].ncci = msg->msg.connect_b3_ind.ncci;
 776                                         actcapi_connect_b3_resp(card, &card->bch[chan], 0);
 777                                 } else {
 778                                         ctmp = (act2000_chan *)tmp;
 779                                         ctmp->ncci = msg->msg.connect_b3_ind.ncci;
 780                                         actcapi_connect_b3_resp(card, ctmp, 0x11); /* All Card-Cannels busy */
 781                                 }
 782                                 break;
 783                         case 0x8302:
 784                                 /* CONNECT_B3_ACTIVE_IND */
 785                                 chan = find_ncci(card, msg->msg.connect_b3_active_ind.ncci);
 786                                 if ((chan >= 0) && (card->bch[chan].fsm_state == ACT2000_STATE_BWAIT)) {
 787                                         actcapi_connect_b3_active_resp(card, &card->bch[chan]);
 788                                         cmd.driver = card->myid;
 789                                         cmd.command = ISDN_STAT_BCONN;
 790                                         cmd.arg = chan;
 791                                         card->interface.statcallb(&cmd);
 792                                 }
 793                                 break;
 794                         case 0x8402:
 795                                 /* DISCONNECT_B3_IND */
 796                                 chan = find_ncci(card, msg->msg.disconnect_b3_ind.ncci);
 797                                 if (chan >= 0) {
 798                                         ctmp = &card->bch[chan];
 799                                         actcapi_disconnect_b3_resp(card, ctmp);
 800                                         switch (ctmp->fsm_state) {
 801                                                 case ACT2000_STATE_ACTIVE:
 802                                                         ctmp->fsm_state = ACT2000_STATE_DHWAIT2;
 803                                                         cmd.driver = card->myid;
 804                                                         cmd.command = ISDN_STAT_BHUP;
 805                                                         cmd.arg = chan;
 806                                                         card->interface.statcallb(&cmd);
 807                                                         break;
 808                                                 case ACT2000_STATE_BHWAIT2:
 809                                                         actcapi_disconnect_req(card, ctmp);
 810                                                         ctmp->fsm_state = ACT2000_STATE_DHWAIT;
 811                                                         cmd.driver = card->myid;
 812                                                         cmd.command = ISDN_STAT_BHUP;
 813                                                         cmd.arg = chan;
 814                                                         card->interface.statcallb(&cmd);
 815                                                         break;
 816                                         }
 817                                 }
 818                                 break;
 819                         case 0x0402:
 820                                 /* DISCONNECT_IND */
 821                                 chan = find_plci(card, msg->msg.disconnect_ind.plci);
 822                                 if (chan >= 0) {
 823                                         ctmp = &card->bch[chan];
 824                                         actcapi_disconnect_resp(card, ctmp);
 825                                         ctmp->fsm_state = ACT2000_STATE_NULL;
 826                                         cmd.driver = card->myid;
 827                                         cmd.command = ISDN_STAT_DHUP;
 828                                         cmd.arg = chan;
 829                                         card->interface.statcallb(&cmd);
 830                                 } else {
 831                                         ctmp = (act2000_chan *)tmp;
 832                                         ctmp->plci = msg->msg.disconnect_ind.plci;
 833                                         actcapi_disconnect_resp(card, ctmp);
 834                                 }
 835                                 break;
 836                         case 0x4001:
 837                                 /* SELECT_B2_PROTOCOL_CONF */
 838                                 chan = find_plci(card, msg->msg.select_b2_protocol_conf.plci);
 839                                 if (chan >= 0)
 840                                         switch (card->bch[chan].fsm_state) {
 841                                                 case ACT2000_STATE_ICALL:
 842                                                 case ACT2000_STATE_OWAIT:
 843                                                         ctmp = &card->bch[chan];
 844                                                         if (msg->msg.select_b2_protocol_conf.info == 0)
 845                                                                 actcapi_select_b3_protocol_req(card, ctmp);
 846                                                         else {
 847                                                                 ctmp->fsm_state = ACT2000_STATE_NULL;
 848                                                                 cmd.driver = card->myid;
 849                                                                 cmd.command = ISDN_STAT_DHUP;
 850                                                                 cmd.arg = chan;
 851                                                                 card->interface.statcallb(&cmd);
 852                                                         }
 853                                                         break;
 854                                         }
 855                                 break;
 856                         case 0x8001:
 857                                 /* SELECT_B3_PROTOCOL_CONF */
 858                                 chan = find_plci(card, msg->msg.select_b3_protocol_conf.plci);
 859                                 if (chan >= 0)
 860                                         switch (card->bch[chan].fsm_state) {
 861                                                 case ACT2000_STATE_ICALL:
 862                                                 case ACT2000_STATE_OWAIT:
 863                                                         ctmp = &card->bch[chan];
 864                                                         if (msg->msg.select_b3_protocol_conf.info == 0)
 865                                                                 actcapi_listen_b3_req(card, ctmp);
 866                                                         else {
 867                                                                 ctmp->fsm_state = ACT2000_STATE_NULL;
 868                                                                 cmd.driver = card->myid;
 869                                                                 cmd.command = ISDN_STAT_DHUP;
 870                                                                 cmd.arg = chan;
 871                                                                 card->interface.statcallb(&cmd);
 872                                                         }
 873                                         }
 874                                 break;
 875                         case 0x8101:
 876                                 /* LISTEN_B3_CONF */
 877                                 chan = find_plci(card, msg->msg.listen_b3_conf.plci);
 878                                 if (chan >= 0)
 879                                         switch (card->bch[chan].fsm_state) {
 880                                                 case ACT2000_STATE_ICALL:
 881                                                         ctmp = &card->bch[chan];
 882                                                         if (msg->msg.listen_b3_conf.info == 0)
 883                                                                 actcapi_connect_resp(card, ctmp, 0);
 884                                                         else {
 885                                                                 ctmp->fsm_state = ACT2000_STATE_NULL;
 886                                                                 cmd.driver = card->myid;
 887                                                                 cmd.command = ISDN_STAT_DHUP;
 888                                                                 cmd.arg = chan;
 889                                                                 card->interface.statcallb(&cmd);
 890                                                         }
 891                                                         break;
 892                                                 case ACT2000_STATE_OWAIT:
 893                                                         ctmp = &card->bch[chan];
 894                                                         if (msg->msg.listen_b3_conf.info == 0) {
 895                                                                 actcapi_connect_b3_req(card, ctmp);
 896                                                                 ctmp->fsm_state = ACT2000_STATE_OBWAIT;
 897                                                                 cmd.driver = card->myid;
 898                                                                 cmd.command = ISDN_STAT_DCONN;
 899                                                                 cmd.arg = chan;
 900                                                                 card->interface.statcallb(&cmd);
 901                                                         } else {
 902                                                                 ctmp->fsm_state = ACT2000_STATE_NULL;
 903                                                                 cmd.driver = card->myid;
 904                                                                 cmd.command = ISDN_STAT_DHUP;
 905                                                                 cmd.arg = chan;
 906                                                                 card->interface.statcallb(&cmd);
 907                                                         }
 908                                                         break;
 909                                         }
 910                                 break;
 911                         case 0x8201:
 912                                 /* CONNECT_B3_CONF */
 913                                 chan = find_plci(card, msg->msg.connect_b3_conf.plci);
 914                                 if ((chan >= 0) && (card->bch[chan].fsm_state == ACT2000_STATE_OBWAIT)) {
 915                                         ctmp = &card->bch[chan];
 916                                         if (msg->msg.connect_b3_conf.info) {
 917                                                 ctmp->fsm_state = ACT2000_STATE_NULL;
 918                                                 cmd.driver = card->myid;
 919                                                 cmd.command = ISDN_STAT_DHUP;
 920                                                 cmd.arg = chan;
 921                                                 card->interface.statcallb(&cmd);
 922                                         } else {
 923                                                 ctmp->ncci = msg->msg.connect_b3_conf.ncci;
 924                                                 ctmp->fsm_state = ACT2000_STATE_BWAIT;
 925                                         }
 926                                 }
 927                                 break;
 928                         case 0x8401:
 929                                 /* DISCONNECT_B3_CONF */
 930                                 chan = find_ncci(card, msg->msg.disconnect_b3_conf.ncci);
 931                                 if ((chan >= 0) && (card->bch[chan].fsm_state == ACT2000_STATE_BHWAIT))
 932                                         card->bch[chan].fsm_state = ACT2000_STATE_BHWAIT2;
 933                                 break;
 934                         case 0x0702:
 935                                 /* INFO_IND */
 936                                 chan = find_plci(card, msg->msg.info_ind.plci);
 937                                 if (chan >= 0)
 938                                         /* TODO: Eval Charging info / cause */
 939                                         actcapi_info_resp(card, &card->bch[chan]);
 940                                 break;
 941                         case 0x0401:
 942                                 /* LISTEN_CONF */
 943                         case 0x0501:
 944                                 /* LISTEN_CONF */
 945                         case 0xff01:
 946                                 /* MANUFACTURER_CONF */
 947                                 break;
 948                         case 0xff02:
 949                                 /* MANUFACTURER_IND */
 950                                 if (msg->msg.manuf_msg == 3) {
 951                                         memset(tmp, 0, sizeof(tmp));
 952                                         strncpy(tmp,
 953                                                 &msg->msg.manufacturer_ind_err.errstring,
 954                                                 msg->hdr.len - 16);
 955                                         if (msg->msg.manufacturer_ind_err.errcode)
 956                                                 printk(KERN_WARNING "act2000: %s\n", tmp);
 957                                         else {
 958                                                 printk(KERN_DEBUG "act2000: %s\n", tmp);
 959                                                 if ((!strncmp(tmp, "INFO: Trace buffer con", 22)) ||
 960                                                     (!strncmp(tmp, "INFO: Compile Date/Tim", 22))) {
 961                                                         card->flags |= ACT2000_FLAGS_RUNNING;
 962                                                         cmd.command = ISDN_STAT_RUN;
 963                                                         cmd.driver = card->myid;
 964                                                         cmd.arg = 0;
 965                                                         actcapi_manufacturer_req_net(card);
 966                                                         actcapi_manufacturer_req_msn(card);
 967                                                         actcapi_listen_req(card);
 968                                                         card->interface.statcallb(&cmd);
 969                                                 }
 970                                         }
 971                                 }
 972                                 break;
 973                         default:
 974                                 printk(KERN_WARNING "act2000: UNHANDLED Message %04x\n", ccmd);
 975                                 break;
 976                 }
 977                 dev_kfree_skb(skb);
 978         }
 979 }
 980
 981 #ifdef DEBUG_MSG
 982 static void
 983 actcapi_debug_caddr(actcapi_addr *addr)
 984 {
 985         char tmp[30];
 986
 987         printk(KERN_DEBUG " Alen  = %d\n", addr->len);
 988         if (addr->len > 0)
 989                 printk(KERN_DEBUG " Atnp  = 0x%02x\n", addr->tnp);
 990         if (addr->len > 1) {
 991                 memset(tmp, 0, 30);
 992                 memcpy(tmp, addr->num, addr->len - 1);
 993                 printk(KERN_DEBUG " Anum  = '%s'\n", tmp);
 994         }
 995 }
 996
 997 static void
 998 actcapi_debug_ncpi(actcapi_ncpi *ncpi)
 999 {
1000         printk(KERN_DEBUG " ncpi.len = %d\n", ncpi->len);
1001         if (ncpi->len >= 2)
1002                 printk(KERN_DEBUG " ncpi.lic = 0x%04x\n", ncpi->lic);
1003         if (ncpi->len >= 4)
1004                 printk(KERN_DEBUG " ncpi.hic = 0x%04x\n", ncpi->hic);
1005         if (ncpi->len >= 6)
1006                 printk(KERN_DEBUG " ncpi.ltc = 0x%04x\n", ncpi->ltc);
1007         if (ncpi->len >= 8)
1008                 printk(KERN_DEBUG " ncpi.htc = 0x%04x\n", ncpi->htc);
1009         if (ncpi->len >= 10)
1010                 printk(KERN_DEBUG " ncpi.loc = 0x%04x\n", ncpi->loc);
1011         if (ncpi->len >= 12)
1012                 printk(KERN_DEBUG " ncpi.hoc = 0x%04x\n", ncpi->hoc);
1013         if (ncpi->len >= 13)
1014                 printk(KERN_DEBUG " ncpi.mod = %d\n", ncpi->modulo);
1015 }
1016
1017 static void
1018 actcapi_debug_dlpd(actcapi_dlpd *dlpd)
1019 {
1020         printk(KERN_DEBUG " dlpd.len = %d\n", dlpd->len);
1021         if (dlpd->len >= 2)
1022                 printk(KERN_DEBUG " dlpd.dlen   = 0x%04x\n", dlpd->dlen);
1023         if (dlpd->len >= 3)
1024                 printk(KERN_DEBUG " dlpd.laa    = 0x%02x\n", dlpd->laa);
1025         if (dlpd->len >= 4)
1026                 printk(KERN_DEBUG " dlpd.lab    = 0x%02x\n", dlpd->lab);
1027         if (dlpd->len >= 5)
1028                 printk(KERN_DEBUG " dlpd.modulo = %d\n", dlpd->modulo);
1029         if (dlpd->len >= 6)
1030                 printk(KERN_DEBUG " dlpd.win    = %d\n", dlpd->win);
1031 }
1032
1033 #ifdef DEBUG_DUMP_SKB
1034 static void dump_skb(struct sk_buff *skb) {
1035         char tmp[80];
1036         char *p = skb->data;
1037         char *t = tmp;
1038         int i;
1039
1040         for (i = 0; i < skb->len; i++) {
1041                 t += sprintf(t, "%02x ", *p++ & 0xff);
1042                 if ((i & 0x0f) == 8) {
1043                         printk(KERN_DEBUG "dump: %s\n", tmp);
1044                         t = tmp;
1045                 }
1046         }
1047         if (i & 0x07)
1048                 printk(KERN_DEBUG "dump: %s\n", tmp);
1049 }
1050 #endif
1051
1052 void
1053 actcapi_debug_msg(struct sk_buff *skb, int direction)
1054 {
1055         actcapi_msg *msg = (actcapi_msg *)skb->data;
1056         char *descr;
1057         int i;
1058         char tmp[170];
1059
1060 #ifndef DEBUG_DATA_MSG
1061         if (msg->hdr.cmd.cmd == 0x86)
1062                 return;
1063 #endif
1064         descr = "INVALID";
1065 #ifdef DEBUG_DUMP_SKB
1066         dump_skb(skb);
1067 #endif
1068         for (i = 0; i < num_valid_msg; i++)
1069                 if ((msg->hdr.cmd.cmd == valid_msg[i].cmd.cmd) &&
1070                     (msg->hdr.cmd.subcmd == valid_msg[i].cmd.subcmd)) {
1071                         descr = valid_msg[i].description;
1072                         break;
1073                 }
1074         printk(KERN_DEBUG "%s %s msg\n", direction?"Outgoing":"Incoming", descr);
1075         printk(KERN_DEBUG " ApplID = %d\n", msg->hdr.applicationID);
1076         printk(KERN_DEBUG " Len    = %d\n", msg->hdr.len);
1077         printk(KERN_DEBUG " MsgNum = 0x%04x\n", msg->hdr.msgnum);
1078         printk(KERN_DEBUG " Cmd    = 0x%02x\n", msg->hdr.cmd.cmd);
1079         printk(KERN_DEBUG " SubCmd = 0x%02x\n", msg->hdr.cmd.subcmd);
1080         switch (i) {
1081                 case 0:
1082                         /* DATA B3 IND */
1083                         printk(KERN_DEBUG " BLOCK = 0x%02x\n",
1084                                msg->msg.data_b3_ind.blocknr);
1085                         break;
1086                 case 2:
1087                         /* CONNECT CONF */
1088                         printk(KERN_DEBUG " PLCI = 0x%04x\n",
1089                                msg->msg.connect_conf.plci);
1090                         printk(KERN_DEBUG " Info = 0x%04x\n",
1091                                msg->msg.connect_conf.info);
1092                         break;
1093                 case 3:
1094                         /* CONNECT IND */
1095                         printk(KERN_DEBUG " PLCI = 0x%04x\n",
1096                                msg->msg.connect_ind.plci);
1097                         printk(KERN_DEBUG " Contr = %d\n",
1098                                msg->msg.connect_ind.controller);
1099                         printk(KERN_DEBUG " SI1   = %d\n",
1100                                msg->msg.connect_ind.si1);
1101                         printk(KERN_DEBUG " SI2   = %d\n",
1102                                msg->msg.connect_ind.si2);
1103                         printk(KERN_DEBUG " EAZ   = '%c'\n",
1104                                msg->msg.connect_ind.eaz);
1105                         actcapi_debug_caddr(&msg->msg.connect_ind.addr);
1106                         break;
1107                 case 5:
1108                         /* CONNECT ACTIVE IND */
1109                         printk(KERN_DEBUG " PLCI = 0x%04x\n",
1110                                msg->msg.connect_active_ind.plci);
1111                         actcapi_debug_caddr(&msg->msg.connect_active_ind.addr);
1112                         break;
1113                 case 8:
1114                         /* LISTEN CONF */
1115                         printk(KERN_DEBUG " Contr = %d\n",
1116                                msg->msg.listen_conf.controller);
1117                         printk(KERN_DEBUG " Info = 0x%04x\n",
1118                                msg->msg.listen_conf.info);
1119                         break;
1120                 case 11:
1121                         /* INFO IND */
1122                         printk(KERN_DEBUG " PLCI = 0x%04x\n",
1123                                msg->msg.info_ind.plci);
1124                         printk(KERN_DEBUG " Imsk = 0x%04x\n",
1125                                msg->msg.info_ind.nr.mask);
1126                         if (msg->hdr.len > 12) {
1127                                 int l = msg->hdr.len - 12;
1128                                 int j;
1129                                 char *p = tmp;
1130                                 for (j = 0; j < l ; j++)
1131                                         p += sprintf(p, "%02x ", msg->msg.info_ind.el.display[j]);
1132                                 printk(KERN_DEBUG " D = '%s'\n", tmp);
1133                         }
1134                         break;
1135                 case 14:
1136                         /* SELECT B2 PROTOCOL CONF */
1137                         printk(KERN_DEBUG " PLCI = 0x%04x\n",
1138                                msg->msg.select_b2_protocol_conf.plci);
1139                         printk(KERN_DEBUG " Info = 0x%04x\n",
1140                                msg->msg.select_b2_protocol_conf.info);
1141                         break;
1142                 case 15:
1143                         /* SELECT B3 PROTOCOL CONF */
1144                         printk(KERN_DEBUG " PLCI = 0x%04x\n",
1145                                msg->msg.select_b3_protocol_conf.plci);
1146                         printk(KERN_DEBUG " Info = 0x%04x\n",
1147                                msg->msg.select_b3_protocol_conf.info);
1148                         break;
1149                 case 16:
1150                         /* LISTEN B3 CONF */
1151                         printk(KERN_DEBUG " PLCI = 0x%04x\n",
1152                                msg->msg.listen_b3_conf.plci);
1153                         printk(KERN_DEBUG " Info = 0x%04x\n",
1154                                msg->msg.listen_b3_conf.info);
1155                         break;
1156                 case 18:
1157                         /* CONNECT B3 IND */
1158                         printk(KERN_DEBUG " NCCI = 0x%04x\n",
1159                                msg->msg.connect_b3_ind.ncci);
1160                         printk(KERN_DEBUG " PLCI = 0x%04x\n",
1161                                msg->msg.connect_b3_ind.plci);
1162                         actcapi_debug_ncpi(&msg->msg.connect_b3_ind.ncpi);
1163                         break;
1164                 case 19:
1165                         /* CONNECT B3 ACTIVE IND */
1166                         printk(KERN_DEBUG " NCCI = 0x%04x\n",
1167                                msg->msg.connect_b3_active_ind.ncci);
1168                         actcapi_debug_ncpi(&msg->msg.connect_b3_active_ind.ncpi);
1169                         break;
1170                 case 26:
1171                         /* MANUFACTURER IND */
1172                         printk(KERN_DEBUG " Mmsg = 0x%02x\n",
1173                                msg->msg.manufacturer_ind_err.manuf_msg);
1174                         switch (msg->msg.manufacturer_ind_err.manuf_msg) {
1175                                 case 3:
1176                                         printk(KERN_DEBUG " Contr = %d\n",
1177                                                msg->msg.manufacturer_ind_err.controller);
1178                                         printk(KERN_DEBUG " Code = 0x%08x\n",
1179                                                msg->msg.manufacturer_ind_err.errcode);
1180                                         memset(tmp, 0, sizeof(tmp));
1181                                         strncpy(tmp, &msg->msg.manufacturer_ind_err.errstring,
1182                                                 msg->hdr.len - 16);
1183                                         printk(KERN_DEBUG " Emsg = '%s'\n", tmp);
1184                                         break;
1185                         }
1186                         break;
1187                 case 30:
1188                         /* LISTEN REQ */
1189                         printk(KERN_DEBUG " Imsk = 0x%08x\n",
1190                                msg->msg.listen_req.infomask);
1191                         printk(KERN_DEBUG " Emsk = 0x%04x\n",
1192                                msg->msg.listen_req.eazmask);
1193                         printk(KERN_DEBUG " Smsk = 0x%04x\n",
1194                                msg->msg.listen_req.simask);
1195                         break;
1196                 case 35:
1197                         /* SELECT_B2_PROTOCOL_REQ */
1198                         printk(KERN_DEBUG " PLCI  = 0x%04x\n",
1199                                msg->msg.select_b2_protocol_req.plci);
1200                         printk(KERN_DEBUG " prot  = 0x%02x\n",
1201                                msg->msg.select_b2_protocol_req.protocol);
1202                         if (msg->hdr.len >= 11)
1203                                 printk(KERN_DEBUG "No dlpd\n");
1204                         else
1205                                 actcapi_debug_dlpd(&msg->msg.select_b2_protocol_req.dlpd);
1206                         break;
1207                 case 44:
1208                         /* CONNECT RESP */
1209                         printk(KERN_DEBUG " PLCI  = 0x%04x\n",
1210                                msg->msg.connect_resp.plci);
1211                         printk(KERN_DEBUG " CAUSE = 0x%02x\n",
1212                                msg->msg.connect_resp.rejectcause);
1213                         break;
1214                 case 45:
1215                         /* CONNECT ACTIVE RESP */
1216                         printk(KERN_DEBUG " PLCI  = 0x%04x\n",
1217                                msg->msg.connect_active_resp.plci);
1218                         break;
1219         }
1220 }
1221 #endif