]> git.proxmox.com Git - mirror_ubuntu-bionic-kernel.git/blame - drivers/isdn/hysdn/hycapi.c
procfs: new helper - PDE_DATA(inode)
[mirror_ubuntu-bionic-kernel.git] / drivers / isdn / hysdn / hycapi.c
CommitLineData
1da177e4
LT
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>
9a58a80a
AD
14#include <linux/proc_fs.h>
15#include <linux/seq_file.h>
1da177e4
LT
16#include <linux/signal.h>
17#include <linux/kernel.h>
18#include <linux/skbuff.h>
19#include <linux/netdevice.h>
5a0e3ad6 20#include <linux/slab.h>
1da177e4
LT
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
475be4d8 34static char hycapi_revision[] = "$Revision: 1.8.6.4 $";
1da177e4 35
475be4d8 36unsigned int hycapi_enable = 0xffffffff;
8d3b33f6 37module_param(hycapi_enable, uint, 0);
1da177e4
LT
38
39typedef 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
45static hycapi_appl hycapi_applications[CAPI_MAXAPPL];
46
aade0e82
AB
47static u16 hycapi_send_message(struct capi_ctr *ctrl, struct sk_buff *skb);
48
1da177e4
LT
49static inline int _hycapi_appCheck(int app_id, int ctrl_no)
50{
475be4d8 51 if ((ctrl_no <= 0) || (ctrl_no > CAPI_MAXCONTR) || (app_id <= 0) ||
1da177e4
LT
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 }
475be4d8 57 return ((hycapi_applications[app_id - 1].ctrl_mask & (1 << (ctrl_no-1))) != 0);
1da177e4
LT
58}
59
60/******************************
61Kernel-Capi callback reset_ctr
475be4d8 62******************************/
1da177e4 63
aade0e82 64static void
1da177e4
LT
65hycapi_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);
4e329972 73 capi_ctr_down(ctrl);
1da177e4
LT
74}
75
76/******************************
77Kernel-Capi callback remove_ctr
475be4d8 78******************************/
1da177e4 79
aade0e82 80static void
1da177e4
LT
81hycapi_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");
475be4d8 88#endif
1da177e4 89 cinfo = (hycapictrl_info *)(ctrl->driverdata);
475be4d8 90 if (!cinfo) {
1da177e4
LT
91 printk(KERN_ERR "No hycapictrl_info set!");
92 return;
475be4d8 93 }
1da177e4
LT
94 card = cinfo->card;
95 capi_ctr_suspend_output(ctrl);
475be4d8
JP
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;
1da177e4
LT
100 }
101 }
102 detach_capi_ctr(ctrl);
103 ctrl->driverdata = NULL;
104 kfree(card->hyctrlinfo);
105
475be4d8 106
1da177e4
LT
107 card->hyctrlinfo = NULL;
108}
109
110/***********************************************************
111
112Queue a CAPI-message to the controller.
113
114***********************************************************/
115
116static void
117hycapi_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
475be4d8 124 printk(KERN_NOTICE "hycapi_send_message\n");
1da177e4
LT
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",
475be4d8 133 card->myid);
1da177e4
LT
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/***********************************************************
142hycapi_register_internal
143
144Send down the CAPI_REGISTER-Command to the controller.
145This functions will also be used if the adapter has been rebooted to
146re-register any applications in the private list.
147
148************************************************************/
149
475be4d8 150static void
1da177e4
LT
151hycapi_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
475be4d8 164 printk(KERN_NOTICE "hycapi_register_appl\n");
1da177e4 165#endif
475be4d8 166 MessageBufferSize = rp->level3cnt * rp->datablkcnt * rp->datablklen;
1da177e4
LT
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 }
475be4d8
JP
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);
1da177e4
LT
186}
187
188/************************************************************
189hycapi_restart_internal
190
191After an adapter has been rebootet, re-register all applications and
192send a LISTEN_REQ (if there has been such a thing )
193
194*************************************************************/
195
196static 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
475be4d8
JP
203 for (i = 0; i < CAPI_MAXAPPL; i++) {
204 if (_hycapi_appCheck(i + 1, ctrl->cnr) == 1) {
205 hycapi_register_internal(ctrl, i + 1,
1da177e4 206 &hycapi_applications[i].rp);
475be4d8
JP
207 if (hycapi_applications[i].listen_req[ctrl->cnr - 1]) {
208 skb = skb_copy(hycapi_applications[i].listen_req[ctrl->cnr - 1], GFP_ATOMIC);
1da177e4
LT
209 hycapi_sendmsg_internal(ctrl, skb);
210 }
211 }
212 }
213}
214
215/*************************************************************
216Register an application.
217Error-checking is done for CAPI-compliance.
218
219The application is recorded in the internal list.
220*************************************************************/
221
aade0e82 222static void
475be4d8 223hycapi_register_appl(struct capi_ctr *ctrl, __u16 appl,
1da177e4
LT
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);
475be4d8 230 if (chk < 0) {
1da177e4
LT
231 return;
232 }
475be4d8 233 if (chk == 1) {
1da177e4
LT
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;
475be4d8 239 MaxBDataLen = rp->datablklen < 1024 ? 1024 : rp->datablklen;
1da177e4 240 rp->datablklen = MaxBDataLen;
475be4d8 241
1da177e4
LT
242 MaxLogicalConnections = rp->level3cnt;
243 if (MaxLogicalConnections < 0) {
475be4d8 244 MaxLogicalConnections = card->bchans * -MaxLogicalConnections;
1da177e4
LT
245 }
246 if (MaxLogicalConnections == 0) {
247 MaxLogicalConnections = card->bchans;
248 }
475be4d8 249
1da177e4 250 rp->level3cnt = MaxLogicalConnections;
475be4d8 251 memcpy(&hycapi_applications[appl - 1].rp,
1da177e4
LT
252 rp, sizeof(capi_register_params));
253}
254
255/*********************************************************************
256
257hycapi_release_internal
258
259Send down a CAPI_RELEASE to the controller.
260*********************************************************************/
261
262static 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 }
475be4d8
JP
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));
1da177e4
LT
289}
290
291/******************************************************************
292hycapi_release_appl
293
475be4d8 294Release the application from the internal list an remove it's
1da177e4
LT
295registration at controller-level
296******************************************************************/
297
aade0e82 298static void
1da177e4
LT
299hycapi_release_appl(struct capi_ctr *ctrl, __u16 appl)
300{
301 int chk;
302
303 chk = _hycapi_appCheck(appl, ctrl->cnr);
475be4d8 304 if (chk < 0) {
1da177e4
LT
305 printk(KERN_ERR "HYCAPI: Releasing invalid appl %d on controller %d\n", appl, ctrl->cnr);
306 return;
307 }
475be4d8
JP
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;
1da177e4 311 }
475be4d8 312 if (chk == 1)
1da177e4
LT
313 {
314 hycapi_release_internal(ctrl, appl);
315 }
316}
317
318
319/**************************************************************
320Kill a single controller.
321**************************************************************/
322
323int 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
475be4d8 330 if (cinfo) {
1da177e4
LT
331 ctrl = &cinfo->capi_ctrl;
332 hycapi_remove_ctr(ctrl);
333 }
334 return 0;
335}
336
337/**************************************************************
338hycapi_capi_stop
339
340Stop CAPI-Output on a card. (e.g. during reboot)
341***************************************************************/
342
343int 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
475be4d8 350 if (cinfo) {
1da177e4
LT
351 ctrl = &cinfo->capi_ctrl;
352/* ctrl->suspend_output(ctrl); */
4e329972 353 capi_ctr_down(ctrl);
1da177e4
LT
354 }
355 return 0;
356}
357
358/***************************************************************
359hycapi_send_message
360
361Send a message to the controller.
362
363Messages are parsed for their Command/Subcommand-type, and appropriate
364action's are performed.
365
366Note that we have to muck around with a 64Bit-DATA_REQ as there are
367firmware-releases that do not check the MsgLen-Indication!
368
369***************************************************************/
370
aade0e82 371static u16 hycapi_send_message(struct capi_ctr *ctrl, struct sk_buff *skb)
1da177e4
LT
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);
475be4d8 380 switch (_hycapi_appCheck(appl_id, ctrl->cnr))
1da177e4 381 {
475be4d8 382 case 0:
1da177e4 383/* printk(KERN_INFO "Need to register\n"); */
475be4d8
JP
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;
1da177e4 394 }
475be4d8
JP
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;
1da177e4 428 }
475be4d8 429out:
1da177e4
LT
430 if (retval == CAPI_NOERROR)
431 hycapi_sendmsg_internal(ctrl, skb);
475be4d8 432 else
1da177e4
LT
433 dev_kfree_skb_any(skb);
434
435 return retval;
436}
437
9a58a80a 438static int hycapi_proc_show(struct seq_file *m, void *v)
1da177e4 439{
9a58a80a 440 struct capi_ctr *ctrl = m->private;
1da177e4
LT
441 hycapictrl_info *cinfo = (hycapictrl_info *)(ctrl->driverdata);
442 hysdn_card *card = cinfo->card;
1da177e4 443 char *s;
9a58a80a
AD
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);
475be4d8 448
1da177e4 449 switch (card->brdtype) {
475be4d8
JP
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;
1da177e4 456 }
9a58a80a 457 seq_printf(m, "%-16s %s\n", "type", s);
94b5e0ac 458 if ((s = cinfo->version[VER_DRIVER]) != NULL)
9a58a80a 459 seq_printf(m, "%-16s %s\n", "ver_driver", s);
94b5e0ac 460 if ((s = cinfo->version[VER_CARDTYPE]) != NULL)
9a58a80a 461 seq_printf(m, "%-16s %s\n", "ver_cardtype", s);
94b5e0ac 462 if ((s = cinfo->version[VER_SERIAL]) != NULL)
9a58a80a 463 seq_printf(m, "%-16s %s\n", "ver_serial", s);
475be4d8 464
9a58a80a 465 seq_printf(m, "%-16s %s\n", "cardname", cinfo->cardname);
475be4d8 466
9a58a80a
AD
467 return 0;
468}
469
470static int hycapi_proc_open(struct inode *inode, struct file *file)
471{
d9dda78b 472 return single_open(file, hycapi_proc_show, PDE_DATA(inode));
1da177e4
LT
473}
474
9a58a80a
AD
475static 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
1da177e4
LT
483/**************************************************************
484hycapi_load_firmware
485
486This does NOT load any firmware, but the callback somehow is needed
487on capi-interface registration.
488
489**************************************************************/
490
aade0e82 491static int hycapi_load_firmware(struct capi_ctr *ctrl, capiloaddata *data)
1da177e4
LT
492{
493#ifdef HYCAPI_PRINTFNAMES
475be4d8 494 printk(KERN_NOTICE "hycapi_load_firmware\n");
1da177e4
LT
495#endif
496 return 0;
497}
498
499
aade0e82 500static char *hycapi_procinfo(struct capi_ctr *ctrl)
1da177e4
LT
501{
502 hycapictrl_info *cinfo = (hycapictrl_info *)(ctrl->driverdata);
503#ifdef HYCAPI_PRINTFNAMES
475be4d8 504 printk(KERN_NOTICE "hycapi_proc_info\n");
1da177e4
LT
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/******************************************************************
519hycapi_rx_capipkt
520
521Receive a capi-message.
522
523All B3_DATA_IND are converted to 64K-extension compatible format.
524New nccis are created if necessary.
525*******************************************************************/
526
527void
475be4d8 528hycapi_rx_capipkt(hysdn_card *card, unsigned char *buf, unsigned short len)
1da177e4
LT
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;
475be4d8 536 __u32 CP64[2] = {0, 0};
1da177e4 537#ifdef HYCAPI_PRINTFNAMES
475be4d8 538 printk(KERN_NOTICE "hycapi_rx_capipkt\n");
1da177e4 539#endif
475be4d8 540 if (!cinfo) {
1da177e4
LT
541 return;
542 }
543 ctrl = &cinfo->capi_ctrl;
475be4d8 544 if (len < CAPI_MSG_BASELEN) {
efad798b 545 printk(KERN_ERR "HYSDN Card%d: invalid CAPI-message, length %d!\n",
1da177e4
LT
546 card->myid, len);
547 return;
475be4d8 548 }
1da177e4
LT
549 MsgLen = CAPIMSG_LEN(buf);
550 ApplId = CAPIMSG_APPID(buf);
551 CapiCmd = CAPIMSG_CMD(buf);
475be4d8
JP
552
553 if ((CapiCmd == CAPI_DATA_B3_IND) && (MsgLen < 30)) {
1da177e4
LT
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);
475be4d8 561 memcpy(skb_put(skb, 2 * sizeof(__u32)), CP64, 2 * sizeof(__u32));
1da177e4
LT
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 }
475be4d8 573 switch (CAPIMSG_CMD(skb->data))
1da177e4 574 {
475be4d8 575 case CAPI_CONNECT_B3_CONF:
1da177e4 576/* Check info-field for error-indication: */
475be4d8
JP
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
584 break;
585 case 0x0001:
586 printk(KERN_ERR "HYSDN Card%d: NCPI not supported by current "
587 "protocol. NCPI ignored.\n", card->myid);
1da177e4 588 break;
475be4d8
JP
589 case 0x2001:
590 printk(KERN_ERR "HYSDN Card%d: Message not supported in"
591 " current state\n", card->myid);
1da177e4 592 break;
475be4d8
JP
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);
1da177e4
LT
602 break;
603 default:
475be4d8
JP
604 printk(KERN_ERR "HYSDN Card%d: Info in CONNECT_B3_CONF: %d\n",
605 card->myid, info);
1da177e4 606 break;
475be4d8
JP
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;
1da177e4
LT
621 }
622 capi_ctr_handle_message(ctrl, ApplId, skb);
623}
624
625/******************************************************************
626hycapi_tx_capiack
627
628Internally acknowledge a msg sent. This will remove the msg from the
629internal queue.
630
631*******************************************************************/
632
475be4d8 633void hycapi_tx_capiack(hysdn_card *card)
1da177e4
LT
634{
635 hycapictrl_info *cinfo = card->hyctrlinfo;
636#ifdef HYCAPI_PRINTFNAMES
475be4d8 637 printk(KERN_NOTICE "hycapi_tx_capiack\n");
1da177e4 638#endif
475be4d8 639 if (!cinfo) {
1da177e4
LT
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/***************************************************************
654hycapi_tx_capiget(hysdn_card *card)
655
656This is called when polling for messages to SEND.
657
658****************************************************************/
659
660struct sk_buff *
661hycapi_tx_capiget(hysdn_card *card)
662{
663 hycapictrl_info *cinfo = card->hyctrlinfo;
475be4d8 664 if (!cinfo) {
1da177e4
LT
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/**********************************************************
675int hycapi_init()
676
677attach the capi-driver to the kernel-capi.
678
679***********************************************************/
680
681int hycapi_init(void)
682{
683 int i;
475be4d8 684 for (i = 0; i < CAPI_MAXAPPL; i++) {
1da177e4
LT
685 memset(&(hycapi_applications[i]), 0, sizeof(hycapi_appl));
686 }
475be4d8 687 return (0);
1da177e4
LT
688}
689
690/**************************************************************
691hycapi_cleanup(void)
692
693detach the capi-driver to the kernel-capi. Actually this should
694free some more ressources. Do that later.
695**************************************************************/
696
475be4d8 697void
1da177e4
LT
698hycapi_cleanup(void)
699{
700}
701
702/********************************************************************
703hycapi_capi_create(hysdn_card *card)
704
705Attach the card with its capi-ctrl.
706*********************************************************************/
707
708static void hycapi_fill_profile(hysdn_card *card)
709{
710 hycapictrl_info *cinfo = NULL;
711 struct capi_ctr *ctrl = NULL;
712 cinfo = card->hyctrlinfo;
475be4d8 713 if (!cinfo) return;
1da177e4 714 ctrl = &cinfo->capi_ctrl;
475be4d8 715 strcpy(ctrl->manu, "Hypercope");
1da177e4
LT
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;
475be4d8 735}
1da177e4 736
475be4d8 737int
1da177e4
LT
738hycapi_capi_create(hysdn_card *card)
739{
740 hycapictrl_info *cinfo = NULL;
741 struct capi_ctr *ctrl = NULL;
742 int retval;
743#ifdef HYCAPI_PRINTFNAMES
475be4d8 744 printk(KERN_NOTICE "hycapi_capi_create\n");
1da177e4 745#endif
475be4d8 746 if ((hycapi_enable & (1 << card->myid)) == 0) {
1da177e4
LT
747 return 1;
748 }
749 if (!card->hyctrlinfo) {
41f96935 750 cinfo = kzalloc(sizeof(hycapictrl_info), GFP_ATOMIC);
1da177e4
LT
751 if (!cinfo) {
752 printk(KERN_WARNING "HYSDN: no memory for capi-ctrl.\n");
753 return -ENOMEM;
754 }
1da177e4
LT
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) {
475be4d8
JP
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;
1da177e4
LT
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;
9a58a80a 778 ctrl->proc_fops = &hycapi_proc_fops;
1da177e4
LT
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);
475be4d8 795 hycapi_restart_internal(ctrl);
1da177e4
LT
796/* ctrl->resume_output(ctrl); */
797 }
798 return 0;
799}