5 #include <linux/kernel.h>
6 #include <linux/delay.h>
11 #define debug_log(fmt, args...) \
12 printk(KERN_INFO "ide: " fmt, ## args)
14 #define debug_log(fmt, args...) do {} while (0)
18 * Check whether we can support a device,
19 * based on the ATAPI IDENTIFY command results.
21 int ide_check_atapi_device(ide_drive_t *drive, const char *s)
24 u8 gcw[2], protocol, device_type, removable, drq_type, packet_size;
26 *((u16 *)&gcw) = id[ATA_ID_CONFIG];
28 protocol = (gcw[1] & 0xC0) >> 6;
29 device_type = gcw[1] & 0x1F;
30 removable = (gcw[0] & 0x80) >> 7;
31 drq_type = (gcw[0] & 0x60) >> 5;
32 packet_size = gcw[0] & 0x03;
35 /* kludge for Apple PowerBook internal zip */
36 if (drive->media == ide_floppy && device_type == 5 &&
37 !strstr((char *)&id[ATA_ID_PROD], "CD-ROM") &&
38 strstr((char *)&id[ATA_ID_PROD], "ZIP"))
43 printk(KERN_ERR "%s: %s: protocol (0x%02x) is not ATAPI\n",
44 s, drive->name, protocol);
45 else if ((drive->media == ide_floppy && device_type != 0) ||
46 (drive->media == ide_tape && device_type != 1))
47 printk(KERN_ERR "%s: %s: invalid device type (0x%02x)\n",
48 s, drive->name, device_type);
49 else if (removable == 0)
50 printk(KERN_ERR "%s: %s: the removable flag is not set\n",
52 else if (drive->media == ide_floppy && drq_type == 3)
53 printk(KERN_ERR "%s: %s: sorry, DRQ type (0x%02x) not "
54 "supported\n", s, drive->name, drq_type);
55 else if (packet_size != 0)
56 printk(KERN_ERR "%s: %s: packet size (0x%02x) is not 12 "
57 "bytes\n", s, drive->name, packet_size);
62 EXPORT_SYMBOL_GPL(ide_check_atapi_device);
64 /* PIO data transfer routine using the scatter gather table. */
65 int ide_io_buffers(ide_drive_t *drive, struct ide_atapi_pc *pc,
66 unsigned int bcount, int write)
68 ide_hwif_t *hwif = drive->hwif;
69 const struct ide_tp_ops *tp_ops = hwif->tp_ops;
70 xfer_func_t *xf = write ? tp_ops->output_data : tp_ops->input_data;
71 struct scatterlist *sg = pc->sg;
76 count = min(sg->length - pc->b_count, bcount);
78 if (PageHighMem(sg_page(sg))) {
81 local_irq_save(flags);
82 buf = kmap_atomic(sg_page(sg), KM_IRQ0) + sg->offset;
83 xf(drive, NULL, buf + pc->b_count, count);
84 kunmap_atomic(buf - sg->offset, KM_IRQ0);
85 local_irq_restore(flags);
88 xf(drive, NULL, buf + pc->b_count, count);
95 if (pc->b_count == sg->length) {
98 pc->sg = sg = sg_next(sg);
104 printk(KERN_ERR "%s: %d leftover bytes, %s\n", drive->name,
105 bcount, write ? "padding with zeros"
106 : "discarding data");
107 ide_pad_transfer(drive, write, bcount);
112 EXPORT_SYMBOL_GPL(ide_io_buffers);
114 void ide_init_pc(struct ide_atapi_pc *pc)
116 memset(pc, 0, sizeof(*pc));
117 pc->buf = pc->pc_buf;
118 pc->buf_size = IDE_PC_BUFFER_SIZE;
120 EXPORT_SYMBOL_GPL(ide_init_pc);
123 * Generate a new packet command request in front of the request queue, before
124 * the current request, so that it will be processed immediately, on the next
125 * pass through the driver.
127 static void ide_queue_pc_head(ide_drive_t *drive, struct gendisk *disk,
128 struct ide_atapi_pc *pc, struct request *rq)
130 blk_rq_init(NULL, rq);
131 rq->cmd_type = REQ_TYPE_SPECIAL;
132 rq->cmd_flags |= REQ_PREEMPT;
133 rq->buffer = (char *)pc;
135 memcpy(rq->cmd, pc->c, 12);
136 if (drive->media == ide_tape)
137 rq->cmd[13] = REQ_IDETAPE_PC1;
138 ide_do_drive_cmd(drive, rq);
142 * Add a special packet command request to the tail of the request queue,
143 * and wait for it to be serviced.
145 int ide_queue_pc_tail(ide_drive_t *drive, struct gendisk *disk,
146 struct ide_atapi_pc *pc)
151 rq = blk_get_request(drive->queue, READ, __GFP_WAIT);
152 rq->cmd_type = REQ_TYPE_SPECIAL;
153 rq->buffer = (char *)pc;
154 memcpy(rq->cmd, pc->c, 12);
155 if (drive->media == ide_tape)
156 rq->cmd[13] = REQ_IDETAPE_PC1;
157 error = blk_execute_rq(drive->queue, disk, rq, 0);
162 EXPORT_SYMBOL_GPL(ide_queue_pc_tail);
164 int ide_do_test_unit_ready(ide_drive_t *drive, struct gendisk *disk)
166 struct ide_atapi_pc pc;
169 pc.c[0] = TEST_UNIT_READY;
171 return ide_queue_pc_tail(drive, disk, &pc);
173 EXPORT_SYMBOL_GPL(ide_do_test_unit_ready);
175 int ide_do_start_stop(ide_drive_t *drive, struct gendisk *disk, int start)
177 struct ide_atapi_pc pc;
180 pc.c[0] = START_STOP;
183 if (drive->media == ide_tape)
184 pc.flags |= PC_FLAG_WAIT_FOR_DSC;
186 return ide_queue_pc_tail(drive, disk, &pc);
188 EXPORT_SYMBOL_GPL(ide_do_start_stop);
190 int ide_set_media_lock(ide_drive_t *drive, struct gendisk *disk, int on)
192 struct ide_atapi_pc pc;
194 if (drive->atapi_flags & IDE_AFLAG_NO_DOORLOCK)
198 pc.c[0] = ALLOW_MEDIUM_REMOVAL;
201 return ide_queue_pc_tail(drive, disk, &pc);
203 EXPORT_SYMBOL_GPL(ide_set_media_lock);
205 void ide_create_request_sense_cmd(ide_drive_t *drive, struct ide_atapi_pc *pc)
208 pc->c[0] = REQUEST_SENSE;
209 if (drive->media == ide_floppy) {
217 EXPORT_SYMBOL_GPL(ide_create_request_sense_cmd);
220 * Called when an error was detected during the last packet command.
221 * We queue a request sense packet command in the head of the request list.
223 void ide_retry_pc(ide_drive_t *drive, struct gendisk *disk)
225 struct request *rq = &drive->request_sense_rq;
226 struct ide_atapi_pc *pc = &drive->request_sense_pc;
228 (void)ide_read_error(drive);
229 ide_create_request_sense_cmd(drive, pc);
230 if (drive->media == ide_tape)
231 set_bit(IDE_AFLAG_IGNORE_DSC, &drive->atapi_flags);
232 ide_queue_pc_head(drive, disk, pc, rq);
234 EXPORT_SYMBOL_GPL(ide_retry_pc);
236 int ide_scsi_expiry(ide_drive_t *drive)
238 struct ide_atapi_pc *pc = drive->pc;
240 debug_log("%s called for %lu at %lu\n", __func__,
241 pc->scsi_cmd->serial_number, jiffies);
243 pc->flags |= PC_FLAG_TIMEDOUT;
245 return 0; /* we do not want the IDE subsystem to retry */
247 EXPORT_SYMBOL_GPL(ide_scsi_expiry);
250 * This is the usual interrupt handler which will be called during a packet
251 * command. We will transfer some of the data (as requested by the drive)
252 * and will re-point interrupt handler to us.
254 static ide_startstop_t ide_pc_intr(ide_drive_t *drive)
256 struct ide_atapi_pc *pc = drive->pc;
257 ide_hwif_t *hwif = drive->hwif;
258 struct request *rq = hwif->hwgroup->rq;
259 const struct ide_tp_ops *tp_ops = hwif->tp_ops;
260 xfer_func_t *xferfunc;
261 ide_expiry_t *expiry;
262 unsigned int timeout, temp;
264 u8 stat, ireason, scsi = !!(drive->dev_flags & IDE_DFLAG_SCSI), dsc = 0;
266 debug_log("Enter %s - interrupt handler\n", __func__);
269 timeout = ide_scsi_get_timeout(pc);
270 expiry = ide_scsi_expiry;
272 timeout = (drive->media == ide_floppy) ? WAIT_FLOPPY_CMD
277 if (pc->flags & PC_FLAG_TIMEDOUT) {
278 drive->pc_callback(drive, 0);
282 /* Clear the interrupt */
283 stat = tp_ops->read_status(hwif);
285 if (pc->flags & PC_FLAG_DMA_IN_PROGRESS) {
286 if (hwif->dma_ops->dma_end(drive) ||
287 (drive->media == ide_tape && !scsi && (stat & ATA_ERR))) {
288 if (drive->media == ide_floppy && !scsi)
289 printk(KERN_ERR "%s: DMA %s error\n",
290 drive->name, rq_data_dir(pc->rq)
292 pc->flags |= PC_FLAG_DMA_ERROR;
294 pc->xferred = pc->req_xfer;
295 if (drive->pc_update_buffers)
296 drive->pc_update_buffers(drive, pc);
298 debug_log("%s: DMA finished\n", drive->name);
301 /* No more interrupts */
302 if ((stat & ATA_DRQ) == 0) {
303 debug_log("Packet command completed, %d bytes transferred\n",
306 pc->flags &= ~PC_FLAG_DMA_IN_PROGRESS;
308 local_irq_enable_in_hardirq();
310 if (drive->media == ide_tape && !scsi &&
311 (stat & ATA_ERR) && rq->cmd[0] == REQUEST_SENSE)
314 if ((stat & ATA_ERR) || (pc->flags & PC_FLAG_DMA_ERROR)) {
316 debug_log("%s: I/O error\n", drive->name);
318 if (drive->media != ide_tape || scsi) {
324 if (rq->cmd[0] == REQUEST_SENSE) {
325 printk(KERN_ERR "%s: I/O error in request sense"
326 " command\n", drive->name);
327 return ide_do_reset(drive);
330 debug_log("[cmd %x]: check condition\n", rq->cmd[0]);
332 /* Retry operation */
333 ide_retry_pc(drive, rq->rq_disk);
335 /* queued, but not started */
341 if ((pc->flags & PC_FLAG_WAIT_FOR_DSC) && (stat & ATA_DSC) == 0)
344 /* Command finished - Call the callback function */
345 drive->pc_callback(drive, dsc);
350 if (pc->flags & PC_FLAG_DMA_IN_PROGRESS) {
351 pc->flags &= ~PC_FLAG_DMA_IN_PROGRESS;
352 printk(KERN_ERR "%s: The device wants to issue more interrupts "
353 "in DMA mode\n", drive->name);
355 return ide_do_reset(drive);
358 /* Get the number of bytes to transfer on this interrupt. */
359 ide_read_bcount_and_ireason(drive, &bcount, &ireason);
361 if (ireason & ATAPI_COD) {
362 printk(KERN_ERR "%s: CoD != 0 in %s\n", drive->name, __func__);
363 return ide_do_reset(drive);
366 if (((ireason & ATAPI_IO) == ATAPI_IO) ==
367 !!(pc->flags & PC_FLAG_WRITING)) {
368 /* Hopefully, we will never get here */
369 printk(KERN_ERR "%s: We wanted to %s, but the device wants us "
370 "to %s!\n", drive->name,
371 (ireason & ATAPI_IO) ? "Write" : "Read",
372 (ireason & ATAPI_IO) ? "Read" : "Write");
373 return ide_do_reset(drive);
376 if (!(pc->flags & PC_FLAG_WRITING)) {
377 /* Reading - Check that we have enough space */
378 temp = pc->xferred + bcount;
379 if (temp > pc->req_xfer) {
380 if (temp > pc->buf_size) {
381 printk(KERN_ERR "%s: The device wants to send "
382 "us more data than expected - "
386 temp = pc->buf_size - pc->xferred;
391 drive->pc_io_buffers(drive, pc,
394 tp_ops->input_data(drive, NULL,
396 printk(KERN_ERR "%s: transferred %d of "
403 ide_pad_transfer(drive, 0, bcount - temp);
406 debug_log("The device wants to send us more data than "
407 "expected - allowing transfer\n");
409 xferfunc = tp_ops->input_data;
411 xferfunc = tp_ops->output_data;
413 if ((drive->media == ide_floppy && !scsi && !pc->buf) ||
414 (drive->media == ide_tape && !scsi && pc->bh) ||
416 int done = drive->pc_io_buffers(drive, pc, bcount,
417 !!(pc->flags & PC_FLAG_WRITING));
419 /* FIXME: don't do partial completions */
420 if (drive->media == ide_floppy && !scsi)
421 ide_end_request(drive, 1, done >> 9);
423 xferfunc(drive, NULL, pc->cur_pos, bcount);
425 /* Update the current position */
426 pc->xferred += bcount;
427 pc->cur_pos += bcount;
429 debug_log("[cmd %x] transferred %d bytes on that intr.\n",
432 /* And set the interrupt handler again */
433 ide_set_handler(drive, ide_pc_intr, timeout, expiry);
437 static u8 ide_read_ireason(ide_drive_t *drive)
441 memset(&task, 0, sizeof(task));
442 task.tf_flags = IDE_TFLAG_IN_NSECT;
444 drive->hwif->tp_ops->tf_read(drive, &task);
446 return task.tf.nsect & 3;
449 static u8 ide_wait_ireason(ide_drive_t *drive, u8 ireason)
453 while (retries-- && ((ireason & ATAPI_COD) == 0 ||
454 (ireason & ATAPI_IO))) {
455 printk(KERN_ERR "%s: (IO,CoD != (0,1) while issuing "
456 "a packet command, retrying\n", drive->name);
458 ireason = ide_read_ireason(drive);
460 printk(KERN_ERR "%s: (IO,CoD != (0,1) while issuing "
461 "a packet command, ignoring\n",
463 ireason |= ATAPI_COD;
464 ireason &= ~ATAPI_IO;
471 static int ide_delayed_transfer_pc(ide_drive_t *drive)
473 /* Send the actual packet */
474 drive->hwif->tp_ops->output_data(drive, NULL, drive->pc->c, 12);
476 /* Timeout for the packet command */
477 return WAIT_FLOPPY_CMD;
480 static ide_startstop_t ide_transfer_pc(ide_drive_t *drive)
482 struct ide_atapi_pc *pc = drive->pc;
483 ide_hwif_t *hwif = drive->hwif;
484 struct request *rq = hwif->hwgroup->rq;
485 ide_expiry_t *expiry;
486 unsigned int timeout;
487 ide_startstop_t startstop;
490 if (ide_wait_stat(&startstop, drive, ATA_DRQ, ATA_BUSY, WAIT_READY)) {
491 printk(KERN_ERR "%s: Strange, packet command initiated yet "
492 "DRQ isn't asserted\n", drive->name);
496 ireason = ide_read_ireason(drive);
497 if (drive->media == ide_tape &&
498 (drive->dev_flags & IDE_DFLAG_SCSI) == 0)
499 ireason = ide_wait_ireason(drive, ireason);
501 if ((ireason & ATAPI_COD) == 0 || (ireason & ATAPI_IO)) {
502 printk(KERN_ERR "%s: (IO,CoD) != (0,1) while issuing "
503 "a packet command\n", drive->name);
504 return ide_do_reset(drive);
508 * If necessary schedule the packet transfer to occur 'timeout'
509 * miliseconds later in ide_delayed_transfer_pc() after the device
510 * says it's ready for a packet.
512 if (drive->atapi_flags & IDE_AFLAG_ZIP_DRIVE) {
513 timeout = drive->pc_delay;
514 expiry = &ide_delayed_transfer_pc;
516 if (drive->dev_flags & IDE_DFLAG_SCSI) {
517 timeout = ide_scsi_get_timeout(pc);
518 expiry = ide_scsi_expiry;
520 timeout = (drive->media == ide_floppy) ? WAIT_FLOPPY_CMD
526 /* Set the interrupt routine */
527 ide_set_handler(drive, ide_pc_intr, timeout, expiry);
529 /* Begin DMA, if necessary */
530 if (pc->flags & PC_FLAG_DMA_OK) {
531 pc->flags |= PC_FLAG_DMA_IN_PROGRESS;
532 hwif->dma_ops->dma_start(drive);
535 /* Send the actual packet */
536 if ((drive->atapi_flags & IDE_AFLAG_ZIP_DRIVE) == 0)
537 hwif->tp_ops->output_data(drive, NULL, rq->cmd, 12);
542 ide_startstop_t ide_issue_pc(ide_drive_t *drive, unsigned int timeout,
543 ide_expiry_t *expiry)
545 struct ide_atapi_pc *pc = drive->pc;
546 ide_hwif_t *hwif = drive->hwif;
549 u8 scsi = !!(drive->dev_flags & IDE_DFLAG_SCSI);
551 /* We haven't transferred any data yet */
553 pc->cur_pos = pc->buf;
555 /* Request to transfer the entire buffer at once */
556 if (drive->media == ide_tape && scsi == 0)
557 bcount = pc->req_xfer;
559 bcount = min(pc->req_xfer, 63 * 1024);
561 if (pc->flags & PC_FLAG_DMA_ERROR) {
562 pc->flags &= ~PC_FLAG_DMA_ERROR;
566 if ((pc->flags & PC_FLAG_DMA_OK) &&
567 (drive->dev_flags & IDE_DFLAG_USING_DMA)) {
570 drive->dma = !hwif->dma_ops->dma_setup(drive);
576 pc->flags &= ~PC_FLAG_DMA_OK;
580 else if (drive->media == ide_cdrom || drive->media == ide_optical)
581 tf_flags = IDE_TFLAG_OUT_NSECT | IDE_TFLAG_OUT_LBAL;
583 tf_flags = IDE_TFLAG_OUT_DEVICE;
585 ide_pktcmd_tf_load(drive, tf_flags, bcount, drive->dma);
587 /* Issue the packet command */
588 if (drive->atapi_flags & IDE_AFLAG_DRQ_INTERRUPT) {
589 ide_execute_command(drive, ATA_CMD_PACKET, ide_transfer_pc,
593 ide_execute_pkt_cmd(drive);
594 return ide_transfer_pc(drive);
597 EXPORT_SYMBOL_GPL(ide_issue_pc);