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