[PATCH] macintosh/adbhid.c: adb buttons support for aluminium PowerBook G4

[linux-2.6] / drivers / cdrom / sonycd535.c

/*
 * Sony CDU-535 interface device driver
 *
 * This is a modified version of the CDU-31A device driver (see below).
 * Changes were made using documentation for the CDU-531 (which Sony
 * assures me is very similar to the 535) and partial disassembly of the
 * DOS driver.  I used Minyard's driver and replaced the CDU-31A
 * commands with the CDU-531 commands.  This was complicated by a different
 * interface protocol with the drive.  The driver is still polled.
 *
 * Data transfer rate is about 110 Kb/sec, theoretical maximum is 150 Kb/sec.
 * I tried polling without the sony_sleep during the data transfers but
 * it did not speed things up any.
 *
 * 1993-05-23 (rgj) changed the major number to 21 to get rid of conflict
 * with CDU-31A driver.  This is the also the number from the Linux
 * Device Driver Registry for the Sony Drive.  Hope nobody else is using it.
 *
 * 1993-08-29 (rgj) remove the configuring of the interface board address
 * from the top level configuration, you have to modify it in this file.
 *
 * 1995-01-26 Made module-capable (Joel Katz <Stimpson@Panix.COM>)
 *
 * 1995-05-20
 *  Modified to support CDU-510/515 series
 *      (Claudio Porfiri<C.Porfiri@nisms.tei.ericsson.se>)
 *  Fixed to report verify_area() failures
 *      (Heiko Eissfeldt <heiko@colossus.escape.de>)
 *
 * 1995-06-01
 *  More changes to support CDU-510/515 series
 *      (Claudio Porfiri<C.Porfiri@nisms.tei.ericsson.se>)
 *
 * November 1999 -- Make kernel-parameter implementation work with 2.3.x 
 *                  Removed init_module & cleanup_module in favor of 
 *                  module_init & module_exit.
 *                  Torben Mathiasen <tmm@image.dk>
 *
 * September 2003 - Fix SMP support by removing cli/sti calls.
 *                  Using spinlocks with a wait_queue instead.
 *                  Felipe Damasio <felipewd@terra.com.br>
 *
 * Things to do:
 *  - handle errors and status better, put everything into a single word
 *  - use interrupts (code mostly there, but a big hole still missing)
 *  - handle multi-session CDs?
 *  - use DMA?
 *
 *  Known Bugs:
 *  -
 *
 *   Ken Pizzini (ken@halcyon.com)
 *
 * Original by:
 *   Ron Jeppesen (ronj.an@site007.saic.com)
 *
 *
 *------------------------------------------------------------------------
 * Sony CDROM interface device driver.
 *
 * Corey Minyard (minyard@wf-rch.cirr.com) (CDU-535 complaints to Ken above)
 *
 * Colossians 3:17
 *
 * The Sony interface device driver handles Sony interface CDROM
 * drives and provides a complete block-level interface as well as an
 * ioctl() interface compatible with the Sun (as specified in
 * include/linux/cdrom.h).  With this interface, CDROMs can be
 * accessed and standard audio CDs can be played back normally.
 *
 * This interface is (unfortunately) a polled interface.  This is
 * because most Sony interfaces are set up with DMA and interrupts
 * disables.  Some (like mine) do not even have the capability to
 * handle interrupts or DMA.  For this reason you will see a bit of
 * the following:
 *
 *   snap = jiffies;
 *   while (jiffies-snap < SONY_JIFFIES_TIMEOUT)
 *   {
 *              if (some_condition())
 *         break;
 *      sony_sleep();
 *   }
 *   if (some_condition not met)
 *   {
 *      return an_error;
 *   }
 *
 * This ugly hack waits for something to happen, sleeping a little
 * between every try.  (The conditional is written so that jiffies
 * wrap-around is handled properly.)
 *
 * One thing about these drives: They talk in MSF (Minute Second Frame) format.
 * There are 75 frames a second, 60 seconds a minute, and up to 75 minutes on a
 * disk.  The funny thing is that these are sent to the drive in BCD, but the
 * interface wants to see them in decimal.  A lot of conversion goes on.
 *
 *  Copyright (C) 1993  Corey Minyard
 *
 *  This program is free software; you can redistribute it and/or modify
 *  it under the terms of the GNU General Public License as published by
 *  the Free Software Foundation; either version 2 of the License, or
 *  (at your option) any later version.
 *
 *  This program is distributed in the hope that it will be useful,
 *  but WITHOUT ANY WARRANTY; without even the implied warranty of
 *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 *  GNU General Public License for more details.
 *
 *  You should have received a copy of the GNU General Public License
 *  along with this program; if not, write to the Free Software
 *  Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
 *
 */


# include <linux/module.h>

#include <linux/errno.h>
#include <linux/signal.h>
#include <linux/sched.h>
#include <linux/timer.h>
#include <linux/fs.h>
#include <linux/kernel.h>
#include <linux/interrupt.h>
#include <linux/ioport.h>
#include <linux/hdreg.h>
#include <linux/genhd.h>
#include <linux/mm.h>
#include <linux/slab.h>
#include <linux/init.h>

#define REALLY_SLOW_IO
#include <asm/system.h>
#include <asm/io.h>
#include <asm/uaccess.h>

#include <linux/cdrom.h>

#define MAJOR_NR CDU535_CDROM_MAJOR
#include <linux/blkdev.h>

#define sony535_cd_base_io sonycd535 /* for compatible parameter passing with "insmod" */
#include "sonycd535.h"

/*
 * this is the base address of the interface card for the Sony CDU-535
 * CDROM drive.  If your jumpers are set for an address other than
 * this one (the default), change the following line to the
 * proper address.
 */
#ifndef CDU535_ADDRESS
# define CDU535_ADDRESS                 0x340
#endif
#ifndef CDU535_INTERRUPT
# define CDU535_INTERRUPT               0
#endif
#ifndef CDU535_HANDLE
# define CDU535_HANDLE                  "cdu535"
#endif
#ifndef CDU535_MESSAGE_NAME
# define CDU535_MESSAGE_NAME    "Sony CDU-535"
#endif

#define CDU535_BLOCK_SIZE       2048 
 
#ifndef MAX_SPINUP_RETRY
# define MAX_SPINUP_RETRY               3       /* 1 is sufficient for most drives... */
#endif
#ifndef RETRY_FOR_BAD_STATUS
# define RETRY_FOR_BAD_STATUS   100     /* in 10th of second */
#endif

#ifndef DEBUG
# define DEBUG  1
#endif

/*
 *  SONY535_BUFFER_SIZE determines the size of internal buffer used
 *  by the drive.  It must be at least 2K and the larger the buffer
 *  the better the transfer rate.  It does however take system memory.
 *  On my system I get the following transfer rates using dd to read
 *  10 Mb off /dev/cdrom.
 *
 *    8K buffer      43 Kb/sec
 *   16K buffer      66 Kb/sec
 *   32K buffer      91 Kb/sec
 *   64K buffer     111 Kb/sec
 *  128K buffer     123 Kb/sec
 *  512K buffer     123 Kb/sec
 */
#define SONY535_BUFFER_SIZE     (64*1024)

/*
 *  if LOCK_DOORS is defined then the eject button is disabled while
 * the device is open.
 */
#ifndef NO_LOCK_DOORS
# define LOCK_DOORS
#endif

static int read_subcode(void);
static void sony_get_toc(void);
static int cdu_open(struct inode *inode, struct file *filp);
static inline unsigned int int_to_bcd(unsigned int val);
static unsigned int bcd_to_int(unsigned int bcd);
static int do_sony_cmd(Byte * cmd, int nCmd, Byte status[2],
                                           Byte * response, int n_response, int ignoreStatusBit7);

/* The base I/O address of the Sony Interface.  This is a variable (not a
   #define) so it can be easily changed via some future ioctl() */
static unsigned int sony535_cd_base_io = CDU535_ADDRESS;
module_param(sony535_cd_base_io, int, 0);

/*
 * The following are I/O addresses of the various registers for the drive.  The
 * comment for the base address also applies here.
 */
static unsigned short select_unit_reg;
static unsigned short result_reg;
static unsigned short command_reg;
static unsigned short read_status_reg;
static unsigned short data_reg;

static DEFINE_SPINLOCK(sonycd535_lock); /* queue lock */
static struct request_queue *sonycd535_queue;

static int initialized;                 /* Has the drive been initialized? */
static int sony_disc_changed = 1;       /* Has the disk been changed
                                           since the last check? */
static int sony_toc_read;               /* Has the table of contents been
                                           read? */
static unsigned int sony_buffer_size;   /* Size in bytes of the read-ahead
                                           buffer. */
static unsigned int sony_buffer_sectors;        /* Size (in 2048 byte records) of
                                                   the read-ahead buffer. */
static unsigned int sony_usage;         /* How many processes have the
                                           drive open. */

static int sony_first_block = -1;       /* First OS block (512 byte) in
                                           the read-ahead buffer */
static int sony_last_block = -1;        /* Last OS block (512 byte) in
                                           the read-ahead buffer */

static struct s535_sony_toc *sony_toc;  /* Points to the table of
                                           contents. */

static struct s535_sony_subcode *last_sony_subcode;             /* Points to the last
                                                                   subcode address read */
static Byte **sony_buffer;              /* Points to the pointers
                                           to the sector buffers */

static int sony_inuse;                  /* is the drive in use? Only one
                                           open at a time allowed */

/*
 * The audio status uses the values from read subchannel data as specified
 * in include/linux/cdrom.h.
 */
static int sony_audio_status = CDROM_AUDIO_NO_STATUS;

/*
 * The following are a hack for pausing and resuming audio play.  The drive
 * does not work as I would expect it, if you stop it then start it again,
 * the drive seeks back to the beginning and starts over.  This holds the
 * position during a pause so a resume can restart it.  It uses the
 * audio status variable above to tell if it is paused.
 *   I just kept the CDU-31A driver behavior rather than using the PAUSE
 * command on the CDU-535.
 */
static Byte cur_pos_msf[3];
static Byte final_pos_msf[3];

/* What IRQ is the drive using?  0 if none. */
static int sony535_irq_used = CDU535_INTERRUPT;

/* The interrupt handler will wake this queue up when it gets an interrupt. */
static DECLARE_WAIT_QUEUE_HEAD(cdu535_irq_wait);


/*
 * This routine returns 1 if the disk has been changed since the last
 * check or 0 if it hasn't.  Setting flag to 0 resets the changed flag.
 */
static int
cdu535_check_media_change(struct gendisk *disk)
{
        /* if driver is not initialized, always return 0 */
        int retval = initialized ? sony_disc_changed : 0;
        sony_disc_changed = 0;
        return retval;
}

static inline void
enable_interrupts(void)
{
#ifdef USE_IRQ
        /*
         * This code was taken from cdu31a.c; it will not
         * directly work for the cdu535 as written...
         */
        curr_control_reg |= ( SONY_ATTN_INT_EN_BIT
                                                | SONY_RES_RDY_INT_EN_BIT
                                                | SONY_DATA_RDY_INT_EN_BIT);
        outb(curr_control_reg, sony_cd_control_reg);
#endif
}

static inline void
disable_interrupts(void)
{
#ifdef USE_IRQ
        /*
         * This code was taken from cdu31a.c; it will not
         * directly work for the cdu535 as written...
         */
        curr_control_reg &= ~(SONY_ATTN_INT_EN_BIT
                                                | SONY_RES_RDY_INT_EN_BIT
                                                | SONY_DATA_RDY_INT_EN_BIT);
        outb(curr_control_reg, sony_cd_control_reg);
#endif
}

static irqreturn_t
cdu535_interrupt(int irq, void *dev_id, struct pt_regs *regs)
{
        disable_interrupts();
        if (waitqueue_active(&cdu535_irq_wait)) {
                wake_up(&cdu535_irq_wait);
                return IRQ_HANDLED;
        }
        printk(CDU535_MESSAGE_NAME
                        ": Got an interrupt but nothing was waiting\n");
        return IRQ_NONE;
}


/*
 * Wait a little while.
 */
static inline void
sony_sleep(void)
{
        if (sony535_irq_used <= 0) {    /* poll */
                yield();
        } else {        /* Interrupt driven */
                DEFINE_WAIT(wait);
                
                spin_lock_irq(&sonycd535_lock);
                enable_interrupts();
                prepare_to_wait(&cdu535_irq_wait, &wait, TASK_INTERRUPTIBLE);
                spin_unlock_irq(&sonycd535_lock);
                schedule();
                finish_wait(&cdu535_irq_wait, &wait);
        }
}

/*------------------start of SONY CDU535 very specific ---------------------*/

/****************************************************************************
 * void select_unit( int unit_no )
 *
 *  Select the specified unit (0-3) so that subsequent commands reference it
 ****************************************************************************/
static void
select_unit(int unit_no)
{
        unsigned int select_mask = ~(1 << unit_no);
        outb(select_mask, select_unit_reg);
}

/***************************************************************************
 * int read_result_reg( Byte *data_ptr )
 *
 *  Read a result byte from the Sony CDU controller, store in location pointed
 * to by data_ptr.  Return zero on success, TIME_OUT if we did not receive
 * data.
 ***************************************************************************/
static int
read_result_reg(Byte *data_ptr)
{
        unsigned long snap;
        int read_status;

        snap = jiffies;
        while (jiffies-snap < SONY_JIFFIES_TIMEOUT) {
                read_status = inb(read_status_reg);
                if ((read_status & SONY535_RESULT_NOT_READY_BIT) == 0) {
#if DEBUG > 1
                        printk(CDU535_MESSAGE_NAME
                                        ": read_result_reg(): readStatReg = 0x%x\n", read_status);
#endif
                        *data_ptr = inb(result_reg);
                        return 0;
                } else {
                        sony_sleep();
                }
        }
        printk(CDU535_MESSAGE_NAME " read_result_reg: TIME OUT!\n");
        return TIME_OUT;
}

/****************************************************************************
 * int read_exec_status( Byte status[2] )
 *
 *  Read the execution status of the last command and put into status.
 * Handles reading second status word if available.  Returns 0 on success,
 * TIME_OUT on failure.
 ****************************************************************************/
static int
read_exec_status(Byte status[2])
{
        status[1] = 0;
        if (read_result_reg(&(status[0])) != 0)
                return TIME_OUT;
        if ((status[0] & 0x80) != 0) {  /* byte two follows */
                if (read_result_reg(&(status[1])) != 0)
                        return TIME_OUT;
        }
#if DEBUG > 1
        printk(CDU535_MESSAGE_NAME ": read_exec_status: read 0x%x 0x%x\n",
                        status[0], status[1]);
#endif
        return 0;
}

/****************************************************************************
 * int check_drive_status( void )
 *
 *  Check the current drive status.  Using this before executing a command
 * takes care of the problem of unsolicited drive status-2 messages.
 * Add a check of the audio status if we think the disk is playing.
 ****************************************************************************/
static int
check_drive_status(void)
{
        Byte status, e_status[2];
        int  CDD, ATN;
        Byte cmd;

        select_unit(0);
        if (sony_audio_status == CDROM_AUDIO_PLAY) {    /* check status */
                outb(SONY535_REQUEST_AUDIO_STATUS, command_reg);
                if (read_result_reg(&status) == 0) {
                        switch (status) {
                        case 0x0:
                                break;          /* play in progress */
                        case 0x1:
                                break;          /* paused */
                        case 0x3:               /* audio play completed */
                        case 0x5:               /* play not requested */
                                sony_audio_status = CDROM_AUDIO_COMPLETED;
                                read_subcode();
                                break;
                        case 0x4:               /* error during play */
                                sony_audio_status = CDROM_AUDIO_ERROR;
                                break;
                        }
                }
        }
        /* now check drive status */
        outb(SONY535_REQUEST_DRIVE_STATUS_2, command_reg);
        if (read_result_reg(&status) != 0)
                return TIME_OUT;

#if DEBUG > 1
        printk(CDU535_MESSAGE_NAME ": check_drive_status() got 0x%x\n", status);
#endif

        if (status == 0)
                return 0;

        ATN = status & 0xf;
        CDD = (status >> 4) & 0xf;

        switch (ATN) {
        case 0x0:
                break;                                  /* go on to CDD stuff */
        case SONY535_ATN_BUSY:
                if (initialized)
                        printk(CDU535_MESSAGE_NAME " error: drive busy\n");
                return CD_BUSY;
        case SONY535_ATN_EJECT_IN_PROGRESS:
                printk(CDU535_MESSAGE_NAME " error: eject in progress\n");
                sony_audio_status = CDROM_AUDIO_INVALID;
                return CD_BUSY;
        case SONY535_ATN_RESET_OCCURRED:
        case SONY535_ATN_DISC_CHANGED:
        case SONY535_ATN_RESET_AND_DISC_CHANGED:
#if DEBUG > 0
                printk(CDU535_MESSAGE_NAME " notice: reset occurred or disc changed\n");
#endif
                sony_disc_changed = 1;
                sony_toc_read = 0;
                sony_audio_status = CDROM_AUDIO_NO_STATUS;
                sony_first_block = -1;
                sony_last_block = -1;
                if (initialized) {
                        cmd = SONY535_SPIN_UP;
                        do_sony_cmd(&cmd, 1, e_status, NULL, 0, 0);
                        sony_get_toc();
                }
                return 0;
        default:
                printk(CDU535_MESSAGE_NAME " error: drive busy (ATN=0x%x)\n", ATN);
                return CD_BUSY;
        }
        switch (CDD) {                  /* the 531 docs are not helpful in decoding this */
        case 0x0:                               /* just use the values from the DOS driver */
        case 0x2:
        case 0xa:
                break;                          /* no error */
        case 0xc:
                printk(CDU535_MESSAGE_NAME
                                ": check_drive_status(): CDD = 0xc! Not properly handled!\n");
                return CD_BUSY;         /* ? */
        default:
                return CD_BUSY;
        }
        return 0;
}       /* check_drive_status() */

/*****************************************************************************
 * int do_sony_cmd( Byte *cmd, int n_cmd, Byte status[2],
 *                Byte *response, int n_response, int ignore_status_bit7 )
 *
 *  Generic routine for executing commands.  The command and its parameters
 *  should be placed in the cmd[] array, number of bytes in the command is
 *  stored in nCmd.  The response from the command will be stored in the
 *  response array.  The number of bytes you expect back (excluding status)
 *  should be passed in n_response.  Finally, some
 *  commands set bit 7 of the return status even when there is no second
 *  status byte, on these commands set ignoreStatusBit7 TRUE.
 *    If the command was sent and data received back, then we return 0,
 *  else we return TIME_OUT.  You still have to check the status yourself.
 *    You should call check_drive_status() before calling this routine
 *  so that you do not lose notifications of disk changes, etc.
 ****************************************************************************/
static int
do_sony_cmd(Byte * cmd, int n_cmd, Byte status[2],
                        Byte * response, int n_response, int ignore_status_bit7)
{
        int i;

        /* write out the command */
        for (i = 0; i < n_cmd; i++)
                outb(cmd[i], command_reg);

        /* read back the status */
        if (read_result_reg(status) != 0)
                return TIME_OUT;
        if (!ignore_status_bit7 && ((status[0] & 0x80) != 0)) {
                /* get second status byte */
                if (read_result_reg(status + 1) != 0)
                        return TIME_OUT;
        } else {
                status[1] = 0;
        }
#if DEBUG > 2
        printk(CDU535_MESSAGE_NAME ": do_sony_cmd %x: %x %x\n",
                        *cmd, status[0], status[1]);
#endif

        /* do not know about when I should read set of data and when not to */
        if ((status[0] & ((ignore_status_bit7 ? 0x7f : 0xff) & 0x8f)) != 0)
                return 0;

        /* else, read in rest of data */
        for (i = 0; 0 < n_response; n_response--, i++)
                if (read_result_reg(response + i) != 0)
                        return TIME_OUT;
        return 0;
}       /* do_sony_cmd() */

/**************************************************************************
 * int set_drive_mode( int mode, Byte status[2] )
 *
 *  Set the drive mode to the specified value (mode=0 is audio, mode=e0
 * is mode-1 CDROM
 **************************************************************************/
static int
set_drive_mode(int mode, Byte status[2])
{
        Byte cmd_buff[2];
        Byte ret_buff[1];

        cmd_buff[0] = SONY535_SET_DRIVE_MODE;
        cmd_buff[1] = mode;
        return do_sony_cmd(cmd_buff, 2, status, ret_buff, 1, 1);
}

/***************************************************************************
 * int seek_and_read_N_blocks( Byte params[], int n_blocks, Byte status[2],
 *                             Byte *data_buff, int buff_size )
 *
 *  Read n_blocks of data from the CDROM starting at position params[0:2],
 *  number of blocks in stored in params[3:5] -- both these are already
 *  int bcd format.
 *  Transfer the data into the buffer pointed at by data_buff.  buff_size
 *  gives the number of bytes available in the buffer.
 *    The routine returns number of bytes read in if successful, otherwise
 *  it returns one of the standard error returns.
 ***************************************************************************/
static int
seek_and_read_N_blocks(Byte params[], int n_blocks, Byte status[2],
                                           Byte **buff, int buf_size)
{
        Byte cmd_buff[7];
        int  i;
        int  read_status;
        unsigned long snap;
        Byte *data_buff;
        int  sector_count = 0;

        if (buf_size < CDU535_BLOCK_SIZE * n_blocks)
                return NO_ROOM;

        set_drive_mode(SONY535_CDROM_DRIVE_MODE, status);

        /* send command to read the data */
        cmd_buff[0] = SONY535_SEEK_AND_READ_N_BLOCKS_1;
        for (i = 0; i < 6; i++)
                cmd_buff[i + 1] = params[i];
        for (i = 0; i < 7; i++)
                outb(cmd_buff[i], command_reg);

        /* read back the data one block at a time */
        while (0 < n_blocks--) {
                /* wait for data to be ready */
                int data_valid = 0;
                snap = jiffies;
                while (jiffies-snap < SONY_JIFFIES_TIMEOUT) {
                        read_status = inb(read_status_reg);
                        if ((read_status & SONY535_RESULT_NOT_READY_BIT) == 0) {
                                read_exec_status(status);
                                return BAD_STATUS;
                        }
                        if ((read_status & SONY535_DATA_NOT_READY_BIT) == 0) {
                                /* data is ready, read it */
                                data_buff = buff[sector_count++];
                                for (i = 0; i < CDU535_BLOCK_SIZE; i++)
                                        *data_buff++ = inb(data_reg);   /* unrolling this loop does not seem to help */
                                data_valid = 1;
                                break;                  /* exit the timeout loop */
                        }
                        sony_sleep();           /* data not ready, sleep a while */
                }
                if (!data_valid)
                        return TIME_OUT;        /* if we reach this stage */
        }

        /* read all the data, now read the status */
        if ((i = read_exec_status(status)) != 0)
                return i;
        return CDU535_BLOCK_SIZE * sector_count;
}       /* seek_and_read_N_blocks() */

/****************************************************************************
 * int request_toc_data( Byte status[2], struct s535_sony_toc *toc )
 *
 *  Read in the table of contents data.  Converts all the bcd data
 * into integers in the toc structure.
 ****************************************************************************/
static int
request_toc_data(Byte status[2], struct s535_sony_toc *toc)
{
        int  to_status;
        int  i, j, n_tracks, track_no;
        int  first_track_num, last_track_num;
        Byte cmd_no = 0xb2;
        Byte track_address_buffer[5];

        /* read the fixed portion of the table of contents */
        if ((to_status = do_sony_cmd(&cmd_no, 1, status, (Byte *) toc, 15, 1)) != 0)
                return to_status;

        /* convert the data into integers so we can use them */
        first_track_num = bcd_to_int(toc->first_track_num);
        last_track_num = bcd_to_int(toc->last_track_num);
        n_tracks = last_track_num - first_track_num + 1;

        /* read each of the track address descriptors */
        for (i = 0; i < n_tracks; i++) {
                /* read the descriptor into a temporary buffer */
                for (j = 0; j < 5; j++) {
                        if (read_result_reg(track_address_buffer + j) != 0)
                                return TIME_OUT;
                        if (j == 1)             /* need to convert from bcd */
                                track_no = bcd_to_int(track_address_buffer[j]);
                }
                /* copy the descriptor to proper location - sonycd.c just fills */
                memcpy(toc->tracks + i, track_address_buffer, 5);
        }
        return 0;
}       /* request_toc_data() */

/***************************************************************************
 * int spin_up_drive( Byte status[2] )
 *
 *  Spin up the drive (unless it is already spinning).
 ***************************************************************************/
static int
spin_up_drive(Byte status[2])
{
        Byte cmd;

        /* first see if the drive is already spinning */
        cmd = SONY535_REQUEST_DRIVE_STATUS_1;
        if (do_sony_cmd(&cmd, 1, status, NULL, 0, 0) != 0)
                return TIME_OUT;
        if ((status[0] & SONY535_STATUS1_NOT_SPINNING) == 0)
                return 0;       /* it's already spinning */

        /* otherwise, give the spin-up command */
        cmd = SONY535_SPIN_UP;
        return do_sony_cmd(&cmd, 1, status, NULL, 0, 0);
}

/*--------------------end of SONY CDU535 very specific ---------------------*/

/* Convert from an integer 0-99 to BCD */
static inline unsigned int
int_to_bcd(unsigned int val)
{
        int retval;

        retval = (val / 10) << 4;
        retval = retval | val % 10;
        return retval;
}


/* Convert from BCD to an integer from 0-99 */
static unsigned int
bcd_to_int(unsigned int bcd)
{
        return (((bcd >> 4) & 0x0f) * 10) + (bcd & 0x0f);
}


/*
 * Convert a logical sector value (like the OS would want to use for
 * a block device) to an MSF format.
 */
static void
log_to_msf(unsigned int log, Byte *msf)
{
        log = log + LOG_START_OFFSET;
        msf[0] = int_to_bcd(log / 4500);
        log = log % 4500;
        msf[1] = int_to_bcd(log / 75);
        msf[2] = int_to_bcd(log % 75);
}


/*
 * Convert an MSF format to a logical sector.
 */
static unsigned int
msf_to_log(Byte *msf)
{
        unsigned int log;


        log = bcd_to_int(msf[2]);
        log += bcd_to_int(msf[1]) * 75;
        log += bcd_to_int(msf[0]) * 4500;
        log = log - LOG_START_OFFSET;

        return log;
}


/*
 * Take in integer size value and put it into a buffer like
 * the drive would want to see a number-of-sector value.
 */
static void
size_to_buf(unsigned int size, Byte *buf)
{
        buf[0] = size / 65536;
        size = size % 65536;
        buf[1] = size / 256;
        buf[2] = size % 256;
}


/*
 * The OS calls this to perform a read or write operation to the drive.
 * Write obviously fail.  Reads to a read ahead of sony_buffer_size
 * bytes to help speed operations.  This especially helps since the OS
 * may use 1024 byte blocks and the drive uses 2048 byte blocks.  Since most
 * data access on a CD is done sequentially, this saves a lot of operations.
 */
static void
do_cdu535_request(request_queue_t * q)
{
        struct request *req;
        unsigned int read_size;
        int  block;
        int  nsect;
        int  copyoff;
        int  spin_up_retry;
        Byte params[10];
        Byte status[2];
        Byte cmd[2];

        while (1) {
                req = elv_next_request(q);
                if (!req)
                        return;

                block = req->sector;
                nsect = req->nr_sectors;
                if (!blk_fs_request(req)) {
                        end_request(req, 0);
                        continue;
                }
                if (rq_data_dir(req) == WRITE) {
                        end_request(req, 0);
                        continue;
                }
                /*
                 * If the block address is invalid or the request goes beyond
                 * the end of the media, return an error.
                 */
                if (sony_toc->lead_out_start_lba <= (block/4)) {
                        end_request(req, 0);
                        return;
                }
                if (sony_toc->lead_out_start_lba <= ((block + nsect) / 4)) {
                        end_request(req, 0);
                        return;
                }
                while (0 < nsect) {
                        /*
                         * If the requested sector is not currently in
                         * the read-ahead buffer, it must be read in.
                         */
                        if ((block < sony_first_block) || (sony_last_block < block)) {
                                sony_first_block = (block / 4) * 4;
                                log_to_msf(block / 4, params);
                                
                                /*
                                 * If the full read-ahead would go beyond the end of the media, trim
                                 * it back to read just till the end of the media.
                                 */
                                if (sony_toc->lead_out_start_lba <= ((block / 4) + sony_buffer_sectors)) {
                                        sony_last_block = (sony_toc->lead_out_start_lba * 4) - 1;
                                        read_size = sony_toc->lead_out_start_lba - (block / 4);
                                } else {
                                        sony_last_block = sony_first_block + (sony_buffer_sectors * 4) - 1;
                                        read_size = sony_buffer_sectors;
                                }
                                size_to_buf(read_size, &params[3]);
                                
                                /*
                                 * Read the data.  If the drive was not spinning,
                                 * spin it up and try some more.
                                 */
                                for (spin_up_retry=0 ;; ++spin_up_retry) {
                                        /* This loop has been modified to support the Sony
                                         * CDU-510/515 series, thanks to Claudio Porfiri 
                                         * <C.Porfiri@nisms.tei.ericsson.se>.
                                         */
                                        /*
                                         * This part is to deal with very slow hardware.  We
                                         * try at most MAX_SPINUP_RETRY times to read the same
                                         * block.  A check for seek_and_read_N_blocks' result is
                                         * performed; if the result is wrong, the CDROM's engine
                                         * is restarted and the operation is tried again.
                                         */
                                        /*
                                         * 1995-06-01: The system got problems when downloading
                                         * from Slackware CDROM, the problem seems to be:
                                         * seek_and_read_N_blocks returns BAD_STATUS and we
                                         * should wait for a while before retrying, so a new
                                         * part was added to discriminate the return value from
                                         * seek_and_read_N_blocks for the various cases.
                                         */
                                        int readStatus = seek_and_read_N_blocks(params, read_size,
                                                                                status, sony_buffer, (read_size * CDU535_BLOCK_SIZE));
                                        if (0 <= readStatus)    /* Good data; common case, placed first */
                                                break;
                                        if (readStatus == NO_ROOM || spin_up_retry == MAX_SPINUP_RETRY) {
                                                /* give up */
                                                if (readStatus == NO_ROOM)
                                                        printk(CDU535_MESSAGE_NAME " No room to read from CD\n");
                                                else
                                                        printk(CDU535_MESSAGE_NAME " Read error: 0x%.2x\n",
                                                               status[0]);
                                                sony_first_block = -1;
                                                sony_last_block = -1;
                                                end_request(req, 0);
                                                return;
                                        }
                                        if (readStatus == BAD_STATUS) {
                                                /* Sleep for a while, then retry */
                                                set_current_state(TASK_INTERRUPTIBLE);
                                                spin_unlock_irq(&sonycd535_lock);
                                                schedule_timeout(RETRY_FOR_BAD_STATUS*HZ/10);
                                                spin_lock_irq(&sonycd535_lock);
                                        }
#if DEBUG > 0
                                        printk(CDU535_MESSAGE_NAME
                                               " debug: calling spin up when reading data!\n");
#endif
                                        cmd[0] = SONY535_SPIN_UP;
                                        do_sony_cmd(cmd, 1, status, NULL, 0, 0);
                                }
                        }
                        /*
                         * The data is in memory now, copy it to the buffer and advance to the
                         * next block to read.
                         */
                        copyoff = block - sony_first_block;
                        memcpy(req->buffer,
                               sony_buffer[copyoff / 4] + 512 * (copyoff % 4), 512);
                        
                        block += 1;
                        nsect -= 1;
                        req->buffer += 512;
                }

                end_request(req, 1);
        }
}

/*
 * Read the table of contents from the drive and set sony_toc_read if
 * successful.
 */
static void
sony_get_toc(void)
{
        Byte status[2];
        if (!sony_toc_read) {
                /* do not call check_drive_status() from here since it can call this routine */
                if (request_toc_data(status, sony_toc) < 0)
                        return;
                sony_toc->lead_out_start_lba = msf_to_log(sony_toc->lead_out_start_msf);
                sony_toc_read = 1;
        }
}


/*
 * Search for a specific track in the table of contents.  track is
 * passed in bcd format
 */
static int
find_track(int track)
{
        int i;
        int num_tracks;


        num_tracks = bcd_to_int(sony_toc->last_track_num) -
                bcd_to_int(sony_toc->first_track_num) + 1;
        for (i = 0; i < num_tracks; i++) {
                if (sony_toc->tracks[i].track == track) {
                        return i;
                }
        }

        return -1;
}

/*
 * Read the subcode and put it int last_sony_subcode for future use.
 */
static int
read_subcode(void)
{
        Byte cmd = SONY535_REQUEST_SUB_Q_DATA;
        Byte status[2];
        int  dsc_status;

        if (check_drive_status() != 0)
                return -EIO;

        if ((dsc_status = do_sony_cmd(&cmd, 1, status, (Byte *) last_sony_subcode,
                                                           sizeof(struct s535_sony_subcode), 1)) != 0) {
                printk(CDU535_MESSAGE_NAME " error 0x%.2x, %d (read_subcode)\n",
                                status[0], dsc_status);
                return -EIO;
        }
        return 0;
}


/*
 * Get the subchannel info like the CDROMSUBCHNL command wants to see it.  If
 * the drive is playing, the subchannel needs to be read (since it would be
 * changing).  If the drive is paused or completed, the subcode information has
 * already been stored, just use that.  The ioctl call wants things in decimal
 * (not BCD), so all the conversions are done.
 */
static int
sony_get_subchnl_info(void __user *arg)
{
        struct cdrom_subchnl schi;

        /* Get attention stuff */
        if (check_drive_status() != 0)
                return -EIO;

        sony_get_toc();
        if (!sony_toc_read) {
                return -EIO;
        }
        if (copy_from_user(&schi, arg, sizeof schi))
                return -EFAULT;

        switch (sony_audio_status) {
        case CDROM_AUDIO_PLAY:
                if (read_subcode() < 0) {
                        return -EIO;
                }
                break;

        case CDROM_AUDIO_PAUSED:
        case CDROM_AUDIO_COMPLETED:
                break;

        case CDROM_AUDIO_NO_STATUS:
                schi.cdsc_audiostatus = sony_audio_status;
                if (copy_to_user(arg, &schi, sizeof schi))
                        return -EFAULT;
                return 0;
                break;

        case CDROM_AUDIO_INVALID:
        case CDROM_AUDIO_ERROR:
        default:
                return -EIO;
        }

        schi.cdsc_audiostatus = sony_audio_status;
        schi.cdsc_adr = last_sony_subcode->address;
        schi.cdsc_ctrl = last_sony_subcode->control;
        schi.cdsc_trk = bcd_to_int(last_sony_subcode->track_num);
        schi.cdsc_ind = bcd_to_int(last_sony_subcode->index_num);
        if (schi.cdsc_format == CDROM_MSF) {
                schi.cdsc_absaddr.msf.minute = bcd_to_int(last_sony_subcode->abs_msf[0]);
                schi.cdsc_absaddr.msf.second = bcd_to_int(last_sony_subcode->abs_msf[1]);
                schi.cdsc_absaddr.msf.frame = bcd_to_int(last_sony_subcode->abs_msf[2]);

                schi.cdsc_reladdr.msf.minute = bcd_to_int(last_sony_subcode->rel_msf[0]);
                schi.cdsc_reladdr.msf.second = bcd_to_int(last_sony_subcode->rel_msf[1]);
                schi.cdsc_reladdr.msf.frame = bcd_to_int(last_sony_subcode->rel_msf[2]);
        } else if (schi.cdsc_format == CDROM_LBA) {
                schi.cdsc_absaddr.lba = msf_to_log(last_sony_subcode->abs_msf);
                schi.cdsc_reladdr.lba = msf_to_log(last_sony_subcode->rel_msf);
        }
        return copy_to_user(arg, &schi, sizeof schi) ? -EFAULT : 0;
}


/*
 * The big ugly ioctl handler.
 */
static int
cdu_ioctl(struct inode *inode,
                  struct file *file,
                  unsigned int cmd,
                  unsigned long arg)
{
        Byte status[2];
        Byte cmd_buff[10], params[10];
        int  i;
        int  dsc_status;
        void __user *argp = (void __user *)arg;

        if (check_drive_status() != 0)
                return -EIO;

        switch (cmd) {
        case CDROMSTART:                        /* Spin up the drive */
                if (spin_up_drive(status) < 0) {
                        printk(CDU535_MESSAGE_NAME " error 0x%.2x (CDROMSTART)\n",
                                        status[0]);
                        return -EIO;
                }
                return 0;
                break;

        case CDROMSTOP:                 /* Spin down the drive */
                cmd_buff[0] = SONY535_HOLD;
                do_sony_cmd(cmd_buff, 1, status, NULL, 0, 0);

                /*
                 * Spin the drive down, ignoring the error if the disk was
                 * already not spinning.
                 */
                sony_audio_status = CDROM_AUDIO_NO_STATUS;
                cmd_buff[0] = SONY535_SPIN_DOWN;
                dsc_status = do_sony_cmd(cmd_buff, 1, status, NULL, 0, 0);
                if (((dsc_status < 0) && (dsc_status != BAD_STATUS)) ||
                        ((status[0] & ~(SONY535_STATUS1_NOT_SPINNING)) != 0)) {
                        printk(CDU535_MESSAGE_NAME " error 0x%.2x (CDROMSTOP)\n",
                                        status[0]);
                        return -EIO;
                }
                return 0;
                break;

        case CDROMPAUSE:                        /* Pause the drive */
                cmd_buff[0] = SONY535_HOLD;             /* CDU-31 driver uses AUDIO_STOP, not pause */
                if (do_sony_cmd(cmd_buff, 1, status, NULL, 0, 0) != 0) {
                        printk(CDU535_MESSAGE_NAME " error 0x%.2x (CDROMPAUSE)\n",
                                        status[0]);
                        return -EIO;
                }
                /* Get the current position and save it for resuming */
                if (read_subcode() < 0) {
                        return -EIO;
                }
                cur_pos_msf[0] = last_sony_subcode->abs_msf[0];
                cur_pos_msf[1] = last_sony_subcode->abs_msf[1];
                cur_pos_msf[2] = last_sony_subcode->abs_msf[2];
                sony_audio_status = CDROM_AUDIO_PAUSED;
                return 0;
                break;

        case CDROMRESUME:                       /* Start the drive after being paused */
                set_drive_mode(SONY535_AUDIO_DRIVE_MODE, status);

                if (sony_audio_status != CDROM_AUDIO_PAUSED) {
                        return -EINVAL;
                }
                spin_up_drive(status);

                /* Start the drive at the saved position. */
                cmd_buff[0] = SONY535_PLAY_AUDIO;
                cmd_buff[1] = 0;                /* play back starting at this address */
                cmd_buff[2] = cur_pos_msf[0];
                cmd_buff[3] = cur_pos_msf[1];
                cmd_buff[4] = cur_pos_msf[2];
                cmd_buff[5] = SONY535_PLAY_AUDIO;
                cmd_buff[6] = 2;                /* set ending address */
                cmd_buff[7] = final_pos_msf[0];
                cmd_buff[8] = final_pos_msf[1];
                cmd_buff[9] = final_pos_msf[2];
                if ((do_sony_cmd(cmd_buff, 5, status, NULL, 0, 0) != 0) ||
                        (do_sony_cmd(cmd_buff + 5, 5, status, NULL, 0, 0) != 0)) {
                        printk(CDU535_MESSAGE_NAME " error 0x%.2x (CDROMRESUME)\n",
                                        status[0]);
                        return -EIO;
                }
                sony_audio_status = CDROM_AUDIO_PLAY;
                return 0;
                break;

        case CDROMPLAYMSF:                      /* Play starting at the given MSF address. */
                if (copy_from_user(params, argp, 6))
                        return -EFAULT;
                spin_up_drive(status);
                set_drive_mode(SONY535_AUDIO_DRIVE_MODE, status);

                /* The parameters are given in int, must be converted */
                for (i = 0; i < 3; i++) {
                        cmd_buff[2 + i] = int_to_bcd(params[i]);
                        cmd_buff[7 + i] = int_to_bcd(params[i + 3]);
                }
                cmd_buff[0] = SONY535_PLAY_AUDIO;
                cmd_buff[1] = 0;                /* play back starting at this address */
                /* cmd_buff[2-4] are filled in for loop above */
                cmd_buff[5] = SONY535_PLAY_AUDIO;
                cmd_buff[6] = 2;                /* set ending address */
                /* cmd_buff[7-9] are filled in for loop above */
                if ((do_sony_cmd(cmd_buff, 5, status, NULL, 0, 0) != 0) ||
                        (do_sony_cmd(cmd_buff + 5, 5, status, NULL, 0, 0) != 0)) {
                        printk(CDU535_MESSAGE_NAME " error 0x%.2x (CDROMPLAYMSF)\n",
                                        status[0]);
                        return -EIO;
                }
                /* Save the final position for pauses and resumes */
                final_pos_msf[0] = cmd_buff[7];
                final_pos_msf[1] = cmd_buff[8];
                final_pos_msf[2] = cmd_buff[9];
                sony_audio_status = CDROM_AUDIO_PLAY;
                return 0;
                break;

        case CDROMREADTOCHDR:           /* Read the table of contents header */
                {
                        struct cdrom_tochdr __user *hdr = argp;
                        struct cdrom_tochdr loc_hdr;

                        sony_get_toc();
                        if (!sony_toc_read)
                                return -EIO;
                        loc_hdr.cdth_trk0 = bcd_to_int(sony_toc->first_track_num);
                        loc_hdr.cdth_trk1 = bcd_to_int(sony_toc->last_track_num);
                        if (copy_to_user(hdr, &loc_hdr, sizeof *hdr))
                                return -EFAULT;
                }
                return 0;
                break;

        case CDROMREADTOCENTRY: /* Read a given table of contents entry */
                {
                        struct cdrom_tocentry __user *entry = argp;
                        struct cdrom_tocentry loc_entry;
                        int  track_idx;
                        Byte *msf_val = NULL;

                        sony_get_toc();
                        if (!sony_toc_read) {
                                return -EIO;
                        }

                        if (copy_from_user(&loc_entry, entry, sizeof loc_entry))
                                return -EFAULT;

                        /* Lead out is handled separately since it is special. */
                        if (loc_entry.cdte_track == CDROM_LEADOUT) {
                                loc_entry.cdte_adr = 0 /*sony_toc->address2 */ ;
                                loc_entry.cdte_ctrl = sony_toc->control2;
                                msf_val = sony_toc->lead_out_start_msf;
                        } else {
                                track_idx = find_track(int_to_bcd(loc_entry.cdte_track));
                                if (track_idx < 0)
                                        return -EINVAL;
                                loc_entry.cdte_adr = 0 /*sony_toc->tracks[track_idx].address */ ;
                                loc_entry.cdte_ctrl = sony_toc->tracks[track_idx].control;
                                msf_val = sony_toc->tracks[track_idx].track_start_msf;
                        }

                        /* Logical buffer address or MSF format requested? */
                        if (loc_entry.cdte_format == CDROM_LBA) {
                                loc_entry.cdte_addr.lba = msf_to_log(msf_val);
                        } else if (loc_entry.cdte_format == CDROM_MSF) {
                                loc_entry.cdte_addr.msf.minute = bcd_to_int(*msf_val);
                                loc_entry.cdte_addr.msf.second = bcd_to_int(*(msf_val + 1));
                                loc_entry.cdte_addr.msf.frame = bcd_to_int(*(msf_val + 2));
                        }
                        if (copy_to_user(entry, &loc_entry, sizeof *entry))
                                return -EFAULT;
                }
                return 0;
                break;

        case CDROMPLAYTRKIND:           /* Play a track.  This currently ignores index. */
                {
                        struct cdrom_ti ti;
                        int track_idx;

                        sony_get_toc();
                        if (!sony_toc_read)
                                return -EIO;

                        if (copy_from_user(&ti, argp, sizeof ti))
                                return -EFAULT;
                        if ((ti.cdti_trk0 < sony_toc->first_track_num)
                                || (sony_toc->last_track_num < ti.cdti_trk0)
                                || (ti.cdti_trk1 < ti.cdti_trk0)) {
                                return -EINVAL;
                        }
                        track_idx = find_track(int_to_bcd(ti.cdti_trk0));
                        if (track_idx < 0)
                                return -EINVAL;
                        params[1] = sony_toc->tracks[track_idx].track_start_msf[0];
                        params[2] = sony_toc->tracks[track_idx].track_start_msf[1];
                        params[3] = sony_toc->tracks[track_idx].track_start_msf[2];
                        /*
                         * If we want to stop after the last track, use the lead-out
                         * MSF to do that.
                         */
                        if (bcd_to_int(sony_toc->last_track_num) <= ti.cdti_trk1) {
                                log_to_msf(msf_to_log(sony_toc->lead_out_start_msf) - 1,
                                                   &(params[4]));
                        } else {
                                track_idx = find_track(int_to_bcd(ti.cdti_trk1 + 1));
                                if (track_idx < 0)
                                        return -EINVAL;
                                log_to_msf(msf_to_log(sony_toc->tracks[track_idx].track_start_msf) - 1,
                                                   &(params[4]));
                        }
                        params[0] = 0x03;

                        spin_up_drive(status);

                        set_drive_mode(SONY535_AUDIO_DRIVE_MODE, status);

                        /* Start the drive at the saved position. */
                        cmd_buff[0] = SONY535_PLAY_AUDIO;
                        cmd_buff[1] = 0;        /* play back starting at this address */
                        cmd_buff[2] = params[1];
                        cmd_buff[3] = params[2];
                        cmd_buff[4] = params[3];
                        cmd_buff[5] = SONY535_PLAY_AUDIO;
                        cmd_buff[6] = 2;        /* set ending address */
                        cmd_buff[7] = params[4];
                        cmd_buff[8] = params[5];
                        cmd_buff[9] = params[6];
                        if ((do_sony_cmd(cmd_buff, 5, status, NULL, 0, 0) != 0) ||
                                (do_sony_cmd(cmd_buff + 5, 5, status, NULL, 0, 0) != 0)) {
                                printk(CDU535_MESSAGE_NAME " error 0x%.2x (CDROMPLAYTRKIND)\n",
                                                status[0]);
                                printk("... Params: %x %x %x %x %x %x %x\n",
                                                params[0], params[1], params[2],
                                                params[3], params[4], params[5], params[6]);
                                return -EIO;
                        }
                        /* Save the final position for pauses and resumes */
                        final_pos_msf[0] = params[4];
                        final_pos_msf[1] = params[5];
                        final_pos_msf[2] = params[6];
                        sony_audio_status = CDROM_AUDIO_PLAY;
                        return 0;
                }

        case CDROMSUBCHNL:                      /* Get subchannel info */
                return sony_get_subchnl_info(argp);

        case CDROMVOLCTRL:                      /* Volume control.  What volume does this change, anyway? */
                {
                        struct cdrom_volctrl volctrl;

                        if (copy_from_user(&volctrl, argp, sizeof volctrl))
                                return -EFAULT;
                        cmd_buff[0] = SONY535_SET_VOLUME;
                        cmd_buff[1] = volctrl.channel0;
                        cmd_buff[2] = volctrl.channel1;
                        if (do_sony_cmd(cmd_buff, 3, status, NULL, 0, 0) != 0) {
                                printk(CDU535_MESSAGE_NAME " error 0x%.2x (CDROMVOLCTRL)\n",
                                                status[0]);
                                return -EIO;
                        }
                }
                return 0;

        case CDROMEJECT:                        /* Eject the drive */
                cmd_buff[0] = SONY535_STOP;
                do_sony_cmd(cmd_buff, 1, status, NULL, 0, 0);
                cmd_buff[0] = SONY535_SPIN_DOWN;
                do_sony_cmd(cmd_buff, 1, status, NULL, 0, 0);

                sony_audio_status = CDROM_AUDIO_INVALID;
                cmd_buff[0] = SONY535_EJECT_CADDY;
                if (do_sony_cmd(cmd_buff, 1, status, NULL, 0, 0) != 0) {
                        printk(CDU535_MESSAGE_NAME " error 0x%.2x (CDROMEJECT)\n",
                                        status[0]);
                        return -EIO;
                }
                return 0;
                break;

        default:
                return -EINVAL;
        }
}


/*
 * Open the drive for operations.  Spin the drive up and read the table of
 * contents if these have not already been done.
 */
static int
cdu_open(struct inode *inode,
                 struct file *filp)
{
        Byte status[2], cmd_buff[2];

        if (sony_inuse)
                return -EBUSY;
        if (check_drive_status() != 0)
                return -EIO;
        sony_inuse = 1;

        if (spin_up_drive(status) != 0) {
                printk(CDU535_MESSAGE_NAME " error 0x%.2x (cdu_open, spin up)\n",
                                status[0]);
                sony_inuse = 0;
                return -EIO;
        }
        sony_get_toc();
        if (!sony_toc_read) {
                cmd_buff[0] = SONY535_SPIN_DOWN;
                do_sony_cmd(cmd_buff, 1, status, NULL, 0, 0);
                sony_inuse = 0;
                return -EIO;
        }
        check_disk_change(inode->i_bdev);
        sony_usage++;

#ifdef LOCK_DOORS
        /* disable the eject button while mounted */
        cmd_buff[0] = SONY535_DISABLE_EJECT_BUTTON;
        do_sony_cmd(cmd_buff, 1, status, NULL, 0, 0);
#endif

        return 0;
}


/*
 * Close the drive.  Spin it down if no task is using it.  The spin
 * down will fail if playing audio, so audio play is OK.
 */
static int
cdu_release(struct inode *inode,
                        struct file *filp)
{
        Byte status[2], cmd_no;

        sony_inuse = 0;

        if (0 < sony_usage) {
                sony_usage--;
        }
        if (sony_usage == 0) {
                check_drive_status();

                if (sony_audio_status != CDROM_AUDIO_PLAY) {
                        cmd_no = SONY535_SPIN_DOWN;
                        do_sony_cmd(&cmd_no, 1, status, NULL, 0, 0);
                }
#ifdef LOCK_DOORS
                /* enable the eject button after umount */
                cmd_no = SONY535_ENABLE_EJECT_BUTTON;
                do_sony_cmd(&cmd_no, 1, status, NULL, 0, 0);
#endif
        }
        return 0;
}

static struct block_device_operations cdu_fops =
{
        .owner          = THIS_MODULE,
        .open           = cdu_open,
        .release        = cdu_release,
        .ioctl          = cdu_ioctl,
        .media_changed  = cdu535_check_media_change,
};

static struct gendisk *cdu_disk;

/*
 * Initialize the driver.
 */
static int __init sony535_init(void)
{
        struct s535_sony_drive_config drive_config;
        Byte cmd_buff[3];
        Byte ret_buff[2];
        Byte status[2];
        unsigned long snap;
        int  got_result = 0;
        int  tmp_irq;
        int  i;
        int err;

        /* Setting the base I/O address to 0 will disable it. */
        if ((sony535_cd_base_io == 0xffff)||(sony535_cd_base_io == 0))
                return 0;

        /* Set up all the register locations */
        result_reg = sony535_cd_base_io;
        command_reg = sony535_cd_base_io;
        data_reg = sony535_cd_base_io + 1;
        read_status_reg = sony535_cd_base_io + 2;
        select_unit_reg = sony535_cd_base_io + 3;

#ifndef USE_IRQ
        sony535_irq_used = 0;   /* polling only until this is ready... */
#endif
        /* we need to poll until things get initialized */
        tmp_irq = sony535_irq_used;
        sony535_irq_used = 0;

#if DEBUG > 0
        printk(KERN_INFO CDU535_MESSAGE_NAME ": probing base address %03X\n",
                        sony535_cd_base_io);
#endif
        /* look for the CD-ROM, follows the procedure in the DOS driver */
        inb(select_unit_reg);
        /* wait for 40 18 Hz ticks (reverse-engineered from DOS driver) */
        set_current_state(TASK_INTERRUPTIBLE);
        schedule_timeout((HZ+17)*40/18);
        inb(result_reg);

        outb(0, read_status_reg);       /* does a reset? */
        snap = jiffies;
        while (jiffies-snap < SONY_JIFFIES_TIMEOUT) {
                select_unit(0);
                if (inb(result_reg) != 0xff) {
                        got_result = 1;
                        break;
                }
                sony_sleep();
        }

        if (!got_result || check_drive_status() == TIME_OUT)
                goto Enodev;

        /* CD-ROM drive responded --  get the drive configuration */
        cmd_buff[0] = SONY535_INQUIRY;
        if (do_sony_cmd(cmd_buff, 1, status, (Byte *)&drive_config, 28, 1) != 0)
                goto Enodev;

        /* was able to get the configuration,
         * set drive mode as rest of init
         */
#if DEBUG > 0
        /* 0x50 == CADDY_NOT_INSERTED | NOT_SPINNING */
        if ( (status[0] & 0x7f) != 0 && (status[0] & 0x7f) != 0x50 )
                printk(CDU535_MESSAGE_NAME
                                "Inquiry command returned status = 0x%x\n", status[0]);
#endif
        /* now ready to use interrupts, if available */
        sony535_irq_used = tmp_irq;

        /* A negative sony535_irq_used will attempt an autoirq. */
        if (sony535_irq_used < 0) {
                unsigned long irq_mask, delay;

                irq_mask = probe_irq_on();
                enable_interrupts();
                outb(0, read_status_reg);       /* does a reset? */
                delay = jiffies + HZ/10;
                while (time_before(jiffies, delay)) ;

                sony535_irq_used = probe_irq_off(irq_mask);
                disable_interrupts();
        }
        if (sony535_irq_used > 0) {
            if (request_irq(sony535_irq_used, cdu535_interrupt,
                                                SA_INTERRUPT, CDU535_HANDLE, NULL)) {
                        printk("Unable to grab IRQ%d for the " CDU535_MESSAGE_NAME
                                        " driver; polling instead.\n", sony535_irq_used);
                        sony535_irq_used = 0;
                }
        }
        cmd_buff[0] = SONY535_SET_DRIVE_MODE;
        cmd_buff[1] = 0x0;      /* default audio */
        if (do_sony_cmd(cmd_buff, 2, status, ret_buff, 1, 1) != 0)
                goto Enodev_irq;

        /* set the drive mode successful, we are set! */
        sony_buffer_size = SONY535_BUFFER_SIZE;
        sony_buffer_sectors = sony_buffer_size / CDU535_BLOCK_SIZE;

        printk(KERN_INFO CDU535_MESSAGE_NAME " I/F CDROM : %8.8s %16.16s %4.4s",
                   drive_config.vendor_id,
                   drive_config.product_id,
                   drive_config.product_rev_level);
        printk("  base address %03X, ", sony535_cd_base_io);
        if (tmp_irq > 0)
                printk("IRQ%d, ", tmp_irq);
        printk("using %d byte buffer\n", sony_buffer_size);

        if (register_blkdev(MAJOR_NR, CDU535_HANDLE)) {
                err = -EIO;
                goto out1;
        }
        sonycd535_queue = blk_init_queue(do_cdu535_request, &sonycd535_lock);
        if (!sonycd535_queue) {
                err = -ENOMEM;
                goto out1a;
        }

        blk_queue_hardsect_size(sonycd535_queue, CDU535_BLOCK_SIZE);
        sony_toc = kmalloc(sizeof(struct s535_sony_toc), GFP_KERNEL);
        err = -ENOMEM;
        if (!sony_toc)
                goto out2;
        last_sony_subcode = kmalloc(sizeof(struct s535_sony_subcode), GFP_KERNEL);
        if (!last_sony_subcode)
                goto out3;
        sony_buffer = kmalloc(sizeof(Byte *) * sony_buffer_sectors, GFP_KERNEL);
        if (!sony_buffer)
                goto out4;
        for (i = 0; i < sony_buffer_sectors; i++) {
                sony_buffer[i] = kmalloc(CDU535_BLOCK_SIZE, GFP_KERNEL);
                if (!sony_buffer[i]) {
                        while (--i>=0)
                                kfree(sony_buffer[i]);
                        goto out5;
                }
        }
        initialized = 1;

        cdu_disk = alloc_disk(1);
        if (!cdu_disk)
                goto out6;
        cdu_disk->major = MAJOR_NR;
        cdu_disk->first_minor = 0;
        cdu_disk->fops = &cdu_fops;
        sprintf(cdu_disk->disk_name, "cdu");
        sprintf(cdu_disk->devfs_name, "cdu535");

        if (!request_region(sony535_cd_base_io, 4, CDU535_HANDLE)) {
                printk(KERN_WARNING"sonycd535: Unable to request region 0x%x\n",
                        sony535_cd_base_io);
                goto out7;
        }
        cdu_disk->queue = sonycd535_queue;
        add_disk(cdu_disk);
        return 0;

out7:
        put_disk(cdu_disk);
out6:
        for (i = 0; i < sony_buffer_sectors; i++)
                if (sony_buffer[i]) 
                        kfree(sony_buffer[i]);
out5:
        kfree(sony_buffer);
out4:
        kfree(last_sony_subcode);
out3:
        kfree(sony_toc);
out2:
        blk_cleanup_queue(sonycd535_queue);
out1a:
        unregister_blkdev(MAJOR_NR, CDU535_HANDLE);
out1:
        if (sony535_irq_used)
                free_irq(sony535_irq_used, NULL);
        return err;
Enodev_irq:
        if (sony535_irq_used)
                free_irq(sony535_irq_used, NULL);
Enodev:
        printk("Did not find a " CDU535_MESSAGE_NAME " drive\n");
        return -EIO;
}

#ifndef MODULE

/*
 * accept "kernel command line" parameters
 * (added by emoenke@gwdg.de)
 *
 * use: tell LILO:
 *                 sonycd535=0x320
 *
 * the address value has to be the existing CDROM port address.
 */
static int __init
sonycd535_setup(char *strings)
{
        int ints[3];
        (void)get_options(strings, ARRAY_SIZE(ints), ints);
        /* if IRQ change and default io base desired,
         * then call with io base of 0
         */
        if (ints[0] > 0)
                if (ints[1] != 0)
                        sony535_cd_base_io = ints[1];
        if (ints[0] > 1)
                sony535_irq_used = ints[2];
        if ((strings != NULL) && (*strings != '\0'))
                printk(CDU535_MESSAGE_NAME
                                ": Warning: Unknown interface type: %s\n", strings);
                                
        return 1;
}

__setup("sonycd535=", sonycd535_setup);

#endif /* MODULE */

static void __exit
sony535_exit(void)
{
        int i;

        release_region(sony535_cd_base_io, 4);
        for (i = 0; i < sony_buffer_sectors; i++)
                kfree(sony_buffer[i]);
        kfree(sony_buffer);
        kfree(last_sony_subcode);
        kfree(sony_toc);
        del_gendisk(cdu_disk);
        put_disk(cdu_disk);
        blk_cleanup_queue(sonycd535_queue);
        if (unregister_blkdev(MAJOR_NR, CDU535_HANDLE) == -EINVAL)
                printk("Uh oh, couldn't unregister " CDU535_HANDLE "\n");
        else
                printk(KERN_INFO CDU535_HANDLE " module released\n");
}

module_init(sony535_init);
module_exit(sony535_exit);


MODULE_LICENSE("GPL");
MODULE_ALIAS_BLOCKDEV_MAJOR(CDU535_CDROM_MAJOR);