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. ;-)
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
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 * For historical changelog please see:
23 * Documentation/ide/ChangeLog.ide-cd.1994-2004
26 #define DRV_NAME "ide-cd"
27 #define PFX DRV_NAME ": "
29 #define IDECD_VERSION "5.00"
31 #include <linux/module.h>
32 #include <linux/types.h>
33 #include <linux/kernel.h>
34 #include <linux/delay.h>
35 #include <linux/timer.h>
36 #include <linux/slab.h>
37 #include <linux/interrupt.h>
38 #include <linux/errno.h>
39 #include <linux/cdrom.h>
40 #include <linux/ide.h>
41 #include <linux/completion.h>
42 #include <linux/mutex.h>
43 #include <linux/bcd.h>
45 /* For SCSI -> ATAPI command conversion */
46 #include <scsi/scsi.h>
48 #include <linux/irq.h>
50 #include <asm/byteorder.h>
51 #include <linux/uaccess.h>
52 #include <asm/unaligned.h>
56 #define IDECD_DEBUG_LOG 1
59 #define ide_debug_log(lvl, fmt, args...) __ide_debug_log(lvl, fmt, args)
61 #define ide_debug_log(lvl, fmt, args...) do {} while (0)
64 static DEFINE_MUTEX(idecd_ref_mutex
);
66 static void ide_cd_release(struct kref
*);
68 static struct cdrom_info
*ide_cd_get(struct gendisk
*disk
)
70 struct cdrom_info
*cd
= NULL
;
72 mutex_lock(&idecd_ref_mutex
);
73 cd
= ide_drv_g(disk
, cdrom_info
);
75 if (ide_device_get(cd
->drive
))
81 mutex_unlock(&idecd_ref_mutex
);
85 static void ide_cd_put(struct cdrom_info
*cd
)
87 ide_drive_t
*drive
= cd
->drive
;
89 mutex_lock(&idecd_ref_mutex
);
90 kref_put(&cd
->kref
, ide_cd_release
);
91 ide_device_put(drive
);
92 mutex_unlock(&idecd_ref_mutex
);
96 * Generic packet command support and error handling routines.
99 /* Mark that we've seen a media change and invalidate our internal buffers. */
100 static void cdrom_saw_media_change(ide_drive_t
*drive
)
102 drive
->dev_flags
|= IDE_DFLAG_MEDIA_CHANGED
;
103 drive
->atapi_flags
&= ~IDE_AFLAG_TOC_VALID
;
106 static int cdrom_log_sense(ide_drive_t
*drive
, struct request
*rq
,
107 struct request_sense
*sense
)
111 ide_debug_log(IDE_DBG_SENSE
, "Call %s, sense_key: 0x%x\n", __func__
,
114 if (!sense
|| !rq
|| (rq
->cmd_flags
& REQ_QUIET
))
117 switch (sense
->sense_key
) {
119 case RECOVERED_ERROR
:
123 * don't care about tray state messages for e.g. capacity
124 * commands or in-progress or becoming ready
126 if (sense
->asc
== 0x3a || sense
->asc
== 0x04)
130 case ILLEGAL_REQUEST
:
132 * don't log START_STOP unit with LoEj set, since we cannot
133 * reliably check if drive can auto-close
135 if (rq
->cmd
[0] == GPCMD_START_STOP_UNIT
&& sense
->asc
== 0x24)
141 * Make good and sure we've seen this potential media change.
142 * Some drives (i.e. Creative) fail to present the correct sense
143 * key in the error register.
145 cdrom_saw_media_change(drive
);
154 static void cdrom_analyze_sense_data(ide_drive_t
*drive
,
155 struct request
*failed_command
,
156 struct request_sense
*sense
)
158 unsigned long sector
;
159 unsigned long bio_sectors
;
160 struct cdrom_info
*info
= drive
->driver_data
;
162 ide_debug_log(IDE_DBG_SENSE
, "Call %s, error_code: 0x%x, "
163 "sense_key: 0x%x\n", __func__
, sense
->error_code
,
167 ide_debug_log(IDE_DBG_SENSE
, "%s: failed cmd: 0x%x\n",
168 __func__
, failed_command
->cmd
[0]);
170 if (!cdrom_log_sense(drive
, failed_command
, sense
))
174 * If a read toc is executed for a CD-R or CD-RW medium where the first
175 * toc has not been recorded yet, it will fail with 05/24/00 (which is a
178 if (failed_command
&& failed_command
->cmd
[0] == GPCMD_READ_TOC_PMA_ATIP
)
179 if (sense
->sense_key
== 0x05 && sense
->asc
== 0x24)
183 if (sense
->error_code
== 0x70) {
184 switch (sense
->sense_key
) {
186 case VOLUME_OVERFLOW
:
187 case ILLEGAL_REQUEST
:
190 if (failed_command
== NULL
||
191 !blk_fs_request(failed_command
))
193 sector
= (sense
->information
[0] << 24) |
194 (sense
->information
[1] << 16) |
195 (sense
->information
[2] << 8) |
196 (sense
->information
[3]);
198 if (drive
->queue
->hardsect_size
== 2048)
199 /* device sector size is 2K */
202 bio_sectors
= max(bio_sectors(failed_command
->bio
), 4U);
203 sector
&= ~(bio_sectors
- 1);
205 if (sector
< get_capacity(info
->disk
) &&
206 drive
->probed_capacity
- sector
< 4 * 75)
207 set_capacity(info
->disk
, sector
);
211 ide_cd_log_error(drive
->name
, failed_command
, sense
);
214 static void cdrom_queue_request_sense(ide_drive_t
*drive
, void *sense
,
215 struct request
*failed_command
)
217 struct cdrom_info
*info
= drive
->driver_data
;
218 struct request
*rq
= &info
->request_sense_request
;
220 ide_debug_log(IDE_DBG_SENSE
, "Call %s\n", __func__
);
223 sense
= &info
->sense_data
;
225 /* stuff the sense request in front of our current request */
226 blk_rq_init(NULL
, rq
);
227 rq
->cmd_type
= REQ_TYPE_ATA_PC
;
228 rq
->rq_disk
= info
->disk
;
231 rq
->cmd
[0] = GPCMD_REQUEST_SENSE
;
235 rq
->cmd_type
= REQ_TYPE_SENSE
;
236 rq
->cmd_flags
|= REQ_PREEMPT
;
238 /* NOTE! Save the failed command in "rq->buffer" */
239 rq
->buffer
= (void *) failed_command
;
242 ide_debug_log(IDE_DBG_SENSE
, "failed_cmd: 0x%x\n",
243 failed_command
->cmd
[0]);
245 ide_do_drive_cmd(drive
, rq
);
248 static void cdrom_end_request(ide_drive_t
*drive
, int uptodate
)
250 struct request
*rq
= HWGROUP(drive
)->rq
;
251 int nsectors
= rq
->hard_cur_sectors
;
253 ide_debug_log(IDE_DBG_FUNC
, "Call %s, cmd: 0x%x, uptodate: 0x%x, "
254 "nsectors: %d\n", __func__
, rq
->cmd
[0], uptodate
,
257 if (blk_sense_request(rq
) && uptodate
) {
259 * For REQ_TYPE_SENSE, "rq->buffer" points to the original
262 struct request
*failed
= (struct request
*) rq
->buffer
;
263 struct cdrom_info
*info
= drive
->driver_data
;
264 void *sense
= &info
->sense_data
;
269 sense
= failed
->sense
;
270 failed
->sense_len
= rq
->sense_len
;
272 cdrom_analyze_sense_data(drive
, failed
, sense
);
274 * now end the failed request
276 if (blk_fs_request(failed
)) {
277 if (ide_end_dequeued_request(drive
, failed
, 0,
278 failed
->hard_nr_sectors
))
281 spin_lock_irqsave(&ide_lock
, flags
);
282 if (__blk_end_request(failed
, -EIO
,
285 spin_unlock_irqrestore(&ide_lock
, flags
);
288 cdrom_analyze_sense_data(drive
, NULL
, sense
);
291 if (!rq
->current_nr_sectors
&& blk_fs_request(rq
))
293 /* make sure it's fully ended */
294 if (blk_pc_request(rq
))
295 nsectors
= (rq
->data_len
+ 511) >> 9;
299 ide_debug_log(IDE_DBG_FUNC
, "Exit %s, uptodate: 0x%x, nsectors: %d\n",
300 __func__
, uptodate
, nsectors
);
302 ide_end_request(drive
, uptodate
, nsectors
);
305 static void ide_dump_status_no_sense(ide_drive_t
*drive
, const char *msg
, u8 st
)
309 ide_dump_status(drive
, msg
, st
);
314 * 0: if the request should be continued.
315 * 1: if the request was ended.
317 static int cdrom_decode_status(ide_drive_t
*drive
, int good_stat
, int *stat_ret
)
319 ide_hwif_t
*hwif
= drive
->hwif
;
320 ide_hwgroup_t
*hwgroup
= hwif
->hwgroup
;
321 struct request
*rq
= hwgroup
->rq
;
322 int stat
, err
, sense_key
;
324 /* check for errors */
325 stat
= hwif
->tp_ops
->read_status(hwif
);
330 if (OK_STAT(stat
, good_stat
, BAD_R_STAT
))
333 /* get the IDE error register */
334 err
= ide_read_error(drive
);
335 sense_key
= err
>> 4;
338 printk(KERN_ERR PFX
"%s: missing rq in %s\n",
339 drive
->name
, __func__
);
343 ide_debug_log(IDE_DBG_RQ
, "%s: stat: 0x%x, good_stat: 0x%x, "
344 "rq->cmd[0]: 0x%x, rq->cmd_type: 0x%x, err: 0x%x\n",
345 __func__
, stat
, good_stat
, rq
->cmd
[0], rq
->cmd_type
, err
);
347 if (blk_sense_request(rq
)) {
349 * We got an error trying to get sense info from the drive
350 * (probably while trying to recover from a former error).
353 rq
->cmd_flags
|= REQ_FAILED
;
354 cdrom_end_request(drive
, 0);
355 ide_error(drive
, "request sense failure", stat
);
358 } else if (blk_pc_request(rq
) || rq
->cmd_type
== REQ_TYPE_ATA_PC
) {
359 /* All other functions, except for READ. */
362 * if we have an error, pass back CHECK_CONDITION as the
365 if (blk_pc_request(rq
) && !rq
->errors
)
366 rq
->errors
= SAM_STAT_CHECK_CONDITION
;
368 /* check for tray open */
369 if (sense_key
== NOT_READY
) {
370 cdrom_saw_media_change(drive
);
371 } else if (sense_key
== UNIT_ATTENTION
) {
372 /* check for media change */
373 cdrom_saw_media_change(drive
);
375 } else if (sense_key
== ILLEGAL_REQUEST
&&
376 rq
->cmd
[0] == GPCMD_START_STOP_UNIT
) {
378 * Don't print error message for this condition--
379 * SFF8090i indicates that 5/24/00 is the correct
380 * response to a request to close the tray if the
381 * drive doesn't have that capability.
382 * cdrom_log_sense() knows this!
384 } else if (!(rq
->cmd_flags
& REQ_QUIET
)) {
385 /* otherwise, print an error */
386 ide_dump_status(drive
, "packet command error", stat
);
389 rq
->cmd_flags
|= REQ_FAILED
;
392 * instead of playing games with moving completions around,
393 * remove failed request completely and end it when the
394 * request sense has completed
398 } else if (blk_fs_request(rq
)) {
399 int do_end_request
= 0;
401 /* handle errors from READ and WRITE requests */
403 if (blk_noretry_request(rq
))
406 if (sense_key
== NOT_READY
) {
408 if (rq_data_dir(rq
) == READ
) {
409 cdrom_saw_media_change(drive
);
411 /* fail the request */
412 printk(KERN_ERR PFX
"%s: tray open\n",
416 struct cdrom_info
*info
= drive
->driver_data
;
419 * Allow the drive 5 seconds to recover, some
420 * devices will return this error while flushing
424 info
->write_timeout
= jiffies
+
425 ATAPI_WAIT_WRITE_BUSY
;
427 if (time_after(jiffies
, info
->write_timeout
))
433 * take a breather relying on the unplug
434 * timer to kick us again
436 spin_lock_irqsave(&ide_lock
, flags
);
437 blk_plug_device(drive
->queue
);
438 spin_unlock_irqrestore(&ide_lock
,
443 } else if (sense_key
== UNIT_ATTENTION
) {
445 cdrom_saw_media_change(drive
);
448 * Arrange to retry the request but be sure to give up
449 * if we've retried too many times.
451 if (++rq
->errors
> ERROR_MAX
)
453 } else if (sense_key
== ILLEGAL_REQUEST
||
454 sense_key
== DATA_PROTECT
) {
456 * No point in retrying after an illegal request or data
459 ide_dump_status_no_sense(drive
, "command error", stat
);
461 } else if (sense_key
== MEDIUM_ERROR
) {
463 * No point in re-trying a zillion times on a bad
464 * sector. If we got here the error is not correctable.
466 ide_dump_status_no_sense(drive
,
467 "media error (bad sector)",
470 } else if (sense_key
== BLANK_CHECK
) {
471 /* disk appears blank ?? */
472 ide_dump_status_no_sense(drive
, "media error (blank)",
475 } else if ((err
& ~ATA_ABORTED
) != 0) {
476 /* go to the default handler for other errors */
477 ide_error(drive
, "cdrom_decode_status", stat
);
479 } else if ((++rq
->errors
> ERROR_MAX
)) {
480 /* we've racked up too many retries, abort */
485 * End a request through request sense analysis when we have
486 * sense data. We need this in order to perform end of media
493 * If we got a CHECK_CONDITION status, queue
494 * a request sense command.
497 cdrom_queue_request_sense(drive
, NULL
, NULL
);
499 blk_dump_rq_flags(rq
, PFX
"bad rq");
500 cdrom_end_request(drive
, 0);
503 /* retry, or handle the next request */
507 if (stat
& ATA_ERR
) {
510 spin_lock_irqsave(&ide_lock
, flags
);
511 blkdev_dequeue_request(rq
);
512 spin_unlock_irqrestore(&ide_lock
, flags
);
516 cdrom_queue_request_sense(drive
, rq
->sense
, rq
);
518 cdrom_end_request(drive
, 0);
523 static int cdrom_timer_expiry(ide_drive_t
*drive
)
525 struct request
*rq
= HWGROUP(drive
)->rq
;
526 unsigned long wait
= 0;
528 ide_debug_log(IDE_DBG_RQ
, "Call %s: rq->cmd[0]: 0x%x\n", __func__
,
532 * Some commands are *slow* and normally take a long time to complete.
533 * Usually we can use the ATAPI "disconnect" to bypass this, but not all
534 * commands/drives support that. Let ide_timer_expiry keep polling us
537 switch (rq
->cmd
[0]) {
539 case GPCMD_FORMAT_UNIT
:
540 case GPCMD_RESERVE_RZONE_TRACK
:
541 case GPCMD_CLOSE_TRACK
:
542 case GPCMD_FLUSH_CACHE
:
543 wait
= ATAPI_WAIT_PC
;
546 if (!(rq
->cmd_flags
& REQ_QUIET
))
547 printk(KERN_INFO PFX
"cmd 0x%x timed out\n",
556 * Set up the device registers for transferring a packet command on DEV,
557 * expecting to later transfer XFERLEN bytes. HANDLER is the routine
558 * which actually transfers the command to the drive. If this is a
559 * drq_interrupt device, this routine will arrange for HANDLER to be
560 * called when the interrupt from the drive arrives. Otherwise, HANDLER
561 * will be called immediately after the drive is prepared for the transfer.
563 static ide_startstop_t
cdrom_start_packet_command(ide_drive_t
*drive
,
565 ide_handler_t
*handler
)
567 ide_hwif_t
*hwif
= drive
->hwif
;
569 ide_debug_log(IDE_DBG_PC
, "Call %s, xferlen: %d\n", __func__
, xferlen
);
571 /* FIXME: for Virtual DMA we must check harder */
573 drive
->dma
= !hwif
->dma_ops
->dma_setup(drive
);
575 /* set up the controller registers */
576 ide_pktcmd_tf_load(drive
, IDE_TFLAG_OUT_NSECT
| IDE_TFLAG_OUT_LBAL
,
577 xferlen
, drive
->dma
);
579 if (drive
->atapi_flags
& IDE_AFLAG_DRQ_INTERRUPT
) {
580 /* waiting for CDB interrupt, not DMA yet. */
582 drive
->waiting_for_dma
= 0;
585 ide_execute_command(drive
, ATA_CMD_PACKET
, handler
,
586 ATAPI_WAIT_PC
, cdrom_timer_expiry
);
589 ide_execute_pkt_cmd(drive
);
591 return (*handler
) (drive
);
596 * Send a packet command to DRIVE described by CMD_BUF and CMD_LEN. The device
597 * registers must have already been prepared by cdrom_start_packet_command.
598 * HANDLER is the interrupt handler to call when the command completes or
599 * there's data ready.
601 #define ATAPI_MIN_CDB_BYTES 12
602 static ide_startstop_t
cdrom_transfer_packet_command(ide_drive_t
*drive
,
604 ide_handler_t
*handler
)
606 ide_hwif_t
*hwif
= drive
->hwif
;
608 ide_startstop_t startstop
;
610 ide_debug_log(IDE_DBG_PC
, "Call %s\n", __func__
);
612 if (drive
->atapi_flags
& IDE_AFLAG_DRQ_INTERRUPT
) {
614 * Here we should have been called after receiving an interrupt
615 * from the device. DRQ should how be set.
618 /* check for errors */
619 if (cdrom_decode_status(drive
, ATA_DRQ
, NULL
))
622 /* ok, next interrupt will be DMA interrupt */
624 drive
->waiting_for_dma
= 1;
626 /* otherwise, we must wait for DRQ to get set */
627 if (ide_wait_stat(&startstop
, drive
, ATA_DRQ
,
628 ATA_BUSY
, WAIT_READY
))
632 /* arm the interrupt handler */
633 ide_set_handler(drive
, handler
, rq
->timeout
, cdrom_timer_expiry
);
635 /* ATAPI commands get padded out to 12 bytes minimum */
636 cmd_len
= COMMAND_SIZE(rq
->cmd
[0]);
637 if (cmd_len
< ATAPI_MIN_CDB_BYTES
)
638 cmd_len
= ATAPI_MIN_CDB_BYTES
;
640 /* send the command to the device */
641 hwif
->tp_ops
->output_data(drive
, NULL
, rq
->cmd
, cmd_len
);
643 /* start the DMA if need be */
645 hwif
->dma_ops
->dma_start(drive
);
651 * Check the contents of the interrupt reason register from the cdrom
652 * and attempt to recover if there are problems. Returns 0 if everything's
653 * ok; nonzero if the request has been terminated.
655 static int ide_cd_check_ireason(ide_drive_t
*drive
, struct request
*rq
,
656 int len
, int ireason
, int rw
)
658 ide_hwif_t
*hwif
= drive
->hwif
;
660 ide_debug_log(IDE_DBG_FUNC
, "Call %s, ireason: 0x%x, rw: 0x%x\n",
661 __func__
, ireason
, rw
);
664 * ireason == 0: the drive wants to receive data from us
665 * ireason == 2: the drive is expecting to transfer data to us
667 if (ireason
== (!rw
<< 1))
669 else if (ireason
== (rw
<< 1)) {
672 printk(KERN_ERR PFX
"%s: %s: wrong transfer direction!\n",
673 drive
->name
, __func__
);
675 ide_pad_transfer(drive
, rw
, len
);
676 } else if (rw
== 0 && ireason
== 1) {
678 * Some drives (ASUS) seem to tell us that status info is
679 * available. Just get it and ignore.
681 (void)hwif
->tp_ops
->read_status(hwif
);
684 /* drive wants a command packet, or invalid ireason... */
685 printk(KERN_ERR PFX
"%s: %s: bad interrupt reason 0x%02x\n",
686 drive
->name
, __func__
, ireason
);
689 if (rq
->cmd_type
== REQ_TYPE_ATA_PC
)
690 rq
->cmd_flags
|= REQ_FAILED
;
692 cdrom_end_request(drive
, 0);
697 * Assume that the drive will always provide data in multiples of at least
698 * SECTOR_SIZE, as it gets hairy to keep track of the transfers otherwise.
700 static int ide_cd_check_transfer_size(ide_drive_t
*drive
, int len
)
702 ide_debug_log(IDE_DBG_FUNC
, "Call %s, len: %d\n", __func__
, len
);
704 if ((len
% SECTOR_SIZE
) == 0)
707 printk(KERN_ERR PFX
"%s: %s: Bad transfer size %d\n", drive
->name
,
710 if (drive
->atapi_flags
& IDE_AFLAG_LIMIT_NFRAMES
)
711 printk(KERN_ERR PFX
"This drive is not supported by this "
712 "version of the driver\n");
714 printk(KERN_ERR PFX
"Trying to limit transfer sizes\n");
715 drive
->atapi_flags
|= IDE_AFLAG_LIMIT_NFRAMES
;
721 static ide_startstop_t
cdrom_newpc_intr(ide_drive_t
*);
723 static ide_startstop_t
ide_cd_prepare_rw_request(ide_drive_t
*drive
,
726 ide_debug_log(IDE_DBG_RQ
, "Call %s: rq->cmd_flags: 0x%x\n", __func__
,
729 if (rq_data_dir(rq
) == READ
) {
730 unsigned short sectors_per_frame
=
731 queue_hardsect_size(drive
->queue
) >> SECTOR_BITS
;
732 int nskip
= rq
->sector
& (sectors_per_frame
- 1);
735 * If the requested sector doesn't start on a frame boundary,
736 * we must adjust the start of the transfer so that it does,
737 * and remember to skip the first few sectors.
739 * If the rq->current_nr_sectors field is larger than the size
740 * of the buffer, it will mean that we're to skip a number of
741 * sectors equal to the amount by which rq->current_nr_sectors
742 * is larger than the buffer size.
745 /* sanity check... */
746 if (rq
->current_nr_sectors
!=
747 bio_cur_sectors(rq
->bio
)) {
748 printk(KERN_ERR PFX
"%s: %s: buffer botch (%u)\n",
749 drive
->name
, __func__
,
750 rq
->current_nr_sectors
);
751 cdrom_end_request(drive
, 0);
754 rq
->current_nr_sectors
+= nskip
;
758 /* set up the command */
759 rq
->timeout
= ATAPI_WAIT_PC
;
765 * Routine to send a read/write packet command to the drive. This is usually
766 * called directly from cdrom_start_{read,write}(). However, for drq_interrupt
767 * devices, it is called from an interrupt when the drive is ready to accept
770 static ide_startstop_t
cdrom_start_rw_cont(ide_drive_t
*drive
)
772 struct request
*rq
= drive
->hwif
->hwgroup
->rq
;
774 /* send the command to the drive and return */
775 return cdrom_transfer_packet_command(drive
, rq
, cdrom_newpc_intr
);
778 #define IDECD_SEEK_THRESHOLD (1000) /* 1000 blocks */
779 #define IDECD_SEEK_TIMER (5 * WAIT_MIN_SLEEP) /* 100 ms */
780 #define IDECD_SEEK_TIMEOUT (2 * WAIT_CMD) /* 20 sec */
782 static ide_startstop_t
cdrom_seek_intr(ide_drive_t
*drive
)
784 struct cdrom_info
*info
= drive
->driver_data
;
786 static int retry
= 10;
788 ide_debug_log(IDE_DBG_FUNC
, "Call %s\n", __func__
);
790 if (cdrom_decode_status(drive
, 0, &stat
))
793 drive
->atapi_flags
|= IDE_AFLAG_SEEKING
;
795 if (retry
&& time_after(jiffies
, info
->start_seek
+ IDECD_SEEK_TIMER
)) {
797 drive
->dev_flags
&= ~IDE_DFLAG_DSC_OVERLAP
;
802 static void ide_cd_prepare_seek_request(ide_drive_t
*drive
, struct request
*rq
)
804 sector_t frame
= rq
->sector
;
806 ide_debug_log(IDE_DBG_FUNC
, "Call %s\n", __func__
);
808 sector_div(frame
, queue_hardsect_size(drive
->queue
) >> SECTOR_BITS
);
810 memset(rq
->cmd
, 0, BLK_MAX_CDB
);
811 rq
->cmd
[0] = GPCMD_SEEK
;
812 put_unaligned(cpu_to_be32(frame
), (unsigned int *) &rq
->cmd
[2]);
814 rq
->timeout
= ATAPI_WAIT_PC
;
817 static ide_startstop_t
cdrom_start_seek_continuation(ide_drive_t
*drive
)
819 struct request
*rq
= drive
->hwif
->hwgroup
->rq
;
821 return cdrom_transfer_packet_command(drive
, rq
, &cdrom_seek_intr
);
825 * Fix up a possibly partially-processed request so that we can start it over
826 * entirely, or even put it back on the request queue.
828 static void ide_cd_restore_request(ide_drive_t
*drive
, struct request
*rq
)
831 ide_debug_log(IDE_DBG_FUNC
, "Call %s\n", __func__
);
833 if (rq
->buffer
!= bio_data(rq
->bio
)) {
835 (rq
->buffer
- (char *)bio_data(rq
->bio
)) / SECTOR_SIZE
;
837 rq
->buffer
= bio_data(rq
->bio
);
841 rq
->current_nr_sectors
= bio_cur_sectors(rq
->bio
);
842 rq
->hard_cur_sectors
= rq
->current_nr_sectors
;
843 rq
->hard_nr_sectors
= rq
->nr_sectors
;
844 rq
->hard_sector
= rq
->sector
;
845 rq
->q
->prep_rq_fn(rq
->q
, rq
);
848 static void ide_cd_request_sense_fixup(ide_drive_t
*drive
, struct request
*rq
)
850 ide_debug_log(IDE_DBG_FUNC
, "Call %s, rq->cmd[0]: 0x%x\n",
851 __func__
, rq
->cmd
[0]);
854 * Some of the trailing request sense fields are optional,
855 * and some drives don't send them. Sigh.
857 if (rq
->cmd
[0] == GPCMD_REQUEST_SENSE
&&
858 rq
->data_len
> 0 && rq
->data_len
<= 5)
859 while (rq
->data_len
> 0) {
860 *(u8
*)rq
->data
++ = 0;
865 int ide_cd_queue_pc(ide_drive_t
*drive
, const unsigned char *cmd
,
866 int write
, void *buffer
, unsigned *bufflen
,
867 struct request_sense
*sense
, int timeout
,
868 unsigned int cmd_flags
)
870 struct cdrom_info
*info
= drive
->driver_data
;
871 struct request_sense local_sense
;
873 unsigned int flags
= 0;
876 sense
= &local_sense
;
878 ide_debug_log(IDE_DBG_PC
, "Call %s, cmd[0]: 0x%x, write: 0x%x, "
879 "timeout: %d, cmd_flags: 0x%x\n", __func__
, cmd
[0], write
,
882 /* start of retry loop */
887 rq
= blk_get_request(drive
->queue
, write
, __GFP_WAIT
);
889 memcpy(rq
->cmd
, cmd
, BLK_MAX_CDB
);
890 rq
->cmd_type
= REQ_TYPE_ATA_PC
;
892 rq
->cmd_flags
|= cmd_flags
;
893 rq
->timeout
= timeout
;
896 rq
->data_len
= *bufflen
;
899 error
= blk_execute_rq(drive
->queue
, info
->disk
, rq
, 0);
902 *bufflen
= rq
->data_len
;
904 flags
= rq
->cmd_flags
;
908 * FIXME: we should probably abort/retry or something in case of
911 if (flags
& REQ_FAILED
) {
913 * The request failed. Retry if it was due to a unit
914 * attention status (usually means media was changed).
916 struct request_sense
*reqbuf
= sense
;
918 if (reqbuf
->sense_key
== UNIT_ATTENTION
)
919 cdrom_saw_media_change(drive
);
920 else if (reqbuf
->sense_key
== NOT_READY
&&
921 reqbuf
->asc
== 4 && reqbuf
->ascq
!= 4) {
923 * The drive is in the process of loading
924 * a disk. Retry, but wait a little to give
925 * the drive time to complete the load.
929 /* otherwise, don't retry */
935 /* end of retry loop */
936 } while ((flags
& REQ_FAILED
) && retries
>= 0);
938 /* return an error if the command failed */
939 return (flags
& REQ_FAILED
) ? -EIO
: 0;
943 * Called from blk_end_request_callback() after the data of the request is
944 * completed and before the request itself is completed. By returning value '1',
945 * blk_end_request_callback() returns immediately without completing it.
947 static int cdrom_newpc_intr_dummy_cb(struct request
*rq
)
952 static ide_startstop_t
cdrom_newpc_intr(ide_drive_t
*drive
)
954 ide_hwif_t
*hwif
= drive
->hwif
;
955 ide_hwgroup_t
*hwgroup
= hwif
->hwgroup
;
956 struct request
*rq
= hwgroup
->rq
;
957 xfer_func_t
*xferfunc
;
958 ide_expiry_t
*expiry
= NULL
;
959 int dma_error
= 0, dma
, stat
, thislen
, uptodate
= 0;
960 int write
= (rq_data_dir(rq
) == WRITE
) ? 1 : 0;
961 unsigned int timeout
;
965 ide_debug_log(IDE_DBG_PC
, "Call %s, rq->cmd[0]: 0x%x, write: 0x%x\n",
966 __func__
, rq
->cmd
[0], write
);
968 /* check for errors */
972 dma_error
= hwif
->dma_ops
->dma_end(drive
);
974 printk(KERN_ERR PFX
"%s: DMA %s error\n", drive
->name
,
975 write
? "write" : "read");
980 if (cdrom_decode_status(drive
, 0, &stat
))
983 /* using dma, transfer is complete now */
986 return ide_error(drive
, "dma error", stat
);
987 if (blk_fs_request(rq
)) {
988 ide_end_request(drive
, 1, rq
->nr_sectors
);
994 ide_read_bcount_and_ireason(drive
, &len
, &ireason
);
996 thislen
= blk_fs_request(rq
) ? len
: rq
->data_len
;
1000 ide_debug_log(IDE_DBG_PC
, "%s: DRQ: stat: 0x%x, thislen: %d\n",
1001 __func__
, stat
, thislen
);
1003 /* If DRQ is clear, the command has completed. */
1004 if ((stat
& ATA_DRQ
) == 0) {
1005 if (blk_fs_request(rq
)) {
1007 * If we're not done reading/writing, complain.
1008 * Otherwise, complete the command normally.
1011 if (rq
->current_nr_sectors
> 0) {
1012 printk(KERN_ERR PFX
"%s: %s: data underrun "
1014 drive
->name
, __func__
,
1015 rq
->current_nr_sectors
);
1017 rq
->cmd_flags
|= REQ_FAILED
;
1020 cdrom_end_request(drive
, uptodate
);
1022 } else if (!blk_pc_request(rq
)) {
1023 ide_cd_request_sense_fixup(drive
, rq
);
1024 /* complain if we still have data left to transfer */
1025 uptodate
= rq
->data_len
? 0 : 1;
1030 /* check which way to transfer data */
1031 if (ide_cd_check_ireason(drive
, rq
, len
, ireason
, write
))
1034 if (blk_fs_request(rq
)) {
1038 if (ide_cd_check_transfer_size(drive
, len
)) {
1039 cdrom_end_request(drive
, 0);
1044 * First, figure out if we need to bit-bucket
1045 * any of the leading sectors.
1047 nskip
= min_t(int, rq
->current_nr_sectors
1048 - bio_cur_sectors(rq
->bio
),
1051 ide_pad_transfer(drive
, write
, nskip
<< 9);
1052 rq
->current_nr_sectors
-= nskip
;
1053 thislen
-= (nskip
<< 9);
1060 xferfunc
= hwif
->tp_ops
->output_data
;
1063 xferfunc
= hwif
->tp_ops
->input_data
;
1066 ide_debug_log(IDE_DBG_PC
, "%s: data transfer, rq->cmd_type: 0x%x, "
1067 "ireason: 0x%x\n", __func__
, rq
->cmd_type
, ireason
);
1070 while (thislen
> 0) {
1071 u8
*ptr
= blk_fs_request(rq
) ? NULL
: rq
->data
;
1072 int blen
= rq
->data_len
;
1076 if (blk_fs_request(rq
)) {
1078 blen
= rq
->current_nr_sectors
<< 9;
1080 ptr
= bio_data(rq
->bio
);
1081 blen
= bio_iovec(rq
->bio
)->bv_len
;
1086 if (blk_fs_request(rq
) && !write
)
1088 * If the buffers are full, pipe the rest into
1091 ide_pad_transfer(drive
, 0, thislen
);
1093 printk(KERN_ERR PFX
"%s: confused, missing data\n",
1095 blk_dump_rq_flags(rq
, rq_data_dir(rq
)
1096 ? "cdrom_newpc_intr, write"
1097 : "cdrom_newpc_intr, read");
1105 xferfunc(drive
, NULL
, ptr
, blen
);
1110 if (blk_fs_request(rq
)) {
1112 rq
->nr_sectors
-= (blen
>> 9);
1113 rq
->current_nr_sectors
-= (blen
>> 9);
1114 rq
->sector
+= (blen
>> 9);
1116 if (rq
->current_nr_sectors
== 0 && rq
->nr_sectors
)
1117 cdrom_end_request(drive
, 1);
1119 rq
->data_len
-= blen
;
1122 * The request can't be completed until DRQ is cleared.
1123 * So complete the data, but don't complete the request
1124 * using the dummy function for the callback feature
1125 * of blk_end_request_callback().
1128 blk_end_request_callback(rq
, 0, blen
,
1129 cdrom_newpc_intr_dummy_cb
);
1133 if (!write
&& blk_sense_request(rq
))
1134 rq
->sense_len
+= blen
;
1137 /* pad, if necessary */
1138 if (!blk_fs_request(rq
) && len
> 0)
1139 ide_pad_transfer(drive
, write
, len
);
1141 if (blk_pc_request(rq
)) {
1142 timeout
= rq
->timeout
;
1144 timeout
= ATAPI_WAIT_PC
;
1145 if (!blk_fs_request(rq
))
1146 expiry
= cdrom_timer_expiry
;
1149 ide_set_handler(drive
, cdrom_newpc_intr
, timeout
, expiry
);
1153 if (blk_pc_request(rq
)) {
1154 unsigned long flags
;
1155 unsigned int dlen
= rq
->data_len
;
1160 spin_lock_irqsave(&ide_lock
, flags
);
1161 if (__blk_end_request(rq
, 0, dlen
))
1163 spin_unlock_irqrestore(&ide_lock
, flags
);
1168 rq
->cmd_flags
|= REQ_FAILED
;
1169 cdrom_end_request(drive
, uptodate
);
1174 static ide_startstop_t
cdrom_start_rw(ide_drive_t
*drive
, struct request
*rq
)
1176 struct cdrom_info
*cd
= drive
->driver_data
;
1177 int write
= rq_data_dir(rq
) == WRITE
;
1178 unsigned short sectors_per_frame
=
1179 queue_hardsect_size(drive
->queue
) >> SECTOR_BITS
;
1181 ide_debug_log(IDE_DBG_RQ
, "Call %s, rq->cmd[0]: 0x%x, write: 0x%x, "
1182 "secs_per_frame: %u\n",
1183 __func__
, rq
->cmd
[0], write
, sectors_per_frame
);
1186 /* disk has become write protected */
1187 if (get_disk_ro(cd
->disk
)) {
1188 cdrom_end_request(drive
, 0);
1193 * We may be retrying this request after an error. Fix up any
1194 * weirdness which might be present in the request packet.
1196 ide_cd_restore_request(drive
, rq
);
1199 /* use DMA, if possible / writes *must* be hardware frame aligned */
1200 if ((rq
->nr_sectors
& (sectors_per_frame
- 1)) ||
1201 (rq
->sector
& (sectors_per_frame
- 1))) {
1203 cdrom_end_request(drive
, 0);
1208 drive
->dma
= !!(drive
->dev_flags
& IDE_DFLAG_USING_DMA
);
1211 cd
->devinfo
.media_written
= 1;
1216 static ide_startstop_t
cdrom_do_newpc_cont(ide_drive_t
*drive
)
1218 struct request
*rq
= HWGROUP(drive
)->rq
;
1220 return cdrom_transfer_packet_command(drive
, rq
, cdrom_newpc_intr
);
1223 static void cdrom_do_block_pc(ide_drive_t
*drive
, struct request
*rq
)
1226 ide_debug_log(IDE_DBG_PC
, "Call %s, rq->cmd[0]: 0x%x, "
1227 "rq->cmd_type: 0x%x\n", __func__
, rq
->cmd
[0],
1230 if (blk_pc_request(rq
))
1231 rq
->cmd_flags
|= REQ_QUIET
;
1233 rq
->cmd_flags
&= ~REQ_FAILED
;
1238 if (rq
->bio
|| ((rq
->cmd_type
== REQ_TYPE_ATA_PC
) && rq
->data_len
)) {
1239 struct request_queue
*q
= drive
->queue
;
1240 unsigned int alignment
;
1244 buf
= bio_data(rq
->bio
);
1248 drive
->dma
= !!(drive
->dev_flags
& IDE_DFLAG_USING_DMA
);
1251 * check if dma is safe
1253 * NOTE! The "len" and "addr" checks should possibly have
1256 alignment
= queue_dma_alignment(q
) | q
->dma_pad_mask
;
1257 if ((unsigned long)buf
& alignment
1258 || rq
->data_len
& q
->dma_pad_mask
1259 || object_is_on_stack(buf
))
1264 static ide_startstop_t
ide_cd_do_request(ide_drive_t
*drive
, struct request
*rq
,
1267 struct cdrom_info
*info
= drive
->driver_data
;
1271 ide_debug_log(IDE_DBG_RQ
, "Call %s, rq->cmd[0]: 0x%x, "
1272 "rq->cmd_type: 0x%x, block: %llu\n",
1273 __func__
, rq
->cmd
[0], rq
->cmd_type
,
1274 (unsigned long long)block
);
1276 if (blk_fs_request(rq
)) {
1277 if (drive
->atapi_flags
& IDE_AFLAG_SEEKING
) {
1278 ide_hwif_t
*hwif
= drive
->hwif
;
1279 unsigned long elapsed
= jiffies
- info
->start_seek
;
1280 int stat
= hwif
->tp_ops
->read_status(hwif
);
1282 if ((stat
& ATA_DSC
) != ATA_DSC
) {
1283 if (elapsed
< IDECD_SEEK_TIMEOUT
) {
1284 ide_stall_queue(drive
,
1288 printk(KERN_ERR PFX
"%s: DSC timeout\n",
1291 drive
->atapi_flags
&= ~IDE_AFLAG_SEEKING
;
1293 if (rq_data_dir(rq
) == READ
&&
1294 IDE_LARGE_SEEK(info
->last_block
, block
,
1295 IDECD_SEEK_THRESHOLD
) &&
1296 (drive
->dev_flags
& IDE_DFLAG_DSC_OVERLAP
)) {
1298 fn
= cdrom_start_seek_continuation
;
1301 info
->start_seek
= jiffies
;
1303 ide_cd_prepare_seek_request(drive
, rq
);
1306 fn
= cdrom_start_rw_cont
;
1308 if (cdrom_start_rw(drive
, rq
) == ide_stopped
)
1311 if (ide_cd_prepare_rw_request(drive
, rq
) == ide_stopped
)
1314 info
->last_block
= block
;
1315 } else if (blk_sense_request(rq
) || blk_pc_request(rq
) ||
1316 rq
->cmd_type
== REQ_TYPE_ATA_PC
) {
1317 xferlen
= rq
->data_len
;
1318 fn
= cdrom_do_newpc_cont
;
1321 rq
->timeout
= ATAPI_WAIT_PC
;
1323 cdrom_do_block_pc(drive
, rq
);
1324 } else if (blk_special_request(rq
)) {
1325 /* right now this can only be a reset... */
1326 cdrom_end_request(drive
, 1);
1329 blk_dump_rq_flags(rq
, DRV_NAME
" bad flags");
1330 cdrom_end_request(drive
, 0);
1334 return cdrom_start_packet_command(drive
, xferlen
, fn
);
1340 * Routines which queue packet commands take as a final argument a pointer to a
1341 * request_sense struct. If execution of the command results in an error with a
1342 * CHECK CONDITION status, this structure will be filled with the results of the
1343 * subsequent request sense command. The pointer can also be NULL, in which case
1344 * no sense information is returned.
1346 static void msf_from_bcd(struct atapi_msf
*msf
)
1348 msf
->minute
= bcd2bin(msf
->minute
);
1349 msf
->second
= bcd2bin(msf
->second
);
1350 msf
->frame
= bcd2bin(msf
->frame
);
1353 int cdrom_check_status(ide_drive_t
*drive
, struct request_sense
*sense
)
1355 struct cdrom_info
*info
= drive
->driver_data
;
1356 struct cdrom_device_info
*cdi
= &info
->devinfo
;
1357 unsigned char cmd
[BLK_MAX_CDB
];
1359 ide_debug_log(IDE_DBG_FUNC
, "Call %s\n", __func__
);
1361 memset(cmd
, 0, BLK_MAX_CDB
);
1362 cmd
[0] = GPCMD_TEST_UNIT_READY
;
1365 * Sanyo 3 CD changer uses byte 7 of TEST_UNIT_READY to switch CDs
1366 * instead of supporting the LOAD_UNLOAD opcode.
1368 cmd
[7] = cdi
->sanyo_slot
% 3;
1370 return ide_cd_queue_pc(drive
, cmd
, 0, NULL
, NULL
, sense
, 0, REQ_QUIET
);
1373 static int cdrom_read_capacity(ide_drive_t
*drive
, unsigned long *capacity
,
1374 unsigned long *sectors_per_frame
,
1375 struct request_sense
*sense
)
1383 unsigned char cmd
[BLK_MAX_CDB
];
1384 unsigned len
= sizeof(capbuf
);
1387 ide_debug_log(IDE_DBG_FUNC
, "Call %s\n", __func__
);
1389 memset(cmd
, 0, BLK_MAX_CDB
);
1390 cmd
[0] = GPCMD_READ_CDVD_CAPACITY
;
1392 stat
= ide_cd_queue_pc(drive
, cmd
, 0, &capbuf
, &len
, sense
, 0,
1398 * Sanity check the given block size
1400 blocklen
= be32_to_cpu(capbuf
.blocklen
);
1408 printk(KERN_ERR PFX
"%s: weird block size %u\n",
1409 drive
->name
, blocklen
);
1410 printk(KERN_ERR PFX
"%s: default to 2kb block size\n",
1416 *capacity
= 1 + be32_to_cpu(capbuf
.lba
);
1417 *sectors_per_frame
= blocklen
>> SECTOR_BITS
;
1419 ide_debug_log(IDE_DBG_PROBE
, "%s: cap: %lu, sectors_per_frame: %lu\n",
1420 __func__
, *capacity
, *sectors_per_frame
);
1425 static int cdrom_read_tocentry(ide_drive_t
*drive
, int trackno
, int msf_flag
,
1426 int format
, char *buf
, int buflen
,
1427 struct request_sense
*sense
)
1429 unsigned char cmd
[BLK_MAX_CDB
];
1431 ide_debug_log(IDE_DBG_FUNC
, "Call %s\n", __func__
);
1433 memset(cmd
, 0, BLK_MAX_CDB
);
1435 cmd
[0] = GPCMD_READ_TOC_PMA_ATIP
;
1437 cmd
[7] = (buflen
>> 8);
1438 cmd
[8] = (buflen
& 0xff);
1439 cmd
[9] = (format
<< 6);
1444 return ide_cd_queue_pc(drive
, cmd
, 0, buf
, &buflen
, sense
, 0, REQ_QUIET
);
1447 /* Try to read the entire TOC for the disk into our internal buffer. */
1448 int ide_cd_read_toc(ide_drive_t
*drive
, struct request_sense
*sense
)
1450 int stat
, ntracks
, i
;
1451 struct cdrom_info
*info
= drive
->driver_data
;
1452 struct cdrom_device_info
*cdi
= &info
->devinfo
;
1453 struct atapi_toc
*toc
= info
->toc
;
1455 struct atapi_toc_header hdr
;
1456 struct atapi_toc_entry ent
;
1459 unsigned long sectors_per_frame
= SECTORS_PER_FRAME
;
1461 ide_debug_log(IDE_DBG_FUNC
, "Call %s\n", __func__
);
1464 /* try to allocate space */
1465 toc
= kmalloc(sizeof(struct atapi_toc
), GFP_KERNEL
);
1467 printk(KERN_ERR PFX
"%s: No cdrom TOC buffer!\n",
1475 * Check to see if the existing data is still valid. If it is,
1478 (void) cdrom_check_status(drive
, sense
);
1480 if (drive
->atapi_flags
& IDE_AFLAG_TOC_VALID
)
1483 /* try to get the total cdrom capacity and sector size */
1484 stat
= cdrom_read_capacity(drive
, &toc
->capacity
, §ors_per_frame
,
1487 toc
->capacity
= 0x1fffff;
1489 set_capacity(info
->disk
, toc
->capacity
* sectors_per_frame
);
1490 /* save a private copy of the TOC capacity for error handling */
1491 drive
->probed_capacity
= toc
->capacity
* sectors_per_frame
;
1493 blk_queue_hardsect_size(drive
->queue
,
1494 sectors_per_frame
<< SECTOR_BITS
);
1496 /* first read just the header, so we know how long the TOC is */
1497 stat
= cdrom_read_tocentry(drive
, 0, 1, 0, (char *) &toc
->hdr
,
1498 sizeof(struct atapi_toc_header
), sense
);
1502 if (drive
->atapi_flags
& IDE_AFLAG_TOCTRACKS_AS_BCD
) {
1503 toc
->hdr
.first_track
= bcd2bin(toc
->hdr
.first_track
);
1504 toc
->hdr
.last_track
= bcd2bin(toc
->hdr
.last_track
);
1507 ntracks
= toc
->hdr
.last_track
- toc
->hdr
.first_track
+ 1;
1510 if (ntracks
> MAX_TRACKS
)
1511 ntracks
= MAX_TRACKS
;
1513 /* now read the whole schmeer */
1514 stat
= cdrom_read_tocentry(drive
, toc
->hdr
.first_track
, 1, 0,
1516 sizeof(struct atapi_toc_header
) +
1518 sizeof(struct atapi_toc_entry
), sense
);
1520 if (stat
&& toc
->hdr
.first_track
> 1) {
1522 * Cds with CDI tracks only don't have any TOC entries, despite
1523 * of this the returned values are
1524 * first_track == last_track = number of CDI tracks + 1,
1525 * so that this case is indistinguishable from the same layout
1526 * plus an additional audio track. If we get an error for the
1527 * regular case, we assume a CDI without additional audio
1528 * tracks. In this case the readable TOC is empty (CDI tracks
1529 * are not included) and only holds the Leadout entry.
1534 stat
= cdrom_read_tocentry(drive
, CDROM_LEADOUT
, 1, 0,
1536 sizeof(struct atapi_toc_header
) +
1538 sizeof(struct atapi_toc_entry
),
1543 if (drive
->atapi_flags
& IDE_AFLAG_TOCTRACKS_AS_BCD
) {
1544 toc
->hdr
.first_track
= (u8
)bin2bcd(CDROM_LEADOUT
);
1545 toc
->hdr
.last_track
= (u8
)bin2bcd(CDROM_LEADOUT
);
1547 toc
->hdr
.first_track
= CDROM_LEADOUT
;
1548 toc
->hdr
.last_track
= CDROM_LEADOUT
;
1555 toc
->hdr
.toc_length
= be16_to_cpu(toc
->hdr
.toc_length
);
1557 if (drive
->atapi_flags
& IDE_AFLAG_TOCTRACKS_AS_BCD
) {
1558 toc
->hdr
.first_track
= bcd2bin(toc
->hdr
.first_track
);
1559 toc
->hdr
.last_track
= bcd2bin(toc
->hdr
.last_track
);
1562 for (i
= 0; i
<= ntracks
; i
++) {
1563 if (drive
->atapi_flags
& IDE_AFLAG_TOCADDR_AS_BCD
) {
1564 if (drive
->atapi_flags
& IDE_AFLAG_TOCTRACKS_AS_BCD
)
1565 toc
->ent
[i
].track
= bcd2bin(toc
->ent
[i
].track
);
1566 msf_from_bcd(&toc
->ent
[i
].addr
.msf
);
1568 toc
->ent
[i
].addr
.lba
= msf_to_lba(toc
->ent
[i
].addr
.msf
.minute
,
1569 toc
->ent
[i
].addr
.msf
.second
,
1570 toc
->ent
[i
].addr
.msf
.frame
);
1573 if (toc
->hdr
.first_track
!= CDROM_LEADOUT
) {
1574 /* read the multisession information */
1575 stat
= cdrom_read_tocentry(drive
, 0, 0, 1, (char *)&ms_tmp
,
1576 sizeof(ms_tmp
), sense
);
1580 toc
->last_session_lba
= be32_to_cpu(ms_tmp
.ent
.addr
.lba
);
1582 ms_tmp
.hdr
.last_track
= CDROM_LEADOUT
;
1583 ms_tmp
.hdr
.first_track
= ms_tmp
.hdr
.last_track
;
1584 toc
->last_session_lba
= msf_to_lba(0, 2, 0); /* 0m 2s 0f */
1587 if (drive
->atapi_flags
& IDE_AFLAG_TOCADDR_AS_BCD
) {
1588 /* re-read multisession information using MSF format */
1589 stat
= cdrom_read_tocentry(drive
, 0, 1, 1, (char *)&ms_tmp
,
1590 sizeof(ms_tmp
), sense
);
1594 msf_from_bcd(&ms_tmp
.ent
.addr
.msf
);
1595 toc
->last_session_lba
= msf_to_lba(ms_tmp
.ent
.addr
.msf
.minute
,
1596 ms_tmp
.ent
.addr
.msf
.second
,
1597 ms_tmp
.ent
.addr
.msf
.frame
);
1600 toc
->xa_flag
= (ms_tmp
.hdr
.first_track
!= ms_tmp
.hdr
.last_track
);
1602 /* now try to get the total cdrom capacity */
1603 stat
= cdrom_get_last_written(cdi
, &last_written
);
1604 if (!stat
&& (last_written
> toc
->capacity
)) {
1605 toc
->capacity
= last_written
;
1606 set_capacity(info
->disk
, toc
->capacity
* sectors_per_frame
);
1607 drive
->probed_capacity
= toc
->capacity
* sectors_per_frame
;
1610 /* Remember that we've read this stuff. */
1611 drive
->atapi_flags
|= IDE_AFLAG_TOC_VALID
;
1616 int ide_cdrom_get_capabilities(ide_drive_t
*drive
, u8
*buf
)
1618 struct cdrom_info
*info
= drive
->driver_data
;
1619 struct cdrom_device_info
*cdi
= &info
->devinfo
;
1620 struct packet_command cgc
;
1621 int stat
, attempts
= 3, size
= ATAPI_CAPABILITIES_PAGE_SIZE
;
1623 ide_debug_log(IDE_DBG_FUNC
, "Call %s\n", __func__
);
1625 if ((drive
->atapi_flags
& IDE_AFLAG_FULL_CAPS_PAGE
) == 0)
1626 size
-= ATAPI_CAPABILITIES_PAGE_PAD_SIZE
;
1628 init_cdrom_command(&cgc
, buf
, size
, CGC_DATA_UNKNOWN
);
1630 /* we seem to get stat=0x01,err=0x00 the first time (??) */
1631 stat
= cdrom_mode_sense(cdi
, &cgc
, GPMODE_CAPABILITIES_PAGE
, 0);
1634 } while (--attempts
);
1638 void ide_cdrom_update_speed(ide_drive_t
*drive
, u8
*buf
)
1640 struct cdrom_info
*cd
= drive
->driver_data
;
1641 u16 curspeed
, maxspeed
;
1643 ide_debug_log(IDE_DBG_FUNC
, "Call %s\n", __func__
);
1645 if (drive
->atapi_flags
& IDE_AFLAG_LE_SPEED_FIELDS
) {
1646 curspeed
= le16_to_cpup((__le16
*)&buf
[8 + 14]);
1647 maxspeed
= le16_to_cpup((__le16
*)&buf
[8 + 8]);
1649 curspeed
= be16_to_cpup((__be16
*)&buf
[8 + 14]);
1650 maxspeed
= be16_to_cpup((__be16
*)&buf
[8 + 8]);
1653 ide_debug_log(IDE_DBG_PROBE
, "%s: curspeed: %u, maxspeed: %u\n",
1654 __func__
, curspeed
, maxspeed
);
1656 cd
->current_speed
= (curspeed
+ (176/2)) / 176;
1657 cd
->max_speed
= (maxspeed
+ (176/2)) / 176;
1660 #define IDE_CD_CAPABILITIES \
1661 (CDC_CLOSE_TRAY | CDC_OPEN_TRAY | CDC_LOCK | CDC_SELECT_SPEED | \
1662 CDC_SELECT_DISC | CDC_MULTI_SESSION | CDC_MCN | CDC_MEDIA_CHANGED | \
1663 CDC_PLAY_AUDIO | CDC_RESET | CDC_DRIVE_STATUS | CDC_CD_R | \
1664 CDC_CD_RW | CDC_DVD | CDC_DVD_R | CDC_DVD_RAM | CDC_GENERIC_PACKET | \
1665 CDC_MO_DRIVE | CDC_MRW | CDC_MRW_W | CDC_RAM)
1667 static struct cdrom_device_ops ide_cdrom_dops
= {
1668 .open
= ide_cdrom_open_real
,
1669 .release
= ide_cdrom_release_real
,
1670 .drive_status
= ide_cdrom_drive_status
,
1671 .media_changed
= ide_cdrom_check_media_change_real
,
1672 .tray_move
= ide_cdrom_tray_move
,
1673 .lock_door
= ide_cdrom_lock_door
,
1674 .select_speed
= ide_cdrom_select_speed
,
1675 .get_last_session
= ide_cdrom_get_last_session
,
1676 .get_mcn
= ide_cdrom_get_mcn
,
1677 .reset
= ide_cdrom_reset
,
1678 .audio_ioctl
= ide_cdrom_audio_ioctl
,
1679 .capability
= IDE_CD_CAPABILITIES
,
1680 .generic_packet
= ide_cdrom_packet
,
1683 static int ide_cdrom_register(ide_drive_t
*drive
, int nslots
)
1685 struct cdrom_info
*info
= drive
->driver_data
;
1686 struct cdrom_device_info
*devinfo
= &info
->devinfo
;
1688 ide_debug_log(IDE_DBG_PROBE
, "Call %s, nslots: %d\n", __func__
, nslots
);
1690 devinfo
->ops
= &ide_cdrom_dops
;
1691 devinfo
->speed
= info
->current_speed
;
1692 devinfo
->capacity
= nslots
;
1693 devinfo
->handle
= drive
;
1694 strcpy(devinfo
->name
, drive
->name
);
1696 if (drive
->atapi_flags
& IDE_AFLAG_NO_SPEED_SELECT
)
1697 devinfo
->mask
|= CDC_SELECT_SPEED
;
1699 devinfo
->disk
= info
->disk
;
1700 return register_cdrom(devinfo
);
1703 static int ide_cdrom_probe_capabilities(ide_drive_t
*drive
)
1705 struct cdrom_info
*cd
= drive
->driver_data
;
1706 struct cdrom_device_info
*cdi
= &cd
->devinfo
;
1707 u8 buf
[ATAPI_CAPABILITIES_PAGE_SIZE
];
1708 mechtype_t mechtype
;
1711 ide_debug_log(IDE_DBG_PROBE
, "Call %s, drive->media: 0x%x, "
1712 "drive->atapi_flags: 0x%lx\n", __func__
, drive
->media
,
1713 drive
->atapi_flags
);
1715 cdi
->mask
= (CDC_CD_R
| CDC_CD_RW
| CDC_DVD
| CDC_DVD_R
|
1716 CDC_DVD_RAM
| CDC_SELECT_DISC
| CDC_PLAY_AUDIO
|
1717 CDC_MO_DRIVE
| CDC_RAM
);
1719 if (drive
->media
== ide_optical
) {
1720 cdi
->mask
&= ~(CDC_MO_DRIVE
| CDC_RAM
);
1721 printk(KERN_ERR PFX
"%s: ATAPI magneto-optical drive\n",
1726 if (drive
->atapi_flags
& IDE_AFLAG_PRE_ATAPI12
) {
1727 drive
->atapi_flags
&= ~IDE_AFLAG_NO_EJECT
;
1728 cdi
->mask
&= ~CDC_PLAY_AUDIO
;
1733 * We have to cheat a little here. the packet will eventually be queued
1734 * with ide_cdrom_packet(), which extracts the drive from cdi->handle.
1735 * Since this device hasn't been registered with the Uniform layer yet,
1736 * it can't do this. Same goes for cdi->ops.
1738 cdi
->handle
= drive
;
1739 cdi
->ops
= &ide_cdrom_dops
;
1741 if (ide_cdrom_get_capabilities(drive
, buf
))
1744 if ((buf
[8 + 6] & 0x01) == 0)
1745 drive
->dev_flags
&= ~IDE_DFLAG_DOORLOCKING
;
1746 if (buf
[8 + 6] & 0x08)
1747 drive
->atapi_flags
&= ~IDE_AFLAG_NO_EJECT
;
1748 if (buf
[8 + 3] & 0x01)
1749 cdi
->mask
&= ~CDC_CD_R
;
1750 if (buf
[8 + 3] & 0x02)
1751 cdi
->mask
&= ~(CDC_CD_RW
| CDC_RAM
);
1752 if (buf
[8 + 2] & 0x38)
1753 cdi
->mask
&= ~CDC_DVD
;
1754 if (buf
[8 + 3] & 0x20)
1755 cdi
->mask
&= ~(CDC_DVD_RAM
| CDC_RAM
);
1756 if (buf
[8 + 3] & 0x10)
1757 cdi
->mask
&= ~CDC_DVD_R
;
1758 if ((buf
[8 + 4] & 0x01) || (drive
->atapi_flags
& IDE_AFLAG_PLAY_AUDIO_OK
))
1759 cdi
->mask
&= ~CDC_PLAY_AUDIO
;
1761 mechtype
= buf
[8 + 6] >> 5;
1762 if (mechtype
== mechtype_caddy
||
1763 mechtype
== mechtype_popup
||
1764 (drive
->atapi_flags
& IDE_AFLAG_NO_AUTOCLOSE
))
1765 cdi
->mask
|= CDC_CLOSE_TRAY
;
1767 if (cdi
->sanyo_slot
> 0) {
1768 cdi
->mask
&= ~CDC_SELECT_DISC
;
1770 } else if (mechtype
== mechtype_individual_changer
||
1771 mechtype
== mechtype_cartridge_changer
) {
1772 nslots
= cdrom_number_of_slots(cdi
);
1774 cdi
->mask
&= ~CDC_SELECT_DISC
;
1777 ide_cdrom_update_speed(drive
, buf
);
1779 printk(KERN_INFO PFX
"%s: ATAPI", drive
->name
);
1781 /* don't print speed if the drive reported 0 */
1783 printk(KERN_CONT
" %dX", cd
->max_speed
);
1785 printk(KERN_CONT
" %s", (cdi
->mask
& CDC_DVD
) ? "CD-ROM" : "DVD-ROM");
1787 if ((cdi
->mask
& CDC_DVD_R
) == 0 || (cdi
->mask
& CDC_DVD_RAM
) == 0)
1788 printk(KERN_CONT
" DVD%s%s",
1789 (cdi
->mask
& CDC_DVD_R
) ? "" : "-R",
1790 (cdi
->mask
& CDC_DVD_RAM
) ? "" : "/RAM");
1792 if ((cdi
->mask
& CDC_CD_R
) == 0 || (cdi
->mask
& CDC_CD_RW
) == 0)
1793 printk(KERN_CONT
" CD%s%s",
1794 (cdi
->mask
& CDC_CD_R
) ? "" : "-R",
1795 (cdi
->mask
& CDC_CD_RW
) ? "" : "/RW");
1797 if ((cdi
->mask
& CDC_SELECT_DISC
) == 0)
1798 printk(KERN_CONT
" changer w/%d slots", nslots
);
1800 printk(KERN_CONT
" drive");
1802 printk(KERN_CONT
", %dkB Cache\n",
1803 be16_to_cpup((__be16
*)&buf
[8 + 12]));
1808 /* standard prep_rq_fn that builds 10 byte cmds */
1809 static int ide_cdrom_prep_fs(struct request_queue
*q
, struct request
*rq
)
1811 int hard_sect
= queue_hardsect_size(q
);
1812 long block
= (long)rq
->hard_sector
/ (hard_sect
>> 9);
1813 unsigned long blocks
= rq
->hard_nr_sectors
/ (hard_sect
>> 9);
1815 memset(rq
->cmd
, 0, BLK_MAX_CDB
);
1817 if (rq_data_dir(rq
) == READ
)
1818 rq
->cmd
[0] = GPCMD_READ_10
;
1820 rq
->cmd
[0] = GPCMD_WRITE_10
;
1825 rq
->cmd
[2] = (block
>> 24) & 0xff;
1826 rq
->cmd
[3] = (block
>> 16) & 0xff;
1827 rq
->cmd
[4] = (block
>> 8) & 0xff;
1828 rq
->cmd
[5] = block
& 0xff;
1831 * and transfer length
1833 rq
->cmd
[7] = (blocks
>> 8) & 0xff;
1834 rq
->cmd
[8] = blocks
& 0xff;
1840 * Most of the SCSI commands are supported directly by ATAPI devices.
1841 * This transform handles the few exceptions.
1843 static int ide_cdrom_prep_pc(struct request
*rq
)
1847 /* transform 6-byte read/write commands to the 10-byte version */
1848 if (c
[0] == READ_6
|| c
[0] == WRITE_6
) {
1855 c
[0] += (READ_10
- READ_6
);
1861 * it's silly to pretend we understand 6-byte sense commands, just
1862 * reject with ILLEGAL_REQUEST and the caller should take the
1863 * appropriate action
1865 if (c
[0] == MODE_SENSE
|| c
[0] == MODE_SELECT
) {
1866 rq
->errors
= ILLEGAL_REQUEST
;
1867 return BLKPREP_KILL
;
1873 static int ide_cdrom_prep_fn(struct request_queue
*q
, struct request
*rq
)
1875 if (blk_fs_request(rq
))
1876 return ide_cdrom_prep_fs(q
, rq
);
1877 else if (blk_pc_request(rq
))
1878 return ide_cdrom_prep_pc(rq
);
1883 struct cd_list_entry
{
1884 const char *id_model
;
1885 const char *id_firmware
;
1886 unsigned int cd_flags
;
1889 #ifdef CONFIG_IDE_PROC_FS
1890 static sector_t
ide_cdrom_capacity(ide_drive_t
*drive
)
1892 unsigned long capacity
, sectors_per_frame
;
1894 if (cdrom_read_capacity(drive
, &capacity
, §ors_per_frame
, NULL
))
1897 return capacity
* sectors_per_frame
;
1900 static int proc_idecd_read_capacity(char *page
, char **start
, off_t off
,
1901 int count
, int *eof
, void *data
)
1903 ide_drive_t
*drive
= data
;
1906 len
= sprintf(page
, "%llu\n", (long long)ide_cdrom_capacity(drive
));
1907 PROC_IDE_READ_RETURN(page
, start
, off
, count
, eof
, len
);
1910 static ide_proc_entry_t idecd_proc
[] = {
1911 { "capacity", S_IFREG
|S_IRUGO
, proc_idecd_read_capacity
, NULL
},
1912 { NULL
, 0, NULL
, NULL
}
1915 ide_devset_rw_flag(dsc_overlap
, IDE_DFLAG_DSC_OVERLAP
);
1917 static const struct ide_proc_devset idecd_settings
[] = {
1918 IDE_PROC_DEVSET(dsc_overlap
, 0, 1),
1922 static ide_proc_entry_t
*ide_cd_proc_entries(ide_drive_t
*drive
)
1927 static const struct ide_proc_devset
*ide_cd_proc_devsets(ide_drive_t
*drive
)
1929 return idecd_settings
;
1933 static const struct cd_list_entry ide_cd_quirks_list
[] = {
1934 /* Limit transfer size per interrupt. */
1935 { "SAMSUNG CD-ROM SCR-2430", NULL
, IDE_AFLAG_LIMIT_NFRAMES
},
1936 { "SAMSUNG CD-ROM SCR-2432", NULL
, IDE_AFLAG_LIMIT_NFRAMES
},
1937 /* SCR-3231 doesn't support the SET_CD_SPEED command. */
1938 { "SAMSUNG CD-ROM SCR-3231", NULL
, IDE_AFLAG_NO_SPEED_SELECT
},
1939 /* Old NEC260 (not R) was released before ATAPI 1.2 spec. */
1940 { "NEC CD-ROM DRIVE:260", "1.01", IDE_AFLAG_TOCADDR_AS_BCD
|
1941 IDE_AFLAG_PRE_ATAPI12
, },
1942 /* Vertos 300, some versions of this drive like to talk BCD. */
1943 { "V003S0DS", NULL
, IDE_AFLAG_VERTOS_300_SSD
, },
1944 /* Vertos 600 ESD. */
1945 { "V006E0DS", NULL
, IDE_AFLAG_VERTOS_600_ESD
, },
1947 * Sanyo 3 CD changer uses a non-standard command for CD changing
1948 * (by default standard ATAPI support for CD changers is used).
1950 { "CD-ROM CDR-C3 G", NULL
, IDE_AFLAG_SANYO_3CD
},
1951 { "CD-ROM CDR-C3G", NULL
, IDE_AFLAG_SANYO_3CD
},
1952 { "CD-ROM CDR_C36", NULL
, IDE_AFLAG_SANYO_3CD
},
1953 /* Stingray 8X CD-ROM. */
1954 { "STINGRAY 8422 IDE 8X CD-ROM 7-27-95", NULL
, IDE_AFLAG_PRE_ATAPI12
},
1956 * ACER 50X CD-ROM and WPI 32X CD-ROM require the full spec length
1957 * mode sense page capabilities size, but older drives break.
1959 { "ATAPI CD ROM DRIVE 50X MAX", NULL
, IDE_AFLAG_FULL_CAPS_PAGE
},
1960 { "WPI CDS-32X", NULL
, IDE_AFLAG_FULL_CAPS_PAGE
},
1961 /* ACER/AOpen 24X CD-ROM has the speed fields byte-swapped. */
1962 { "", "241N", IDE_AFLAG_LE_SPEED_FIELDS
},
1964 * Some drives used by Apple don't advertise audio play
1965 * but they do support reading TOC & audio datas.
1967 { "MATSHITADVD-ROM SR-8187", NULL
, IDE_AFLAG_PLAY_AUDIO_OK
},
1968 { "MATSHITADVD-ROM SR-8186", NULL
, IDE_AFLAG_PLAY_AUDIO_OK
},
1969 { "MATSHITADVD-ROM SR-8176", NULL
, IDE_AFLAG_PLAY_AUDIO_OK
},
1970 { "MATSHITADVD-ROM SR-8174", NULL
, IDE_AFLAG_PLAY_AUDIO_OK
},
1971 { "Optiarc DVD RW AD-5200A", NULL
, IDE_AFLAG_PLAY_AUDIO_OK
},
1972 { "Optiarc DVD RW AD-7200A", NULL
, IDE_AFLAG_PLAY_AUDIO_OK
},
1973 { "Optiarc DVD RW AD-7543A", NULL
, IDE_AFLAG_NO_AUTOCLOSE
},
1974 { "TEAC CD-ROM CD-224E", NULL
, IDE_AFLAG_NO_AUTOCLOSE
},
1978 static unsigned int ide_cd_flags(u16
*id
)
1980 const struct cd_list_entry
*cle
= ide_cd_quirks_list
;
1982 while (cle
->id_model
) {
1983 if (strcmp(cle
->id_model
, (char *)&id
[ATA_ID_PROD
]) == 0 &&
1984 (cle
->id_firmware
== NULL
||
1985 strstr((char *)&id
[ATA_ID_FW_REV
], cle
->id_firmware
)))
1986 return cle
->cd_flags
;
1993 static int ide_cdrom_setup(ide_drive_t
*drive
)
1995 struct cdrom_info
*cd
= drive
->driver_data
;
1996 struct cdrom_device_info
*cdi
= &cd
->devinfo
;
1997 u16
*id
= drive
->id
;
1998 char *fw_rev
= (char *)&id
[ATA_ID_FW_REV
];
2001 ide_debug_log(IDE_DBG_PROBE
, "Call %s\n", __func__
);
2003 blk_queue_prep_rq(drive
->queue
, ide_cdrom_prep_fn
);
2004 blk_queue_dma_alignment(drive
->queue
, 31);
2005 blk_queue_update_dma_pad(drive
->queue
, 15);
2006 drive
->queue
->unplug_delay
= (1 * HZ
) / 1000;
2007 if (!drive
->queue
->unplug_delay
)
2008 drive
->queue
->unplug_delay
= 1;
2010 drive
->dev_flags
|= IDE_DFLAG_MEDIA_CHANGED
;
2011 drive
->atapi_flags
= IDE_AFLAG_NO_EJECT
| ide_cd_flags(id
);
2013 if ((drive
->atapi_flags
& IDE_AFLAG_VERTOS_300_SSD
) &&
2014 fw_rev
[4] == '1' && fw_rev
[6] <= '2')
2015 drive
->atapi_flags
|= (IDE_AFLAG_TOCTRACKS_AS_BCD
|
2016 IDE_AFLAG_TOCADDR_AS_BCD
);
2017 else if ((drive
->atapi_flags
& IDE_AFLAG_VERTOS_600_ESD
) &&
2018 fw_rev
[4] == '1' && fw_rev
[6] <= '2')
2019 drive
->atapi_flags
|= IDE_AFLAG_TOCTRACKS_AS_BCD
;
2020 else if (drive
->atapi_flags
& IDE_AFLAG_SANYO_3CD
)
2021 /* 3 => use CD in slot 0 */
2022 cdi
->sanyo_slot
= 3;
2024 nslots
= ide_cdrom_probe_capabilities(drive
);
2026 /* set correct block size */
2027 blk_queue_hardsect_size(drive
->queue
, CD_FRAMESIZE
);
2029 if (drive
->next
!= drive
)
2030 drive
->dev_flags
|= IDE_DFLAG_DSC_OVERLAP
;
2032 drive
->dev_flags
&= ~IDE_DFLAG_DSC_OVERLAP
;
2034 if (ide_cdrom_register(drive
, nslots
)) {
2035 printk(KERN_ERR PFX
"%s: %s failed to register device with the"
2036 " cdrom driver.\n", drive
->name
, __func__
);
2037 cd
->devinfo
.handle
= NULL
;
2041 ide_proc_register_driver(drive
, cd
->driver
);
2045 static void ide_cd_remove(ide_drive_t
*drive
)
2047 struct cdrom_info
*info
= drive
->driver_data
;
2049 ide_debug_log(IDE_DBG_FUNC
, "Call %s\n", __func__
);
2051 ide_proc_unregister_driver(drive
, info
->driver
);
2053 del_gendisk(info
->disk
);
2058 static void ide_cd_release(struct kref
*kref
)
2060 struct cdrom_info
*info
= to_ide_drv(kref
, cdrom_info
);
2061 struct cdrom_device_info
*devinfo
= &info
->devinfo
;
2062 ide_drive_t
*drive
= info
->drive
;
2063 struct gendisk
*g
= info
->disk
;
2065 ide_debug_log(IDE_DBG_FUNC
, "Call %s\n", __func__
);
2068 if (devinfo
->handle
== drive
)
2069 unregister_cdrom(devinfo
);
2070 drive
->dev_flags
&= ~IDE_DFLAG_DSC_OVERLAP
;
2071 drive
->driver_data
= NULL
;
2072 blk_queue_prep_rq(drive
->queue
, NULL
);
2073 g
->private_data
= NULL
;
2078 static int ide_cd_probe(ide_drive_t
*);
2080 static ide_driver_t ide_cdrom_driver
= {
2082 .owner
= THIS_MODULE
,
2083 .name
= "ide-cdrom",
2084 .bus
= &ide_bus_type
,
2086 .probe
= ide_cd_probe
,
2087 .remove
= ide_cd_remove
,
2088 .version
= IDECD_VERSION
,
2089 .do_request
= ide_cd_do_request
,
2090 .end_request
= ide_end_request
,
2091 .error
= __ide_error
,
2092 #ifdef CONFIG_IDE_PROC_FS
2093 .proc_entries
= ide_cd_proc_entries
,
2094 .proc_devsets
= ide_cd_proc_devsets
,
2098 static int idecd_open(struct block_device
*bdev
, fmode_t mode
)
2100 struct cdrom_info
*info
= ide_cd_get(bdev
->bd_disk
);
2106 rc
= cdrom_open(&info
->devinfo
, bdev
, mode
);
2114 static int idecd_release(struct gendisk
*disk
, fmode_t mode
)
2116 struct cdrom_info
*info
= ide_drv_g(disk
, cdrom_info
);
2118 cdrom_release(&info
->devinfo
, mode
);
2125 static int idecd_set_spindown(struct cdrom_device_info
*cdi
, unsigned long arg
)
2127 struct packet_command cgc
;
2132 if (copy_from_user(&spindown
, (void __user
*)arg
, sizeof(char)))
2135 init_cdrom_command(&cgc
, buffer
, sizeof(buffer
), CGC_DATA_UNKNOWN
);
2137 stat
= cdrom_mode_sense(cdi
, &cgc
, GPMODE_CDROM_PAGE
, 0);
2141 buffer
[11] = (buffer
[11] & 0xf0) | (spindown
& 0x0f);
2142 return cdrom_mode_select(cdi
, &cgc
);
2145 static int idecd_get_spindown(struct cdrom_device_info
*cdi
, unsigned long arg
)
2147 struct packet_command cgc
;
2152 init_cdrom_command(&cgc
, buffer
, sizeof(buffer
), CGC_DATA_UNKNOWN
);
2154 stat
= cdrom_mode_sense(cdi
, &cgc
, GPMODE_CDROM_PAGE
, 0);
2158 spindown
= buffer
[11] & 0x0f;
2159 if (copy_to_user((void __user
*)arg
, &spindown
, sizeof(char)))
2164 static int idecd_ioctl(struct block_device
*bdev
, fmode_t mode
,
2165 unsigned int cmd
, unsigned long arg
)
2167 struct cdrom_info
*info
= ide_drv_g(bdev
->bd_disk
, cdrom_info
);
2171 case CDROMSETSPINDOWN
:
2172 return idecd_set_spindown(&info
->devinfo
, arg
);
2173 case CDROMGETSPINDOWN
:
2174 return idecd_get_spindown(&info
->devinfo
, arg
);
2179 err
= generic_ide_ioctl(info
->drive
, bdev
, cmd
, arg
);
2181 err
= cdrom_ioctl(&info
->devinfo
, bdev
, mode
, cmd
, arg
);
2186 static int idecd_media_changed(struct gendisk
*disk
)
2188 struct cdrom_info
*info
= ide_drv_g(disk
, cdrom_info
);
2189 return cdrom_media_changed(&info
->devinfo
);
2192 static int idecd_revalidate_disk(struct gendisk
*disk
)
2194 struct cdrom_info
*info
= ide_drv_g(disk
, cdrom_info
);
2195 struct request_sense sense
;
2197 ide_cd_read_toc(info
->drive
, &sense
);
2202 static struct block_device_operations idecd_ops
= {
2203 .owner
= THIS_MODULE
,
2205 .release
= idecd_release
,
2206 .locked_ioctl
= idecd_ioctl
,
2207 .media_changed
= idecd_media_changed
,
2208 .revalidate_disk
= idecd_revalidate_disk
2211 /* module options */
2212 static char *ignore
;
2213 module_param(ignore
, charp
, 0400);
2215 static unsigned long debug_mask
;
2216 module_param(debug_mask
, ulong
, 0644);
2218 MODULE_DESCRIPTION("ATAPI CD-ROM Driver");
2220 static int ide_cd_probe(ide_drive_t
*drive
)
2222 struct cdrom_info
*info
;
2224 struct request_sense sense
;
2226 ide_debug_log(IDE_DBG_PROBE
, "Call %s, drive->driver_req: %s, "
2227 "drive->media: 0x%x\n", __func__
, drive
->driver_req
,
2230 if (!strstr("ide-cdrom", drive
->driver_req
))
2233 if (drive
->media
!= ide_cdrom
&& drive
->media
!= ide_optical
)
2236 /* skip drives that we were told to ignore */
2237 if (ignore
!= NULL
) {
2238 if (strstr(ignore
, drive
->name
)) {
2239 printk(KERN_INFO PFX
"ignoring drive %s\n",
2245 drive
->debug_mask
= debug_mask
;
2247 info
= kzalloc(sizeof(struct cdrom_info
), GFP_KERNEL
);
2249 printk(KERN_ERR PFX
"%s: Can't allocate a cdrom structure\n",
2254 g
= alloc_disk(1 << PARTN_BITS
);
2258 ide_init_disk(g
, drive
);
2260 kref_init(&info
->kref
);
2262 info
->drive
= drive
;
2263 info
->driver
= &ide_cdrom_driver
;
2266 g
->private_data
= &info
->driver
;
2268 drive
->driver_data
= info
;
2271 g
->driverfs_dev
= &drive
->gendev
;
2272 g
->flags
= GENHD_FL_CD
| GENHD_FL_REMOVABLE
;
2273 if (ide_cdrom_setup(drive
)) {
2274 ide_cd_release(&info
->kref
);
2278 ide_cd_read_toc(drive
, &sense
);
2279 g
->fops
= &idecd_ops
;
2280 g
->flags
|= GENHD_FL_REMOVABLE
;
2290 static void __exit
ide_cdrom_exit(void)
2292 driver_unregister(&ide_cdrom_driver
.gen_driver
);
2295 static int __init
ide_cdrom_init(void)
2297 printk(KERN_INFO DRV_NAME
" driver " IDECD_VERSION
"\n");
2298 return driver_register(&ide_cdrom_driver
.gen_driver
);
2301 MODULE_ALIAS("ide:*m-cdrom*");
2302 MODULE_ALIAS("ide-cd");
2303 module_init(ide_cdrom_init
);
2304 module_exit(ide_cdrom_exit
);
2305 MODULE_LICENSE("GPL");