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