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