drivers/char/lp.c

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