Merge master.kernel.org:/pub/scm/linux/kernel/git/mchehab/v4l-dvb
[linux-drm-fsl-dcu.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)\n",
1455                         drive->name, ireason);
1456                 rq->flags |= REQ_FAILED;
1457         }
1458
1459         /* Now we wait for another interrupt. */
1460         ide_set_handler(drive, &cdrom_pc_intr, ATAPI_WAIT_PC, cdrom_timer_expiry);
1461         return ide_started;
1462 }
1463
1464 static ide_startstop_t cdrom_do_pc_continuation (ide_drive_t *drive)
1465 {
1466         struct request *rq = HWGROUP(drive)->rq;
1467
1468         if (!rq->timeout)
1469                 rq->timeout = ATAPI_WAIT_PC;
1470
1471         /* Send the command to the drive and return. */
1472         return cdrom_transfer_packet_command(drive, rq, &cdrom_pc_intr);
1473 }
1474
1475
1476 static ide_startstop_t cdrom_do_packet_command (ide_drive_t *drive)
1477 {
1478         int len;
1479         struct request *rq = HWGROUP(drive)->rq;
1480         struct cdrom_info *info = drive->driver_data;
1481
1482         info->dma = 0;
1483         rq->flags &= ~REQ_FAILED;
1484         len = rq->data_len;
1485
1486         /* Start sending the command to the drive. */
1487         return cdrom_start_packet_command(drive, len, cdrom_do_pc_continuation);
1488 }
1489
1490
1491 static
1492 int cdrom_queue_packet_command(ide_drive_t *drive, struct request *rq)
1493 {
1494         struct request_sense sense;
1495         int retries = 10;
1496         unsigned int flags = rq->flags;
1497
1498         if (rq->sense == NULL)
1499                 rq->sense = &sense;
1500
1501         /* Start of retry loop. */
1502         do {
1503                 int error;
1504                 unsigned long time = jiffies;
1505                 rq->flags = flags;
1506
1507                 error = ide_do_drive_cmd(drive, rq, ide_wait);
1508                 time = jiffies - time;
1509
1510                 /* FIXME: we should probably abort/retry or something 
1511                  * in case of failure */
1512                 if (rq->flags & REQ_FAILED) {
1513                         /* The request failed.  Retry if it was due to a unit
1514                            attention status
1515                            (usually means media was changed). */
1516                         struct request_sense *reqbuf = rq->sense;
1517
1518                         if (reqbuf->sense_key == UNIT_ATTENTION)
1519                                 cdrom_saw_media_change(drive);
1520                         else if (reqbuf->sense_key == NOT_READY &&
1521                                  reqbuf->asc == 4 && reqbuf->ascq != 4) {
1522                                 /* The drive is in the process of loading
1523                                    a disk.  Retry, but wait a little to give
1524                                    the drive time to complete the load. */
1525                                 ssleep(2);
1526                         } else {
1527                                 /* Otherwise, don't retry. */
1528                                 retries = 0;
1529                         }
1530                         --retries;
1531                 }
1532
1533                 /* End of retry loop. */
1534         } while ((rq->flags & REQ_FAILED) && retries >= 0);
1535
1536         /* Return an error if the command failed. */
1537         return (rq->flags & REQ_FAILED) ? -EIO : 0;
1538 }
1539
1540 /*
1541  * Write handling
1542  */
1543 static int cdrom_write_check_ireason(ide_drive_t *drive, int len, int ireason)
1544 {
1545         /* Two notes about IDE interrupt reason here - 0 means that
1546          * the drive wants to receive data from us, 2 means that
1547          * the drive is expecting to transfer data to us.
1548          */
1549         if (ireason == 0)
1550                 return 0;
1551         else if (ireason == 2) {
1552                 /* Whoops... The drive wants to send data. */
1553                 printk(KERN_ERR "%s: write_intr: wrong transfer direction!\n",
1554                                                         drive->name);
1555
1556                 while (len > 0) {
1557                         int dum = 0;
1558                         HWIF(drive)->atapi_input_bytes(drive, &dum, sizeof(dum));
1559                         len -= sizeof(dum);
1560                 }
1561         } else {
1562                 /* Drive wants a command packet, or invalid ireason... */
1563                 printk(KERN_ERR "%s: write_intr: bad interrupt reason %x\n",
1564                                                         drive->name, ireason);
1565         }
1566
1567         cdrom_end_request(drive, 0);
1568         return 1;
1569 }
1570
1571 static void post_transform_command(struct request *req)
1572 {
1573         u8 *c = req->cmd;
1574         char *ibuf;
1575
1576         if (!blk_pc_request(req))
1577                 return;
1578
1579         if (req->bio)
1580                 ibuf = bio_data(req->bio);
1581         else
1582                 ibuf = req->data;
1583
1584         if (!ibuf)
1585                 return;
1586
1587         /*
1588          * set ansi-revision and response data as atapi
1589          */
1590         if (c[0] == GPCMD_INQUIRY) {
1591                 ibuf[2] |= 2;
1592                 ibuf[3] = (ibuf[3] & 0xf0) | 2;
1593         }
1594 }
1595
1596 typedef void (xfer_func_t)(ide_drive_t *, void *, u32);
1597
1598 /*
1599  * best way to deal with dma that is not sector aligned right now... note
1600  * that in this path we are not using ->data or ->buffer at all. this irs
1601  * can replace cdrom_pc_intr, cdrom_read_intr, and cdrom_write_intr in the
1602  * future.
1603  */
1604 static ide_startstop_t cdrom_newpc_intr(ide_drive_t *drive)
1605 {
1606         struct cdrom_info *info = drive->driver_data;
1607         struct request *rq = HWGROUP(drive)->rq;
1608         int dma_error, dma, stat, ireason, len, thislen;
1609         u8 lowcyl, highcyl;
1610         xfer_func_t *xferfunc;
1611         unsigned long flags;
1612
1613         /* Check for errors. */
1614         dma_error = 0;
1615         dma = info->dma;
1616         if (dma) {
1617                 info->dma = 0;
1618                 dma_error = HWIF(drive)->ide_dma_end(drive);
1619         }
1620
1621         if (cdrom_decode_status(drive, 0, &stat))
1622                 return ide_stopped;
1623
1624         /*
1625          * using dma, transfer is complete now
1626          */
1627         if (dma) {
1628                 if (dma_error) {
1629                         printk(KERN_ERR "ide-cd: dma error\n");
1630                         __ide_dma_off(drive);
1631                         return ide_error(drive, "dma error", stat);
1632                 }
1633
1634                 end_that_request_chunk(rq, 1, rq->data_len);
1635                 rq->data_len = 0;
1636                 goto end_request;
1637         }
1638
1639         /*
1640          * ok we fall to pio :/
1641          */
1642         ireason = HWIF(drive)->INB(IDE_IREASON_REG) & 0x3;
1643         lowcyl  = HWIF(drive)->INB(IDE_BCOUNTL_REG);
1644         highcyl = HWIF(drive)->INB(IDE_BCOUNTH_REG);
1645
1646         len = lowcyl + (256 * highcyl);
1647         thislen = rq->data_len;
1648         if (thislen > len)
1649                 thislen = len;
1650
1651         /*
1652          * If DRQ is clear, the command has completed.
1653          */
1654         if ((stat & DRQ_STAT) == 0)
1655                 goto end_request;
1656
1657         /*
1658          * check which way to transfer data
1659          */
1660         if (rq_data_dir(rq) == WRITE) {
1661                 /*
1662                  * write to drive
1663                  */
1664                 if (cdrom_write_check_ireason(drive, len, ireason))
1665                         return ide_stopped;
1666
1667                 xferfunc = HWIF(drive)->atapi_output_bytes;
1668         } else  {
1669                 /*
1670                  * read from drive
1671                  */
1672                 if (cdrom_read_check_ireason(drive, len, ireason))
1673                         return ide_stopped;
1674
1675                 xferfunc = HWIF(drive)->atapi_input_bytes;
1676         }
1677
1678         /*
1679          * transfer data
1680          */
1681         while (thislen > 0) {
1682                 int blen = blen = rq->data_len;
1683                 char *ptr = rq->data;
1684
1685                 /*
1686                  * bio backed?
1687                  */
1688                 if (rq->bio) {
1689                         ptr = bio_data(rq->bio);
1690                         blen = bio_iovec(rq->bio)->bv_len;
1691                 }
1692
1693                 if (!ptr) {
1694                         printk(KERN_ERR "%s: confused, missing data\n", drive->name);
1695                         break;
1696                 }
1697
1698                 if (blen > thislen)
1699                         blen = thislen;
1700
1701                 xferfunc(drive, ptr, blen);
1702
1703                 thislen -= blen;
1704                 len -= blen;
1705                 rq->data_len -= blen;
1706
1707                 if (rq->bio)
1708                         end_that_request_chunk(rq, 1, blen);
1709                 else
1710                         rq->data += blen;
1711         }
1712
1713         /*
1714          * pad, if necessary
1715          */
1716         if (len > 0) {
1717                 while (len > 0) {
1718                         int pad = 0;
1719
1720                         xferfunc(drive, &pad, sizeof(pad));
1721                         len -= sizeof(pad);
1722                 }
1723         }
1724
1725         if (HWGROUP(drive)->handler != NULL)
1726                 BUG();
1727
1728         ide_set_handler(drive, cdrom_newpc_intr, rq->timeout, NULL);
1729         return ide_started;
1730
1731 end_request:
1732         if (!rq->data_len)
1733                 post_transform_command(rq);
1734
1735         spin_lock_irqsave(&ide_lock, flags);
1736         blkdev_dequeue_request(rq);
1737         end_that_request_last(rq, 1);
1738         HWGROUP(drive)->rq = NULL;
1739         spin_unlock_irqrestore(&ide_lock, flags);
1740         return ide_stopped;
1741 }
1742
1743 static ide_startstop_t cdrom_write_intr(ide_drive_t *drive)
1744 {
1745         int stat, ireason, len, sectors_to_transfer, uptodate;
1746         struct cdrom_info *info = drive->driver_data;
1747         int dma_error = 0, dma = info->dma;
1748         u8 lowcyl = 0, highcyl = 0;
1749
1750         struct request *rq = HWGROUP(drive)->rq;
1751
1752         /* Check for errors. */
1753         if (dma) {
1754                 info->dma = 0;
1755                 if ((dma_error = HWIF(drive)->ide_dma_end(drive))) {
1756                         printk(KERN_ERR "ide-cd: write dma error\n");
1757                         __ide_dma_off(drive);
1758                 }
1759         }
1760
1761         if (cdrom_decode_status(drive, 0, &stat))
1762                 return ide_stopped;
1763
1764         /*
1765          * using dma, transfer is complete now
1766          */
1767         if (dma) {
1768                 if (dma_error)
1769                         return ide_error(drive, "dma error", stat);
1770
1771                 ide_end_request(drive, 1, rq->nr_sectors);
1772                 return ide_stopped;
1773         }
1774
1775         /* Read the interrupt reason and the transfer length. */
1776         ireason = HWIF(drive)->INB(IDE_IREASON_REG);
1777         lowcyl  = HWIF(drive)->INB(IDE_BCOUNTL_REG);
1778         highcyl = HWIF(drive)->INB(IDE_BCOUNTH_REG);
1779
1780         len = lowcyl + (256 * highcyl);
1781
1782         /* If DRQ is clear, the command has completed. */
1783         if ((stat & DRQ_STAT) == 0) {
1784                 /* If we're not done writing, complain.
1785                  * Otherwise, complete the command normally.
1786                  */
1787                 uptodate = 1;
1788                 if (rq->current_nr_sectors > 0) {
1789                         printk(KERN_ERR "%s: write_intr: data underrun (%d blocks)\n",
1790                         drive->name, rq->current_nr_sectors);
1791                         uptodate = 0;
1792                 }
1793                 cdrom_end_request(drive, uptodate);
1794                 return ide_stopped;
1795         }
1796
1797         /* Check that the drive is expecting to do the same thing we are. */
1798         if (cdrom_write_check_ireason(drive, len, ireason))
1799                 return ide_stopped;
1800
1801         sectors_to_transfer = len / SECTOR_SIZE;
1802
1803         /*
1804          * now loop and write out the data
1805          */
1806         while (sectors_to_transfer > 0) {
1807                 int this_transfer;
1808
1809                 if (!rq->current_nr_sectors) {
1810                         printk(KERN_ERR "ide-cd: write_intr: oops\n");
1811                         break;
1812                 }
1813
1814                 /*
1815                  * Figure out how many sectors we can transfer
1816                  */
1817                 this_transfer = min_t(int, sectors_to_transfer, rq->current_nr_sectors);
1818
1819                 while (this_transfer > 0) {
1820                         HWIF(drive)->atapi_output_bytes(drive, rq->buffer, SECTOR_SIZE);
1821                         rq->buffer += SECTOR_SIZE;
1822                         --rq->nr_sectors;
1823                         --rq->current_nr_sectors;
1824                         ++rq->sector;
1825                         --this_transfer;
1826                         --sectors_to_transfer;
1827                 }
1828
1829                 /*
1830                  * current buffer complete, move on
1831                  */
1832                 if (rq->current_nr_sectors == 0 && rq->nr_sectors)
1833                         cdrom_end_request(drive, 1);
1834         }
1835
1836         /* re-arm handler */
1837         ide_set_handler(drive, &cdrom_write_intr, ATAPI_WAIT_PC, NULL);
1838         return ide_started;
1839 }
1840
1841 static ide_startstop_t cdrom_start_write_cont(ide_drive_t *drive)
1842 {
1843         struct request *rq = HWGROUP(drive)->rq;
1844
1845 #if 0   /* the immediate bit */
1846         rq->cmd[1] = 1 << 3;
1847 #endif
1848         rq->timeout = ATAPI_WAIT_PC;
1849
1850         return cdrom_transfer_packet_command(drive, rq, cdrom_write_intr);
1851 }
1852
1853 static ide_startstop_t cdrom_start_write(ide_drive_t *drive, struct request *rq)
1854 {
1855         struct cdrom_info *info = drive->driver_data;
1856         struct gendisk *g = info->disk;
1857         unsigned short sectors_per_frame = queue_hardsect_size(drive->queue) >> SECTOR_BITS;
1858
1859         /*
1860          * writes *must* be hardware frame aligned
1861          */
1862         if ((rq->nr_sectors & (sectors_per_frame - 1)) ||
1863             (rq->sector & (sectors_per_frame - 1))) {
1864                 cdrom_end_request(drive, 0);
1865                 return ide_stopped;
1866         }
1867
1868         /*
1869          * disk has become write protected
1870          */
1871         if (g->policy) {
1872                 cdrom_end_request(drive, 0);
1873                 return ide_stopped;
1874         }
1875
1876         info->nsectors_buffered = 0;
1877
1878         /* use dma, if possible. we don't need to check more, since we
1879          * know that the transfer is always (at least!) frame aligned */
1880         info->dma = drive->using_dma ? 1 : 0;
1881
1882         info->devinfo.media_written = 1;
1883
1884         /* Start sending the write request to the drive. */
1885         return cdrom_start_packet_command(drive, 32768, cdrom_start_write_cont);
1886 }
1887
1888 static ide_startstop_t cdrom_do_newpc_cont(ide_drive_t *drive)
1889 {
1890         struct request *rq = HWGROUP(drive)->rq;
1891
1892         if (!rq->timeout)
1893                 rq->timeout = ATAPI_WAIT_PC;
1894
1895         return cdrom_transfer_packet_command(drive, rq, cdrom_newpc_intr);
1896 }
1897
1898 static ide_startstop_t cdrom_do_block_pc(ide_drive_t *drive, struct request *rq)
1899 {
1900         struct cdrom_info *info = drive->driver_data;
1901
1902         rq->flags |= REQ_QUIET;
1903
1904         info->dma = 0;
1905
1906         /*
1907          * sg request
1908          */
1909         if (rq->bio) {
1910                 int mask = drive->queue->dma_alignment;
1911                 unsigned long addr = (unsigned long) page_address(bio_page(rq->bio));
1912
1913                 info->dma = drive->using_dma;
1914
1915                 /*
1916                  * check if dma is safe
1917                  *
1918                  * NOTE! The "len" and "addr" checks should possibly have
1919                  * separate masks.
1920                  */
1921                 if ((rq->data_len & 15) || (addr & mask))
1922                         info->dma = 0;
1923         }
1924
1925         /* Start sending the command to the drive. */
1926         return cdrom_start_packet_command(drive, rq->data_len, cdrom_do_newpc_cont);
1927 }
1928
1929 /****************************************************************************
1930  * cdrom driver request routine.
1931  */
1932 static ide_startstop_t
1933 ide_do_rw_cdrom (ide_drive_t *drive, struct request *rq, sector_t block)
1934 {
1935         ide_startstop_t action;
1936         struct cdrom_info *info = drive->driver_data;
1937
1938         if (blk_fs_request(rq)) {
1939                 if (CDROM_CONFIG_FLAGS(drive)->seeking) {
1940                         unsigned long elapsed = jiffies - info->start_seek;
1941                         int stat = HWIF(drive)->INB(IDE_STATUS_REG);
1942
1943                         if ((stat & SEEK_STAT) != SEEK_STAT) {
1944                                 if (elapsed < IDECD_SEEK_TIMEOUT) {
1945                                         ide_stall_queue(drive, IDECD_SEEK_TIMER);
1946                                         return ide_stopped;
1947                                 }
1948                                 printk (KERN_ERR "%s: DSC timeout\n", drive->name);
1949                         }
1950                         CDROM_CONFIG_FLAGS(drive)->seeking = 0;
1951                 }
1952                 if ((rq_data_dir(rq) == READ) && IDE_LARGE_SEEK(info->last_block, block, IDECD_SEEK_THRESHOLD) && drive->dsc_overlap) {
1953                         action = cdrom_start_seek(drive, block);
1954                 } else {
1955                         if (rq_data_dir(rq) == READ)
1956                                 action = cdrom_start_read(drive, block);
1957                         else
1958                                 action = cdrom_start_write(drive, rq);
1959                 }
1960                 info->last_block = block;
1961                 return action;
1962         } else if (rq->flags & (REQ_PC | REQ_SENSE)) {
1963                 return cdrom_do_packet_command(drive);
1964         } else if (rq->flags & REQ_BLOCK_PC) {
1965                 return cdrom_do_block_pc(drive, rq);
1966         } else if (rq->flags & REQ_SPECIAL) {
1967                 /*
1968                  * right now this can only be a reset...
1969                  */
1970                 cdrom_end_request(drive, 1);
1971                 return ide_stopped;
1972         }
1973
1974         blk_dump_rq_flags(rq, "ide-cd bad flags");
1975         cdrom_end_request(drive, 0);
1976         return ide_stopped;
1977 }
1978
1979
1980
1981 /****************************************************************************
1982  * Ioctl handling.
1983  *
1984  * Routines which queue packet commands take as a final argument a pointer
1985  * to a request_sense struct.  If execution of the command results
1986  * in an error with a CHECK CONDITION status, this structure will be filled
1987  * with the results of the subsequent request sense command.  The pointer
1988  * can also be NULL, in which case no sense information is returned.
1989  */
1990
1991 #if ! STANDARD_ATAPI
1992 static inline
1993 int bin2bcd (int x)
1994 {
1995         return (x%10) | ((x/10) << 4);
1996 }
1997
1998
1999 static inline
2000 int bcd2bin (int x)
2001 {
2002         return (x >> 4) * 10 + (x & 0x0f);
2003 }
2004
2005 static
2006 void msf_from_bcd (struct atapi_msf *msf)
2007 {
2008         msf->minute = bcd2bin (msf->minute);
2009         msf->second = bcd2bin (msf->second);
2010         msf->frame  = bcd2bin (msf->frame);
2011 }
2012
2013 #endif /* not STANDARD_ATAPI */
2014
2015
2016 static inline
2017 void lba_to_msf (int lba, byte *m, byte *s, byte *f)
2018 {
2019         lba += CD_MSF_OFFSET;
2020         lba &= 0xffffff;  /* negative lbas use only 24 bits */
2021         *m = lba / (CD_SECS * CD_FRAMES);
2022         lba %= (CD_SECS * CD_FRAMES);
2023         *s = lba / CD_FRAMES;
2024         *f = lba % CD_FRAMES;
2025 }
2026
2027
2028 static inline
2029 int msf_to_lba (byte m, byte s, byte f)
2030 {
2031         return (((m * CD_SECS) + s) * CD_FRAMES + f) - CD_MSF_OFFSET;
2032 }
2033
2034 static int cdrom_check_status(ide_drive_t *drive, struct request_sense *sense)
2035 {
2036         struct request req;
2037         struct cdrom_info *info = drive->driver_data;
2038         struct cdrom_device_info *cdi = &info->devinfo;
2039
2040         cdrom_prepare_request(drive, &req);
2041
2042         req.sense = sense;
2043         req.cmd[0] = GPCMD_TEST_UNIT_READY;
2044         req.flags |= REQ_QUIET;
2045
2046 #if ! STANDARD_ATAPI
2047         /* the Sanyo 3 CD changer uses byte 7 of TEST_UNIT_READY to 
2048            switch CDs instead of supporting the LOAD_UNLOAD opcode   */
2049
2050         req.cmd[7] = cdi->sanyo_slot % 3;
2051 #endif /* not STANDARD_ATAPI */
2052
2053         return cdrom_queue_packet_command(drive, &req);
2054 }
2055
2056
2057 /* Lock the door if LOCKFLAG is nonzero; unlock it otherwise. */
2058 static int
2059 cdrom_lockdoor(ide_drive_t *drive, int lockflag, struct request_sense *sense)
2060 {
2061         struct request_sense my_sense;
2062         struct request req;
2063         int stat;
2064
2065         if (sense == NULL)
2066                 sense = &my_sense;
2067
2068         /* If the drive cannot lock the door, just pretend. */
2069         if (CDROM_CONFIG_FLAGS(drive)->no_doorlock) {
2070                 stat = 0;
2071         } else {
2072                 cdrom_prepare_request(drive, &req);
2073                 req.sense = sense;
2074                 req.cmd[0] = GPCMD_PREVENT_ALLOW_MEDIUM_REMOVAL;
2075                 req.cmd[4] = lockflag ? 1 : 0;
2076                 stat = cdrom_queue_packet_command(drive, &req);
2077         }
2078
2079         /* If we got an illegal field error, the drive
2080            probably cannot lock the door. */
2081         if (stat != 0 &&
2082             sense->sense_key == ILLEGAL_REQUEST &&
2083             (sense->asc == 0x24 || sense->asc == 0x20)) {
2084                 printk (KERN_ERR "%s: door locking not supported\n",
2085                         drive->name);
2086                 CDROM_CONFIG_FLAGS(drive)->no_doorlock = 1;
2087                 stat = 0;
2088         }
2089         
2090         /* no medium, that's alright. */
2091         if (stat != 0 && sense->sense_key == NOT_READY && sense->asc == 0x3a)
2092                 stat = 0;
2093
2094         if (stat == 0)
2095                 CDROM_STATE_FLAGS(drive)->door_locked = lockflag;
2096
2097         return stat;
2098 }
2099
2100
2101 /* Eject the disk if EJECTFLAG is 0.
2102    If EJECTFLAG is 1, try to reload the disk. */
2103 static int cdrom_eject(ide_drive_t *drive, int ejectflag,
2104                        struct request_sense *sense)
2105 {
2106         struct request req;
2107         char loej = 0x02;
2108
2109         if (CDROM_CONFIG_FLAGS(drive)->no_eject && !ejectflag)
2110                 return -EDRIVE_CANT_DO_THIS;
2111         
2112         /* reload fails on some drives, if the tray is locked */
2113         if (CDROM_STATE_FLAGS(drive)->door_locked && ejectflag)
2114                 return 0;
2115
2116         cdrom_prepare_request(drive, &req);
2117
2118         /* only tell drive to close tray if open, if it can do that */
2119         if (ejectflag && !CDROM_CONFIG_FLAGS(drive)->close_tray)
2120                 loej = 0;
2121
2122         req.sense = sense;
2123         req.cmd[0] = GPCMD_START_STOP_UNIT;
2124         req.cmd[4] = loej | (ejectflag != 0);
2125         return cdrom_queue_packet_command(drive, &req);
2126 }
2127
2128 static int cdrom_read_capacity(ide_drive_t *drive, unsigned long *capacity,
2129                                unsigned long *sectors_per_frame,
2130                                struct request_sense *sense)
2131 {
2132         struct {
2133                 __u32 lba;
2134                 __u32 blocklen;
2135         } capbuf;
2136
2137         int stat;
2138         struct request req;
2139
2140         cdrom_prepare_request(drive, &req);
2141
2142         req.sense = sense;
2143         req.cmd[0] = GPCMD_READ_CDVD_CAPACITY;
2144         req.data = (char *)&capbuf;
2145         req.data_len = sizeof(capbuf);
2146
2147         stat = cdrom_queue_packet_command(drive, &req);
2148         if (stat == 0) {
2149                 *capacity = 1 + be32_to_cpu(capbuf.lba);
2150                 *sectors_per_frame =
2151                         be32_to_cpu(capbuf.blocklen) >> SECTOR_BITS;
2152         }
2153
2154         return stat;
2155 }
2156
2157 static int cdrom_read_tocentry(ide_drive_t *drive, int trackno, int msf_flag,
2158                                 int format, char *buf, int buflen,
2159                                 struct request_sense *sense)
2160 {
2161         struct request req;
2162
2163         cdrom_prepare_request(drive, &req);
2164
2165         req.sense = sense;
2166         req.data =  buf;
2167         req.data_len = buflen;
2168         req.flags |= REQ_QUIET;
2169         req.cmd[0] = GPCMD_READ_TOC_PMA_ATIP;
2170         req.cmd[6] = trackno;
2171         req.cmd[7] = (buflen >> 8);
2172         req.cmd[8] = (buflen & 0xff);
2173         req.cmd[9] = (format << 6);
2174
2175         if (msf_flag)
2176                 req.cmd[1] = 2;
2177
2178         return cdrom_queue_packet_command(drive, &req);
2179 }
2180
2181
2182 /* Try to read the entire TOC for the disk into our internal buffer. */
2183 static int cdrom_read_toc(ide_drive_t *drive, struct request_sense *sense)
2184 {
2185         int stat, ntracks, i;
2186         struct cdrom_info *info = drive->driver_data;
2187         struct cdrom_device_info *cdi = &info->devinfo;
2188         struct atapi_toc *toc = info->toc;
2189         struct {
2190                 struct atapi_toc_header hdr;
2191                 struct atapi_toc_entry  ent;
2192         } ms_tmp;
2193         long last_written;
2194         unsigned long sectors_per_frame = SECTORS_PER_FRAME;
2195
2196         if (toc == NULL) {
2197                 /* Try to allocate space. */
2198                 toc = kmalloc(sizeof(struct atapi_toc), GFP_KERNEL);
2199                 if (toc == NULL) {
2200                         printk (KERN_ERR "%s: No cdrom TOC buffer!\n", drive->name);
2201                         return -ENOMEM;
2202                 }
2203                 info->toc = toc;
2204         }
2205
2206         /* Check to see if the existing data is still valid.
2207            If it is, just return. */
2208         (void) cdrom_check_status(drive, sense);
2209
2210         if (CDROM_STATE_FLAGS(drive)->toc_valid)
2211                 return 0;
2212
2213         /* Try to get the total cdrom capacity and sector size. */
2214         stat = cdrom_read_capacity(drive, &toc->capacity, &sectors_per_frame,
2215                                    sense);
2216         if (stat)
2217                 toc->capacity = 0x1fffff;
2218
2219         set_capacity(info->disk, toc->capacity * sectors_per_frame);
2220         blk_queue_hardsect_size(drive->queue,
2221                                 sectors_per_frame << SECTOR_BITS);
2222
2223         /* First read just the header, so we know how long the TOC is. */
2224         stat = cdrom_read_tocentry(drive, 0, 1, 0, (char *) &toc->hdr,
2225                                     sizeof(struct atapi_toc_header), sense);
2226         if (stat)
2227                 return stat;
2228
2229 #if ! STANDARD_ATAPI
2230         if (CDROM_CONFIG_FLAGS(drive)->toctracks_as_bcd) {
2231                 toc->hdr.first_track = bcd2bin(toc->hdr.first_track);
2232                 toc->hdr.last_track  = bcd2bin(toc->hdr.last_track);
2233         }
2234 #endif  /* not STANDARD_ATAPI */
2235
2236         ntracks = toc->hdr.last_track - toc->hdr.first_track + 1;
2237         if (ntracks <= 0)
2238                 return -EIO;
2239         if (ntracks > MAX_TRACKS)
2240                 ntracks = MAX_TRACKS;
2241
2242         /* Now read the whole schmeer. */
2243         stat = cdrom_read_tocentry(drive, toc->hdr.first_track, 1, 0,
2244                                   (char *)&toc->hdr,
2245                                    sizeof(struct atapi_toc_header) +
2246                                    (ntracks + 1) *
2247                                    sizeof(struct atapi_toc_entry), sense);
2248
2249         if (stat && toc->hdr.first_track > 1) {
2250                 /* Cds with CDI tracks only don't have any TOC entries,
2251                    despite of this the returned values are
2252                    first_track == last_track = number of CDI tracks + 1,
2253                    so that this case is indistinguishable from the same
2254                    layout plus an additional audio track.
2255                    If we get an error for the regular case, we assume
2256                    a CDI without additional audio tracks. In this case
2257                    the readable TOC is empty (CDI tracks are not included)
2258                    and only holds the Leadout entry. Heiko Eißfeldt */
2259                 ntracks = 0;
2260                 stat = cdrom_read_tocentry(drive, CDROM_LEADOUT, 1, 0,
2261                                            (char *)&toc->hdr,
2262                                            sizeof(struct atapi_toc_header) +
2263                                            (ntracks + 1) *
2264                                            sizeof(struct atapi_toc_entry),
2265                                            sense);
2266                 if (stat) {
2267                         return stat;
2268                 }
2269 #if ! STANDARD_ATAPI
2270                 if (CDROM_CONFIG_FLAGS(drive)->toctracks_as_bcd) {
2271                         toc->hdr.first_track = bin2bcd(CDROM_LEADOUT);
2272                         toc->hdr.last_track = bin2bcd(CDROM_LEADOUT);
2273                 } else
2274 #endif  /* not STANDARD_ATAPI */
2275                 {
2276                         toc->hdr.first_track = CDROM_LEADOUT;
2277                         toc->hdr.last_track = CDROM_LEADOUT;
2278                 }
2279         }
2280
2281         if (stat)
2282                 return stat;
2283
2284         toc->hdr.toc_length = ntohs (toc->hdr.toc_length);
2285
2286 #if ! STANDARD_ATAPI
2287         if (CDROM_CONFIG_FLAGS(drive)->toctracks_as_bcd) {
2288                 toc->hdr.first_track = bcd2bin(toc->hdr.first_track);
2289                 toc->hdr.last_track  = bcd2bin(toc->hdr.last_track);
2290         }
2291 #endif  /* not STANDARD_ATAPI */
2292
2293         for (i=0; i<=ntracks; i++) {
2294 #if ! STANDARD_ATAPI
2295                 if (CDROM_CONFIG_FLAGS(drive)->tocaddr_as_bcd) {
2296                         if (CDROM_CONFIG_FLAGS(drive)->toctracks_as_bcd)
2297                                 toc->ent[i].track = bcd2bin(toc->ent[i].track);
2298                         msf_from_bcd(&toc->ent[i].addr.msf);
2299                 }
2300 #endif  /* not STANDARD_ATAPI */
2301                 toc->ent[i].addr.lba = msf_to_lba (toc->ent[i].addr.msf.minute,
2302                                                    toc->ent[i].addr.msf.second,
2303                                                    toc->ent[i].addr.msf.frame);
2304         }
2305
2306         /* Read the multisession information. */
2307         if (toc->hdr.first_track != CDROM_LEADOUT) {
2308                 /* Read the multisession information. */
2309                 stat = cdrom_read_tocentry(drive, 0, 0, 1, (char *)&ms_tmp,
2310                                            sizeof(ms_tmp), sense);
2311                 if (stat)
2312                         return stat;
2313
2314                 toc->last_session_lba = be32_to_cpu(ms_tmp.ent.addr.lba);
2315         } else {
2316                 ms_tmp.hdr.first_track = ms_tmp.hdr.last_track = CDROM_LEADOUT;
2317                 toc->last_session_lba = msf_to_lba(0, 2, 0); /* 0m 2s 0f */
2318         }
2319
2320 #if ! STANDARD_ATAPI
2321         if (CDROM_CONFIG_FLAGS(drive)->tocaddr_as_bcd) {
2322                 /* Re-read multisession information using MSF format */
2323                 stat = cdrom_read_tocentry(drive, 0, 1, 1, (char *)&ms_tmp,
2324                                            sizeof(ms_tmp), sense);
2325                 if (stat)
2326                         return stat;
2327
2328                 msf_from_bcd (&ms_tmp.ent.addr.msf);
2329                 toc->last_session_lba = msf_to_lba(ms_tmp.ent.addr.msf.minute,
2330                                                    ms_tmp.ent.addr.msf.second,
2331                                                    ms_tmp.ent.addr.msf.frame);
2332         }
2333 #endif  /* not STANDARD_ATAPI */
2334
2335         toc->xa_flag = (ms_tmp.hdr.first_track != ms_tmp.hdr.last_track);
2336
2337         /* Now try to get the total cdrom capacity. */
2338         stat = cdrom_get_last_written(cdi, &last_written);
2339         if (!stat && (last_written > toc->capacity)) {
2340                 toc->capacity = last_written;
2341                 set_capacity(info->disk, toc->capacity * sectors_per_frame);
2342         }
2343
2344         /* Remember that we've read this stuff. */
2345         CDROM_STATE_FLAGS(drive)->toc_valid = 1;
2346
2347         return 0;
2348 }
2349
2350
2351 static int cdrom_read_subchannel(ide_drive_t *drive, int format, char *buf,
2352                                  int buflen, struct request_sense *sense)
2353 {
2354         struct request req;
2355
2356         cdrom_prepare_request(drive, &req);
2357
2358         req.sense = sense;
2359         req.data = buf;
2360         req.data_len = buflen;
2361         req.cmd[0] = GPCMD_READ_SUBCHANNEL;
2362         req.cmd[1] = 2;     /* MSF addressing */
2363         req.cmd[2] = 0x40;  /* request subQ data */
2364         req.cmd[3] = format;
2365         req.cmd[7] = (buflen >> 8);
2366         req.cmd[8] = (buflen & 0xff);
2367         return cdrom_queue_packet_command(drive, &req);
2368 }
2369
2370 /* ATAPI cdrom drives are free to select the speed you request or any slower
2371    rate :-( Requesting too fast a speed will _not_ produce an error. */
2372 static int cdrom_select_speed(ide_drive_t *drive, int speed,
2373                               struct request_sense *sense)
2374 {
2375         struct request req;
2376         cdrom_prepare_request(drive, &req);
2377
2378         req.sense = sense;
2379         if (speed == 0)
2380                 speed = 0xffff; /* set to max */
2381         else
2382                 speed *= 177;   /* Nx to kbytes/s */
2383
2384         req.cmd[0] = GPCMD_SET_SPEED;
2385         /* Read Drive speed in kbytes/second MSB */
2386         req.cmd[2] = (speed >> 8) & 0xff;       
2387         /* Read Drive speed in kbytes/second LSB */
2388         req.cmd[3] = speed & 0xff;
2389         if (CDROM_CONFIG_FLAGS(drive)->cd_r ||
2390             CDROM_CONFIG_FLAGS(drive)->cd_rw ||
2391             CDROM_CONFIG_FLAGS(drive)->dvd_r) {
2392                 /* Write Drive speed in kbytes/second MSB */
2393                 req.cmd[4] = (speed >> 8) & 0xff;
2394                 /* Write Drive speed in kbytes/second LSB */
2395                 req.cmd[5] = speed & 0xff;
2396        }
2397
2398         return cdrom_queue_packet_command(drive, &req);
2399 }
2400
2401 static int cdrom_play_audio(ide_drive_t *drive, int lba_start, int lba_end)
2402 {
2403         struct request_sense sense;
2404         struct request req;
2405
2406         cdrom_prepare_request(drive, &req);
2407
2408         req.sense = &sense;
2409         req.cmd[0] = GPCMD_PLAY_AUDIO_MSF;
2410         lba_to_msf(lba_start, &req.cmd[3], &req.cmd[4], &req.cmd[5]);
2411         lba_to_msf(lba_end-1, &req.cmd[6], &req.cmd[7], &req.cmd[8]);
2412
2413         return cdrom_queue_packet_command(drive, &req);
2414 }
2415
2416 static int cdrom_get_toc_entry(ide_drive_t *drive, int track,
2417                                 struct atapi_toc_entry **ent)
2418 {
2419         struct cdrom_info *info = drive->driver_data;
2420         struct atapi_toc *toc = info->toc;
2421         int ntracks;
2422
2423         /*
2424          * don't serve cached data, if the toc isn't valid
2425          */
2426         if (!CDROM_STATE_FLAGS(drive)->toc_valid)
2427                 return -EINVAL;
2428
2429         /* Check validity of requested track number. */
2430         ntracks = toc->hdr.last_track - toc->hdr.first_track + 1;
2431         if (toc->hdr.first_track == CDROM_LEADOUT) ntracks = 0;
2432         if (track == CDROM_LEADOUT)
2433                 *ent = &toc->ent[ntracks];
2434         else if (track < toc->hdr.first_track ||
2435                  track > toc->hdr.last_track)
2436                 return -EINVAL;
2437         else
2438                 *ent = &toc->ent[track - toc->hdr.first_track];
2439
2440         return 0;
2441 }
2442
2443 /* the generic packet interface to cdrom.c */
2444 static int ide_cdrom_packet(struct cdrom_device_info *cdi,
2445                             struct packet_command *cgc)
2446 {
2447         struct request req;
2448         ide_drive_t *drive = cdi->handle;
2449
2450         if (cgc->timeout <= 0)
2451                 cgc->timeout = ATAPI_WAIT_PC;
2452
2453         /* here we queue the commands from the uniform CD-ROM
2454            layer. the packet must be complete, as we do not
2455            touch it at all. */
2456         cdrom_prepare_request(drive, &req);
2457         memcpy(req.cmd, cgc->cmd, CDROM_PACKET_SIZE);
2458         if (cgc->sense)
2459                 memset(cgc->sense, 0, sizeof(struct request_sense));
2460         req.data = cgc->buffer;
2461         req.data_len = cgc->buflen;
2462         req.timeout = cgc->timeout;
2463
2464         if (cgc->quiet)
2465                 req.flags |= REQ_QUIET;
2466
2467         req.sense = cgc->sense;
2468         cgc->stat = cdrom_queue_packet_command(drive, &req);
2469         if (!cgc->stat)
2470                 cgc->buflen -= req.data_len;
2471         return cgc->stat;
2472 }
2473
2474 static
2475 int ide_cdrom_audio_ioctl (struct cdrom_device_info *cdi,
2476                            unsigned int cmd, void *arg)
2477                            
2478 {
2479         ide_drive_t *drive = cdi->handle;
2480         struct cdrom_info *info = drive->driver_data;
2481         int stat;
2482
2483         switch (cmd) {
2484         /*
2485          * emulate PLAY_AUDIO_TI command with PLAY_AUDIO_10, since
2486          * atapi doesn't support it
2487          */
2488         case CDROMPLAYTRKIND: {
2489                 unsigned long lba_start, lba_end;
2490                 struct cdrom_ti *ti = arg;
2491                 struct atapi_toc_entry *first_toc, *last_toc;
2492
2493                 stat = cdrom_get_toc_entry(drive, ti->cdti_trk0, &first_toc);
2494                 if (stat)
2495                         return stat;
2496
2497                 stat = cdrom_get_toc_entry(drive, ti->cdti_trk1, &last_toc);
2498                 if (stat)
2499                         return stat;
2500
2501                 if (ti->cdti_trk1 != CDROM_LEADOUT)
2502                         ++last_toc;
2503                 lba_start = first_toc->addr.lba;
2504                 lba_end   = last_toc->addr.lba;
2505
2506                 if (lba_end <= lba_start)
2507                         return -EINVAL;
2508
2509                 return cdrom_play_audio(drive, lba_start, lba_end);
2510         }
2511
2512         case CDROMREADTOCHDR: {
2513                 struct cdrom_tochdr *tochdr = arg;
2514                 struct atapi_toc *toc;
2515
2516                 /* Make sure our saved TOC is valid. */
2517                 stat = cdrom_read_toc(drive, NULL);
2518                 if (stat)
2519                         return stat;
2520
2521                 toc = info->toc;
2522                 tochdr->cdth_trk0 = toc->hdr.first_track;
2523                 tochdr->cdth_trk1 = toc->hdr.last_track;
2524
2525                 return 0;
2526         }
2527
2528         case CDROMREADTOCENTRY: {
2529                 struct cdrom_tocentry *tocentry = arg;
2530                 struct atapi_toc_entry *toce;
2531
2532                 stat = cdrom_get_toc_entry(drive, tocentry->cdte_track, &toce);
2533                 if (stat)
2534                         return stat;
2535
2536                 tocentry->cdte_ctrl = toce->control;
2537                 tocentry->cdte_adr  = toce->adr;
2538                 if (tocentry->cdte_format == CDROM_MSF) {
2539                         lba_to_msf (toce->addr.lba,
2540                                    &tocentry->cdte_addr.msf.minute,
2541                                    &tocentry->cdte_addr.msf.second,
2542                                    &tocentry->cdte_addr.msf.frame);
2543                 } else
2544                         tocentry->cdte_addr.lba = toce->addr.lba;
2545
2546                 return 0;
2547         }
2548
2549         default:
2550                 return -EINVAL;
2551         }
2552 }
2553
2554 static
2555 int ide_cdrom_reset (struct cdrom_device_info *cdi)
2556 {
2557         ide_drive_t *drive = cdi->handle;
2558         struct request_sense sense;
2559         struct request req;
2560         int ret;
2561
2562         cdrom_prepare_request(drive, &req);
2563         req.flags = REQ_SPECIAL | REQ_QUIET;
2564         ret = ide_do_drive_cmd(drive, &req, ide_wait);
2565
2566         /*
2567          * A reset will unlock the door. If it was previously locked,
2568          * lock it again.
2569          */
2570         if (CDROM_STATE_FLAGS(drive)->door_locked)
2571                 (void) cdrom_lockdoor(drive, 1, &sense);
2572
2573         return ret;
2574 }
2575
2576
2577 static
2578 int ide_cdrom_tray_move (struct cdrom_device_info *cdi, int position)
2579 {
2580         ide_drive_t *drive = cdi->handle;
2581         struct request_sense sense;
2582
2583         if (position) {
2584                 int stat = cdrom_lockdoor(drive, 0, &sense);
2585                 if (stat)
2586                         return stat;
2587         }
2588
2589         return cdrom_eject(drive, !position, &sense);
2590 }
2591
2592 static
2593 int ide_cdrom_lock_door (struct cdrom_device_info *cdi, int lock)
2594 {
2595         ide_drive_t *drive = cdi->handle;
2596         return cdrom_lockdoor(drive, lock, NULL);
2597 }
2598
2599 static
2600 int ide_cdrom_get_capabilities(ide_drive_t *drive, struct atapi_capabilities_page *cap)
2601 {
2602         struct cdrom_info *info = drive->driver_data;
2603         struct cdrom_device_info *cdi = &info->devinfo;
2604         struct packet_command cgc;
2605         int stat, attempts = 3, size = sizeof(*cap);
2606
2607         /*
2608          * ACER50 (and others?) require the full spec length mode sense
2609          * page capabilities size, but older drives break.
2610          */
2611         if (!(!strcmp(drive->id->model, "ATAPI CD ROM DRIVE 50X MAX") ||
2612             !strcmp(drive->id->model, "WPI CDS-32X")))
2613                 size -= sizeof(cap->pad);
2614
2615         init_cdrom_command(&cgc, cap, size, CGC_DATA_UNKNOWN);
2616         do { /* we seem to get stat=0x01,err=0x00 the first time (??) */
2617                 stat = cdrom_mode_sense(cdi, &cgc, GPMODE_CAPABILITIES_PAGE, 0);
2618                 if (!stat)
2619                         break;
2620         } while (--attempts);
2621         return stat;
2622 }
2623
2624 static
2625 void ide_cdrom_update_speed (ide_drive_t *drive, struct atapi_capabilities_page *cap)
2626 {
2627         /* The ACER/AOpen 24X cdrom has the speed fields byte-swapped */
2628         if (!drive->id->model[0] &&
2629             !strncmp(drive->id->fw_rev, "241N", 4)) {
2630                 CDROM_STATE_FLAGS(drive)->current_speed  =
2631                         (((unsigned int)cap->curspeed) + (176/2)) / 176;
2632                 CDROM_CONFIG_FLAGS(drive)->max_speed =
2633                         (((unsigned int)cap->maxspeed) + (176/2)) / 176;
2634         } else {
2635                 CDROM_STATE_FLAGS(drive)->current_speed  =
2636                         (ntohs(cap->curspeed) + (176/2)) / 176;
2637                 CDROM_CONFIG_FLAGS(drive)->max_speed =
2638                         (ntohs(cap->maxspeed) + (176/2)) / 176;
2639         }
2640 }
2641
2642 static
2643 int ide_cdrom_select_speed (struct cdrom_device_info *cdi, int speed)
2644 {
2645         ide_drive_t *drive = cdi->handle;
2646         struct request_sense sense;
2647         struct atapi_capabilities_page cap;
2648         int stat;
2649
2650         if ((stat = cdrom_select_speed(drive, speed, &sense)) < 0)
2651                 return stat;
2652
2653         if (!ide_cdrom_get_capabilities(drive, &cap)) {
2654                 ide_cdrom_update_speed(drive, &cap);
2655                 cdi->speed = CDROM_STATE_FLAGS(drive)->current_speed;
2656         }
2657         return 0;
2658 }
2659
2660 /*
2661  * add logic to try GET_EVENT command first to check for media and tray
2662  * status. this should be supported by newer cd-r/w and all DVD etc
2663  * drives
2664  */
2665 static
2666 int ide_cdrom_drive_status (struct cdrom_device_info *cdi, int slot_nr)
2667 {
2668         ide_drive_t *drive = cdi->handle;
2669         struct media_event_desc med;
2670         struct request_sense sense;
2671         int stat;
2672
2673         if (slot_nr != CDSL_CURRENT)
2674                 return -EINVAL;
2675
2676         stat = cdrom_check_status(drive, &sense);
2677         if (!stat || sense.sense_key == UNIT_ATTENTION)
2678                 return CDS_DISC_OK;
2679
2680         if (!cdrom_get_media_event(cdi, &med)) {
2681                 if (med.media_present)
2682                         return CDS_DISC_OK;
2683                 else if (med.door_open)
2684                         return CDS_TRAY_OPEN;
2685                 else
2686                         return CDS_NO_DISC;
2687         }
2688
2689         if (sense.sense_key == NOT_READY && sense.asc == 0x04 && sense.ascq == 0x04)
2690                 return CDS_DISC_OK;
2691
2692         /*
2693          * If not using Mt Fuji extended media tray reports,
2694          * just return TRAY_OPEN since ATAPI doesn't provide
2695          * any other way to detect this...
2696          */
2697         if (sense.sense_key == NOT_READY) {
2698                 if (sense.asc == 0x3a) {
2699                         if (sense.ascq == 1)
2700                                 return CDS_NO_DISC;
2701                         else if (sense.ascq == 0 || sense.ascq == 2)
2702                                 return CDS_TRAY_OPEN;
2703                 }
2704         }
2705
2706         return CDS_DRIVE_NOT_READY;
2707 }
2708
2709 static
2710 int ide_cdrom_get_last_session (struct cdrom_device_info *cdi,
2711                                 struct cdrom_multisession *ms_info)
2712 {
2713         struct atapi_toc *toc;
2714         ide_drive_t *drive = cdi->handle;
2715         struct cdrom_info *info = drive->driver_data;
2716         struct request_sense sense;
2717         int ret;
2718
2719         if (!CDROM_STATE_FLAGS(drive)->toc_valid || info->toc == NULL)
2720                 if ((ret = cdrom_read_toc(drive, &sense)))
2721                         return ret;
2722
2723         toc = info->toc;
2724         ms_info->addr.lba = toc->last_session_lba;
2725         ms_info->xa_flag = toc->xa_flag;
2726
2727         return 0;
2728 }
2729
2730 static
2731 int ide_cdrom_get_mcn (struct cdrom_device_info *cdi,
2732                        struct cdrom_mcn *mcn_info)
2733 {
2734         int stat;
2735         char mcnbuf[24];
2736         ide_drive_t *drive = cdi->handle;
2737
2738 /* get MCN */
2739         if ((stat = cdrom_read_subchannel(drive, 2, mcnbuf, sizeof (mcnbuf), NULL)))
2740                 return stat;
2741
2742         memcpy (mcn_info->medium_catalog_number, mcnbuf+9,
2743                 sizeof (mcn_info->medium_catalog_number)-1);
2744         mcn_info->medium_catalog_number[sizeof (mcn_info->medium_catalog_number)-1]
2745                 = '\0';
2746
2747         return 0;
2748 }
2749
2750
2751
2752 /****************************************************************************
2753  * Other driver requests (open, close, check media change).
2754  */
2755
2756 static
2757 int ide_cdrom_check_media_change_real (struct cdrom_device_info *cdi,
2758                                        int slot_nr)
2759 {
2760         ide_drive_t *drive = cdi->handle;
2761         int retval;
2762         
2763         if (slot_nr == CDSL_CURRENT) {
2764                 (void) cdrom_check_status(drive, NULL);
2765                 retval = CDROM_STATE_FLAGS(drive)->media_changed;
2766                 CDROM_STATE_FLAGS(drive)->media_changed = 0;
2767                 return retval;
2768         } else {
2769                 return -EINVAL;
2770         }
2771 }
2772
2773
2774 static
2775 int ide_cdrom_open_real (struct cdrom_device_info *cdi, int purpose)
2776 {
2777         return 0;
2778 }
2779
2780 /*
2781  * Close down the device.  Invalidate all cached blocks.
2782  */
2783
2784 static
2785 void ide_cdrom_release_real (struct cdrom_device_info *cdi)
2786 {
2787         ide_drive_t *drive = cdi->handle;
2788
2789         if (!cdi->use_count)
2790                 CDROM_STATE_FLAGS(drive)->toc_valid = 0;
2791 }
2792
2793
2794
2795 /****************************************************************************
2796  * Device initialization.
2797  */
2798 static struct cdrom_device_ops ide_cdrom_dops = {
2799         .open                   = ide_cdrom_open_real,
2800         .release                = ide_cdrom_release_real,
2801         .drive_status           = ide_cdrom_drive_status,
2802         .media_changed          = ide_cdrom_check_media_change_real,
2803         .tray_move              = ide_cdrom_tray_move,
2804         .lock_door              = ide_cdrom_lock_door,
2805         .select_speed           = ide_cdrom_select_speed,
2806         .get_last_session       = ide_cdrom_get_last_session,
2807         .get_mcn                = ide_cdrom_get_mcn,
2808         .reset                  = ide_cdrom_reset,
2809         .audio_ioctl            = ide_cdrom_audio_ioctl,
2810         .capability             = CDC_CLOSE_TRAY | CDC_OPEN_TRAY | CDC_LOCK |
2811                                 CDC_SELECT_SPEED | CDC_SELECT_DISC |
2812                                 CDC_MULTI_SESSION | CDC_MCN |
2813                                 CDC_MEDIA_CHANGED | CDC_PLAY_AUDIO | CDC_RESET |
2814                                 CDC_DRIVE_STATUS | CDC_CD_R |
2815                                 CDC_CD_RW | CDC_DVD | CDC_DVD_R| CDC_DVD_RAM |
2816                                 CDC_GENERIC_PACKET | CDC_MO_DRIVE | CDC_MRW |
2817                                 CDC_MRW_W | CDC_RAM,
2818         .generic_packet         = ide_cdrom_packet,
2819 };
2820
2821 static int ide_cdrom_register (ide_drive_t *drive, int nslots)
2822 {
2823         struct cdrom_info *info = drive->driver_data;
2824         struct cdrom_device_info *devinfo = &info->devinfo;
2825
2826         devinfo->ops = &ide_cdrom_dops;
2827         devinfo->mask = 0;
2828         devinfo->speed = CDROM_STATE_FLAGS(drive)->current_speed;
2829         devinfo->capacity = nslots;
2830         devinfo->handle = drive;
2831         strcpy(devinfo->name, drive->name);
2832         
2833         /* set capability mask to match the probe. */
2834         if (!CDROM_CONFIG_FLAGS(drive)->cd_r)
2835                 devinfo->mask |= CDC_CD_R;
2836         if (!CDROM_CONFIG_FLAGS(drive)->cd_rw)
2837                 devinfo->mask |= CDC_CD_RW;
2838         if (!CDROM_CONFIG_FLAGS(drive)->dvd)
2839                 devinfo->mask |= CDC_DVD;
2840         if (!CDROM_CONFIG_FLAGS(drive)->dvd_r)
2841                 devinfo->mask |= CDC_DVD_R;
2842         if (!CDROM_CONFIG_FLAGS(drive)->dvd_ram)
2843                 devinfo->mask |= CDC_DVD_RAM;
2844         if (!CDROM_CONFIG_FLAGS(drive)->is_changer)
2845                 devinfo->mask |= CDC_SELECT_DISC;
2846         if (!CDROM_CONFIG_FLAGS(drive)->audio_play)
2847                 devinfo->mask |= CDC_PLAY_AUDIO;
2848         if (!CDROM_CONFIG_FLAGS(drive)->close_tray)
2849                 devinfo->mask |= CDC_CLOSE_TRAY;
2850         if (!CDROM_CONFIG_FLAGS(drive)->mo_drive)
2851                 devinfo->mask |= CDC_MO_DRIVE;
2852         if (!CDROM_CONFIG_FLAGS(drive)->ram)
2853                 devinfo->mask |= CDC_RAM;
2854
2855         devinfo->disk = info->disk;
2856         return register_cdrom(devinfo);
2857 }
2858
2859 static
2860 int ide_cdrom_probe_capabilities (ide_drive_t *drive)
2861 {
2862         struct cdrom_info *info = drive->driver_data;
2863         struct cdrom_device_info *cdi = &info->devinfo;
2864         struct atapi_capabilities_page cap;
2865         int nslots = 1;
2866
2867         if (drive->media == ide_optical) {
2868                 CDROM_CONFIG_FLAGS(drive)->mo_drive = 1;
2869                 CDROM_CONFIG_FLAGS(drive)->ram = 1;
2870                 printk(KERN_ERR "%s: ATAPI magneto-optical drive\n", drive->name);
2871                 return nslots;
2872         }
2873
2874         if (CDROM_CONFIG_FLAGS(drive)->nec260 ||
2875             !strcmp(drive->id->model,"STINGRAY 8422 IDE 8X CD-ROM 7-27-95")) {
2876                 CDROM_CONFIG_FLAGS(drive)->no_eject = 0;
2877                 CDROM_CONFIG_FLAGS(drive)->audio_play = 1;
2878                 return nslots;
2879         }
2880
2881         /*
2882          * we have to cheat a little here. the packet will eventually
2883          * be queued with ide_cdrom_packet(), which extracts the
2884          * drive from cdi->handle. Since this device hasn't been
2885          * registered with the Uniform layer yet, it can't do this.
2886          * Same goes for cdi->ops.
2887          */
2888         cdi->handle = drive;
2889         cdi->ops = &ide_cdrom_dops;
2890
2891         if (ide_cdrom_get_capabilities(drive, &cap))
2892                 return 0;
2893
2894         if (cap.lock == 0)
2895                 CDROM_CONFIG_FLAGS(drive)->no_doorlock = 1;
2896         if (cap.eject)
2897                 CDROM_CONFIG_FLAGS(drive)->no_eject = 0;
2898         if (cap.cd_r_write)
2899                 CDROM_CONFIG_FLAGS(drive)->cd_r = 1;
2900         if (cap.cd_rw_write) {
2901                 CDROM_CONFIG_FLAGS(drive)->cd_rw = 1;
2902                 CDROM_CONFIG_FLAGS(drive)->ram = 1;
2903         }
2904         if (cap.test_write)
2905                 CDROM_CONFIG_FLAGS(drive)->test_write = 1;
2906         if (cap.dvd_ram_read || cap.dvd_r_read || cap.dvd_rom)
2907                 CDROM_CONFIG_FLAGS(drive)->dvd = 1;
2908         if (cap.dvd_ram_write) {
2909                 CDROM_CONFIG_FLAGS(drive)->dvd_ram = 1;
2910                 CDROM_CONFIG_FLAGS(drive)->ram = 1;
2911         }
2912         if (cap.dvd_r_write)
2913                 CDROM_CONFIG_FLAGS(drive)->dvd_r = 1;
2914         if (cap.audio_play)
2915                 CDROM_CONFIG_FLAGS(drive)->audio_play = 1;
2916         if (cap.mechtype == mechtype_caddy || cap.mechtype == mechtype_popup)
2917                 CDROM_CONFIG_FLAGS(drive)->close_tray = 0;
2918
2919         /* Some drives used by Apple don't advertise audio play
2920          * but they do support reading TOC & audio datas
2921          */
2922         if (strcmp(drive->id->model, "MATSHITADVD-ROM SR-8187") == 0 ||
2923             strcmp(drive->id->model, "MATSHITADVD-ROM SR-8186") == 0 ||
2924             strcmp(drive->id->model, "MATSHITADVD-ROM SR-8176") == 0 ||
2925             strcmp(drive->id->model, "MATSHITADVD-ROM SR-8174") == 0)
2926                 CDROM_CONFIG_FLAGS(drive)->audio_play = 1;
2927
2928 #if ! STANDARD_ATAPI
2929         if (cdi->sanyo_slot > 0) {
2930                 CDROM_CONFIG_FLAGS(drive)->is_changer = 1;
2931                 nslots = 3;
2932         }
2933
2934         else
2935 #endif /* not STANDARD_ATAPI */
2936         if (cap.mechtype == mechtype_individual_changer ||
2937             cap.mechtype == mechtype_cartridge_changer) {
2938                 if ((nslots = cdrom_number_of_slots(cdi)) > 1) {
2939                         CDROM_CONFIG_FLAGS(drive)->is_changer = 1;
2940                         CDROM_CONFIG_FLAGS(drive)->supp_disc_present = 1;
2941                 }
2942         }
2943
2944         ide_cdrom_update_speed(drive, &cap);
2945         /* don't print speed if the drive reported 0.
2946          */
2947         printk(KERN_INFO "%s: ATAPI", drive->name);
2948         if (CDROM_CONFIG_FLAGS(drive)->max_speed)
2949                 printk(" %dX", CDROM_CONFIG_FLAGS(drive)->max_speed);
2950         printk(" %s", CDROM_CONFIG_FLAGS(drive)->dvd ? "DVD-ROM" : "CD-ROM");
2951
2952         if (CDROM_CONFIG_FLAGS(drive)->dvd_r|CDROM_CONFIG_FLAGS(drive)->dvd_ram)
2953                 printk(" DVD%s%s", 
2954                 (CDROM_CONFIG_FLAGS(drive)->dvd_r)? "-R" : "", 
2955                 (CDROM_CONFIG_FLAGS(drive)->dvd_ram)? "-RAM" : "");
2956
2957         if (CDROM_CONFIG_FLAGS(drive)->cd_r|CDROM_CONFIG_FLAGS(drive)->cd_rw) 
2958                 printk(" CD%s%s", 
2959                 (CDROM_CONFIG_FLAGS(drive)->cd_r)? "-R" : "", 
2960                 (CDROM_CONFIG_FLAGS(drive)->cd_rw)? "/RW" : "");
2961
2962         if (CDROM_CONFIG_FLAGS(drive)->is_changer) 
2963                 printk(" changer w/%d slots", nslots);
2964         else    
2965                 printk(" drive");
2966
2967         printk(", %dkB Cache", be16_to_cpu(cap.buffer_size));
2968
2969         if (drive->using_dma)
2970                 ide_dma_verbose(drive);
2971
2972         printk("\n");
2973
2974         return nslots;
2975 }
2976
2977 static void ide_cdrom_add_settings(ide_drive_t *drive)
2978 {
2979         ide_add_setting(drive,  "dsc_overlap",          SETTING_RW, -1, -1, TYPE_BYTE, 0, 1, 1, 1, &drive->dsc_overlap, NULL);
2980 }
2981
2982 /*
2983  * standard prep_rq_fn that builds 10 byte cmds
2984  */
2985 static int ide_cdrom_prep_fs(request_queue_t *q, struct request *rq)
2986 {
2987         int hard_sect = queue_hardsect_size(q);
2988         long block = (long)rq->hard_sector / (hard_sect >> 9);
2989         unsigned long blocks = rq->hard_nr_sectors / (hard_sect >> 9);
2990
2991         memset(rq->cmd, 0, sizeof(rq->cmd));
2992
2993         if (rq_data_dir(rq) == READ)
2994                 rq->cmd[0] = GPCMD_READ_10;
2995         else
2996                 rq->cmd[0] = GPCMD_WRITE_10;
2997
2998         /*
2999          * fill in lba
3000          */
3001         rq->cmd[2] = (block >> 24) & 0xff;
3002         rq->cmd[3] = (block >> 16) & 0xff;
3003         rq->cmd[4] = (block >>  8) & 0xff;
3004         rq->cmd[5] = block & 0xff;
3005
3006         /*
3007          * and transfer length
3008          */
3009         rq->cmd[7] = (blocks >> 8) & 0xff;
3010         rq->cmd[8] = blocks & 0xff;
3011         rq->cmd_len = 10;
3012         return BLKPREP_OK;
3013 }
3014
3015 /*
3016  * Most of the SCSI commands are supported directly by ATAPI devices.
3017  * This transform handles the few exceptions.
3018  */
3019 static int ide_cdrom_prep_pc(struct request *rq)
3020 {
3021         u8 *c = rq->cmd;
3022
3023         /*
3024          * Transform 6-byte read/write commands to the 10-byte version
3025          */
3026         if (c[0] == READ_6 || c[0] == WRITE_6) {
3027                 c[8] = c[4];
3028                 c[5] = c[3];
3029                 c[4] = c[2];
3030                 c[3] = c[1] & 0x1f;
3031                 c[2] = 0;
3032                 c[1] &= 0xe0;
3033                 c[0] += (READ_10 - READ_6);
3034                 rq->cmd_len = 10;
3035                 return BLKPREP_OK;
3036         }
3037
3038         /*
3039          * it's silly to pretend we understand 6-byte sense commands, just
3040          * reject with ILLEGAL_REQUEST and the caller should take the
3041          * appropriate action
3042          */
3043         if (c[0] == MODE_SENSE || c[0] == MODE_SELECT) {
3044                 rq->errors = ILLEGAL_REQUEST;
3045                 return BLKPREP_KILL;
3046         }
3047         
3048         return BLKPREP_OK;
3049 }
3050
3051 static int ide_cdrom_prep_fn(request_queue_t *q, struct request *rq)
3052 {
3053         if (rq->flags & REQ_CMD)
3054                 return ide_cdrom_prep_fs(q, rq);
3055         else if (rq->flags & REQ_BLOCK_PC)
3056                 return ide_cdrom_prep_pc(rq);
3057
3058         return 0;
3059 }
3060
3061 static
3062 int ide_cdrom_setup (ide_drive_t *drive)
3063 {
3064         struct cdrom_info *info = drive->driver_data;
3065         struct cdrom_device_info *cdi = &info->devinfo;
3066         int nslots;
3067
3068         blk_queue_prep_rq(drive->queue, ide_cdrom_prep_fn);
3069         blk_queue_dma_alignment(drive->queue, 31);
3070         drive->queue->unplug_delay = (1 * HZ) / 1000;
3071         if (!drive->queue->unplug_delay)
3072                 drive->queue->unplug_delay = 1;
3073
3074         drive->special.all      = 0;
3075
3076         CDROM_STATE_FLAGS(drive)->media_changed = 1;
3077         CDROM_STATE_FLAGS(drive)->toc_valid     = 0;
3078         CDROM_STATE_FLAGS(drive)->door_locked   = 0;
3079
3080 #if NO_DOOR_LOCKING
3081         CDROM_CONFIG_FLAGS(drive)->no_doorlock = 1;
3082 #else
3083         CDROM_CONFIG_FLAGS(drive)->no_doorlock = 0;
3084 #endif
3085
3086         CDROM_CONFIG_FLAGS(drive)->drq_interrupt = ((drive->id->config & 0x0060) == 0x20);
3087         CDROM_CONFIG_FLAGS(drive)->is_changer = 0;
3088         CDROM_CONFIG_FLAGS(drive)->cd_r = 0;
3089         CDROM_CONFIG_FLAGS(drive)->cd_rw = 0;
3090         CDROM_CONFIG_FLAGS(drive)->test_write = 0;
3091         CDROM_CONFIG_FLAGS(drive)->dvd = 0;
3092         CDROM_CONFIG_FLAGS(drive)->dvd_r = 0;
3093         CDROM_CONFIG_FLAGS(drive)->dvd_ram = 0;
3094         CDROM_CONFIG_FLAGS(drive)->no_eject = 1;
3095         CDROM_CONFIG_FLAGS(drive)->supp_disc_present = 0;
3096         CDROM_CONFIG_FLAGS(drive)->audio_play = 0;
3097         CDROM_CONFIG_FLAGS(drive)->close_tray = 1;
3098         
3099         /* limit transfer size per interrupt. */
3100         CDROM_CONFIG_FLAGS(drive)->limit_nframes = 0;
3101         /* a testament to the nice quality of Samsung drives... */
3102         if (!strcmp(drive->id->model, "SAMSUNG CD-ROM SCR-2430"))
3103                 CDROM_CONFIG_FLAGS(drive)->limit_nframes = 1;
3104         else if (!strcmp(drive->id->model, "SAMSUNG CD-ROM SCR-2432"))
3105                 CDROM_CONFIG_FLAGS(drive)->limit_nframes = 1;
3106         /* the 3231 model does not support the SET_CD_SPEED command */
3107         else if (!strcmp(drive->id->model, "SAMSUNG CD-ROM SCR-3231"))
3108                 cdi->mask |= CDC_SELECT_SPEED;
3109
3110 #if ! STANDARD_ATAPI
3111         /* by default Sanyo 3 CD changer support is turned off and
3112            ATAPI Rev 2.2+ standard support for CD changers is used */
3113         cdi->sanyo_slot = 0;
3114
3115         CDROM_CONFIG_FLAGS(drive)->nec260 = 0;
3116         CDROM_CONFIG_FLAGS(drive)->toctracks_as_bcd = 0;
3117         CDROM_CONFIG_FLAGS(drive)->tocaddr_as_bcd = 0;
3118         CDROM_CONFIG_FLAGS(drive)->playmsf_as_bcd = 0;
3119         CDROM_CONFIG_FLAGS(drive)->subchan_as_bcd = 0;
3120
3121         if (strcmp (drive->id->model, "V003S0DS") == 0 &&
3122             drive->id->fw_rev[4] == '1' &&
3123             drive->id->fw_rev[6] <= '2') {
3124                 /* Vertos 300.
3125                    Some versions of this drive like to talk BCD. */
3126                 CDROM_CONFIG_FLAGS(drive)->toctracks_as_bcd = 1;
3127                 CDROM_CONFIG_FLAGS(drive)->tocaddr_as_bcd = 1;
3128                 CDROM_CONFIG_FLAGS(drive)->playmsf_as_bcd = 1;
3129                 CDROM_CONFIG_FLAGS(drive)->subchan_as_bcd = 1;
3130         }
3131
3132         else if (strcmp (drive->id->model, "V006E0DS") == 0 &&
3133             drive->id->fw_rev[4] == '1' &&
3134             drive->id->fw_rev[6] <= '2') {
3135                 /* Vertos 600 ESD. */
3136                 CDROM_CONFIG_FLAGS(drive)->toctracks_as_bcd = 1;
3137         }
3138         else if (strcmp(drive->id->model, "NEC CD-ROM DRIVE:260") == 0 &&
3139                  strncmp(drive->id->fw_rev, "1.01", 4) == 0) { /* FIXME */
3140                 /* Old NEC260 (not R).
3141                    This drive was released before the 1.2 version
3142                    of the spec. */
3143                 CDROM_CONFIG_FLAGS(drive)->tocaddr_as_bcd = 1;
3144                 CDROM_CONFIG_FLAGS(drive)->playmsf_as_bcd = 1;
3145                 CDROM_CONFIG_FLAGS(drive)->subchan_as_bcd = 1;
3146                 CDROM_CONFIG_FLAGS(drive)->nec260         = 1;
3147         }
3148         else if (strcmp(drive->id->model, "WEARNES CDD-120") == 0 &&
3149                  strncmp(drive->id->fw_rev, "A1.1", 4) == 0) { /* FIXME */
3150                 /* Wearnes */
3151                 CDROM_CONFIG_FLAGS(drive)->playmsf_as_bcd = 1;
3152                 CDROM_CONFIG_FLAGS(drive)->subchan_as_bcd = 1;
3153         }
3154         /* Sanyo 3 CD changer uses a non-standard command
3155            for CD changing */
3156         else if ((strcmp(drive->id->model, "CD-ROM CDR-C3 G") == 0) ||
3157                  (strcmp(drive->id->model, "CD-ROM CDR-C3G") == 0) ||
3158                  (strcmp(drive->id->model, "CD-ROM CDR_C36") == 0)) {
3159                  /* uses CD in slot 0 when value is set to 3 */
3160                  cdi->sanyo_slot = 3;
3161         }
3162 #endif /* not STANDARD_ATAPI */
3163
3164         info->toc               = NULL;
3165         info->buffer            = NULL;
3166         info->sector_buffered   = 0;
3167         info->nsectors_buffered = 0;
3168         info->changer_info      = NULL;
3169         info->last_block        = 0;
3170         info->start_seek        = 0;
3171
3172         nslots = ide_cdrom_probe_capabilities (drive);
3173
3174         /*
3175          * set correct block size
3176          */
3177         blk_queue_hardsect_size(drive->queue, CD_FRAMESIZE);
3178
3179         if (drive->autotune == IDE_TUNE_DEFAULT ||
3180             drive->autotune == IDE_TUNE_AUTO)
3181                 drive->dsc_overlap = (drive->next != drive);
3182 #if 0
3183         drive->dsc_overlap = (HWIF(drive)->no_dsc) ? 0 : 1;
3184         if (HWIF(drive)->no_dsc) {
3185                 printk(KERN_INFO "ide-cd: %s: disabling DSC overlap\n",
3186                         drive->name);
3187                 drive->dsc_overlap = 0;
3188         }
3189 #endif
3190
3191         if (ide_cdrom_register(drive, nslots)) {
3192                 printk (KERN_ERR "%s: ide_cdrom_setup failed to register device with the cdrom driver.\n", drive->name);
3193                 info->devinfo.handle = NULL;
3194                 return 1;
3195         }
3196         ide_cdrom_add_settings(drive);
3197         return 0;
3198 }
3199
3200 #ifdef CONFIG_PROC_FS
3201 static
3202 sector_t ide_cdrom_capacity (ide_drive_t *drive)
3203 {
3204         unsigned long capacity, sectors_per_frame;
3205
3206         if (cdrom_read_capacity(drive, &capacity, &sectors_per_frame, NULL))
3207                 return 0;
3208
3209         return capacity * sectors_per_frame;
3210 }
3211 #endif
3212
3213 static void ide_cd_remove(ide_drive_t *drive)
3214 {
3215         struct cdrom_info *info = drive->driver_data;
3216
3217         ide_unregister_subdriver(drive, info->driver);
3218
3219         del_gendisk(info->disk);
3220
3221         ide_cd_put(info);
3222 }
3223
3224 static void ide_cd_release(struct kref *kref)
3225 {
3226         struct cdrom_info *info = to_ide_cd(kref);
3227         struct cdrom_device_info *devinfo = &info->devinfo;
3228         ide_drive_t *drive = info->drive;
3229         struct gendisk *g = info->disk;
3230
3231         kfree(info->buffer);
3232         kfree(info->toc);
3233         kfree(info->changer_info);
3234         if (devinfo->handle == drive && unregister_cdrom(devinfo))
3235                 printk(KERN_ERR "%s: %s failed to unregister device from the cdrom "
3236                                 "driver.\n", __FUNCTION__, drive->name);
3237         drive->dsc_overlap = 0;
3238         drive->driver_data = NULL;
3239         blk_queue_prep_rq(drive->queue, NULL);
3240         g->private_data = NULL;
3241         put_disk(g);
3242         kfree(info);
3243 }
3244
3245 static int ide_cd_probe(ide_drive_t *);
3246
3247 #ifdef CONFIG_PROC_FS
3248 static int proc_idecd_read_capacity
3249         (char *page, char **start, off_t off, int count, int *eof, void *data)
3250 {
3251         ide_drive_t *drive = data;
3252         int len;
3253
3254         len = sprintf(page,"%llu\n", (long long)ide_cdrom_capacity(drive));
3255         PROC_IDE_READ_RETURN(page,start,off,count,eof,len);
3256 }
3257
3258 static ide_proc_entry_t idecd_proc[] = {
3259         { "capacity", S_IFREG|S_IRUGO, proc_idecd_read_capacity, NULL },
3260         { NULL, 0, NULL, NULL }
3261 };
3262 #else
3263 # define idecd_proc     NULL
3264 #endif
3265
3266 static ide_driver_t ide_cdrom_driver = {
3267         .gen_driver = {
3268                 .owner          = THIS_MODULE,
3269                 .name           = "ide-cdrom",
3270                 .bus            = &ide_bus_type,
3271         },
3272         .probe                  = ide_cd_probe,
3273         .remove                 = ide_cd_remove,
3274         .version                = IDECD_VERSION,
3275         .media                  = ide_cdrom,
3276         .supports_dsc_overlap   = 1,
3277         .do_request             = ide_do_rw_cdrom,
3278         .end_request            = ide_end_request,
3279         .error                  = __ide_error,
3280         .abort                  = __ide_abort,
3281         .proc                   = idecd_proc,
3282 };
3283
3284 static int idecd_open(struct inode * inode, struct file * file)
3285 {
3286         struct gendisk *disk = inode->i_bdev->bd_disk;
3287         struct cdrom_info *info;
3288         ide_drive_t *drive;
3289         int rc = -ENOMEM;
3290
3291         if (!(info = ide_cd_get(disk)))
3292                 return -ENXIO;
3293
3294         drive = info->drive;
3295
3296         drive->usage++;
3297
3298         if (!info->buffer)
3299                 info->buffer = kmalloc(SECTOR_BUFFER_SIZE,
3300                                         GFP_KERNEL|__GFP_REPEAT);
3301         if (!info->buffer || (rc = cdrom_open(&info->devinfo, inode, file)))
3302                 drive->usage--;
3303
3304         if (rc < 0)
3305                 ide_cd_put(info);
3306
3307         return rc;
3308 }
3309
3310 static int idecd_release(struct inode * inode, struct file * file)
3311 {
3312         struct gendisk *disk = inode->i_bdev->bd_disk;
3313         struct cdrom_info *info = ide_cd_g(disk);
3314         ide_drive_t *drive = info->drive;
3315
3316         cdrom_release (&info->devinfo, file);
3317         drive->usage--;
3318
3319         ide_cd_put(info);
3320
3321         return 0;
3322 }
3323
3324 static int idecd_set_spindown(struct cdrom_device_info *cdi, unsigned long arg)
3325 {
3326         struct packet_command cgc;
3327         char buffer[16];
3328         int stat;
3329         char spindown;
3330
3331         if (copy_from_user(&spindown, (void __user *)arg, sizeof(char)))
3332                 return -EFAULT;
3333
3334         init_cdrom_command(&cgc, buffer, sizeof(buffer), CGC_DATA_UNKNOWN);
3335
3336         stat = cdrom_mode_sense(cdi, &cgc, GPMODE_CDROM_PAGE, 0);
3337         if (stat)
3338                 return stat;
3339
3340         buffer[11] = (buffer[11] & 0xf0) | (spindown & 0x0f);
3341         return cdrom_mode_select(cdi, &cgc);
3342 }
3343
3344 static int idecd_get_spindown(struct cdrom_device_info *cdi, unsigned long arg)
3345 {
3346         struct packet_command cgc;
3347         char buffer[16];
3348         int stat;
3349         char spindown;
3350
3351         init_cdrom_command(&cgc, buffer, sizeof(buffer), CGC_DATA_UNKNOWN);
3352
3353         stat = cdrom_mode_sense(cdi, &cgc, GPMODE_CDROM_PAGE, 0);
3354         if (stat)
3355                 return stat;
3356
3357         spindown = buffer[11] & 0x0f;
3358         if (copy_to_user((void __user *)arg, &spindown, sizeof (char)))
3359                 return -EFAULT;
3360         return 0;
3361 }
3362
3363 static int idecd_ioctl (struct inode *inode, struct file *file,
3364                         unsigned int cmd, unsigned long arg)
3365 {
3366         struct block_device *bdev = inode->i_bdev;
3367         struct cdrom_info *info = ide_cd_g(bdev->bd_disk);
3368         int err;
3369
3370         switch (cmd) {
3371         case CDROMSETSPINDOWN:
3372                 return idecd_set_spindown(&info->devinfo, arg);
3373         case CDROMGETSPINDOWN:
3374                 return idecd_get_spindown(&info->devinfo, arg);
3375         default:
3376                 break;
3377         }
3378
3379         err = generic_ide_ioctl(info->drive, file, bdev, cmd, arg);
3380         if (err == -EINVAL)
3381                 err = cdrom_ioctl(file, &info->devinfo, inode, cmd, arg);
3382
3383         return err;
3384 }
3385
3386 static int idecd_media_changed(struct gendisk *disk)
3387 {
3388         struct cdrom_info *info = ide_cd_g(disk);
3389         return cdrom_media_changed(&info->devinfo);
3390 }
3391
3392 static int idecd_revalidate_disk(struct gendisk *disk)
3393 {
3394         struct cdrom_info *info = ide_cd_g(disk);
3395         struct request_sense sense;
3396         cdrom_read_toc(info->drive, &sense);
3397         return  0;
3398 }
3399
3400 static struct block_device_operations idecd_ops = {
3401         .owner          = THIS_MODULE,
3402         .open           = idecd_open,
3403         .release        = idecd_release,
3404         .ioctl          = idecd_ioctl,
3405         .media_changed  = idecd_media_changed,
3406         .revalidate_disk= idecd_revalidate_disk
3407 };
3408
3409 /* options */
3410 static char *ignore = NULL;
3411
3412 module_param(ignore, charp, 0400);
3413 MODULE_DESCRIPTION("ATAPI CD-ROM Driver");
3414
3415 static int ide_cd_probe(ide_drive_t *drive)
3416 {
3417         struct cdrom_info *info;
3418         struct gendisk *g;
3419         struct request_sense sense;
3420
3421         if (!strstr("ide-cdrom", drive->driver_req))
3422                 goto failed;
3423         if (!drive->present)
3424                 goto failed;
3425         if (drive->media != ide_cdrom && drive->media != ide_optical)
3426                 goto failed;
3427         /* skip drives that we were told to ignore */
3428         if (ignore != NULL) {
3429                 if (strstr(ignore, drive->name)) {
3430                         printk(KERN_INFO "ide-cd: ignoring drive %s\n", drive->name);
3431                         goto failed;
3432                 }
3433         }
3434         if (drive->scsi) {
3435                 printk(KERN_INFO "ide-cd: passing drive %s to ide-scsi emulation.\n", drive->name);
3436                 goto failed;
3437         }
3438         info = kzalloc(sizeof(struct cdrom_info), GFP_KERNEL);
3439         if (info == NULL) {
3440                 printk(KERN_ERR "%s: Can't allocate a cdrom structure\n", drive->name);
3441                 goto failed;
3442         }
3443
3444         g = alloc_disk(1 << PARTN_BITS);
3445         if (!g)
3446                 goto out_free_cd;
3447
3448         ide_init_disk(g, drive);
3449
3450         ide_register_subdriver(drive, &ide_cdrom_driver);
3451
3452         kref_init(&info->kref);
3453
3454         info->drive = drive;
3455         info->driver = &ide_cdrom_driver;
3456         info->disk = g;
3457
3458         g->private_data = &info->driver;
3459
3460         drive->driver_data = info;
3461
3462         g->minors = 1;
3463         snprintf(g->devfs_name, sizeof(g->devfs_name),
3464                         "%s/cd", drive->devfs_name);
3465         g->driverfs_dev = &drive->gendev;
3466         g->flags = GENHD_FL_CD | GENHD_FL_REMOVABLE;
3467         if (ide_cdrom_setup(drive)) {
3468                 struct cdrom_device_info *devinfo = &info->devinfo;
3469                 ide_unregister_subdriver(drive, &ide_cdrom_driver);
3470                 kfree(info->buffer);
3471                 kfree(info->toc);
3472                 kfree(info->changer_info);
3473                 if (devinfo->handle == drive && unregister_cdrom(devinfo))
3474                         printk (KERN_ERR "%s: ide_cdrom_cleanup failed to unregister device from the cdrom driver.\n", drive->name);
3475                 kfree(info);
3476                 drive->driver_data = NULL;
3477                 goto failed;
3478         }
3479
3480         cdrom_read_toc(drive, &sense);
3481         g->fops = &idecd_ops;
3482         g->flags |= GENHD_FL_REMOVABLE;
3483         add_disk(g);
3484         return 0;
3485
3486 out_free_cd:
3487         kfree(info);
3488 failed:
3489         return -ENODEV;
3490 }
3491
3492 static void __exit ide_cdrom_exit(void)
3493 {
3494         driver_unregister(&ide_cdrom_driver.gen_driver);
3495 }
3496
3497 static int __init ide_cdrom_init(void)
3498 {
3499         return driver_register(&ide_cdrom_driver.gen_driver);
3500 }
3501
3502 MODULE_ALIAS("ide:*m-cdrom*");
3503 module_init(ide_cdrom_init);
3504 module_exit(ide_cdrom_exit);
3505 MODULE_LICENSE("GPL");