58397617b281936fdc4309cb9c3d2e65a54ccd8b
[safe/jmp/linux-2.6] / drivers / ide / ide-cd.c
1 /*
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  *
31  * For historical changelog please see:
32  *      Documentation/ide/ChangeLog.ide-cd.1994-2004
33  */
34
35 #define IDECD_VERSION "4.61"
36
37 #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>
48 #include <linux/mutex.h>
49 #include <linux/bcd.h>
50
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
61 static DEFINE_MUTEX(idecd_ref_mutex);
62
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
68 static struct cdrom_info *ide_cd_get(struct gendisk *disk)
69 {
70         struct cdrom_info *cd = NULL;
71
72         mutex_lock(&idecd_ref_mutex);
73         cd = ide_cd_g(disk);
74         if (cd)
75                 kref_get(&cd->kref);
76         mutex_unlock(&idecd_ref_mutex);
77         return cd;
78 }
79
80 static void ide_cd_release(struct kref *);
81
82 static void ide_cd_put(struct cdrom_info *cd)
83 {
84         mutex_lock(&idecd_ref_mutex);
85         kref_put(&cd->kref, ide_cd_release);
86         mutex_unlock(&idecd_ref_mutex);
87 }
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. */
95 static void cdrom_saw_media_change (ide_drive_t *drive)
96 {
97         struct cdrom_info *cd = drive->driver_data;
98
99         cd->cd_flags |= IDE_CD_FLAG_MEDIA_CHANGED;
100         cd->cd_flags &= ~IDE_CD_FLAG_TOC_VALID;
101         cd->nsectors_buffered = 0;
102 }
103
104 static int cdrom_log_sense(ide_drive_t *drive, struct request *rq,
105                            struct request_sense *sense)
106 {
107         int log = 0;
108
109         if (!sense || !rq || (rq->cmd_flags & REQ_QUIET))
110                 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)
131                                 break;
132                         log = 1;
133                         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
149 static
150 void cdrom_analyze_sense_data(ide_drive_t *drive,
151                               struct request *failed_command,
152                               struct request_sense *sense)
153 {
154         unsigned long sector;
155         unsigned long bio_sectors;
156         unsigned long valid;
157         struct cdrom_info *info = drive->driver_data;
158
159         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
171         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         }
202
203         ide_cd_log_error(drive->name, failed_command, sense);
204 }
205
206 /*
207  * Initialize a ide-cd packet command request
208  */
209 void ide_cd_init_rq(ide_drive_t *drive, struct request *rq)
210 {
211         struct cdrom_info *cd = drive->driver_data;
212
213         ide_init_drive_cmd(rq);
214         rq->cmd_type = REQ_TYPE_ATA_PC;
215         rq->rq_disk = cd->disk;
216 }
217
218 static 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 */
228         ide_cd_init_rq(drive, rq);
229
230         rq->data = sense;
231         rq->cmd[0] = GPCMD_REQUEST_SENSE;
232         rq->cmd[4] = rq->data_len = 18;
233
234         rq->cmd_type = REQ_TYPE_SENSE;
235
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
242 static 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
247         if (blk_sense_request(rq) && uptodate) {
248                 /*
249                  * For REQ_TYPE_SENSE, "rq->buffer" points to the original
250                  * failed request
251                  */
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                         }
262                         cdrom_analyze_sense_data(drive, failed, sense);
263                         /*
264                          * now end failed request
265                          */
266                         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);
272                                 if (__blk_end_request(failed, -EIO,
273                                                       failed->data_len))
274                                         BUG();
275                                 spin_unlock_irqrestore(&ide_lock, flags);
276                         }
277                 } else
278                         cdrom_analyze_sense_data(drive, NULL, sense);
279         }
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
292 static 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
299 /* Returns 0 if the request should be continued.
300    Returns 1 if the request was ended. */
301 static 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
323         if (blk_sense_request(rq)) {
324                 /* 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
328                 rq->cmd_flags |= REQ_FAILED;
329                 cdrom_end_request(drive, 0);
330                 ide_error(drive, "request sense failure", stat);
331                 return 1;
332
333         } else if (blk_pc_request(rq) || rq->cmd_type == REQ_TYPE_ATA_PC) {
334                 /* 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                  */
341                 if (blk_pc_request(rq) && !rq->errors)
342                         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;
352                 } 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                          */
361                 } else if (!(rq->cmd_flags & REQ_QUIET)) {
362                         /* Otherwise, print an error. */
363                         ide_dump_status(drive, "packet command error", stat);
364                 }
365                 
366                 rq->cmd_flags |= REQ_FAILED;
367
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.*/
436                         ide_dump_status_no_sense (drive, "command error", stat);
437                         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 */
441                         ide_dump_status_no_sense (drive, "media error (bad sector)", stat);
442                         do_end_request = 1;
443                 } else if (sense_key == BLANK_CHECK) {
444                         /* Disk appears blank ?? */
445                         ide_dump_status_no_sense (drive, "media error (blank)", stat);
446                         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
457                 /* 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 */
460
461                 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                 }
478         } 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
487 static 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:
507                         if (!(rq->cmd_flags & REQ_QUIET))
508                                 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
522 static 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
534         /* FIXME: for Virtual DMA we must check harder */
535         if (info->dma)
536                 info->dma = !hwif->dma_setup(drive);
537
538         /* Set up the controller registers. */
539         ide_pktcmd_tf_load(drive, IDE_TFLAG_OUT_NSECT | IDE_TFLAG_OUT_LBAL |
540                            IDE_TFLAG_NO_SELECT_MASK, xferlen, info->dma);
541
542         if (info->cd_flags & IDE_CD_FLAG_DRQ_INTERRUPT) {
543                 /* waiting for CDB interrupt, not DMA yet. */
544                 if (info->dma)
545                         drive->waiting_for_dma = 0;
546
547                 /* 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. */
568 #define ATAPI_MIN_CDB_BYTES 12
569 static 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
578         if (info->cd_flags & IDE_CD_FLAG_DRQ_INTERRUPT) {
579                 /* 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;
585
586                 /* Ok, next interrupt will be DMA interrupt. */
587                 if (info->dma)
588                         drive->waiting_for_dma = 1;
589         } 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
618 typedef void (xfer_func_t)(ide_drive_t *, void *, u32);
619
620 static 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
629 static 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
639 /*
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  */
646 static 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. */
677         ide_cd_drain_data(drive, sectors_to_transfer);
678 }
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  */
685 static
686 int cdrom_read_check_ireason (ide_drive_t *drive, int len, int ireason)
687 {
688         if (ireason == 2)
689                 return 0;
690         else if (ireason == 0) {
691                 ide_hwif_t *hwif = drive->hwif;
692
693                 /* Whoops... The drive is expecting to receive data from us! */
694                 printk(KERN_ERR "%s: %s: wrong transfer direction!\n",
695                                 drive->name, __FUNCTION__);
696
697                 /* Throw some data at the drive so it doesn't hang
698                    and quit this request. */
699                 ide_cd_pad_transfer(drive, hwif->atapi_output_bytes, len);
700         } else  if (ireason == 1) {
701                 /* Some drives (ASUS) seem to tell us that status
702                  * info is available. just get it and ignore.
703                  */
704                 (void) HWIF(drive)->INB(IDE_STATUS_REG);
705                 return 0;
706         } else {
707                 /* Drive wants a command packet, or invalid ireason... */
708                 printk(KERN_ERR "%s: %s: bad interrupt reason 0x%02x\n",
709                                 drive->name, __FUNCTION__, ireason);
710         }
711
712         cdrom_end_request(drive, 0);
713         return -1;
714 }
715
716 /*
717  * Assume that the drive will always provide data in multiples of at least
718  * SECTOR_SIZE, as it gets hairy to keep track of the transfers otherwise.
719  */
720 static int ide_cd_check_transfer_size(ide_drive_t *drive, int len)
721 {
722         struct cdrom_info *cd = drive->driver_data;
723
724         if ((len % SECTOR_SIZE) == 0)
725                 return 0;
726
727         printk(KERN_ERR "%s: %s: Bad transfer size %d\n",
728                         drive->name, __FUNCTION__, len);
729
730         if (cd->cd_flags & IDE_CD_FLAG_LIMIT_NFRAMES)
731                 printk(KERN_ERR "  This drive is not supported by "
732                                 "this version of the driver\n");
733         else {
734                 printk(KERN_ERR "  Trying to limit transfer sizes\n");
735                 cd->cd_flags |= IDE_CD_FLAG_LIMIT_NFRAMES;
736         }
737
738         return 1;
739 }
740
741 /*
742  * Try to satisfy some of the current read request from our cached data.
743  * Returns nonzero if the request has been completed, zero otherwise.
744  */
745 static int cdrom_read_from_buffer (ide_drive_t *drive)
746 {
747         struct cdrom_info *info = drive->driver_data;
748         struct request *rq = HWGROUP(drive)->rq;
749         unsigned short sectors_per_frame;
750
751         sectors_per_frame = queue_hardsect_size(drive->queue) >> SECTOR_BITS;
752
753         /* Can't do anything if there's no buffer. */
754         if (info->buffer == NULL) return 0;
755
756         /* Loop while this request needs data and the next block is present
757            in our cache. */
758         while (rq->nr_sectors > 0 &&
759                rq->sector >= info->sector_buffered &&
760                rq->sector < info->sector_buffered + info->nsectors_buffered) {
761                 if (rq->current_nr_sectors == 0)
762                         cdrom_end_request(drive, 1);
763
764                 memcpy (rq->buffer,
765                         info->buffer +
766                         (rq->sector - info->sector_buffered) * SECTOR_SIZE,
767                         SECTOR_SIZE);
768                 rq->buffer += SECTOR_SIZE;
769                 --rq->current_nr_sectors;
770                 --rq->nr_sectors;
771                 ++rq->sector;
772         }
773
774         /* If we've satisfied the current request,
775            terminate it successfully. */
776         if (rq->nr_sectors == 0) {
777                 cdrom_end_request(drive, 1);
778                 return -1;
779         }
780
781         /* Move on to the next buffer if needed. */
782         if (rq->current_nr_sectors == 0)
783                 cdrom_end_request(drive, 1);
784
785         /* If this condition does not hold, then the kluge i use to
786            represent the number of sectors to skip at the start of a transfer
787            will fail.  I think that this will never happen, but let's be
788            paranoid and check. */
789         if (rq->current_nr_sectors < bio_cur_sectors(rq->bio) &&
790             (rq->sector & (sectors_per_frame - 1))) {
791                 printk(KERN_ERR "%s: cdrom_read_from_buffer: buffer botch (%ld)\n",
792                         drive->name, (long)rq->sector);
793                 cdrom_end_request(drive, 0);
794                 return -1;
795         }
796
797         return 0;
798 }
799
800 static ide_startstop_t cdrom_rw_intr(ide_drive_t *);
801
802 /*
803  * Routine to send a read packet command to the drive.
804  * This is usually called directly from cdrom_start_read.
805  * However, for drq_interrupt devices, it is called from an interrupt
806  * when the drive is ready to accept the command.
807  */
808 static ide_startstop_t cdrom_start_read_continuation (ide_drive_t *drive)
809 {
810         struct request *rq = HWGROUP(drive)->rq;
811         unsigned short sectors_per_frame;
812         int nskip;
813
814         sectors_per_frame = queue_hardsect_size(drive->queue) >> SECTOR_BITS;
815
816         /* If the requested sector doesn't start on a cdrom block boundary,
817            we must adjust the start of the transfer so that it does,
818            and remember to skip the first few sectors.
819            If the CURRENT_NR_SECTORS field is larger than the size
820            of the buffer, it will mean that we're to skip a number
821            of sectors equal to the amount by which CURRENT_NR_SECTORS
822            is larger than the buffer size. */
823         nskip = rq->sector & (sectors_per_frame - 1);
824         if (nskip > 0) {
825                 /* Sanity check... */
826                 if (rq->current_nr_sectors != bio_cur_sectors(rq->bio) &&
827                         (rq->sector & (sectors_per_frame - 1))) {
828                         printk(KERN_ERR "%s: cdrom_start_read_continuation: buffer botch (%u)\n",
829                                 drive->name, rq->current_nr_sectors);
830                         cdrom_end_request(drive, 0);
831                         return ide_stopped;
832                 }
833                 rq->current_nr_sectors += nskip;
834         }
835
836         /* Set up the command */
837         rq->timeout = ATAPI_WAIT_PC;
838
839         /* Send the command to the drive and return. */
840         return cdrom_transfer_packet_command(drive, rq, cdrom_rw_intr);
841 }
842
843
844 #define IDECD_SEEK_THRESHOLD    (1000)                  /* 1000 blocks */
845 #define IDECD_SEEK_TIMER        (5 * WAIT_MIN_SLEEP)    /* 100 ms */
846 #define IDECD_SEEK_TIMEOUT      (2 * WAIT_CMD)          /* 20 sec */
847
848 static ide_startstop_t cdrom_seek_intr (ide_drive_t *drive)
849 {
850         struct cdrom_info *info = drive->driver_data;
851         int stat;
852         static int retry = 10;
853
854         if (cdrom_decode_status(drive, 0, &stat))
855                 return ide_stopped;
856
857         info->cd_flags |= IDE_CD_FLAG_SEEKING;
858
859         if (retry && time_after(jiffies, info->start_seek + IDECD_SEEK_TIMER)) {
860                 if (--retry == 0) {
861                         /*
862                          * this condition is far too common, to bother
863                          * users about it
864                          */
865                         /* printk("%s: disabled DSC seek overlap\n", drive->name);*/ 
866                         drive->dsc_overlap = 0;
867                 }
868         }
869         return ide_stopped;
870 }
871
872 static ide_startstop_t cdrom_start_seek_continuation (ide_drive_t *drive)
873 {
874         struct request *rq = HWGROUP(drive)->rq;
875         sector_t frame = rq->sector;
876
877         sector_div(frame, queue_hardsect_size(drive->queue) >> SECTOR_BITS);
878
879         memset(rq->cmd, 0, sizeof(rq->cmd));
880         rq->cmd[0] = GPCMD_SEEK;
881         put_unaligned(cpu_to_be32(frame), (unsigned int *) &rq->cmd[2]);
882
883         rq->timeout = ATAPI_WAIT_PC;
884         return cdrom_transfer_packet_command(drive, rq, &cdrom_seek_intr);
885 }
886
887 static ide_startstop_t cdrom_start_seek (ide_drive_t *drive, unsigned int block)
888 {
889         struct cdrom_info *info = drive->driver_data;
890
891         info->dma = 0;
892         info->start_seek = jiffies;
893         return cdrom_start_packet_command(drive, 0, cdrom_start_seek_continuation);
894 }
895
896 /* Fix up a possibly partially-processed request so that we can
897    start it over entirely, or even put it back on the request queue. */
898 static void restore_request (struct request *rq)
899 {
900         if (rq->buffer != bio_data(rq->bio)) {
901                 sector_t n = (rq->buffer - (char *) bio_data(rq->bio)) / SECTOR_SIZE;
902
903                 rq->buffer = bio_data(rq->bio);
904                 rq->nr_sectors += n;
905                 rq->sector -= n;
906         }
907         rq->hard_cur_sectors = rq->current_nr_sectors = bio_cur_sectors(rq->bio);
908         rq->hard_nr_sectors = rq->nr_sectors;
909         rq->hard_sector = rq->sector;
910         rq->q->prep_rq_fn(rq->q, rq);
911 }
912
913 /*
914  * Start a read request from the CD-ROM.
915  */
916 static ide_startstop_t cdrom_start_read (ide_drive_t *drive, unsigned int block)
917 {
918         struct cdrom_info *info = drive->driver_data;
919         struct request *rq = HWGROUP(drive)->rq;
920         unsigned short sectors_per_frame;
921
922         sectors_per_frame = queue_hardsect_size(drive->queue) >> SECTOR_BITS;
923
924         /* We may be retrying this request after an error.  Fix up
925            any weirdness which might be present in the request packet. */
926         restore_request(rq);
927
928         /* Satisfy whatever we can of this request from our cached sector. */
929         if (cdrom_read_from_buffer(drive))
930                 return ide_stopped;
931
932         /* Clear the local sector buffer. */
933         info->nsectors_buffered = 0;
934
935         /* use dma, if possible. */
936         info->dma = drive->using_dma;
937         if ((rq->sector & (sectors_per_frame - 1)) ||
938             (rq->nr_sectors & (sectors_per_frame - 1)))
939                 info->dma = 0;
940
941         /* Start sending the read request to the drive. */
942         return cdrom_start_packet_command(drive, 32768, cdrom_start_read_continuation);
943 }
944
945 /****************************************************************************
946  * Execute all other packet commands.
947  */
948
949 static void ide_cd_request_sense_fixup(struct request *rq)
950 {
951         /*
952          * Some of the trailing request sense fields are optional,
953          * and some drives don't send them.  Sigh.
954          */
955         if (rq->cmd[0] == GPCMD_REQUEST_SENSE &&
956             rq->data_len > 0 && rq->data_len <= 5)
957                 while (rq->data_len > 0) {
958                         *(u8 *)rq->data++ = 0;
959                         --rq->data_len;
960                 }
961 }
962
963 int ide_cd_queue_pc(ide_drive_t *drive, struct request *rq)
964 {
965         struct request_sense sense;
966         int retries = 10;
967         unsigned int flags = rq->cmd_flags;
968
969         if (rq->sense == NULL)
970                 rq->sense = &sense;
971
972         /* Start of retry loop. */
973         do {
974                 int error;
975                 unsigned long time = jiffies;
976                 rq->cmd_flags = flags;
977
978                 error = ide_do_drive_cmd(drive, rq, ide_wait);
979                 time = jiffies - time;
980
981                 /* FIXME: we should probably abort/retry or something 
982                  * in case of failure */
983                 if (rq->cmd_flags & REQ_FAILED) {
984                         /* The request failed.  Retry if it was due to a unit
985                            attention status
986                            (usually means media was changed). */
987                         struct request_sense *reqbuf = rq->sense;
988
989                         if (reqbuf->sense_key == UNIT_ATTENTION)
990                                 cdrom_saw_media_change(drive);
991                         else if (reqbuf->sense_key == NOT_READY &&
992                                  reqbuf->asc == 4 && reqbuf->ascq != 4) {
993                                 /* The drive is in the process of loading
994                                    a disk.  Retry, but wait a little to give
995                                    the drive time to complete the load. */
996                                 ssleep(2);
997                         } else {
998                                 /* Otherwise, don't retry. */
999                                 retries = 0;
1000                         }
1001                         --retries;
1002                 }
1003
1004                 /* End of retry loop. */
1005         } while ((rq->cmd_flags & REQ_FAILED) && retries >= 0);
1006
1007         /* Return an error if the command failed. */
1008         return (rq->cmd_flags & REQ_FAILED) ? -EIO : 0;
1009 }
1010
1011 /*
1012  * Write handling
1013  */
1014 static int cdrom_write_check_ireason(ide_drive_t *drive, int len, int ireason)
1015 {
1016         /* Two notes about IDE interrupt reason here - 0 means that
1017          * the drive wants to receive data from us, 2 means that
1018          * the drive is expecting to transfer data to us.
1019          */
1020         if (ireason == 0)
1021                 return 0;
1022         else if (ireason == 2) {
1023                 ide_hwif_t *hwif = drive->hwif;
1024
1025                 /* Whoops... The drive wants to send data. */
1026                 printk(KERN_ERR "%s: %s: wrong transfer direction!\n",
1027                                 drive->name, __FUNCTION__);
1028
1029                 ide_cd_pad_transfer(drive, hwif->atapi_input_bytes, len);
1030         } else {
1031                 /* Drive wants a command packet, or invalid ireason... */
1032                 printk(KERN_ERR "%s: %s: bad interrupt reason 0x%02x\n",
1033                                 drive->name, __FUNCTION__, ireason);
1034         }
1035
1036         cdrom_end_request(drive, 0);
1037         return 1;
1038 }
1039
1040 /*
1041  * Called from blk_end_request_callback() after the data of the request
1042  * is completed and before the request is completed.
1043  * By returning value '1', blk_end_request_callback() returns immediately
1044  * without completing the request.
1045  */
1046 static int cdrom_newpc_intr_dummy_cb(struct request *rq)
1047 {
1048         return 1;
1049 }
1050
1051 /*
1052  * best way to deal with dma that is not sector aligned right now... note
1053  * that in this path we are not using ->data or ->buffer at all. this irs
1054  * can replace cdrom_rw_intr() in the future.
1055  */
1056 static ide_startstop_t cdrom_newpc_intr(ide_drive_t *drive)
1057 {
1058         struct cdrom_info *info = drive->driver_data;
1059         struct request *rq = HWGROUP(drive)->rq;
1060         xfer_func_t *xferfunc;
1061         ide_expiry_t *expiry;
1062         int dma_error = 0, dma, stat, ireason, len, thislen, uptodate = 0;
1063         int write = (rq_data_dir(rq) == WRITE) ? 1 : 0;
1064         unsigned int timeout;
1065         u8 lowcyl, highcyl;
1066
1067         /* Check for errors. */
1068         dma = info->dma;
1069         if (dma) {
1070                 info->dma = 0;
1071                 dma_error = HWIF(drive)->ide_dma_end(drive);
1072                 if (dma_error) {
1073                         printk(KERN_ERR "%s: DMA %s error\n", drive->name,
1074                                         write ? "write" : "read");
1075                         ide_dma_off(drive);
1076                 }
1077         }
1078
1079         if (cdrom_decode_status(drive, 0, &stat))
1080                 return ide_stopped;
1081
1082         /*
1083          * using dma, transfer is complete now
1084          */
1085         if (dma) {
1086                 if (dma_error)
1087                         return ide_error(drive, "dma error", stat);
1088                 goto end_request;
1089         }
1090
1091         /*
1092          * ok we fall to pio :/
1093          */
1094         ireason = HWIF(drive)->INB(IDE_IREASON_REG) & 0x3;
1095         lowcyl  = HWIF(drive)->INB(IDE_BCOUNTL_REG);
1096         highcyl = HWIF(drive)->INB(IDE_BCOUNTH_REG);
1097
1098         len = lowcyl + (256 * highcyl);
1099         thislen = rq->data_len;
1100         if (thislen > len)
1101                 thislen = len;
1102
1103         /*
1104          * If DRQ is clear, the command has completed.
1105          */
1106         if ((stat & DRQ_STAT) == 0) {
1107                 if (!blk_pc_request(rq)) {
1108                         ide_cd_request_sense_fixup(rq);
1109                         /* Complain if we still have data left to transfer. */
1110                         uptodate = rq->data_len ? 0 : 1;
1111                 }
1112                 goto end_request;
1113         }
1114
1115         /*
1116          * check which way to transfer data
1117          */
1118         if (blk_pc_request(rq) && rq_data_dir(rq) == WRITE) {
1119                 /*
1120                  * write to drive
1121                  */
1122                 if (cdrom_write_check_ireason(drive, len, ireason))
1123                         return ide_stopped;
1124         } else if (blk_pc_request(rq)) {
1125                 /*
1126                  * read from drive
1127                  */
1128                 if (cdrom_read_check_ireason(drive, len, ireason))
1129                         return ide_stopped;
1130         }
1131
1132         if (ireason == 0) {
1133                 write = 1;
1134                 xferfunc = HWIF(drive)->atapi_output_bytes;
1135         } else if (ireason == 2 || (ireason == 1 && blk_pc_request(rq))) {
1136                 write = 0;
1137                 xferfunc = HWIF(drive)->atapi_input_bytes;
1138         } else {
1139                 printk(KERN_ERR "%s: %s: The drive "
1140                                 "appears confused (ireason = 0x%02x). "
1141                                 "Trying to recover by ending request.\n",
1142                                 drive->name, __FUNCTION__, ireason);
1143                 goto end_request;
1144         }
1145
1146         /*
1147          * transfer data
1148          */
1149         while (thislen > 0) {
1150                 int blen = blen = rq->data_len;
1151                 char *ptr = rq->data;
1152
1153                 /*
1154                  * bio backed?
1155                  */
1156                 if (rq->bio) {
1157                         ptr = bio_data(rq->bio);
1158                         blen = bio_iovec(rq->bio)->bv_len;
1159                 }
1160
1161                 if (!ptr) {
1162                         printk(KERN_ERR "%s: confused, missing data\n",
1163                                         drive->name);
1164                         blk_dump_rq_flags(rq, rq_data_dir(rq)
1165                                               ? "cdrom_newpc_intr, write"
1166                                               : "cdrom_newpc_intr, read");
1167                         break;
1168                 }
1169
1170                 if (blen > thislen)
1171                         blen = thislen;
1172
1173                 xferfunc(drive, ptr, blen);
1174
1175                 thislen -= blen;
1176                 len -= blen;
1177                 rq->data_len -= blen;
1178
1179                 if (rq->bio)
1180                         /*
1181                          * The request can't be completed until DRQ is cleared.
1182                          * So complete the data, but don't complete the request
1183                          * using the dummy function for the callback feature
1184                          * of blk_end_request_callback().
1185                          */
1186                         blk_end_request_callback(rq, 0, blen,
1187                                                  cdrom_newpc_intr_dummy_cb);
1188                 else
1189                         rq->data += blen;
1190         }
1191
1192         if (write && blk_sense_request(rq))
1193                 rq->sense_len += thislen;
1194
1195         /*
1196          * pad, if necessary
1197          */
1198         if (len > 0)
1199                 ide_cd_pad_transfer(drive, xferfunc, len);
1200
1201         if (blk_pc_request(rq)) {
1202                 timeout = rq->timeout;
1203                 expiry = NULL;
1204         } else {
1205                 timeout = ATAPI_WAIT_PC;
1206                 expiry = cdrom_timer_expiry;
1207         }
1208
1209         ide_set_handler(drive, cdrom_newpc_intr, timeout, expiry);
1210         return ide_started;
1211
1212 end_request:
1213         if (blk_pc_request(rq)) {
1214                 unsigned long flags;
1215
1216                 spin_lock_irqsave(&ide_lock, flags);
1217                 if (__blk_end_request(rq, 0, rq->data_len))
1218                         BUG();
1219                 HWGROUP(drive)->rq = NULL;
1220                 spin_unlock_irqrestore(&ide_lock, flags);
1221         } else {
1222                 if (!uptodate)
1223                         rq->cmd_flags |= REQ_FAILED;
1224                 cdrom_end_request(drive, uptodate);
1225         }
1226         return ide_stopped;
1227 }
1228
1229 static ide_startstop_t cdrom_rw_intr(ide_drive_t *drive)
1230 {
1231         struct cdrom_info *info = drive->driver_data;
1232         struct request *rq = HWGROUP(drive)->rq;
1233         xfer_func_t *xferfunc;
1234         int stat, ireason, len, sectors_to_transfer, uptodate, nskip;
1235         int dma_error = 0, dma = info->dma, write = rq_data_dir(rq) == WRITE;
1236         u8 lowcyl = 0, highcyl = 0;
1237
1238         /* Check for errors. */
1239         if (dma) {
1240                 info->dma = 0;
1241                 dma_error = HWIF(drive)->ide_dma_end(drive);
1242                 if (dma_error) {
1243                         printk(KERN_ERR "%s: DMA %s error\n", drive->name,
1244                                         write ? "write" : "read");
1245                         ide_dma_off(drive);
1246                 }
1247         }
1248
1249         if (cdrom_decode_status(drive, 0, &stat))
1250                 return ide_stopped;
1251
1252         /*
1253          * using dma, transfer is complete now
1254          */
1255         if (dma) {
1256                 if (dma_error)
1257                         return ide_error(drive, "dma error", stat);
1258
1259                 ide_end_request(drive, 1, rq->nr_sectors);
1260                 return ide_stopped;
1261         }
1262
1263         /* Read the interrupt reason and the transfer length. */
1264         ireason = HWIF(drive)->INB(IDE_IREASON_REG) & 0x3;
1265         lowcyl  = HWIF(drive)->INB(IDE_BCOUNTL_REG);
1266         highcyl = HWIF(drive)->INB(IDE_BCOUNTH_REG);
1267
1268         len = lowcyl + (256 * highcyl);
1269
1270         /* If DRQ is clear, the command has completed. */
1271         if ((stat & DRQ_STAT) == 0) {
1272                 /*
1273                  * If we're not done reading/writing, complain.
1274                  * Otherwise, complete the command normally.
1275                  */
1276                 uptodate = 1;
1277                 if (rq->current_nr_sectors > 0) {
1278                         printk(KERN_ERR "%s: %s: data underrun (%d blocks)\n",
1279                                         drive->name, __FUNCTION__,
1280                                         rq->current_nr_sectors);
1281                         if (!write)
1282                                 rq->cmd_flags |= REQ_FAILED;
1283                         uptodate = 0;
1284                 }
1285                 cdrom_end_request(drive, uptodate);
1286                 return ide_stopped;
1287         }
1288
1289         sectors_to_transfer = len / SECTOR_SIZE;
1290
1291         /* Check that the drive is expecting to do the same thing we are. */
1292         if (write) {
1293                 if (cdrom_write_check_ireason(drive, len, ireason))
1294                         return ide_stopped;
1295
1296                 xferfunc = HWIF(drive)->atapi_output_bytes;
1297         } else {
1298                 if (cdrom_read_check_ireason(drive, len, ireason))
1299                         return ide_stopped;
1300
1301                 if (ide_cd_check_transfer_size(drive, len)) {
1302                         cdrom_end_request(drive, 0);
1303                         return ide_stopped;
1304                 }
1305
1306                 /*
1307                  * First, figure out if we need to bit-bucket
1308                  * any of the leading sectors.
1309                  */
1310                 nskip = min_t(int, rq->current_nr_sectors
1311                                    - bio_cur_sectors(rq->bio),
1312                                    sectors_to_transfer);
1313
1314                 if (nskip > 0) {
1315                         ide_cd_drain_data(drive, nskip);
1316                         rq->current_nr_sectors -= nskip;
1317                         sectors_to_transfer -= nskip;
1318                 }
1319
1320                 xferfunc = HWIF(drive)->atapi_input_bytes;
1321         }
1322
1323         /*
1324          * now loop and read/write the data
1325          */
1326         while (sectors_to_transfer > 0) {
1327                 int this_transfer;
1328
1329                 /*
1330                  * If we've filled the present buffer but there's another
1331                  * chained buffer after it, move on.
1332                  */
1333                 if (!write && rq->current_nr_sectors == 0 && rq->nr_sectors)
1334                         cdrom_end_request(drive, 1);
1335
1336                 if (!rq->current_nr_sectors) {
1337                         if (!write)
1338                                 /*
1339                                  * If the buffers are full, cache the rest
1340                                  * of the data in our internal buffer.
1341                                  */
1342                                 cdrom_buffer_sectors(drive, rq->sector,
1343                                                      sectors_to_transfer);
1344                         else
1345                                 printk(KERN_ERR "%s: %s: confused, missing "
1346                                                 "data\n",
1347                                                 drive->name, __FUNCTION__);
1348                         break;
1349                 }
1350
1351                 /*
1352                  * Figure out how many sectors we can transfer
1353                  */
1354                 this_transfer = min_t(int, sectors_to_transfer, rq->current_nr_sectors);
1355
1356                 while (this_transfer > 0) {
1357                         xferfunc(drive, rq->buffer, SECTOR_SIZE);
1358                         rq->buffer += SECTOR_SIZE;
1359                         --rq->nr_sectors;
1360                         --rq->current_nr_sectors;
1361                         ++rq->sector;
1362                         --this_transfer;
1363                         --sectors_to_transfer;
1364                 }
1365
1366                 /*
1367                  * current buffer complete, move on
1368                  */
1369                 if (write && rq->current_nr_sectors == 0 && rq->nr_sectors)
1370                         cdrom_end_request(drive, 1);
1371         }
1372
1373         /* re-arm handler */
1374         ide_set_handler(drive, cdrom_rw_intr, ATAPI_WAIT_PC, NULL);
1375         return ide_started;
1376 }
1377
1378 static ide_startstop_t cdrom_start_write_cont(ide_drive_t *drive)
1379 {
1380         struct request *rq = HWGROUP(drive)->rq;
1381
1382 #if 0   /* the immediate bit */
1383         rq->cmd[1] = 1 << 3;
1384 #endif
1385         rq->timeout = ATAPI_WAIT_PC;
1386
1387         return cdrom_transfer_packet_command(drive, rq, cdrom_rw_intr);
1388 }
1389
1390 static ide_startstop_t cdrom_start_write(ide_drive_t *drive, struct request *rq)
1391 {
1392         struct cdrom_info *info = drive->driver_data;
1393         struct gendisk *g = info->disk;
1394         unsigned short sectors_per_frame = queue_hardsect_size(drive->queue) >> SECTOR_BITS;
1395
1396         /*
1397          * writes *must* be hardware frame aligned
1398          */
1399         if ((rq->nr_sectors & (sectors_per_frame - 1)) ||
1400             (rq->sector & (sectors_per_frame - 1))) {
1401                 cdrom_end_request(drive, 0);
1402                 return ide_stopped;
1403         }
1404
1405         /*
1406          * disk has become write protected
1407          */
1408         if (g->policy) {
1409                 cdrom_end_request(drive, 0);
1410                 return ide_stopped;
1411         }
1412
1413         info->nsectors_buffered = 0;
1414
1415         /* use dma, if possible. we don't need to check more, since we
1416          * know that the transfer is always (at least!) frame aligned */
1417         info->dma = drive->using_dma ? 1 : 0;
1418
1419         info->devinfo.media_written = 1;
1420
1421         /* Start sending the write request to the drive. */
1422         return cdrom_start_packet_command(drive, 32768, cdrom_start_write_cont);
1423 }
1424
1425 static ide_startstop_t cdrom_do_newpc_cont(ide_drive_t *drive)
1426 {
1427         struct request *rq = HWGROUP(drive)->rq;
1428
1429         if (!rq->timeout)
1430                 rq->timeout = ATAPI_WAIT_PC;
1431
1432         return cdrom_transfer_packet_command(drive, rq, cdrom_newpc_intr);
1433 }
1434
1435 static ide_startstop_t cdrom_do_block_pc(ide_drive_t *drive, struct request *rq)
1436 {
1437         struct cdrom_info *info = drive->driver_data;
1438
1439         if (blk_pc_request(rq))
1440                 rq->cmd_flags |= REQ_QUIET;
1441         else
1442                 rq->cmd_flags &= ~REQ_FAILED;
1443
1444         info->dma = 0;
1445
1446         /*
1447          * sg request
1448          */
1449         if (rq->bio) {
1450                 int mask = drive->queue->dma_alignment;
1451                 unsigned long addr = (unsigned long) page_address(bio_page(rq->bio));
1452
1453                 info->dma = drive->using_dma;
1454
1455                 /*
1456                  * check if dma is safe
1457                  *
1458                  * NOTE! The "len" and "addr" checks should possibly have
1459                  * separate masks.
1460                  */
1461                 if ((rq->data_len & 15) || (addr & mask))
1462                         info->dma = 0;
1463         }
1464
1465         /* Start sending the command to the drive. */
1466         return cdrom_start_packet_command(drive, rq->data_len, cdrom_do_newpc_cont);
1467 }
1468
1469 /****************************************************************************
1470  * cdrom driver request routine.
1471  */
1472 static ide_startstop_t
1473 ide_do_rw_cdrom (ide_drive_t *drive, struct request *rq, sector_t block)
1474 {
1475         ide_startstop_t action;
1476         struct cdrom_info *info = drive->driver_data;
1477
1478         if (blk_fs_request(rq)) {
1479                 if (info->cd_flags & IDE_CD_FLAG_SEEKING) {
1480                         unsigned long elapsed = jiffies - info->start_seek;
1481                         int stat = HWIF(drive)->INB(IDE_STATUS_REG);
1482
1483                         if ((stat & SEEK_STAT) != SEEK_STAT) {
1484                                 if (elapsed < IDECD_SEEK_TIMEOUT) {
1485                                         ide_stall_queue(drive, IDECD_SEEK_TIMER);
1486                                         return ide_stopped;
1487                                 }
1488                                 printk (KERN_ERR "%s: DSC timeout\n", drive->name);
1489                         }
1490                         info->cd_flags &= ~IDE_CD_FLAG_SEEKING;
1491                 }
1492                 if ((rq_data_dir(rq) == READ) && IDE_LARGE_SEEK(info->last_block, block, IDECD_SEEK_THRESHOLD) && drive->dsc_overlap) {
1493                         action = cdrom_start_seek(drive, block);
1494                 } else {
1495                         if (rq_data_dir(rq) == READ)
1496                                 action = cdrom_start_read(drive, block);
1497                         else
1498                                 action = cdrom_start_write(drive, rq);
1499                 }
1500                 info->last_block = block;
1501                 return action;
1502         } else if (blk_sense_request(rq) || blk_pc_request(rq) ||
1503                    rq->cmd_type == REQ_TYPE_ATA_PC) {
1504                 return cdrom_do_block_pc(drive, rq);
1505         } else if (blk_special_request(rq)) {
1506                 /*
1507                  * right now this can only be a reset...
1508                  */
1509                 cdrom_end_request(drive, 1);
1510                 return ide_stopped;
1511         }
1512
1513         blk_dump_rq_flags(rq, "ide-cd bad flags");
1514         cdrom_end_request(drive, 0);
1515         return ide_stopped;
1516 }
1517
1518
1519
1520 /****************************************************************************
1521  * Ioctl handling.
1522  *
1523  * Routines which queue packet commands take as a final argument a pointer
1524  * to a request_sense struct.  If execution of the command results
1525  * in an error with a CHECK CONDITION status, this structure will be filled
1526  * with the results of the subsequent request sense command.  The pointer
1527  * can also be NULL, in which case no sense information is returned.
1528  */
1529
1530 static
1531 void msf_from_bcd (struct atapi_msf *msf)
1532 {
1533         msf->minute = BCD2BIN(msf->minute);
1534         msf->second = BCD2BIN(msf->second);
1535         msf->frame  = BCD2BIN(msf->frame);
1536 }
1537
1538 static int cdrom_check_status(ide_drive_t *drive, struct request_sense *sense)
1539 {
1540         struct request req;
1541         struct cdrom_info *info = drive->driver_data;
1542         struct cdrom_device_info *cdi = &info->devinfo;
1543
1544         ide_cd_init_rq(drive, &req);
1545
1546         req.sense = sense;
1547         req.cmd[0] = GPCMD_TEST_UNIT_READY;
1548         req.cmd_flags |= REQ_QUIET;
1549
1550         /*
1551          * Sanyo 3 CD changer uses byte 7 of TEST_UNIT_READY to
1552          * switch CDs instead of supporting the LOAD_UNLOAD opcode.
1553          */
1554         req.cmd[7] = cdi->sanyo_slot % 3;
1555
1556         return ide_cd_queue_pc(drive, &req);
1557 }
1558
1559 /* Lock the door if LOCKFLAG is nonzero; unlock it otherwise. */
1560 int ide_cd_lockdoor(ide_drive_t *drive, int lockflag,
1561                     struct request_sense *sense)
1562 {
1563         struct cdrom_info *cd = drive->driver_data;
1564         struct request_sense my_sense;
1565         struct request req;
1566         int stat;
1567
1568         if (sense == NULL)
1569                 sense = &my_sense;
1570
1571         /* If the drive cannot lock the door, just pretend. */
1572         if (cd->cd_flags & IDE_CD_FLAG_NO_DOORLOCK) {
1573                 stat = 0;
1574         } else {
1575                 ide_cd_init_rq(drive, &req);
1576                 req.sense = sense;
1577                 req.cmd[0] = GPCMD_PREVENT_ALLOW_MEDIUM_REMOVAL;
1578                 req.cmd[4] = lockflag ? 1 : 0;
1579                 stat = ide_cd_queue_pc(drive, &req);
1580         }
1581
1582         /* If we got an illegal field error, the drive
1583            probably cannot lock the door. */
1584         if (stat != 0 &&
1585             sense->sense_key == ILLEGAL_REQUEST &&
1586             (sense->asc == 0x24 || sense->asc == 0x20)) {
1587                 printk (KERN_ERR "%s: door locking not supported\n",
1588                         drive->name);
1589                 cd->cd_flags |= IDE_CD_FLAG_NO_DOORLOCK;
1590                 stat = 0;
1591         }
1592         
1593         /* no medium, that's alright. */
1594         if (stat != 0 && sense->sense_key == NOT_READY && sense->asc == 0x3a)
1595                 stat = 0;
1596
1597         if (stat == 0) {
1598                 if (lockflag)
1599                         cd->cd_flags |= IDE_CD_FLAG_DOOR_LOCKED;
1600                 else
1601                         cd->cd_flags &= ~IDE_CD_FLAG_DOOR_LOCKED;
1602         }
1603
1604         return stat;
1605 }
1606
1607
1608 /* Eject the disk if EJECTFLAG is 0.
1609    If EJECTFLAG is 1, try to reload the disk. */
1610 static int cdrom_eject(ide_drive_t *drive, int ejectflag,
1611                        struct request_sense *sense)
1612 {
1613         struct cdrom_info *cd = drive->driver_data;
1614         struct cdrom_device_info *cdi = &cd->devinfo;
1615         struct request req;
1616         char loej = 0x02;
1617
1618         if ((cd->cd_flags & IDE_CD_FLAG_NO_EJECT) && !ejectflag)
1619                 return -EDRIVE_CANT_DO_THIS;
1620
1621         /* reload fails on some drives, if the tray is locked */
1622         if ((cd->cd_flags & IDE_CD_FLAG_DOOR_LOCKED) && ejectflag)
1623                 return 0;
1624
1625         ide_cd_init_rq(drive, &req);
1626
1627         /* only tell drive to close tray if open, if it can do that */
1628         if (ejectflag && (cdi->mask & CDC_CLOSE_TRAY))
1629                 loej = 0;
1630
1631         req.sense = sense;
1632         req.cmd[0] = GPCMD_START_STOP_UNIT;
1633         req.cmd[4] = loej | (ejectflag != 0);
1634
1635         return ide_cd_queue_pc(drive, &req);
1636 }
1637
1638 static int cdrom_read_capacity(ide_drive_t *drive, unsigned long *capacity,
1639                                unsigned long *sectors_per_frame,
1640                                struct request_sense *sense)
1641 {
1642         struct {
1643                 __u32 lba;
1644                 __u32 blocklen;
1645         } capbuf;
1646
1647         int stat;
1648         struct request req;
1649
1650         ide_cd_init_rq(drive, &req);
1651
1652         req.sense = sense;
1653         req.cmd[0] = GPCMD_READ_CDVD_CAPACITY;
1654         req.data = (char *)&capbuf;
1655         req.data_len = sizeof(capbuf);
1656         req.cmd_flags |= REQ_QUIET;
1657
1658         stat = ide_cd_queue_pc(drive, &req);
1659         if (stat == 0) {
1660                 *capacity = 1 + be32_to_cpu(capbuf.lba);
1661                 *sectors_per_frame =
1662                         be32_to_cpu(capbuf.blocklen) >> SECTOR_BITS;
1663         }
1664
1665         return stat;
1666 }
1667
1668 static int cdrom_read_tocentry(ide_drive_t *drive, int trackno, int msf_flag,
1669                                 int format, char *buf, int buflen,
1670                                 struct request_sense *sense)
1671 {
1672         struct request req;
1673
1674         ide_cd_init_rq(drive, &req);
1675
1676         req.sense = sense;
1677         req.data =  buf;
1678         req.data_len = buflen;
1679         req.cmd_flags |= REQ_QUIET;
1680         req.cmd[0] = GPCMD_READ_TOC_PMA_ATIP;
1681         req.cmd[6] = trackno;
1682         req.cmd[7] = (buflen >> 8);
1683         req.cmd[8] = (buflen & 0xff);
1684         req.cmd[9] = (format << 6);
1685
1686         if (msf_flag)
1687                 req.cmd[1] = 2;
1688
1689         return ide_cd_queue_pc(drive, &req);
1690 }
1691
1692 /* Try to read the entire TOC for the disk into our internal buffer. */
1693 int ide_cd_read_toc(ide_drive_t *drive, struct request_sense *sense)
1694 {
1695         int stat, ntracks, i;
1696         struct cdrom_info *info = drive->driver_data;
1697         struct cdrom_device_info *cdi = &info->devinfo;
1698         struct atapi_toc *toc = info->toc;
1699         struct {
1700                 struct atapi_toc_header hdr;
1701                 struct atapi_toc_entry  ent;
1702         } ms_tmp;
1703         long last_written;
1704         unsigned long sectors_per_frame = SECTORS_PER_FRAME;
1705
1706         if (toc == NULL) {
1707                 /* Try to allocate space. */
1708                 toc = kmalloc(sizeof(struct atapi_toc), GFP_KERNEL);
1709                 if (toc == NULL) {
1710                         printk (KERN_ERR "%s: No cdrom TOC buffer!\n", drive->name);
1711                         return -ENOMEM;
1712                 }
1713                 info->toc = toc;
1714         }
1715
1716         /* Check to see if the existing data is still valid.
1717            If it is, just return. */
1718         (void) cdrom_check_status(drive, sense);
1719
1720         if (info->cd_flags & IDE_CD_FLAG_TOC_VALID)
1721                 return 0;
1722
1723         /* Try to get the total cdrom capacity and sector size. */
1724         stat = cdrom_read_capacity(drive, &toc->capacity, &sectors_per_frame,
1725                                    sense);
1726         if (stat)
1727                 toc->capacity = 0x1fffff;
1728
1729         set_capacity(info->disk, toc->capacity * sectors_per_frame);
1730         /* Save a private copy of te TOC capacity for error handling */
1731         drive->probed_capacity = toc->capacity * sectors_per_frame;
1732
1733         blk_queue_hardsect_size(drive->queue,
1734                                 sectors_per_frame << SECTOR_BITS);
1735
1736         /* First read just the header, so we know how long the TOC is. */
1737         stat = cdrom_read_tocentry(drive, 0, 1, 0, (char *) &toc->hdr,
1738                                     sizeof(struct atapi_toc_header), sense);
1739         if (stat)
1740                 return stat;
1741
1742         if (info->cd_flags & IDE_CD_FLAG_TOCTRACKS_AS_BCD) {
1743                 toc->hdr.first_track = BCD2BIN(toc->hdr.first_track);
1744                 toc->hdr.last_track  = BCD2BIN(toc->hdr.last_track);
1745         }
1746
1747         ntracks = toc->hdr.last_track - toc->hdr.first_track + 1;
1748         if (ntracks <= 0)
1749                 return -EIO;
1750         if (ntracks > MAX_TRACKS)
1751                 ntracks = MAX_TRACKS;
1752
1753         /* Now read the whole schmeer. */
1754         stat = cdrom_read_tocentry(drive, toc->hdr.first_track, 1, 0,
1755                                   (char *)&toc->hdr,
1756                                    sizeof(struct atapi_toc_header) +
1757                                    (ntracks + 1) *
1758                                    sizeof(struct atapi_toc_entry), sense);
1759
1760         if (stat && toc->hdr.first_track > 1) {
1761                 /* Cds with CDI tracks only don't have any TOC entries,
1762                    despite of this the returned values are
1763                    first_track == last_track = number of CDI tracks + 1,
1764                    so that this case is indistinguishable from the same
1765                    layout plus an additional audio track.
1766                    If we get an error for the regular case, we assume
1767                    a CDI without additional audio tracks. In this case
1768                    the readable TOC is empty (CDI tracks are not included)
1769                    and only holds the Leadout entry. Heiko Eißfeldt */
1770                 ntracks = 0;
1771                 stat = cdrom_read_tocentry(drive, CDROM_LEADOUT, 1, 0,
1772                                            (char *)&toc->hdr,
1773                                            sizeof(struct atapi_toc_header) +
1774                                            (ntracks + 1) *
1775                                            sizeof(struct atapi_toc_entry),
1776                                            sense);
1777                 if (stat)
1778                         return stat;
1779
1780                 if (info->cd_flags & IDE_CD_FLAG_TOCTRACKS_AS_BCD) {
1781                         toc->hdr.first_track = (u8)BIN2BCD(CDROM_LEADOUT);
1782                         toc->hdr.last_track = (u8)BIN2BCD(CDROM_LEADOUT);
1783                 } else {
1784                         toc->hdr.first_track = CDROM_LEADOUT;
1785                         toc->hdr.last_track = CDROM_LEADOUT;
1786                 }
1787         }
1788
1789         if (stat)
1790                 return stat;
1791
1792         toc->hdr.toc_length = ntohs (toc->hdr.toc_length);
1793
1794         if (info->cd_flags & IDE_CD_FLAG_TOCTRACKS_AS_BCD) {
1795                 toc->hdr.first_track = BCD2BIN(toc->hdr.first_track);
1796                 toc->hdr.last_track  = BCD2BIN(toc->hdr.last_track);
1797         }
1798
1799         for (i = 0; i <= ntracks; i++) {
1800                 if (info->cd_flags & IDE_CD_FLAG_TOCADDR_AS_BCD) {
1801                         if (info->cd_flags & IDE_CD_FLAG_TOCTRACKS_AS_BCD)
1802                                 toc->ent[i].track = BCD2BIN(toc->ent[i].track);
1803                         msf_from_bcd(&toc->ent[i].addr.msf);
1804                 }
1805                 toc->ent[i].addr.lba = msf_to_lba (toc->ent[i].addr.msf.minute,
1806                                                    toc->ent[i].addr.msf.second,
1807                                                    toc->ent[i].addr.msf.frame);
1808         }
1809
1810         /* Read the multisession information. */
1811         if (toc->hdr.first_track != CDROM_LEADOUT) {
1812                 /* Read the multisession information. */
1813                 stat = cdrom_read_tocentry(drive, 0, 0, 1, (char *)&ms_tmp,
1814                                            sizeof(ms_tmp), sense);
1815                 if (stat)
1816                         return stat;
1817
1818                 toc->last_session_lba = be32_to_cpu(ms_tmp.ent.addr.lba);
1819         } else {
1820                 ms_tmp.hdr.first_track = ms_tmp.hdr.last_track = CDROM_LEADOUT;
1821                 toc->last_session_lba = msf_to_lba(0, 2, 0); /* 0m 2s 0f */
1822         }
1823
1824         if (info->cd_flags & IDE_CD_FLAG_TOCADDR_AS_BCD) {
1825                 /* Re-read multisession information using MSF format */
1826                 stat = cdrom_read_tocentry(drive, 0, 1, 1, (char *)&ms_tmp,
1827                                            sizeof(ms_tmp), sense);
1828                 if (stat)
1829                         return stat;
1830
1831                 msf_from_bcd (&ms_tmp.ent.addr.msf);
1832                 toc->last_session_lba = msf_to_lba(ms_tmp.ent.addr.msf.minute,
1833                                                    ms_tmp.ent.addr.msf.second,
1834                                                    ms_tmp.ent.addr.msf.frame);
1835         }
1836
1837         toc->xa_flag = (ms_tmp.hdr.first_track != ms_tmp.hdr.last_track);
1838
1839         /* Now try to get the total cdrom capacity. */
1840         stat = cdrom_get_last_written(cdi, &last_written);
1841         if (!stat && (last_written > toc->capacity)) {
1842                 toc->capacity = last_written;
1843                 set_capacity(info->disk, toc->capacity * sectors_per_frame);
1844                 drive->probed_capacity = toc->capacity * sectors_per_frame;
1845         }
1846
1847         /* Remember that we've read this stuff. */
1848         info->cd_flags |= IDE_CD_FLAG_TOC_VALID;
1849
1850         return 0;
1851 }
1852
1853 /* the generic packet interface to cdrom.c */
1854 static int ide_cdrom_packet(struct cdrom_device_info *cdi,
1855                             struct packet_command *cgc)
1856 {
1857         struct request req;
1858         ide_drive_t *drive = cdi->handle;
1859
1860         if (cgc->timeout <= 0)
1861                 cgc->timeout = ATAPI_WAIT_PC;
1862
1863         /* here we queue the commands from the uniform CD-ROM
1864            layer. the packet must be complete, as we do not
1865            touch it at all. */
1866         ide_cd_init_rq(drive, &req);
1867         memcpy(req.cmd, cgc->cmd, CDROM_PACKET_SIZE);
1868         if (cgc->sense)
1869                 memset(cgc->sense, 0, sizeof(struct request_sense));
1870         req.data = cgc->buffer;
1871         req.data_len = cgc->buflen;
1872         req.timeout = cgc->timeout;
1873
1874         if (cgc->quiet)
1875                 req.cmd_flags |= REQ_QUIET;
1876
1877         req.sense = cgc->sense;
1878         cgc->stat = ide_cd_queue_pc(drive, &req);
1879         if (!cgc->stat)
1880                 cgc->buflen -= req.data_len;
1881         return cgc->stat;
1882 }
1883
1884 static
1885 int ide_cdrom_tray_move (struct cdrom_device_info *cdi, int position)
1886 {
1887         ide_drive_t *drive = cdi->handle;
1888         struct request_sense sense;
1889
1890         if (position) {
1891                 int stat = ide_cd_lockdoor(drive, 0, &sense);
1892
1893                 if (stat)
1894                         return stat;
1895         }
1896
1897         return cdrom_eject(drive, !position, &sense);
1898 }
1899
1900 int ide_cdrom_get_capabilities(ide_drive_t *drive, u8 *buf)
1901 {
1902         struct cdrom_info *info = drive->driver_data;
1903         struct cdrom_device_info *cdi = &info->devinfo;
1904         struct packet_command cgc;
1905         int stat, attempts = 3, size = ATAPI_CAPABILITIES_PAGE_SIZE;
1906
1907         if ((info->cd_flags & IDE_CD_FLAG_FULL_CAPS_PAGE) == 0)
1908                 size -= ATAPI_CAPABILITIES_PAGE_PAD_SIZE;
1909
1910         init_cdrom_command(&cgc, buf, size, CGC_DATA_UNKNOWN);
1911         do { /* we seem to get stat=0x01,err=0x00 the first time (??) */
1912                 stat = cdrom_mode_sense(cdi, &cgc, GPMODE_CAPABILITIES_PAGE, 0);
1913                 if (!stat)
1914                         break;
1915         } while (--attempts);
1916         return stat;
1917 }
1918
1919 void ide_cdrom_update_speed(ide_drive_t *drive, u8 *buf)
1920 {
1921         struct cdrom_info *cd = drive->driver_data;
1922         u16 curspeed, maxspeed;
1923
1924         curspeed = *(u16 *)&buf[8 + 14];
1925         maxspeed = *(u16 *)&buf[8 +  8];
1926
1927         if (cd->cd_flags & IDE_CD_FLAG_LE_SPEED_FIELDS) {
1928                 curspeed = le16_to_cpu(curspeed);
1929                 maxspeed = le16_to_cpu(maxspeed);
1930         } else {
1931                 curspeed = be16_to_cpu(curspeed);
1932                 maxspeed = be16_to_cpu(maxspeed);
1933         }
1934
1935         cd->current_speed = (curspeed + (176/2)) / 176;
1936         cd->max_speed = (maxspeed + (176/2)) / 176;
1937 }
1938
1939 /*
1940  * add logic to try GET_EVENT command first to check for media and tray
1941  * status. this should be supported by newer cd-r/w and all DVD etc
1942  * drives
1943  */
1944 static
1945 int ide_cdrom_drive_status (struct cdrom_device_info *cdi, int slot_nr)
1946 {
1947         ide_drive_t *drive = cdi->handle;
1948         struct media_event_desc med;
1949         struct request_sense sense;
1950         int stat;
1951
1952         if (slot_nr != CDSL_CURRENT)
1953                 return -EINVAL;
1954
1955         stat = cdrom_check_status(drive, &sense);
1956         if (!stat || sense.sense_key == UNIT_ATTENTION)
1957                 return CDS_DISC_OK;
1958
1959         if (!cdrom_get_media_event(cdi, &med)) {
1960                 if (med.media_present)
1961                         return CDS_DISC_OK;
1962                 else if (med.door_open)
1963                         return CDS_TRAY_OPEN;
1964                 else
1965                         return CDS_NO_DISC;
1966         }
1967
1968         if (sense.sense_key == NOT_READY && sense.asc == 0x04 && sense.ascq == 0x04)
1969                 return CDS_DISC_OK;
1970
1971         /*
1972          * If not using Mt Fuji extended media tray reports,
1973          * just return TRAY_OPEN since ATAPI doesn't provide
1974          * any other way to detect this...
1975          */
1976         if (sense.sense_key == NOT_READY) {
1977                 if (sense.asc == 0x3a && sense.ascq == 1)
1978                         return CDS_NO_DISC;
1979                 else
1980                         return CDS_TRAY_OPEN;
1981         }
1982         return CDS_DRIVE_NOT_READY;
1983 }
1984
1985 /****************************************************************************
1986  * Other driver requests (open, close, check media change).
1987  */
1988
1989 static
1990 int ide_cdrom_check_media_change_real (struct cdrom_device_info *cdi,
1991                                        int slot_nr)
1992 {
1993         ide_drive_t *drive = cdi->handle;
1994         struct cdrom_info *cd = drive->driver_data;
1995         int retval;
1996
1997         if (slot_nr == CDSL_CURRENT) {
1998                 (void) cdrom_check_status(drive, NULL);
1999                 retval = (cd->cd_flags & IDE_CD_FLAG_MEDIA_CHANGED) ? 1 : 0;
2000                 cd->cd_flags &= ~IDE_CD_FLAG_MEDIA_CHANGED;
2001                 return retval;
2002         } else {
2003                 return -EINVAL;
2004         }
2005 }
2006
2007
2008 static
2009 int ide_cdrom_open_real (struct cdrom_device_info *cdi, int purpose)
2010 {
2011         return 0;
2012 }
2013
2014 /*
2015  * Close down the device.  Invalidate all cached blocks.
2016  */
2017
2018 static
2019 void ide_cdrom_release_real (struct cdrom_device_info *cdi)
2020 {
2021         ide_drive_t *drive = cdi->handle;
2022         struct cdrom_info *cd = drive->driver_data;
2023
2024         if (!cdi->use_count)
2025                 cd->cd_flags &= ~IDE_CD_FLAG_TOC_VALID;
2026 }
2027
2028 #define IDE_CD_CAPABILITIES \
2029         (CDC_CLOSE_TRAY | CDC_OPEN_TRAY | CDC_LOCK | CDC_SELECT_SPEED | \
2030          CDC_SELECT_DISC | CDC_MULTI_SESSION | CDC_MCN | CDC_MEDIA_CHANGED | \
2031          CDC_PLAY_AUDIO | CDC_RESET | CDC_DRIVE_STATUS | CDC_CD_R | \
2032          CDC_CD_RW | CDC_DVD | CDC_DVD_R | CDC_DVD_RAM | CDC_GENERIC_PACKET | \
2033          CDC_MO_DRIVE | CDC_MRW | CDC_MRW_W | CDC_RAM)
2034
2035 static struct cdrom_device_ops ide_cdrom_dops = {
2036         .open                   = ide_cdrom_open_real,
2037         .release                = ide_cdrom_release_real,
2038         .drive_status           = ide_cdrom_drive_status,
2039         .media_changed          = ide_cdrom_check_media_change_real,
2040         .tray_move              = ide_cdrom_tray_move,
2041         .lock_door              = ide_cdrom_lock_door,
2042         .select_speed           = ide_cdrom_select_speed,
2043         .get_last_session       = ide_cdrom_get_last_session,
2044         .get_mcn                = ide_cdrom_get_mcn,
2045         .reset                  = ide_cdrom_reset,
2046         .audio_ioctl            = ide_cdrom_audio_ioctl,
2047         .capability             = IDE_CD_CAPABILITIES,
2048         .generic_packet         = ide_cdrom_packet,
2049 };
2050
2051 static int ide_cdrom_register (ide_drive_t *drive, int nslots)
2052 {
2053         struct cdrom_info *info = drive->driver_data;
2054         struct cdrom_device_info *devinfo = &info->devinfo;
2055
2056         devinfo->ops = &ide_cdrom_dops;
2057         devinfo->speed = info->current_speed;
2058         devinfo->capacity = nslots;
2059         devinfo->handle = drive;
2060         strcpy(devinfo->name, drive->name);
2061
2062         if (info->cd_flags & IDE_CD_FLAG_NO_SPEED_SELECT)
2063                 devinfo->mask |= CDC_SELECT_SPEED;
2064
2065         devinfo->disk = info->disk;
2066         return register_cdrom(devinfo);
2067 }
2068
2069 static
2070 int ide_cdrom_probe_capabilities (ide_drive_t *drive)
2071 {
2072         struct cdrom_info *cd = drive->driver_data;
2073         struct cdrom_device_info *cdi = &cd->devinfo;
2074         u8 buf[ATAPI_CAPABILITIES_PAGE_SIZE];
2075         mechtype_t mechtype;
2076         int nslots = 1;
2077
2078         cdi->mask = (CDC_CD_R | CDC_CD_RW | CDC_DVD | CDC_DVD_R |
2079                      CDC_DVD_RAM | CDC_SELECT_DISC | CDC_PLAY_AUDIO |
2080                      CDC_MO_DRIVE | CDC_RAM);
2081
2082         if (drive->media == ide_optical) {
2083                 cdi->mask &= ~(CDC_MO_DRIVE | CDC_RAM);
2084                 printk(KERN_ERR "%s: ATAPI magneto-optical drive\n", drive->name);
2085                 return nslots;
2086         }
2087
2088         if (cd->cd_flags & IDE_CD_FLAG_PRE_ATAPI12) {
2089                 cd->cd_flags &= ~IDE_CD_FLAG_NO_EJECT;
2090                 cdi->mask &= ~CDC_PLAY_AUDIO;
2091                 return nslots;
2092         }
2093
2094         /*
2095          * we have to cheat a little here. the packet will eventually
2096          * be queued with ide_cdrom_packet(), which extracts the
2097          * drive from cdi->handle. Since this device hasn't been
2098          * registered with the Uniform layer yet, it can't do this.
2099          * Same goes for cdi->ops.
2100          */
2101         cdi->handle = drive;
2102         cdi->ops = &ide_cdrom_dops;
2103
2104         if (ide_cdrom_get_capabilities(drive, buf))
2105                 return 0;
2106
2107         if ((buf[8 + 6] & 0x01) == 0)
2108                 cd->cd_flags |= IDE_CD_FLAG_NO_DOORLOCK;
2109         if (buf[8 + 6] & 0x08)
2110                 cd->cd_flags &= ~IDE_CD_FLAG_NO_EJECT;
2111         if (buf[8 + 3] & 0x01)
2112                 cdi->mask &= ~CDC_CD_R;
2113         if (buf[8 + 3] & 0x02)
2114                 cdi->mask &= ~(CDC_CD_RW | CDC_RAM);
2115         if (buf[8 + 2] & 0x38)
2116                 cdi->mask &= ~CDC_DVD;
2117         if (buf[8 + 3] & 0x20)
2118                 cdi->mask &= ~(CDC_DVD_RAM | CDC_RAM);
2119         if (buf[8 + 3] & 0x10)
2120                 cdi->mask &= ~CDC_DVD_R;
2121         if ((buf[8 + 4] & 0x01) || (cd->cd_flags & IDE_CD_FLAG_PLAY_AUDIO_OK))
2122                 cdi->mask &= ~CDC_PLAY_AUDIO;
2123
2124         mechtype = buf[8 + 6] >> 5;
2125         if (mechtype == mechtype_caddy || mechtype == mechtype_popup)
2126                 cdi->mask |= CDC_CLOSE_TRAY;
2127
2128         if (cdi->sanyo_slot > 0) {
2129                 cdi->mask &= ~CDC_SELECT_DISC;
2130                 nslots = 3;
2131         } else if (mechtype == mechtype_individual_changer ||
2132                    mechtype == mechtype_cartridge_changer) {
2133                 nslots = cdrom_number_of_slots(cdi);
2134                 if (nslots > 1)
2135                         cdi->mask &= ~CDC_SELECT_DISC;
2136         }
2137
2138         ide_cdrom_update_speed(drive, buf);
2139
2140         printk(KERN_INFO "%s: ATAPI", drive->name);
2141
2142         /* don't print speed if the drive reported 0 */
2143         if (cd->max_speed)
2144                 printk(KERN_CONT " %dX", cd->max_speed);
2145
2146         printk(KERN_CONT " %s", (cdi->mask & CDC_DVD) ? "CD-ROM" : "DVD-ROM");
2147
2148         if ((cdi->mask & CDC_DVD_R) == 0 || (cdi->mask & CDC_DVD_RAM) == 0)
2149                 printk(KERN_CONT " DVD%s%s",
2150                                  (cdi->mask & CDC_DVD_R) ? "" : "-R",
2151                                  (cdi->mask & CDC_DVD_RAM) ? "" : "-RAM");
2152
2153         if ((cdi->mask & CDC_CD_R) == 0 || (cdi->mask & CDC_CD_RW) == 0)
2154                 printk(KERN_CONT " CD%s%s",
2155                                  (cdi->mask & CDC_CD_R) ? "" : "-R",
2156                                  (cdi->mask & CDC_CD_RW) ? "" : "/RW");
2157
2158         if ((cdi->mask & CDC_SELECT_DISC) == 0)
2159                 printk(KERN_CONT " changer w/%d slots", nslots);
2160         else
2161                 printk(KERN_CONT " drive");
2162
2163         printk(KERN_CONT ", %dkB Cache\n", be16_to_cpu(*(u16 *)&buf[8 + 12]));
2164
2165         return nslots;
2166 }
2167
2168 #ifdef CONFIG_IDE_PROC_FS
2169 static void ide_cdrom_add_settings(ide_drive_t *drive)
2170 {
2171         ide_add_setting(drive, "dsc_overlap", SETTING_RW, TYPE_BYTE, 0, 1, 1, 1, &drive->dsc_overlap, NULL);
2172 }
2173 #else
2174 static inline void ide_cdrom_add_settings(ide_drive_t *drive) { ; }
2175 #endif
2176
2177 /*
2178  * standard prep_rq_fn that builds 10 byte cmds
2179  */
2180 static int ide_cdrom_prep_fs(struct request_queue *q, struct request *rq)
2181 {
2182         int hard_sect = queue_hardsect_size(q);
2183         long block = (long)rq->hard_sector / (hard_sect >> 9);
2184         unsigned long blocks = rq->hard_nr_sectors / (hard_sect >> 9);
2185
2186         memset(rq->cmd, 0, sizeof(rq->cmd));
2187
2188         if (rq_data_dir(rq) == READ)
2189                 rq->cmd[0] = GPCMD_READ_10;
2190         else
2191                 rq->cmd[0] = GPCMD_WRITE_10;
2192
2193         /*
2194          * fill in lba
2195          */
2196         rq->cmd[2] = (block >> 24) & 0xff;
2197         rq->cmd[3] = (block >> 16) & 0xff;
2198         rq->cmd[4] = (block >>  8) & 0xff;
2199         rq->cmd[5] = block & 0xff;
2200
2201         /*
2202          * and transfer length
2203          */
2204         rq->cmd[7] = (blocks >> 8) & 0xff;
2205         rq->cmd[8] = blocks & 0xff;
2206         rq->cmd_len = 10;
2207         return BLKPREP_OK;
2208 }
2209
2210 /*
2211  * Most of the SCSI commands are supported directly by ATAPI devices.
2212  * This transform handles the few exceptions.
2213  */
2214 static int ide_cdrom_prep_pc(struct request *rq)
2215 {
2216         u8 *c = rq->cmd;
2217
2218         /*
2219          * Transform 6-byte read/write commands to the 10-byte version
2220          */
2221         if (c[0] == READ_6 || c[0] == WRITE_6) {
2222                 c[8] = c[4];
2223                 c[5] = c[3];
2224                 c[4] = c[2];
2225                 c[3] = c[1] & 0x1f;
2226                 c[2] = 0;
2227                 c[1] &= 0xe0;
2228                 c[0] += (READ_10 - READ_6);
2229                 rq->cmd_len = 10;
2230                 return BLKPREP_OK;
2231         }
2232
2233         /*
2234          * it's silly to pretend we understand 6-byte sense commands, just
2235          * reject with ILLEGAL_REQUEST and the caller should take the
2236          * appropriate action
2237          */
2238         if (c[0] == MODE_SENSE || c[0] == MODE_SELECT) {
2239                 rq->errors = ILLEGAL_REQUEST;
2240                 return BLKPREP_KILL;
2241         }
2242         
2243         return BLKPREP_OK;
2244 }
2245
2246 static int ide_cdrom_prep_fn(struct request_queue *q, struct request *rq)
2247 {
2248         if (blk_fs_request(rq))
2249                 return ide_cdrom_prep_fs(q, rq);
2250         else if (blk_pc_request(rq))
2251                 return ide_cdrom_prep_pc(rq);
2252
2253         return 0;
2254 }
2255
2256 struct cd_list_entry {
2257         const char      *id_model;
2258         const char      *id_firmware;
2259         unsigned int    cd_flags;
2260 };
2261
2262 static const struct cd_list_entry ide_cd_quirks_list[] = {
2263         /* Limit transfer size per interrupt. */
2264         { "SAMSUNG CD-ROM SCR-2430", NULL,   IDE_CD_FLAG_LIMIT_NFRAMES      },
2265         { "SAMSUNG CD-ROM SCR-2432", NULL,   IDE_CD_FLAG_LIMIT_NFRAMES      },
2266         /* SCR-3231 doesn't support the SET_CD_SPEED command. */
2267         { "SAMSUNG CD-ROM SCR-3231", NULL,   IDE_CD_FLAG_NO_SPEED_SELECT    },
2268         /* Old NEC260 (not R) was released before ATAPI 1.2 spec. */
2269         { "NEC CD-ROM DRIVE:260",    "1.01", IDE_CD_FLAG_TOCADDR_AS_BCD |
2270                                              IDE_CD_FLAG_PRE_ATAPI12,       },
2271         /* Vertos 300, some versions of this drive like to talk BCD. */
2272         { "V003S0DS",                NULL,   IDE_CD_FLAG_VERTOS_300_SSD,    },
2273         /* Vertos 600 ESD. */
2274         { "V006E0DS",                NULL,   IDE_CD_FLAG_VERTOS_600_ESD,    },
2275         /*
2276          * Sanyo 3 CD changer uses a non-standard command for CD changing
2277          * (by default standard ATAPI support for CD changers is used).
2278          */
2279         { "CD-ROM CDR-C3 G",         NULL,   IDE_CD_FLAG_SANYO_3CD          },
2280         { "CD-ROM CDR-C3G",          NULL,   IDE_CD_FLAG_SANYO_3CD          },
2281         { "CD-ROM CDR_C36",          NULL,   IDE_CD_FLAG_SANYO_3CD          },
2282         /* Stingray 8X CD-ROM. */
2283         { "STINGRAY 8422 IDE 8X CD-ROM 7-27-95", NULL, IDE_CD_FLAG_PRE_ATAPI12},
2284         /*
2285          * ACER 50X CD-ROM and WPI 32X CD-ROM require the full spec length
2286          * mode sense page capabilities size, but older drives break.
2287          */
2288         { "ATAPI CD ROM DRIVE 50X MAX", NULL,   IDE_CD_FLAG_FULL_CAPS_PAGE  },
2289         { "WPI CDS-32X",                NULL,   IDE_CD_FLAG_FULL_CAPS_PAGE  },
2290         /* ACER/AOpen 24X CD-ROM has the speed fields byte-swapped. */
2291         { "",                        "241N", IDE_CD_FLAG_LE_SPEED_FIELDS    },
2292         /*
2293          * Some drives used by Apple don't advertise audio play
2294          * but they do support reading TOC & audio datas.
2295          */
2296         { "MATSHITADVD-ROM SR-8187", NULL,   IDE_CD_FLAG_PLAY_AUDIO_OK      },
2297         { "MATSHITADVD-ROM SR-8186", NULL,   IDE_CD_FLAG_PLAY_AUDIO_OK      },
2298         { "MATSHITADVD-ROM SR-8176", NULL,   IDE_CD_FLAG_PLAY_AUDIO_OK      },
2299         { "MATSHITADVD-ROM SR-8174", NULL,   IDE_CD_FLAG_PLAY_AUDIO_OK      },
2300         { NULL, NULL, 0 }
2301 };
2302
2303 static unsigned int ide_cd_flags(struct hd_driveid *id)
2304 {
2305         const struct cd_list_entry *cle = ide_cd_quirks_list;
2306
2307         while (cle->id_model) {
2308                 if (strcmp(cle->id_model, id->model) == 0 &&
2309                     (cle->id_firmware == NULL ||
2310                      strstr(id->fw_rev, cle->id_firmware)))
2311                         return cle->cd_flags;
2312                 cle++;
2313         }
2314
2315         return 0;
2316 }
2317
2318 static
2319 int ide_cdrom_setup (ide_drive_t *drive)
2320 {
2321         struct cdrom_info *cd = drive->driver_data;
2322         struct cdrom_device_info *cdi = &cd->devinfo;
2323         struct hd_driveid *id = drive->id;
2324         int nslots;
2325
2326         blk_queue_prep_rq(drive->queue, ide_cdrom_prep_fn);
2327         blk_queue_dma_alignment(drive->queue, 31);
2328         drive->queue->unplug_delay = (1 * HZ) / 1000;
2329         if (!drive->queue->unplug_delay)
2330                 drive->queue->unplug_delay = 1;
2331
2332         drive->special.all      = 0;
2333
2334         cd->cd_flags = IDE_CD_FLAG_MEDIA_CHANGED | IDE_CD_FLAG_NO_EJECT |
2335                        ide_cd_flags(id);
2336
2337         if ((id->config & 0x0060) == 0x20)
2338                 cd->cd_flags |= IDE_CD_FLAG_DRQ_INTERRUPT;
2339
2340         if ((cd->cd_flags & IDE_CD_FLAG_VERTOS_300_SSD) &&
2341             id->fw_rev[4] == '1' && id->fw_rev[6] <= '2')
2342                 cd->cd_flags |= (IDE_CD_FLAG_TOCTRACKS_AS_BCD |
2343                                  IDE_CD_FLAG_TOCADDR_AS_BCD);
2344         else if ((cd->cd_flags & IDE_CD_FLAG_VERTOS_600_ESD) &&
2345                  id->fw_rev[4] == '1' && id->fw_rev[6] <= '2')
2346                 cd->cd_flags |= IDE_CD_FLAG_TOCTRACKS_AS_BCD;
2347         else if (cd->cd_flags & IDE_CD_FLAG_SANYO_3CD)
2348                 cdi->sanyo_slot = 3;    /* 3 => use CD in slot 0 */
2349
2350         nslots = ide_cdrom_probe_capabilities (drive);
2351
2352         /*
2353          * set correct block size
2354          */
2355         blk_queue_hardsect_size(drive->queue, CD_FRAMESIZE);
2356
2357         if (drive->autotune == IDE_TUNE_DEFAULT ||
2358             drive->autotune == IDE_TUNE_AUTO)
2359                 drive->dsc_overlap = (drive->next != drive);
2360
2361         if (ide_cdrom_register(drive, nslots)) {
2362                 printk (KERN_ERR "%s: ide_cdrom_setup failed to register device with the cdrom driver.\n", drive->name);
2363                 cd->devinfo.handle = NULL;
2364                 return 1;
2365         }
2366         ide_cdrom_add_settings(drive);
2367         return 0;
2368 }
2369
2370 #ifdef CONFIG_IDE_PROC_FS
2371 static
2372 sector_t ide_cdrom_capacity (ide_drive_t *drive)
2373 {
2374         unsigned long capacity, sectors_per_frame;
2375
2376         if (cdrom_read_capacity(drive, &capacity, &sectors_per_frame, NULL))
2377                 return 0;
2378
2379         return capacity * sectors_per_frame;
2380 }
2381 #endif
2382
2383 static void ide_cd_remove(ide_drive_t *drive)
2384 {
2385         struct cdrom_info *info = drive->driver_data;
2386
2387         ide_proc_unregister_driver(drive, info->driver);
2388
2389         del_gendisk(info->disk);
2390
2391         ide_cd_put(info);
2392 }
2393
2394 static void ide_cd_release(struct kref *kref)
2395 {
2396         struct cdrom_info *info = to_ide_cd(kref);
2397         struct cdrom_device_info *devinfo = &info->devinfo;
2398         ide_drive_t *drive = info->drive;
2399         struct gendisk *g = info->disk;
2400
2401         kfree(info->buffer);
2402         kfree(info->toc);
2403         if (devinfo->handle == drive && unregister_cdrom(devinfo))
2404                 printk(KERN_ERR "%s: %s failed to unregister device from the cdrom "
2405                                 "driver.\n", __FUNCTION__, drive->name);
2406         drive->dsc_overlap = 0;
2407         drive->driver_data = NULL;
2408         blk_queue_prep_rq(drive->queue, NULL);
2409         g->private_data = NULL;
2410         put_disk(g);
2411         kfree(info);
2412 }
2413
2414 static int ide_cd_probe(ide_drive_t *);
2415
2416 #ifdef CONFIG_IDE_PROC_FS
2417 static int proc_idecd_read_capacity
2418         (char *page, char **start, off_t off, int count, int *eof, void *data)
2419 {
2420         ide_drive_t *drive = data;
2421         int len;
2422
2423         len = sprintf(page,"%llu\n", (long long)ide_cdrom_capacity(drive));
2424         PROC_IDE_READ_RETURN(page,start,off,count,eof,len);
2425 }
2426
2427 static ide_proc_entry_t idecd_proc[] = {
2428         { "capacity", S_IFREG|S_IRUGO, proc_idecd_read_capacity, NULL },
2429         { NULL, 0, NULL, NULL }
2430 };
2431 #endif
2432
2433 static ide_driver_t ide_cdrom_driver = {
2434         .gen_driver = {
2435                 .owner          = THIS_MODULE,
2436                 .name           = "ide-cdrom",
2437                 .bus            = &ide_bus_type,
2438         },
2439         .probe                  = ide_cd_probe,
2440         .remove                 = ide_cd_remove,
2441         .version                = IDECD_VERSION,
2442         .media                  = ide_cdrom,
2443         .supports_dsc_overlap   = 1,
2444         .do_request             = ide_do_rw_cdrom,
2445         .end_request            = ide_end_request,
2446         .error                  = __ide_error,
2447         .abort                  = __ide_abort,
2448 #ifdef CONFIG_IDE_PROC_FS
2449         .proc                   = idecd_proc,
2450 #endif
2451 };
2452
2453 static int idecd_open(struct inode * inode, struct file * file)
2454 {
2455         struct gendisk *disk = inode->i_bdev->bd_disk;
2456         struct cdrom_info *info;
2457         int rc = -ENOMEM;
2458
2459         if (!(info = ide_cd_get(disk)))
2460                 return -ENXIO;
2461
2462         if (!info->buffer)
2463                 info->buffer = kmalloc(SECTOR_BUFFER_SIZE, GFP_KERNEL|__GFP_REPEAT);
2464
2465         if (info->buffer)
2466                 rc = cdrom_open(&info->devinfo, inode, file);
2467
2468         if (rc < 0)
2469                 ide_cd_put(info);
2470
2471         return rc;
2472 }
2473
2474 static int idecd_release(struct inode * inode, struct file * file)
2475 {
2476         struct gendisk *disk = inode->i_bdev->bd_disk;
2477         struct cdrom_info *info = ide_cd_g(disk);
2478
2479         cdrom_release (&info->devinfo, file);
2480
2481         ide_cd_put(info);
2482
2483         return 0;
2484 }
2485
2486 static int idecd_set_spindown(struct cdrom_device_info *cdi, unsigned long arg)
2487 {
2488         struct packet_command cgc;
2489         char buffer[16];
2490         int stat;
2491         char spindown;
2492
2493         if (copy_from_user(&spindown, (void __user *)arg, sizeof(char)))
2494                 return -EFAULT;
2495
2496         init_cdrom_command(&cgc, buffer, sizeof(buffer), CGC_DATA_UNKNOWN);
2497
2498         stat = cdrom_mode_sense(cdi, &cgc, GPMODE_CDROM_PAGE, 0);
2499         if (stat)
2500                 return stat;
2501
2502         buffer[11] = (buffer[11] & 0xf0) | (spindown & 0x0f);
2503         return cdrom_mode_select(cdi, &cgc);
2504 }
2505
2506 static int idecd_get_spindown(struct cdrom_device_info *cdi, unsigned long arg)
2507 {
2508         struct packet_command cgc;
2509         char buffer[16];
2510         int stat;
2511         char spindown;
2512
2513         init_cdrom_command(&cgc, buffer, sizeof(buffer), CGC_DATA_UNKNOWN);
2514
2515         stat = cdrom_mode_sense(cdi, &cgc, GPMODE_CDROM_PAGE, 0);
2516         if (stat)
2517                 return stat;
2518
2519         spindown = buffer[11] & 0x0f;
2520         if (copy_to_user((void __user *)arg, &spindown, sizeof (char)))
2521                 return -EFAULT;
2522         return 0;
2523 }
2524
2525 static int idecd_ioctl (struct inode *inode, struct file *file,
2526                         unsigned int cmd, unsigned long arg)
2527 {
2528         struct block_device *bdev = inode->i_bdev;
2529         struct cdrom_info *info = ide_cd_g(bdev->bd_disk);
2530         int err;
2531
2532         switch (cmd) {
2533         case CDROMSETSPINDOWN:
2534                 return idecd_set_spindown(&info->devinfo, arg);
2535         case CDROMGETSPINDOWN:
2536                 return idecd_get_spindown(&info->devinfo, arg);
2537         default:
2538                 break;
2539         }
2540
2541         err = generic_ide_ioctl(info->drive, file, bdev, cmd, arg);
2542         if (err == -EINVAL)
2543                 err = cdrom_ioctl(file, &info->devinfo, inode, cmd, arg);
2544
2545         return err;
2546 }
2547
2548 static int idecd_media_changed(struct gendisk *disk)
2549 {
2550         struct cdrom_info *info = ide_cd_g(disk);
2551         return cdrom_media_changed(&info->devinfo);
2552 }
2553
2554 static int idecd_revalidate_disk(struct gendisk *disk)
2555 {
2556         struct cdrom_info *info = ide_cd_g(disk);
2557         struct request_sense sense;
2558
2559         ide_cd_read_toc(info->drive, &sense);
2560
2561         return  0;
2562 }
2563
2564 static struct block_device_operations idecd_ops = {
2565         .owner          = THIS_MODULE,
2566         .open           = idecd_open,
2567         .release        = idecd_release,
2568         .ioctl          = idecd_ioctl,
2569         .media_changed  = idecd_media_changed,
2570         .revalidate_disk= idecd_revalidate_disk
2571 };
2572
2573 /* options */
2574 static char *ignore = NULL;
2575
2576 module_param(ignore, charp, 0400);
2577 MODULE_DESCRIPTION("ATAPI CD-ROM Driver");
2578
2579 static int ide_cd_probe(ide_drive_t *drive)
2580 {
2581         struct cdrom_info *info;
2582         struct gendisk *g;
2583         struct request_sense sense;
2584
2585         if (!strstr("ide-cdrom", drive->driver_req))
2586                 goto failed;
2587         if (!drive->present)
2588                 goto failed;
2589         if (drive->media != ide_cdrom && drive->media != ide_optical)
2590                 goto failed;
2591         /* skip drives that we were told to ignore */
2592         if (ignore != NULL) {
2593                 if (strstr(ignore, drive->name)) {
2594                         printk(KERN_INFO "ide-cd: ignoring drive %s\n", drive->name);
2595                         goto failed;
2596                 }
2597         }
2598         if (drive->scsi) {
2599                 printk(KERN_INFO "ide-cd: passing drive %s to ide-scsi emulation.\n", drive->name);
2600                 goto failed;
2601         }
2602         info = kzalloc(sizeof(struct cdrom_info), GFP_KERNEL);
2603         if (info == NULL) {
2604                 printk(KERN_ERR "%s: Can't allocate a cdrom structure\n", drive->name);
2605                 goto failed;
2606         }
2607
2608         g = alloc_disk(1 << PARTN_BITS);
2609         if (!g)
2610                 goto out_free_cd;
2611
2612         ide_init_disk(g, drive);
2613
2614         ide_proc_register_driver(drive, &ide_cdrom_driver);
2615
2616         kref_init(&info->kref);
2617
2618         info->drive = drive;
2619         info->driver = &ide_cdrom_driver;
2620         info->disk = g;
2621
2622         g->private_data = &info->driver;
2623
2624         drive->driver_data = info;
2625
2626         g->minors = 1;
2627         g->driverfs_dev = &drive->gendev;
2628         g->flags = GENHD_FL_CD | GENHD_FL_REMOVABLE;
2629         if (ide_cdrom_setup(drive)) {
2630                 ide_proc_unregister_driver(drive, &ide_cdrom_driver);
2631                 ide_cd_release(&info->kref);
2632                 goto failed;
2633         }
2634
2635         ide_cd_read_toc(drive, &sense);
2636         g->fops = &idecd_ops;
2637         g->flags |= GENHD_FL_REMOVABLE;
2638         add_disk(g);
2639         return 0;
2640
2641 out_free_cd:
2642         kfree(info);
2643 failed:
2644         return -ENODEV;
2645 }
2646
2647 static void __exit ide_cdrom_exit(void)
2648 {
2649         driver_unregister(&ide_cdrom_driver.gen_driver);
2650 }
2651
2652 static int __init ide_cdrom_init(void)
2653 {
2654         return driver_register(&ide_cdrom_driver.gen_driver);
2655 }
2656
2657 MODULE_ALIAS("ide:*m-cdrom*");
2658 MODULE_ALIAS("ide-cd");
2659 module_init(ide_cdrom_init);
2660 module_exit(ide_cdrom_exit);
2661 MODULE_LICENSE("GPL");