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