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