[PATCH] ide-cd mini cleanup of casts
[linux-3.10.git] / drivers / ide / ide-cd.c
1 /*
2  * linux/drivers/ide/ide-cd.c
3  *
4  * Copyright (C) 1994, 1995, 1996  scott snyder  <snyder@fnald0.fnal.gov>
5  * Copyright (C) 1996-1998  Erik Andersen <andersee@debian.org>
6  * Copyright (C) 1998-2000  Jens Axboe <axboe@suse.de>
7  *
8  * May be copied or modified under the terms of the GNU General Public
9  * License.  See linux/COPYING for more information.
10  *
11  * ATAPI CD-ROM driver.  To be used with ide.c.
12  * See Documentation/cdrom/ide-cd for usage information.
13  *
14  * Suggestions are welcome. Patches that work are more welcome though. ;-)
15  * For those wishing to work on this driver, please be sure you download
16  * and comply with the latest Mt. Fuji (SFF8090 version 4) and ATAPI 
17  * (SFF-8020i rev 2.6) standards. These documents can be obtained by 
18  * anonymous ftp from:
19  * ftp://fission.dt.wdc.com/pub/standards/SFF_atapi/spec/SFF8020-r2.6/PS/8020r26.ps
20  * ftp://ftp.avc-pioneer.com/Mtfuji4/Spec/Fuji4r10.pdf
21  *
22  * Drives that deviate from these standards will be accommodated as much
23  * as possible via compile time or command-line options.  Since I only have
24  * a few drives, you generally need to send me patches...
25  *
26  * ----------------------------------
27  * TO DO LIST:
28  * -Make it so that Pioneer CD DR-A24X and friends don't get screwed up on
29  *   boot
30  *
31  * ----------------------------------
32  * 1.00  Oct 31, 1994 -- Initial version.
33  * 1.01  Nov  2, 1994 -- Fixed problem with starting request in
34  *                       cdrom_check_status.
35  * 1.03  Nov 25, 1994 -- leaving unmask_intr[] as a user-setting (as for disks)
36  * (from mlord)       -- minor changes to cdrom_setup()
37  *                    -- renamed ide_dev_s to ide_drive_t, enable irq on command
38  * 2.00  Nov 27, 1994 -- Generalize packet command interface;
39  *                       add audio ioctls.
40  * 2.01  Dec  3, 1994 -- Rework packet command interface to handle devices
41  *                       which send an interrupt when ready for a command.
42  * 2.02  Dec 11, 1994 -- Cache the TOC in the driver.
43  *                       Don't use SCMD_PLAYAUDIO_TI; it's not included
44  *                       in the current version of ATAPI.
45  *                       Try to use LBA instead of track or MSF addressing
46  *                       when possible.
47  *                       Don't wait for READY_STAT.
48  * 2.03  Jan 10, 1995 -- Rewrite block read routines to handle block sizes
49  *                       other than 2k and to move multiple sectors in a
50  *                       single transaction.
51  * 2.04  Apr 21, 1995 -- Add work-around for Creative Labs CD220E drives.
52  *                       Thanks to Nick Saw <cwsaw@pts7.pts.mot.com> for
53  *                       help in figuring this out.  Ditto for Acer and
54  *                       Aztech drives, which seem to have the same problem.
55  * 2.04b May 30, 1995 -- Fix to match changes in ide.c version 3.16 -ml
56  * 2.05  Jun  8, 1995 -- Don't attempt to retry after an illegal request
57  *                        or data protect error.
58  *                       Use HWIF and DEV_HWIF macros as in ide.c.
59  *                       Always try to do a request_sense after
60  *                        a failed command.
61  *                       Include an option to give textual descriptions
62  *                        of ATAPI errors.
63  *                       Fix a bug in handling the sector cache which
64  *                        showed up if the drive returned data in 512 byte
65  *                        blocks (like Pioneer drives).  Thanks to
66  *                        Richard Hirst <srh@gpt.co.uk> for diagnosing this.
67  *                       Properly supply the page number field in the
68  *                        MODE_SELECT command.
69  *                       PLAYAUDIO12 is broken on the Aztech; work around it.
70  * 2.05x Aug 11, 1995 -- lots of data structure renaming/restructuring in ide.c
71  *                       (my apologies to Scott, but now ide-cd.c is independent)
72  * 3.00  Aug 22, 1995 -- Implement CDROMMULTISESSION ioctl.
73  *                       Implement CDROMREADAUDIO ioctl (UNTESTED).
74  *                       Use input_ide_data() and output_ide_data().
75  *                       Add door locking.
76  *                       Fix usage count leak in cdrom_open, which happened
77  *                        when a read-write mount was attempted.
78  *                       Try to load the disk on open.
79  *                       Implement CDROMEJECT_SW ioctl (off by default).
80  *                       Read total cdrom capacity during open.
81  *                       Rearrange logic in cdrom_decode_status.  Issue
82  *                        request sense commands for failed packet commands
83  *                        from here instead of from cdrom_queue_packet_command.
84  *                        Fix a race condition in retrieving error information.
85  *                       Suppress printing normal unit attention errors and
86  *                        some drive not ready errors.
87  *                       Implement CDROMVOLREAD ioctl.
88  *                       Implement CDROMREADMODE1/2 ioctls.
89  *                       Fix race condition in setting up interrupt handlers
90  *                        when the `serialize' option is used.
91  * 3.01  Sep  2, 1995 -- Fix ordering of reenabling interrupts in
92  *                        cdrom_queue_request.
93  *                       Another try at using ide_[input,output]_data.
94  * 3.02  Sep 16, 1995 -- Stick total disk capacity in partition table as well.
95  *                       Make VERBOSE_IDE_CD_ERRORS dump failed command again.
96  *                       Dump out more information for ILLEGAL REQUEST errs.
97  *                       Fix handling of errors occurring before the
98  *                        packet command is transferred.
99  *                       Fix transfers with odd bytelengths.
100  * 3.03  Oct 27, 1995 -- Some Creative drives have an id of just `CD'.
101  *                       `DCI-2S10' drives are broken too.
102  * 3.04  Nov 20, 1995 -- So are Vertos drives.
103  * 3.05  Dec  1, 1995 -- Changes to go with overhaul of ide.c and ide-tape.c
104  * 3.06  Dec 16, 1995 -- Add support needed for partitions.
105  *                       More workarounds for Vertos bugs (based on patches
106  *                        from Holger Dietze <dietze@aix520.informatik.uni-leipzig.de>).
107  *                       Try to eliminate byteorder assumptions.
108  *                       Use atapi_cdrom_subchnl struct definition.
109  *                       Add STANDARD_ATAPI compilation option.
110  * 3.07  Jan 29, 1996 -- More twiddling for broken drives: Sony 55D,
111  *                        Vertos 300.
112  *                       Add NO_DOOR_LOCKING configuration option.
113  *                       Handle drive_cmd requests w/NULL args (for hdparm -t).
114  *                       Work around sporadic Sony55e audio play problem.
115  * 3.07a Feb 11, 1996 -- check drive->id for NULL before dereferencing, to fix
116  *                        problem with "hde=cdrom" with no drive present.  -ml
117  * 3.08  Mar  6, 1996 -- More Vertos workarounds.
118  * 3.09  Apr  5, 1996 -- Add CDROMCLOSETRAY ioctl.
119  *                       Switch to using MSF addressing for audio commands.
120  *                       Reformat to match kernel tabbing style.
121  *                       Add CDROM_GET_UPC ioctl.
122  * 3.10  Apr 10, 1996 -- Fix compilation error with STANDARD_ATAPI.
123  * 3.11  Apr 29, 1996 -- Patch from Heiko Eissfeldt <heiko@colossus.escape.de>
124  *                       to remove redundant verify_area calls.
125  * 3.12  May  7, 1996 -- Rudimentary changer support.  Based on patches
126  *                        from Gerhard Zuber <zuber@berlin.snafu.de>.
127  *                       Let open succeed even if there's no loaded disc.
128  * 3.13  May 19, 1996 -- Fixes for changer code.
129  * 3.14  May 29, 1996 -- Add work-around for Vertos 600.
130  *                        (From Hennus Bergman <hennus@sky.ow.nl>.)
131  * 3.15  July 2, 1996 -- Added support for Sanyo 3 CD changers
132  *                        from Ben Galliart <bgallia@luc.edu> with 
133  *                        special help from Jeff Lightfoot 
134  *                        <jeffml@pobox.com>
135  * 3.15a July 9, 1996 -- Improved Sanyo 3 CD changer identification
136  * 3.16  Jul 28, 1996 -- Fix from Gadi to reduce kernel stack usage for ioctl.
137  * 3.17  Sep 17, 1996 -- Tweak audio reads for some drives.
138  *                       Start changing CDROMLOADFROMSLOT to CDROM_SELECT_DISC.
139  * 3.18  Oct 31, 1996 -- Added module and DMA support.
140  *                       
141  *                       
142  * 4.00  Nov 5, 1996   -- New ide-cd maintainer,
143  *                                 Erik B. Andersen <andersee@debian.org>
144  *                     -- Newer Creative drives don't always set the error
145  *                          register correctly.  Make sure we see media changes
146  *                          regardless.
147  *                     -- Integrate with generic cdrom driver.
148  *                     -- CDROMGETSPINDOWN and CDROMSETSPINDOWN ioctls, based on
149  *                          a patch from Ciro Cattuto <>.
150  *                     -- Call set_device_ro.
151  *                     -- Implement CDROMMECHANISMSTATUS and CDROMSLOTTABLE
152  *                          ioctls, based on patch by Erik Andersen
153  *                     -- Add some probes of drive capability during setup.
154  *
155  * 4.01  Nov 11, 1996  -- Split into ide-cd.c and ide-cd.h
156  *                     -- Removed CDROMMECHANISMSTATUS and CDROMSLOTTABLE 
157  *                          ioctls in favor of a generalized approach 
158  *                          using the generic cdrom driver.
159  *                     -- Fully integrated with the 2.1.X kernel.
160  *                     -- Other stuff that I forgot (lots of changes)
161  *
162  * 4.02  Dec 01, 1996  -- Applied patch from Gadi Oxman <gadio@netvision.net.il>
163  *                          to fix the drive door locking problems.
164  *
165  * 4.03  Dec 04, 1996  -- Added DSC overlap support.
166  * 4.04  Dec 29, 1996  -- Added CDROMREADRAW ioclt based on patch 
167  *                          by Ales Makarov (xmakarov@sun.felk.cvut.cz)
168  *
169  * 4.05  Nov 20, 1997  -- Modified to print more drive info on init
170  *                        Minor other changes
171  *                        Fix errors on CDROMSTOP (If you have a "Dolphin",
172  *                          you must define IHAVEADOLPHIN)
173  *                        Added identifier so new Sanyo CD-changer works
174  *                        Better detection if door locking isn't supported
175  *
176  * 4.06  Dec 17, 1997  -- fixed endless "tray open" messages  -ml
177  * 4.07  Dec 17, 1997  -- fallback to set pc->stat on "tray open"
178  * 4.08  Dec 18, 1997  -- spew less noise when tray is empty
179  *                     -- fix speed display for ACER 24X, 18X
180  * 4.09  Jan 04, 1998  -- fix handling of the last block so we return
181  *                         an end of file instead of an I/O error (Gadi)
182  * 4.10  Jan 24, 1998  -- fixed a bug so now changers can change to a new
183  *                         slot when there is no disc in the current slot.
184  *                     -- Fixed a memory leak where info->changer_info was
185  *                         malloc'ed but never free'd when closing the device.
186  *                     -- Cleaned up the global namespace a bit by making more
187  *                         functions static that should already have been.
188  * 4.11  Mar 12, 1998  -- Added support for the CDROM_SELECT_SPEED ioctl
189  *                         based on a patch for 2.0.33 by Jelle Foks 
190  *                         <jelle@scintilla.utwente.nl>, a patch for 2.0.33
191  *                         by Toni Giorgino <toni@pcape2.pi.infn.it>, the SCSI
192  *                         version, and my own efforts.  -erik
193  *                     -- Fixed a stupid bug which egcs was kind enough to
194  *                         inform me of where "Illegal mode for this track"
195  *                         was never returned due to a comparison on data
196  *                         types of limited range.
197  * 4.12  Mar 29, 1998  -- Fixed bug in CDROM_SELECT_SPEED so write speed is 
198  *                         now set ionly for CD-R and CD-RW drives.  I had 
199  *                         removed this support because it produced errors.
200  *                         It produced errors _only_ for non-writers. duh.
201  * 4.13  May 05, 1998  -- Suppress useless "in progress of becoming ready"
202  *                         messages, since this is not an error.
203  *                     -- Change error messages to be const
204  *                     -- Remove a "\t" which looks ugly in the syslogs
205  * 4.14  July 17, 1998 -- Change to pointing to .ps version of ATAPI spec
206  *                         since the .pdf version doesn't seem to work...
207  *                     -- Updated the TODO list to something more current.
208  *
209  * 4.15  Aug 25, 1998  -- Updated ide-cd.h to respect mechine endianess, 
210  *                         patch thanks to "Eddie C. Dost" <ecd@skynet.be>
211  *
212  * 4.50  Oct 19, 1998  -- New maintainers!
213  *                         Jens Axboe <axboe@image.dk>
214  *                         Chris Zwilling <chris@cloudnet.com>
215  *
216  * 4.51  Dec 23, 1998  -- Jens Axboe <axboe@image.dk>
217  *                      - ide_cdrom_reset enabled since the ide subsystem
218  *                         handles resets fine now. <axboe@image.dk>
219  *                      - Transfer size fix for Samsung CD-ROMs, thanks to
220  *                        "Ville Hallik" <ville.hallik@mail.ee>.
221  *                      - other minor stuff.
222  *
223  * 4.52  Jan 19, 1999  -- Jens Axboe <axboe@image.dk>
224  *                      - Detect DVD-ROM/RAM drives
225  *
226  * 4.53  Feb 22, 1999   - Include other model Samsung and one Goldstar
227  *                         drive in transfer size limit.
228  *                      - Fix the I/O error when doing eject without a medium
229  *                         loaded on some drives.
230  *                      - CDROMREADMODE2 is now implemented through
231  *                         CDROMREADRAW, since many drives don't support
232  *                         MODE2 (even though ATAPI 2.6 says they must).
233  *                      - Added ignore parameter to ide-cd (as a module), eg
234  *                              insmod ide-cd ignore='hda hdb'
235  *                         Useful when using ide-cd in conjunction with
236  *                         ide-scsi. TODO: non-modular way of doing the
237  *                         same.
238  *
239  * 4.54  Aug 5, 1999    - Support for MMC2 class commands through the generic
240  *                        packet interface to cdrom.c.
241  *                      - Unified audio ioctl support, most of it.
242  *                      - cleaned up various deprecated verify_area().
243  *                      - Added ide_cdrom_packet() as the interface for
244  *                        the Uniform generic_packet().
245  *                      - bunch of other stuff, will fill in logs later.
246  *                      - report 1 slot for non-changers, like the other
247  *                        cd-rom drivers. don't report select disc for
248  *                        non-changers as well.
249  *                      - mask out audio playing, if the device can't do it.
250  *
251  * 4.55  Sep 1, 1999    - Eliminated the rest of the audio ioctls, except
252  *                        for CDROMREADTOC[ENTRY|HEADER]. Some of the drivers
253  *                        use this independently of the actual audio handling.
254  *                        They will disappear later when I get the time to
255  *                        do it cleanly.
256  *                      - Minimize the TOC reading - only do it when we
257  *                        know a media change has occurred.
258  *                      - Moved all the CDROMREADx ioctls to the Uniform layer.
259  *                      - Heiko Eissfeldt <heiko@colossus.escape.de> supplied
260  *                        some fixes for CDI.
261  *                      - CD-ROM leaving door locked fix from Andries
262  *                        Brouwer <Andries.Brouwer@cwi.nl>
263  *                      - Erik Andersen <andersen@xmission.com> unified
264  *                        commands across the various drivers and how
265  *                        sense errors are handled.
266  *
267  * 4.56  Sep 12, 1999   - Removed changer support - it is now in the
268  *                        Uniform layer.
269  *                      - Added partition based multisession handling.
270  *                      - Mode sense and mode select moved to the
271  *                        Uniform layer.
272  *                      - Fixed a problem with WPI CDS-32X drive - it
273  *                        failed the capabilities 
274  *
275  * 4.57  Apr 7, 2000    - Fixed sense reporting.
276  *                      - Fixed possible oops in ide_cdrom_get_last_session()
277  *                      - Fix locking mania and make ide_cdrom_reset relock
278  *                      - Stop spewing errors to log when magicdev polls with
279  *                        TEST_UNIT_READY on some drives.
280  *                      - Various fixes from Tobias Ringstrom:
281  *                        tray if it was locked prior to the reset.
282  *                        - cdrom_read_capacity returns one frame too little.
283  *                        - Fix real capacity reporting.
284  *
285  * 4.58  May 1, 2000    - Clean up ACER50 stuff.
286  *                      - Fix small problem with ide_cdrom_capacity
287  *
288  * 4.59  Aug 11, 2000   - Fix changer problem in cdrom_read_toc, we weren't
289  *                        correctly sensing a disc change.
290  *                      - Rearranged some code
291  *                      - Use extended sense on drives that support it for
292  *                        correctly reporting tray status -- from
293  *                        Michael D Johnson <johnsom@orst.edu>
294  * 4.60  Dec 17, 2003   - Add mt rainier support
295  *                      - Bump timeout for packet commands, matches sr
296  *                      - Odd stuff
297  * 4.61  Jan 22, 2004   - support hardware sector sizes other than 2kB,
298  *                        Pascal Schmidt <der.eremit@email.de>
299  *
300  *************************************************************************/
301  
302 #define IDECD_VERSION "4.61"
303
304 #include <linux/config.h>
305 #include <linux/module.h>
306 #include <linux/types.h>
307 #include <linux/kernel.h>
308 #include <linux/delay.h>
309 #include <linux/timer.h>
310 #include <linux/slab.h>
311 #include <linux/interrupt.h>
312 #include <linux/errno.h>
313 #include <linux/cdrom.h>
314 #include <linux/ide.h>
315 #include <linux/completion.h>
316
317 #include <scsi/scsi.h>  /* For SCSI -> ATAPI command conversion */
318
319 #include <asm/irq.h>
320 #include <asm/io.h>
321 #include <asm/byteorder.h>
322 #include <asm/uaccess.h>
323 #include <asm/unaligned.h>
324
325 #include "ide-cd.h"
326
327 static DECLARE_MUTEX(idecd_ref_sem);
328
329 #define to_ide_cd(obj) container_of(obj, struct cdrom_info, kref) 
330
331 #define ide_cd_g(disk) \
332         container_of((disk)->private_data, struct cdrom_info, driver)
333
334 static struct cdrom_info *ide_cd_get(struct gendisk *disk)
335 {
336         struct cdrom_info *cd = NULL;
337
338         down(&idecd_ref_sem);
339         cd = ide_cd_g(disk);
340         if (cd)
341                 kref_get(&cd->kref);
342         up(&idecd_ref_sem);
343         return cd;
344 }
345
346 static void ide_cd_release(struct kref *);
347
348 static void ide_cd_put(struct cdrom_info *cd)
349 {
350         down(&idecd_ref_sem);
351         kref_put(&cd->kref, ide_cd_release);
352         up(&idecd_ref_sem);
353 }
354
355 /****************************************************************************
356  * Generic packet command support and error handling routines.
357  */
358
359 /* Mark that we've seen a media change, and invalidate our internal
360    buffers. */
361 static void cdrom_saw_media_change (ide_drive_t *drive)
362 {
363         struct cdrom_info *info = drive->driver_data;
364         
365         CDROM_STATE_FLAGS (drive)->media_changed = 1;
366         CDROM_STATE_FLAGS (drive)->toc_valid = 0;
367         info->nsectors_buffered = 0;
368 }
369
370 static int cdrom_log_sense(ide_drive_t *drive, struct request *rq,
371                            struct request_sense *sense)
372 {
373         int log = 0;
374
375         if (!sense || !rq || (rq->flags & REQ_QUIET))
376                 return 0;
377
378         switch (sense->sense_key) {
379                 case NO_SENSE: case RECOVERED_ERROR:
380                         break;
381                 case NOT_READY:
382                         /*
383                          * don't care about tray state messages for
384                          * e.g. capacity commands or in-progress or
385                          * becoming ready
386                          */
387                         if (sense->asc == 0x3a || sense->asc == 0x04)
388                                 break;
389                         log = 1;
390                         break;
391                 case ILLEGAL_REQUEST:
392                         /*
393                          * don't log START_STOP unit with LoEj set, since
394                          * we cannot reliably check if drive can auto-close
395                          */
396                         if (rq->cmd[0] == GPCMD_START_STOP_UNIT && sense->asc == 0x24)
397                                 log = 0;
398                         break;
399                 case UNIT_ATTENTION:
400                         /*
401                          * Make good and sure we've seen this potential media
402                          * change. Some drives (i.e. Creative) fail to present
403                          * the correct sense key in the error register.
404                          */
405                         cdrom_saw_media_change(drive);
406                         break;
407                 default:
408                         log = 1;
409                         break;
410         }
411         return log;
412 }
413
414 static
415 void cdrom_analyze_sense_data(ide_drive_t *drive,
416                               struct request *failed_command,
417                               struct request_sense *sense)
418 {
419         if (!cdrom_log_sense(drive, failed_command, sense))
420                 return;
421
422         /*
423          * If a read toc is executed for a CD-R or CD-RW medium where
424          * the first toc has not been recorded yet, it will fail with
425          * 05/24/00 (which is a confusing error)
426          */
427         if (failed_command && failed_command->cmd[0] == GPCMD_READ_TOC_PMA_ATIP)
428                 if (sense->sense_key == 0x05 && sense->asc == 0x24)
429                         return;
430
431 #if VERBOSE_IDE_CD_ERRORS
432         {
433                 int i;
434                 const char *s = "bad sense key!";
435                 char buf[80];
436
437                 printk ("ATAPI device %s:\n", drive->name);
438                 if (sense->error_code==0x70)
439                         printk("  Error: ");
440                 else if (sense->error_code==0x71)
441                         printk("  Deferred Error: ");
442                 else if (sense->error_code == 0x7f)
443                         printk("  Vendor-specific Error: ");
444                 else
445                         printk("  Unknown Error Type: ");
446
447                 if (sense->sense_key < ARY_LEN(sense_key_texts))
448                         s = sense_key_texts[sense->sense_key];
449
450                 printk("%s -- (Sense key=0x%02x)\n", s, sense->sense_key);
451
452                 if (sense->asc == 0x40) {
453                         sprintf(buf, "Diagnostic failure on component 0x%02x",
454                                  sense->ascq);
455                         s = buf;
456                 } else {
457                         int lo = 0, mid, hi = ARY_LEN(sense_data_texts);
458                         unsigned long key = (sense->sense_key << 16);
459                         key |= (sense->asc << 8);
460                         if (!(sense->ascq >= 0x80 && sense->ascq <= 0xdd))
461                                 key |= sense->ascq;
462                         s = NULL;
463
464                         while (hi > lo) {
465                                 mid = (lo + hi) / 2;
466                                 if (sense_data_texts[mid].asc_ascq == key ||
467                                     sense_data_texts[mid].asc_ascq == (0xff0000|key)) {
468                                         s = sense_data_texts[mid].text;
469                                         break;
470                                 }
471                                 else if (sense_data_texts[mid].asc_ascq > key)
472                                         hi = mid;
473                                 else
474                                         lo = mid+1;
475                         }
476                 }
477
478                 if (s == NULL) {
479                         if (sense->asc > 0x80)
480                                 s = "(vendor-specific error)";
481                         else
482                                 s = "(reserved error code)";
483                 }
484
485                 printk(KERN_ERR "  %s -- (asc=0x%02x, ascq=0x%02x)\n",
486                         s, sense->asc, sense->ascq);
487
488                 if (failed_command != NULL) {
489
490                         int lo=0, mid, hi= ARY_LEN (packet_command_texts);
491                         s = NULL;
492
493                         while (hi > lo) {
494                                 mid = (lo + hi) / 2;
495                                 if (packet_command_texts[mid].packet_command ==
496                                     failed_command->cmd[0]) {
497                                         s = packet_command_texts[mid].text;
498                                         break;
499                                 }
500                                 if (packet_command_texts[mid].packet_command >
501                                     failed_command->cmd[0])
502                                         hi = mid;
503                                 else
504                                         lo = mid+1;
505                         }
506
507                         printk (KERN_ERR "  The failed \"%s\" packet command was: \n  \"", s);
508                         for (i=0; i<sizeof (failed_command->cmd); i++)
509                                 printk ("%02x ", failed_command->cmd[i]);
510                         printk ("\"\n");
511                 }
512
513                 /* The SKSV bit specifies validity of the sense_key_specific
514                  * in the next two commands. It is bit 7 of the first byte.
515                  * In the case of NOT_READY, if SKSV is set the drive can
516                  * give us nice ETA readings.
517                  */
518                 if (sense->sense_key == NOT_READY && (sense->sks[0] & 0x80)) {
519                         int progress = (sense->sks[1] << 8 | sense->sks[2]) * 100;
520                         printk(KERN_ERR "  Command is %02d%% complete\n", progress / 0xffff);
521
522                 }
523
524                 if (sense->sense_key == ILLEGAL_REQUEST &&
525                     (sense->sks[0] & 0x80) != 0) {
526                         printk(KERN_ERR "  Error in %s byte %d",
527                                 (sense->sks[0] & 0x40) != 0 ?
528                                 "command packet" : "command data",
529                                 (sense->sks[1] << 8) + sense->sks[2]);
530
531                         if ((sense->sks[0] & 0x40) != 0)
532                                 printk (" bit %d", sense->sks[0] & 0x07);
533
534                         printk ("\n");
535                 }
536         }
537
538 #else /* not VERBOSE_IDE_CD_ERRORS */
539
540         /* Suppress printing unit attention and `in progress of becoming ready'
541            errors when we're not being verbose. */
542
543         if (sense->sense_key == UNIT_ATTENTION ||
544             (sense->sense_key == NOT_READY && (sense->asc == 4 ||
545                                                 sense->asc == 0x3a)))
546                 return;
547
548         printk(KERN_ERR "%s: error code: 0x%02x  sense_key: 0x%02x  asc: 0x%02x  ascq: 0x%02x\n",
549                 drive->name,
550                 sense->error_code, sense->sense_key,
551                 sense->asc, sense->ascq);
552 #endif /* not VERBOSE_IDE_CD_ERRORS */
553 }
554
555 /*
556  * Initialize a ide-cd packet command request
557  */
558 static void cdrom_prepare_request(ide_drive_t *drive, struct request *rq)
559 {
560         struct cdrom_info *cd = drive->driver_data;
561
562         ide_init_drive_cmd(rq);
563         rq->flags = REQ_PC;
564         rq->rq_disk = cd->disk;
565 }
566
567 static void cdrom_queue_request_sense(ide_drive_t *drive, void *sense,
568                                       struct request *failed_command)
569 {
570         struct cdrom_info *info         = drive->driver_data;
571         struct request *rq              = &info->request_sense_request;
572
573         if (sense == NULL)
574                 sense = &info->sense_data;
575
576         /* stuff the sense request in front of our current request */
577         cdrom_prepare_request(drive, rq);
578
579         rq->data = sense;
580         rq->cmd[0] = GPCMD_REQUEST_SENSE;
581         rq->cmd[4] = rq->data_len = 18;
582
583         rq->flags = REQ_SENSE;
584
585         /* NOTE! Save the failed command in "rq->buffer" */
586         rq->buffer = (void *) failed_command;
587
588         (void) ide_do_drive_cmd(drive, rq, ide_preempt);
589 }
590
591 static void cdrom_end_request (ide_drive_t *drive, int uptodate)
592 {
593         struct request *rq = HWGROUP(drive)->rq;
594         int nsectors = rq->hard_cur_sectors;
595
596         if ((rq->flags & REQ_SENSE) && uptodate) {
597                 /*
598                  * For REQ_SENSE, "rq->buffer" points to the original failed
599                  * request
600                  */
601                 struct request *failed = (struct request *) rq->buffer;
602                 struct cdrom_info *info = drive->driver_data;
603                 void *sense = &info->sense_data;
604                 unsigned long flags;
605
606                 if (failed) {
607                         if (failed->sense) {
608                                 sense = failed->sense;
609                                 failed->sense_len = rq->sense_len;
610                         }
611
612                         /*
613                          * now end failed request
614                          */
615                         spin_lock_irqsave(&ide_lock, flags);
616                         end_that_request_chunk(failed, 0, failed->data_len);
617                         end_that_request_last(failed);
618                         spin_unlock_irqrestore(&ide_lock, flags);
619                 }
620
621                 cdrom_analyze_sense_data(drive, failed, sense);
622         }
623
624         if (!rq->current_nr_sectors && blk_fs_request(rq))
625                 uptodate = 1;
626         /* make sure it's fully ended */
627         if (blk_pc_request(rq))
628                 nsectors = (rq->data_len + 511) >> 9;
629         if (!nsectors)
630                 nsectors = 1;
631
632         ide_end_request(drive, uptodate, nsectors);
633 }
634
635 /* Returns 0 if the request should be continued.
636    Returns 1 if the request was ended. */
637 static int cdrom_decode_status(ide_drive_t *drive, int good_stat, int *stat_ret)
638 {
639         struct request *rq = HWGROUP(drive)->rq;
640         int stat, err, sense_key;
641         
642         /* Check for errors. */
643         stat = HWIF(drive)->INB(IDE_STATUS_REG);
644         if (stat_ret)
645                 *stat_ret = stat;
646
647         if (OK_STAT(stat, good_stat, BAD_R_STAT))
648                 return 0;
649
650         /* Get the IDE error register. */
651         err = HWIF(drive)->INB(IDE_ERROR_REG);
652         sense_key = err >> 4;
653
654         if (rq == NULL) {
655                 printk("%s: missing rq in cdrom_decode_status\n", drive->name);
656                 return 1;
657         }
658
659         if (rq->flags & REQ_SENSE) {
660                 /* We got an error trying to get sense info
661                    from the drive (probably while trying
662                    to recover from a former error).  Just give up. */
663
664                 rq->flags |= REQ_FAILED;
665                 cdrom_end_request(drive, 0);
666                 ide_error(drive, "request sense failure", stat);
667                 return 1;
668
669         } else if (rq->flags & (REQ_PC | REQ_BLOCK_PC)) {
670                 /* All other functions, except for READ. */
671                 unsigned long flags;
672
673                 /*
674                  * if we have an error, pass back CHECK_CONDITION as the
675                  * scsi status byte
676                  */
677                 if ((rq->flags & REQ_BLOCK_PC) && !rq->errors)
678                         rq->errors = SAM_STAT_CHECK_CONDITION;
679
680                 /* Check for tray open. */
681                 if (sense_key == NOT_READY) {
682                         cdrom_saw_media_change (drive);
683                 } else if (sense_key == UNIT_ATTENTION) {
684                         /* Check for media change. */
685                         cdrom_saw_media_change (drive);
686                         /*printk("%s: media changed\n",drive->name);*/
687                         return 0;
688                 } else if (!(rq->flags & REQ_QUIET)) {
689                         /* Otherwise, print an error. */
690                         ide_dump_status(drive, "packet command error", stat);
691                 }
692                 
693                 rq->flags |= REQ_FAILED;
694
695                 /*
696                  * instead of playing games with moving completions around,
697                  * remove failed request completely and end it when the
698                  * request sense has completed
699                  */
700                 if (stat & ERR_STAT) {
701                         spin_lock_irqsave(&ide_lock, flags);
702                         blkdev_dequeue_request(rq);
703                         HWGROUP(drive)->rq = NULL;
704                         spin_unlock_irqrestore(&ide_lock, flags);
705
706                         cdrom_queue_request_sense(drive, rq->sense, rq);
707                 } else
708                         cdrom_end_request(drive, 0);
709
710         } else if (blk_fs_request(rq)) {
711                 int do_end_request = 0;
712
713                 /* Handle errors from READ and WRITE requests. */
714
715                 if (blk_noretry_request(rq))
716                         do_end_request = 1;
717
718                 if (sense_key == NOT_READY) {
719                         /* Tray open. */
720                         if (rq_data_dir(rq) == READ) {
721                                 cdrom_saw_media_change (drive);
722
723                                 /* Fail the request. */
724                                 printk ("%s: tray open\n", drive->name);
725                                 do_end_request = 1;
726                         } else {
727                                 struct cdrom_info *info = drive->driver_data;
728
729                                 /* allow the drive 5 seconds to recover, some
730                                  * devices will return this error while flushing
731                                  * data from cache */
732                                 if (!rq->errors)
733                                         info->write_timeout = jiffies + ATAPI_WAIT_WRITE_BUSY;
734                                 rq->errors = 1;
735                                 if (time_after(jiffies, info->write_timeout))
736                                         do_end_request = 1;
737                                 else {
738                                         unsigned long flags;
739
740                                         /*
741                                          * take a breather relying on the
742                                          * unplug timer to kick us again
743                                          */
744                                         spin_lock_irqsave(&ide_lock, flags);
745                                         blk_plug_device(drive->queue);
746                                         spin_unlock_irqrestore(&ide_lock,flags);
747                                         return 1;
748                                 }
749                         }
750                 } else if (sense_key == UNIT_ATTENTION) {
751                         /* Media change. */
752                         cdrom_saw_media_change (drive);
753
754                         /* Arrange to retry the request.
755                            But be sure to give up if we've retried
756                            too many times. */
757                         if (++rq->errors > ERROR_MAX)
758                                 do_end_request = 1;
759                 } else if (sense_key == ILLEGAL_REQUEST ||
760                            sense_key == DATA_PROTECT) {
761                         /* No point in retrying after an illegal
762                            request or data protect error.*/
763                         ide_dump_status (drive, "command error", stat);
764                         do_end_request = 1;
765                 } else if (sense_key == MEDIUM_ERROR) {
766                         /* No point in re-trying a zillion times on a bad 
767                          * sector...  If we got here the error is not correctable */
768                         ide_dump_status (drive, "media error (bad sector)", stat);
769                         do_end_request = 1;
770                 } else if (sense_key == BLANK_CHECK) {
771                         /* Disk appears blank ?? */
772                         ide_dump_status (drive, "media error (blank)", stat);
773                         do_end_request = 1;
774                 } else if ((err & ~ABRT_ERR) != 0) {
775                         /* Go to the default handler
776                            for other errors. */
777                         ide_error(drive, "cdrom_decode_status", stat);
778                         return 1;
779                 } else if ((++rq->errors > ERROR_MAX)) {
780                         /* We've racked up too many retries.  Abort. */
781                         do_end_request = 1;
782                 }
783
784                 if (do_end_request)
785                         cdrom_end_request(drive, 0);
786
787                 /* If we got a CHECK_CONDITION status,
788                    queue a request sense command. */
789                 if ((stat & ERR_STAT) != 0)
790                         cdrom_queue_request_sense(drive, NULL, NULL);
791         } else {
792                 blk_dump_rq_flags(rq, "ide-cd: bad rq");
793                 cdrom_end_request(drive, 0);
794         }
795
796         /* Retry, or handle the next request. */
797         return 1;
798 }
799
800 static int cdrom_timer_expiry(ide_drive_t *drive)
801 {
802         struct request *rq = HWGROUP(drive)->rq;
803         unsigned long wait = 0;
804
805         /*
806          * Some commands are *slow* and normally take a long time to
807          * complete. Usually we can use the ATAPI "disconnect" to bypass
808          * this, but not all commands/drives support that. Let
809          * ide_timer_expiry keep polling us for these.
810          */
811         switch (rq->cmd[0]) {
812                 case GPCMD_BLANK:
813                 case GPCMD_FORMAT_UNIT:
814                 case GPCMD_RESERVE_RZONE_TRACK:
815                 case GPCMD_CLOSE_TRACK:
816                 case GPCMD_FLUSH_CACHE:
817                         wait = ATAPI_WAIT_PC;
818                         break;
819                 default:
820                         if (!(rq->flags & REQ_QUIET))
821                                 printk(KERN_INFO "ide-cd: cmd 0x%x timed out\n", rq->cmd[0]);
822                         wait = 0;
823                         break;
824         }
825         return wait;
826 }
827
828 /* Set up the device registers for transferring a packet command on DEV,
829    expecting to later transfer XFERLEN bytes.  HANDLER is the routine
830    which actually transfers the command to the drive.  If this is a
831    drq_interrupt device, this routine will arrange for HANDLER to be
832    called when the interrupt from the drive arrives.  Otherwise, HANDLER
833    will be called immediately after the drive is prepared for the transfer. */
834
835 static ide_startstop_t cdrom_start_packet_command(ide_drive_t *drive,
836                                                   int xferlen,
837                                                   ide_handler_t *handler)
838 {
839         ide_startstop_t startstop;
840         struct cdrom_info *info = drive->driver_data;
841         ide_hwif_t *hwif = drive->hwif;
842
843         /* Wait for the controller to be idle. */
844         if (ide_wait_stat(&startstop, drive, 0, BUSY_STAT, WAIT_READY))
845                 return startstop;
846
847         if (info->dma)
848                 info->dma = !hwif->dma_setup(drive);
849
850         /* Set up the controller registers. */
851         /* FIXME: for Virtual DMA we must check harder */
852         HWIF(drive)->OUTB(info->dma, IDE_FEATURE_REG);
853         HWIF(drive)->OUTB(0, IDE_IREASON_REG);
854         HWIF(drive)->OUTB(0, IDE_SECTOR_REG);
855
856         HWIF(drive)->OUTB(xferlen & 0xff, IDE_BCOUNTL_REG);
857         HWIF(drive)->OUTB(xferlen >> 8  , IDE_BCOUNTH_REG);
858         if (IDE_CONTROL_REG)
859                 HWIF(drive)->OUTB(drive->ctl, IDE_CONTROL_REG);
860  
861         if (CDROM_CONFIG_FLAGS (drive)->drq_interrupt) {
862                 /* packet command */
863                 ide_execute_command(drive, WIN_PACKETCMD, handler, ATAPI_WAIT_PC, cdrom_timer_expiry);
864                 return ide_started;
865         } else {
866                 unsigned long flags;
867
868                 /* packet command */
869                 spin_lock_irqsave(&ide_lock, flags);
870                 hwif->OUTBSYNC(drive, WIN_PACKETCMD, IDE_COMMAND_REG);
871                 ndelay(400);
872                 spin_unlock_irqrestore(&ide_lock, flags);
873
874                 return (*handler) (drive);
875         }
876 }
877
878 /* Send a packet command to DRIVE described by CMD_BUF and CMD_LEN.
879    The device registers must have already been prepared
880    by cdrom_start_packet_command.
881    HANDLER is the interrupt handler to call when the command completes
882    or there's data ready. */
883 /*
884  * changed 5 parameters to 3 for dvd-ram
885  * struct packet_command *pc; now packet_command_t *pc;
886  */
887 #define ATAPI_MIN_CDB_BYTES 12
888 static ide_startstop_t cdrom_transfer_packet_command (ide_drive_t *drive,
889                                           struct request *rq,
890                                           ide_handler_t *handler)
891 {
892         ide_hwif_t *hwif = drive->hwif;
893         int cmd_len;
894         struct cdrom_info *info = drive->driver_data;
895         ide_startstop_t startstop;
896
897         if (CDROM_CONFIG_FLAGS(drive)->drq_interrupt) {
898                 /* Here we should have been called after receiving an interrupt
899                    from the device.  DRQ should how be set. */
900
901                 /* Check for errors. */
902                 if (cdrom_decode_status(drive, DRQ_STAT, NULL))
903                         return ide_stopped;
904         } else {
905                 /* Otherwise, we must wait for DRQ to get set. */
906                 if (ide_wait_stat(&startstop, drive, DRQ_STAT,
907                                 BUSY_STAT, WAIT_READY))
908                         return startstop;
909         }
910
911         /* Arm the interrupt handler. */
912         ide_set_handler(drive, handler, rq->timeout, cdrom_timer_expiry);
913
914         /* ATAPI commands get padded out to 12 bytes minimum */
915         cmd_len = COMMAND_SIZE(rq->cmd[0]);
916         if (cmd_len < ATAPI_MIN_CDB_BYTES)
917                 cmd_len = ATAPI_MIN_CDB_BYTES;
918
919         /* Send the command to the device. */
920         HWIF(drive)->atapi_output_bytes(drive, rq->cmd, cmd_len);
921
922         /* Start the DMA if need be */
923         if (info->dma)
924                 hwif->dma_start(drive);
925
926         return ide_started;
927 }
928
929 /****************************************************************************
930  * Block read functions.
931  */
932
933 /*
934  * Buffer up to SECTORS_TO_TRANSFER sectors from the drive in our sector
935  * buffer.  Once the first sector is added, any subsequent sectors are
936  * assumed to be continuous (until the buffer is cleared).  For the first
937  * sector added, SECTOR is its sector number.  (SECTOR is then ignored until
938  * the buffer is cleared.)
939  */
940 static void cdrom_buffer_sectors (ide_drive_t *drive, unsigned long sector,
941                                   int sectors_to_transfer)
942 {
943         struct cdrom_info *info = drive->driver_data;
944
945         /* Number of sectors to read into the buffer. */
946         int sectors_to_buffer = min_t(int, sectors_to_transfer,
947                                      (SECTOR_BUFFER_SIZE >> SECTOR_BITS) -
948                                        info->nsectors_buffered);
949
950         char *dest;
951
952         /* If we couldn't get a buffer, don't try to buffer anything... */
953         if (info->buffer == NULL)
954                 sectors_to_buffer = 0;
955
956         /* If this is the first sector in the buffer, remember its number. */
957         if (info->nsectors_buffered == 0)
958                 info->sector_buffered = sector;
959
960         /* Read the data into the buffer. */
961         dest = info->buffer + info->nsectors_buffered * SECTOR_SIZE;
962         while (sectors_to_buffer > 0) {
963                 HWIF(drive)->atapi_input_bytes(drive, dest, SECTOR_SIZE);
964                 --sectors_to_buffer;
965                 --sectors_to_transfer;
966                 ++info->nsectors_buffered;
967                 dest += SECTOR_SIZE;
968         }
969
970         /* Throw away any remaining data. */
971         while (sectors_to_transfer > 0) {
972                 static char dum[SECTOR_SIZE];
973                 HWIF(drive)->atapi_input_bytes(drive, dum, sizeof (dum));
974                 --sectors_to_transfer;
975         }
976 }
977
978 /*
979  * Check the contents of the interrupt reason register from the cdrom
980  * and attempt to recover if there are problems.  Returns  0 if everything's
981  * ok; nonzero if the request has been terminated.
982  */
983 static inline
984 int cdrom_read_check_ireason (ide_drive_t *drive, int len, int ireason)
985 {
986         if (ireason == 2)
987                 return 0;
988         else if (ireason == 0) {
989                 /* Whoops... The drive is expecting to receive data from us! */
990                 printk(KERN_ERR "%s: read_intr: Drive wants to transfer data the "
991                                                 "wrong way!\n", drive->name);
992
993                 /* Throw some data at the drive so it doesn't hang
994                    and quit this request. */
995                 while (len > 0) {
996                         int dum = 0;
997                         HWIF(drive)->atapi_output_bytes(drive, &dum, sizeof (dum));
998                         len -= sizeof (dum);
999                 }
1000         } else  if (ireason == 1) {
1001                 /* Some drives (ASUS) seem to tell us that status
1002                  * info is available. just get it and ignore.
1003                  */
1004                 (void) HWIF(drive)->INB(IDE_STATUS_REG);
1005                 return 0;
1006         } else {
1007                 /* Drive wants a command packet, or invalid ireason... */
1008                 printk(KERN_ERR "%s: read_intr: bad interrupt reason %x\n", drive->name,
1009                                                                 ireason);
1010         }
1011
1012         cdrom_end_request(drive, 0);
1013         return -1;
1014 }
1015
1016 /*
1017  * Interrupt routine.  Called when a read request has completed.
1018  */
1019 static ide_startstop_t cdrom_read_intr (ide_drive_t *drive)
1020 {
1021         int stat;
1022         int ireason, len, sectors_to_transfer, nskip;
1023         struct cdrom_info *info = drive->driver_data;
1024         u8 lowcyl = 0, highcyl = 0;
1025         int dma = info->dma, dma_error = 0;
1026
1027         struct request *rq = HWGROUP(drive)->rq;
1028
1029         /*
1030          * handle dma case
1031          */
1032         if (dma) {
1033                 info->dma = 0;
1034                 if ((dma_error = HWIF(drive)->ide_dma_end(drive)))
1035                         __ide_dma_off(drive);
1036         }
1037
1038         if (cdrom_decode_status(drive, 0, &stat))
1039                 return ide_stopped;
1040
1041         if (dma) {
1042                 if (!dma_error) {
1043                         ide_end_request(drive, 1, rq->nr_sectors);
1044                         return ide_stopped;
1045                 } else
1046                         return ide_error(drive, "dma error", stat);
1047         }
1048
1049         /* Read the interrupt reason and the transfer length. */
1050         ireason = HWIF(drive)->INB(IDE_IREASON_REG) & 0x3;
1051         lowcyl  = HWIF(drive)->INB(IDE_BCOUNTL_REG);
1052         highcyl = HWIF(drive)->INB(IDE_BCOUNTH_REG);
1053
1054         len = lowcyl + (256 * highcyl);
1055
1056         /* If DRQ is clear, the command has completed. */
1057         if ((stat & DRQ_STAT) == 0) {
1058                 /* If we're not done filling the current buffer, complain.
1059                    Otherwise, complete the command normally. */
1060                 if (rq->current_nr_sectors > 0) {
1061                         printk (KERN_ERR "%s: cdrom_read_intr: data underrun (%d blocks)\n",
1062                                 drive->name, rq->current_nr_sectors);
1063                         rq->flags |= REQ_FAILED;
1064                         cdrom_end_request(drive, 0);
1065                 } else
1066                         cdrom_end_request(drive, 1);
1067                 return ide_stopped;
1068         }
1069
1070         /* Check that the drive is expecting to do the same thing we are. */
1071         if (cdrom_read_check_ireason (drive, len, ireason))
1072                 return ide_stopped;
1073
1074         /* Assume that the drive will always provide data in multiples
1075            of at least SECTOR_SIZE, as it gets hairy to keep track
1076            of the transfers otherwise. */
1077         if ((len % SECTOR_SIZE) != 0) {
1078                 printk (KERN_ERR "%s: cdrom_read_intr: Bad transfer size %d\n",
1079                         drive->name, len);
1080                 if (CDROM_CONFIG_FLAGS(drive)->limit_nframes)
1081                         printk (KERN_ERR "  This drive is not supported by this version of the driver\n");
1082                 else {
1083                         printk (KERN_ERR "  Trying to limit transfer sizes\n");
1084                         CDROM_CONFIG_FLAGS(drive)->limit_nframes = 1;
1085                 }
1086                 cdrom_end_request(drive, 0);
1087                 return ide_stopped;
1088         }
1089
1090         /* The number of sectors we need to read from the drive. */
1091         sectors_to_transfer = len / SECTOR_SIZE;
1092
1093         /* First, figure out if we need to bit-bucket
1094            any of the leading sectors. */
1095         nskip = min_t(int, rq->current_nr_sectors - bio_cur_sectors(rq->bio), sectors_to_transfer);
1096
1097         while (nskip > 0) {
1098                 /* We need to throw away a sector. */
1099                 static char dum[SECTOR_SIZE];
1100                 HWIF(drive)->atapi_input_bytes(drive, dum, sizeof (dum));
1101
1102                 --rq->current_nr_sectors;
1103                 --nskip;
1104                 --sectors_to_transfer;
1105         }
1106
1107         /* Now loop while we still have data to read from the drive. */
1108         while (sectors_to_transfer > 0) {
1109                 int this_transfer;
1110
1111                 /* If we've filled the present buffer but there's another
1112                    chained buffer after it, move on. */
1113                 if (rq->current_nr_sectors == 0 && rq->nr_sectors)
1114                         cdrom_end_request(drive, 1);
1115
1116                 /* If the buffers are full, cache the rest of the data in our
1117                    internal buffer. */
1118                 if (rq->current_nr_sectors == 0) {
1119                         cdrom_buffer_sectors(drive, rq->sector, sectors_to_transfer);
1120                         sectors_to_transfer = 0;
1121                 } else {
1122                         /* Transfer data to the buffers.
1123                            Figure out how many sectors we can transfer
1124                            to the current buffer. */
1125                         this_transfer = min_t(int, sectors_to_transfer,
1126                                              rq->current_nr_sectors);
1127
1128                         /* Read this_transfer sectors
1129                            into the current buffer. */
1130                         while (this_transfer > 0) {
1131                                 HWIF(drive)->atapi_input_bytes(drive, rq->buffer, SECTOR_SIZE);
1132                                 rq->buffer += SECTOR_SIZE;
1133                                 --rq->nr_sectors;
1134                                 --rq->current_nr_sectors;
1135                                 ++rq->sector;
1136                                 --this_transfer;
1137                                 --sectors_to_transfer;
1138                         }
1139                 }
1140         }
1141
1142         /* Done moving data!  Wait for another interrupt. */
1143         ide_set_handler(drive, &cdrom_read_intr, ATAPI_WAIT_PC, NULL);
1144         return ide_started;
1145 }
1146
1147 /*
1148  * Try to satisfy some of the current read request from our cached data.
1149  * Returns nonzero if the request has been completed, zero otherwise.
1150  */
1151 static int cdrom_read_from_buffer (ide_drive_t *drive)
1152 {
1153         struct cdrom_info *info = drive->driver_data;
1154         struct request *rq = HWGROUP(drive)->rq;
1155         unsigned short sectors_per_frame;
1156
1157         sectors_per_frame = queue_hardsect_size(drive->queue) >> SECTOR_BITS;
1158
1159         /* Can't do anything if there's no buffer. */
1160         if (info->buffer == NULL) return 0;
1161
1162         /* Loop while this request needs data and the next block is present
1163            in our cache. */
1164         while (rq->nr_sectors > 0 &&
1165                rq->sector >= info->sector_buffered &&
1166                rq->sector < info->sector_buffered + info->nsectors_buffered) {
1167                 if (rq->current_nr_sectors == 0)
1168                         cdrom_end_request(drive, 1);
1169
1170                 memcpy (rq->buffer,
1171                         info->buffer +
1172                         (rq->sector - info->sector_buffered) * SECTOR_SIZE,
1173                         SECTOR_SIZE);
1174                 rq->buffer += SECTOR_SIZE;
1175                 --rq->current_nr_sectors;
1176                 --rq->nr_sectors;
1177                 ++rq->sector;
1178         }
1179
1180         /* If we've satisfied the current request,
1181            terminate it successfully. */
1182         if (rq->nr_sectors == 0) {
1183                 cdrom_end_request(drive, 1);
1184                 return -1;
1185         }
1186
1187         /* Move on to the next buffer if needed. */
1188         if (rq->current_nr_sectors == 0)
1189                 cdrom_end_request(drive, 1);
1190
1191         /* If this condition does not hold, then the kluge i use to
1192            represent the number of sectors to skip at the start of a transfer
1193            will fail.  I think that this will never happen, but let's be
1194            paranoid and check. */
1195         if (rq->current_nr_sectors < bio_cur_sectors(rq->bio) &&
1196             (rq->sector & (sectors_per_frame - 1))) {
1197                 printk(KERN_ERR "%s: cdrom_read_from_buffer: buffer botch (%ld)\n",
1198                         drive->name, (long)rq->sector);
1199                 cdrom_end_request(drive, 0);
1200                 return -1;
1201         }
1202
1203         return 0;
1204 }
1205
1206 /*
1207  * Routine to send a read packet command to the drive.
1208  * This is usually called directly from cdrom_start_read.
1209  * However, for drq_interrupt devices, it is called from an interrupt
1210  * when the drive is ready to accept the command.
1211  */
1212 static ide_startstop_t cdrom_start_read_continuation (ide_drive_t *drive)
1213 {
1214         struct request *rq = HWGROUP(drive)->rq;
1215         unsigned short sectors_per_frame;
1216         int nskip;
1217
1218         sectors_per_frame = queue_hardsect_size(drive->queue) >> SECTOR_BITS;
1219
1220         /* If the requested sector doesn't start on a cdrom block boundary,
1221            we must adjust the start of the transfer so that it does,
1222            and remember to skip the first few sectors.
1223            If the CURRENT_NR_SECTORS field is larger than the size
1224            of the buffer, it will mean that we're to skip a number
1225            of sectors equal to the amount by which CURRENT_NR_SECTORS
1226            is larger than the buffer size. */
1227         nskip = rq->sector & (sectors_per_frame - 1);
1228         if (nskip > 0) {
1229                 /* Sanity check... */
1230                 if (rq->current_nr_sectors != bio_cur_sectors(rq->bio) &&
1231                         (rq->sector & (sectors_per_frame - 1))) {
1232                         printk(KERN_ERR "%s: cdrom_start_read_continuation: buffer botch (%u)\n",
1233                                 drive->name, rq->current_nr_sectors);
1234                         cdrom_end_request(drive, 0);
1235                         return ide_stopped;
1236                 }
1237                 rq->current_nr_sectors += nskip;
1238         }
1239
1240         /* Set up the command */
1241         rq->timeout = ATAPI_WAIT_PC;
1242
1243         /* Send the command to the drive and return. */
1244         return cdrom_transfer_packet_command(drive, rq, &cdrom_read_intr);
1245 }
1246
1247
1248 #define IDECD_SEEK_THRESHOLD    (1000)                  /* 1000 blocks */
1249 #define IDECD_SEEK_TIMER        (5 * WAIT_MIN_SLEEP)    /* 100 ms */
1250 #define IDECD_SEEK_TIMEOUT      (2 * WAIT_CMD)          /* 20 sec */
1251
1252 static ide_startstop_t cdrom_seek_intr (ide_drive_t *drive)
1253 {
1254         struct cdrom_info *info = drive->driver_data;
1255         int stat;
1256         static int retry = 10;
1257
1258         if (cdrom_decode_status(drive, 0, &stat))
1259                 return ide_stopped;
1260         CDROM_CONFIG_FLAGS(drive)->seeking = 1;
1261
1262         if (retry && time_after(jiffies, info->start_seek + IDECD_SEEK_TIMER)) {
1263                 if (--retry == 0) {
1264                         /*
1265                          * this condition is far too common, to bother
1266                          * users about it
1267                          */
1268                         /* printk("%s: disabled DSC seek overlap\n", drive->name);*/ 
1269                         drive->dsc_overlap = 0;
1270                 }
1271         }
1272         return ide_stopped;
1273 }
1274
1275 static ide_startstop_t cdrom_start_seek_continuation (ide_drive_t *drive)
1276 {
1277         struct request *rq = HWGROUP(drive)->rq;
1278         sector_t frame = rq->sector;
1279
1280         sector_div(frame, queue_hardsect_size(drive->queue) >> SECTOR_BITS);
1281
1282         memset(rq->cmd, 0, sizeof(rq->cmd));
1283         rq->cmd[0] = GPCMD_SEEK;
1284         put_unaligned(cpu_to_be32(frame), (unsigned int *) &rq->cmd[2]);
1285
1286         rq->timeout = ATAPI_WAIT_PC;
1287         return cdrom_transfer_packet_command(drive, rq, &cdrom_seek_intr);
1288 }
1289
1290 static ide_startstop_t cdrom_start_seek (ide_drive_t *drive, unsigned int block)
1291 {
1292         struct cdrom_info *info = drive->driver_data;
1293
1294         info->dma = 0;
1295         info->cmd = 0;
1296         info->start_seek = jiffies;
1297         return cdrom_start_packet_command(drive, 0, cdrom_start_seek_continuation);
1298 }
1299
1300 /* Fix up a possibly partially-processed request so that we can
1301    start it over entirely, or even put it back on the request queue. */
1302 static void restore_request (struct request *rq)
1303 {
1304         if (rq->buffer != bio_data(rq->bio)) {
1305                 sector_t n = (rq->buffer - (char *) bio_data(rq->bio)) / SECTOR_SIZE;
1306
1307                 rq->buffer = bio_data(rq->bio);
1308                 rq->nr_sectors += n;
1309                 rq->sector -= n;
1310         }
1311         rq->hard_cur_sectors = rq->current_nr_sectors = bio_cur_sectors(rq->bio);
1312         rq->hard_nr_sectors = rq->nr_sectors;
1313         rq->hard_sector = rq->sector;
1314         rq->q->prep_rq_fn(rq->q, rq);
1315 }
1316
1317 /*
1318  * Start a read request from the CD-ROM.
1319  */
1320 static ide_startstop_t cdrom_start_read (ide_drive_t *drive, unsigned int block)
1321 {
1322         struct cdrom_info *info = drive->driver_data;
1323         struct request *rq = HWGROUP(drive)->rq;
1324         unsigned short sectors_per_frame;
1325
1326         sectors_per_frame = queue_hardsect_size(drive->queue) >> SECTOR_BITS;
1327
1328         /* We may be retrying this request after an error.  Fix up
1329            any weirdness which might be present in the request packet. */
1330         restore_request(rq);
1331
1332         /* Satisfy whatever we can of this request from our cached sector. */
1333         if (cdrom_read_from_buffer(drive))
1334                 return ide_stopped;
1335
1336         blk_attempt_remerge(drive->queue, rq);
1337
1338         /* Clear the local sector buffer. */
1339         info->nsectors_buffered = 0;
1340
1341         /* use dma, if possible. */
1342         info->dma = drive->using_dma;
1343         if ((rq->sector & (sectors_per_frame - 1)) ||
1344             (rq->nr_sectors & (sectors_per_frame - 1)))
1345                 info->dma = 0;
1346
1347         info->cmd = READ;
1348
1349         /* Start sending the read request to the drive. */
1350         return cdrom_start_packet_command(drive, 32768, cdrom_start_read_continuation);
1351 }
1352
1353 /****************************************************************************
1354  * Execute all other packet commands.
1355  */
1356
1357 /* Interrupt routine for packet command completion. */
1358 static ide_startstop_t cdrom_pc_intr (ide_drive_t *drive)
1359 {
1360         int ireason, len, thislen;
1361         struct request *rq = HWGROUP(drive)->rq;
1362         u8 lowcyl = 0, highcyl = 0;
1363         int stat;
1364
1365         /* Check for errors. */
1366         if (cdrom_decode_status(drive, 0, &stat))
1367                 return ide_stopped;
1368
1369         /* Read the interrupt reason and the transfer length. */
1370         ireason = HWIF(drive)->INB(IDE_IREASON_REG);
1371         lowcyl  = HWIF(drive)->INB(IDE_BCOUNTL_REG);
1372         highcyl = HWIF(drive)->INB(IDE_BCOUNTH_REG);
1373
1374         len = lowcyl + (256 * highcyl);
1375
1376         /* If DRQ is clear, the command has completed.
1377            Complain if we still have data left to transfer. */
1378         if ((stat & DRQ_STAT) == 0) {
1379                 /* Some of the trailing request sense fields are optional, and
1380                    some drives don't send them.  Sigh. */
1381                 if (rq->cmd[0] == GPCMD_REQUEST_SENSE &&
1382                     rq->data_len > 0 &&
1383                     rq->data_len <= 5) {
1384                         while (rq->data_len > 0) {
1385                                 *(unsigned char *)rq->data++ = 0;
1386                                 --rq->data_len;
1387                         }
1388                 }
1389
1390                 if (rq->data_len == 0)
1391                         cdrom_end_request(drive, 1);
1392                 else {
1393                         /* Comment this out, because this always happens 
1394                            right after a reset occurs, and it is annoying to 
1395                            always print expected stuff.  */
1396                         /*
1397                         printk ("%s: cdrom_pc_intr: data underrun %d\n",
1398                                 drive->name, pc->buflen);
1399                         */
1400                         rq->flags |= REQ_FAILED;
1401                         cdrom_end_request(drive, 0);
1402                 }
1403                 return ide_stopped;
1404         }
1405
1406         /* Figure out how much data to transfer. */
1407         thislen = rq->data_len;
1408         if (thislen > len) thislen = len;
1409
1410         /* The drive wants to be written to. */
1411         if ((ireason & 3) == 0) {
1412                 if (!rq->data) {
1413                         blk_dump_rq_flags(rq, "cdrom_pc_intr, write");
1414                         goto confused;
1415                 }
1416                 /* Transfer the data. */
1417                 HWIF(drive)->atapi_output_bytes(drive, rq->data, thislen);
1418
1419                 /* If we haven't moved enough data to satisfy the drive,
1420                    add some padding. */
1421                 while (len > thislen) {
1422                         int dum = 0;
1423                         HWIF(drive)->atapi_output_bytes(drive, &dum, sizeof(dum));
1424                         len -= sizeof(dum);
1425                 }
1426
1427                 /* Keep count of how much data we've moved. */
1428                 rq->data += thislen;
1429                 rq->data_len -= thislen;
1430         }
1431
1432         /* Same drill for reading. */
1433         else if ((ireason & 3) == 2) {
1434                 if (!rq->data) {
1435                         blk_dump_rq_flags(rq, "cdrom_pc_intr, write");
1436                         goto confused;
1437                 }
1438                 /* Transfer the data. */
1439                 HWIF(drive)->atapi_input_bytes(drive, rq->data, thislen);
1440
1441                 /* If we haven't moved enough data to satisfy the drive,
1442                    add some padding. */
1443                 while (len > thislen) {
1444                         int dum = 0;
1445                         HWIF(drive)->atapi_input_bytes(drive, &dum, sizeof(dum));
1446                         len -= sizeof(dum);
1447                 }
1448
1449                 /* Keep count of how much data we've moved. */
1450                 rq->data += thislen;
1451                 rq->data_len -= thislen;
1452
1453                 if (rq->flags & REQ_SENSE)
1454                         rq->sense_len += thislen;
1455         } else {
1456 confused:
1457                 printk (KERN_ERR "%s: cdrom_pc_intr: The drive "
1458                         "appears confused (ireason = 0x%02x)\n",
1459                         drive->name, ireason);
1460                 rq->flags |= REQ_FAILED;
1461         }
1462
1463         /* Now we wait for another interrupt. */
1464         ide_set_handler(drive, &cdrom_pc_intr, ATAPI_WAIT_PC, cdrom_timer_expiry);
1465         return ide_started;
1466 }
1467
1468 static ide_startstop_t cdrom_do_pc_continuation (ide_drive_t *drive)
1469 {
1470         struct request *rq = HWGROUP(drive)->rq;
1471
1472         if (!rq->timeout)
1473                 rq->timeout = ATAPI_WAIT_PC;
1474
1475         /* Send the command to the drive and return. */
1476         return cdrom_transfer_packet_command(drive, rq, &cdrom_pc_intr);
1477 }
1478
1479
1480 static ide_startstop_t cdrom_do_packet_command (ide_drive_t *drive)
1481 {
1482         int len;
1483         struct request *rq = HWGROUP(drive)->rq;
1484         struct cdrom_info *info = drive->driver_data;
1485
1486         info->dma = 0;
1487         info->cmd = 0;
1488         rq->flags &= ~REQ_FAILED;
1489         len = rq->data_len;
1490
1491         /* Start sending the command to the drive. */
1492         return cdrom_start_packet_command(drive, len, cdrom_do_pc_continuation);
1493 }
1494
1495
1496 static
1497 int cdrom_queue_packet_command(ide_drive_t *drive, struct request *rq)
1498 {
1499         struct request_sense sense;
1500         int retries = 10;
1501         unsigned int flags = rq->flags;
1502
1503         if (rq->sense == NULL)
1504                 rq->sense = &sense;
1505
1506         /* Start of retry loop. */
1507         do {
1508                 int error;
1509                 unsigned long time = jiffies;
1510                 rq->flags = flags;
1511
1512                 error = ide_do_drive_cmd(drive, rq, ide_wait);
1513                 time = jiffies - time;
1514
1515                 /* FIXME: we should probably abort/retry or something 
1516                  * in case of failure */
1517                 if (rq->flags & REQ_FAILED) {
1518                         /* The request failed.  Retry if it was due to a unit
1519                            attention status
1520                            (usually means media was changed). */
1521                         struct request_sense *reqbuf = rq->sense;
1522
1523                         if (reqbuf->sense_key == UNIT_ATTENTION)
1524                                 cdrom_saw_media_change(drive);
1525                         else if (reqbuf->sense_key == NOT_READY &&
1526                                  reqbuf->asc == 4 && reqbuf->ascq != 4) {
1527                                 /* The drive is in the process of loading
1528                                    a disk.  Retry, but wait a little to give
1529                                    the drive time to complete the load. */
1530                                 ssleep(2);
1531                         } else {
1532                                 /* Otherwise, don't retry. */
1533                                 retries = 0;
1534                         }
1535                         --retries;
1536                 }
1537
1538                 /* End of retry loop. */
1539         } while ((rq->flags & REQ_FAILED) && retries >= 0);
1540
1541         /* Return an error if the command failed. */
1542         return (rq->flags & REQ_FAILED) ? -EIO : 0;
1543 }
1544
1545 /*
1546  * Write handling
1547  */
1548 static inline int cdrom_write_check_ireason(ide_drive_t *drive, int len, int ireason)
1549 {
1550         /* Two notes about IDE interrupt reason here - 0 means that
1551          * the drive wants to receive data from us, 2 means that
1552          * the drive is expecting to transfer data to us.
1553          */
1554         if (ireason == 0)
1555                 return 0;
1556         else if (ireason == 2) {
1557                 /* Whoops... The drive wants to send data. */
1558                 printk(KERN_ERR "%s: write_intr: wrong transfer direction!\n",
1559                                                         drive->name);
1560
1561                 while (len > 0) {
1562                         int dum = 0;
1563                         HWIF(drive)->atapi_input_bytes(drive, &dum, sizeof(dum));
1564                         len -= sizeof(dum);
1565                 }
1566         } else {
1567                 /* Drive wants a command packet, or invalid ireason... */
1568                 printk(KERN_ERR "%s: write_intr: bad interrupt reason %x\n",
1569                                                         drive->name, ireason);
1570         }
1571
1572         cdrom_end_request(drive, 0);
1573         return 1;
1574 }
1575
1576 static void post_transform_command(struct request *req)
1577 {
1578         u8 *c = req->cmd;
1579         char *ibuf;
1580
1581         if (!blk_pc_request(req))
1582                 return;
1583
1584         if (req->bio)
1585                 ibuf = bio_data(req->bio);
1586         else
1587                 ibuf = req->data;
1588
1589         if (!ibuf)
1590                 return;
1591
1592         /*
1593          * set ansi-revision and response data as atapi
1594          */
1595         if (c[0] == GPCMD_INQUIRY) {
1596                 ibuf[2] |= 2;
1597                 ibuf[3] = (ibuf[3] & 0xf0) | 2;
1598         }
1599 }
1600
1601 typedef void (xfer_func_t)(ide_drive_t *, void *, u32);
1602
1603 /*
1604  * best way to deal with dma that is not sector aligned right now... note
1605  * that in this path we are not using ->data or ->buffer at all. this irs
1606  * can replace cdrom_pc_intr, cdrom_read_intr, and cdrom_write_intr in the
1607  * future.
1608  */
1609 static ide_startstop_t cdrom_newpc_intr(ide_drive_t *drive)
1610 {
1611         struct cdrom_info *info = drive->driver_data;
1612         struct request *rq = HWGROUP(drive)->rq;
1613         int dma_error, dma, stat, ireason, len, thislen;
1614         u8 lowcyl, highcyl;
1615         xfer_func_t *xferfunc;
1616         unsigned long flags;
1617
1618         /* Check for errors. */
1619         dma_error = 0;
1620         dma = info->dma;
1621         if (dma) {
1622                 info->dma = 0;
1623                 dma_error = HWIF(drive)->ide_dma_end(drive);
1624         }
1625
1626         if (cdrom_decode_status(drive, 0, &stat))
1627                 return ide_stopped;
1628
1629         /*
1630          * using dma, transfer is complete now
1631          */
1632         if (dma) {
1633                 if (dma_error) {
1634                         printk(KERN_ERR "ide-cd: dma error\n");
1635                         __ide_dma_off(drive);
1636                         return ide_error(drive, "dma error", stat);
1637                 }
1638
1639                 end_that_request_chunk(rq, 1, rq->data_len);
1640                 rq->data_len = 0;
1641                 goto end_request;
1642         }
1643
1644         /*
1645          * ok we fall to pio :/
1646          */
1647         ireason = HWIF(drive)->INB(IDE_IREASON_REG) & 0x3;
1648         lowcyl  = HWIF(drive)->INB(IDE_BCOUNTL_REG);
1649         highcyl = HWIF(drive)->INB(IDE_BCOUNTH_REG);
1650
1651         len = lowcyl + (256 * highcyl);
1652         thislen = rq->data_len;
1653         if (thislen > len)
1654                 thislen = len;
1655
1656         /*
1657          * If DRQ is clear, the command has completed.
1658          */
1659         if ((stat & DRQ_STAT) == 0)
1660                 goto end_request;
1661
1662         /*
1663          * check which way to transfer data
1664          */
1665         if (rq_data_dir(rq) == WRITE) {
1666                 /*
1667                  * write to drive
1668                  */
1669                 if (cdrom_write_check_ireason(drive, len, ireason))
1670                         return ide_stopped;
1671
1672                 xferfunc = HWIF(drive)->atapi_output_bytes;
1673         } else  {
1674                 /*
1675                  * read from drive
1676                  */
1677                 if (cdrom_read_check_ireason(drive, len, ireason))
1678                         return ide_stopped;
1679
1680                 xferfunc = HWIF(drive)->atapi_input_bytes;
1681         }
1682
1683         /*
1684          * transfer data
1685          */
1686         while (thislen > 0) {
1687                 int blen = blen = rq->data_len;
1688                 char *ptr = rq->data;
1689
1690                 /*
1691                  * bio backed?
1692                  */
1693                 if (rq->bio) {
1694                         ptr = bio_data(rq->bio);
1695                         blen = bio_iovec(rq->bio)->bv_len;
1696                 }
1697
1698                 if (!ptr) {
1699                         printk(KERN_ERR "%s: confused, missing data\n", drive->name);
1700                         break;
1701                 }
1702
1703                 if (blen > thislen)
1704                         blen = thislen;
1705
1706                 xferfunc(drive, ptr, blen);
1707
1708                 thislen -= blen;
1709                 len -= blen;
1710                 rq->data_len -= blen;
1711
1712                 if (rq->bio)
1713                         end_that_request_chunk(rq, 1, blen);
1714                 else
1715                         rq->data += blen;
1716         }
1717
1718         /*
1719          * pad, if necessary
1720          */
1721         if (len > 0) {
1722                 while (len > 0) {
1723                         int pad = 0;
1724
1725                         xferfunc(drive, &pad, sizeof(pad));
1726                         len -= sizeof(pad);
1727                 }
1728         }
1729
1730         if (HWGROUP(drive)->handler != NULL)
1731                 BUG();
1732
1733         ide_set_handler(drive, cdrom_newpc_intr, rq->timeout, NULL);
1734         return ide_started;
1735
1736 end_request:
1737         if (!rq->data_len)
1738                 post_transform_command(rq);
1739
1740         spin_lock_irqsave(&ide_lock, flags);
1741         blkdev_dequeue_request(rq);
1742         end_that_request_last(rq);
1743         HWGROUP(drive)->rq = NULL;
1744         spin_unlock_irqrestore(&ide_lock, flags);
1745         return ide_stopped;
1746 }
1747
1748 static ide_startstop_t cdrom_write_intr(ide_drive_t *drive)
1749 {
1750         int stat, ireason, len, sectors_to_transfer, uptodate;
1751         struct cdrom_info *info = drive->driver_data;
1752         int dma_error = 0, dma = info->dma;
1753         u8 lowcyl = 0, highcyl = 0;
1754
1755         struct request *rq = HWGROUP(drive)->rq;
1756
1757         /* Check for errors. */
1758         if (dma) {
1759                 info->dma = 0;
1760                 if ((dma_error = HWIF(drive)->ide_dma_end(drive))) {
1761                         printk(KERN_ERR "ide-cd: write dma error\n");
1762                         __ide_dma_off(drive);
1763                 }
1764         }
1765
1766         if (cdrom_decode_status(drive, 0, &stat))
1767                 return ide_stopped;
1768
1769         /*
1770          * using dma, transfer is complete now
1771          */
1772         if (dma) {
1773                 if (dma_error)
1774                         return ide_error(drive, "dma error", stat);
1775
1776                 ide_end_request(drive, 1, rq->nr_sectors);
1777                 return ide_stopped;
1778         }
1779
1780         /* Read the interrupt reason and the transfer length. */
1781         ireason = HWIF(drive)->INB(IDE_IREASON_REG);
1782         lowcyl  = HWIF(drive)->INB(IDE_BCOUNTL_REG);
1783         highcyl = HWIF(drive)->INB(IDE_BCOUNTH_REG);
1784
1785         len = lowcyl + (256 * highcyl);
1786
1787         /* If DRQ is clear, the command has completed. */
1788         if ((stat & DRQ_STAT) == 0) {
1789                 /* If we're not done writing, complain.
1790                  * Otherwise, complete the command normally.
1791                  */
1792                 uptodate = 1;
1793                 if (rq->current_nr_sectors > 0) {
1794                         printk(KERN_ERR "%s: write_intr: data underrun (%d blocks)\n",
1795                         drive->name, rq->current_nr_sectors);
1796                         uptodate = 0;
1797                 }
1798                 cdrom_end_request(drive, uptodate);
1799                 return ide_stopped;
1800         }
1801
1802         /* Check that the drive is expecting to do the same thing we are. */
1803         if (cdrom_write_check_ireason(drive, len, ireason))
1804                 return ide_stopped;
1805
1806         sectors_to_transfer = len / SECTOR_SIZE;
1807
1808         /*
1809          * now loop and write out the data
1810          */
1811         while (sectors_to_transfer > 0) {
1812                 int this_transfer;
1813
1814                 if (!rq->current_nr_sectors) {
1815                         printk(KERN_ERR "ide-cd: write_intr: oops\n");
1816                         break;
1817                 }
1818
1819                 /*
1820                  * Figure out how many sectors we can transfer
1821                  */
1822                 this_transfer = min_t(int, sectors_to_transfer, rq->current_nr_sectors);
1823
1824                 while (this_transfer > 0) {
1825                         HWIF(drive)->atapi_output_bytes(drive, rq->buffer, SECTOR_SIZE);
1826                         rq->buffer += SECTOR_SIZE;
1827                         --rq->nr_sectors;
1828                         --rq->current_nr_sectors;
1829                         ++rq->sector;
1830                         --this_transfer;
1831                         --sectors_to_transfer;
1832                 }
1833
1834                 /*
1835                  * current buffer complete, move on
1836                  */
1837                 if (rq->current_nr_sectors == 0 && rq->nr_sectors)
1838                         cdrom_end_request(drive, 1);
1839         }
1840
1841         /* re-arm handler */
1842         ide_set_handler(drive, &cdrom_write_intr, ATAPI_WAIT_PC, NULL);
1843         return ide_started;
1844 }
1845
1846 static ide_startstop_t cdrom_start_write_cont(ide_drive_t *drive)
1847 {
1848         struct request *rq = HWGROUP(drive)->rq;
1849
1850 #if 0   /* the immediate bit */
1851         rq->cmd[1] = 1 << 3;
1852 #endif
1853         rq->timeout = ATAPI_WAIT_PC;
1854
1855         return cdrom_transfer_packet_command(drive, rq, cdrom_write_intr);
1856 }
1857
1858 static ide_startstop_t cdrom_start_write(ide_drive_t *drive, struct request *rq)
1859 {
1860         struct cdrom_info *info = drive->driver_data;
1861         struct gendisk *g = info->disk;
1862         unsigned short sectors_per_frame = queue_hardsect_size(drive->queue) >> SECTOR_BITS;
1863
1864         /*
1865          * writes *must* be hardware frame aligned
1866          */
1867         if ((rq->nr_sectors & (sectors_per_frame - 1)) ||
1868             (rq->sector & (sectors_per_frame - 1))) {
1869                 cdrom_end_request(drive, 0);
1870                 return ide_stopped;
1871         }
1872
1873         /*
1874          * disk has become write protected
1875          */
1876         if (g->policy) {
1877                 cdrom_end_request(drive, 0);
1878                 return ide_stopped;
1879         }
1880
1881         /*
1882          * for dvd-ram and such media, it's a really big deal to get
1883          * big writes all the time. so scour the queue and attempt to
1884          * remerge requests, often the plugging will not have had time
1885          * to do this properly
1886          */
1887         blk_attempt_remerge(drive->queue, rq);
1888
1889         info->nsectors_buffered = 0;
1890
1891         /* use dma, if possible. we don't need to check more, since we
1892          * know that the transfer is always (at least!) frame aligned */
1893         info->dma = drive->using_dma ? 1 : 0;
1894         info->cmd = WRITE;
1895
1896         info->devinfo.media_written = 1;
1897
1898         /* Start sending the write request to the drive. */
1899         return cdrom_start_packet_command(drive, 32768, cdrom_start_write_cont);
1900 }
1901
1902 static ide_startstop_t cdrom_do_newpc_cont(ide_drive_t *drive)
1903 {
1904         struct request *rq = HWGROUP(drive)->rq;
1905
1906         if (!rq->timeout)
1907                 rq->timeout = ATAPI_WAIT_PC;
1908
1909         return cdrom_transfer_packet_command(drive, rq, cdrom_newpc_intr);
1910 }
1911
1912 static ide_startstop_t cdrom_do_block_pc(ide_drive_t *drive, struct request *rq)
1913 {
1914         struct cdrom_info *info = drive->driver_data;
1915
1916         rq->flags |= REQ_QUIET;
1917
1918         info->dma = 0;
1919         info->cmd = 0;
1920
1921         /*
1922          * sg request
1923          */
1924         if (rq->bio) {
1925                 int mask = drive->queue->dma_alignment;
1926                 unsigned long addr = (unsigned long) page_address(bio_page(rq->bio));
1927
1928                 info->cmd = rq_data_dir(rq);
1929                 info->dma = drive->using_dma;
1930
1931                 /*
1932                  * check if dma is safe
1933                  *
1934                  * NOTE! The "len" and "addr" checks should possibly have
1935                  * separate masks.
1936                  */
1937                 if ((rq->data_len & 15) || (addr & mask))
1938                         info->dma = 0;
1939         }
1940
1941         /* Start sending the command to the drive. */
1942         return cdrom_start_packet_command(drive, rq->data_len, cdrom_do_newpc_cont);
1943 }
1944
1945 /****************************************************************************
1946  * cdrom driver request routine.
1947  */
1948 static ide_startstop_t
1949 ide_do_rw_cdrom (ide_drive_t *drive, struct request *rq, sector_t block)
1950 {
1951         ide_startstop_t action;
1952         struct cdrom_info *info = drive->driver_data;
1953
1954         if (blk_fs_request(rq)) {
1955                 if (CDROM_CONFIG_FLAGS(drive)->seeking) {
1956                         unsigned long elapsed = jiffies - info->start_seek;
1957                         int stat = HWIF(drive)->INB(IDE_STATUS_REG);
1958
1959                         if ((stat & SEEK_STAT) != SEEK_STAT) {
1960                                 if (elapsed < IDECD_SEEK_TIMEOUT) {
1961                                         ide_stall_queue(drive, IDECD_SEEK_TIMER);
1962                                         return ide_stopped;
1963                                 }
1964                                 printk (KERN_ERR "%s: DSC timeout\n", drive->name);
1965                         }
1966                         CDROM_CONFIG_FLAGS(drive)->seeking = 0;
1967                 }
1968                 if ((rq_data_dir(rq) == READ) && IDE_LARGE_SEEK(info->last_block, block, IDECD_SEEK_THRESHOLD) && drive->dsc_overlap) {
1969                         action = cdrom_start_seek(drive, block);
1970                 } else {
1971                         if (rq_data_dir(rq) == READ)
1972                                 action = cdrom_start_read(drive, block);
1973                         else
1974                                 action = cdrom_start_write(drive, rq);
1975                 }
1976                 info->last_block = block;
1977                 return action;
1978         } else if (rq->flags & (REQ_PC | REQ_SENSE)) {
1979                 return cdrom_do_packet_command(drive);
1980         } else if (rq->flags & REQ_BLOCK_PC) {
1981                 return cdrom_do_block_pc(drive, rq);
1982         } else if (rq->flags & REQ_SPECIAL) {
1983                 /*
1984                  * right now this can only be a reset...
1985                  */
1986                 cdrom_end_request(drive, 1);
1987                 return ide_stopped;
1988         }
1989
1990         blk_dump_rq_flags(rq, "ide-cd bad flags");
1991         cdrom_end_request(drive, 0);
1992         return ide_stopped;
1993 }
1994
1995
1996
1997 /****************************************************************************
1998  * Ioctl handling.
1999  *
2000  * Routines which queue packet commands take as a final argument a pointer
2001  * to a request_sense struct.  If execution of the command results
2002  * in an error with a CHECK CONDITION status, this structure will be filled
2003  * with the results of the subsequent request sense command.  The pointer
2004  * can also be NULL, in which case no sense information is returned.
2005  */
2006
2007 #if ! STANDARD_ATAPI
2008 static inline
2009 int bin2bcd (int x)
2010 {
2011         return (x%10) | ((x/10) << 4);
2012 }
2013
2014
2015 static inline
2016 int bcd2bin (int x)
2017 {
2018         return (x >> 4) * 10 + (x & 0x0f);
2019 }
2020
2021 static
2022 void msf_from_bcd (struct atapi_msf *msf)
2023 {
2024         msf->minute = bcd2bin (msf->minute);
2025         msf->second = bcd2bin (msf->second);
2026         msf->frame  = bcd2bin (msf->frame);
2027 }
2028
2029 #endif /* not STANDARD_ATAPI */
2030
2031
2032 static inline
2033 void lba_to_msf (int lba, byte *m, byte *s, byte *f)
2034 {
2035         lba += CD_MSF_OFFSET;
2036         lba &= 0xffffff;  /* negative lbas use only 24 bits */
2037         *m = lba / (CD_SECS * CD_FRAMES);
2038         lba %= (CD_SECS * CD_FRAMES);
2039         *s = lba / CD_FRAMES;
2040         *f = lba % CD_FRAMES;
2041 }
2042
2043
2044 static inline
2045 int msf_to_lba (byte m, byte s, byte f)
2046 {
2047         return (((m * CD_SECS) + s) * CD_FRAMES + f) - CD_MSF_OFFSET;
2048 }
2049
2050 static int cdrom_check_status(ide_drive_t *drive, struct request_sense *sense)
2051 {
2052         struct request req;
2053         struct cdrom_info *info = drive->driver_data;
2054         struct cdrom_device_info *cdi = &info->devinfo;
2055
2056         cdrom_prepare_request(drive, &req);
2057
2058         req.sense = sense;
2059         req.cmd[0] = GPCMD_TEST_UNIT_READY;
2060         req.flags |= REQ_QUIET;
2061
2062 #if ! STANDARD_ATAPI
2063         /* the Sanyo 3 CD changer uses byte 7 of TEST_UNIT_READY to 
2064            switch CDs instead of supporting the LOAD_UNLOAD opcode   */
2065
2066         req.cmd[7] = cdi->sanyo_slot % 3;
2067 #endif /* not STANDARD_ATAPI */
2068
2069         return cdrom_queue_packet_command(drive, &req);
2070 }
2071
2072
2073 /* Lock the door if LOCKFLAG is nonzero; unlock it otherwise. */
2074 static int
2075 cdrom_lockdoor(ide_drive_t *drive, int lockflag, struct request_sense *sense)
2076 {
2077         struct request_sense my_sense;
2078         struct request req;
2079         int stat;
2080
2081         if (sense == NULL)
2082                 sense = &my_sense;
2083
2084         /* If the drive cannot lock the door, just pretend. */
2085         if (CDROM_CONFIG_FLAGS(drive)->no_doorlock) {
2086                 stat = 0;
2087         } else {
2088                 cdrom_prepare_request(drive, &req);
2089                 req.sense = sense;
2090                 req.cmd[0] = GPCMD_PREVENT_ALLOW_MEDIUM_REMOVAL;
2091                 req.cmd[4] = lockflag ? 1 : 0;
2092                 stat = cdrom_queue_packet_command(drive, &req);
2093         }
2094
2095         /* If we got an illegal field error, the drive
2096            probably cannot lock the door. */
2097         if (stat != 0 &&
2098             sense->sense_key == ILLEGAL_REQUEST &&
2099             (sense->asc == 0x24 || sense->asc == 0x20)) {
2100                 printk (KERN_ERR "%s: door locking not supported\n",
2101                         drive->name);
2102                 CDROM_CONFIG_FLAGS(drive)->no_doorlock = 1;
2103                 stat = 0;
2104         }
2105         
2106         /* no medium, that's alright. */
2107         if (stat != 0 && sense->sense_key == NOT_READY && sense->asc == 0x3a)
2108                 stat = 0;
2109
2110         if (stat == 0)
2111                 CDROM_STATE_FLAGS(drive)->door_locked = lockflag;
2112
2113         return stat;
2114 }
2115
2116
2117 /* Eject the disk if EJECTFLAG is 0.
2118    If EJECTFLAG is 1, try to reload the disk. */
2119 static int cdrom_eject(ide_drive_t *drive, int ejectflag,
2120                        struct request_sense *sense)
2121 {
2122         struct request req;
2123         char loej = 0x02;
2124
2125         if (CDROM_CONFIG_FLAGS(drive)->no_eject && !ejectflag)
2126                 return -EDRIVE_CANT_DO_THIS;
2127         
2128         /* reload fails on some drives, if the tray is locked */
2129         if (CDROM_STATE_FLAGS(drive)->door_locked && ejectflag)
2130                 return 0;
2131
2132         cdrom_prepare_request(drive, &req);
2133
2134         /* only tell drive to close tray if open, if it can do that */
2135         if (ejectflag && !CDROM_CONFIG_FLAGS(drive)->close_tray)
2136                 loej = 0;
2137
2138         req.sense = sense;
2139         req.cmd[0] = GPCMD_START_STOP_UNIT;
2140         req.cmd[4] = loej | (ejectflag != 0);
2141         return cdrom_queue_packet_command(drive, &req);
2142 }
2143
2144 static int cdrom_read_capacity(ide_drive_t *drive, unsigned long *capacity,
2145                                unsigned long *sectors_per_frame,
2146                                struct request_sense *sense)
2147 {
2148         struct {
2149                 __u32 lba;
2150                 __u32 blocklen;
2151         } capbuf;
2152
2153         int stat;
2154         struct request req;
2155
2156         cdrom_prepare_request(drive, &req);
2157
2158         req.sense = sense;
2159         req.cmd[0] = GPCMD_READ_CDVD_CAPACITY;
2160         req.data = (char *)&capbuf;
2161         req.data_len = sizeof(capbuf);
2162
2163         stat = cdrom_queue_packet_command(drive, &req);
2164         if (stat == 0) {
2165                 *capacity = 1 + be32_to_cpu(capbuf.lba);
2166                 *sectors_per_frame =
2167                         be32_to_cpu(capbuf.blocklen) >> SECTOR_BITS;
2168         }
2169
2170         return stat;
2171 }
2172
2173 static int cdrom_read_tocentry(ide_drive_t *drive, int trackno, int msf_flag,
2174                                 int format, char *buf, int buflen,
2175                                 struct request_sense *sense)
2176 {
2177         struct request req;
2178
2179         cdrom_prepare_request(drive, &req);
2180
2181         req.sense = sense;
2182         req.data =  buf;
2183         req.data_len = buflen;
2184         req.flags |= REQ_QUIET;
2185         req.cmd[0] = GPCMD_READ_TOC_PMA_ATIP;
2186         req.cmd[6] = trackno;
2187         req.cmd[7] = (buflen >> 8);
2188         req.cmd[8] = (buflen & 0xff);
2189         req.cmd[9] = (format << 6);
2190
2191         if (msf_flag)
2192                 req.cmd[1] = 2;
2193
2194         return cdrom_queue_packet_command(drive, &req);
2195 }
2196
2197
2198 /* Try to read the entire TOC for the disk into our internal buffer. */
2199 static int cdrom_read_toc(ide_drive_t *drive, struct request_sense *sense)
2200 {
2201         int stat, ntracks, i;
2202         struct cdrom_info *info = drive->driver_data;
2203         struct cdrom_device_info *cdi = &info->devinfo;
2204         struct atapi_toc *toc = info->toc;
2205         struct {
2206                 struct atapi_toc_header hdr;
2207                 struct atapi_toc_entry  ent;
2208         } ms_tmp;
2209         long last_written;
2210         unsigned long sectors_per_frame = SECTORS_PER_FRAME;
2211
2212         if (toc == NULL) {
2213                 /* Try to allocate space. */
2214                 toc = kmalloc(sizeof(struct atapi_toc), GFP_KERNEL);
2215                 if (toc == NULL) {
2216                         printk (KERN_ERR "%s: No cdrom TOC buffer!\n", drive->name);
2217                         return -ENOMEM;
2218                 }
2219                 info->toc = toc;
2220         }
2221
2222         /* Check to see if the existing data is still valid.
2223            If it is, just return. */
2224         (void) cdrom_check_status(drive, sense);
2225
2226         if (CDROM_STATE_FLAGS(drive)->toc_valid)
2227                 return 0;
2228
2229         /* Try to get the total cdrom capacity and sector size. */
2230         stat = cdrom_read_capacity(drive, &toc->capacity, &sectors_per_frame,
2231                                    sense);
2232         if (stat)
2233                 toc->capacity = 0x1fffff;
2234
2235         set_capacity(info->disk, toc->capacity * sectors_per_frame);
2236         blk_queue_hardsect_size(drive->queue,
2237                                 sectors_per_frame << SECTOR_BITS);
2238
2239         /* First read just the header, so we know how long the TOC is. */
2240         stat = cdrom_read_tocentry(drive, 0, 1, 0, (char *) &toc->hdr,
2241                                     sizeof(struct atapi_toc_header), sense);
2242         if (stat)
2243                 return stat;
2244
2245 #if ! STANDARD_ATAPI
2246         if (CDROM_CONFIG_FLAGS(drive)->toctracks_as_bcd) {
2247                 toc->hdr.first_track = bcd2bin(toc->hdr.first_track);
2248                 toc->hdr.last_track  = bcd2bin(toc->hdr.last_track);
2249         }
2250 #endif  /* not STANDARD_ATAPI */
2251
2252         ntracks = toc->hdr.last_track - toc->hdr.first_track + 1;
2253         if (ntracks <= 0)
2254                 return -EIO;
2255         if (ntracks > MAX_TRACKS)
2256                 ntracks = MAX_TRACKS;
2257
2258         /* Now read the whole schmeer. */
2259         stat = cdrom_read_tocentry(drive, toc->hdr.first_track, 1, 0,
2260                                   (char *)&toc->hdr,
2261                                    sizeof(struct atapi_toc_header) +
2262                                    (ntracks + 1) *
2263                                    sizeof(struct atapi_toc_entry), sense);
2264
2265         if (stat && toc->hdr.first_track > 1) {
2266                 /* Cds with CDI tracks only don't have any TOC entries,
2267                    despite of this the returned values are
2268                    first_track == last_track = number of CDI tracks + 1,
2269                    so that this case is indistinguishable from the same
2270                    layout plus an additional audio track.
2271                    If we get an error for the regular case, we assume
2272                    a CDI without additional audio tracks. In this case
2273                    the readable TOC is empty (CDI tracks are not included)
2274                    and only holds the Leadout entry. Heiko EiƟfeldt */
2275                 ntracks = 0;
2276                 stat = cdrom_read_tocentry(drive, CDROM_LEADOUT, 1, 0,
2277                                            (char *)&toc->hdr,
2278                                            sizeof(struct atapi_toc_header) +
2279                                            (ntracks + 1) *
2280                                            sizeof(struct atapi_toc_entry),
2281                                            sense);
2282                 if (stat) {
2283                         return stat;
2284                 }
2285 #if ! STANDARD_ATAPI
2286                 if (CDROM_CONFIG_FLAGS(drive)->toctracks_as_bcd) {
2287                         toc->hdr.first_track = bin2bcd(CDROM_LEADOUT);
2288                         toc->hdr.last_track = bin2bcd(CDROM_LEADOUT);
2289                 } else
2290 #endif  /* not STANDARD_ATAPI */
2291                 {
2292                         toc->hdr.first_track = CDROM_LEADOUT;
2293                         toc->hdr.last_track = CDROM_LEADOUT;
2294                 }
2295         }
2296
2297         if (stat)
2298                 return stat;
2299
2300         toc->hdr.toc_length = ntohs (toc->hdr.toc_length);
2301
2302 #if ! STANDARD_ATAPI
2303         if (CDROM_CONFIG_FLAGS(drive)->toctracks_as_bcd) {
2304                 toc->hdr.first_track = bcd2bin(toc->hdr.first_track);
2305                 toc->hdr.last_track  = bcd2bin(toc->hdr.last_track);
2306         }
2307 #endif  /* not STANDARD_ATAPI */
2308
2309         for (i=0; i<=ntracks; i++) {
2310 #if ! STANDARD_ATAPI
2311                 if (CDROM_CONFIG_FLAGS(drive)->tocaddr_as_bcd) {
2312                         if (CDROM_CONFIG_FLAGS(drive)->toctracks_as_bcd)
2313                                 toc->ent[i].track = bcd2bin(toc->ent[i].track);
2314                         msf_from_bcd(&toc->ent[i].addr.msf);
2315                 }
2316 #endif  /* not STANDARD_ATAPI */
2317                 toc->ent[i].addr.lba = msf_to_lba (toc->ent[i].addr.msf.minute,
2318                                                    toc->ent[i].addr.msf.second,
2319                                                    toc->ent[i].addr.msf.frame);
2320         }
2321
2322         /* Read the multisession information. */
2323         if (toc->hdr.first_track != CDROM_LEADOUT) {
2324                 /* Read the multisession information. */
2325                 stat = cdrom_read_tocentry(drive, 0, 0, 1, (char *)&ms_tmp,
2326                                            sizeof(ms_tmp), sense);
2327                 if (stat)
2328                         return stat;
2329
2330                 toc->last_session_lba = be32_to_cpu(ms_tmp.ent.addr.lba);
2331         } else {
2332                 ms_tmp.hdr.first_track = ms_tmp.hdr.last_track = CDROM_LEADOUT;
2333                 toc->last_session_lba = msf_to_lba(0, 2, 0); /* 0m 2s 0f */
2334         }
2335
2336 #if ! STANDARD_ATAPI
2337         if (CDROM_CONFIG_FLAGS(drive)->tocaddr_as_bcd) {
2338                 /* Re-read multisession information using MSF format */
2339                 stat = cdrom_read_tocentry(drive, 0, 1, 1, (char *)&ms_tmp,
2340                                            sizeof(ms_tmp), sense);
2341                 if (stat)
2342                         return stat;
2343
2344                 msf_from_bcd (&ms_tmp.ent.addr.msf);
2345                 toc->last_session_lba = msf_to_lba(ms_tmp.ent.addr.msf.minute,
2346                                                    ms_tmp.ent.addr.msf.second,
2347                                                    ms_tmp.ent.addr.msf.frame);
2348         }
2349 #endif  /* not STANDARD_ATAPI */
2350
2351         toc->xa_flag = (ms_tmp.hdr.first_track != ms_tmp.hdr.last_track);
2352
2353         /* Now try to get the total cdrom capacity. */
2354         stat = cdrom_get_last_written(cdi, &last_written);
2355         if (!stat && (last_written > toc->capacity)) {
2356                 toc->capacity = last_written;
2357                 set_capacity(info->disk, toc->capacity * sectors_per_frame);
2358         }
2359
2360         /* Remember that we've read this stuff. */
2361         CDROM_STATE_FLAGS(drive)->toc_valid = 1;
2362
2363         return 0;
2364 }
2365
2366
2367 static int cdrom_read_subchannel(ide_drive_t *drive, int format, char *buf,
2368                                  int buflen, struct request_sense *sense)
2369 {
2370         struct request req;
2371
2372         cdrom_prepare_request(drive, &req);
2373
2374         req.sense = sense;
2375         req.data = buf;
2376         req.data_len = buflen;
2377         req.cmd[0] = GPCMD_READ_SUBCHANNEL;
2378         req.cmd[1] = 2;     /* MSF addressing */
2379         req.cmd[2] = 0x40;  /* request subQ data */
2380         req.cmd[3] = format;
2381         req.cmd[7] = (buflen >> 8);
2382         req.cmd[8] = (buflen & 0xff);
2383         return cdrom_queue_packet_command(drive, &req);
2384 }
2385
2386 /* ATAPI cdrom drives are free to select the speed you request or any slower
2387    rate :-( Requesting too fast a speed will _not_ produce an error. */
2388 static int cdrom_select_speed(ide_drive_t *drive, int speed,
2389                               struct request_sense *sense)
2390 {
2391         struct request req;
2392         cdrom_prepare_request(drive, &req);
2393
2394         req.sense = sense;
2395         if (speed == 0)
2396                 speed = 0xffff; /* set to max */
2397         else
2398                 speed *= 177;   /* Nx to kbytes/s */
2399
2400         req.cmd[0] = GPCMD_SET_SPEED;
2401         /* Read Drive speed in kbytes/second MSB */
2402         req.cmd[2] = (speed >> 8) & 0xff;       
2403         /* Read Drive speed in kbytes/second LSB */
2404         req.cmd[3] = speed & 0xff;
2405         if (CDROM_CONFIG_FLAGS(drive)->cd_r ||
2406             CDROM_CONFIG_FLAGS(drive)->cd_rw ||
2407             CDROM_CONFIG_FLAGS(drive)->dvd_r) {
2408                 /* Write Drive speed in kbytes/second MSB */
2409                 req.cmd[4] = (speed >> 8) & 0xff;
2410                 /* Write Drive speed in kbytes/second LSB */
2411                 req.cmd[5] = speed & 0xff;
2412        }
2413
2414         return cdrom_queue_packet_command(drive, &req);
2415 }
2416
2417 static int cdrom_play_audio(ide_drive_t *drive, int lba_start, int lba_end)
2418 {
2419         struct request_sense sense;
2420         struct request req;
2421
2422         cdrom_prepare_request(drive, &req);
2423
2424         req.sense = &sense;
2425         req.cmd[0] = GPCMD_PLAY_AUDIO_MSF;
2426         lba_to_msf(lba_start, &req.cmd[3], &req.cmd[4], &req.cmd[5]);
2427         lba_to_msf(lba_end-1, &req.cmd[6], &req.cmd[7], &req.cmd[8]);
2428
2429         return cdrom_queue_packet_command(drive, &req);
2430 }
2431
2432 static int cdrom_get_toc_entry(ide_drive_t *drive, int track,
2433                                 struct atapi_toc_entry **ent)
2434 {
2435         struct cdrom_info *info = drive->driver_data;
2436         struct atapi_toc *toc = info->toc;
2437         int ntracks;
2438
2439         /*
2440          * don't serve cached data, if the toc isn't valid
2441          */
2442         if (!CDROM_STATE_FLAGS(drive)->toc_valid)
2443                 return -EINVAL;
2444
2445         /* Check validity of requested track number. */
2446         ntracks = toc->hdr.last_track - toc->hdr.first_track + 1;
2447         if (toc->hdr.first_track == CDROM_LEADOUT) ntracks = 0;
2448         if (track == CDROM_LEADOUT)
2449                 *ent = &toc->ent[ntracks];
2450         else if (track < toc->hdr.first_track ||
2451                  track > toc->hdr.last_track)
2452                 return -EINVAL;
2453         else
2454                 *ent = &toc->ent[track - toc->hdr.first_track];
2455
2456         return 0;
2457 }
2458
2459 /* the generic packet interface to cdrom.c */
2460 static int ide_cdrom_packet(struct cdrom_device_info *cdi,
2461                             struct packet_command *cgc)
2462 {
2463         struct request req;
2464         ide_drive_t *drive = cdi->handle;
2465
2466         if (cgc->timeout <= 0)
2467                 cgc->timeout = ATAPI_WAIT_PC;
2468
2469         /* here we queue the commands from the uniform CD-ROM
2470            layer. the packet must be complete, as we do not
2471            touch it at all. */
2472         cdrom_prepare_request(drive, &req);
2473         memcpy(req.cmd, cgc->cmd, CDROM_PACKET_SIZE);
2474         if (cgc->sense)
2475                 memset(cgc->sense, 0, sizeof(struct request_sense));
2476         req.data = cgc->buffer;
2477         req.data_len = cgc->buflen;
2478         req.timeout = cgc->timeout;
2479
2480         if (cgc->quiet)
2481                 req.flags |= REQ_QUIET;
2482
2483         req.sense = cgc->sense;
2484         cgc->stat = cdrom_queue_packet_command(drive, &req);
2485         if (!cgc->stat)
2486                 cgc->buflen -= req.data_len;
2487         return cgc->stat;
2488 }
2489
2490 static
2491 int ide_cdrom_dev_ioctl (struct cdrom_device_info *cdi,
2492                          unsigned int cmd, unsigned long arg)
2493 {
2494         struct packet_command cgc;
2495         char buffer[16];
2496         int stat;
2497
2498         init_cdrom_command(&cgc, buffer, sizeof(buffer), CGC_DATA_UNKNOWN);
2499
2500         /* These will be moved into the Uniform layer shortly... */
2501         switch (cmd) {
2502         case CDROMSETSPINDOWN: {
2503                 char spindown;
2504  
2505                 if (copy_from_user(&spindown, (void __user *) arg, sizeof(char)))
2506                         return -EFAULT;
2507  
2508                 if ((stat = cdrom_mode_sense(cdi, &cgc, GPMODE_CDROM_PAGE, 0)))
2509                         return stat;
2510
2511                 buffer[11] = (buffer[11] & 0xf0) | (spindown & 0x0f);
2512
2513                 return cdrom_mode_select(cdi, &cgc);
2514         } 
2515  
2516         case CDROMGETSPINDOWN: {
2517                 char spindown;
2518  
2519                 if ((stat = cdrom_mode_sense(cdi, &cgc, GPMODE_CDROM_PAGE, 0)))
2520                         return stat;
2521  
2522                 spindown = buffer[11] & 0x0f;
2523  
2524                 if (copy_to_user((void __user *) arg, &spindown, sizeof (char)))
2525                         return -EFAULT;
2526  
2527                 return 0;
2528         }
2529   
2530         default:
2531                 return -EINVAL;
2532         }
2533
2534 }
2535
2536 static
2537 int ide_cdrom_audio_ioctl (struct cdrom_device_info *cdi,
2538                            unsigned int cmd, void *arg)
2539                            
2540 {
2541         ide_drive_t *drive = cdi->handle;
2542         struct cdrom_info *info = drive->driver_data;
2543         int stat;
2544
2545         switch (cmd) {
2546         /*
2547          * emulate PLAY_AUDIO_TI command with PLAY_AUDIO_10, since
2548          * atapi doesn't support it
2549          */
2550         case CDROMPLAYTRKIND: {
2551                 unsigned long lba_start, lba_end;
2552                 struct cdrom_ti *ti = arg;
2553                 struct atapi_toc_entry *first_toc, *last_toc;
2554
2555                 stat = cdrom_get_toc_entry(drive, ti->cdti_trk0, &first_toc);
2556                 if (stat)
2557                         return stat;
2558
2559                 stat = cdrom_get_toc_entry(drive, ti->cdti_trk1, &last_toc);
2560                 if (stat)
2561                         return stat;
2562
2563                 if (ti->cdti_trk1 != CDROM_LEADOUT)
2564                         ++last_toc;
2565                 lba_start = first_toc->addr.lba;
2566                 lba_end   = last_toc->addr.lba;
2567
2568                 if (lba_end <= lba_start)
2569                         return -EINVAL;
2570
2571                 return cdrom_play_audio(drive, lba_start, lba_end);
2572         }
2573
2574         case CDROMREADTOCHDR: {
2575                 struct cdrom_tochdr *tochdr = arg;
2576                 struct atapi_toc *toc;
2577
2578                 /* Make sure our saved TOC is valid. */
2579                 stat = cdrom_read_toc(drive, NULL);
2580                 if (stat)
2581                         return stat;
2582
2583                 toc = info->toc;
2584                 tochdr->cdth_trk0 = toc->hdr.first_track;
2585                 tochdr->cdth_trk1 = toc->hdr.last_track;
2586
2587                 return 0;
2588         }
2589
2590         case CDROMREADTOCENTRY: {
2591                 struct cdrom_tocentry *tocentry = arg;
2592                 struct atapi_toc_entry *toce;
2593
2594                 stat = cdrom_get_toc_entry(drive, tocentry->cdte_track, &toce);
2595                 if (stat)
2596                         return stat;
2597
2598                 tocentry->cdte_ctrl = toce->control;
2599                 tocentry->cdte_adr  = toce->adr;
2600                 if (tocentry->cdte_format == CDROM_MSF) {
2601                         lba_to_msf (toce->addr.lba,
2602                                    &tocentry->cdte_addr.msf.minute,
2603                                    &tocentry->cdte_addr.msf.second,
2604                                    &tocentry->cdte_addr.msf.frame);
2605                 } else
2606                         tocentry->cdte_addr.lba = toce->addr.lba;
2607
2608                 return 0;
2609         }
2610
2611         default:
2612                 return -EINVAL;
2613         }
2614 }
2615
2616 static
2617 int ide_cdrom_reset (struct cdrom_device_info *cdi)
2618 {
2619         ide_drive_t *drive = cdi->handle;
2620         struct request_sense sense;
2621         struct request req;
2622         int ret;
2623
2624         cdrom_prepare_request(drive, &req);
2625         req.flags = REQ_SPECIAL | REQ_QUIET;
2626         ret = ide_do_drive_cmd(drive, &req, ide_wait);
2627
2628         /*
2629          * A reset will unlock the door. If it was previously locked,
2630          * lock it again.
2631          */
2632         if (CDROM_STATE_FLAGS(drive)->door_locked)
2633                 (void) cdrom_lockdoor(drive, 1, &sense);
2634
2635         return ret;
2636 }
2637
2638
2639 static
2640 int ide_cdrom_tray_move (struct cdrom_device_info *cdi, int position)
2641 {
2642         ide_drive_t *drive = cdi->handle;
2643         struct request_sense sense;
2644
2645         if (position) {
2646                 int stat = cdrom_lockdoor(drive, 0, &sense);
2647                 if (stat)
2648                         return stat;
2649         }
2650
2651         return cdrom_eject(drive, !position, &sense);
2652 }
2653
2654 static
2655 int ide_cdrom_lock_door (struct cdrom_device_info *cdi, int lock)
2656 {
2657         ide_drive_t *drive = cdi->handle;
2658         return cdrom_lockdoor(drive, lock, NULL);
2659 }
2660
2661 static
2662 int ide_cdrom_get_capabilities(ide_drive_t *drive, struct atapi_capabilities_page *cap)
2663 {
2664         struct cdrom_info *info = drive->driver_data;
2665         struct cdrom_device_info *cdi = &info->devinfo;
2666         struct packet_command cgc;
2667         int stat, attempts = 3, size = sizeof(*cap);
2668
2669         /*
2670          * ACER50 (and others?) require the full spec length mode sense
2671          * page capabilities size, but older drives break.
2672          */
2673         if (!(!strcmp(drive->id->model, "ATAPI CD ROM DRIVE 50X MAX") ||
2674             !strcmp(drive->id->model, "WPI CDS-32X")))
2675                 size -= sizeof(cap->pad);
2676
2677         init_cdrom_command(&cgc, cap, size, CGC_DATA_UNKNOWN);
2678         do { /* we seem to get stat=0x01,err=0x00 the first time (??) */
2679                 stat = cdrom_mode_sense(cdi, &cgc, GPMODE_CAPABILITIES_PAGE, 0);
2680                 if (!stat)
2681                         break;
2682         } while (--attempts);
2683         return stat;
2684 }
2685
2686 static
2687 void ide_cdrom_update_speed (ide_drive_t *drive, struct atapi_capabilities_page *cap)
2688 {
2689         /* The ACER/AOpen 24X cdrom has the speed fields byte-swapped */
2690         if (!drive->id->model[0] &&
2691             !strncmp(drive->id->fw_rev, "241N", 4)) {
2692                 CDROM_STATE_FLAGS(drive)->current_speed  =
2693                         (((unsigned int)cap->curspeed) + (176/2)) / 176;
2694                 CDROM_CONFIG_FLAGS(drive)->max_speed =
2695                         (((unsigned int)cap->maxspeed) + (176/2)) / 176;
2696         } else {
2697                 CDROM_STATE_FLAGS(drive)->current_speed  =
2698                         (ntohs(cap->curspeed) + (176/2)) / 176;
2699                 CDROM_CONFIG_FLAGS(drive)->max_speed =
2700                         (ntohs(cap->maxspeed) + (176/2)) / 176;
2701         }
2702 }
2703
2704 static
2705 int ide_cdrom_select_speed (struct cdrom_device_info *cdi, int speed)
2706 {
2707         ide_drive_t *drive = cdi->handle;
2708         struct request_sense sense;
2709         struct atapi_capabilities_page cap;
2710         int stat;
2711
2712         if ((stat = cdrom_select_speed(drive, speed, &sense)) < 0)
2713                 return stat;
2714
2715         if (!ide_cdrom_get_capabilities(drive, &cap)) {
2716                 ide_cdrom_update_speed(drive, &cap);
2717                 cdi->speed = CDROM_STATE_FLAGS(drive)->current_speed;
2718         }
2719         return 0;
2720 }
2721
2722 /*
2723  * add logic to try GET_EVENT command first to check for media and tray
2724  * status. this should be supported by newer cd-r/w and all DVD etc
2725  * drives
2726  */
2727 static
2728 int ide_cdrom_drive_status (struct cdrom_device_info *cdi, int slot_nr)
2729 {
2730         ide_drive_t *drive = cdi->handle;
2731         struct media_event_desc med;
2732         struct request_sense sense;
2733         int stat;
2734
2735         if (slot_nr != CDSL_CURRENT)
2736                 return -EINVAL;
2737
2738         stat = cdrom_check_status(drive, &sense);
2739         if (!stat || sense.sense_key == UNIT_ATTENTION)
2740                 return CDS_DISC_OK;
2741
2742         if (!cdrom_get_media_event(cdi, &med)) {
2743                 if (med.media_present)
2744                         return CDS_DISC_OK;
2745                 else if (med.door_open)
2746                         return CDS_TRAY_OPEN;
2747                 else
2748                         return CDS_NO_DISC;
2749         }
2750
2751         if (sense.sense_key == NOT_READY && sense.asc == 0x04 && sense.ascq == 0x04)
2752                 return CDS_DISC_OK;
2753
2754         /*
2755          * If not using Mt Fuji extended media tray reports,
2756          * just return TRAY_OPEN since ATAPI doesn't provide
2757          * any other way to detect this...
2758          */
2759         if (sense.sense_key == NOT_READY) {
2760                 if (sense.asc == 0x3a) {
2761                         if (sense.ascq == 1)
2762                                 return CDS_NO_DISC;
2763                         else if (sense.ascq == 0 || sense.ascq == 2)
2764                                 return CDS_TRAY_OPEN;
2765                 }
2766         }
2767
2768         return CDS_DRIVE_NOT_READY;
2769 }
2770
2771 static
2772 int ide_cdrom_get_last_session (struct cdrom_device_info *cdi,
2773                                 struct cdrom_multisession *ms_info)
2774 {
2775         struct atapi_toc *toc;
2776         ide_drive_t *drive = cdi->handle;
2777         struct cdrom_info *info = drive->driver_data;
2778         struct request_sense sense;
2779         int ret;
2780
2781         if (!CDROM_STATE_FLAGS(drive)->toc_valid || info->toc == NULL)
2782                 if ((ret = cdrom_read_toc(drive, &sense)))
2783                         return ret;
2784
2785         toc = info->toc;
2786         ms_info->addr.lba = toc->last_session_lba;
2787         ms_info->xa_flag = toc->xa_flag;
2788
2789         return 0;
2790 }
2791
2792 static
2793 int ide_cdrom_get_mcn (struct cdrom_device_info *cdi,
2794                        struct cdrom_mcn *mcn_info)
2795 {
2796         int stat;
2797         char mcnbuf[24];
2798         ide_drive_t *drive = cdi->handle;
2799
2800 /* get MCN */
2801         if ((stat = cdrom_read_subchannel(drive, 2, mcnbuf, sizeof (mcnbuf), NULL)))
2802                 return stat;
2803
2804         memcpy (mcn_info->medium_catalog_number, mcnbuf+9,
2805                 sizeof (mcn_info->medium_catalog_number)-1);
2806         mcn_info->medium_catalog_number[sizeof (mcn_info->medium_catalog_number)-1]
2807                 = '\0';
2808
2809         return 0;
2810 }
2811
2812
2813
2814 /****************************************************************************
2815  * Other driver requests (open, close, check media change).
2816  */
2817
2818 static
2819 int ide_cdrom_check_media_change_real (struct cdrom_device_info *cdi,
2820                                        int slot_nr)
2821 {
2822         ide_drive_t *drive = cdi->handle;
2823         int retval;
2824         
2825         if (slot_nr == CDSL_CURRENT) {
2826                 (void) cdrom_check_status(drive, NULL);
2827                 retval = CDROM_STATE_FLAGS(drive)->media_changed;
2828                 CDROM_STATE_FLAGS(drive)->media_changed = 0;
2829                 return retval;
2830         } else {
2831                 return -EINVAL;
2832         }
2833 }
2834
2835
2836 static
2837 int ide_cdrom_open_real (struct cdrom_device_info *cdi, int purpose)
2838 {
2839         return 0;
2840 }
2841
2842 /*
2843  * Close down the device.  Invalidate all cached blocks.
2844  */
2845
2846 static
2847 void ide_cdrom_release_real (struct cdrom_device_info *cdi)
2848 {
2849         ide_drive_t *drive = cdi->handle;
2850
2851         if (!cdi->use_count)
2852                 CDROM_STATE_FLAGS(drive)->toc_valid = 0;
2853 }
2854
2855
2856
2857 /****************************************************************************
2858  * Device initialization.
2859  */
2860 static struct cdrom_device_ops ide_cdrom_dops = {
2861         .open                   = ide_cdrom_open_real,
2862         .release                = ide_cdrom_release_real,
2863         .drive_status           = ide_cdrom_drive_status,
2864         .media_changed          = ide_cdrom_check_media_change_real,
2865         .tray_move              = ide_cdrom_tray_move,
2866         .lock_door              = ide_cdrom_lock_door,
2867         .select_speed           = ide_cdrom_select_speed,
2868         .get_last_session       = ide_cdrom_get_last_session,
2869         .get_mcn                = ide_cdrom_get_mcn,
2870         .reset                  = ide_cdrom_reset,
2871         .audio_ioctl            = ide_cdrom_audio_ioctl,
2872         .dev_ioctl              = ide_cdrom_dev_ioctl,
2873         .capability             = CDC_CLOSE_TRAY | CDC_OPEN_TRAY | CDC_LOCK |
2874                                 CDC_SELECT_SPEED | CDC_SELECT_DISC |
2875                                 CDC_MULTI_SESSION | CDC_MCN |
2876                                 CDC_MEDIA_CHANGED | CDC_PLAY_AUDIO | CDC_RESET |
2877                                 CDC_IOCTLS | CDC_DRIVE_STATUS | CDC_CD_R |
2878                                 CDC_CD_RW | CDC_DVD | CDC_DVD_R| CDC_DVD_RAM |
2879                                 CDC_GENERIC_PACKET | CDC_MO_DRIVE | CDC_MRW |
2880                                 CDC_MRW_W | CDC_RAM,
2881         .generic_packet         = ide_cdrom_packet,
2882 };
2883
2884 static int ide_cdrom_register (ide_drive_t *drive, int nslots)
2885 {
2886         struct cdrom_info *info = drive->driver_data;
2887         struct cdrom_device_info *devinfo = &info->devinfo;
2888
2889         devinfo->ops = &ide_cdrom_dops;
2890         devinfo->mask = 0;
2891         devinfo->speed = CDROM_STATE_FLAGS(drive)->current_speed;
2892         devinfo->capacity = nslots;
2893         devinfo->handle = drive;
2894         strcpy(devinfo->name, drive->name);
2895         
2896         /* set capability mask to match the probe. */
2897         if (!CDROM_CONFIG_FLAGS(drive)->cd_r)
2898                 devinfo->mask |= CDC_CD_R;
2899         if (!CDROM_CONFIG_FLAGS(drive)->cd_rw)
2900                 devinfo->mask |= CDC_CD_RW;
2901         if (!CDROM_CONFIG_FLAGS(drive)->dvd)
2902                 devinfo->mask |= CDC_DVD;
2903         if (!CDROM_CONFIG_FLAGS(drive)->dvd_r)
2904                 devinfo->mask |= CDC_DVD_R;
2905         if (!CDROM_CONFIG_FLAGS(drive)->dvd_ram)
2906                 devinfo->mask |= CDC_DVD_RAM;
2907         if (!CDROM_CONFIG_FLAGS(drive)->is_changer)
2908                 devinfo->mask |= CDC_SELECT_DISC;
2909         if (!CDROM_CONFIG_FLAGS(drive)->audio_play)
2910                 devinfo->mask |= CDC_PLAY_AUDIO;
2911         if (!CDROM_CONFIG_FLAGS(drive)->close_tray)
2912                 devinfo->mask |= CDC_CLOSE_TRAY;
2913         if (!CDROM_CONFIG_FLAGS(drive)->mo_drive)
2914                 devinfo->mask |= CDC_MO_DRIVE;
2915
2916         devinfo->disk = info->disk;
2917         return register_cdrom(devinfo);
2918 }
2919
2920 static
2921 int ide_cdrom_probe_capabilities (ide_drive_t *drive)
2922 {
2923         struct cdrom_info *info = drive->driver_data;
2924         struct cdrom_device_info *cdi = &info->devinfo;
2925         struct atapi_capabilities_page cap;
2926         int nslots = 1;
2927
2928         if (drive->media == ide_optical) {
2929                 CDROM_CONFIG_FLAGS(drive)->mo_drive = 1;
2930                 CDROM_CONFIG_FLAGS(drive)->ram = 1;
2931                 printk(KERN_ERR "%s: ATAPI magneto-optical drive\n", drive->name);
2932                 return nslots;
2933         }
2934
2935         if (CDROM_CONFIG_FLAGS(drive)->nec260 ||
2936             !strcmp(drive->id->model,"STINGRAY 8422 IDE 8X CD-ROM 7-27-95")) {
2937                 CDROM_CONFIG_FLAGS(drive)->no_eject = 0;
2938                 CDROM_CONFIG_FLAGS(drive)->audio_play = 1;
2939                 return nslots;
2940         }
2941
2942         /*
2943          * we have to cheat a little here. the packet will eventually
2944          * be queued with ide_cdrom_packet(), which extracts the
2945          * drive from cdi->handle. Since this device hasn't been
2946          * registered with the Uniform layer yet, it can't do this.
2947          * Same goes for cdi->ops.
2948          */
2949         cdi->handle = drive;
2950         cdi->ops = &ide_cdrom_dops;
2951
2952         if (ide_cdrom_get_capabilities(drive, &cap))
2953                 return 0;
2954
2955         if (cap.lock == 0)
2956                 CDROM_CONFIG_FLAGS(drive)->no_doorlock = 1;
2957         if (cap.eject)
2958                 CDROM_CONFIG_FLAGS(drive)->no_eject = 0;
2959         if (cap.cd_r_write)
2960                 CDROM_CONFIG_FLAGS(drive)->cd_r = 1;
2961         if (cap.cd_rw_write) {
2962                 CDROM_CONFIG_FLAGS(drive)->cd_rw = 1;
2963                 CDROM_CONFIG_FLAGS(drive)->ram = 1;
2964         }
2965         if (cap.test_write)
2966                 CDROM_CONFIG_FLAGS(drive)->test_write = 1;
2967         if (cap.dvd_ram_read || cap.dvd_r_read || cap.dvd_rom)
2968                 CDROM_CONFIG_FLAGS(drive)->dvd = 1;
2969         if (cap.dvd_ram_write) {
2970                 CDROM_CONFIG_FLAGS(drive)->dvd_ram = 1;
2971                 CDROM_CONFIG_FLAGS(drive)->ram = 1;
2972         }
2973         if (cap.dvd_r_write)
2974                 CDROM_CONFIG_FLAGS(drive)->dvd_r = 1;
2975         if (cap.audio_play)
2976                 CDROM_CONFIG_FLAGS(drive)->audio_play = 1;
2977         if (cap.mechtype == mechtype_caddy || cap.mechtype == mechtype_popup)
2978                 CDROM_CONFIG_FLAGS(drive)->close_tray = 0;
2979
2980         /* Some drives used by Apple don't advertise audio play
2981          * but they do support reading TOC & audio datas
2982          */
2983         if (strcmp(drive->id->model, "MATSHITADVD-ROM SR-8187") == 0 ||
2984             strcmp(drive->id->model, "MATSHITADVD-ROM SR-8186") == 0 ||
2985             strcmp(drive->id->model, "MATSHITADVD-ROM SR-8176") == 0 ||
2986             strcmp(drive->id->model, "MATSHITADVD-ROM SR-8174") == 0)
2987                 CDROM_CONFIG_FLAGS(drive)->audio_play = 1;
2988
2989 #if ! STANDARD_ATAPI
2990         if (cdi->sanyo_slot > 0) {
2991                 CDROM_CONFIG_FLAGS(drive)->is_changer = 1;
2992                 nslots = 3;
2993         }
2994
2995         else
2996 #endif /* not STANDARD_ATAPI */
2997         if (cap.mechtype == mechtype_individual_changer ||
2998             cap.mechtype == mechtype_cartridge_changer) {
2999                 if ((nslots = cdrom_number_of_slots(cdi)) > 1) {
3000                         CDROM_CONFIG_FLAGS(drive)->is_changer = 1;
3001                         CDROM_CONFIG_FLAGS(drive)->supp_disc_present = 1;
3002                 }
3003         }
3004
3005         ide_cdrom_update_speed(drive, &cap);
3006         /* don't print speed if the drive reported 0.
3007          */
3008         printk(KERN_INFO "%s: ATAPI", drive->name);
3009         if (CDROM_CONFIG_FLAGS(drive)->max_speed)
3010                 printk(" %dX", CDROM_CONFIG_FLAGS(drive)->max_speed);
3011         printk(" %s", CDROM_CONFIG_FLAGS(drive)->dvd ? "DVD-ROM" : "CD-ROM");
3012
3013         if (CDROM_CONFIG_FLAGS(drive)->dvd_r|CDROM_CONFIG_FLAGS(drive)->dvd_ram)
3014                 printk(" DVD%s%s", 
3015                 (CDROM_CONFIG_FLAGS(drive)->dvd_r)? "-R" : "", 
3016                 (CDROM_CONFIG_FLAGS(drive)->dvd_ram)? "-RAM" : "");
3017
3018         if (CDROM_CONFIG_FLAGS(drive)->cd_r|CDROM_CONFIG_FLAGS(drive)->cd_rw) 
3019                 printk(" CD%s%s", 
3020                 (CDROM_CONFIG_FLAGS(drive)->cd_r)? "-R" : "", 
3021                 (CDROM_CONFIG_FLAGS(drive)->cd_rw)? "/RW" : "");
3022
3023         if (CDROM_CONFIG_FLAGS(drive)->is_changer) 
3024                 printk(" changer w/%d slots", nslots);
3025         else    
3026                 printk(" drive");
3027
3028         printk(", %dkB Cache", be16_to_cpu(cap.buffer_size));
3029
3030         if (drive->using_dma)
3031                 ide_dma_verbose(drive);
3032
3033         printk("\n");
3034
3035         return nslots;
3036 }
3037
3038 static void ide_cdrom_add_settings(ide_drive_t *drive)
3039 {
3040         ide_add_setting(drive,  "dsc_overlap",          SETTING_RW, -1, -1, TYPE_BYTE, 0, 1, 1, 1, &drive->dsc_overlap, NULL);
3041 }
3042
3043 /*
3044  * standard prep_rq_fn that builds 10 byte cmds
3045  */
3046 static int ide_cdrom_prep_fs(request_queue_t *q, struct request *rq)
3047 {
3048         int hard_sect = queue_hardsect_size(q);
3049         long block = (long)rq->hard_sector / (hard_sect >> 9);
3050         unsigned long blocks = rq->hard_nr_sectors / (hard_sect >> 9);
3051
3052         memset(rq->cmd, 0, sizeof(rq->cmd));
3053
3054         if (rq_data_dir(rq) == READ)
3055                 rq->cmd[0] = GPCMD_READ_10;
3056         else
3057                 rq->cmd[0] = GPCMD_WRITE_10;
3058
3059         /*
3060          * fill in lba
3061          */
3062         rq->cmd[2] = (block >> 24) & 0xff;
3063         rq->cmd[3] = (block >> 16) & 0xff;
3064         rq->cmd[4] = (block >>  8) & 0xff;
3065         rq->cmd[5] = block & 0xff;
3066
3067         /*
3068          * and transfer length
3069          */
3070         rq->cmd[7] = (blocks >> 8) & 0xff;
3071         rq->cmd[8] = blocks & 0xff;
3072         rq->cmd_len = 10;
3073         return BLKPREP_OK;
3074 }
3075
3076 /*
3077  * Most of the SCSI commands are supported directly by ATAPI devices.
3078  * This transform handles the few exceptions.
3079  */
3080 static int ide_cdrom_prep_pc(struct request *rq)
3081 {
3082         u8 *c = rq->cmd;
3083
3084         /*
3085          * Transform 6-byte read/write commands to the 10-byte version
3086          */
3087         if (c[0] == READ_6 || c[0] == WRITE_6) {
3088                 c[8] = c[4];
3089                 c[5] = c[3];
3090                 c[4] = c[2];
3091                 c[3] = c[1] & 0x1f;
3092                 c[2] = 0;
3093                 c[1] &= 0xe0;
3094                 c[0] += (READ_10 - READ_6);
3095                 rq->cmd_len = 10;
3096                 return BLKPREP_OK;
3097         }
3098
3099         /*
3100          * it's silly to pretend we understand 6-byte sense commands, just
3101          * reject with ILLEGAL_REQUEST and the caller should take the
3102          * appropriate action
3103          */
3104         if (c[0] == MODE_SENSE || c[0] == MODE_SELECT) {
3105                 rq->errors = ILLEGAL_REQUEST;
3106                 return BLKPREP_KILL;
3107         }
3108         
3109         return BLKPREP_OK;
3110 }
3111
3112 static int ide_cdrom_prep_fn(request_queue_t *q, struct request *rq)
3113 {
3114         if (rq->flags & REQ_CMD)
3115                 return ide_cdrom_prep_fs(q, rq);
3116         else if (rq->flags & REQ_BLOCK_PC)
3117                 return ide_cdrom_prep_pc(rq);
3118
3119         return 0;
3120 }
3121
3122 static
3123 int ide_cdrom_setup (ide_drive_t *drive)
3124 {
3125         struct cdrom_info *info = drive->driver_data;
3126         struct cdrom_device_info *cdi = &info->devinfo;
3127         int nslots;
3128
3129         blk_queue_prep_rq(drive->queue, ide_cdrom_prep_fn);
3130         blk_queue_dma_alignment(drive->queue, 31);
3131         drive->queue->unplug_delay = (1 * HZ) / 1000;
3132         if (!drive->queue->unplug_delay)
3133                 drive->queue->unplug_delay = 1;
3134
3135         drive->special.all      = 0;
3136
3137         CDROM_STATE_FLAGS(drive)->media_changed = 1;
3138         CDROM_STATE_FLAGS(drive)->toc_valid     = 0;
3139         CDROM_STATE_FLAGS(drive)->door_locked   = 0;
3140
3141 #if NO_DOOR_LOCKING
3142         CDROM_CONFIG_FLAGS(drive)->no_doorlock = 1;
3143 #else
3144         CDROM_CONFIG_FLAGS(drive)->no_doorlock = 0;
3145 #endif
3146
3147         CDROM_CONFIG_FLAGS(drive)->drq_interrupt = ((drive->id->config & 0x0060) == 0x20);
3148         CDROM_CONFIG_FLAGS(drive)->is_changer = 0;
3149         CDROM_CONFIG_FLAGS(drive)->cd_r = 0;
3150         CDROM_CONFIG_FLAGS(drive)->cd_rw = 0;
3151         CDROM_CONFIG_FLAGS(drive)->test_write = 0;
3152         CDROM_CONFIG_FLAGS(drive)->dvd = 0;
3153         CDROM_CONFIG_FLAGS(drive)->dvd_r = 0;
3154         CDROM_CONFIG_FLAGS(drive)->dvd_ram = 0;
3155         CDROM_CONFIG_FLAGS(drive)->no_eject = 1;
3156         CDROM_CONFIG_FLAGS(drive)->supp_disc_present = 0;
3157         CDROM_CONFIG_FLAGS(drive)->audio_play = 0;
3158         CDROM_CONFIG_FLAGS(drive)->close_tray = 1;
3159         
3160         /* limit transfer size per interrupt. */
3161         CDROM_CONFIG_FLAGS(drive)->limit_nframes = 0;
3162         /* a testament to the nice quality of Samsung drives... */
3163         if (!strcmp(drive->id->model, "SAMSUNG CD-ROM SCR-2430"))
3164                 CDROM_CONFIG_FLAGS(drive)->limit_nframes = 1;
3165         else if (!strcmp(drive->id->model, "SAMSUNG CD-ROM SCR-2432"))
3166                 CDROM_CONFIG_FLAGS(drive)->limit_nframes = 1;
3167         /* the 3231 model does not support the SET_CD_SPEED command */
3168         else if (!strcmp(drive->id->model, "SAMSUNG CD-ROM SCR-3231"))
3169                 cdi->mask |= CDC_SELECT_SPEED;
3170
3171 #if ! STANDARD_ATAPI
3172         /* by default Sanyo 3 CD changer support is turned off and
3173            ATAPI Rev 2.2+ standard support for CD changers is used */
3174         cdi->sanyo_slot = 0;
3175
3176         CDROM_CONFIG_FLAGS(drive)->nec260 = 0;
3177         CDROM_CONFIG_FLAGS(drive)->toctracks_as_bcd = 0;
3178         CDROM_CONFIG_FLAGS(drive)->tocaddr_as_bcd = 0;
3179         CDROM_CONFIG_FLAGS(drive)->playmsf_as_bcd = 0;
3180         CDROM_CONFIG_FLAGS(drive)->subchan_as_bcd = 0;
3181
3182         if (strcmp (drive->id->model, "V003S0DS") == 0 &&
3183             drive->id->fw_rev[4] == '1' &&
3184             drive->id->fw_rev[6] <= '2') {
3185                 /* Vertos 300.
3186                    Some versions of this drive like to talk BCD. */
3187                 CDROM_CONFIG_FLAGS(drive)->toctracks_as_bcd = 1;
3188                 CDROM_CONFIG_FLAGS(drive)->tocaddr_as_bcd = 1;
3189                 CDROM_CONFIG_FLAGS(drive)->playmsf_as_bcd = 1;
3190                 CDROM_CONFIG_FLAGS(drive)->subchan_as_bcd = 1;
3191         }
3192
3193         else if (strcmp (drive->id->model, "V006E0DS") == 0 &&
3194             drive->id->fw_rev[4] == '1' &&
3195             drive->id->fw_rev[6] <= '2') {
3196                 /* Vertos 600 ESD. */
3197                 CDROM_CONFIG_FLAGS(drive)->toctracks_as_bcd = 1;
3198         }
3199         else if (strcmp(drive->id->model, "NEC CD-ROM DRIVE:260") == 0 &&
3200                  strncmp(drive->id->fw_rev, "1.01", 4) == 0) { /* FIXME */
3201                 /* Old NEC260 (not R).
3202                    This drive was released before the 1.2 version
3203                    of the spec. */
3204                 CDROM_CONFIG_FLAGS(drive)->tocaddr_as_bcd = 1;
3205                 CDROM_CONFIG_FLAGS(drive)->playmsf_as_bcd = 1;
3206                 CDROM_CONFIG_FLAGS(drive)->subchan_as_bcd = 1;
3207                 CDROM_CONFIG_FLAGS(drive)->nec260         = 1;
3208         }
3209         else if (strcmp(drive->id->model, "WEARNES CDD-120") == 0 &&
3210                  strncmp(drive->id->fw_rev, "A1.1", 4) == 0) { /* FIXME */
3211                 /* Wearnes */
3212                 CDROM_CONFIG_FLAGS(drive)->playmsf_as_bcd = 1;
3213                 CDROM_CONFIG_FLAGS(drive)->subchan_as_bcd = 1;
3214         }
3215         /* Sanyo 3 CD changer uses a non-standard command
3216            for CD changing */
3217         else if ((strcmp(drive->id->model, "CD-ROM CDR-C3 G") == 0) ||
3218                  (strcmp(drive->id->model, "CD-ROM CDR-C3G") == 0) ||
3219                  (strcmp(drive->id->model, "CD-ROM CDR_C36") == 0)) {
3220                  /* uses CD in slot 0 when value is set to 3 */
3221                  cdi->sanyo_slot = 3;
3222         }
3223 #endif /* not STANDARD_ATAPI */
3224
3225         info->toc               = NULL;
3226         info->buffer            = NULL;
3227         info->sector_buffered   = 0;
3228         info->nsectors_buffered = 0;
3229         info->changer_info      = NULL;
3230         info->last_block        = 0;
3231         info->start_seek        = 0;
3232
3233         nslots = ide_cdrom_probe_capabilities (drive);
3234
3235         /*
3236          * set correct block size
3237          */
3238         blk_queue_hardsect_size(drive->queue, CD_FRAMESIZE);
3239
3240         if (drive->autotune == IDE_TUNE_DEFAULT ||
3241             drive->autotune == IDE_TUNE_AUTO)
3242                 drive->dsc_overlap = (drive->next != drive);
3243 #if 0
3244         drive->dsc_overlap = (HWIF(drive)->no_dsc) ? 0 : 1;
3245         if (HWIF(drive)->no_dsc) {
3246                 printk(KERN_INFO "ide-cd: %s: disabling DSC overlap\n",
3247                         drive->name);
3248                 drive->dsc_overlap = 0;
3249         }
3250 #endif
3251
3252         if (ide_cdrom_register(drive, nslots)) {
3253                 printk (KERN_ERR "%s: ide_cdrom_setup failed to register device with the cdrom driver.\n", drive->name);
3254                 info->devinfo.handle = NULL;
3255                 return 1;
3256         }
3257         ide_cdrom_add_settings(drive);
3258         return 0;
3259 }
3260
3261 #ifdef CONFIG_PROC_FS
3262 static
3263 sector_t ide_cdrom_capacity (ide_drive_t *drive)
3264 {
3265         unsigned long capacity, sectors_per_frame;
3266
3267         if (cdrom_read_capacity(drive, &capacity, &sectors_per_frame, NULL))
3268                 return 0;
3269
3270         return capacity * sectors_per_frame;
3271 }
3272 #endif
3273
3274 static int ide_cd_remove(struct device *dev)
3275 {
3276         ide_drive_t *drive = to_ide_device(dev);
3277         struct cdrom_info *info = drive->driver_data;
3278
3279         ide_unregister_subdriver(drive, info->driver);
3280
3281         del_gendisk(info->disk);
3282
3283         ide_cd_put(info);
3284
3285         return 0;
3286 }
3287
3288 static void ide_cd_release(struct kref *kref)
3289 {
3290         struct cdrom_info *info = to_ide_cd(kref);
3291         struct cdrom_device_info *devinfo = &info->devinfo;
3292         ide_drive_t *drive = info->drive;
3293         struct gendisk *g = info->disk;
3294
3295         if (info->buffer != NULL)
3296                 kfree(info->buffer);
3297         if (info->toc != NULL)
3298                 kfree(info->toc);
3299         if (info->changer_info != NULL)
3300                 kfree(info->changer_info);
3301         if (devinfo->handle == drive && unregister_cdrom(devinfo))
3302                 printk(KERN_ERR "%s: %s failed to unregister device from the cdrom "
3303                                 "driver.\n", __FUNCTION__, drive->name);
3304         drive->dsc_overlap = 0;
3305         drive->driver_data = NULL;
3306         blk_queue_prep_rq(drive->queue, NULL);
3307         g->private_data = NULL;
3308         put_disk(g);
3309         kfree(info);
3310 }
3311
3312 static int ide_cd_probe(struct device *);
3313
3314 #ifdef CONFIG_PROC_FS
3315 static int proc_idecd_read_capacity
3316         (char *page, char **start, off_t off, int count, int *eof, void *data)
3317 {
3318         ide_drive_t *drive = data;
3319         int len;
3320
3321         len = sprintf(page,"%llu\n", (long long)ide_cdrom_capacity(drive));
3322         PROC_IDE_READ_RETURN(page,start,off,count,eof,len);
3323 }
3324
3325 static ide_proc_entry_t idecd_proc[] = {
3326         { "capacity", S_IFREG|S_IRUGO, proc_idecd_read_capacity, NULL },
3327         { NULL, 0, NULL, NULL }
3328 };
3329 #else
3330 # define idecd_proc     NULL
3331 #endif
3332
3333 static ide_driver_t ide_cdrom_driver = {
3334         .owner                  = THIS_MODULE,
3335         .gen_driver = {
3336                 .name           = "ide-cdrom",
3337                 .bus            = &ide_bus_type,
3338                 .probe          = ide_cd_probe,
3339                 .remove         = ide_cd_remove,
3340         },
3341         .version                = IDECD_VERSION,
3342         .media                  = ide_cdrom,
3343         .supports_dsc_overlap   = 1,
3344         .do_request             = ide_do_rw_cdrom,
3345         .end_request            = ide_end_request,
3346         .error                  = __ide_error,
3347         .abort                  = __ide_abort,
3348         .proc                   = idecd_proc,
3349 };
3350
3351 static int idecd_open(struct inode * inode, struct file * file)
3352 {
3353         struct gendisk *disk = inode->i_bdev->bd_disk;
3354         struct cdrom_info *info;
3355         ide_drive_t *drive;
3356         int rc = -ENOMEM;
3357
3358         if (!(info = ide_cd_get(disk)))
3359                 return -ENXIO;
3360
3361         drive = info->drive;
3362
3363         drive->usage++;
3364
3365         if (!info->buffer)
3366                 info->buffer = kmalloc(SECTOR_BUFFER_SIZE,
3367                                         GFP_KERNEL|__GFP_REPEAT);
3368         if (!info->buffer || (rc = cdrom_open(&info->devinfo, inode, file)))
3369                 drive->usage--;
3370
3371         if (rc < 0)
3372                 ide_cd_put(info);
3373
3374         return rc;
3375 }
3376
3377 static int idecd_release(struct inode * inode, struct file * file)
3378 {
3379         struct gendisk *disk = inode->i_bdev->bd_disk;
3380         struct cdrom_info *info = ide_cd_g(disk);
3381         ide_drive_t *drive = info->drive;
3382
3383         cdrom_release (&info->devinfo, file);
3384         drive->usage--;
3385
3386         ide_cd_put(info);
3387
3388         return 0;
3389 }
3390
3391 static int idecd_ioctl (struct inode *inode, struct file *file,
3392                         unsigned int cmd, unsigned long arg)
3393 {
3394         struct block_device *bdev = inode->i_bdev;
3395         struct cdrom_info *info = ide_cd_g(bdev->bd_disk);
3396         int err;
3397
3398         err  = generic_ide_ioctl(info->drive, file, bdev, cmd, arg);
3399         if (err == -EINVAL)
3400                 err = cdrom_ioctl(file, &info->devinfo, inode, cmd, arg);
3401
3402         return err;
3403 }
3404
3405 static int idecd_media_changed(struct gendisk *disk)
3406 {
3407         struct cdrom_info *info = ide_cd_g(disk);
3408         return cdrom_media_changed(&info->devinfo);
3409 }
3410
3411 static int idecd_revalidate_disk(struct gendisk *disk)
3412 {
3413         struct cdrom_info *info = ide_cd_g(disk);
3414         struct request_sense sense;
3415         cdrom_read_toc(info->drive, &sense);
3416         return  0;
3417 }
3418
3419 static struct block_device_operations idecd_ops = {
3420         .owner          = THIS_MODULE,
3421         .open           = idecd_open,
3422         .release        = idecd_release,
3423         .ioctl          = idecd_ioctl,
3424         .media_changed  = idecd_media_changed,
3425         .revalidate_disk= idecd_revalidate_disk
3426 };
3427
3428 /* options */
3429 static char *ignore = NULL;
3430
3431 module_param(ignore, charp, 0400);
3432 MODULE_DESCRIPTION("ATAPI CD-ROM Driver");
3433
3434 static int ide_cd_probe(struct device *dev)
3435 {
3436         ide_drive_t *drive = to_ide_device(dev);
3437         struct cdrom_info *info;
3438         struct gendisk *g;
3439         struct request_sense sense;
3440
3441         if (!strstr("ide-cdrom", drive->driver_req))
3442                 goto failed;
3443         if (!drive->present)
3444                 goto failed;
3445         if (drive->media != ide_cdrom && drive->media != ide_optical)
3446                 goto failed;
3447         /* skip drives that we were told to ignore */
3448         if (ignore != NULL) {
3449                 if (strstr(ignore, drive->name)) {
3450                         printk(KERN_INFO "ide-cd: ignoring drive %s\n", drive->name);
3451                         goto failed;
3452                 }
3453         }
3454         if (drive->scsi) {
3455                 printk(KERN_INFO "ide-cd: passing drive %s to ide-scsi emulation.\n", drive->name);
3456                 goto failed;
3457         }
3458         info = kmalloc(sizeof(struct cdrom_info), GFP_KERNEL);
3459         if (info == NULL) {
3460                 printk(KERN_ERR "%s: Can't allocate a cdrom structure\n", drive->name);
3461                 goto failed;
3462         }
3463
3464         g = alloc_disk(1 << PARTN_BITS);
3465         if (!g)
3466                 goto out_free_cd;
3467
3468         ide_init_disk(g, drive);
3469
3470         ide_register_subdriver(drive, &ide_cdrom_driver);
3471
3472         memset(info, 0, sizeof (struct cdrom_info));
3473
3474         kref_init(&info->kref);
3475
3476         info->drive = drive;
3477         info->driver = &ide_cdrom_driver;
3478         info->disk = g;
3479
3480         g->private_data = &info->driver;
3481
3482         drive->driver_data = info;
3483
3484         g->minors = 1;
3485         snprintf(g->devfs_name, sizeof(g->devfs_name),
3486                         "%s/cd", drive->devfs_name);
3487         g->driverfs_dev = &drive->gendev;
3488         g->flags = GENHD_FL_CD | GENHD_FL_REMOVABLE;
3489         if (ide_cdrom_setup(drive)) {
3490                 struct cdrom_device_info *devinfo = &info->devinfo;
3491                 ide_unregister_subdriver(drive, &ide_cdrom_driver);
3492                 if (info->buffer != NULL)
3493                         kfree(info->buffer);
3494                 if (info->toc != NULL)
3495                         kfree(info->toc);
3496                 if (info->changer_info != NULL)
3497                         kfree(info->changer_info);
3498                 if (devinfo->handle == drive && unregister_cdrom(devinfo))
3499                         printk (KERN_ERR "%s: ide_cdrom_cleanup failed to unregister device from the cdrom driver.\n", drive->name);
3500                 kfree(info);
3501                 drive->driver_data = NULL;
3502                 goto failed;
3503         }
3504
3505         cdrom_read_toc(drive, &sense);
3506         g->fops = &idecd_ops;
3507         g->flags |= GENHD_FL_REMOVABLE;
3508         add_disk(g);
3509         return 0;
3510
3511 out_free_cd:
3512         kfree(info);
3513 failed:
3514         return -ENODEV;
3515 }
3516
3517 static void __exit ide_cdrom_exit(void)
3518 {
3519         driver_unregister(&ide_cdrom_driver.gen_driver);
3520 }
3521  
3522 static int ide_cdrom_init(void)
3523 {
3524         return driver_register(&ide_cdrom_driver.gen_driver);
3525 }
3526
3527 module_init(ide_cdrom_init);
3528 module_exit(ide_cdrom_exit);
3529 MODULE_LICENSE("GPL");