1 files changed, 13 insertions, 14 deletions

diff --git a/drivers/ata/pata_cmd64x.c b/drivers/ata/pata_cmd64x.c
index 0efb1f58f255..4c81a71b8877 100644
--- a/drivers/ata/pata_cmd64x.c
+++ b/drivers/ata/pata_cmd64x.c
@@ -2,6 +2,7 @@
  * pata_cmd64x.c        - CMD64x PATA for new ATA layer
  *                        (C) 2005 Red Hat Inc
  *                        Alan Cox <alan@lxorguk.ukuu.org.uk>
+ *                        (C) 2009-2010 Bartlomiej Zolnierkiewicz
  *
  * Based upon
  * linux/drivers/ide/pci/cmd64x.c               Version 1.30    Sept 10, 2002
@@ -39,11 +40,7 @@
 
 enum {
         CFR             = 0x50,
-                CFR_INTR_CH0  = 0x02,
-        CNTRL           = 0x51,
-                CNTRL_DIS_RA0 = 0x40,
-                CNTRL_DIS_RA1 = 0x80,
-                CNTRL_ENA_2ND = 0x08,
+                CFR_INTR_CH0  = 0x04,
         CMDTIM          = 0x52,
         ARTTIM0         = 0x53,
         DRWTIM0         = 0x54,
@@ -53,9 +50,6 @@ enum {
                 ARTTIM23_DIS_RA2  = 0x04,
                 ARTTIM23_DIS_RA3  = 0x08,
                 ARTTIM23_INTR_CH1 = 0x10,
-        ARTTIM2         = 0x57,
-        ARTTIM3         = 0x57,
-        DRWTIM23        = 0x58,
         DRWTIM2         = 0x58,
         BRST            = 0x59,
         DRWTIM3         = 0x5b,
@@ -63,14 +57,11 @@ enum {
         MRDMODE         = 0x71,
                 MRDMODE_INTR_CH0 = 0x04,
                 MRDMODE_INTR_CH1 = 0x08,
-                MRDMODE_BLK_CH0  = 0x10,
-                MRDMODE_BLK_CH1  = 0x20,
         BMIDESR0        = 0x72,
         UDIDETCR0       = 0x73,
         DTPR0           = 0x74,
         BMIDECR1        = 0x78,
         BMIDECSR        = 0x79,
-        BMIDESR1        = 0x7A,
         UDIDETCR1       = 0x7B,
         DTPR1           = 0x7C
 };
@@ -130,8 +121,14 @@ static void cmd64x_set_timing(struct ata_port *ap, struct ata_device *adev, u8 m
 
                 if (pair) {
                         struct ata_timing tp;
+
                         ata_timing_compute(pair, pair->pio_mode, &tp, T, 0);
                         ata_timing_merge(&t, &tp, &t, ATA_TIMING_SETUP);
+                        if (pair->dma_mode) {
+                                ata_timing_compute(pair, pair->dma_mode,
+                                                &tp, T, 0);
+                                ata_timing_merge(&tp, &t, &t, ATA_TIMING_SETUP);
+                        }
                 }
         }
 
@@ -147,7 +144,9 @@ static void cmd64x_set_timing(struct ata_port *ap, struct ata_device *adev, u8 m
         /* Now convert the clocks into values we can actually stuff into
            the chip */
 
-        if (t.recover > 1)
+        if (t.recover == 16)
+                t.recover = 0;
+        else if (t.recover > 1)
                 t.recover--;
         else
                 t.recover = 15;
@@ -245,7 +244,7 @@ static void cmd648_bmdma_stop(struct ata_queued_cmd *qc)
         struct pci_dev *pdev = to_pci_dev(ap->host->dev);
         u8 dma_intr;
         int dma_mask = ap->port_no ? ARTTIM23_INTR_CH1 : CFR_INTR_CH0;
-        int dma_reg = ap->port_no ? ARTTIM2 : CFR;
+        int dma_reg = ap->port_no ? ARTTIM23 : CFR;
 
         ata_bmdma_stop(qc);
 
@@ -368,7 +367,7 @@ static int cmd64x_init_one(struct pci_dev *pdev, const struct pci_device_id *id)
         pci_write_config_byte(pdev, UDIDETCR0, 0xF0);
 #endif
 
-        return ata_pci_sff_init_one(pdev, ppi, &cmd64x_sht, NULL);
+        return ata_pci_sff_init_one(pdev, ppi, &cmd64x_sht, NULL, 0);
 }
 
 #ifdef CONFIG_PM