Lines Matching +full:tf +full:- +full:a
1 // SPDX-License-Identifier: GPL-2.0-or-later
3 * libata-sff.c - helper library for PCI IDE BMDMA
5 * Copyright 2003-2006 Red Hat, Inc. All rights reserved.
6 * Copyright 2003-2006 Jeff Garzik
9 * as Documentation/driver-api/libata.rst
12 * http://www.sata-io.org/
54 * ata_sff_check_status - Read device status reg & clear interrupt
57 * Reads ATA taskfile status register for currently-selected device
66 return ioread8(ap->ioaddr.status_addr); in ata_sff_check_status()
71 * ata_sff_altstatus - Read device alternate status reg
75 * currently-selected device and return its value.
85 if (ap->ops->sff_check_altstatus) in ata_sff_altstatus()
86 return ap->ops->sff_check_altstatus(ap); in ata_sff_altstatus()
88 return ioread8(ap->ioaddr.altstatus_addr); in ata_sff_altstatus()
92 * ata_sff_irq_status - Check if the device is busy
107 if (ap->ops->sff_check_altstatus || ap->ioaddr.altstatus_addr) { in ata_sff_irq_status()
114 status = ap->ops->sff_check_status(ap); in ata_sff_irq_status()
119 * ata_sff_sync - Flush writes
132 if (ap->ops->sff_check_altstatus) in ata_sff_sync()
133 ap->ops->sff_check_altstatus(ap); in ata_sff_sync()
134 else if (ap->ioaddr.altstatus_addr) in ata_sff_sync()
135 ioread8(ap->ioaddr.altstatus_addr); in ata_sff_sync()
139 * ata_sff_pause - Flush writes and wait 400nS
158 * ata_sff_dma_pause - Pause before commencing DMA
167 if (ap->ops->sff_check_altstatus || ap->ioaddr.altstatus_addr) { in ata_sff_dma_pause()
181 * ata_sff_busy_sleep - sleep until BSY clears, or timeout
187 * or a timeout occurs.
193 * 0 on success, -errno otherwise.
219 status = ap->ops->sff_check_status(ap); in ata_sff_busy_sleep()
223 return -ENODEV; in ata_sff_busy_sleep()
229 return -EBUSY; in ata_sff_busy_sleep()
238 u8 status = link->ap->ops->sff_check_status(link->ap); in ata_sff_check_ready()
244 * ata_sff_wait_ready - sleep until BSY clears, or timeout
255 * 0 on success, -errno otherwise.
264 * ata_sff_set_devctl - Write device control reg
278 if (ap->ops->sff_set_devctl) in ata_sff_set_devctl()
279 ap->ops->sff_set_devctl(ap, ctl); in ata_sff_set_devctl()
281 iowrite8(ctl, ap->ioaddr.ctl_addr); in ata_sff_set_devctl()
285 * ata_sff_dev_select - Select device 0/1 on ATA bus
307 iowrite8(tmp, ap->ioaddr.device_addr); in ata_sff_dev_select()
313 * ata_dev_select - Select device 0/1 on ATA bus
316 * @wait: non-zero to wait for Status register BSY bit to clear
317 * @can_sleep: non-zero if context allows sleeping
323 * This is a high-level version of ata_sff_dev_select(), which
340 ap->ops->sff_dev_select(ap, device); in ata_dev_select()
343 if (can_sleep && ap->link.device[device].class == ATA_DEV_ATAPI) in ata_dev_select()
350 * ata_sff_irq_on - Enable interrupts on a port.
353 * Enable interrupts on a legacy IDE device using MMIO or PIO,
364 struct ata_ioports *ioaddr = &ap->ioaddr; in ata_sff_irq_on()
366 if (ap->ops->sff_irq_on) { in ata_sff_irq_on()
367 ap->ops->sff_irq_on(ap); in ata_sff_irq_on()
371 ap->ctl &= ~ATA_NIEN; in ata_sff_irq_on()
372 ap->last_ctl = ap->ctl; in ata_sff_irq_on()
374 if (ap->ops->sff_set_devctl || ioaddr->ctl_addr) in ata_sff_irq_on()
375 ata_sff_set_devctl(ap, ap->ctl); in ata_sff_irq_on()
378 if (ap->ops->sff_irq_clear) in ata_sff_irq_on()
379 ap->ops->sff_irq_clear(ap); in ata_sff_irq_on()
384 * ata_sff_tf_load - send taskfile registers to host controller
386 * @tf: ATA taskfile register set
393 void ata_sff_tf_load(struct ata_port *ap, const struct ata_taskfile *tf) in ata_sff_tf_load() argument
395 struct ata_ioports *ioaddr = &ap->ioaddr; in ata_sff_tf_load()
396 unsigned int is_addr = tf->flags & ATA_TFLAG_ISADDR; in ata_sff_tf_load()
398 if (tf->ctl != ap->last_ctl) { in ata_sff_tf_load()
399 if (ioaddr->ctl_addr) in ata_sff_tf_load()
400 iowrite8(tf->ctl, ioaddr->ctl_addr); in ata_sff_tf_load()
401 ap->last_ctl = tf->ctl; in ata_sff_tf_load()
405 if (is_addr && (tf->flags & ATA_TFLAG_LBA48)) { in ata_sff_tf_load()
406 WARN_ON_ONCE(!ioaddr->ctl_addr); in ata_sff_tf_load()
407 iowrite8(tf->hob_feature, ioaddr->feature_addr); in ata_sff_tf_load()
408 iowrite8(tf->hob_nsect, ioaddr->nsect_addr); in ata_sff_tf_load()
409 iowrite8(tf->hob_lbal, ioaddr->lbal_addr); in ata_sff_tf_load()
410 iowrite8(tf->hob_lbam, ioaddr->lbam_addr); in ata_sff_tf_load()
411 iowrite8(tf->hob_lbah, ioaddr->lbah_addr); in ata_sff_tf_load()
413 tf->hob_feature, in ata_sff_tf_load()
414 tf->hob_nsect, in ata_sff_tf_load()
415 tf->hob_lbal, in ata_sff_tf_load()
416 tf->hob_lbam, in ata_sff_tf_load()
417 tf->hob_lbah); in ata_sff_tf_load()
421 iowrite8(tf->feature, ioaddr->feature_addr); in ata_sff_tf_load()
422 iowrite8(tf->nsect, ioaddr->nsect_addr); in ata_sff_tf_load()
423 iowrite8(tf->lbal, ioaddr->lbal_addr); in ata_sff_tf_load()
424 iowrite8(tf->lbam, ioaddr->lbam_addr); in ata_sff_tf_load()
425 iowrite8(tf->lbah, ioaddr->lbah_addr); in ata_sff_tf_load()
427 tf->feature, in ata_sff_tf_load()
428 tf->nsect, in ata_sff_tf_load()
429 tf->lbal, in ata_sff_tf_load()
430 tf->lbam, in ata_sff_tf_load()
431 tf->lbah); in ata_sff_tf_load()
434 if (tf->flags & ATA_TFLAG_DEVICE) { in ata_sff_tf_load()
435 iowrite8(tf->device, ioaddr->device_addr); in ata_sff_tf_load()
436 VPRINTK("device 0x%X\n", tf->device); in ata_sff_tf_load()
444 * ata_sff_tf_read - input device's ATA taskfile shadow registers
446 * @tf: ATA taskfile register set for storing input
448 * Reads ATA taskfile registers for currently-selected device
449 * into @tf. Assumes the device has a fully SFF compliant task file
450 * layout and behaviour. If you device does not (eg has a different
451 * status method) then you will need to provide a replacement tf_read
456 void ata_sff_tf_read(struct ata_port *ap, struct ata_taskfile *tf) in ata_sff_tf_read() argument
458 struct ata_ioports *ioaddr = &ap->ioaddr; in ata_sff_tf_read()
460 tf->command = ata_sff_check_status(ap); in ata_sff_tf_read()
461 tf->feature = ioread8(ioaddr->error_addr); in ata_sff_tf_read()
462 tf->nsect = ioread8(ioaddr->nsect_addr); in ata_sff_tf_read()
463 tf->lbal = ioread8(ioaddr->lbal_addr); in ata_sff_tf_read()
464 tf->lbam = ioread8(ioaddr->lbam_addr); in ata_sff_tf_read()
465 tf->lbah = ioread8(ioaddr->lbah_addr); in ata_sff_tf_read()
466 tf->device = ioread8(ioaddr->device_addr); in ata_sff_tf_read()
468 if (tf->flags & ATA_TFLAG_LBA48) { in ata_sff_tf_read()
469 if (likely(ioaddr->ctl_addr)) { in ata_sff_tf_read()
470 iowrite8(tf->ctl | ATA_HOB, ioaddr->ctl_addr); in ata_sff_tf_read()
471 tf->hob_feature = ioread8(ioaddr->error_addr); in ata_sff_tf_read()
472 tf->hob_nsect = ioread8(ioaddr->nsect_addr); in ata_sff_tf_read()
473 tf->hob_lbal = ioread8(ioaddr->lbal_addr); in ata_sff_tf_read()
474 tf->hob_lbam = ioread8(ioaddr->lbam_addr); in ata_sff_tf_read()
475 tf->hob_lbah = ioread8(ioaddr->lbah_addr); in ata_sff_tf_read()
476 iowrite8(tf->ctl, ioaddr->ctl_addr); in ata_sff_tf_read()
477 ap->last_ctl = tf->ctl; in ata_sff_tf_read()
485 * ata_sff_exec_command - issue ATA command to host controller
487 * @tf: ATA taskfile register set
495 void ata_sff_exec_command(struct ata_port *ap, const struct ata_taskfile *tf) in ata_sff_exec_command() argument
497 DPRINTK("ata%u: cmd 0x%X\n", ap->print_id, tf->command); in ata_sff_exec_command()
499 iowrite8(tf->command, ap->ioaddr.command_addr); in ata_sff_exec_command()
505 * ata_tf_to_host - issue ATA taskfile to host controller
507 * @tf: ATA taskfile register set
517 const struct ata_taskfile *tf) in ata_tf_to_host() argument
519 ap->ops->sff_tf_load(ap, tf); in ata_tf_to_host()
520 ap->ops->sff_exec_command(ap, tf); in ata_tf_to_host()
524 * ata_sff_data_xfer - Transfer data by PIO
541 struct ata_port *ap = qc->dev->link->ap; in ata_sff_data_xfer()
542 void __iomem *data_addr = ap->ioaddr.data_addr; in ata_sff_data_xfer()
556 buf += buflen - 1; in ata_sff_data_xfer()
577 * ata_sff_data_xfer32 - Transfer data by PIO
596 struct ata_device *dev = qc->dev; in ata_sff_data_xfer32()
597 struct ata_port *ap = dev->link->ap; in ata_sff_data_xfer32()
598 void __iomem *data_addr = ap->ioaddr.data_addr; in ata_sff_data_xfer32()
602 if (!(ap->pflags & ATA_PFLAG_PIO32)) in ata_sff_data_xfer32()
616 buf += buflen - slop; in ata_sff_data_xfer32()
641 * ata_pio_sector - Transfer a sector of data.
644 * Transfer qc->sect_size bytes of data from/to the ATA device.
651 int do_write = (qc->tf.flags & ATA_TFLAG_WRITE); in ata_pio_sector()
652 struct ata_port *ap = qc->ap; in ata_pio_sector()
657 if (!qc->cursg) { in ata_pio_sector()
658 qc->curbytes = qc->nbytes; in ata_pio_sector()
661 if (qc->curbytes == qc->nbytes - qc->sect_size) in ata_pio_sector()
662 ap->hsm_task_state = HSM_ST_LAST; in ata_pio_sector()
664 page = sg_page(qc->cursg); in ata_pio_sector()
665 offset = qc->cursg->offset + qc->cursg_ofs; in ata_pio_sector()
671 DPRINTK("data %s\n", qc->tf.flags & ATA_TFLAG_WRITE ? "write" : "read"); in ata_pio_sector()
675 ap->ops->sff_data_xfer(qc, buf + offset, qc->sect_size, do_write); in ata_pio_sector()
681 qc->curbytes += qc->sect_size; in ata_pio_sector()
682 qc->cursg_ofs += qc->sect_size; in ata_pio_sector()
684 if (qc->cursg_ofs == qc->cursg->length) { in ata_pio_sector()
685 qc->cursg = sg_next(qc->cursg); in ata_pio_sector()
686 if (!qc->cursg) in ata_pio_sector()
687 ap->hsm_task_state = HSM_ST_LAST; in ata_pio_sector()
688 qc->cursg_ofs = 0; in ata_pio_sector()
693 * ata_pio_sectors - Transfer one or many sectors.
704 if (is_multi_taskfile(&qc->tf)) { in ata_pio_sectors()
708 WARN_ON_ONCE(qc->dev->multi_count == 0); in ata_pio_sectors()
710 nsect = min((qc->nbytes - qc->curbytes) / qc->sect_size, in ata_pio_sectors()
711 qc->dev->multi_count); in ata_pio_sectors()
712 while (nsect--) in ata_pio_sectors()
717 ata_sff_sync(qc->ap); /* flush */ in ata_pio_sectors()
721 * atapi_send_cdb - Write CDB bytes to hardware
726 * a CDB, this function is called. Send the CDB.
735 WARN_ON_ONCE(qc->dev->cdb_len < 12); in atapi_send_cdb()
737 ap->ops->sff_data_xfer(qc, qc->cdb, qc->dev->cdb_len, 1); in atapi_send_cdb()
741 switch (qc->tf.protocol) { in atapi_send_cdb()
743 ap->hsm_task_state = HSM_ST; in atapi_send_cdb()
746 ap->hsm_task_state = HSM_ST_LAST; in atapi_send_cdb()
750 ap->hsm_task_state = HSM_ST_LAST; in atapi_send_cdb()
752 ap->ops->bmdma_start(qc); in atapi_send_cdb()
761 * __atapi_pio_bytes - Transfer data from/to the ATAPI device.
773 int rw = (qc->tf.flags & ATA_TFLAG_WRITE) ? WRITE : READ; in __atapi_pio_bytes()
774 struct ata_port *ap = qc->ap; in __atapi_pio_bytes()
775 struct ata_device *dev = qc->dev; in __atapi_pio_bytes()
776 struct ata_eh_info *ehi = &dev->link->eh_info; in __atapi_pio_bytes()
783 sg = qc->cursg; in __atapi_pio_bytes()
787 qc->nbytes, qc->curbytes, bytes); in __atapi_pio_bytes()
788 return -1; in __atapi_pio_bytes()
792 offset = sg->offset + qc->cursg_ofs; in __atapi_pio_bytes()
799 count = min(sg->length - qc->cursg_ofs, bytes); in __atapi_pio_bytes()
802 count = min(count, (unsigned int)PAGE_SIZE - offset); in __atapi_pio_bytes()
804 DPRINTK("data %s\n", qc->tf.flags & ATA_TFLAG_WRITE ? "write" : "read"); in __atapi_pio_bytes()
808 consumed = ap->ops->sff_data_xfer(qc, buf + offset, count, rw); in __atapi_pio_bytes()
811 bytes -= min(bytes, consumed); in __atapi_pio_bytes()
812 qc->curbytes += count; in __atapi_pio_bytes()
813 qc->cursg_ofs += count; in __atapi_pio_bytes()
815 if (qc->cursg_ofs == sg->length) { in __atapi_pio_bytes()
816 qc->cursg = sg_next(qc->cursg); in __atapi_pio_bytes()
817 qc->cursg_ofs = 0; in __atapi_pio_bytes()
821 * There used to be a WARN_ON_ONCE(qc->cursg && count != consumed); in __atapi_pio_bytes()
824 * made. Somebody should implement a proper sanity check. in __atapi_pio_bytes()
832 * atapi_pio_bytes - Transfer data from/to the ATAPI device.
842 struct ata_port *ap = qc->ap; in atapi_pio_bytes()
843 struct ata_device *dev = qc->dev; in atapi_pio_bytes()
844 struct ata_eh_info *ehi = &dev->link->eh_info; in atapi_pio_bytes()
846 int i_write, do_write = (qc->tf.flags & ATA_TFLAG_WRITE) ? 1 : 0; in atapi_pio_bytes()
848 /* Abuse qc->result_tf for temp storage of intermediate TF in atapi_pio_bytes()
850 * For normal completion, qc->result_tf is not relevant. For in atapi_pio_bytes()
851 * error, qc->result_tf is later overwritten by ata_qc_complete(). in atapi_pio_bytes()
852 * So, the correctness of qc->result_tf is not affected. in atapi_pio_bytes()
854 ap->ops->sff_tf_read(ap, &qc->result_tf); in atapi_pio_bytes()
855 ireason = qc->result_tf.nsect; in atapi_pio_bytes()
856 bc_lo = qc->result_tf.lbam; in atapi_pio_bytes()
857 bc_hi = qc->result_tf.lbah; in atapi_pio_bytes()
872 VPRINTK("ata%u: xfering %d bytes\n", ap->print_id, bytes); in atapi_pio_bytes()
884 qc->err_mask |= AC_ERR_HSM; in atapi_pio_bytes()
885 ap->hsm_task_state = HSM_ST_ERR; in atapi_pio_bytes()
889 * ata_hsm_ok_in_wq - Check if the qc can be handled in the workqueue.
899 if (qc->tf.flags & ATA_TFLAG_POLLING) in ata_hsm_ok_in_wq()
902 if (ap->hsm_task_state == HSM_ST_FIRST) { in ata_hsm_ok_in_wq()
903 if (qc->tf.protocol == ATA_PROT_PIO && in ata_hsm_ok_in_wq()
904 (qc->tf.flags & ATA_TFLAG_WRITE)) in ata_hsm_ok_in_wq()
907 if (ata_is_atapi(qc->tf.protocol) && in ata_hsm_ok_in_wq()
908 !(qc->dev->flags & ATA_DFLAG_CDB_INTR)) in ata_hsm_ok_in_wq()
916 * ata_hsm_qc_complete - finish a qc running on standard HSM
928 struct ata_port *ap = qc->ap; in ata_hsm_qc_complete()
930 if (ap->ops->error_handler) { in ata_hsm_qc_complete()
935 qc = ata_qc_from_tag(ap, qc->tag); in ata_hsm_qc_complete()
937 if (likely(!(qc->err_mask & AC_ERR_HSM))) { in ata_hsm_qc_complete()
944 if (likely(!(qc->err_mask & AC_ERR_HSM))) in ata_hsm_qc_complete()
959 * ata_sff_hsm_move - move the HSM to the next state.
971 struct ata_link *link = qc->dev->link; in ata_sff_hsm_move()
972 struct ata_eh_info *ehi = &link->eh_info; in ata_sff_hsm_move()
975 lockdep_assert_held(ap->lock); in ata_sff_hsm_move()
977 WARN_ON_ONCE((qc->flags & ATA_QCFLAG_ACTIVE) == 0); in ata_sff_hsm_move()
981 * in_wq is not equivalent to (qc->tf.flags & ATA_TFLAG_POLLING). in ata_sff_hsm_move()
987 ap->print_id, qc->tf.protocol, ap->hsm_task_state, status); in ata_sff_hsm_move()
989 switch (ap->hsm_task_state) { in ata_sff_hsm_move()
997 poll_next = (qc->tf.flags & ATA_TFLAG_POLLING); in ata_sff_hsm_move()
1004 qc->err_mask |= AC_ERR_DEV; in ata_sff_hsm_move()
1009 qc->err_mask |= AC_ERR_HSM; in ata_sff_hsm_move()
1012 ap->hsm_task_state = HSM_ST_ERR; in ata_sff_hsm_move()
1028 if (!(qc->dev->horkage & ATA_HORKAGE_STUCK_ERR)) { in ata_sff_hsm_move()
1032 qc->err_mask |= AC_ERR_HSM; in ata_sff_hsm_move()
1033 ap->hsm_task_state = HSM_ST_ERR; in ata_sff_hsm_move()
1038 if (qc->tf.protocol == ATA_PROT_PIO) { in ata_sff_hsm_move()
1047 ap->hsm_task_state = HSM_ST; in ata_sff_hsm_move()
1060 if (qc->tf.protocol == ATAPI_PROT_PIO) { in ata_sff_hsm_move()
1066 ap->hsm_task_state = HSM_ST_LAST; in ata_sff_hsm_move()
1077 ata_ehi_push_desc(ehi, "ST-ATAPI: " in ata_sff_hsm_move()
1080 qc->err_mask |= AC_ERR_HSM; in ata_sff_hsm_move()
1081 ap->hsm_task_state = HSM_ST_ERR; in ata_sff_hsm_move()
1087 if (unlikely(ap->hsm_task_state == HSM_ST_ERR)) in ata_sff_hsm_move()
1097 qc->err_mask |= AC_ERR_DEV; in ata_sff_hsm_move()
1100 * IDENTIFY, it's likely a phantom in ata_sff_hsm_move()
1103 if (qc->dev->horkage & in ata_sff_hsm_move()
1105 qc->err_mask |= in ata_sff_hsm_move()
1112 ata_ehi_push_desc(ehi, "ST-ATA: " in ata_sff_hsm_move()
1115 qc->err_mask |= AC_ERR_HSM | in ata_sff_hsm_move()
1119 ap->hsm_task_state = HSM_ST_ERR; in ata_sff_hsm_move()
1135 qc->err_mask |= AC_ERR_DEV; in ata_sff_hsm_move()
1137 if (!(qc->tf.flags & ATA_TFLAG_WRITE)) { in ata_sff_hsm_move()
1143 ata_ehi_push_desc(ehi, "ST-ATA: " in ata_sff_hsm_move()
1146 qc->err_mask |= AC_ERR_HSM; in ata_sff_hsm_move()
1157 qc->err_mask |= AC_ERR_NODEV_HINT; in ata_sff_hsm_move()
1163 ap->hsm_task_state = HSM_ST_ERR; in ata_sff_hsm_move()
1169 if (ap->hsm_task_state == HSM_ST_LAST && in ata_sff_hsm_move()
1170 (!(qc->tf.flags & ATA_TFLAG_WRITE))) { in ata_sff_hsm_move()
1182 qc->err_mask |= __ac_err_mask(status); in ata_sff_hsm_move()
1183 ap->hsm_task_state = HSM_ST_ERR; in ata_sff_hsm_move()
1189 ap->print_id, qc->dev->devno, status); in ata_sff_hsm_move()
1191 WARN_ON_ONCE(qc->err_mask & (AC_ERR_DEV | AC_ERR_HSM)); in ata_sff_hsm_move()
1193 ap->hsm_task_state = HSM_ST_IDLE; in ata_sff_hsm_move()
1202 ap->hsm_task_state = HSM_ST_IDLE; in ata_sff_hsm_move()
1212 ap->print_id, ap->hsm_task_state); in ata_sff_hsm_move()
1233 struct ata_port *ap = link->ap; in ata_sff_queue_pio_task()
1235 WARN_ON((ap->sff_pio_task_link != NULL) && in ata_sff_queue_pio_task()
1236 (ap->sff_pio_task_link != link)); in ata_sff_queue_pio_task()
1237 ap->sff_pio_task_link = link; in ata_sff_queue_pio_task()
1240 ata_sff_queue_delayed_work(&ap->sff_pio_task, msecs_to_jiffies(delay)); in ata_sff_queue_pio_task()
1248 cancel_delayed_work_sync(&ap->sff_pio_task); in ata_sff_flush_pio_task()
1258 spin_lock_irq(ap->lock); in ata_sff_flush_pio_task()
1259 ap->hsm_task_state = HSM_ST_IDLE; in ata_sff_flush_pio_task()
1260 spin_unlock_irq(ap->lock); in ata_sff_flush_pio_task()
1262 ap->sff_pio_task_link = NULL; in ata_sff_flush_pio_task()
1272 struct ata_link *link = ap->sff_pio_task_link; in ata_sff_pio_task()
1277 spin_lock_irq(ap->lock); in ata_sff_pio_task()
1279 BUG_ON(ap->sff_pio_task_link == NULL); in ata_sff_pio_task()
1281 qc = ata_qc_from_tag(ap, link->active_tag); in ata_sff_pio_task()
1283 ap->sff_pio_task_link = NULL; in ata_sff_pio_task()
1288 WARN_ON_ONCE(ap->hsm_task_state == HSM_ST_IDLE); in ata_sff_pio_task()
1291 * This is purely heuristic. This is a fast path. in ata_sff_pio_task()
1293 * a chk-status or two. If not, the drive is probably seeking in ata_sff_pio_task()
1294 * or something. Snooze for a couple msecs, then in ata_sff_pio_task()
1295 * chk-status again. If still busy, queue delayed work. in ata_sff_pio_task()
1299 spin_unlock_irq(ap->lock); in ata_sff_pio_task()
1301 spin_lock_irq(ap->lock); in ata_sff_pio_task()
1314 ap->sff_pio_task_link = NULL; in ata_sff_pio_task()
1324 spin_unlock_irq(ap->lock); in ata_sff_pio_task()
1328 * ata_sff_qc_issue - issue taskfile to a SFF controller
1331 * This function issues a PIO or NODATA command to a SFF
1342 struct ata_port *ap = qc->ap; in ata_sff_qc_issue()
1343 struct ata_link *link = qc->dev->link; in ata_sff_qc_issue()
1348 if (ap->flags & ATA_FLAG_PIO_POLLING) in ata_sff_qc_issue()
1349 qc->tf.flags |= ATA_TFLAG_POLLING; in ata_sff_qc_issue()
1352 ata_dev_select(ap, qc->dev->devno, 1, 0); in ata_sff_qc_issue()
1355 switch (qc->tf.protocol) { in ata_sff_qc_issue()
1357 if (qc->tf.flags & ATA_TFLAG_POLLING) in ata_sff_qc_issue()
1360 ata_tf_to_host(ap, &qc->tf); in ata_sff_qc_issue()
1361 ap->hsm_task_state = HSM_ST_LAST; in ata_sff_qc_issue()
1363 if (qc->tf.flags & ATA_TFLAG_POLLING) in ata_sff_qc_issue()
1369 if (qc->tf.flags & ATA_TFLAG_POLLING) in ata_sff_qc_issue()
1372 ata_tf_to_host(ap, &qc->tf); in ata_sff_qc_issue()
1374 if (qc->tf.flags & ATA_TFLAG_WRITE) { in ata_sff_qc_issue()
1376 ap->hsm_task_state = HSM_ST_FIRST; in ata_sff_qc_issue()
1384 ap->hsm_task_state = HSM_ST; in ata_sff_qc_issue()
1386 if (qc->tf.flags & ATA_TFLAG_POLLING) in ata_sff_qc_issue()
1399 if (qc->tf.flags & ATA_TFLAG_POLLING) in ata_sff_qc_issue()
1402 ata_tf_to_host(ap, &qc->tf); in ata_sff_qc_issue()
1404 ap->hsm_task_state = HSM_ST_FIRST; in ata_sff_qc_issue()
1407 if ((!(qc->dev->flags & ATA_DFLAG_CDB_INTR)) || in ata_sff_qc_issue()
1408 (qc->tf.flags & ATA_TFLAG_POLLING)) in ata_sff_qc_issue()
1421 * ata_sff_qc_fill_rtf - fill result TF using ->sff_tf_read
1422 * @qc: qc to fill result TF for
1424 * @qc is finished and result TF needs to be filled. Fill it
1425 * using ->sff_tf_read.
1431 * true indicating that result TF is successfully filled.
1435 qc->ap->ops->sff_tf_read(qc->ap, &qc->result_tf); in ata_sff_qc_fill_rtf()
1442 ap->stats.idle_irq++; in ata_sff_idle_irq()
1445 if ((ap->stats.idle_irq % 1000) == 0) { in ata_sff_idle_irq()
1446 ap->ops->sff_check_status(ap); in ata_sff_idle_irq()
1447 if (ap->ops->sff_irq_clear) in ata_sff_idle_irq()
1448 ap->ops->sff_irq_clear(ap); in ata_sff_idle_irq()
1463 ap->print_id, qc->tf.protocol, ap->hsm_task_state); in __ata_sff_port_intr()
1466 switch (ap->hsm_task_state) { in __ata_sff_port_intr()
1468 /* Some pre-ATAPI-4 devices assert INTRQ in __ata_sff_port_intr()
1474 * need to check ata_is_atapi(qc->tf.protocol) again. in __ata_sff_port_intr()
1476 if (!(qc->dev->flags & ATA_DFLAG_CDB_INTR)) in __ata_sff_port_intr()
1490 qc->err_mask |= AC_ERR_HSM; in __ata_sff_port_intr()
1491 ap->hsm_task_state = HSM_ST_ERR; in __ata_sff_port_intr()
1497 if (ap->ops->sff_irq_clear) in __ata_sff_port_intr()
1498 ap->ops->sff_irq_clear(ap); in __ata_sff_port_intr()
1506 * ata_sff_port_intr - Handle SFF port interrupt
1534 spin_lock_irqsave(&host->lock, flags); in __ata_sff_interrupt()
1538 for (i = 0; i < host->n_ports; i++) { in __ata_sff_interrupt()
1539 struct ata_port *ap = host->ports[i]; in __ata_sff_interrupt()
1542 qc = ata_qc_from_tag(ap, ap->link.active_tag); in __ata_sff_interrupt()
1544 if (!(qc->tf.flags & ATA_TFLAG_POLLING)) in __ata_sff_interrupt()
1560 for (i = 0; i < host->n_ports; i++) { in __ata_sff_interrupt()
1561 struct ata_port *ap = host->ports[i]; in __ata_sff_interrupt()
1566 if (!ap->ops->sff_irq_check || in __ata_sff_interrupt()
1567 !ap->ops->sff_irq_check(ap)) in __ata_sff_interrupt()
1571 ap->ops->sff_check_status(ap); in __ata_sff_interrupt()
1572 if (ap->ops->sff_irq_clear) in __ata_sff_interrupt()
1573 ap->ops->sff_irq_clear(ap); in __ata_sff_interrupt()
1576 if (!(ap->ops->sff_check_status(ap) & ATA_BUSY)) in __ata_sff_interrupt()
1591 spin_unlock_irqrestore(&host->lock, flags); in __ata_sff_interrupt()
1597 * ata_sff_interrupt - Default SFF ATA host interrupt handler
1617 * ata_sff_lost_interrupt - Check for an apparent lost interrupt
1635 qc = ata_qc_from_tag(ap, ap->link.active_tag); in ata_sff_lost_interrupt()
1636 /* We cannot lose an interrupt on a non-existent or polled command */ in ata_sff_lost_interrupt()
1637 if (!qc || qc->tf.flags & ATA_TFLAG_POLLING) in ata_sff_lost_interrupt()
1639 /* See if the controller thinks it is still busy - if so the command in ata_sff_lost_interrupt()
1640 isn't a lost IRQ but is still in progress */ in ata_sff_lost_interrupt()
1645 /* There was a command running, we are no longer busy and we have in ata_sff_lost_interrupt()
1656 * ata_sff_freeze - Freeze SFF controller port
1666 ap->ctl |= ATA_NIEN; in ata_sff_freeze()
1667 ap->last_ctl = ap->ctl; in ata_sff_freeze()
1669 if (ap->ops->sff_set_devctl || ap->ioaddr.ctl_addr) in ata_sff_freeze()
1670 ata_sff_set_devctl(ap, ap->ctl); in ata_sff_freeze()
1676 ap->ops->sff_check_status(ap); in ata_sff_freeze()
1678 if (ap->ops->sff_irq_clear) in ata_sff_freeze()
1679 ap->ops->sff_irq_clear(ap); in ata_sff_freeze()
1684 * ata_sff_thaw - Thaw SFF controller port
1694 /* clear & re-enable interrupts */ in ata_sff_thaw()
1695 ap->ops->sff_check_status(ap); in ata_sff_thaw()
1696 if (ap->ops->sff_irq_clear) in ata_sff_thaw()
1697 ap->ops->sff_irq_clear(ap); in ata_sff_thaw()
1703 * ata_sff_prereset - prepare SFF link for reset
1715 * 0 on success, -errno otherwise.
1719 struct ata_eh_context *ehc = &link->eh_context; in ata_sff_prereset()
1727 if (ehc->i.action & ATA_EH_HARDRESET) in ata_sff_prereset()
1733 if (rc && rc != -ENODEV) { in ata_sff_prereset()
1737 ehc->i.action |= ATA_EH_HARDRESET; in ata_sff_prereset()
1746 * ata_devchk - PATA device presence detection
1751 * Hale Landis's ATADRVR (www.ata-atapi.com), and
1754 * Write a pattern to the ATA shadow registers,
1755 * and if a device is present, it will respond by
1764 struct ata_ioports *ioaddr = &ap->ioaddr; in ata_devchk()
1767 ap->ops->sff_dev_select(ap, device); in ata_devchk()
1769 iowrite8(0x55, ioaddr->nsect_addr); in ata_devchk()
1770 iowrite8(0xaa, ioaddr->lbal_addr); in ata_devchk()
1772 iowrite8(0xaa, ioaddr->nsect_addr); in ata_devchk()
1773 iowrite8(0x55, ioaddr->lbal_addr); in ata_devchk()
1775 iowrite8(0x55, ioaddr->nsect_addr); in ata_devchk()
1776 iowrite8(0xaa, ioaddr->lbal_addr); in ata_devchk()
1778 nsect = ioread8(ioaddr->nsect_addr); in ata_devchk()
1779 lbal = ioread8(ioaddr->lbal_addr); in ata_devchk()
1782 return 1; /* we found a device */ in ata_devchk()
1788 * ata_sff_dev_classify - Parse returned ATA device signature
1793 * After an event -- SRST, E.D.D., or SATA COMRESET -- occurs,
1794 * an ATA/ATAPI-defined set of values is placed in the ATA
1800 * and the spec-defined values examined by ata_dev_classify().
1806 * Device type - %ATA_DEV_ATA, %ATA_DEV_ATAPI or %ATA_DEV_NONE.
1811 struct ata_port *ap = dev->link->ap; in ata_sff_dev_classify()
1812 struct ata_taskfile tf; in ata_sff_dev_classify() local
1816 ap->ops->sff_dev_select(ap, dev->devno); in ata_sff_dev_classify()
1818 memset(&tf, 0, sizeof(tf)); in ata_sff_dev_classify()
1820 ap->ops->sff_tf_read(ap, &tf); in ata_sff_dev_classify()
1821 err = tf.feature; in ata_sff_dev_classify()
1828 dev->horkage |= ATA_HORKAGE_DIAGNOSTIC; in ata_sff_dev_classify()
1831 else if ((dev->devno == 0) && (err == 0x81)) in ata_sff_dev_classify()
1837 class = ata_dev_classify(&tf); in ata_sff_dev_classify()
1846 if (present && (dev->horkage & ATA_HORKAGE_DIAGNOSTIC)) in ata_sff_dev_classify()
1851 (ap->ops->sff_check_status(ap) == 0)) in ata_sff_dev_classify()
1859 * ata_sff_wait_after_reset - wait for devices to become ready after reset
1865 * reset. It contains preceding 150ms wait to avoid accessing TF
1872 * 0 on success, -ENODEV if some or all of devices in @devmask
1873 * don't seem to exist. -errno on other errors.
1878 struct ata_port *ap = link->ap; in ata_sff_wait_after_reset()
1879 struct ata_ioports *ioaddr = &ap->ioaddr; in ata_sff_wait_after_reset()
1888 /* -ENODEV means the odd clown forgot the D7 pulldown resistor in ata_sff_wait_after_reset()
1889 * and TF status is 0xff, bail out on it too. in ata_sff_wait_after_reset()
1900 ap->ops->sff_dev_select(ap, 1); in ata_sff_wait_after_reset()
1909 nsect = ioread8(ioaddr->nsect_addr); in ata_sff_wait_after_reset()
1910 lbal = ioread8(ioaddr->lbal_addr); in ata_sff_wait_after_reset()
1913 ata_msleep(ap, 50); /* give drive a breather */ in ata_sff_wait_after_reset()
1918 if (rc != -ENODEV) in ata_sff_wait_after_reset()
1925 ap->ops->sff_dev_select(ap, 0); in ata_sff_wait_after_reset()
1927 ap->ops->sff_dev_select(ap, 1); in ata_sff_wait_after_reset()
1929 ap->ops->sff_dev_select(ap, 0); in ata_sff_wait_after_reset()
1938 struct ata_ioports *ioaddr = &ap->ioaddr; in ata_bus_softreset()
1940 DPRINTK("ata%u: bus reset via SRST\n", ap->print_id); in ata_bus_softreset()
1942 if (ap->ioaddr.ctl_addr) { in ata_bus_softreset()
1944 iowrite8(ap->ctl, ioaddr->ctl_addr); in ata_bus_softreset()
1946 iowrite8(ap->ctl | ATA_SRST, ioaddr->ctl_addr); in ata_bus_softreset()
1948 iowrite8(ap->ctl, ioaddr->ctl_addr); in ata_bus_softreset()
1949 ap->last_ctl = ap->ctl; in ata_bus_softreset()
1953 return ata_sff_wait_after_reset(&ap->link, devmask, deadline); in ata_bus_softreset()
1957 * ata_sff_softreset - reset host port via ATA SRST
1968 * 0 on success, -errno otherwise.
1973 struct ata_port *ap = link->ap; in ata_sff_softreset()
1974 unsigned int slave_possible = ap->flags & ATA_FLAG_SLAVE_POSS; in ata_sff_softreset()
1988 ap->ops->sff_dev_select(ap, 0); in ata_sff_softreset()
1993 /* if link is occupied, -ENODEV too is an error */ in ata_sff_softreset()
1994 if (rc && (rc != -ENODEV || sata_scr_valid(link))) { in ata_sff_softreset()
2000 classes[0] = ata_sff_dev_classify(&link->device[0], in ata_sff_softreset()
2003 classes[1] = ata_sff_dev_classify(&link->device[1], in ata_sff_softreset()
2012 * sata_sff_hardreset - reset host port via SATA phy reset
2017 * SATA phy-reset host port using DET bits of SControl register,
2024 * 0 on success, -errno otherwise.
2029 struct ata_eh_context *ehc = &link->eh_context; in sata_sff_hardreset()
2037 *class = ata_sff_dev_classify(link->device, 1, NULL); in sata_sff_hardreset()
2045 * ata_sff_postreset - SFF postreset callback
2049 * This function is invoked after a successful reset. It first
2058 struct ata_port *ap = link->ap; in ata_sff_postreset()
2062 /* is double-select really necessary? */ in ata_sff_postreset()
2064 ap->ops->sff_dev_select(ap, 1); in ata_sff_postreset()
2066 ap->ops->sff_dev_select(ap, 0); in ata_sff_postreset()
2075 if (ap->ops->sff_set_devctl || ap->ioaddr.ctl_addr) { in ata_sff_postreset()
2076 ata_sff_set_devctl(ap, ap->ctl); in ata_sff_postreset()
2077 ap->last_ctl = ap->ctl; in ata_sff_postreset()
2083 * ata_sff_drain_fifo - Stock FIFO drain logic for SFF controllers
2086 * Drain the FIFO and device of any stuck data following a command
2087 * failing to complete. In some cases this is necessary before a
2097 /* We only need to flush incoming data when a command was running */ in ata_sff_drain_fifo()
2098 if (qc == NULL || qc->dma_dir == DMA_TO_DEVICE) in ata_sff_drain_fifo()
2101 ap = qc->ap; in ata_sff_drain_fifo()
2103 for (count = 0; (ap->ops->sff_check_status(ap) & ATA_DRQ) in ata_sff_drain_fifo()
2105 ioread16(ap->ioaddr.data_addr); in ata_sff_drain_fifo()
2115 * ata_sff_error_handler - Stock error handler for SFF controller
2120 * use this EH as-is or with some added handling before and
2128 ata_reset_fn_t softreset = ap->ops->softreset; in ata_sff_error_handler()
2129 ata_reset_fn_t hardreset = ap->ops->hardreset; in ata_sff_error_handler()
2133 qc = __ata_qc_from_tag(ap, ap->link.active_tag); in ata_sff_error_handler()
2134 if (qc && !(qc->flags & ATA_QCFLAG_FAILED)) in ata_sff_error_handler()
2137 spin_lock_irqsave(ap->lock, flags); in ata_sff_error_handler()
2140 * We *MUST* do FIFO draining before we issue a reset as in ata_sff_error_handler()
2146 if (ap->ops->sff_drain_fifo) in ata_sff_error_handler()
2147 ap->ops->sff_drain_fifo(qc); in ata_sff_error_handler()
2149 spin_unlock_irqrestore(ap->lock, flags); in ata_sff_error_handler()
2151 /* ignore built-in hardresets if SCR access is not available */ in ata_sff_error_handler()
2153 hardreset == sata_sff_hardreset) && !sata_scr_valid(&ap->link)) in ata_sff_error_handler()
2156 ata_do_eh(ap, ap->ops->prereset, softreset, hardreset, in ata_sff_error_handler()
2157 ap->ops->postreset); in ata_sff_error_handler()
2162 * ata_sff_std_ports - initialize ioaddr with standard port offsets.
2174 ioaddr->data_addr = ioaddr->cmd_addr + ATA_REG_DATA; in ata_sff_std_ports()
2175 ioaddr->error_addr = ioaddr->cmd_addr + ATA_REG_ERR; in ata_sff_std_ports()
2176 ioaddr->feature_addr = ioaddr->cmd_addr + ATA_REG_FEATURE; in ata_sff_std_ports()
2177 ioaddr->nsect_addr = ioaddr->cmd_addr + ATA_REG_NSECT; in ata_sff_std_ports()
2178 ioaddr->lbal_addr = ioaddr->cmd_addr + ATA_REG_LBAL; in ata_sff_std_ports()
2179 ioaddr->lbam_addr = ioaddr->cmd_addr + ATA_REG_LBAM; in ata_sff_std_ports()
2180 ioaddr->lbah_addr = ioaddr->cmd_addr + ATA_REG_LBAH; in ata_sff_std_ports()
2181 ioaddr->device_addr = ioaddr->cmd_addr + ATA_REG_DEVICE; in ata_sff_std_ports()
2182 ioaddr->status_addr = ioaddr->cmd_addr + ATA_REG_STATUS; in ata_sff_std_ports()
2183 ioaddr->command_addr = ioaddr->cmd_addr + ATA_REG_CMD; in ata_sff_std_ports()
2204 * ata_pci_sff_init_host - acquire native PCI ATA resources and init host
2219 * 0 if at least one port is initialized, -ENODEV if no port is
2224 struct device *gdev = host->dev; in ata_pci_sff_init_host()
2231 struct ata_port *ap = host->ports[i]; in ata_pci_sff_init_host()
2243 ap->ops = &ata_dummy_port_ops; in ata_pci_sff_init_host()
2253 if (rc == -EBUSY) in ata_pci_sff_init_host()
2255 ap->ops = &ata_dummy_port_ops; in ata_pci_sff_init_host()
2258 host->iomap = iomap = pcim_iomap_table(pdev); in ata_pci_sff_init_host()
2260 ap->ioaddr.cmd_addr = iomap[base]; in ata_pci_sff_init_host()
2261 ap->ioaddr.altstatus_addr = in ata_pci_sff_init_host()
2262 ap->ioaddr.ctl_addr = (void __iomem *) in ata_pci_sff_init_host()
2264 ata_sff_std_ports(&ap->ioaddr); in ata_pci_sff_init_host()
2275 return -ENODEV; in ata_pci_sff_init_host()
2283 * ata_pci_sff_prepare_host - helper to prepare PCI PIO-only SFF ATA host
2288 * Helper to allocate PIO-only SFF ATA host for @pdev, acquire
2295 * 0 on success, -errno otherwise.
2304 if (!devres_open_group(&pdev->dev, NULL, GFP_KERNEL)) in ata_pci_sff_prepare_host()
2305 return -ENOMEM; in ata_pci_sff_prepare_host()
2307 host = ata_host_alloc_pinfo(&pdev->dev, ppi, 2); in ata_pci_sff_prepare_host()
2309 dev_err(&pdev->dev, "failed to allocate ATA host\n"); in ata_pci_sff_prepare_host()
2310 rc = -ENOMEM; in ata_pci_sff_prepare_host()
2318 devres_remove_group(&pdev->dev, NULL); in ata_pci_sff_prepare_host()
2323 devres_release_group(&pdev->dev, NULL); in ata_pci_sff_prepare_host()
2329 * ata_pci_sff_activate_host - start SFF host, request IRQ and register it
2342 * 0 on success, -errno otherwise.
2348 struct device *dev = host->dev; in ata_pci_sff_activate_host()
2350 const char *drv_name = dev_driver_string(host->dev); in ata_pci_sff_activate_host()
2357 if ((pdev->class >> 8) == PCI_CLASS_STORAGE_IDE) { in ata_pci_sff_activate_host()
2369 if (!ata_port_is_dummy(host->ports[0])) in ata_pci_sff_activate_host()
2371 if (!ata_port_is_dummy(host->ports[1])) in ata_pci_sff_activate_host()
2378 return -ENOMEM; in ata_pci_sff_activate_host()
2380 if (!legacy_mode && pdev->irq) { in ata_pci_sff_activate_host()
2383 rc = devm_request_irq(dev, pdev->irq, irq_handler, in ata_pci_sff_activate_host()
2389 if (ata_port_is_dummy(host->ports[i])) in ata_pci_sff_activate_host()
2391 ata_port_desc(host->ports[i], "irq %d", pdev->irq); in ata_pci_sff_activate_host()
2394 if (!ata_port_is_dummy(host->ports[0])) { in ata_pci_sff_activate_host()
2401 ata_port_desc(host->ports[0], "irq %d", in ata_pci_sff_activate_host()
2405 if (!ata_port_is_dummy(host->ports[1])) { in ata_pci_sff_activate_host()
2412 ata_port_desc(host->ports[1], "irq %d", in ata_pci_sff_activate_host()
2435 if (ppi[i]->port_ops != &ata_dummy_port_ops) in ata_sff_find_valid_pi()
2446 struct device *dev = &pdev->dev; in ata_pci_init_one()
2455 dev_err(&pdev->dev, "no valid port_info specified\n"); in ata_pci_init_one()
2456 return -EINVAL; in ata_pci_init_one()
2460 return -ENOMEM; in ata_pci_init_one()
2476 host->private_data = host_priv; in ata_pci_init_one()
2477 host->flags |= hflags; in ata_pci_init_one()
2488 devres_remove_group(&pdev->dev, NULL); in ata_pci_init_one()
2490 devres_release_group(&pdev->dev, NULL); in ata_pci_init_one()
2496 * ata_pci_sff_init_one - Initialize/register PIO-only PCI IDE controller
2503 * This is a helper function which can be called from a driver's
2508 * Nobody makes a single channel controller that appears solely as
2515 * Zero on success, negative on errno-based value on error.
2561 * ata_bmdma_fill_sg - Fill PCI IDE PRD table
2564 * Fill PCI IDE PRD (scatter-gather) table with segments
2573 struct ata_port *ap = qc->ap; in ata_bmdma_fill_sg()
2574 struct ata_bmdma_prd *prd = ap->bmdma_prd; in ata_bmdma_fill_sg()
2579 for_each_sg(qc->sg, sg, qc->n_elem, si) { in ata_bmdma_fill_sg()
2584 * Note h/w doesn't support 64-bit, so we unconditionally in ata_bmdma_fill_sg()
2594 len = 0x10000 - offset; in ata_bmdma_fill_sg()
2601 sg_len -= len; in ata_bmdma_fill_sg()
2606 prd[pi - 1].flags_len |= cpu_to_le32(ATA_PRD_EOT); in ata_bmdma_fill_sg()
2610 * ata_bmdma_fill_sg_dumb - Fill PCI IDE PRD table
2613 * Fill PCI IDE PRD (scatter-gather) table with segments
2624 struct ata_port *ap = qc->ap; in ata_bmdma_fill_sg_dumb()
2625 struct ata_bmdma_prd *prd = ap->bmdma_prd; in ata_bmdma_fill_sg_dumb()
2630 for_each_sg(qc->sg, sg, qc->n_elem, si) { in ata_bmdma_fill_sg_dumb()
2635 * Note h/w doesn't support 64-bit, so we unconditionally in ata_bmdma_fill_sg_dumb()
2645 len = 0x10000 - offset; in ata_bmdma_fill_sg_dumb()
2661 sg_len -= len; in ata_bmdma_fill_sg_dumb()
2666 prd[pi - 1].flags_len |= cpu_to_le32(ATA_PRD_EOT); in ata_bmdma_fill_sg_dumb()
2670 * ata_bmdma_qc_prep - Prepare taskfile for submission
2680 if (!(qc->flags & ATA_QCFLAG_DMAMAP)) in ata_bmdma_qc_prep()
2690 * ata_bmdma_dumb_qc_prep - Prepare taskfile for submission
2700 if (!(qc->flags & ATA_QCFLAG_DMAMAP)) in ata_bmdma_dumb_qc_prep()
2710 * ata_bmdma_qc_issue - issue taskfile to a BMDMA controller
2713 * This function issues a PIO, NODATA or DMA command to a
2725 struct ata_port *ap = qc->ap; in ata_bmdma_qc_issue()
2726 struct ata_link *link = qc->dev->link; in ata_bmdma_qc_issue()
2729 if (!ata_is_dma(qc->tf.protocol)) in ata_bmdma_qc_issue()
2733 ata_dev_select(ap, qc->dev->devno, 1, 0); in ata_bmdma_qc_issue()
2736 switch (qc->tf.protocol) { in ata_bmdma_qc_issue()
2738 WARN_ON_ONCE(qc->tf.flags & ATA_TFLAG_POLLING); in ata_bmdma_qc_issue()
2740 ap->ops->sff_tf_load(ap, &qc->tf); /* load tf registers */ in ata_bmdma_qc_issue()
2741 ap->ops->bmdma_setup(qc); /* set up bmdma */ in ata_bmdma_qc_issue()
2742 ap->ops->bmdma_start(qc); /* initiate bmdma */ in ata_bmdma_qc_issue()
2743 ap->hsm_task_state = HSM_ST_LAST; in ata_bmdma_qc_issue()
2747 WARN_ON_ONCE(qc->tf.flags & ATA_TFLAG_POLLING); in ata_bmdma_qc_issue()
2749 ap->ops->sff_tf_load(ap, &qc->tf); /* load tf registers */ in ata_bmdma_qc_issue()
2750 ap->ops->bmdma_setup(qc); /* set up bmdma */ in ata_bmdma_qc_issue()
2751 ap->hsm_task_state = HSM_ST_FIRST; in ata_bmdma_qc_issue()
2754 if (!(qc->dev->flags & ATA_DFLAG_CDB_INTR)) in ata_bmdma_qc_issue()
2768 * ata_bmdma_port_intr - Handle BMDMA port interrupt
2782 struct ata_eh_info *ehi = &ap->link.eh_info; in ata_bmdma_port_intr()
2787 if (ap->hsm_task_state == HSM_ST_LAST && ata_is_dma(qc->tf.protocol)) { in ata_bmdma_port_intr()
2789 host_stat = ap->ops->bmdma_status(ap); in ata_bmdma_port_intr()
2790 VPRINTK("ata%u: host_stat 0x%X\n", ap->print_id, host_stat); in ata_bmdma_port_intr()
2796 /* before we do anything else, clear DMA-Start bit */ in ata_bmdma_port_intr()
2797 ap->ops->bmdma_stop(qc); in ata_bmdma_port_intr()
2802 qc->err_mask |= AC_ERR_HOST_BUS; in ata_bmdma_port_intr()
2803 ap->hsm_task_state = HSM_ST_ERR; in ata_bmdma_port_intr()
2809 if (unlikely(qc->err_mask) && ata_is_dma(qc->tf.protocol)) in ata_bmdma_port_intr()
2817 * ata_bmdma_interrupt - Default BMDMA ATA host interrupt handler
2837 * ata_bmdma_error_handler - Stock error handler for BMDMA controller
2842 * able to use this EH as-is or with some added handling before
2854 qc = __ata_qc_from_tag(ap, ap->link.active_tag); in ata_bmdma_error_handler()
2855 if (qc && !(qc->flags & ATA_QCFLAG_FAILED)) in ata_bmdma_error_handler()
2859 spin_lock_irqsave(ap->lock, flags); in ata_bmdma_error_handler()
2861 if (qc && ata_is_dma(qc->tf.protocol)) { in ata_bmdma_error_handler()
2864 host_stat = ap->ops->bmdma_status(ap); in ata_bmdma_error_handler()
2868 * really a timeout event, adjust error mask and in ata_bmdma_error_handler()
2871 if (qc->err_mask == AC_ERR_TIMEOUT && (host_stat & ATA_DMA_ERR)) { in ata_bmdma_error_handler()
2872 qc->err_mask = AC_ERR_HOST_BUS; in ata_bmdma_error_handler()
2876 ap->ops->bmdma_stop(qc); in ata_bmdma_error_handler()
2880 ap->ops->sff_check_status(ap); in ata_bmdma_error_handler()
2881 if (ap->ops->sff_irq_clear) in ata_bmdma_error_handler()
2882 ap->ops->sff_irq_clear(ap); in ata_bmdma_error_handler()
2886 spin_unlock_irqrestore(ap->lock, flags); in ata_bmdma_error_handler()
2896 * ata_bmdma_post_internal_cmd - Stock post_internal_cmd for BMDMA
2904 struct ata_port *ap = qc->ap; in ata_bmdma_post_internal_cmd()
2907 if (ata_is_dma(qc->tf.protocol)) { in ata_bmdma_post_internal_cmd()
2908 spin_lock_irqsave(ap->lock, flags); in ata_bmdma_post_internal_cmd()
2909 ap->ops->bmdma_stop(qc); in ata_bmdma_post_internal_cmd()
2910 spin_unlock_irqrestore(ap->lock, flags); in ata_bmdma_post_internal_cmd()
2916 * ata_bmdma_irq_clear - Clear PCI IDE BMDMA interrupt.
2928 void __iomem *mmio = ap->ioaddr.bmdma_addr; in ata_bmdma_irq_clear()
2938 * ata_bmdma_setup - Set up PCI IDE BMDMA transaction
2946 struct ata_port *ap = qc->ap; in ata_bmdma_setup()
2947 unsigned int rw = (qc->tf.flags & ATA_TFLAG_WRITE); in ata_bmdma_setup()
2952 iowrite32(ap->bmdma_prd_dma, ap->ioaddr.bmdma_addr + ATA_DMA_TABLE_OFS); in ata_bmdma_setup()
2954 /* specify data direction, triple-check start bit is clear */ in ata_bmdma_setup()
2955 dmactl = ioread8(ap->ioaddr.bmdma_addr + ATA_DMA_CMD); in ata_bmdma_setup()
2959 iowrite8(dmactl, ap->ioaddr.bmdma_addr + ATA_DMA_CMD); in ata_bmdma_setup()
2962 ap->ops->sff_exec_command(ap, &qc->tf); in ata_bmdma_setup()
2967 * ata_bmdma_start - Start a PCI IDE BMDMA transaction
2975 struct ata_port *ap = qc->ap; in ata_bmdma_start()
2979 dmactl = ioread8(ap->ioaddr.bmdma_addr + ATA_DMA_CMD); in ata_bmdma_start()
2980 iowrite8(dmactl | ATA_DMA_START, ap->ioaddr.bmdma_addr + ATA_DMA_CMD); in ata_bmdma_start()
2987 * Further, a read of the DMA status register _immediately_ in ata_bmdma_start()
2989 * is expected, so I think it is best to not add a readb() in ata_bmdma_start()
3000 * ata_bmdma_stop - Stop PCI IDE BMDMA transfer
3012 struct ata_port *ap = qc->ap; in ata_bmdma_stop()
3013 void __iomem *mmio = ap->ioaddr.bmdma_addr; in ata_bmdma_stop()
3019 /* one-PIO-cycle guaranteed wait, per spec, for HDMA1:0 transition */ in ata_bmdma_stop()
3025 * ata_bmdma_status - Read PCI IDE BMDMA status
3037 return ioread8(ap->ioaddr.bmdma_addr + ATA_DMA_STATUS); in ata_bmdma_status()
3043 * ata_bmdma_port_start - Set port up for bmdma.
3056 if (ap->mwdma_mask || ap->udma_mask) { in ata_bmdma_port_start()
3057 ap->bmdma_prd = in ata_bmdma_port_start()
3058 dmam_alloc_coherent(ap->host->dev, ATA_PRD_TBL_SZ, in ata_bmdma_port_start()
3059 &ap->bmdma_prd_dma, GFP_KERNEL); in ata_bmdma_port_start()
3060 if (!ap->bmdma_prd) in ata_bmdma_port_start()
3061 return -ENOMEM; in ata_bmdma_port_start()
3069 * ata_bmdma_port_start32 - Set port up for dma.
3084 ap->pflags |= ATA_PFLAG_PIO32 | ATA_PFLAG_PIO32CHANGE; in ata_bmdma_port_start32()
3092 * ata_pci_bmdma_clear_simplex - attempt to kick device out of simplex
3098 * have -undefined- behaviour.
3106 return -ENOENT; in ata_pci_bmdma_clear_simplex()
3112 return -EOPNOTSUPP; in ata_pci_bmdma_clear_simplex()
3121 dev_err(host->dev, "BMDMA: %s, falling back to PIO\n", reason); in ata_bmdma_nodma()
3124 host->ports[i]->mwdma_mask = 0; in ata_bmdma_nodma()
3125 host->ports[i]->udma_mask = 0; in ata_bmdma_nodma()
3130 * ata_pci_bmdma_init - acquire PCI BMDMA resources and init ATA host
3140 struct device *gdev = host->dev; in ata_pci_bmdma_init()
3153 * ->sff_irq_clear method. Try to initialize bmdma_addr in ata_pci_bmdma_init()
3156 rc = dma_set_mask_and_coherent(&pdev->dev, ATA_DMA_MASK); in ata_pci_bmdma_init()
3166 host->iomap = pcim_iomap_table(pdev); in ata_pci_bmdma_init()
3169 struct ata_port *ap = host->ports[i]; in ata_pci_bmdma_init()
3170 void __iomem *bmdma = host->iomap[4] + 8 * i; in ata_pci_bmdma_init()
3175 ap->ioaddr.bmdma_addr = bmdma; in ata_pci_bmdma_init()
3176 if ((!(ap->flags & ATA_FLAG_IGN_SIMPLEX)) && in ata_pci_bmdma_init()
3178 host->flags |= ATA_HOST_SIMPLEX; in ata_pci_bmdma_init()
3187 * ata_pci_bmdma_prepare_host - helper to prepare PCI BMDMA ATA host
3199 * 0 on success, -errno otherwise.
3217 * ata_pci_bmdma_init_one - Initialize/register BMDMA PCI IDE controller
3231 * Zero on success, negative on errno-based value on error.
3246 * ata_sff_port_init - Initialize SFF/BMDMA ATA port
3257 INIT_DELAYED_WORK(&ap->sff_pio_task, ata_sff_pio_task); in ata_sff_port_init()
3258 ap->ctl = ATA_DEVCTL_OBS; in ata_sff_port_init()
3259 ap->last_ctl = 0xFF; in ata_sff_port_init()
3266 return -ENOMEM; in ata_sff_init()