1 /* $Id: kcapi.c,v 1.1.2.8 2004/03/26 19:57:20 armin Exp $
2 *
3 * Kernel CAPI 2.0 Module
4 *
5 * Copyright 1999 by Carsten Paeth <calle@calle.de>
6 * Copyright 2002 by Kai Germaschewski <kai@germaschewski.name>
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 "kcapi.h"
14 #include <linux/module.h>
15 #include <linux/mm.h>
16 #include <linux/interrupt.h>
17 #include <linux/ioport.h>
18 #include <linux/proc_fs.h>
19 #include <linux/sched/signal.h>
20 #include <linux/seq_file.h>
21 #include <linux/skbuff.h>
22 #include <linux/workqueue.h>
23 #include <linux/capi.h>
24 #include <linux/kernelcapi.h>
25 #include <linux/init.h>
26 #include <linux/moduleparam.h>
27 #include <linux/delay.h>
28 #include <linux/slab.h>
29 #include <linux/uaccess.h>
30 #include <linux/isdn/capicmd.h>
31 #include <linux/isdn/capiutil.h>
32 #include <linux/mutex.h>
33 #include <linux/rcupdate.h>
34
35 static int showcapimsgs;
36 static struct workqueue_struct *kcapi_wq;
37
38 module_param(showcapimsgs, uint, 0);
39
40 /* ------------------------------------------------------------- */
41
42 struct capictr_event {
43 struct work_struct work;
44 unsigned int type;
45 u32 controller;
46 };
47
48 /* ------------------------------------------------------------- */
49
50 static const struct capi_version driver_version = {2, 0, 1, 1 << 4};
51 static char driver_serial[CAPI_SERIAL_LEN] = "0004711";
52 static char capi_manufakturer[64] = "AVM Berlin";
53
54 #define NCCI2CTRL(ncci) (((ncci) >> 24) & 0x7f)
55
56 struct capi_ctr *capi_controller[CAPI_MAXCONTR];
57 DEFINE_MUTEX(capi_controller_lock);
58
59 struct capi20_appl *capi_applications[CAPI_MAXAPPL];
60
61 static int ncontrollers;
62
63 /* -------- controller ref counting -------------------------------------- */
64
65 static inline struct capi_ctr *
capi_ctr_get(struct capi_ctr * ctr)66 capi_ctr_get(struct capi_ctr *ctr)
67 {
68 if (!try_module_get(ctr->owner))
69 return NULL;
70 return ctr;
71 }
72
73 static inline void
capi_ctr_put(struct capi_ctr * ctr)74 capi_ctr_put(struct capi_ctr *ctr)
75 {
76 module_put(ctr->owner);
77 }
78
79 /* ------------------------------------------------------------- */
80
get_capi_ctr_by_nr(u16 contr)81 static inline struct capi_ctr *get_capi_ctr_by_nr(u16 contr)
82 {
83 if (contr < 1 || contr - 1 >= CAPI_MAXCONTR)
84 return NULL;
85
86 return capi_controller[contr - 1];
87 }
88
__get_capi_appl_by_nr(u16 applid)89 static inline struct capi20_appl *__get_capi_appl_by_nr(u16 applid)
90 {
91 lockdep_assert_held(&capi_controller_lock);
92
93 if (applid < 1 || applid - 1 >= CAPI_MAXAPPL)
94 return NULL;
95
96 return capi_applications[applid - 1];
97 }
98
get_capi_appl_by_nr(u16 applid)99 static inline struct capi20_appl *get_capi_appl_by_nr(u16 applid)
100 {
101 if (applid < 1 || applid - 1 >= CAPI_MAXAPPL)
102 return NULL;
103
104 return rcu_dereference(capi_applications[applid - 1]);
105 }
106
107 /* -------- util functions ------------------------------------ */
108
capi_cmd_valid(u8 cmd)109 static inline int capi_cmd_valid(u8 cmd)
110 {
111 switch (cmd) {
112 case CAPI_ALERT:
113 case CAPI_CONNECT:
114 case CAPI_CONNECT_ACTIVE:
115 case CAPI_CONNECT_B3_ACTIVE:
116 case CAPI_CONNECT_B3:
117 case CAPI_CONNECT_B3_T90_ACTIVE:
118 case CAPI_DATA_B3:
119 case CAPI_DISCONNECT_B3:
120 case CAPI_DISCONNECT:
121 case CAPI_FACILITY:
122 case CAPI_INFO:
123 case CAPI_LISTEN:
124 case CAPI_MANUFACTURER:
125 case CAPI_RESET_B3:
126 case CAPI_SELECT_B_PROTOCOL:
127 return 1;
128 }
129 return 0;
130 }
131
capi_subcmd_valid(u8 subcmd)132 static inline int capi_subcmd_valid(u8 subcmd)
133 {
134 switch (subcmd) {
135 case CAPI_REQ:
136 case CAPI_CONF:
137 case CAPI_IND:
138 case CAPI_RESP:
139 return 1;
140 }
141 return 0;
142 }
143
144 /* ------------------------------------------------------------ */
145
146 static void
register_appl(struct capi_ctr * ctr,u16 applid,capi_register_params * rparam)147 register_appl(struct capi_ctr *ctr, u16 applid, capi_register_params *rparam)
148 {
149 ctr = capi_ctr_get(ctr);
150
151 if (ctr)
152 ctr->register_appl(ctr, applid, rparam);
153 else
154 printk(KERN_WARNING "%s: cannot get controller resources\n",
155 __func__);
156 }
157
158
release_appl(struct capi_ctr * ctr,u16 applid)159 static void release_appl(struct capi_ctr *ctr, u16 applid)
160 {
161 DBG("applid %#x", applid);
162
163 ctr->release_appl(ctr, applid);
164 capi_ctr_put(ctr);
165 }
166
notify_up(u32 contr)167 static void notify_up(u32 contr)
168 {
169 struct capi20_appl *ap;
170 struct capi_ctr *ctr;
171 u16 applid;
172
173 mutex_lock(&capi_controller_lock);
174
175 if (showcapimsgs & 1)
176 printk(KERN_DEBUG "kcapi: notify up contr %d\n", contr);
177
178 ctr = get_capi_ctr_by_nr(contr);
179 if (ctr) {
180 if (ctr->state == CAPI_CTR_RUNNING)
181 goto unlock_out;
182
183 ctr->state = CAPI_CTR_RUNNING;
184
185 for (applid = 1; applid <= CAPI_MAXAPPL; applid++) {
186 ap = __get_capi_appl_by_nr(applid);
187 if (ap)
188 register_appl(ctr, applid, &ap->rparam);
189 }
190 } else
191 printk(KERN_WARNING "%s: invalid contr %d\n", __func__, contr);
192
193 unlock_out:
194 mutex_unlock(&capi_controller_lock);
195 }
196
ctr_down(struct capi_ctr * ctr,int new_state)197 static void ctr_down(struct capi_ctr *ctr, int new_state)
198 {
199 struct capi20_appl *ap;
200 u16 applid;
201
202 if (ctr->state == CAPI_CTR_DETECTED || ctr->state == CAPI_CTR_DETACHED)
203 return;
204
205 ctr->state = new_state;
206
207 memset(ctr->manu, 0, sizeof(ctr->manu));
208 memset(&ctr->version, 0, sizeof(ctr->version));
209 memset(&ctr->profile, 0, sizeof(ctr->profile));
210 memset(ctr->serial, 0, sizeof(ctr->serial));
211
212 for (applid = 1; applid <= CAPI_MAXAPPL; applid++) {
213 ap = __get_capi_appl_by_nr(applid);
214 if (ap)
215 capi_ctr_put(ctr);
216 }
217 }
218
notify_down(u32 contr)219 static void notify_down(u32 contr)
220 {
221 struct capi_ctr *ctr;
222
223 mutex_lock(&capi_controller_lock);
224
225 if (showcapimsgs & 1)
226 printk(KERN_DEBUG "kcapi: notify down contr %d\n", contr);
227
228 ctr = get_capi_ctr_by_nr(contr);
229 if (ctr)
230 ctr_down(ctr, CAPI_CTR_DETECTED);
231 else
232 printk(KERN_WARNING "%s: invalid contr %d\n", __func__, contr);
233
234 mutex_unlock(&capi_controller_lock);
235 }
236
do_notify_work(struct work_struct * work)237 static void do_notify_work(struct work_struct *work)
238 {
239 struct capictr_event *event =
240 container_of(work, struct capictr_event, work);
241
242 switch (event->type) {
243 case CAPICTR_UP:
244 notify_up(event->controller);
245 break;
246 case CAPICTR_DOWN:
247 notify_down(event->controller);
248 break;
249 }
250
251 kfree(event);
252 }
253
notify_push(unsigned int event_type,u32 controller)254 static int notify_push(unsigned int event_type, u32 controller)
255 {
256 struct capictr_event *event = kmalloc(sizeof(*event), GFP_ATOMIC);
257
258 if (!event)
259 return -ENOMEM;
260
261 INIT_WORK(&event->work, do_notify_work);
262 event->type = event_type;
263 event->controller = controller;
264
265 queue_work(kcapi_wq, &event->work);
266 return 0;
267 }
268
269 /* -------- Receiver ------------------------------------------ */
270
recv_handler(struct work_struct * work)271 static void recv_handler(struct work_struct *work)
272 {
273 struct sk_buff *skb;
274 struct capi20_appl *ap =
275 container_of(work, struct capi20_appl, recv_work);
276
277 if ((!ap) || (ap->release_in_progress))
278 return;
279
280 mutex_lock(&ap->recv_mtx);
281 while ((skb = skb_dequeue(&ap->recv_queue))) {
282 if (CAPIMSG_CMD(skb->data) == CAPI_DATA_B3_IND)
283 ap->nrecvdatapkt++;
284 else
285 ap->nrecvctlpkt++;
286
287 ap->recv_message(ap, skb);
288 }
289 mutex_unlock(&ap->recv_mtx);
290 }
291
292 /**
293 * capi_ctr_handle_message() - handle incoming CAPI message
294 * @ctr: controller descriptor structure.
295 * @appl: application ID.
296 * @skb: message.
297 *
298 * Called by hardware driver to pass a CAPI message to the application.
299 */
300
capi_ctr_handle_message(struct capi_ctr * ctr,u16 appl,struct sk_buff * skb)301 void capi_ctr_handle_message(struct capi_ctr *ctr, u16 appl,
302 struct sk_buff *skb)
303 {
304 struct capi20_appl *ap;
305 int showctl = 0;
306 u8 cmd, subcmd;
307 _cdebbuf *cdb;
308
309 if (ctr->state != CAPI_CTR_RUNNING) {
310 cdb = capi_message2str(skb->data);
311 if (cdb) {
312 printk(KERN_INFO "kcapi: controller [%03d] not active, got: %s",
313 ctr->cnr, cdb->buf);
314 cdebbuf_free(cdb);
315 } else
316 printk(KERN_INFO "kcapi: controller [%03d] not active, cannot trace\n",
317 ctr->cnr);
318 goto error;
319 }
320
321 cmd = CAPIMSG_COMMAND(skb->data);
322 subcmd = CAPIMSG_SUBCOMMAND(skb->data);
323 if (cmd == CAPI_DATA_B3 && subcmd == CAPI_IND) {
324 ctr->nrecvdatapkt++;
325 if (ctr->traceflag > 2)
326 showctl |= 2;
327 } else {
328 ctr->nrecvctlpkt++;
329 if (ctr->traceflag)
330 showctl |= 2;
331 }
332 showctl |= (ctr->traceflag & 1);
333 if (showctl & 2) {
334 if (showctl & 1) {
335 printk(KERN_DEBUG "kcapi: got [%03d] id#%d %s len=%u\n",
336 ctr->cnr, CAPIMSG_APPID(skb->data),
337 capi_cmd2str(cmd, subcmd),
338 CAPIMSG_LEN(skb->data));
339 } else {
340 cdb = capi_message2str(skb->data);
341 if (cdb) {
342 printk(KERN_DEBUG "kcapi: got [%03d] %s\n",
343 ctr->cnr, cdb->buf);
344 cdebbuf_free(cdb);
345 } else
346 printk(KERN_DEBUG "kcapi: got [%03d] id#%d %s len=%u, cannot trace\n",
347 ctr->cnr, CAPIMSG_APPID(skb->data),
348 capi_cmd2str(cmd, subcmd),
349 CAPIMSG_LEN(skb->data));
350 }
351
352 }
353
354 rcu_read_lock();
355 ap = get_capi_appl_by_nr(CAPIMSG_APPID(skb->data));
356 if (!ap) {
357 rcu_read_unlock();
358 cdb = capi_message2str(skb->data);
359 if (cdb) {
360 printk(KERN_ERR "kcapi: handle_message: applid %d state released (%s)\n",
361 CAPIMSG_APPID(skb->data), cdb->buf);
362 cdebbuf_free(cdb);
363 } else
364 printk(KERN_ERR "kcapi: handle_message: applid %d state released (%s) cannot trace\n",
365 CAPIMSG_APPID(skb->data),
366 capi_cmd2str(cmd, subcmd));
367 goto error;
368 }
369 skb_queue_tail(&ap->recv_queue, skb);
370 queue_work(kcapi_wq, &ap->recv_work);
371 rcu_read_unlock();
372
373 return;
374
375 error:
376 kfree_skb(skb);
377 }
378
379 EXPORT_SYMBOL(capi_ctr_handle_message);
380
381 /**
382 * capi_ctr_ready() - signal CAPI controller ready
383 * @ctr: controller descriptor structure.
384 *
385 * Called by hardware driver to signal that the controller is up and running.
386 */
387
capi_ctr_ready(struct capi_ctr * ctr)388 void capi_ctr_ready(struct capi_ctr *ctr)
389 {
390 printk(KERN_NOTICE "kcapi: controller [%03d] \"%s\" ready.\n",
391 ctr->cnr, ctr->name);
392
393 notify_push(CAPICTR_UP, ctr->cnr);
394 }
395
396 EXPORT_SYMBOL(capi_ctr_ready);
397
398 /**
399 * capi_ctr_down() - signal CAPI controller not ready
400 * @ctr: controller descriptor structure.
401 *
402 * Called by hardware driver to signal that the controller is down and
403 * unavailable for use.
404 */
405
capi_ctr_down(struct capi_ctr * ctr)406 void capi_ctr_down(struct capi_ctr *ctr)
407 {
408 printk(KERN_NOTICE "kcapi: controller [%03d] down.\n", ctr->cnr);
409
410 notify_push(CAPICTR_DOWN, ctr->cnr);
411 }
412
413 EXPORT_SYMBOL(capi_ctr_down);
414
415 /* ------------------------------------------------------------- */
416
417 /**
418 * attach_capi_ctr() - register CAPI controller
419 * @ctr: controller descriptor structure.
420 *
421 * Called by hardware driver to register a controller with the CAPI subsystem.
422 * Return value: 0 on success, error code < 0 on error
423 */
424
attach_capi_ctr(struct capi_ctr * ctr)425 int attach_capi_ctr(struct capi_ctr *ctr)
426 {
427 int i;
428
429 mutex_lock(&capi_controller_lock);
430
431 for (i = 0; i < CAPI_MAXCONTR; i++) {
432 if (!capi_controller[i])
433 break;
434 }
435 if (i == CAPI_MAXCONTR) {
436 mutex_unlock(&capi_controller_lock);
437 printk(KERN_ERR "kcapi: out of controller slots\n");
438 return -EBUSY;
439 }
440 capi_controller[i] = ctr;
441
442 ctr->nrecvctlpkt = 0;
443 ctr->nrecvdatapkt = 0;
444 ctr->nsentctlpkt = 0;
445 ctr->nsentdatapkt = 0;
446 ctr->cnr = i + 1;
447 ctr->state = CAPI_CTR_DETECTED;
448 ctr->blocked = 0;
449 ctr->traceflag = showcapimsgs;
450
451 sprintf(ctr->procfn, "capi/controllers/%d", ctr->cnr);
452 ctr->procent = proc_create_single_data(ctr->procfn, 0, NULL,
453 ctr->proc_show, ctr);
454
455 ncontrollers++;
456
457 mutex_unlock(&capi_controller_lock);
458
459 printk(KERN_NOTICE "kcapi: controller [%03d]: %s attached\n",
460 ctr->cnr, ctr->name);
461 return 0;
462 }
463
464 EXPORT_SYMBOL(attach_capi_ctr);
465
466 /**
467 * detach_capi_ctr() - unregister CAPI controller
468 * @ctr: controller descriptor structure.
469 *
470 * Called by hardware driver to remove the registration of a controller
471 * with the CAPI subsystem.
472 * Return value: 0 on success, error code < 0 on error
473 */
474
detach_capi_ctr(struct capi_ctr * ctr)475 int detach_capi_ctr(struct capi_ctr *ctr)
476 {
477 int err = 0;
478
479 mutex_lock(&capi_controller_lock);
480
481 ctr_down(ctr, CAPI_CTR_DETACHED);
482
483 if (ctr->cnr < 1 || ctr->cnr - 1 >= CAPI_MAXCONTR) {
484 err = -EINVAL;
485 goto unlock_out;
486 }
487
488 if (capi_controller[ctr->cnr - 1] != ctr) {
489 err = -EINVAL;
490 goto unlock_out;
491 }
492 capi_controller[ctr->cnr - 1] = NULL;
493 ncontrollers--;
494
495 if (ctr->procent)
496 remove_proc_entry(ctr->procfn, NULL);
497
498 printk(KERN_NOTICE "kcapi: controller [%03d]: %s unregistered\n",
499 ctr->cnr, ctr->name);
500
501 unlock_out:
502 mutex_unlock(&capi_controller_lock);
503
504 return err;
505 }
506
507 EXPORT_SYMBOL(detach_capi_ctr);
508
509 /* ------------------------------------------------------------- */
510 /* -------- CAPI2.0 Interface ---------------------------------- */
511 /* ------------------------------------------------------------- */
512
513 /**
514 * capi20_isinstalled() - CAPI 2.0 operation CAPI_INSTALLED
515 *
516 * Return value: CAPI result code (CAPI_NOERROR if at least one ISDN controller
517 * is ready for use, CAPI_REGNOTINSTALLED otherwise)
518 */
519
capi20_isinstalled(void)520 u16 capi20_isinstalled(void)
521 {
522 u16 ret = CAPI_REGNOTINSTALLED;
523 int i;
524
525 mutex_lock(&capi_controller_lock);
526
527 for (i = 0; i < CAPI_MAXCONTR; i++)
528 if (capi_controller[i] &&
529 capi_controller[i]->state == CAPI_CTR_RUNNING) {
530 ret = CAPI_NOERROR;
531 break;
532 }
533
534 mutex_unlock(&capi_controller_lock);
535
536 return ret;
537 }
538
539 /**
540 * capi20_register() - CAPI 2.0 operation CAPI_REGISTER
541 * @ap: CAPI application descriptor structure.
542 *
543 * Register an application's presence with CAPI.
544 * A unique application ID is assigned and stored in @ap->applid.
545 * After this function returns successfully, the message receive
546 * callback function @ap->recv_message() may be called at any time
547 * until capi20_release() has been called for the same @ap.
548 * Return value: CAPI result code
549 */
550
capi20_register(struct capi20_appl * ap)551 u16 capi20_register(struct capi20_appl *ap)
552 {
553 int i;
554 u16 applid;
555
556 DBG("");
557
558 if (ap->rparam.datablklen < 128)
559 return CAPI_LOGBLKSIZETOSMALL;
560
561 ap->nrecvctlpkt = 0;
562 ap->nrecvdatapkt = 0;
563 ap->nsentctlpkt = 0;
564 ap->nsentdatapkt = 0;
565 mutex_init(&ap->recv_mtx);
566 skb_queue_head_init(&ap->recv_queue);
567 INIT_WORK(&ap->recv_work, recv_handler);
568 ap->release_in_progress = 0;
569
570 mutex_lock(&capi_controller_lock);
571
572 for (applid = 1; applid <= CAPI_MAXAPPL; applid++) {
573 if (capi_applications[applid - 1] == NULL)
574 break;
575 }
576 if (applid > CAPI_MAXAPPL) {
577 mutex_unlock(&capi_controller_lock);
578 return CAPI_TOOMANYAPPLS;
579 }
580
581 ap->applid = applid;
582 capi_applications[applid - 1] = ap;
583
584 for (i = 0; i < CAPI_MAXCONTR; i++) {
585 if (!capi_controller[i] ||
586 capi_controller[i]->state != CAPI_CTR_RUNNING)
587 continue;
588 register_appl(capi_controller[i], applid, &ap->rparam);
589 }
590
591 mutex_unlock(&capi_controller_lock);
592
593 if (showcapimsgs & 1) {
594 printk(KERN_DEBUG "kcapi: appl %d up\n", applid);
595 }
596
597 return CAPI_NOERROR;
598 }
599
600 /**
601 * capi20_release() - CAPI 2.0 operation CAPI_RELEASE
602 * @ap: CAPI application descriptor structure.
603 *
604 * Terminate an application's registration with CAPI.
605 * After this function returns successfully, the message receive
606 * callback function @ap->recv_message() will no longer be called.
607 * Return value: CAPI result code
608 */
609
capi20_release(struct capi20_appl * ap)610 u16 capi20_release(struct capi20_appl *ap)
611 {
612 int i;
613
614 DBG("applid %#x", ap->applid);
615
616 mutex_lock(&capi_controller_lock);
617
618 ap->release_in_progress = 1;
619 capi_applications[ap->applid - 1] = NULL;
620
621 synchronize_rcu();
622
623 for (i = 0; i < CAPI_MAXCONTR; i++) {
624 if (!capi_controller[i] ||
625 capi_controller[i]->state != CAPI_CTR_RUNNING)
626 continue;
627 release_appl(capi_controller[i], ap->applid);
628 }
629
630 mutex_unlock(&capi_controller_lock);
631
632 flush_workqueue(kcapi_wq);
633 skb_queue_purge(&ap->recv_queue);
634
635 if (showcapimsgs & 1) {
636 printk(KERN_DEBUG "kcapi: appl %d down\n", ap->applid);
637 }
638
639 return CAPI_NOERROR;
640 }
641
642 /**
643 * capi20_put_message() - CAPI 2.0 operation CAPI_PUT_MESSAGE
644 * @ap: CAPI application descriptor structure.
645 * @skb: CAPI message.
646 *
647 * Transfer a single message to CAPI.
648 * Return value: CAPI result code
649 */
650
capi20_put_message(struct capi20_appl * ap,struct sk_buff * skb)651 u16 capi20_put_message(struct capi20_appl *ap, struct sk_buff *skb)
652 {
653 struct capi_ctr *ctr;
654 int showctl = 0;
655 u8 cmd, subcmd;
656
657 DBG("applid %#x", ap->applid);
658
659 if (ncontrollers == 0)
660 return CAPI_REGNOTINSTALLED;
661 if ((ap->applid == 0) || ap->release_in_progress)
662 return CAPI_ILLAPPNR;
663 if (skb->len < 12
664 || !capi_cmd_valid(CAPIMSG_COMMAND(skb->data))
665 || !capi_subcmd_valid(CAPIMSG_SUBCOMMAND(skb->data)))
666 return CAPI_ILLCMDORSUBCMDORMSGTOSMALL;
667
668 /*
669 * The controller reference is protected by the existence of the
670 * application passed to us. We assume that the caller properly
671 * synchronizes this service with capi20_release.
672 */
673 ctr = get_capi_ctr_by_nr(CAPIMSG_CONTROLLER(skb->data));
674 if (!ctr || ctr->state != CAPI_CTR_RUNNING)
675 return CAPI_REGNOTINSTALLED;
676 if (ctr->blocked)
677 return CAPI_SENDQUEUEFULL;
678
679 cmd = CAPIMSG_COMMAND(skb->data);
680 subcmd = CAPIMSG_SUBCOMMAND(skb->data);
681
682 if (cmd == CAPI_DATA_B3 && subcmd == CAPI_REQ) {
683 ctr->nsentdatapkt++;
684 ap->nsentdatapkt++;
685 if (ctr->traceflag > 2)
686 showctl |= 2;
687 } else {
688 ctr->nsentctlpkt++;
689 ap->nsentctlpkt++;
690 if (ctr->traceflag)
691 showctl |= 2;
692 }
693 showctl |= (ctr->traceflag & 1);
694 if (showctl & 2) {
695 if (showctl & 1) {
696 printk(KERN_DEBUG "kcapi: put [%03d] id#%d %s len=%u\n",
697 CAPIMSG_CONTROLLER(skb->data),
698 CAPIMSG_APPID(skb->data),
699 capi_cmd2str(cmd, subcmd),
700 CAPIMSG_LEN(skb->data));
701 } else {
702 _cdebbuf *cdb = capi_message2str(skb->data);
703 if (cdb) {
704 printk(KERN_DEBUG "kcapi: put [%03d] %s\n",
705 CAPIMSG_CONTROLLER(skb->data),
706 cdb->buf);
707 cdebbuf_free(cdb);
708 } else
709 printk(KERN_DEBUG "kcapi: put [%03d] id#%d %s len=%u cannot trace\n",
710 CAPIMSG_CONTROLLER(skb->data),
711 CAPIMSG_APPID(skb->data),
712 capi_cmd2str(cmd, subcmd),
713 CAPIMSG_LEN(skb->data));
714 }
715 }
716 return ctr->send_message(ctr, skb);
717 }
718
719 /**
720 * capi20_get_manufacturer() - CAPI 2.0 operation CAPI_GET_MANUFACTURER
721 * @contr: controller number.
722 * @buf: result buffer (64 bytes).
723 *
724 * Retrieve information about the manufacturer of the specified ISDN controller
725 * or (for @contr == 0) the driver itself.
726 * Return value: CAPI result code
727 */
728
capi20_get_manufacturer(u32 contr,u8 buf[CAPI_MANUFACTURER_LEN])729 u16 capi20_get_manufacturer(u32 contr, u8 buf[CAPI_MANUFACTURER_LEN])
730 {
731 struct capi_ctr *ctr;
732 u16 ret;
733
734 if (contr == 0) {
735 strscpy_pad(buf, capi_manufakturer, CAPI_MANUFACTURER_LEN);
736 return CAPI_NOERROR;
737 }
738
739 mutex_lock(&capi_controller_lock);
740
741 ctr = get_capi_ctr_by_nr(contr);
742 if (ctr && ctr->state == CAPI_CTR_RUNNING) {
743 strscpy_pad(buf, ctr->manu, CAPI_MANUFACTURER_LEN);
744 ret = CAPI_NOERROR;
745 } else
746 ret = CAPI_REGNOTINSTALLED;
747
748 mutex_unlock(&capi_controller_lock);
749 return ret;
750 }
751
752 /**
753 * capi20_get_version() - CAPI 2.0 operation CAPI_GET_VERSION
754 * @contr: controller number.
755 * @verp: result structure.
756 *
757 * Retrieve version information for the specified ISDN controller
758 * or (for @contr == 0) the driver itself.
759 * Return value: CAPI result code
760 */
761
capi20_get_version(u32 contr,struct capi_version * verp)762 u16 capi20_get_version(u32 contr, struct capi_version *verp)
763 {
764 struct capi_ctr *ctr;
765 u16 ret;
766
767 if (contr == 0) {
768 *verp = driver_version;
769 return CAPI_NOERROR;
770 }
771
772 mutex_lock(&capi_controller_lock);
773
774 ctr = get_capi_ctr_by_nr(contr);
775 if (ctr && ctr->state == CAPI_CTR_RUNNING) {
776 memcpy(verp, &ctr->version, sizeof(capi_version));
777 ret = CAPI_NOERROR;
778 } else
779 ret = CAPI_REGNOTINSTALLED;
780
781 mutex_unlock(&capi_controller_lock);
782 return ret;
783 }
784
785 /**
786 * capi20_get_serial() - CAPI 2.0 operation CAPI_GET_SERIAL_NUMBER
787 * @contr: controller number.
788 * @serial: result buffer (8 bytes).
789 *
790 * Retrieve the serial number of the specified ISDN controller
791 * or (for @contr == 0) the driver itself.
792 * Return value: CAPI result code
793 */
794
capi20_get_serial(u32 contr,u8 serial[CAPI_SERIAL_LEN])795 u16 capi20_get_serial(u32 contr, u8 serial[CAPI_SERIAL_LEN])
796 {
797 struct capi_ctr *ctr;
798 u16 ret;
799
800 if (contr == 0) {
801 strscpy(serial, driver_serial, CAPI_SERIAL_LEN);
802 return CAPI_NOERROR;
803 }
804
805 mutex_lock(&capi_controller_lock);
806
807 ctr = get_capi_ctr_by_nr(contr);
808 if (ctr && ctr->state == CAPI_CTR_RUNNING) {
809 strscpy(serial, ctr->serial, CAPI_SERIAL_LEN);
810 ret = CAPI_NOERROR;
811 } else
812 ret = CAPI_REGNOTINSTALLED;
813
814 mutex_unlock(&capi_controller_lock);
815 return ret;
816 }
817
818 /**
819 * capi20_get_profile() - CAPI 2.0 operation CAPI_GET_PROFILE
820 * @contr: controller number.
821 * @profp: result structure.
822 *
823 * Retrieve capability information for the specified ISDN controller
824 * or (for @contr == 0) the number of installed controllers.
825 * Return value: CAPI result code
826 */
827
capi20_get_profile(u32 contr,struct capi_profile * profp)828 u16 capi20_get_profile(u32 contr, struct capi_profile *profp)
829 {
830 struct capi_ctr *ctr;
831 u16 ret;
832
833 if (contr == 0) {
834 profp->ncontroller = ncontrollers;
835 return CAPI_NOERROR;
836 }
837
838 mutex_lock(&capi_controller_lock);
839
840 ctr = get_capi_ctr_by_nr(contr);
841 if (ctr && ctr->state == CAPI_CTR_RUNNING) {
842 memcpy(profp, &ctr->profile, sizeof(struct capi_profile));
843 ret = CAPI_NOERROR;
844 } else
845 ret = CAPI_REGNOTINSTALLED;
846
847 mutex_unlock(&capi_controller_lock);
848 return ret;
849 }
850
851 /**
852 * capi20_manufacturer() - CAPI 2.0 operation CAPI_MANUFACTURER
853 * @cmd: command.
854 * @data: parameter.
855 *
856 * Perform manufacturer specific command.
857 * Return value: CAPI result code
858 */
859
capi20_manufacturer(unsigned long cmd,void __user * data)860 int capi20_manufacturer(unsigned long cmd, void __user *data)
861 {
862 struct capi_ctr *ctr;
863 int retval;
864
865 switch (cmd) {
866 case KCAPI_CMD_TRACE:
867 {
868 kcapi_flagdef fdef;
869
870 if (copy_from_user(&fdef, data, sizeof(kcapi_flagdef)))
871 return -EFAULT;
872
873 mutex_lock(&capi_controller_lock);
874
875 ctr = get_capi_ctr_by_nr(fdef.contr);
876 if (ctr) {
877 ctr->traceflag = fdef.flag;
878 printk(KERN_INFO "kcapi: contr [%03d] set trace=%d\n",
879 ctr->cnr, ctr->traceflag);
880 retval = 0;
881 } else
882 retval = -ESRCH;
883
884 mutex_unlock(&capi_controller_lock);
885
886 return retval;
887 }
888
889 default:
890 printk(KERN_ERR "kcapi: manufacturer command %lu unknown.\n",
891 cmd);
892 break;
893
894 }
895 return -EINVAL;
896 }
897
898 /* ------------------------------------------------------------- */
899 /* -------- Init & Cleanup ------------------------------------- */
900 /* ------------------------------------------------------------- */
901
902 /*
903 * init / exit functions
904 */
905
kcapi_init(void)906 int __init kcapi_init(void)
907 {
908 int err;
909
910 kcapi_wq = alloc_workqueue("kcapi", 0, 0);
911 if (!kcapi_wq)
912 return -ENOMEM;
913
914 err = cdebug_init();
915 if (err) {
916 destroy_workqueue(kcapi_wq);
917 return err;
918 }
919
920 if (IS_ENABLED(CONFIG_PROC_FS))
921 kcapi_proc_init();
922
923 return 0;
924 }
925
kcapi_exit(void)926 void kcapi_exit(void)
927 {
928 if (IS_ENABLED(CONFIG_PROC_FS))
929 kcapi_proc_exit();
930
931 cdebug_exit();
932 destroy_workqueue(kcapi_wq);
933 }
934