[libata sata_promise] Add PATA cable detection.

Original patch from Phillip Jordan <phillip.m.jordan@gmail.com>
Cleanups and fixes by me.

1 files changed, 15 insertions, 4 deletions

diff --git a/drivers/scsi/sata_promise.c b/drivers/scsi/sata_promise.c
index bb000438cb6c..285ab0263d91 100644
--- a/drivers/scsi/sata_promise.c
+++ b/drivers/scsi/sata_promise.c
@@ -364,12 +364,23 @@ static void pdc_sata_phy_reset(struct ata_port *ap)
         sata_phy_reset(ap);
 }
 
-static void pdc_pata_phy_reset(struct ata_port *ap)
+static void pdc_pata_cbl_detect(struct ata_port *ap)
 {
-        /* FIXME: add cable detect.  Don't assume 40-pin cable */
-        ap->cbl = ATA_CBL_PATA40;
-        ap->udma_mask &= ATA_UDMA_MASK_40C;
+        u8 tmp;
+        void __iomem *mmio = (void *) ap->ioaddr.cmd_addr + PDC_CTLSTAT + 0x03;
+
+        tmp = readb(mmio);
+
+        if (tmp & 0x01) {
+                ap->cbl = ATA_CBL_PATA40;
+                ap->udma_mask &= ATA_UDMA_MASK_40C;
+        } else
+                ap->cbl = ATA_CBL_PATA80;
+}
 
+static void pdc_pata_phy_reset(struct ata_port *ap)
+{
+        pdc_pata_cbl_detect(ap);
         pdc_reset_port(ap);
         ata_port_probe(ap);
         ata_bus_reset(ap);