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