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