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