return 0;
 }
 
+static int ahci_check_ready(struct ata_link *link)
+{
+       void __iomem *mmio = link->ap->ioaddr.cmd_addr;
+       u8 status = readl(mmio + PORT_TFDATA) & 0xFF;
+
+       if (!(status & ATA_BUSY))
+               return 1;
+       return 0;
+}
+
 static int ahci_do_softreset(struct ata_link *link, unsigned int *class,
                             int pmp, unsigned long deadline)
 {
        ahci_exec_polled_cmd(ap, pmp, &tf, 0, 0, 0);
 
        /* wait for link to become ready */
-       rc = ata_sff_wait_after_reset(link, 1, deadline);
+       rc = ata_wait_after_reset(link, deadline, ahci_check_ready);
        /* link occupied, -ENODEV too is an error */
        if (rc) {
                reason = "device not ready";
         * have to be reset again.  For most cases, this should
         * suffice while making probing snappish enough.
         */
-       rc = ata_sff_wait_after_reset(link, 1, jiffies + 2 * HZ);
+       rc = ata_wait_after_reset(link, jiffies + 2 * HZ, ahci_check_ready);
        if (rc)
                ahci_kick_engine(ap, 0);