blob: 9d2e458250ba18054f6a727cc60e1c181a8014f5 [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
Bartlomiej Zolnierkiewicz0d6f7e32008-02-01 23:09:28 +0100686int ide_cd_check_ireason(ide_drive_t *drive, int len, int ireason, int rw)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700687{
Bartlomiej Zolnierkiewicz0d6f7e32008-02-01 23:09:28 +0100688 /*
689 * ireason == 0: the drive wants to receive data from us
690 * ireason == 2: the drive is expecting to transfer data to us
691 */
692 if (ireason == (!rw << 1))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700693 return 0;
Bartlomiej Zolnierkiewicz0d6f7e32008-02-01 23:09:28 +0100694 else if (ireason == (rw << 1)) {
Bartlomiej Zolnierkiewicz5a5222d2008-02-01 23:09:17 +0100695 ide_hwif_t *hwif = drive->hwif;
Bartlomiej Zolnierkiewicz0d6f7e32008-02-01 23:09:28 +0100696 xfer_func_t *xf;
Bartlomiej Zolnierkiewicz5a5222d2008-02-01 23:09:17 +0100697
Bartlomiej Zolnierkiewicz0d6f7e32008-02-01 23:09:28 +0100698 /* Whoops... */
Bartlomiej Zolnierkiewicz35379c02007-12-24 15:23:43 +0100699 printk(KERN_ERR "%s: %s: wrong transfer direction!\n",
700 drive->name, __FUNCTION__);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700701
Bartlomiej Zolnierkiewicz0d6f7e32008-02-01 23:09:28 +0100702 xf = rw ? hwif->atapi_output_bytes : hwif->atapi_input_bytes;
703 ide_cd_pad_transfer(drive, xf, len);
704 } else if (rw == 0 && ireason == 1) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700705 /* Some drives (ASUS) seem to tell us that status
706 * info is available. just get it and ignore.
707 */
708 (void) HWIF(drive)->INB(IDE_STATUS_REG);
709 return 0;
710 } else {
711 /* Drive wants a command packet, or invalid ireason... */
Bartlomiej Zolnierkiewicz35379c02007-12-24 15:23:43 +0100712 printk(KERN_ERR "%s: %s: bad interrupt reason 0x%02x\n",
713 drive->name, __FUNCTION__, ireason);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700714 }
715
716 cdrom_end_request(drive, 0);
717 return -1;
718}
719
720/*
Bartlomiej Zolnierkiewicz64814f22008-02-01 23:09:26 +0100721 * Assume that the drive will always provide data in multiples of at least
722 * SECTOR_SIZE, as it gets hairy to keep track of the transfers otherwise.
723 */
724static int ide_cd_check_transfer_size(ide_drive_t *drive, int len)
725{
726 struct cdrom_info *cd = drive->driver_data;
727
728 if ((len % SECTOR_SIZE) == 0)
729 return 0;
730
731 printk(KERN_ERR "%s: %s: Bad transfer size %d\n",
732 drive->name, __FUNCTION__, len);
733
734 if (cd->cd_flags & IDE_CD_FLAG_LIMIT_NFRAMES)
735 printk(KERN_ERR " This drive is not supported by "
736 "this version of the driver\n");
737 else {
738 printk(KERN_ERR " Trying to limit transfer sizes\n");
739 cd->cd_flags |= IDE_CD_FLAG_LIMIT_NFRAMES;
740 }
741
742 return 1;
743}
744
745/*
Linus Torvalds1da177e2005-04-16 15:20:36 -0700746 * Try to satisfy some of the current read request from our cached data.
747 * Returns nonzero if the request has been completed, zero otherwise.
748 */
749static int cdrom_read_from_buffer (ide_drive_t *drive)
750{
751 struct cdrom_info *info = drive->driver_data;
752 struct request *rq = HWGROUP(drive)->rq;
753 unsigned short sectors_per_frame;
754
755 sectors_per_frame = queue_hardsect_size(drive->queue) >> SECTOR_BITS;
756
757 /* Can't do anything if there's no buffer. */
758 if (info->buffer == NULL) return 0;
759
760 /* Loop while this request needs data and the next block is present
761 in our cache. */
762 while (rq->nr_sectors > 0 &&
763 rq->sector >= info->sector_buffered &&
764 rq->sector < info->sector_buffered + info->nsectors_buffered) {
765 if (rq->current_nr_sectors == 0)
766 cdrom_end_request(drive, 1);
767
768 memcpy (rq->buffer,
769 info->buffer +
770 (rq->sector - info->sector_buffered) * SECTOR_SIZE,
771 SECTOR_SIZE);
772 rq->buffer += SECTOR_SIZE;
773 --rq->current_nr_sectors;
774 --rq->nr_sectors;
775 ++rq->sector;
776 }
777
778 /* If we've satisfied the current request,
779 terminate it successfully. */
780 if (rq->nr_sectors == 0) {
781 cdrom_end_request(drive, 1);
782 return -1;
783 }
784
785 /* Move on to the next buffer if needed. */
786 if (rq->current_nr_sectors == 0)
787 cdrom_end_request(drive, 1);
788
789 /* If this condition does not hold, then the kluge i use to
790 represent the number of sectors to skip at the start of a transfer
791 will fail. I think that this will never happen, but let's be
792 paranoid and check. */
793 if (rq->current_nr_sectors < bio_cur_sectors(rq->bio) &&
794 (rq->sector & (sectors_per_frame - 1))) {
795 printk(KERN_ERR "%s: cdrom_read_from_buffer: buffer botch (%ld)\n",
796 drive->name, (long)rq->sector);
797 cdrom_end_request(drive, 0);
798 return -1;
799 }
800
801 return 0;
802}
803
Bartlomiej Zolnierkiewicz0041e7c2008-02-01 23:09:28 +0100804static ide_startstop_t cdrom_newpc_intr(ide_drive_t *);
Bartlomiej Zolnierkiewicz94f5a862008-02-01 23:09:26 +0100805
Linus Torvalds1da177e2005-04-16 15:20:36 -0700806/*
Bartlomiej Zolnierkiewicz29f3aac2008-02-01 23:09:27 +0100807 * Routine to send a read/write packet command to the drive.
808 * This is usually called directly from cdrom_start_{read,write}().
Linus Torvalds1da177e2005-04-16 15:20:36 -0700809 * However, for drq_interrupt devices, it is called from an interrupt
810 * when the drive is ready to accept the command.
811 */
Bartlomiej Zolnierkiewicz29f3aac2008-02-01 23:09:27 +0100812static ide_startstop_t cdrom_start_rw_cont(ide_drive_t *drive)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700813{
814 struct request *rq = HWGROUP(drive)->rq;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700815
Bartlomiej Zolnierkiewicz29f3aac2008-02-01 23:09:27 +0100816 if (rq_data_dir(rq) == READ) {
817 unsigned short sectors_per_frame =
818 queue_hardsect_size(drive->queue) >> SECTOR_BITS;
819 int nskip = rq->sector & (sectors_per_frame - 1);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700820
Bartlomiej Zolnierkiewicz29f3aac2008-02-01 23:09:27 +0100821 /*
822 * If the requested sector doesn't start on a frame boundary,
823 * we must adjust the start of the transfer so that it does,
824 * and remember to skip the first few sectors.
825 *
826 * If the rq->current_nr_sectors field is larger than the size
827 * of the buffer, it will mean that we're to skip a number of
828 * sectors equal to the amount by which rq->current_nr_sectors
829 * is larger than the buffer size.
830 */
831 if (nskip > 0) {
832 /* Sanity check... */
833 if (rq->current_nr_sectors !=
834 bio_cur_sectors(rq->bio)) {
835 printk(KERN_ERR "%s: %s: buffer botch (%u)\n",
836 drive->name, __FUNCTION__,
837 rq->current_nr_sectors);
838 cdrom_end_request(drive, 0);
839 return ide_stopped;
840 }
841 rq->current_nr_sectors += nskip;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700842 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700843 }
Bartlomiej Zolnierkiewicz29f3aac2008-02-01 23:09:27 +0100844#if 0
845 else
846 /* the immediate bit */
847 rq->cmd[1] = 1 << 3;
848#endif
Linus Torvalds1da177e2005-04-16 15:20:36 -0700849 /* Set up the command */
850 rq->timeout = ATAPI_WAIT_PC;
851
852 /* Send the command to the drive and return. */
Bartlomiej Zolnierkiewicz0041e7c2008-02-01 23:09:28 +0100853 return cdrom_transfer_packet_command(drive, rq, cdrom_newpc_intr);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700854}
855
Linus Torvalds1da177e2005-04-16 15:20:36 -0700856#define IDECD_SEEK_THRESHOLD (1000) /* 1000 blocks */
857#define IDECD_SEEK_TIMER (5 * WAIT_MIN_SLEEP) /* 100 ms */
858#define IDECD_SEEK_TIMEOUT (2 * WAIT_CMD) /* 20 sec */
859
860static ide_startstop_t cdrom_seek_intr (ide_drive_t *drive)
861{
862 struct cdrom_info *info = drive->driver_data;
863 int stat;
864 static int retry = 10;
865
866 if (cdrom_decode_status(drive, 0, &stat))
867 return ide_stopped;
Bartlomiej Zolnierkiewicz4fe67172008-02-01 23:09:21 +0100868
Bartlomiej Zolnierkiewicz2bc4cf22008-02-01 23:09:22 +0100869 info->cd_flags |= IDE_CD_FLAG_SEEKING;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700870
871 if (retry && time_after(jiffies, info->start_seek + IDECD_SEEK_TIMER)) {
872 if (--retry == 0) {
873 /*
874 * this condition is far too common, to bother
875 * users about it
876 */
877 /* printk("%s: disabled DSC seek overlap\n", drive->name);*/
878 drive->dsc_overlap = 0;
879 }
880 }
881 return ide_stopped;
882}
883
884static ide_startstop_t cdrom_start_seek_continuation (ide_drive_t *drive)
885{
886 struct request *rq = HWGROUP(drive)->rq;
887 sector_t frame = rq->sector;
888
889 sector_div(frame, queue_hardsect_size(drive->queue) >> SECTOR_BITS);
890
891 memset(rq->cmd, 0, sizeof(rq->cmd));
892 rq->cmd[0] = GPCMD_SEEK;
893 put_unaligned(cpu_to_be32(frame), (unsigned int *) &rq->cmd[2]);
894
895 rq->timeout = ATAPI_WAIT_PC;
896 return cdrom_transfer_packet_command(drive, rq, &cdrom_seek_intr);
897}
898
899static ide_startstop_t cdrom_start_seek (ide_drive_t *drive, unsigned int block)
900{
901 struct cdrom_info *info = drive->driver_data;
902
903 info->dma = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700904 info->start_seek = jiffies;
905 return cdrom_start_packet_command(drive, 0, cdrom_start_seek_continuation);
906}
907
908/* Fix up a possibly partially-processed request so that we can
909 start it over entirely, or even put it back on the request queue. */
910static void restore_request (struct request *rq)
911{
912 if (rq->buffer != bio_data(rq->bio)) {
913 sector_t n = (rq->buffer - (char *) bio_data(rq->bio)) / SECTOR_SIZE;
914
915 rq->buffer = bio_data(rq->bio);
916 rq->nr_sectors += n;
917 rq->sector -= n;
918 }
919 rq->hard_cur_sectors = rq->current_nr_sectors = bio_cur_sectors(rq->bio);
920 rq->hard_nr_sectors = rq->nr_sectors;
921 rq->hard_sector = rq->sector;
922 rq->q->prep_rq_fn(rq->q, rq);
923}
924
Linus Torvalds1da177e2005-04-16 15:20:36 -0700925/****************************************************************************
926 * Execute all other packet commands.
927 */
928
Bartlomiej Zolnierkiewicz8ee69f52008-02-01 23:09:25 +0100929static void ide_cd_request_sense_fixup(struct request *rq)
930{
931 /*
932 * Some of the trailing request sense fields are optional,
933 * and some drives don't send them. Sigh.
934 */
935 if (rq->cmd[0] == GPCMD_REQUEST_SENSE &&
936 rq->data_len > 0 && rq->data_len <= 5)
937 while (rq->data_len > 0) {
938 *(u8 *)rq->data++ = 0;
939 --rq->data_len;
940 }
941}
942
Bartlomiej Zolnierkiewicz17802992008-02-01 23:09:25 +0100943int ide_cd_queue_pc(ide_drive_t *drive, struct request *rq)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700944{
945 struct request_sense sense;
946 int retries = 10;
Jens Axboe4aff5e22006-08-10 08:44:47 +0200947 unsigned int flags = rq->cmd_flags;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700948
949 if (rq->sense == NULL)
950 rq->sense = &sense;
951
952 /* Start of retry loop. */
953 do {
954 int error;
955 unsigned long time = jiffies;
Jens Axboe4aff5e22006-08-10 08:44:47 +0200956 rq->cmd_flags = flags;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700957
958 error = ide_do_drive_cmd(drive, rq, ide_wait);
959 time = jiffies - time;
960
961 /* FIXME: we should probably abort/retry or something
962 * in case of failure */
Jens Axboe4aff5e22006-08-10 08:44:47 +0200963 if (rq->cmd_flags & REQ_FAILED) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700964 /* The request failed. Retry if it was due to a unit
965 attention status
966 (usually means media was changed). */
967 struct request_sense *reqbuf = rq->sense;
968
969 if (reqbuf->sense_key == UNIT_ATTENTION)
970 cdrom_saw_media_change(drive);
971 else if (reqbuf->sense_key == NOT_READY &&
972 reqbuf->asc == 4 && reqbuf->ascq != 4) {
973 /* The drive is in the process of loading
974 a disk. Retry, but wait a little to give
975 the drive time to complete the load. */
976 ssleep(2);
977 } else {
978 /* Otherwise, don't retry. */
979 retries = 0;
980 }
981 --retries;
982 }
983
984 /* End of retry loop. */
Jens Axboe4aff5e22006-08-10 08:44:47 +0200985 } while ((rq->cmd_flags & REQ_FAILED) && retries >= 0);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700986
987 /* Return an error if the command failed. */
Jens Axboe4aff5e22006-08-10 08:44:47 +0200988 return (rq->cmd_flags & REQ_FAILED) ? -EIO : 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700989}
990
991/*
Kiyoshi Uedaaaa04c22007-12-11 17:51:23 -0500992 * Called from blk_end_request_callback() after the data of the request
993 * is completed and before the request is completed.
994 * By returning value '1', blk_end_request_callback() returns immediately
995 * without completing the request.
996 */
997static int cdrom_newpc_intr_dummy_cb(struct request *rq)
998{
999 return 1;
1000}
1001
Linus Torvalds1da177e2005-04-16 15:20:36 -07001002static ide_startstop_t cdrom_newpc_intr(ide_drive_t *drive)
1003{
1004 struct cdrom_info *info = drive->driver_data;
1005 struct request *rq = HWGROUP(drive)->rq;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001006 xfer_func_t *xferfunc;
Bartlomiej Zolnierkiewicz0041e7c2008-02-01 23:09:28 +01001007 ide_expiry_t *expiry = NULL;
Bartlomiej Zolnierkiewiczff1bfbc12008-02-01 23:09:25 +01001008 int dma_error = 0, dma, stat, ireason, len, thislen, uptodate = 0;
1009 int write = (rq_data_dir(rq) == WRITE) ? 1 : 0;
1010 unsigned int timeout;
1011 u8 lowcyl, highcyl;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001012
1013 /* Check for errors. */
Linus Torvalds1da177e2005-04-16 15:20:36 -07001014 dma = info->dma;
1015 if (dma) {
1016 info->dma = 0;
1017 dma_error = HWIF(drive)->ide_dma_end(drive);
Bartlomiej Zolnierkiewiczeba15fb2008-02-01 23:09:17 +01001018 if (dma_error) {
1019 printk(KERN_ERR "%s: DMA %s error\n", drive->name,
Bartlomiej Zolnierkiewiczff1bfbc12008-02-01 23:09:25 +01001020 write ? "write" : "read");
Bartlomiej Zolnierkiewiczeba15fb2008-02-01 23:09:17 +01001021 ide_dma_off(drive);
1022 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001023 }
1024
1025 if (cdrom_decode_status(drive, 0, &stat))
1026 return ide_stopped;
1027
1028 /*
1029 * using dma, transfer is complete now
1030 */
1031 if (dma) {
Bartlomiej Zolnierkiewiczeba15fb2008-02-01 23:09:17 +01001032 if (dma_error)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001033 return ide_error(drive, "dma error", stat);
Bartlomiej Zolnierkiewicz0041e7c2008-02-01 23:09:28 +01001034 if (blk_fs_request(rq)) {
1035 ide_end_request(drive, 1, rq->nr_sectors);
1036 return ide_stopped;
1037 }
Bartlomiej Zolnierkiewiczff1bfbc12008-02-01 23:09:25 +01001038 goto end_request;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001039 }
1040
1041 /*
1042 * ok we fall to pio :/
1043 */
1044 ireason = HWIF(drive)->INB(IDE_IREASON_REG) & 0x3;
1045 lowcyl = HWIF(drive)->INB(IDE_BCOUNTL_REG);
1046 highcyl = HWIF(drive)->INB(IDE_BCOUNTH_REG);
1047
1048 len = lowcyl + (256 * highcyl);
Bartlomiej Zolnierkiewicz0041e7c2008-02-01 23:09:28 +01001049
1050 thislen = blk_fs_request(rq) ? len : rq->data_len;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001051 if (thislen > len)
1052 thislen = len;
1053
1054 /*
1055 * If DRQ is clear, the command has completed.
1056 */
Kiyoshi Uedaaaa04c22007-12-11 17:51:23 -05001057 if ((stat & DRQ_STAT) == 0) {
Bartlomiej Zolnierkiewicz0041e7c2008-02-01 23:09:28 +01001058 if (blk_fs_request(rq)) {
1059 /*
1060 * If we're not done reading/writing, complain.
1061 * Otherwise, complete the command normally.
1062 */
1063 uptodate = 1;
1064 if (rq->current_nr_sectors > 0) {
1065 printk(KERN_ERR "%s: %s: data underrun "
1066 "(%d blocks)\n",
1067 drive->name, __FUNCTION__,
1068 rq->current_nr_sectors);
1069 if (!write)
1070 rq->cmd_flags |= REQ_FAILED;
1071 uptodate = 0;
1072 }
1073 cdrom_end_request(drive, uptodate);
1074 return ide_stopped;
1075 } else if (!blk_pc_request(rq)) {
Bartlomiej Zolnierkiewiczff1bfbc12008-02-01 23:09:25 +01001076 ide_cd_request_sense_fixup(rq);
1077 /* Complain if we still have data left to transfer. */
1078 uptodate = rq->data_len ? 0 : 1;
1079 }
1080 goto end_request;
Kiyoshi Uedaaaa04c22007-12-11 17:51:23 -05001081 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001082
1083 /*
1084 * check which way to transfer data
1085 */
Bartlomiej Zolnierkiewicz0d6f7e32008-02-01 23:09:28 +01001086 if (blk_fs_request(rq) || blk_pc_request(rq)) {
1087 if (ide_cd_check_ireason(drive, len, ireason, write))
Linus Torvalds1da177e2005-04-16 15:20:36 -07001088 return ide_stopped;
Bartlomiej Zolnierkiewicz0041e7c2008-02-01 23:09:28 +01001089
Bartlomiej Zolnierkiewicz0d6f7e32008-02-01 23:09:28 +01001090 if (blk_fs_request(rq) && write == 0) {
Bartlomiej Zolnierkiewicz0041e7c2008-02-01 23:09:28 +01001091 int nskip;
1092
1093 if (ide_cd_check_transfer_size(drive, len)) {
1094 cdrom_end_request(drive, 0);
1095 return ide_stopped;
1096 }
1097
1098 /*
1099 * First, figure out if we need to bit-bucket
1100 * any of the leading sectors.
1101 */
1102 nskip = min_t(int, rq->current_nr_sectors
1103 - bio_cur_sectors(rq->bio),
1104 thislen >> 9);
1105 if (nskip > 0) {
1106 ide_cd_drain_data(drive, nskip);
1107 rq->current_nr_sectors -= nskip;
1108 thislen -= (nskip << 9);
1109 }
1110 }
Bartlomiej Zolnierkiewiczff1bfbc12008-02-01 23:09:25 +01001111 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001112
Bartlomiej Zolnierkiewiczff1bfbc12008-02-01 23:09:25 +01001113 if (ireason == 0) {
1114 write = 1;
1115 xferfunc = HWIF(drive)->atapi_output_bytes;
Bartlomiej Zolnierkiewicz0041e7c2008-02-01 23:09:28 +01001116 } else if (ireason == 2 || (ireason == 1 &&
1117 (blk_fs_request(rq) || blk_pc_request(rq)))) {
Bartlomiej Zolnierkiewiczff1bfbc12008-02-01 23:09:25 +01001118 write = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001119 xferfunc = HWIF(drive)->atapi_input_bytes;
Bartlomiej Zolnierkiewiczff1bfbc12008-02-01 23:09:25 +01001120 } else {
1121 printk(KERN_ERR "%s: %s: The drive "
1122 "appears confused (ireason = 0x%02x). "
1123 "Trying to recover by ending request.\n",
1124 drive->name, __FUNCTION__, ireason);
1125 goto end_request;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001126 }
1127
1128 /*
1129 * transfer data
1130 */
1131 while (thislen > 0) {
Bartlomiej Zolnierkiewicz0041e7c2008-02-01 23:09:28 +01001132 u8 *ptr = blk_fs_request(rq) ? NULL : rq->data;
Bartlomiej Zolnierkiewicza11e77d2008-02-01 23:09:27 +01001133 int blen = rq->data_len;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001134
1135 /*
1136 * bio backed?
1137 */
1138 if (rq->bio) {
Bartlomiej Zolnierkiewicz0041e7c2008-02-01 23:09:28 +01001139 if (blk_fs_request(rq)) {
1140 ptr = rq->buffer;
1141 blen = rq->current_nr_sectors << 9;
1142 } else {
1143 ptr = bio_data(rq->bio);
1144 blen = bio_iovec(rq->bio)->bv_len;
1145 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001146 }
1147
1148 if (!ptr) {
Bartlomiej Zolnierkiewicz0041e7c2008-02-01 23:09:28 +01001149 if (blk_fs_request(rq) && !write)
1150 /*
1151 * If the buffers are full, cache the rest
1152 * of the data in our internal buffer.
1153 */
1154 cdrom_buffer_sectors(drive, rq->sector,
1155 thislen >> 9);
1156 else {
1157 printk(KERN_ERR "%s: confused, missing data\n",
1158 drive->name);
1159 blk_dump_rq_flags(rq, rq_data_dir(rq)
1160 ? "cdrom_newpc_intr, write"
1161 : "cdrom_newpc_intr, read");
1162 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001163 break;
1164 }
1165
1166 if (blen > thislen)
1167 blen = thislen;
1168
1169 xferfunc(drive, ptr, blen);
1170
1171 thislen -= blen;
1172 len -= blen;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001173
Bartlomiej Zolnierkiewicz0041e7c2008-02-01 23:09:28 +01001174 if (blk_fs_request(rq)) {
1175 rq->buffer += blen;
1176 rq->nr_sectors -= (blen >> 9);
1177 rq->current_nr_sectors -= (blen >> 9);
1178 rq->sector += (blen >> 9);
1179
1180 if (rq->current_nr_sectors == 0 && rq->nr_sectors)
1181 cdrom_end_request(drive, 1);
1182 } else {
1183 rq->data_len -= blen;
1184
Kiyoshi Uedaaaa04c22007-12-11 17:51:23 -05001185 /*
1186 * The request can't be completed until DRQ is cleared.
1187 * So complete the data, but don't complete the request
1188 * using the dummy function for the callback feature
1189 * of blk_end_request_callback().
1190 */
Bartlomiej Zolnierkiewicz0041e7c2008-02-01 23:09:28 +01001191 if (rq->bio)
1192 blk_end_request_callback(rq, 0, blen,
Kiyoshi Uedaaaa04c22007-12-11 17:51:23 -05001193 cdrom_newpc_intr_dummy_cb);
Bartlomiej Zolnierkiewicz0041e7c2008-02-01 23:09:28 +01001194 else
1195 rq->data += blen;
1196 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001197 }
1198
Bartlomiej Zolnierkiewiczff1bfbc12008-02-01 23:09:25 +01001199 if (write && blk_sense_request(rq))
1200 rq->sense_len += thislen;
1201
Linus Torvalds1da177e2005-04-16 15:20:36 -07001202 /*
1203 * pad, if necessary
1204 */
Bartlomiej Zolnierkiewicz0041e7c2008-02-01 23:09:28 +01001205 if (!blk_fs_request(rq) && len > 0)
Bartlomiej Zolnierkiewicz5a5222d2008-02-01 23:09:17 +01001206 ide_cd_pad_transfer(drive, xferfunc, len);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001207
Bartlomiej Zolnierkiewiczff1bfbc12008-02-01 23:09:25 +01001208 if (blk_pc_request(rq)) {
1209 timeout = rq->timeout;
Bartlomiej Zolnierkiewiczff1bfbc12008-02-01 23:09:25 +01001210 } else {
1211 timeout = ATAPI_WAIT_PC;
Bartlomiej Zolnierkiewicz0041e7c2008-02-01 23:09:28 +01001212 if (!blk_fs_request(rq))
1213 expiry = cdrom_timer_expiry;
Bartlomiej Zolnierkiewiczff1bfbc12008-02-01 23:09:25 +01001214 }
1215
1216 ide_set_handler(drive, cdrom_newpc_intr, timeout, expiry);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001217 return ide_started;
Bartlomiej Zolnierkiewiczff1bfbc12008-02-01 23:09:25 +01001218
1219end_request:
1220 if (blk_pc_request(rq)) {
1221 unsigned long flags;
1222
1223 spin_lock_irqsave(&ide_lock, flags);
1224 if (__blk_end_request(rq, 0, rq->data_len))
1225 BUG();
1226 HWGROUP(drive)->rq = NULL;
1227 spin_unlock_irqrestore(&ide_lock, flags);
1228 } else {
1229 if (!uptodate)
1230 rq->cmd_flags |= REQ_FAILED;
1231 cdrom_end_request(drive, uptodate);
1232 }
1233 return ide_stopped;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001234}
1235
Bartlomiej Zolnierkiewicz21ea1f02008-02-01 23:09:27 +01001236static ide_startstop_t cdrom_start_rw(ide_drive_t *drive, struct request *rq)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001237{
Bartlomiej Zolnierkiewicz21ea1f02008-02-01 23:09:27 +01001238 struct cdrom_info *cd = drive->driver_data;
1239 int write = rq_data_dir(rq) == WRITE;
1240 unsigned short sectors_per_frame =
1241 queue_hardsect_size(drive->queue) >> SECTOR_BITS;
1242
1243 if (write) {
1244 /*
1245 * disk has become write protected
1246 */
1247 if (cd->disk->policy) {
1248 cdrom_end_request(drive, 0);
1249 return ide_stopped;
1250 }
1251 } else {
1252 /*
1253 * We may be retrying this request after an error. Fix up any
1254 * weirdness which might be present in the request packet.
1255 */
1256 restore_request(rq);
1257
1258 /* Satisfy whatever we can of this request from our cache. */
1259 if (cdrom_read_from_buffer(drive))
1260 return ide_stopped;
1261 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001262
1263 /*
Bartlomiej Zolnierkiewicz21ea1f02008-02-01 23:09:27 +01001264 * use DMA, if possible / writes *must* be hardware frame aligned
Linus Torvalds1da177e2005-04-16 15:20:36 -07001265 */
1266 if ((rq->nr_sectors & (sectors_per_frame - 1)) ||
1267 (rq->sector & (sectors_per_frame - 1))) {
Bartlomiej Zolnierkiewicz21ea1f02008-02-01 23:09:27 +01001268 if (write) {
1269 cdrom_end_request(drive, 0);
1270 return ide_stopped;
1271 }
1272 cd->dma = 0;
1273 } else
1274 cd->dma = drive->using_dma;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001275
Bartlomiej Zolnierkiewicz21ea1f02008-02-01 23:09:27 +01001276 /* Clear the local sector buffer. */
1277 cd->nsectors_buffered = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001278
Bartlomiej Zolnierkiewicz21ea1f02008-02-01 23:09:27 +01001279 if (write)
1280 cd->devinfo.media_written = 1;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001281
Bartlomiej Zolnierkiewicz21ea1f02008-02-01 23:09:27 +01001282 /* Start sending the read/write request to the drive. */
Bartlomiej Zolnierkiewicz29f3aac2008-02-01 23:09:27 +01001283 return cdrom_start_packet_command(drive, 32768, cdrom_start_rw_cont);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001284}
1285
1286static ide_startstop_t cdrom_do_newpc_cont(ide_drive_t *drive)
1287{
1288 struct request *rq = HWGROUP(drive)->rq;
1289
1290 if (!rq->timeout)
1291 rq->timeout = ATAPI_WAIT_PC;
1292
1293 return cdrom_transfer_packet_command(drive, rq, cdrom_newpc_intr);
1294}
1295
1296static ide_startstop_t cdrom_do_block_pc(ide_drive_t *drive, struct request *rq)
1297{
1298 struct cdrom_info *info = drive->driver_data;
1299
Bartlomiej Zolnierkiewiczc9f56a82008-02-01 23:09:26 +01001300 if (blk_pc_request(rq))
1301 rq->cmd_flags |= REQ_QUIET;
1302 else
1303 rq->cmd_flags &= ~REQ_FAILED;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001304
1305 info->dma = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001306
1307 /*
1308 * sg request
1309 */
1310 if (rq->bio) {
1311 int mask = drive->queue->dma_alignment;
1312 unsigned long addr = (unsigned long) page_address(bio_page(rq->bio));
1313
Linus Torvalds1da177e2005-04-16 15:20:36 -07001314 info->dma = drive->using_dma;
1315
1316 /*
1317 * check if dma is safe
Linus Torvalds5d9e4ea2005-05-27 07:36:17 -07001318 *
1319 * NOTE! The "len" and "addr" checks should possibly have
1320 * separate masks.
Linus Torvalds1da177e2005-04-16 15:20:36 -07001321 */
Jens Axboe4e7c6812005-05-31 17:47:36 +02001322 if ((rq->data_len & 15) || (addr & mask))
Linus Torvalds1da177e2005-04-16 15:20:36 -07001323 info->dma = 0;
1324 }
1325
1326 /* Start sending the command to the drive. */
1327 return cdrom_start_packet_command(drive, rq->data_len, cdrom_do_newpc_cont);
1328}
1329
1330/****************************************************************************
1331 * cdrom driver request routine.
1332 */
1333static ide_startstop_t
1334ide_do_rw_cdrom (ide_drive_t *drive, struct request *rq, sector_t block)
1335{
1336 ide_startstop_t action;
1337 struct cdrom_info *info = drive->driver_data;
1338
1339 if (blk_fs_request(rq)) {
Bartlomiej Zolnierkiewicz2bc4cf22008-02-01 23:09:22 +01001340 if (info->cd_flags & IDE_CD_FLAG_SEEKING) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07001341 unsigned long elapsed = jiffies - info->start_seek;
1342 int stat = HWIF(drive)->INB(IDE_STATUS_REG);
1343
1344 if ((stat & SEEK_STAT) != SEEK_STAT) {
1345 if (elapsed < IDECD_SEEK_TIMEOUT) {
1346 ide_stall_queue(drive, IDECD_SEEK_TIMER);
1347 return ide_stopped;
1348 }
1349 printk (KERN_ERR "%s: DSC timeout\n", drive->name);
1350 }
Bartlomiej Zolnierkiewicz2bc4cf22008-02-01 23:09:22 +01001351 info->cd_flags &= ~IDE_CD_FLAG_SEEKING;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001352 }
1353 if ((rq_data_dir(rq) == READ) && IDE_LARGE_SEEK(info->last_block, block, IDECD_SEEK_THRESHOLD) && drive->dsc_overlap) {
1354 action = cdrom_start_seek(drive, block);
Bartlomiej Zolnierkiewicz21ea1f02008-02-01 23:09:27 +01001355 } else
1356 action = cdrom_start_rw(drive, rq);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001357 info->last_block = block;
1358 return action;
Bartlomiej Zolnierkiewiczc9f56a82008-02-01 23:09:26 +01001359 } else if (blk_sense_request(rq) || blk_pc_request(rq) ||
Jens Axboecea28852006-10-12 15:08:45 +02001360 rq->cmd_type == REQ_TYPE_ATA_PC) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07001361 return cdrom_do_block_pc(drive, rq);
Jens Axboe4aff5e22006-08-10 08:44:47 +02001362 } else if (blk_special_request(rq)) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07001363 /*
1364 * right now this can only be a reset...
1365 */
1366 cdrom_end_request(drive, 1);
1367 return ide_stopped;
1368 }
1369
1370 blk_dump_rq_flags(rq, "ide-cd bad flags");
1371 cdrom_end_request(drive, 0);
1372 return ide_stopped;
1373}
1374
1375
1376
1377/****************************************************************************
1378 * Ioctl handling.
1379 *
1380 * Routines which queue packet commands take as a final argument a pointer
1381 * to a request_sense struct. If execution of the command results
1382 * in an error with a CHECK CONDITION status, this structure will be filled
1383 * with the results of the subsequent request sense command. The pointer
1384 * can also be NULL, in which case no sense information is returned.
1385 */
1386
Linus Torvalds1da177e2005-04-16 15:20:36 -07001387static
1388void msf_from_bcd (struct atapi_msf *msf)
1389{
Bartlomiej Zolnierkiewicz9a6dc662008-02-01 23:09:22 +01001390 msf->minute = BCD2BIN(msf->minute);
1391 msf->second = BCD2BIN(msf->second);
1392 msf->frame = BCD2BIN(msf->frame);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001393}
1394
Linus Torvalds1da177e2005-04-16 15:20:36 -07001395static int cdrom_check_status(ide_drive_t *drive, struct request_sense *sense)
1396{
1397 struct request req;
1398 struct cdrom_info *info = drive->driver_data;
1399 struct cdrom_device_info *cdi = &info->devinfo;
1400
Bartlomiej Zolnierkiewicz139c8292008-02-01 23:09:24 +01001401 ide_cd_init_rq(drive, &req);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001402
1403 req.sense = sense;
1404 req.cmd[0] = GPCMD_TEST_UNIT_READY;
Jens Axboe4aff5e22006-08-10 08:44:47 +02001405 req.cmd_flags |= REQ_QUIET;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001406
Bartlomiej Zolnierkiewiczcdf60002008-02-01 23:09:22 +01001407 /*
1408 * Sanyo 3 CD changer uses byte 7 of TEST_UNIT_READY to
1409 * switch CDs instead of supporting the LOAD_UNLOAD opcode.
1410 */
Linus Torvalds1da177e2005-04-16 15:20:36 -07001411 req.cmd[7] = cdi->sanyo_slot % 3;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001412
Bartlomiej Zolnierkiewicz139c8292008-02-01 23:09:24 +01001413 return ide_cd_queue_pc(drive, &req);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001414}
1415
Linus Torvalds1da177e2005-04-16 15:20:36 -07001416/* Lock the door if LOCKFLAG is nonzero; unlock it otherwise. */
Bartlomiej Zolnierkiewicz17802992008-02-01 23:09:25 +01001417int ide_cd_lockdoor(ide_drive_t *drive, int lockflag,
1418 struct request_sense *sense)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001419{
Bartlomiej Zolnierkiewicz4fe67172008-02-01 23:09:21 +01001420 struct cdrom_info *cd = drive->driver_data;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001421 struct request_sense my_sense;
1422 struct request req;
1423 int stat;
1424
1425 if (sense == NULL)
1426 sense = &my_sense;
1427
1428 /* If the drive cannot lock the door, just pretend. */
Bartlomiej Zolnierkiewicz2bc4cf22008-02-01 23:09:22 +01001429 if (cd->cd_flags & IDE_CD_FLAG_NO_DOORLOCK) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07001430 stat = 0;
1431 } else {
Bartlomiej Zolnierkiewicz139c8292008-02-01 23:09:24 +01001432 ide_cd_init_rq(drive, &req);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001433 req.sense = sense;
1434 req.cmd[0] = GPCMD_PREVENT_ALLOW_MEDIUM_REMOVAL;
1435 req.cmd[4] = lockflag ? 1 : 0;
Bartlomiej Zolnierkiewicz139c8292008-02-01 23:09:24 +01001436 stat = ide_cd_queue_pc(drive, &req);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001437 }
1438
1439 /* If we got an illegal field error, the drive
1440 probably cannot lock the door. */
1441 if (stat != 0 &&
1442 sense->sense_key == ILLEGAL_REQUEST &&
1443 (sense->asc == 0x24 || sense->asc == 0x20)) {
1444 printk (KERN_ERR "%s: door locking not supported\n",
1445 drive->name);
Bartlomiej Zolnierkiewicz2bc4cf22008-02-01 23:09:22 +01001446 cd->cd_flags |= IDE_CD_FLAG_NO_DOORLOCK;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001447 stat = 0;
1448 }
1449
1450 /* no medium, that's alright. */
1451 if (stat != 0 && sense->sense_key == NOT_READY && sense->asc == 0x3a)
1452 stat = 0;
1453
Bartlomiej Zolnierkiewicz2bc4cf22008-02-01 23:09:22 +01001454 if (stat == 0) {
1455 if (lockflag)
1456 cd->cd_flags |= IDE_CD_FLAG_DOOR_LOCKED;
1457 else
1458 cd->cd_flags &= ~IDE_CD_FLAG_DOOR_LOCKED;
1459 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001460
1461 return stat;
1462}
1463
1464
1465/* Eject the disk if EJECTFLAG is 0.
1466 If EJECTFLAG is 1, try to reload the disk. */
1467static int cdrom_eject(ide_drive_t *drive, int ejectflag,
1468 struct request_sense *sense)
1469{
Bartlomiej Zolnierkiewicz3f1b86d2008-02-01 23:09:20 +01001470 struct cdrom_info *cd = drive->driver_data;
1471 struct cdrom_device_info *cdi = &cd->devinfo;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001472 struct request req;
1473 char loej = 0x02;
1474
Bartlomiej Zolnierkiewicz2bc4cf22008-02-01 23:09:22 +01001475 if ((cd->cd_flags & IDE_CD_FLAG_NO_EJECT) && !ejectflag)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001476 return -EDRIVE_CANT_DO_THIS;
Bartlomiej Zolnierkiewicz4fe67172008-02-01 23:09:21 +01001477
Linus Torvalds1da177e2005-04-16 15:20:36 -07001478 /* reload fails on some drives, if the tray is locked */
Bartlomiej Zolnierkiewicz2bc4cf22008-02-01 23:09:22 +01001479 if ((cd->cd_flags & IDE_CD_FLAG_DOOR_LOCKED) && ejectflag)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001480 return 0;
1481
Bartlomiej Zolnierkiewicz139c8292008-02-01 23:09:24 +01001482 ide_cd_init_rq(drive, &req);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001483
1484 /* only tell drive to close tray if open, if it can do that */
Bartlomiej Zolnierkiewicz3f1b86d2008-02-01 23:09:20 +01001485 if (ejectflag && (cdi->mask & CDC_CLOSE_TRAY))
Linus Torvalds1da177e2005-04-16 15:20:36 -07001486 loej = 0;
1487
1488 req.sense = sense;
1489 req.cmd[0] = GPCMD_START_STOP_UNIT;
1490 req.cmd[4] = loej | (ejectflag != 0);
Bartlomiej Zolnierkiewicz139c8292008-02-01 23:09:24 +01001491
1492 return ide_cd_queue_pc(drive, &req);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001493}
1494
1495static int cdrom_read_capacity(ide_drive_t *drive, unsigned long *capacity,
1496 unsigned long *sectors_per_frame,
1497 struct request_sense *sense)
1498{
1499 struct {
1500 __u32 lba;
1501 __u32 blocklen;
1502 } capbuf;
1503
1504 int stat;
1505 struct request req;
1506
Bartlomiej Zolnierkiewicz139c8292008-02-01 23:09:24 +01001507 ide_cd_init_rq(drive, &req);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001508
1509 req.sense = sense;
1510 req.cmd[0] = GPCMD_READ_CDVD_CAPACITY;
1511 req.data = (char *)&capbuf;
1512 req.data_len = sizeof(capbuf);
Jens Axboe4aff5e22006-08-10 08:44:47 +02001513 req.cmd_flags |= REQ_QUIET;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001514
Bartlomiej Zolnierkiewicz139c8292008-02-01 23:09:24 +01001515 stat = ide_cd_queue_pc(drive, &req);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001516 if (stat == 0) {
1517 *capacity = 1 + be32_to_cpu(capbuf.lba);
1518 *sectors_per_frame =
1519 be32_to_cpu(capbuf.blocklen) >> SECTOR_BITS;
1520 }
1521
1522 return stat;
1523}
1524
1525static int cdrom_read_tocentry(ide_drive_t *drive, int trackno, int msf_flag,
1526 int format, char *buf, int buflen,
1527 struct request_sense *sense)
1528{
1529 struct request req;
1530
Bartlomiej Zolnierkiewicz139c8292008-02-01 23:09:24 +01001531 ide_cd_init_rq(drive, &req);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001532
1533 req.sense = sense;
1534 req.data = buf;
1535 req.data_len = buflen;
Jens Axboe4aff5e22006-08-10 08:44:47 +02001536 req.cmd_flags |= REQ_QUIET;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001537 req.cmd[0] = GPCMD_READ_TOC_PMA_ATIP;
1538 req.cmd[6] = trackno;
1539 req.cmd[7] = (buflen >> 8);
1540 req.cmd[8] = (buflen & 0xff);
1541 req.cmd[9] = (format << 6);
1542
1543 if (msf_flag)
1544 req.cmd[1] = 2;
1545
Bartlomiej Zolnierkiewicz139c8292008-02-01 23:09:24 +01001546 return ide_cd_queue_pc(drive, &req);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001547}
1548
Linus Torvalds1da177e2005-04-16 15:20:36 -07001549/* Try to read the entire TOC for the disk into our internal buffer. */
Bartlomiej Zolnierkiewicz17802992008-02-01 23:09:25 +01001550int ide_cd_read_toc(ide_drive_t *drive, struct request_sense *sense)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001551{
1552 int stat, ntracks, i;
1553 struct cdrom_info *info = drive->driver_data;
1554 struct cdrom_device_info *cdi = &info->devinfo;
1555 struct atapi_toc *toc = info->toc;
1556 struct {
1557 struct atapi_toc_header hdr;
1558 struct atapi_toc_entry ent;
1559 } ms_tmp;
1560 long last_written;
1561 unsigned long sectors_per_frame = SECTORS_PER_FRAME;
1562
1563 if (toc == NULL) {
1564 /* Try to allocate space. */
Jesper Juhl2a91f3e2005-10-30 15:02:45 -08001565 toc = kmalloc(sizeof(struct atapi_toc), GFP_KERNEL);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001566 if (toc == NULL) {
1567 printk (KERN_ERR "%s: No cdrom TOC buffer!\n", drive->name);
1568 return -ENOMEM;
1569 }
Jesper Juhl2a91f3e2005-10-30 15:02:45 -08001570 info->toc = toc;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001571 }
1572
1573 /* Check to see if the existing data is still valid.
1574 If it is, just return. */
1575 (void) cdrom_check_status(drive, sense);
1576
Bartlomiej Zolnierkiewicz2bc4cf22008-02-01 23:09:22 +01001577 if (info->cd_flags & IDE_CD_FLAG_TOC_VALID)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001578 return 0;
1579
1580 /* Try to get the total cdrom capacity and sector size. */
1581 stat = cdrom_read_capacity(drive, &toc->capacity, &sectors_per_frame,
1582 sense);
1583 if (stat)
1584 toc->capacity = 0x1fffff;
1585
1586 set_capacity(info->disk, toc->capacity * sectors_per_frame);
Alan Coxdbe217a2006-06-25 05:47:44 -07001587 /* Save a private copy of te TOC capacity for error handling */
1588 drive->probed_capacity = toc->capacity * sectors_per_frame;
1589
Linus Torvalds1da177e2005-04-16 15:20:36 -07001590 blk_queue_hardsect_size(drive->queue,
1591 sectors_per_frame << SECTOR_BITS);
1592
1593 /* First read just the header, so we know how long the TOC is. */
1594 stat = cdrom_read_tocentry(drive, 0, 1, 0, (char *) &toc->hdr,
1595 sizeof(struct atapi_toc_header), sense);
Jesper Juhl2a91f3e2005-10-30 15:02:45 -08001596 if (stat)
1597 return stat;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001598
Bartlomiej Zolnierkiewicz2bc4cf22008-02-01 23:09:22 +01001599 if (info->cd_flags & IDE_CD_FLAG_TOCTRACKS_AS_BCD) {
Bartlomiej Zolnierkiewicz9a6dc662008-02-01 23:09:22 +01001600 toc->hdr.first_track = BCD2BIN(toc->hdr.first_track);
1601 toc->hdr.last_track = BCD2BIN(toc->hdr.last_track);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001602 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001603
1604 ntracks = toc->hdr.last_track - toc->hdr.first_track + 1;
1605 if (ntracks <= 0)
1606 return -EIO;
1607 if (ntracks > MAX_TRACKS)
1608 ntracks = MAX_TRACKS;
1609
1610 /* Now read the whole schmeer. */
1611 stat = cdrom_read_tocentry(drive, toc->hdr.first_track, 1, 0,
1612 (char *)&toc->hdr,
1613 sizeof(struct atapi_toc_header) +
1614 (ntracks + 1) *
1615 sizeof(struct atapi_toc_entry), sense);
1616
1617 if (stat && toc->hdr.first_track > 1) {
1618 /* Cds with CDI tracks only don't have any TOC entries,
1619 despite of this the returned values are
1620 first_track == last_track = number of CDI tracks + 1,
1621 so that this case is indistinguishable from the same
1622 layout plus an additional audio track.
1623 If we get an error for the regular case, we assume
1624 a CDI without additional audio tracks. In this case
1625 the readable TOC is empty (CDI tracks are not included)
Jan Engelhardt96de0e22007-10-19 23:21:04 +02001626 and only holds the Leadout entry. Heiko Eißfeldt */
Linus Torvalds1da177e2005-04-16 15:20:36 -07001627 ntracks = 0;
1628 stat = cdrom_read_tocentry(drive, CDROM_LEADOUT, 1, 0,
1629 (char *)&toc->hdr,
1630 sizeof(struct atapi_toc_header) +
1631 (ntracks + 1) *
1632 sizeof(struct atapi_toc_entry),
1633 sense);
Bartlomiej Zolnierkiewiczcdf60002008-02-01 23:09:22 +01001634 if (stat)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001635 return stat;
Bartlomiej Zolnierkiewiczcdf60002008-02-01 23:09:22 +01001636
Bartlomiej Zolnierkiewicz2bc4cf22008-02-01 23:09:22 +01001637 if (info->cd_flags & IDE_CD_FLAG_TOCTRACKS_AS_BCD) {
Bartlomiej Zolnierkiewicz9a6dc662008-02-01 23:09:22 +01001638 toc->hdr.first_track = (u8)BIN2BCD(CDROM_LEADOUT);
1639 toc->hdr.last_track = (u8)BIN2BCD(CDROM_LEADOUT);
Bartlomiej Zolnierkiewiczcdf60002008-02-01 23:09:22 +01001640 } else {
Linus Torvalds1da177e2005-04-16 15:20:36 -07001641 toc->hdr.first_track = CDROM_LEADOUT;
1642 toc->hdr.last_track = CDROM_LEADOUT;
1643 }
1644 }
1645
1646 if (stat)
1647 return stat;
1648
1649 toc->hdr.toc_length = ntohs (toc->hdr.toc_length);
1650
Bartlomiej Zolnierkiewicz2bc4cf22008-02-01 23:09:22 +01001651 if (info->cd_flags & IDE_CD_FLAG_TOCTRACKS_AS_BCD) {
Bartlomiej Zolnierkiewicz9a6dc662008-02-01 23:09:22 +01001652 toc->hdr.first_track = BCD2BIN(toc->hdr.first_track);
1653 toc->hdr.last_track = BCD2BIN(toc->hdr.last_track);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001654 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001655
Bartlomiej Zolnierkiewiczcdf60002008-02-01 23:09:22 +01001656 for (i = 0; i <= ntracks; i++) {
Bartlomiej Zolnierkiewicz2bc4cf22008-02-01 23:09:22 +01001657 if (info->cd_flags & IDE_CD_FLAG_TOCADDR_AS_BCD) {
1658 if (info->cd_flags & IDE_CD_FLAG_TOCTRACKS_AS_BCD)
Bartlomiej Zolnierkiewicz9a6dc662008-02-01 23:09:22 +01001659 toc->ent[i].track = BCD2BIN(toc->ent[i].track);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001660 msf_from_bcd(&toc->ent[i].addr.msf);
1661 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001662 toc->ent[i].addr.lba = msf_to_lba (toc->ent[i].addr.msf.minute,
1663 toc->ent[i].addr.msf.second,
1664 toc->ent[i].addr.msf.frame);
1665 }
1666
1667 /* Read the multisession information. */
1668 if (toc->hdr.first_track != CDROM_LEADOUT) {
1669 /* Read the multisession information. */
1670 stat = cdrom_read_tocentry(drive, 0, 0, 1, (char *)&ms_tmp,
1671 sizeof(ms_tmp), sense);
Jesper Juhl2a91f3e2005-10-30 15:02:45 -08001672 if (stat)
1673 return stat;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001674
1675 toc->last_session_lba = be32_to_cpu(ms_tmp.ent.addr.lba);
1676 } else {
1677 ms_tmp.hdr.first_track = ms_tmp.hdr.last_track = CDROM_LEADOUT;
1678 toc->last_session_lba = msf_to_lba(0, 2, 0); /* 0m 2s 0f */
1679 }
1680
Bartlomiej Zolnierkiewicz2bc4cf22008-02-01 23:09:22 +01001681 if (info->cd_flags & IDE_CD_FLAG_TOCADDR_AS_BCD) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07001682 /* Re-read multisession information using MSF format */
1683 stat = cdrom_read_tocentry(drive, 0, 1, 1, (char *)&ms_tmp,
1684 sizeof(ms_tmp), sense);
1685 if (stat)
1686 return stat;
1687
1688 msf_from_bcd (&ms_tmp.ent.addr.msf);
1689 toc->last_session_lba = msf_to_lba(ms_tmp.ent.addr.msf.minute,
1690 ms_tmp.ent.addr.msf.second,
1691 ms_tmp.ent.addr.msf.frame);
1692 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001693
1694 toc->xa_flag = (ms_tmp.hdr.first_track != ms_tmp.hdr.last_track);
1695
1696 /* Now try to get the total cdrom capacity. */
1697 stat = cdrom_get_last_written(cdi, &last_written);
1698 if (!stat && (last_written > toc->capacity)) {
1699 toc->capacity = last_written;
1700 set_capacity(info->disk, toc->capacity * sectors_per_frame);
Alan Coxdbe217a2006-06-25 05:47:44 -07001701 drive->probed_capacity = toc->capacity * sectors_per_frame;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001702 }
1703
1704 /* Remember that we've read this stuff. */
Bartlomiej Zolnierkiewicz2bc4cf22008-02-01 23:09:22 +01001705 info->cd_flags |= IDE_CD_FLAG_TOC_VALID;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001706
1707 return 0;
1708}
1709
Linus Torvalds1da177e2005-04-16 15:20:36 -07001710/* the generic packet interface to cdrom.c */
1711static int ide_cdrom_packet(struct cdrom_device_info *cdi,
1712 struct packet_command *cgc)
1713{
1714 struct request req;
Jesper Juhl2a91f3e2005-10-30 15:02:45 -08001715 ide_drive_t *drive = cdi->handle;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001716
1717 if (cgc->timeout <= 0)
1718 cgc->timeout = ATAPI_WAIT_PC;
1719
1720 /* here we queue the commands from the uniform CD-ROM
1721 layer. the packet must be complete, as we do not
1722 touch it at all. */
Bartlomiej Zolnierkiewicz139c8292008-02-01 23:09:24 +01001723 ide_cd_init_rq(drive, &req);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001724 memcpy(req.cmd, cgc->cmd, CDROM_PACKET_SIZE);
1725 if (cgc->sense)
1726 memset(cgc->sense, 0, sizeof(struct request_sense));
1727 req.data = cgc->buffer;
1728 req.data_len = cgc->buflen;
1729 req.timeout = cgc->timeout;
1730
1731 if (cgc->quiet)
Jens Axboe4aff5e22006-08-10 08:44:47 +02001732 req.cmd_flags |= REQ_QUIET;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001733
1734 req.sense = cgc->sense;
Bartlomiej Zolnierkiewicz139c8292008-02-01 23:09:24 +01001735 cgc->stat = ide_cd_queue_pc(drive, &req);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001736 if (!cgc->stat)
1737 cgc->buflen -= req.data_len;
1738 return cgc->stat;
1739}
1740
Linus Torvalds1da177e2005-04-16 15:20:36 -07001741static
1742int ide_cdrom_tray_move (struct cdrom_device_info *cdi, int position)
1743{
Jesper Juhl2a91f3e2005-10-30 15:02:45 -08001744 ide_drive_t *drive = cdi->handle;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001745 struct request_sense sense;
1746
1747 if (position) {
Bartlomiej Zolnierkiewicz139c8292008-02-01 23:09:24 +01001748 int stat = ide_cd_lockdoor(drive, 0, &sense);
1749
Jesper Juhl2a91f3e2005-10-30 15:02:45 -08001750 if (stat)
1751 return stat;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001752 }
1753
1754 return cdrom_eject(drive, !position, &sense);
1755}
1756
Bartlomiej Zolnierkiewicz17802992008-02-01 23:09:25 +01001757int ide_cdrom_get_capabilities(ide_drive_t *drive, u8 *buf)
Eric Piel9235e682005-06-23 00:10:29 -07001758{
1759 struct cdrom_info *info = drive->driver_data;
1760 struct cdrom_device_info *cdi = &info->devinfo;
1761 struct packet_command cgc;
Bartlomiej Zolnierkiewicz455d80a2008-02-01 23:09:21 +01001762 int stat, attempts = 3, size = ATAPI_CAPABILITIES_PAGE_SIZE;
Eric Piel9235e682005-06-23 00:10:29 -07001763
Bartlomiej Zolnierkiewicze59724c2008-02-01 23:09:22 +01001764 if ((info->cd_flags & IDE_CD_FLAG_FULL_CAPS_PAGE) == 0)
Bartlomiej Zolnierkiewicz455d80a2008-02-01 23:09:21 +01001765 size -= ATAPI_CAPABILITIES_PAGE_PAD_SIZE;
Eric Piel9235e682005-06-23 00:10:29 -07001766
Bartlomiej Zolnierkiewicz455d80a2008-02-01 23:09:21 +01001767 init_cdrom_command(&cgc, buf, size, CGC_DATA_UNKNOWN);
Eric Piel9235e682005-06-23 00:10:29 -07001768 do { /* we seem to get stat=0x01,err=0x00 the first time (??) */
1769 stat = cdrom_mode_sense(cdi, &cgc, GPMODE_CAPABILITIES_PAGE, 0);
1770 if (!stat)
1771 break;
1772 } while (--attempts);
1773 return stat;
1774}
1775
Bartlomiej Zolnierkiewicz17802992008-02-01 23:09:25 +01001776void ide_cdrom_update_speed(ide_drive_t *drive, u8 *buf)
Eric Piel9235e682005-06-23 00:10:29 -07001777{
Bartlomiej Zolnierkiewicz4fe67172008-02-01 23:09:21 +01001778 struct cdrom_info *cd = drive->driver_data;
Bartlomiej Zolnierkiewicz481c8c62008-02-01 23:09:20 +01001779 u16 curspeed, maxspeed;
1780
Bartlomiej Zolnierkiewicz455d80a2008-02-01 23:09:21 +01001781 curspeed = *(u16 *)&buf[8 + 14];
1782 maxspeed = *(u16 *)&buf[8 + 8];
1783
Bartlomiej Zolnierkiewicze59724c2008-02-01 23:09:22 +01001784 if (cd->cd_flags & IDE_CD_FLAG_LE_SPEED_FIELDS) {
Bartlomiej Zolnierkiewicz455d80a2008-02-01 23:09:21 +01001785 curspeed = le16_to_cpu(curspeed);
1786 maxspeed = le16_to_cpu(maxspeed);
Eric Piel9235e682005-06-23 00:10:29 -07001787 } else {
Bartlomiej Zolnierkiewicz455d80a2008-02-01 23:09:21 +01001788 curspeed = be16_to_cpu(curspeed);
1789 maxspeed = be16_to_cpu(maxspeed);
Eric Piel9235e682005-06-23 00:10:29 -07001790 }
Bartlomiej Zolnierkiewicz481c8c62008-02-01 23:09:20 +01001791
Bartlomiej Zolnierkiewicz2bc4cf22008-02-01 23:09:22 +01001792 cd->current_speed = (curspeed + (176/2)) / 176;
1793 cd->max_speed = (maxspeed + (176/2)) / 176;
Eric Piel9235e682005-06-23 00:10:29 -07001794}
1795
Bartlomiej Zolnierkiewicz5c684292008-02-01 23:09:24 +01001796/*
Linus Torvalds1da177e2005-04-16 15:20:36 -07001797 * add logic to try GET_EVENT command first to check for media and tray
1798 * status. this should be supported by newer cd-r/w and all DVD etc
1799 * drives
1800 */
1801static
1802int ide_cdrom_drive_status (struct cdrom_device_info *cdi, int slot_nr)
1803{
Jesper Juhl2a91f3e2005-10-30 15:02:45 -08001804 ide_drive_t *drive = cdi->handle;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001805 struct media_event_desc med;
1806 struct request_sense sense;
1807 int stat;
1808
1809 if (slot_nr != CDSL_CURRENT)
1810 return -EINVAL;
1811
1812 stat = cdrom_check_status(drive, &sense);
1813 if (!stat || sense.sense_key == UNIT_ATTENTION)
1814 return CDS_DISC_OK;
1815
1816 if (!cdrom_get_media_event(cdi, &med)) {
1817 if (med.media_present)
1818 return CDS_DISC_OK;
1819 else if (med.door_open)
1820 return CDS_TRAY_OPEN;
1821 else
1822 return CDS_NO_DISC;
1823 }
1824
1825 if (sense.sense_key == NOT_READY && sense.asc == 0x04 && sense.ascq == 0x04)
1826 return CDS_DISC_OK;
1827
1828 /*
1829 * If not using Mt Fuji extended media tray reports,
1830 * just return TRAY_OPEN since ATAPI doesn't provide
1831 * any other way to detect this...
1832 */
1833 if (sense.sense_key == NOT_READY) {
Alan Coxdbe217a2006-06-25 05:47:44 -07001834 if (sense.asc == 0x3a && sense.ascq == 1)
1835 return CDS_NO_DISC;
1836 else
1837 return CDS_TRAY_OPEN;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001838 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001839 return CDS_DRIVE_NOT_READY;
1840}
1841
Linus Torvalds1da177e2005-04-16 15:20:36 -07001842/****************************************************************************
1843 * Other driver requests (open, close, check media change).
1844 */
1845
1846static
1847int ide_cdrom_check_media_change_real (struct cdrom_device_info *cdi,
1848 int slot_nr)
1849{
Jesper Juhl2a91f3e2005-10-30 15:02:45 -08001850 ide_drive_t *drive = cdi->handle;
Bartlomiej Zolnierkiewicz0ba11212008-02-01 23:09:21 +01001851 struct cdrom_info *cd = drive->driver_data;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001852 int retval;
Bartlomiej Zolnierkiewicz0ba11212008-02-01 23:09:21 +01001853
Linus Torvalds1da177e2005-04-16 15:20:36 -07001854 if (slot_nr == CDSL_CURRENT) {
1855 (void) cdrom_check_status(drive, NULL);
Bartlomiej Zolnierkiewicz2bc4cf22008-02-01 23:09:22 +01001856 retval = (cd->cd_flags & IDE_CD_FLAG_MEDIA_CHANGED) ? 1 : 0;
1857 cd->cd_flags &= ~IDE_CD_FLAG_MEDIA_CHANGED;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001858 return retval;
1859 } else {
1860 return -EINVAL;
1861 }
1862}
1863
1864
1865static
1866int ide_cdrom_open_real (struct cdrom_device_info *cdi, int purpose)
1867{
1868 return 0;
1869}
1870
1871/*
1872 * Close down the device. Invalidate all cached blocks.
1873 */
1874
1875static
1876void ide_cdrom_release_real (struct cdrom_device_info *cdi)
1877{
1878 ide_drive_t *drive = cdi->handle;
Bartlomiej Zolnierkiewicz0ba11212008-02-01 23:09:21 +01001879 struct cdrom_info *cd = drive->driver_data;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001880
1881 if (!cdi->use_count)
Bartlomiej Zolnierkiewicz2bc4cf22008-02-01 23:09:22 +01001882 cd->cd_flags &= ~IDE_CD_FLAG_TOC_VALID;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001883}
1884
Bartlomiej Zolnierkiewicz20e7f7e2008-02-01 23:09:20 +01001885#define IDE_CD_CAPABILITIES \
1886 (CDC_CLOSE_TRAY | CDC_OPEN_TRAY | CDC_LOCK | CDC_SELECT_SPEED | \
1887 CDC_SELECT_DISC | CDC_MULTI_SESSION | CDC_MCN | CDC_MEDIA_CHANGED | \
1888 CDC_PLAY_AUDIO | CDC_RESET | CDC_DRIVE_STATUS | CDC_CD_R | \
1889 CDC_CD_RW | CDC_DVD | CDC_DVD_R | CDC_DVD_RAM | CDC_GENERIC_PACKET | \
1890 CDC_MO_DRIVE | CDC_MRW | CDC_MRW_W | CDC_RAM)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001891
Linus Torvalds1da177e2005-04-16 15:20:36 -07001892static struct cdrom_device_ops ide_cdrom_dops = {
1893 .open = ide_cdrom_open_real,
1894 .release = ide_cdrom_release_real,
1895 .drive_status = ide_cdrom_drive_status,
1896 .media_changed = ide_cdrom_check_media_change_real,
1897 .tray_move = ide_cdrom_tray_move,
1898 .lock_door = ide_cdrom_lock_door,
1899 .select_speed = ide_cdrom_select_speed,
1900 .get_last_session = ide_cdrom_get_last_session,
1901 .get_mcn = ide_cdrom_get_mcn,
1902 .reset = ide_cdrom_reset,
1903 .audio_ioctl = ide_cdrom_audio_ioctl,
Bartlomiej Zolnierkiewicz20e7f7e2008-02-01 23:09:20 +01001904 .capability = IDE_CD_CAPABILITIES,
Linus Torvalds1da177e2005-04-16 15:20:36 -07001905 .generic_packet = ide_cdrom_packet,
1906};
1907
1908static int ide_cdrom_register (ide_drive_t *drive, int nslots)
1909{
1910 struct cdrom_info *info = drive->driver_data;
1911 struct cdrom_device_info *devinfo = &info->devinfo;
1912
1913 devinfo->ops = &ide_cdrom_dops;
Bartlomiej Zolnierkiewicz2bc4cf22008-02-01 23:09:22 +01001914 devinfo->speed = info->current_speed;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001915 devinfo->capacity = nslots;
Jesper Juhl2a91f3e2005-10-30 15:02:45 -08001916 devinfo->handle = drive;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001917 strcpy(devinfo->name, drive->name);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001918
Bartlomiej Zolnierkiewicz2bc4cf22008-02-01 23:09:22 +01001919 if (info->cd_flags & IDE_CD_FLAG_NO_SPEED_SELECT)
Bartlomiej Zolnierkiewicz3cbd8142007-12-24 15:23:43 +01001920 devinfo->mask |= CDC_SELECT_SPEED;
1921
Linus Torvalds1da177e2005-04-16 15:20:36 -07001922 devinfo->disk = info->disk;
1923 return register_cdrom(devinfo);
1924}
1925
1926static
Linus Torvalds1da177e2005-04-16 15:20:36 -07001927int ide_cdrom_probe_capabilities (ide_drive_t *drive)
1928{
Bartlomiej Zolnierkiewicz4fe67172008-02-01 23:09:21 +01001929 struct cdrom_info *cd = drive->driver_data;
1930 struct cdrom_device_info *cdi = &cd->devinfo;
Bartlomiej Zolnierkiewicz455d80a2008-02-01 23:09:21 +01001931 u8 buf[ATAPI_CAPABILITIES_PAGE_SIZE];
1932 mechtype_t mechtype;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001933 int nslots = 1;
1934
Bartlomiej Zolnierkiewicz3f1b86d2008-02-01 23:09:20 +01001935 cdi->mask = (CDC_CD_R | CDC_CD_RW | CDC_DVD | CDC_DVD_R |
1936 CDC_DVD_RAM | CDC_SELECT_DISC | CDC_PLAY_AUDIO |
1937 CDC_MO_DRIVE | CDC_RAM);
1938
Linus Torvalds1da177e2005-04-16 15:20:36 -07001939 if (drive->media == ide_optical) {
Bartlomiej Zolnierkiewicz3f1b86d2008-02-01 23:09:20 +01001940 cdi->mask &= ~(CDC_MO_DRIVE | CDC_RAM);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001941 printk(KERN_ERR "%s: ATAPI magneto-optical drive\n", drive->name);
1942 return nslots;
1943 }
1944
Bartlomiej Zolnierkiewicze59724c2008-02-01 23:09:22 +01001945 if (cd->cd_flags & IDE_CD_FLAG_PRE_ATAPI12) {
Bartlomiej Zolnierkiewicz2bc4cf22008-02-01 23:09:22 +01001946 cd->cd_flags &= ~IDE_CD_FLAG_NO_EJECT;
Bartlomiej Zolnierkiewicz3f1b86d2008-02-01 23:09:20 +01001947 cdi->mask &= ~CDC_PLAY_AUDIO;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001948 return nslots;
1949 }
1950
1951 /*
1952 * we have to cheat a little here. the packet will eventually
1953 * be queued with ide_cdrom_packet(), which extracts the
1954 * drive from cdi->handle. Since this device hasn't been
1955 * registered with the Uniform layer yet, it can't do this.
1956 * Same goes for cdi->ops.
1957 */
Jesper Juhl2a91f3e2005-10-30 15:02:45 -08001958 cdi->handle = drive;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001959 cdi->ops = &ide_cdrom_dops;
1960
Bartlomiej Zolnierkiewicz455d80a2008-02-01 23:09:21 +01001961 if (ide_cdrom_get_capabilities(drive, buf))
Linus Torvalds1da177e2005-04-16 15:20:36 -07001962 return 0;
1963
Bartlomiej Zolnierkiewicz455d80a2008-02-01 23:09:21 +01001964 if ((buf[8 + 6] & 0x01) == 0)
Bartlomiej Zolnierkiewicz2bc4cf22008-02-01 23:09:22 +01001965 cd->cd_flags |= IDE_CD_FLAG_NO_DOORLOCK;
Bartlomiej Zolnierkiewicz455d80a2008-02-01 23:09:21 +01001966 if (buf[8 + 6] & 0x08)
Bartlomiej Zolnierkiewicz2bc4cf22008-02-01 23:09:22 +01001967 cd->cd_flags &= ~IDE_CD_FLAG_NO_EJECT;
Bartlomiej Zolnierkiewicz455d80a2008-02-01 23:09:21 +01001968 if (buf[8 + 3] & 0x01)
Bartlomiej Zolnierkiewicz3f1b86d2008-02-01 23:09:20 +01001969 cdi->mask &= ~CDC_CD_R;
Bartlomiej Zolnierkiewicz455d80a2008-02-01 23:09:21 +01001970 if (buf[8 + 3] & 0x02)
Bartlomiej Zolnierkiewicz3f1b86d2008-02-01 23:09:20 +01001971 cdi->mask &= ~(CDC_CD_RW | CDC_RAM);
Bartlomiej Zolnierkiewicz455d80a2008-02-01 23:09:21 +01001972 if (buf[8 + 2] & 0x38)
Bartlomiej Zolnierkiewicz3f1b86d2008-02-01 23:09:20 +01001973 cdi->mask &= ~CDC_DVD;
Bartlomiej Zolnierkiewicz455d80a2008-02-01 23:09:21 +01001974 if (buf[8 + 3] & 0x20)
Bartlomiej Zolnierkiewicz3f1b86d2008-02-01 23:09:20 +01001975 cdi->mask &= ~(CDC_DVD_RAM | CDC_RAM);
Bartlomiej Zolnierkiewicz455d80a2008-02-01 23:09:21 +01001976 if (buf[8 + 3] & 0x10)
Bartlomiej Zolnierkiewicz3f1b86d2008-02-01 23:09:20 +01001977 cdi->mask &= ~CDC_DVD_R;
Bartlomiej Zolnierkiewicze59724c2008-02-01 23:09:22 +01001978 if ((buf[8 + 4] & 0x01) || (cd->cd_flags & IDE_CD_FLAG_PLAY_AUDIO_OK))
Bartlomiej Zolnierkiewicz3f1b86d2008-02-01 23:09:20 +01001979 cdi->mask &= ~CDC_PLAY_AUDIO;
Bartlomiej Zolnierkiewicz455d80a2008-02-01 23:09:21 +01001980
1981 mechtype = buf[8 + 6] >> 5;
1982 if (mechtype == mechtype_caddy || mechtype == mechtype_popup)
Bartlomiej Zolnierkiewicz3f1b86d2008-02-01 23:09:20 +01001983 cdi->mask |= CDC_CLOSE_TRAY;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001984
Linus Torvalds1da177e2005-04-16 15:20:36 -07001985 if (cdi->sanyo_slot > 0) {
Bartlomiej Zolnierkiewicz3f1b86d2008-02-01 23:09:20 +01001986 cdi->mask &= ~CDC_SELECT_DISC;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001987 nslots = 3;
Bartlomiej Zolnierkiewiczcdf60002008-02-01 23:09:22 +01001988 } else if (mechtype == mechtype_individual_changer ||
1989 mechtype == mechtype_cartridge_changer) {
Bartlomiej Zolnierkiewicz2609d062008-02-01 23:09:19 +01001990 nslots = cdrom_number_of_slots(cdi);
1991 if (nslots > 1)
Bartlomiej Zolnierkiewicz3f1b86d2008-02-01 23:09:20 +01001992 cdi->mask &= ~CDC_SELECT_DISC;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001993 }
1994
Bartlomiej Zolnierkiewicz455d80a2008-02-01 23:09:21 +01001995 ide_cdrom_update_speed(drive, buf);
Bartlomiej Zolnierkiewicz4fe67172008-02-01 23:09:21 +01001996
Linus Torvalds1da177e2005-04-16 15:20:36 -07001997 printk(KERN_INFO "%s: ATAPI", drive->name);
Bartlomiej Zolnierkiewicz4fe67172008-02-01 23:09:21 +01001998
1999 /* don't print speed if the drive reported 0 */
Bartlomiej Zolnierkiewicz2bc4cf22008-02-01 23:09:22 +01002000 if (cd->max_speed)
2001 printk(KERN_CONT " %dX", cd->max_speed);
Bartlomiej Zolnierkiewicz4fe67172008-02-01 23:09:21 +01002002
Bartlomiej Zolnierkiewicz3f1b86d2008-02-01 23:09:20 +01002003 printk(KERN_CONT " %s", (cdi->mask & CDC_DVD) ? "CD-ROM" : "DVD-ROM");
Linus Torvalds1da177e2005-04-16 15:20:36 -07002004
Bartlomiej Zolnierkiewicz3f1b86d2008-02-01 23:09:20 +01002005 if ((cdi->mask & CDC_DVD_R) == 0 || (cdi->mask & CDC_DVD_RAM) == 0)
2006 printk(KERN_CONT " DVD%s%s",
2007 (cdi->mask & CDC_DVD_R) ? "" : "-R",
2008 (cdi->mask & CDC_DVD_RAM) ? "" : "-RAM");
Linus Torvalds1da177e2005-04-16 15:20:36 -07002009
Bartlomiej Zolnierkiewicz3f1b86d2008-02-01 23:09:20 +01002010 if ((cdi->mask & CDC_CD_R) == 0 || (cdi->mask & CDC_CD_RW) == 0)
2011 printk(KERN_CONT " CD%s%s",
2012 (cdi->mask & CDC_CD_R) ? "" : "-R",
2013 (cdi->mask & CDC_CD_RW) ? "" : "/RW");
Linus Torvalds1da177e2005-04-16 15:20:36 -07002014
Bartlomiej Zolnierkiewicz3f1b86d2008-02-01 23:09:20 +01002015 if ((cdi->mask & CDC_SELECT_DISC) == 0)
2016 printk(KERN_CONT " changer w/%d slots", nslots);
2017 else
2018 printk(KERN_CONT " drive");
Linus Torvalds1da177e2005-04-16 15:20:36 -07002019
Bartlomiej Zolnierkiewicz455d80a2008-02-01 23:09:21 +01002020 printk(KERN_CONT ", %dkB Cache\n", be16_to_cpu(*(u16 *)&buf[8 + 12]));
Linus Torvalds1da177e2005-04-16 15:20:36 -07002021
2022 return nslots;
2023}
2024
Bartlomiej Zolnierkiewicz7662d042007-05-10 00:01:10 +02002025#ifdef CONFIG_IDE_PROC_FS
Linus Torvalds1da177e2005-04-16 15:20:36 -07002026static void ide_cdrom_add_settings(ide_drive_t *drive)
2027{
Bartlomiej Zolnierkiewicz14979432007-05-10 00:01:10 +02002028 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 -07002029}
Bartlomiej Zolnierkiewicz7662d042007-05-10 00:01:10 +02002030#else
2031static inline void ide_cdrom_add_settings(ide_drive_t *drive) { ; }
2032#endif
Linus Torvalds1da177e2005-04-16 15:20:36 -07002033
2034/*
2035 * standard prep_rq_fn that builds 10 byte cmds
2036 */
Jens Axboe165125e2007-07-24 09:28:11 +02002037static int ide_cdrom_prep_fs(struct request_queue *q, struct request *rq)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002038{
2039 int hard_sect = queue_hardsect_size(q);
2040 long block = (long)rq->hard_sector / (hard_sect >> 9);
2041 unsigned long blocks = rq->hard_nr_sectors / (hard_sect >> 9);
2042
2043 memset(rq->cmd, 0, sizeof(rq->cmd));
2044
2045 if (rq_data_dir(rq) == READ)
2046 rq->cmd[0] = GPCMD_READ_10;
2047 else
2048 rq->cmd[0] = GPCMD_WRITE_10;
2049
2050 /*
2051 * fill in lba
2052 */
2053 rq->cmd[2] = (block >> 24) & 0xff;
2054 rq->cmd[3] = (block >> 16) & 0xff;
2055 rq->cmd[4] = (block >> 8) & 0xff;
2056 rq->cmd[5] = block & 0xff;
2057
2058 /*
2059 * and transfer length
2060 */
2061 rq->cmd[7] = (blocks >> 8) & 0xff;
2062 rq->cmd[8] = blocks & 0xff;
2063 rq->cmd_len = 10;
2064 return BLKPREP_OK;
2065}
2066
2067/*
2068 * Most of the SCSI commands are supported directly by ATAPI devices.
2069 * This transform handles the few exceptions.
2070 */
2071static int ide_cdrom_prep_pc(struct request *rq)
2072{
2073 u8 *c = rq->cmd;
2074
2075 /*
2076 * Transform 6-byte read/write commands to the 10-byte version
2077 */
2078 if (c[0] == READ_6 || c[0] == WRITE_6) {
2079 c[8] = c[4];
2080 c[5] = c[3];
2081 c[4] = c[2];
2082 c[3] = c[1] & 0x1f;
2083 c[2] = 0;
2084 c[1] &= 0xe0;
2085 c[0] += (READ_10 - READ_6);
2086 rq->cmd_len = 10;
2087 return BLKPREP_OK;
2088 }
2089
2090 /*
2091 * it's silly to pretend we understand 6-byte sense commands, just
2092 * reject with ILLEGAL_REQUEST and the caller should take the
2093 * appropriate action
2094 */
2095 if (c[0] == MODE_SENSE || c[0] == MODE_SELECT) {
2096 rq->errors = ILLEGAL_REQUEST;
2097 return BLKPREP_KILL;
2098 }
2099
2100 return BLKPREP_OK;
2101}
2102
Jens Axboe165125e2007-07-24 09:28:11 +02002103static int ide_cdrom_prep_fn(struct request_queue *q, struct request *rq)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002104{
Jens Axboe4aff5e22006-08-10 08:44:47 +02002105 if (blk_fs_request(rq))
Linus Torvalds1da177e2005-04-16 15:20:36 -07002106 return ide_cdrom_prep_fs(q, rq);
Jens Axboe4aff5e22006-08-10 08:44:47 +02002107 else if (blk_pc_request(rq))
Linus Torvalds1da177e2005-04-16 15:20:36 -07002108 return ide_cdrom_prep_pc(rq);
2109
2110 return 0;
2111}
2112
Bartlomiej Zolnierkiewicze59724c2008-02-01 23:09:22 +01002113struct cd_list_entry {
2114 const char *id_model;
2115 const char *id_firmware;
2116 unsigned int cd_flags;
2117};
2118
2119static const struct cd_list_entry ide_cd_quirks_list[] = {
2120 /* Limit transfer size per interrupt. */
2121 { "SAMSUNG CD-ROM SCR-2430", NULL, IDE_CD_FLAG_LIMIT_NFRAMES },
2122 { "SAMSUNG CD-ROM SCR-2432", NULL, IDE_CD_FLAG_LIMIT_NFRAMES },
2123 /* SCR-3231 doesn't support the SET_CD_SPEED command. */
2124 { "SAMSUNG CD-ROM SCR-3231", NULL, IDE_CD_FLAG_NO_SPEED_SELECT },
2125 /* Old NEC260 (not R) was released before ATAPI 1.2 spec. */
2126 { "NEC CD-ROM DRIVE:260", "1.01", IDE_CD_FLAG_TOCADDR_AS_BCD |
2127 IDE_CD_FLAG_PRE_ATAPI12, },
2128 /* Vertos 300, some versions of this drive like to talk BCD. */
2129 { "V003S0DS", NULL, IDE_CD_FLAG_VERTOS_300_SSD, },
2130 /* Vertos 600 ESD. */
2131 { "V006E0DS", NULL, IDE_CD_FLAG_VERTOS_600_ESD, },
2132 /*
2133 * Sanyo 3 CD changer uses a non-standard command for CD changing
2134 * (by default standard ATAPI support for CD changers is used).
2135 */
2136 { "CD-ROM CDR-C3 G", NULL, IDE_CD_FLAG_SANYO_3CD },
2137 { "CD-ROM CDR-C3G", NULL, IDE_CD_FLAG_SANYO_3CD },
2138 { "CD-ROM CDR_C36", NULL, IDE_CD_FLAG_SANYO_3CD },
2139 /* Stingray 8X CD-ROM. */
2140 { "STINGRAY 8422 IDE 8X CD-ROM 7-27-95", NULL, IDE_CD_FLAG_PRE_ATAPI12},
2141 /*
2142 * ACER 50X CD-ROM and WPI 32X CD-ROM require the full spec length
2143 * mode sense page capabilities size, but older drives break.
2144 */
2145 { "ATAPI CD ROM DRIVE 50X MAX", NULL, IDE_CD_FLAG_FULL_CAPS_PAGE },
2146 { "WPI CDS-32X", NULL, IDE_CD_FLAG_FULL_CAPS_PAGE },
2147 /* ACER/AOpen 24X CD-ROM has the speed fields byte-swapped. */
2148 { "", "241N", IDE_CD_FLAG_LE_SPEED_FIELDS },
2149 /*
2150 * Some drives used by Apple don't advertise audio play
2151 * but they do support reading TOC & audio datas.
2152 */
2153 { "MATSHITADVD-ROM SR-8187", NULL, IDE_CD_FLAG_PLAY_AUDIO_OK },
2154 { "MATSHITADVD-ROM SR-8186", NULL, IDE_CD_FLAG_PLAY_AUDIO_OK },
2155 { "MATSHITADVD-ROM SR-8176", NULL, IDE_CD_FLAG_PLAY_AUDIO_OK },
2156 { "MATSHITADVD-ROM SR-8174", NULL, IDE_CD_FLAG_PLAY_AUDIO_OK },
2157 { NULL, NULL, 0 }
2158};
2159
2160static unsigned int ide_cd_flags(struct hd_driveid *id)
2161{
2162 const struct cd_list_entry *cle = ide_cd_quirks_list;
2163
2164 while (cle->id_model) {
2165 if (strcmp(cle->id_model, id->model) == 0 &&
2166 (cle->id_firmware == NULL ||
2167 strstr(id->fw_rev, cle->id_firmware)))
2168 return cle->cd_flags;
2169 cle++;
2170 }
2171
2172 return 0;
2173}
2174
Linus Torvalds1da177e2005-04-16 15:20:36 -07002175static
2176int ide_cdrom_setup (ide_drive_t *drive)
2177{
Bartlomiej Zolnierkiewicz4fe67172008-02-01 23:09:21 +01002178 struct cdrom_info *cd = drive->driver_data;
2179 struct cdrom_device_info *cdi = &cd->devinfo;
Bartlomiej Zolnierkiewicze59724c2008-02-01 23:09:22 +01002180 struct hd_driveid *id = drive->id;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002181 int nslots;
2182
2183 blk_queue_prep_rq(drive->queue, ide_cdrom_prep_fn);
2184 blk_queue_dma_alignment(drive->queue, 31);
2185 drive->queue->unplug_delay = (1 * HZ) / 1000;
2186 if (!drive->queue->unplug_delay)
2187 drive->queue->unplug_delay = 1;
2188
2189 drive->special.all = 0;
2190
Bartlomiej Zolnierkiewicze59724c2008-02-01 23:09:22 +01002191 cd->cd_flags = IDE_CD_FLAG_MEDIA_CHANGED | IDE_CD_FLAG_NO_EJECT |
2192 ide_cd_flags(id);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002193
Bartlomiej Zolnierkiewicze59724c2008-02-01 23:09:22 +01002194 if ((id->config & 0x0060) == 0x20)
Bartlomiej Zolnierkiewicz2bc4cf22008-02-01 23:09:22 +01002195 cd->cd_flags |= IDE_CD_FLAG_DRQ_INTERRUPT;
Bartlomiej Zolnierkiewiczb8d25de2008-02-01 23:09:19 +01002196
Bartlomiej Zolnierkiewicze59724c2008-02-01 23:09:22 +01002197 if ((cd->cd_flags & IDE_CD_FLAG_VERTOS_300_SSD) &&
2198 id->fw_rev[4] == '1' && id->fw_rev[6] <= '2')
Bartlomiej Zolnierkiewicz2bc4cf22008-02-01 23:09:22 +01002199 cd->cd_flags |= (IDE_CD_FLAG_TOCTRACKS_AS_BCD |
2200 IDE_CD_FLAG_TOCADDR_AS_BCD);
Bartlomiej Zolnierkiewicze59724c2008-02-01 23:09:22 +01002201 else if ((cd->cd_flags & IDE_CD_FLAG_VERTOS_600_ESD) &&
2202 id->fw_rev[4] == '1' && id->fw_rev[6] <= '2')
Bartlomiej Zolnierkiewicz2bc4cf22008-02-01 23:09:22 +01002203 cd->cd_flags |= IDE_CD_FLAG_TOCTRACKS_AS_BCD;
Bartlomiej Zolnierkiewicze59724c2008-02-01 23:09:22 +01002204 else if (cd->cd_flags & IDE_CD_FLAG_SANYO_3CD)
2205 cdi->sanyo_slot = 3; /* 3 => use CD in slot 0 */
Linus Torvalds1da177e2005-04-16 15:20:36 -07002206
Linus Torvalds1da177e2005-04-16 15:20:36 -07002207 nslots = ide_cdrom_probe_capabilities (drive);
2208
2209 /*
2210 * set correct block size
2211 */
2212 blk_queue_hardsect_size(drive->queue, CD_FRAMESIZE);
2213
2214 if (drive->autotune == IDE_TUNE_DEFAULT ||
2215 drive->autotune == IDE_TUNE_AUTO)
2216 drive->dsc_overlap = (drive->next != drive);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002217
2218 if (ide_cdrom_register(drive, nslots)) {
2219 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 +01002220 cd->devinfo.handle = NULL;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002221 return 1;
2222 }
2223 ide_cdrom_add_settings(drive);
2224 return 0;
2225}
2226
Bartlomiej Zolnierkiewiczecfd80e2007-05-10 00:01:09 +02002227#ifdef CONFIG_IDE_PROC_FS
Linus Torvalds1da177e2005-04-16 15:20:36 -07002228static
2229sector_t ide_cdrom_capacity (ide_drive_t *drive)
2230{
2231 unsigned long capacity, sectors_per_frame;
2232
2233 if (cdrom_read_capacity(drive, &capacity, &sectors_per_frame, NULL))
2234 return 0;
2235
2236 return capacity * sectors_per_frame;
2237}
Amos Waterlandd97b32142005-10-30 15:02:10 -08002238#endif
Linus Torvalds1da177e2005-04-16 15:20:36 -07002239
Russell King4031bbe2006-01-06 11:41:00 +00002240static void ide_cd_remove(ide_drive_t *drive)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002241{
2242 struct cdrom_info *info = drive->driver_data;
2243
Bartlomiej Zolnierkiewicz7662d042007-05-10 00:01:10 +02002244 ide_proc_unregister_driver(drive, info->driver);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002245
2246 del_gendisk(info->disk);
2247
2248 ide_cd_put(info);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002249}
2250
2251static void ide_cd_release(struct kref *kref)
2252{
2253 struct cdrom_info *info = to_ide_cd(kref);
2254 struct cdrom_device_info *devinfo = &info->devinfo;
2255 ide_drive_t *drive = info->drive;
2256 struct gendisk *g = info->disk;
2257
Jesper Juhl6044ec82005-11-07 01:01:32 -08002258 kfree(info->buffer);
2259 kfree(info->toc);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002260 if (devinfo->handle == drive && unregister_cdrom(devinfo))
2261 printk(KERN_ERR "%s: %s failed to unregister device from the cdrom "
2262 "driver.\n", __FUNCTION__, drive->name);
2263 drive->dsc_overlap = 0;
2264 drive->driver_data = NULL;
2265 blk_queue_prep_rq(drive->queue, NULL);
2266 g->private_data = NULL;
2267 put_disk(g);
2268 kfree(info);
2269}
2270
Russell King4031bbe2006-01-06 11:41:00 +00002271static int ide_cd_probe(ide_drive_t *);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002272
Bartlomiej Zolnierkiewiczecfd80e2007-05-10 00:01:09 +02002273#ifdef CONFIG_IDE_PROC_FS
Linus Torvalds1da177e2005-04-16 15:20:36 -07002274static int proc_idecd_read_capacity
2275 (char *page, char **start, off_t off, int count, int *eof, void *data)
2276{
Jesper Juhl2a91f3e2005-10-30 15:02:45 -08002277 ide_drive_t *drive = data;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002278 int len;
2279
2280 len = sprintf(page,"%llu\n", (long long)ide_cdrom_capacity(drive));
2281 PROC_IDE_READ_RETURN(page,start,off,count,eof,len);
2282}
2283
2284static ide_proc_entry_t idecd_proc[] = {
2285 { "capacity", S_IFREG|S_IRUGO, proc_idecd_read_capacity, NULL },
2286 { NULL, 0, NULL, NULL }
2287};
Linus Torvalds1da177e2005-04-16 15:20:36 -07002288#endif
2289
2290static ide_driver_t ide_cdrom_driver = {
Bartlomiej Zolnierkiewicz8604aff2005-05-26 14:55:34 +02002291 .gen_driver = {
Laurent Riffard4ef3b8f2005-11-18 22:15:40 +01002292 .owner = THIS_MODULE,
Bartlomiej Zolnierkiewicz8604aff2005-05-26 14:55:34 +02002293 .name = "ide-cdrom",
2294 .bus = &ide_bus_type,
Bartlomiej Zolnierkiewicz8604aff2005-05-26 14:55:34 +02002295 },
Russell King4031bbe2006-01-06 11:41:00 +00002296 .probe = ide_cd_probe,
2297 .remove = ide_cd_remove,
Linus Torvalds1da177e2005-04-16 15:20:36 -07002298 .version = IDECD_VERSION,
2299 .media = ide_cdrom,
Linus Torvalds1da177e2005-04-16 15:20:36 -07002300 .supports_dsc_overlap = 1,
Linus Torvalds1da177e2005-04-16 15:20:36 -07002301 .do_request = ide_do_rw_cdrom,
2302 .end_request = ide_end_request,
2303 .error = __ide_error,
2304 .abort = __ide_abort,
Bartlomiej Zolnierkiewicz7662d042007-05-10 00:01:10 +02002305#ifdef CONFIG_IDE_PROC_FS
Linus Torvalds1da177e2005-04-16 15:20:36 -07002306 .proc = idecd_proc,
Bartlomiej Zolnierkiewicz7662d042007-05-10 00:01:10 +02002307#endif
Linus Torvalds1da177e2005-04-16 15:20:36 -07002308};
2309
2310static int idecd_open(struct inode * inode, struct file * file)
2311{
2312 struct gendisk *disk = inode->i_bdev->bd_disk;
2313 struct cdrom_info *info;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002314 int rc = -ENOMEM;
2315
2316 if (!(info = ide_cd_get(disk)))
2317 return -ENXIO;
2318
Linus Torvalds1da177e2005-04-16 15:20:36 -07002319 if (!info->buffer)
Bartlomiej Zolnierkiewiczc94964a2007-02-17 02:40:24 +01002320 info->buffer = kmalloc(SECTOR_BUFFER_SIZE, GFP_KERNEL|__GFP_REPEAT);
2321
2322 if (info->buffer)
2323 rc = cdrom_open(&info->devinfo, inode, file);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002324
2325 if (rc < 0)
2326 ide_cd_put(info);
2327
2328 return rc;
2329}
2330
2331static int idecd_release(struct inode * inode, struct file * file)
2332{
2333 struct gendisk *disk = inode->i_bdev->bd_disk;
2334 struct cdrom_info *info = ide_cd_g(disk);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002335
2336 cdrom_release (&info->devinfo, file);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002337
2338 ide_cd_put(info);
2339
2340 return 0;
2341}
2342
Christoph Hellwig6a2900b2006-03-23 03:00:15 -08002343static int idecd_set_spindown(struct cdrom_device_info *cdi, unsigned long arg)
2344{
2345 struct packet_command cgc;
2346 char buffer[16];
2347 int stat;
2348 char spindown;
2349
2350 if (copy_from_user(&spindown, (void __user *)arg, sizeof(char)))
2351 return -EFAULT;
2352
2353 init_cdrom_command(&cgc, buffer, sizeof(buffer), CGC_DATA_UNKNOWN);
2354
2355 stat = cdrom_mode_sense(cdi, &cgc, GPMODE_CDROM_PAGE, 0);
2356 if (stat)
2357 return stat;
2358
2359 buffer[11] = (buffer[11] & 0xf0) | (spindown & 0x0f);
2360 return cdrom_mode_select(cdi, &cgc);
2361}
2362
2363static int idecd_get_spindown(struct cdrom_device_info *cdi, unsigned long arg)
2364{
2365 struct packet_command cgc;
2366 char buffer[16];
2367 int stat;
2368 char spindown;
2369
2370 init_cdrom_command(&cgc, buffer, sizeof(buffer), CGC_DATA_UNKNOWN);
2371
2372 stat = cdrom_mode_sense(cdi, &cgc, GPMODE_CDROM_PAGE, 0);
2373 if (stat)
2374 return stat;
2375
2376 spindown = buffer[11] & 0x0f;
2377 if (copy_to_user((void __user *)arg, &spindown, sizeof (char)))
2378 return -EFAULT;
2379 return 0;
2380}
2381
Linus Torvalds1da177e2005-04-16 15:20:36 -07002382static int idecd_ioctl (struct inode *inode, struct file *file,
2383 unsigned int cmd, unsigned long arg)
2384{
2385 struct block_device *bdev = inode->i_bdev;
2386 struct cdrom_info *info = ide_cd_g(bdev->bd_disk);
2387 int err;
2388
Christoph Hellwig6a2900b2006-03-23 03:00:15 -08002389 switch (cmd) {
2390 case CDROMSETSPINDOWN:
2391 return idecd_set_spindown(&info->devinfo, arg);
2392 case CDROMGETSPINDOWN:
2393 return idecd_get_spindown(&info->devinfo, arg);
2394 default:
2395 break;
2396 }
2397
2398 err = generic_ide_ioctl(info->drive, file, bdev, cmd, arg);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002399 if (err == -EINVAL)
2400 err = cdrom_ioctl(file, &info->devinfo, inode, cmd, arg);
2401
2402 return err;
2403}
2404
2405static int idecd_media_changed(struct gendisk *disk)
2406{
2407 struct cdrom_info *info = ide_cd_g(disk);
2408 return cdrom_media_changed(&info->devinfo);
2409}
2410
2411static int idecd_revalidate_disk(struct gendisk *disk)
2412{
2413 struct cdrom_info *info = ide_cd_g(disk);
2414 struct request_sense sense;
Bartlomiej Zolnierkiewicz139c8292008-02-01 23:09:24 +01002415
2416 ide_cd_read_toc(info->drive, &sense);
2417
Linus Torvalds1da177e2005-04-16 15:20:36 -07002418 return 0;
2419}
2420
2421static struct block_device_operations idecd_ops = {
2422 .owner = THIS_MODULE,
2423 .open = idecd_open,
2424 .release = idecd_release,
2425 .ioctl = idecd_ioctl,
2426 .media_changed = idecd_media_changed,
2427 .revalidate_disk= idecd_revalidate_disk
2428};
2429
2430/* options */
2431static char *ignore = NULL;
2432
2433module_param(ignore, charp, 0400);
2434MODULE_DESCRIPTION("ATAPI CD-ROM Driver");
2435
Russell King4031bbe2006-01-06 11:41:00 +00002436static int ide_cd_probe(ide_drive_t *drive)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002437{
2438 struct cdrom_info *info;
2439 struct gendisk *g;
2440 struct request_sense sense;
2441
2442 if (!strstr("ide-cdrom", drive->driver_req))
2443 goto failed;
2444 if (!drive->present)
2445 goto failed;
2446 if (drive->media != ide_cdrom && drive->media != ide_optical)
2447 goto failed;
2448 /* skip drives that we were told to ignore */
2449 if (ignore != NULL) {
2450 if (strstr(ignore, drive->name)) {
2451 printk(KERN_INFO "ide-cd: ignoring drive %s\n", drive->name);
2452 goto failed;
2453 }
2454 }
2455 if (drive->scsi) {
2456 printk(KERN_INFO "ide-cd: passing drive %s to ide-scsi emulation.\n", drive->name);
2457 goto failed;
2458 }
Deepak Saxenaf5e3c2f2005-11-07 01:01:25 -08002459 info = kzalloc(sizeof(struct cdrom_info), GFP_KERNEL);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002460 if (info == NULL) {
2461 printk(KERN_ERR "%s: Can't allocate a cdrom structure\n", drive->name);
2462 goto failed;
2463 }
2464
2465 g = alloc_disk(1 << PARTN_BITS);
2466 if (!g)
2467 goto out_free_cd;
2468
2469 ide_init_disk(g, drive);
2470
Bartlomiej Zolnierkiewicz7662d042007-05-10 00:01:10 +02002471 ide_proc_register_driver(drive, &ide_cdrom_driver);
Bartlomiej Zolnierkiewicz8604aff2005-05-26 14:55:34 +02002472
Linus Torvalds1da177e2005-04-16 15:20:36 -07002473 kref_init(&info->kref);
2474
2475 info->drive = drive;
2476 info->driver = &ide_cdrom_driver;
2477 info->disk = g;
2478
2479 g->private_data = &info->driver;
2480
2481 drive->driver_data = info;
2482
Linus Torvalds1da177e2005-04-16 15:20:36 -07002483 g->minors = 1;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002484 g->driverfs_dev = &drive->gendev;
2485 g->flags = GENHD_FL_CD | GENHD_FL_REMOVABLE;
2486 if (ide_cdrom_setup(drive)) {
Bartlomiej Zolnierkiewicz7662d042007-05-10 00:01:10 +02002487 ide_proc_unregister_driver(drive, &ide_cdrom_driver);
Bartlomiej Zolnierkiewicz05017db2007-12-24 15:23:43 +01002488 ide_cd_release(&info->kref);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002489 goto failed;
2490 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07002491
Bartlomiej Zolnierkiewicz139c8292008-02-01 23:09:24 +01002492 ide_cd_read_toc(drive, &sense);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002493 g->fops = &idecd_ops;
2494 g->flags |= GENHD_FL_REMOVABLE;
2495 add_disk(g);
2496 return 0;
2497
Linus Torvalds1da177e2005-04-16 15:20:36 -07002498out_free_cd:
2499 kfree(info);
2500failed:
Bartlomiej Zolnierkiewicz8604aff2005-05-26 14:55:34 +02002501 return -ENODEV;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002502}
2503
2504static void __exit ide_cdrom_exit(void)
2505{
Bartlomiej Zolnierkiewicz8604aff2005-05-26 14:55:34 +02002506 driver_unregister(&ide_cdrom_driver.gen_driver);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002507}
Bartlomiej Zolnierkiewicz17514e82005-11-19 22:24:35 +01002508
2509static int __init ide_cdrom_init(void)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002510{
Bartlomiej Zolnierkiewicz8604aff2005-05-26 14:55:34 +02002511 return driver_register(&ide_cdrom_driver.gen_driver);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002512}
2513
Kay Sievers263756e2005-12-12 18:03:44 +01002514MODULE_ALIAS("ide:*m-cdrom*");
Bartlomiej Zolnierkiewicz972560f2008-02-01 23:09:23 +01002515MODULE_ALIAS("ide-cd");
Linus Torvalds1da177e2005-04-16 15:20:36 -07002516module_init(ide_cdrom_init);
2517module_exit(ide_cdrom_exit);
2518MODULE_LICENSE("GPL");