Commit | Line | Data |
---|---|---|
1da177e4 LT |
1 | /* |
2 | * Generic parallel printer driver | |
3 | * | |
4 | * Copyright (C) 1992 by Jim Weigand and Linus Torvalds | |
5 | * Copyright (C) 1992,1993 by Michael K. Johnson | |
6 | * - Thanks much to Gunter Windau for pointing out to me where the error | |
7 | * checking ought to be. | |
8 | * Copyright (C) 1993 by Nigel Gamble (added interrupt code) | |
9 | * Copyright (C) 1994 by Alan Cox (Modularised it) | |
10 | * LPCAREFUL, LPABORT, LPGETSTATUS added by Chris Metcalf, metcalf@lcs.mit.edu | |
11 | * Statistics and support for slow printers by Rob Janssen, rob@knoware.nl | |
12 | * "lp=" command line parameters added by Grant Guenther, grant@torque.net | |
13 | * lp_read (Status readback) support added by Carsten Gross, | |
14 | * carsten@sol.wohnheim.uni-ulm.de | |
15 | * Support for parport by Philip Blundell <philb@gnu.org> | |
16 | * Parport sharing hacking by Andrea Arcangeli | |
17 | * Fixed kernel_(to/from)_user memory copy to check for errors | |
18 | * by Riccardo Facchetti <fizban@tin.it> | |
19 | * 22-JAN-1998 Added support for devfs Richard Gooch <rgooch@atnf.csiro.au> | |
20 | * Redesigned interrupt handling for handle printers with buggy handshake | |
21 | * by Andrea Arcangeli, 11 May 1998 | |
22 | * Full efficient handling of printer with buggy irq handshake (now I have | |
23 | * understood the meaning of the strange handshake). This is done sending new | |
24 | * characters if the interrupt is just happened, even if the printer say to | |
25 | * be still BUSY. This is needed at least with Epson Stylus Color. To enable | |
26 | * the new TRUST_IRQ mode read the `LP OPTIMIZATION' section below... | |
27 | * Fixed the irq on the rising edge of the strobe case. | |
28 | * Obsoleted the CAREFUL flag since a printer that doesn' t work with | |
29 | * CAREFUL will block a bit after in lp_check_status(). | |
30 | * Andrea Arcangeli, 15 Oct 1998 | |
31 | * Obsoleted and removed all the lowlevel stuff implemented in the last | |
32 | * month to use the IEEE1284 functions (that handle the _new_ compatibilty | |
33 | * mode fine). | |
34 | */ | |
35 | ||
36 | /* This driver should, in theory, work with any parallel port that has an | |
37 | * appropriate low-level driver; all I/O is done through the parport | |
38 | * abstraction layer. | |
39 | * | |
40 | * If this driver is built into the kernel, you can configure it using the | |
41 | * kernel command-line. For example: | |
42 | * | |
43 | * lp=parport1,none,parport2 (bind lp0 to parport1, disable lp1 and | |
44 | * bind lp2 to parport2) | |
45 | * | |
46 | * lp=auto (assign lp devices to all ports that | |
47 | * have printers attached, as determined | |
48 | * by the IEEE-1284 autoprobe) | |
69f92163 SM |
49 | * |
50 | * lp=reset (reset the printer during | |
1da177e4 LT |
51 | * initialisation) |
52 | * | |
53 | * lp=off (disable the printer driver entirely) | |
54 | * | |
55 | * If the driver is loaded as a module, similar functionality is available | |
56 | * using module parameters. The equivalent of the above commands would be: | |
57 | * | |
58 | * # insmod lp.o parport=1,none,2 | |
59 | * | |
60 | * # insmod lp.o parport=auto | |
61 | * | |
62 | * # insmod lp.o reset=1 | |
63 | */ | |
64 | ||
65 | /* COMPATIBILITY WITH OLD KERNELS | |
66 | * | |
67 | * Under Linux 2.0 and previous versions, lp devices were bound to ports at | |
68 | * particular I/O addresses, as follows: | |
69 | * | |
70 | * lp0 0x3bc | |
71 | * lp1 0x378 | |
72 | * lp2 0x278 | |
73 | * | |
74 | * The new driver, by default, binds lp devices to parport devices as it | |
75 | * finds them. This means that if you only have one port, it will be bound | |
76 | * to lp0 regardless of its I/O address. If you need the old behaviour, you | |
77 | * can force it using the parameters described above. | |
78 | */ | |
79 | ||
80 | /* | |
81 | * The new interrupt handling code take care of the buggy handshake | |
82 | * of some HP and Epson printer: | |
83 | * ___ | |
84 | * ACK _______________ ___________ | |
85 | * |__| | |
86 | * ____ | |
87 | * BUSY _________ _______ | |
88 | * |____________| | |
89 | * | |
90 | * I discovered this using the printer scanner that you can find at: | |
91 | * | |
92 | * ftp://e-mind.com/pub/linux/pscan/ | |
93 | * | |
94 | * 11 May 98, Andrea Arcangeli | |
95 | * | |
96 | * My printer scanner run on an Epson Stylus Color show that such printer | |
97 | * generates the irq on the _rising_ edge of the STROBE. Now lp handle | |
98 | * this case fine too. | |
99 | * | |
100 | * 15 Oct 1998, Andrea Arcangeli | |
101 | * | |
102 | * The so called `buggy' handshake is really the well documented | |
103 | * compatibility mode IEEE1284 handshake. They changed the well known | |
104 | * Centronics handshake acking in the middle of busy expecting to not | |
105 | * break drivers or legacy application, while they broken linux lp | |
106 | * until I fixed it reverse engineering the protocol by hand some | |
107 | * month ago... | |
108 | * | |
109 | * 14 Dec 1998, Andrea Arcangeli | |
110 | * | |
111 | * Copyright (C) 2000 by Tim Waugh (added LPSETTIMEOUT ioctl) | |
112 | */ | |
113 | ||
114 | #include <linux/module.h> | |
115 | #include <linux/init.h> | |
116 | ||
1da177e4 LT |
117 | #include <linux/errno.h> |
118 | #include <linux/kernel.h> | |
119 | #include <linux/major.h> | |
174cd4b1 | 120 | #include <linux/sched/signal.h> |
1da177e4 LT |
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> | |
96757701 | 128 | #include <linux/jiffies.h> |
613655fa | 129 | #include <linux/mutex.h> |
3695669c | 130 | #include <linux/compat.h> |
1da177e4 LT |
131 | |
132 | #include <linux/parport.h> | |
133 | #undef LP_STATS | |
134 | #include <linux/lp.h> | |
135 | ||
136 | #include <asm/irq.h> | |
7c0f6ba6 | 137 | #include <linux/uaccess.h> |
1da177e4 LT |
138 | |
139 | /* if you have more than 8 printers, remember to increase LP_NO */ | |
140 | #define LP_NO 8 | |
141 | ||
613655fa | 142 | static DEFINE_MUTEX(lp_mutex); |
1da177e4 | 143 | static struct lp_struct lp_table[LP_NO]; |
0edf39d2 | 144 | static int port_num[LP_NO]; |
1da177e4 LT |
145 | |
146 | static unsigned int lp_count = 0; | |
ca8eca68 | 147 | static struct class *lp_class; |
1da177e4 LT |
148 | |
149 | #ifdef CONFIG_LP_CONSOLE | |
f4a1c2bc | 150 | static struct parport *console_registered; |
1da177e4 LT |
151 | #endif /* CONFIG_LP_CONSOLE */ |
152 | ||
153 | #undef LP_DEBUG | |
154 | ||
155 | /* Bits used to manage claiming the parport device */ | |
156 | #define LP_PREEMPT_REQUEST 1 | |
157 | #define LP_PARPORT_CLAIMED 2 | |
158 | ||
159 | /* --- low-level port access ----------------------------------- */ | |
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 | /* Claim the parport or block trying unless we've already claimed it */ | |
167 | static void lp_claim_parport_or_block(struct lp_struct *this_lp) | |
168 | { | |
169 | if (!test_and_set_bit(LP_PARPORT_CLAIMED, &this_lp->bits)) { | |
885b3680 | 170 | parport_claim_or_block(this_lp->dev); |
1da177e4 LT |
171 | } |
172 | } | |
173 | ||
174 | /* Claim the parport or block trying unless we've already claimed it */ | |
175 | static void lp_release_parport(struct lp_struct *this_lp) | |
176 | { | |
177 | if (test_and_clear_bit(LP_PARPORT_CLAIMED, &this_lp->bits)) { | |
885b3680 | 178 | parport_release(this_lp->dev); |
1da177e4 LT |
179 | } |
180 | } | |
181 | ||
182 | ||
183 | ||
184 | static 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); | |
39992028 | 188 | return 1; |
1da177e4 LT |
189 | } |
190 | ||
191 | ||
69f92163 | 192 | /* |
1da177e4 LT |
193 | * Try to negotiate to a new mode; if unsuccessful negotiate to |
194 | * compatibility mode. Return the mode we ended up in. | |
195 | */ | |
2081f9c0 | 196 | static int lp_negotiate(struct parport *port, int mode) |
1da177e4 | 197 | { |
885b3680 | 198 | if (parport_negotiate(port, mode) != 0) { |
1da177e4 | 199 | mode = IEEE1284_MODE_COMPAT; |
885b3680 | 200 | parport_negotiate(port, mode); |
1da177e4 LT |
201 | } |
202 | ||
39992028 | 203 | return mode; |
1da177e4 LT |
204 | } |
205 | ||
206 | static int lp_reset(int minor) | |
207 | { | |
208 | int retval; | |
885b3680 | 209 | lp_claim_parport_or_block(&lp_table[minor]); |
1da177e4 | 210 | w_ctr(minor, LP_PSELECP); |
885b3680 | 211 | udelay(LP_DELAY); |
1da177e4 LT |
212 | w_ctr(minor, LP_PSELECP | LP_PINITP); |
213 | retval = r_str(minor); | |
885b3680 | 214 | lp_release_parport(&lp_table[minor]); |
1da177e4 LT |
215 | return retval; |
216 | } | |
217 | ||
885b3680 | 218 | static void lp_error(int minor) |
1da177e4 LT |
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; | |
1c3de936 | 227 | if (polling) |
885b3680 | 228 | lp_release_parport(&lp_table[minor]); |
1da177e4 LT |
229 | prepare_to_wait(&lp_table[minor].waitq, &wait, TASK_INTERRUPTIBLE); |
230 | schedule_timeout(LP_TIMEOUT_POLLED); | |
231 | finish_wait(&lp_table[minor].waitq, &wait); | |
1c3de936 | 232 | if (polling) |
885b3680 | 233 | lp_claim_parport_or_block(&lp_table[minor]); |
1c3de936 | 234 | else |
885b3680 | 235 | parport_yield_blocking(lp_table[minor].dev); |
1da177e4 LT |
236 | } |
237 | ||
238 | static int lp_check_status(int minor) | |
239 | { | |
240 | int error = 0; | |
241 | unsigned int last = lp_table[minor].last_error; | |
242 | unsigned char status = r_str(minor); | |
243 | if ((status & LP_PERRORP) && !(LP_F(minor) & LP_CAREFUL)) | |
244 | /* No error. */ | |
245 | last = 0; | |
246 | else if ((status & LP_POUTPA)) { | |
247 | if (last != LP_POUTPA) { | |
248 | last = LP_POUTPA; | |
249 | printk(KERN_INFO "lp%d out of paper\n", minor); | |
250 | } | |
251 | error = -ENOSPC; | |
252 | } else if (!(status & LP_PSELECD)) { | |
253 | if (last != LP_PSELECD) { | |
254 | last = LP_PSELECD; | |
255 | printk(KERN_INFO "lp%d off-line\n", minor); | |
256 | } | |
257 | error = -EIO; | |
258 | } else if (!(status & LP_PERRORP)) { | |
259 | if (last != LP_PERRORP) { | |
260 | last = LP_PERRORP; | |
261 | printk(KERN_INFO "lp%d on fire\n", minor); | |
262 | } | |
263 | error = -EIO; | |
264 | } else { | |
265 | last = 0; /* Come here if LP_CAREFUL is set and no | |
1b3451e0 | 266 | errors are reported. */ |
1da177e4 LT |
267 | } |
268 | ||
269 | lp_table[minor].last_error = last; | |
270 | ||
271 | if (last != 0) | |
272 | lp_error(minor); | |
273 | ||
274 | return error; | |
275 | } | |
276 | ||
277 | static int lp_wait_ready(int minor, int nonblock) | |
278 | { | |
279 | int error = 0; | |
280 | ||
281 | /* If we're not in compatibility mode, we're ready now! */ | |
282 | if (lp_table[minor].current_mode != IEEE1284_MODE_COMPAT) { | |
39992028 | 283 | return 0; |
1da177e4 LT |
284 | } |
285 | ||
286 | do { | |
885b3680 | 287 | error = lp_check_status(minor); |
1da177e4 LT |
288 | if (error && (nonblock || (LP_F(minor) & LP_ABORT))) |
289 | break; | |
885b3680 | 290 | if (signal_pending(current)) { |
1da177e4 LT |
291 | error = -EINTR; |
292 | break; | |
293 | } | |
294 | } while (error); | |
295 | return error; | |
296 | } | |
297 | ||
2081f9c0 | 298 | static ssize_t lp_write(struct file *file, const char __user *buf, |
1b3451e0 | 299 | size_t count, loff_t *ppos) |
1da177e4 | 300 | { |
496ad9aa | 301 | unsigned int minor = iminor(file_inode(file)); |
1da177e4 LT |
302 | struct parport *port = lp_table[minor].dev->port; |
303 | char *kbuf = lp_table[minor].lp_buffer; | |
304 | ssize_t retv = 0; | |
305 | ssize_t written; | |
306 | size_t copy_size = count; | |
307 | int nonblock = ((file->f_flags & O_NONBLOCK) || | |
308 | (LP_F(minor) & LP_ABORT)); | |
309 | ||
310 | #ifdef LP_STATS | |
96757701 | 311 | if (time_after(jiffies, lp_table[minor].lastcall + LP_TIME(minor))) |
1da177e4 LT |
312 | lp_table[minor].runchars = 0; |
313 | ||
314 | lp_table[minor].lastcall = jiffies; | |
315 | #endif | |
316 | ||
317 | /* Need to copy the data from user-space. */ | |
318 | if (copy_size > LP_BUFFER_SIZE) | |
319 | copy_size = LP_BUFFER_SIZE; | |
320 | ||
0a5dcb51 | 321 | if (mutex_lock_interruptible(&lp_table[minor].port_mutex)) |
1da177e4 LT |
322 | return -EINTR; |
323 | ||
885b3680 | 324 | if (copy_from_user(kbuf, buf, copy_size)) { |
1da177e4 LT |
325 | retv = -EFAULT; |
326 | goto out_unlock; | |
327 | } | |
328 | ||
1b3451e0 SM |
329 | /* Claim Parport or sleep until it becomes available |
330 | */ | |
885b3680 | 331 | lp_claim_parport_or_block(&lp_table[minor]); |
1da177e4 | 332 | /* Go to the proper mode. */ |
885b3680 SM |
333 | lp_table[minor].current_mode = lp_negotiate(port, |
334 | lp_table[minor].best_mode); | |
1da177e4 | 335 | |
885b3680 SM |
336 | parport_set_timeout(lp_table[minor].dev, |
337 | (nonblock ? PARPORT_INACTIVITY_O_NONBLOCK | |
338 | : lp_table[minor].timeout)); | |
1da177e4 | 339 | |
885b3680 | 340 | if ((retv = lp_wait_ready(minor, nonblock)) == 0) |
1da177e4 LT |
341 | do { |
342 | /* Write the data. */ | |
885b3680 | 343 | written = parport_write(port, kbuf, copy_size); |
1da177e4 LT |
344 | if (written > 0) { |
345 | copy_size -= written; | |
346 | count -= written; | |
347 | buf += written; | |
348 | retv += written; | |
349 | } | |
350 | ||
885b3680 | 351 | if (signal_pending(current)) { |
1da177e4 LT |
352 | if (retv == 0) |
353 | retv = -EINTR; | |
354 | ||
355 | break; | |
356 | } | |
357 | ||
358 | if (copy_size > 0) { | |
359 | /* incomplete write -> check error ! */ | |
360 | int error; | |
361 | ||
885b3680 SM |
362 | parport_negotiate(lp_table[minor].dev->port, |
363 | IEEE1284_MODE_COMPAT); | |
1da177e4 LT |
364 | lp_table[minor].current_mode = IEEE1284_MODE_COMPAT; |
365 | ||
885b3680 | 366 | error = lp_wait_ready(minor, nonblock); |
1da177e4 LT |
367 | |
368 | if (error) { | |
369 | if (retv == 0) | |
370 | retv = error; | |
371 | break; | |
372 | } else if (nonblock) { | |
373 | if (retv == 0) | |
374 | retv = -EAGAIN; | |
375 | break; | |
376 | } | |
377 | ||
885b3680 | 378 | parport_yield_blocking(lp_table[minor].dev); |
69f92163 | 379 | lp_table[minor].current_mode |
885b3680 SM |
380 | = lp_negotiate(port, |
381 | lp_table[minor].best_mode); | |
1da177e4 LT |
382 | |
383 | } else if (need_resched()) | |
885b3680 | 384 | schedule(); |
1da177e4 LT |
385 | |
386 | if (count) { | |
387 | copy_size = count; | |
388 | if (copy_size > LP_BUFFER_SIZE) | |
389 | copy_size = LP_BUFFER_SIZE; | |
390 | ||
391 | if (copy_from_user(kbuf, buf, copy_size)) { | |
392 | if (retv == 0) | |
393 | retv = -EFAULT; | |
394 | break; | |
395 | } | |
69f92163 | 396 | } |
1da177e4 LT |
397 | } while (count > 0); |
398 | ||
69f92163 | 399 | if (test_and_clear_bit(LP_PREEMPT_REQUEST, |
1da177e4 LT |
400 | &lp_table[minor].bits)) { |
401 | printk(KERN_INFO "lp%d releasing parport\n", minor); | |
885b3680 SM |
402 | parport_negotiate(lp_table[minor].dev->port, |
403 | IEEE1284_MODE_COMPAT); | |
1da177e4 | 404 | lp_table[minor].current_mode = IEEE1284_MODE_COMPAT; |
885b3680 | 405 | lp_release_parport(&lp_table[minor]); |
1da177e4 LT |
406 | } |
407 | out_unlock: | |
0a5dcb51 | 408 | mutex_unlock(&lp_table[minor].port_mutex); |
1da177e4 | 409 | |
1b3451e0 | 410 | return retv; |
1da177e4 LT |
411 | } |
412 | ||
413 | #ifdef CONFIG_PARPORT_1284 | |
414 | ||
415 | /* Status readback conforming to ieee1284 */ | |
2081f9c0 | 416 | static ssize_t lp_read(struct file *file, char __user *buf, |
1da177e4 LT |
417 | size_t count, loff_t *ppos) |
418 | { | |
419 | DEFINE_WAIT(wait); | |
496ad9aa | 420 | unsigned int minor=iminor(file_inode(file)); |
1da177e4 LT |
421 | struct parport *port = lp_table[minor].dev->port; |
422 | ssize_t retval = 0; | |
423 | char *kbuf = lp_table[minor].lp_buffer; | |
424 | int nonblock = ((file->f_flags & O_NONBLOCK) || | |
425 | (LP_F(minor) & LP_ABORT)); | |
426 | ||
427 | if (count > LP_BUFFER_SIZE) | |
428 | count = LP_BUFFER_SIZE; | |
429 | ||
0a5dcb51 | 430 | if (mutex_lock_interruptible(&lp_table[minor].port_mutex)) |
1da177e4 LT |
431 | return -EINTR; |
432 | ||
885b3680 | 433 | lp_claim_parport_or_block(&lp_table[minor]); |
1da177e4 | 434 | |
885b3680 SM |
435 | parport_set_timeout(lp_table[minor].dev, |
436 | (nonblock ? PARPORT_INACTIVITY_O_NONBLOCK | |
437 | : lp_table[minor].timeout)); | |
1da177e4 | 438 | |
885b3680 SM |
439 | parport_negotiate(lp_table[minor].dev->port, IEEE1284_MODE_COMPAT); |
440 | if (parport_negotiate(lp_table[minor].dev->port, | |
441 | IEEE1284_MODE_NIBBLE)) { | |
1da177e4 LT |
442 | retval = -EIO; |
443 | goto out; | |
444 | } | |
445 | ||
446 | while (retval == 0) { | |
885b3680 | 447 | retval = parport_read(port, kbuf, count); |
1da177e4 LT |
448 | |
449 | if (retval > 0) | |
450 | break; | |
451 | ||
452 | if (nonblock) { | |
453 | retval = -EAGAIN; | |
454 | break; | |
455 | } | |
456 | ||
457 | /* Wait for data. */ | |
458 | ||
459 | if (lp_table[minor].dev->port->irq == PARPORT_IRQ_NONE) { | |
885b3680 SM |
460 | parport_negotiate(lp_table[minor].dev->port, |
461 | IEEE1284_MODE_COMPAT); | |
462 | lp_error(minor); | |
463 | if (parport_negotiate(lp_table[minor].dev->port, | |
464 | IEEE1284_MODE_NIBBLE)) { | |
1da177e4 LT |
465 | retval = -EIO; |
466 | goto out; | |
467 | } | |
468 | } else { | |
469 | prepare_to_wait(&lp_table[minor].waitq, &wait, TASK_INTERRUPTIBLE); | |
470 | schedule_timeout(LP_TIMEOUT_POLLED); | |
471 | finish_wait(&lp_table[minor].waitq, &wait); | |
472 | } | |
473 | ||
885b3680 | 474 | if (signal_pending(current)) { |
1da177e4 LT |
475 | retval = -ERESTARTSYS; |
476 | break; | |
477 | } | |
478 | ||
885b3680 | 479 | cond_resched(); |
1da177e4 | 480 | } |
885b3680 | 481 | parport_negotiate(lp_table[minor].dev->port, IEEE1284_MODE_COMPAT); |
1da177e4 | 482 | out: |
885b3680 | 483 | lp_release_parport(&lp_table[minor]); |
1da177e4 | 484 | |
885b3680 | 485 | if (retval > 0 && copy_to_user(buf, kbuf, retval)) |
1da177e4 LT |
486 | retval = -EFAULT; |
487 | ||
0a5dcb51 | 488 | mutex_unlock(&lp_table[minor].port_mutex); |
1da177e4 LT |
489 | |
490 | return retval; | |
491 | } | |
492 | ||
493 | #endif /* IEEE 1284 support */ | |
494 | ||
2081f9c0 | 495 | static int lp_open(struct inode *inode, struct file *file) |
1da177e4 LT |
496 | { |
497 | unsigned int minor = iminor(inode); | |
abedd296 | 498 | int ret = 0; |
1da177e4 | 499 | |
613655fa | 500 | mutex_lock(&lp_mutex); |
abedd296 JC |
501 | if (minor >= LP_NO) { |
502 | ret = -ENXIO; | |
503 | goto out; | |
504 | } | |
505 | if ((LP_F(minor) & LP_EXIST) == 0) { | |
506 | ret = -ENXIO; | |
507 | goto out; | |
508 | } | |
509 | if (test_and_set_bit(LP_BUSY_BIT_POS, &LP_F(minor))) { | |
510 | ret = -EBUSY; | |
511 | goto out; | |
512 | } | |
1da177e4 LT |
513 | /* If ABORTOPEN is set and the printer is offline or out of paper, |
514 | we may still want to open it to perform ioctl()s. Therefore we | |
515 | have commandeered O_NONBLOCK, even though it is being used in | |
516 | a non-standard manner. This is strictly a Linux hack, and | |
517 | should most likely only ever be used by the tunelp application. */ | |
518 | if ((LP_F(minor) & LP_ABORTOPEN) && !(file->f_flags & O_NONBLOCK)) { | |
519 | int status; | |
885b3680 | 520 | lp_claim_parport_or_block(&lp_table[minor]); |
1da177e4 | 521 | status = r_str(minor); |
885b3680 | 522 | lp_release_parport(&lp_table[minor]); |
1da177e4 LT |
523 | if (status & LP_POUTPA) { |
524 | printk(KERN_INFO "lp%d out of paper\n", minor); | |
525 | LP_F(minor) &= ~LP_BUSY; | |
abedd296 JC |
526 | ret = -ENOSPC; |
527 | goto out; | |
1da177e4 LT |
528 | } else if (!(status & LP_PSELECD)) { |
529 | printk(KERN_INFO "lp%d off-line\n", minor); | |
530 | LP_F(minor) &= ~LP_BUSY; | |
abedd296 JC |
531 | ret = -EIO; |
532 | goto out; | |
1da177e4 LT |
533 | } else if (!(status & LP_PERRORP)) { |
534 | printk(KERN_ERR "lp%d printer error\n", minor); | |
535 | LP_F(minor) &= ~LP_BUSY; | |
abedd296 JC |
536 | ret = -EIO; |
537 | goto out; | |
1da177e4 LT |
538 | } |
539 | } | |
5cbded58 | 540 | lp_table[minor].lp_buffer = kmalloc(LP_BUFFER_SIZE, GFP_KERNEL); |
1da177e4 LT |
541 | if (!lp_table[minor].lp_buffer) { |
542 | LP_F(minor) &= ~LP_BUSY; | |
abedd296 JC |
543 | ret = -ENOMEM; |
544 | goto out; | |
1da177e4 LT |
545 | } |
546 | /* Determine if the peripheral supports ECP mode */ | |
885b3680 | 547 | lp_claim_parport_or_block(&lp_table[minor]); |
1da177e4 | 548 | if ( (lp_table[minor].dev->port->modes & PARPORT_MODE_ECP) && |
885b3680 | 549 | !parport_negotiate(lp_table[minor].dev->port, |
1b3451e0 | 550 | IEEE1284_MODE_ECP)) { |
885b3680 | 551 | printk(KERN_INFO "lp%d: ECP mode\n", minor); |
1da177e4 LT |
552 | lp_table[minor].best_mode = IEEE1284_MODE_ECP; |
553 | } else { | |
554 | lp_table[minor].best_mode = IEEE1284_MODE_COMPAT; | |
555 | } | |
556 | /* Leave peripheral in compatibility mode */ | |
885b3680 SM |
557 | parport_negotiate(lp_table[minor].dev->port, IEEE1284_MODE_COMPAT); |
558 | lp_release_parport(&lp_table[minor]); | |
1da177e4 | 559 | lp_table[minor].current_mode = IEEE1284_MODE_COMPAT; |
abedd296 | 560 | out: |
613655fa | 561 | mutex_unlock(&lp_mutex); |
abedd296 | 562 | return ret; |
1da177e4 LT |
563 | } |
564 | ||
2081f9c0 | 565 | static int lp_release(struct inode *inode, struct file *file) |
1da177e4 LT |
566 | { |
567 | unsigned int minor = iminor(inode); | |
568 | ||
885b3680 SM |
569 | lp_claim_parport_or_block(&lp_table[minor]); |
570 | parport_negotiate(lp_table[minor].dev->port, IEEE1284_MODE_COMPAT); | |
1da177e4 | 571 | lp_table[minor].current_mode = IEEE1284_MODE_COMPAT; |
885b3680 | 572 | lp_release_parport(&lp_table[minor]); |
1da177e4 LT |
573 | kfree(lp_table[minor].lp_buffer); |
574 | lp_table[minor].lp_buffer = NULL; | |
575 | LP_F(minor) &= ~LP_BUSY; | |
576 | return 0; | |
577 | } | |
578 | ||
3695669c AB |
579 | static int lp_do_ioctl(unsigned int minor, unsigned int cmd, |
580 | unsigned long arg, void __user *argp) | |
1da177e4 | 581 | { |
1da177e4 LT |
582 | int status; |
583 | int retval = 0; | |
1da177e4 LT |
584 | |
585 | #ifdef LP_DEBUG | |
586 | printk(KERN_DEBUG "lp%d ioctl, cmd: 0x%x, arg: 0x%lx\n", minor, cmd, arg); | |
587 | #endif | |
588 | if (minor >= LP_NO) | |
589 | return -ENODEV; | |
590 | if ((LP_F(minor) & LP_EXIST) == 0) | |
591 | return -ENODEV; | |
592 | switch ( cmd ) { | |
1da177e4 | 593 | case LPTIME: |
1c2de820 YX |
594 | if (arg > UINT_MAX / HZ) |
595 | return -EINVAL; | |
1da177e4 LT |
596 | LP_TIME(minor) = arg * HZ/100; |
597 | break; | |
598 | case LPCHAR: | |
599 | LP_CHAR(minor) = arg; | |
600 | break; | |
601 | case LPABORT: | |
602 | if (arg) | |
603 | LP_F(minor) |= LP_ABORT; | |
604 | else | |
605 | LP_F(minor) &= ~LP_ABORT; | |
606 | break; | |
607 | case LPABORTOPEN: | |
608 | if (arg) | |
609 | LP_F(minor) |= LP_ABORTOPEN; | |
610 | else | |
611 | LP_F(minor) &= ~LP_ABORTOPEN; | |
612 | break; | |
613 | case LPCAREFUL: | |
614 | if (arg) | |
615 | LP_F(minor) |= LP_CAREFUL; | |
616 | else | |
617 | LP_F(minor) &= ~LP_CAREFUL; | |
618 | break; | |
619 | case LPWAIT: | |
620 | LP_WAIT(minor) = arg; | |
621 | break; | |
69f92163 | 622 | case LPSETIRQ: |
1da177e4 LT |
623 | return -EINVAL; |
624 | break; | |
625 | case LPGETIRQ: | |
626 | if (copy_to_user(argp, &LP_IRQ(minor), | |
627 | sizeof(int))) | |
628 | return -EFAULT; | |
629 | break; | |
630 | case LPGETSTATUS: | |
221ba151 | 631 | if (mutex_lock_interruptible(&lp_table[minor].port_mutex)) |
632 | return -EINTR; | |
885b3680 | 633 | lp_claim_parport_or_block(&lp_table[minor]); |
1da177e4 | 634 | status = r_str(minor); |
885b3680 | 635 | lp_release_parport(&lp_table[minor]); |
221ba151 | 636 | mutex_unlock(&lp_table[minor].port_mutex); |
1da177e4 LT |
637 | |
638 | if (copy_to_user(argp, &status, sizeof(int))) | |
639 | return -EFAULT; | |
640 | break; | |
641 | case LPRESET: | |
642 | lp_reset(minor); | |
643 | break; | |
644 | #ifdef LP_STATS | |
645 | case LPGETSTATS: | |
646 | if (copy_to_user(argp, &LP_STAT(minor), | |
647 | sizeof(struct lp_stats))) | |
648 | return -EFAULT; | |
649 | if (capable(CAP_SYS_ADMIN)) | |
650 | memset(&LP_STAT(minor), 0, | |
651 | sizeof(struct lp_stats)); | |
652 | break; | |
653 | #endif | |
1b3451e0 SM |
654 | case LPGETFLAGS: |
655 | status = LP_F(minor); | |
1da177e4 LT |
656 | if (copy_to_user(argp, &status, sizeof(int))) |
657 | return -EFAULT; | |
658 | break; | |
659 | ||
1da177e4 LT |
660 | default: |
661 | retval = -EINVAL; | |
662 | } | |
663 | return retval; | |
664 | } | |
665 | ||
9a450484 | 666 | static int lp_set_timeout(unsigned int minor, s64 tv_sec, long tv_usec) |
3695669c AB |
667 | { |
668 | long to_jiffies; | |
669 | ||
670 | /* Convert to jiffies, place in lp_table */ | |
9a450484 | 671 | if (tv_sec < 0 || tv_usec < 0) |
3695669c | 672 | return -EINVAL; |
9a450484 AB |
673 | |
674 | /* | |
675 | * we used to not check, so let's not make this fatal, | |
676 | * but deal with user space passing a 32-bit tv_nsec in | |
677 | * a 64-bit field, capping the timeout to 1 second | |
678 | * worth of microseconds, and capping the total at | |
679 | * MAX_JIFFY_OFFSET. | |
680 | */ | |
681 | if (tv_usec > 999999) | |
682 | tv_usec = 999999; | |
683 | ||
684 | if (tv_sec >= MAX_SEC_IN_JIFFIES - 1) { | |
685 | to_jiffies = MAX_JIFFY_OFFSET; | |
686 | } else { | |
687 | to_jiffies = DIV_ROUND_UP(tv_usec, 1000000/HZ); | |
688 | to_jiffies += tv_sec * (long) HZ; | |
3695669c | 689 | } |
9a450484 | 690 | |
3695669c AB |
691 | if (to_jiffies <= 0) { |
692 | return -EINVAL; | |
693 | } | |
694 | lp_table[minor].timeout = to_jiffies; | |
695 | return 0; | |
696 | } | |
697 | ||
9a450484 AB |
698 | static int lp_set_timeout32(unsigned int minor, void __user *arg) |
699 | { | |
700 | s32 karg[2]; | |
701 | ||
702 | if (copy_from_user(karg, arg, sizeof(karg))) | |
703 | return -EFAULT; | |
704 | ||
705 | return lp_set_timeout(minor, karg[0], karg[1]); | |
706 | } | |
707 | ||
708 | static int lp_set_timeout64(unsigned int minor, void __user *arg) | |
709 | { | |
710 | s64 karg[2]; | |
711 | ||
712 | if (copy_from_user(karg, arg, sizeof(karg))) | |
713 | return -EFAULT; | |
714 | ||
715 | return lp_set_timeout(minor, karg[0], karg[1]); | |
716 | } | |
717 | ||
3695669c AB |
718 | static long lp_ioctl(struct file *file, unsigned int cmd, |
719 | unsigned long arg) | |
720 | { | |
721 | unsigned int minor; | |
3695669c AB |
722 | int ret; |
723 | ||
496ad9aa | 724 | minor = iminor(file_inode(file)); |
613655fa | 725 | mutex_lock(&lp_mutex); |
3695669c | 726 | switch (cmd) { |
9a450484 AB |
727 | case LPSETTIMEOUT_OLD: |
728 | if (BITS_PER_LONG == 32) { | |
729 | ret = lp_set_timeout32(minor, (void __user *)arg); | |
3695669c AB |
730 | break; |
731 | } | |
9a450484 AB |
732 | /* fallthrough for 64-bit */ |
733 | case LPSETTIMEOUT_NEW: | |
734 | ret = lp_set_timeout64(minor, (void __user *)arg); | |
3695669c AB |
735 | break; |
736 | default: | |
737 | ret = lp_do_ioctl(minor, cmd, arg, (void __user *)arg); | |
738 | break; | |
739 | } | |
613655fa | 740 | mutex_unlock(&lp_mutex); |
3695669c AB |
741 | |
742 | return ret; | |
743 | } | |
744 | ||
745 | #ifdef CONFIG_COMPAT | |
746 | static long lp_compat_ioctl(struct file *file, unsigned int cmd, | |
747 | unsigned long arg) | |
748 | { | |
749 | unsigned int minor; | |
3695669c AB |
750 | int ret; |
751 | ||
496ad9aa | 752 | minor = iminor(file_inode(file)); |
613655fa | 753 | mutex_lock(&lp_mutex); |
3695669c | 754 | switch (cmd) { |
9a450484 AB |
755 | case LPSETTIMEOUT_OLD: |
756 | if (!COMPAT_USE_64BIT_TIME) { | |
757 | ret = lp_set_timeout32(minor, (void __user *)arg); | |
3695669c AB |
758 | break; |
759 | } | |
9a450484 AB |
760 | /* fallthrough for x32 mode */ |
761 | case LPSETTIMEOUT_NEW: | |
762 | ret = lp_set_timeout64(minor, (void __user *)arg); | |
3695669c AB |
763 | break; |
764 | #ifdef LP_STATS | |
765 | case LPGETSTATS: | |
766 | /* FIXME: add an implementation if you set LP_STATS */ | |
767 | ret = -EINVAL; | |
768 | break; | |
769 | #endif | |
770 | default: | |
771 | ret = lp_do_ioctl(minor, cmd, arg, compat_ptr(arg)); | |
772 | break; | |
773 | } | |
613655fa | 774 | mutex_unlock(&lp_mutex); |
3695669c AB |
775 | |
776 | return ret; | |
777 | } | |
778 | #endif | |
779 | ||
62322d25 | 780 | static const struct file_operations lp_fops = { |
1da177e4 LT |
781 | .owner = THIS_MODULE, |
782 | .write = lp_write, | |
3695669c AB |
783 | .unlocked_ioctl = lp_ioctl, |
784 | #ifdef CONFIG_COMPAT | |
785 | .compat_ioctl = lp_compat_ioctl, | |
786 | #endif | |
1da177e4 LT |
787 | .open = lp_open, |
788 | .release = lp_release, | |
789 | #ifdef CONFIG_PARPORT_1284 | |
790 | .read = lp_read, | |
791 | #endif | |
6038f373 | 792 | .llseek = noop_llseek, |
1da177e4 LT |
793 | }; |
794 | ||
795 | /* --- support for console on the line printer ----------------- */ | |
796 | ||
797 | #ifdef CONFIG_LP_CONSOLE | |
798 | ||
799 | #define CONSOLE_LP 0 | |
800 | ||
801 | /* If the printer is out of paper, we can either lose the messages or | |
802 | * stall until the printer is happy again. Define CONSOLE_LP_STRICT | |
803 | * non-zero to get the latter behaviour. */ | |
804 | #define CONSOLE_LP_STRICT 1 | |
805 | ||
806 | /* The console must be locked when we get here. */ | |
807 | ||
885b3680 SM |
808 | static void lp_console_write(struct console *co, const char *s, |
809 | unsigned count) | |
1da177e4 LT |
810 | { |
811 | struct pardevice *dev = lp_table[CONSOLE_LP].dev; | |
812 | struct parport *port = dev->port; | |
813 | ssize_t written; | |
814 | ||
885b3680 | 815 | if (parport_claim(dev)) |
1da177e4 LT |
816 | /* Nothing we can do. */ |
817 | return; | |
818 | ||
885b3680 | 819 | parport_set_timeout(dev, 0); |
1da177e4 LT |
820 | |
821 | /* Go to compatibility mode. */ | |
885b3680 | 822 | parport_negotiate(port, IEEE1284_MODE_COMPAT); |
1da177e4 LT |
823 | |
824 | do { | |
825 | /* Write the data, converting LF->CRLF as we go. */ | |
826 | ssize_t canwrite = count; | |
885b3680 | 827 | char *lf = memchr(s, '\n', count); |
1da177e4 LT |
828 | if (lf) |
829 | canwrite = lf - s; | |
830 | ||
831 | if (canwrite > 0) { | |
885b3680 | 832 | written = parport_write(port, s, canwrite); |
1da177e4 LT |
833 | |
834 | if (written <= 0) | |
835 | continue; | |
836 | ||
837 | s += written; | |
838 | count -= written; | |
839 | canwrite -= written; | |
840 | } | |
841 | ||
842 | if (lf && canwrite <= 0) { | |
843 | const char *crlf = "\r\n"; | |
844 | int i = 2; | |
845 | ||
846 | /* Dodge the original '\n', and put '\r\n' instead. */ | |
847 | s++; | |
848 | count--; | |
849 | do { | |
885b3680 | 850 | written = parport_write(port, crlf, i); |
1da177e4 LT |
851 | if (written > 0) |
852 | i -= written, crlf += written; | |
853 | } while (i > 0 && (CONSOLE_LP_STRICT || written > 0)); | |
854 | } | |
855 | } while (count > 0 && (CONSOLE_LP_STRICT || written > 0)); | |
856 | ||
885b3680 | 857 | parport_release(dev); |
1da177e4 LT |
858 | } |
859 | ||
860 | static struct console lpcons = { | |
861 | .name = "lp", | |
862 | .write = lp_console_write, | |
863 | .flags = CON_PRINTBUFFER, | |
864 | }; | |
865 | ||
866 | #endif /* console on line printer */ | |
867 | ||
868 | /* --- initialisation code ------------------------------------- */ | |
869 | ||
870 | static int parport_nr[LP_NO] = { [0 ... LP_NO-1] = LP_PARPORT_UNSPEC }; | |
f4a1c2bc | 871 | static char *parport[LP_NO]; |
90ab5ee9 | 872 | static bool reset; |
1da177e4 LT |
873 | |
874 | module_param_array(parport, charp, NULL, 0); | |
875 | module_param(reset, bool, 0); | |
876 | ||
877 | #ifndef MODULE | |
885b3680 | 878 | static int __init lp_setup(char *str) |
1da177e4 | 879 | { |
f4a1c2bc | 880 | static int parport_ptr; |
1da177e4 LT |
881 | int x; |
882 | ||
f4a1c2bc | 883 | if (get_option(&str, &x)) { |
1da177e4 LT |
884 | if (x == 0) { |
885 | /* disable driver on "lp=" or "lp=0" */ | |
886 | parport_nr[0] = LP_PARPORT_OFF; | |
887 | } else { | |
888 | printk(KERN_WARNING "warning: 'lp=0x%x' is deprecated, ignored\n", x); | |
889 | return 0; | |
890 | } | |
891 | } else if (!strncmp(str, "parport", 7)) { | |
892 | int n = simple_strtoul(str+7, NULL, 10); | |
893 | if (parport_ptr < LP_NO) | |
894 | parport_nr[parport_ptr++] = n; | |
895 | else | |
896 | printk(KERN_INFO "lp: too many ports, %s ignored.\n", | |
897 | str); | |
898 | } else if (!strcmp(str, "auto")) { | |
899 | parport_nr[0] = LP_PARPORT_AUTO; | |
900 | } else if (!strcmp(str, "none")) { | |
3e21f4af WT |
901 | if (parport_ptr < LP_NO) |
902 | parport_nr[parport_ptr++] = LP_PARPORT_NONE; | |
903 | else | |
904 | printk(KERN_INFO "lp: too many ports, %s ignored.\n", | |
905 | str); | |
1da177e4 | 906 | } else if (!strcmp(str, "reset")) { |
9ff6576e | 907 | reset = true; |
1da177e4 LT |
908 | } |
909 | return 1; | |
910 | } | |
911 | #endif | |
912 | ||
913 | static int lp_register(int nr, struct parport *port) | |
914 | { | |
fdfaef21 SM |
915 | struct pardev_cb ppdev_cb; |
916 | ||
917 | memset(&ppdev_cb, 0, sizeof(ppdev_cb)); | |
918 | ppdev_cb.preempt = lp_preempt; | |
919 | ppdev_cb.private = &lp_table[nr]; | |
920 | lp_table[nr].dev = parport_register_dev_model(port, "lp", | |
921 | &ppdev_cb, nr); | |
1da177e4 LT |
922 | if (lp_table[nr].dev == NULL) |
923 | return 1; | |
924 | lp_table[nr].flags |= LP_EXIST; | |
925 | ||
926 | if (reset) | |
927 | lp_reset(nr); | |
928 | ||
03457cd4 GKH |
929 | device_create(lp_class, port->dev, MKDEV(LP_MAJOR, nr), NULL, |
930 | "lp%d", nr); | |
1da177e4 | 931 | |
69f92163 | 932 | printk(KERN_INFO "lp%d: using %s (%s).\n", nr, port->name, |
1da177e4 LT |
933 | (port->irq == PARPORT_IRQ_NONE)?"polling":"interrupt-driven"); |
934 | ||
935 | #ifdef CONFIG_LP_CONSOLE | |
936 | if (!nr) { | |
937 | if (port->modes & PARPORT_MODE_SAFEININT) { | |
f4a1c2bc | 938 | register_console(&lpcons); |
1da177e4 | 939 | console_registered = port; |
885b3680 | 940 | printk(KERN_INFO "lp%d: console ready\n", CONSOLE_LP); |
1da177e4 | 941 | } else |
885b3680 SM |
942 | printk(KERN_ERR "lp%d: cannot run console on %s\n", |
943 | CONSOLE_LP, port->name); | |
1da177e4 LT |
944 | } |
945 | #endif | |
0edf39d2 | 946 | port_num[nr] = port->number; |
1da177e4 LT |
947 | |
948 | return 0; | |
949 | } | |
950 | ||
885b3680 | 951 | static void lp_attach(struct parport *port) |
1da177e4 LT |
952 | { |
953 | unsigned int i; | |
954 | ||
f4a1c2bc | 955 | switch (parport_nr[0]) { |
1da177e4 LT |
956 | case LP_PARPORT_UNSPEC: |
957 | case LP_PARPORT_AUTO: | |
958 | if (parport_nr[0] == LP_PARPORT_AUTO && | |
959 | port->probe_info[0].class != PARPORT_CLASS_PRINTER) | |
960 | return; | |
961 | if (lp_count == LP_NO) { | |
962 | printk(KERN_INFO "lp: ignoring parallel port (max. %d)\n",LP_NO); | |
963 | return; | |
964 | } | |
dc34da42 SM |
965 | for (i = 0; i < LP_NO; i++) |
966 | if (port_num[i] == -1) | |
967 | break; | |
968 | ||
969 | if (!lp_register(i, port)) | |
1da177e4 LT |
970 | lp_count++; |
971 | break; | |
972 | ||
973 | default: | |
974 | for (i = 0; i < LP_NO; i++) { | |
975 | if (port->number == parport_nr[i]) { | |
976 | if (!lp_register(i, port)) | |
977 | lp_count++; | |
978 | break; | |
979 | } | |
980 | } | |
981 | break; | |
982 | } | |
983 | } | |
984 | ||
885b3680 | 985 | static void lp_detach(struct parport *port) |
1da177e4 | 986 | { |
d6318c0e SM |
987 | int n; |
988 | ||
1da177e4 LT |
989 | /* Write this some day. */ |
990 | #ifdef CONFIG_LP_CONSOLE | |
991 | if (console_registered == port) { | |
f4a1c2bc | 992 | unregister_console(&lpcons); |
1da177e4 LT |
993 | console_registered = NULL; |
994 | } | |
995 | #endif /* CONFIG_LP_CONSOLE */ | |
d6318c0e SM |
996 | |
997 | for (n = 0; n < LP_NO; n++) { | |
998 | if (port_num[n] == port->number) { | |
999 | port_num[n] = -1; | |
e379c1a4 | 1000 | lp_count--; |
d6318c0e SM |
1001 | device_destroy(lp_class, MKDEV(LP_MAJOR, n)); |
1002 | parport_unregister_device(lp_table[n].dev); | |
1003 | } | |
1004 | } | |
1da177e4 LT |
1005 | } |
1006 | ||
1007 | static struct parport_driver lp_driver = { | |
1008 | .name = "lp", | |
fdfaef21 | 1009 | .match_port = lp_attach, |
1da177e4 | 1010 | .detach = lp_detach, |
fdfaef21 | 1011 | .devmodel = true, |
1da177e4 LT |
1012 | }; |
1013 | ||
885b3680 | 1014 | static int __init lp_init(void) |
1da177e4 LT |
1015 | { |
1016 | int i, err = 0; | |
1017 | ||
1018 | if (parport_nr[0] == LP_PARPORT_OFF) | |
1019 | return 0; | |
1020 | ||
1021 | for (i = 0; i < LP_NO; i++) { | |
1022 | lp_table[i].dev = NULL; | |
1023 | lp_table[i].flags = 0; | |
1024 | lp_table[i].chars = LP_INIT_CHAR; | |
1025 | lp_table[i].time = LP_INIT_TIME; | |
1026 | lp_table[i].wait = LP_INIT_WAIT; | |
1027 | lp_table[i].lp_buffer = NULL; | |
1028 | #ifdef LP_STATS | |
1029 | lp_table[i].lastcall = 0; | |
1030 | lp_table[i].runchars = 0; | |
885b3680 | 1031 | memset(&lp_table[i].stats, 0, sizeof(struct lp_stats)); |
1da177e4 LT |
1032 | #endif |
1033 | lp_table[i].last_error = 0; | |
885b3680 SM |
1034 | init_waitqueue_head(&lp_table[i].waitq); |
1035 | init_waitqueue_head(&lp_table[i].dataq); | |
0a5dcb51 | 1036 | mutex_init(&lp_table[i].port_mutex); |
1da177e4 | 1037 | lp_table[i].timeout = 10 * HZ; |
0edf39d2 | 1038 | port_num[i] = -1; |
1da177e4 LT |
1039 | } |
1040 | ||
885b3680 SM |
1041 | if (register_chrdev(LP_MAJOR, "lp", &lp_fops)) { |
1042 | printk(KERN_ERR "lp: unable to get major %d\n", LP_MAJOR); | |
1da177e4 LT |
1043 | return -EIO; |
1044 | } | |
1045 | ||
ca8eca68 | 1046 | lp_class = class_create(THIS_MODULE, "printer"); |
1da177e4 LT |
1047 | if (IS_ERR(lp_class)) { |
1048 | err = PTR_ERR(lp_class); | |
d09d7ddf | 1049 | goto out_reg; |
1da177e4 LT |
1050 | } |
1051 | ||
885b3680 SM |
1052 | if (parport_register_driver(&lp_driver)) { |
1053 | printk(KERN_ERR "lp: unable to register with parport\n"); | |
1da177e4 LT |
1054 | err = -EIO; |
1055 | goto out_class; | |
1056 | } | |
1057 | ||
1058 | if (!lp_count) { | |
885b3680 | 1059 | printk(KERN_INFO "lp: driver loaded but no devices found\n"); |
1da177e4 LT |
1060 | #ifndef CONFIG_PARPORT_1284 |
1061 | if (parport_nr[0] == LP_PARPORT_AUTO) | |
885b3680 | 1062 | printk(KERN_INFO "lp: (is IEEE 1284 support enabled?)\n"); |
1da177e4 LT |
1063 | #endif |
1064 | } | |
1065 | ||
1066 | return 0; | |
1067 | ||
1068 | out_class: | |
ca8eca68 | 1069 | class_destroy(lp_class); |
d09d7ddf | 1070 | out_reg: |
1da177e4 LT |
1071 | unregister_chrdev(LP_MAJOR, "lp"); |
1072 | return err; | |
1073 | } | |
1074 | ||
885b3680 | 1075 | static int __init lp_init_module(void) |
1da177e4 LT |
1076 | { |
1077 | if (parport[0]) { | |
1078 | /* The user gave some parameters. Let's see what they were. */ | |
1079 | if (!strncmp(parport[0], "auto", 4)) | |
1080 | parport_nr[0] = LP_PARPORT_AUTO; | |
1081 | else { | |
1082 | int n; | |
1083 | for (n = 0; n < LP_NO && parport[n]; n++) { | |
1084 | if (!strncmp(parport[n], "none", 4)) | |
1085 | parport_nr[n] = LP_PARPORT_NONE; | |
1086 | else { | |
1087 | char *ep; | |
1088 | unsigned long r = simple_strtoul(parport[n], &ep, 0); | |
69f92163 | 1089 | if (ep != parport[n]) |
1da177e4 LT |
1090 | parport_nr[n] = r; |
1091 | else { | |
1092 | printk(KERN_ERR "lp: bad port specifier `%s'\n", parport[n]); | |
1093 | return -ENODEV; | |
1094 | } | |
1095 | } | |
1096 | } | |
1097 | } | |
1098 | } | |
1099 | ||
1100 | return lp_init(); | |
1101 | } | |
1102 | ||
885b3680 | 1103 | static void lp_cleanup_module(void) |
1da177e4 | 1104 | { |
885b3680 | 1105 | parport_unregister_driver(&lp_driver); |
1da177e4 LT |
1106 | |
1107 | #ifdef CONFIG_LP_CONSOLE | |
885b3680 | 1108 | unregister_console(&lpcons); |
1da177e4 LT |
1109 | #endif |
1110 | ||
1111 | unregister_chrdev(LP_MAJOR, "lp"); | |
ca8eca68 | 1112 | class_destroy(lp_class); |
1da177e4 LT |
1113 | } |
1114 | ||
1115 | __setup("lp=", lp_setup); | |
1116 | module_init(lp_init_module); | |
1117 | module_exit(lp_cleanup_module); | |
1118 | ||
1119 | MODULE_ALIAS_CHARDEV_MAJOR(LP_MAJOR); | |
1120 | MODULE_LICENSE("GPL"); |