blob: 50f78eb7dce98c20a6326fc5958b767f2a96ad4b [file] [log] [blame]
Linus Torvalds1da177e2005-04-16 15:20:36 -07001/*
2 * linux/drivers/ide/ide-cd.c
3 *
4 * Copyright (C) 1994, 1995, 1996 scott snyder <snyder@fnald0.fnal.gov>
5 * Copyright (C) 1996-1998 Erik Andersen <andersee@debian.org>
6 * Copyright (C) 1998-2000 Jens Axboe <axboe@suse.de>
7 *
8 * May be copied or modified under the terms of the GNU General Public
9 * License. See linux/COPYING for more information.
10 *
11 * ATAPI CD-ROM driver. To be used with ide.c.
12 * See Documentation/cdrom/ide-cd for usage information.
13 *
14 * Suggestions are welcome. Patches that work are more welcome though. ;-)
15 * For those wishing to work on this driver, please be sure you download
16 * and comply with the latest Mt. Fuji (SFF8090 version 4) and ATAPI
17 * (SFF-8020i rev 2.6) standards. These documents can be obtained by
18 * anonymous ftp from:
19 * ftp://fission.dt.wdc.com/pub/standards/SFF_atapi/spec/SFF8020-r2.6/PS/8020r26.ps
20 * ftp://ftp.avc-pioneer.com/Mtfuji4/Spec/Fuji4r10.pdf
21 *
22 * Drives that deviate from these standards will be accommodated as much
23 * as possible via compile time or command-line options. Since I only have
24 * a few drives, you generally need to send me patches...
25 *
26 * ----------------------------------
27 * TO DO LIST:
28 * -Make it so that Pioneer CD DR-A24X and friends don't get screwed up on
29 * boot
30 *
Bartlomiej Zolnierkiewicz03553352008-02-01 23:09:18 +010031 * For historical changelog please see:
32 * Documentation/ide/ChangeLog.ide-cd.1994-2004
33 */
34
Linus Torvalds1da177e2005-04-16 15:20:36 -070035#define IDECD_VERSION "4.61"
36
Linus Torvalds1da177e2005-04-16 15:20:36 -070037#include <linux/module.h>
38#include <linux/types.h>
39#include <linux/kernel.h>
40#include <linux/delay.h>
41#include <linux/timer.h>
42#include <linux/slab.h>
43#include <linux/interrupt.h>
44#include <linux/errno.h>
45#include <linux/cdrom.h>
46#include <linux/ide.h>
47#include <linux/completion.h>
Arjan van de Vencf8b8972006-03-23 03:00:45 -080048#include <linux/mutex.h>
Bartlomiej Zolnierkiewicz9a6dc662008-02-01 23:09:22 +010049#include <linux/bcd.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070050
51#include <scsi/scsi.h> /* For SCSI -> ATAPI command conversion */
52
53#include <asm/irq.h>
54#include <asm/io.h>
55#include <asm/byteorder.h>
56#include <asm/uaccess.h>
57#include <asm/unaligned.h>
58
59#include "ide-cd.h"
60
Arjan van de Vencf8b8972006-03-23 03:00:45 -080061static DEFINE_MUTEX(idecd_ref_mutex);
Linus Torvalds1da177e2005-04-16 15:20:36 -070062
63#define to_ide_cd(obj) container_of(obj, struct cdrom_info, kref)
64
65#define ide_cd_g(disk) \
66 container_of((disk)->private_data, struct cdrom_info, driver)
67
68static struct cdrom_info *ide_cd_get(struct gendisk *disk)
69{
70 struct cdrom_info *cd = NULL;
71
Arjan van de Vencf8b8972006-03-23 03:00:45 -080072 mutex_lock(&idecd_ref_mutex);
Linus Torvalds1da177e2005-04-16 15:20:36 -070073 cd = ide_cd_g(disk);
74 if (cd)
75 kref_get(&cd->kref);
Arjan van de Vencf8b8972006-03-23 03:00:45 -080076 mutex_unlock(&idecd_ref_mutex);
Linus Torvalds1da177e2005-04-16 15:20:36 -070077 return cd;
78}
79
80static void ide_cd_release(struct kref *);
81
82static void ide_cd_put(struct cdrom_info *cd)
83{
Arjan van de Vencf8b8972006-03-23 03:00:45 -080084 mutex_lock(&idecd_ref_mutex);
Linus Torvalds1da177e2005-04-16 15:20:36 -070085 kref_put(&cd->kref, ide_cd_release);
Arjan van de Vencf8b8972006-03-23 03:00:45 -080086 mutex_unlock(&idecd_ref_mutex);
Linus Torvalds1da177e2005-04-16 15:20:36 -070087}
88
89/****************************************************************************
90 * Generic packet command support and error handling routines.
91 */
92
93/* Mark that we've seen a media change, and invalidate our internal
94 buffers. */
95static void cdrom_saw_media_change (ide_drive_t *drive)
96{
Bartlomiej Zolnierkiewicz0ba11212008-02-01 23:09:21 +010097 struct cdrom_info *cd = drive->driver_data;
98
Bartlomiej Zolnierkiewicz2bc4cf22008-02-01 23:09:22 +010099 cd->cd_flags |= IDE_CD_FLAG_MEDIA_CHANGED;
100 cd->cd_flags &= ~IDE_CD_FLAG_TOC_VALID;
Bartlomiej Zolnierkiewicz0ba11212008-02-01 23:09:21 +0100101 cd->nsectors_buffered = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700102}
103
104static int cdrom_log_sense(ide_drive_t *drive, struct request *rq,
105 struct request_sense *sense)
106{
107 int log = 0;
108
Jens Axboe4aff5e22006-08-10 08:44:47 +0200109 if (!sense || !rq || (rq->cmd_flags & REQ_QUIET))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700110 return 0;
111
112 switch (sense->sense_key) {
113 case NO_SENSE: case RECOVERED_ERROR:
114 break;
115 case NOT_READY:
116 /*
117 * don't care about tray state messages for
118 * e.g. capacity commands or in-progress or
119 * becoming ready
120 */
121 if (sense->asc == 0x3a || sense->asc == 0x04)
122 break;
123 log = 1;
124 break;
125 case ILLEGAL_REQUEST:
126 /*
127 * don't log START_STOP unit with LoEj set, since
128 * we cannot reliably check if drive can auto-close
129 */
130 if (rq->cmd[0] == GPCMD_START_STOP_UNIT && sense->asc == 0x24)
Alan Coxdbe217a2006-06-25 05:47:44 -0700131 break;
132 log = 1;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700133 break;
134 case UNIT_ATTENTION:
135 /*
136 * Make good and sure we've seen this potential media
137 * change. Some drives (i.e. Creative) fail to present
138 * the correct sense key in the error register.
139 */
140 cdrom_saw_media_change(drive);
141 break;
142 default:
143 log = 1;
144 break;
145 }
146 return log;
147}
148
149static
150void cdrom_analyze_sense_data(ide_drive_t *drive,
151 struct request *failed_command,
152 struct request_sense *sense)
153{
Alan Coxdbe217a2006-06-25 05:47:44 -0700154 unsigned long sector;
155 unsigned long bio_sectors;
156 unsigned long valid;
157 struct cdrom_info *info = drive->driver_data;
158
Linus Torvalds1da177e2005-04-16 15:20:36 -0700159 if (!cdrom_log_sense(drive, failed_command, sense))
160 return;
161
162 /*
163 * If a read toc is executed for a CD-R or CD-RW medium where
164 * the first toc has not been recorded yet, it will fail with
165 * 05/24/00 (which is a confusing error)
166 */
167 if (failed_command && failed_command->cmd[0] == GPCMD_READ_TOC_PMA_ATIP)
168 if (sense->sense_key == 0x05 && sense->asc == 0x24)
169 return;
170
Alan Coxdbe217a2006-06-25 05:47:44 -0700171 if (sense->error_code == 0x70) { /* Current Error */
172 switch(sense->sense_key) {
173 case MEDIUM_ERROR:
174 case VOLUME_OVERFLOW:
175 case ILLEGAL_REQUEST:
176 if (!sense->valid)
177 break;
178 if (failed_command == NULL ||
179 !blk_fs_request(failed_command))
180 break;
181 sector = (sense->information[0] << 24) |
182 (sense->information[1] << 16) |
183 (sense->information[2] << 8) |
184 (sense->information[3]);
185
186 bio_sectors = bio_sectors(failed_command->bio);
187 if (bio_sectors < 4)
188 bio_sectors = 4;
189 if (drive->queue->hardsect_size == 2048)
190 sector <<= 2; /* Device sector size is 2K */
191 sector &= ~(bio_sectors -1);
192 valid = (sector - failed_command->sector) << 9;
193
194 if (valid < 0)
195 valid = 0;
196 if (sector < get_capacity(info->disk) &&
197 drive->probed_capacity - sector < 4 * 75) {
198 set_capacity(info->disk, sector);
199 }
200 }
201 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700202
Bartlomiej Zolnierkiewicz972560f2008-02-01 23:09:23 +0100203 ide_cd_log_error(drive->name, failed_command, sense);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700204}
205
206/*
207 * Initialize a ide-cd packet command request
208 */
Bartlomiej Zolnierkiewicz17802992008-02-01 23:09:25 +0100209void ide_cd_init_rq(ide_drive_t *drive, struct request *rq)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700210{
211 struct cdrom_info *cd = drive->driver_data;
212
213 ide_init_drive_cmd(rq);
Jens Axboecea28852006-10-12 15:08:45 +0200214 rq->cmd_type = REQ_TYPE_ATA_PC;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700215 rq->rq_disk = cd->disk;
216}
217
218static void cdrom_queue_request_sense(ide_drive_t *drive, void *sense,
219 struct request *failed_command)
220{
221 struct cdrom_info *info = drive->driver_data;
222 struct request *rq = &info->request_sense_request;
223
224 if (sense == NULL)
225 sense = &info->sense_data;
226
227 /* stuff the sense request in front of our current request */
Bartlomiej Zolnierkiewicz139c8292008-02-01 23:09:24 +0100228 ide_cd_init_rq(drive, rq);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700229
230 rq->data = sense;
231 rq->cmd[0] = GPCMD_REQUEST_SENSE;
232 rq->cmd[4] = rq->data_len = 18;
233
Jens Axboe4aff5e22006-08-10 08:44:47 +0200234 rq->cmd_type = REQ_TYPE_SENSE;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700235
236 /* NOTE! Save the failed command in "rq->buffer" */
237 rq->buffer = (void *) failed_command;
238
239 (void) ide_do_drive_cmd(drive, rq, ide_preempt);
240}
241
242static void cdrom_end_request (ide_drive_t *drive, int uptodate)
243{
244 struct request *rq = HWGROUP(drive)->rq;
245 int nsectors = rq->hard_cur_sectors;
246
Jens Axboe4aff5e22006-08-10 08:44:47 +0200247 if (blk_sense_request(rq) && uptodate) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700248 /*
Jens Axboe4aff5e22006-08-10 08:44:47 +0200249 * For REQ_TYPE_SENSE, "rq->buffer" points to the original
250 * failed request
Linus Torvalds1da177e2005-04-16 15:20:36 -0700251 */
252 struct request *failed = (struct request *) rq->buffer;
253 struct cdrom_info *info = drive->driver_data;
254 void *sense = &info->sense_data;
255 unsigned long flags;
256
257 if (failed) {
258 if (failed->sense) {
259 sense = failed->sense;
260 failed->sense_len = rq->sense_len;
261 }
Alan Coxdbe217a2006-06-25 05:47:44 -0700262 cdrom_analyze_sense_data(drive, failed, sense);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700263 /*
264 * now end failed request
265 */
Alan Coxdbe217a2006-06-25 05:47:44 -0700266 if (blk_fs_request(failed)) {
267 if (ide_end_dequeued_request(drive, failed, 0,
268 failed->hard_nr_sectors))
269 BUG();
270 } else {
271 spin_lock_irqsave(&ide_lock, flags);
Kiyoshi Ueda5e36bb62008-01-28 10:34:20 +0100272 if (__blk_end_request(failed, -EIO,
273 failed->data_len))
274 BUG();
Alan Coxdbe217a2006-06-25 05:47:44 -0700275 spin_unlock_irqrestore(&ide_lock, flags);
276 }
277 } else
278 cdrom_analyze_sense_data(drive, NULL, sense);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700279 }
280
281 if (!rq->current_nr_sectors && blk_fs_request(rq))
282 uptodate = 1;
283 /* make sure it's fully ended */
284 if (blk_pc_request(rq))
285 nsectors = (rq->data_len + 511) >> 9;
286 if (!nsectors)
287 nsectors = 1;
288
289 ide_end_request(drive, uptodate, nsectors);
290}
291
Alan Coxdbe217a2006-06-25 05:47:44 -0700292static void ide_dump_status_no_sense(ide_drive_t *drive, const char *msg, u8 stat)
293{
294 if (stat & 0x80)
295 return;
296 ide_dump_status(drive, msg, stat);
297}
298
Linus Torvalds1da177e2005-04-16 15:20:36 -0700299/* Returns 0 if the request should be continued.
300 Returns 1 if the request was ended. */
301static int cdrom_decode_status(ide_drive_t *drive, int good_stat, int *stat_ret)
302{
303 struct request *rq = HWGROUP(drive)->rq;
304 int stat, err, sense_key;
305
306 /* Check for errors. */
307 stat = HWIF(drive)->INB(IDE_STATUS_REG);
308 if (stat_ret)
309 *stat_ret = stat;
310
311 if (OK_STAT(stat, good_stat, BAD_R_STAT))
312 return 0;
313
314 /* Get the IDE error register. */
315 err = HWIF(drive)->INB(IDE_ERROR_REG);
316 sense_key = err >> 4;
317
318 if (rq == NULL) {
319 printk("%s: missing rq in cdrom_decode_status\n", drive->name);
320 return 1;
321 }
322
Jens Axboe4aff5e22006-08-10 08:44:47 +0200323 if (blk_sense_request(rq)) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700324 /* We got an error trying to get sense info
325 from the drive (probably while trying
326 to recover from a former error). Just give up. */
327
Jens Axboe4aff5e22006-08-10 08:44:47 +0200328 rq->cmd_flags |= REQ_FAILED;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700329 cdrom_end_request(drive, 0);
330 ide_error(drive, "request sense failure", stat);
331 return 1;
332
Jens Axboe8770c012006-10-12 17:24:52 +0200333 } else if (blk_pc_request(rq) || rq->cmd_type == REQ_TYPE_ATA_PC) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700334 /* All other functions, except for READ. */
335 unsigned long flags;
336
337 /*
338 * if we have an error, pass back CHECK_CONDITION as the
339 * scsi status byte
340 */
Jens Axboeb7156732006-11-13 18:05:02 +0100341 if (blk_pc_request(rq) && !rq->errors)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700342 rq->errors = SAM_STAT_CHECK_CONDITION;
343
344 /* Check for tray open. */
345 if (sense_key == NOT_READY) {
346 cdrom_saw_media_change (drive);
347 } else if (sense_key == UNIT_ATTENTION) {
348 /* Check for media change. */
349 cdrom_saw_media_change (drive);
350 /*printk("%s: media changed\n",drive->name);*/
351 return 0;
Stuart Hayes76ca1af2007-04-10 22:38:43 +0200352 } else if ((sense_key == ILLEGAL_REQUEST) &&
353 (rq->cmd[0] == GPCMD_START_STOP_UNIT)) {
354 /*
355 * Don't print error message for this condition--
356 * SFF8090i indicates that 5/24/00 is the correct
357 * response to a request to close the tray if the
358 * drive doesn't have that capability.
359 * cdrom_log_sense() knows this!
360 */
Jens Axboe4aff5e22006-08-10 08:44:47 +0200361 } else if (!(rq->cmd_flags & REQ_QUIET)) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700362 /* Otherwise, print an error. */
363 ide_dump_status(drive, "packet command error", stat);
364 }
365
Jens Axboe4aff5e22006-08-10 08:44:47 +0200366 rq->cmd_flags |= REQ_FAILED;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700367
368 /*
369 * instead of playing games with moving completions around,
370 * remove failed request completely and end it when the
371 * request sense has completed
372 */
373 if (stat & ERR_STAT) {
374 spin_lock_irqsave(&ide_lock, flags);
375 blkdev_dequeue_request(rq);
376 HWGROUP(drive)->rq = NULL;
377 spin_unlock_irqrestore(&ide_lock, flags);
378
379 cdrom_queue_request_sense(drive, rq->sense, rq);
380 } else
381 cdrom_end_request(drive, 0);
382
383 } else if (blk_fs_request(rq)) {
384 int do_end_request = 0;
385
386 /* Handle errors from READ and WRITE requests. */
387
388 if (blk_noretry_request(rq))
389 do_end_request = 1;
390
391 if (sense_key == NOT_READY) {
392 /* Tray open. */
393 if (rq_data_dir(rq) == READ) {
394 cdrom_saw_media_change (drive);
395
396 /* Fail the request. */
397 printk ("%s: tray open\n", drive->name);
398 do_end_request = 1;
399 } else {
400 struct cdrom_info *info = drive->driver_data;
401
402 /* allow the drive 5 seconds to recover, some
403 * devices will return this error while flushing
404 * data from cache */
405 if (!rq->errors)
406 info->write_timeout = jiffies + ATAPI_WAIT_WRITE_BUSY;
407 rq->errors = 1;
408 if (time_after(jiffies, info->write_timeout))
409 do_end_request = 1;
410 else {
411 unsigned long flags;
412
413 /*
414 * take a breather relying on the
415 * unplug timer to kick us again
416 */
417 spin_lock_irqsave(&ide_lock, flags);
418 blk_plug_device(drive->queue);
419 spin_unlock_irqrestore(&ide_lock,flags);
420 return 1;
421 }
422 }
423 } else if (sense_key == UNIT_ATTENTION) {
424 /* Media change. */
425 cdrom_saw_media_change (drive);
426
427 /* Arrange to retry the request.
428 But be sure to give up if we've retried
429 too many times. */
430 if (++rq->errors > ERROR_MAX)
431 do_end_request = 1;
432 } else if (sense_key == ILLEGAL_REQUEST ||
433 sense_key == DATA_PROTECT) {
434 /* No point in retrying after an illegal
435 request or data protect error.*/
Alan Coxdbe217a2006-06-25 05:47:44 -0700436 ide_dump_status_no_sense (drive, "command error", stat);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700437 do_end_request = 1;
438 } else if (sense_key == MEDIUM_ERROR) {
439 /* No point in re-trying a zillion times on a bad
440 * sector... If we got here the error is not correctable */
Alan Coxdbe217a2006-06-25 05:47:44 -0700441 ide_dump_status_no_sense (drive, "media error (bad sector)", stat);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700442 do_end_request = 1;
443 } else if (sense_key == BLANK_CHECK) {
444 /* Disk appears blank ?? */
Alan Coxdbe217a2006-06-25 05:47:44 -0700445 ide_dump_status_no_sense (drive, "media error (blank)", stat);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700446 do_end_request = 1;
447 } else if ((err & ~ABRT_ERR) != 0) {
448 /* Go to the default handler
449 for other errors. */
450 ide_error(drive, "cdrom_decode_status", stat);
451 return 1;
452 } else if ((++rq->errors > ERROR_MAX)) {
453 /* We've racked up too many retries. Abort. */
454 do_end_request = 1;
455 }
456
Alan Coxdbe217a2006-06-25 05:47:44 -0700457 /* End a request through request sense analysis when we have
458 sense data. We need this in order to perform end of media
459 processing */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700460
Alan Coxdbe217a2006-06-25 05:47:44 -0700461 if (do_end_request) {
462 if (stat & ERR_STAT) {
463 unsigned long flags;
464 spin_lock_irqsave(&ide_lock, flags);
465 blkdev_dequeue_request(rq);
466 HWGROUP(drive)->rq = NULL;
467 spin_unlock_irqrestore(&ide_lock, flags);
468
469 cdrom_queue_request_sense(drive, rq->sense, rq);
470 } else
471 cdrom_end_request(drive, 0);
472 } else {
473 /* If we got a CHECK_CONDITION status,
474 queue a request sense command. */
475 if (stat & ERR_STAT)
476 cdrom_queue_request_sense(drive, NULL, NULL);
477 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700478 } else {
479 blk_dump_rq_flags(rq, "ide-cd: bad rq");
480 cdrom_end_request(drive, 0);
481 }
482
483 /* Retry, or handle the next request. */
484 return 1;
485}
486
487static int cdrom_timer_expiry(ide_drive_t *drive)
488{
489 struct request *rq = HWGROUP(drive)->rq;
490 unsigned long wait = 0;
491
492 /*
493 * Some commands are *slow* and normally take a long time to
494 * complete. Usually we can use the ATAPI "disconnect" to bypass
495 * this, but not all commands/drives support that. Let
496 * ide_timer_expiry keep polling us for these.
497 */
498 switch (rq->cmd[0]) {
499 case GPCMD_BLANK:
500 case GPCMD_FORMAT_UNIT:
501 case GPCMD_RESERVE_RZONE_TRACK:
502 case GPCMD_CLOSE_TRACK:
503 case GPCMD_FLUSH_CACHE:
504 wait = ATAPI_WAIT_PC;
505 break;
506 default:
Jens Axboe4aff5e22006-08-10 08:44:47 +0200507 if (!(rq->cmd_flags & REQ_QUIET))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700508 printk(KERN_INFO "ide-cd: cmd 0x%x timed out\n", rq->cmd[0]);
509 wait = 0;
510 break;
511 }
512 return wait;
513}
514
515/* Set up the device registers for transferring a packet command on DEV,
516 expecting to later transfer XFERLEN bytes. HANDLER is the routine
517 which actually transfers the command to the drive. If this is a
518 drq_interrupt device, this routine will arrange for HANDLER to be
519 called when the interrupt from the drive arrives. Otherwise, HANDLER
520 will be called immediately after the drive is prepared for the transfer. */
521
522static ide_startstop_t cdrom_start_packet_command(ide_drive_t *drive,
523 int xferlen,
524 ide_handler_t *handler)
525{
526 ide_startstop_t startstop;
527 struct cdrom_info *info = drive->driver_data;
528 ide_hwif_t *hwif = drive->hwif;
529
530 /* Wait for the controller to be idle. */
531 if (ide_wait_stat(&startstop, drive, 0, BUSY_STAT, WAIT_READY))
532 return startstop;
533
Bartlomiej Zolnierkiewicz3a6a3542008-01-25 22:17:13 +0100534 /* FIXME: for Virtual DMA we must check harder */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700535 if (info->dma)
536 info->dma = !hwif->dma_setup(drive);
537
538 /* Set up the controller registers. */
Bartlomiej Zolnierkiewicz2fc57382008-01-25 22:17:13 +0100539 ide_pktcmd_tf_load(drive, IDE_TFLAG_OUT_NSECT | IDE_TFLAG_OUT_LBAL |
540 IDE_TFLAG_NO_SELECT_MASK, xferlen, info->dma);
Bartlomiej Zolnierkiewicz4fe67172008-02-01 23:09:21 +0100541
Bartlomiej Zolnierkiewicz2bc4cf22008-02-01 23:09:22 +0100542 if (info->cd_flags & IDE_CD_FLAG_DRQ_INTERRUPT) {
Albert Leef0dd8712007-02-17 02:40:21 +0100543 /* waiting for CDB interrupt, not DMA yet. */
544 if (info->dma)
545 drive->waiting_for_dma = 0;
546
Linus Torvalds1da177e2005-04-16 15:20:36 -0700547 /* packet command */
548 ide_execute_command(drive, WIN_PACKETCMD, handler, ATAPI_WAIT_PC, cdrom_timer_expiry);
549 return ide_started;
550 } else {
551 unsigned long flags;
552
553 /* packet command */
554 spin_lock_irqsave(&ide_lock, flags);
555 hwif->OUTBSYNC(drive, WIN_PACKETCMD, IDE_COMMAND_REG);
556 ndelay(400);
557 spin_unlock_irqrestore(&ide_lock, flags);
558
559 return (*handler) (drive);
560 }
561}
562
563/* Send a packet command to DRIVE described by CMD_BUF and CMD_LEN.
564 The device registers must have already been prepared
565 by cdrom_start_packet_command.
566 HANDLER is the interrupt handler to call when the command completes
567 or there's data ready. */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700568#define ATAPI_MIN_CDB_BYTES 12
569static ide_startstop_t cdrom_transfer_packet_command (ide_drive_t *drive,
570 struct request *rq,
571 ide_handler_t *handler)
572{
573 ide_hwif_t *hwif = drive->hwif;
574 int cmd_len;
575 struct cdrom_info *info = drive->driver_data;
576 ide_startstop_t startstop;
577
Bartlomiej Zolnierkiewicz2bc4cf22008-02-01 23:09:22 +0100578 if (info->cd_flags & IDE_CD_FLAG_DRQ_INTERRUPT) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700579 /* Here we should have been called after receiving an interrupt
580 from the device. DRQ should how be set. */
581
582 /* Check for errors. */
583 if (cdrom_decode_status(drive, DRQ_STAT, NULL))
584 return ide_stopped;
Albert Leef0dd8712007-02-17 02:40:21 +0100585
586 /* Ok, next interrupt will be DMA interrupt. */
587 if (info->dma)
588 drive->waiting_for_dma = 1;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700589 } else {
590 /* Otherwise, we must wait for DRQ to get set. */
591 if (ide_wait_stat(&startstop, drive, DRQ_STAT,
592 BUSY_STAT, WAIT_READY))
593 return startstop;
594 }
595
596 /* Arm the interrupt handler. */
597 ide_set_handler(drive, handler, rq->timeout, cdrom_timer_expiry);
598
599 /* ATAPI commands get padded out to 12 bytes minimum */
600 cmd_len = COMMAND_SIZE(rq->cmd[0]);
601 if (cmd_len < ATAPI_MIN_CDB_BYTES)
602 cmd_len = ATAPI_MIN_CDB_BYTES;
603
604 /* Send the command to the device. */
605 HWIF(drive)->atapi_output_bytes(drive, rq->cmd, cmd_len);
606
607 /* Start the DMA if need be */
608 if (info->dma)
609 hwif->dma_start(drive);
610
611 return ide_started;
612}
613
614/****************************************************************************
615 * Block read functions.
616 */
617
Bartlomiej Zolnierkiewicz68661c52008-02-01 23:09:17 +0100618typedef void (xfer_func_t)(ide_drive_t *, void *, u32);
619
Bartlomiej Zolnierkiewicz5a5222d2008-02-01 23:09:17 +0100620static void ide_cd_pad_transfer(ide_drive_t *drive, xfer_func_t *xf, int len)
621{
622 while (len > 0) {
623 int dum = 0;
624 xf(drive, &dum, sizeof(dum));
625 len -= sizeof(dum);
626 }
627}
628
Bartlomiej Zolnierkiewiczb4ab7262008-02-01 23:09:26 +0100629static void ide_cd_drain_data(ide_drive_t *drive, int nsects)
630{
631 while (nsects > 0) {
632 static char dum[SECTOR_SIZE];
633
634 drive->hwif->atapi_input_bytes(drive, dum, sizeof(dum));
635 nsects--;
636 }
637}
638
Linus Torvalds1da177e2005-04-16 15:20:36 -0700639/*
640 * Buffer up to SECTORS_TO_TRANSFER sectors from the drive in our sector
641 * buffer. Once the first sector is added, any subsequent sectors are
642 * assumed to be continuous (until the buffer is cleared). For the first
643 * sector added, SECTOR is its sector number. (SECTOR is then ignored until
644 * the buffer is cleared.)
645 */
646static void cdrom_buffer_sectors (ide_drive_t *drive, unsigned long sector,
647 int sectors_to_transfer)
648{
649 struct cdrom_info *info = drive->driver_data;
650
651 /* Number of sectors to read into the buffer. */
652 int sectors_to_buffer = min_t(int, sectors_to_transfer,
653 (SECTOR_BUFFER_SIZE >> SECTOR_BITS) -
654 info->nsectors_buffered);
655
656 char *dest;
657
658 /* If we couldn't get a buffer, don't try to buffer anything... */
659 if (info->buffer == NULL)
660 sectors_to_buffer = 0;
661
662 /* If this is the first sector in the buffer, remember its number. */
663 if (info->nsectors_buffered == 0)
664 info->sector_buffered = sector;
665
666 /* Read the data into the buffer. */
667 dest = info->buffer + info->nsectors_buffered * SECTOR_SIZE;
668 while (sectors_to_buffer > 0) {
669 HWIF(drive)->atapi_input_bytes(drive, dest, SECTOR_SIZE);
670 --sectors_to_buffer;
671 --sectors_to_transfer;
672 ++info->nsectors_buffered;
673 dest += SECTOR_SIZE;
674 }
675
676 /* Throw away any remaining data. */
Bartlomiej Zolnierkiewiczb4ab7262008-02-01 23:09:26 +0100677 ide_cd_drain_data(drive, sectors_to_transfer);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700678}
679
680/*
681 * Check the contents of the interrupt reason register from the cdrom
682 * and attempt to recover if there are problems. Returns 0 if everything's
683 * ok; nonzero if the request has been terminated.
684 */
Arjan van de Ven858119e2006-01-14 13:20:43 -0800685static
Linus Torvalds1da177e2005-04-16 15:20:36 -0700686int cdrom_read_check_ireason (ide_drive_t *drive, int len, int ireason)
687{
688 if (ireason == 2)
689 return 0;
690 else if (ireason == 0) {
Bartlomiej Zolnierkiewicz5a5222d2008-02-01 23:09:17 +0100691 ide_hwif_t *hwif = drive->hwif;
692
Linus Torvalds1da177e2005-04-16 15:20:36 -0700693 /* Whoops... The drive is expecting to receive data from us! */
Bartlomiej Zolnierkiewicz35379c02007-12-24 15:23:43 +0100694 printk(KERN_ERR "%s: %s: wrong transfer direction!\n",
695 drive->name, __FUNCTION__);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700696
697 /* Throw some data at the drive so it doesn't hang
698 and quit this request. */
Bartlomiej Zolnierkiewicz5a5222d2008-02-01 23:09:17 +0100699 ide_cd_pad_transfer(drive, hwif->atapi_output_bytes, len);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700700 } else if (ireason == 1) {
701 /* Some drives (ASUS) seem to tell us that status
702 * info is available. just get it and ignore.
703 */
704 (void) HWIF(drive)->INB(IDE_STATUS_REG);
705 return 0;
706 } else {
707 /* Drive wants a command packet, or invalid ireason... */
Bartlomiej Zolnierkiewicz35379c02007-12-24 15:23:43 +0100708 printk(KERN_ERR "%s: %s: bad interrupt reason 0x%02x\n",
709 drive->name, __FUNCTION__, ireason);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700710 }
711
712 cdrom_end_request(drive, 0);
713 return -1;
714}
715
716/*
Bartlomiej Zolnierkiewicz64814f22008-02-01 23:09:26 +0100717 * Assume that the drive will always provide data in multiples of at least
718 * SECTOR_SIZE, as it gets hairy to keep track of the transfers otherwise.
719 */
720static int ide_cd_check_transfer_size(ide_drive_t *drive, int len)
721{
722 struct cdrom_info *cd = drive->driver_data;
723
724 if ((len % SECTOR_SIZE) == 0)
725 return 0;
726
727 printk(KERN_ERR "%s: %s: Bad transfer size %d\n",
728 drive->name, __FUNCTION__, len);
729
730 if (cd->cd_flags & IDE_CD_FLAG_LIMIT_NFRAMES)
731 printk(KERN_ERR " This drive is not supported by "
732 "this version of the driver\n");
733 else {
734 printk(KERN_ERR " Trying to limit transfer sizes\n");
735 cd->cd_flags |= IDE_CD_FLAG_LIMIT_NFRAMES;
736 }
737
738 return 1;
739}
740
741/*
Linus Torvalds1da177e2005-04-16 15:20:36 -0700742 * Try to satisfy some of the current read request from our cached data.
743 * Returns nonzero if the request has been completed, zero otherwise.
744 */
745static int cdrom_read_from_buffer (ide_drive_t *drive)
746{
747 struct cdrom_info *info = drive->driver_data;
748 struct request *rq = HWGROUP(drive)->rq;
749 unsigned short sectors_per_frame;
750
751 sectors_per_frame = queue_hardsect_size(drive->queue) >> SECTOR_BITS;
752
753 /* Can't do anything if there's no buffer. */
754 if (info->buffer == NULL) return 0;
755
756 /* Loop while this request needs data and the next block is present
757 in our cache. */
758 while (rq->nr_sectors > 0 &&
759 rq->sector >= info->sector_buffered &&
760 rq->sector < info->sector_buffered + info->nsectors_buffered) {
761 if (rq->current_nr_sectors == 0)
762 cdrom_end_request(drive, 1);
763
764 memcpy (rq->buffer,
765 info->buffer +
766 (rq->sector - info->sector_buffered) * SECTOR_SIZE,
767 SECTOR_SIZE);
768 rq->buffer += SECTOR_SIZE;
769 --rq->current_nr_sectors;
770 --rq->nr_sectors;
771 ++rq->sector;
772 }
773
774 /* If we've satisfied the current request,
775 terminate it successfully. */
776 if (rq->nr_sectors == 0) {
777 cdrom_end_request(drive, 1);
778 return -1;
779 }
780
781 /* Move on to the next buffer if needed. */
782 if (rq->current_nr_sectors == 0)
783 cdrom_end_request(drive, 1);
784
785 /* If this condition does not hold, then the kluge i use to
786 represent the number of sectors to skip at the start of a transfer
787 will fail. I think that this will never happen, but let's be
788 paranoid and check. */
789 if (rq->current_nr_sectors < bio_cur_sectors(rq->bio) &&
790 (rq->sector & (sectors_per_frame - 1))) {
791 printk(KERN_ERR "%s: cdrom_read_from_buffer: buffer botch (%ld)\n",
792 drive->name, (long)rq->sector);
793 cdrom_end_request(drive, 0);
794 return -1;
795 }
796
797 return 0;
798}
799
Bartlomiej Zolnierkiewicz0041e7c2008-02-01 23:09:28 +0100800static ide_startstop_t cdrom_newpc_intr(ide_drive_t *);
Bartlomiej Zolnierkiewicz94f5a862008-02-01 23:09:26 +0100801
Linus Torvalds1da177e2005-04-16 15:20:36 -0700802/*
Bartlomiej Zolnierkiewicz29f3aac2008-02-01 23:09:27 +0100803 * Routine to send a read/write packet command to the drive.
804 * This is usually called directly from cdrom_start_{read,write}().
Linus Torvalds1da177e2005-04-16 15:20:36 -0700805 * However, for drq_interrupt devices, it is called from an interrupt
806 * when the drive is ready to accept the command.
807 */
Bartlomiej Zolnierkiewicz29f3aac2008-02-01 23:09:27 +0100808static ide_startstop_t cdrom_start_rw_cont(ide_drive_t *drive)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700809{
810 struct request *rq = HWGROUP(drive)->rq;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700811
Bartlomiej Zolnierkiewicz29f3aac2008-02-01 23:09:27 +0100812 if (rq_data_dir(rq) == READ) {
813 unsigned short sectors_per_frame =
814 queue_hardsect_size(drive->queue) >> SECTOR_BITS;
815 int nskip = rq->sector & (sectors_per_frame - 1);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700816
Bartlomiej Zolnierkiewicz29f3aac2008-02-01 23:09:27 +0100817 /*
818 * If the requested sector doesn't start on a frame boundary,
819 * we must adjust the start of the transfer so that it does,
820 * and remember to skip the first few sectors.
821 *
822 * If the rq->current_nr_sectors field is larger than the size
823 * of the buffer, it will mean that we're to skip a number of
824 * sectors equal to the amount by which rq->current_nr_sectors
825 * is larger than the buffer size.
826 */
827 if (nskip > 0) {
828 /* Sanity check... */
829 if (rq->current_nr_sectors !=
830 bio_cur_sectors(rq->bio)) {
831 printk(KERN_ERR "%s: %s: buffer botch (%u)\n",
832 drive->name, __FUNCTION__,
833 rq->current_nr_sectors);
834 cdrom_end_request(drive, 0);
835 return ide_stopped;
836 }
837 rq->current_nr_sectors += nskip;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700838 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700839 }
Bartlomiej Zolnierkiewicz29f3aac2008-02-01 23:09:27 +0100840#if 0
841 else
842 /* the immediate bit */
843 rq->cmd[1] = 1 << 3;
844#endif
Linus Torvalds1da177e2005-04-16 15:20:36 -0700845 /* Set up the command */
846 rq->timeout = ATAPI_WAIT_PC;
847
848 /* Send the command to the drive and return. */
Bartlomiej Zolnierkiewicz0041e7c2008-02-01 23:09:28 +0100849 return cdrom_transfer_packet_command(drive, rq, cdrom_newpc_intr);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700850}
851
Linus Torvalds1da177e2005-04-16 15:20:36 -0700852#define IDECD_SEEK_THRESHOLD (1000) /* 1000 blocks */
853#define IDECD_SEEK_TIMER (5 * WAIT_MIN_SLEEP) /* 100 ms */
854#define IDECD_SEEK_TIMEOUT (2 * WAIT_CMD) /* 20 sec */
855
856static ide_startstop_t cdrom_seek_intr (ide_drive_t *drive)
857{
858 struct cdrom_info *info = drive->driver_data;
859 int stat;
860 static int retry = 10;
861
862 if (cdrom_decode_status(drive, 0, &stat))
863 return ide_stopped;
Bartlomiej Zolnierkiewicz4fe67172008-02-01 23:09:21 +0100864
Bartlomiej Zolnierkiewicz2bc4cf22008-02-01 23:09:22 +0100865 info->cd_flags |= IDE_CD_FLAG_SEEKING;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700866
867 if (retry && time_after(jiffies, info->start_seek + IDECD_SEEK_TIMER)) {
868 if (--retry == 0) {
869 /*
870 * this condition is far too common, to bother
871 * users about it
872 */
873 /* printk("%s: disabled DSC seek overlap\n", drive->name);*/
874 drive->dsc_overlap = 0;
875 }
876 }
877 return ide_stopped;
878}
879
880static ide_startstop_t cdrom_start_seek_continuation (ide_drive_t *drive)
881{
882 struct request *rq = HWGROUP(drive)->rq;
883 sector_t frame = rq->sector;
884
885 sector_div(frame, queue_hardsect_size(drive->queue) >> SECTOR_BITS);
886
887 memset(rq->cmd, 0, sizeof(rq->cmd));
888 rq->cmd[0] = GPCMD_SEEK;
889 put_unaligned(cpu_to_be32(frame), (unsigned int *) &rq->cmd[2]);
890
891 rq->timeout = ATAPI_WAIT_PC;
892 return cdrom_transfer_packet_command(drive, rq, &cdrom_seek_intr);
893}
894
895static ide_startstop_t cdrom_start_seek (ide_drive_t *drive, unsigned int block)
896{
897 struct cdrom_info *info = drive->driver_data;
898
899 info->dma = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700900 info->start_seek = jiffies;
901 return cdrom_start_packet_command(drive, 0, cdrom_start_seek_continuation);
902}
903
904/* Fix up a possibly partially-processed request so that we can
905 start it over entirely, or even put it back on the request queue. */
906static void restore_request (struct request *rq)
907{
908 if (rq->buffer != bio_data(rq->bio)) {
909 sector_t n = (rq->buffer - (char *) bio_data(rq->bio)) / SECTOR_SIZE;
910
911 rq->buffer = bio_data(rq->bio);
912 rq->nr_sectors += n;
913 rq->sector -= n;
914 }
915 rq->hard_cur_sectors = rq->current_nr_sectors = bio_cur_sectors(rq->bio);
916 rq->hard_nr_sectors = rq->nr_sectors;
917 rq->hard_sector = rq->sector;
918 rq->q->prep_rq_fn(rq->q, rq);
919}
920
Linus Torvalds1da177e2005-04-16 15:20:36 -0700921/****************************************************************************
922 * Execute all other packet commands.
923 */
924
Bartlomiej Zolnierkiewicz8ee69f52008-02-01 23:09:25 +0100925static void ide_cd_request_sense_fixup(struct request *rq)
926{
927 /*
928 * Some of the trailing request sense fields are optional,
929 * and some drives don't send them. Sigh.
930 */
931 if (rq->cmd[0] == GPCMD_REQUEST_SENSE &&
932 rq->data_len > 0 && rq->data_len <= 5)
933 while (rq->data_len > 0) {
934 *(u8 *)rq->data++ = 0;
935 --rq->data_len;
936 }
937}
938
Bartlomiej Zolnierkiewicz17802992008-02-01 23:09:25 +0100939int ide_cd_queue_pc(ide_drive_t *drive, struct request *rq)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700940{
941 struct request_sense sense;
942 int retries = 10;
Jens Axboe4aff5e22006-08-10 08:44:47 +0200943 unsigned int flags = rq->cmd_flags;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700944
945 if (rq->sense == NULL)
946 rq->sense = &sense;
947
948 /* Start of retry loop. */
949 do {
950 int error;
951 unsigned long time = jiffies;
Jens Axboe4aff5e22006-08-10 08:44:47 +0200952 rq->cmd_flags = flags;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700953
954 error = ide_do_drive_cmd(drive, rq, ide_wait);
955 time = jiffies - time;
956
957 /* FIXME: we should probably abort/retry or something
958 * in case of failure */
Jens Axboe4aff5e22006-08-10 08:44:47 +0200959 if (rq->cmd_flags & REQ_FAILED) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700960 /* The request failed. Retry if it was due to a unit
961 attention status
962 (usually means media was changed). */
963 struct request_sense *reqbuf = rq->sense;
964
965 if (reqbuf->sense_key == UNIT_ATTENTION)
966 cdrom_saw_media_change(drive);
967 else if (reqbuf->sense_key == NOT_READY &&
968 reqbuf->asc == 4 && reqbuf->ascq != 4) {
969 /* The drive is in the process of loading
970 a disk. Retry, but wait a little to give
971 the drive time to complete the load. */
972 ssleep(2);
973 } else {
974 /* Otherwise, don't retry. */
975 retries = 0;
976 }
977 --retries;
978 }
979
980 /* End of retry loop. */
Jens Axboe4aff5e22006-08-10 08:44:47 +0200981 } while ((rq->cmd_flags & REQ_FAILED) && retries >= 0);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700982
983 /* Return an error if the command failed. */
Jens Axboe4aff5e22006-08-10 08:44:47 +0200984 return (rq->cmd_flags & REQ_FAILED) ? -EIO : 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700985}
986
987/*
988 * Write handling
989 */
Arjan van de Ven858119e2006-01-14 13:20:43 -0800990static int cdrom_write_check_ireason(ide_drive_t *drive, int len, int ireason)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700991{
992 /* Two notes about IDE interrupt reason here - 0 means that
993 * the drive wants to receive data from us, 2 means that
994 * the drive is expecting to transfer data to us.
995 */
996 if (ireason == 0)
997 return 0;
998 else if (ireason == 2) {
Bartlomiej Zolnierkiewicz5a5222d2008-02-01 23:09:17 +0100999 ide_hwif_t *hwif = drive->hwif;
1000
Linus Torvalds1da177e2005-04-16 15:20:36 -07001001 /* Whoops... The drive wants to send data. */
Bartlomiej Zolnierkiewicz35379c02007-12-24 15:23:43 +01001002 printk(KERN_ERR "%s: %s: wrong transfer direction!\n",
1003 drive->name, __FUNCTION__);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001004
Bartlomiej Zolnierkiewicz5a5222d2008-02-01 23:09:17 +01001005 ide_cd_pad_transfer(drive, hwif->atapi_input_bytes, len);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001006 } else {
1007 /* Drive wants a command packet, or invalid ireason... */
Bartlomiej Zolnierkiewicz35379c02007-12-24 15:23:43 +01001008 printk(KERN_ERR "%s: %s: bad interrupt reason 0x%02x\n",
1009 drive->name, __FUNCTION__, ireason);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001010 }
1011
1012 cdrom_end_request(drive, 0);
1013 return 1;
1014}
1015
Kiyoshi Uedaaaa04c22007-12-11 17:51:23 -05001016/*
1017 * Called from blk_end_request_callback() after the data of the request
1018 * is completed and before the request is completed.
1019 * By returning value '1', blk_end_request_callback() returns immediately
1020 * without completing the request.
1021 */
1022static int cdrom_newpc_intr_dummy_cb(struct request *rq)
1023{
1024 return 1;
1025}
1026
Linus Torvalds1da177e2005-04-16 15:20:36 -07001027static ide_startstop_t cdrom_newpc_intr(ide_drive_t *drive)
1028{
1029 struct cdrom_info *info = drive->driver_data;
1030 struct request *rq = HWGROUP(drive)->rq;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001031 xfer_func_t *xferfunc;
Bartlomiej Zolnierkiewicz0041e7c2008-02-01 23:09:28 +01001032 ide_expiry_t *expiry = NULL;
Bartlomiej Zolnierkiewiczff1bfbc2008-02-01 23:09:25 +01001033 int dma_error = 0, dma, stat, ireason, len, thislen, uptodate = 0;
1034 int write = (rq_data_dir(rq) == WRITE) ? 1 : 0;
1035 unsigned int timeout;
1036 u8 lowcyl, highcyl;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001037
1038 /* Check for errors. */
Linus Torvalds1da177e2005-04-16 15:20:36 -07001039 dma = info->dma;
1040 if (dma) {
1041 info->dma = 0;
1042 dma_error = HWIF(drive)->ide_dma_end(drive);
Bartlomiej Zolnierkiewiczeba15fb2008-02-01 23:09:17 +01001043 if (dma_error) {
1044 printk(KERN_ERR "%s: DMA %s error\n", drive->name,
Bartlomiej Zolnierkiewiczff1bfbc2008-02-01 23:09:25 +01001045 write ? "write" : "read");
Bartlomiej Zolnierkiewiczeba15fb2008-02-01 23:09:17 +01001046 ide_dma_off(drive);
1047 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001048 }
1049
1050 if (cdrom_decode_status(drive, 0, &stat))
1051 return ide_stopped;
1052
1053 /*
1054 * using dma, transfer is complete now
1055 */
1056 if (dma) {
Bartlomiej Zolnierkiewiczeba15fb2008-02-01 23:09:17 +01001057 if (dma_error)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001058 return ide_error(drive, "dma error", stat);
Bartlomiej Zolnierkiewicz0041e7c2008-02-01 23:09:28 +01001059 if (blk_fs_request(rq)) {
1060 ide_end_request(drive, 1, rq->nr_sectors);
1061 return ide_stopped;
1062 }
Bartlomiej Zolnierkiewiczff1bfbc2008-02-01 23:09:25 +01001063 goto end_request;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001064 }
1065
1066 /*
1067 * ok we fall to pio :/
1068 */
1069 ireason = HWIF(drive)->INB(IDE_IREASON_REG) & 0x3;
1070 lowcyl = HWIF(drive)->INB(IDE_BCOUNTL_REG);
1071 highcyl = HWIF(drive)->INB(IDE_BCOUNTH_REG);
1072
1073 len = lowcyl + (256 * highcyl);
Bartlomiej Zolnierkiewicz0041e7c2008-02-01 23:09:28 +01001074
1075 thislen = blk_fs_request(rq) ? len : rq->data_len;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001076 if (thislen > len)
1077 thislen = len;
1078
1079 /*
1080 * If DRQ is clear, the command has completed.
1081 */
Kiyoshi Uedaaaa04c22007-12-11 17:51:23 -05001082 if ((stat & DRQ_STAT) == 0) {
Bartlomiej Zolnierkiewicz0041e7c2008-02-01 23:09:28 +01001083 if (blk_fs_request(rq)) {
1084 /*
1085 * If we're not done reading/writing, complain.
1086 * Otherwise, complete the command normally.
1087 */
1088 uptodate = 1;
1089 if (rq->current_nr_sectors > 0) {
1090 printk(KERN_ERR "%s: %s: data underrun "
1091 "(%d blocks)\n",
1092 drive->name, __FUNCTION__,
1093 rq->current_nr_sectors);
1094 if (!write)
1095 rq->cmd_flags |= REQ_FAILED;
1096 uptodate = 0;
1097 }
1098 cdrom_end_request(drive, uptodate);
1099 return ide_stopped;
1100 } else if (!blk_pc_request(rq)) {
Bartlomiej Zolnierkiewiczff1bfbc2008-02-01 23:09:25 +01001101 ide_cd_request_sense_fixup(rq);
1102 /* Complain if we still have data left to transfer. */
1103 uptodate = rq->data_len ? 0 : 1;
1104 }
1105 goto end_request;
Kiyoshi Uedaaaa04c22007-12-11 17:51:23 -05001106 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001107
1108 /*
1109 * check which way to transfer data
1110 */
Bartlomiej Zolnierkiewicz0041e7c2008-02-01 23:09:28 +01001111 if ((blk_fs_request(rq) || blk_pc_request(rq)) && write) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07001112 /*
1113 * write to drive
1114 */
1115 if (cdrom_write_check_ireason(drive, len, ireason))
1116 return ide_stopped;
Bartlomiej Zolnierkiewicz0041e7c2008-02-01 23:09:28 +01001117 } else if (blk_fs_request(rq) || blk_pc_request(rq)) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07001118 /*
1119 * read from drive
1120 */
1121 if (cdrom_read_check_ireason(drive, len, ireason))
1122 return ide_stopped;
Bartlomiej Zolnierkiewicz0041e7c2008-02-01 23:09:28 +01001123
1124 if (blk_fs_request(rq)) {
1125 int nskip;
1126
1127 if (ide_cd_check_transfer_size(drive, len)) {
1128 cdrom_end_request(drive, 0);
1129 return ide_stopped;
1130 }
1131
1132 /*
1133 * First, figure out if we need to bit-bucket
1134 * any of the leading sectors.
1135 */
1136 nskip = min_t(int, rq->current_nr_sectors
1137 - bio_cur_sectors(rq->bio),
1138 thislen >> 9);
1139 if (nskip > 0) {
1140 ide_cd_drain_data(drive, nskip);
1141 rq->current_nr_sectors -= nskip;
1142 thislen -= (nskip << 9);
1143 }
1144 }
Bartlomiej Zolnierkiewiczff1bfbc2008-02-01 23:09:25 +01001145 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001146
Bartlomiej Zolnierkiewiczff1bfbc2008-02-01 23:09:25 +01001147 if (ireason == 0) {
1148 write = 1;
1149 xferfunc = HWIF(drive)->atapi_output_bytes;
Bartlomiej Zolnierkiewicz0041e7c2008-02-01 23:09:28 +01001150 } else if (ireason == 2 || (ireason == 1 &&
1151 (blk_fs_request(rq) || blk_pc_request(rq)))) {
Bartlomiej Zolnierkiewiczff1bfbc2008-02-01 23:09:25 +01001152 write = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001153 xferfunc = HWIF(drive)->atapi_input_bytes;
Bartlomiej Zolnierkiewiczff1bfbc2008-02-01 23:09:25 +01001154 } else {
1155 printk(KERN_ERR "%s: %s: The drive "
1156 "appears confused (ireason = 0x%02x). "
1157 "Trying to recover by ending request.\n",
1158 drive->name, __FUNCTION__, ireason);
1159 goto end_request;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001160 }
1161
1162 /*
1163 * transfer data
1164 */
1165 while (thislen > 0) {
Bartlomiej Zolnierkiewicz0041e7c2008-02-01 23:09:28 +01001166 u8 *ptr = blk_fs_request(rq) ? NULL : rq->data;
Bartlomiej Zolnierkiewicza11e77d2008-02-01 23:09:27 +01001167 int blen = rq->data_len;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001168
1169 /*
1170 * bio backed?
1171 */
1172 if (rq->bio) {
Bartlomiej Zolnierkiewicz0041e7c2008-02-01 23:09:28 +01001173 if (blk_fs_request(rq)) {
1174 ptr = rq->buffer;
1175 blen = rq->current_nr_sectors << 9;
1176 } else {
1177 ptr = bio_data(rq->bio);
1178 blen = bio_iovec(rq->bio)->bv_len;
1179 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001180 }
1181
1182 if (!ptr) {
Bartlomiej Zolnierkiewicz0041e7c2008-02-01 23:09:28 +01001183 if (blk_fs_request(rq) && !write)
1184 /*
1185 * If the buffers are full, cache the rest
1186 * of the data in our internal buffer.
1187 */
1188 cdrom_buffer_sectors(drive, rq->sector,
1189 thislen >> 9);
1190 else {
1191 printk(KERN_ERR "%s: confused, missing data\n",
1192 drive->name);
1193 blk_dump_rq_flags(rq, rq_data_dir(rq)
1194 ? "cdrom_newpc_intr, write"
1195 : "cdrom_newpc_intr, read");
1196 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001197 break;
1198 }
1199
1200 if (blen > thislen)
1201 blen = thislen;
1202
1203 xferfunc(drive, ptr, blen);
1204
1205 thislen -= blen;
1206 len -= blen;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001207
Bartlomiej Zolnierkiewicz0041e7c2008-02-01 23:09:28 +01001208 if (blk_fs_request(rq)) {
1209 rq->buffer += blen;
1210 rq->nr_sectors -= (blen >> 9);
1211 rq->current_nr_sectors -= (blen >> 9);
1212 rq->sector += (blen >> 9);
1213
1214 if (rq->current_nr_sectors == 0 && rq->nr_sectors)
1215 cdrom_end_request(drive, 1);
1216 } else {
1217 rq->data_len -= blen;
1218
Kiyoshi Uedaaaa04c22007-12-11 17:51:23 -05001219 /*
1220 * The request can't be completed until DRQ is cleared.
1221 * So complete the data, but don't complete the request
1222 * using the dummy function for the callback feature
1223 * of blk_end_request_callback().
1224 */
Bartlomiej Zolnierkiewicz0041e7c2008-02-01 23:09:28 +01001225 if (rq->bio)
1226 blk_end_request_callback(rq, 0, blen,
Kiyoshi Uedaaaa04c22007-12-11 17:51:23 -05001227 cdrom_newpc_intr_dummy_cb);
Bartlomiej Zolnierkiewicz0041e7c2008-02-01 23:09:28 +01001228 else
1229 rq->data += blen;
1230 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001231 }
1232
Bartlomiej Zolnierkiewiczff1bfbc2008-02-01 23:09:25 +01001233 if (write && blk_sense_request(rq))
1234 rq->sense_len += thislen;
1235
Linus Torvalds1da177e2005-04-16 15:20:36 -07001236 /*
1237 * pad, if necessary
1238 */
Bartlomiej Zolnierkiewicz0041e7c2008-02-01 23:09:28 +01001239 if (!blk_fs_request(rq) && len > 0)
Bartlomiej Zolnierkiewicz5a5222d2008-02-01 23:09:17 +01001240 ide_cd_pad_transfer(drive, xferfunc, len);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001241
Bartlomiej Zolnierkiewiczff1bfbc2008-02-01 23:09:25 +01001242 if (blk_pc_request(rq)) {
1243 timeout = rq->timeout;
Bartlomiej Zolnierkiewiczff1bfbc2008-02-01 23:09:25 +01001244 } else {
1245 timeout = ATAPI_WAIT_PC;
Bartlomiej Zolnierkiewicz0041e7c2008-02-01 23:09:28 +01001246 if (!blk_fs_request(rq))
1247 expiry = cdrom_timer_expiry;
Bartlomiej Zolnierkiewiczff1bfbc2008-02-01 23:09:25 +01001248 }
1249
1250 ide_set_handler(drive, cdrom_newpc_intr, timeout, expiry);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001251 return ide_started;
Bartlomiej Zolnierkiewiczff1bfbc2008-02-01 23:09:25 +01001252
1253end_request:
1254 if (blk_pc_request(rq)) {
1255 unsigned long flags;
1256
1257 spin_lock_irqsave(&ide_lock, flags);
1258 if (__blk_end_request(rq, 0, rq->data_len))
1259 BUG();
1260 HWGROUP(drive)->rq = NULL;
1261 spin_unlock_irqrestore(&ide_lock, flags);
1262 } else {
1263 if (!uptodate)
1264 rq->cmd_flags |= REQ_FAILED;
1265 cdrom_end_request(drive, uptodate);
1266 }
1267 return ide_stopped;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001268}
1269
Bartlomiej Zolnierkiewicz21ea1f02008-02-01 23:09:27 +01001270static ide_startstop_t cdrom_start_rw(ide_drive_t *drive, struct request *rq)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001271{
Bartlomiej Zolnierkiewicz21ea1f02008-02-01 23:09:27 +01001272 struct cdrom_info *cd = drive->driver_data;
1273 int write = rq_data_dir(rq) == WRITE;
1274 unsigned short sectors_per_frame =
1275 queue_hardsect_size(drive->queue) >> SECTOR_BITS;
1276
1277 if (write) {
1278 /*
1279 * disk has become write protected
1280 */
1281 if (cd->disk->policy) {
1282 cdrom_end_request(drive, 0);
1283 return ide_stopped;
1284 }
1285 } else {
1286 /*
1287 * We may be retrying this request after an error. Fix up any
1288 * weirdness which might be present in the request packet.
1289 */
1290 restore_request(rq);
1291
1292 /* Satisfy whatever we can of this request from our cache. */
1293 if (cdrom_read_from_buffer(drive))
1294 return ide_stopped;
1295 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001296
1297 /*
Bartlomiej Zolnierkiewicz21ea1f02008-02-01 23:09:27 +01001298 * use DMA, if possible / writes *must* be hardware frame aligned
Linus Torvalds1da177e2005-04-16 15:20:36 -07001299 */
1300 if ((rq->nr_sectors & (sectors_per_frame - 1)) ||
1301 (rq->sector & (sectors_per_frame - 1))) {
Bartlomiej Zolnierkiewicz21ea1f02008-02-01 23:09:27 +01001302 if (write) {
1303 cdrom_end_request(drive, 0);
1304 return ide_stopped;
1305 }
1306 cd->dma = 0;
1307 } else
1308 cd->dma = drive->using_dma;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001309
Bartlomiej Zolnierkiewicz21ea1f02008-02-01 23:09:27 +01001310 /* Clear the local sector buffer. */
1311 cd->nsectors_buffered = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001312
Bartlomiej Zolnierkiewicz21ea1f02008-02-01 23:09:27 +01001313 if (write)
1314 cd->devinfo.media_written = 1;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001315
Bartlomiej Zolnierkiewicz21ea1f02008-02-01 23:09:27 +01001316 /* Start sending the read/write request to the drive. */
Bartlomiej Zolnierkiewicz29f3aac2008-02-01 23:09:27 +01001317 return cdrom_start_packet_command(drive, 32768, cdrom_start_rw_cont);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001318}
1319
1320static ide_startstop_t cdrom_do_newpc_cont(ide_drive_t *drive)
1321{
1322 struct request *rq = HWGROUP(drive)->rq;
1323
1324 if (!rq->timeout)
1325 rq->timeout = ATAPI_WAIT_PC;
1326
1327 return cdrom_transfer_packet_command(drive, rq, cdrom_newpc_intr);
1328}
1329
1330static ide_startstop_t cdrom_do_block_pc(ide_drive_t *drive, struct request *rq)
1331{
1332 struct cdrom_info *info = drive->driver_data;
1333
Bartlomiej Zolnierkiewiczc9f56a82008-02-01 23:09:26 +01001334 if (blk_pc_request(rq))
1335 rq->cmd_flags |= REQ_QUIET;
1336 else
1337 rq->cmd_flags &= ~REQ_FAILED;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001338
1339 info->dma = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001340
1341 /*
1342 * sg request
1343 */
1344 if (rq->bio) {
1345 int mask = drive->queue->dma_alignment;
1346 unsigned long addr = (unsigned long) page_address(bio_page(rq->bio));
1347
Linus Torvalds1da177e2005-04-16 15:20:36 -07001348 info->dma = drive->using_dma;
1349
1350 /*
1351 * check if dma is safe
Linus Torvalds5d9e4ea2005-05-27 07:36:17 -07001352 *
1353 * NOTE! The "len" and "addr" checks should possibly have
1354 * separate masks.
Linus Torvalds1da177e2005-04-16 15:20:36 -07001355 */
Jens Axboe4e7c6812005-05-31 17:47:36 +02001356 if ((rq->data_len & 15) || (addr & mask))
Linus Torvalds1da177e2005-04-16 15:20:36 -07001357 info->dma = 0;
1358 }
1359
1360 /* Start sending the command to the drive. */
1361 return cdrom_start_packet_command(drive, rq->data_len, cdrom_do_newpc_cont);
1362}
1363
1364/****************************************************************************
1365 * cdrom driver request routine.
1366 */
1367static ide_startstop_t
1368ide_do_rw_cdrom (ide_drive_t *drive, struct request *rq, sector_t block)
1369{
1370 ide_startstop_t action;
1371 struct cdrom_info *info = drive->driver_data;
1372
1373 if (blk_fs_request(rq)) {
Bartlomiej Zolnierkiewicz2bc4cf22008-02-01 23:09:22 +01001374 if (info->cd_flags & IDE_CD_FLAG_SEEKING) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07001375 unsigned long elapsed = jiffies - info->start_seek;
1376 int stat = HWIF(drive)->INB(IDE_STATUS_REG);
1377
1378 if ((stat & SEEK_STAT) != SEEK_STAT) {
1379 if (elapsed < IDECD_SEEK_TIMEOUT) {
1380 ide_stall_queue(drive, IDECD_SEEK_TIMER);
1381 return ide_stopped;
1382 }
1383 printk (KERN_ERR "%s: DSC timeout\n", drive->name);
1384 }
Bartlomiej Zolnierkiewicz2bc4cf22008-02-01 23:09:22 +01001385 info->cd_flags &= ~IDE_CD_FLAG_SEEKING;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001386 }
1387 if ((rq_data_dir(rq) == READ) && IDE_LARGE_SEEK(info->last_block, block, IDECD_SEEK_THRESHOLD) && drive->dsc_overlap) {
1388 action = cdrom_start_seek(drive, block);
Bartlomiej Zolnierkiewicz21ea1f02008-02-01 23:09:27 +01001389 } else
1390 action = cdrom_start_rw(drive, rq);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001391 info->last_block = block;
1392 return action;
Bartlomiej Zolnierkiewiczc9f56a82008-02-01 23:09:26 +01001393 } else if (blk_sense_request(rq) || blk_pc_request(rq) ||
Jens Axboecea28852006-10-12 15:08:45 +02001394 rq->cmd_type == REQ_TYPE_ATA_PC) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07001395 return cdrom_do_block_pc(drive, rq);
Jens Axboe4aff5e22006-08-10 08:44:47 +02001396 } else if (blk_special_request(rq)) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07001397 /*
1398 * right now this can only be a reset...
1399 */
1400 cdrom_end_request(drive, 1);
1401 return ide_stopped;
1402 }
1403
1404 blk_dump_rq_flags(rq, "ide-cd bad flags");
1405 cdrom_end_request(drive, 0);
1406 return ide_stopped;
1407}
1408
1409
1410
1411/****************************************************************************
1412 * Ioctl handling.
1413 *
1414 * Routines which queue packet commands take as a final argument a pointer
1415 * to a request_sense struct. If execution of the command results
1416 * in an error with a CHECK CONDITION status, this structure will be filled
1417 * with the results of the subsequent request sense command. The pointer
1418 * can also be NULL, in which case no sense information is returned.
1419 */
1420
Linus Torvalds1da177e2005-04-16 15:20:36 -07001421static
1422void msf_from_bcd (struct atapi_msf *msf)
1423{
Bartlomiej Zolnierkiewicz9a6dc662008-02-01 23:09:22 +01001424 msf->minute = BCD2BIN(msf->minute);
1425 msf->second = BCD2BIN(msf->second);
1426 msf->frame = BCD2BIN(msf->frame);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001427}
1428
Linus Torvalds1da177e2005-04-16 15:20:36 -07001429static int cdrom_check_status(ide_drive_t *drive, struct request_sense *sense)
1430{
1431 struct request req;
1432 struct cdrom_info *info = drive->driver_data;
1433 struct cdrom_device_info *cdi = &info->devinfo;
1434
Bartlomiej Zolnierkiewicz139c8292008-02-01 23:09:24 +01001435 ide_cd_init_rq(drive, &req);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001436
1437 req.sense = sense;
1438 req.cmd[0] = GPCMD_TEST_UNIT_READY;
Jens Axboe4aff5e22006-08-10 08:44:47 +02001439 req.cmd_flags |= REQ_QUIET;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001440
Bartlomiej Zolnierkiewiczcdf60002008-02-01 23:09:22 +01001441 /*
1442 * Sanyo 3 CD changer uses byte 7 of TEST_UNIT_READY to
1443 * switch CDs instead of supporting the LOAD_UNLOAD opcode.
1444 */
Linus Torvalds1da177e2005-04-16 15:20:36 -07001445 req.cmd[7] = cdi->sanyo_slot % 3;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001446
Bartlomiej Zolnierkiewicz139c8292008-02-01 23:09:24 +01001447 return ide_cd_queue_pc(drive, &req);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001448}
1449
Linus Torvalds1da177e2005-04-16 15:20:36 -07001450/* Lock the door if LOCKFLAG is nonzero; unlock it otherwise. */
Bartlomiej Zolnierkiewicz17802992008-02-01 23:09:25 +01001451int ide_cd_lockdoor(ide_drive_t *drive, int lockflag,
1452 struct request_sense *sense)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001453{
Bartlomiej Zolnierkiewicz4fe67172008-02-01 23:09:21 +01001454 struct cdrom_info *cd = drive->driver_data;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001455 struct request_sense my_sense;
1456 struct request req;
1457 int stat;
1458
1459 if (sense == NULL)
1460 sense = &my_sense;
1461
1462 /* If the drive cannot lock the door, just pretend. */
Bartlomiej Zolnierkiewicz2bc4cf22008-02-01 23:09:22 +01001463 if (cd->cd_flags & IDE_CD_FLAG_NO_DOORLOCK) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07001464 stat = 0;
1465 } else {
Bartlomiej Zolnierkiewicz139c8292008-02-01 23:09:24 +01001466 ide_cd_init_rq(drive, &req);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001467 req.sense = sense;
1468 req.cmd[0] = GPCMD_PREVENT_ALLOW_MEDIUM_REMOVAL;
1469 req.cmd[4] = lockflag ? 1 : 0;
Bartlomiej Zolnierkiewicz139c8292008-02-01 23:09:24 +01001470 stat = ide_cd_queue_pc(drive, &req);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001471 }
1472
1473 /* If we got an illegal field error, the drive
1474 probably cannot lock the door. */
1475 if (stat != 0 &&
1476 sense->sense_key == ILLEGAL_REQUEST &&
1477 (sense->asc == 0x24 || sense->asc == 0x20)) {
1478 printk (KERN_ERR "%s: door locking not supported\n",
1479 drive->name);
Bartlomiej Zolnierkiewicz2bc4cf22008-02-01 23:09:22 +01001480 cd->cd_flags |= IDE_CD_FLAG_NO_DOORLOCK;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001481 stat = 0;
1482 }
1483
1484 /* no medium, that's alright. */
1485 if (stat != 0 && sense->sense_key == NOT_READY && sense->asc == 0x3a)
1486 stat = 0;
1487
Bartlomiej Zolnierkiewicz2bc4cf22008-02-01 23:09:22 +01001488 if (stat == 0) {
1489 if (lockflag)
1490 cd->cd_flags |= IDE_CD_FLAG_DOOR_LOCKED;
1491 else
1492 cd->cd_flags &= ~IDE_CD_FLAG_DOOR_LOCKED;
1493 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001494
1495 return stat;
1496}
1497
1498
1499/* Eject the disk if EJECTFLAG is 0.
1500 If EJECTFLAG is 1, try to reload the disk. */
1501static int cdrom_eject(ide_drive_t *drive, int ejectflag,
1502 struct request_sense *sense)
1503{
Bartlomiej Zolnierkiewicz3f1b86d2008-02-01 23:09:20 +01001504 struct cdrom_info *cd = drive->driver_data;
1505 struct cdrom_device_info *cdi = &cd->devinfo;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001506 struct request req;
1507 char loej = 0x02;
1508
Bartlomiej Zolnierkiewicz2bc4cf22008-02-01 23:09:22 +01001509 if ((cd->cd_flags & IDE_CD_FLAG_NO_EJECT) && !ejectflag)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001510 return -EDRIVE_CANT_DO_THIS;
Bartlomiej Zolnierkiewicz4fe67172008-02-01 23:09:21 +01001511
Linus Torvalds1da177e2005-04-16 15:20:36 -07001512 /* reload fails on some drives, if the tray is locked */
Bartlomiej Zolnierkiewicz2bc4cf22008-02-01 23:09:22 +01001513 if ((cd->cd_flags & IDE_CD_FLAG_DOOR_LOCKED) && ejectflag)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001514 return 0;
1515
Bartlomiej Zolnierkiewicz139c8292008-02-01 23:09:24 +01001516 ide_cd_init_rq(drive, &req);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001517
1518 /* only tell drive to close tray if open, if it can do that */
Bartlomiej Zolnierkiewicz3f1b86d2008-02-01 23:09:20 +01001519 if (ejectflag && (cdi->mask & CDC_CLOSE_TRAY))
Linus Torvalds1da177e2005-04-16 15:20:36 -07001520 loej = 0;
1521
1522 req.sense = sense;
1523 req.cmd[0] = GPCMD_START_STOP_UNIT;
1524 req.cmd[4] = loej | (ejectflag != 0);
Bartlomiej Zolnierkiewicz139c8292008-02-01 23:09:24 +01001525
1526 return ide_cd_queue_pc(drive, &req);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001527}
1528
1529static int cdrom_read_capacity(ide_drive_t *drive, unsigned long *capacity,
1530 unsigned long *sectors_per_frame,
1531 struct request_sense *sense)
1532{
1533 struct {
1534 __u32 lba;
1535 __u32 blocklen;
1536 } capbuf;
1537
1538 int stat;
1539 struct request req;
1540
Bartlomiej Zolnierkiewicz139c8292008-02-01 23:09:24 +01001541 ide_cd_init_rq(drive, &req);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001542
1543 req.sense = sense;
1544 req.cmd[0] = GPCMD_READ_CDVD_CAPACITY;
1545 req.data = (char *)&capbuf;
1546 req.data_len = sizeof(capbuf);
Jens Axboe4aff5e22006-08-10 08:44:47 +02001547 req.cmd_flags |= REQ_QUIET;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001548
Bartlomiej Zolnierkiewicz139c8292008-02-01 23:09:24 +01001549 stat = ide_cd_queue_pc(drive, &req);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001550 if (stat == 0) {
1551 *capacity = 1 + be32_to_cpu(capbuf.lba);
1552 *sectors_per_frame =
1553 be32_to_cpu(capbuf.blocklen) >> SECTOR_BITS;
1554 }
1555
1556 return stat;
1557}
1558
1559static int cdrom_read_tocentry(ide_drive_t *drive, int trackno, int msf_flag,
1560 int format, char *buf, int buflen,
1561 struct request_sense *sense)
1562{
1563 struct request req;
1564
Bartlomiej Zolnierkiewicz139c8292008-02-01 23:09:24 +01001565 ide_cd_init_rq(drive, &req);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001566
1567 req.sense = sense;
1568 req.data = buf;
1569 req.data_len = buflen;
Jens Axboe4aff5e22006-08-10 08:44:47 +02001570 req.cmd_flags |= REQ_QUIET;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001571 req.cmd[0] = GPCMD_READ_TOC_PMA_ATIP;
1572 req.cmd[6] = trackno;
1573 req.cmd[7] = (buflen >> 8);
1574 req.cmd[8] = (buflen & 0xff);
1575 req.cmd[9] = (format << 6);
1576
1577 if (msf_flag)
1578 req.cmd[1] = 2;
1579
Bartlomiej Zolnierkiewicz139c8292008-02-01 23:09:24 +01001580 return ide_cd_queue_pc(drive, &req);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001581}
1582
Linus Torvalds1da177e2005-04-16 15:20:36 -07001583/* Try to read the entire TOC for the disk into our internal buffer. */
Bartlomiej Zolnierkiewicz17802992008-02-01 23:09:25 +01001584int ide_cd_read_toc(ide_drive_t *drive, struct request_sense *sense)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001585{
1586 int stat, ntracks, i;
1587 struct cdrom_info *info = drive->driver_data;
1588 struct cdrom_device_info *cdi = &info->devinfo;
1589 struct atapi_toc *toc = info->toc;
1590 struct {
1591 struct atapi_toc_header hdr;
1592 struct atapi_toc_entry ent;
1593 } ms_tmp;
1594 long last_written;
1595 unsigned long sectors_per_frame = SECTORS_PER_FRAME;
1596
1597 if (toc == NULL) {
1598 /* Try to allocate space. */
Jesper Juhl2a91f3e2005-10-30 15:02:45 -08001599 toc = kmalloc(sizeof(struct atapi_toc), GFP_KERNEL);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001600 if (toc == NULL) {
1601 printk (KERN_ERR "%s: No cdrom TOC buffer!\n", drive->name);
1602 return -ENOMEM;
1603 }
Jesper Juhl2a91f3e2005-10-30 15:02:45 -08001604 info->toc = toc;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001605 }
1606
1607 /* Check to see if the existing data is still valid.
1608 If it is, just return. */
1609 (void) cdrom_check_status(drive, sense);
1610
Bartlomiej Zolnierkiewicz2bc4cf22008-02-01 23:09:22 +01001611 if (info->cd_flags & IDE_CD_FLAG_TOC_VALID)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001612 return 0;
1613
1614 /* Try to get the total cdrom capacity and sector size. */
1615 stat = cdrom_read_capacity(drive, &toc->capacity, &sectors_per_frame,
1616 sense);
1617 if (stat)
1618 toc->capacity = 0x1fffff;
1619
1620 set_capacity(info->disk, toc->capacity * sectors_per_frame);
Alan Coxdbe217a2006-06-25 05:47:44 -07001621 /* Save a private copy of te TOC capacity for error handling */
1622 drive->probed_capacity = toc->capacity * sectors_per_frame;
1623
Linus Torvalds1da177e2005-04-16 15:20:36 -07001624 blk_queue_hardsect_size(drive->queue,
1625 sectors_per_frame << SECTOR_BITS);
1626
1627 /* First read just the header, so we know how long the TOC is. */
1628 stat = cdrom_read_tocentry(drive, 0, 1, 0, (char *) &toc->hdr,
1629 sizeof(struct atapi_toc_header), sense);
Jesper Juhl2a91f3e2005-10-30 15:02:45 -08001630 if (stat)
1631 return stat;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001632
Bartlomiej Zolnierkiewicz2bc4cf22008-02-01 23:09:22 +01001633 if (info->cd_flags & IDE_CD_FLAG_TOCTRACKS_AS_BCD) {
Bartlomiej Zolnierkiewicz9a6dc662008-02-01 23:09:22 +01001634 toc->hdr.first_track = BCD2BIN(toc->hdr.first_track);
1635 toc->hdr.last_track = BCD2BIN(toc->hdr.last_track);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001636 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001637
1638 ntracks = toc->hdr.last_track - toc->hdr.first_track + 1;
1639 if (ntracks <= 0)
1640 return -EIO;
1641 if (ntracks > MAX_TRACKS)
1642 ntracks = MAX_TRACKS;
1643
1644 /* Now read the whole schmeer. */
1645 stat = cdrom_read_tocentry(drive, toc->hdr.first_track, 1, 0,
1646 (char *)&toc->hdr,
1647 sizeof(struct atapi_toc_header) +
1648 (ntracks + 1) *
1649 sizeof(struct atapi_toc_entry), sense);
1650
1651 if (stat && toc->hdr.first_track > 1) {
1652 /* Cds with CDI tracks only don't have any TOC entries,
1653 despite of this the returned values are
1654 first_track == last_track = number of CDI tracks + 1,
1655 so that this case is indistinguishable from the same
1656 layout plus an additional audio track.
1657 If we get an error for the regular case, we assume
1658 a CDI without additional audio tracks. In this case
1659 the readable TOC is empty (CDI tracks are not included)
Jan Engelhardt96de0e22007-10-19 23:21:04 +02001660 and only holds the Leadout entry. Heiko Eißfeldt */
Linus Torvalds1da177e2005-04-16 15:20:36 -07001661 ntracks = 0;
1662 stat = cdrom_read_tocentry(drive, CDROM_LEADOUT, 1, 0,
1663 (char *)&toc->hdr,
1664 sizeof(struct atapi_toc_header) +
1665 (ntracks + 1) *
1666 sizeof(struct atapi_toc_entry),
1667 sense);
Bartlomiej Zolnierkiewiczcdf60002008-02-01 23:09:22 +01001668 if (stat)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001669 return stat;
Bartlomiej Zolnierkiewiczcdf60002008-02-01 23:09:22 +01001670
Bartlomiej Zolnierkiewicz2bc4cf22008-02-01 23:09:22 +01001671 if (info->cd_flags & IDE_CD_FLAG_TOCTRACKS_AS_BCD) {
Bartlomiej Zolnierkiewicz9a6dc662008-02-01 23:09:22 +01001672 toc->hdr.first_track = (u8)BIN2BCD(CDROM_LEADOUT);
1673 toc->hdr.last_track = (u8)BIN2BCD(CDROM_LEADOUT);
Bartlomiej Zolnierkiewiczcdf60002008-02-01 23:09:22 +01001674 } else {
Linus Torvalds1da177e2005-04-16 15:20:36 -07001675 toc->hdr.first_track = CDROM_LEADOUT;
1676 toc->hdr.last_track = CDROM_LEADOUT;
1677 }
1678 }
1679
1680 if (stat)
1681 return stat;
1682
1683 toc->hdr.toc_length = ntohs (toc->hdr.toc_length);
1684
Bartlomiej Zolnierkiewicz2bc4cf22008-02-01 23:09:22 +01001685 if (info->cd_flags & IDE_CD_FLAG_TOCTRACKS_AS_BCD) {
Bartlomiej Zolnierkiewicz9a6dc662008-02-01 23:09:22 +01001686 toc->hdr.first_track = BCD2BIN(toc->hdr.first_track);
1687 toc->hdr.last_track = BCD2BIN(toc->hdr.last_track);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001688 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001689
Bartlomiej Zolnierkiewiczcdf60002008-02-01 23:09:22 +01001690 for (i = 0; i <= ntracks; i++) {
Bartlomiej Zolnierkiewicz2bc4cf22008-02-01 23:09:22 +01001691 if (info->cd_flags & IDE_CD_FLAG_TOCADDR_AS_BCD) {
1692 if (info->cd_flags & IDE_CD_FLAG_TOCTRACKS_AS_BCD)
Bartlomiej Zolnierkiewicz9a6dc662008-02-01 23:09:22 +01001693 toc->ent[i].track = BCD2BIN(toc->ent[i].track);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001694 msf_from_bcd(&toc->ent[i].addr.msf);
1695 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001696 toc->ent[i].addr.lba = msf_to_lba (toc->ent[i].addr.msf.minute,
1697 toc->ent[i].addr.msf.second,
1698 toc->ent[i].addr.msf.frame);
1699 }
1700
1701 /* Read the multisession information. */
1702 if (toc->hdr.first_track != CDROM_LEADOUT) {
1703 /* Read the multisession information. */
1704 stat = cdrom_read_tocentry(drive, 0, 0, 1, (char *)&ms_tmp,
1705 sizeof(ms_tmp), sense);
Jesper Juhl2a91f3e2005-10-30 15:02:45 -08001706 if (stat)
1707 return stat;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001708
1709 toc->last_session_lba = be32_to_cpu(ms_tmp.ent.addr.lba);
1710 } else {
1711 ms_tmp.hdr.first_track = ms_tmp.hdr.last_track = CDROM_LEADOUT;
1712 toc->last_session_lba = msf_to_lba(0, 2, 0); /* 0m 2s 0f */
1713 }
1714
Bartlomiej Zolnierkiewicz2bc4cf22008-02-01 23:09:22 +01001715 if (info->cd_flags & IDE_CD_FLAG_TOCADDR_AS_BCD) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07001716 /* Re-read multisession information using MSF format */
1717 stat = cdrom_read_tocentry(drive, 0, 1, 1, (char *)&ms_tmp,
1718 sizeof(ms_tmp), sense);
1719 if (stat)
1720 return stat;
1721
1722 msf_from_bcd (&ms_tmp.ent.addr.msf);
1723 toc->last_session_lba = msf_to_lba(ms_tmp.ent.addr.msf.minute,
1724 ms_tmp.ent.addr.msf.second,
1725 ms_tmp.ent.addr.msf.frame);
1726 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001727
1728 toc->xa_flag = (ms_tmp.hdr.first_track != ms_tmp.hdr.last_track);
1729
1730 /* Now try to get the total cdrom capacity. */
1731 stat = cdrom_get_last_written(cdi, &last_written);
1732 if (!stat && (last_written > toc->capacity)) {
1733 toc->capacity = last_written;
1734 set_capacity(info->disk, toc->capacity * sectors_per_frame);
Alan Coxdbe217a2006-06-25 05:47:44 -07001735 drive->probed_capacity = toc->capacity * sectors_per_frame;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001736 }
1737
1738 /* Remember that we've read this stuff. */
Bartlomiej Zolnierkiewicz2bc4cf22008-02-01 23:09:22 +01001739 info->cd_flags |= IDE_CD_FLAG_TOC_VALID;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001740
1741 return 0;
1742}
1743
Linus Torvalds1da177e2005-04-16 15:20:36 -07001744/* the generic packet interface to cdrom.c */
1745static int ide_cdrom_packet(struct cdrom_device_info *cdi,
1746 struct packet_command *cgc)
1747{
1748 struct request req;
Jesper Juhl2a91f3e2005-10-30 15:02:45 -08001749 ide_drive_t *drive = cdi->handle;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001750
1751 if (cgc->timeout <= 0)
1752 cgc->timeout = ATAPI_WAIT_PC;
1753
1754 /* here we queue the commands from the uniform CD-ROM
1755 layer. the packet must be complete, as we do not
1756 touch it at all. */
Bartlomiej Zolnierkiewicz139c8292008-02-01 23:09:24 +01001757 ide_cd_init_rq(drive, &req);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001758 memcpy(req.cmd, cgc->cmd, CDROM_PACKET_SIZE);
1759 if (cgc->sense)
1760 memset(cgc->sense, 0, sizeof(struct request_sense));
1761 req.data = cgc->buffer;
1762 req.data_len = cgc->buflen;
1763 req.timeout = cgc->timeout;
1764
1765 if (cgc->quiet)
Jens Axboe4aff5e22006-08-10 08:44:47 +02001766 req.cmd_flags |= REQ_QUIET;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001767
1768 req.sense = cgc->sense;
Bartlomiej Zolnierkiewicz139c8292008-02-01 23:09:24 +01001769 cgc->stat = ide_cd_queue_pc(drive, &req);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001770 if (!cgc->stat)
1771 cgc->buflen -= req.data_len;
1772 return cgc->stat;
1773}
1774
Linus Torvalds1da177e2005-04-16 15:20:36 -07001775static
1776int ide_cdrom_tray_move (struct cdrom_device_info *cdi, int position)
1777{
Jesper Juhl2a91f3e2005-10-30 15:02:45 -08001778 ide_drive_t *drive = cdi->handle;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001779 struct request_sense sense;
1780
1781 if (position) {
Bartlomiej Zolnierkiewicz139c8292008-02-01 23:09:24 +01001782 int stat = ide_cd_lockdoor(drive, 0, &sense);
1783
Jesper Juhl2a91f3e2005-10-30 15:02:45 -08001784 if (stat)
1785 return stat;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001786 }
1787
1788 return cdrom_eject(drive, !position, &sense);
1789}
1790
Bartlomiej Zolnierkiewicz17802992008-02-01 23:09:25 +01001791int ide_cdrom_get_capabilities(ide_drive_t *drive, u8 *buf)
Eric Piel9235e682005-06-23 00:10:29 -07001792{
1793 struct cdrom_info *info = drive->driver_data;
1794 struct cdrom_device_info *cdi = &info->devinfo;
1795 struct packet_command cgc;
Bartlomiej Zolnierkiewicz455d80a2008-02-01 23:09:21 +01001796 int stat, attempts = 3, size = ATAPI_CAPABILITIES_PAGE_SIZE;
Eric Piel9235e682005-06-23 00:10:29 -07001797
Bartlomiej Zolnierkiewicze59724c2008-02-01 23:09:22 +01001798 if ((info->cd_flags & IDE_CD_FLAG_FULL_CAPS_PAGE) == 0)
Bartlomiej Zolnierkiewicz455d80a2008-02-01 23:09:21 +01001799 size -= ATAPI_CAPABILITIES_PAGE_PAD_SIZE;
Eric Piel9235e682005-06-23 00:10:29 -07001800
Bartlomiej Zolnierkiewicz455d80a2008-02-01 23:09:21 +01001801 init_cdrom_command(&cgc, buf, size, CGC_DATA_UNKNOWN);
Eric Piel9235e682005-06-23 00:10:29 -07001802 do { /* we seem to get stat=0x01,err=0x00 the first time (??) */
1803 stat = cdrom_mode_sense(cdi, &cgc, GPMODE_CAPABILITIES_PAGE, 0);
1804 if (!stat)
1805 break;
1806 } while (--attempts);
1807 return stat;
1808}
1809
Bartlomiej Zolnierkiewicz17802992008-02-01 23:09:25 +01001810void ide_cdrom_update_speed(ide_drive_t *drive, u8 *buf)
Eric Piel9235e682005-06-23 00:10:29 -07001811{
Bartlomiej Zolnierkiewicz4fe67172008-02-01 23:09:21 +01001812 struct cdrom_info *cd = drive->driver_data;
Bartlomiej Zolnierkiewicz481c8c62008-02-01 23:09:20 +01001813 u16 curspeed, maxspeed;
1814
Bartlomiej Zolnierkiewicz455d80a2008-02-01 23:09:21 +01001815 curspeed = *(u16 *)&buf[8 + 14];
1816 maxspeed = *(u16 *)&buf[8 + 8];
1817
Bartlomiej Zolnierkiewicze59724c2008-02-01 23:09:22 +01001818 if (cd->cd_flags & IDE_CD_FLAG_LE_SPEED_FIELDS) {
Bartlomiej Zolnierkiewicz455d80a2008-02-01 23:09:21 +01001819 curspeed = le16_to_cpu(curspeed);
1820 maxspeed = le16_to_cpu(maxspeed);
Eric Piel9235e682005-06-23 00:10:29 -07001821 } else {
Bartlomiej Zolnierkiewicz455d80a2008-02-01 23:09:21 +01001822 curspeed = be16_to_cpu(curspeed);
1823 maxspeed = be16_to_cpu(maxspeed);
Eric Piel9235e682005-06-23 00:10:29 -07001824 }
Bartlomiej Zolnierkiewicz481c8c62008-02-01 23:09:20 +01001825
Bartlomiej Zolnierkiewicz2bc4cf22008-02-01 23:09:22 +01001826 cd->current_speed = (curspeed + (176/2)) / 176;
1827 cd->max_speed = (maxspeed + (176/2)) / 176;
Eric Piel9235e682005-06-23 00:10:29 -07001828}
1829
Bartlomiej Zolnierkiewicz5c684292008-02-01 23:09:24 +01001830/*
Linus Torvalds1da177e2005-04-16 15:20:36 -07001831 * add logic to try GET_EVENT command first to check for media and tray
1832 * status. this should be supported by newer cd-r/w and all DVD etc
1833 * drives
1834 */
1835static
1836int ide_cdrom_drive_status (struct cdrom_device_info *cdi, int slot_nr)
1837{
Jesper Juhl2a91f3e2005-10-30 15:02:45 -08001838 ide_drive_t *drive = cdi->handle;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001839 struct media_event_desc med;
1840 struct request_sense sense;
1841 int stat;
1842
1843 if (slot_nr != CDSL_CURRENT)
1844 return -EINVAL;
1845
1846 stat = cdrom_check_status(drive, &sense);
1847 if (!stat || sense.sense_key == UNIT_ATTENTION)
1848 return CDS_DISC_OK;
1849
1850 if (!cdrom_get_media_event(cdi, &med)) {
1851 if (med.media_present)
1852 return CDS_DISC_OK;
1853 else if (med.door_open)
1854 return CDS_TRAY_OPEN;
1855 else
1856 return CDS_NO_DISC;
1857 }
1858
1859 if (sense.sense_key == NOT_READY && sense.asc == 0x04 && sense.ascq == 0x04)
1860 return CDS_DISC_OK;
1861
1862 /*
1863 * If not using Mt Fuji extended media tray reports,
1864 * just return TRAY_OPEN since ATAPI doesn't provide
1865 * any other way to detect this...
1866 */
1867 if (sense.sense_key == NOT_READY) {
Alan Coxdbe217a2006-06-25 05:47:44 -07001868 if (sense.asc == 0x3a && sense.ascq == 1)
1869 return CDS_NO_DISC;
1870 else
1871 return CDS_TRAY_OPEN;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001872 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001873 return CDS_DRIVE_NOT_READY;
1874}
1875
Linus Torvalds1da177e2005-04-16 15:20:36 -07001876/****************************************************************************
1877 * Other driver requests (open, close, check media change).
1878 */
1879
1880static
1881int ide_cdrom_check_media_change_real (struct cdrom_device_info *cdi,
1882 int slot_nr)
1883{
Jesper Juhl2a91f3e2005-10-30 15:02:45 -08001884 ide_drive_t *drive = cdi->handle;
Bartlomiej Zolnierkiewicz0ba11212008-02-01 23:09:21 +01001885 struct cdrom_info *cd = drive->driver_data;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001886 int retval;
Bartlomiej Zolnierkiewicz0ba11212008-02-01 23:09:21 +01001887
Linus Torvalds1da177e2005-04-16 15:20:36 -07001888 if (slot_nr == CDSL_CURRENT) {
1889 (void) cdrom_check_status(drive, NULL);
Bartlomiej Zolnierkiewicz2bc4cf22008-02-01 23:09:22 +01001890 retval = (cd->cd_flags & IDE_CD_FLAG_MEDIA_CHANGED) ? 1 : 0;
1891 cd->cd_flags &= ~IDE_CD_FLAG_MEDIA_CHANGED;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001892 return retval;
1893 } else {
1894 return -EINVAL;
1895 }
1896}
1897
1898
1899static
1900int ide_cdrom_open_real (struct cdrom_device_info *cdi, int purpose)
1901{
1902 return 0;
1903}
1904
1905/*
1906 * Close down the device. Invalidate all cached blocks.
1907 */
1908
1909static
1910void ide_cdrom_release_real (struct cdrom_device_info *cdi)
1911{
1912 ide_drive_t *drive = cdi->handle;
Bartlomiej Zolnierkiewicz0ba11212008-02-01 23:09:21 +01001913 struct cdrom_info *cd = drive->driver_data;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001914
1915 if (!cdi->use_count)
Bartlomiej Zolnierkiewicz2bc4cf22008-02-01 23:09:22 +01001916 cd->cd_flags &= ~IDE_CD_FLAG_TOC_VALID;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001917}
1918
Bartlomiej Zolnierkiewicz20e7f7e2008-02-01 23:09:20 +01001919#define IDE_CD_CAPABILITIES \
1920 (CDC_CLOSE_TRAY | CDC_OPEN_TRAY | CDC_LOCK | CDC_SELECT_SPEED | \
1921 CDC_SELECT_DISC | CDC_MULTI_SESSION | CDC_MCN | CDC_MEDIA_CHANGED | \
1922 CDC_PLAY_AUDIO | CDC_RESET | CDC_DRIVE_STATUS | CDC_CD_R | \
1923 CDC_CD_RW | CDC_DVD | CDC_DVD_R | CDC_DVD_RAM | CDC_GENERIC_PACKET | \
1924 CDC_MO_DRIVE | CDC_MRW | CDC_MRW_W | CDC_RAM)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001925
Linus Torvalds1da177e2005-04-16 15:20:36 -07001926static struct cdrom_device_ops ide_cdrom_dops = {
1927 .open = ide_cdrom_open_real,
1928 .release = ide_cdrom_release_real,
1929 .drive_status = ide_cdrom_drive_status,
1930 .media_changed = ide_cdrom_check_media_change_real,
1931 .tray_move = ide_cdrom_tray_move,
1932 .lock_door = ide_cdrom_lock_door,
1933 .select_speed = ide_cdrom_select_speed,
1934 .get_last_session = ide_cdrom_get_last_session,
1935 .get_mcn = ide_cdrom_get_mcn,
1936 .reset = ide_cdrom_reset,
1937 .audio_ioctl = ide_cdrom_audio_ioctl,
Bartlomiej Zolnierkiewicz20e7f7e2008-02-01 23:09:20 +01001938 .capability = IDE_CD_CAPABILITIES,
Linus Torvalds1da177e2005-04-16 15:20:36 -07001939 .generic_packet = ide_cdrom_packet,
1940};
1941
1942static int ide_cdrom_register (ide_drive_t *drive, int nslots)
1943{
1944 struct cdrom_info *info = drive->driver_data;
1945 struct cdrom_device_info *devinfo = &info->devinfo;
1946
1947 devinfo->ops = &ide_cdrom_dops;
Bartlomiej Zolnierkiewicz2bc4cf22008-02-01 23:09:22 +01001948 devinfo->speed = info->current_speed;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001949 devinfo->capacity = nslots;
Jesper Juhl2a91f3e2005-10-30 15:02:45 -08001950 devinfo->handle = drive;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001951 strcpy(devinfo->name, drive->name);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001952
Bartlomiej Zolnierkiewicz2bc4cf22008-02-01 23:09:22 +01001953 if (info->cd_flags & IDE_CD_FLAG_NO_SPEED_SELECT)
Bartlomiej Zolnierkiewicz3cbd8142007-12-24 15:23:43 +01001954 devinfo->mask |= CDC_SELECT_SPEED;
1955
Linus Torvalds1da177e2005-04-16 15:20:36 -07001956 devinfo->disk = info->disk;
1957 return register_cdrom(devinfo);
1958}
1959
1960static
Linus Torvalds1da177e2005-04-16 15:20:36 -07001961int ide_cdrom_probe_capabilities (ide_drive_t *drive)
1962{
Bartlomiej Zolnierkiewicz4fe67172008-02-01 23:09:21 +01001963 struct cdrom_info *cd = drive->driver_data;
1964 struct cdrom_device_info *cdi = &cd->devinfo;
Bartlomiej Zolnierkiewicz455d80a2008-02-01 23:09:21 +01001965 u8 buf[ATAPI_CAPABILITIES_PAGE_SIZE];
1966 mechtype_t mechtype;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001967 int nslots = 1;
1968
Bartlomiej Zolnierkiewicz3f1b86d2008-02-01 23:09:20 +01001969 cdi->mask = (CDC_CD_R | CDC_CD_RW | CDC_DVD | CDC_DVD_R |
1970 CDC_DVD_RAM | CDC_SELECT_DISC | CDC_PLAY_AUDIO |
1971 CDC_MO_DRIVE | CDC_RAM);
1972
Linus Torvalds1da177e2005-04-16 15:20:36 -07001973 if (drive->media == ide_optical) {
Bartlomiej Zolnierkiewicz3f1b86d2008-02-01 23:09:20 +01001974 cdi->mask &= ~(CDC_MO_DRIVE | CDC_RAM);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001975 printk(KERN_ERR "%s: ATAPI magneto-optical drive\n", drive->name);
1976 return nslots;
1977 }
1978
Bartlomiej Zolnierkiewicze59724c2008-02-01 23:09:22 +01001979 if (cd->cd_flags & IDE_CD_FLAG_PRE_ATAPI12) {
Bartlomiej Zolnierkiewicz2bc4cf22008-02-01 23:09:22 +01001980 cd->cd_flags &= ~IDE_CD_FLAG_NO_EJECT;
Bartlomiej Zolnierkiewicz3f1b86d2008-02-01 23:09:20 +01001981 cdi->mask &= ~CDC_PLAY_AUDIO;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001982 return nslots;
1983 }
1984
1985 /*
1986 * we have to cheat a little here. the packet will eventually
1987 * be queued with ide_cdrom_packet(), which extracts the
1988 * drive from cdi->handle. Since this device hasn't been
1989 * registered with the Uniform layer yet, it can't do this.
1990 * Same goes for cdi->ops.
1991 */
Jesper Juhl2a91f3e2005-10-30 15:02:45 -08001992 cdi->handle = drive;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001993 cdi->ops = &ide_cdrom_dops;
1994
Bartlomiej Zolnierkiewicz455d80a2008-02-01 23:09:21 +01001995 if (ide_cdrom_get_capabilities(drive, buf))
Linus Torvalds1da177e2005-04-16 15:20:36 -07001996 return 0;
1997
Bartlomiej Zolnierkiewicz455d80a2008-02-01 23:09:21 +01001998 if ((buf[8 + 6] & 0x01) == 0)
Bartlomiej Zolnierkiewicz2bc4cf22008-02-01 23:09:22 +01001999 cd->cd_flags |= IDE_CD_FLAG_NO_DOORLOCK;
Bartlomiej Zolnierkiewicz455d80a2008-02-01 23:09:21 +01002000 if (buf[8 + 6] & 0x08)
Bartlomiej Zolnierkiewicz2bc4cf22008-02-01 23:09:22 +01002001 cd->cd_flags &= ~IDE_CD_FLAG_NO_EJECT;
Bartlomiej Zolnierkiewicz455d80a2008-02-01 23:09:21 +01002002 if (buf[8 + 3] & 0x01)
Bartlomiej Zolnierkiewicz3f1b86d2008-02-01 23:09:20 +01002003 cdi->mask &= ~CDC_CD_R;
Bartlomiej Zolnierkiewicz455d80a2008-02-01 23:09:21 +01002004 if (buf[8 + 3] & 0x02)
Bartlomiej Zolnierkiewicz3f1b86d2008-02-01 23:09:20 +01002005 cdi->mask &= ~(CDC_CD_RW | CDC_RAM);
Bartlomiej Zolnierkiewicz455d80a2008-02-01 23:09:21 +01002006 if (buf[8 + 2] & 0x38)
Bartlomiej Zolnierkiewicz3f1b86d2008-02-01 23:09:20 +01002007 cdi->mask &= ~CDC_DVD;
Bartlomiej Zolnierkiewicz455d80a2008-02-01 23:09:21 +01002008 if (buf[8 + 3] & 0x20)
Bartlomiej Zolnierkiewicz3f1b86d2008-02-01 23:09:20 +01002009 cdi->mask &= ~(CDC_DVD_RAM | CDC_RAM);
Bartlomiej Zolnierkiewicz455d80a2008-02-01 23:09:21 +01002010 if (buf[8 + 3] & 0x10)
Bartlomiej Zolnierkiewicz3f1b86d2008-02-01 23:09:20 +01002011 cdi->mask &= ~CDC_DVD_R;
Bartlomiej Zolnierkiewicze59724c2008-02-01 23:09:22 +01002012 if ((buf[8 + 4] & 0x01) || (cd->cd_flags & IDE_CD_FLAG_PLAY_AUDIO_OK))
Bartlomiej Zolnierkiewicz3f1b86d2008-02-01 23:09:20 +01002013 cdi->mask &= ~CDC_PLAY_AUDIO;
Bartlomiej Zolnierkiewicz455d80a2008-02-01 23:09:21 +01002014
2015 mechtype = buf[8 + 6] >> 5;
2016 if (mechtype == mechtype_caddy || mechtype == mechtype_popup)
Bartlomiej Zolnierkiewicz3f1b86d2008-02-01 23:09:20 +01002017 cdi->mask |= CDC_CLOSE_TRAY;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002018
Linus Torvalds1da177e2005-04-16 15:20:36 -07002019 if (cdi->sanyo_slot > 0) {
Bartlomiej Zolnierkiewicz3f1b86d2008-02-01 23:09:20 +01002020 cdi->mask &= ~CDC_SELECT_DISC;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002021 nslots = 3;
Bartlomiej Zolnierkiewiczcdf60002008-02-01 23:09:22 +01002022 } else if (mechtype == mechtype_individual_changer ||
2023 mechtype == mechtype_cartridge_changer) {
Bartlomiej Zolnierkiewicz2609d062008-02-01 23:09:19 +01002024 nslots = cdrom_number_of_slots(cdi);
2025 if (nslots > 1)
Bartlomiej Zolnierkiewicz3f1b86d2008-02-01 23:09:20 +01002026 cdi->mask &= ~CDC_SELECT_DISC;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002027 }
2028
Bartlomiej Zolnierkiewicz455d80a2008-02-01 23:09:21 +01002029 ide_cdrom_update_speed(drive, buf);
Bartlomiej Zolnierkiewicz4fe67172008-02-01 23:09:21 +01002030
Linus Torvalds1da177e2005-04-16 15:20:36 -07002031 printk(KERN_INFO "%s: ATAPI", drive->name);
Bartlomiej Zolnierkiewicz4fe67172008-02-01 23:09:21 +01002032
2033 /* don't print speed if the drive reported 0 */
Bartlomiej Zolnierkiewicz2bc4cf22008-02-01 23:09:22 +01002034 if (cd->max_speed)
2035 printk(KERN_CONT " %dX", cd->max_speed);
Bartlomiej Zolnierkiewicz4fe67172008-02-01 23:09:21 +01002036
Bartlomiej Zolnierkiewicz3f1b86d2008-02-01 23:09:20 +01002037 printk(KERN_CONT " %s", (cdi->mask & CDC_DVD) ? "CD-ROM" : "DVD-ROM");
Linus Torvalds1da177e2005-04-16 15:20:36 -07002038
Bartlomiej Zolnierkiewicz3f1b86d2008-02-01 23:09:20 +01002039 if ((cdi->mask & CDC_DVD_R) == 0 || (cdi->mask & CDC_DVD_RAM) == 0)
2040 printk(KERN_CONT " DVD%s%s",
2041 (cdi->mask & CDC_DVD_R) ? "" : "-R",
2042 (cdi->mask & CDC_DVD_RAM) ? "" : "-RAM");
Linus Torvalds1da177e2005-04-16 15:20:36 -07002043
Bartlomiej Zolnierkiewicz3f1b86d2008-02-01 23:09:20 +01002044 if ((cdi->mask & CDC_CD_R) == 0 || (cdi->mask & CDC_CD_RW) == 0)
2045 printk(KERN_CONT " CD%s%s",
2046 (cdi->mask & CDC_CD_R) ? "" : "-R",
2047 (cdi->mask & CDC_CD_RW) ? "" : "/RW");
Linus Torvalds1da177e2005-04-16 15:20:36 -07002048
Bartlomiej Zolnierkiewicz3f1b86d2008-02-01 23:09:20 +01002049 if ((cdi->mask & CDC_SELECT_DISC) == 0)
2050 printk(KERN_CONT " changer w/%d slots", nslots);
2051 else
2052 printk(KERN_CONT " drive");
Linus Torvalds1da177e2005-04-16 15:20:36 -07002053
Bartlomiej Zolnierkiewicz455d80a2008-02-01 23:09:21 +01002054 printk(KERN_CONT ", %dkB Cache\n", be16_to_cpu(*(u16 *)&buf[8 + 12]));
Linus Torvalds1da177e2005-04-16 15:20:36 -07002055
2056 return nslots;
2057}
2058
Bartlomiej Zolnierkiewicz7662d042007-05-10 00:01:10 +02002059#ifdef CONFIG_IDE_PROC_FS
Linus Torvalds1da177e2005-04-16 15:20:36 -07002060static void ide_cdrom_add_settings(ide_drive_t *drive)
2061{
Bartlomiej Zolnierkiewicz14979432007-05-10 00:01:10 +02002062 ide_add_setting(drive, "dsc_overlap", SETTING_RW, TYPE_BYTE, 0, 1, 1, 1, &drive->dsc_overlap, NULL);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002063}
Bartlomiej Zolnierkiewicz7662d042007-05-10 00:01:10 +02002064#else
2065static inline void ide_cdrom_add_settings(ide_drive_t *drive) { ; }
2066#endif
Linus Torvalds1da177e2005-04-16 15:20:36 -07002067
2068/*
2069 * standard prep_rq_fn that builds 10 byte cmds
2070 */
Jens Axboe165125e2007-07-24 09:28:11 +02002071static int ide_cdrom_prep_fs(struct request_queue *q, struct request *rq)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002072{
2073 int hard_sect = queue_hardsect_size(q);
2074 long block = (long)rq->hard_sector / (hard_sect >> 9);
2075 unsigned long blocks = rq->hard_nr_sectors / (hard_sect >> 9);
2076
2077 memset(rq->cmd, 0, sizeof(rq->cmd));
2078
2079 if (rq_data_dir(rq) == READ)
2080 rq->cmd[0] = GPCMD_READ_10;
2081 else
2082 rq->cmd[0] = GPCMD_WRITE_10;
2083
2084 /*
2085 * fill in lba
2086 */
2087 rq->cmd[2] = (block >> 24) & 0xff;
2088 rq->cmd[3] = (block >> 16) & 0xff;
2089 rq->cmd[4] = (block >> 8) & 0xff;
2090 rq->cmd[5] = block & 0xff;
2091
2092 /*
2093 * and transfer length
2094 */
2095 rq->cmd[7] = (blocks >> 8) & 0xff;
2096 rq->cmd[8] = blocks & 0xff;
2097 rq->cmd_len = 10;
2098 return BLKPREP_OK;
2099}
2100
2101/*
2102 * Most of the SCSI commands are supported directly by ATAPI devices.
2103 * This transform handles the few exceptions.
2104 */
2105static int ide_cdrom_prep_pc(struct request *rq)
2106{
2107 u8 *c = rq->cmd;
2108
2109 /*
2110 * Transform 6-byte read/write commands to the 10-byte version
2111 */
2112 if (c[0] == READ_6 || c[0] == WRITE_6) {
2113 c[8] = c[4];
2114 c[5] = c[3];
2115 c[4] = c[2];
2116 c[3] = c[1] & 0x1f;
2117 c[2] = 0;
2118 c[1] &= 0xe0;
2119 c[0] += (READ_10 - READ_6);
2120 rq->cmd_len = 10;
2121 return BLKPREP_OK;
2122 }
2123
2124 /*
2125 * it's silly to pretend we understand 6-byte sense commands, just
2126 * reject with ILLEGAL_REQUEST and the caller should take the
2127 * appropriate action
2128 */
2129 if (c[0] == MODE_SENSE || c[0] == MODE_SELECT) {
2130 rq->errors = ILLEGAL_REQUEST;
2131 return BLKPREP_KILL;
2132 }
2133
2134 return BLKPREP_OK;
2135}
2136
Jens Axboe165125e2007-07-24 09:28:11 +02002137static int ide_cdrom_prep_fn(struct request_queue *q, struct request *rq)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002138{
Jens Axboe4aff5e22006-08-10 08:44:47 +02002139 if (blk_fs_request(rq))
Linus Torvalds1da177e2005-04-16 15:20:36 -07002140 return ide_cdrom_prep_fs(q, rq);
Jens Axboe4aff5e22006-08-10 08:44:47 +02002141 else if (blk_pc_request(rq))
Linus Torvalds1da177e2005-04-16 15:20:36 -07002142 return ide_cdrom_prep_pc(rq);
2143
2144 return 0;
2145}
2146
Bartlomiej Zolnierkiewicze59724c2008-02-01 23:09:22 +01002147struct cd_list_entry {
2148 const char *id_model;
2149 const char *id_firmware;
2150 unsigned int cd_flags;
2151};
2152
2153static const struct cd_list_entry ide_cd_quirks_list[] = {
2154 /* Limit transfer size per interrupt. */
2155 { "SAMSUNG CD-ROM SCR-2430", NULL, IDE_CD_FLAG_LIMIT_NFRAMES },
2156 { "SAMSUNG CD-ROM SCR-2432", NULL, IDE_CD_FLAG_LIMIT_NFRAMES },
2157 /* SCR-3231 doesn't support the SET_CD_SPEED command. */
2158 { "SAMSUNG CD-ROM SCR-3231", NULL, IDE_CD_FLAG_NO_SPEED_SELECT },
2159 /* Old NEC260 (not R) was released before ATAPI 1.2 spec. */
2160 { "NEC CD-ROM DRIVE:260", "1.01", IDE_CD_FLAG_TOCADDR_AS_BCD |
2161 IDE_CD_FLAG_PRE_ATAPI12, },
2162 /* Vertos 300, some versions of this drive like to talk BCD. */
2163 { "V003S0DS", NULL, IDE_CD_FLAG_VERTOS_300_SSD, },
2164 /* Vertos 600 ESD. */
2165 { "V006E0DS", NULL, IDE_CD_FLAG_VERTOS_600_ESD, },
2166 /*
2167 * Sanyo 3 CD changer uses a non-standard command for CD changing
2168 * (by default standard ATAPI support for CD changers is used).
2169 */
2170 { "CD-ROM CDR-C3 G", NULL, IDE_CD_FLAG_SANYO_3CD },
2171 { "CD-ROM CDR-C3G", NULL, IDE_CD_FLAG_SANYO_3CD },
2172 { "CD-ROM CDR_C36", NULL, IDE_CD_FLAG_SANYO_3CD },
2173 /* Stingray 8X CD-ROM. */
2174 { "STINGRAY 8422 IDE 8X CD-ROM 7-27-95", NULL, IDE_CD_FLAG_PRE_ATAPI12},
2175 /*
2176 * ACER 50X CD-ROM and WPI 32X CD-ROM require the full spec length
2177 * mode sense page capabilities size, but older drives break.
2178 */
2179 { "ATAPI CD ROM DRIVE 50X MAX", NULL, IDE_CD_FLAG_FULL_CAPS_PAGE },
2180 { "WPI CDS-32X", NULL, IDE_CD_FLAG_FULL_CAPS_PAGE },
2181 /* ACER/AOpen 24X CD-ROM has the speed fields byte-swapped. */
2182 { "", "241N", IDE_CD_FLAG_LE_SPEED_FIELDS },
2183 /*
2184 * Some drives used by Apple don't advertise audio play
2185 * but they do support reading TOC & audio datas.
2186 */
2187 { "MATSHITADVD-ROM SR-8187", NULL, IDE_CD_FLAG_PLAY_AUDIO_OK },
2188 { "MATSHITADVD-ROM SR-8186", NULL, IDE_CD_FLAG_PLAY_AUDIO_OK },
2189 { "MATSHITADVD-ROM SR-8176", NULL, IDE_CD_FLAG_PLAY_AUDIO_OK },
2190 { "MATSHITADVD-ROM SR-8174", NULL, IDE_CD_FLAG_PLAY_AUDIO_OK },
2191 { NULL, NULL, 0 }
2192};
2193
2194static unsigned int ide_cd_flags(struct hd_driveid *id)
2195{
2196 const struct cd_list_entry *cle = ide_cd_quirks_list;
2197
2198 while (cle->id_model) {
2199 if (strcmp(cle->id_model, id->model) == 0 &&
2200 (cle->id_firmware == NULL ||
2201 strstr(id->fw_rev, cle->id_firmware)))
2202 return cle->cd_flags;
2203 cle++;
2204 }
2205
2206 return 0;
2207}
2208
Linus Torvalds1da177e2005-04-16 15:20:36 -07002209static
2210int ide_cdrom_setup (ide_drive_t *drive)
2211{
Bartlomiej Zolnierkiewicz4fe67172008-02-01 23:09:21 +01002212 struct cdrom_info *cd = drive->driver_data;
2213 struct cdrom_device_info *cdi = &cd->devinfo;
Bartlomiej Zolnierkiewicze59724c2008-02-01 23:09:22 +01002214 struct hd_driveid *id = drive->id;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002215 int nslots;
2216
2217 blk_queue_prep_rq(drive->queue, ide_cdrom_prep_fn);
2218 blk_queue_dma_alignment(drive->queue, 31);
2219 drive->queue->unplug_delay = (1 * HZ) / 1000;
2220 if (!drive->queue->unplug_delay)
2221 drive->queue->unplug_delay = 1;
2222
2223 drive->special.all = 0;
2224
Bartlomiej Zolnierkiewicze59724c2008-02-01 23:09:22 +01002225 cd->cd_flags = IDE_CD_FLAG_MEDIA_CHANGED | IDE_CD_FLAG_NO_EJECT |
2226 ide_cd_flags(id);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002227
Bartlomiej Zolnierkiewicze59724c2008-02-01 23:09:22 +01002228 if ((id->config & 0x0060) == 0x20)
Bartlomiej Zolnierkiewicz2bc4cf22008-02-01 23:09:22 +01002229 cd->cd_flags |= IDE_CD_FLAG_DRQ_INTERRUPT;
Bartlomiej Zolnierkiewiczb8d25de2008-02-01 23:09:19 +01002230
Bartlomiej Zolnierkiewicze59724c2008-02-01 23:09:22 +01002231 if ((cd->cd_flags & IDE_CD_FLAG_VERTOS_300_SSD) &&
2232 id->fw_rev[4] == '1' && id->fw_rev[6] <= '2')
Bartlomiej Zolnierkiewicz2bc4cf22008-02-01 23:09:22 +01002233 cd->cd_flags |= (IDE_CD_FLAG_TOCTRACKS_AS_BCD |
2234 IDE_CD_FLAG_TOCADDR_AS_BCD);
Bartlomiej Zolnierkiewicze59724c2008-02-01 23:09:22 +01002235 else if ((cd->cd_flags & IDE_CD_FLAG_VERTOS_600_ESD) &&
2236 id->fw_rev[4] == '1' && id->fw_rev[6] <= '2')
Bartlomiej Zolnierkiewicz2bc4cf22008-02-01 23:09:22 +01002237 cd->cd_flags |= IDE_CD_FLAG_TOCTRACKS_AS_BCD;
Bartlomiej Zolnierkiewicze59724c2008-02-01 23:09:22 +01002238 else if (cd->cd_flags & IDE_CD_FLAG_SANYO_3CD)
2239 cdi->sanyo_slot = 3; /* 3 => use CD in slot 0 */
Linus Torvalds1da177e2005-04-16 15:20:36 -07002240
Linus Torvalds1da177e2005-04-16 15:20:36 -07002241 nslots = ide_cdrom_probe_capabilities (drive);
2242
2243 /*
2244 * set correct block size
2245 */
2246 blk_queue_hardsect_size(drive->queue, CD_FRAMESIZE);
2247
2248 if (drive->autotune == IDE_TUNE_DEFAULT ||
2249 drive->autotune == IDE_TUNE_AUTO)
2250 drive->dsc_overlap = (drive->next != drive);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002251
2252 if (ide_cdrom_register(drive, nslots)) {
2253 printk (KERN_ERR "%s: ide_cdrom_setup failed to register device with the cdrom driver.\n", drive->name);
Bartlomiej Zolnierkiewicz4fe67172008-02-01 23:09:21 +01002254 cd->devinfo.handle = NULL;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002255 return 1;
2256 }
2257 ide_cdrom_add_settings(drive);
2258 return 0;
2259}
2260
Bartlomiej Zolnierkiewiczecfd80e2007-05-10 00:01:09 +02002261#ifdef CONFIG_IDE_PROC_FS
Linus Torvalds1da177e2005-04-16 15:20:36 -07002262static
2263sector_t ide_cdrom_capacity (ide_drive_t *drive)
2264{
2265 unsigned long capacity, sectors_per_frame;
2266
2267 if (cdrom_read_capacity(drive, &capacity, &sectors_per_frame, NULL))
2268 return 0;
2269
2270 return capacity * sectors_per_frame;
2271}
Amos Waterlandd97b32142005-10-30 15:02:10 -08002272#endif
Linus Torvalds1da177e2005-04-16 15:20:36 -07002273
Russell King4031bbe2006-01-06 11:41:00 +00002274static void ide_cd_remove(ide_drive_t *drive)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002275{
2276 struct cdrom_info *info = drive->driver_data;
2277
Bartlomiej Zolnierkiewicz7662d042007-05-10 00:01:10 +02002278 ide_proc_unregister_driver(drive, info->driver);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002279
2280 del_gendisk(info->disk);
2281
2282 ide_cd_put(info);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002283}
2284
2285static void ide_cd_release(struct kref *kref)
2286{
2287 struct cdrom_info *info = to_ide_cd(kref);
2288 struct cdrom_device_info *devinfo = &info->devinfo;
2289 ide_drive_t *drive = info->drive;
2290 struct gendisk *g = info->disk;
2291
Jesper Juhl6044ec82005-11-07 01:01:32 -08002292 kfree(info->buffer);
2293 kfree(info->toc);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002294 if (devinfo->handle == drive && unregister_cdrom(devinfo))
2295 printk(KERN_ERR "%s: %s failed to unregister device from the cdrom "
2296 "driver.\n", __FUNCTION__, drive->name);
2297 drive->dsc_overlap = 0;
2298 drive->driver_data = NULL;
2299 blk_queue_prep_rq(drive->queue, NULL);
2300 g->private_data = NULL;
2301 put_disk(g);
2302 kfree(info);
2303}
2304
Russell King4031bbe2006-01-06 11:41:00 +00002305static int ide_cd_probe(ide_drive_t *);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002306
Bartlomiej Zolnierkiewiczecfd80e2007-05-10 00:01:09 +02002307#ifdef CONFIG_IDE_PROC_FS
Linus Torvalds1da177e2005-04-16 15:20:36 -07002308static int proc_idecd_read_capacity
2309 (char *page, char **start, off_t off, int count, int *eof, void *data)
2310{
Jesper Juhl2a91f3e2005-10-30 15:02:45 -08002311 ide_drive_t *drive = data;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002312 int len;
2313
2314 len = sprintf(page,"%llu\n", (long long)ide_cdrom_capacity(drive));
2315 PROC_IDE_READ_RETURN(page,start,off,count,eof,len);
2316}
2317
2318static ide_proc_entry_t idecd_proc[] = {
2319 { "capacity", S_IFREG|S_IRUGO, proc_idecd_read_capacity, NULL },
2320 { NULL, 0, NULL, NULL }
2321};
Linus Torvalds1da177e2005-04-16 15:20:36 -07002322#endif
2323
2324static ide_driver_t ide_cdrom_driver = {
Bartlomiej Zolnierkiewicz8604aff2005-05-26 14:55:34 +02002325 .gen_driver = {
Laurent Riffard4ef3b8f2005-11-18 22:15:40 +01002326 .owner = THIS_MODULE,
Bartlomiej Zolnierkiewicz8604aff2005-05-26 14:55:34 +02002327 .name = "ide-cdrom",
2328 .bus = &ide_bus_type,
Bartlomiej Zolnierkiewicz8604aff2005-05-26 14:55:34 +02002329 },
Russell King4031bbe2006-01-06 11:41:00 +00002330 .probe = ide_cd_probe,
2331 .remove = ide_cd_remove,
Linus Torvalds1da177e2005-04-16 15:20:36 -07002332 .version = IDECD_VERSION,
2333 .media = ide_cdrom,
Linus Torvalds1da177e2005-04-16 15:20:36 -07002334 .supports_dsc_overlap = 1,
Linus Torvalds1da177e2005-04-16 15:20:36 -07002335 .do_request = ide_do_rw_cdrom,
2336 .end_request = ide_end_request,
2337 .error = __ide_error,
2338 .abort = __ide_abort,
Bartlomiej Zolnierkiewicz7662d042007-05-10 00:01:10 +02002339#ifdef CONFIG_IDE_PROC_FS
Linus Torvalds1da177e2005-04-16 15:20:36 -07002340 .proc = idecd_proc,
Bartlomiej Zolnierkiewicz7662d042007-05-10 00:01:10 +02002341#endif
Linus Torvalds1da177e2005-04-16 15:20:36 -07002342};
2343
2344static int idecd_open(struct inode * inode, struct file * file)
2345{
2346 struct gendisk *disk = inode->i_bdev->bd_disk;
2347 struct cdrom_info *info;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002348 int rc = -ENOMEM;
2349
2350 if (!(info = ide_cd_get(disk)))
2351 return -ENXIO;
2352
Linus Torvalds1da177e2005-04-16 15:20:36 -07002353 if (!info->buffer)
Bartlomiej Zolnierkiewiczc94964a2007-02-17 02:40:24 +01002354 info->buffer = kmalloc(SECTOR_BUFFER_SIZE, GFP_KERNEL|__GFP_REPEAT);
2355
2356 if (info->buffer)
2357 rc = cdrom_open(&info->devinfo, inode, file);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002358
2359 if (rc < 0)
2360 ide_cd_put(info);
2361
2362 return rc;
2363}
2364
2365static int idecd_release(struct inode * inode, struct file * file)
2366{
2367 struct gendisk *disk = inode->i_bdev->bd_disk;
2368 struct cdrom_info *info = ide_cd_g(disk);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002369
2370 cdrom_release (&info->devinfo, file);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002371
2372 ide_cd_put(info);
2373
2374 return 0;
2375}
2376
Christoph Hellwig6a2900b2006-03-23 03:00:15 -08002377static int idecd_set_spindown(struct cdrom_device_info *cdi, unsigned long arg)
2378{
2379 struct packet_command cgc;
2380 char buffer[16];
2381 int stat;
2382 char spindown;
2383
2384 if (copy_from_user(&spindown, (void __user *)arg, sizeof(char)))
2385 return -EFAULT;
2386
2387 init_cdrom_command(&cgc, buffer, sizeof(buffer), CGC_DATA_UNKNOWN);
2388
2389 stat = cdrom_mode_sense(cdi, &cgc, GPMODE_CDROM_PAGE, 0);
2390 if (stat)
2391 return stat;
2392
2393 buffer[11] = (buffer[11] & 0xf0) | (spindown & 0x0f);
2394 return cdrom_mode_select(cdi, &cgc);
2395}
2396
2397static int idecd_get_spindown(struct cdrom_device_info *cdi, unsigned long arg)
2398{
2399 struct packet_command cgc;
2400 char buffer[16];
2401 int stat;
2402 char spindown;
2403
2404 init_cdrom_command(&cgc, buffer, sizeof(buffer), CGC_DATA_UNKNOWN);
2405
2406 stat = cdrom_mode_sense(cdi, &cgc, GPMODE_CDROM_PAGE, 0);
2407 if (stat)
2408 return stat;
2409
2410 spindown = buffer[11] & 0x0f;
2411 if (copy_to_user((void __user *)arg, &spindown, sizeof (char)))
2412 return -EFAULT;
2413 return 0;
2414}
2415
Linus Torvalds1da177e2005-04-16 15:20:36 -07002416static int idecd_ioctl (struct inode *inode, struct file *file,
2417 unsigned int cmd, unsigned long arg)
2418{
2419 struct block_device *bdev = inode->i_bdev;
2420 struct cdrom_info *info = ide_cd_g(bdev->bd_disk);
2421 int err;
2422
Christoph Hellwig6a2900b2006-03-23 03:00:15 -08002423 switch (cmd) {
2424 case CDROMSETSPINDOWN:
2425 return idecd_set_spindown(&info->devinfo, arg);
2426 case CDROMGETSPINDOWN:
2427 return idecd_get_spindown(&info->devinfo, arg);
2428 default:
2429 break;
2430 }
2431
2432 err = generic_ide_ioctl(info->drive, file, bdev, cmd, arg);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002433 if (err == -EINVAL)
2434 err = cdrom_ioctl(file, &info->devinfo, inode, cmd, arg);
2435
2436 return err;
2437}
2438
2439static int idecd_media_changed(struct gendisk *disk)
2440{
2441 struct cdrom_info *info = ide_cd_g(disk);
2442 return cdrom_media_changed(&info->devinfo);
2443}
2444
2445static int idecd_revalidate_disk(struct gendisk *disk)
2446{
2447 struct cdrom_info *info = ide_cd_g(disk);
2448 struct request_sense sense;
Bartlomiej Zolnierkiewicz139c8292008-02-01 23:09:24 +01002449
2450 ide_cd_read_toc(info->drive, &sense);
2451
Linus Torvalds1da177e2005-04-16 15:20:36 -07002452 return 0;
2453}
2454
2455static struct block_device_operations idecd_ops = {
2456 .owner = THIS_MODULE,
2457 .open = idecd_open,
2458 .release = idecd_release,
2459 .ioctl = idecd_ioctl,
2460 .media_changed = idecd_media_changed,
2461 .revalidate_disk= idecd_revalidate_disk
2462};
2463
2464/* options */
2465static char *ignore = NULL;
2466
2467module_param(ignore, charp, 0400);
2468MODULE_DESCRIPTION("ATAPI CD-ROM Driver");
2469
Russell King4031bbe2006-01-06 11:41:00 +00002470static int ide_cd_probe(ide_drive_t *drive)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002471{
2472 struct cdrom_info *info;
2473 struct gendisk *g;
2474 struct request_sense sense;
2475
2476 if (!strstr("ide-cdrom", drive->driver_req))
2477 goto failed;
2478 if (!drive->present)
2479 goto failed;
2480 if (drive->media != ide_cdrom && drive->media != ide_optical)
2481 goto failed;
2482 /* skip drives that we were told to ignore */
2483 if (ignore != NULL) {
2484 if (strstr(ignore, drive->name)) {
2485 printk(KERN_INFO "ide-cd: ignoring drive %s\n", drive->name);
2486 goto failed;
2487 }
2488 }
2489 if (drive->scsi) {
2490 printk(KERN_INFO "ide-cd: passing drive %s to ide-scsi emulation.\n", drive->name);
2491 goto failed;
2492 }
Deepak Saxenaf5e3c2f2005-11-07 01:01:25 -08002493 info = kzalloc(sizeof(struct cdrom_info), GFP_KERNEL);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002494 if (info == NULL) {
2495 printk(KERN_ERR "%s: Can't allocate a cdrom structure\n", drive->name);
2496 goto failed;
2497 }
2498
2499 g = alloc_disk(1 << PARTN_BITS);
2500 if (!g)
2501 goto out_free_cd;
2502
2503 ide_init_disk(g, drive);
2504
Bartlomiej Zolnierkiewicz7662d042007-05-10 00:01:10 +02002505 ide_proc_register_driver(drive, &ide_cdrom_driver);
Bartlomiej Zolnierkiewicz8604aff2005-05-26 14:55:34 +02002506
Linus Torvalds1da177e2005-04-16 15:20:36 -07002507 kref_init(&info->kref);
2508
2509 info->drive = drive;
2510 info->driver = &ide_cdrom_driver;
2511 info->disk = g;
2512
2513 g->private_data = &info->driver;
2514
2515 drive->driver_data = info;
2516
Linus Torvalds1da177e2005-04-16 15:20:36 -07002517 g->minors = 1;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002518 g->driverfs_dev = &drive->gendev;
2519 g->flags = GENHD_FL_CD | GENHD_FL_REMOVABLE;
2520 if (ide_cdrom_setup(drive)) {
Bartlomiej Zolnierkiewicz7662d042007-05-10 00:01:10 +02002521 ide_proc_unregister_driver(drive, &ide_cdrom_driver);
Bartlomiej Zolnierkiewicz05017db2007-12-24 15:23:43 +01002522 ide_cd_release(&info->kref);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002523 goto failed;
2524 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07002525
Bartlomiej Zolnierkiewicz139c8292008-02-01 23:09:24 +01002526 ide_cd_read_toc(drive, &sense);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002527 g->fops = &idecd_ops;
2528 g->flags |= GENHD_FL_REMOVABLE;
2529 add_disk(g);
2530 return 0;
2531
Linus Torvalds1da177e2005-04-16 15:20:36 -07002532out_free_cd:
2533 kfree(info);
2534failed:
Bartlomiej Zolnierkiewicz8604aff2005-05-26 14:55:34 +02002535 return -ENODEV;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002536}
2537
2538static void __exit ide_cdrom_exit(void)
2539{
Bartlomiej Zolnierkiewicz8604aff2005-05-26 14:55:34 +02002540 driver_unregister(&ide_cdrom_driver.gen_driver);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002541}
Bartlomiej Zolnierkiewicz17514e82005-11-19 22:24:35 +01002542
2543static int __init ide_cdrom_init(void)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002544{
Bartlomiej Zolnierkiewicz8604aff2005-05-26 14:55:34 +02002545 return driver_register(&ide_cdrom_driver.gen_driver);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002546}
2547
Kay Sievers263756e2005-12-12 18:03:44 +01002548MODULE_ALIAS("ide:*m-cdrom*");
Bartlomiej Zolnierkiewicz972560f2008-02-01 23:09:23 +01002549MODULE_ALIAS("ide-cd");
Linus Torvalds1da177e2005-04-16 15:20:36 -07002550module_init(ide_cdrom_init);
2551module_exit(ide_cdrom_exit);
2552MODULE_LICENSE("GPL");