1 /* $Id: kcapi.c,v 1.1.2.8 2004/03/26 19:57:20 armin Exp $
3 * Kernel CAPI 2.0 Module
5 * Copyright 1999 by Carsten Paeth <calle@calle.de>
6 * Copyright 2002 by Kai Germaschewski <kai@germaschewski.name>
8 * This software may be used and distributed according to the terms
9 * of the GNU General Public License, incorporated herein by reference.
16 #include <linux/module.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>
35 #include <linux/b1lli.h>
37 #include <linux/mutex.h>
38 #include <linux/rcupdate.h>
40 static int showcapimsgs = 0;
41 static struct workqueue_struct *kcapi_wq;
43 MODULE_DESCRIPTION("CAPI4Linux: kernel CAPI layer");
44 MODULE_AUTHOR("Carsten Paeth");
45 MODULE_LICENSE("GPL");
46 module_param(showcapimsgs, uint, 0);
48 /* ------------------------------------------------------------- */
50 struct capictr_event {
51 struct work_struct work;
56 /* ------------------------------------------------------------- */
58 static const struct capi_version driver_version = {2, 0, 1, 1 << 4};
59 static char driver_serial[CAPI_SERIAL_LEN] = "0004711";
60 static char capi_manufakturer[64] = "AVM Berlin";
62 #define NCCI2CTRL(ncci) (((ncci) >> 24) & 0x7f)
64 LIST_HEAD(capi_drivers);
65 DEFINE_MUTEX(capi_drivers_lock);
67 struct capi_ctr *capi_controller[CAPI_MAXCONTR];
68 DEFINE_MUTEX(capi_controller_lock);
70 struct capi20_appl *capi_applications[CAPI_MAXAPPL];
72 static int ncontrollers;
74 static BLOCKING_NOTIFIER_HEAD(ctr_notifier_list);
76 /* -------- controller ref counting -------------------------------------- */
78 static inline struct capi_ctr *
79 capi_ctr_get(struct capi_ctr *ctr)
81 if (!try_module_get(ctr->owner))
87 capi_ctr_put(struct capi_ctr *ctr)
89 module_put(ctr->owner);
92 /* ------------------------------------------------------------- */
94 static inline struct capi_ctr *get_capi_ctr_by_nr(u16 contr)
96 if (contr < 1 || contr - 1 >= CAPI_MAXCONTR)
99 return capi_controller[contr - 1];
102 static inline struct capi20_appl *__get_capi_appl_by_nr(u16 applid)
104 lockdep_assert_held(&capi_controller_lock);
106 if (applid < 1 || applid - 1 >= CAPI_MAXAPPL)
109 return capi_applications[applid - 1];
112 static inline struct capi20_appl *get_capi_appl_by_nr(u16 applid)
114 if (applid < 1 || applid - 1 >= CAPI_MAXAPPL)
117 return rcu_dereference(capi_applications[applid - 1]);
120 /* -------- util functions ------------------------------------ */
122 static inline int capi_cmd_valid(u8 cmd)
127 case CAPI_CONNECT_ACTIVE:
128 case CAPI_CONNECT_B3_ACTIVE:
129 case CAPI_CONNECT_B3:
130 case CAPI_CONNECT_B3_T90_ACTIVE:
132 case CAPI_DISCONNECT_B3:
133 case CAPI_DISCONNECT:
137 case CAPI_MANUFACTURER:
139 case CAPI_SELECT_B_PROTOCOL:
145 static inline int capi_subcmd_valid(u8 subcmd)
157 /* ------------------------------------------------------------ */
160 register_appl(struct capi_ctr *ctr, u16 applid, capi_register_params *rparam)
162 ctr = capi_ctr_get(ctr);
165 ctr->register_appl(ctr, applid, rparam);
167 printk(KERN_WARNING "%s: cannot get controller resources\n",
172 static void release_appl(struct capi_ctr *ctr, u16 applid)
174 DBG("applid %#x", applid);
176 ctr->release_appl(ctr, applid);
180 static void notify_up(u32 contr)
182 struct capi20_appl *ap;
183 struct capi_ctr *ctr;
186 mutex_lock(&capi_controller_lock);
188 if (showcapimsgs & 1)
189 printk(KERN_DEBUG "kcapi: notify up contr %d\n", contr);
191 ctr = get_capi_ctr_by_nr(contr);
193 if (ctr->state == CAPI_CTR_RUNNING)
196 ctr->state = CAPI_CTR_RUNNING;
198 for (applid = 1; applid <= CAPI_MAXAPPL; applid++) {
199 ap = __get_capi_appl_by_nr(applid);
201 register_appl(ctr, applid, &ap->rparam);
204 wake_up_interruptible_all(&ctr->state_wait_queue);
206 printk(KERN_WARNING "%s: invalid contr %d\n", __func__, contr);
209 mutex_unlock(&capi_controller_lock);
212 static void ctr_down(struct capi_ctr *ctr, int new_state)
214 struct capi20_appl *ap;
217 if (ctr->state == CAPI_CTR_DETECTED || ctr->state == CAPI_CTR_DETACHED)
220 ctr->state = new_state;
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));
227 for (applid = 1; applid <= CAPI_MAXAPPL; applid++) {
228 ap = __get_capi_appl_by_nr(applid);
233 wake_up_interruptible_all(&ctr->state_wait_queue);
236 static void notify_down(u32 contr)
238 struct capi_ctr *ctr;
240 mutex_lock(&capi_controller_lock);
242 if (showcapimsgs & 1)
243 printk(KERN_DEBUG "kcapi: notify down contr %d\n", contr);
245 ctr = get_capi_ctr_by_nr(contr);
247 ctr_down(ctr, CAPI_CTR_DETECTED);
249 printk(KERN_WARNING "%s: invalid contr %d\n", __func__, contr);
251 mutex_unlock(&capi_controller_lock);
255 notify_handler(struct notifier_block *nb, unsigned long val, void *v)
270 static void do_notify_work(struct work_struct *work)
272 struct capictr_event *event =
273 container_of(work, struct capictr_event, work);
275 blocking_notifier_call_chain(&ctr_notifier_list, event->type,
276 (void *)(long)event->controller);
281 * The notifier will result in adding/deleteing of devices. Devices can
282 * only removed in user process, not in bh.
284 static int notify_push(unsigned int event_type, u32 controller)
286 struct capictr_event *event = kmalloc(sizeof(*event), GFP_ATOMIC);
291 INIT_WORK(&event->work, do_notify_work);
292 event->type = event_type;
293 event->controller = controller;
295 queue_work(kcapi_wq, &event->work);
299 int register_capictr_notifier(struct notifier_block *nb)
301 return blocking_notifier_chain_register(&ctr_notifier_list, nb);
303 EXPORT_SYMBOL_GPL(register_capictr_notifier);
305 int unregister_capictr_notifier(struct notifier_block *nb)
307 return blocking_notifier_chain_unregister(&ctr_notifier_list, nb);
309 EXPORT_SYMBOL_GPL(unregister_capictr_notifier);
311 /* -------- Receiver ------------------------------------------ */
313 static void recv_handler(struct work_struct *work)
316 struct capi20_appl *ap =
317 container_of(work, struct capi20_appl, recv_work);
319 if ((!ap) || (ap->release_in_progress))
322 mutex_lock(&ap->recv_mtx);
323 while ((skb = skb_dequeue(&ap->recv_queue))) {
324 if (CAPIMSG_CMD(skb->data) == CAPI_DATA_B3_IND)
329 ap->recv_message(ap, skb);
331 mutex_unlock(&ap->recv_mtx);
335 * capi_ctr_handle_message() - handle incoming CAPI message
336 * @ctr: controller descriptor structure.
337 * @appl: application ID.
340 * Called by hardware driver to pass a CAPI message to the application.
343 void capi_ctr_handle_message(struct capi_ctr *ctr, u16 appl,
346 struct capi20_appl *ap;
351 if (ctr->state != CAPI_CTR_RUNNING) {
352 cdb = capi_message2str(skb->data);
354 printk(KERN_INFO "kcapi: controller [%03d] not active, got: %s",
358 printk(KERN_INFO "kcapi: controller [%03d] not active, cannot trace\n",
363 cmd = CAPIMSG_COMMAND(skb->data);
364 subcmd = CAPIMSG_SUBCOMMAND(skb->data);
365 if (cmd == CAPI_DATA_B3 && subcmd == CAPI_IND) {
367 if (ctr->traceflag > 2)
374 showctl |= (ctr->traceflag & 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));
382 cdb = capi_message2str(skb->data);
384 printk(KERN_DEBUG "kcapi: got [%03d] %s\n",
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));
397 ap = get_capi_appl_by_nr(CAPIMSG_APPID(skb->data));
400 cdb = capi_message2str(skb->data);
402 printk(KERN_ERR "kcapi: handle_message: applid %d state released (%s)\n",
403 CAPIMSG_APPID(skb->data), cdb->buf);
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));
411 skb_queue_tail(&ap->recv_queue, skb);
412 queue_work(kcapi_wq, &ap->recv_work);
421 EXPORT_SYMBOL(capi_ctr_handle_message);
424 * capi_ctr_ready() - signal CAPI controller ready
425 * @ctr: controller descriptor structure.
427 * Called by hardware driver to signal that the controller is up and running.
430 void capi_ctr_ready(struct capi_ctr *ctr)
432 printk(KERN_NOTICE "kcapi: controller [%03d] \"%s\" ready.\n",
433 ctr->cnr, ctr->name);
435 notify_push(CAPICTR_UP, ctr->cnr);
438 EXPORT_SYMBOL(capi_ctr_ready);
441 * capi_ctr_down() - signal CAPI controller not ready
442 * @ctr: controller descriptor structure.
444 * Called by hardware driver to signal that the controller is down and
445 * unavailable for use.
448 void capi_ctr_down(struct capi_ctr *ctr)
450 printk(KERN_NOTICE "kcapi: controller [%03d] down.\n", ctr->cnr);
452 notify_push(CAPICTR_DOWN, ctr->cnr);
455 EXPORT_SYMBOL(capi_ctr_down);
458 * capi_ctr_suspend_output() - suspend controller
459 * @ctr: controller descriptor structure.
461 * Called by hardware driver to stop data flow.
463 * Note: The caller is responsible for synchronizing concurrent state changes
464 * as well as invocations of capi_ctr_handle_message.
467 void capi_ctr_suspend_output(struct capi_ctr *ctr)
470 printk(KERN_DEBUG "kcapi: controller [%03d] suspend\n",
476 EXPORT_SYMBOL(capi_ctr_suspend_output);
479 * capi_ctr_resume_output() - resume controller
480 * @ctr: controller descriptor structure.
482 * Called by hardware driver to resume data flow.
484 * Note: The caller is responsible for synchronizing concurrent state changes
485 * as well as invocations of capi_ctr_handle_message.
488 void capi_ctr_resume_output(struct capi_ctr *ctr)
491 printk(KERN_DEBUG "kcapi: controller [%03d] resumed\n",
497 EXPORT_SYMBOL(capi_ctr_resume_output);
499 /* ------------------------------------------------------------- */
502 * attach_capi_ctr() - register CAPI controller
503 * @ctr: controller descriptor structure.
505 * Called by hardware driver to register a controller with the CAPI subsystem.
506 * Return value: 0 on success, error code < 0 on error
509 int attach_capi_ctr(struct capi_ctr *ctr)
513 mutex_lock(&capi_controller_lock);
515 for (i = 0; i < CAPI_MAXCONTR; i++) {
516 if (!capi_controller[i])
519 if (i == CAPI_MAXCONTR) {
520 mutex_unlock(&capi_controller_lock);
521 printk(KERN_ERR "kcapi: out of controller slots\n");
524 capi_controller[i] = ctr;
526 ctr->nrecvctlpkt = 0;
527 ctr->nrecvdatapkt = 0;
528 ctr->nsentctlpkt = 0;
529 ctr->nsentdatapkt = 0;
531 ctr->state = CAPI_CTR_DETECTED;
533 ctr->traceflag = showcapimsgs;
534 init_waitqueue_head(&ctr->state_wait_queue);
536 sprintf(ctr->procfn, "capi/controllers/%d", ctr->cnr);
537 ctr->procent = proc_create_single_data(ctr->procfn, 0, NULL,
538 ctr->proc_show, ctr);
542 mutex_unlock(&capi_controller_lock);
544 printk(KERN_NOTICE "kcapi: controller [%03d]: %s attached\n",
545 ctr->cnr, ctr->name);
549 EXPORT_SYMBOL(attach_capi_ctr);
552 * detach_capi_ctr() - unregister CAPI controller
553 * @ctr: controller descriptor structure.
555 * Called by hardware driver to remove the registration of a controller
556 * with the CAPI subsystem.
557 * Return value: 0 on success, error code < 0 on error
560 int detach_capi_ctr(struct capi_ctr *ctr)
564 mutex_lock(&capi_controller_lock);
566 ctr_down(ctr, CAPI_CTR_DETACHED);
568 if (ctr->cnr < 1 || ctr->cnr - 1 >= CAPI_MAXCONTR) {
573 if (capi_controller[ctr->cnr - 1] != ctr) {
577 capi_controller[ctr->cnr - 1] = NULL;
581 remove_proc_entry(ctr->procfn, NULL);
583 printk(KERN_NOTICE "kcapi: controller [%03d]: %s unregistered\n",
584 ctr->cnr, ctr->name);
587 mutex_unlock(&capi_controller_lock);
592 EXPORT_SYMBOL(detach_capi_ctr);
595 * register_capi_driver() - register CAPI driver
596 * @driver: driver descriptor structure.
598 * Called by hardware driver to register itself with the CAPI subsystem.
601 void register_capi_driver(struct capi_driver *driver)
603 mutex_lock(&capi_drivers_lock);
604 list_add_tail(&driver->list, &capi_drivers);
605 mutex_unlock(&capi_drivers_lock);
608 EXPORT_SYMBOL(register_capi_driver);
611 * unregister_capi_driver() - unregister CAPI driver
612 * @driver: driver descriptor structure.
614 * Called by hardware driver to unregister itself from the CAPI subsystem.
617 void unregister_capi_driver(struct capi_driver *driver)
619 mutex_lock(&capi_drivers_lock);
620 list_del(&driver->list);
621 mutex_unlock(&capi_drivers_lock);
624 EXPORT_SYMBOL(unregister_capi_driver);
626 /* ------------------------------------------------------------- */
627 /* -------- CAPI2.0 Interface ---------------------------------- */
628 /* ------------------------------------------------------------- */
631 * capi20_isinstalled() - CAPI 2.0 operation CAPI_INSTALLED
633 * Return value: CAPI result code (CAPI_NOERROR if at least one ISDN controller
634 * is ready for use, CAPI_REGNOTINSTALLED otherwise)
637 u16 capi20_isinstalled(void)
639 u16 ret = CAPI_REGNOTINSTALLED;
642 mutex_lock(&capi_controller_lock);
644 for (i = 0; i < CAPI_MAXCONTR; i++)
645 if (capi_controller[i] &&
646 capi_controller[i]->state == CAPI_CTR_RUNNING) {
651 mutex_unlock(&capi_controller_lock);
656 EXPORT_SYMBOL(capi20_isinstalled);
659 * capi20_register() - CAPI 2.0 operation CAPI_REGISTER
660 * @ap: CAPI application descriptor structure.
662 * Register an application's presence with CAPI.
663 * A unique application ID is assigned and stored in @ap->applid.
664 * After this function returns successfully, the message receive
665 * callback function @ap->recv_message() may be called at any time
666 * until capi20_release() has been called for the same @ap.
667 * Return value: CAPI result code
670 u16 capi20_register(struct capi20_appl *ap)
677 if (ap->rparam.datablklen < 128)
678 return CAPI_LOGBLKSIZETOSMALL;
681 ap->nrecvdatapkt = 0;
683 ap->nsentdatapkt = 0;
684 mutex_init(&ap->recv_mtx);
685 skb_queue_head_init(&ap->recv_queue);
686 INIT_WORK(&ap->recv_work, recv_handler);
687 ap->release_in_progress = 0;
689 mutex_lock(&capi_controller_lock);
691 for (applid = 1; applid <= CAPI_MAXAPPL; applid++) {
692 if (capi_applications[applid - 1] == NULL)
695 if (applid > CAPI_MAXAPPL) {
696 mutex_unlock(&capi_controller_lock);
697 return CAPI_TOOMANYAPPLS;
701 capi_applications[applid - 1] = ap;
703 for (i = 0; i < CAPI_MAXCONTR; i++) {
704 if (!capi_controller[i] ||
705 capi_controller[i]->state != CAPI_CTR_RUNNING)
707 register_appl(capi_controller[i], applid, &ap->rparam);
710 mutex_unlock(&capi_controller_lock);
712 if (showcapimsgs & 1) {
713 printk(KERN_DEBUG "kcapi: appl %d up\n", applid);
719 EXPORT_SYMBOL(capi20_register);
722 * capi20_release() - CAPI 2.0 operation CAPI_RELEASE
723 * @ap: CAPI application descriptor structure.
725 * Terminate an application's registration with CAPI.
726 * After this function returns successfully, the message receive
727 * callback function @ap->recv_message() will no longer be called.
728 * Return value: CAPI result code
731 u16 capi20_release(struct capi20_appl *ap)
735 DBG("applid %#x", ap->applid);
737 mutex_lock(&capi_controller_lock);
739 ap->release_in_progress = 1;
740 capi_applications[ap->applid - 1] = NULL;
744 for (i = 0; i < CAPI_MAXCONTR; i++) {
745 if (!capi_controller[i] ||
746 capi_controller[i]->state != CAPI_CTR_RUNNING)
748 release_appl(capi_controller[i], ap->applid);
751 mutex_unlock(&capi_controller_lock);
753 flush_workqueue(kcapi_wq);
754 skb_queue_purge(&ap->recv_queue);
756 if (showcapimsgs & 1) {
757 printk(KERN_DEBUG "kcapi: appl %d down\n", ap->applid);
763 EXPORT_SYMBOL(capi20_release);
766 * capi20_put_message() - CAPI 2.0 operation CAPI_PUT_MESSAGE
767 * @ap: CAPI application descriptor structure.
768 * @skb: CAPI message.
770 * Transfer a single message to CAPI.
771 * Return value: CAPI result code
774 u16 capi20_put_message(struct capi20_appl *ap, struct sk_buff *skb)
776 struct capi_ctr *ctr;
780 DBG("applid %#x", ap->applid);
782 if (ncontrollers == 0)
783 return CAPI_REGNOTINSTALLED;
784 if ((ap->applid == 0) || ap->release_in_progress)
785 return CAPI_ILLAPPNR;
787 || !capi_cmd_valid(CAPIMSG_COMMAND(skb->data))
788 || !capi_subcmd_valid(CAPIMSG_SUBCOMMAND(skb->data)))
789 return CAPI_ILLCMDORSUBCMDORMSGTOSMALL;
792 * The controller reference is protected by the existence of the
793 * application passed to us. We assume that the caller properly
794 * synchronizes this service with capi20_release.
796 ctr = get_capi_ctr_by_nr(CAPIMSG_CONTROLLER(skb->data));
797 if (!ctr || ctr->state != CAPI_CTR_RUNNING)
798 return CAPI_REGNOTINSTALLED;
800 return CAPI_SENDQUEUEFULL;
802 cmd = CAPIMSG_COMMAND(skb->data);
803 subcmd = CAPIMSG_SUBCOMMAND(skb->data);
805 if (cmd == CAPI_DATA_B3 && subcmd == CAPI_REQ) {
808 if (ctr->traceflag > 2)
816 showctl |= (ctr->traceflag & 1);
819 printk(KERN_DEBUG "kcapi: put [%03d] id#%d %s len=%u\n",
820 CAPIMSG_CONTROLLER(skb->data),
821 CAPIMSG_APPID(skb->data),
822 capi_cmd2str(cmd, subcmd),
823 CAPIMSG_LEN(skb->data));
825 _cdebbuf *cdb = capi_message2str(skb->data);
827 printk(KERN_DEBUG "kcapi: put [%03d] %s\n",
828 CAPIMSG_CONTROLLER(skb->data),
832 printk(KERN_DEBUG "kcapi: put [%03d] id#%d %s len=%u cannot trace\n",
833 CAPIMSG_CONTROLLER(skb->data),
834 CAPIMSG_APPID(skb->data),
835 capi_cmd2str(cmd, subcmd),
836 CAPIMSG_LEN(skb->data));
839 return ctr->send_message(ctr, skb);
842 EXPORT_SYMBOL(capi20_put_message);
845 * capi20_get_manufacturer() - CAPI 2.0 operation CAPI_GET_MANUFACTURER
846 * @contr: controller number.
847 * @buf: result buffer (64 bytes).
849 * Retrieve information about the manufacturer of the specified ISDN controller
850 * or (for @contr == 0) the driver itself.
851 * Return value: CAPI result code
854 u16 capi20_get_manufacturer(u32 contr, u8 buf[CAPI_MANUFACTURER_LEN])
856 struct capi_ctr *ctr;
860 strncpy(buf, capi_manufakturer, CAPI_MANUFACTURER_LEN);
864 mutex_lock(&capi_controller_lock);
866 ctr = get_capi_ctr_by_nr(contr);
867 if (ctr && ctr->state == CAPI_CTR_RUNNING) {
868 strncpy(buf, ctr->manu, CAPI_MANUFACTURER_LEN);
871 ret = CAPI_REGNOTINSTALLED;
873 mutex_unlock(&capi_controller_lock);
877 EXPORT_SYMBOL(capi20_get_manufacturer);
880 * capi20_get_version() - CAPI 2.0 operation CAPI_GET_VERSION
881 * @contr: controller number.
882 * @verp: result structure.
884 * Retrieve version information for the specified ISDN controller
885 * or (for @contr == 0) the driver itself.
886 * Return value: CAPI result code
889 u16 capi20_get_version(u32 contr, struct capi_version *verp)
891 struct capi_ctr *ctr;
895 *verp = driver_version;
899 mutex_lock(&capi_controller_lock);
901 ctr = get_capi_ctr_by_nr(contr);
902 if (ctr && ctr->state == CAPI_CTR_RUNNING) {
903 memcpy(verp, &ctr->version, sizeof(capi_version));
906 ret = CAPI_REGNOTINSTALLED;
908 mutex_unlock(&capi_controller_lock);
912 EXPORT_SYMBOL(capi20_get_version);
915 * capi20_get_serial() - CAPI 2.0 operation CAPI_GET_SERIAL_NUMBER
916 * @contr: controller number.
917 * @serial: result buffer (8 bytes).
919 * Retrieve the serial number of the specified ISDN controller
920 * or (for @contr == 0) the driver itself.
921 * Return value: CAPI result code
924 u16 capi20_get_serial(u32 contr, u8 serial[CAPI_SERIAL_LEN])
926 struct capi_ctr *ctr;
930 strlcpy(serial, driver_serial, CAPI_SERIAL_LEN);
934 mutex_lock(&capi_controller_lock);
936 ctr = get_capi_ctr_by_nr(contr);
937 if (ctr && ctr->state == CAPI_CTR_RUNNING) {
938 strlcpy(serial, ctr->serial, CAPI_SERIAL_LEN);
941 ret = CAPI_REGNOTINSTALLED;
943 mutex_unlock(&capi_controller_lock);
947 EXPORT_SYMBOL(capi20_get_serial);
950 * capi20_get_profile() - CAPI 2.0 operation CAPI_GET_PROFILE
951 * @contr: controller number.
952 * @profp: result structure.
954 * Retrieve capability information for the specified ISDN controller
955 * or (for @contr == 0) the number of installed controllers.
956 * Return value: CAPI result code
959 u16 capi20_get_profile(u32 contr, struct capi_profile *profp)
961 struct capi_ctr *ctr;
965 profp->ncontroller = ncontrollers;
969 mutex_lock(&capi_controller_lock);
971 ctr = get_capi_ctr_by_nr(contr);
972 if (ctr && ctr->state == CAPI_CTR_RUNNING) {
973 memcpy(profp, &ctr->profile, sizeof(struct capi_profile));
976 ret = CAPI_REGNOTINSTALLED;
978 mutex_unlock(&capi_controller_lock);
982 EXPORT_SYMBOL(capi20_get_profile);
984 /* Must be called with capi_controller_lock held. */
985 static int wait_on_ctr_state(struct capi_ctr *ctr, unsigned int state)
990 ctr = capi_ctr_get(ctr);
995 prepare_to_wait(&ctr->state_wait_queue, &wait,
998 if (ctr->state == state)
1000 if (ctr->state == CAPI_CTR_DETACHED) {
1004 if (signal_pending(current)) {
1009 mutex_unlock(&capi_controller_lock);
1011 mutex_lock(&capi_controller_lock);
1013 finish_wait(&ctr->state_wait_queue, &wait);
1021 static int old_capi_manufacturer(unsigned int cmd, void __user *data)
1023 avmb1_loadandconfigdef ldef;
1024 avmb1_extcarddef cdef;
1025 avmb1_resetdef rdef;
1026 capicardparams cparams;
1027 struct capi_ctr *ctr;
1028 struct capi_driver *driver = NULL;
1030 struct list_head *l;
1035 case AVMB1_ADDCARD_WITH_TYPE:
1036 if (cmd == AVMB1_ADDCARD) {
1037 if ((retval = copy_from_user(&cdef, data,
1038 sizeof(avmb1_carddef))))
1040 cdef.cardtype = AVM_CARDTYPE_B1;
1043 if ((retval = copy_from_user(&cdef, data,
1044 sizeof(avmb1_extcarddef))))
1047 cparams.port = cdef.port;
1048 cparams.irq = cdef.irq;
1049 cparams.cardnr = cdef.cardnr;
1051 mutex_lock(&capi_drivers_lock);
1053 switch (cdef.cardtype) {
1054 case AVM_CARDTYPE_B1:
1055 list_for_each(l, &capi_drivers) {
1056 driver = list_entry(l, struct capi_driver, list);
1057 if (strcmp(driver->name, "b1isa") == 0)
1061 case AVM_CARDTYPE_T1:
1062 list_for_each(l, &capi_drivers) {
1063 driver = list_entry(l, struct capi_driver, list);
1064 if (strcmp(driver->name, "t1isa") == 0)
1073 printk(KERN_ERR "kcapi: driver not loaded.\n");
1075 } else if (!driver->add_card) {
1076 printk(KERN_ERR "kcapi: driver has no add card function.\n");
1079 retval = driver->add_card(driver, &cparams);
1081 mutex_unlock(&capi_drivers_lock);
1085 case AVMB1_LOAD_AND_CONFIG:
1087 if (cmd == AVMB1_LOAD) {
1088 if (copy_from_user(&ldef, data,
1089 sizeof(avmb1_loaddef)))
1091 ldef.t4config.len = 0;
1092 ldef.t4config.data = NULL;
1094 if (copy_from_user(&ldef, data,
1095 sizeof(avmb1_loadandconfigdef)))
1099 mutex_lock(&capi_controller_lock);
1101 ctr = get_capi_ctr_by_nr(ldef.contr);
1104 goto load_unlock_out;
1107 if (ctr->load_firmware == NULL) {
1108 printk(KERN_DEBUG "kcapi: load: no load function\n");
1110 goto load_unlock_out;
1113 if (ldef.t4file.len <= 0) {
1114 printk(KERN_DEBUG "kcapi: load: invalid parameter: length of t4file is %d ?\n", ldef.t4file.len);
1116 goto load_unlock_out;
1118 if (ldef.t4file.data == NULL) {
1119 printk(KERN_DEBUG "kcapi: load: invalid parameter: dataptr is 0\n");
1121 goto load_unlock_out;
1124 ldata.firmware.user = 1;
1125 ldata.firmware.data = ldef.t4file.data;
1126 ldata.firmware.len = ldef.t4file.len;
1127 ldata.configuration.user = 1;
1128 ldata.configuration.data = ldef.t4config.data;
1129 ldata.configuration.len = ldef.t4config.len;
1131 if (ctr->state != CAPI_CTR_DETECTED) {
1132 printk(KERN_INFO "kcapi: load: contr=%d not in detect state\n", ldef.contr);
1134 goto load_unlock_out;
1136 ctr->state = CAPI_CTR_LOADING;
1138 retval = ctr->load_firmware(ctr, &ldata);
1140 ctr->state = CAPI_CTR_DETECTED;
1141 goto load_unlock_out;
1144 retval = wait_on_ctr_state(ctr, CAPI_CTR_RUNNING);
1147 mutex_unlock(&capi_controller_lock);
1150 case AVMB1_RESETCARD:
1151 if (copy_from_user(&rdef, data, sizeof(avmb1_resetdef)))
1156 mutex_lock(&capi_controller_lock);
1158 ctr = get_capi_ctr_by_nr(rdef.contr);
1161 goto reset_unlock_out;
1164 if (ctr->state == CAPI_CTR_DETECTED)
1165 goto reset_unlock_out;
1167 if (ctr->reset_ctr == NULL) {
1168 printk(KERN_DEBUG "kcapi: reset: no reset function\n");
1170 goto reset_unlock_out;
1173 ctr->reset_ctr(ctr);
1175 retval = wait_on_ctr_state(ctr, CAPI_CTR_DETECTED);
1178 mutex_unlock(&capi_controller_lock);
1186 * capi20_manufacturer() - CAPI 2.0 operation CAPI_MANUFACTURER
1190 * Perform manufacturer specific command.
1191 * Return value: CAPI result code
1194 int capi20_manufacturer(unsigned long cmd, void __user *data)
1196 struct capi_ctr *ctr;
1202 case AVMB1_LOAD_AND_CONFIG:
1203 case AVMB1_RESETCARD:
1204 case AVMB1_GET_CARDINFO:
1205 case AVMB1_REMOVECARD:
1206 return old_capi_manufacturer(cmd, data);
1208 case KCAPI_CMD_TRACE:
1212 if (copy_from_user(&fdef, data, sizeof(kcapi_flagdef)))
1215 mutex_lock(&capi_controller_lock);
1217 ctr = get_capi_ctr_by_nr(fdef.contr);
1219 ctr->traceflag = fdef.flag;
1220 printk(KERN_INFO "kcapi: contr [%03d] set trace=%d\n",
1221 ctr->cnr, ctr->traceflag);
1226 mutex_unlock(&capi_controller_lock);
1230 case KCAPI_CMD_ADDCARD:
1232 struct list_head *l;
1233 struct capi_driver *driver = NULL;
1234 capicardparams cparams;
1237 if ((retval = copy_from_user(&cdef, data, sizeof(cdef))))
1240 cparams.port = cdef.port;
1241 cparams.irq = cdef.irq;
1242 cparams.membase = cdef.membase;
1243 cparams.cardnr = cdef.cardnr;
1244 cparams.cardtype = 0;
1245 cdef.driver[sizeof(cdef.driver) - 1] = 0;
1247 mutex_lock(&capi_drivers_lock);
1249 list_for_each(l, &capi_drivers) {
1250 driver = list_entry(l, struct capi_driver, list);
1251 if (strcmp(driver->name, cdef.driver) == 0)
1254 if (driver == NULL) {
1255 printk(KERN_ERR "kcapi: driver \"%s\" not loaded.\n",
1258 } else if (!driver->add_card) {
1259 printk(KERN_ERR "kcapi: driver \"%s\" has no add card function.\n", cdef.driver);
1262 retval = driver->add_card(driver, &cparams);
1264 mutex_unlock(&capi_drivers_lock);
1269 printk(KERN_ERR "kcapi: manufacturer command %lu unknown.\n",
1277 EXPORT_SYMBOL(capi20_manufacturer);
1279 /* ------------------------------------------------------------- */
1280 /* -------- Init & Cleanup ------------------------------------- */
1281 /* ------------------------------------------------------------- */
1284 * init / exit functions
1287 static struct notifier_block capictr_nb = {
1288 .notifier_call = notify_handler,
1289 .priority = INT_MAX,
1292 static int __init kcapi_init(void)
1296 kcapi_wq = alloc_workqueue("kcapi", 0, 0);
1300 register_capictr_notifier(&capictr_nb);
1302 err = cdebug_init();
1304 unregister_capictr_notifier(&capictr_nb);
1305 destroy_workqueue(kcapi_wq);
1313 static void __exit kcapi_exit(void)
1317 unregister_capictr_notifier(&capictr_nb);
1319 destroy_workqueue(kcapi_wq);
1322 module_init(kcapi_init);
1323 module_exit(kcapi_exit);