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.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 <asm/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 LP_TIME(minor) = arg * HZ/100;
591 break;
592 case LPCHAR:
593 LP_CHAR(minor) = arg;
594 break;
595 case LPABORT:
596 if (arg)
597 LP_F(minor) |= LP_ABORT;
598 else
599 LP_F(minor) &= ~LP_ABORT;
600 break;
601 case LPABORTOPEN:
602 if (arg)
603 LP_F(minor) |= LP_ABORTOPEN;
604 else
605 LP_F(minor) &= ~LP_ABORTOPEN;
606 break;
607 case LPCAREFUL:
608 if (arg)
609 LP_F(minor) |= LP_CAREFUL;
610 else
611 LP_F(minor) &= ~LP_CAREFUL;
612 break;
613 case LPWAIT:
614 LP_WAIT(minor) = arg;
615 break;
616 case LPSETIRQ:
617 return -EINVAL;
618 break;
619 case LPGETIRQ:
620 if (copy_to_user(argp, &LP_IRQ(minor),
621 sizeof(int)))
622 return -EFAULT;
623 break;
624 case LPGETSTATUS:
625 if (mutex_lock_interruptible(&lp_table[minor].port_mutex))
626 return -EINTR;
627 lp_claim_parport_or_block (&lp_table[minor]);
628 status = r_str(minor);
629 lp_release_parport (&lp_table[minor]);
630 mutex_unlock(&lp_table[minor].port_mutex);
631
632 if (copy_to_user(argp, &status, sizeof(int)))
633 return -EFAULT;
634 break;
635 case LPRESET:
636 lp_reset(minor);
637 break;
638#ifdef LP_STATS
639 case LPGETSTATS:
640 if (copy_to_user(argp, &LP_STAT(minor),
641 sizeof(struct lp_stats)))
642 return -EFAULT;
643 if (capable(CAP_SYS_ADMIN))
644 memset(&LP_STAT(minor), 0,
645 sizeof(struct lp_stats));
646 break;
647#endif
648 case LPGETFLAGS:
649 status = LP_F(minor);
650 if (copy_to_user(argp, &status, sizeof(int)))
651 return -EFAULT;
652 break;
653
654 default:
655 retval = -EINVAL;
656 }
657 return retval;
658}
659
660static int lp_set_timeout(unsigned int minor, struct timeval *par_timeout)
661{
662 long to_jiffies;
663
664
665 if ((par_timeout->tv_sec < 0) ||
666 (par_timeout->tv_usec < 0)) {
667 return -EINVAL;
668 }
669 to_jiffies = DIV_ROUND_UP(par_timeout->tv_usec, 1000000/HZ);
670 to_jiffies += par_timeout->tv_sec * (long) HZ;
671 if (to_jiffies <= 0) {
672 return -EINVAL;
673 }
674 lp_table[minor].timeout = to_jiffies;
675 return 0;
676}
677
678static long lp_ioctl(struct file *file, unsigned int cmd,
679 unsigned long arg)
680{
681 unsigned int minor;
682 struct timeval par_timeout;
683 int ret;
684
685 minor = iminor(file_inode(file));
686 mutex_lock(&lp_mutex);
687 switch (cmd) {
688 case LPSETTIMEOUT:
689 if (copy_from_user(&par_timeout, (void __user *)arg,
690 sizeof (struct timeval))) {
691 ret = -EFAULT;
692 break;
693 }
694 ret = lp_set_timeout(minor, &par_timeout);
695 break;
696 default:
697 ret = lp_do_ioctl(minor, cmd, arg, (void __user *)arg);
698 break;
699 }
700 mutex_unlock(&lp_mutex);
701
702 return ret;
703}
704
705#ifdef CONFIG_COMPAT
706static long lp_compat_ioctl(struct file *file, unsigned int cmd,
707 unsigned long arg)
708{
709 unsigned int minor;
710 struct timeval par_timeout;
711 int ret;
712
713 minor = iminor(file_inode(file));
714 mutex_lock(&lp_mutex);
715 switch (cmd) {
716 case LPSETTIMEOUT:
717 if (compat_get_timeval(&par_timeout, compat_ptr(arg))) {
718 ret = -EFAULT;
719 break;
720 }
721 ret = lp_set_timeout(minor, &par_timeout);
722 break;
723#ifdef LP_STATS
724 case LPGETSTATS:
725
726 ret = -EINVAL;
727 break;
728#endif
729 default:
730 ret = lp_do_ioctl(minor, cmd, arg, compat_ptr(arg));
731 break;
732 }
733 mutex_unlock(&lp_mutex);
734
735 return ret;
736}
737#endif
738
739static const struct file_operations lp_fops = {
740 .owner = THIS_MODULE,
741 .write = lp_write,
742 .unlocked_ioctl = lp_ioctl,
743#ifdef CONFIG_COMPAT
744 .compat_ioctl = lp_compat_ioctl,
745#endif
746 .open = lp_open,
747 .release = lp_release,
748#ifdef CONFIG_PARPORT_1284
749 .read = lp_read,
750#endif
751 .llseek = noop_llseek,
752};
753
754
755
756#ifdef CONFIG_LP_CONSOLE
757
758#define CONSOLE_LP 0
759
760
761
762
763#define CONSOLE_LP_STRICT 1
764
765
766
767static void lp_console_write (struct console *co, const char *s,
768 unsigned count)
769{
770 struct pardevice *dev = lp_table[CONSOLE_LP].dev;
771 struct parport *port = dev->port;
772 ssize_t written;
773
774 if (parport_claim (dev))
775
776 return;
777
778 parport_set_timeout (dev, 0);
779
780
781 parport_negotiate (port, IEEE1284_MODE_COMPAT);
782
783 do {
784
785 ssize_t canwrite = count;
786 char *lf = memchr (s, '\n', count);
787 if (lf)
788 canwrite = lf - s;
789
790 if (canwrite > 0) {
791 written = parport_write (port, s, canwrite);
792
793 if (written <= 0)
794 continue;
795
796 s += written;
797 count -= written;
798 canwrite -= written;
799 }
800
801 if (lf && canwrite <= 0) {
802 const char *crlf = "\r\n";
803 int i = 2;
804
805
806 s++;
807 count--;
808 do {
809 written = parport_write (port, crlf, i);
810 if (written > 0)
811 i -= written, crlf += written;
812 } while (i > 0 && (CONSOLE_LP_STRICT || written > 0));
813 }
814 } while (count > 0 && (CONSOLE_LP_STRICT || written > 0));
815
816 parport_release (dev);
817}
818
819static struct console lpcons = {
820 .name = "lp",
821 .write = lp_console_write,
822 .flags = CON_PRINTBUFFER,
823};
824
825#endif
826
827
828
829static int parport_nr[LP_NO] = { [0 ... LP_NO-1] = LP_PARPORT_UNSPEC };
830static char *parport[LP_NO];
831static bool reset;
832
833module_param_array(parport, charp, NULL, 0);
834module_param(reset, bool, 0);
835
836#ifndef MODULE
837static int __init lp_setup (char *str)
838{
839 static int parport_ptr;
840 int x;
841
842 if (get_option(&str, &x)) {
843 if (x == 0) {
844
845 parport_nr[0] = LP_PARPORT_OFF;
846 } else {
847 printk(KERN_WARNING "warning: 'lp=0x%x' is deprecated, ignored\n", x);
848 return 0;
849 }
850 } else if (!strncmp(str, "parport", 7)) {
851 int n = simple_strtoul(str+7, NULL, 10);
852 if (parport_ptr < LP_NO)
853 parport_nr[parport_ptr++] = n;
854 else
855 printk(KERN_INFO "lp: too many ports, %s ignored.\n",
856 str);
857 } else if (!strcmp(str, "auto")) {
858 parport_nr[0] = LP_PARPORT_AUTO;
859 } else if (!strcmp(str, "none")) {
860 parport_nr[parport_ptr++] = LP_PARPORT_NONE;
861 } else if (!strcmp(str, "reset")) {
862 reset = 1;
863 }
864 return 1;
865}
866#endif
867
868static int lp_register(int nr, struct parport *port)
869{
870 lp_table[nr].dev = parport_register_device(port, "lp",
871 lp_preempt, NULL, NULL, 0,
872 (void *) &lp_table[nr]);
873 if (lp_table[nr].dev == NULL)
874 return 1;
875 lp_table[nr].flags |= LP_EXIST;
876
877 if (reset)
878 lp_reset(nr);
879
880 device_create(lp_class, port->dev, MKDEV(LP_MAJOR, nr), NULL,
881 "lp%d", nr);
882
883 printk(KERN_INFO "lp%d: using %s (%s).\n", nr, port->name,
884 (port->irq == PARPORT_IRQ_NONE)?"polling":"interrupt-driven");
885
886#ifdef CONFIG_LP_CONSOLE
887 if (!nr) {
888 if (port->modes & PARPORT_MODE_SAFEININT) {
889 register_console(&lpcons);
890 console_registered = port;
891 printk (KERN_INFO "lp%d: console ready\n", CONSOLE_LP);
892 } else
893 printk (KERN_ERR "lp%d: cannot run console on %s\n",
894 CONSOLE_LP, port->name);
895 }
896#endif
897
898 return 0;
899}
900
901static void lp_attach (struct parport *port)
902{
903 unsigned int i;
904
905 switch (parport_nr[0]) {
906 case LP_PARPORT_UNSPEC:
907 case LP_PARPORT_AUTO:
908 if (parport_nr[0] == LP_PARPORT_AUTO &&
909 port->probe_info[0].class != PARPORT_CLASS_PRINTER)
910 return;
911 if (lp_count == LP_NO) {
912 printk(KERN_INFO "lp: ignoring parallel port (max. %d)\n",LP_NO);
913 return;
914 }
915 if (!lp_register(lp_count, port))
916 lp_count++;
917 break;
918
919 default:
920 for (i = 0; i < LP_NO; i++) {
921 if (port->number == parport_nr[i]) {
922 if (!lp_register(i, port))
923 lp_count++;
924 break;
925 }
926 }
927 break;
928 }
929}
930
931static void lp_detach (struct parport *port)
932{
933
934#ifdef CONFIG_LP_CONSOLE
935 if (console_registered == port) {
936 unregister_console(&lpcons);
937 console_registered = NULL;
938 }
939#endif
940}
941
942static struct parport_driver lp_driver = {
943 .name = "lp",
944 .attach = lp_attach,
945 .detach = lp_detach,
946};
947
948static int __init lp_init (void)
949{
950 int i, err = 0;
951
952 if (parport_nr[0] == LP_PARPORT_OFF)
953 return 0;
954
955 for (i = 0; i < LP_NO; i++) {
956 lp_table[i].dev = NULL;
957 lp_table[i].flags = 0;
958 lp_table[i].chars = LP_INIT_CHAR;
959 lp_table[i].time = LP_INIT_TIME;
960 lp_table[i].wait = LP_INIT_WAIT;
961 lp_table[i].lp_buffer = NULL;
962#ifdef LP_STATS
963 lp_table[i].lastcall = 0;
964 lp_table[i].runchars = 0;
965 memset (&lp_table[i].stats, 0, sizeof (struct lp_stats));
966#endif
967 lp_table[i].last_error = 0;
968 init_waitqueue_head (&lp_table[i].waitq);
969 init_waitqueue_head (&lp_table[i].dataq);
970 mutex_init(&lp_table[i].port_mutex);
971 lp_table[i].timeout = 10 * HZ;
972 }
973
974 if (register_chrdev (LP_MAJOR, "lp", &lp_fops)) {
975 printk (KERN_ERR "lp: unable to get major %d\n", LP_MAJOR);
976 return -EIO;
977 }
978
979 lp_class = class_create(THIS_MODULE, "printer");
980 if (IS_ERR(lp_class)) {
981 err = PTR_ERR(lp_class);
982 goto out_reg;
983 }
984
985 if (parport_register_driver (&lp_driver)) {
986 printk (KERN_ERR "lp: unable to register with parport\n");
987 err = -EIO;
988 goto out_class;
989 }
990
991 if (!lp_count) {
992 printk (KERN_INFO "lp: driver loaded but no devices found\n");
993#ifndef CONFIG_PARPORT_1284
994 if (parport_nr[0] == LP_PARPORT_AUTO)
995 printk (KERN_INFO "lp: (is IEEE 1284 support enabled?)\n");
996#endif
997 }
998
999 return 0;
1000
1001out_class:
1002 class_destroy(lp_class);
1003out_reg:
1004 unregister_chrdev(LP_MAJOR, "lp");
1005 return err;
1006}
1007
1008static int __init lp_init_module (void)
1009{
1010 if (parport[0]) {
1011
1012 if (!strncmp(parport[0], "auto", 4))
1013 parport_nr[0] = LP_PARPORT_AUTO;
1014 else {
1015 int n;
1016 for (n = 0; n < LP_NO && parport[n]; n++) {
1017 if (!strncmp(parport[n], "none", 4))
1018 parport_nr[n] = LP_PARPORT_NONE;
1019 else {
1020 char *ep;
1021 unsigned long r = simple_strtoul(parport[n], &ep, 0);
1022 if (ep != parport[n])
1023 parport_nr[n] = r;
1024 else {
1025 printk(KERN_ERR "lp: bad port specifier `%s'\n", parport[n]);
1026 return -ENODEV;
1027 }
1028 }
1029 }
1030 }
1031 }
1032
1033 return lp_init();
1034}
1035
1036static void lp_cleanup_module (void)
1037{
1038 unsigned int offset;
1039
1040 parport_unregister_driver (&lp_driver);
1041
1042#ifdef CONFIG_LP_CONSOLE
1043 unregister_console (&lpcons);
1044#endif
1045
1046 unregister_chrdev(LP_MAJOR, "lp");
1047 for (offset = 0; offset < LP_NO; offset++) {
1048 if (lp_table[offset].dev == NULL)
1049 continue;
1050 parport_unregister_device(lp_table[offset].dev);
1051 device_destroy(lp_class, MKDEV(LP_MAJOR, offset));
1052 }
1053 class_destroy(lp_class);
1054}
1055
1056__setup("lp=", lp_setup);
1057module_init(lp_init_module);
1058module_exit(lp_cleanup_module);
1059
1060MODULE_ALIAS_CHARDEV_MAJOR(LP_MAJOR);
1061MODULE_LICENSE("GPL");
1062