1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114#include <linux/module.h>
115#include <linux/init.h>
116
117#include <linux/errno.h>
118#include <linux/kernel.h>
119#include <linux/major.h>
120#include <linux/sched/signal.h>
121#include <linux/slab.h>
122#include <linux/fcntl.h>
123#include <linux/delay.h>
124#include <linux/poll.h>
125#include <linux/console.h>
126#include <linux/device.h>
127#include <linux/wait.h>
128#include <linux/jiffies.h>
129#include <linux/mutex.h>
130#include <linux/compat.h>
131
132#include <linux/parport.h>
133#undef LP_STATS
134#include <linux/lp.h>
135
136#include <asm/irq.h>
137#include <linux/uaccess.h>
138
139
140#define LP_NO 8
141
142static DEFINE_MUTEX(lp_mutex);
143static struct lp_struct lp_table[LP_NO];
144
145static unsigned int lp_count = 0;
146static struct class *lp_class;
147
148#ifdef CONFIG_LP_CONSOLE
149static struct parport *console_registered;
150#endif
151
152#undef LP_DEBUG
153
154
155#define LP_PREEMPT_REQUEST 1
156#define LP_PARPORT_CLAIMED 2
157
158
159
160#define r_dtr(x) (parport_read_data(lp_table[(x)].dev->port))
161#define r_str(x) (parport_read_status(lp_table[(x)].dev->port))
162#define w_ctr(x,y) do { parport_write_control(lp_table[(x)].dev->port, (y)); } while (0)
163#define w_dtr(x,y) do { parport_write_data(lp_table[(x)].dev->port, (y)); } while (0)
164
165
166static void lp_claim_parport_or_block(struct lp_struct *this_lp)
167{
168 if (!test_and_set_bit(LP_PARPORT_CLAIMED, &this_lp->bits)) {
169 parport_claim_or_block (this_lp->dev);
170 }
171}
172
173
174static void lp_release_parport(struct lp_struct *this_lp)
175{
176 if (test_and_clear_bit(LP_PARPORT_CLAIMED, &this_lp->bits)) {
177 parport_release (this_lp->dev);
178 }
179}
180
181
182
183static int lp_preempt(void *handle)
184{
185 struct lp_struct *this_lp = (struct lp_struct *)handle;
186 set_bit(LP_PREEMPT_REQUEST, &this_lp->bits);
187 return (1);
188}
189
190
191
192
193
194
195static int lp_negotiate(struct parport * port, int mode)
196{
197 if (parport_negotiate (port, mode) != 0) {
198 mode = IEEE1284_MODE_COMPAT;
199 parport_negotiate (port, mode);
200 }
201
202 return (mode);
203}
204
205static int lp_reset(int minor)
206{
207 int retval;
208 lp_claim_parport_or_block (&lp_table[minor]);
209 w_ctr(minor, LP_PSELECP);
210 udelay (LP_DELAY);
211 w_ctr(minor, LP_PSELECP | LP_PINITP);
212 retval = r_str(minor);
213 lp_release_parport (&lp_table[minor]);
214 return retval;
215}
216
217static void lp_error (int minor)
218{
219 DEFINE_WAIT(wait);
220 int polling;
221
222 if (LP_F(minor) & LP_ABORT)
223 return;
224
225 polling = lp_table[minor].dev->port->irq == PARPORT_IRQ_NONE;
226 if (polling) lp_release_parport (&lp_table[minor]);
227 prepare_to_wait(&lp_table[minor].waitq, &wait, TASK_INTERRUPTIBLE);
228 schedule_timeout(LP_TIMEOUT_POLLED);
229 finish_wait(&lp_table[minor].waitq, &wait);
230 if (polling) lp_claim_parport_or_block (&lp_table[minor]);
231 else parport_yield_blocking (lp_table[minor].dev);
232}
233
234static int lp_check_status(int minor)
235{
236 int error = 0;
237 unsigned int last = lp_table[minor].last_error;
238 unsigned char status = r_str(minor);
239 if ((status & LP_PERRORP) && !(LP_F(minor) & LP_CAREFUL))
240
241 last = 0;
242 else if ((status & LP_POUTPA)) {
243 if (last != LP_POUTPA) {
244 last = LP_POUTPA;
245 printk(KERN_INFO "lp%d out of paper\n", minor);
246 }
247 error = -ENOSPC;
248 } else if (!(status & LP_PSELECD)) {
249 if (last != LP_PSELECD) {
250 last = LP_PSELECD;
251 printk(KERN_INFO "lp%d off-line\n", minor);
252 }
253 error = -EIO;
254 } else if (!(status & LP_PERRORP)) {
255 if (last != LP_PERRORP) {
256 last = LP_PERRORP;
257 printk(KERN_INFO "lp%d on fire\n", minor);
258 }
259 error = -EIO;
260 } else {
261 last = 0;
262
263 }
264
265 lp_table[minor].last_error = last;
266
267 if (last != 0)
268 lp_error(minor);
269
270 return error;
271}
272
273static int lp_wait_ready(int minor, int nonblock)
274{
275 int error = 0;
276
277
278 if (lp_table[minor].current_mode != IEEE1284_MODE_COMPAT) {
279 return (0);
280 }
281
282 do {
283 error = lp_check_status (minor);
284 if (error && (nonblock || (LP_F(minor) & LP_ABORT)))
285 break;
286 if (signal_pending (current)) {
287 error = -EINTR;
288 break;
289 }
290 } while (error);
291 return error;
292}
293
294static ssize_t lp_write(struct file * file, const char __user * buf,
295 size_t count, loff_t *ppos)
296{
297 unsigned int minor = iminor(file_inode(file));
298 struct parport *port = lp_table[minor].dev->port;
299 char *kbuf = lp_table[minor].lp_buffer;
300 ssize_t retv = 0;
301 ssize_t written;
302 size_t copy_size = count;
303 int nonblock = ((file->f_flags & O_NONBLOCK) ||
304 (LP_F(minor) & LP_ABORT));
305
306#ifdef LP_STATS
307 if (time_after(jiffies, lp_table[minor].lastcall + LP_TIME(minor)))
308 lp_table[minor].runchars = 0;
309
310 lp_table[minor].lastcall = jiffies;
311#endif
312
313
314 if (copy_size > LP_BUFFER_SIZE)
315 copy_size = LP_BUFFER_SIZE;
316
317 if (mutex_lock_interruptible(&lp_table[minor].port_mutex))
318 return -EINTR;
319
320 if (copy_from_user (kbuf, buf, copy_size)) {
321 retv = -EFAULT;
322 goto out_unlock;
323 }
324
325
326
327 lp_claim_parport_or_block (&lp_table[minor]);
328
329 lp_table[minor].current_mode = lp_negotiate (port,
330 lp_table[minor].best_mode);
331
332 parport_set_timeout (lp_table[minor].dev,
333 (nonblock ? PARPORT_INACTIVITY_O_NONBLOCK
334 : lp_table[minor].timeout));
335
336 if ((retv = lp_wait_ready (minor, nonblock)) == 0)
337 do {
338
339 written = parport_write (port, kbuf, copy_size);
340 if (written > 0) {
341 copy_size -= written;
342 count -= written;
343 buf += written;
344 retv += written;
345 }
346
347 if (signal_pending (current)) {
348 if (retv == 0)
349 retv = -EINTR;
350
351 break;
352 }
353
354 if (copy_size > 0) {
355
356 int error;
357
358 parport_negotiate (lp_table[minor].dev->port,
359 IEEE1284_MODE_COMPAT);
360 lp_table[minor].current_mode = IEEE1284_MODE_COMPAT;
361
362 error = lp_wait_ready (minor, nonblock);
363
364 if (error) {
365 if (retv == 0)
366 retv = error;
367 break;
368 } else if (nonblock) {
369 if (retv == 0)
370 retv = -EAGAIN;
371 break;
372 }
373
374 parport_yield_blocking (lp_table[minor].dev);
375 lp_table[minor].current_mode
376 = lp_negotiate (port,
377 lp_table[minor].best_mode);
378
379 } else if (need_resched())
380 schedule ();
381
382 if (count) {
383 copy_size = count;
384 if (copy_size > LP_BUFFER_SIZE)
385 copy_size = LP_BUFFER_SIZE;
386
387 if (copy_from_user(kbuf, buf, copy_size)) {
388 if (retv == 0)
389 retv = -EFAULT;
390 break;
391 }
392 }
393 } while (count > 0);
394
395 if (test_and_clear_bit(LP_PREEMPT_REQUEST,
396 &lp_table[minor].bits)) {
397 printk(KERN_INFO "lp%d releasing parport\n", minor);
398 parport_negotiate (lp_table[minor].dev->port,
399 IEEE1284_MODE_COMPAT);
400 lp_table[minor].current_mode = IEEE1284_MODE_COMPAT;
401 lp_release_parport (&lp_table[minor]);
402 }
403out_unlock:
404 mutex_unlock(&lp_table[minor].port_mutex);
405
406 return retv;
407}
408
409#ifdef CONFIG_PARPORT_1284
410
411
412static ssize_t lp_read(struct file * file, char __user * buf,
413 size_t count, loff_t *ppos)
414{
415 DEFINE_WAIT(wait);
416 unsigned int minor=iminor(file_inode(file));
417 struct parport *port = lp_table[minor].dev->port;
418 ssize_t retval = 0;
419 char *kbuf = lp_table[minor].lp_buffer;
420 int nonblock = ((file->f_flags & O_NONBLOCK) ||
421 (LP_F(minor) & LP_ABORT));
422
423 if (count > LP_BUFFER_SIZE)
424 count = LP_BUFFER_SIZE;
425
426 if (mutex_lock_interruptible(&lp_table[minor].port_mutex))
427 return -EINTR;
428
429 lp_claim_parport_or_block (&lp_table[minor]);
430
431 parport_set_timeout (lp_table[minor].dev,
432 (nonblock ? PARPORT_INACTIVITY_O_NONBLOCK
433 : lp_table[minor].timeout));
434
435 parport_negotiate (lp_table[minor].dev->port, IEEE1284_MODE_COMPAT);
436 if (parport_negotiate (lp_table[minor].dev->port,
437 IEEE1284_MODE_NIBBLE)) {
438 retval = -EIO;
439 goto out;
440 }
441
442 while (retval == 0) {
443 retval = parport_read (port, kbuf, count);
444
445 if (retval > 0)
446 break;
447
448 if (nonblock) {
449 retval = -EAGAIN;
450 break;
451 }
452
453
454
455 if (lp_table[minor].dev->port->irq == PARPORT_IRQ_NONE) {
456 parport_negotiate (lp_table[minor].dev->port,
457 IEEE1284_MODE_COMPAT);
458 lp_error (minor);
459 if (parport_negotiate (lp_table[minor].dev->port,
460 IEEE1284_MODE_NIBBLE)) {
461 retval = -EIO;
462 goto out;
463 }
464 } else {
465 prepare_to_wait(&lp_table[minor].waitq, &wait, TASK_INTERRUPTIBLE);
466 schedule_timeout(LP_TIMEOUT_POLLED);
467 finish_wait(&lp_table[minor].waitq, &wait);
468 }
469
470 if (signal_pending (current)) {
471 retval = -ERESTARTSYS;
472 break;
473 }
474
475 cond_resched ();
476 }
477 parport_negotiate (lp_table[minor].dev->port, IEEE1284_MODE_COMPAT);
478 out:
479 lp_release_parport (&lp_table[minor]);
480
481 if (retval > 0 && copy_to_user (buf, kbuf, retval))
482 retval = -EFAULT;
483
484 mutex_unlock(&lp_table[minor].port_mutex);
485
486 return retval;
487}
488
489#endif
490
491static int lp_open(struct inode * inode, struct file * file)
492{
493 unsigned int minor = iminor(inode);
494 int ret = 0;
495
496 mutex_lock(&lp_mutex);
497 if (minor >= LP_NO) {
498 ret = -ENXIO;
499 goto out;
500 }
501 if ((LP_F(minor) & LP_EXIST) == 0) {
502 ret = -ENXIO;
503 goto out;
504 }
505 if (test_and_set_bit(LP_BUSY_BIT_POS, &LP_F(minor))) {
506 ret = -EBUSY;
507 goto out;
508 }
509
510
511
512
513
514 if ((LP_F(minor) & LP_ABORTOPEN) && !(file->f_flags & O_NONBLOCK)) {
515 int status;
516 lp_claim_parport_or_block (&lp_table[minor]);
517 status = r_str(minor);
518 lp_release_parport (&lp_table[minor]);
519 if (status & LP_POUTPA) {
520 printk(KERN_INFO "lp%d out of paper\n", minor);
521 LP_F(minor) &= ~LP_BUSY;
522 ret = -ENOSPC;
523 goto out;
524 } else if (!(status & LP_PSELECD)) {
525 printk(KERN_INFO "lp%d off-line\n", minor);
526 LP_F(minor) &= ~LP_BUSY;
527 ret = -EIO;
528 goto out;
529 } else if (!(status & LP_PERRORP)) {
530 printk(KERN_ERR "lp%d printer error\n", minor);
531 LP_F(minor) &= ~LP_BUSY;
532 ret = -EIO;
533 goto out;
534 }
535 }
536 lp_table[minor].lp_buffer = kmalloc(LP_BUFFER_SIZE, GFP_KERNEL);
537 if (!lp_table[minor].lp_buffer) {
538 LP_F(minor) &= ~LP_BUSY;
539 ret = -ENOMEM;
540 goto out;
541 }
542
543 lp_claim_parport_or_block (&lp_table[minor]);
544 if ( (lp_table[minor].dev->port->modes & PARPORT_MODE_ECP) &&
545 !parport_negotiate (lp_table[minor].dev->port,
546 IEEE1284_MODE_ECP)) {
547 printk (KERN_INFO "lp%d: ECP mode\n", minor);
548 lp_table[minor].best_mode = IEEE1284_MODE_ECP;
549 } else {
550 lp_table[minor].best_mode = IEEE1284_MODE_COMPAT;
551 }
552
553 parport_negotiate (lp_table[minor].dev->port, IEEE1284_MODE_COMPAT);
554 lp_release_parport (&lp_table[minor]);
555 lp_table[minor].current_mode = IEEE1284_MODE_COMPAT;
556out:
557 mutex_unlock(&lp_mutex);
558 return ret;
559}
560
561static int lp_release(struct inode * inode, struct file * file)
562{
563 unsigned int minor = iminor(inode);
564
565 lp_claim_parport_or_block (&lp_table[minor]);
566 parport_negotiate (lp_table[minor].dev->port, IEEE1284_MODE_COMPAT);
567 lp_table[minor].current_mode = IEEE1284_MODE_COMPAT;
568 lp_release_parport (&lp_table[minor]);
569 kfree(lp_table[minor].lp_buffer);
570 lp_table[minor].lp_buffer = NULL;
571 LP_F(minor) &= ~LP_BUSY;
572 return 0;
573}
574
575static int lp_do_ioctl(unsigned int minor, unsigned int cmd,
576 unsigned long arg, void __user *argp)
577{
578 int status;
579 int retval = 0;
580
581#ifdef LP_DEBUG
582 printk(KERN_DEBUG "lp%d ioctl, cmd: 0x%x, arg: 0x%lx\n", minor, cmd, arg);
583#endif
584 if (minor >= LP_NO)
585 return -ENODEV;
586 if ((LP_F(minor) & LP_EXIST) == 0)
587 return -ENODEV;
588 switch ( cmd ) {
589 case LPTIME:
590 if (arg > UINT_MAX / HZ)
591 return -EINVAL;
592 LP_TIME(minor) = arg * HZ/100;
593 break;
594 case LPCHAR:
595 LP_CHAR(minor) = arg;
596 break;
597 case LPABORT:
598 if (arg)
599 LP_F(minor) |= LP_ABORT;
600 else
601 LP_F(minor) &= ~LP_ABORT;
602 break;
603 case LPABORTOPEN:
604 if (arg)
605 LP_F(minor) |= LP_ABORTOPEN;
606 else
607 LP_F(minor) &= ~LP_ABORTOPEN;
608 break;
609 case LPCAREFUL:
610 if (arg)
611 LP_F(minor) |= LP_CAREFUL;
612 else
613 LP_F(minor) &= ~LP_CAREFUL;
614 break;
615 case LPWAIT:
616 LP_WAIT(minor) = arg;
617 break;
618 case LPSETIRQ:
619 return -EINVAL;
620 break;
621 case LPGETIRQ:
622 if (copy_to_user(argp, &LP_IRQ(minor),
623 sizeof(int)))
624 return -EFAULT;
625 break;
626 case LPGETSTATUS:
627 if (mutex_lock_interruptible(&lp_table[minor].port_mutex))
628 return -EINTR;
629 lp_claim_parport_or_block (&lp_table[minor]);
630 status = r_str(minor);
631 lp_release_parport (&lp_table[minor]);
632 mutex_unlock(&lp_table[minor].port_mutex);
633
634 if (copy_to_user(argp, &status, sizeof(int)))
635 return -EFAULT;
636 break;
637 case LPRESET:
638 lp_reset(minor);
639 break;
640#ifdef LP_STATS
641 case LPGETSTATS:
642 if (copy_to_user(argp, &LP_STAT(minor),
643 sizeof(struct lp_stats)))
644 return -EFAULT;
645 if (capable(CAP_SYS_ADMIN))
646 memset(&LP_STAT(minor), 0,
647 sizeof(struct lp_stats));
648 break;
649#endif
650 case LPGETFLAGS:
651 status = LP_F(minor);
652 if (copy_to_user(argp, &status, sizeof(int)))
653 return -EFAULT;
654 break;
655
656 default:
657 retval = -EINVAL;
658 }
659 return retval;
660}
661
662static int lp_set_timeout(unsigned int minor, s64 tv_sec, long tv_usec)
663{
664 long to_jiffies;
665
666
667 if (tv_sec < 0 || tv_usec < 0)
668 return -EINVAL;
669
670
671
672
673
674
675
676
677 if (tv_usec > 999999)
678 tv_usec = 999999;
679
680 if (tv_sec >= MAX_SEC_IN_JIFFIES - 1) {
681 to_jiffies = MAX_JIFFY_OFFSET;
682 } else {
683 to_jiffies = DIV_ROUND_UP(tv_usec, 1000000/HZ);
684 to_jiffies += tv_sec * (long) HZ;
685 }
686
687 if (to_jiffies <= 0) {
688 return -EINVAL;
689 }
690 lp_table[minor].timeout = to_jiffies;
691 return 0;
692}
693
694static int lp_set_timeout32(unsigned int minor, void __user *arg)
695{
696 s32 karg[2];
697
698 if (copy_from_user(karg, arg, sizeof(karg)))
699 return -EFAULT;
700
701 return lp_set_timeout(minor, karg[0], karg[1]);
702}
703
704static int lp_set_timeout64(unsigned int minor, void __user *arg)
705{
706 s64 karg[2];
707
708 if (copy_from_user(karg, arg, sizeof(karg)))
709 return -EFAULT;
710
711 return lp_set_timeout(minor, karg[0], karg[1]);
712}
713
714static long lp_ioctl(struct file *file, unsigned int cmd,
715 unsigned long arg)
716{
717 unsigned int minor;
718 int ret;
719
720 minor = iminor(file_inode(file));
721 mutex_lock(&lp_mutex);
722 switch (cmd) {
723 case LPSETTIMEOUT_OLD:
724 if (BITS_PER_LONG == 32) {
725 ret = lp_set_timeout32(minor, (void __user *)arg);
726 break;
727 }
728
729 case LPSETTIMEOUT_NEW:
730 ret = lp_set_timeout64(minor, (void __user *)arg);
731 break;
732 default:
733 ret = lp_do_ioctl(minor, cmd, arg, (void __user *)arg);
734 break;
735 }
736 mutex_unlock(&lp_mutex);
737
738 return ret;
739}
740
741#ifdef CONFIG_COMPAT
742static long lp_compat_ioctl(struct file *file, unsigned int cmd,
743 unsigned long arg)
744{
745 unsigned int minor;
746 int ret;
747
748 minor = iminor(file_inode(file));
749 mutex_lock(&lp_mutex);
750 switch (cmd) {
751 case LPSETTIMEOUT_OLD:
752 if (!COMPAT_USE_64BIT_TIME) {
753 ret = lp_set_timeout32(minor, (void __user *)arg);
754 break;
755 }
756
757 case LPSETTIMEOUT_NEW:
758 ret = lp_set_timeout64(minor, (void __user *)arg);
759 break;
760#ifdef LP_STATS
761 case LPGETSTATS:
762
763 ret = -EINVAL;
764 break;
765#endif
766 default:
767 ret = lp_do_ioctl(minor, cmd, arg, compat_ptr(arg));
768 break;
769 }
770 mutex_unlock(&lp_mutex);
771
772 return ret;
773}
774#endif
775
776static const struct file_operations lp_fops = {
777 .owner = THIS_MODULE,
778 .write = lp_write,
779 .unlocked_ioctl = lp_ioctl,
780#ifdef CONFIG_COMPAT
781 .compat_ioctl = lp_compat_ioctl,
782#endif
783 .open = lp_open,
784 .release = lp_release,
785#ifdef CONFIG_PARPORT_1284
786 .read = lp_read,
787#endif
788 .llseek = noop_llseek,
789};
790
791
792
793#ifdef CONFIG_LP_CONSOLE
794
795#define CONSOLE_LP 0
796
797
798
799
800#define CONSOLE_LP_STRICT 1
801
802
803
804static void lp_console_write (struct console *co, const char *s,
805 unsigned count)
806{
807 struct pardevice *dev = lp_table[CONSOLE_LP].dev;
808 struct parport *port = dev->port;
809 ssize_t written;
810
811 if (parport_claim (dev))
812
813 return;
814
815 parport_set_timeout (dev, 0);
816
817
818 parport_negotiate (port, IEEE1284_MODE_COMPAT);
819
820 do {
821
822 ssize_t canwrite = count;
823 char *lf = memchr (s, '\n', count);
824 if (lf)
825 canwrite = lf - s;
826
827 if (canwrite > 0) {
828 written = parport_write (port, s, canwrite);
829
830 if (written <= 0)
831 continue;
832
833 s += written;
834 count -= written;
835 canwrite -= written;
836 }
837
838 if (lf && canwrite <= 0) {
839 const char *crlf = "\r\n";
840 int i = 2;
841
842
843 s++;
844 count--;
845 do {
846 written = parport_write (port, crlf, i);
847 if (written > 0)
848 i -= written, crlf += written;
849 } while (i > 0 && (CONSOLE_LP_STRICT || written > 0));
850 }
851 } while (count > 0 && (CONSOLE_LP_STRICT || written > 0));
852
853 parport_release (dev);
854}
855
856static struct console lpcons = {
857 .name = "lp",
858 .write = lp_console_write,
859 .flags = CON_PRINTBUFFER,
860};
861
862#endif
863
864
865
866static int parport_nr[LP_NO] = { [0 ... LP_NO-1] = LP_PARPORT_UNSPEC };
867static char *parport[LP_NO];
868static bool reset;
869
870module_param_array(parport, charp, NULL, 0);
871module_param(reset, bool, 0);
872
873#ifndef MODULE
874static int __init lp_setup (char *str)
875{
876 static int parport_ptr;
877 int x;
878
879 if (get_option(&str, &x)) {
880 if (x == 0) {
881
882 parport_nr[0] = LP_PARPORT_OFF;
883 } else {
884 printk(KERN_WARNING "warning: 'lp=0x%x' is deprecated, ignored\n", x);
885 return 0;
886 }
887 } else if (!strncmp(str, "parport", 7)) {
888 int n = simple_strtoul(str+7, NULL, 10);
889 if (parport_ptr < LP_NO)
890 parport_nr[parport_ptr++] = n;
891 else
892 printk(KERN_INFO "lp: too many ports, %s ignored.\n",
893 str);
894 } else if (!strcmp(str, "auto")) {
895 parport_nr[0] = LP_PARPORT_AUTO;
896 } else if (!strcmp(str, "none")) {
897 if (parport_ptr < LP_NO)
898 parport_nr[parport_ptr++] = LP_PARPORT_NONE;
899 else
900 printk(KERN_INFO "lp: too many ports, %s ignored.\n",
901 str);
902 } else if (!strcmp(str, "reset")) {
903 reset = true;
904 }
905 return 1;
906}
907#endif
908
909static int lp_register(int nr, struct parport *port)
910{
911 lp_table[nr].dev = parport_register_device(port, "lp",
912 lp_preempt, NULL, NULL, 0,
913 (void *) &lp_table[nr]);
914 if (lp_table[nr].dev == NULL)
915 return 1;
916 lp_table[nr].flags |= LP_EXIST;
917
918 if (reset)
919 lp_reset(nr);
920
921 device_create(lp_class, port->dev, MKDEV(LP_MAJOR, nr), NULL,
922 "lp%d", nr);
923
924 printk(KERN_INFO "lp%d: using %s (%s).\n", nr, port->name,
925 (port->irq == PARPORT_IRQ_NONE)?"polling":"interrupt-driven");
926
927#ifdef CONFIG_LP_CONSOLE
928 if (!nr) {
929 if (port->modes & PARPORT_MODE_SAFEININT) {
930 register_console(&lpcons);
931 console_registered = port;
932 printk (KERN_INFO "lp%d: console ready\n", CONSOLE_LP);
933 } else
934 printk (KERN_ERR "lp%d: cannot run console on %s\n",
935 CONSOLE_LP, port->name);
936 }
937#endif
938
939 return 0;
940}
941
942static void lp_attach (struct parport *port)
943{
944 unsigned int i;
945
946 switch (parport_nr[0]) {
947 case LP_PARPORT_UNSPEC:
948 case LP_PARPORT_AUTO:
949 if (parport_nr[0] == LP_PARPORT_AUTO &&
950 port->probe_info[0].class != PARPORT_CLASS_PRINTER)
951 return;
952 if (lp_count == LP_NO) {
953 printk(KERN_INFO "lp: ignoring parallel port (max. %d)\n",LP_NO);
954 return;
955 }
956 if (!lp_register(lp_count, port))
957 lp_count++;
958 break;
959
960 default:
961 for (i = 0; i < LP_NO; i++) {
962 if (port->number == parport_nr[i]) {
963 if (!lp_register(i, port))
964 lp_count++;
965 break;
966 }
967 }
968 break;
969 }
970}
971
972static void lp_detach (struct parport *port)
973{
974
975#ifdef CONFIG_LP_CONSOLE
976 if (console_registered == port) {
977 unregister_console(&lpcons);
978 console_registered = NULL;
979 }
980#endif
981}
982
983static struct parport_driver lp_driver = {
984 .name = "lp",
985 .attach = lp_attach,
986 .detach = lp_detach,
987};
988
989static int __init lp_init (void)
990{
991 int i, err = 0;
992
993 if (parport_nr[0] == LP_PARPORT_OFF)
994 return 0;
995
996 for (i = 0; i < LP_NO; i++) {
997 lp_table[i].dev = NULL;
998 lp_table[i].flags = 0;
999 lp_table[i].chars = LP_INIT_CHAR;
1000 lp_table[i].time = LP_INIT_TIME;
1001 lp_table[i].wait = LP_INIT_WAIT;
1002 lp_table[i].lp_buffer = NULL;
1003#ifdef LP_STATS
1004 lp_table[i].lastcall = 0;
1005 lp_table[i].runchars = 0;
1006 memset (&lp_table[i].stats, 0, sizeof (struct lp_stats));
1007#endif
1008 lp_table[i].last_error = 0;
1009 init_waitqueue_head (&lp_table[i].waitq);
1010 init_waitqueue_head (&lp_table[i].dataq);
1011 mutex_init(&lp_table[i].port_mutex);
1012 lp_table[i].timeout = 10 * HZ;
1013 }
1014
1015 if (register_chrdev (LP_MAJOR, "lp", &lp_fops)) {
1016 printk (KERN_ERR "lp: unable to get major %d\n", LP_MAJOR);
1017 return -EIO;
1018 }
1019
1020 lp_class = class_create(THIS_MODULE, "printer");
1021 if (IS_ERR(lp_class)) {
1022 err = PTR_ERR(lp_class);
1023 goto out_reg;
1024 }
1025
1026 if (parport_register_driver (&lp_driver)) {
1027 printk (KERN_ERR "lp: unable to register with parport\n");
1028 err = -EIO;
1029 goto out_class;
1030 }
1031
1032 if (!lp_count) {
1033 printk (KERN_INFO "lp: driver loaded but no devices found\n");
1034#ifndef CONFIG_PARPORT_1284
1035 if (parport_nr[0] == LP_PARPORT_AUTO)
1036 printk (KERN_INFO "lp: (is IEEE 1284 support enabled?)\n");
1037#endif
1038 }
1039
1040 return 0;
1041
1042out_class:
1043 class_destroy(lp_class);
1044out_reg:
1045 unregister_chrdev(LP_MAJOR, "lp");
1046 return err;
1047}
1048
1049static int __init lp_init_module (void)
1050{
1051 if (parport[0]) {
1052
1053 if (!strncmp(parport[0], "auto", 4))
1054 parport_nr[0] = LP_PARPORT_AUTO;
1055 else {
1056 int n;
1057 for (n = 0; n < LP_NO && parport[n]; n++) {
1058 if (!strncmp(parport[n], "none", 4))
1059 parport_nr[n] = LP_PARPORT_NONE;
1060 else {
1061 char *ep;
1062 unsigned long r = simple_strtoul(parport[n], &ep, 0);
1063 if (ep != parport[n])
1064 parport_nr[n] = r;
1065 else {
1066 printk(KERN_ERR "lp: bad port specifier `%s'\n", parport[n]);
1067 return -ENODEV;
1068 }
1069 }
1070 }
1071 }
1072 }
1073
1074 return lp_init();
1075}
1076
1077static void lp_cleanup_module (void)
1078{
1079 unsigned int offset;
1080
1081 parport_unregister_driver (&lp_driver);
1082
1083#ifdef CONFIG_LP_CONSOLE
1084 unregister_console (&lpcons);
1085#endif
1086
1087 unregister_chrdev(LP_MAJOR, "lp");
1088 for (offset = 0; offset < LP_NO; offset++) {
1089 if (lp_table[offset].dev == NULL)
1090 continue;
1091 parport_unregister_device(lp_table[offset].dev);
1092 device_destroy(lp_class, MKDEV(LP_MAJOR, offset));
1093 }
1094 class_destroy(lp_class);
1095}
1096
1097__setup("lp=", lp_setup);
1098module_init(lp_init_module);
1099module_exit(lp_cleanup_module);
1100
1101MODULE_ALIAS_CHARDEV_MAJOR(LP_MAJOR);
1102MODULE_LICENSE("GPL");
1103