2 * linux/drivers/char/ppdev.c
4 * This is the code behind /dev/parport* -- it allows a user-space
5 * application to use the parport subsystem.
7 * Copyright (C) 1998-2000, 2002 Tim Waugh <tim@cyberelk.net>
9 * This program is free software; you can redistribute it and/or
10 * modify it under the terms of the GNU General Public License
11 * as published by the Free Software Foundation; either version
12 * 2 of the License, or (at your option) any later version.
14 * A /dev/parportx device node represents an arbitrary device
15 * on port 'x'. The following operations are possible:
17 * open do nothing, set up default IEEE 1284 protocol to be COMPAT
18 * close release port and unregister device (if necessary)
20 * EXCL register device exclusively (may fail)
21 * CLAIM (register device first time) parport_claim_or_block
22 * RELEASE parport_release
23 * SETMODE set the IEEE 1284 protocol to use for read/write
24 * SETPHASE set the IEEE 1284 phase of a particular mode. Not to be
25 * confused with ioctl(fd, SETPHASER, &stun). ;-)
26 * DATADIR data_forward / data_reverse
29 * WCONTROL write_control
30 * RCONTROL read_control
31 * FCONTROL frob_control
33 * NEGOT parport_negotiate
34 * YIELD parport_yield_blocking
35 * WCTLONIRQ on interrupt, set control lines
36 * CLRIRQ clear (and return) interrupt count
37 * SETTIME sets device timeout (struct timeval)
38 * GETTIME gets device timeout (struct timeval)
39 * GETMODES gets hardware supported modes (unsigned int)
40 * GETMODE gets the current IEEE1284 mode
41 * GETPHASE gets the current IEEE1284 phase
42 * GETFLAGS gets current (user-visible) flags
43 * SETFLAGS sets current (user-visible) flags
44 * read/write read or write in current IEEE 1284 protocol
45 * select wait for interrupt (in readfds)
48 * Added SETTIME/GETTIME ioctl, Fred Barnes, 1999.
50 * Arnaldo Carvalho de Melo <acme@conectiva.com.br> 2000/08/25
51 * - On error, copy_from_user and copy_to_user do not return -EFAULT,
52 * They return the positive number of bytes *not* copied due to address
55 * Added GETMODES/GETMODE/GETPHASE ioctls, Fred Barnes <frmb2@ukc.ac.uk>, 03/01/2001.
56 * Added GETFLAGS/SETFLAGS ioctls, Fred Barnes, 04/2001
59 #include <linux/module.h>
60 #include <linux/init.h>
61 #include <linux/sched.h>
62 #include <linux/device.h>
63 #include <linux/ioctl.h>
64 #include <linux/parport.h>
65 #include <linux/ctype.h>
66 #include <linux/poll.h>
67 #include <linux/major.h>
68 #include <linux/ppdev.h>
69 #include <linux/device.h>
70 #include <asm/uaccess.h>
72 #define PP_VERSION "ppdev: user-space parallel port driver"
73 #define CHRDEV "ppdev"
76 struct pardevice
* pdev
;
77 wait_queue_head_t irq_wait
;
82 struct ieee1284_info state
;
83 struct ieee1284_info saved_state
;
84 long default_inactivity
;
87 /* pp_struct.flags bitfields */
88 #define PP_CLAIMED (1<<0)
89 #define PP_EXCL (1<<1)
92 #define PP_INTERRUPT_TIMEOUT (10 * HZ) /* 10s */
93 #define PP_BUFFER_SIZE 1024
94 #define PARDEVICE_MAX 8
96 /* ROUND_UP macro from fs/select.c */
97 #define ROUND_UP(x,y) (((x)+(y)-1)/(y))
99 static inline void pp_enable_irq (struct pp_struct
*pp
)
101 struct parport
*port
= pp
->pdev
->port
;
102 port
->ops
->enable_irq (port
);
105 static ssize_t
pp_read (struct file
* file
, char __user
* buf
, size_t count
,
108 unsigned int minor
= iminor(file
->f_path
.dentry
->d_inode
);
109 struct pp_struct
*pp
= file
->private_data
;
111 ssize_t bytes_read
= 0;
112 struct parport
*pport
;
115 if (!(pp
->flags
& PP_CLAIMED
)) {
116 /* Don't have the port claimed */
117 printk (KERN_DEBUG CHRDEV
"%x: claim the port first\n",
126 kbuffer
= kmalloc(min_t(size_t, count
, PP_BUFFER_SIZE
), GFP_KERNEL
);
130 pport
= pp
->pdev
->port
;
131 mode
= pport
->ieee1284
.mode
& ~(IEEE1284_DEVICEID
| IEEE1284_ADDR
);
133 parport_set_timeout (pp
->pdev
,
134 (file
->f_flags
& O_NONBLOCK
) ?
135 PARPORT_INACTIVITY_O_NONBLOCK
:
136 pp
->default_inactivity
);
138 while (bytes_read
== 0) {
139 ssize_t need
= min_t(unsigned long, count
, PP_BUFFER_SIZE
);
141 if (mode
== IEEE1284_MODE_EPP
) {
142 /* various specials for EPP mode */
144 size_t (*fn
)(struct parport
*, void *, size_t, int);
146 if (pp
->flags
& PP_W91284PIC
) {
147 flags
|= PARPORT_W91284PIC
;
149 if (pp
->flags
& PP_FASTREAD
) {
150 flags
|= PARPORT_EPP_FAST
;
152 if (pport
->ieee1284
.mode
& IEEE1284_ADDR
) {
153 fn
= pport
->ops
->epp_read_addr
;
155 fn
= pport
->ops
->epp_read_data
;
157 bytes_read
= (*fn
)(pport
, kbuffer
, need
, flags
);
159 bytes_read
= parport_read (pport
, kbuffer
, need
);
165 if (file
->f_flags
& O_NONBLOCK
) {
166 bytes_read
= -EAGAIN
;
170 if (signal_pending (current
)) {
171 bytes_read
= -ERESTARTSYS
;
178 parport_set_timeout (pp
->pdev
, pp
->default_inactivity
);
180 if (bytes_read
> 0 && copy_to_user (buf
, kbuffer
, bytes_read
))
181 bytes_read
= -EFAULT
;
188 static ssize_t
pp_write (struct file
* file
, const char __user
* buf
,
189 size_t count
, loff_t
* ppos
)
191 unsigned int minor
= iminor(file
->f_path
.dentry
->d_inode
);
192 struct pp_struct
*pp
= file
->private_data
;
194 ssize_t bytes_written
= 0;
197 struct parport
*pport
;
199 if (!(pp
->flags
& PP_CLAIMED
)) {
200 /* Don't have the port claimed */
201 printk (KERN_DEBUG CHRDEV
"%x: claim the port first\n",
206 kbuffer
= kmalloc(min_t(size_t, count
, PP_BUFFER_SIZE
), GFP_KERNEL
);
210 pport
= pp
->pdev
->port
;
211 mode
= pport
->ieee1284
.mode
& ~(IEEE1284_DEVICEID
| IEEE1284_ADDR
);
213 parport_set_timeout (pp
->pdev
,
214 (file
->f_flags
& O_NONBLOCK
) ?
215 PARPORT_INACTIVITY_O_NONBLOCK
:
216 pp
->default_inactivity
);
218 while (bytes_written
< count
) {
219 ssize_t n
= min_t(unsigned long, count
- bytes_written
, PP_BUFFER_SIZE
);
221 if (copy_from_user (kbuffer
, buf
+ bytes_written
, n
)) {
222 bytes_written
= -EFAULT
;
226 if ((pp
->flags
& PP_FASTWRITE
) && (mode
== IEEE1284_MODE_EPP
)) {
227 /* do a fast EPP write */
228 if (pport
->ieee1284
.mode
& IEEE1284_ADDR
) {
229 wrote
= pport
->ops
->epp_write_addr (pport
,
230 kbuffer
, n
, PARPORT_EPP_FAST
);
232 wrote
= pport
->ops
->epp_write_data (pport
,
233 kbuffer
, n
, PARPORT_EPP_FAST
);
236 wrote
= parport_write (pp
->pdev
->port
, kbuffer
, n
);
240 if (!bytes_written
) {
241 bytes_written
= wrote
;
246 bytes_written
+= wrote
;
248 if (file
->f_flags
& O_NONBLOCK
) {
250 bytes_written
= -EAGAIN
;
254 if (signal_pending (current
)) {
255 if (!bytes_written
) {
256 bytes_written
= -EINTR
;
264 parport_set_timeout (pp
->pdev
, pp
->default_inactivity
);
268 return bytes_written
;
271 static void pp_irq (int irq
, void * private)
273 struct pp_struct
* pp
= (struct pp_struct
*) private;
275 if (pp
->irqresponse
) {
276 parport_write_control (pp
->pdev
->port
, pp
->irqctl
);
280 atomic_inc (&pp
->irqc
);
281 wake_up_interruptible (&pp
->irq_wait
);
284 static int register_device (int minor
, struct pp_struct
*pp
)
286 struct parport
*port
;
287 struct pardevice
* pdev
= NULL
;
291 name
= kmalloc (strlen (CHRDEV
) + 3, GFP_KERNEL
);
295 sprintf (name
, CHRDEV
"%x", minor
);
297 port
= parport_find_number (minor
);
299 printk (KERN_WARNING
"%s: no associated port!\n", name
);
304 fl
= (pp
->flags
& PP_EXCL
) ? PARPORT_FLAG_EXCL
: 0;
305 pdev
= parport_register_device (port
, name
, NULL
,
306 NULL
, pp_irq
, fl
, pp
);
307 parport_put_port (port
);
310 printk (KERN_WARNING
"%s: failed to register device!\n", name
);
316 printk (KERN_DEBUG
"%s: registered pardevice\n", name
);
320 static enum ieee1284_phase
init_phase (int mode
)
322 switch (mode
& ~(IEEE1284_DEVICEID
324 case IEEE1284_MODE_NIBBLE
:
325 case IEEE1284_MODE_BYTE
:
326 return IEEE1284_PH_REV_IDLE
;
328 return IEEE1284_PH_FWD_IDLE
;
331 static int pp_ioctl(struct inode
*inode
, struct file
*file
,
332 unsigned int cmd
, unsigned long arg
)
334 unsigned int minor
= iminor(inode
);
335 struct pp_struct
*pp
= file
->private_data
;
336 struct parport
* port
;
337 void __user
*argp
= (void __user
*)arg
;
339 /* First handle the cases that don't take arguments. */
343 struct ieee1284_info
*info
;
346 if (pp
->flags
& PP_CLAIMED
) {
347 printk (KERN_DEBUG CHRDEV
348 "%x: you've already got it!\n", minor
);
352 /* Deferred device registration. */
354 int err
= register_device (minor
, pp
);
360 ret
= parport_claim_or_block (pp
->pdev
);
364 pp
->flags
|= PP_CLAIMED
;
366 /* For interrupt-reporting to work, we need to be
367 * informed of each interrupt. */
370 /* We may need to fix up the state machine. */
371 info
= &pp
->pdev
->port
->ieee1284
;
372 pp
->saved_state
.mode
= info
->mode
;
373 pp
->saved_state
.phase
= info
->phase
;
374 info
->mode
= pp
->state
.mode
;
375 info
->phase
= pp
->state
.phase
;
376 pp
->default_inactivity
= parport_set_timeout (pp
->pdev
, 0);
377 parport_set_timeout (pp
->pdev
, pp
->default_inactivity
);
383 printk (KERN_DEBUG CHRDEV
"%x: too late for PPEXCL; "
384 "already registered\n", minor
);
385 if (pp
->flags
& PP_EXCL
)
386 /* But it's not really an error. */
388 /* There's no chance of making the driver happy. */
392 /* Just remember to register the device exclusively
393 * when we finally do the registration. */
394 pp
->flags
|= PP_EXCL
;
399 if (copy_from_user (&mode
, argp
, sizeof (mode
)))
401 /* FIXME: validate mode */
402 pp
->state
.mode
= mode
;
403 pp
->state
.phase
= init_phase (mode
);
405 if (pp
->flags
& PP_CLAIMED
) {
406 pp
->pdev
->port
->ieee1284
.mode
= mode
;
407 pp
->pdev
->port
->ieee1284
.phase
= pp
->state
.phase
;
416 if (pp
->flags
& PP_CLAIMED
) {
417 mode
= pp
->pdev
->port
->ieee1284
.mode
;
419 mode
= pp
->state
.mode
;
421 if (copy_to_user (argp
, &mode
, sizeof (mode
))) {
429 if (copy_from_user (&phase
, argp
, sizeof (phase
))) {
432 /* FIXME: validate phase */
433 pp
->state
.phase
= phase
;
435 if (pp
->flags
& PP_CLAIMED
) {
436 pp
->pdev
->port
->ieee1284
.phase
= phase
;
445 if (pp
->flags
& PP_CLAIMED
) {
446 phase
= pp
->pdev
->port
->ieee1284
.phase
;
448 phase
= pp
->state
.phase
;
450 if (copy_to_user (argp
, &phase
, sizeof (phase
))) {
459 port
= parport_find_number (minor
);
464 if (copy_to_user (argp
, &modes
, sizeof (modes
))) {
473 if (copy_from_user (&uflags
, argp
, sizeof (uflags
))) {
476 pp
->flags
&= ~PP_FLAGMASK
;
477 pp
->flags
|= (uflags
& PP_FLAGMASK
);
484 uflags
= pp
->flags
& PP_FLAGMASK
;
485 if (copy_to_user (argp
, &uflags
, sizeof (uflags
))) {
492 /* Everything else requires the port to be claimed, so check
494 if ((pp
->flags
& PP_CLAIMED
) == 0) {
495 printk (KERN_DEBUG CHRDEV
"%x: claim the port first\n",
500 port
= pp
->pdev
->port
;
502 struct ieee1284_info
*info
;
507 struct timeval par_timeout
;
511 reg
= parport_read_status (port
);
512 if (copy_to_user (argp
, ®
, sizeof (reg
)))
516 reg
= parport_read_data (port
);
517 if (copy_to_user (argp
, ®
, sizeof (reg
)))
521 reg
= parport_read_control (port
);
522 if (copy_to_user (argp
, ®
, sizeof (reg
)))
526 parport_yield_blocking (pp
->pdev
);
530 /* Save the state machine's state. */
531 info
= &pp
->pdev
->port
->ieee1284
;
532 pp
->state
.mode
= info
->mode
;
533 pp
->state
.phase
= info
->phase
;
534 info
->mode
= pp
->saved_state
.mode
;
535 info
->phase
= pp
->saved_state
.phase
;
536 parport_release (pp
->pdev
);
537 pp
->flags
&= ~PP_CLAIMED
;
541 if (copy_from_user (®
, argp
, sizeof (reg
)))
543 parport_write_control (port
, reg
);
547 if (copy_from_user (®
, argp
, sizeof (reg
)))
549 parport_write_data (port
, reg
);
553 if (copy_from_user (&mask
, argp
,
556 if (copy_from_user (®
, 1 + (unsigned char __user
*) arg
,
559 parport_frob_control (port
, mask
, reg
);
563 if (copy_from_user (&mode
, argp
, sizeof (mode
)))
566 port
->ops
->data_reverse (port
);
568 port
->ops
->data_forward (port
);
572 if (copy_from_user (&mode
, argp
, sizeof (mode
)))
574 switch ((ret
= parport_negotiate (port
, mode
))) {
576 case -1: /* handshake failed, peripheral not IEEE 1284 */
579 case 1: /* handshake succeeded, peripheral rejected mode */
587 if (copy_from_user (®
, argp
, sizeof (reg
)))
590 /* Remember what to set the control lines to, for next
591 * time we get an interrupt. */
597 ret
= atomic_read (&pp
->irqc
);
598 if (copy_to_user (argp
, &ret
, sizeof (ret
)))
600 atomic_sub (ret
, &pp
->irqc
);
604 if (copy_from_user (&par_timeout
, argp
, sizeof(struct timeval
))) {
607 /* Convert to jiffies, place in pp->pdev->timeout */
608 if ((par_timeout
.tv_sec
< 0) || (par_timeout
.tv_usec
< 0)) {
611 to_jiffies
= ROUND_UP(par_timeout
.tv_usec
, 1000000/HZ
);
612 to_jiffies
+= par_timeout
.tv_sec
* (long)HZ
;
613 if (to_jiffies
<= 0) {
616 pp
->pdev
->timeout
= to_jiffies
;
620 to_jiffies
= pp
->pdev
->timeout
;
621 par_timeout
.tv_sec
= to_jiffies
/ HZ
;
622 par_timeout
.tv_usec
= (to_jiffies
% (long)HZ
) * (1000000/HZ
);
623 if (copy_to_user (argp
, &par_timeout
, sizeof(struct timeval
)))
628 printk (KERN_DEBUG CHRDEV
"%x: What? (cmd=0x%x)\n", minor
,
633 /* Keep the compiler happy */
637 static int pp_open (struct inode
* inode
, struct file
* file
)
639 unsigned int minor
= iminor(inode
);
640 struct pp_struct
*pp
;
642 if (minor
>= PARPORT_MAX
)
645 pp
= kmalloc (sizeof (struct pp_struct
), GFP_KERNEL
);
649 pp
->state
.mode
= IEEE1284_MODE_COMPAT
;
650 pp
->state
.phase
= init_phase (pp
->state
.mode
);
653 atomic_set (&pp
->irqc
, 0);
654 init_waitqueue_head (&pp
->irq_wait
);
656 /* Defer the actual device registration until the first claim.
657 * That way, we know whether or not the driver wants to have
658 * exclusive access to the port (PPEXCL).
661 file
->private_data
= pp
;
666 static int pp_release (struct inode
* inode
, struct file
* file
)
668 unsigned int minor
= iminor(inode
);
669 struct pp_struct
*pp
= file
->private_data
;
673 if (!(pp
->flags
& PP_CLAIMED
) && pp
->pdev
&&
674 (pp
->state
.mode
!= IEEE1284_MODE_COMPAT
)) {
675 struct ieee1284_info
*info
;
677 /* parport released, but not in compatibility mode */
678 parport_claim_or_block (pp
->pdev
);
679 pp
->flags
|= PP_CLAIMED
;
680 info
= &pp
->pdev
->port
->ieee1284
;
681 pp
->saved_state
.mode
= info
->mode
;
682 pp
->saved_state
.phase
= info
->phase
;
683 info
->mode
= pp
->state
.mode
;
684 info
->phase
= pp
->state
.phase
;
686 } else if ((pp
->flags
& PP_CLAIMED
) && pp
->pdev
&&
687 (pp
->pdev
->port
->ieee1284
.mode
!= IEEE1284_MODE_COMPAT
)) {
691 parport_negotiate (pp
->pdev
->port
, IEEE1284_MODE_COMPAT
);
692 printk (KERN_DEBUG CHRDEV
693 "%x: negotiated back to compatibility mode because "
694 "user-space forgot\n", minor
);
697 if (pp
->flags
& PP_CLAIMED
) {
698 struct ieee1284_info
*info
;
700 info
= &pp
->pdev
->port
->ieee1284
;
701 pp
->state
.mode
= info
->mode
;
702 pp
->state
.phase
= info
->phase
;
703 info
->mode
= pp
->saved_state
.mode
;
704 info
->phase
= pp
->saved_state
.phase
;
705 parport_release (pp
->pdev
);
706 if (compat_negot
!= 1) {
707 printk (KERN_DEBUG CHRDEV
"%x: released pardevice "
708 "because user-space forgot\n", minor
);
713 const char *name
= pp
->pdev
->name
;
714 parport_unregister_device (pp
->pdev
);
717 printk (KERN_DEBUG CHRDEV
"%x: unregistered pardevice\n",
726 /* No kernel lock held - fine */
727 static unsigned int pp_poll (struct file
* file
, poll_table
* wait
)
729 struct pp_struct
*pp
= file
->private_data
;
730 unsigned int mask
= 0;
732 poll_wait (file
, &pp
->irq_wait
, wait
);
733 if (atomic_read (&pp
->irqc
))
734 mask
|= POLLIN
| POLLRDNORM
;
739 static struct class *ppdev_class
;
741 static const struct file_operations pp_fops
= {
742 .owner
= THIS_MODULE
,
749 .release
= pp_release
,
752 static void pp_attach(struct parport
*port
)
754 device_create(ppdev_class
, port
->dev
, MKDEV(PP_MAJOR
, port
->number
),
755 "parport%d", port
->number
);
758 static void pp_detach(struct parport
*port
)
760 device_destroy(ppdev_class
, MKDEV(PP_MAJOR
, port
->number
));
763 static struct parport_driver pp_driver
= {
769 static int __init
ppdev_init (void)
773 if (register_chrdev (PP_MAJOR
, CHRDEV
, &pp_fops
)) {
774 printk (KERN_WARNING CHRDEV
": unable to get major %d\n",
778 ppdev_class
= class_create(THIS_MODULE
, CHRDEV
);
779 if (IS_ERR(ppdev_class
)) {
780 err
= PTR_ERR(ppdev_class
);
783 if (parport_register_driver(&pp_driver
)) {
784 printk (KERN_WARNING CHRDEV
": unable to register with parport\n");
788 printk (KERN_INFO PP_VERSION
"\n");
792 class_destroy(ppdev_class
);
794 unregister_chrdev(PP_MAJOR
, CHRDEV
);
799 static void __exit
ppdev_cleanup (void)
801 /* Clean up all parport stuff */
802 parport_unregister_driver(&pp_driver
);
803 class_destroy(ppdev_class
);
804 unregister_chrdev (PP_MAJOR
, CHRDEV
);
807 module_init(ppdev_init
);
808 module_exit(ppdev_cleanup
);
810 MODULE_LICENSE("GPL");
811 MODULE_ALIAS_CHARDEV_MAJOR(PP_MAJOR
);