blob: 58397617b281936fdc4309cb9c3d2e65a54ccd8b [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 Zolnierkiewicz94f5a862008-02-01 23:09:26 +0100800static ide_startstop_t cdrom_rw_intr(ide_drive_t *);
801
Linus Torvalds1da177e2005-04-16 15:20:36 -0700802/*
803 * Routine to send a read packet command to the drive.
804 * This is usually called directly from cdrom_start_read.
805 * However, for drq_interrupt devices, it is called from an interrupt
806 * when the drive is ready to accept the command.
807 */
808static ide_startstop_t cdrom_start_read_continuation (ide_drive_t *drive)
809{
810 struct request *rq = HWGROUP(drive)->rq;
811 unsigned short sectors_per_frame;
812 int nskip;
813
814 sectors_per_frame = queue_hardsect_size(drive->queue) >> SECTOR_BITS;
815
816 /* If the requested sector doesn't start on a cdrom block boundary,
817 we must adjust the start of the transfer so that it does,
818 and remember to skip the first few sectors.
819 If the CURRENT_NR_SECTORS field is larger than the size
820 of the buffer, it will mean that we're to skip a number
821 of sectors equal to the amount by which CURRENT_NR_SECTORS
822 is larger than the buffer size. */
823 nskip = rq->sector & (sectors_per_frame - 1);
824 if (nskip > 0) {
825 /* Sanity check... */
826 if (rq->current_nr_sectors != bio_cur_sectors(rq->bio) &&
827 (rq->sector & (sectors_per_frame - 1))) {
828 printk(KERN_ERR "%s: cdrom_start_read_continuation: buffer botch (%u)\n",
829 drive->name, rq->current_nr_sectors);
830 cdrom_end_request(drive, 0);
831 return ide_stopped;
832 }
833 rq->current_nr_sectors += nskip;
834 }
835
836 /* Set up the command */
837 rq->timeout = ATAPI_WAIT_PC;
838
839 /* Send the command to the drive and return. */
Bartlomiej Zolnierkiewicz94f5a862008-02-01 23:09:26 +0100840 return cdrom_transfer_packet_command(drive, rq, cdrom_rw_intr);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700841}
842
843
844#define IDECD_SEEK_THRESHOLD (1000) /* 1000 blocks */
845#define IDECD_SEEK_TIMER (5 * WAIT_MIN_SLEEP) /* 100 ms */
846#define IDECD_SEEK_TIMEOUT (2 * WAIT_CMD) /* 20 sec */
847
848static ide_startstop_t cdrom_seek_intr (ide_drive_t *drive)
849{
850 struct cdrom_info *info = drive->driver_data;
851 int stat;
852 static int retry = 10;
853
854 if (cdrom_decode_status(drive, 0, &stat))
855 return ide_stopped;
Bartlomiej Zolnierkiewicz4fe67172008-02-01 23:09:21 +0100856
Bartlomiej Zolnierkiewicz2bc4cf22008-02-01 23:09:22 +0100857 info->cd_flags |= IDE_CD_FLAG_SEEKING;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700858
859 if (retry && time_after(jiffies, info->start_seek + IDECD_SEEK_TIMER)) {
860 if (--retry == 0) {
861 /*
862 * this condition is far too common, to bother
863 * users about it
864 */
865 /* printk("%s: disabled DSC seek overlap\n", drive->name);*/
866 drive->dsc_overlap = 0;
867 }
868 }
869 return ide_stopped;
870}
871
872static ide_startstop_t cdrom_start_seek_continuation (ide_drive_t *drive)
873{
874 struct request *rq = HWGROUP(drive)->rq;
875 sector_t frame = rq->sector;
876
877 sector_div(frame, queue_hardsect_size(drive->queue) >> SECTOR_BITS);
878
879 memset(rq->cmd, 0, sizeof(rq->cmd));
880 rq->cmd[0] = GPCMD_SEEK;
881 put_unaligned(cpu_to_be32(frame), (unsigned int *) &rq->cmd[2]);
882
883 rq->timeout = ATAPI_WAIT_PC;
884 return cdrom_transfer_packet_command(drive, rq, &cdrom_seek_intr);
885}
886
887static ide_startstop_t cdrom_start_seek (ide_drive_t *drive, unsigned int block)
888{
889 struct cdrom_info *info = drive->driver_data;
890
891 info->dma = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700892 info->start_seek = jiffies;
893 return cdrom_start_packet_command(drive, 0, cdrom_start_seek_continuation);
894}
895
896/* Fix up a possibly partially-processed request so that we can
897 start it over entirely, or even put it back on the request queue. */
898static void restore_request (struct request *rq)
899{
900 if (rq->buffer != bio_data(rq->bio)) {
901 sector_t n = (rq->buffer - (char *) bio_data(rq->bio)) / SECTOR_SIZE;
902
903 rq->buffer = bio_data(rq->bio);
904 rq->nr_sectors += n;
905 rq->sector -= n;
906 }
907 rq->hard_cur_sectors = rq->current_nr_sectors = bio_cur_sectors(rq->bio);
908 rq->hard_nr_sectors = rq->nr_sectors;
909 rq->hard_sector = rq->sector;
910 rq->q->prep_rq_fn(rq->q, rq);
911}
912
913/*
914 * Start a read request from the CD-ROM.
915 */
916static ide_startstop_t cdrom_start_read (ide_drive_t *drive, unsigned int block)
917{
918 struct cdrom_info *info = drive->driver_data;
919 struct request *rq = HWGROUP(drive)->rq;
920 unsigned short sectors_per_frame;
921
922 sectors_per_frame = queue_hardsect_size(drive->queue) >> SECTOR_BITS;
923
924 /* We may be retrying this request after an error. Fix up
925 any weirdness which might be present in the request packet. */
926 restore_request(rq);
927
928 /* Satisfy whatever we can of this request from our cached sector. */
929 if (cdrom_read_from_buffer(drive))
930 return ide_stopped;
931
Linus Torvalds1da177e2005-04-16 15:20:36 -0700932 /* Clear the local sector buffer. */
933 info->nsectors_buffered = 0;
934
935 /* use dma, if possible. */
936 info->dma = drive->using_dma;
937 if ((rq->sector & (sectors_per_frame - 1)) ||
938 (rq->nr_sectors & (sectors_per_frame - 1)))
939 info->dma = 0;
940
Linus Torvalds1da177e2005-04-16 15:20:36 -0700941 /* Start sending the read request to the drive. */
942 return cdrom_start_packet_command(drive, 32768, cdrom_start_read_continuation);
943}
944
945/****************************************************************************
946 * Execute all other packet commands.
947 */
948
Bartlomiej Zolnierkiewicz8ee69f52008-02-01 23:09:25 +0100949static void ide_cd_request_sense_fixup(struct request *rq)
950{
951 /*
952 * Some of the trailing request sense fields are optional,
953 * and some drives don't send them. Sigh.
954 */
955 if (rq->cmd[0] == GPCMD_REQUEST_SENSE &&
956 rq->data_len > 0 && rq->data_len <= 5)
957 while (rq->data_len > 0) {
958 *(u8 *)rq->data++ = 0;
959 --rq->data_len;
960 }
961}
962
Bartlomiej Zolnierkiewicz17802992008-02-01 23:09:25 +0100963int ide_cd_queue_pc(ide_drive_t *drive, struct request *rq)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700964{
965 struct request_sense sense;
966 int retries = 10;
Jens Axboe4aff5e22006-08-10 08:44:47 +0200967 unsigned int flags = rq->cmd_flags;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700968
969 if (rq->sense == NULL)
970 rq->sense = &sense;
971
972 /* Start of retry loop. */
973 do {
974 int error;
975 unsigned long time = jiffies;
Jens Axboe4aff5e22006-08-10 08:44:47 +0200976 rq->cmd_flags = flags;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700977
978 error = ide_do_drive_cmd(drive, rq, ide_wait);
979 time = jiffies - time;
980
981 /* FIXME: we should probably abort/retry or something
982 * in case of failure */
Jens Axboe4aff5e22006-08-10 08:44:47 +0200983 if (rq->cmd_flags & REQ_FAILED) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700984 /* The request failed. Retry if it was due to a unit
985 attention status
986 (usually means media was changed). */
987 struct request_sense *reqbuf = rq->sense;
988
989 if (reqbuf->sense_key == UNIT_ATTENTION)
990 cdrom_saw_media_change(drive);
991 else if (reqbuf->sense_key == NOT_READY &&
992 reqbuf->asc == 4 && reqbuf->ascq != 4) {
993 /* The drive is in the process of loading
994 a disk. Retry, but wait a little to give
995 the drive time to complete the load. */
996 ssleep(2);
997 } else {
998 /* Otherwise, don't retry. */
999 retries = 0;
1000 }
1001 --retries;
1002 }
1003
1004 /* End of retry loop. */
Jens Axboe4aff5e22006-08-10 08:44:47 +02001005 } while ((rq->cmd_flags & REQ_FAILED) && retries >= 0);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001006
1007 /* Return an error if the command failed. */
Jens Axboe4aff5e22006-08-10 08:44:47 +02001008 return (rq->cmd_flags & REQ_FAILED) ? -EIO : 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001009}
1010
1011/*
1012 * Write handling
1013 */
Arjan van de Ven858119e2006-01-14 13:20:43 -08001014static int cdrom_write_check_ireason(ide_drive_t *drive, int len, int ireason)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001015{
1016 /* Two notes about IDE interrupt reason here - 0 means that
1017 * the drive wants to receive data from us, 2 means that
1018 * the drive is expecting to transfer data to us.
1019 */
1020 if (ireason == 0)
1021 return 0;
1022 else if (ireason == 2) {
Bartlomiej Zolnierkiewicz5a5222d2008-02-01 23:09:17 +01001023 ide_hwif_t *hwif = drive->hwif;
1024
Linus Torvalds1da177e2005-04-16 15:20:36 -07001025 /* Whoops... The drive wants to send data. */
Bartlomiej Zolnierkiewicz35379c02007-12-24 15:23:43 +01001026 printk(KERN_ERR "%s: %s: wrong transfer direction!\n",
1027 drive->name, __FUNCTION__);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001028
Bartlomiej Zolnierkiewicz5a5222d2008-02-01 23:09:17 +01001029 ide_cd_pad_transfer(drive, hwif->atapi_input_bytes, len);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001030 } else {
1031 /* Drive wants a command packet, or invalid ireason... */
Bartlomiej Zolnierkiewicz35379c02007-12-24 15:23:43 +01001032 printk(KERN_ERR "%s: %s: bad interrupt reason 0x%02x\n",
1033 drive->name, __FUNCTION__, ireason);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001034 }
1035
1036 cdrom_end_request(drive, 0);
1037 return 1;
1038}
1039
Kiyoshi Uedaaaa04c22007-12-11 17:51:23 -05001040/*
1041 * Called from blk_end_request_callback() after the data of the request
1042 * is completed and before the request is completed.
1043 * By returning value '1', blk_end_request_callback() returns immediately
1044 * without completing the request.
1045 */
1046static int cdrom_newpc_intr_dummy_cb(struct request *rq)
1047{
1048 return 1;
1049}
1050
Linus Torvalds1da177e2005-04-16 15:20:36 -07001051/*
1052 * best way to deal with dma that is not sector aligned right now... note
1053 * that in this path we are not using ->data or ->buffer at all. this irs
Bartlomiej Zolnierkiewicz94f5a862008-02-01 23:09:26 +01001054 * can replace cdrom_rw_intr() in the future.
Linus Torvalds1da177e2005-04-16 15:20:36 -07001055 */
1056static ide_startstop_t cdrom_newpc_intr(ide_drive_t *drive)
1057{
1058 struct cdrom_info *info = drive->driver_data;
1059 struct request *rq = HWGROUP(drive)->rq;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001060 xfer_func_t *xferfunc;
Bartlomiej Zolnierkiewiczff1bfbc12008-02-01 23:09:25 +01001061 ide_expiry_t *expiry;
1062 int dma_error = 0, dma, stat, ireason, len, thislen, uptodate = 0;
1063 int write = (rq_data_dir(rq) == WRITE) ? 1 : 0;
1064 unsigned int timeout;
1065 u8 lowcyl, highcyl;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001066
1067 /* Check for errors. */
Linus Torvalds1da177e2005-04-16 15:20:36 -07001068 dma = info->dma;
1069 if (dma) {
1070 info->dma = 0;
1071 dma_error = HWIF(drive)->ide_dma_end(drive);
Bartlomiej Zolnierkiewiczeba15fb2008-02-01 23:09:17 +01001072 if (dma_error) {
1073 printk(KERN_ERR "%s: DMA %s error\n", drive->name,
Bartlomiej Zolnierkiewiczff1bfbc12008-02-01 23:09:25 +01001074 write ? "write" : "read");
Bartlomiej Zolnierkiewiczeba15fb2008-02-01 23:09:17 +01001075 ide_dma_off(drive);
1076 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001077 }
1078
1079 if (cdrom_decode_status(drive, 0, &stat))
1080 return ide_stopped;
1081
1082 /*
1083 * using dma, transfer is complete now
1084 */
1085 if (dma) {
Bartlomiej Zolnierkiewiczeba15fb2008-02-01 23:09:17 +01001086 if (dma_error)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001087 return ide_error(drive, "dma error", stat);
Bartlomiej Zolnierkiewiczff1bfbc12008-02-01 23:09:25 +01001088 goto end_request;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001089 }
1090
1091 /*
1092 * ok we fall to pio :/
1093 */
1094 ireason = HWIF(drive)->INB(IDE_IREASON_REG) & 0x3;
1095 lowcyl = HWIF(drive)->INB(IDE_BCOUNTL_REG);
1096 highcyl = HWIF(drive)->INB(IDE_BCOUNTH_REG);
1097
1098 len = lowcyl + (256 * highcyl);
1099 thislen = rq->data_len;
1100 if (thislen > len)
1101 thislen = len;
1102
1103 /*
1104 * If DRQ is clear, the command has completed.
1105 */
Kiyoshi Uedaaaa04c22007-12-11 17:51:23 -05001106 if ((stat & DRQ_STAT) == 0) {
Bartlomiej Zolnierkiewiczff1bfbc12008-02-01 23:09:25 +01001107 if (!blk_pc_request(rq)) {
1108 ide_cd_request_sense_fixup(rq);
1109 /* Complain if we still have data left to transfer. */
1110 uptodate = rq->data_len ? 0 : 1;
1111 }
1112 goto end_request;
Kiyoshi Uedaaaa04c22007-12-11 17:51:23 -05001113 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001114
1115 /*
1116 * check which way to transfer data
1117 */
Bartlomiej Zolnierkiewiczff1bfbc12008-02-01 23:09:25 +01001118 if (blk_pc_request(rq) && rq_data_dir(rq) == WRITE) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07001119 /*
1120 * write to drive
1121 */
1122 if (cdrom_write_check_ireason(drive, len, ireason))
1123 return ide_stopped;
Bartlomiej Zolnierkiewiczff1bfbc12008-02-01 23:09:25 +01001124 } else if (blk_pc_request(rq)) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07001125 /*
1126 * read from drive
1127 */
1128 if (cdrom_read_check_ireason(drive, len, ireason))
1129 return ide_stopped;
Bartlomiej Zolnierkiewiczff1bfbc12008-02-01 23:09:25 +01001130 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001131
Bartlomiej Zolnierkiewiczff1bfbc12008-02-01 23:09:25 +01001132 if (ireason == 0) {
1133 write = 1;
1134 xferfunc = HWIF(drive)->atapi_output_bytes;
1135 } else if (ireason == 2 || (ireason == 1 && blk_pc_request(rq))) {
1136 write = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001137 xferfunc = HWIF(drive)->atapi_input_bytes;
Bartlomiej Zolnierkiewiczff1bfbc12008-02-01 23:09:25 +01001138 } else {
1139 printk(KERN_ERR "%s: %s: The drive "
1140 "appears confused (ireason = 0x%02x). "
1141 "Trying to recover by ending request.\n",
1142 drive->name, __FUNCTION__, ireason);
1143 goto end_request;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001144 }
1145
1146 /*
1147 * transfer data
1148 */
1149 while (thislen > 0) {
1150 int blen = blen = rq->data_len;
1151 char *ptr = rq->data;
1152
1153 /*
1154 * bio backed?
1155 */
1156 if (rq->bio) {
1157 ptr = bio_data(rq->bio);
1158 blen = bio_iovec(rq->bio)->bv_len;
1159 }
1160
1161 if (!ptr) {
Bartlomiej Zolnierkiewicz03f537d2008-02-01 23:09:25 +01001162 printk(KERN_ERR "%s: confused, missing data\n",
1163 drive->name);
1164 blk_dump_rq_flags(rq, rq_data_dir(rq)
1165 ? "cdrom_newpc_intr, write"
1166 : "cdrom_newpc_intr, read");
Linus Torvalds1da177e2005-04-16 15:20:36 -07001167 break;
1168 }
1169
1170 if (blen > thislen)
1171 blen = thislen;
1172
1173 xferfunc(drive, ptr, blen);
1174
1175 thislen -= blen;
1176 len -= blen;
1177 rq->data_len -= blen;
1178
1179 if (rq->bio)
Kiyoshi Uedaaaa04c22007-12-11 17:51:23 -05001180 /*
1181 * The request can't be completed until DRQ is cleared.
1182 * So complete the data, but don't complete the request
1183 * using the dummy function for the callback feature
1184 * of blk_end_request_callback().
1185 */
1186 blk_end_request_callback(rq, 0, blen,
1187 cdrom_newpc_intr_dummy_cb);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001188 else
1189 rq->data += blen;
1190 }
1191
Bartlomiej Zolnierkiewiczff1bfbc12008-02-01 23:09:25 +01001192 if (write && blk_sense_request(rq))
1193 rq->sense_len += thislen;
1194
Linus Torvalds1da177e2005-04-16 15:20:36 -07001195 /*
1196 * pad, if necessary
1197 */
Bartlomiej Zolnierkiewicz5a5222d2008-02-01 23:09:17 +01001198 if (len > 0)
1199 ide_cd_pad_transfer(drive, xferfunc, len);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001200
Bartlomiej Zolnierkiewiczff1bfbc12008-02-01 23:09:25 +01001201 if (blk_pc_request(rq)) {
1202 timeout = rq->timeout;
1203 expiry = NULL;
1204 } else {
1205 timeout = ATAPI_WAIT_PC;
1206 expiry = cdrom_timer_expiry;
1207 }
1208
1209 ide_set_handler(drive, cdrom_newpc_intr, timeout, expiry);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001210 return ide_started;
Bartlomiej Zolnierkiewiczff1bfbc12008-02-01 23:09:25 +01001211
1212end_request:
1213 if (blk_pc_request(rq)) {
1214 unsigned long flags;
1215
1216 spin_lock_irqsave(&ide_lock, flags);
1217 if (__blk_end_request(rq, 0, rq->data_len))
1218 BUG();
1219 HWGROUP(drive)->rq = NULL;
1220 spin_unlock_irqrestore(&ide_lock, flags);
1221 } else {
1222 if (!uptodate)
1223 rq->cmd_flags |= REQ_FAILED;
1224 cdrom_end_request(drive, uptodate);
1225 }
1226 return ide_stopped;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001227}
1228
Bartlomiej Zolnierkiewicz94f5a862008-02-01 23:09:26 +01001229static ide_startstop_t cdrom_rw_intr(ide_drive_t *drive)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001230{
Linus Torvalds1da177e2005-04-16 15:20:36 -07001231 struct cdrom_info *info = drive->driver_data;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001232 struct request *rq = HWGROUP(drive)->rq;
Bartlomiej Zolnierkiewicz94f5a862008-02-01 23:09:26 +01001233 xfer_func_t *xferfunc;
1234 int stat, ireason, len, sectors_to_transfer, uptodate, nskip;
1235 int dma_error = 0, dma = info->dma, write = rq_data_dir(rq) == WRITE;
1236 u8 lowcyl = 0, highcyl = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001237
1238 /* Check for errors. */
1239 if (dma) {
1240 info->dma = 0;
Bartlomiej Zolnierkiewiczb481b232007-12-24 15:23:43 +01001241 dma_error = HWIF(drive)->ide_dma_end(drive);
1242 if (dma_error) {
Bartlomiej Zolnierkiewicz94f5a862008-02-01 23:09:26 +01001243 printk(KERN_ERR "%s: DMA %s error\n", drive->name,
1244 write ? "write" : "read");
Bartlomiej Zolnierkiewicz7469aaf2007-02-17 02:40:26 +01001245 ide_dma_off(drive);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001246 }
1247 }
1248
1249 if (cdrom_decode_status(drive, 0, &stat))
1250 return ide_stopped;
1251
1252 /*
1253 * using dma, transfer is complete now
1254 */
1255 if (dma) {
1256 if (dma_error)
1257 return ide_error(drive, "dma error", stat);
1258
1259 ide_end_request(drive, 1, rq->nr_sectors);
1260 return ide_stopped;
1261 }
1262
1263 /* Read the interrupt reason and the transfer length. */
Bartlomiej Zolnierkiewicz31a71192007-12-24 15:23:43 +01001264 ireason = HWIF(drive)->INB(IDE_IREASON_REG) & 0x3;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001265 lowcyl = HWIF(drive)->INB(IDE_BCOUNTL_REG);
1266 highcyl = HWIF(drive)->INB(IDE_BCOUNTH_REG);
1267
1268 len = lowcyl + (256 * highcyl);
1269
1270 /* If DRQ is clear, the command has completed. */
1271 if ((stat & DRQ_STAT) == 0) {
Bartlomiej Zolnierkiewicz94f5a862008-02-01 23:09:26 +01001272 /*
1273 * If we're not done reading/writing, complain.
Linus Torvalds1da177e2005-04-16 15:20:36 -07001274 * Otherwise, complete the command normally.
1275 */
1276 uptodate = 1;
1277 if (rq->current_nr_sectors > 0) {
Bartlomiej Zolnierkiewiczb481b232007-12-24 15:23:43 +01001278 printk(KERN_ERR "%s: %s: data underrun (%d blocks)\n",
1279 drive->name, __FUNCTION__,
1280 rq->current_nr_sectors);
Bartlomiej Zolnierkiewicz94f5a862008-02-01 23:09:26 +01001281 if (!write)
1282 rq->cmd_flags |= REQ_FAILED;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001283 uptodate = 0;
1284 }
1285 cdrom_end_request(drive, uptodate);
1286 return ide_stopped;
1287 }
1288
Linus Torvalds1da177e2005-04-16 15:20:36 -07001289 sectors_to_transfer = len / SECTOR_SIZE;
1290
Bartlomiej Zolnierkiewicz94f5a862008-02-01 23:09:26 +01001291 /* Check that the drive is expecting to do the same thing we are. */
1292 if (write) {
1293 if (cdrom_write_check_ireason(drive, len, ireason))
1294 return ide_stopped;
1295
1296 xferfunc = HWIF(drive)->atapi_output_bytes;
1297 } else {
1298 if (cdrom_read_check_ireason(drive, len, ireason))
1299 return ide_stopped;
1300
1301 if (ide_cd_check_transfer_size(drive, len)) {
1302 cdrom_end_request(drive, 0);
1303 return ide_stopped;
1304 }
1305
1306 /*
1307 * First, figure out if we need to bit-bucket
1308 * any of the leading sectors.
1309 */
1310 nskip = min_t(int, rq->current_nr_sectors
1311 - bio_cur_sectors(rq->bio),
1312 sectors_to_transfer);
1313
1314 if (nskip > 0) {
1315 ide_cd_drain_data(drive, nskip);
1316 rq->current_nr_sectors -= nskip;
1317 sectors_to_transfer -= nskip;
1318 }
1319
1320 xferfunc = HWIF(drive)->atapi_input_bytes;
1321 }
1322
Linus Torvalds1da177e2005-04-16 15:20:36 -07001323 /*
Bartlomiej Zolnierkiewicz94f5a862008-02-01 23:09:26 +01001324 * now loop and read/write the data
Linus Torvalds1da177e2005-04-16 15:20:36 -07001325 */
1326 while (sectors_to_transfer > 0) {
1327 int this_transfer;
1328
Bartlomiej Zolnierkiewicz94f5a862008-02-01 23:09:26 +01001329 /*
1330 * If we've filled the present buffer but there's another
1331 * chained buffer after it, move on.
1332 */
1333 if (!write && rq->current_nr_sectors == 0 && rq->nr_sectors)
1334 cdrom_end_request(drive, 1);
1335
Linus Torvalds1da177e2005-04-16 15:20:36 -07001336 if (!rq->current_nr_sectors) {
Bartlomiej Zolnierkiewicz94f5a862008-02-01 23:09:26 +01001337 if (!write)
1338 /*
1339 * If the buffers are full, cache the rest
1340 * of the data in our internal buffer.
1341 */
1342 cdrom_buffer_sectors(drive, rq->sector,
1343 sectors_to_transfer);
1344 else
1345 printk(KERN_ERR "%s: %s: confused, missing "
1346 "data\n",
1347 drive->name, __FUNCTION__);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001348 break;
1349 }
1350
1351 /*
1352 * Figure out how many sectors we can transfer
1353 */
1354 this_transfer = min_t(int, sectors_to_transfer, rq->current_nr_sectors);
1355
1356 while (this_transfer > 0) {
Bartlomiej Zolnierkiewicz94f5a862008-02-01 23:09:26 +01001357 xferfunc(drive, rq->buffer, SECTOR_SIZE);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001358 rq->buffer += SECTOR_SIZE;
1359 --rq->nr_sectors;
1360 --rq->current_nr_sectors;
1361 ++rq->sector;
1362 --this_transfer;
1363 --sectors_to_transfer;
1364 }
1365
1366 /*
1367 * current buffer complete, move on
1368 */
Bartlomiej Zolnierkiewicz94f5a862008-02-01 23:09:26 +01001369 if (write && rq->current_nr_sectors == 0 && rq->nr_sectors)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001370 cdrom_end_request(drive, 1);
1371 }
1372
1373 /* re-arm handler */
Bartlomiej Zolnierkiewicz94f5a862008-02-01 23:09:26 +01001374 ide_set_handler(drive, cdrom_rw_intr, ATAPI_WAIT_PC, NULL);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001375 return ide_started;
1376}
1377
1378static ide_startstop_t cdrom_start_write_cont(ide_drive_t *drive)
1379{
1380 struct request *rq = HWGROUP(drive)->rq;
1381
1382#if 0 /* the immediate bit */
1383 rq->cmd[1] = 1 << 3;
1384#endif
1385 rq->timeout = ATAPI_WAIT_PC;
1386
Bartlomiej Zolnierkiewicz94f5a862008-02-01 23:09:26 +01001387 return cdrom_transfer_packet_command(drive, rq, cdrom_rw_intr);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001388}
1389
1390static ide_startstop_t cdrom_start_write(ide_drive_t *drive, struct request *rq)
1391{
1392 struct cdrom_info *info = drive->driver_data;
1393 struct gendisk *g = info->disk;
1394 unsigned short sectors_per_frame = queue_hardsect_size(drive->queue) >> SECTOR_BITS;
1395
1396 /*
1397 * writes *must* be hardware frame aligned
1398 */
1399 if ((rq->nr_sectors & (sectors_per_frame - 1)) ||
1400 (rq->sector & (sectors_per_frame - 1))) {
1401 cdrom_end_request(drive, 0);
1402 return ide_stopped;
1403 }
1404
1405 /*
1406 * disk has become write protected
1407 */
1408 if (g->policy) {
1409 cdrom_end_request(drive, 0);
1410 return ide_stopped;
1411 }
1412
Linus Torvalds1da177e2005-04-16 15:20:36 -07001413 info->nsectors_buffered = 0;
1414
1415 /* use dma, if possible. we don't need to check more, since we
1416 * know that the transfer is always (at least!) frame aligned */
1417 info->dma = drive->using_dma ? 1 : 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001418
1419 info->devinfo.media_written = 1;
1420
1421 /* Start sending the write request to the drive. */
1422 return cdrom_start_packet_command(drive, 32768, cdrom_start_write_cont);
1423}
1424
1425static ide_startstop_t cdrom_do_newpc_cont(ide_drive_t *drive)
1426{
1427 struct request *rq = HWGROUP(drive)->rq;
1428
1429 if (!rq->timeout)
1430 rq->timeout = ATAPI_WAIT_PC;
1431
1432 return cdrom_transfer_packet_command(drive, rq, cdrom_newpc_intr);
1433}
1434
1435static ide_startstop_t cdrom_do_block_pc(ide_drive_t *drive, struct request *rq)
1436{
1437 struct cdrom_info *info = drive->driver_data;
1438
Bartlomiej Zolnierkiewiczc9f56a82008-02-01 23:09:26 +01001439 if (blk_pc_request(rq))
1440 rq->cmd_flags |= REQ_QUIET;
1441 else
1442 rq->cmd_flags &= ~REQ_FAILED;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001443
1444 info->dma = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001445
1446 /*
1447 * sg request
1448 */
1449 if (rq->bio) {
1450 int mask = drive->queue->dma_alignment;
1451 unsigned long addr = (unsigned long) page_address(bio_page(rq->bio));
1452
Linus Torvalds1da177e2005-04-16 15:20:36 -07001453 info->dma = drive->using_dma;
1454
1455 /*
1456 * check if dma is safe
Linus Torvalds5d9e4ea2005-05-27 07:36:17 -07001457 *
1458 * NOTE! The "len" and "addr" checks should possibly have
1459 * separate masks.
Linus Torvalds1da177e2005-04-16 15:20:36 -07001460 */
Jens Axboe4e7c6812005-05-31 17:47:36 +02001461 if ((rq->data_len & 15) || (addr & mask))
Linus Torvalds1da177e2005-04-16 15:20:36 -07001462 info->dma = 0;
1463 }
1464
1465 /* Start sending the command to the drive. */
1466 return cdrom_start_packet_command(drive, rq->data_len, cdrom_do_newpc_cont);
1467}
1468
1469/****************************************************************************
1470 * cdrom driver request routine.
1471 */
1472static ide_startstop_t
1473ide_do_rw_cdrom (ide_drive_t *drive, struct request *rq, sector_t block)
1474{
1475 ide_startstop_t action;
1476 struct cdrom_info *info = drive->driver_data;
1477
1478 if (blk_fs_request(rq)) {
Bartlomiej Zolnierkiewicz2bc4cf22008-02-01 23:09:22 +01001479 if (info->cd_flags & IDE_CD_FLAG_SEEKING) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07001480 unsigned long elapsed = jiffies - info->start_seek;
1481 int stat = HWIF(drive)->INB(IDE_STATUS_REG);
1482
1483 if ((stat & SEEK_STAT) != SEEK_STAT) {
1484 if (elapsed < IDECD_SEEK_TIMEOUT) {
1485 ide_stall_queue(drive, IDECD_SEEK_TIMER);
1486 return ide_stopped;
1487 }
1488 printk (KERN_ERR "%s: DSC timeout\n", drive->name);
1489 }
Bartlomiej Zolnierkiewicz2bc4cf22008-02-01 23:09:22 +01001490 info->cd_flags &= ~IDE_CD_FLAG_SEEKING;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001491 }
1492 if ((rq_data_dir(rq) == READ) && IDE_LARGE_SEEK(info->last_block, block, IDECD_SEEK_THRESHOLD) && drive->dsc_overlap) {
1493 action = cdrom_start_seek(drive, block);
1494 } else {
1495 if (rq_data_dir(rq) == READ)
1496 action = cdrom_start_read(drive, block);
1497 else
1498 action = cdrom_start_write(drive, rq);
1499 }
1500 info->last_block = block;
1501 return action;
Bartlomiej Zolnierkiewiczc9f56a82008-02-01 23:09:26 +01001502 } else if (blk_sense_request(rq) || blk_pc_request(rq) ||
Jens Axboecea28852006-10-12 15:08:45 +02001503 rq->cmd_type == REQ_TYPE_ATA_PC) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07001504 return cdrom_do_block_pc(drive, rq);
Jens Axboe4aff5e22006-08-10 08:44:47 +02001505 } else if (blk_special_request(rq)) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07001506 /*
1507 * right now this can only be a reset...
1508 */
1509 cdrom_end_request(drive, 1);
1510 return ide_stopped;
1511 }
1512
1513 blk_dump_rq_flags(rq, "ide-cd bad flags");
1514 cdrom_end_request(drive, 0);
1515 return ide_stopped;
1516}
1517
1518
1519
1520/****************************************************************************
1521 * Ioctl handling.
1522 *
1523 * Routines which queue packet commands take as a final argument a pointer
1524 * to a request_sense struct. If execution of the command results
1525 * in an error with a CHECK CONDITION status, this structure will be filled
1526 * with the results of the subsequent request sense command. The pointer
1527 * can also be NULL, in which case no sense information is returned.
1528 */
1529
Linus Torvalds1da177e2005-04-16 15:20:36 -07001530static
1531void msf_from_bcd (struct atapi_msf *msf)
1532{
Bartlomiej Zolnierkiewicz9a6dc662008-02-01 23:09:22 +01001533 msf->minute = BCD2BIN(msf->minute);
1534 msf->second = BCD2BIN(msf->second);
1535 msf->frame = BCD2BIN(msf->frame);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001536}
1537
Linus Torvalds1da177e2005-04-16 15:20:36 -07001538static int cdrom_check_status(ide_drive_t *drive, struct request_sense *sense)
1539{
1540 struct request req;
1541 struct cdrom_info *info = drive->driver_data;
1542 struct cdrom_device_info *cdi = &info->devinfo;
1543
Bartlomiej Zolnierkiewicz139c8292008-02-01 23:09:24 +01001544 ide_cd_init_rq(drive, &req);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001545
1546 req.sense = sense;
1547 req.cmd[0] = GPCMD_TEST_UNIT_READY;
Jens Axboe4aff5e22006-08-10 08:44:47 +02001548 req.cmd_flags |= REQ_QUIET;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001549
Bartlomiej Zolnierkiewiczcdf60002008-02-01 23:09:22 +01001550 /*
1551 * Sanyo 3 CD changer uses byte 7 of TEST_UNIT_READY to
1552 * switch CDs instead of supporting the LOAD_UNLOAD opcode.
1553 */
Linus Torvalds1da177e2005-04-16 15:20:36 -07001554 req.cmd[7] = cdi->sanyo_slot % 3;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001555
Bartlomiej Zolnierkiewicz139c8292008-02-01 23:09:24 +01001556 return ide_cd_queue_pc(drive, &req);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001557}
1558
Linus Torvalds1da177e2005-04-16 15:20:36 -07001559/* Lock the door if LOCKFLAG is nonzero; unlock it otherwise. */
Bartlomiej Zolnierkiewicz17802992008-02-01 23:09:25 +01001560int ide_cd_lockdoor(ide_drive_t *drive, int lockflag,
1561 struct request_sense *sense)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001562{
Bartlomiej Zolnierkiewicz4fe67172008-02-01 23:09:21 +01001563 struct cdrom_info *cd = drive->driver_data;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001564 struct request_sense my_sense;
1565 struct request req;
1566 int stat;
1567
1568 if (sense == NULL)
1569 sense = &my_sense;
1570
1571 /* If the drive cannot lock the door, just pretend. */
Bartlomiej Zolnierkiewicz2bc4cf22008-02-01 23:09:22 +01001572 if (cd->cd_flags & IDE_CD_FLAG_NO_DOORLOCK) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07001573 stat = 0;
1574 } else {
Bartlomiej Zolnierkiewicz139c8292008-02-01 23:09:24 +01001575 ide_cd_init_rq(drive, &req);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001576 req.sense = sense;
1577 req.cmd[0] = GPCMD_PREVENT_ALLOW_MEDIUM_REMOVAL;
1578 req.cmd[4] = lockflag ? 1 : 0;
Bartlomiej Zolnierkiewicz139c8292008-02-01 23:09:24 +01001579 stat = ide_cd_queue_pc(drive, &req);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001580 }
1581
1582 /* If we got an illegal field error, the drive
1583 probably cannot lock the door. */
1584 if (stat != 0 &&
1585 sense->sense_key == ILLEGAL_REQUEST &&
1586 (sense->asc == 0x24 || sense->asc == 0x20)) {
1587 printk (KERN_ERR "%s: door locking not supported\n",
1588 drive->name);
Bartlomiej Zolnierkiewicz2bc4cf22008-02-01 23:09:22 +01001589 cd->cd_flags |= IDE_CD_FLAG_NO_DOORLOCK;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001590 stat = 0;
1591 }
1592
1593 /* no medium, that's alright. */
1594 if (stat != 0 && sense->sense_key == NOT_READY && sense->asc == 0x3a)
1595 stat = 0;
1596
Bartlomiej Zolnierkiewicz2bc4cf22008-02-01 23:09:22 +01001597 if (stat == 0) {
1598 if (lockflag)
1599 cd->cd_flags |= IDE_CD_FLAG_DOOR_LOCKED;
1600 else
1601 cd->cd_flags &= ~IDE_CD_FLAG_DOOR_LOCKED;
1602 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001603
1604 return stat;
1605}
1606
1607
1608/* Eject the disk if EJECTFLAG is 0.
1609 If EJECTFLAG is 1, try to reload the disk. */
1610static int cdrom_eject(ide_drive_t *drive, int ejectflag,
1611 struct request_sense *sense)
1612{
Bartlomiej Zolnierkiewicz3f1b86d2008-02-01 23:09:20 +01001613 struct cdrom_info *cd = drive->driver_data;
1614 struct cdrom_device_info *cdi = &cd->devinfo;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001615 struct request req;
1616 char loej = 0x02;
1617
Bartlomiej Zolnierkiewicz2bc4cf22008-02-01 23:09:22 +01001618 if ((cd->cd_flags & IDE_CD_FLAG_NO_EJECT) && !ejectflag)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001619 return -EDRIVE_CANT_DO_THIS;
Bartlomiej Zolnierkiewicz4fe67172008-02-01 23:09:21 +01001620
Linus Torvalds1da177e2005-04-16 15:20:36 -07001621 /* reload fails on some drives, if the tray is locked */
Bartlomiej Zolnierkiewicz2bc4cf22008-02-01 23:09:22 +01001622 if ((cd->cd_flags & IDE_CD_FLAG_DOOR_LOCKED) && ejectflag)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001623 return 0;
1624
Bartlomiej Zolnierkiewicz139c8292008-02-01 23:09:24 +01001625 ide_cd_init_rq(drive, &req);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001626
1627 /* only tell drive to close tray if open, if it can do that */
Bartlomiej Zolnierkiewicz3f1b86d2008-02-01 23:09:20 +01001628 if (ejectflag && (cdi->mask & CDC_CLOSE_TRAY))
Linus Torvalds1da177e2005-04-16 15:20:36 -07001629 loej = 0;
1630
1631 req.sense = sense;
1632 req.cmd[0] = GPCMD_START_STOP_UNIT;
1633 req.cmd[4] = loej | (ejectflag != 0);
Bartlomiej Zolnierkiewicz139c8292008-02-01 23:09:24 +01001634
1635 return ide_cd_queue_pc(drive, &req);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001636}
1637
1638static int cdrom_read_capacity(ide_drive_t *drive, unsigned long *capacity,
1639 unsigned long *sectors_per_frame,
1640 struct request_sense *sense)
1641{
1642 struct {
1643 __u32 lba;
1644 __u32 blocklen;
1645 } capbuf;
1646
1647 int stat;
1648 struct request req;
1649
Bartlomiej Zolnierkiewicz139c8292008-02-01 23:09:24 +01001650 ide_cd_init_rq(drive, &req);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001651
1652 req.sense = sense;
1653 req.cmd[0] = GPCMD_READ_CDVD_CAPACITY;
1654 req.data = (char *)&capbuf;
1655 req.data_len = sizeof(capbuf);
Jens Axboe4aff5e22006-08-10 08:44:47 +02001656 req.cmd_flags |= REQ_QUIET;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001657
Bartlomiej Zolnierkiewicz139c8292008-02-01 23:09:24 +01001658 stat = ide_cd_queue_pc(drive, &req);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001659 if (stat == 0) {
1660 *capacity = 1 + be32_to_cpu(capbuf.lba);
1661 *sectors_per_frame =
1662 be32_to_cpu(capbuf.blocklen) >> SECTOR_BITS;
1663 }
1664
1665 return stat;
1666}
1667
1668static int cdrom_read_tocentry(ide_drive_t *drive, int trackno, int msf_flag,
1669 int format, char *buf, int buflen,
1670 struct request_sense *sense)
1671{
1672 struct request req;
1673
Bartlomiej Zolnierkiewicz139c8292008-02-01 23:09:24 +01001674 ide_cd_init_rq(drive, &req);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001675
1676 req.sense = sense;
1677 req.data = buf;
1678 req.data_len = buflen;
Jens Axboe4aff5e22006-08-10 08:44:47 +02001679 req.cmd_flags |= REQ_QUIET;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001680 req.cmd[0] = GPCMD_READ_TOC_PMA_ATIP;
1681 req.cmd[6] = trackno;
1682 req.cmd[7] = (buflen >> 8);
1683 req.cmd[8] = (buflen & 0xff);
1684 req.cmd[9] = (format << 6);
1685
1686 if (msf_flag)
1687 req.cmd[1] = 2;
1688
Bartlomiej Zolnierkiewicz139c8292008-02-01 23:09:24 +01001689 return ide_cd_queue_pc(drive, &req);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001690}
1691
Linus Torvalds1da177e2005-04-16 15:20:36 -07001692/* Try to read the entire TOC for the disk into our internal buffer. */
Bartlomiej Zolnierkiewicz17802992008-02-01 23:09:25 +01001693int ide_cd_read_toc(ide_drive_t *drive, struct request_sense *sense)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001694{
1695 int stat, ntracks, i;
1696 struct cdrom_info *info = drive->driver_data;
1697 struct cdrom_device_info *cdi = &info->devinfo;
1698 struct atapi_toc *toc = info->toc;
1699 struct {
1700 struct atapi_toc_header hdr;
1701 struct atapi_toc_entry ent;
1702 } ms_tmp;
1703 long last_written;
1704 unsigned long sectors_per_frame = SECTORS_PER_FRAME;
1705
1706 if (toc == NULL) {
1707 /* Try to allocate space. */
Jesper Juhl2a91f3e2005-10-30 15:02:45 -08001708 toc = kmalloc(sizeof(struct atapi_toc), GFP_KERNEL);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001709 if (toc == NULL) {
1710 printk (KERN_ERR "%s: No cdrom TOC buffer!\n", drive->name);
1711 return -ENOMEM;
1712 }
Jesper Juhl2a91f3e2005-10-30 15:02:45 -08001713 info->toc = toc;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001714 }
1715
1716 /* Check to see if the existing data is still valid.
1717 If it is, just return. */
1718 (void) cdrom_check_status(drive, sense);
1719
Bartlomiej Zolnierkiewicz2bc4cf22008-02-01 23:09:22 +01001720 if (info->cd_flags & IDE_CD_FLAG_TOC_VALID)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001721 return 0;
1722
1723 /* Try to get the total cdrom capacity and sector size. */
1724 stat = cdrom_read_capacity(drive, &toc->capacity, &sectors_per_frame,
1725 sense);
1726 if (stat)
1727 toc->capacity = 0x1fffff;
1728
1729 set_capacity(info->disk, toc->capacity * sectors_per_frame);
Alan Coxdbe217a2006-06-25 05:47:44 -07001730 /* Save a private copy of te TOC capacity for error handling */
1731 drive->probed_capacity = toc->capacity * sectors_per_frame;
1732
Linus Torvalds1da177e2005-04-16 15:20:36 -07001733 blk_queue_hardsect_size(drive->queue,
1734 sectors_per_frame << SECTOR_BITS);
1735
1736 /* First read just the header, so we know how long the TOC is. */
1737 stat = cdrom_read_tocentry(drive, 0, 1, 0, (char *) &toc->hdr,
1738 sizeof(struct atapi_toc_header), sense);
Jesper Juhl2a91f3e2005-10-30 15:02:45 -08001739 if (stat)
1740 return stat;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001741
Bartlomiej Zolnierkiewicz2bc4cf22008-02-01 23:09:22 +01001742 if (info->cd_flags & IDE_CD_FLAG_TOCTRACKS_AS_BCD) {
Bartlomiej Zolnierkiewicz9a6dc662008-02-01 23:09:22 +01001743 toc->hdr.first_track = BCD2BIN(toc->hdr.first_track);
1744 toc->hdr.last_track = BCD2BIN(toc->hdr.last_track);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001745 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001746
1747 ntracks = toc->hdr.last_track - toc->hdr.first_track + 1;
1748 if (ntracks <= 0)
1749 return -EIO;
1750 if (ntracks > MAX_TRACKS)
1751 ntracks = MAX_TRACKS;
1752
1753 /* Now read the whole schmeer. */
1754 stat = cdrom_read_tocentry(drive, toc->hdr.first_track, 1, 0,
1755 (char *)&toc->hdr,
1756 sizeof(struct atapi_toc_header) +
1757 (ntracks + 1) *
1758 sizeof(struct atapi_toc_entry), sense);
1759
1760 if (stat && toc->hdr.first_track > 1) {
1761 /* Cds with CDI tracks only don't have any TOC entries,
1762 despite of this the returned values are
1763 first_track == last_track = number of CDI tracks + 1,
1764 so that this case is indistinguishable from the same
1765 layout plus an additional audio track.
1766 If we get an error for the regular case, we assume
1767 a CDI without additional audio tracks. In this case
1768 the readable TOC is empty (CDI tracks are not included)
Jan Engelhardt96de0e22007-10-19 23:21:04 +02001769 and only holds the Leadout entry. Heiko Eißfeldt */
Linus Torvalds1da177e2005-04-16 15:20:36 -07001770 ntracks = 0;
1771 stat = cdrom_read_tocentry(drive, CDROM_LEADOUT, 1, 0,
1772 (char *)&toc->hdr,
1773 sizeof(struct atapi_toc_header) +
1774 (ntracks + 1) *
1775 sizeof(struct atapi_toc_entry),
1776 sense);
Bartlomiej Zolnierkiewiczcdf60002008-02-01 23:09:22 +01001777 if (stat)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001778 return stat;
Bartlomiej Zolnierkiewiczcdf60002008-02-01 23:09:22 +01001779
Bartlomiej Zolnierkiewicz2bc4cf22008-02-01 23:09:22 +01001780 if (info->cd_flags & IDE_CD_FLAG_TOCTRACKS_AS_BCD) {
Bartlomiej Zolnierkiewicz9a6dc662008-02-01 23:09:22 +01001781 toc->hdr.first_track = (u8)BIN2BCD(CDROM_LEADOUT);
1782 toc->hdr.last_track = (u8)BIN2BCD(CDROM_LEADOUT);
Bartlomiej Zolnierkiewiczcdf60002008-02-01 23:09:22 +01001783 } else {
Linus Torvalds1da177e2005-04-16 15:20:36 -07001784 toc->hdr.first_track = CDROM_LEADOUT;
1785 toc->hdr.last_track = CDROM_LEADOUT;
1786 }
1787 }
1788
1789 if (stat)
1790 return stat;
1791
1792 toc->hdr.toc_length = ntohs (toc->hdr.toc_length);
1793
Bartlomiej Zolnierkiewicz2bc4cf22008-02-01 23:09:22 +01001794 if (info->cd_flags & IDE_CD_FLAG_TOCTRACKS_AS_BCD) {
Bartlomiej Zolnierkiewicz9a6dc662008-02-01 23:09:22 +01001795 toc->hdr.first_track = BCD2BIN(toc->hdr.first_track);
1796 toc->hdr.last_track = BCD2BIN(toc->hdr.last_track);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001797 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001798
Bartlomiej Zolnierkiewiczcdf60002008-02-01 23:09:22 +01001799 for (i = 0; i <= ntracks; i++) {
Bartlomiej Zolnierkiewicz2bc4cf22008-02-01 23:09:22 +01001800 if (info->cd_flags & IDE_CD_FLAG_TOCADDR_AS_BCD) {
1801 if (info->cd_flags & IDE_CD_FLAG_TOCTRACKS_AS_BCD)
Bartlomiej Zolnierkiewicz9a6dc662008-02-01 23:09:22 +01001802 toc->ent[i].track = BCD2BIN(toc->ent[i].track);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001803 msf_from_bcd(&toc->ent[i].addr.msf);
1804 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001805 toc->ent[i].addr.lba = msf_to_lba (toc->ent[i].addr.msf.minute,
1806 toc->ent[i].addr.msf.second,
1807 toc->ent[i].addr.msf.frame);
1808 }
1809
1810 /* Read the multisession information. */
1811 if (toc->hdr.first_track != CDROM_LEADOUT) {
1812 /* Read the multisession information. */
1813 stat = cdrom_read_tocentry(drive, 0, 0, 1, (char *)&ms_tmp,
1814 sizeof(ms_tmp), sense);
Jesper Juhl2a91f3e2005-10-30 15:02:45 -08001815 if (stat)
1816 return stat;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001817
1818 toc->last_session_lba = be32_to_cpu(ms_tmp.ent.addr.lba);
1819 } else {
1820 ms_tmp.hdr.first_track = ms_tmp.hdr.last_track = CDROM_LEADOUT;
1821 toc->last_session_lba = msf_to_lba(0, 2, 0); /* 0m 2s 0f */
1822 }
1823
Bartlomiej Zolnierkiewicz2bc4cf22008-02-01 23:09:22 +01001824 if (info->cd_flags & IDE_CD_FLAG_TOCADDR_AS_BCD) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07001825 /* Re-read multisession information using MSF format */
1826 stat = cdrom_read_tocentry(drive, 0, 1, 1, (char *)&ms_tmp,
1827 sizeof(ms_tmp), sense);
1828 if (stat)
1829 return stat;
1830
1831 msf_from_bcd (&ms_tmp.ent.addr.msf);
1832 toc->last_session_lba = msf_to_lba(ms_tmp.ent.addr.msf.minute,
1833 ms_tmp.ent.addr.msf.second,
1834 ms_tmp.ent.addr.msf.frame);
1835 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001836
1837 toc->xa_flag = (ms_tmp.hdr.first_track != ms_tmp.hdr.last_track);
1838
1839 /* Now try to get the total cdrom capacity. */
1840 stat = cdrom_get_last_written(cdi, &last_written);
1841 if (!stat && (last_written > toc->capacity)) {
1842 toc->capacity = last_written;
1843 set_capacity(info->disk, toc->capacity * sectors_per_frame);
Alan Coxdbe217a2006-06-25 05:47:44 -07001844 drive->probed_capacity = toc->capacity * sectors_per_frame;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001845 }
1846
1847 /* Remember that we've read this stuff. */
Bartlomiej Zolnierkiewicz2bc4cf22008-02-01 23:09:22 +01001848 info->cd_flags |= IDE_CD_FLAG_TOC_VALID;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001849
1850 return 0;
1851}
1852
Linus Torvalds1da177e2005-04-16 15:20:36 -07001853/* the generic packet interface to cdrom.c */
1854static int ide_cdrom_packet(struct cdrom_device_info *cdi,
1855 struct packet_command *cgc)
1856{
1857 struct request req;
Jesper Juhl2a91f3e2005-10-30 15:02:45 -08001858 ide_drive_t *drive = cdi->handle;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001859
1860 if (cgc->timeout <= 0)
1861 cgc->timeout = ATAPI_WAIT_PC;
1862
1863 /* here we queue the commands from the uniform CD-ROM
1864 layer. the packet must be complete, as we do not
1865 touch it at all. */
Bartlomiej Zolnierkiewicz139c8292008-02-01 23:09:24 +01001866 ide_cd_init_rq(drive, &req);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001867 memcpy(req.cmd, cgc->cmd, CDROM_PACKET_SIZE);
1868 if (cgc->sense)
1869 memset(cgc->sense, 0, sizeof(struct request_sense));
1870 req.data = cgc->buffer;
1871 req.data_len = cgc->buflen;
1872 req.timeout = cgc->timeout;
1873
1874 if (cgc->quiet)
Jens Axboe4aff5e22006-08-10 08:44:47 +02001875 req.cmd_flags |= REQ_QUIET;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001876
1877 req.sense = cgc->sense;
Bartlomiej Zolnierkiewicz139c8292008-02-01 23:09:24 +01001878 cgc->stat = ide_cd_queue_pc(drive, &req);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001879 if (!cgc->stat)
1880 cgc->buflen -= req.data_len;
1881 return cgc->stat;
1882}
1883
Linus Torvalds1da177e2005-04-16 15:20:36 -07001884static
1885int ide_cdrom_tray_move (struct cdrom_device_info *cdi, int position)
1886{
Jesper Juhl2a91f3e2005-10-30 15:02:45 -08001887 ide_drive_t *drive = cdi->handle;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001888 struct request_sense sense;
1889
1890 if (position) {
Bartlomiej Zolnierkiewicz139c8292008-02-01 23:09:24 +01001891 int stat = ide_cd_lockdoor(drive, 0, &sense);
1892
Jesper Juhl2a91f3e2005-10-30 15:02:45 -08001893 if (stat)
1894 return stat;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001895 }
1896
1897 return cdrom_eject(drive, !position, &sense);
1898}
1899
Bartlomiej Zolnierkiewicz17802992008-02-01 23:09:25 +01001900int ide_cdrom_get_capabilities(ide_drive_t *drive, u8 *buf)
Eric Piel9235e682005-06-23 00:10:29 -07001901{
1902 struct cdrom_info *info = drive->driver_data;
1903 struct cdrom_device_info *cdi = &info->devinfo;
1904 struct packet_command cgc;
Bartlomiej Zolnierkiewicz455d80a2008-02-01 23:09:21 +01001905 int stat, attempts = 3, size = ATAPI_CAPABILITIES_PAGE_SIZE;
Eric Piel9235e682005-06-23 00:10:29 -07001906
Bartlomiej Zolnierkiewicze59724c2008-02-01 23:09:22 +01001907 if ((info->cd_flags & IDE_CD_FLAG_FULL_CAPS_PAGE) == 0)
Bartlomiej Zolnierkiewicz455d80a2008-02-01 23:09:21 +01001908 size -= ATAPI_CAPABILITIES_PAGE_PAD_SIZE;
Eric Piel9235e682005-06-23 00:10:29 -07001909
Bartlomiej Zolnierkiewicz455d80a2008-02-01 23:09:21 +01001910 init_cdrom_command(&cgc, buf, size, CGC_DATA_UNKNOWN);
Eric Piel9235e682005-06-23 00:10:29 -07001911 do { /* we seem to get stat=0x01,err=0x00 the first time (??) */
1912 stat = cdrom_mode_sense(cdi, &cgc, GPMODE_CAPABILITIES_PAGE, 0);
1913 if (!stat)
1914 break;
1915 } while (--attempts);
1916 return stat;
1917}
1918
Bartlomiej Zolnierkiewicz17802992008-02-01 23:09:25 +01001919void ide_cdrom_update_speed(ide_drive_t *drive, u8 *buf)
Eric Piel9235e682005-06-23 00:10:29 -07001920{
Bartlomiej Zolnierkiewicz4fe67172008-02-01 23:09:21 +01001921 struct cdrom_info *cd = drive->driver_data;
Bartlomiej Zolnierkiewicz481c8c62008-02-01 23:09:20 +01001922 u16 curspeed, maxspeed;
1923
Bartlomiej Zolnierkiewicz455d80a2008-02-01 23:09:21 +01001924 curspeed = *(u16 *)&buf[8 + 14];
1925 maxspeed = *(u16 *)&buf[8 + 8];
1926
Bartlomiej Zolnierkiewicze59724c2008-02-01 23:09:22 +01001927 if (cd->cd_flags & IDE_CD_FLAG_LE_SPEED_FIELDS) {
Bartlomiej Zolnierkiewicz455d80a2008-02-01 23:09:21 +01001928 curspeed = le16_to_cpu(curspeed);
1929 maxspeed = le16_to_cpu(maxspeed);
Eric Piel9235e682005-06-23 00:10:29 -07001930 } else {
Bartlomiej Zolnierkiewicz455d80a2008-02-01 23:09:21 +01001931 curspeed = be16_to_cpu(curspeed);
1932 maxspeed = be16_to_cpu(maxspeed);
Eric Piel9235e682005-06-23 00:10:29 -07001933 }
Bartlomiej Zolnierkiewicz481c8c62008-02-01 23:09:20 +01001934
Bartlomiej Zolnierkiewicz2bc4cf22008-02-01 23:09:22 +01001935 cd->current_speed = (curspeed + (176/2)) / 176;
1936 cd->max_speed = (maxspeed + (176/2)) / 176;
Eric Piel9235e682005-06-23 00:10:29 -07001937}
1938
Bartlomiej Zolnierkiewicz5c684292008-02-01 23:09:24 +01001939/*
Linus Torvalds1da177e2005-04-16 15:20:36 -07001940 * add logic to try GET_EVENT command first to check for media and tray
1941 * status. this should be supported by newer cd-r/w and all DVD etc
1942 * drives
1943 */
1944static
1945int ide_cdrom_drive_status (struct cdrom_device_info *cdi, int slot_nr)
1946{
Jesper Juhl2a91f3e2005-10-30 15:02:45 -08001947 ide_drive_t *drive = cdi->handle;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001948 struct media_event_desc med;
1949 struct request_sense sense;
1950 int stat;
1951
1952 if (slot_nr != CDSL_CURRENT)
1953 return -EINVAL;
1954
1955 stat = cdrom_check_status(drive, &sense);
1956 if (!stat || sense.sense_key == UNIT_ATTENTION)
1957 return CDS_DISC_OK;
1958
1959 if (!cdrom_get_media_event(cdi, &med)) {
1960 if (med.media_present)
1961 return CDS_DISC_OK;
1962 else if (med.door_open)
1963 return CDS_TRAY_OPEN;
1964 else
1965 return CDS_NO_DISC;
1966 }
1967
1968 if (sense.sense_key == NOT_READY && sense.asc == 0x04 && sense.ascq == 0x04)
1969 return CDS_DISC_OK;
1970
1971 /*
1972 * If not using Mt Fuji extended media tray reports,
1973 * just return TRAY_OPEN since ATAPI doesn't provide
1974 * any other way to detect this...
1975 */
1976 if (sense.sense_key == NOT_READY) {
Alan Coxdbe217a2006-06-25 05:47:44 -07001977 if (sense.asc == 0x3a && sense.ascq == 1)
1978 return CDS_NO_DISC;
1979 else
1980 return CDS_TRAY_OPEN;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001981 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001982 return CDS_DRIVE_NOT_READY;
1983}
1984
Linus Torvalds1da177e2005-04-16 15:20:36 -07001985/****************************************************************************
1986 * Other driver requests (open, close, check media change).
1987 */
1988
1989static
1990int ide_cdrom_check_media_change_real (struct cdrom_device_info *cdi,
1991 int slot_nr)
1992{
Jesper Juhl2a91f3e2005-10-30 15:02:45 -08001993 ide_drive_t *drive = cdi->handle;
Bartlomiej Zolnierkiewicz0ba11212008-02-01 23:09:21 +01001994 struct cdrom_info *cd = drive->driver_data;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001995 int retval;
Bartlomiej Zolnierkiewicz0ba11212008-02-01 23:09:21 +01001996
Linus Torvalds1da177e2005-04-16 15:20:36 -07001997 if (slot_nr == CDSL_CURRENT) {
1998 (void) cdrom_check_status(drive, NULL);
Bartlomiej Zolnierkiewicz2bc4cf22008-02-01 23:09:22 +01001999 retval = (cd->cd_flags & IDE_CD_FLAG_MEDIA_CHANGED) ? 1 : 0;
2000 cd->cd_flags &= ~IDE_CD_FLAG_MEDIA_CHANGED;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002001 return retval;
2002 } else {
2003 return -EINVAL;
2004 }
2005}
2006
2007
2008static
2009int ide_cdrom_open_real (struct cdrom_device_info *cdi, int purpose)
2010{
2011 return 0;
2012}
2013
2014/*
2015 * Close down the device. Invalidate all cached blocks.
2016 */
2017
2018static
2019void ide_cdrom_release_real (struct cdrom_device_info *cdi)
2020{
2021 ide_drive_t *drive = cdi->handle;
Bartlomiej Zolnierkiewicz0ba11212008-02-01 23:09:21 +01002022 struct cdrom_info *cd = drive->driver_data;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002023
2024 if (!cdi->use_count)
Bartlomiej Zolnierkiewicz2bc4cf22008-02-01 23:09:22 +01002025 cd->cd_flags &= ~IDE_CD_FLAG_TOC_VALID;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002026}
2027
Bartlomiej Zolnierkiewicz20e7f7e2008-02-01 23:09:20 +01002028#define IDE_CD_CAPABILITIES \
2029 (CDC_CLOSE_TRAY | CDC_OPEN_TRAY | CDC_LOCK | CDC_SELECT_SPEED | \
2030 CDC_SELECT_DISC | CDC_MULTI_SESSION | CDC_MCN | CDC_MEDIA_CHANGED | \
2031 CDC_PLAY_AUDIO | CDC_RESET | CDC_DRIVE_STATUS | CDC_CD_R | \
2032 CDC_CD_RW | CDC_DVD | CDC_DVD_R | CDC_DVD_RAM | CDC_GENERIC_PACKET | \
2033 CDC_MO_DRIVE | CDC_MRW | CDC_MRW_W | CDC_RAM)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002034
Linus Torvalds1da177e2005-04-16 15:20:36 -07002035static struct cdrom_device_ops ide_cdrom_dops = {
2036 .open = ide_cdrom_open_real,
2037 .release = ide_cdrom_release_real,
2038 .drive_status = ide_cdrom_drive_status,
2039 .media_changed = ide_cdrom_check_media_change_real,
2040 .tray_move = ide_cdrom_tray_move,
2041 .lock_door = ide_cdrom_lock_door,
2042 .select_speed = ide_cdrom_select_speed,
2043 .get_last_session = ide_cdrom_get_last_session,
2044 .get_mcn = ide_cdrom_get_mcn,
2045 .reset = ide_cdrom_reset,
2046 .audio_ioctl = ide_cdrom_audio_ioctl,
Bartlomiej Zolnierkiewicz20e7f7e2008-02-01 23:09:20 +01002047 .capability = IDE_CD_CAPABILITIES,
Linus Torvalds1da177e2005-04-16 15:20:36 -07002048 .generic_packet = ide_cdrom_packet,
2049};
2050
2051static int ide_cdrom_register (ide_drive_t *drive, int nslots)
2052{
2053 struct cdrom_info *info = drive->driver_data;
2054 struct cdrom_device_info *devinfo = &info->devinfo;
2055
2056 devinfo->ops = &ide_cdrom_dops;
Bartlomiej Zolnierkiewicz2bc4cf22008-02-01 23:09:22 +01002057 devinfo->speed = info->current_speed;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002058 devinfo->capacity = nslots;
Jesper Juhl2a91f3e2005-10-30 15:02:45 -08002059 devinfo->handle = drive;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002060 strcpy(devinfo->name, drive->name);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002061
Bartlomiej Zolnierkiewicz2bc4cf22008-02-01 23:09:22 +01002062 if (info->cd_flags & IDE_CD_FLAG_NO_SPEED_SELECT)
Bartlomiej Zolnierkiewicz3cbd8142007-12-24 15:23:43 +01002063 devinfo->mask |= CDC_SELECT_SPEED;
2064
Linus Torvalds1da177e2005-04-16 15:20:36 -07002065 devinfo->disk = info->disk;
2066 return register_cdrom(devinfo);
2067}
2068
2069static
Linus Torvalds1da177e2005-04-16 15:20:36 -07002070int ide_cdrom_probe_capabilities (ide_drive_t *drive)
2071{
Bartlomiej Zolnierkiewicz4fe67172008-02-01 23:09:21 +01002072 struct cdrom_info *cd = drive->driver_data;
2073 struct cdrom_device_info *cdi = &cd->devinfo;
Bartlomiej Zolnierkiewicz455d80a2008-02-01 23:09:21 +01002074 u8 buf[ATAPI_CAPABILITIES_PAGE_SIZE];
2075 mechtype_t mechtype;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002076 int nslots = 1;
2077
Bartlomiej Zolnierkiewicz3f1b86d2008-02-01 23:09:20 +01002078 cdi->mask = (CDC_CD_R | CDC_CD_RW | CDC_DVD | CDC_DVD_R |
2079 CDC_DVD_RAM | CDC_SELECT_DISC | CDC_PLAY_AUDIO |
2080 CDC_MO_DRIVE | CDC_RAM);
2081
Linus Torvalds1da177e2005-04-16 15:20:36 -07002082 if (drive->media == ide_optical) {
Bartlomiej Zolnierkiewicz3f1b86d2008-02-01 23:09:20 +01002083 cdi->mask &= ~(CDC_MO_DRIVE | CDC_RAM);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002084 printk(KERN_ERR "%s: ATAPI magneto-optical drive\n", drive->name);
2085 return nslots;
2086 }
2087
Bartlomiej Zolnierkiewicze59724c2008-02-01 23:09:22 +01002088 if (cd->cd_flags & IDE_CD_FLAG_PRE_ATAPI12) {
Bartlomiej Zolnierkiewicz2bc4cf22008-02-01 23:09:22 +01002089 cd->cd_flags &= ~IDE_CD_FLAG_NO_EJECT;
Bartlomiej Zolnierkiewicz3f1b86d2008-02-01 23:09:20 +01002090 cdi->mask &= ~CDC_PLAY_AUDIO;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002091 return nslots;
2092 }
2093
2094 /*
2095 * we have to cheat a little here. the packet will eventually
2096 * be queued with ide_cdrom_packet(), which extracts the
2097 * drive from cdi->handle. Since this device hasn't been
2098 * registered with the Uniform layer yet, it can't do this.
2099 * Same goes for cdi->ops.
2100 */
Jesper Juhl2a91f3e2005-10-30 15:02:45 -08002101 cdi->handle = drive;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002102 cdi->ops = &ide_cdrom_dops;
2103
Bartlomiej Zolnierkiewicz455d80a2008-02-01 23:09:21 +01002104 if (ide_cdrom_get_capabilities(drive, buf))
Linus Torvalds1da177e2005-04-16 15:20:36 -07002105 return 0;
2106
Bartlomiej Zolnierkiewicz455d80a2008-02-01 23:09:21 +01002107 if ((buf[8 + 6] & 0x01) == 0)
Bartlomiej Zolnierkiewicz2bc4cf22008-02-01 23:09:22 +01002108 cd->cd_flags |= IDE_CD_FLAG_NO_DOORLOCK;
Bartlomiej Zolnierkiewicz455d80a2008-02-01 23:09:21 +01002109 if (buf[8 + 6] & 0x08)
Bartlomiej Zolnierkiewicz2bc4cf22008-02-01 23:09:22 +01002110 cd->cd_flags &= ~IDE_CD_FLAG_NO_EJECT;
Bartlomiej Zolnierkiewicz455d80a2008-02-01 23:09:21 +01002111 if (buf[8 + 3] & 0x01)
Bartlomiej Zolnierkiewicz3f1b86d2008-02-01 23:09:20 +01002112 cdi->mask &= ~CDC_CD_R;
Bartlomiej Zolnierkiewicz455d80a2008-02-01 23:09:21 +01002113 if (buf[8 + 3] & 0x02)
Bartlomiej Zolnierkiewicz3f1b86d2008-02-01 23:09:20 +01002114 cdi->mask &= ~(CDC_CD_RW | CDC_RAM);
Bartlomiej Zolnierkiewicz455d80a2008-02-01 23:09:21 +01002115 if (buf[8 + 2] & 0x38)
Bartlomiej Zolnierkiewicz3f1b86d2008-02-01 23:09:20 +01002116 cdi->mask &= ~CDC_DVD;
Bartlomiej Zolnierkiewicz455d80a2008-02-01 23:09:21 +01002117 if (buf[8 + 3] & 0x20)
Bartlomiej Zolnierkiewicz3f1b86d2008-02-01 23:09:20 +01002118 cdi->mask &= ~(CDC_DVD_RAM | CDC_RAM);
Bartlomiej Zolnierkiewicz455d80a2008-02-01 23:09:21 +01002119 if (buf[8 + 3] & 0x10)
Bartlomiej Zolnierkiewicz3f1b86d2008-02-01 23:09:20 +01002120 cdi->mask &= ~CDC_DVD_R;
Bartlomiej Zolnierkiewicze59724c2008-02-01 23:09:22 +01002121 if ((buf[8 + 4] & 0x01) || (cd->cd_flags & IDE_CD_FLAG_PLAY_AUDIO_OK))
Bartlomiej Zolnierkiewicz3f1b86d2008-02-01 23:09:20 +01002122 cdi->mask &= ~CDC_PLAY_AUDIO;
Bartlomiej Zolnierkiewicz455d80a2008-02-01 23:09:21 +01002123
2124 mechtype = buf[8 + 6] >> 5;
2125 if (mechtype == mechtype_caddy || mechtype == mechtype_popup)
Bartlomiej Zolnierkiewicz3f1b86d2008-02-01 23:09:20 +01002126 cdi->mask |= CDC_CLOSE_TRAY;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002127
Linus Torvalds1da177e2005-04-16 15:20:36 -07002128 if (cdi->sanyo_slot > 0) {
Bartlomiej Zolnierkiewicz3f1b86d2008-02-01 23:09:20 +01002129 cdi->mask &= ~CDC_SELECT_DISC;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002130 nslots = 3;
Bartlomiej Zolnierkiewiczcdf60002008-02-01 23:09:22 +01002131 } else if (mechtype == mechtype_individual_changer ||
2132 mechtype == mechtype_cartridge_changer) {
Bartlomiej Zolnierkiewicz2609d062008-02-01 23:09:19 +01002133 nslots = cdrom_number_of_slots(cdi);
2134 if (nslots > 1)
Bartlomiej Zolnierkiewicz3f1b86d2008-02-01 23:09:20 +01002135 cdi->mask &= ~CDC_SELECT_DISC;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002136 }
2137
Bartlomiej Zolnierkiewicz455d80a2008-02-01 23:09:21 +01002138 ide_cdrom_update_speed(drive, buf);
Bartlomiej Zolnierkiewicz4fe67172008-02-01 23:09:21 +01002139
Linus Torvalds1da177e2005-04-16 15:20:36 -07002140 printk(KERN_INFO "%s: ATAPI", drive->name);
Bartlomiej Zolnierkiewicz4fe67172008-02-01 23:09:21 +01002141
2142 /* don't print speed if the drive reported 0 */
Bartlomiej Zolnierkiewicz2bc4cf22008-02-01 23:09:22 +01002143 if (cd->max_speed)
2144 printk(KERN_CONT " %dX", cd->max_speed);
Bartlomiej Zolnierkiewicz4fe67172008-02-01 23:09:21 +01002145
Bartlomiej Zolnierkiewicz3f1b86d2008-02-01 23:09:20 +01002146 printk(KERN_CONT " %s", (cdi->mask & CDC_DVD) ? "CD-ROM" : "DVD-ROM");
Linus Torvalds1da177e2005-04-16 15:20:36 -07002147
Bartlomiej Zolnierkiewicz3f1b86d2008-02-01 23:09:20 +01002148 if ((cdi->mask & CDC_DVD_R) == 0 || (cdi->mask & CDC_DVD_RAM) == 0)
2149 printk(KERN_CONT " DVD%s%s",
2150 (cdi->mask & CDC_DVD_R) ? "" : "-R",
2151 (cdi->mask & CDC_DVD_RAM) ? "" : "-RAM");
Linus Torvalds1da177e2005-04-16 15:20:36 -07002152
Bartlomiej Zolnierkiewicz3f1b86d2008-02-01 23:09:20 +01002153 if ((cdi->mask & CDC_CD_R) == 0 || (cdi->mask & CDC_CD_RW) == 0)
2154 printk(KERN_CONT " CD%s%s",
2155 (cdi->mask & CDC_CD_R) ? "" : "-R",
2156 (cdi->mask & CDC_CD_RW) ? "" : "/RW");
Linus Torvalds1da177e2005-04-16 15:20:36 -07002157
Bartlomiej Zolnierkiewicz3f1b86d2008-02-01 23:09:20 +01002158 if ((cdi->mask & CDC_SELECT_DISC) == 0)
2159 printk(KERN_CONT " changer w/%d slots", nslots);
2160 else
2161 printk(KERN_CONT " drive");
Linus Torvalds1da177e2005-04-16 15:20:36 -07002162
Bartlomiej Zolnierkiewicz455d80a2008-02-01 23:09:21 +01002163 printk(KERN_CONT ", %dkB Cache\n", be16_to_cpu(*(u16 *)&buf[8 + 12]));
Linus Torvalds1da177e2005-04-16 15:20:36 -07002164
2165 return nslots;
2166}
2167
Bartlomiej Zolnierkiewicz7662d042007-05-10 00:01:10 +02002168#ifdef CONFIG_IDE_PROC_FS
Linus Torvalds1da177e2005-04-16 15:20:36 -07002169static void ide_cdrom_add_settings(ide_drive_t *drive)
2170{
Bartlomiej Zolnierkiewicz14979432007-05-10 00:01:10 +02002171 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 -07002172}
Bartlomiej Zolnierkiewicz7662d042007-05-10 00:01:10 +02002173#else
2174static inline void ide_cdrom_add_settings(ide_drive_t *drive) { ; }
2175#endif
Linus Torvalds1da177e2005-04-16 15:20:36 -07002176
2177/*
2178 * standard prep_rq_fn that builds 10 byte cmds
2179 */
Jens Axboe165125e2007-07-24 09:28:11 +02002180static int ide_cdrom_prep_fs(struct request_queue *q, struct request *rq)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002181{
2182 int hard_sect = queue_hardsect_size(q);
2183 long block = (long)rq->hard_sector / (hard_sect >> 9);
2184 unsigned long blocks = rq->hard_nr_sectors / (hard_sect >> 9);
2185
2186 memset(rq->cmd, 0, sizeof(rq->cmd));
2187
2188 if (rq_data_dir(rq) == READ)
2189 rq->cmd[0] = GPCMD_READ_10;
2190 else
2191 rq->cmd[0] = GPCMD_WRITE_10;
2192
2193 /*
2194 * fill in lba
2195 */
2196 rq->cmd[2] = (block >> 24) & 0xff;
2197 rq->cmd[3] = (block >> 16) & 0xff;
2198 rq->cmd[4] = (block >> 8) & 0xff;
2199 rq->cmd[5] = block & 0xff;
2200
2201 /*
2202 * and transfer length
2203 */
2204 rq->cmd[7] = (blocks >> 8) & 0xff;
2205 rq->cmd[8] = blocks & 0xff;
2206 rq->cmd_len = 10;
2207 return BLKPREP_OK;
2208}
2209
2210/*
2211 * Most of the SCSI commands are supported directly by ATAPI devices.
2212 * This transform handles the few exceptions.
2213 */
2214static int ide_cdrom_prep_pc(struct request *rq)
2215{
2216 u8 *c = rq->cmd;
2217
2218 /*
2219 * Transform 6-byte read/write commands to the 10-byte version
2220 */
2221 if (c[0] == READ_6 || c[0] == WRITE_6) {
2222 c[8] = c[4];
2223 c[5] = c[3];
2224 c[4] = c[2];
2225 c[3] = c[1] & 0x1f;
2226 c[2] = 0;
2227 c[1] &= 0xe0;
2228 c[0] += (READ_10 - READ_6);
2229 rq->cmd_len = 10;
2230 return BLKPREP_OK;
2231 }
2232
2233 /*
2234 * it's silly to pretend we understand 6-byte sense commands, just
2235 * reject with ILLEGAL_REQUEST and the caller should take the
2236 * appropriate action
2237 */
2238 if (c[0] == MODE_SENSE || c[0] == MODE_SELECT) {
2239 rq->errors = ILLEGAL_REQUEST;
2240 return BLKPREP_KILL;
2241 }
2242
2243 return BLKPREP_OK;
2244}
2245
Jens Axboe165125e2007-07-24 09:28:11 +02002246static int ide_cdrom_prep_fn(struct request_queue *q, struct request *rq)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002247{
Jens Axboe4aff5e22006-08-10 08:44:47 +02002248 if (blk_fs_request(rq))
Linus Torvalds1da177e2005-04-16 15:20:36 -07002249 return ide_cdrom_prep_fs(q, rq);
Jens Axboe4aff5e22006-08-10 08:44:47 +02002250 else if (blk_pc_request(rq))
Linus Torvalds1da177e2005-04-16 15:20:36 -07002251 return ide_cdrom_prep_pc(rq);
2252
2253 return 0;
2254}
2255
Bartlomiej Zolnierkiewicze59724c2008-02-01 23:09:22 +01002256struct cd_list_entry {
2257 const char *id_model;
2258 const char *id_firmware;
2259 unsigned int cd_flags;
2260};
2261
2262static const struct cd_list_entry ide_cd_quirks_list[] = {
2263 /* Limit transfer size per interrupt. */
2264 { "SAMSUNG CD-ROM SCR-2430", NULL, IDE_CD_FLAG_LIMIT_NFRAMES },
2265 { "SAMSUNG CD-ROM SCR-2432", NULL, IDE_CD_FLAG_LIMIT_NFRAMES },
2266 /* SCR-3231 doesn't support the SET_CD_SPEED command. */
2267 { "SAMSUNG CD-ROM SCR-3231", NULL, IDE_CD_FLAG_NO_SPEED_SELECT },
2268 /* Old NEC260 (not R) was released before ATAPI 1.2 spec. */
2269 { "NEC CD-ROM DRIVE:260", "1.01", IDE_CD_FLAG_TOCADDR_AS_BCD |
2270 IDE_CD_FLAG_PRE_ATAPI12, },
2271 /* Vertos 300, some versions of this drive like to talk BCD. */
2272 { "V003S0DS", NULL, IDE_CD_FLAG_VERTOS_300_SSD, },
2273 /* Vertos 600 ESD. */
2274 { "V006E0DS", NULL, IDE_CD_FLAG_VERTOS_600_ESD, },
2275 /*
2276 * Sanyo 3 CD changer uses a non-standard command for CD changing
2277 * (by default standard ATAPI support for CD changers is used).
2278 */
2279 { "CD-ROM CDR-C3 G", NULL, IDE_CD_FLAG_SANYO_3CD },
2280 { "CD-ROM CDR-C3G", NULL, IDE_CD_FLAG_SANYO_3CD },
2281 { "CD-ROM CDR_C36", NULL, IDE_CD_FLAG_SANYO_3CD },
2282 /* Stingray 8X CD-ROM. */
2283 { "STINGRAY 8422 IDE 8X CD-ROM 7-27-95", NULL, IDE_CD_FLAG_PRE_ATAPI12},
2284 /*
2285 * ACER 50X CD-ROM and WPI 32X CD-ROM require the full spec length
2286 * mode sense page capabilities size, but older drives break.
2287 */
2288 { "ATAPI CD ROM DRIVE 50X MAX", NULL, IDE_CD_FLAG_FULL_CAPS_PAGE },
2289 { "WPI CDS-32X", NULL, IDE_CD_FLAG_FULL_CAPS_PAGE },
2290 /* ACER/AOpen 24X CD-ROM has the speed fields byte-swapped. */
2291 { "", "241N", IDE_CD_FLAG_LE_SPEED_FIELDS },
2292 /*
2293 * Some drives used by Apple don't advertise audio play
2294 * but they do support reading TOC & audio datas.
2295 */
2296 { "MATSHITADVD-ROM SR-8187", NULL, IDE_CD_FLAG_PLAY_AUDIO_OK },
2297 { "MATSHITADVD-ROM SR-8186", NULL, IDE_CD_FLAG_PLAY_AUDIO_OK },
2298 { "MATSHITADVD-ROM SR-8176", NULL, IDE_CD_FLAG_PLAY_AUDIO_OK },
2299 { "MATSHITADVD-ROM SR-8174", NULL, IDE_CD_FLAG_PLAY_AUDIO_OK },
2300 { NULL, NULL, 0 }
2301};
2302
2303static unsigned int ide_cd_flags(struct hd_driveid *id)
2304{
2305 const struct cd_list_entry *cle = ide_cd_quirks_list;
2306
2307 while (cle->id_model) {
2308 if (strcmp(cle->id_model, id->model) == 0 &&
2309 (cle->id_firmware == NULL ||
2310 strstr(id->fw_rev, cle->id_firmware)))
2311 return cle->cd_flags;
2312 cle++;
2313 }
2314
2315 return 0;
2316}
2317
Linus Torvalds1da177e2005-04-16 15:20:36 -07002318static
2319int ide_cdrom_setup (ide_drive_t *drive)
2320{
Bartlomiej Zolnierkiewicz4fe67172008-02-01 23:09:21 +01002321 struct cdrom_info *cd = drive->driver_data;
2322 struct cdrom_device_info *cdi = &cd->devinfo;
Bartlomiej Zolnierkiewicze59724c2008-02-01 23:09:22 +01002323 struct hd_driveid *id = drive->id;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002324 int nslots;
2325
2326 blk_queue_prep_rq(drive->queue, ide_cdrom_prep_fn);
2327 blk_queue_dma_alignment(drive->queue, 31);
2328 drive->queue->unplug_delay = (1 * HZ) / 1000;
2329 if (!drive->queue->unplug_delay)
2330 drive->queue->unplug_delay = 1;
2331
2332 drive->special.all = 0;
2333
Bartlomiej Zolnierkiewicze59724c2008-02-01 23:09:22 +01002334 cd->cd_flags = IDE_CD_FLAG_MEDIA_CHANGED | IDE_CD_FLAG_NO_EJECT |
2335 ide_cd_flags(id);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002336
Bartlomiej Zolnierkiewicze59724c2008-02-01 23:09:22 +01002337 if ((id->config & 0x0060) == 0x20)
Bartlomiej Zolnierkiewicz2bc4cf22008-02-01 23:09:22 +01002338 cd->cd_flags |= IDE_CD_FLAG_DRQ_INTERRUPT;
Bartlomiej Zolnierkiewiczb8d25de2008-02-01 23:09:19 +01002339
Bartlomiej Zolnierkiewicze59724c2008-02-01 23:09:22 +01002340 if ((cd->cd_flags & IDE_CD_FLAG_VERTOS_300_SSD) &&
2341 id->fw_rev[4] == '1' && id->fw_rev[6] <= '2')
Bartlomiej Zolnierkiewicz2bc4cf22008-02-01 23:09:22 +01002342 cd->cd_flags |= (IDE_CD_FLAG_TOCTRACKS_AS_BCD |
2343 IDE_CD_FLAG_TOCADDR_AS_BCD);
Bartlomiej Zolnierkiewicze59724c2008-02-01 23:09:22 +01002344 else if ((cd->cd_flags & IDE_CD_FLAG_VERTOS_600_ESD) &&
2345 id->fw_rev[4] == '1' && id->fw_rev[6] <= '2')
Bartlomiej Zolnierkiewicz2bc4cf22008-02-01 23:09:22 +01002346 cd->cd_flags |= IDE_CD_FLAG_TOCTRACKS_AS_BCD;
Bartlomiej Zolnierkiewicze59724c2008-02-01 23:09:22 +01002347 else if (cd->cd_flags & IDE_CD_FLAG_SANYO_3CD)
2348 cdi->sanyo_slot = 3; /* 3 => use CD in slot 0 */
Linus Torvalds1da177e2005-04-16 15:20:36 -07002349
Linus Torvalds1da177e2005-04-16 15:20:36 -07002350 nslots = ide_cdrom_probe_capabilities (drive);
2351
2352 /*
2353 * set correct block size
2354 */
2355 blk_queue_hardsect_size(drive->queue, CD_FRAMESIZE);
2356
2357 if (drive->autotune == IDE_TUNE_DEFAULT ||
2358 drive->autotune == IDE_TUNE_AUTO)
2359 drive->dsc_overlap = (drive->next != drive);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002360
2361 if (ide_cdrom_register(drive, nslots)) {
2362 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 +01002363 cd->devinfo.handle = NULL;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002364 return 1;
2365 }
2366 ide_cdrom_add_settings(drive);
2367 return 0;
2368}
2369
Bartlomiej Zolnierkiewiczecfd80e2007-05-10 00:01:09 +02002370#ifdef CONFIG_IDE_PROC_FS
Linus Torvalds1da177e2005-04-16 15:20:36 -07002371static
2372sector_t ide_cdrom_capacity (ide_drive_t *drive)
2373{
2374 unsigned long capacity, sectors_per_frame;
2375
2376 if (cdrom_read_capacity(drive, &capacity, &sectors_per_frame, NULL))
2377 return 0;
2378
2379 return capacity * sectors_per_frame;
2380}
Amos Waterlandd97b32142005-10-30 15:02:10 -08002381#endif
Linus Torvalds1da177e2005-04-16 15:20:36 -07002382
Russell King4031bbe2006-01-06 11:41:00 +00002383static void ide_cd_remove(ide_drive_t *drive)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002384{
2385 struct cdrom_info *info = drive->driver_data;
2386
Bartlomiej Zolnierkiewicz7662d042007-05-10 00:01:10 +02002387 ide_proc_unregister_driver(drive, info->driver);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002388
2389 del_gendisk(info->disk);
2390
2391 ide_cd_put(info);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002392}
2393
2394static void ide_cd_release(struct kref *kref)
2395{
2396 struct cdrom_info *info = to_ide_cd(kref);
2397 struct cdrom_device_info *devinfo = &info->devinfo;
2398 ide_drive_t *drive = info->drive;
2399 struct gendisk *g = info->disk;
2400
Jesper Juhl6044ec82005-11-07 01:01:32 -08002401 kfree(info->buffer);
2402 kfree(info->toc);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002403 if (devinfo->handle == drive && unregister_cdrom(devinfo))
2404 printk(KERN_ERR "%s: %s failed to unregister device from the cdrom "
2405 "driver.\n", __FUNCTION__, drive->name);
2406 drive->dsc_overlap = 0;
2407 drive->driver_data = NULL;
2408 blk_queue_prep_rq(drive->queue, NULL);
2409 g->private_data = NULL;
2410 put_disk(g);
2411 kfree(info);
2412}
2413
Russell King4031bbe2006-01-06 11:41:00 +00002414static int ide_cd_probe(ide_drive_t *);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002415
Bartlomiej Zolnierkiewiczecfd80e2007-05-10 00:01:09 +02002416#ifdef CONFIG_IDE_PROC_FS
Linus Torvalds1da177e2005-04-16 15:20:36 -07002417static int proc_idecd_read_capacity
2418 (char *page, char **start, off_t off, int count, int *eof, void *data)
2419{
Jesper Juhl2a91f3e2005-10-30 15:02:45 -08002420 ide_drive_t *drive = data;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002421 int len;
2422
2423 len = sprintf(page,"%llu\n", (long long)ide_cdrom_capacity(drive));
2424 PROC_IDE_READ_RETURN(page,start,off,count,eof,len);
2425}
2426
2427static ide_proc_entry_t idecd_proc[] = {
2428 { "capacity", S_IFREG|S_IRUGO, proc_idecd_read_capacity, NULL },
2429 { NULL, 0, NULL, NULL }
2430};
Linus Torvalds1da177e2005-04-16 15:20:36 -07002431#endif
2432
2433static ide_driver_t ide_cdrom_driver = {
Bartlomiej Zolnierkiewicz8604aff2005-05-26 14:55:34 +02002434 .gen_driver = {
Laurent Riffard4ef3b8f2005-11-18 22:15:40 +01002435 .owner = THIS_MODULE,
Bartlomiej Zolnierkiewicz8604aff2005-05-26 14:55:34 +02002436 .name = "ide-cdrom",
2437 .bus = &ide_bus_type,
Bartlomiej Zolnierkiewicz8604aff2005-05-26 14:55:34 +02002438 },
Russell King4031bbe2006-01-06 11:41:00 +00002439 .probe = ide_cd_probe,
2440 .remove = ide_cd_remove,
Linus Torvalds1da177e2005-04-16 15:20:36 -07002441 .version = IDECD_VERSION,
2442 .media = ide_cdrom,
Linus Torvalds1da177e2005-04-16 15:20:36 -07002443 .supports_dsc_overlap = 1,
Linus Torvalds1da177e2005-04-16 15:20:36 -07002444 .do_request = ide_do_rw_cdrom,
2445 .end_request = ide_end_request,
2446 .error = __ide_error,
2447 .abort = __ide_abort,
Bartlomiej Zolnierkiewicz7662d042007-05-10 00:01:10 +02002448#ifdef CONFIG_IDE_PROC_FS
Linus Torvalds1da177e2005-04-16 15:20:36 -07002449 .proc = idecd_proc,
Bartlomiej Zolnierkiewicz7662d042007-05-10 00:01:10 +02002450#endif
Linus Torvalds1da177e2005-04-16 15:20:36 -07002451};
2452
2453static int idecd_open(struct inode * inode, struct file * file)
2454{
2455 struct gendisk *disk = inode->i_bdev->bd_disk;
2456 struct cdrom_info *info;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002457 int rc = -ENOMEM;
2458
2459 if (!(info = ide_cd_get(disk)))
2460 return -ENXIO;
2461
Linus Torvalds1da177e2005-04-16 15:20:36 -07002462 if (!info->buffer)
Bartlomiej Zolnierkiewiczc94964a2007-02-17 02:40:24 +01002463 info->buffer = kmalloc(SECTOR_BUFFER_SIZE, GFP_KERNEL|__GFP_REPEAT);
2464
2465 if (info->buffer)
2466 rc = cdrom_open(&info->devinfo, inode, file);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002467
2468 if (rc < 0)
2469 ide_cd_put(info);
2470
2471 return rc;
2472}
2473
2474static int idecd_release(struct inode * inode, struct file * file)
2475{
2476 struct gendisk *disk = inode->i_bdev->bd_disk;
2477 struct cdrom_info *info = ide_cd_g(disk);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002478
2479 cdrom_release (&info->devinfo, file);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002480
2481 ide_cd_put(info);
2482
2483 return 0;
2484}
2485
Christoph Hellwig6a2900b2006-03-23 03:00:15 -08002486static int idecd_set_spindown(struct cdrom_device_info *cdi, unsigned long arg)
2487{
2488 struct packet_command cgc;
2489 char buffer[16];
2490 int stat;
2491 char spindown;
2492
2493 if (copy_from_user(&spindown, (void __user *)arg, sizeof(char)))
2494 return -EFAULT;
2495
2496 init_cdrom_command(&cgc, buffer, sizeof(buffer), CGC_DATA_UNKNOWN);
2497
2498 stat = cdrom_mode_sense(cdi, &cgc, GPMODE_CDROM_PAGE, 0);
2499 if (stat)
2500 return stat;
2501
2502 buffer[11] = (buffer[11] & 0xf0) | (spindown & 0x0f);
2503 return cdrom_mode_select(cdi, &cgc);
2504}
2505
2506static int idecd_get_spindown(struct cdrom_device_info *cdi, unsigned long arg)
2507{
2508 struct packet_command cgc;
2509 char buffer[16];
2510 int stat;
2511 char spindown;
2512
2513 init_cdrom_command(&cgc, buffer, sizeof(buffer), CGC_DATA_UNKNOWN);
2514
2515 stat = cdrom_mode_sense(cdi, &cgc, GPMODE_CDROM_PAGE, 0);
2516 if (stat)
2517 return stat;
2518
2519 spindown = buffer[11] & 0x0f;
2520 if (copy_to_user((void __user *)arg, &spindown, sizeof (char)))
2521 return -EFAULT;
2522 return 0;
2523}
2524
Linus Torvalds1da177e2005-04-16 15:20:36 -07002525static int idecd_ioctl (struct inode *inode, struct file *file,
2526 unsigned int cmd, unsigned long arg)
2527{
2528 struct block_device *bdev = inode->i_bdev;
2529 struct cdrom_info *info = ide_cd_g(bdev->bd_disk);
2530 int err;
2531
Christoph Hellwig6a2900b2006-03-23 03:00:15 -08002532 switch (cmd) {
2533 case CDROMSETSPINDOWN:
2534 return idecd_set_spindown(&info->devinfo, arg);
2535 case CDROMGETSPINDOWN:
2536 return idecd_get_spindown(&info->devinfo, arg);
2537 default:
2538 break;
2539 }
2540
2541 err = generic_ide_ioctl(info->drive, file, bdev, cmd, arg);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002542 if (err == -EINVAL)
2543 err = cdrom_ioctl(file, &info->devinfo, inode, cmd, arg);
2544
2545 return err;
2546}
2547
2548static int idecd_media_changed(struct gendisk *disk)
2549{
2550 struct cdrom_info *info = ide_cd_g(disk);
2551 return cdrom_media_changed(&info->devinfo);
2552}
2553
2554static int idecd_revalidate_disk(struct gendisk *disk)
2555{
2556 struct cdrom_info *info = ide_cd_g(disk);
2557 struct request_sense sense;
Bartlomiej Zolnierkiewicz139c8292008-02-01 23:09:24 +01002558
2559 ide_cd_read_toc(info->drive, &sense);
2560
Linus Torvalds1da177e2005-04-16 15:20:36 -07002561 return 0;
2562}
2563
2564static struct block_device_operations idecd_ops = {
2565 .owner = THIS_MODULE,
2566 .open = idecd_open,
2567 .release = idecd_release,
2568 .ioctl = idecd_ioctl,
2569 .media_changed = idecd_media_changed,
2570 .revalidate_disk= idecd_revalidate_disk
2571};
2572
2573/* options */
2574static char *ignore = NULL;
2575
2576module_param(ignore, charp, 0400);
2577MODULE_DESCRIPTION("ATAPI CD-ROM Driver");
2578
Russell King4031bbe2006-01-06 11:41:00 +00002579static int ide_cd_probe(ide_drive_t *drive)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002580{
2581 struct cdrom_info *info;
2582 struct gendisk *g;
2583 struct request_sense sense;
2584
2585 if (!strstr("ide-cdrom", drive->driver_req))
2586 goto failed;
2587 if (!drive->present)
2588 goto failed;
2589 if (drive->media != ide_cdrom && drive->media != ide_optical)
2590 goto failed;
2591 /* skip drives that we were told to ignore */
2592 if (ignore != NULL) {
2593 if (strstr(ignore, drive->name)) {
2594 printk(KERN_INFO "ide-cd: ignoring drive %s\n", drive->name);
2595 goto failed;
2596 }
2597 }
2598 if (drive->scsi) {
2599 printk(KERN_INFO "ide-cd: passing drive %s to ide-scsi emulation.\n", drive->name);
2600 goto failed;
2601 }
Deepak Saxenaf5e3c2f2005-11-07 01:01:25 -08002602 info = kzalloc(sizeof(struct cdrom_info), GFP_KERNEL);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002603 if (info == NULL) {
2604 printk(KERN_ERR "%s: Can't allocate a cdrom structure\n", drive->name);
2605 goto failed;
2606 }
2607
2608 g = alloc_disk(1 << PARTN_BITS);
2609 if (!g)
2610 goto out_free_cd;
2611
2612 ide_init_disk(g, drive);
2613
Bartlomiej Zolnierkiewicz7662d042007-05-10 00:01:10 +02002614 ide_proc_register_driver(drive, &ide_cdrom_driver);
Bartlomiej Zolnierkiewicz8604aff2005-05-26 14:55:34 +02002615
Linus Torvalds1da177e2005-04-16 15:20:36 -07002616 kref_init(&info->kref);
2617
2618 info->drive = drive;
2619 info->driver = &ide_cdrom_driver;
2620 info->disk = g;
2621
2622 g->private_data = &info->driver;
2623
2624 drive->driver_data = info;
2625
Linus Torvalds1da177e2005-04-16 15:20:36 -07002626 g->minors = 1;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002627 g->driverfs_dev = &drive->gendev;
2628 g->flags = GENHD_FL_CD | GENHD_FL_REMOVABLE;
2629 if (ide_cdrom_setup(drive)) {
Bartlomiej Zolnierkiewicz7662d042007-05-10 00:01:10 +02002630 ide_proc_unregister_driver(drive, &ide_cdrom_driver);
Bartlomiej Zolnierkiewicz05017db2007-12-24 15:23:43 +01002631 ide_cd_release(&info->kref);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002632 goto failed;
2633 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07002634
Bartlomiej Zolnierkiewicz139c8292008-02-01 23:09:24 +01002635 ide_cd_read_toc(drive, &sense);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002636 g->fops = &idecd_ops;
2637 g->flags |= GENHD_FL_REMOVABLE;
2638 add_disk(g);
2639 return 0;
2640
Linus Torvalds1da177e2005-04-16 15:20:36 -07002641out_free_cd:
2642 kfree(info);
2643failed:
Bartlomiej Zolnierkiewicz8604aff2005-05-26 14:55:34 +02002644 return -ENODEV;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002645}
2646
2647static void __exit ide_cdrom_exit(void)
2648{
Bartlomiej Zolnierkiewicz8604aff2005-05-26 14:55:34 +02002649 driver_unregister(&ide_cdrom_driver.gen_driver);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002650}
Bartlomiej Zolnierkiewicz17514e82005-11-19 22:24:35 +01002651
2652static int __init ide_cdrom_init(void)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002653{
Bartlomiej Zolnierkiewicz8604aff2005-05-26 14:55:34 +02002654 return driver_register(&ide_cdrom_driver.gen_driver);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002655}
2656
Kay Sievers263756e2005-12-12 18:03:44 +01002657MODULE_ALIAS("ide:*m-cdrom*");
Bartlomiej Zolnierkiewicz972560f2008-02-01 23:09:23 +01002658MODULE_ALIAS("ide-cd");
Linus Torvalds1da177e2005-04-16 15:20:36 -07002659module_init(ide_cdrom_init);
2660module_exit(ide_cdrom_exit);
2661MODULE_LICENSE("GPL");