SAFE public projects git trees. - safe/jmp/linux-2.6/blob - drivers/isdn/hysdn/hycapi.c

   1 /* $Id: hycapi.c,v 1.8.6.4 2001/09/23 22:24:54 kai Exp $
   2  *
   3  * Linux driver for HYSDN cards, CAPI2.0-Interface.
   4  *
   5  * Author    Ulrich Albrecht <u.albrecht@hypercope.de> for Hypercope GmbH
   6  * Copyright 2000 by Hypercope GmbH
   7  *
   8  * This software may be used and distributed according to the terms
   9  * of the GNU General Public License, incorporated herein by reference.
  10  *
  11  */
  12
  13 #include <linux/module.h>
  14 #include <linux/version.h>
  15 #include <linux/signal.h>
  16 #include <linux/kernel.h>
  17 #include <linux/skbuff.h>
  18 #include <linux/netdevice.h>
  19
  20 #define VER_DRIVER      0
  21 #define VER_CARDTYPE    1
  22 #define VER_HWID        2
  23 #define VER_SERIAL      3
  24 #define VER_OPTION      4
  25 #define VER_PROTO       5
  26 #define VER_PROFILE     6
  27 #define VER_CAPI        7
  28
  29 #include "hysdn_defs.h"
  30 #include <linux/kernelcapi.h>
  31
  32 static char hycapi_revision[]="$Revision: 1.8.6.4 $";
  33
  34 unsigned int hycapi_enable = 0xffffffff;
  35 MODULE_PARM(hycapi_enable, "i");
  36
  37 typedef struct _hycapi_appl {
  38         unsigned int ctrl_mask;
  39         capi_register_params rp;
  40         struct sk_buff *listen_req[CAPI_MAXCONTR];
  41 } hycapi_appl;
  42
  43 static hycapi_appl hycapi_applications[CAPI_MAXAPPL];
  44
  45 static inline int _hycapi_appCheck(int app_id, int ctrl_no)
  46 {
  47         if((ctrl_no <= 0) || (ctrl_no > CAPI_MAXCONTR) || (app_id <= 0) ||
  48            (app_id > CAPI_MAXAPPL))
  49         {
  50                 printk(KERN_ERR "HYCAPI: Invalid request app_id %d for controller %d", app_id, ctrl_no);
  51                 return -1;
  52         }
  53         return ((hycapi_applications[app_id-1].ctrl_mask & (1 << (ctrl_no-1))) != 0);
  54 }
  55
  56 /******************************
  57 Kernel-Capi callback reset_ctr
  58 ******************************/
  59
  60 void
  61 hycapi_reset_ctr(struct capi_ctr *ctrl)
  62 {
  63         hycapictrl_info *cinfo = ctrl->driverdata;
  64
  65 #ifdef HYCAPI_PRINTFNAMES
  66         printk(KERN_NOTICE "HYCAPI hycapi_reset_ctr\n");
  67 #endif
  68         capilib_release(&cinfo->ncci_head);
  69         capi_ctr_reseted(ctrl);
  70 }
  71
  72 /******************************
  73 Kernel-Capi callback remove_ctr
  74 ******************************/
  75
  76 void
  77 hycapi_remove_ctr(struct capi_ctr *ctrl)
  78 {
  79         int i;
  80         hycapictrl_info *cinfo = NULL;
  81         hysdn_card *card = NULL;
  82 #ifdef HYCAPI_PRINTFNAMES
  83         printk(KERN_NOTICE "HYCAPI hycapi_remove_ctr\n");
  84 #endif
  85         cinfo = (hycapictrl_info *)(ctrl->driverdata);
  86         if(!cinfo) {
  87                 printk(KERN_ERR "No hycapictrl_info set!");
  88                 return;
  89         }
  90         card = cinfo->card;
  91         capi_ctr_suspend_output(ctrl);
  92         for(i=0; i<CAPI_MAXAPPL;i++) {
  93                 if(hycapi_applications[i].listen_req[ctrl->cnr-1]) {
  94                         kfree_skb(hycapi_applications[i].listen_req[ctrl->cnr-1]);
  95                         hycapi_applications[i].listen_req[ctrl->cnr-1] = NULL;
  96                 }
  97         }
  98         detach_capi_ctr(ctrl);
  99         ctrl->driverdata = NULL;
 100         kfree(card->hyctrlinfo);
 101
 102
 103         card->hyctrlinfo = NULL;
 104 }
 105
 106 /***********************************************************
 107
 108 Queue a CAPI-message to the controller.
 109
 110 ***********************************************************/
 111
 112 static void
 113 hycapi_sendmsg_internal(struct capi_ctr *ctrl, struct sk_buff *skb)
 114 {
 115         hycapictrl_info *cinfo = (hycapictrl_info *)(ctrl->driverdata);
 116         hysdn_card *card = cinfo->card;
 117
 118         spin_lock_irq(&cinfo->lock);
 119 #ifdef HYCAPI_PRINTFNAMES
 120         printk(KERN_NOTICE "hycapi_send_message\n");
 121 #endif
 122         cinfo->skbs[cinfo->in_idx++] = skb;     /* add to buffer list */
 123         if (cinfo->in_idx >= HYSDN_MAX_CAPI_SKB)
 124                 cinfo->in_idx = 0;      /* wrap around */
 125         cinfo->sk_count++;              /* adjust counter */
 126         if (cinfo->sk_count >= HYSDN_MAX_CAPI_SKB) {
 127                 /* inform upper layers we're full */
 128                 printk(KERN_ERR "HYSDN Card%d: CAPI-buffer overrun!\n",
 129                        card->myid);
 130                 capi_ctr_suspend_output(ctrl);
 131         }
 132         cinfo->tx_skb = skb;
 133         spin_unlock_irq(&cinfo->lock);
 134         schedule_work(&card->irq_queue);
 135 }
 136
 137 /***********************************************************
 138 hycapi_register_internal
 139
 140 Send down the CAPI_REGISTER-Command to the controller.
 141 This functions will also be used if the adapter has been rebooted to
 142 re-register any applications in the private list.
 143
 144 ************************************************************/
 145
 146 static void
 147 hycapi_register_internal(struct capi_ctr *ctrl, __u16 appl,
 148                          capi_register_params *rp)
 149 {
 150         char ExtFeatureDefaults[] = "49  /0/0/0/0,*/1,*/2,*/3,*/4,*/5,*/6,*/7,*/8,*/9,*";
 151         hycapictrl_info *cinfo = (hycapictrl_info *)(ctrl->driverdata);
 152         hysdn_card *card = cinfo->card;
 153         struct sk_buff *skb;
 154         __u16 len;
 155         __u8 _command = 0xa0, _subcommand = 0x80;
 156         __u16 MessageNumber = 0x0000;
 157         __u16 MessageBufferSize = 0;
 158         int slen = strlen(ExtFeatureDefaults);
 159 #ifdef HYCAPI_PRINTFNAMES
 160         printk(KERN_NOTICE "hycapi_register_appl\n");
 161 #endif
 162         MessageBufferSize = rp->level3cnt * rp->datablkcnt * rp->datablklen;
 163
 164         len = CAPI_MSG_BASELEN + 8 + slen + 1;
 165         if (!(skb = alloc_skb(len, GFP_ATOMIC))) {
 166                 printk(KERN_ERR "HYSDN card%d: memory squeeze in hycapi_register_appl\n",
 167                        card->myid);
 168                 return;
 169         }
 170         memcpy(skb_put(skb,sizeof(__u16)), &len, sizeof(__u16));
 171         memcpy(skb_put(skb,sizeof(__u16)), &appl, sizeof(__u16));
 172         memcpy(skb_put(skb,sizeof(__u8)), &_command, sizeof(_command));
 173         memcpy(skb_put(skb,sizeof(__u8)), &_subcommand, sizeof(_subcommand));
 174         memcpy(skb_put(skb,sizeof(__u16)), &MessageNumber, sizeof(__u16));
 175         memcpy(skb_put(skb,sizeof(__u16)), &MessageBufferSize, sizeof(__u16));
 176         memcpy(skb_put(skb,sizeof(__u16)), &(rp->level3cnt), sizeof(__u16));
 177         memcpy(skb_put(skb,sizeof(__u16)), &(rp->datablkcnt), sizeof(__u16));
 178         memcpy(skb_put(skb,sizeof(__u16)), &(rp->datablklen), sizeof(__u16));
 179         memcpy(skb_put(skb,slen), ExtFeatureDefaults, slen);
 180         hycapi_applications[appl-1].ctrl_mask |= (1 << (ctrl->cnr-1));
 181         hycapi_send_message(ctrl, skb);
 182 }
 183
 184 /************************************************************
 185 hycapi_restart_internal
 186
 187 After an adapter has been rebootet, re-register all applications and
 188 send a LISTEN_REQ (if there has been such a thing )
 189
 190 *************************************************************/
 191
 192 static void hycapi_restart_internal(struct capi_ctr *ctrl)
 193 {
 194         int i;
 195         struct sk_buff *skb;
 196 #ifdef HYCAPI_PRINTFNAMES
 197         printk(KERN_WARNING "HYSDN: hycapi_restart_internal");
 198 #endif
 199         for(i=0; i<CAPI_MAXAPPL; i++) {
 200                 if(_hycapi_appCheck(i+1, ctrl->cnr) == 1) {
 201                         hycapi_register_internal(ctrl, i+1,
 202                                                  &hycapi_applications[i].rp);
 203                         if(hycapi_applications[i].listen_req[ctrl->cnr-1]) {
 204                                 skb = skb_copy(hycapi_applications[i].listen_req[ctrl->cnr-1], GFP_ATOMIC);
 205                                 hycapi_sendmsg_internal(ctrl, skb);
 206                         }
 207                 }
 208         }
 209 }
 210
 211 /*************************************************************
 212 Register an application.
 213 Error-checking is done for CAPI-compliance.
 214
 215 The application is recorded in the internal list.
 216 *************************************************************/
 217
 218 void
 219 hycapi_register_appl(struct capi_ctr *ctrl, __u16 appl,
 220                      capi_register_params *rp)
 221 {
 222         int MaxLogicalConnections = 0, MaxBDataBlocks = 0, MaxBDataLen = 0;
 223         hycapictrl_info *cinfo = (hycapictrl_info *)(ctrl->driverdata);
 224         hysdn_card *card = cinfo->card;
 225         int chk = _hycapi_appCheck(appl, ctrl->cnr);
 226         if(chk < 0) {
 227                 return;
 228         }
 229         if(chk == 1) {
 230                 printk(KERN_INFO "HYSDN: apl %d already registered\n", appl);
 231                 return;
 232         }
 233         MaxBDataBlocks = rp->datablkcnt > CAPI_MAXDATAWINDOW ? CAPI_MAXDATAWINDOW : rp->datablkcnt;
 234         rp->datablkcnt = MaxBDataBlocks;
 235         MaxBDataLen = rp->datablklen < 1024 ? 1024 : rp->datablklen ;
 236         rp->datablklen = MaxBDataLen;
 237
 238         MaxLogicalConnections = rp->level3cnt;
 239         if (MaxLogicalConnections < 0) {
 240                 MaxLogicalConnections = card->bchans * -MaxLogicalConnections;
 241         }
 242         if (MaxLogicalConnections == 0) {
 243                 MaxLogicalConnections = card->bchans;
 244         }
 245
 246         rp->level3cnt = MaxLogicalConnections;
 247         memcpy(&hycapi_applications[appl-1].rp,
 248                rp, sizeof(capi_register_params));
 249 }
 250
 251 /*********************************************************************
 252
 253 hycapi_release_internal
 254
 255 Send down a CAPI_RELEASE to the controller.
 256 *********************************************************************/
 257
 258 static void hycapi_release_internal(struct capi_ctr *ctrl, __u16 appl)
 259 {
 260         hycapictrl_info *cinfo = (hycapictrl_info *)(ctrl->driverdata);
 261         hysdn_card *card = cinfo->card;
 262         struct sk_buff *skb;
 263         __u16 len;
 264         __u8 _command = 0xa1, _subcommand = 0x80;
 265         __u16 MessageNumber = 0x0000;
 266
 267         capilib_release_appl(&cinfo->ncci_head, appl);
 268
 269 #ifdef HYCAPI_PRINTFNAMES
 270         printk(KERN_NOTICE "hycapi_release_appl\n");
 271 #endif
 272         len = CAPI_MSG_BASELEN;
 273         if (!(skb = alloc_skb(len, GFP_ATOMIC))) {
 274                 printk(KERN_ERR "HYSDN card%d: memory squeeze in hycapi_register_appl\n",
 275                        card->myid);
 276                 return;
 277         }
 278         memcpy(skb_put(skb,sizeof(__u16)), &len, sizeof(__u16));
 279         memcpy(skb_put(skb,sizeof(__u16)), &appl, sizeof(__u16));
 280         memcpy(skb_put(skb,sizeof(__u8)), &_command, sizeof(_command));
 281         memcpy(skb_put(skb,sizeof(__u8)), &_subcommand, sizeof(_subcommand));
 282         memcpy(skb_put(skb,sizeof(__u16)), &MessageNumber, sizeof(__u16));
 283         hycapi_send_message(ctrl, skb);
 284         hycapi_applications[appl-1].ctrl_mask &= ~(1 << (ctrl->cnr-1));
 285 }
 286
 287 /******************************************************************
 288 hycapi_release_appl
 289
 290 Release the application from the internal list an remove it's
 291 registration at controller-level
 292 ******************************************************************/
 293
 294 void
 295 hycapi_release_appl(struct capi_ctr *ctrl, __u16 appl)
 296 {
 297         int chk;
 298
 299         chk = _hycapi_appCheck(appl, ctrl->cnr);
 300         if(chk<0) {
 301                 printk(KERN_ERR "HYCAPI: Releasing invalid appl %d on controller %d\n", appl, ctrl->cnr);
 302                 return;
 303         }
 304         if(hycapi_applications[appl-1].listen_req[ctrl->cnr-1]) {
 305                 kfree_skb(hycapi_applications[appl-1].listen_req[ctrl->cnr-1]);
 306                 hycapi_applications[appl-1].listen_req[ctrl->cnr-1] = NULL;
 307         }
 308         if(chk == 1)
 309         {
 310                 hycapi_release_internal(ctrl, appl);
 311         }
 312 }
 313
 314
 315 /**************************************************************
 316 Kill a single controller.
 317 **************************************************************/
 318
 319 int hycapi_capi_release(hysdn_card *card)
 320 {
 321         hycapictrl_info *cinfo = card->hyctrlinfo;
 322         struct capi_ctr *ctrl;
 323 #ifdef HYCAPI_PRINTFNAMES
 324         printk(KERN_NOTICE "hycapi_capi_release\n");
 325 #endif
 326         if(cinfo) {
 327                 ctrl = &cinfo->capi_ctrl;
 328                 hycapi_remove_ctr(ctrl);
 329         }
 330         return 0;
 331 }
 332
 333 /**************************************************************
 334 hycapi_capi_stop
 335
 336 Stop CAPI-Output on a card. (e.g. during reboot)
 337 ***************************************************************/
 338
 339 int hycapi_capi_stop(hysdn_card *card)
 340 {
 341         hycapictrl_info *cinfo = card->hyctrlinfo;
 342         struct capi_ctr *ctrl;
 343 #ifdef HYCAPI_PRINTFNAMES
 344         printk(KERN_NOTICE "hycapi_capi_stop\n");
 345 #endif
 346         if(cinfo) {
 347                 ctrl = &cinfo->capi_ctrl;
 348 /*              ctrl->suspend_output(ctrl); */
 349                 capi_ctr_reseted(ctrl);
 350         }
 351         return 0;
 352 }
 353
 354 /***************************************************************
 355 hycapi_send_message
 356
 357 Send a message to the controller.
 358
 359 Messages are parsed for their Command/Subcommand-type, and appropriate
 360 action's are performed.
 361
 362 Note that we have to muck around with a 64Bit-DATA_REQ as there are
 363 firmware-releases that do not check the MsgLen-Indication!
 364
 365 ***************************************************************/
 366
 367 u16 hycapi_send_message(struct capi_ctr *ctrl, struct sk_buff *skb)
 368 {
 369         __u16 appl_id;
 370         int _len, _len2;
 371         __u8 msghead[64];
 372         hycapictrl_info *cinfo = ctrl->driverdata;
 373         u16 retval = CAPI_NOERROR;
 374
 375         appl_id = CAPIMSG_APPID(skb->data);
 376         switch(_hycapi_appCheck(appl_id, ctrl->cnr))
 377         {
 378                 case 0:
 379 /*                      printk(KERN_INFO "Need to register\n"); */
 380                         hycapi_register_internal(ctrl,
 381                                                  appl_id,
 382                                                  &(hycapi_applications[appl_id-1].rp));
 383                         break;
 384                 case 1:
 385                         break;
 386                 default:
 387                         printk(KERN_ERR "HYCAPI: Controller mixup!\n");
 388                         retval = CAPI_ILLAPPNR;
 389                         goto out;
 390         }
 391         switch(CAPIMSG_CMD(skb->data)) {
 392                 case CAPI_DISCONNECT_B3_RESP:
 393                         capilib_free_ncci(&cinfo->ncci_head, appl_id,
 394                                           CAPIMSG_NCCI(skb->data));
 395                         break;
 396                 case CAPI_DATA_B3_REQ:
 397                         _len = CAPIMSG_LEN(skb->data);
 398                         if (_len > 22) {
 399                                 _len2 = _len - 22;
 400                                 memcpy(msghead, skb->data, 22);
 401                                 memcpy(skb->data + _len2, msghead, 22);
 402                                 skb_pull(skb, _len2);
 403                                 CAPIMSG_SETLEN(skb->data, 22);
 404                                 retval = capilib_data_b3_req(&cinfo->ncci_head,
 405                                                              CAPIMSG_APPID(skb->data),
 406                                                              CAPIMSG_NCCI(skb->data),
 407                                                              CAPIMSG_MSGID(skb->data));
 408                         }
 409                         break;
 410                 case CAPI_LISTEN_REQ:
 411                         if(hycapi_applications[appl_id-1].listen_req[ctrl->cnr-1])
 412                         {
 413                                 kfree_skb(hycapi_applications[appl_id-1].listen_req[ctrl->cnr-1]);
 414                                 hycapi_applications[appl_id-1].listen_req[ctrl->cnr-1] = NULL;
 415                         }
 416                         if (!(hycapi_applications[appl_id-1].listen_req[ctrl->cnr-1] = skb_copy(skb, GFP_ATOMIC)))
 417                         {
 418                                 printk(KERN_ERR "HYSDN: memory squeeze in private_listen\n");
 419                         }
 420                         break;
 421                 default:
 422                         break;
 423         }
 424  out:
 425         if (retval == CAPI_NOERROR)
 426                 hycapi_sendmsg_internal(ctrl, skb);
 427         else
 428                 dev_kfree_skb_any(skb);
 429
 430         return retval;
 431 }
 432
 433 /*********************************************************************
 434 hycapi_read_proc
 435
 436 Informations provided in the /proc/capi-entries.
 437
 438 *********************************************************************/
 439
 440 int hycapi_read_proc(char *page, char **start, off_t off,
 441                      int count, int *eof, struct capi_ctr *ctrl)
 442 {
 443         hycapictrl_info *cinfo = (hycapictrl_info *)(ctrl->driverdata);
 444         hysdn_card *card = cinfo->card;
 445         int len = 0;
 446         char *s;
 447 #ifdef HYCAPI_PRINTFNAMES
 448         printk(KERN_NOTICE "hycapi_read_proc\n");
 449 #endif
 450         len += sprintf(page+len, "%-16s %s\n", "name", cinfo->cardname);
 451         len += sprintf(page+len, "%-16s 0x%x\n", "io", card->iobase);
 452         len += sprintf(page+len, "%-16s %d\n", "irq", card->irq);
 453
 454         switch (card->brdtype) {
 455                 case BD_PCCARD:  s = "HYSDN Hycard"; break;
 456                 case BD_ERGO: s = "HYSDN Ergo2"; break;
 457                 case BD_METRO: s = "HYSDN Metro4"; break;
 458                 case BD_CHAMP2: s = "HYSDN Champ2";     break;
 459                 case BD_PLEXUS: s = "HYSDN Plexus30"; break;
 460                 default: s = "???"; break;
 461         }
 462         len += sprintf(page+len, "%-16s %s\n", "type", s);
 463         if ((s = cinfo->version[VER_DRIVER]) != 0)
 464                 len += sprintf(page+len, "%-16s %s\n", "ver_driver", s);
 465         if ((s = cinfo->version[VER_CARDTYPE]) != 0)
 466                 len += sprintf(page+len, "%-16s %s\n", "ver_cardtype", s);
 467         if ((s = cinfo->version[VER_SERIAL]) != 0)
 468                 len += sprintf(page+len, "%-16s %s\n", "ver_serial", s);
 469
 470         len += sprintf(page+len, "%-16s %s\n", "cardname", cinfo->cardname);
 471
 472         if (off+count >= len)
 473                 *eof = 1;
 474         if (len < off)
 475                 return 0;
 476         *start = page + off;
 477         return ((count < len-off) ? count : len-off);
 478 }
 479
 480 /**************************************************************
 481 hycapi_load_firmware
 482
 483 This does NOT load any firmware, but the callback somehow is needed
 484 on capi-interface registration.
 485
 486 **************************************************************/
 487
 488 int hycapi_load_firmware(struct capi_ctr *ctrl, capiloaddata *data)
 489 {
 490 #ifdef HYCAPI_PRINTFNAMES
 491         printk(KERN_NOTICE "hycapi_load_firmware\n");
 492 #endif
 493         return 0;
 494 }
 495
 496
 497 char *hycapi_procinfo(struct capi_ctr *ctrl)
 498 {
 499         hycapictrl_info *cinfo = (hycapictrl_info *)(ctrl->driverdata);
 500 #ifdef HYCAPI_PRINTFNAMES
 501         printk(KERN_NOTICE "hycapi_proc_info\n");
 502 #endif
 503         if (!cinfo)
 504                 return "";
 505         sprintf(cinfo->infobuf, "%s %s 0x%x %d %s",
 506                 cinfo->cardname[0] ? cinfo->cardname : "-",
 507                 cinfo->version[VER_DRIVER] ? cinfo->version[VER_DRIVER] : "-",
 508                 cinfo->card ? cinfo->card->iobase : 0x0,
 509                 cinfo->card ? cinfo->card->irq : 0,
 510                 hycapi_revision
 511                 );
 512         return cinfo->infobuf;
 513 }
 514
 515 /******************************************************************
 516 hycapi_rx_capipkt
 517
 518 Receive a capi-message.
 519
 520 All B3_DATA_IND are converted to 64K-extension compatible format.
 521 New nccis are created if necessary.
 522 *******************************************************************/
 523
 524 void
 525 hycapi_rx_capipkt(hysdn_card * card, uchar * buf, word len)
 526 {
 527         struct sk_buff *skb;
 528         hycapictrl_info *cinfo = card->hyctrlinfo;
 529         struct capi_ctr *ctrl;
 530         __u16 ApplId;
 531         __u16 MsgLen, info;
 532         __u16 len2, CapiCmd;
 533         __u32 CP64[2] = {0,0};
 534 #ifdef HYCAPI_PRINTFNAMES
 535         printk(KERN_NOTICE "hycapi_rx_capipkt\n");
 536 #endif
 537         if(!cinfo) {
 538                 return;
 539         }
 540         ctrl = &cinfo->capi_ctrl;
 541         if(len < CAPI_MSG_BASELEN) {
 542                 printk(KERN_ERR "HYSDN Card%d: invalid CAPI-message, lenght %d!\n",
 543                        card->myid, len);
 544                 return;
 545         }
 546         MsgLen = CAPIMSG_LEN(buf);
 547         ApplId = CAPIMSG_APPID(buf);
 548         CapiCmd = CAPIMSG_CMD(buf);
 549
 550         if((CapiCmd == CAPI_DATA_B3_IND) && (MsgLen < 30)) {
 551                 len2 = len + (30 - MsgLen);
 552                 if (!(skb = alloc_skb(len2, GFP_ATOMIC))) {
 553                         printk(KERN_ERR "HYSDN Card%d: incoming packet dropped\n",
 554                                card->myid);
 555                         return;
 556                 }
 557                 memcpy(skb_put(skb, MsgLen), buf, MsgLen);
 558                 memcpy(skb_put(skb, 2*sizeof(__u32)), CP64, 2* sizeof(__u32));
 559                 memcpy(skb_put(skb, len - MsgLen), buf + MsgLen,
 560                        len - MsgLen);
 561                 CAPIMSG_SETLEN(skb->data, 30);
 562         } else {
 563                 if (!(skb = alloc_skb(len, GFP_ATOMIC))) {
 564                         printk(KERN_ERR "HYSDN Card%d: incoming packet dropped\n",
 565                                card->myid);
 566                         return;
 567                 }
 568                 memcpy(skb_put(skb, len), buf, len);
 569         }
 570         switch(CAPIMSG_CMD(skb->data))
 571         {
 572                 case CAPI_CONNECT_B3_CONF:
 573 /* Check info-field for error-indication: */
 574                         info = CAPIMSG_U16(skb->data, 12);
 575                         switch(info)
 576                         {
 577                                 case 0:
 578                                         capilib_new_ncci(&cinfo->ncci_head, ApplId, CAPIMSG_NCCI(skb->data),
 579                                                          hycapi_applications[ApplId-1].rp.datablkcnt);
 580
 581                                         break;
 582                                 case 0x0001:
 583                                         printk(KERN_ERR "HYSDN Card%d: NCPI not supported by current "
 584                                                "protocol. NCPI ignored.\n", card->myid);
 585                                         break;
 586                                 case 0x2001:
 587                                         printk(KERN_ERR "HYSDN Card%d: Message not supported in"
 588                                                " current state\n", card->myid);
 589                                         break;
 590                                 case 0x2002:
 591                                         printk(KERN_ERR "HYSDN Card%d: invalid PLCI\n", card->myid);
 592                                         break;
 593                                 case 0x2004:
 594                                         printk(KERN_ERR "HYSDN Card%d: out of NCCI\n", card->myid);
 595                                         break;
 596                                 case 0x3008:
 597                                         printk(KERN_ERR "HYSDN Card%d: NCPI not supported\n",
 598                                                card->myid);
 599                                         break;
 600                                 default:
 601                                         printk(KERN_ERR "HYSDN Card%d: Info in CONNECT_B3_CONF: %d\n",
 602                                                card->myid, info);
 603                                         break;
 604                         }
 605                         break;
 606                 case CAPI_CONNECT_B3_IND:
 607                         capilib_new_ncci(&cinfo->ncci_head, ApplId,
 608                                          CAPIMSG_NCCI(skb->data),
 609                                          hycapi_applications[ApplId-1].rp.datablkcnt);
 610                         break;
 611                 case CAPI_DATA_B3_CONF:
 612                         capilib_data_b3_conf(&cinfo->ncci_head, ApplId,
 613                                              CAPIMSG_NCCI(skb->data),
 614                                              CAPIMSG_MSGID(skb->data));
 615                         break;
 616                 default:
 617                         break;
 618         }
 619         capi_ctr_handle_message(ctrl, ApplId, skb);
 620 }
 621
 622 /******************************************************************
 623 hycapi_tx_capiack
 624
 625 Internally acknowledge a msg sent. This will remove the msg from the
 626 internal queue.
 627
 628 *******************************************************************/
 629
 630 void hycapi_tx_capiack(hysdn_card * card)
 631 {
 632         hycapictrl_info *cinfo = card->hyctrlinfo;
 633 #ifdef HYCAPI_PRINTFNAMES
 634         printk(KERN_NOTICE "hycapi_tx_capiack\n");
 635 #endif
 636         if(!cinfo) {
 637                 return;
 638         }
 639         spin_lock_irq(&cinfo->lock);
 640         kfree_skb(cinfo->skbs[cinfo->out_idx]);         /* free skb */
 641         cinfo->skbs[cinfo->out_idx++] = NULL;
 642         if (cinfo->out_idx >= HYSDN_MAX_CAPI_SKB)
 643                 cinfo->out_idx = 0;     /* wrap around */
 644
 645         if (cinfo->sk_count-- == HYSDN_MAX_CAPI_SKB)    /* dec usage count */
 646                 capi_ctr_resume_output(&cinfo->capi_ctrl);
 647         spin_unlock_irq(&cinfo->lock);
 648 }
 649
 650 /***************************************************************
 651 hycapi_tx_capiget(hysdn_card *card)
 652
 653 This is called when polling for messages to SEND.
 654
 655 ****************************************************************/
 656
 657 struct sk_buff *
 658 hycapi_tx_capiget(hysdn_card *card)
 659 {
 660         hycapictrl_info *cinfo = card->hyctrlinfo;
 661         if(!cinfo) {
 662                 return (struct sk_buff *)NULL;
 663         }
 664         if (!cinfo->sk_count)
 665                 return (struct sk_buff *)NULL;  /* nothing available */
 666
 667         return (cinfo->skbs[cinfo->out_idx]);           /* next packet to send */
 668 }
 669
 670
 671 /**********************************************************
 672 int hycapi_init()
 673
 674 attach the capi-driver to the kernel-capi.
 675
 676 ***********************************************************/
 677
 678 int hycapi_init(void)
 679 {
 680         int i;
 681         for(i=0;i<CAPI_MAXAPPL;i++) {
 682                 memset(&(hycapi_applications[i]), 0, sizeof(hycapi_appl));
 683         }
 684         return(0);
 685 }
 686
 687 /**************************************************************
 688 hycapi_cleanup(void)
 689
 690 detach the capi-driver to the kernel-capi. Actually this should
 691 free some more ressources. Do that later.
 692 **************************************************************/
 693
 694 void
 695 hycapi_cleanup(void)
 696 {
 697 }
 698
 699 /********************************************************************
 700 hycapi_capi_create(hysdn_card *card)
 701
 702 Attach the card with its capi-ctrl.
 703 *********************************************************************/
 704
 705 static void hycapi_fill_profile(hysdn_card *card)
 706 {
 707         hycapictrl_info *cinfo = NULL;
 708         struct capi_ctr *ctrl = NULL;
 709         cinfo = card->hyctrlinfo;
 710         if(!cinfo) return;
 711         ctrl = &cinfo->capi_ctrl;
 712         strcpy(ctrl->manu, "Hypercope");
 713         ctrl->version.majorversion = 2;
 714         ctrl->version.minorversion = 0;
 715         ctrl->version.majormanuversion = 3;
 716         ctrl->version.minormanuversion = 2;
 717         ctrl->profile.ncontroller = card->myid;
 718         ctrl->profile.nbchannel = card->bchans;
 719         ctrl->profile.goptions = GLOBAL_OPTION_INTERNAL_CONTROLLER |
 720                 GLOBAL_OPTION_B_CHANNEL_OPERATION;
 721         ctrl->profile.support1 =  B1_PROT_64KBIT_HDLC |
 722                 (card->faxchans ? B1_PROT_T30 : 0) |
 723                 B1_PROT_64KBIT_TRANSPARENT;
 724         ctrl->profile.support2 = B2_PROT_ISO7776 |
 725                 (card->faxchans ? B2_PROT_T30 : 0) |
 726                 B2_PROT_TRANSPARENT;
 727         ctrl->profile.support3 = B3_PROT_TRANSPARENT |
 728                 B3_PROT_T90NL |
 729                 (card->faxchans ? B3_PROT_T30 : 0) |
 730                 (card->faxchans ? B3_PROT_T30EXT : 0) |
 731                 B3_PROT_ISO8208;
 732 }
 733
 734 int
 735 hycapi_capi_create(hysdn_card *card)
 736 {
 737         hycapictrl_info *cinfo = NULL;
 738         struct capi_ctr *ctrl = NULL;
 739         int retval;
 740 #ifdef HYCAPI_PRINTFNAMES
 741         printk(KERN_NOTICE "hycapi_capi_create\n");
 742 #endif
 743         if((hycapi_enable & (1 << card->myid)) == 0) {
 744                 return 1;
 745         }
 746         if (!card->hyctrlinfo) {
 747                 cinfo = (hycapictrl_info *) kmalloc(sizeof(hycapictrl_info), GFP_ATOMIC);
 748                 if (!cinfo) {
 749                         printk(KERN_WARNING "HYSDN: no memory for capi-ctrl.\n");
 750                         return -ENOMEM;
 751                 }
 752                 memset(cinfo, 0, sizeof(hycapictrl_info));
 753                 card->hyctrlinfo = cinfo;
 754                 cinfo->card = card;
 755                 spin_lock_init(&cinfo->lock);
 756                 INIT_LIST_HEAD(&cinfo->ncci_head);
 757
 758                 switch (card->brdtype) {
 759                         case BD_PCCARD:  strcpy(cinfo->cardname,"HYSDN Hycard"); break;
 760                         case BD_ERGO: strcpy(cinfo->cardname,"HYSDN Ergo2"); break;
 761                         case BD_METRO: strcpy(cinfo->cardname,"HYSDN Metro4"); break;
 762                         case BD_CHAMP2: strcpy(cinfo->cardname,"HYSDN Champ2"); break;
 763                         case BD_PLEXUS: strcpy(cinfo->cardname,"HYSDN Plexus30"); break;
 764                         default: strcpy(cinfo->cardname,"HYSDN ???"); break;
 765                 }
 766
 767                 ctrl = &cinfo->capi_ctrl;
 768                 ctrl->driver_name   = "hycapi";
 769                 ctrl->driverdata    = cinfo;
 770                 ctrl->register_appl = hycapi_register_appl;
 771                 ctrl->release_appl  = hycapi_release_appl;
 772                 ctrl->send_message  = hycapi_send_message;
 773                 ctrl->load_firmware = hycapi_load_firmware;
 774                 ctrl->reset_ctr     = hycapi_reset_ctr;
 775                 ctrl->procinfo      = hycapi_procinfo;
 776                 ctrl->ctr_read_proc = hycapi_read_proc;
 777                 strcpy(ctrl->name, cinfo->cardname);
 778                 ctrl->owner = THIS_MODULE;
 779
 780                 retval = attach_capi_ctr(ctrl);
 781                 if (retval) {
 782                         printk(KERN_ERR "hycapi: attach controller failed.\n");
 783                         return -EBUSY;
 784                 }
 785                 /* fill in the blanks: */
 786                 hycapi_fill_profile(card);
 787                 capi_ctr_ready(ctrl);
 788         } else {
 789                 /* resume output on stopped ctrl */
 790                 ctrl = &card->hyctrlinfo->capi_ctrl;
 791                 hycapi_fill_profile(card);
 792                 capi_ctr_ready(ctrl);
 793                 hycapi_restart_internal(ctrl);
 794 /*              ctrl->resume_output(ctrl); */
 795         }
 796         return 0;
 797 }