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