Fix calculation in move_freepages_block for counting pages
[linux-2.6/openmoko-kernel/knife-kernel.git] / drivers / ide / ide-cd.c
blobca843522f91dc914e26f656e5011116f5f2b5ca0
1 /*
2 * linux/drivers/ide/ide-cd.c
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>
8 * May be copied or modified under the terms of the GNU General Public
9 * License. See linux/COPYING for more information.
11 * ATAPI CD-ROM driver. To be used with ide.c.
12 * See Documentation/cdrom/ide-cd for usage information.
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
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...
26 * ----------------------------------
27 * TO DO LIST:
28 * -Make it so that Pioneer CD DR-A24X and friends don't get screwed up on
29 * boot
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.
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.
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)
162 * 4.02 Dec 01, 1996 -- Applied patch from Gadi Oxman <gadio@netvision.net.il>
163 * to fix the drive door locking problems.
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)
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
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.
209 * 4.15 Aug 25, 1998 -- Updated ide-cd.h to respect mechine endianess,
210 * patch thanks to "Eddie C. Dost" <ecd@skynet.be>
212 * 4.50 Oct 19, 1998 -- New maintainers!
213 * Jens Axboe <axboe@image.dk>
214 * Chris Zwilling <chris@cloudnet.com>
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.
223 * 4.52 Jan 19, 1999 -- Jens Axboe <axboe@image.dk>
224 * - Detect DVD-ROM/RAM drives
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.
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.
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.
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
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.
285 * 4.58 May 1, 2000 - Clean up ACER50 stuff.
286 * - Fix small problem with ide_cdrom_capacity
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>
300 *************************************************************************/
302 #define IDECD_VERSION "4.61"
304 #include <linux/module.h>
305 #include <linux/types.h>
306 #include <linux/kernel.h>
307 #include <linux/delay.h>
308 #include <linux/timer.h>
309 #include <linux/slab.h>
310 #include <linux/interrupt.h>
311 #include <linux/errno.h>
312 #include <linux/cdrom.h>
313 #include <linux/ide.h>
314 #include <linux/completion.h>
315 #include <linux/mutex.h>
317 #include <scsi/scsi.h> /* For SCSI -> ATAPI command conversion */
319 #include <asm/irq.h>
320 #include <asm/io.h>
321 #include <asm/byteorder.h>
322 #include <asm/uaccess.h>
323 #include <asm/unaligned.h>
325 #include "ide-cd.h"
327 static DEFINE_MUTEX(idecd_ref_mutex);
329 #define to_ide_cd(obj) container_of(obj, struct cdrom_info, kref)
331 #define ide_cd_g(disk) \
332 container_of((disk)->private_data, struct cdrom_info, driver)
334 static struct cdrom_info *ide_cd_get(struct gendisk *disk)
336 struct cdrom_info *cd = NULL;
338 mutex_lock(&idecd_ref_mutex);
339 cd = ide_cd_g(disk);
340 if (cd)
341 kref_get(&cd->kref);
342 mutex_unlock(&idecd_ref_mutex);
343 return cd;
346 static void ide_cd_release(struct kref *);
348 static void ide_cd_put(struct cdrom_info *cd)
350 mutex_lock(&idecd_ref_mutex);
351 kref_put(&cd->kref, ide_cd_release);
352 mutex_unlock(&idecd_ref_mutex);
355 /****************************************************************************
356 * Generic packet command support and error handling routines.
359 /* Mark that we've seen a media change, and invalidate our internal
360 buffers. */
361 static void cdrom_saw_media_change (ide_drive_t *drive)
363 struct cdrom_info *info = drive->driver_data;
365 CDROM_STATE_FLAGS (drive)->media_changed = 1;
366 CDROM_STATE_FLAGS (drive)->toc_valid = 0;
367 info->nsectors_buffered = 0;
370 static int cdrom_log_sense(ide_drive_t *drive, struct request *rq,
371 struct request_sense *sense)
373 int log = 0;
375 if (!sense || !rq || (rq->cmd_flags & REQ_QUIET))
376 return 0;
378 switch (sense->sense_key) {
379 case NO_SENSE: case RECOVERED_ERROR:
380 break;
381 case NOT_READY:
383 * don't care about tray state messages for
384 * e.g. capacity commands or in-progress or
385 * becoming ready
387 if (sense->asc == 0x3a || sense->asc == 0x04)
388 break;
389 log = 1;
390 break;
391 case ILLEGAL_REQUEST:
393 * don't log START_STOP unit with LoEj set, since
394 * we cannot reliably check if drive can auto-close
396 if (rq->cmd[0] == GPCMD_START_STOP_UNIT && sense->asc == 0x24)
397 break;
398 log = 1;
399 break;
400 case UNIT_ATTENTION:
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.
406 cdrom_saw_media_change(drive);
407 break;
408 default:
409 log = 1;
410 break;
412 return log;
415 static
416 void cdrom_analyze_sense_data(ide_drive_t *drive,
417 struct request *failed_command,
418 struct request_sense *sense)
420 unsigned long sector;
421 unsigned long bio_sectors;
422 unsigned long valid;
423 struct cdrom_info *info = drive->driver_data;
425 if (!cdrom_log_sense(drive, failed_command, sense))
426 return;
429 * If a read toc is executed for a CD-R or CD-RW medium where
430 * the first toc has not been recorded yet, it will fail with
431 * 05/24/00 (which is a confusing error)
433 if (failed_command && failed_command->cmd[0] == GPCMD_READ_TOC_PMA_ATIP)
434 if (sense->sense_key == 0x05 && sense->asc == 0x24)
435 return;
437 if (sense->error_code == 0x70) { /* Current Error */
438 switch(sense->sense_key) {
439 case MEDIUM_ERROR:
440 case VOLUME_OVERFLOW:
441 case ILLEGAL_REQUEST:
442 if (!sense->valid)
443 break;
444 if (failed_command == NULL ||
445 !blk_fs_request(failed_command))
446 break;
447 sector = (sense->information[0] << 24) |
448 (sense->information[1] << 16) |
449 (sense->information[2] << 8) |
450 (sense->information[3]);
452 bio_sectors = bio_sectors(failed_command->bio);
453 if (bio_sectors < 4)
454 bio_sectors = 4;
455 if (drive->queue->hardsect_size == 2048)
456 sector <<= 2; /* Device sector size is 2K */
457 sector &= ~(bio_sectors -1);
458 valid = (sector - failed_command->sector) << 9;
460 if (valid < 0)
461 valid = 0;
462 if (sector < get_capacity(info->disk) &&
463 drive->probed_capacity - sector < 4 * 75) {
464 set_capacity(info->disk, sector);
468 #if VERBOSE_IDE_CD_ERRORS
470 int i;
471 const char *s = "bad sense key!";
472 char buf[80];
474 printk ("ATAPI device %s:\n", drive->name);
475 if (sense->error_code==0x70)
476 printk(" Error: ");
477 else if (sense->error_code==0x71)
478 printk(" Deferred Error: ");
479 else if (sense->error_code == 0x7f)
480 printk(" Vendor-specific Error: ");
481 else
482 printk(" Unknown Error Type: ");
484 if (sense->sense_key < ARRAY_SIZE(sense_key_texts))
485 s = sense_key_texts[sense->sense_key];
487 printk("%s -- (Sense key=0x%02x)\n", s, sense->sense_key);
489 if (sense->asc == 0x40) {
490 sprintf(buf, "Diagnostic failure on component 0x%02x",
491 sense->ascq);
492 s = buf;
493 } else {
494 int lo = 0, mid, hi = ARRAY_SIZE(sense_data_texts);
495 unsigned long key = (sense->sense_key << 16);
496 key |= (sense->asc << 8);
497 if (!(sense->ascq >= 0x80 && sense->ascq <= 0xdd))
498 key |= sense->ascq;
499 s = NULL;
501 while (hi > lo) {
502 mid = (lo + hi) / 2;
503 if (sense_data_texts[mid].asc_ascq == key ||
504 sense_data_texts[mid].asc_ascq == (0xff0000|key)) {
505 s = sense_data_texts[mid].text;
506 break;
508 else if (sense_data_texts[mid].asc_ascq > key)
509 hi = mid;
510 else
511 lo = mid+1;
515 if (s == NULL) {
516 if (sense->asc > 0x80)
517 s = "(vendor-specific error)";
518 else
519 s = "(reserved error code)";
522 printk(KERN_ERR " %s -- (asc=0x%02x, ascq=0x%02x)\n",
523 s, sense->asc, sense->ascq);
525 if (failed_command != NULL) {
527 int lo=0, mid, hi= ARRAY_SIZE(packet_command_texts);
528 s = NULL;
530 while (hi > lo) {
531 mid = (lo + hi) / 2;
532 if (packet_command_texts[mid].packet_command ==
533 failed_command->cmd[0]) {
534 s = packet_command_texts[mid].text;
535 break;
537 if (packet_command_texts[mid].packet_command >
538 failed_command->cmd[0])
539 hi = mid;
540 else
541 lo = mid+1;
544 printk (KERN_ERR " The failed \"%s\" packet command was: \n \"", s);
545 for (i=0; i<sizeof (failed_command->cmd); i++)
546 printk ("%02x ", failed_command->cmd[i]);
547 printk ("\"\n");
550 /* The SKSV bit specifies validity of the sense_key_specific
551 * in the next two commands. It is bit 7 of the first byte.
552 * In the case of NOT_READY, if SKSV is set the drive can
553 * give us nice ETA readings.
555 if (sense->sense_key == NOT_READY && (sense->sks[0] & 0x80)) {
556 int progress = (sense->sks[1] << 8 | sense->sks[2]) * 100;
557 printk(KERN_ERR " Command is %02d%% complete\n", progress / 0xffff);
561 if (sense->sense_key == ILLEGAL_REQUEST &&
562 (sense->sks[0] & 0x80) != 0) {
563 printk(KERN_ERR " Error in %s byte %d",
564 (sense->sks[0] & 0x40) != 0 ?
565 "command packet" : "command data",
566 (sense->sks[1] << 8) + sense->sks[2]);
568 if ((sense->sks[0] & 0x40) != 0)
569 printk (" bit %d", sense->sks[0] & 0x07);
571 printk ("\n");
575 #else /* not VERBOSE_IDE_CD_ERRORS */
577 /* Suppress printing unit attention and `in progress of becoming ready'
578 errors when we're not being verbose. */
580 if (sense->sense_key == UNIT_ATTENTION ||
581 (sense->sense_key == NOT_READY && (sense->asc == 4 ||
582 sense->asc == 0x3a)))
583 return;
585 printk(KERN_ERR "%s: error code: 0x%02x sense_key: 0x%02x asc: 0x%02x ascq: 0x%02x\n",
586 drive->name,
587 sense->error_code, sense->sense_key,
588 sense->asc, sense->ascq);
589 #endif /* not VERBOSE_IDE_CD_ERRORS */
593 * Initialize a ide-cd packet command request
595 static void cdrom_prepare_request(ide_drive_t *drive, struct request *rq)
597 struct cdrom_info *cd = drive->driver_data;
599 ide_init_drive_cmd(rq);
600 rq->cmd_type = REQ_TYPE_ATA_PC;
601 rq->rq_disk = cd->disk;
604 static void cdrom_queue_request_sense(ide_drive_t *drive, void *sense,
605 struct request *failed_command)
607 struct cdrom_info *info = drive->driver_data;
608 struct request *rq = &info->request_sense_request;
610 if (sense == NULL)
611 sense = &info->sense_data;
613 /* stuff the sense request in front of our current request */
614 cdrom_prepare_request(drive, rq);
616 rq->data = sense;
617 rq->cmd[0] = GPCMD_REQUEST_SENSE;
618 rq->cmd[4] = rq->data_len = 18;
620 rq->cmd_type = REQ_TYPE_SENSE;
622 /* NOTE! Save the failed command in "rq->buffer" */
623 rq->buffer = (void *) failed_command;
625 (void) ide_do_drive_cmd(drive, rq, ide_preempt);
628 static void cdrom_end_request (ide_drive_t *drive, int uptodate)
630 struct request *rq = HWGROUP(drive)->rq;
631 int nsectors = rq->hard_cur_sectors;
633 if (blk_sense_request(rq) && uptodate) {
635 * For REQ_TYPE_SENSE, "rq->buffer" points to the original
636 * failed request
638 struct request *failed = (struct request *) rq->buffer;
639 struct cdrom_info *info = drive->driver_data;
640 void *sense = &info->sense_data;
641 unsigned long flags;
643 if (failed) {
644 if (failed->sense) {
645 sense = failed->sense;
646 failed->sense_len = rq->sense_len;
648 cdrom_analyze_sense_data(drive, failed, sense);
650 * now end failed request
652 if (blk_fs_request(failed)) {
653 if (ide_end_dequeued_request(drive, failed, 0,
654 failed->hard_nr_sectors))
655 BUG();
656 } else {
657 spin_lock_irqsave(&ide_lock, flags);
658 end_that_request_chunk(failed, 0,
659 failed->data_len);
660 end_that_request_last(failed, 0);
661 spin_unlock_irqrestore(&ide_lock, flags);
663 } else
664 cdrom_analyze_sense_data(drive, NULL, sense);
667 if (!rq->current_nr_sectors && blk_fs_request(rq))
668 uptodate = 1;
669 /* make sure it's fully ended */
670 if (blk_pc_request(rq))
671 nsectors = (rq->data_len + 511) >> 9;
672 if (!nsectors)
673 nsectors = 1;
675 ide_end_request(drive, uptodate, nsectors);
678 static void ide_dump_status_no_sense(ide_drive_t *drive, const char *msg, u8 stat)
680 if (stat & 0x80)
681 return;
682 ide_dump_status(drive, msg, stat);
685 /* Returns 0 if the request should be continued.
686 Returns 1 if the request was ended. */
687 static int cdrom_decode_status(ide_drive_t *drive, int good_stat, int *stat_ret)
689 struct request *rq = HWGROUP(drive)->rq;
690 int stat, err, sense_key;
692 /* Check for errors. */
693 stat = HWIF(drive)->INB(IDE_STATUS_REG);
694 if (stat_ret)
695 *stat_ret = stat;
697 if (OK_STAT(stat, good_stat, BAD_R_STAT))
698 return 0;
700 /* Get the IDE error register. */
701 err = HWIF(drive)->INB(IDE_ERROR_REG);
702 sense_key = err >> 4;
704 if (rq == NULL) {
705 printk("%s: missing rq in cdrom_decode_status\n", drive->name);
706 return 1;
709 if (blk_sense_request(rq)) {
710 /* We got an error trying to get sense info
711 from the drive (probably while trying
712 to recover from a former error). Just give up. */
714 rq->cmd_flags |= REQ_FAILED;
715 cdrom_end_request(drive, 0);
716 ide_error(drive, "request sense failure", stat);
717 return 1;
719 } else if (blk_pc_request(rq) || rq->cmd_type == REQ_TYPE_ATA_PC) {
720 /* All other functions, except for READ. */
721 unsigned long flags;
724 * if we have an error, pass back CHECK_CONDITION as the
725 * scsi status byte
727 if (blk_pc_request(rq) && !rq->errors)
728 rq->errors = SAM_STAT_CHECK_CONDITION;
730 /* Check for tray open. */
731 if (sense_key == NOT_READY) {
732 cdrom_saw_media_change (drive);
733 } else if (sense_key == UNIT_ATTENTION) {
734 /* Check for media change. */
735 cdrom_saw_media_change (drive);
736 /*printk("%s: media changed\n",drive->name);*/
737 return 0;
738 } else if ((sense_key == ILLEGAL_REQUEST) &&
739 (rq->cmd[0] == GPCMD_START_STOP_UNIT)) {
741 * Don't print error message for this condition--
742 * SFF8090i indicates that 5/24/00 is the correct
743 * response to a request to close the tray if the
744 * drive doesn't have that capability.
745 * cdrom_log_sense() knows this!
747 } else if (!(rq->cmd_flags & REQ_QUIET)) {
748 /* Otherwise, print an error. */
749 ide_dump_status(drive, "packet command error", stat);
752 rq->cmd_flags |= REQ_FAILED;
755 * instead of playing games with moving completions around,
756 * remove failed request completely and end it when the
757 * request sense has completed
759 if (stat & ERR_STAT) {
760 spin_lock_irqsave(&ide_lock, flags);
761 blkdev_dequeue_request(rq);
762 HWGROUP(drive)->rq = NULL;
763 spin_unlock_irqrestore(&ide_lock, flags);
765 cdrom_queue_request_sense(drive, rq->sense, rq);
766 } else
767 cdrom_end_request(drive, 0);
769 } else if (blk_fs_request(rq)) {
770 int do_end_request = 0;
772 /* Handle errors from READ and WRITE requests. */
774 if (blk_noretry_request(rq))
775 do_end_request = 1;
777 if (sense_key == NOT_READY) {
778 /* Tray open. */
779 if (rq_data_dir(rq) == READ) {
780 cdrom_saw_media_change (drive);
782 /* Fail the request. */
783 printk ("%s: tray open\n", drive->name);
784 do_end_request = 1;
785 } else {
786 struct cdrom_info *info = drive->driver_data;
788 /* allow the drive 5 seconds to recover, some
789 * devices will return this error while flushing
790 * data from cache */
791 if (!rq->errors)
792 info->write_timeout = jiffies + ATAPI_WAIT_WRITE_BUSY;
793 rq->errors = 1;
794 if (time_after(jiffies, info->write_timeout))
795 do_end_request = 1;
796 else {
797 unsigned long flags;
800 * take a breather relying on the
801 * unplug timer to kick us again
803 spin_lock_irqsave(&ide_lock, flags);
804 blk_plug_device(drive->queue);
805 spin_unlock_irqrestore(&ide_lock,flags);
806 return 1;
809 } else if (sense_key == UNIT_ATTENTION) {
810 /* Media change. */
811 cdrom_saw_media_change (drive);
813 /* Arrange to retry the request.
814 But be sure to give up if we've retried
815 too many times. */
816 if (++rq->errors > ERROR_MAX)
817 do_end_request = 1;
818 } else if (sense_key == ILLEGAL_REQUEST ||
819 sense_key == DATA_PROTECT) {
820 /* No point in retrying after an illegal
821 request or data protect error.*/
822 ide_dump_status_no_sense (drive, "command error", stat);
823 do_end_request = 1;
824 } else if (sense_key == MEDIUM_ERROR) {
825 /* No point in re-trying a zillion times on a bad
826 * sector... If we got here the error is not correctable */
827 ide_dump_status_no_sense (drive, "media error (bad sector)", stat);
828 do_end_request = 1;
829 } else if (sense_key == BLANK_CHECK) {
830 /* Disk appears blank ?? */
831 ide_dump_status_no_sense (drive, "media error (blank)", stat);
832 do_end_request = 1;
833 } else if ((err & ~ABRT_ERR) != 0) {
834 /* Go to the default handler
835 for other errors. */
836 ide_error(drive, "cdrom_decode_status", stat);
837 return 1;
838 } else if ((++rq->errors > ERROR_MAX)) {
839 /* We've racked up too many retries. Abort. */
840 do_end_request = 1;
843 /* End a request through request sense analysis when we have
844 sense data. We need this in order to perform end of media
845 processing */
847 if (do_end_request) {
848 if (stat & ERR_STAT) {
849 unsigned long flags;
850 spin_lock_irqsave(&ide_lock, flags);
851 blkdev_dequeue_request(rq);
852 HWGROUP(drive)->rq = NULL;
853 spin_unlock_irqrestore(&ide_lock, flags);
855 cdrom_queue_request_sense(drive, rq->sense, rq);
856 } else
857 cdrom_end_request(drive, 0);
858 } else {
859 /* If we got a CHECK_CONDITION status,
860 queue a request sense command. */
861 if (stat & ERR_STAT)
862 cdrom_queue_request_sense(drive, NULL, NULL);
864 } else {
865 blk_dump_rq_flags(rq, "ide-cd: bad rq");
866 cdrom_end_request(drive, 0);
869 /* Retry, or handle the next request. */
870 return 1;
873 static int cdrom_timer_expiry(ide_drive_t *drive)
875 struct request *rq = HWGROUP(drive)->rq;
876 unsigned long wait = 0;
879 * Some commands are *slow* and normally take a long time to
880 * complete. Usually we can use the ATAPI "disconnect" to bypass
881 * this, but not all commands/drives support that. Let
882 * ide_timer_expiry keep polling us for these.
884 switch (rq->cmd[0]) {
885 case GPCMD_BLANK:
886 case GPCMD_FORMAT_UNIT:
887 case GPCMD_RESERVE_RZONE_TRACK:
888 case GPCMD_CLOSE_TRACK:
889 case GPCMD_FLUSH_CACHE:
890 wait = ATAPI_WAIT_PC;
891 break;
892 default:
893 if (!(rq->cmd_flags & REQ_QUIET))
894 printk(KERN_INFO "ide-cd: cmd 0x%x timed out\n", rq->cmd[0]);
895 wait = 0;
896 break;
898 return wait;
901 /* Set up the device registers for transferring a packet command on DEV,
902 expecting to later transfer XFERLEN bytes. HANDLER is the routine
903 which actually transfers the command to the drive. If this is a
904 drq_interrupt device, this routine will arrange for HANDLER to be
905 called when the interrupt from the drive arrives. Otherwise, HANDLER
906 will be called immediately after the drive is prepared for the transfer. */
908 static ide_startstop_t cdrom_start_packet_command(ide_drive_t *drive,
909 int xferlen,
910 ide_handler_t *handler)
912 ide_startstop_t startstop;
913 struct cdrom_info *info = drive->driver_data;
914 ide_hwif_t *hwif = drive->hwif;
916 /* Wait for the controller to be idle. */
917 if (ide_wait_stat(&startstop, drive, 0, BUSY_STAT, WAIT_READY))
918 return startstop;
920 if (info->dma)
921 info->dma = !hwif->dma_setup(drive);
923 /* Set up the controller registers. */
924 /* FIXME: for Virtual DMA we must check harder */
925 HWIF(drive)->OUTB(info->dma, IDE_FEATURE_REG);
926 HWIF(drive)->OUTB(0, IDE_IREASON_REG);
927 HWIF(drive)->OUTB(0, IDE_SECTOR_REG);
929 HWIF(drive)->OUTB(xferlen & 0xff, IDE_BCOUNTL_REG);
930 HWIF(drive)->OUTB(xferlen >> 8 , IDE_BCOUNTH_REG);
931 if (IDE_CONTROL_REG)
932 HWIF(drive)->OUTB(drive->ctl, IDE_CONTROL_REG);
934 if (CDROM_CONFIG_FLAGS (drive)->drq_interrupt) {
935 /* waiting for CDB interrupt, not DMA yet. */
936 if (info->dma)
937 drive->waiting_for_dma = 0;
939 /* packet command */
940 ide_execute_command(drive, WIN_PACKETCMD, handler, ATAPI_WAIT_PC, cdrom_timer_expiry);
941 return ide_started;
942 } else {
943 unsigned long flags;
945 /* packet command */
946 spin_lock_irqsave(&ide_lock, flags);
947 hwif->OUTBSYNC(drive, WIN_PACKETCMD, IDE_COMMAND_REG);
948 ndelay(400);
949 spin_unlock_irqrestore(&ide_lock, flags);
951 return (*handler) (drive);
955 /* Send a packet command to DRIVE described by CMD_BUF and CMD_LEN.
956 The device registers must have already been prepared
957 by cdrom_start_packet_command.
958 HANDLER is the interrupt handler to call when the command completes
959 or there's data ready. */
961 * changed 5 parameters to 3 for dvd-ram
962 * struct packet_command *pc; now packet_command_t *pc;
964 #define ATAPI_MIN_CDB_BYTES 12
965 static ide_startstop_t cdrom_transfer_packet_command (ide_drive_t *drive,
966 struct request *rq,
967 ide_handler_t *handler)
969 ide_hwif_t *hwif = drive->hwif;
970 int cmd_len;
971 struct cdrom_info *info = drive->driver_data;
972 ide_startstop_t startstop;
974 if (CDROM_CONFIG_FLAGS(drive)->drq_interrupt) {
975 /* Here we should have been called after receiving an interrupt
976 from the device. DRQ should how be set. */
978 /* Check for errors. */
979 if (cdrom_decode_status(drive, DRQ_STAT, NULL))
980 return ide_stopped;
982 /* Ok, next interrupt will be DMA interrupt. */
983 if (info->dma)
984 drive->waiting_for_dma = 1;
985 } else {
986 /* Otherwise, we must wait for DRQ to get set. */
987 if (ide_wait_stat(&startstop, drive, DRQ_STAT,
988 BUSY_STAT, WAIT_READY))
989 return startstop;
992 /* Arm the interrupt handler. */
993 ide_set_handler(drive, handler, rq->timeout, cdrom_timer_expiry);
995 /* ATAPI commands get padded out to 12 bytes minimum */
996 cmd_len = COMMAND_SIZE(rq->cmd[0]);
997 if (cmd_len < ATAPI_MIN_CDB_BYTES)
998 cmd_len = ATAPI_MIN_CDB_BYTES;
1000 /* Send the command to the device. */
1001 HWIF(drive)->atapi_output_bytes(drive, rq->cmd, cmd_len);
1003 /* Start the DMA if need be */
1004 if (info->dma)
1005 hwif->dma_start(drive);
1007 return ide_started;
1010 /****************************************************************************
1011 * Block read functions.
1015 * Buffer up to SECTORS_TO_TRANSFER sectors from the drive in our sector
1016 * buffer. Once the first sector is added, any subsequent sectors are
1017 * assumed to be continuous (until the buffer is cleared). For the first
1018 * sector added, SECTOR is its sector number. (SECTOR is then ignored until
1019 * the buffer is cleared.)
1021 static void cdrom_buffer_sectors (ide_drive_t *drive, unsigned long sector,
1022 int sectors_to_transfer)
1024 struct cdrom_info *info = drive->driver_data;
1026 /* Number of sectors to read into the buffer. */
1027 int sectors_to_buffer = min_t(int, sectors_to_transfer,
1028 (SECTOR_BUFFER_SIZE >> SECTOR_BITS) -
1029 info->nsectors_buffered);
1031 char *dest;
1033 /* If we couldn't get a buffer, don't try to buffer anything... */
1034 if (info->buffer == NULL)
1035 sectors_to_buffer = 0;
1037 /* If this is the first sector in the buffer, remember its number. */
1038 if (info->nsectors_buffered == 0)
1039 info->sector_buffered = sector;
1041 /* Read the data into the buffer. */
1042 dest = info->buffer + info->nsectors_buffered * SECTOR_SIZE;
1043 while (sectors_to_buffer > 0) {
1044 HWIF(drive)->atapi_input_bytes(drive, dest, SECTOR_SIZE);
1045 --sectors_to_buffer;
1046 --sectors_to_transfer;
1047 ++info->nsectors_buffered;
1048 dest += SECTOR_SIZE;
1051 /* Throw away any remaining data. */
1052 while (sectors_to_transfer > 0) {
1053 static char dum[SECTOR_SIZE];
1054 HWIF(drive)->atapi_input_bytes(drive, dum, sizeof (dum));
1055 --sectors_to_transfer;
1060 * Check the contents of the interrupt reason register from the cdrom
1061 * and attempt to recover if there are problems. Returns 0 if everything's
1062 * ok; nonzero if the request has been terminated.
1064 static
1065 int cdrom_read_check_ireason (ide_drive_t *drive, int len, int ireason)
1067 if (ireason == 2)
1068 return 0;
1069 else if (ireason == 0) {
1070 /* Whoops... The drive is expecting to receive data from us! */
1071 printk(KERN_ERR "%s: read_intr: Drive wants to transfer data the "
1072 "wrong way!\n", drive->name);
1074 /* Throw some data at the drive so it doesn't hang
1075 and quit this request. */
1076 while (len > 0) {
1077 int dum = 0;
1078 HWIF(drive)->atapi_output_bytes(drive, &dum, sizeof (dum));
1079 len -= sizeof (dum);
1081 } else if (ireason == 1) {
1082 /* Some drives (ASUS) seem to tell us that status
1083 * info is available. just get it and ignore.
1085 (void) HWIF(drive)->INB(IDE_STATUS_REG);
1086 return 0;
1087 } else {
1088 /* Drive wants a command packet, or invalid ireason... */
1089 printk(KERN_ERR "%s: read_intr: bad interrupt reason %x\n", drive->name,
1090 ireason);
1093 cdrom_end_request(drive, 0);
1094 return -1;
1098 * Interrupt routine. Called when a read request has completed.
1100 static ide_startstop_t cdrom_read_intr (ide_drive_t *drive)
1102 int stat;
1103 int ireason, len, sectors_to_transfer, nskip;
1104 struct cdrom_info *info = drive->driver_data;
1105 u8 lowcyl = 0, highcyl = 0;
1106 int dma = info->dma, dma_error = 0;
1108 struct request *rq = HWGROUP(drive)->rq;
1111 * handle dma case
1113 if (dma) {
1114 info->dma = 0;
1115 if ((dma_error = HWIF(drive)->ide_dma_end(drive)))
1116 ide_dma_off(drive);
1119 if (cdrom_decode_status(drive, 0, &stat))
1120 return ide_stopped;
1122 if (dma) {
1123 if (!dma_error) {
1124 ide_end_request(drive, 1, rq->nr_sectors);
1125 return ide_stopped;
1126 } else
1127 return ide_error(drive, "dma error", stat);
1130 /* Read the interrupt reason and the transfer length. */
1131 ireason = HWIF(drive)->INB(IDE_IREASON_REG) & 0x3;
1132 lowcyl = HWIF(drive)->INB(IDE_BCOUNTL_REG);
1133 highcyl = HWIF(drive)->INB(IDE_BCOUNTH_REG);
1135 len = lowcyl + (256 * highcyl);
1137 /* If DRQ is clear, the command has completed. */
1138 if ((stat & DRQ_STAT) == 0) {
1139 /* If we're not done filling the current buffer, complain.
1140 Otherwise, complete the command normally. */
1141 if (rq->current_nr_sectors > 0) {
1142 printk (KERN_ERR "%s: cdrom_read_intr: data underrun (%d blocks)\n",
1143 drive->name, rq->current_nr_sectors);
1144 rq->cmd_flags |= REQ_FAILED;
1145 cdrom_end_request(drive, 0);
1146 } else
1147 cdrom_end_request(drive, 1);
1148 return ide_stopped;
1151 /* Check that the drive is expecting to do the same thing we are. */
1152 if (cdrom_read_check_ireason (drive, len, ireason))
1153 return ide_stopped;
1155 /* Assume that the drive will always provide data in multiples
1156 of at least SECTOR_SIZE, as it gets hairy to keep track
1157 of the transfers otherwise. */
1158 if ((len % SECTOR_SIZE) != 0) {
1159 printk (KERN_ERR "%s: cdrom_read_intr: Bad transfer size %d\n",
1160 drive->name, len);
1161 if (CDROM_CONFIG_FLAGS(drive)->limit_nframes)
1162 printk (KERN_ERR " This drive is not supported by this version of the driver\n");
1163 else {
1164 printk (KERN_ERR " Trying to limit transfer sizes\n");
1165 CDROM_CONFIG_FLAGS(drive)->limit_nframes = 1;
1167 cdrom_end_request(drive, 0);
1168 return ide_stopped;
1171 /* The number of sectors we need to read from the drive. */
1172 sectors_to_transfer = len / SECTOR_SIZE;
1174 /* First, figure out if we need to bit-bucket
1175 any of the leading sectors. */
1176 nskip = min_t(int, rq->current_nr_sectors - bio_cur_sectors(rq->bio), sectors_to_transfer);
1178 while (nskip > 0) {
1179 /* We need to throw away a sector. */
1180 static char dum[SECTOR_SIZE];
1181 HWIF(drive)->atapi_input_bytes(drive, dum, sizeof (dum));
1183 --rq->current_nr_sectors;
1184 --nskip;
1185 --sectors_to_transfer;
1188 /* Now loop while we still have data to read from the drive. */
1189 while (sectors_to_transfer > 0) {
1190 int this_transfer;
1192 /* If we've filled the present buffer but there's another
1193 chained buffer after it, move on. */
1194 if (rq->current_nr_sectors == 0 && rq->nr_sectors)
1195 cdrom_end_request(drive, 1);
1197 /* If the buffers are full, cache the rest of the data in our
1198 internal buffer. */
1199 if (rq->current_nr_sectors == 0) {
1200 cdrom_buffer_sectors(drive, rq->sector, sectors_to_transfer);
1201 sectors_to_transfer = 0;
1202 } else {
1203 /* Transfer data to the buffers.
1204 Figure out how many sectors we can transfer
1205 to the current buffer. */
1206 this_transfer = min_t(int, sectors_to_transfer,
1207 rq->current_nr_sectors);
1209 /* Read this_transfer sectors
1210 into the current buffer. */
1211 while (this_transfer > 0) {
1212 HWIF(drive)->atapi_input_bytes(drive, rq->buffer, SECTOR_SIZE);
1213 rq->buffer += SECTOR_SIZE;
1214 --rq->nr_sectors;
1215 --rq->current_nr_sectors;
1216 ++rq->sector;
1217 --this_transfer;
1218 --sectors_to_transfer;
1223 /* Done moving data! Wait for another interrupt. */
1224 ide_set_handler(drive, &cdrom_read_intr, ATAPI_WAIT_PC, NULL);
1225 return ide_started;
1229 * Try to satisfy some of the current read request from our cached data.
1230 * Returns nonzero if the request has been completed, zero otherwise.
1232 static int cdrom_read_from_buffer (ide_drive_t *drive)
1234 struct cdrom_info *info = drive->driver_data;
1235 struct request *rq = HWGROUP(drive)->rq;
1236 unsigned short sectors_per_frame;
1238 sectors_per_frame = queue_hardsect_size(drive->queue) >> SECTOR_BITS;
1240 /* Can't do anything if there's no buffer. */
1241 if (info->buffer == NULL) return 0;
1243 /* Loop while this request needs data and the next block is present
1244 in our cache. */
1245 while (rq->nr_sectors > 0 &&
1246 rq->sector >= info->sector_buffered &&
1247 rq->sector < info->sector_buffered + info->nsectors_buffered) {
1248 if (rq->current_nr_sectors == 0)
1249 cdrom_end_request(drive, 1);
1251 memcpy (rq->buffer,
1252 info->buffer +
1253 (rq->sector - info->sector_buffered) * SECTOR_SIZE,
1254 SECTOR_SIZE);
1255 rq->buffer += SECTOR_SIZE;
1256 --rq->current_nr_sectors;
1257 --rq->nr_sectors;
1258 ++rq->sector;
1261 /* If we've satisfied the current request,
1262 terminate it successfully. */
1263 if (rq->nr_sectors == 0) {
1264 cdrom_end_request(drive, 1);
1265 return -1;
1268 /* Move on to the next buffer if needed. */
1269 if (rq->current_nr_sectors == 0)
1270 cdrom_end_request(drive, 1);
1272 /* If this condition does not hold, then the kluge i use to
1273 represent the number of sectors to skip at the start of a transfer
1274 will fail. I think that this will never happen, but let's be
1275 paranoid and check. */
1276 if (rq->current_nr_sectors < bio_cur_sectors(rq->bio) &&
1277 (rq->sector & (sectors_per_frame - 1))) {
1278 printk(KERN_ERR "%s: cdrom_read_from_buffer: buffer botch (%ld)\n",
1279 drive->name, (long)rq->sector);
1280 cdrom_end_request(drive, 0);
1281 return -1;
1284 return 0;
1288 * Routine to send a read packet command to the drive.
1289 * This is usually called directly from cdrom_start_read.
1290 * However, for drq_interrupt devices, it is called from an interrupt
1291 * when the drive is ready to accept the command.
1293 static ide_startstop_t cdrom_start_read_continuation (ide_drive_t *drive)
1295 struct request *rq = HWGROUP(drive)->rq;
1296 unsigned short sectors_per_frame;
1297 int nskip;
1299 sectors_per_frame = queue_hardsect_size(drive->queue) >> SECTOR_BITS;
1301 /* If the requested sector doesn't start on a cdrom block boundary,
1302 we must adjust the start of the transfer so that it does,
1303 and remember to skip the first few sectors.
1304 If the CURRENT_NR_SECTORS field is larger than the size
1305 of the buffer, it will mean that we're to skip a number
1306 of sectors equal to the amount by which CURRENT_NR_SECTORS
1307 is larger than the buffer size. */
1308 nskip = rq->sector & (sectors_per_frame - 1);
1309 if (nskip > 0) {
1310 /* Sanity check... */
1311 if (rq->current_nr_sectors != bio_cur_sectors(rq->bio) &&
1312 (rq->sector & (sectors_per_frame - 1))) {
1313 printk(KERN_ERR "%s: cdrom_start_read_continuation: buffer botch (%u)\n",
1314 drive->name, rq->current_nr_sectors);
1315 cdrom_end_request(drive, 0);
1316 return ide_stopped;
1318 rq->current_nr_sectors += nskip;
1321 /* Set up the command */
1322 rq->timeout = ATAPI_WAIT_PC;
1324 /* Send the command to the drive and return. */
1325 return cdrom_transfer_packet_command(drive, rq, &cdrom_read_intr);
1329 #define IDECD_SEEK_THRESHOLD (1000) /* 1000 blocks */
1330 #define IDECD_SEEK_TIMER (5 * WAIT_MIN_SLEEP) /* 100 ms */
1331 #define IDECD_SEEK_TIMEOUT (2 * WAIT_CMD) /* 20 sec */
1333 static ide_startstop_t cdrom_seek_intr (ide_drive_t *drive)
1335 struct cdrom_info *info = drive->driver_data;
1336 int stat;
1337 static int retry = 10;
1339 if (cdrom_decode_status(drive, 0, &stat))
1340 return ide_stopped;
1341 CDROM_CONFIG_FLAGS(drive)->seeking = 1;
1343 if (retry && time_after(jiffies, info->start_seek + IDECD_SEEK_TIMER)) {
1344 if (--retry == 0) {
1346 * this condition is far too common, to bother
1347 * users about it
1349 /* printk("%s: disabled DSC seek overlap\n", drive->name);*/
1350 drive->dsc_overlap = 0;
1353 return ide_stopped;
1356 static ide_startstop_t cdrom_start_seek_continuation (ide_drive_t *drive)
1358 struct request *rq = HWGROUP(drive)->rq;
1359 sector_t frame = rq->sector;
1361 sector_div(frame, queue_hardsect_size(drive->queue) >> SECTOR_BITS);
1363 memset(rq->cmd, 0, sizeof(rq->cmd));
1364 rq->cmd[0] = GPCMD_SEEK;
1365 put_unaligned(cpu_to_be32(frame), (unsigned int *) &rq->cmd[2]);
1367 rq->timeout = ATAPI_WAIT_PC;
1368 return cdrom_transfer_packet_command(drive, rq, &cdrom_seek_intr);
1371 static ide_startstop_t cdrom_start_seek (ide_drive_t *drive, unsigned int block)
1373 struct cdrom_info *info = drive->driver_data;
1375 info->dma = 0;
1376 info->start_seek = jiffies;
1377 return cdrom_start_packet_command(drive, 0, cdrom_start_seek_continuation);
1380 /* Fix up a possibly partially-processed request so that we can
1381 start it over entirely, or even put it back on the request queue. */
1382 static void restore_request (struct request *rq)
1384 if (rq->buffer != bio_data(rq->bio)) {
1385 sector_t n = (rq->buffer - (char *) bio_data(rq->bio)) / SECTOR_SIZE;
1387 rq->buffer = bio_data(rq->bio);
1388 rq->nr_sectors += n;
1389 rq->sector -= n;
1391 rq->hard_cur_sectors = rq->current_nr_sectors = bio_cur_sectors(rq->bio);
1392 rq->hard_nr_sectors = rq->nr_sectors;
1393 rq->hard_sector = rq->sector;
1394 rq->q->prep_rq_fn(rq->q, rq);
1398 * Start a read request from the CD-ROM.
1400 static ide_startstop_t cdrom_start_read (ide_drive_t *drive, unsigned int block)
1402 struct cdrom_info *info = drive->driver_data;
1403 struct request *rq = HWGROUP(drive)->rq;
1404 unsigned short sectors_per_frame;
1406 sectors_per_frame = queue_hardsect_size(drive->queue) >> SECTOR_BITS;
1408 /* We may be retrying this request after an error. Fix up
1409 any weirdness which might be present in the request packet. */
1410 restore_request(rq);
1412 /* Satisfy whatever we can of this request from our cached sector. */
1413 if (cdrom_read_from_buffer(drive))
1414 return ide_stopped;
1416 /* Clear the local sector buffer. */
1417 info->nsectors_buffered = 0;
1419 /* use dma, if possible. */
1420 info->dma = drive->using_dma;
1421 if ((rq->sector & (sectors_per_frame - 1)) ||
1422 (rq->nr_sectors & (sectors_per_frame - 1)))
1423 info->dma = 0;
1425 /* Start sending the read request to the drive. */
1426 return cdrom_start_packet_command(drive, 32768, cdrom_start_read_continuation);
1429 /****************************************************************************
1430 * Execute all other packet commands.
1433 /* Interrupt routine for packet command completion. */
1434 static ide_startstop_t cdrom_pc_intr (ide_drive_t *drive)
1436 int ireason, len, thislen;
1437 struct request *rq = HWGROUP(drive)->rq;
1438 u8 lowcyl = 0, highcyl = 0;
1439 int stat;
1441 /* Check for errors. */
1442 if (cdrom_decode_status(drive, 0, &stat))
1443 return ide_stopped;
1445 /* Read the interrupt reason and the transfer length. */
1446 ireason = HWIF(drive)->INB(IDE_IREASON_REG);
1447 lowcyl = HWIF(drive)->INB(IDE_BCOUNTL_REG);
1448 highcyl = HWIF(drive)->INB(IDE_BCOUNTH_REG);
1450 len = lowcyl + (256 * highcyl);
1452 /* If DRQ is clear, the command has completed.
1453 Complain if we still have data left to transfer. */
1454 if ((stat & DRQ_STAT) == 0) {
1455 /* Some of the trailing request sense fields are optional, and
1456 some drives don't send them. Sigh. */
1457 if (rq->cmd[0] == GPCMD_REQUEST_SENSE &&
1458 rq->data_len > 0 &&
1459 rq->data_len <= 5) {
1460 while (rq->data_len > 0) {
1461 *(unsigned char *)rq->data++ = 0;
1462 --rq->data_len;
1466 if (rq->data_len == 0)
1467 cdrom_end_request(drive, 1);
1468 else {
1469 /* Comment this out, because this always happens
1470 right after a reset occurs, and it is annoying to
1471 always print expected stuff. */
1473 printk ("%s: cdrom_pc_intr: data underrun %d\n",
1474 drive->name, pc->buflen);
1476 rq->cmd_flags |= REQ_FAILED;
1477 cdrom_end_request(drive, 0);
1479 return ide_stopped;
1482 /* Figure out how much data to transfer. */
1483 thislen = rq->data_len;
1484 if (thislen > len) thislen = len;
1486 /* The drive wants to be written to. */
1487 if ((ireason & 3) == 0) {
1488 if (!rq->data) {
1489 blk_dump_rq_flags(rq, "cdrom_pc_intr, write");
1490 goto confused;
1492 /* Transfer the data. */
1493 HWIF(drive)->atapi_output_bytes(drive, rq->data, thislen);
1495 /* If we haven't moved enough data to satisfy the drive,
1496 add some padding. */
1497 while (len > thislen) {
1498 int dum = 0;
1499 HWIF(drive)->atapi_output_bytes(drive, &dum, sizeof(dum));
1500 len -= sizeof(dum);
1503 /* Keep count of how much data we've moved. */
1504 rq->data += thislen;
1505 rq->data_len -= thislen;
1508 /* Same drill for reading. */
1509 else if ((ireason & 3) == 2) {
1510 if (!rq->data) {
1511 blk_dump_rq_flags(rq, "cdrom_pc_intr, write");
1512 goto confused;
1514 /* Transfer the data. */
1515 HWIF(drive)->atapi_input_bytes(drive, rq->data, thislen);
1517 /* If we haven't moved enough data to satisfy the drive,
1518 add some padding. */
1519 while (len > thislen) {
1520 int dum = 0;
1521 HWIF(drive)->atapi_input_bytes(drive, &dum, sizeof(dum));
1522 len -= sizeof(dum);
1525 /* Keep count of how much data we've moved. */
1526 rq->data += thislen;
1527 rq->data_len -= thislen;
1529 if (blk_sense_request(rq))
1530 rq->sense_len += thislen;
1531 } else {
1532 confused:
1533 printk (KERN_ERR "%s: cdrom_pc_intr: The drive "
1534 "appears confused (ireason = 0x%02x). "
1535 "Trying to recover by ending request.\n",
1536 drive->name, ireason);
1537 rq->cmd_flags |= REQ_FAILED;
1538 cdrom_end_request(drive, 0);
1539 return ide_stopped;
1542 /* Now we wait for another interrupt. */
1543 ide_set_handler(drive, &cdrom_pc_intr, ATAPI_WAIT_PC, cdrom_timer_expiry);
1544 return ide_started;
1547 static ide_startstop_t cdrom_do_pc_continuation (ide_drive_t *drive)
1549 struct request *rq = HWGROUP(drive)->rq;
1551 if (!rq->timeout)
1552 rq->timeout = ATAPI_WAIT_PC;
1554 /* Send the command to the drive and return. */
1555 return cdrom_transfer_packet_command(drive, rq, &cdrom_pc_intr);
1559 static ide_startstop_t cdrom_do_packet_command (ide_drive_t *drive)
1561 int len;
1562 struct request *rq = HWGROUP(drive)->rq;
1563 struct cdrom_info *info = drive->driver_data;
1565 info->dma = 0;
1566 rq->cmd_flags &= ~REQ_FAILED;
1567 len = rq->data_len;
1569 /* Start sending the command to the drive. */
1570 return cdrom_start_packet_command(drive, len, cdrom_do_pc_continuation);
1574 static int cdrom_queue_packet_command(ide_drive_t *drive, struct request *rq)
1576 struct request_sense sense;
1577 int retries = 10;
1578 unsigned int flags = rq->cmd_flags;
1580 if (rq->sense == NULL)
1581 rq->sense = &sense;
1583 /* Start of retry loop. */
1584 do {
1585 int error;
1586 unsigned long time = jiffies;
1587 rq->cmd_flags = flags;
1589 error = ide_do_drive_cmd(drive, rq, ide_wait);
1590 time = jiffies - time;
1592 /* FIXME: we should probably abort/retry or something
1593 * in case of failure */
1594 if (rq->cmd_flags & REQ_FAILED) {
1595 /* The request failed. Retry if it was due to a unit
1596 attention status
1597 (usually means media was changed). */
1598 struct request_sense *reqbuf = rq->sense;
1600 if (reqbuf->sense_key == UNIT_ATTENTION)
1601 cdrom_saw_media_change(drive);
1602 else if (reqbuf->sense_key == NOT_READY &&
1603 reqbuf->asc == 4 && reqbuf->ascq != 4) {
1604 /* The drive is in the process of loading
1605 a disk. Retry, but wait a little to give
1606 the drive time to complete the load. */
1607 ssleep(2);
1608 } else {
1609 /* Otherwise, don't retry. */
1610 retries = 0;
1612 --retries;
1615 /* End of retry loop. */
1616 } while ((rq->cmd_flags & REQ_FAILED) && retries >= 0);
1618 /* Return an error if the command failed. */
1619 return (rq->cmd_flags & REQ_FAILED) ? -EIO : 0;
1623 * Write handling
1625 static int cdrom_write_check_ireason(ide_drive_t *drive, int len, int ireason)
1627 /* Two notes about IDE interrupt reason here - 0 means that
1628 * the drive wants to receive data from us, 2 means that
1629 * the drive is expecting to transfer data to us.
1631 if (ireason == 0)
1632 return 0;
1633 else if (ireason == 2) {
1634 /* Whoops... The drive wants to send data. */
1635 printk(KERN_ERR "%s: write_intr: wrong transfer direction!\n",
1636 drive->name);
1638 while (len > 0) {
1639 int dum = 0;
1640 HWIF(drive)->atapi_input_bytes(drive, &dum, sizeof(dum));
1641 len -= sizeof(dum);
1643 } else {
1644 /* Drive wants a command packet, or invalid ireason... */
1645 printk(KERN_ERR "%s: write_intr: bad interrupt reason %x\n",
1646 drive->name, ireason);
1649 cdrom_end_request(drive, 0);
1650 return 1;
1653 static void post_transform_command(struct request *req)
1655 u8 *c = req->cmd;
1656 char *ibuf;
1658 if (!blk_pc_request(req))
1659 return;
1661 if (req->bio)
1662 ibuf = bio_data(req->bio);
1663 else
1664 ibuf = req->data;
1666 if (!ibuf)
1667 return;
1670 * set ansi-revision and response data as atapi
1672 if (c[0] == GPCMD_INQUIRY) {
1673 ibuf[2] |= 2;
1674 ibuf[3] = (ibuf[3] & 0xf0) | 2;
1678 typedef void (xfer_func_t)(ide_drive_t *, void *, u32);
1681 * best way to deal with dma that is not sector aligned right now... note
1682 * that in this path we are not using ->data or ->buffer at all. this irs
1683 * can replace cdrom_pc_intr, cdrom_read_intr, and cdrom_write_intr in the
1684 * future.
1686 static ide_startstop_t cdrom_newpc_intr(ide_drive_t *drive)
1688 struct cdrom_info *info = drive->driver_data;
1689 struct request *rq = HWGROUP(drive)->rq;
1690 int dma_error, dma, stat, ireason, len, thislen;
1691 u8 lowcyl, highcyl;
1692 xfer_func_t *xferfunc;
1693 unsigned long flags;
1695 /* Check for errors. */
1696 dma_error = 0;
1697 dma = info->dma;
1698 if (dma) {
1699 info->dma = 0;
1700 dma_error = HWIF(drive)->ide_dma_end(drive);
1703 if (cdrom_decode_status(drive, 0, &stat))
1704 return ide_stopped;
1707 * using dma, transfer is complete now
1709 if (dma) {
1710 if (dma_error) {
1711 printk(KERN_ERR "ide-cd: dma error\n");
1712 ide_dma_off(drive);
1713 return ide_error(drive, "dma error", stat);
1716 end_that_request_chunk(rq, 1, rq->data_len);
1717 rq->data_len = 0;
1718 goto end_request;
1722 * ok we fall to pio :/
1724 ireason = HWIF(drive)->INB(IDE_IREASON_REG) & 0x3;
1725 lowcyl = HWIF(drive)->INB(IDE_BCOUNTL_REG);
1726 highcyl = HWIF(drive)->INB(IDE_BCOUNTH_REG);
1728 len = lowcyl + (256 * highcyl);
1729 thislen = rq->data_len;
1730 if (thislen > len)
1731 thislen = len;
1734 * If DRQ is clear, the command has completed.
1736 if ((stat & DRQ_STAT) == 0)
1737 goto end_request;
1740 * check which way to transfer data
1742 if (rq_data_dir(rq) == WRITE) {
1744 * write to drive
1746 if (cdrom_write_check_ireason(drive, len, ireason))
1747 return ide_stopped;
1749 xferfunc = HWIF(drive)->atapi_output_bytes;
1750 } else {
1752 * read from drive
1754 if (cdrom_read_check_ireason(drive, len, ireason))
1755 return ide_stopped;
1757 xferfunc = HWIF(drive)->atapi_input_bytes;
1761 * transfer data
1763 while (thislen > 0) {
1764 int blen = blen = rq->data_len;
1765 char *ptr = rq->data;
1768 * bio backed?
1770 if (rq->bio) {
1771 ptr = bio_data(rq->bio);
1772 blen = bio_iovec(rq->bio)->bv_len;
1775 if (!ptr) {
1776 printk(KERN_ERR "%s: confused, missing data\n", drive->name);
1777 break;
1780 if (blen > thislen)
1781 blen = thislen;
1783 xferfunc(drive, ptr, blen);
1785 thislen -= blen;
1786 len -= blen;
1787 rq->data_len -= blen;
1789 if (rq->bio)
1790 end_that_request_chunk(rq, 1, blen);
1791 else
1792 rq->data += blen;
1796 * pad, if necessary
1798 if (len > 0) {
1799 while (len > 0) {
1800 int pad = 0;
1802 xferfunc(drive, &pad, sizeof(pad));
1803 len -= sizeof(pad);
1807 BUG_ON(HWGROUP(drive)->handler != NULL);
1809 ide_set_handler(drive, cdrom_newpc_intr, rq->timeout, NULL);
1810 return ide_started;
1812 end_request:
1813 if (!rq->data_len)
1814 post_transform_command(rq);
1816 spin_lock_irqsave(&ide_lock, flags);
1817 blkdev_dequeue_request(rq);
1818 end_that_request_last(rq, 1);
1819 HWGROUP(drive)->rq = NULL;
1820 spin_unlock_irqrestore(&ide_lock, flags);
1821 return ide_stopped;
1824 static ide_startstop_t cdrom_write_intr(ide_drive_t *drive)
1826 int stat, ireason, len, sectors_to_transfer, uptodate;
1827 struct cdrom_info *info = drive->driver_data;
1828 int dma_error = 0, dma = info->dma;
1829 u8 lowcyl = 0, highcyl = 0;
1831 struct request *rq = HWGROUP(drive)->rq;
1833 /* Check for errors. */
1834 if (dma) {
1835 info->dma = 0;
1836 if ((dma_error = HWIF(drive)->ide_dma_end(drive))) {
1837 printk(KERN_ERR "ide-cd: write dma error\n");
1838 ide_dma_off(drive);
1842 if (cdrom_decode_status(drive, 0, &stat))
1843 return ide_stopped;
1846 * using dma, transfer is complete now
1848 if (dma) {
1849 if (dma_error)
1850 return ide_error(drive, "dma error", stat);
1852 ide_end_request(drive, 1, rq->nr_sectors);
1853 return ide_stopped;
1856 /* Read the interrupt reason and the transfer length. */
1857 ireason = HWIF(drive)->INB(IDE_IREASON_REG);
1858 lowcyl = HWIF(drive)->INB(IDE_BCOUNTL_REG);
1859 highcyl = HWIF(drive)->INB(IDE_BCOUNTH_REG);
1861 len = lowcyl + (256 * highcyl);
1863 /* If DRQ is clear, the command has completed. */
1864 if ((stat & DRQ_STAT) == 0) {
1865 /* If we're not done writing, complain.
1866 * Otherwise, complete the command normally.
1868 uptodate = 1;
1869 if (rq->current_nr_sectors > 0) {
1870 printk(KERN_ERR "%s: write_intr: data underrun (%d blocks)\n",
1871 drive->name, rq->current_nr_sectors);
1872 uptodate = 0;
1874 cdrom_end_request(drive, uptodate);
1875 return ide_stopped;
1878 /* Check that the drive is expecting to do the same thing we are. */
1879 if (cdrom_write_check_ireason(drive, len, ireason))
1880 return ide_stopped;
1882 sectors_to_transfer = len / SECTOR_SIZE;
1885 * now loop and write out the data
1887 while (sectors_to_transfer > 0) {
1888 int this_transfer;
1890 if (!rq->current_nr_sectors) {
1891 printk(KERN_ERR "ide-cd: write_intr: oops\n");
1892 break;
1896 * Figure out how many sectors we can transfer
1898 this_transfer = min_t(int, sectors_to_transfer, rq->current_nr_sectors);
1900 while (this_transfer > 0) {
1901 HWIF(drive)->atapi_output_bytes(drive, rq->buffer, SECTOR_SIZE);
1902 rq->buffer += SECTOR_SIZE;
1903 --rq->nr_sectors;
1904 --rq->current_nr_sectors;
1905 ++rq->sector;
1906 --this_transfer;
1907 --sectors_to_transfer;
1911 * current buffer complete, move on
1913 if (rq->current_nr_sectors == 0 && rq->nr_sectors)
1914 cdrom_end_request(drive, 1);
1917 /* re-arm handler */
1918 ide_set_handler(drive, &cdrom_write_intr, ATAPI_WAIT_PC, NULL);
1919 return ide_started;
1922 static ide_startstop_t cdrom_start_write_cont(ide_drive_t *drive)
1924 struct request *rq = HWGROUP(drive)->rq;
1926 #if 0 /* the immediate bit */
1927 rq->cmd[1] = 1 << 3;
1928 #endif
1929 rq->timeout = ATAPI_WAIT_PC;
1931 return cdrom_transfer_packet_command(drive, rq, cdrom_write_intr);
1934 static ide_startstop_t cdrom_start_write(ide_drive_t *drive, struct request *rq)
1936 struct cdrom_info *info = drive->driver_data;
1937 struct gendisk *g = info->disk;
1938 unsigned short sectors_per_frame = queue_hardsect_size(drive->queue) >> SECTOR_BITS;
1941 * writes *must* be hardware frame aligned
1943 if ((rq->nr_sectors & (sectors_per_frame - 1)) ||
1944 (rq->sector & (sectors_per_frame - 1))) {
1945 cdrom_end_request(drive, 0);
1946 return ide_stopped;
1950 * disk has become write protected
1952 if (g->policy) {
1953 cdrom_end_request(drive, 0);
1954 return ide_stopped;
1957 info->nsectors_buffered = 0;
1959 /* use dma, if possible. we don't need to check more, since we
1960 * know that the transfer is always (at least!) frame aligned */
1961 info->dma = drive->using_dma ? 1 : 0;
1963 info->devinfo.media_written = 1;
1965 /* Start sending the write request to the drive. */
1966 return cdrom_start_packet_command(drive, 32768, cdrom_start_write_cont);
1969 static ide_startstop_t cdrom_do_newpc_cont(ide_drive_t *drive)
1971 struct request *rq = HWGROUP(drive)->rq;
1973 if (!rq->timeout)
1974 rq->timeout = ATAPI_WAIT_PC;
1976 return cdrom_transfer_packet_command(drive, rq, cdrom_newpc_intr);
1979 static ide_startstop_t cdrom_do_block_pc(ide_drive_t *drive, struct request *rq)
1981 struct cdrom_info *info = drive->driver_data;
1983 rq->cmd_flags |= REQ_QUIET;
1985 info->dma = 0;
1988 * sg request
1990 if (rq->bio) {
1991 int mask = drive->queue->dma_alignment;
1992 unsigned long addr = (unsigned long) page_address(bio_page(rq->bio));
1994 info->dma = drive->using_dma;
1997 * check if dma is safe
1999 * NOTE! The "len" and "addr" checks should possibly have
2000 * separate masks.
2002 if ((rq->data_len & 15) || (addr & mask))
2003 info->dma = 0;
2006 /* Start sending the command to the drive. */
2007 return cdrom_start_packet_command(drive, rq->data_len, cdrom_do_newpc_cont);
2010 /****************************************************************************
2011 * cdrom driver request routine.
2013 static ide_startstop_t
2014 ide_do_rw_cdrom (ide_drive_t *drive, struct request *rq, sector_t block)
2016 ide_startstop_t action;
2017 struct cdrom_info *info = drive->driver_data;
2019 if (blk_fs_request(rq)) {
2020 if (CDROM_CONFIG_FLAGS(drive)->seeking) {
2021 unsigned long elapsed = jiffies - info->start_seek;
2022 int stat = HWIF(drive)->INB(IDE_STATUS_REG);
2024 if ((stat & SEEK_STAT) != SEEK_STAT) {
2025 if (elapsed < IDECD_SEEK_TIMEOUT) {
2026 ide_stall_queue(drive, IDECD_SEEK_TIMER);
2027 return ide_stopped;
2029 printk (KERN_ERR "%s: DSC timeout\n", drive->name);
2031 CDROM_CONFIG_FLAGS(drive)->seeking = 0;
2033 if ((rq_data_dir(rq) == READ) && IDE_LARGE_SEEK(info->last_block, block, IDECD_SEEK_THRESHOLD) && drive->dsc_overlap) {
2034 action = cdrom_start_seek(drive, block);
2035 } else {
2036 if (rq_data_dir(rq) == READ)
2037 action = cdrom_start_read(drive, block);
2038 else
2039 action = cdrom_start_write(drive, rq);
2041 info->last_block = block;
2042 return action;
2043 } else if (rq->cmd_type == REQ_TYPE_SENSE ||
2044 rq->cmd_type == REQ_TYPE_ATA_PC) {
2045 return cdrom_do_packet_command(drive);
2046 } else if (blk_pc_request(rq)) {
2047 return cdrom_do_block_pc(drive, rq);
2048 } else if (blk_special_request(rq)) {
2050 * right now this can only be a reset...
2052 cdrom_end_request(drive, 1);
2053 return ide_stopped;
2056 blk_dump_rq_flags(rq, "ide-cd bad flags");
2057 cdrom_end_request(drive, 0);
2058 return ide_stopped;
2063 /****************************************************************************
2064 * Ioctl handling.
2066 * Routines which queue packet commands take as a final argument a pointer
2067 * to a request_sense struct. If execution of the command results
2068 * in an error with a CHECK CONDITION status, this structure will be filled
2069 * with the results of the subsequent request sense command. The pointer
2070 * can also be NULL, in which case no sense information is returned.
2073 #if ! STANDARD_ATAPI
2074 static inline
2075 int bin2bcd (int x)
2077 return (x%10) | ((x/10) << 4);
2081 static inline
2082 int bcd2bin (int x)
2084 return (x >> 4) * 10 + (x & 0x0f);
2087 static
2088 void msf_from_bcd (struct atapi_msf *msf)
2090 msf->minute = bcd2bin (msf->minute);
2091 msf->second = bcd2bin (msf->second);
2092 msf->frame = bcd2bin (msf->frame);
2095 #endif /* not STANDARD_ATAPI */
2098 static inline
2099 void lba_to_msf (int lba, byte *m, byte *s, byte *f)
2101 lba += CD_MSF_OFFSET;
2102 lba &= 0xffffff; /* negative lbas use only 24 bits */
2103 *m = lba / (CD_SECS * CD_FRAMES);
2104 lba %= (CD_SECS * CD_FRAMES);
2105 *s = lba / CD_FRAMES;
2106 *f = lba % CD_FRAMES;
2110 static inline
2111 int msf_to_lba (byte m, byte s, byte f)
2113 return (((m * CD_SECS) + s) * CD_FRAMES + f) - CD_MSF_OFFSET;
2116 static int cdrom_check_status(ide_drive_t *drive, struct request_sense *sense)
2118 struct request req;
2119 struct cdrom_info *info = drive->driver_data;
2120 struct cdrom_device_info *cdi = &info->devinfo;
2122 cdrom_prepare_request(drive, &req);
2124 req.sense = sense;
2125 req.cmd[0] = GPCMD_TEST_UNIT_READY;
2126 req.cmd_flags |= REQ_QUIET;
2128 #if ! STANDARD_ATAPI
2129 /* the Sanyo 3 CD changer uses byte 7 of TEST_UNIT_READY to
2130 switch CDs instead of supporting the LOAD_UNLOAD opcode */
2132 req.cmd[7] = cdi->sanyo_slot % 3;
2133 #endif /* not STANDARD_ATAPI */
2135 return cdrom_queue_packet_command(drive, &req);
2139 /* Lock the door if LOCKFLAG is nonzero; unlock it otherwise. */
2140 static int
2141 cdrom_lockdoor(ide_drive_t *drive, int lockflag, struct request_sense *sense)
2143 struct request_sense my_sense;
2144 struct request req;
2145 int stat;
2147 if (sense == NULL)
2148 sense = &my_sense;
2150 /* If the drive cannot lock the door, just pretend. */
2151 if (CDROM_CONFIG_FLAGS(drive)->no_doorlock) {
2152 stat = 0;
2153 } else {
2154 cdrom_prepare_request(drive, &req);
2155 req.sense = sense;
2156 req.cmd[0] = GPCMD_PREVENT_ALLOW_MEDIUM_REMOVAL;
2157 req.cmd[4] = lockflag ? 1 : 0;
2158 stat = cdrom_queue_packet_command(drive, &req);
2161 /* If we got an illegal field error, the drive
2162 probably cannot lock the door. */
2163 if (stat != 0 &&
2164 sense->sense_key == ILLEGAL_REQUEST &&
2165 (sense->asc == 0x24 || sense->asc == 0x20)) {
2166 printk (KERN_ERR "%s: door locking not supported\n",
2167 drive->name);
2168 CDROM_CONFIG_FLAGS(drive)->no_doorlock = 1;
2169 stat = 0;
2172 /* no medium, that's alright. */
2173 if (stat != 0 && sense->sense_key == NOT_READY && sense->asc == 0x3a)
2174 stat = 0;
2176 if (stat == 0)
2177 CDROM_STATE_FLAGS(drive)->door_locked = lockflag;
2179 return stat;
2183 /* Eject the disk if EJECTFLAG is 0.
2184 If EJECTFLAG is 1, try to reload the disk. */
2185 static int cdrom_eject(ide_drive_t *drive, int ejectflag,
2186 struct request_sense *sense)
2188 struct request req;
2189 char loej = 0x02;
2191 if (CDROM_CONFIG_FLAGS(drive)->no_eject && !ejectflag)
2192 return -EDRIVE_CANT_DO_THIS;
2194 /* reload fails on some drives, if the tray is locked */
2195 if (CDROM_STATE_FLAGS(drive)->door_locked && ejectflag)
2196 return 0;
2198 cdrom_prepare_request(drive, &req);
2200 /* only tell drive to close tray if open, if it can do that */
2201 if (ejectflag && !CDROM_CONFIG_FLAGS(drive)->close_tray)
2202 loej = 0;
2204 req.sense = sense;
2205 req.cmd[0] = GPCMD_START_STOP_UNIT;
2206 req.cmd[4] = loej | (ejectflag != 0);
2207 return cdrom_queue_packet_command(drive, &req);
2210 static int cdrom_read_capacity(ide_drive_t *drive, unsigned long *capacity,
2211 unsigned long *sectors_per_frame,
2212 struct request_sense *sense)
2214 struct {
2215 __u32 lba;
2216 __u32 blocklen;
2217 } capbuf;
2219 int stat;
2220 struct request req;
2222 cdrom_prepare_request(drive, &req);
2224 req.sense = sense;
2225 req.cmd[0] = GPCMD_READ_CDVD_CAPACITY;
2226 req.data = (char *)&capbuf;
2227 req.data_len = sizeof(capbuf);
2228 req.cmd_flags |= REQ_QUIET;
2230 stat = cdrom_queue_packet_command(drive, &req);
2231 if (stat == 0) {
2232 *capacity = 1 + be32_to_cpu(capbuf.lba);
2233 *sectors_per_frame =
2234 be32_to_cpu(capbuf.blocklen) >> SECTOR_BITS;
2237 return stat;
2240 static int cdrom_read_tocentry(ide_drive_t *drive, int trackno, int msf_flag,
2241 int format, char *buf, int buflen,
2242 struct request_sense *sense)
2244 struct request req;
2246 cdrom_prepare_request(drive, &req);
2248 req.sense = sense;
2249 req.data = buf;
2250 req.data_len = buflen;
2251 req.cmd_flags |= REQ_QUIET;
2252 req.cmd[0] = GPCMD_READ_TOC_PMA_ATIP;
2253 req.cmd[6] = trackno;
2254 req.cmd[7] = (buflen >> 8);
2255 req.cmd[8] = (buflen & 0xff);
2256 req.cmd[9] = (format << 6);
2258 if (msf_flag)
2259 req.cmd[1] = 2;
2261 return cdrom_queue_packet_command(drive, &req);
2265 /* Try to read the entire TOC for the disk into our internal buffer. */
2266 static int cdrom_read_toc(ide_drive_t *drive, struct request_sense *sense)
2268 int stat, ntracks, i;
2269 struct cdrom_info *info = drive->driver_data;
2270 struct cdrom_device_info *cdi = &info->devinfo;
2271 struct atapi_toc *toc = info->toc;
2272 struct {
2273 struct atapi_toc_header hdr;
2274 struct atapi_toc_entry ent;
2275 } ms_tmp;
2276 long last_written;
2277 unsigned long sectors_per_frame = SECTORS_PER_FRAME;
2279 if (toc == NULL) {
2280 /* Try to allocate space. */
2281 toc = kmalloc(sizeof(struct atapi_toc), GFP_KERNEL);
2282 if (toc == NULL) {
2283 printk (KERN_ERR "%s: No cdrom TOC buffer!\n", drive->name);
2284 return -ENOMEM;
2286 info->toc = toc;
2289 /* Check to see if the existing data is still valid.
2290 If it is, just return. */
2291 (void) cdrom_check_status(drive, sense);
2293 if (CDROM_STATE_FLAGS(drive)->toc_valid)
2294 return 0;
2296 /* Try to get the total cdrom capacity and sector size. */
2297 stat = cdrom_read_capacity(drive, &toc->capacity, &sectors_per_frame,
2298 sense);
2299 if (stat)
2300 toc->capacity = 0x1fffff;
2302 set_capacity(info->disk, toc->capacity * sectors_per_frame);
2303 /* Save a private copy of te TOC capacity for error handling */
2304 drive->probed_capacity = toc->capacity * sectors_per_frame;
2306 blk_queue_hardsect_size(drive->queue,
2307 sectors_per_frame << SECTOR_BITS);
2309 /* First read just the header, so we know how long the TOC is. */
2310 stat = cdrom_read_tocentry(drive, 0, 1, 0, (char *) &toc->hdr,
2311 sizeof(struct atapi_toc_header), sense);
2312 if (stat)
2313 return stat;
2315 #if ! STANDARD_ATAPI
2316 if (CDROM_CONFIG_FLAGS(drive)->toctracks_as_bcd) {
2317 toc->hdr.first_track = bcd2bin(toc->hdr.first_track);
2318 toc->hdr.last_track = bcd2bin(toc->hdr.last_track);
2320 #endif /* not STANDARD_ATAPI */
2322 ntracks = toc->hdr.last_track - toc->hdr.first_track + 1;
2323 if (ntracks <= 0)
2324 return -EIO;
2325 if (ntracks > MAX_TRACKS)
2326 ntracks = MAX_TRACKS;
2328 /* Now read the whole schmeer. */
2329 stat = cdrom_read_tocentry(drive, toc->hdr.first_track, 1, 0,
2330 (char *)&toc->hdr,
2331 sizeof(struct atapi_toc_header) +
2332 (ntracks + 1) *
2333 sizeof(struct atapi_toc_entry), sense);
2335 if (stat && toc->hdr.first_track > 1) {
2336 /* Cds with CDI tracks only don't have any TOC entries,
2337 despite of this the returned values are
2338 first_track == last_track = number of CDI tracks + 1,
2339 so that this case is indistinguishable from the same
2340 layout plus an additional audio track.
2341 If we get an error for the regular case, we assume
2342 a CDI without additional audio tracks. In this case
2343 the readable TOC is empty (CDI tracks are not included)
2344 and only holds the Leadout entry. Heiko Eißfeldt */
2345 ntracks = 0;
2346 stat = cdrom_read_tocentry(drive, CDROM_LEADOUT, 1, 0,
2347 (char *)&toc->hdr,
2348 sizeof(struct atapi_toc_header) +
2349 (ntracks + 1) *
2350 sizeof(struct atapi_toc_entry),
2351 sense);
2352 if (stat) {
2353 return stat;
2355 #if ! STANDARD_ATAPI
2356 if (CDROM_CONFIG_FLAGS(drive)->toctracks_as_bcd) {
2357 toc->hdr.first_track = bin2bcd(CDROM_LEADOUT);
2358 toc->hdr.last_track = bin2bcd(CDROM_LEADOUT);
2359 } else
2360 #endif /* not STANDARD_ATAPI */
2362 toc->hdr.first_track = CDROM_LEADOUT;
2363 toc->hdr.last_track = CDROM_LEADOUT;
2367 if (stat)
2368 return stat;
2370 toc->hdr.toc_length = ntohs (toc->hdr.toc_length);
2372 #if ! STANDARD_ATAPI
2373 if (CDROM_CONFIG_FLAGS(drive)->toctracks_as_bcd) {
2374 toc->hdr.first_track = bcd2bin(toc->hdr.first_track);
2375 toc->hdr.last_track = bcd2bin(toc->hdr.last_track);
2377 #endif /* not STANDARD_ATAPI */
2379 for (i=0; i<=ntracks; i++) {
2380 #if ! STANDARD_ATAPI
2381 if (CDROM_CONFIG_FLAGS(drive)->tocaddr_as_bcd) {
2382 if (CDROM_CONFIG_FLAGS(drive)->toctracks_as_bcd)
2383 toc->ent[i].track = bcd2bin(toc->ent[i].track);
2384 msf_from_bcd(&toc->ent[i].addr.msf);
2386 #endif /* not STANDARD_ATAPI */
2387 toc->ent[i].addr.lba = msf_to_lba (toc->ent[i].addr.msf.minute,
2388 toc->ent[i].addr.msf.second,
2389 toc->ent[i].addr.msf.frame);
2392 /* Read the multisession information. */
2393 if (toc->hdr.first_track != CDROM_LEADOUT) {
2394 /* Read the multisession information. */
2395 stat = cdrom_read_tocentry(drive, 0, 0, 1, (char *)&ms_tmp,
2396 sizeof(ms_tmp), sense);
2397 if (stat)
2398 return stat;
2400 toc->last_session_lba = be32_to_cpu(ms_tmp.ent.addr.lba);
2401 } else {
2402 ms_tmp.hdr.first_track = ms_tmp.hdr.last_track = CDROM_LEADOUT;
2403 toc->last_session_lba = msf_to_lba(0, 2, 0); /* 0m 2s 0f */
2406 #if ! STANDARD_ATAPI
2407 if (CDROM_CONFIG_FLAGS(drive)->tocaddr_as_bcd) {
2408 /* Re-read multisession information using MSF format */
2409 stat = cdrom_read_tocentry(drive, 0, 1, 1, (char *)&ms_tmp,
2410 sizeof(ms_tmp), sense);
2411 if (stat)
2412 return stat;
2414 msf_from_bcd (&ms_tmp.ent.addr.msf);
2415 toc->last_session_lba = msf_to_lba(ms_tmp.ent.addr.msf.minute,
2416 ms_tmp.ent.addr.msf.second,
2417 ms_tmp.ent.addr.msf.frame);
2419 #endif /* not STANDARD_ATAPI */
2421 toc->xa_flag = (ms_tmp.hdr.first_track != ms_tmp.hdr.last_track);
2423 /* Now try to get the total cdrom capacity. */
2424 stat = cdrom_get_last_written(cdi, &last_written);
2425 if (!stat && (last_written > toc->capacity)) {
2426 toc->capacity = last_written;
2427 set_capacity(info->disk, toc->capacity * sectors_per_frame);
2428 drive->probed_capacity = toc->capacity * sectors_per_frame;
2431 /* Remember that we've read this stuff. */
2432 CDROM_STATE_FLAGS(drive)->toc_valid = 1;
2434 return 0;
2438 static int cdrom_read_subchannel(ide_drive_t *drive, int format, char *buf,
2439 int buflen, struct request_sense *sense)
2441 struct request req;
2443 cdrom_prepare_request(drive, &req);
2445 req.sense = sense;
2446 req.data = buf;
2447 req.data_len = buflen;
2448 req.cmd[0] = GPCMD_READ_SUBCHANNEL;
2449 req.cmd[1] = 2; /* MSF addressing */
2450 req.cmd[2] = 0x40; /* request subQ data */
2451 req.cmd[3] = format;
2452 req.cmd[7] = (buflen >> 8);
2453 req.cmd[8] = (buflen & 0xff);
2454 return cdrom_queue_packet_command(drive, &req);
2457 /* ATAPI cdrom drives are free to select the speed you request or any slower
2458 rate :-( Requesting too fast a speed will _not_ produce an error. */
2459 static int cdrom_select_speed(ide_drive_t *drive, int speed,
2460 struct request_sense *sense)
2462 struct request req;
2463 cdrom_prepare_request(drive, &req);
2465 req.sense = sense;
2466 if (speed == 0)
2467 speed = 0xffff; /* set to max */
2468 else
2469 speed *= 177; /* Nx to kbytes/s */
2471 req.cmd[0] = GPCMD_SET_SPEED;
2472 /* Read Drive speed in kbytes/second MSB */
2473 req.cmd[2] = (speed >> 8) & 0xff;
2474 /* Read Drive speed in kbytes/second LSB */
2475 req.cmd[3] = speed & 0xff;
2476 if (CDROM_CONFIG_FLAGS(drive)->cd_r ||
2477 CDROM_CONFIG_FLAGS(drive)->cd_rw ||
2478 CDROM_CONFIG_FLAGS(drive)->dvd_r) {
2479 /* Write Drive speed in kbytes/second MSB */
2480 req.cmd[4] = (speed >> 8) & 0xff;
2481 /* Write Drive speed in kbytes/second LSB */
2482 req.cmd[5] = speed & 0xff;
2485 return cdrom_queue_packet_command(drive, &req);
2488 static int cdrom_play_audio(ide_drive_t *drive, int lba_start, int lba_end)
2490 struct request_sense sense;
2491 struct request req;
2493 cdrom_prepare_request(drive, &req);
2495 req.sense = &sense;
2496 req.cmd[0] = GPCMD_PLAY_AUDIO_MSF;
2497 lba_to_msf(lba_start, &req.cmd[3], &req.cmd[4], &req.cmd[5]);
2498 lba_to_msf(lba_end-1, &req.cmd[6], &req.cmd[7], &req.cmd[8]);
2500 return cdrom_queue_packet_command(drive, &req);
2503 static int cdrom_get_toc_entry(ide_drive_t *drive, int track,
2504 struct atapi_toc_entry **ent)
2506 struct cdrom_info *info = drive->driver_data;
2507 struct atapi_toc *toc = info->toc;
2508 int ntracks;
2511 * don't serve cached data, if the toc isn't valid
2513 if (!CDROM_STATE_FLAGS(drive)->toc_valid)
2514 return -EINVAL;
2516 /* Check validity of requested track number. */
2517 ntracks = toc->hdr.last_track - toc->hdr.first_track + 1;
2518 if (toc->hdr.first_track == CDROM_LEADOUT) ntracks = 0;
2519 if (track == CDROM_LEADOUT)
2520 *ent = &toc->ent[ntracks];
2521 else if (track < toc->hdr.first_track ||
2522 track > toc->hdr.last_track)
2523 return -EINVAL;
2524 else
2525 *ent = &toc->ent[track - toc->hdr.first_track];
2527 return 0;
2530 /* the generic packet interface to cdrom.c */
2531 static int ide_cdrom_packet(struct cdrom_device_info *cdi,
2532 struct packet_command *cgc)
2534 struct request req;
2535 ide_drive_t *drive = cdi->handle;
2537 if (cgc->timeout <= 0)
2538 cgc->timeout = ATAPI_WAIT_PC;
2540 /* here we queue the commands from the uniform CD-ROM
2541 layer. the packet must be complete, as we do not
2542 touch it at all. */
2543 cdrom_prepare_request(drive, &req);
2544 memcpy(req.cmd, cgc->cmd, CDROM_PACKET_SIZE);
2545 if (cgc->sense)
2546 memset(cgc->sense, 0, sizeof(struct request_sense));
2547 req.data = cgc->buffer;
2548 req.data_len = cgc->buflen;
2549 req.timeout = cgc->timeout;
2551 if (cgc->quiet)
2552 req.cmd_flags |= REQ_QUIET;
2554 req.sense = cgc->sense;
2555 cgc->stat = cdrom_queue_packet_command(drive, &req);
2556 if (!cgc->stat)
2557 cgc->buflen -= req.data_len;
2558 return cgc->stat;
2561 static
2562 int ide_cdrom_audio_ioctl (struct cdrom_device_info *cdi,
2563 unsigned int cmd, void *arg)
2566 ide_drive_t *drive = cdi->handle;
2567 struct cdrom_info *info = drive->driver_data;
2568 int stat;
2570 switch (cmd) {
2572 * emulate PLAY_AUDIO_TI command with PLAY_AUDIO_10, since
2573 * atapi doesn't support it
2575 case CDROMPLAYTRKIND: {
2576 unsigned long lba_start, lba_end;
2577 struct cdrom_ti *ti = arg;
2578 struct atapi_toc_entry *first_toc, *last_toc;
2580 stat = cdrom_get_toc_entry(drive, ti->cdti_trk0, &first_toc);
2581 if (stat)
2582 return stat;
2584 stat = cdrom_get_toc_entry(drive, ti->cdti_trk1, &last_toc);
2585 if (stat)
2586 return stat;
2588 if (ti->cdti_trk1 != CDROM_LEADOUT)
2589 ++last_toc;
2590 lba_start = first_toc->addr.lba;
2591 lba_end = last_toc->addr.lba;
2593 if (lba_end <= lba_start)
2594 return -EINVAL;
2596 return cdrom_play_audio(drive, lba_start, lba_end);
2599 case CDROMREADTOCHDR: {
2600 struct cdrom_tochdr *tochdr = arg;
2601 struct atapi_toc *toc;
2603 /* Make sure our saved TOC is valid. */
2604 stat = cdrom_read_toc(drive, NULL);
2605 if (stat)
2606 return stat;
2608 toc = info->toc;
2609 tochdr->cdth_trk0 = toc->hdr.first_track;
2610 tochdr->cdth_trk1 = toc->hdr.last_track;
2612 return 0;
2615 case CDROMREADTOCENTRY: {
2616 struct cdrom_tocentry *tocentry = arg;
2617 struct atapi_toc_entry *toce;
2619 stat = cdrom_get_toc_entry(drive, tocentry->cdte_track, &toce);
2620 if (stat)
2621 return stat;
2623 tocentry->cdte_ctrl = toce->control;
2624 tocentry->cdte_adr = toce->adr;
2625 if (tocentry->cdte_format == CDROM_MSF) {
2626 lba_to_msf (toce->addr.lba,
2627 &tocentry->cdte_addr.msf.minute,
2628 &tocentry->cdte_addr.msf.second,
2629 &tocentry->cdte_addr.msf.frame);
2630 } else
2631 tocentry->cdte_addr.lba = toce->addr.lba;
2633 return 0;
2636 default:
2637 return -EINVAL;
2641 static
2642 int ide_cdrom_reset (struct cdrom_device_info *cdi)
2644 ide_drive_t *drive = cdi->handle;
2645 struct request_sense sense;
2646 struct request req;
2647 int ret;
2649 cdrom_prepare_request(drive, &req);
2650 req.cmd_type = REQ_TYPE_SPECIAL;
2651 req.cmd_flags = REQ_QUIET;
2652 ret = ide_do_drive_cmd(drive, &req, ide_wait);
2655 * A reset will unlock the door. If it was previously locked,
2656 * lock it again.
2658 if (CDROM_STATE_FLAGS(drive)->door_locked)
2659 (void) cdrom_lockdoor(drive, 1, &sense);
2661 return ret;
2665 static
2666 int ide_cdrom_tray_move (struct cdrom_device_info *cdi, int position)
2668 ide_drive_t *drive = cdi->handle;
2669 struct request_sense sense;
2671 if (position) {
2672 int stat = cdrom_lockdoor(drive, 0, &sense);
2673 if (stat)
2674 return stat;
2677 return cdrom_eject(drive, !position, &sense);
2680 static
2681 int ide_cdrom_lock_door (struct cdrom_device_info *cdi, int lock)
2683 ide_drive_t *drive = cdi->handle;
2684 return cdrom_lockdoor(drive, lock, NULL);
2687 static
2688 int ide_cdrom_get_capabilities(ide_drive_t *drive, struct atapi_capabilities_page *cap)
2690 struct cdrom_info *info = drive->driver_data;
2691 struct cdrom_device_info *cdi = &info->devinfo;
2692 struct packet_command cgc;
2693 int stat, attempts = 3, size = sizeof(*cap);
2696 * ACER50 (and others?) require the full spec length mode sense
2697 * page capabilities size, but older drives break.
2699 if (!(!strcmp(drive->id->model, "ATAPI CD ROM DRIVE 50X MAX") ||
2700 !strcmp(drive->id->model, "WPI CDS-32X")))
2701 size -= sizeof(cap->pad);
2703 init_cdrom_command(&cgc, cap, size, CGC_DATA_UNKNOWN);
2704 do { /* we seem to get stat=0x01,err=0x00 the first time (??) */
2705 stat = cdrom_mode_sense(cdi, &cgc, GPMODE_CAPABILITIES_PAGE, 0);
2706 if (!stat)
2707 break;
2708 } while (--attempts);
2709 return stat;
2712 static
2713 void ide_cdrom_update_speed (ide_drive_t *drive, struct atapi_capabilities_page *cap)
2715 /* The ACER/AOpen 24X cdrom has the speed fields byte-swapped */
2716 if (!drive->id->model[0] &&
2717 !strncmp(drive->id->fw_rev, "241N", 4)) {
2718 CDROM_STATE_FLAGS(drive)->current_speed =
2719 (((unsigned int)cap->curspeed) + (176/2)) / 176;
2720 CDROM_CONFIG_FLAGS(drive)->max_speed =
2721 (((unsigned int)cap->maxspeed) + (176/2)) / 176;
2722 } else {
2723 CDROM_STATE_FLAGS(drive)->current_speed =
2724 (ntohs(cap->curspeed) + (176/2)) / 176;
2725 CDROM_CONFIG_FLAGS(drive)->max_speed =
2726 (ntohs(cap->maxspeed) + (176/2)) / 176;
2730 static
2731 int ide_cdrom_select_speed (struct cdrom_device_info *cdi, int speed)
2733 ide_drive_t *drive = cdi->handle;
2734 struct request_sense sense;
2735 struct atapi_capabilities_page cap;
2736 int stat;
2738 if ((stat = cdrom_select_speed(drive, speed, &sense)) < 0)
2739 return stat;
2741 if (!ide_cdrom_get_capabilities(drive, &cap)) {
2742 ide_cdrom_update_speed(drive, &cap);
2743 cdi->speed = CDROM_STATE_FLAGS(drive)->current_speed;
2745 return 0;
2749 * add logic to try GET_EVENT command first to check for media and tray
2750 * status. this should be supported by newer cd-r/w and all DVD etc
2751 * drives
2753 static
2754 int ide_cdrom_drive_status (struct cdrom_device_info *cdi, int slot_nr)
2756 ide_drive_t *drive = cdi->handle;
2757 struct media_event_desc med;
2758 struct request_sense sense;
2759 int stat;
2761 if (slot_nr != CDSL_CURRENT)
2762 return -EINVAL;
2764 stat = cdrom_check_status(drive, &sense);
2765 if (!stat || sense.sense_key == UNIT_ATTENTION)
2766 return CDS_DISC_OK;
2768 if (!cdrom_get_media_event(cdi, &med)) {
2769 if (med.media_present)
2770 return CDS_DISC_OK;
2771 else if (med.door_open)
2772 return CDS_TRAY_OPEN;
2773 else
2774 return CDS_NO_DISC;
2777 if (sense.sense_key == NOT_READY && sense.asc == 0x04 && sense.ascq == 0x04)
2778 return CDS_DISC_OK;
2781 * If not using Mt Fuji extended media tray reports,
2782 * just return TRAY_OPEN since ATAPI doesn't provide
2783 * any other way to detect this...
2785 if (sense.sense_key == NOT_READY) {
2786 if (sense.asc == 0x3a && sense.ascq == 1)
2787 return CDS_NO_DISC;
2788 else
2789 return CDS_TRAY_OPEN;
2791 return CDS_DRIVE_NOT_READY;
2794 static
2795 int ide_cdrom_get_last_session (struct cdrom_device_info *cdi,
2796 struct cdrom_multisession *ms_info)
2798 struct atapi_toc *toc;
2799 ide_drive_t *drive = cdi->handle;
2800 struct cdrom_info *info = drive->driver_data;
2801 struct request_sense sense;
2802 int ret;
2804 if (!CDROM_STATE_FLAGS(drive)->toc_valid || info->toc == NULL)
2805 if ((ret = cdrom_read_toc(drive, &sense)))
2806 return ret;
2808 toc = info->toc;
2809 ms_info->addr.lba = toc->last_session_lba;
2810 ms_info->xa_flag = toc->xa_flag;
2812 return 0;
2815 static
2816 int ide_cdrom_get_mcn (struct cdrom_device_info *cdi,
2817 struct cdrom_mcn *mcn_info)
2819 int stat;
2820 char mcnbuf[24];
2821 ide_drive_t *drive = cdi->handle;
2823 /* get MCN */
2824 if ((stat = cdrom_read_subchannel(drive, 2, mcnbuf, sizeof (mcnbuf), NULL)))
2825 return stat;
2827 memcpy (mcn_info->medium_catalog_number, mcnbuf+9,
2828 sizeof (mcn_info->medium_catalog_number)-1);
2829 mcn_info->medium_catalog_number[sizeof (mcn_info->medium_catalog_number)-1]
2830 = '\0';
2832 return 0;
2837 /****************************************************************************
2838 * Other driver requests (open, close, check media change).
2841 static
2842 int ide_cdrom_check_media_change_real (struct cdrom_device_info *cdi,
2843 int slot_nr)
2845 ide_drive_t *drive = cdi->handle;
2846 int retval;
2848 if (slot_nr == CDSL_CURRENT) {
2849 (void) cdrom_check_status(drive, NULL);
2850 retval = CDROM_STATE_FLAGS(drive)->media_changed;
2851 CDROM_STATE_FLAGS(drive)->media_changed = 0;
2852 return retval;
2853 } else {
2854 return -EINVAL;
2859 static
2860 int ide_cdrom_open_real (struct cdrom_device_info *cdi, int purpose)
2862 return 0;
2866 * Close down the device. Invalidate all cached blocks.
2869 static
2870 void ide_cdrom_release_real (struct cdrom_device_info *cdi)
2872 ide_drive_t *drive = cdi->handle;
2874 if (!cdi->use_count)
2875 CDROM_STATE_FLAGS(drive)->toc_valid = 0;
2880 /****************************************************************************
2881 * Device initialization.
2883 static struct cdrom_device_ops ide_cdrom_dops = {
2884 .open = ide_cdrom_open_real,
2885 .release = ide_cdrom_release_real,
2886 .drive_status = ide_cdrom_drive_status,
2887 .media_changed = ide_cdrom_check_media_change_real,
2888 .tray_move = ide_cdrom_tray_move,
2889 .lock_door = ide_cdrom_lock_door,
2890 .select_speed = ide_cdrom_select_speed,
2891 .get_last_session = ide_cdrom_get_last_session,
2892 .get_mcn = ide_cdrom_get_mcn,
2893 .reset = ide_cdrom_reset,
2894 .audio_ioctl = ide_cdrom_audio_ioctl,
2895 .capability = CDC_CLOSE_TRAY | CDC_OPEN_TRAY | CDC_LOCK |
2896 CDC_SELECT_SPEED | CDC_SELECT_DISC |
2897 CDC_MULTI_SESSION | CDC_MCN |
2898 CDC_MEDIA_CHANGED | CDC_PLAY_AUDIO | CDC_RESET |
2899 CDC_DRIVE_STATUS | CDC_CD_R |
2900 CDC_CD_RW | CDC_DVD | CDC_DVD_R| CDC_DVD_RAM |
2901 CDC_GENERIC_PACKET | CDC_MO_DRIVE | CDC_MRW |
2902 CDC_MRW_W | CDC_RAM,
2903 .generic_packet = ide_cdrom_packet,
2906 static int ide_cdrom_register (ide_drive_t *drive, int nslots)
2908 struct cdrom_info *info = drive->driver_data;
2909 struct cdrom_device_info *devinfo = &info->devinfo;
2911 devinfo->ops = &ide_cdrom_dops;
2912 devinfo->mask = 0;
2913 devinfo->speed = CDROM_STATE_FLAGS(drive)->current_speed;
2914 devinfo->capacity = nslots;
2915 devinfo->handle = drive;
2916 strcpy(devinfo->name, drive->name);
2918 /* set capability mask to match the probe. */
2919 if (!CDROM_CONFIG_FLAGS(drive)->cd_r)
2920 devinfo->mask |= CDC_CD_R;
2921 if (!CDROM_CONFIG_FLAGS(drive)->cd_rw)
2922 devinfo->mask |= CDC_CD_RW;
2923 if (!CDROM_CONFIG_FLAGS(drive)->dvd)
2924 devinfo->mask |= CDC_DVD;
2925 if (!CDROM_CONFIG_FLAGS(drive)->dvd_r)
2926 devinfo->mask |= CDC_DVD_R;
2927 if (!CDROM_CONFIG_FLAGS(drive)->dvd_ram)
2928 devinfo->mask |= CDC_DVD_RAM;
2929 if (!CDROM_CONFIG_FLAGS(drive)->is_changer)
2930 devinfo->mask |= CDC_SELECT_DISC;
2931 if (!CDROM_CONFIG_FLAGS(drive)->audio_play)
2932 devinfo->mask |= CDC_PLAY_AUDIO;
2933 if (!CDROM_CONFIG_FLAGS(drive)->close_tray)
2934 devinfo->mask |= CDC_CLOSE_TRAY;
2935 if (!CDROM_CONFIG_FLAGS(drive)->mo_drive)
2936 devinfo->mask |= CDC_MO_DRIVE;
2937 if (!CDROM_CONFIG_FLAGS(drive)->ram)
2938 devinfo->mask |= CDC_RAM;
2940 devinfo->disk = info->disk;
2941 return register_cdrom(devinfo);
2944 static
2945 int ide_cdrom_probe_capabilities (ide_drive_t *drive)
2947 struct cdrom_info *info = drive->driver_data;
2948 struct cdrom_device_info *cdi = &info->devinfo;
2949 struct atapi_capabilities_page cap;
2950 int nslots = 1;
2952 if (drive->media == ide_optical) {
2953 CDROM_CONFIG_FLAGS(drive)->mo_drive = 1;
2954 CDROM_CONFIG_FLAGS(drive)->ram = 1;
2955 printk(KERN_ERR "%s: ATAPI magneto-optical drive\n", drive->name);
2956 return nslots;
2959 if (CDROM_CONFIG_FLAGS(drive)->nec260 ||
2960 !strcmp(drive->id->model,"STINGRAY 8422 IDE 8X CD-ROM 7-27-95")) {
2961 CDROM_CONFIG_FLAGS(drive)->no_eject = 0;
2962 CDROM_CONFIG_FLAGS(drive)->audio_play = 1;
2963 return nslots;
2967 * we have to cheat a little here. the packet will eventually
2968 * be queued with ide_cdrom_packet(), which extracts the
2969 * drive from cdi->handle. Since this device hasn't been
2970 * registered with the Uniform layer yet, it can't do this.
2971 * Same goes for cdi->ops.
2973 cdi->handle = drive;
2974 cdi->ops = &ide_cdrom_dops;
2976 if (ide_cdrom_get_capabilities(drive, &cap))
2977 return 0;
2979 if (cap.lock == 0)
2980 CDROM_CONFIG_FLAGS(drive)->no_doorlock = 1;
2981 if (cap.eject)
2982 CDROM_CONFIG_FLAGS(drive)->no_eject = 0;
2983 if (cap.cd_r_write)
2984 CDROM_CONFIG_FLAGS(drive)->cd_r = 1;
2985 if (cap.cd_rw_write) {
2986 CDROM_CONFIG_FLAGS(drive)->cd_rw = 1;
2987 CDROM_CONFIG_FLAGS(drive)->ram = 1;
2989 if (cap.test_write)
2990 CDROM_CONFIG_FLAGS(drive)->test_write = 1;
2991 if (cap.dvd_ram_read || cap.dvd_r_read || cap.dvd_rom)
2992 CDROM_CONFIG_FLAGS(drive)->dvd = 1;
2993 if (cap.dvd_ram_write) {
2994 CDROM_CONFIG_FLAGS(drive)->dvd_ram = 1;
2995 CDROM_CONFIG_FLAGS(drive)->ram = 1;
2997 if (cap.dvd_r_write)
2998 CDROM_CONFIG_FLAGS(drive)->dvd_r = 1;
2999 if (cap.audio_play)
3000 CDROM_CONFIG_FLAGS(drive)->audio_play = 1;
3001 if (cap.mechtype == mechtype_caddy || cap.mechtype == mechtype_popup)
3002 CDROM_CONFIG_FLAGS(drive)->close_tray = 0;
3004 /* Some drives used by Apple don't advertise audio play
3005 * but they do support reading TOC & audio datas
3007 if (strcmp(drive->id->model, "MATSHITADVD-ROM SR-8187") == 0 ||
3008 strcmp(drive->id->model, "MATSHITADVD-ROM SR-8186") == 0 ||
3009 strcmp(drive->id->model, "MATSHITADVD-ROM SR-8176") == 0 ||
3010 strcmp(drive->id->model, "MATSHITADVD-ROM SR-8174") == 0)
3011 CDROM_CONFIG_FLAGS(drive)->audio_play = 1;
3013 #if ! STANDARD_ATAPI
3014 if (cdi->sanyo_slot > 0) {
3015 CDROM_CONFIG_FLAGS(drive)->is_changer = 1;
3016 nslots = 3;
3019 else
3020 #endif /* not STANDARD_ATAPI */
3021 if (cap.mechtype == mechtype_individual_changer ||
3022 cap.mechtype == mechtype_cartridge_changer) {
3023 if ((nslots = cdrom_number_of_slots(cdi)) > 1) {
3024 CDROM_CONFIG_FLAGS(drive)->is_changer = 1;
3025 CDROM_CONFIG_FLAGS(drive)->supp_disc_present = 1;
3029 ide_cdrom_update_speed(drive, &cap);
3030 /* don't print speed if the drive reported 0.
3032 printk(KERN_INFO "%s: ATAPI", drive->name);
3033 if (CDROM_CONFIG_FLAGS(drive)->max_speed)
3034 printk(" %dX", CDROM_CONFIG_FLAGS(drive)->max_speed);
3035 printk(" %s", CDROM_CONFIG_FLAGS(drive)->dvd ? "DVD-ROM" : "CD-ROM");
3037 if (CDROM_CONFIG_FLAGS(drive)->dvd_r|CDROM_CONFIG_FLAGS(drive)->dvd_ram)
3038 printk(" DVD%s%s",
3039 (CDROM_CONFIG_FLAGS(drive)->dvd_r)? "-R" : "",
3040 (CDROM_CONFIG_FLAGS(drive)->dvd_ram)? "-RAM" : "");
3042 if (CDROM_CONFIG_FLAGS(drive)->cd_r|CDROM_CONFIG_FLAGS(drive)->cd_rw)
3043 printk(" CD%s%s",
3044 (CDROM_CONFIG_FLAGS(drive)->cd_r)? "-R" : "",
3045 (CDROM_CONFIG_FLAGS(drive)->cd_rw)? "/RW" : "");
3047 if (CDROM_CONFIG_FLAGS(drive)->is_changer)
3048 printk(" changer w/%d slots", nslots);
3049 else
3050 printk(" drive");
3052 printk(", %dkB Cache", be16_to_cpu(cap.buffer_size));
3054 if (drive->using_dma)
3055 ide_dma_verbose(drive);
3057 printk("\n");
3059 return nslots;
3062 #ifdef CONFIG_IDE_PROC_FS
3063 static void ide_cdrom_add_settings(ide_drive_t *drive)
3065 ide_add_setting(drive, "dsc_overlap", SETTING_RW, TYPE_BYTE, 0, 1, 1, 1, &drive->dsc_overlap, NULL);
3067 #else
3068 static inline void ide_cdrom_add_settings(ide_drive_t *drive) { ; }
3069 #endif
3072 * standard prep_rq_fn that builds 10 byte cmds
3074 static int ide_cdrom_prep_fs(struct request_queue *q, struct request *rq)
3076 int hard_sect = queue_hardsect_size(q);
3077 long block = (long)rq->hard_sector / (hard_sect >> 9);
3078 unsigned long blocks = rq->hard_nr_sectors / (hard_sect >> 9);
3080 memset(rq->cmd, 0, sizeof(rq->cmd));
3082 if (rq_data_dir(rq) == READ)
3083 rq->cmd[0] = GPCMD_READ_10;
3084 else
3085 rq->cmd[0] = GPCMD_WRITE_10;
3088 * fill in lba
3090 rq->cmd[2] = (block >> 24) & 0xff;
3091 rq->cmd[3] = (block >> 16) & 0xff;
3092 rq->cmd[4] = (block >> 8) & 0xff;
3093 rq->cmd[5] = block & 0xff;
3096 * and transfer length
3098 rq->cmd[7] = (blocks >> 8) & 0xff;
3099 rq->cmd[8] = blocks & 0xff;
3100 rq->cmd_len = 10;
3101 return BLKPREP_OK;
3105 * Most of the SCSI commands are supported directly by ATAPI devices.
3106 * This transform handles the few exceptions.
3108 static int ide_cdrom_prep_pc(struct request *rq)
3110 u8 *c = rq->cmd;
3113 * Transform 6-byte read/write commands to the 10-byte version
3115 if (c[0] == READ_6 || c[0] == WRITE_6) {
3116 c[8] = c[4];
3117 c[5] = c[3];
3118 c[4] = c[2];
3119 c[3] = c[1] & 0x1f;
3120 c[2] = 0;
3121 c[1] &= 0xe0;
3122 c[0] += (READ_10 - READ_6);
3123 rq->cmd_len = 10;
3124 return BLKPREP_OK;
3128 * it's silly to pretend we understand 6-byte sense commands, just
3129 * reject with ILLEGAL_REQUEST and the caller should take the
3130 * appropriate action
3132 if (c[0] == MODE_SENSE || c[0] == MODE_SELECT) {
3133 rq->errors = ILLEGAL_REQUEST;
3134 return BLKPREP_KILL;
3137 return BLKPREP_OK;
3140 static int ide_cdrom_prep_fn(struct request_queue *q, struct request *rq)
3142 if (blk_fs_request(rq))
3143 return ide_cdrom_prep_fs(q, rq);
3144 else if (blk_pc_request(rq))
3145 return ide_cdrom_prep_pc(rq);
3147 return 0;
3150 static
3151 int ide_cdrom_setup (ide_drive_t *drive)
3153 struct cdrom_info *info = drive->driver_data;
3154 struct cdrom_device_info *cdi = &info->devinfo;
3155 int nslots;
3157 blk_queue_prep_rq(drive->queue, ide_cdrom_prep_fn);
3158 blk_queue_dma_alignment(drive->queue, 31);
3159 drive->queue->unplug_delay = (1 * HZ) / 1000;
3160 if (!drive->queue->unplug_delay)
3161 drive->queue->unplug_delay = 1;
3163 drive->special.all = 0;
3165 CDROM_STATE_FLAGS(drive)->media_changed = 1;
3166 CDROM_STATE_FLAGS(drive)->toc_valid = 0;
3167 CDROM_STATE_FLAGS(drive)->door_locked = 0;
3169 #if NO_DOOR_LOCKING
3170 CDROM_CONFIG_FLAGS(drive)->no_doorlock = 1;
3171 #else
3172 CDROM_CONFIG_FLAGS(drive)->no_doorlock = 0;
3173 #endif
3175 CDROM_CONFIG_FLAGS(drive)->drq_interrupt = ((drive->id->config & 0x0060) == 0x20);
3176 CDROM_CONFIG_FLAGS(drive)->is_changer = 0;
3177 CDROM_CONFIG_FLAGS(drive)->cd_r = 0;
3178 CDROM_CONFIG_FLAGS(drive)->cd_rw = 0;
3179 CDROM_CONFIG_FLAGS(drive)->test_write = 0;
3180 CDROM_CONFIG_FLAGS(drive)->dvd = 0;
3181 CDROM_CONFIG_FLAGS(drive)->dvd_r = 0;
3182 CDROM_CONFIG_FLAGS(drive)->dvd_ram = 0;
3183 CDROM_CONFIG_FLAGS(drive)->no_eject = 1;
3184 CDROM_CONFIG_FLAGS(drive)->supp_disc_present = 0;
3185 CDROM_CONFIG_FLAGS(drive)->audio_play = 0;
3186 CDROM_CONFIG_FLAGS(drive)->close_tray = 1;
3188 /* limit transfer size per interrupt. */
3189 CDROM_CONFIG_FLAGS(drive)->limit_nframes = 0;
3190 /* a testament to the nice quality of Samsung drives... */
3191 if (!strcmp(drive->id->model, "SAMSUNG CD-ROM SCR-2430"))
3192 CDROM_CONFIG_FLAGS(drive)->limit_nframes = 1;
3193 else if (!strcmp(drive->id->model, "SAMSUNG CD-ROM SCR-2432"))
3194 CDROM_CONFIG_FLAGS(drive)->limit_nframes = 1;
3195 /* the 3231 model does not support the SET_CD_SPEED command */
3196 else if (!strcmp(drive->id->model, "SAMSUNG CD-ROM SCR-3231"))
3197 cdi->mask |= CDC_SELECT_SPEED;
3199 #if ! STANDARD_ATAPI
3200 /* by default Sanyo 3 CD changer support is turned off and
3201 ATAPI Rev 2.2+ standard support for CD changers is used */
3202 cdi->sanyo_slot = 0;
3204 CDROM_CONFIG_FLAGS(drive)->nec260 = 0;
3205 CDROM_CONFIG_FLAGS(drive)->toctracks_as_bcd = 0;
3206 CDROM_CONFIG_FLAGS(drive)->tocaddr_as_bcd = 0;
3207 CDROM_CONFIG_FLAGS(drive)->playmsf_as_bcd = 0;
3208 CDROM_CONFIG_FLAGS(drive)->subchan_as_bcd = 0;
3210 if (strcmp (drive->id->model, "V003S0DS") == 0 &&
3211 drive->id->fw_rev[4] == '1' &&
3212 drive->id->fw_rev[6] <= '2') {
3213 /* Vertos 300.
3214 Some versions of this drive like to talk BCD. */
3215 CDROM_CONFIG_FLAGS(drive)->toctracks_as_bcd = 1;
3216 CDROM_CONFIG_FLAGS(drive)->tocaddr_as_bcd = 1;
3217 CDROM_CONFIG_FLAGS(drive)->playmsf_as_bcd = 1;
3218 CDROM_CONFIG_FLAGS(drive)->subchan_as_bcd = 1;
3221 else if (strcmp (drive->id->model, "V006E0DS") == 0 &&
3222 drive->id->fw_rev[4] == '1' &&
3223 drive->id->fw_rev[6] <= '2') {
3224 /* Vertos 600 ESD. */
3225 CDROM_CONFIG_FLAGS(drive)->toctracks_as_bcd = 1;
3227 else if (strcmp(drive->id->model, "NEC CD-ROM DRIVE:260") == 0 &&
3228 strncmp(drive->id->fw_rev, "1.01", 4) == 0) { /* FIXME */
3229 /* Old NEC260 (not R).
3230 This drive was released before the 1.2 version
3231 of the spec. */
3232 CDROM_CONFIG_FLAGS(drive)->tocaddr_as_bcd = 1;
3233 CDROM_CONFIG_FLAGS(drive)->playmsf_as_bcd = 1;
3234 CDROM_CONFIG_FLAGS(drive)->subchan_as_bcd = 1;
3235 CDROM_CONFIG_FLAGS(drive)->nec260 = 1;
3237 else if (strcmp(drive->id->model, "WEARNES CDD-120") == 0 &&
3238 strncmp(drive->id->fw_rev, "A1.1", 4) == 0) { /* FIXME */
3239 /* Wearnes */
3240 CDROM_CONFIG_FLAGS(drive)->playmsf_as_bcd = 1;
3241 CDROM_CONFIG_FLAGS(drive)->subchan_as_bcd = 1;
3243 /* Sanyo 3 CD changer uses a non-standard command
3244 for CD changing */
3245 else if ((strcmp(drive->id->model, "CD-ROM CDR-C3 G") == 0) ||
3246 (strcmp(drive->id->model, "CD-ROM CDR-C3G") == 0) ||
3247 (strcmp(drive->id->model, "CD-ROM CDR_C36") == 0)) {
3248 /* uses CD in slot 0 when value is set to 3 */
3249 cdi->sanyo_slot = 3;
3251 #endif /* not STANDARD_ATAPI */
3253 info->toc = NULL;
3254 info->buffer = NULL;
3255 info->sector_buffered = 0;
3256 info->nsectors_buffered = 0;
3257 info->changer_info = NULL;
3258 info->last_block = 0;
3259 info->start_seek = 0;
3261 nslots = ide_cdrom_probe_capabilities (drive);
3264 * set correct block size
3266 blk_queue_hardsect_size(drive->queue, CD_FRAMESIZE);
3268 if (drive->autotune == IDE_TUNE_DEFAULT ||
3269 drive->autotune == IDE_TUNE_AUTO)
3270 drive->dsc_overlap = (drive->next != drive);
3272 if (ide_cdrom_register(drive, nslots)) {
3273 printk (KERN_ERR "%s: ide_cdrom_setup failed to register device with the cdrom driver.\n", drive->name);
3274 info->devinfo.handle = NULL;
3275 return 1;
3277 ide_cdrom_add_settings(drive);
3278 return 0;
3281 #ifdef CONFIG_IDE_PROC_FS
3282 static
3283 sector_t ide_cdrom_capacity (ide_drive_t *drive)
3285 unsigned long capacity, sectors_per_frame;
3287 if (cdrom_read_capacity(drive, &capacity, &sectors_per_frame, NULL))
3288 return 0;
3290 return capacity * sectors_per_frame;
3292 #endif
3294 static void ide_cd_remove(ide_drive_t *drive)
3296 struct cdrom_info *info = drive->driver_data;
3298 ide_proc_unregister_driver(drive, info->driver);
3300 del_gendisk(info->disk);
3302 ide_cd_put(info);
3305 static void ide_cd_release(struct kref *kref)
3307 struct cdrom_info *info = to_ide_cd(kref);
3308 struct cdrom_device_info *devinfo = &info->devinfo;
3309 ide_drive_t *drive = info->drive;
3310 struct gendisk *g = info->disk;
3312 kfree(info->buffer);
3313 kfree(info->toc);
3314 kfree(info->changer_info);
3315 if (devinfo->handle == drive && unregister_cdrom(devinfo))
3316 printk(KERN_ERR "%s: %s failed to unregister device from the cdrom "
3317 "driver.\n", __FUNCTION__, drive->name);
3318 drive->dsc_overlap = 0;
3319 drive->driver_data = NULL;
3320 blk_queue_prep_rq(drive->queue, NULL);
3321 g->private_data = NULL;
3322 put_disk(g);
3323 kfree(info);
3326 static int ide_cd_probe(ide_drive_t *);
3328 #ifdef CONFIG_IDE_PROC_FS
3329 static int proc_idecd_read_capacity
3330 (char *page, char **start, off_t off, int count, int *eof, void *data)
3332 ide_drive_t *drive = data;
3333 int len;
3335 len = sprintf(page,"%llu\n", (long long)ide_cdrom_capacity(drive));
3336 PROC_IDE_READ_RETURN(page,start,off,count,eof,len);
3339 static ide_proc_entry_t idecd_proc[] = {
3340 { "capacity", S_IFREG|S_IRUGO, proc_idecd_read_capacity, NULL },
3341 { NULL, 0, NULL, NULL }
3343 #endif
3345 static ide_driver_t ide_cdrom_driver = {
3346 .gen_driver = {
3347 .owner = THIS_MODULE,
3348 .name = "ide-cdrom",
3349 .bus = &ide_bus_type,
3351 .probe = ide_cd_probe,
3352 .remove = ide_cd_remove,
3353 .version = IDECD_VERSION,
3354 .media = ide_cdrom,
3355 .supports_dsc_overlap = 1,
3356 .do_request = ide_do_rw_cdrom,
3357 .end_request = ide_end_request,
3358 .error = __ide_error,
3359 .abort = __ide_abort,
3360 #ifdef CONFIG_IDE_PROC_FS
3361 .proc = idecd_proc,
3362 #endif
3365 static int idecd_open(struct inode * inode, struct file * file)
3367 struct gendisk *disk = inode->i_bdev->bd_disk;
3368 struct cdrom_info *info;
3369 int rc = -ENOMEM;
3371 if (!(info = ide_cd_get(disk)))
3372 return -ENXIO;
3374 if (!info->buffer)
3375 info->buffer = kmalloc(SECTOR_BUFFER_SIZE, GFP_KERNEL|__GFP_REPEAT);
3377 if (info->buffer)
3378 rc = cdrom_open(&info->devinfo, inode, file);
3380 if (rc < 0)
3381 ide_cd_put(info);
3383 return rc;
3386 static int idecd_release(struct inode * inode, struct file * file)
3388 struct gendisk *disk = inode->i_bdev->bd_disk;
3389 struct cdrom_info *info = ide_cd_g(disk);
3391 cdrom_release (&info->devinfo, file);
3393 ide_cd_put(info);
3395 return 0;
3398 static int idecd_set_spindown(struct cdrom_device_info *cdi, unsigned long arg)
3400 struct packet_command cgc;
3401 char buffer[16];
3402 int stat;
3403 char spindown;
3405 if (copy_from_user(&spindown, (void __user *)arg, sizeof(char)))
3406 return -EFAULT;
3408 init_cdrom_command(&cgc, buffer, sizeof(buffer), CGC_DATA_UNKNOWN);
3410 stat = cdrom_mode_sense(cdi, &cgc, GPMODE_CDROM_PAGE, 0);
3411 if (stat)
3412 return stat;
3414 buffer[11] = (buffer[11] & 0xf0) | (spindown & 0x0f);
3415 return cdrom_mode_select(cdi, &cgc);
3418 static int idecd_get_spindown(struct cdrom_device_info *cdi, unsigned long arg)
3420 struct packet_command cgc;
3421 char buffer[16];
3422 int stat;
3423 char spindown;
3425 init_cdrom_command(&cgc, buffer, sizeof(buffer), CGC_DATA_UNKNOWN);
3427 stat = cdrom_mode_sense(cdi, &cgc, GPMODE_CDROM_PAGE, 0);
3428 if (stat)
3429 return stat;
3431 spindown = buffer[11] & 0x0f;
3432 if (copy_to_user((void __user *)arg, &spindown, sizeof (char)))
3433 return -EFAULT;
3434 return 0;
3437 static int idecd_ioctl (struct inode *inode, struct file *file,
3438 unsigned int cmd, unsigned long arg)
3440 struct block_device *bdev = inode->i_bdev;
3441 struct cdrom_info *info = ide_cd_g(bdev->bd_disk);
3442 int err;
3444 switch (cmd) {
3445 case CDROMSETSPINDOWN:
3446 return idecd_set_spindown(&info->devinfo, arg);
3447 case CDROMGETSPINDOWN:
3448 return idecd_get_spindown(&info->devinfo, arg);
3449 default:
3450 break;
3453 err = generic_ide_ioctl(info->drive, file, bdev, cmd, arg);
3454 if (err == -EINVAL)
3455 err = cdrom_ioctl(file, &info->devinfo, inode, cmd, arg);
3457 return err;
3460 static int idecd_media_changed(struct gendisk *disk)
3462 struct cdrom_info *info = ide_cd_g(disk);
3463 return cdrom_media_changed(&info->devinfo);
3466 static int idecd_revalidate_disk(struct gendisk *disk)
3468 struct cdrom_info *info = ide_cd_g(disk);
3469 struct request_sense sense;
3470 cdrom_read_toc(info->drive, &sense);
3471 return 0;
3474 static struct block_device_operations idecd_ops = {
3475 .owner = THIS_MODULE,
3476 .open = idecd_open,
3477 .release = idecd_release,
3478 .ioctl = idecd_ioctl,
3479 .media_changed = idecd_media_changed,
3480 .revalidate_disk= idecd_revalidate_disk
3483 /* options */
3484 static char *ignore = NULL;
3486 module_param(ignore, charp, 0400);
3487 MODULE_DESCRIPTION("ATAPI CD-ROM Driver");
3489 static int ide_cd_probe(ide_drive_t *drive)
3491 struct cdrom_info *info;
3492 struct gendisk *g;
3493 struct request_sense sense;
3495 if (!strstr("ide-cdrom", drive->driver_req))
3496 goto failed;
3497 if (!drive->present)
3498 goto failed;
3499 if (drive->media != ide_cdrom && drive->media != ide_optical)
3500 goto failed;
3501 /* skip drives that we were told to ignore */
3502 if (ignore != NULL) {
3503 if (strstr(ignore, drive->name)) {
3504 printk(KERN_INFO "ide-cd: ignoring drive %s\n", drive->name);
3505 goto failed;
3508 if (drive->scsi) {
3509 printk(KERN_INFO "ide-cd: passing drive %s to ide-scsi emulation.\n", drive->name);
3510 goto failed;
3512 info = kzalloc(sizeof(struct cdrom_info), GFP_KERNEL);
3513 if (info == NULL) {
3514 printk(KERN_ERR "%s: Can't allocate a cdrom structure\n", drive->name);
3515 goto failed;
3518 g = alloc_disk(1 << PARTN_BITS);
3519 if (!g)
3520 goto out_free_cd;
3522 ide_init_disk(g, drive);
3524 ide_proc_register_driver(drive, &ide_cdrom_driver);
3526 kref_init(&info->kref);
3528 info->drive = drive;
3529 info->driver = &ide_cdrom_driver;
3530 info->disk = g;
3532 g->private_data = &info->driver;
3534 drive->driver_data = info;
3536 g->minors = 1;
3537 g->driverfs_dev = &drive->gendev;
3538 g->flags = GENHD_FL_CD | GENHD_FL_REMOVABLE;
3539 if (ide_cdrom_setup(drive)) {
3540 struct cdrom_device_info *devinfo = &info->devinfo;
3541 ide_proc_unregister_driver(drive, &ide_cdrom_driver);
3542 kfree(info->buffer);
3543 kfree(info->toc);
3544 kfree(info->changer_info);
3545 if (devinfo->handle == drive && unregister_cdrom(devinfo))
3546 printk (KERN_ERR "%s: ide_cdrom_cleanup failed to unregister device from the cdrom driver.\n", drive->name);
3547 kfree(info);
3548 drive->driver_data = NULL;
3549 goto failed;
3552 cdrom_read_toc(drive, &sense);
3553 g->fops = &idecd_ops;
3554 g->flags |= GENHD_FL_REMOVABLE;
3555 add_disk(g);
3556 return 0;
3558 out_free_cd:
3559 kfree(info);
3560 failed:
3561 return -ENODEV;
3564 static void __exit ide_cdrom_exit(void)
3566 driver_unregister(&ide_cdrom_driver.gen_driver);
3569 static int __init ide_cdrom_init(void)
3571 return driver_register(&ide_cdrom_driver.gen_driver);
3574 MODULE_ALIAS("ide:*m-cdrom*");
3575 module_init(ide_cdrom_init);
3576 module_exit(ide_cdrom_exit);
3577 MODULE_LICENSE("GPL");