1 /* $Id: capi.c,v 1.1.2.7 2004/04/28 09:48:59 armin Exp $
3 * CAPI 2.0 Interface for Linux
5 * Copyright 1996 by Carsten Paeth <calle@calle.de>
7 * This software may be used and distributed according to the terms
8 * of the GNU General Public License, incorporated herein by reference.
12 #include <linux/module.h>
13 #include <linux/errno.h>
14 #include <linux/kernel.h>
15 #include <linux/major.h>
16 #include <linux/sched.h>
17 #include <linux/slab.h>
18 #include <linux/fcntl.h>
20 #include <linux/signal.h>
21 #include <linux/mutex.h>
23 #include <linux/timer.h>
24 #include <linux/wait.h>
25 #include <linux/tty.h>
26 #include <linux/netdevice.h>
27 #include <linux/ppp_defs.h>
28 #include <linux/if_ppp.h>
29 #include <linux/skbuff.h>
30 #include <linux/proc_fs.h>
31 #include <linux/seq_file.h>
32 #include <linux/poll.h>
33 #include <linux/capi.h>
34 #include <linux/kernelcapi.h>
35 #include <linux/init.h>
36 #include <linux/device.h>
37 #include <linux/moduleparam.h>
38 #include <linux/isdn/capiutil.h>
39 #include <linux/isdn/capicmd.h>
43 MODULE_DESCRIPTION("CAPI4Linux: Userspace /dev/capi20 interface");
44 MODULE_AUTHOR("Carsten Paeth");
45 MODULE_LICENSE("GPL");
47 #undef _DEBUG_TTYFUNCS /* call to tty_driver */
48 #undef _DEBUG_DATAFLOW /* data flow */
50 /* -------- driver information -------------------------------------- */
52 static DEFINE_MUTEX(capi_mutex
);
53 static struct class *capi_class
;
54 static int capi_major
= 68; /* allocated */
56 module_param_named(major
, capi_major
, uint
, 0);
58 #ifdef CONFIG_ISDN_CAPI_MIDDLEWARE
59 #define CAPINC_NR_PORTS 32
60 #define CAPINC_MAX_PORTS 256
62 static int capi_ttyminors
= CAPINC_NR_PORTS
;
64 module_param_named(ttyminors
, capi_ttyminors
, uint
, 0);
65 #endif /* CONFIG_ISDN_CAPI_MIDDLEWARE */
67 /* -------- defines ------------------------------------------------- */
69 #define CAPINC_MAX_RECVQUEUE 10
70 #define CAPINC_MAX_SENDQUEUE 10
71 #define CAPI_MAX_BLKSIZE 2048
73 /* -------- data structures ----------------------------------------- */
79 struct ackqueue_entry
{
80 struct list_head list
;
88 struct dentry
*capifs_dentry
;
90 struct capi20_appl
*ap
;
99 struct sk_buff_head inqueue
;
101 struct sk_buff_head outqueue
;
103 struct sk_buff
*outskb
;
107 struct list_head ackqueue
;
113 struct list_head list
;
115 struct capidev
*cdev
;
116 #ifdef CONFIG_ISDN_CAPI_MIDDLEWARE
117 struct capiminor
*minorp
;
118 #endif /* CONFIG_ISDN_CAPI_MIDDLEWARE */
122 struct list_head list
;
123 struct capi20_appl ap
;
127 struct sk_buff_head recvqueue
;
128 wait_queue_head_t recvwait
;
130 struct list_head nccis
;
135 /* -------- global variables ---------------------------------------- */
137 static DEFINE_MUTEX(capidev_list_lock
);
138 static LIST_HEAD(capidev_list
);
140 #ifdef CONFIG_ISDN_CAPI_MIDDLEWARE
142 static DEFINE_SPINLOCK(capiminors_lock
);
143 static struct capiminor
**capiminors
;
145 static struct tty_driver
*capinc_tty_driver
;
147 /* -------- datahandles --------------------------------------------- */
149 static int capiminor_add_ack(struct capiminor
*mp
, u16 datahandle
)
151 struct ackqueue_entry
*n
;
153 n
= kmalloc(sizeof(*n
), GFP_ATOMIC
);
155 printk(KERN_ERR
"capi: alloc datahandle failed\n");
158 n
->datahandle
= datahandle
;
159 INIT_LIST_HEAD(&n
->list
);
160 spin_lock_bh(&mp
->ackqlock
);
161 list_add_tail(&n
->list
, &mp
->ackqueue
);
163 spin_unlock_bh(&mp
->ackqlock
);
167 static int capiminor_del_ack(struct capiminor
*mp
, u16 datahandle
)
169 struct ackqueue_entry
*p
, *tmp
;
171 spin_lock_bh(&mp
->ackqlock
);
172 list_for_each_entry_safe(p
, tmp
, &mp
->ackqueue
, list
) {
173 if (p
->datahandle
== datahandle
) {
176 spin_unlock_bh(&mp
->ackqlock
);
181 spin_unlock_bh(&mp
->ackqlock
);
185 static void capiminor_del_all_ack(struct capiminor
*mp
)
187 struct ackqueue_entry
*p
, *tmp
;
189 list_for_each_entry_safe(p
, tmp
, &mp
->ackqueue
, list
) {
197 /* -------- struct capiminor ---------------------------------------- */
199 static const struct tty_port_operations capiminor_port_ops
; /* we have none */
201 static struct capiminor
*capiminor_alloc(struct capi20_appl
*ap
, u32 ncci
)
203 struct capiminor
*mp
;
207 mp
= kzalloc(sizeof(*mp
), GFP_KERNEL
);
209 printk(KERN_ERR
"capi: can't alloc capiminor\n");
213 kref_init(&mp
->kref
);
217 INIT_LIST_HEAD(&mp
->ackqueue
);
218 spin_lock_init(&mp
->ackqlock
);
220 skb_queue_head_init(&mp
->inqueue
);
221 skb_queue_head_init(&mp
->outqueue
);
222 spin_lock_init(&mp
->outlock
);
224 tty_port_init(&mp
->port
);
225 mp
->port
.ops
= &capiminor_port_ops
;
227 /* Allocate the least unused minor number. */
228 spin_lock(&capiminors_lock
);
229 for (minor
= 0; minor
< capi_ttyminors
; minor
++)
230 if (!capiminors
[minor
]) {
231 capiminors
[minor
] = mp
;
234 spin_unlock(&capiminors_lock
);
236 if (minor
== capi_ttyminors
) {
237 printk(KERN_NOTICE
"capi: out of minors\n");
243 dev
= tty_register_device(capinc_tty_driver
, minor
, NULL
);
250 spin_lock(&capiminors_lock
);
251 capiminors
[minor
] = NULL
;
252 spin_unlock(&capiminors_lock
);
259 static void capiminor_destroy(struct kref
*kref
)
261 struct capiminor
*mp
= container_of(kref
, struct capiminor
, kref
);
263 kfree_skb(mp
->outskb
);
264 skb_queue_purge(&mp
->inqueue
);
265 skb_queue_purge(&mp
->outqueue
);
266 capiminor_del_all_ack(mp
);
270 static struct capiminor
*capiminor_get(unsigned int minor
)
272 struct capiminor
*mp
;
274 spin_lock(&capiminors_lock
);
275 mp
= capiminors
[minor
];
278 spin_unlock(&capiminors_lock
);
283 static inline void capiminor_put(struct capiminor
*mp
)
285 kref_put(&mp
->kref
, capiminor_destroy
);
288 static void capiminor_free(struct capiminor
*mp
)
290 tty_unregister_device(capinc_tty_driver
, mp
->minor
);
292 spin_lock(&capiminors_lock
);
293 capiminors
[mp
->minor
] = NULL
;
294 spin_unlock(&capiminors_lock
);
299 /* -------- struct capincci ----------------------------------------- */
301 static void capincci_alloc_minor(struct capidev
*cdev
, struct capincci
*np
)
303 struct capiminor
*mp
;
306 if (!(cdev
->userflags
& CAPIFLAG_HIGHJACKING
))
309 mp
= np
->minorp
= capiminor_alloc(&cdev
->ap
, np
->ncci
);
311 device
= MKDEV(capinc_tty_driver
->major
, mp
->minor
);
312 mp
->capifs_dentry
= capifs_new_ncci(mp
->minor
, device
);
316 static void capincci_free_minor(struct capincci
*np
)
318 struct capiminor
*mp
= np
->minorp
;
319 struct tty_struct
*tty
;
322 capifs_free_ncci(mp
->capifs_dentry
);
324 tty
= tty_port_tty_get(&mp
->port
);
334 static inline unsigned int capincci_minor_opencount(struct capincci
*np
)
336 struct capiminor
*mp
= np
->minorp
;
337 unsigned int count
= 0;
338 struct tty_struct
*tty
;
341 tty
= tty_port_tty_get(&mp
->port
);
350 #else /* !CONFIG_ISDN_CAPI_MIDDLEWARE */
353 capincci_alloc_minor(struct capidev
*cdev
, struct capincci
*np
) { }
354 static inline void capincci_free_minor(struct capincci
*np
) { }
356 static inline unsigned int capincci_minor_opencount(struct capincci
*np
)
361 #endif /* !CONFIG_ISDN_CAPI_MIDDLEWARE */
363 static struct capincci
*capincci_alloc(struct capidev
*cdev
, u32 ncci
)
367 np
= kzalloc(sizeof(*np
), GFP_KERNEL
);
373 capincci_alloc_minor(cdev
, np
);
375 list_add_tail(&np
->list
, &cdev
->nccis
);
380 static void capincci_free(struct capidev
*cdev
, u32 ncci
)
382 struct capincci
*np
, *tmp
;
384 list_for_each_entry_safe(np
, tmp
, &cdev
->nccis
, list
)
385 if (ncci
== 0xffffffff || np
->ncci
== ncci
) {
386 capincci_free_minor(np
);
392 static struct capincci
*capincci_find(struct capidev
*cdev
, u32 ncci
)
396 list_for_each_entry(np
, &cdev
->nccis
, list
)
397 if (np
->ncci
== ncci
)
402 #ifdef CONFIG_ISDN_CAPI_MIDDLEWARE
403 /* -------- handle data queue --------------------------------------- */
405 static struct sk_buff
*
406 gen_data_b3_resp_for(struct capiminor
*mp
, struct sk_buff
*skb
)
408 struct sk_buff
*nskb
;
409 nskb
= alloc_skb(CAPI_DATA_B3_RESP_LEN
, GFP_KERNEL
);
411 u16 datahandle
= CAPIMSG_U16(skb
->data
,CAPIMSG_BASELEN
+4+4+2);
412 unsigned char *s
= skb_put(nskb
, CAPI_DATA_B3_RESP_LEN
);
413 capimsg_setu16(s
, 0, CAPI_DATA_B3_RESP_LEN
);
414 capimsg_setu16(s
, 2, mp
->ap
->applid
);
415 capimsg_setu8 (s
, 4, CAPI_DATA_B3
);
416 capimsg_setu8 (s
, 5, CAPI_RESP
);
417 capimsg_setu16(s
, 6, atomic_inc_return(&mp
->msgid
));
418 capimsg_setu32(s
, 8, mp
->ncci
);
419 capimsg_setu16(s
, 12, datahandle
);
424 static int handle_recv_skb(struct capiminor
*mp
, struct sk_buff
*skb
)
426 unsigned int datalen
= skb
->len
- CAPIMSG_LEN(skb
->data
);
427 struct tty_struct
*tty
;
428 struct sk_buff
*nskb
;
429 u16 errcode
, datahandle
;
430 struct tty_ldisc
*ld
;
433 tty
= tty_port_tty_get(&mp
->port
);
435 #ifdef _DEBUG_DATAFLOW
436 printk(KERN_DEBUG
"capi: currently no receiver\n");
441 ld
= tty_ldisc_ref(tty
);
443 /* fatal error, do not requeue */
449 if (ld
->ops
->receive_buf
== NULL
) {
450 #if defined(_DEBUG_DATAFLOW) || defined(_DEBUG_TTYFUNCS)
451 printk(KERN_DEBUG
"capi: ldisc has no receive_buf function\n");
453 /* fatal error, do not requeue */
457 #if defined(_DEBUG_DATAFLOW) || defined(_DEBUG_TTYFUNCS)
458 printk(KERN_DEBUG
"capi: recv tty throttled\n");
463 if (tty
->receive_room
< datalen
) {
464 #if defined(_DEBUG_DATAFLOW) || defined(_DEBUG_TTYFUNCS)
465 printk(KERN_DEBUG
"capi: no room in tty\n");
470 nskb
= gen_data_b3_resp_for(mp
, skb
);
472 printk(KERN_ERR
"capi: gen_data_b3_resp failed\n");
476 datahandle
= CAPIMSG_U16(skb
->data
, CAPIMSG_BASELEN
+ 4);
478 errcode
= capi20_put_message(mp
->ap
, nskb
);
480 if (errcode
== CAPI_NOERROR
) {
481 skb_pull(skb
, CAPIMSG_LEN(skb
->data
));
482 #ifdef _DEBUG_DATAFLOW
483 printk(KERN_DEBUG
"capi: DATA_B3_RESP %u len=%d => ldisc\n",
484 datahandle
, skb
->len
);
486 ld
->ops
->receive_buf(tty
, skb
->data
, NULL
, skb
->len
);
488 printk(KERN_ERR
"capi: send DATA_B3_RESP failed=%x\n",
492 if (errcode
== CAPI_SENDQUEUEFULL
)
508 static void handle_minor_recv(struct capiminor
*mp
)
512 while ((skb
= skb_dequeue(&mp
->inqueue
)) != NULL
)
513 if (handle_recv_skb(mp
, skb
) < 0) {
514 skb_queue_head(&mp
->inqueue
, skb
);
519 static void handle_minor_send(struct capiminor
*mp
)
521 struct tty_struct
*tty
;
527 tty
= tty_port_tty_get(&mp
->port
);
531 if (mp
->ttyoutstop
) {
532 #if defined(_DEBUG_DATAFLOW) || defined(_DEBUG_TTYFUNCS)
533 printk(KERN_DEBUG
"capi: send: tty stopped\n");
540 spin_lock_bh(&mp
->outlock
);
541 skb
= __skb_dequeue(&mp
->outqueue
);
543 spin_unlock_bh(&mp
->outlock
);
548 spin_unlock_bh(&mp
->outlock
);
550 datahandle
= atomic_inc_return(&mp
->datahandle
);
551 skb_push(skb
, CAPI_DATA_B3_REQ_LEN
);
552 memset(skb
->data
, 0, CAPI_DATA_B3_REQ_LEN
);
553 capimsg_setu16(skb
->data
, 0, CAPI_DATA_B3_REQ_LEN
);
554 capimsg_setu16(skb
->data
, 2, mp
->ap
->applid
);
555 capimsg_setu8 (skb
->data
, 4, CAPI_DATA_B3
);
556 capimsg_setu8 (skb
->data
, 5, CAPI_REQ
);
557 capimsg_setu16(skb
->data
, 6, atomic_inc_return(&mp
->msgid
));
558 capimsg_setu32(skb
->data
, 8, mp
->ncci
); /* NCCI */
559 capimsg_setu32(skb
->data
, 12, (u32
)(long)skb
->data
);/* Data32 */
560 capimsg_setu16(skb
->data
, 16, len
); /* Data length */
561 capimsg_setu16(skb
->data
, 18, datahandle
);
562 capimsg_setu16(skb
->data
, 20, 0); /* Flags */
564 if (capiminor_add_ack(mp
, datahandle
) < 0) {
565 skb_pull(skb
, CAPI_DATA_B3_REQ_LEN
);
567 spin_lock_bh(&mp
->outlock
);
568 __skb_queue_head(&mp
->outqueue
, skb
);
570 spin_unlock_bh(&mp
->outlock
);
574 errcode
= capi20_put_message(mp
->ap
, skb
);
575 if (errcode
== CAPI_NOERROR
) {
576 #ifdef _DEBUG_DATAFLOW
577 printk(KERN_DEBUG
"capi: DATA_B3_REQ %u len=%u\n",
582 capiminor_del_ack(mp
, datahandle
);
584 if (errcode
== CAPI_SENDQUEUEFULL
) {
585 skb_pull(skb
, CAPI_DATA_B3_REQ_LEN
);
587 spin_lock_bh(&mp
->outlock
);
588 __skb_queue_head(&mp
->outqueue
, skb
);
590 spin_unlock_bh(&mp
->outlock
);
595 /* ups, drop packet */
596 printk(KERN_ERR
"capi: put_message = %x\n", errcode
);
602 #endif /* CONFIG_ISDN_CAPI_MIDDLEWARE */
603 /* -------- function called by lower level -------------------------- */
605 static void capi_recv_message(struct capi20_appl
*ap
, struct sk_buff
*skb
)
607 struct capidev
*cdev
= ap
->private;
608 #ifdef CONFIG_ISDN_CAPI_MIDDLEWARE
609 struct tty_struct
*tty
;
610 struct capiminor
*mp
;
612 #endif /* CONFIG_ISDN_CAPI_MIDDLEWARE */
615 mutex_lock(&cdev
->lock
);
617 if (CAPIMSG_CMD(skb
->data
) == CAPI_CONNECT_B3_CONF
) {
618 u16 info
= CAPIMSG_U16(skb
->data
, 12); // Info field
619 if ((info
& 0xff00) == 0)
620 capincci_alloc(cdev
, CAPIMSG_NCCI(skb
->data
));
622 if (CAPIMSG_CMD(skb
->data
) == CAPI_CONNECT_B3_IND
)
623 capincci_alloc(cdev
, CAPIMSG_NCCI(skb
->data
));
625 if (CAPIMSG_COMMAND(skb
->data
) != CAPI_DATA_B3
) {
626 skb_queue_tail(&cdev
->recvqueue
, skb
);
627 wake_up_interruptible(&cdev
->recvwait
);
631 np
= capincci_find(cdev
, CAPIMSG_CONTROL(skb
->data
));
633 printk(KERN_ERR
"BUG: capi_signal: ncci not found\n");
634 skb_queue_tail(&cdev
->recvqueue
, skb
);
635 wake_up_interruptible(&cdev
->recvwait
);
639 #ifndef CONFIG_ISDN_CAPI_MIDDLEWARE
640 skb_queue_tail(&cdev
->recvqueue
, skb
);
641 wake_up_interruptible(&cdev
->recvwait
);
643 #else /* CONFIG_ISDN_CAPI_MIDDLEWARE */
647 skb_queue_tail(&cdev
->recvqueue
, skb
);
648 wake_up_interruptible(&cdev
->recvwait
);
651 if (CAPIMSG_SUBCOMMAND(skb
->data
) == CAPI_IND
) {
652 datahandle
= CAPIMSG_U16(skb
->data
, CAPIMSG_BASELEN
+4+4+2);
653 #ifdef _DEBUG_DATAFLOW
654 printk(KERN_DEBUG
"capi_signal: DATA_B3_IND %u len=%d\n",
655 datahandle
, skb
->len
-CAPIMSG_LEN(skb
->data
));
657 skb_queue_tail(&mp
->inqueue
, skb
);
659 handle_minor_recv(mp
);
661 } else if (CAPIMSG_SUBCOMMAND(skb
->data
) == CAPI_CONF
) {
663 datahandle
= CAPIMSG_U16(skb
->data
, CAPIMSG_BASELEN
+4);
664 #ifdef _DEBUG_DATAFLOW
665 printk(KERN_DEBUG
"capi_signal: DATA_B3_CONF %u 0x%x\n",
667 CAPIMSG_U16(skb
->data
, CAPIMSG_BASELEN
+4+2));
670 capiminor_del_ack(mp
, datahandle
);
671 tty
= tty_port_tty_get(&mp
->port
);
676 handle_minor_send(mp
);
679 /* ups, let capi application handle it :-) */
680 skb_queue_tail(&cdev
->recvqueue
, skb
);
681 wake_up_interruptible(&cdev
->recvwait
);
683 #endif /* CONFIG_ISDN_CAPI_MIDDLEWARE */
686 mutex_unlock(&cdev
->lock
);
689 /* -------- file_operations for capidev ----------------------------- */
692 capi_read(struct file
*file
, char __user
*buf
, size_t count
, loff_t
*ppos
)
694 struct capidev
*cdev
= file
->private_data
;
699 if (!cdev
->ap
.applid
)
702 skb
= skb_dequeue(&cdev
->recvqueue
);
704 if (file
->f_flags
& O_NONBLOCK
)
706 err
= wait_event_interruptible(cdev
->recvwait
,
707 (skb
= skb_dequeue(&cdev
->recvqueue
)));
711 if (skb
->len
> count
) {
712 skb_queue_head(&cdev
->recvqueue
, skb
);
715 if (copy_to_user(buf
, skb
->data
, skb
->len
)) {
716 skb_queue_head(&cdev
->recvqueue
, skb
);
727 capi_write(struct file
*file
, const char __user
*buf
, size_t count
, loff_t
*ppos
)
729 struct capidev
*cdev
= file
->private_data
;
733 if (!cdev
->ap
.applid
)
736 skb
= alloc_skb(count
, GFP_USER
);
740 if (copy_from_user(skb_put(skb
, count
), buf
, count
)) {
744 mlen
= CAPIMSG_LEN(skb
->data
);
745 if (CAPIMSG_CMD(skb
->data
) == CAPI_DATA_B3_REQ
) {
746 if ((size_t)(mlen
+ CAPIMSG_DATALEN(skb
->data
)) != count
) {
756 CAPIMSG_SETAPPID(skb
->data
, cdev
->ap
.applid
);
758 if (CAPIMSG_CMD(skb
->data
) == CAPI_DISCONNECT_B3_RESP
) {
759 mutex_lock(&cdev
->lock
);
760 capincci_free(cdev
, CAPIMSG_NCCI(skb
->data
));
761 mutex_unlock(&cdev
->lock
);
764 cdev
->errcode
= capi20_put_message(&cdev
->ap
, skb
);
774 capi_poll(struct file
*file
, poll_table
* wait
)
776 struct capidev
*cdev
= file
->private_data
;
777 unsigned int mask
= 0;
779 if (!cdev
->ap
.applid
)
782 poll_wait(file
, &(cdev
->recvwait
), wait
);
783 mask
= POLLOUT
| POLLWRNORM
;
784 if (!skb_queue_empty(&cdev
->recvqueue
))
785 mask
|= POLLIN
| POLLRDNORM
;
790 capi_ioctl(struct file
*file
, unsigned int cmd
, unsigned long arg
)
792 struct capidev
*cdev
= file
->private_data
;
793 capi_ioctl_struct data
;
794 int retval
= -EINVAL
;
795 void __user
*argp
= (void __user
*)arg
;
799 mutex_lock(&cdev
->lock
);
801 if (cdev
->ap
.applid
) {
805 if (copy_from_user(&cdev
->ap
.rparam
, argp
,
806 sizeof(struct capi_register_params
))) {
810 cdev
->ap
.private = cdev
;
811 cdev
->ap
.recv_message
= capi_recv_message
;
812 cdev
->errcode
= capi20_register(&cdev
->ap
);
813 retval
= (int)cdev
->ap
.applid
;
820 mutex_unlock(&cdev
->lock
);
823 case CAPI_GET_VERSION
:
825 if (copy_from_user(&data
.contr
, argp
,
828 cdev
->errcode
= capi20_get_version(data
.contr
, &data
.version
);
831 if (copy_to_user(argp
, &data
.version
,
832 sizeof(data
.version
)))
837 case CAPI_GET_SERIAL
:
839 if (copy_from_user(&data
.contr
, argp
,
842 cdev
->errcode
= capi20_get_serial (data
.contr
, data
.serial
);
845 if (copy_to_user(argp
, data
.serial
,
846 sizeof(data
.serial
)))
850 case CAPI_GET_PROFILE
:
852 if (copy_from_user(&data
.contr
, argp
,
856 if (data
.contr
== 0) {
857 cdev
->errcode
= capi20_get_profile(data
.contr
, &data
.profile
);
861 retval
= copy_to_user(argp
,
862 &data
.profile
.ncontroller
,
863 sizeof(data
.profile
.ncontroller
));
866 cdev
->errcode
= capi20_get_profile(data
.contr
, &data
.profile
);
870 retval
= copy_to_user(argp
, &data
.profile
,
871 sizeof(data
.profile
));
878 case CAPI_GET_MANUFACTURER
:
880 if (copy_from_user(&data
.contr
, argp
,
883 cdev
->errcode
= capi20_get_manufacturer(data
.contr
, data
.manufacturer
);
887 if (copy_to_user(argp
, data
.manufacturer
,
888 sizeof(data
.manufacturer
)))
893 case CAPI_GET_ERRCODE
:
894 data
.errcode
= cdev
->errcode
;
895 cdev
->errcode
= CAPI_NOERROR
;
897 if (copy_to_user(argp
, &data
.errcode
,
898 sizeof(data
.errcode
)))
904 if (capi20_isinstalled() == CAPI_NOERROR
)
908 case CAPI_MANUFACTURER_CMD
:
910 struct capi_manufacturer_cmd mcmd
;
911 if (!capable(CAP_SYS_ADMIN
))
913 if (copy_from_user(&mcmd
, argp
, sizeof(mcmd
)))
915 return capi20_manufacturer(mcmd
.cmd
, mcmd
.data
);
920 case CAPI_CLR_FLAGS
: {
923 if (copy_from_user(&userflags
, argp
, sizeof(userflags
)))
926 mutex_lock(&cdev
->lock
);
927 if (cmd
== CAPI_SET_FLAGS
)
928 cdev
->userflags
|= userflags
;
930 cdev
->userflags
&= ~userflags
;
931 mutex_unlock(&cdev
->lock
);
935 if (copy_to_user(argp
, &cdev
->userflags
,
936 sizeof(cdev
->userflags
)))
940 case CAPI_NCCI_OPENCOUNT
: {
941 struct capincci
*nccip
;
945 if (copy_from_user(&ncci
, argp
, sizeof(ncci
)))
948 mutex_lock(&cdev
->lock
);
949 nccip
= capincci_find(cdev
, (u32
)ncci
);
951 count
= capincci_minor_opencount(nccip
);
952 mutex_unlock(&cdev
->lock
);
956 #ifdef CONFIG_ISDN_CAPI_MIDDLEWARE
957 case CAPI_NCCI_GETUNIT
: {
958 struct capincci
*nccip
;
959 struct capiminor
*mp
;
963 if (copy_from_user(&ncci
, argp
, sizeof(ncci
)))
966 mutex_lock(&cdev
->lock
);
967 nccip
= capincci_find(cdev
, (u32
)ncci
);
973 mutex_unlock(&cdev
->lock
);
976 #endif /* CONFIG_ISDN_CAPI_MIDDLEWARE */
984 capi_unlocked_ioctl(struct file
*file
, unsigned int cmd
, unsigned long arg
)
988 mutex_lock(&capi_mutex
);
989 ret
= capi_ioctl(file
, cmd
, arg
);
990 mutex_unlock(&capi_mutex
);
995 static int capi_open(struct inode
*inode
, struct file
*file
)
997 struct capidev
*cdev
;
999 cdev
= kzalloc(sizeof(*cdev
), GFP_KERNEL
);
1003 mutex_init(&cdev
->lock
);
1004 skb_queue_head_init(&cdev
->recvqueue
);
1005 init_waitqueue_head(&cdev
->recvwait
);
1006 INIT_LIST_HEAD(&cdev
->nccis
);
1007 file
->private_data
= cdev
;
1009 mutex_lock(&capidev_list_lock
);
1010 list_add_tail(&cdev
->list
, &capidev_list
);
1011 mutex_unlock(&capidev_list_lock
);
1013 return nonseekable_open(inode
, file
);
1016 static int capi_release(struct inode
*inode
, struct file
*file
)
1018 struct capidev
*cdev
= file
->private_data
;
1020 mutex_lock(&capidev_list_lock
);
1021 list_del(&cdev
->list
);
1022 mutex_unlock(&capidev_list_lock
);
1024 if (cdev
->ap
.applid
)
1025 capi20_release(&cdev
->ap
);
1026 skb_queue_purge(&cdev
->recvqueue
);
1027 capincci_free(cdev
, 0xffffffff);
1033 static const struct file_operations capi_fops
=
1035 .owner
= THIS_MODULE
,
1036 .llseek
= no_llseek
,
1038 .write
= capi_write
,
1040 .unlocked_ioctl
= capi_unlocked_ioctl
,
1042 .release
= capi_release
,
1045 #ifdef CONFIG_ISDN_CAPI_MIDDLEWARE
1046 /* -------- tty_operations for capincci ----------------------------- */
1049 capinc_tty_install(struct tty_driver
*driver
, struct tty_struct
*tty
)
1051 int idx
= tty
->index
;
1052 struct capiminor
*mp
= capiminor_get(idx
);
1053 int ret
= tty_init_termios(tty
);
1056 tty_driver_kref_get(driver
);
1058 tty
->driver_data
= mp
;
1059 driver
->ttys
[idx
] = tty
;
1065 static void capinc_tty_cleanup(struct tty_struct
*tty
)
1067 struct capiminor
*mp
= tty
->driver_data
;
1068 tty
->driver_data
= NULL
;
1072 static int capinc_tty_open(struct tty_struct
*tty
, struct file
*filp
)
1074 struct capiminor
*mp
= tty
->driver_data
;
1077 err
= tty_port_open(&mp
->port
, tty
, filp
);
1081 handle_minor_recv(mp
);
1085 static void capinc_tty_close(struct tty_struct
*tty
, struct file
*filp
)
1087 struct capiminor
*mp
= tty
->driver_data
;
1089 tty_port_close(&mp
->port
, tty
, filp
);
1092 static int capinc_tty_write(struct tty_struct
*tty
,
1093 const unsigned char *buf
, int count
)
1095 struct capiminor
*mp
= tty
->driver_data
;
1096 struct sk_buff
*skb
;
1098 #ifdef _DEBUG_TTYFUNCS
1099 printk(KERN_DEBUG
"capinc_tty_write(count=%d)\n", count
);
1102 spin_lock_bh(&mp
->outlock
);
1106 __skb_queue_tail(&mp
->outqueue
, skb
);
1107 mp
->outbytes
+= skb
->len
;
1110 skb
= alloc_skb(CAPI_DATA_B3_REQ_LEN
+count
, GFP_ATOMIC
);
1112 printk(KERN_ERR
"capinc_tty_write: alloc_skb failed\n");
1113 spin_unlock_bh(&mp
->outlock
);
1117 skb_reserve(skb
, CAPI_DATA_B3_REQ_LEN
);
1118 memcpy(skb_put(skb
, count
), buf
, count
);
1120 __skb_queue_tail(&mp
->outqueue
, skb
);
1121 mp
->outbytes
+= skb
->len
;
1122 spin_unlock_bh(&mp
->outlock
);
1124 handle_minor_send(mp
);
1129 static int capinc_tty_put_char(struct tty_struct
*tty
, unsigned char ch
)
1131 struct capiminor
*mp
= tty
->driver_data
;
1132 bool invoke_send
= false;
1133 struct sk_buff
*skb
;
1136 #ifdef _DEBUG_TTYFUNCS
1137 printk(KERN_DEBUG
"capinc_put_char(%u)\n", ch
);
1140 spin_lock_bh(&mp
->outlock
);
1143 if (skb_tailroom(skb
) > 0) {
1144 *(skb_put(skb
, 1)) = ch
;
1148 __skb_queue_tail(&mp
->outqueue
, skb
);
1149 mp
->outbytes
+= skb
->len
;
1153 skb
= alloc_skb(CAPI_DATA_B3_REQ_LEN
+CAPI_MAX_BLKSIZE
, GFP_ATOMIC
);
1155 skb_reserve(skb
, CAPI_DATA_B3_REQ_LEN
);
1156 *(skb_put(skb
, 1)) = ch
;
1159 printk(KERN_ERR
"capinc_put_char: char %u lost\n", ch
);
1164 spin_unlock_bh(&mp
->outlock
);
1167 handle_minor_send(mp
);
1172 static void capinc_tty_flush_chars(struct tty_struct
*tty
)
1174 struct capiminor
*mp
= tty
->driver_data
;
1175 struct sk_buff
*skb
;
1177 #ifdef _DEBUG_TTYFUNCS
1178 printk(KERN_DEBUG
"capinc_tty_flush_chars\n");
1181 spin_lock_bh(&mp
->outlock
);
1185 __skb_queue_tail(&mp
->outqueue
, skb
);
1186 mp
->outbytes
+= skb
->len
;
1187 spin_unlock_bh(&mp
->outlock
);
1189 handle_minor_send(mp
);
1191 spin_unlock_bh(&mp
->outlock
);
1193 handle_minor_recv(mp
);
1196 static int capinc_tty_write_room(struct tty_struct
*tty
)
1198 struct capiminor
*mp
= tty
->driver_data
;
1201 room
= CAPINC_MAX_SENDQUEUE
-skb_queue_len(&mp
->outqueue
);
1202 room
*= CAPI_MAX_BLKSIZE
;
1203 #ifdef _DEBUG_TTYFUNCS
1204 printk(KERN_DEBUG
"capinc_tty_write_room = %d\n", room
);
1209 static int capinc_tty_chars_in_buffer(struct tty_struct
*tty
)
1211 struct capiminor
*mp
= tty
->driver_data
;
1213 #ifdef _DEBUG_TTYFUNCS
1214 printk(KERN_DEBUG
"capinc_tty_chars_in_buffer = %d nack=%d sq=%d rq=%d\n",
1215 mp
->outbytes
, mp
->nack
,
1216 skb_queue_len(&mp
->outqueue
),
1217 skb_queue_len(&mp
->inqueue
));
1219 return mp
->outbytes
;
1222 static int capinc_tty_ioctl(struct tty_struct
*tty
, struct file
* file
,
1223 unsigned int cmd
, unsigned long arg
)
1228 error
= n_tty_ioctl_helper(tty
, file
, cmd
, arg
);
1234 static void capinc_tty_set_termios(struct tty_struct
*tty
, struct ktermios
* old
)
1236 #ifdef _DEBUG_TTYFUNCS
1237 printk(KERN_DEBUG
"capinc_tty_set_termios\n");
1241 static void capinc_tty_throttle(struct tty_struct
*tty
)
1243 struct capiminor
*mp
= tty
->driver_data
;
1244 #ifdef _DEBUG_TTYFUNCS
1245 printk(KERN_DEBUG
"capinc_tty_throttle\n");
1250 static void capinc_tty_unthrottle(struct tty_struct
*tty
)
1252 struct capiminor
*mp
= tty
->driver_data
;
1254 #ifdef _DEBUG_TTYFUNCS
1255 printk(KERN_DEBUG
"capinc_tty_unthrottle\n");
1258 handle_minor_recv(mp
);
1261 static void capinc_tty_stop(struct tty_struct
*tty
)
1263 struct capiminor
*mp
= tty
->driver_data
;
1265 #ifdef _DEBUG_TTYFUNCS
1266 printk(KERN_DEBUG
"capinc_tty_stop\n");
1271 static void capinc_tty_start(struct tty_struct
*tty
)
1273 struct capiminor
*mp
= tty
->driver_data
;
1275 #ifdef _DEBUG_TTYFUNCS
1276 printk(KERN_DEBUG
"capinc_tty_start\n");
1279 handle_minor_send(mp
);
1282 static void capinc_tty_hangup(struct tty_struct
*tty
)
1284 struct capiminor
*mp
= tty
->driver_data
;
1286 #ifdef _DEBUG_TTYFUNCS
1287 printk(KERN_DEBUG
"capinc_tty_hangup\n");
1289 tty_port_hangup(&mp
->port
);
1292 static int capinc_tty_break_ctl(struct tty_struct
*tty
, int state
)
1294 #ifdef _DEBUG_TTYFUNCS
1295 printk(KERN_DEBUG
"capinc_tty_break_ctl(%d)\n", state
);
1300 static void capinc_tty_flush_buffer(struct tty_struct
*tty
)
1302 #ifdef _DEBUG_TTYFUNCS
1303 printk(KERN_DEBUG
"capinc_tty_flush_buffer\n");
1307 static void capinc_tty_set_ldisc(struct tty_struct
*tty
)
1309 #ifdef _DEBUG_TTYFUNCS
1310 printk(KERN_DEBUG
"capinc_tty_set_ldisc\n");
1314 static void capinc_tty_send_xchar(struct tty_struct
*tty
, char ch
)
1316 #ifdef _DEBUG_TTYFUNCS
1317 printk(KERN_DEBUG
"capinc_tty_send_xchar(%d)\n", ch
);
1321 static const struct tty_operations capinc_ops
= {
1322 .open
= capinc_tty_open
,
1323 .close
= capinc_tty_close
,
1324 .write
= capinc_tty_write
,
1325 .put_char
= capinc_tty_put_char
,
1326 .flush_chars
= capinc_tty_flush_chars
,
1327 .write_room
= capinc_tty_write_room
,
1328 .chars_in_buffer
= capinc_tty_chars_in_buffer
,
1329 .ioctl
= capinc_tty_ioctl
,
1330 .set_termios
= capinc_tty_set_termios
,
1331 .throttle
= capinc_tty_throttle
,
1332 .unthrottle
= capinc_tty_unthrottle
,
1333 .stop
= capinc_tty_stop
,
1334 .start
= capinc_tty_start
,
1335 .hangup
= capinc_tty_hangup
,
1336 .break_ctl
= capinc_tty_break_ctl
,
1337 .flush_buffer
= capinc_tty_flush_buffer
,
1338 .set_ldisc
= capinc_tty_set_ldisc
,
1339 .send_xchar
= capinc_tty_send_xchar
,
1340 .install
= capinc_tty_install
,
1341 .cleanup
= capinc_tty_cleanup
,
1344 static int __init
capinc_tty_init(void)
1346 struct tty_driver
*drv
;
1349 if (capi_ttyminors
> CAPINC_MAX_PORTS
)
1350 capi_ttyminors
= CAPINC_MAX_PORTS
;
1351 if (capi_ttyminors
<= 0)
1352 capi_ttyminors
= CAPINC_NR_PORTS
;
1354 capiminors
= kzalloc(sizeof(struct capi_minor
*) * capi_ttyminors
,
1359 drv
= alloc_tty_driver(capi_ttyminors
);
1364 drv
->owner
= THIS_MODULE
;
1365 drv
->driver_name
= "capi_nc";
1368 drv
->minor_start
= 0;
1369 drv
->type
= TTY_DRIVER_TYPE_SERIAL
;
1370 drv
->subtype
= SERIAL_TYPE_NORMAL
;
1371 drv
->init_termios
= tty_std_termios
;
1372 drv
->init_termios
.c_iflag
= ICRNL
;
1373 drv
->init_termios
.c_oflag
= OPOST
| ONLCR
;
1374 drv
->init_termios
.c_cflag
= B9600
| CS8
| CREAD
| HUPCL
| CLOCAL
;
1375 drv
->init_termios
.c_lflag
= 0;
1377 TTY_DRIVER_REAL_RAW
| TTY_DRIVER_RESET_TERMIOS
|
1378 TTY_DRIVER_DYNAMIC_DEV
;
1379 tty_set_operations(drv
, &capinc_ops
);
1381 err
= tty_register_driver(drv
);
1383 put_tty_driver(drv
);
1385 printk(KERN_ERR
"Couldn't register capi_nc driver\n");
1388 capinc_tty_driver
= drv
;
1392 static void __exit
capinc_tty_exit(void)
1394 tty_unregister_driver(capinc_tty_driver
);
1395 put_tty_driver(capinc_tty_driver
);
1399 #else /* !CONFIG_ISDN_CAPI_MIDDLEWARE */
1401 static inline int capinc_tty_init(void)
1406 static inline void capinc_tty_exit(void) { }
1408 #endif /* !CONFIG_ISDN_CAPI_MIDDLEWARE */
1410 /* -------- /proc functions ----------------------------------------- */
1413 * /proc/capi/capi20:
1414 * minor applid nrecvctlpkt nrecvdatapkt nsendctlpkt nsenddatapkt
1416 static int capi20_proc_show(struct seq_file
*m
, void *v
)
1418 struct capidev
*cdev
;
1419 struct list_head
*l
;
1421 mutex_lock(&capidev_list_lock
);
1422 list_for_each(l
, &capidev_list
) {
1423 cdev
= list_entry(l
, struct capidev
, list
);
1424 seq_printf(m
, "0 %d %lu %lu %lu %lu\n",
1426 cdev
->ap
.nrecvctlpkt
,
1427 cdev
->ap
.nrecvdatapkt
,
1428 cdev
->ap
.nsentctlpkt
,
1429 cdev
->ap
.nsentdatapkt
);
1431 mutex_unlock(&capidev_list_lock
);
1435 static int capi20_proc_open(struct inode
*inode
, struct file
*file
)
1437 return single_open(file
, capi20_proc_show
, NULL
);
1440 static const struct file_operations capi20_proc_fops
= {
1441 .owner
= THIS_MODULE
,
1442 .open
= capi20_proc_open
,
1444 .llseek
= seq_lseek
,
1445 .release
= single_release
,
1449 * /proc/capi/capi20ncci:
1452 static int capi20ncci_proc_show(struct seq_file
*m
, void *v
)
1454 struct capidev
*cdev
;
1455 struct capincci
*np
;
1457 mutex_lock(&capidev_list_lock
);
1458 list_for_each_entry(cdev
, &capidev_list
, list
) {
1459 mutex_lock(&cdev
->lock
);
1460 list_for_each_entry(np
, &cdev
->nccis
, list
)
1461 seq_printf(m
, "%d 0x%x\n", cdev
->ap
.applid
, np
->ncci
);
1462 mutex_unlock(&cdev
->lock
);
1464 mutex_unlock(&capidev_list_lock
);
1468 static int capi20ncci_proc_open(struct inode
*inode
, struct file
*file
)
1470 return single_open(file
, capi20ncci_proc_show
, NULL
);
1473 static const struct file_operations capi20ncci_proc_fops
= {
1474 .owner
= THIS_MODULE
,
1475 .open
= capi20ncci_proc_open
,
1477 .llseek
= seq_lseek
,
1478 .release
= single_release
,
1481 static void __init
proc_init(void)
1483 proc_create("capi/capi20", 0, NULL
, &capi20_proc_fops
);
1484 proc_create("capi/capi20ncci", 0, NULL
, &capi20ncci_proc_fops
);
1487 static void __exit
proc_exit(void)
1489 remove_proc_entry("capi/capi20", NULL
);
1490 remove_proc_entry("capi/capi20ncci", NULL
);
1493 /* -------- init function and module interface ---------------------- */
1496 static int __init
capi_init(void)
1498 const char *compileinfo
;
1501 major_ret
= register_chrdev(capi_major
, "capi20", &capi_fops
);
1502 if (major_ret
< 0) {
1503 printk(KERN_ERR
"capi20: unable to get major %d\n", capi_major
);
1506 capi_class
= class_create(THIS_MODULE
, "capi");
1507 if (IS_ERR(capi_class
)) {
1508 unregister_chrdev(capi_major
, "capi20");
1509 return PTR_ERR(capi_class
);
1512 device_create(capi_class
, NULL
, MKDEV(capi_major
, 0), NULL
, "capi");
1514 if (capinc_tty_init() < 0) {
1515 device_destroy(capi_class
, MKDEV(capi_major
, 0));
1516 class_destroy(capi_class
);
1517 unregister_chrdev(capi_major
, "capi20");
1523 #if defined(CONFIG_ISDN_CAPI_CAPIFS) || defined(CONFIG_ISDN_CAPI_CAPIFS_MODULE)
1524 compileinfo
= " (middleware+capifs)";
1525 #elif defined(CONFIG_ISDN_CAPI_MIDDLEWARE)
1526 compileinfo
= " (no capifs)";
1528 compileinfo
= " (no middleware)";
1530 printk(KERN_NOTICE
"CAPI 2.0 started up with major %d%s\n",
1531 capi_major
, compileinfo
);
1536 static void __exit
capi_exit(void)
1540 device_destroy(capi_class
, MKDEV(capi_major
, 0));
1541 class_destroy(capi_class
);
1542 unregister_chrdev(capi_major
, "capi20");
1547 module_init(capi_init
);
1548 module_exit(capi_exit
);