4 * Copyright (C) 1994-1996 Scott Snyder <snyder@fnald0.fnal.gov>
5 * Copyright (C) 1996-1998 Erik Andersen <andersee@debian.org>
6 * Copyright (C) 1998-2000 Jens Axboe <axboe@suse.de>
7 * Copyright (C) 2005, 2007 Bartlomiej Zolnierkiewicz
9 * May be copied or modified under the terms of the GNU General Public
10 * License. See linux/COPYING for more information.
12 * See Documentation/cdrom/ide-cd for usage information.
14 * Suggestions are welcome. Patches that work are more welcome though. ;-)
17 * Mt. Fuji (SFF8090 version 4) and ATAPI (SFF-8020i rev 2.6) standards.
19 * For historical changelog please see:
20 * Documentation/ide/ChangeLog.ide-cd.1994-2004
23 #define DRV_NAME "ide-cd"
24 #define PFX DRV_NAME ": "
26 #define IDECD_VERSION "5.00"
28 #include <linux/module.h>
29 #include <linux/types.h>
30 #include <linux/kernel.h>
31 #include <linux/delay.h>
32 #include <linux/timer.h>
33 #include <linux/slab.h>
34 #include <linux/interrupt.h>
35 #include <linux/errno.h>
36 #include <linux/cdrom.h>
37 #include <linux/ide.h>
38 #include <linux/completion.h>
39 #include <linux/mutex.h>
40 #include <linux/bcd.h>
42 /* For SCSI -> ATAPI command conversion */
43 #include <scsi/scsi.h>
45 #include <linux/irq.h>
47 #include <asm/byteorder.h>
48 #include <linux/uaccess.h>
49 #include <asm/unaligned.h>
53 static DEFINE_MUTEX(idecd_ref_mutex
);
55 static void ide_cd_release(struct device
*);
57 static struct cdrom_info
*ide_cd_get(struct gendisk
*disk
)
59 struct cdrom_info
*cd
= NULL
;
61 mutex_lock(&idecd_ref_mutex
);
62 cd
= ide_drv_g(disk
, cdrom_info
);
64 if (ide_device_get(cd
->drive
))
70 mutex_unlock(&idecd_ref_mutex
);
74 static void ide_cd_put(struct cdrom_info
*cd
)
76 ide_drive_t
*drive
= cd
->drive
;
78 mutex_lock(&idecd_ref_mutex
);
80 ide_device_put(drive
);
81 mutex_unlock(&idecd_ref_mutex
);
85 * Generic packet command support and error handling routines.
88 /* Mark that we've seen a media change and invalidate our internal buffers. */
89 static void cdrom_saw_media_change(ide_drive_t
*drive
)
91 drive
->dev_flags
|= IDE_DFLAG_MEDIA_CHANGED
;
92 drive
->atapi_flags
&= ~IDE_AFLAG_TOC_VALID
;
95 static int cdrom_log_sense(ide_drive_t
*drive
, struct request
*rq
,
96 struct request_sense
*sense
)
100 ide_debug_log(IDE_DBG_SENSE
, "sense_key: 0x%x", sense
->sense_key
);
102 if (!sense
|| !rq
|| (rq
->cmd_flags
& REQ_QUIET
))
105 switch (sense
->sense_key
) {
107 case RECOVERED_ERROR
:
111 * don't care about tray state messages for e.g. capacity
112 * commands or in-progress or becoming ready
114 if (sense
->asc
== 0x3a || sense
->asc
== 0x04)
118 case ILLEGAL_REQUEST
:
120 * don't log START_STOP unit with LoEj set, since we cannot
121 * reliably check if drive can auto-close
123 if (rq
->cmd
[0] == GPCMD_START_STOP_UNIT
&& sense
->asc
== 0x24)
129 * Make good and sure we've seen this potential media change.
130 * Some drives (i.e. Creative) fail to present the correct sense
131 * key in the error register.
133 cdrom_saw_media_change(drive
);
142 static void cdrom_analyze_sense_data(ide_drive_t
*drive
,
143 struct request
*failed_command
,
144 struct request_sense
*sense
)
146 unsigned long sector
;
147 unsigned long bio_sectors
;
148 struct cdrom_info
*info
= drive
->driver_data
;
150 ide_debug_log(IDE_DBG_SENSE
, "error_code: 0x%x, sense_key: 0x%x",
151 sense
->error_code
, sense
->sense_key
);
154 ide_debug_log(IDE_DBG_SENSE
, "failed cmd: 0x%x",
155 failed_command
->cmd
[0]);
157 if (!cdrom_log_sense(drive
, failed_command
, sense
))
161 * If a read toc is executed for a CD-R or CD-RW medium where the first
162 * toc has not been recorded yet, it will fail with 05/24/00 (which is a
165 if (failed_command
&& failed_command
->cmd
[0] == GPCMD_READ_TOC_PMA_ATIP
)
166 if (sense
->sense_key
== 0x05 && sense
->asc
== 0x24)
170 if (sense
->error_code
== 0x70) {
171 switch (sense
->sense_key
) {
173 case VOLUME_OVERFLOW
:
174 case ILLEGAL_REQUEST
:
177 if (failed_command
== NULL
||
178 !blk_fs_request(failed_command
))
180 sector
= (sense
->information
[0] << 24) |
181 (sense
->information
[1] << 16) |
182 (sense
->information
[2] << 8) |
183 (sense
->information
[3]);
185 if (drive
->queue
->hardsect_size
== 2048)
186 /* device sector size is 2K */
189 bio_sectors
= max(bio_sectors(failed_command
->bio
), 4U);
190 sector
&= ~(bio_sectors
- 1);
193 * The SCSI specification allows for the value
194 * returned by READ CAPACITY to be up to 75 2K
195 * sectors past the last readable block.
196 * Therefore, if we hit a medium error within the
197 * last 75 2K sectors, we decrease the saved size
200 if (sector
< get_capacity(info
->disk
) &&
201 drive
->probed_capacity
- sector
< 4 * 75)
202 set_capacity(info
->disk
, sector
);
206 ide_cd_log_error(drive
->name
, failed_command
, sense
);
209 static void cdrom_queue_request_sense(ide_drive_t
*drive
, void *sense
,
210 struct request
*failed_command
)
212 struct cdrom_info
*info
= drive
->driver_data
;
213 struct request
*rq
= &drive
->request_sense_rq
;
215 ide_debug_log(IDE_DBG_SENSE
, "enter");
218 sense
= &info
->sense_data
;
220 /* stuff the sense request in front of our current request */
221 blk_rq_init(NULL
, rq
);
222 rq
->cmd_type
= REQ_TYPE_ATA_PC
;
223 rq
->rq_disk
= info
->disk
;
226 rq
->cmd
[0] = GPCMD_REQUEST_SENSE
;
230 rq
->cmd_type
= REQ_TYPE_SENSE
;
231 rq
->cmd_flags
|= REQ_PREEMPT
;
233 /* NOTE! Save the failed command in "rq->buffer" */
234 rq
->buffer
= (void *) failed_command
;
237 ide_debug_log(IDE_DBG_SENSE
, "failed_cmd: 0x%x",
238 failed_command
->cmd
[0]);
240 drive
->hwif
->rq
= NULL
;
242 elv_add_request(drive
->queue
, rq
, ELEVATOR_INSERT_FRONT
, 0);
245 static void cdrom_end_request(ide_drive_t
*drive
, int uptodate
)
247 struct request
*rq
= drive
->hwif
->rq
;
248 int nsectors
= rq
->hard_cur_sectors
;
250 ide_debug_log(IDE_DBG_FUNC
, "cmd: 0x%x, uptodate: 0x%x, nsectors: %d",
251 rq
->cmd
[0], uptodate
, nsectors
);
253 if (blk_sense_request(rq
) && uptodate
) {
255 * For REQ_TYPE_SENSE, "rq->buffer" points to the original
258 struct request
*failed
= (struct request
*) rq
->buffer
;
259 struct cdrom_info
*info
= drive
->driver_data
;
260 void *sense
= &info
->sense_data
;
264 sense
= failed
->sense
;
265 failed
->sense_len
= rq
->sense_len
;
267 cdrom_analyze_sense_data(drive
, failed
, sense
);
269 if (ide_end_rq(drive
, failed
, -EIO
,
270 blk_rq_bytes(failed
)))
273 cdrom_analyze_sense_data(drive
, NULL
, sense
);
276 if (!rq
->current_nr_sectors
&& blk_fs_request(rq
))
278 /* make sure it's fully ended */
279 if (blk_pc_request(rq
))
280 nsectors
= (rq
->data_len
+ 511) >> 9;
284 ide_debug_log(IDE_DBG_FUNC
, "uptodate: 0x%x, nsectors: %d",
287 if (blk_fs_request(rq
) == 0 && uptodate
<= 0 && rq
->errors
== 0)
290 ide_complete_rq(drive
, uptodate
? 0 : -EIO
, nsectors
<< 9);
293 static void ide_dump_status_no_sense(ide_drive_t
*drive
, const char *msg
, u8 st
)
297 ide_dump_status(drive
, msg
, st
);
302 * 0: if the request should be continued.
303 * 1: if the request was ended.
305 static int cdrom_decode_status(ide_drive_t
*drive
, int good_stat
, int *stat_ret
)
307 ide_hwif_t
*hwif
= drive
->hwif
;
308 struct request
*rq
= hwif
->rq
;
309 int stat
, err
, sense_key
;
311 /* check for errors */
312 stat
= hwif
->tp_ops
->read_status(hwif
);
317 if (OK_STAT(stat
, good_stat
, BAD_R_STAT
))
320 /* get the IDE error register */
321 err
= ide_read_error(drive
);
322 sense_key
= err
>> 4;
325 printk(KERN_ERR PFX
"%s: missing rq in %s\n",
326 drive
->name
, __func__
);
330 ide_debug_log(IDE_DBG_RQ
, "stat: 0x%x, good_stat: 0x%x, cmd[0]: 0x%x, "
331 "rq->cmd_type: 0x%x, err: 0x%x",
332 stat
, good_stat
, rq
->cmd
[0], rq
->cmd_type
,
335 if (blk_sense_request(rq
)) {
337 * We got an error trying to get sense info from the drive
338 * (probably while trying to recover from a former error).
341 rq
->cmd_flags
|= REQ_FAILED
;
342 cdrom_end_request(drive
, 0);
343 ide_error(drive
, "request sense failure", stat
);
346 } else if (blk_pc_request(rq
) || rq
->cmd_type
== REQ_TYPE_ATA_PC
) {
347 /* All other functions, except for READ. */
350 * if we have an error, pass back CHECK_CONDITION as the
353 if (blk_pc_request(rq
) && !rq
->errors
)
354 rq
->errors
= SAM_STAT_CHECK_CONDITION
;
356 /* check for tray open */
357 if (sense_key
== NOT_READY
) {
358 cdrom_saw_media_change(drive
);
359 } else if (sense_key
== UNIT_ATTENTION
) {
360 /* check for media change */
361 cdrom_saw_media_change(drive
);
363 } else if (sense_key
== ILLEGAL_REQUEST
&&
364 rq
->cmd
[0] == GPCMD_START_STOP_UNIT
) {
366 * Don't print error message for this condition--
367 * SFF8090i indicates that 5/24/00 is the correct
368 * response to a request to close the tray if the
369 * drive doesn't have that capability.
370 * cdrom_log_sense() knows this!
372 } else if (!(rq
->cmd_flags
& REQ_QUIET
)) {
373 /* otherwise, print an error */
374 ide_dump_status(drive
, "packet command error", stat
);
377 rq
->cmd_flags
|= REQ_FAILED
;
380 * instead of playing games with moving completions around,
381 * remove failed request completely and end it when the
382 * request sense has completed
386 } else if (blk_fs_request(rq
)) {
387 int do_end_request
= 0;
389 /* handle errors from READ and WRITE requests */
391 if (blk_noretry_request(rq
))
394 if (sense_key
== NOT_READY
) {
396 if (rq_data_dir(rq
) == READ
) {
397 cdrom_saw_media_change(drive
);
399 /* fail the request */
400 printk(KERN_ERR PFX
"%s: tray open\n",
404 struct cdrom_info
*info
= drive
->driver_data
;
407 * Allow the drive 5 seconds to recover, some
408 * devices will return this error while flushing
412 info
->write_timeout
= jiffies
+
413 ATAPI_WAIT_WRITE_BUSY
;
415 if (time_after(jiffies
, info
->write_timeout
))
418 struct request_queue
*q
= drive
->queue
;
422 * take a breather relying on the unplug
423 * timer to kick us again
425 spin_lock_irqsave(q
->queue_lock
, flags
);
427 spin_unlock_irqrestore(q
->queue_lock
, flags
);
432 } else if (sense_key
== UNIT_ATTENTION
) {
434 cdrom_saw_media_change(drive
);
437 * Arrange to retry the request but be sure to give up
438 * if we've retried too many times.
440 if (++rq
->errors
> ERROR_MAX
)
442 } else if (sense_key
== ILLEGAL_REQUEST
||
443 sense_key
== DATA_PROTECT
) {
445 * No point in retrying after an illegal request or data
448 ide_dump_status_no_sense(drive
, "command error", stat
);
450 } else if (sense_key
== MEDIUM_ERROR
) {
452 * No point in re-trying a zillion times on a bad
453 * sector. If we got here the error is not correctable.
455 ide_dump_status_no_sense(drive
,
456 "media error (bad sector)",
459 } else if (sense_key
== BLANK_CHECK
) {
460 /* disk appears blank ?? */
461 ide_dump_status_no_sense(drive
, "media error (blank)",
464 } else if ((err
& ~ATA_ABORTED
) != 0) {
465 /* go to the default handler for other errors */
466 ide_error(drive
, "cdrom_decode_status", stat
);
468 } else if ((++rq
->errors
> ERROR_MAX
)) {
469 /* we've racked up too many retries, abort */
474 * End a request through request sense analysis when we have
475 * sense data. We need this in order to perform end of media
482 * If we got a CHECK_CONDITION status, queue
483 * a request sense command.
486 cdrom_queue_request_sense(drive
, NULL
, NULL
);
488 blk_dump_rq_flags(rq
, PFX
"bad rq");
489 cdrom_end_request(drive
, 0);
492 /* retry, or handle the next request */
496 if (stat
& ATA_ERR
) {
497 struct request_queue
*q
= drive
->queue
;
500 spin_lock_irqsave(q
->queue_lock
, flags
);
501 blkdev_dequeue_request(rq
);
502 spin_unlock_irqrestore(q
->queue_lock
, flags
);
506 cdrom_queue_request_sense(drive
, rq
->sense
, rq
);
508 cdrom_end_request(drive
, 0);
514 * Check the contents of the interrupt reason register from the cdrom
515 * and attempt to recover if there are problems. Returns 0 if everything's
516 * ok; nonzero if the request has been terminated.
518 static int ide_cd_check_ireason(ide_drive_t
*drive
, struct request
*rq
,
519 int len
, int ireason
, int rw
)
521 ide_hwif_t
*hwif
= drive
->hwif
;
523 ide_debug_log(IDE_DBG_FUNC
, "ireason: 0x%x, rw: 0x%x", ireason
, rw
);
526 * ireason == 0: the drive wants to receive data from us
527 * ireason == 2: the drive is expecting to transfer data to us
529 if (ireason
== (!rw
<< 1))
531 else if (ireason
== (rw
<< 1)) {
534 printk(KERN_ERR PFX
"%s: %s: wrong transfer direction!\n",
535 drive
->name
, __func__
);
537 ide_pad_transfer(drive
, rw
, len
);
538 } else if (rw
== 0 && ireason
== 1) {
540 * Some drives (ASUS) seem to tell us that status info is
541 * available. Just get it and ignore.
543 (void)hwif
->tp_ops
->read_status(hwif
);
546 /* drive wants a command packet, or invalid ireason... */
547 printk(KERN_ERR PFX
"%s: %s: bad interrupt reason 0x%02x\n",
548 drive
->name
, __func__
, ireason
);
551 if (rq
->cmd_type
== REQ_TYPE_ATA_PC
)
552 rq
->cmd_flags
|= REQ_FAILED
;
554 cdrom_end_request(drive
, 0);
559 * Assume that the drive will always provide data in multiples of at least
560 * SECTOR_SIZE, as it gets hairy to keep track of the transfers otherwise.
562 static int ide_cd_check_transfer_size(ide_drive_t
*drive
, int len
)
564 ide_debug_log(IDE_DBG_FUNC
, "len: %d", len
);
566 if ((len
% SECTOR_SIZE
) == 0)
569 printk(KERN_ERR PFX
"%s: %s: Bad transfer size %d\n", drive
->name
,
572 if (drive
->atapi_flags
& IDE_AFLAG_LIMIT_NFRAMES
)
573 printk(KERN_ERR PFX
"This drive is not supported by this "
574 "version of the driver\n");
576 printk(KERN_ERR PFX
"Trying to limit transfer sizes\n");
577 drive
->atapi_flags
|= IDE_AFLAG_LIMIT_NFRAMES
;
583 static ide_startstop_t
ide_cd_prepare_rw_request(ide_drive_t
*drive
,
586 ide_debug_log(IDE_DBG_RQ
, "rq->cmd_flags: 0x%x", rq
->cmd_flags
);
588 if (rq_data_dir(rq
) == READ
) {
589 unsigned short sectors_per_frame
=
590 queue_hardsect_size(drive
->queue
) >> SECTOR_BITS
;
591 int nskip
= rq
->sector
& (sectors_per_frame
- 1);
594 * If the requested sector doesn't start on a frame boundary,
595 * we must adjust the start of the transfer so that it does,
596 * and remember to skip the first few sectors.
598 * If the rq->current_nr_sectors field is larger than the size
599 * of the buffer, it will mean that we're to skip a number of
600 * sectors equal to the amount by which rq->current_nr_sectors
601 * is larger than the buffer size.
604 /* sanity check... */
605 if (rq
->current_nr_sectors
!=
606 bio_cur_sectors(rq
->bio
)) {
607 printk(KERN_ERR PFX
"%s: %s: buffer botch (%u)\n",
608 drive
->name
, __func__
,
609 rq
->current_nr_sectors
);
610 cdrom_end_request(drive
, 0);
613 rq
->current_nr_sectors
+= nskip
;
617 /* set up the command */
618 rq
->timeout
= ATAPI_WAIT_PC
;
624 * Fix up a possibly partially-processed request so that we can start it over
625 * entirely, or even put it back on the request queue.
627 static void ide_cd_restore_request(ide_drive_t
*drive
, struct request
*rq
)
630 ide_debug_log(IDE_DBG_FUNC
, "enter");
632 if (rq
->buffer
!= bio_data(rq
->bio
)) {
634 (rq
->buffer
- (char *)bio_data(rq
->bio
)) / SECTOR_SIZE
;
636 rq
->buffer
= bio_data(rq
->bio
);
640 rq
->current_nr_sectors
= bio_cur_sectors(rq
->bio
);
641 rq
->hard_cur_sectors
= rq
->current_nr_sectors
;
642 rq
->hard_nr_sectors
= rq
->nr_sectors
;
643 rq
->hard_sector
= rq
->sector
;
644 rq
->q
->prep_rq_fn(rq
->q
, rq
);
647 static void ide_cd_request_sense_fixup(ide_drive_t
*drive
, struct request
*rq
)
649 ide_debug_log(IDE_DBG_FUNC
, "rq->cmd[0]: 0x%x", rq
->cmd
[0]);
652 * Some of the trailing request sense fields are optional,
653 * and some drives don't send them. Sigh.
655 if (rq
->cmd
[0] == GPCMD_REQUEST_SENSE
&&
656 rq
->data_len
> 0 && rq
->data_len
<= 5)
657 while (rq
->data_len
> 0) {
658 *(u8
*)rq
->data
++ = 0;
663 int ide_cd_queue_pc(ide_drive_t
*drive
, const unsigned char *cmd
,
664 int write
, void *buffer
, unsigned *bufflen
,
665 struct request_sense
*sense
, int timeout
,
666 unsigned int cmd_flags
)
668 struct cdrom_info
*info
= drive
->driver_data
;
669 struct request_sense local_sense
;
671 unsigned int flags
= 0;
674 sense
= &local_sense
;
676 ide_debug_log(IDE_DBG_PC
, "cmd[0]: 0x%x, write: 0x%x, timeout: %d, "
678 cmd
[0], write
, timeout
, cmd_flags
);
680 /* start of retry loop */
685 rq
= blk_get_request(drive
->queue
, write
, __GFP_WAIT
);
687 memcpy(rq
->cmd
, cmd
, BLK_MAX_CDB
);
688 rq
->cmd_type
= REQ_TYPE_ATA_PC
;
690 rq
->cmd_flags
|= cmd_flags
;
691 rq
->timeout
= timeout
;
694 rq
->data_len
= *bufflen
;
697 error
= blk_execute_rq(drive
->queue
, info
->disk
, rq
, 0);
700 *bufflen
= rq
->data_len
;
702 flags
= rq
->cmd_flags
;
706 * FIXME: we should probably abort/retry or something in case of
709 if (flags
& REQ_FAILED
) {
711 * The request failed. Retry if it was due to a unit
712 * attention status (usually means media was changed).
714 struct request_sense
*reqbuf
= sense
;
716 if (reqbuf
->sense_key
== UNIT_ATTENTION
)
717 cdrom_saw_media_change(drive
);
718 else if (reqbuf
->sense_key
== NOT_READY
&&
719 reqbuf
->asc
== 4 && reqbuf
->ascq
!= 4) {
721 * The drive is in the process of loading
722 * a disk. Retry, but wait a little to give
723 * the drive time to complete the load.
727 /* otherwise, don't retry */
733 /* end of retry loop */
734 } while ((flags
& REQ_FAILED
) && retries
>= 0);
736 /* return an error if the command failed */
737 return (flags
& REQ_FAILED
) ? -EIO
: 0;
741 * Called from blk_end_request_callback() after the data of the request is
742 * completed and before the request itself is completed. By returning value '1',
743 * blk_end_request_callback() returns immediately without completing it.
745 static int cdrom_newpc_intr_dummy_cb(struct request
*rq
)
750 static ide_startstop_t
cdrom_newpc_intr(ide_drive_t
*drive
)
752 ide_hwif_t
*hwif
= drive
->hwif
;
753 struct request
*rq
= hwif
->rq
;
754 xfer_func_t
*xferfunc
;
755 ide_expiry_t
*expiry
= NULL
;
756 int dma_error
= 0, dma
, stat
, thislen
, uptodate
= 0;
757 int write
= (rq_data_dir(rq
) == WRITE
) ? 1 : 0;
758 unsigned int timeout
;
762 ide_debug_log(IDE_DBG_PC
, "cmd[0]: 0x%x, write: 0x%x",
765 /* check for errors */
769 dma_error
= hwif
->dma_ops
->dma_end(drive
);
771 printk(KERN_ERR PFX
"%s: DMA %s error\n", drive
->name
,
772 write
? "write" : "read");
777 if (cdrom_decode_status(drive
, 0, &stat
))
780 /* using dma, transfer is complete now */
783 return ide_error(drive
, "dma error", stat
);
784 if (blk_fs_request(rq
)) {
785 ide_complete_rq(drive
, 0, rq
->nr_sectors
786 ? (rq
->nr_sectors
<< 9) : ide_rq_bytes(rq
));
788 } else if (rq
->cmd_type
== REQ_TYPE_ATA_PC
&& !rq
->bio
) {
789 ide_complete_rq(drive
, 0, 512);
795 ide_read_bcount_and_ireason(drive
, &len
, &ireason
);
797 thislen
= blk_fs_request(rq
) ? len
: rq
->data_len
;
801 ide_debug_log(IDE_DBG_PC
, "DRQ: stat: 0x%x, thislen: %d",
804 /* If DRQ is clear, the command has completed. */
805 if ((stat
& ATA_DRQ
) == 0) {
806 if (blk_fs_request(rq
)) {
808 * If we're not done reading/writing, complain.
809 * Otherwise, complete the command normally.
812 if (rq
->current_nr_sectors
> 0) {
813 printk(KERN_ERR PFX
"%s: %s: data underrun "
815 drive
->name
, __func__
,
816 rq
->current_nr_sectors
);
818 rq
->cmd_flags
|= REQ_FAILED
;
821 cdrom_end_request(drive
, uptodate
);
823 } else if (!blk_pc_request(rq
)) {
824 ide_cd_request_sense_fixup(drive
, rq
);
825 /* complain if we still have data left to transfer */
826 uptodate
= rq
->data_len
? 0 : 1;
831 /* check which way to transfer data */
832 if (ide_cd_check_ireason(drive
, rq
, len
, ireason
, write
))
835 if (blk_fs_request(rq
)) {
839 if (ide_cd_check_transfer_size(drive
, len
)) {
840 cdrom_end_request(drive
, 0);
845 * First, figure out if we need to bit-bucket
846 * any of the leading sectors.
848 nskip
= min_t(int, rq
->current_nr_sectors
849 - bio_cur_sectors(rq
->bio
),
852 ide_pad_transfer(drive
, write
, nskip
<< 9);
853 rq
->current_nr_sectors
-= nskip
;
854 thislen
-= (nskip
<< 9);
861 xferfunc
= hwif
->tp_ops
->output_data
;
864 xferfunc
= hwif
->tp_ops
->input_data
;
867 ide_debug_log(IDE_DBG_PC
, "data transfer, rq->cmd_type: 0x%x, "
869 rq
->cmd_type
, ireason
);
872 while (thislen
> 0) {
873 u8
*ptr
= blk_fs_request(rq
) ? NULL
: rq
->data
;
874 int blen
= rq
->data_len
;
878 if (blk_fs_request(rq
)) {
880 blen
= rq
->current_nr_sectors
<< 9;
882 ptr
= bio_data(rq
->bio
);
883 blen
= bio_iovec(rq
->bio
)->bv_len
;
888 if (blk_fs_request(rq
) && !write
)
890 * If the buffers are full, pipe the rest into
893 ide_pad_transfer(drive
, 0, thislen
);
895 printk(KERN_ERR PFX
"%s: confused, missing data\n",
897 blk_dump_rq_flags(rq
, rq_data_dir(rq
)
898 ? "cdrom_newpc_intr, write"
899 : "cdrom_newpc_intr, read");
907 xferfunc(drive
, NULL
, ptr
, blen
);
912 if (blk_fs_request(rq
)) {
914 rq
->nr_sectors
-= (blen
>> 9);
915 rq
->current_nr_sectors
-= (blen
>> 9);
916 rq
->sector
+= (blen
>> 9);
918 if (rq
->current_nr_sectors
== 0 && rq
->nr_sectors
)
919 cdrom_end_request(drive
, 1);
921 rq
->data_len
-= blen
;
924 * The request can't be completed until DRQ is cleared.
925 * So complete the data, but don't complete the request
926 * using the dummy function for the callback feature
927 * of blk_end_request_callback().
930 blk_end_request_callback(rq
, 0, blen
,
931 cdrom_newpc_intr_dummy_cb
);
935 if (!write
&& blk_sense_request(rq
))
936 rq
->sense_len
+= blen
;
939 /* pad, if necessary */
940 if (!blk_fs_request(rq
) && len
> 0)
941 ide_pad_transfer(drive
, write
, len
);
943 if (blk_pc_request(rq
)) {
944 timeout
= rq
->timeout
;
946 timeout
= ATAPI_WAIT_PC
;
947 if (!blk_fs_request(rq
))
948 expiry
= ide_cd_expiry
;
951 hwif
->expiry
= expiry
;
952 ide_set_handler(drive
, cdrom_newpc_intr
, timeout
);
956 if (blk_pc_request(rq
)) {
957 unsigned int dlen
= rq
->data_len
;
962 if (blk_end_request(rq
, 0, dlen
))
968 rq
->cmd_flags
|= REQ_FAILED
;
969 cdrom_end_request(drive
, uptodate
);
974 static ide_startstop_t
cdrom_start_rw(ide_drive_t
*drive
, struct request
*rq
)
976 struct cdrom_info
*cd
= drive
->driver_data
;
977 int write
= rq_data_dir(rq
) == WRITE
;
978 unsigned short sectors_per_frame
=
979 queue_hardsect_size(drive
->queue
) >> SECTOR_BITS
;
981 ide_debug_log(IDE_DBG_RQ
, "rq->cmd[0]: 0x%x, write: 0x%x, "
982 "secs_per_frame: %u",
983 rq
->cmd
[0], write
, sectors_per_frame
);
986 /* disk has become write protected */
987 if (get_disk_ro(cd
->disk
)) {
988 cdrom_end_request(drive
, 0);
993 * We may be retrying this request after an error. Fix up any
994 * weirdness which might be present in the request packet.
996 ide_cd_restore_request(drive
, rq
);
999 /* use DMA, if possible / writes *must* be hardware frame aligned */
1000 if ((rq
->nr_sectors
& (sectors_per_frame
- 1)) ||
1001 (rq
->sector
& (sectors_per_frame
- 1))) {
1003 cdrom_end_request(drive
, 0);
1008 drive
->dma
= !!(drive
->dev_flags
& IDE_DFLAG_USING_DMA
);
1011 cd
->devinfo
.media_written
= 1;
1016 static void cdrom_do_block_pc(ide_drive_t
*drive
, struct request
*rq
)
1019 ide_debug_log(IDE_DBG_PC
, "rq->cmd[0]: 0x%x, rq->cmd_type: 0x%x",
1020 rq
->cmd
[0], rq
->cmd_type
);
1022 if (blk_pc_request(rq
))
1023 rq
->cmd_flags
|= REQ_QUIET
;
1025 rq
->cmd_flags
&= ~REQ_FAILED
;
1030 if (rq
->bio
|| ((rq
->cmd_type
== REQ_TYPE_ATA_PC
) && rq
->data_len
)) {
1031 struct request_queue
*q
= drive
->queue
;
1032 unsigned int alignment
;
1036 buf
= bio_data(rq
->bio
);
1040 drive
->dma
= !!(drive
->dev_flags
& IDE_DFLAG_USING_DMA
);
1043 * check if dma is safe
1045 * NOTE! The "len" and "addr" checks should possibly have
1048 alignment
= queue_dma_alignment(q
) | q
->dma_pad_mask
;
1049 if ((unsigned long)buf
& alignment
1050 || rq
->data_len
& q
->dma_pad_mask
1051 || object_is_on_stack(buf
))
1056 static ide_startstop_t
ide_cd_do_request(ide_drive_t
*drive
, struct request
*rq
,
1061 ide_debug_log(IDE_DBG_RQ
, "cmd: 0x%x, block: %llu",
1062 rq
->cmd
[0], (unsigned long long)block
);
1064 if (drive
->debug_mask
& IDE_DBG_RQ
)
1065 blk_dump_rq_flags(rq
, "ide_cd_do_request");
1067 if (blk_fs_request(rq
)) {
1068 if (cdrom_start_rw(drive
, rq
) == ide_stopped
)
1071 if (ide_cd_prepare_rw_request(drive
, rq
) == ide_stopped
)
1073 } else if (blk_sense_request(rq
) || blk_pc_request(rq
) ||
1074 rq
->cmd_type
== REQ_TYPE_ATA_PC
) {
1076 rq
->timeout
= ATAPI_WAIT_PC
;
1078 cdrom_do_block_pc(drive
, rq
);
1079 } else if (blk_special_request(rq
)) {
1080 /* right now this can only be a reset... */
1081 cdrom_end_request(drive
, 1);
1084 blk_dump_rq_flags(rq
, DRV_NAME
" bad flags");
1085 cdrom_end_request(drive
, 0);
1089 memset(&cmd
, 0, sizeof(cmd
));
1091 if (rq_data_dir(rq
))
1092 cmd
.tf_flags
|= IDE_TFLAG_WRITE
;
1096 return ide_issue_pc(drive
, &cmd
);
1102 * Routines which queue packet commands take as a final argument a pointer to a
1103 * request_sense struct. If execution of the command results in an error with a
1104 * CHECK CONDITION status, this structure will be filled with the results of the
1105 * subsequent request sense command. The pointer can also be NULL, in which case
1106 * no sense information is returned.
1108 static void msf_from_bcd(struct atapi_msf
*msf
)
1110 msf
->minute
= bcd2bin(msf
->minute
);
1111 msf
->second
= bcd2bin(msf
->second
);
1112 msf
->frame
= bcd2bin(msf
->frame
);
1115 int cdrom_check_status(ide_drive_t
*drive
, struct request_sense
*sense
)
1117 struct cdrom_info
*info
= drive
->driver_data
;
1118 struct cdrom_device_info
*cdi
= &info
->devinfo
;
1119 unsigned char cmd
[BLK_MAX_CDB
];
1121 ide_debug_log(IDE_DBG_FUNC
, "enter");
1123 memset(cmd
, 0, BLK_MAX_CDB
);
1124 cmd
[0] = GPCMD_TEST_UNIT_READY
;
1127 * Sanyo 3 CD changer uses byte 7 of TEST_UNIT_READY to switch CDs
1128 * instead of supporting the LOAD_UNLOAD opcode.
1130 cmd
[7] = cdi
->sanyo_slot
% 3;
1132 return ide_cd_queue_pc(drive
, cmd
, 0, NULL
, NULL
, sense
, 0, REQ_QUIET
);
1135 static int cdrom_read_capacity(ide_drive_t
*drive
, unsigned long *capacity
,
1136 unsigned long *sectors_per_frame
,
1137 struct request_sense
*sense
)
1145 unsigned char cmd
[BLK_MAX_CDB
];
1146 unsigned len
= sizeof(capbuf
);
1149 ide_debug_log(IDE_DBG_FUNC
, "enter");
1151 memset(cmd
, 0, BLK_MAX_CDB
);
1152 cmd
[0] = GPCMD_READ_CDVD_CAPACITY
;
1154 stat
= ide_cd_queue_pc(drive
, cmd
, 0, &capbuf
, &len
, sense
, 0,
1160 * Sanity check the given block size
1162 blocklen
= be32_to_cpu(capbuf
.blocklen
);
1170 printk(KERN_ERR PFX
"%s: weird block size %u\n",
1171 drive
->name
, blocklen
);
1172 printk(KERN_ERR PFX
"%s: default to 2kb block size\n",
1178 *capacity
= 1 + be32_to_cpu(capbuf
.lba
);
1179 *sectors_per_frame
= blocklen
>> SECTOR_BITS
;
1181 ide_debug_log(IDE_DBG_PROBE
, "cap: %lu, sectors_per_frame: %lu",
1182 *capacity
, *sectors_per_frame
);
1187 static int cdrom_read_tocentry(ide_drive_t
*drive
, int trackno
, int msf_flag
,
1188 int format
, char *buf
, int buflen
,
1189 struct request_sense
*sense
)
1191 unsigned char cmd
[BLK_MAX_CDB
];
1193 ide_debug_log(IDE_DBG_FUNC
, "enter");
1195 memset(cmd
, 0, BLK_MAX_CDB
);
1197 cmd
[0] = GPCMD_READ_TOC_PMA_ATIP
;
1199 cmd
[7] = (buflen
>> 8);
1200 cmd
[8] = (buflen
& 0xff);
1201 cmd
[9] = (format
<< 6);
1206 return ide_cd_queue_pc(drive
, cmd
, 0, buf
, &buflen
, sense
, 0, REQ_QUIET
);
1209 /* Try to read the entire TOC for the disk into our internal buffer. */
1210 int ide_cd_read_toc(ide_drive_t
*drive
, struct request_sense
*sense
)
1212 int stat
, ntracks
, i
;
1213 struct cdrom_info
*info
= drive
->driver_data
;
1214 struct cdrom_device_info
*cdi
= &info
->devinfo
;
1215 struct atapi_toc
*toc
= info
->toc
;
1217 struct atapi_toc_header hdr
;
1218 struct atapi_toc_entry ent
;
1221 unsigned long sectors_per_frame
= SECTORS_PER_FRAME
;
1223 ide_debug_log(IDE_DBG_FUNC
, "enter");
1226 /* try to allocate space */
1227 toc
= kmalloc(sizeof(struct atapi_toc
), GFP_KERNEL
);
1229 printk(KERN_ERR PFX
"%s: No cdrom TOC buffer!\n",
1237 * Check to see if the existing data is still valid. If it is,
1240 (void) cdrom_check_status(drive
, sense
);
1242 if (drive
->atapi_flags
& IDE_AFLAG_TOC_VALID
)
1245 /* try to get the total cdrom capacity and sector size */
1246 stat
= cdrom_read_capacity(drive
, &toc
->capacity
, §ors_per_frame
,
1249 toc
->capacity
= 0x1fffff;
1251 set_capacity(info
->disk
, toc
->capacity
* sectors_per_frame
);
1252 /* save a private copy of the TOC capacity for error handling */
1253 drive
->probed_capacity
= toc
->capacity
* sectors_per_frame
;
1255 blk_queue_hardsect_size(drive
->queue
,
1256 sectors_per_frame
<< SECTOR_BITS
);
1258 /* first read just the header, so we know how long the TOC is */
1259 stat
= cdrom_read_tocentry(drive
, 0, 1, 0, (char *) &toc
->hdr
,
1260 sizeof(struct atapi_toc_header
), sense
);
1264 if (drive
->atapi_flags
& IDE_AFLAG_TOCTRACKS_AS_BCD
) {
1265 toc
->hdr
.first_track
= bcd2bin(toc
->hdr
.first_track
);
1266 toc
->hdr
.last_track
= bcd2bin(toc
->hdr
.last_track
);
1269 ntracks
= toc
->hdr
.last_track
- toc
->hdr
.first_track
+ 1;
1272 if (ntracks
> MAX_TRACKS
)
1273 ntracks
= MAX_TRACKS
;
1275 /* now read the whole schmeer */
1276 stat
= cdrom_read_tocentry(drive
, toc
->hdr
.first_track
, 1, 0,
1278 sizeof(struct atapi_toc_header
) +
1280 sizeof(struct atapi_toc_entry
), sense
);
1282 if (stat
&& toc
->hdr
.first_track
> 1) {
1284 * Cds with CDI tracks only don't have any TOC entries, despite
1285 * of this the returned values are
1286 * first_track == last_track = number of CDI tracks + 1,
1287 * so that this case is indistinguishable from the same layout
1288 * plus an additional audio track. If we get an error for the
1289 * regular case, we assume a CDI without additional audio
1290 * tracks. In this case the readable TOC is empty (CDI tracks
1291 * are not included) and only holds the Leadout entry.
1296 stat
= cdrom_read_tocentry(drive
, CDROM_LEADOUT
, 1, 0,
1298 sizeof(struct atapi_toc_header
) +
1300 sizeof(struct atapi_toc_entry
),
1305 if (drive
->atapi_flags
& IDE_AFLAG_TOCTRACKS_AS_BCD
) {
1306 toc
->hdr
.first_track
= (u8
)bin2bcd(CDROM_LEADOUT
);
1307 toc
->hdr
.last_track
= (u8
)bin2bcd(CDROM_LEADOUT
);
1309 toc
->hdr
.first_track
= CDROM_LEADOUT
;
1310 toc
->hdr
.last_track
= CDROM_LEADOUT
;
1317 toc
->hdr
.toc_length
= be16_to_cpu(toc
->hdr
.toc_length
);
1319 if (drive
->atapi_flags
& IDE_AFLAG_TOCTRACKS_AS_BCD
) {
1320 toc
->hdr
.first_track
= bcd2bin(toc
->hdr
.first_track
);
1321 toc
->hdr
.last_track
= bcd2bin(toc
->hdr
.last_track
);
1324 for (i
= 0; i
<= ntracks
; i
++) {
1325 if (drive
->atapi_flags
& IDE_AFLAG_TOCADDR_AS_BCD
) {
1326 if (drive
->atapi_flags
& IDE_AFLAG_TOCTRACKS_AS_BCD
)
1327 toc
->ent
[i
].track
= bcd2bin(toc
->ent
[i
].track
);
1328 msf_from_bcd(&toc
->ent
[i
].addr
.msf
);
1330 toc
->ent
[i
].addr
.lba
= msf_to_lba(toc
->ent
[i
].addr
.msf
.minute
,
1331 toc
->ent
[i
].addr
.msf
.second
,
1332 toc
->ent
[i
].addr
.msf
.frame
);
1335 if (toc
->hdr
.first_track
!= CDROM_LEADOUT
) {
1336 /* read the multisession information */
1337 stat
= cdrom_read_tocentry(drive
, 0, 0, 1, (char *)&ms_tmp
,
1338 sizeof(ms_tmp
), sense
);
1342 toc
->last_session_lba
= be32_to_cpu(ms_tmp
.ent
.addr
.lba
);
1344 ms_tmp
.hdr
.last_track
= CDROM_LEADOUT
;
1345 ms_tmp
.hdr
.first_track
= ms_tmp
.hdr
.last_track
;
1346 toc
->last_session_lba
= msf_to_lba(0, 2, 0); /* 0m 2s 0f */
1349 if (drive
->atapi_flags
& IDE_AFLAG_TOCADDR_AS_BCD
) {
1350 /* re-read multisession information using MSF format */
1351 stat
= cdrom_read_tocentry(drive
, 0, 1, 1, (char *)&ms_tmp
,
1352 sizeof(ms_tmp
), sense
);
1356 msf_from_bcd(&ms_tmp
.ent
.addr
.msf
);
1357 toc
->last_session_lba
= msf_to_lba(ms_tmp
.ent
.addr
.msf
.minute
,
1358 ms_tmp
.ent
.addr
.msf
.second
,
1359 ms_tmp
.ent
.addr
.msf
.frame
);
1362 toc
->xa_flag
= (ms_tmp
.hdr
.first_track
!= ms_tmp
.hdr
.last_track
);
1364 /* now try to get the total cdrom capacity */
1365 stat
= cdrom_get_last_written(cdi
, &last_written
);
1366 if (!stat
&& (last_written
> toc
->capacity
)) {
1367 toc
->capacity
= last_written
;
1368 set_capacity(info
->disk
, toc
->capacity
* sectors_per_frame
);
1369 drive
->probed_capacity
= toc
->capacity
* sectors_per_frame
;
1372 /* Remember that we've read this stuff. */
1373 drive
->atapi_flags
|= IDE_AFLAG_TOC_VALID
;
1378 int ide_cdrom_get_capabilities(ide_drive_t
*drive
, u8
*buf
)
1380 struct cdrom_info
*info
= drive
->driver_data
;
1381 struct cdrom_device_info
*cdi
= &info
->devinfo
;
1382 struct packet_command cgc
;
1383 int stat
, attempts
= 3, size
= ATAPI_CAPABILITIES_PAGE_SIZE
;
1385 ide_debug_log(IDE_DBG_FUNC
, "enter");
1387 if ((drive
->atapi_flags
& IDE_AFLAG_FULL_CAPS_PAGE
) == 0)
1388 size
-= ATAPI_CAPABILITIES_PAGE_PAD_SIZE
;
1390 init_cdrom_command(&cgc
, buf
, size
, CGC_DATA_UNKNOWN
);
1392 /* we seem to get stat=0x01,err=0x00 the first time (??) */
1393 stat
= cdrom_mode_sense(cdi
, &cgc
, GPMODE_CAPABILITIES_PAGE
, 0);
1396 } while (--attempts
);
1400 void ide_cdrom_update_speed(ide_drive_t
*drive
, u8
*buf
)
1402 struct cdrom_info
*cd
= drive
->driver_data
;
1403 u16 curspeed
, maxspeed
;
1405 ide_debug_log(IDE_DBG_FUNC
, "enter");
1407 if (drive
->atapi_flags
& IDE_AFLAG_LE_SPEED_FIELDS
) {
1408 curspeed
= le16_to_cpup((__le16
*)&buf
[8 + 14]);
1409 maxspeed
= le16_to_cpup((__le16
*)&buf
[8 + 8]);
1411 curspeed
= be16_to_cpup((__be16
*)&buf
[8 + 14]);
1412 maxspeed
= be16_to_cpup((__be16
*)&buf
[8 + 8]);
1415 ide_debug_log(IDE_DBG_PROBE
, "curspeed: %u, maxspeed: %u",
1416 curspeed
, maxspeed
);
1418 cd
->current_speed
= (curspeed
+ (176/2)) / 176;
1419 cd
->max_speed
= (maxspeed
+ (176/2)) / 176;
1422 #define IDE_CD_CAPABILITIES \
1423 (CDC_CLOSE_TRAY | CDC_OPEN_TRAY | CDC_LOCK | CDC_SELECT_SPEED | \
1424 CDC_SELECT_DISC | CDC_MULTI_SESSION | CDC_MCN | CDC_MEDIA_CHANGED | \
1425 CDC_PLAY_AUDIO | CDC_RESET | CDC_DRIVE_STATUS | CDC_CD_R | \
1426 CDC_CD_RW | CDC_DVD | CDC_DVD_R | CDC_DVD_RAM | CDC_GENERIC_PACKET | \
1427 CDC_MO_DRIVE | CDC_MRW | CDC_MRW_W | CDC_RAM)
1429 static struct cdrom_device_ops ide_cdrom_dops
= {
1430 .open
= ide_cdrom_open_real
,
1431 .release
= ide_cdrom_release_real
,
1432 .drive_status
= ide_cdrom_drive_status
,
1433 .media_changed
= ide_cdrom_check_media_change_real
,
1434 .tray_move
= ide_cdrom_tray_move
,
1435 .lock_door
= ide_cdrom_lock_door
,
1436 .select_speed
= ide_cdrom_select_speed
,
1437 .get_last_session
= ide_cdrom_get_last_session
,
1438 .get_mcn
= ide_cdrom_get_mcn
,
1439 .reset
= ide_cdrom_reset
,
1440 .audio_ioctl
= ide_cdrom_audio_ioctl
,
1441 .capability
= IDE_CD_CAPABILITIES
,
1442 .generic_packet
= ide_cdrom_packet
,
1445 static int ide_cdrom_register(ide_drive_t
*drive
, int nslots
)
1447 struct cdrom_info
*info
= drive
->driver_data
;
1448 struct cdrom_device_info
*devinfo
= &info
->devinfo
;
1450 ide_debug_log(IDE_DBG_PROBE
, "nslots: %d", nslots
);
1452 devinfo
->ops
= &ide_cdrom_dops
;
1453 devinfo
->speed
= info
->current_speed
;
1454 devinfo
->capacity
= nslots
;
1455 devinfo
->handle
= drive
;
1456 strcpy(devinfo
->name
, drive
->name
);
1458 if (drive
->atapi_flags
& IDE_AFLAG_NO_SPEED_SELECT
)
1459 devinfo
->mask
|= CDC_SELECT_SPEED
;
1461 devinfo
->disk
= info
->disk
;
1462 return register_cdrom(devinfo
);
1465 static int ide_cdrom_probe_capabilities(ide_drive_t
*drive
)
1467 struct cdrom_info
*cd
= drive
->driver_data
;
1468 struct cdrom_device_info
*cdi
= &cd
->devinfo
;
1469 u8 buf
[ATAPI_CAPABILITIES_PAGE_SIZE
];
1470 mechtype_t mechtype
;
1473 ide_debug_log(IDE_DBG_PROBE
, "media: 0x%x, atapi_flags: 0x%lx",
1474 drive
->media
, drive
->atapi_flags
);
1476 cdi
->mask
= (CDC_CD_R
| CDC_CD_RW
| CDC_DVD
| CDC_DVD_R
|
1477 CDC_DVD_RAM
| CDC_SELECT_DISC
| CDC_PLAY_AUDIO
|
1478 CDC_MO_DRIVE
| CDC_RAM
);
1480 if (drive
->media
== ide_optical
) {
1481 cdi
->mask
&= ~(CDC_MO_DRIVE
| CDC_RAM
);
1482 printk(KERN_ERR PFX
"%s: ATAPI magneto-optical drive\n",
1487 if (drive
->atapi_flags
& IDE_AFLAG_PRE_ATAPI12
) {
1488 drive
->atapi_flags
&= ~IDE_AFLAG_NO_EJECT
;
1489 cdi
->mask
&= ~CDC_PLAY_AUDIO
;
1494 * We have to cheat a little here. the packet will eventually be queued
1495 * with ide_cdrom_packet(), which extracts the drive from cdi->handle.
1496 * Since this device hasn't been registered with the Uniform layer yet,
1497 * it can't do this. Same goes for cdi->ops.
1499 cdi
->handle
= drive
;
1500 cdi
->ops
= &ide_cdrom_dops
;
1502 if (ide_cdrom_get_capabilities(drive
, buf
))
1505 if ((buf
[8 + 6] & 0x01) == 0)
1506 drive
->dev_flags
&= ~IDE_DFLAG_DOORLOCKING
;
1507 if (buf
[8 + 6] & 0x08)
1508 drive
->atapi_flags
&= ~IDE_AFLAG_NO_EJECT
;
1509 if (buf
[8 + 3] & 0x01)
1510 cdi
->mask
&= ~CDC_CD_R
;
1511 if (buf
[8 + 3] & 0x02)
1512 cdi
->mask
&= ~(CDC_CD_RW
| CDC_RAM
);
1513 if (buf
[8 + 2] & 0x38)
1514 cdi
->mask
&= ~CDC_DVD
;
1515 if (buf
[8 + 3] & 0x20)
1516 cdi
->mask
&= ~(CDC_DVD_RAM
| CDC_RAM
);
1517 if (buf
[8 + 3] & 0x10)
1518 cdi
->mask
&= ~CDC_DVD_R
;
1519 if ((buf
[8 + 4] & 0x01) || (drive
->atapi_flags
& IDE_AFLAG_PLAY_AUDIO_OK
))
1520 cdi
->mask
&= ~CDC_PLAY_AUDIO
;
1522 mechtype
= buf
[8 + 6] >> 5;
1523 if (mechtype
== mechtype_caddy
||
1524 mechtype
== mechtype_popup
||
1525 (drive
->atapi_flags
& IDE_AFLAG_NO_AUTOCLOSE
))
1526 cdi
->mask
|= CDC_CLOSE_TRAY
;
1528 if (cdi
->sanyo_slot
> 0) {
1529 cdi
->mask
&= ~CDC_SELECT_DISC
;
1531 } else if (mechtype
== mechtype_individual_changer
||
1532 mechtype
== mechtype_cartridge_changer
) {
1533 nslots
= cdrom_number_of_slots(cdi
);
1535 cdi
->mask
&= ~CDC_SELECT_DISC
;
1538 ide_cdrom_update_speed(drive
, buf
);
1540 printk(KERN_INFO PFX
"%s: ATAPI", drive
->name
);
1542 /* don't print speed if the drive reported 0 */
1544 printk(KERN_CONT
" %dX", cd
->max_speed
);
1546 printk(KERN_CONT
" %s", (cdi
->mask
& CDC_DVD
) ? "CD-ROM" : "DVD-ROM");
1548 if ((cdi
->mask
& CDC_DVD_R
) == 0 || (cdi
->mask
& CDC_DVD_RAM
) == 0)
1549 printk(KERN_CONT
" DVD%s%s",
1550 (cdi
->mask
& CDC_DVD_R
) ? "" : "-R",
1551 (cdi
->mask
& CDC_DVD_RAM
) ? "" : "/RAM");
1553 if ((cdi
->mask
& CDC_CD_R
) == 0 || (cdi
->mask
& CDC_CD_RW
) == 0)
1554 printk(KERN_CONT
" CD%s%s",
1555 (cdi
->mask
& CDC_CD_R
) ? "" : "-R",
1556 (cdi
->mask
& CDC_CD_RW
) ? "" : "/RW");
1558 if ((cdi
->mask
& CDC_SELECT_DISC
) == 0)
1559 printk(KERN_CONT
" changer w/%d slots", nslots
);
1561 printk(KERN_CONT
" drive");
1563 printk(KERN_CONT
", %dkB Cache\n",
1564 be16_to_cpup((__be16
*)&buf
[8 + 12]));
1569 /* standard prep_rq_fn that builds 10 byte cmds */
1570 static int ide_cdrom_prep_fs(struct request_queue
*q
, struct request
*rq
)
1572 int hard_sect
= queue_hardsect_size(q
);
1573 long block
= (long)rq
->hard_sector
/ (hard_sect
>> 9);
1574 unsigned long blocks
= rq
->hard_nr_sectors
/ (hard_sect
>> 9);
1576 memset(rq
->cmd
, 0, BLK_MAX_CDB
);
1578 if (rq_data_dir(rq
) == READ
)
1579 rq
->cmd
[0] = GPCMD_READ_10
;
1581 rq
->cmd
[0] = GPCMD_WRITE_10
;
1586 rq
->cmd
[2] = (block
>> 24) & 0xff;
1587 rq
->cmd
[3] = (block
>> 16) & 0xff;
1588 rq
->cmd
[4] = (block
>> 8) & 0xff;
1589 rq
->cmd
[5] = block
& 0xff;
1592 * and transfer length
1594 rq
->cmd
[7] = (blocks
>> 8) & 0xff;
1595 rq
->cmd
[8] = blocks
& 0xff;
1601 * Most of the SCSI commands are supported directly by ATAPI devices.
1602 * This transform handles the few exceptions.
1604 static int ide_cdrom_prep_pc(struct request
*rq
)
1608 /* transform 6-byte read/write commands to the 10-byte version */
1609 if (c
[0] == READ_6
|| c
[0] == WRITE_6
) {
1616 c
[0] += (READ_10
- READ_6
);
1622 * it's silly to pretend we understand 6-byte sense commands, just
1623 * reject with ILLEGAL_REQUEST and the caller should take the
1624 * appropriate action
1626 if (c
[0] == MODE_SENSE
|| c
[0] == MODE_SELECT
) {
1627 rq
->errors
= ILLEGAL_REQUEST
;
1628 return BLKPREP_KILL
;
1634 static int ide_cdrom_prep_fn(struct request_queue
*q
, struct request
*rq
)
1636 if (blk_fs_request(rq
))
1637 return ide_cdrom_prep_fs(q
, rq
);
1638 else if (blk_pc_request(rq
))
1639 return ide_cdrom_prep_pc(rq
);
1644 struct cd_list_entry
{
1645 const char *id_model
;
1646 const char *id_firmware
;
1647 unsigned int cd_flags
;
1650 #ifdef CONFIG_IDE_PROC_FS
1651 static sector_t
ide_cdrom_capacity(ide_drive_t
*drive
)
1653 unsigned long capacity
, sectors_per_frame
;
1655 if (cdrom_read_capacity(drive
, &capacity
, §ors_per_frame
, NULL
))
1658 return capacity
* sectors_per_frame
;
1661 static int proc_idecd_read_capacity(char *page
, char **start
, off_t off
,
1662 int count
, int *eof
, void *data
)
1664 ide_drive_t
*drive
= data
;
1667 len
= sprintf(page
, "%llu\n", (long long)ide_cdrom_capacity(drive
));
1668 PROC_IDE_READ_RETURN(page
, start
, off
, count
, eof
, len
);
1671 static ide_proc_entry_t idecd_proc
[] = {
1672 { "capacity", S_IFREG
|S_IRUGO
, proc_idecd_read_capacity
, NULL
},
1673 { NULL
, 0, NULL
, NULL
}
1676 static ide_proc_entry_t
*ide_cd_proc_entries(ide_drive_t
*drive
)
1681 static const struct ide_proc_devset
*ide_cd_proc_devsets(ide_drive_t
*drive
)
1687 static const struct cd_list_entry ide_cd_quirks_list
[] = {
1688 /* Limit transfer size per interrupt. */
1689 { "SAMSUNG CD-ROM SCR-2430", NULL
, IDE_AFLAG_LIMIT_NFRAMES
},
1690 { "SAMSUNG CD-ROM SCR-2432", NULL
, IDE_AFLAG_LIMIT_NFRAMES
},
1691 /* SCR-3231 doesn't support the SET_CD_SPEED command. */
1692 { "SAMSUNG CD-ROM SCR-3231", NULL
, IDE_AFLAG_NO_SPEED_SELECT
},
1693 /* Old NEC260 (not R) was released before ATAPI 1.2 spec. */
1694 { "NEC CD-ROM DRIVE:260", "1.01", IDE_AFLAG_TOCADDR_AS_BCD
|
1695 IDE_AFLAG_PRE_ATAPI12
, },
1696 /* Vertos 300, some versions of this drive like to talk BCD. */
1697 { "V003S0DS", NULL
, IDE_AFLAG_VERTOS_300_SSD
, },
1698 /* Vertos 600 ESD. */
1699 { "V006E0DS", NULL
, IDE_AFLAG_VERTOS_600_ESD
, },
1701 * Sanyo 3 CD changer uses a non-standard command for CD changing
1702 * (by default standard ATAPI support for CD changers is used).
1704 { "CD-ROM CDR-C3 G", NULL
, IDE_AFLAG_SANYO_3CD
},
1705 { "CD-ROM CDR-C3G", NULL
, IDE_AFLAG_SANYO_3CD
},
1706 { "CD-ROM CDR_C36", NULL
, IDE_AFLAG_SANYO_3CD
},
1707 /* Stingray 8X CD-ROM. */
1708 { "STINGRAY 8422 IDE 8X CD-ROM 7-27-95", NULL
, IDE_AFLAG_PRE_ATAPI12
},
1710 * ACER 50X CD-ROM and WPI 32X CD-ROM require the full spec length
1711 * mode sense page capabilities size, but older drives break.
1713 { "ATAPI CD ROM DRIVE 50X MAX", NULL
, IDE_AFLAG_FULL_CAPS_PAGE
},
1714 { "WPI CDS-32X", NULL
, IDE_AFLAG_FULL_CAPS_PAGE
},
1715 /* ACER/AOpen 24X CD-ROM has the speed fields byte-swapped. */
1716 { "", "241N", IDE_AFLAG_LE_SPEED_FIELDS
},
1718 * Some drives used by Apple don't advertise audio play
1719 * but they do support reading TOC & audio datas.
1721 { "MATSHITADVD-ROM SR-8187", NULL
, IDE_AFLAG_PLAY_AUDIO_OK
},
1722 { "MATSHITADVD-ROM SR-8186", NULL
, IDE_AFLAG_PLAY_AUDIO_OK
},
1723 { "MATSHITADVD-ROM SR-8176", NULL
, IDE_AFLAG_PLAY_AUDIO_OK
},
1724 { "MATSHITADVD-ROM SR-8174", NULL
, IDE_AFLAG_PLAY_AUDIO_OK
},
1725 { "Optiarc DVD RW AD-5200A", NULL
, IDE_AFLAG_PLAY_AUDIO_OK
},
1726 { "Optiarc DVD RW AD-7200A", NULL
, IDE_AFLAG_PLAY_AUDIO_OK
},
1727 { "Optiarc DVD RW AD-7543A", NULL
, IDE_AFLAG_NO_AUTOCLOSE
},
1728 { "TEAC CD-ROM CD-224E", NULL
, IDE_AFLAG_NO_AUTOCLOSE
},
1732 static unsigned int ide_cd_flags(u16
*id
)
1734 const struct cd_list_entry
*cle
= ide_cd_quirks_list
;
1736 while (cle
->id_model
) {
1737 if (strcmp(cle
->id_model
, (char *)&id
[ATA_ID_PROD
]) == 0 &&
1738 (cle
->id_firmware
== NULL
||
1739 strstr((char *)&id
[ATA_ID_FW_REV
], cle
->id_firmware
)))
1740 return cle
->cd_flags
;
1747 static int ide_cdrom_setup(ide_drive_t
*drive
)
1749 struct cdrom_info
*cd
= drive
->driver_data
;
1750 struct cdrom_device_info
*cdi
= &cd
->devinfo
;
1751 u16
*id
= drive
->id
;
1752 char *fw_rev
= (char *)&id
[ATA_ID_FW_REV
];
1755 ide_debug_log(IDE_DBG_PROBE
, "enter");
1757 blk_queue_prep_rq(drive
->queue
, ide_cdrom_prep_fn
);
1758 blk_queue_dma_alignment(drive
->queue
, 31);
1759 blk_queue_update_dma_pad(drive
->queue
, 15);
1760 drive
->queue
->unplug_delay
= (1 * HZ
) / 1000;
1761 if (!drive
->queue
->unplug_delay
)
1762 drive
->queue
->unplug_delay
= 1;
1764 drive
->dev_flags
|= IDE_DFLAG_MEDIA_CHANGED
;
1765 drive
->atapi_flags
= IDE_AFLAG_NO_EJECT
| ide_cd_flags(id
);
1767 if ((drive
->atapi_flags
& IDE_AFLAG_VERTOS_300_SSD
) &&
1768 fw_rev
[4] == '1' && fw_rev
[6] <= '2')
1769 drive
->atapi_flags
|= (IDE_AFLAG_TOCTRACKS_AS_BCD
|
1770 IDE_AFLAG_TOCADDR_AS_BCD
);
1771 else if ((drive
->atapi_flags
& IDE_AFLAG_VERTOS_600_ESD
) &&
1772 fw_rev
[4] == '1' && fw_rev
[6] <= '2')
1773 drive
->atapi_flags
|= IDE_AFLAG_TOCTRACKS_AS_BCD
;
1774 else if (drive
->atapi_flags
& IDE_AFLAG_SANYO_3CD
)
1775 /* 3 => use CD in slot 0 */
1776 cdi
->sanyo_slot
= 3;
1778 nslots
= ide_cdrom_probe_capabilities(drive
);
1780 /* set correct block size */
1781 blk_queue_hardsect_size(drive
->queue
, CD_FRAMESIZE
);
1783 if (ide_cdrom_register(drive
, nslots
)) {
1784 printk(KERN_ERR PFX
"%s: %s failed to register device with the"
1785 " cdrom driver.\n", drive
->name
, __func__
);
1786 cd
->devinfo
.handle
= NULL
;
1790 ide_proc_register_driver(drive
, cd
->driver
);
1794 static void ide_cd_remove(ide_drive_t
*drive
)
1796 struct cdrom_info
*info
= drive
->driver_data
;
1798 ide_debug_log(IDE_DBG_FUNC
, "enter");
1800 ide_proc_unregister_driver(drive
, info
->driver
);
1801 device_del(&info
->dev
);
1802 del_gendisk(info
->disk
);
1804 mutex_lock(&idecd_ref_mutex
);
1805 put_device(&info
->dev
);
1806 mutex_unlock(&idecd_ref_mutex
);
1809 static void ide_cd_release(struct device
*dev
)
1811 struct cdrom_info
*info
= to_ide_drv(dev
, cdrom_info
);
1812 struct cdrom_device_info
*devinfo
= &info
->devinfo
;
1813 ide_drive_t
*drive
= info
->drive
;
1814 struct gendisk
*g
= info
->disk
;
1816 ide_debug_log(IDE_DBG_FUNC
, "enter");
1819 if (devinfo
->handle
== drive
)
1820 unregister_cdrom(devinfo
);
1821 drive
->driver_data
= NULL
;
1822 blk_queue_prep_rq(drive
->queue
, NULL
);
1823 g
->private_data
= NULL
;
1828 static int ide_cd_probe(ide_drive_t
*);
1830 static struct ide_driver ide_cdrom_driver
= {
1832 .owner
= THIS_MODULE
,
1833 .name
= "ide-cdrom",
1834 .bus
= &ide_bus_type
,
1836 .probe
= ide_cd_probe
,
1837 .remove
= ide_cd_remove
,
1838 .version
= IDECD_VERSION
,
1839 .do_request
= ide_cd_do_request
,
1840 #ifdef CONFIG_IDE_PROC_FS
1841 .proc_entries
= ide_cd_proc_entries
,
1842 .proc_devsets
= ide_cd_proc_devsets
,
1846 static int idecd_open(struct block_device
*bdev
, fmode_t mode
)
1848 struct cdrom_info
*info
= ide_cd_get(bdev
->bd_disk
);
1854 rc
= cdrom_open(&info
->devinfo
, bdev
, mode
);
1862 static int idecd_release(struct gendisk
*disk
, fmode_t mode
)
1864 struct cdrom_info
*info
= ide_drv_g(disk
, cdrom_info
);
1866 cdrom_release(&info
->devinfo
, mode
);
1873 static int idecd_set_spindown(struct cdrom_device_info
*cdi
, unsigned long arg
)
1875 struct packet_command cgc
;
1880 if (copy_from_user(&spindown
, (void __user
*)arg
, sizeof(char)))
1883 init_cdrom_command(&cgc
, buffer
, sizeof(buffer
), CGC_DATA_UNKNOWN
);
1885 stat
= cdrom_mode_sense(cdi
, &cgc
, GPMODE_CDROM_PAGE
, 0);
1889 buffer
[11] = (buffer
[11] & 0xf0) | (spindown
& 0x0f);
1890 return cdrom_mode_select(cdi
, &cgc
);
1893 static int idecd_get_spindown(struct cdrom_device_info
*cdi
, unsigned long arg
)
1895 struct packet_command cgc
;
1900 init_cdrom_command(&cgc
, buffer
, sizeof(buffer
), CGC_DATA_UNKNOWN
);
1902 stat
= cdrom_mode_sense(cdi
, &cgc
, GPMODE_CDROM_PAGE
, 0);
1906 spindown
= buffer
[11] & 0x0f;
1907 if (copy_to_user((void __user
*)arg
, &spindown
, sizeof(char)))
1912 static int idecd_ioctl(struct block_device
*bdev
, fmode_t mode
,
1913 unsigned int cmd
, unsigned long arg
)
1915 struct cdrom_info
*info
= ide_drv_g(bdev
->bd_disk
, cdrom_info
);
1919 case CDROMSETSPINDOWN
:
1920 return idecd_set_spindown(&info
->devinfo
, arg
);
1921 case CDROMGETSPINDOWN
:
1922 return idecd_get_spindown(&info
->devinfo
, arg
);
1927 err
= generic_ide_ioctl(info
->drive
, bdev
, cmd
, arg
);
1929 err
= cdrom_ioctl(&info
->devinfo
, bdev
, mode
, cmd
, arg
);
1934 static int idecd_media_changed(struct gendisk
*disk
)
1936 struct cdrom_info
*info
= ide_drv_g(disk
, cdrom_info
);
1937 return cdrom_media_changed(&info
->devinfo
);
1940 static int idecd_revalidate_disk(struct gendisk
*disk
)
1942 struct cdrom_info
*info
= ide_drv_g(disk
, cdrom_info
);
1943 struct request_sense sense
;
1945 ide_cd_read_toc(info
->drive
, &sense
);
1950 static struct block_device_operations idecd_ops
= {
1951 .owner
= THIS_MODULE
,
1953 .release
= idecd_release
,
1954 .locked_ioctl
= idecd_ioctl
,
1955 .media_changed
= idecd_media_changed
,
1956 .revalidate_disk
= idecd_revalidate_disk
1959 /* module options */
1960 static char *ignore
;
1961 module_param(ignore
, charp
, 0400);
1963 static unsigned long debug_mask
;
1964 module_param(debug_mask
, ulong
, 0644);
1966 MODULE_DESCRIPTION("ATAPI CD-ROM Driver");
1968 static int ide_cd_probe(ide_drive_t
*drive
)
1970 struct cdrom_info
*info
;
1972 struct request_sense sense
;
1974 ide_debug_log(IDE_DBG_PROBE
, "driver_req: %s, media: 0x%x",
1975 drive
->driver_req
, drive
->media
);
1977 if (!strstr("ide-cdrom", drive
->driver_req
))
1980 if (drive
->media
!= ide_cdrom
&& drive
->media
!= ide_optical
)
1983 /* skip drives that we were told to ignore */
1984 if (ignore
!= NULL
) {
1985 if (strstr(ignore
, drive
->name
)) {
1986 printk(KERN_INFO PFX
"ignoring drive %s\n",
1992 drive
->debug_mask
= debug_mask
;
1993 drive
->irq_handler
= cdrom_newpc_intr
;
1995 info
= kzalloc(sizeof(struct cdrom_info
), GFP_KERNEL
);
1997 printk(KERN_ERR PFX
"%s: Can't allocate a cdrom structure\n",
2002 g
= alloc_disk(1 << PARTN_BITS
);
2006 ide_init_disk(g
, drive
);
2008 info
->dev
.parent
= &drive
->gendev
;
2009 info
->dev
.release
= ide_cd_release
;
2010 dev_set_name(&info
->dev
, dev_name(&drive
->gendev
));
2012 if (device_register(&info
->dev
))
2015 info
->drive
= drive
;
2016 info
->driver
= &ide_cdrom_driver
;
2019 g
->private_data
= &info
->driver
;
2021 drive
->driver_data
= info
;
2024 g
->driverfs_dev
= &drive
->gendev
;
2025 g
->flags
= GENHD_FL_CD
| GENHD_FL_REMOVABLE
;
2026 if (ide_cdrom_setup(drive
)) {
2027 put_device(&info
->dev
);
2031 ide_cd_read_toc(drive
, &sense
);
2032 g
->fops
= &idecd_ops
;
2033 g
->flags
|= GENHD_FL_REMOVABLE
;
2045 static void __exit
ide_cdrom_exit(void)
2047 driver_unregister(&ide_cdrom_driver
.gen_driver
);
2050 static int __init
ide_cdrom_init(void)
2052 printk(KERN_INFO DRV_NAME
" driver " IDECD_VERSION
"\n");
2053 return driver_register(&ide_cdrom_driver
.gen_driver
);
2056 MODULE_ALIAS("ide:*m-cdrom*");
2057 MODULE_ALIAS("ide-cd");
2058 module_init(ide_cdrom_init
);
2059 module_exit(ide_cdrom_exit
);
2060 MODULE_LICENSE("GPL");