1
2
3
4
5
6
7
8
9
10
11
12
13#define AVMB1_COMPAT
14
15#include "kcapi.h"
16#include <linux/module.h>
17#include <linux/mm.h>
18#include <linux/interrupt.h>
19#include <linux/ioport.h>
20#include <linux/proc_fs.h>
21#include <linux/sched/signal.h>
22#include <linux/seq_file.h>
23#include <linux/skbuff.h>
24#include <linux/workqueue.h>
25#include <linux/capi.h>
26#include <linux/kernelcapi.h>
27#include <linux/init.h>
28#include <linux/moduleparam.h>
29#include <linux/delay.h>
30#include <linux/slab.h>
31#include <linux/uaccess.h>
32#include <linux/isdn/capicmd.h>
33#include <linux/isdn/capiutil.h>
34#ifdef AVMB1_COMPAT
35#include <linux/b1lli.h>
36#endif
37#include <linux/mutex.h>
38#include <linux/rcupdate.h>
39
40static int showcapimsgs = 0;
41static struct workqueue_struct *kcapi_wq;
42
43MODULE_DESCRIPTION("CAPI4Linux: kernel CAPI layer");
44MODULE_AUTHOR("Carsten Paeth");
45MODULE_LICENSE("GPL");
46module_param(showcapimsgs, uint, 0);
47
48
49
50struct capictr_event {
51 struct work_struct work;
52 unsigned int type;
53 u32 controller;
54};
55
56
57
58static const struct capi_version driver_version = {2, 0, 1, 1 << 4};
59static char driver_serial[CAPI_SERIAL_LEN] = "0004711";
60static char capi_manufakturer[64] = "AVM Berlin";
61
62#define NCCI2CTRL(ncci) (((ncci) >> 24) & 0x7f)
63
64LIST_HEAD(capi_drivers);
65DEFINE_MUTEX(capi_drivers_lock);
66
67struct capi_ctr *capi_controller[CAPI_MAXCONTR];
68DEFINE_MUTEX(capi_controller_lock);
69
70struct capi20_appl *capi_applications[CAPI_MAXAPPL];
71
72static int ncontrollers;
73
74static BLOCKING_NOTIFIER_HEAD(ctr_notifier_list);
75
76
77
78static inline struct capi_ctr *
79capi_ctr_get(struct capi_ctr *ctr)
80{
81 if (!try_module_get(ctr->owner))
82 return NULL;
83 return ctr;
84}
85
86static inline void
87capi_ctr_put(struct capi_ctr *ctr)
88{
89 module_put(ctr->owner);
90}
91
92
93
94static inline struct capi_ctr *get_capi_ctr_by_nr(u16 contr)
95{
96 if (contr < 1 || contr - 1 >= CAPI_MAXCONTR)
97 return NULL;
98
99 return capi_controller[contr - 1];
100}
101
102static inline struct capi20_appl *__get_capi_appl_by_nr(u16 applid)
103{
104 lockdep_assert_held(&capi_controller_lock);
105
106 if (applid < 1 || applid - 1 >= CAPI_MAXAPPL)
107 return NULL;
108
109 return capi_applications[applid - 1];
110}
111
112static inline struct capi20_appl *get_capi_appl_by_nr(u16 applid)
113{
114 if (applid < 1 || applid - 1 >= CAPI_MAXAPPL)
115 return NULL;
116
117 return rcu_dereference(capi_applications[applid - 1]);
118}
119
120
121
122static inline int capi_cmd_valid(u8 cmd)
123{
124 switch (cmd) {
125 case CAPI_ALERT:
126 case CAPI_CONNECT:
127 case CAPI_CONNECT_ACTIVE:
128 case CAPI_CONNECT_B3_ACTIVE:
129 case CAPI_CONNECT_B3:
130 case CAPI_CONNECT_B3_T90_ACTIVE:
131 case CAPI_DATA_B3:
132 case CAPI_DISCONNECT_B3:
133 case CAPI_DISCONNECT:
134 case CAPI_FACILITY:
135 case CAPI_INFO:
136 case CAPI_LISTEN:
137 case CAPI_MANUFACTURER:
138 case CAPI_RESET_B3:
139 case CAPI_SELECT_B_PROTOCOL:
140 return 1;
141 }
142 return 0;
143}
144
145static inline int capi_subcmd_valid(u8 subcmd)
146{
147 switch (subcmd) {
148 case CAPI_REQ:
149 case CAPI_CONF:
150 case CAPI_IND:
151 case CAPI_RESP:
152 return 1;
153 }
154 return 0;
155}
156
157
158
159static void
160register_appl(struct capi_ctr *ctr, u16 applid, capi_register_params *rparam)
161{
162 ctr = capi_ctr_get(ctr);
163
164 if (ctr)
165 ctr->register_appl(ctr, applid, rparam);
166 else
167 printk(KERN_WARNING "%s: cannot get controller resources\n",
168 __func__);
169}
170
171
172static void release_appl(struct capi_ctr *ctr, u16 applid)
173{
174 DBG("applid %#x", applid);
175
176 ctr->release_appl(ctr, applid);
177 capi_ctr_put(ctr);
178}
179
180static void notify_up(u32 contr)
181{
182 struct capi20_appl *ap;
183 struct capi_ctr *ctr;
184 u16 applid;
185
186 mutex_lock(&capi_controller_lock);
187
188 if (showcapimsgs & 1)
189 printk(KERN_DEBUG "kcapi: notify up contr %d\n", contr);
190
191 ctr = get_capi_ctr_by_nr(contr);
192 if (ctr) {
193 if (ctr->state == CAPI_CTR_RUNNING)
194 goto unlock_out;
195
196 ctr->state = CAPI_CTR_RUNNING;
197
198 for (applid = 1; applid <= CAPI_MAXAPPL; applid++) {
199 ap = __get_capi_appl_by_nr(applid);
200 if (ap)
201 register_appl(ctr, applid, &ap->rparam);
202 }
203
204 wake_up_interruptible_all(&ctr->state_wait_queue);
205 } else
206 printk(KERN_WARNING "%s: invalid contr %d\n", __func__, contr);
207
208unlock_out:
209 mutex_unlock(&capi_controller_lock);
210}
211
212static void ctr_down(struct capi_ctr *ctr, int new_state)
213{
214 struct capi20_appl *ap;
215 u16 applid;
216
217 if (ctr->state == CAPI_CTR_DETECTED || ctr->state == CAPI_CTR_DETACHED)
218 return;
219
220 ctr->state = new_state;
221
222 memset(ctr->manu, 0, sizeof(ctr->manu));
223 memset(&ctr->version, 0, sizeof(ctr->version));
224 memset(&ctr->profile, 0, sizeof(ctr->profile));
225 memset(ctr->serial, 0, sizeof(ctr->serial));
226
227 for (applid = 1; applid <= CAPI_MAXAPPL; applid++) {
228 ap = __get_capi_appl_by_nr(applid);
229 if (ap)
230 capi_ctr_put(ctr);
231 }
232
233 wake_up_interruptible_all(&ctr->state_wait_queue);
234}
235
236static void notify_down(u32 contr)
237{
238 struct capi_ctr *ctr;
239
240 mutex_lock(&capi_controller_lock);
241
242 if (showcapimsgs & 1)
243 printk(KERN_DEBUG "kcapi: notify down contr %d\n", contr);
244
245 ctr = get_capi_ctr_by_nr(contr);
246 if (ctr)
247 ctr_down(ctr, CAPI_CTR_DETECTED);
248 else
249 printk(KERN_WARNING "%s: invalid contr %d\n", __func__, contr);
250
251 mutex_unlock(&capi_controller_lock);
252}
253
254static int
255notify_handler(struct notifier_block *nb, unsigned long val, void *v)
256{
257 u32 contr = (long)v;
258
259 switch (val) {
260 case CAPICTR_UP:
261 notify_up(contr);
262 break;
263 case CAPICTR_DOWN:
264 notify_down(contr);
265 break;
266 }
267 return NOTIFY_OK;
268}
269
270static void do_notify_work(struct work_struct *work)
271{
272 struct capictr_event *event =
273 container_of(work, struct capictr_event, work);
274
275 blocking_notifier_call_chain(&ctr_notifier_list, event->type,
276 (void *)(long)event->controller);
277 kfree(event);
278}
279
280
281
282
283
284static int notify_push(unsigned int event_type, u32 controller)
285{
286 struct capictr_event *event = kmalloc(sizeof(*event), GFP_ATOMIC);
287
288 if (!event)
289 return -ENOMEM;
290
291 INIT_WORK(&event->work, do_notify_work);
292 event->type = event_type;
293 event->controller = controller;
294
295 queue_work(kcapi_wq, &event->work);
296 return 0;
297}
298
299int register_capictr_notifier(struct notifier_block *nb)
300{
301 return blocking_notifier_chain_register(&ctr_notifier_list, nb);
302}
303EXPORT_SYMBOL_GPL(register_capictr_notifier);
304
305int unregister_capictr_notifier(struct notifier_block *nb)
306{
307 return blocking_notifier_chain_unregister(&ctr_notifier_list, nb);
308}
309EXPORT_SYMBOL_GPL(unregister_capictr_notifier);
310
311
312
313static void recv_handler(struct work_struct *work)
314{
315 struct sk_buff *skb;
316 struct capi20_appl *ap =
317 container_of(work, struct capi20_appl, recv_work);
318
319 if ((!ap) || (ap->release_in_progress))
320 return;
321
322 mutex_lock(&ap->recv_mtx);
323 while ((skb = skb_dequeue(&ap->recv_queue))) {
324 if (CAPIMSG_CMD(skb->data) == CAPI_DATA_B3_IND)
325 ap->nrecvdatapkt++;
326 else
327 ap->nrecvctlpkt++;
328
329 ap->recv_message(ap, skb);
330 }
331 mutex_unlock(&ap->recv_mtx);
332}
333
334
335
336
337
338
339
340
341
342
343void capi_ctr_handle_message(struct capi_ctr *ctr, u16 appl,
344 struct sk_buff *skb)
345{
346 struct capi20_appl *ap;
347 int showctl = 0;
348 u8 cmd, subcmd;
349 _cdebbuf *cdb;
350
351 if (ctr->state != CAPI_CTR_RUNNING) {
352 cdb = capi_message2str(skb->data);
353 if (cdb) {
354 printk(KERN_INFO "kcapi: controller [%03d] not active, got: %s",
355 ctr->cnr, cdb->buf);
356 cdebbuf_free(cdb);
357 } else
358 printk(KERN_INFO "kcapi: controller [%03d] not active, cannot trace\n",
359 ctr->cnr);
360 goto error;
361 }
362
363 cmd = CAPIMSG_COMMAND(skb->data);
364 subcmd = CAPIMSG_SUBCOMMAND(skb->data);
365 if (cmd == CAPI_DATA_B3 && subcmd == CAPI_IND) {
366 ctr->nrecvdatapkt++;
367 if (ctr->traceflag > 2)
368 showctl |= 2;
369 } else {
370 ctr->nrecvctlpkt++;
371 if (ctr->traceflag)
372 showctl |= 2;
373 }
374 showctl |= (ctr->traceflag & 1);
375 if (showctl & 2) {
376 if (showctl & 1) {
377 printk(KERN_DEBUG "kcapi: got [%03d] id#%d %s len=%u\n",
378 ctr->cnr, CAPIMSG_APPID(skb->data),
379 capi_cmd2str(cmd, subcmd),
380 CAPIMSG_LEN(skb->data));
381 } else {
382 cdb = capi_message2str(skb->data);
383 if (cdb) {
384 printk(KERN_DEBUG "kcapi: got [%03d] %s\n",
385 ctr->cnr, cdb->buf);
386 cdebbuf_free(cdb);
387 } else
388 printk(KERN_DEBUG "kcapi: got [%03d] id#%d %s len=%u, cannot trace\n",
389 ctr->cnr, CAPIMSG_APPID(skb->data),
390 capi_cmd2str(cmd, subcmd),
391 CAPIMSG_LEN(skb->data));
392 }
393
394 }
395
396 rcu_read_lock();
397 ap = get_capi_appl_by_nr(CAPIMSG_APPID(skb->data));
398 if (!ap) {
399 rcu_read_unlock();
400 cdb = capi_message2str(skb->data);
401 if (cdb) {
402 printk(KERN_ERR "kcapi: handle_message: applid %d state released (%s)\n",
403 CAPIMSG_APPID(skb->data), cdb->buf);
404 cdebbuf_free(cdb);
405 } else
406 printk(KERN_ERR "kcapi: handle_message: applid %d state released (%s) cannot trace\n",
407 CAPIMSG_APPID(skb->data),
408 capi_cmd2str(cmd, subcmd));
409 goto error;
410 }
411 skb_queue_tail(&ap->recv_queue, skb);
412 queue_work(kcapi_wq, &ap->recv_work);
413 rcu_read_unlock();
414
415 return;
416
417error:
418 kfree_skb(skb);
419}
420
421EXPORT_SYMBOL(capi_ctr_handle_message);
422
423
424
425
426
427
428
429
430void capi_ctr_ready(struct capi_ctr *ctr)
431{
432 printk(KERN_NOTICE "kcapi: controller [%03d] \"%s\" ready.\n",
433 ctr->cnr, ctr->name);
434
435 notify_push(CAPICTR_UP, ctr->cnr);
436}
437
438EXPORT_SYMBOL(capi_ctr_ready);
439
440
441
442
443
444
445
446
447
448void capi_ctr_down(struct capi_ctr *ctr)
449{
450 printk(KERN_NOTICE "kcapi: controller [%03d] down.\n", ctr->cnr);
451
452 notify_push(CAPICTR_DOWN, ctr->cnr);
453}
454
455EXPORT_SYMBOL(capi_ctr_down);
456
457
458
459
460
461
462
463
464
465
466
467void capi_ctr_suspend_output(struct capi_ctr *ctr)
468{
469 if (!ctr->blocked) {
470 printk(KERN_DEBUG "kcapi: controller [%03d] suspend\n",
471 ctr->cnr);
472 ctr->blocked = 1;
473 }
474}
475
476EXPORT_SYMBOL(capi_ctr_suspend_output);
477
478
479
480
481
482
483
484
485
486
487
488void capi_ctr_resume_output(struct capi_ctr *ctr)
489{
490 if (ctr->blocked) {
491 printk(KERN_DEBUG "kcapi: controller [%03d] resumed\n",
492 ctr->cnr);
493 ctr->blocked = 0;
494 }
495}
496
497EXPORT_SYMBOL(capi_ctr_resume_output);
498
499
500
501
502
503
504
505
506
507
508
509int attach_capi_ctr(struct capi_ctr *ctr)
510{
511 int i;
512
513 mutex_lock(&capi_controller_lock);
514
515 for (i = 0; i < CAPI_MAXCONTR; i++) {
516 if (!capi_controller[i])
517 break;
518 }
519 if (i == CAPI_MAXCONTR) {
520 mutex_unlock(&capi_controller_lock);
521 printk(KERN_ERR "kcapi: out of controller slots\n");
522 return -EBUSY;
523 }
524 capi_controller[i] = ctr;
525
526 ctr->nrecvctlpkt = 0;
527 ctr->nrecvdatapkt = 0;
528 ctr->nsentctlpkt = 0;
529 ctr->nsentdatapkt = 0;
530 ctr->cnr = i + 1;
531 ctr->state = CAPI_CTR_DETECTED;
532 ctr->blocked = 0;
533 ctr->traceflag = showcapimsgs;
534 init_waitqueue_head(&ctr->state_wait_queue);
535
536 sprintf(ctr->procfn, "capi/controllers/%d", ctr->cnr);
537 ctr->procent = proc_create_data(ctr->procfn, 0, NULL, ctr->proc_fops, ctr);
538
539 ncontrollers++;
540
541 mutex_unlock(&capi_controller_lock);
542
543 printk(KERN_NOTICE "kcapi: controller [%03d]: %s attached\n",
544 ctr->cnr, ctr->name);
545 return 0;
546}
547
548EXPORT_SYMBOL(attach_capi_ctr);
549
550
551
552
553
554
555
556
557
558
559int detach_capi_ctr(struct capi_ctr *ctr)
560{
561 int err = 0;
562
563 mutex_lock(&capi_controller_lock);
564
565 ctr_down(ctr, CAPI_CTR_DETACHED);
566
567 if (capi_controller[ctr->cnr - 1] != ctr) {
568 err = -EINVAL;
569 goto unlock_out;
570 }
571 capi_controller[ctr->cnr - 1] = NULL;
572 ncontrollers--;
573
574 if (ctr->procent)
575 remove_proc_entry(ctr->procfn, NULL);
576
577 printk(KERN_NOTICE "kcapi: controller [%03d]: %s unregistered\n",
578 ctr->cnr, ctr->name);
579
580unlock_out:
581 mutex_unlock(&capi_controller_lock);
582
583 return err;
584}
585
586EXPORT_SYMBOL(detach_capi_ctr);
587
588
589
590
591
592
593
594
595void register_capi_driver(struct capi_driver *driver)
596{
597 mutex_lock(&capi_drivers_lock);
598 list_add_tail(&driver->list, &capi_drivers);
599 mutex_unlock(&capi_drivers_lock);
600}
601
602EXPORT_SYMBOL(register_capi_driver);
603
604
605
606
607
608
609
610
611void unregister_capi_driver(struct capi_driver *driver)
612{
613 mutex_lock(&capi_drivers_lock);
614 list_del(&driver->list);
615 mutex_unlock(&capi_drivers_lock);
616}
617
618EXPORT_SYMBOL(unregister_capi_driver);
619
620
621
622
623
624
625
626
627
628
629
630
631u16 capi20_isinstalled(void)
632{
633 u16 ret = CAPI_REGNOTINSTALLED;
634 int i;
635
636 mutex_lock(&capi_controller_lock);
637
638 for (i = 0; i < CAPI_MAXCONTR; i++)
639 if (capi_controller[i] &&
640 capi_controller[i]->state == CAPI_CTR_RUNNING) {
641 ret = CAPI_NOERROR;
642 break;
643 }
644
645 mutex_unlock(&capi_controller_lock);
646
647 return ret;
648}
649
650EXPORT_SYMBOL(capi20_isinstalled);
651
652
653
654
655
656
657
658
659
660
661
662
663
664u16 capi20_register(struct capi20_appl *ap)
665{
666 int i;
667 u16 applid;
668
669 DBG("");
670
671 if (ap->rparam.datablklen < 128)
672 return CAPI_LOGBLKSIZETOSMALL;
673
674 ap->nrecvctlpkt = 0;
675 ap->nrecvdatapkt = 0;
676 ap->nsentctlpkt = 0;
677 ap->nsentdatapkt = 0;
678 mutex_init(&ap->recv_mtx);
679 skb_queue_head_init(&ap->recv_queue);
680 INIT_WORK(&ap->recv_work, recv_handler);
681 ap->release_in_progress = 0;
682
683 mutex_lock(&capi_controller_lock);
684
685 for (applid = 1; applid <= CAPI_MAXAPPL; applid++) {
686 if (capi_applications[applid - 1] == NULL)
687 break;
688 }
689 if (applid > CAPI_MAXAPPL) {
690 mutex_unlock(&capi_controller_lock);
691 return CAPI_TOOMANYAPPLS;
692 }
693
694 ap->applid = applid;
695 capi_applications[applid - 1] = ap;
696
697 for (i = 0; i < CAPI_MAXCONTR; i++) {
698 if (!capi_controller[i] ||
699 capi_controller[i]->state != CAPI_CTR_RUNNING)
700 continue;
701 register_appl(capi_controller[i], applid, &ap->rparam);
702 }
703
704 mutex_unlock(&capi_controller_lock);
705
706 if (showcapimsgs & 1) {
707 printk(KERN_DEBUG "kcapi: appl %d up\n", applid);
708 }
709
710 return CAPI_NOERROR;
711}
712
713EXPORT_SYMBOL(capi20_register);
714
715
716
717
718
719
720
721
722
723
724
725u16 capi20_release(struct capi20_appl *ap)
726{
727 int i;
728
729 DBG("applid %#x", ap->applid);
730
731 mutex_lock(&capi_controller_lock);
732
733 ap->release_in_progress = 1;
734 capi_applications[ap->applid - 1] = NULL;
735
736 synchronize_rcu();
737
738 for (i = 0; i < CAPI_MAXCONTR; i++) {
739 if (!capi_controller[i] ||
740 capi_controller[i]->state != CAPI_CTR_RUNNING)
741 continue;
742 release_appl(capi_controller[i], ap->applid);
743 }
744
745 mutex_unlock(&capi_controller_lock);
746
747 flush_workqueue(kcapi_wq);
748 skb_queue_purge(&ap->recv_queue);
749
750 if (showcapimsgs & 1) {
751 printk(KERN_DEBUG "kcapi: appl %d down\n", ap->applid);
752 }
753
754 return CAPI_NOERROR;
755}
756
757EXPORT_SYMBOL(capi20_release);
758
759
760
761
762
763
764
765
766
767
768u16 capi20_put_message(struct capi20_appl *ap, struct sk_buff *skb)
769{
770 struct capi_ctr *ctr;
771 int showctl = 0;
772 u8 cmd, subcmd;
773
774 DBG("applid %#x", ap->applid);
775
776 if (ncontrollers == 0)
777 return CAPI_REGNOTINSTALLED;
778 if ((ap->applid == 0) || ap->release_in_progress)
779 return CAPI_ILLAPPNR;
780 if (skb->len < 12
781 || !capi_cmd_valid(CAPIMSG_COMMAND(skb->data))
782 || !capi_subcmd_valid(CAPIMSG_SUBCOMMAND(skb->data)))
783 return CAPI_ILLCMDORSUBCMDORMSGTOSMALL;
784
785
786
787
788
789
790 ctr = get_capi_ctr_by_nr(CAPIMSG_CONTROLLER(skb->data));
791 if (!ctr || ctr->state != CAPI_CTR_RUNNING)
792 return CAPI_REGNOTINSTALLED;
793 if (ctr->blocked)
794 return CAPI_SENDQUEUEFULL;
795
796 cmd = CAPIMSG_COMMAND(skb->data);
797 subcmd = CAPIMSG_SUBCOMMAND(skb->data);
798
799 if (cmd == CAPI_DATA_B3 && subcmd == CAPI_REQ) {
800 ctr->nsentdatapkt++;
801 ap->nsentdatapkt++;
802 if (ctr->traceflag > 2)
803 showctl |= 2;
804 } else {
805 ctr->nsentctlpkt++;
806 ap->nsentctlpkt++;
807 if (ctr->traceflag)
808 showctl |= 2;
809 }
810 showctl |= (ctr->traceflag & 1);
811 if (showctl & 2) {
812 if (showctl & 1) {
813 printk(KERN_DEBUG "kcapi: put [%03d] id#%d %s len=%u\n",
814 CAPIMSG_CONTROLLER(skb->data),
815 CAPIMSG_APPID(skb->data),
816 capi_cmd2str(cmd, subcmd),
817 CAPIMSG_LEN(skb->data));
818 } else {
819 _cdebbuf *cdb = capi_message2str(skb->data);
820 if (cdb) {
821 printk(KERN_DEBUG "kcapi: put [%03d] %s\n",
822 CAPIMSG_CONTROLLER(skb->data),
823 cdb->buf);
824 cdebbuf_free(cdb);
825 } else
826 printk(KERN_DEBUG "kcapi: put [%03d] id#%d %s len=%u cannot trace\n",
827 CAPIMSG_CONTROLLER(skb->data),
828 CAPIMSG_APPID(skb->data),
829 capi_cmd2str(cmd, subcmd),
830 CAPIMSG_LEN(skb->data));
831 }
832 }
833 return ctr->send_message(ctr, skb);
834}
835
836EXPORT_SYMBOL(capi20_put_message);
837
838
839
840
841
842
843
844
845
846
847
848u16 capi20_get_manufacturer(u32 contr, u8 *buf)
849{
850 struct capi_ctr *ctr;
851 u16 ret;
852
853 if (contr == 0) {
854 strlcpy(buf, capi_manufakturer, CAPI_MANUFACTURER_LEN);
855 return CAPI_NOERROR;
856 }
857
858 mutex_lock(&capi_controller_lock);
859
860 ctr = get_capi_ctr_by_nr(contr);
861 if (ctr && ctr->state == CAPI_CTR_RUNNING) {
862 strlcpy(buf, ctr->manu, CAPI_MANUFACTURER_LEN);
863 ret = CAPI_NOERROR;
864 } else
865 ret = CAPI_REGNOTINSTALLED;
866
867 mutex_unlock(&capi_controller_lock);
868 return ret;
869}
870
871EXPORT_SYMBOL(capi20_get_manufacturer);
872
873
874
875
876
877
878
879
880
881
882
883u16 capi20_get_version(u32 contr, struct capi_version *verp)
884{
885 struct capi_ctr *ctr;
886 u16 ret;
887
888 if (contr == 0) {
889 *verp = driver_version;
890 return CAPI_NOERROR;
891 }
892
893 mutex_lock(&capi_controller_lock);
894
895 ctr = get_capi_ctr_by_nr(contr);
896 if (ctr && ctr->state == CAPI_CTR_RUNNING) {
897 memcpy(verp, &ctr->version, sizeof(capi_version));
898 ret = CAPI_NOERROR;
899 } else
900 ret = CAPI_REGNOTINSTALLED;
901
902 mutex_unlock(&capi_controller_lock);
903 return ret;
904}
905
906EXPORT_SYMBOL(capi20_get_version);
907
908
909
910
911
912
913
914
915
916
917
918u16 capi20_get_serial(u32 contr, u8 *serial)
919{
920 struct capi_ctr *ctr;
921 u16 ret;
922
923 if (contr == 0) {
924 strlcpy(serial, driver_serial, CAPI_SERIAL_LEN);
925 return CAPI_NOERROR;
926 }
927
928 mutex_lock(&capi_controller_lock);
929
930 ctr = get_capi_ctr_by_nr(contr);
931 if (ctr && ctr->state == CAPI_CTR_RUNNING) {
932 strlcpy(serial, ctr->serial, CAPI_SERIAL_LEN);
933 ret = CAPI_NOERROR;
934 } else
935 ret = CAPI_REGNOTINSTALLED;
936
937 mutex_unlock(&capi_controller_lock);
938 return ret;
939}
940
941EXPORT_SYMBOL(capi20_get_serial);
942
943
944
945
946
947
948
949
950
951
952
953u16 capi20_get_profile(u32 contr, struct capi_profile *profp)
954{
955 struct capi_ctr *ctr;
956 u16 ret;
957
958 if (contr == 0) {
959 profp->ncontroller = ncontrollers;
960 return CAPI_NOERROR;
961 }
962
963 mutex_lock(&capi_controller_lock);
964
965 ctr = get_capi_ctr_by_nr(contr);
966 if (ctr && ctr->state == CAPI_CTR_RUNNING) {
967 memcpy(profp, &ctr->profile, sizeof(struct capi_profile));
968 ret = CAPI_NOERROR;
969 } else
970 ret = CAPI_REGNOTINSTALLED;
971
972 mutex_unlock(&capi_controller_lock);
973 return ret;
974}
975
976EXPORT_SYMBOL(capi20_get_profile);
977
978
979static int wait_on_ctr_state(struct capi_ctr *ctr, unsigned int state)
980{
981 DEFINE_WAIT(wait);
982 int retval = 0;
983
984 ctr = capi_ctr_get(ctr);
985 if (!ctr)
986 return -ESRCH;
987
988 for (;;) {
989 prepare_to_wait(&ctr->state_wait_queue, &wait,
990 TASK_INTERRUPTIBLE);
991
992 if (ctr->state == state)
993 break;
994 if (ctr->state == CAPI_CTR_DETACHED) {
995 retval = -ESRCH;
996 break;
997 }
998 if (signal_pending(current)) {
999 retval = -EINTR;
1000 break;
1001 }
1002
1003 mutex_unlock(&capi_controller_lock);
1004 schedule();
1005 mutex_lock(&capi_controller_lock);
1006 }
1007 finish_wait(&ctr->state_wait_queue, &wait);
1008
1009 capi_ctr_put(ctr);
1010
1011 return retval;
1012}
1013
1014#ifdef AVMB1_COMPAT
1015static int old_capi_manufacturer(unsigned int cmd, void __user *data)
1016{
1017 avmb1_loadandconfigdef ldef;
1018 avmb1_extcarddef cdef;
1019 avmb1_resetdef rdef;
1020 capicardparams cparams;
1021 struct capi_ctr *ctr;
1022 struct capi_driver *driver = NULL;
1023 capiloaddata ldata;
1024 struct list_head *l;
1025 int retval;
1026
1027 switch (cmd) {
1028 case AVMB1_ADDCARD:
1029 case AVMB1_ADDCARD_WITH_TYPE:
1030 if (cmd == AVMB1_ADDCARD) {
1031 if ((retval = copy_from_user(&cdef, data,
1032 sizeof(avmb1_carddef))))
1033 return -EFAULT;
1034 cdef.cardtype = AVM_CARDTYPE_B1;
1035 cdef.cardnr = 0;
1036 } else {
1037 if ((retval = copy_from_user(&cdef, data,
1038 sizeof(avmb1_extcarddef))))
1039 return -EFAULT;
1040 }
1041 cparams.port = cdef.port;
1042 cparams.irq = cdef.irq;
1043 cparams.cardnr = cdef.cardnr;
1044
1045 mutex_lock(&capi_drivers_lock);
1046
1047 switch (cdef.cardtype) {
1048 case AVM_CARDTYPE_B1:
1049 list_for_each(l, &capi_drivers) {
1050 driver = list_entry(l, struct capi_driver, list);
1051 if (strcmp(driver->name, "b1isa") == 0)
1052 break;
1053 }
1054 break;
1055 case AVM_CARDTYPE_T1:
1056 list_for_each(l, &capi_drivers) {
1057 driver = list_entry(l, struct capi_driver, list);
1058 if (strcmp(driver->name, "t1isa") == 0)
1059 break;
1060 }
1061 break;
1062 default:
1063 driver = NULL;
1064 break;
1065 }
1066 if (!driver) {
1067 printk(KERN_ERR "kcapi: driver not loaded.\n");
1068 retval = -EIO;
1069 } else if (!driver->add_card) {
1070 printk(KERN_ERR "kcapi: driver has no add card function.\n");
1071 retval = -EIO;
1072 } else
1073 retval = driver->add_card(driver, &cparams);
1074
1075 mutex_unlock(&capi_drivers_lock);
1076 return retval;
1077
1078 case AVMB1_LOAD:
1079 case AVMB1_LOAD_AND_CONFIG:
1080
1081 if (cmd == AVMB1_LOAD) {
1082 if (copy_from_user(&ldef, data,
1083 sizeof(avmb1_loaddef)))
1084 return -EFAULT;
1085 ldef.t4config.len = 0;
1086 ldef.t4config.data = NULL;
1087 } else {
1088 if (copy_from_user(&ldef, data,
1089 sizeof(avmb1_loadandconfigdef)))
1090 return -EFAULT;
1091 }
1092
1093 mutex_lock(&capi_controller_lock);
1094
1095 ctr = get_capi_ctr_by_nr(ldef.contr);
1096 if (!ctr) {
1097 retval = -EINVAL;
1098 goto load_unlock_out;
1099 }
1100
1101 if (ctr->load_firmware == NULL) {
1102 printk(KERN_DEBUG "kcapi: load: no load function\n");
1103 retval = -ESRCH;
1104 goto load_unlock_out;
1105 }
1106
1107 if (ldef.t4file.len <= 0) {
1108 printk(KERN_DEBUG "kcapi: load: invalid parameter: length of t4file is %d ?\n", ldef.t4file.len);
1109 retval = -EINVAL;
1110 goto load_unlock_out;
1111 }
1112 if (ldef.t4file.data == NULL) {
1113 printk(KERN_DEBUG "kcapi: load: invalid parameter: dataptr is 0\n");
1114 retval = -EINVAL;
1115 goto load_unlock_out;
1116 }
1117
1118 ldata.firmware.user = 1;
1119 ldata.firmware.data = ldef.t4file.data;
1120 ldata.firmware.len = ldef.t4file.len;
1121 ldata.configuration.user = 1;
1122 ldata.configuration.data = ldef.t4config.data;
1123 ldata.configuration.len = ldef.t4config.len;
1124
1125 if (ctr->state != CAPI_CTR_DETECTED) {
1126 printk(KERN_INFO "kcapi: load: contr=%d not in detect state\n", ldef.contr);
1127 retval = -EBUSY;
1128 goto load_unlock_out;
1129 }
1130 ctr->state = CAPI_CTR_LOADING;
1131
1132 retval = ctr->load_firmware(ctr, &ldata);
1133 if (retval) {
1134 ctr->state = CAPI_CTR_DETECTED;
1135 goto load_unlock_out;
1136 }
1137
1138 retval = wait_on_ctr_state(ctr, CAPI_CTR_RUNNING);
1139
1140 load_unlock_out:
1141 mutex_unlock(&capi_controller_lock);
1142 return retval;
1143
1144 case AVMB1_RESETCARD:
1145 if (copy_from_user(&rdef, data, sizeof(avmb1_resetdef)))
1146 return -EFAULT;
1147
1148 retval = 0;
1149
1150 mutex_lock(&capi_controller_lock);
1151
1152 ctr = get_capi_ctr_by_nr(rdef.contr);
1153 if (!ctr) {
1154 retval = -ESRCH;
1155 goto reset_unlock_out;
1156 }
1157
1158 if (ctr->state == CAPI_CTR_DETECTED)
1159 goto reset_unlock_out;
1160
1161 if (ctr->reset_ctr == NULL) {
1162 printk(KERN_DEBUG "kcapi: reset: no reset function\n");
1163 retval = -ESRCH;
1164 goto reset_unlock_out;
1165 }
1166
1167 ctr->reset_ctr(ctr);
1168
1169 retval = wait_on_ctr_state(ctr, CAPI_CTR_DETECTED);
1170
1171 reset_unlock_out:
1172 mutex_unlock(&capi_controller_lock);
1173 return retval;
1174 }
1175 return -EINVAL;
1176}
1177#endif
1178
1179
1180
1181
1182
1183
1184
1185
1186
1187
1188int capi20_manufacturer(unsigned long cmd, void __user *data)
1189{
1190 struct capi_ctr *ctr;
1191 int retval;
1192
1193 switch (cmd) {
1194#ifdef AVMB1_COMPAT
1195 case AVMB1_LOAD:
1196 case AVMB1_LOAD_AND_CONFIG:
1197 case AVMB1_RESETCARD:
1198 case AVMB1_GET_CARDINFO:
1199 case AVMB1_REMOVECARD:
1200 return old_capi_manufacturer(cmd, data);
1201#endif
1202 case KCAPI_CMD_TRACE:
1203 {
1204 kcapi_flagdef fdef;
1205
1206 if (copy_from_user(&fdef, data, sizeof(kcapi_flagdef)))
1207 return -EFAULT;
1208
1209 mutex_lock(&capi_controller_lock);
1210
1211 ctr = get_capi_ctr_by_nr(fdef.contr);
1212 if (ctr) {
1213 ctr->traceflag = fdef.flag;
1214 printk(KERN_INFO "kcapi: contr [%03d] set trace=%d\n",
1215 ctr->cnr, ctr->traceflag);
1216 retval = 0;
1217 } else
1218 retval = -ESRCH;
1219
1220 mutex_unlock(&capi_controller_lock);
1221
1222 return retval;
1223 }
1224 case KCAPI_CMD_ADDCARD:
1225 {
1226 struct list_head *l;
1227 struct capi_driver *driver = NULL;
1228 capicardparams cparams;
1229 kcapi_carddef cdef;
1230
1231 if ((retval = copy_from_user(&cdef, data, sizeof(cdef))))
1232 return -EFAULT;
1233
1234 cparams.port = cdef.port;
1235 cparams.irq = cdef.irq;
1236 cparams.membase = cdef.membase;
1237 cparams.cardnr = cdef.cardnr;
1238 cparams.cardtype = 0;
1239 cdef.driver[sizeof(cdef.driver) - 1] = 0;
1240
1241 mutex_lock(&capi_drivers_lock);
1242
1243 list_for_each(l, &capi_drivers) {
1244 driver = list_entry(l, struct capi_driver, list);
1245 if (strcmp(driver->name, cdef.driver) == 0)
1246 break;
1247 }
1248 if (driver == NULL) {
1249 printk(KERN_ERR "kcapi: driver \"%s\" not loaded.\n",
1250 cdef.driver);
1251 retval = -ESRCH;
1252 } else if (!driver->add_card) {
1253 printk(KERN_ERR "kcapi: driver \"%s\" has no add card function.\n", cdef.driver);
1254 retval = -EIO;
1255 } else
1256 retval = driver->add_card(driver, &cparams);
1257
1258 mutex_unlock(&capi_drivers_lock);
1259 return retval;
1260 }
1261
1262 default:
1263 printk(KERN_ERR "kcapi: manufacturer command %lu unknown.\n",
1264 cmd);
1265 break;
1266
1267 }
1268 return -EINVAL;
1269}
1270
1271EXPORT_SYMBOL(capi20_manufacturer);
1272
1273
1274
1275
1276
1277
1278
1279
1280
1281static struct notifier_block capictr_nb = {
1282 .notifier_call = notify_handler,
1283 .priority = INT_MAX,
1284};
1285
1286static int __init kcapi_init(void)
1287{
1288 int err;
1289
1290 kcapi_wq = alloc_workqueue("kcapi", 0, 0);
1291 if (!kcapi_wq)
1292 return -ENOMEM;
1293
1294 register_capictr_notifier(&capictr_nb);
1295
1296 err = cdebug_init();
1297 if (err) {
1298 unregister_capictr_notifier(&capictr_nb);
1299 destroy_workqueue(kcapi_wq);
1300 return err;
1301 }
1302
1303 kcapi_proc_init();
1304 return 0;
1305}
1306
1307static void __exit kcapi_exit(void)
1308{
1309 kcapi_proc_exit();
1310
1311 unregister_capictr_notifier(&capictr_nb);
1312 cdebug_exit();
1313 destroy_workqueue(kcapi_wq);
1314}
1315
1316module_init(kcapi_init);
1317module_exit(kcapi_exit);
1318
