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