1 files changed, 24 insertions, 11 deletions

diff --git a/drivers/ata/ata_piix.c b/drivers/ata/ata_piix.c
index 9c07b88631be..6a3bfef58e13 100644
--- a/drivers/ata/ata_piix.c
+++ b/drivers/ata/ata_piix.c
@@ -200,6 +200,8 @@ static const struct pci_device_id piix_pci_tbl[] = {
         /* ICH7/7-R (i945, i975) UDMA 100*/
         { 0x8086, 0x27DF, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich_pata_133 },
         { 0x8086, 0x269E, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich_pata_100 },
+        /* ICH8 Mobile PATA Controller */
+        { 0x8086, 0x2850, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich_pata_100 },
 
         /* NOTE: The following PCI ids must be kept in sync with the
          * list in drivers/pci/quirks.c.
@@ -495,7 +497,7 @@ static struct ata_port_info piix_port_info[] = {
                 .flags          = PIIX_SATA_FLAGS,
                 .pio_mask       = 0x1f, /* pio0-4 */
                 .mwdma_mask     = 0x07, /* mwdma0-2 */
-                .udma_mask      = 0x7f, /* udma0-6 */
+                .udma_mask      = ATA_UDMA6,
                 .port_ops       = &piix_sata_ops,
         },
 
@@ -505,7 +507,7 @@ static struct ata_port_info piix_port_info[] = {
                 .flags          = PIIX_SATA_FLAGS | PIIX_FLAG_SCR,
                 .pio_mask       = 0x1f, /* pio0-4 */
                 .mwdma_mask     = 0x07, /* mwdma0-2 */
-                .udma_mask      = 0x7f, /* udma0-6 */
+                .udma_mask      = ATA_UDMA6,
                 .port_ops       = &piix_sata_ops,
         },
 
@@ -516,7 +518,7 @@ static struct ata_port_info piix_port_info[] = {
                                   PIIX_FLAG_AHCI,
                 .pio_mask       = 0x1f, /* pio0-4 */
                 .mwdma_mask     = 0x07, /* mwdma0-2 */
-                .udma_mask      = 0x7f, /* udma0-6 */
+                .udma_mask      = ATA_UDMA6,
                 .port_ops       = &piix_sata_ops,
         },
 
@@ -527,7 +529,7 @@ static struct ata_port_info piix_port_info[] = {
                                   PIIX_FLAG_AHCI,
                 .pio_mask       = 0x1f, /* pio0-4 */
                 .mwdma_mask     = 0x07, /* mwdma0-2 */
-                .udma_mask      = 0x7f, /* udma0-6 */
+                .udma_mask      = ATA_UDMA6,
                 .port_ops       = &piix_sata_ops,
         },
 
@@ -538,7 +540,7 @@ static struct ata_port_info piix_port_info[] = {
                                   PIIX_FLAG_AHCI,
                 .pio_mask       = 0x1f, /* pio0-4 */
                 .mwdma_mask     = 0x07, /* mwdma0-2 */
-                .udma_mask      = 0x7f, /* udma0-6 */
+                .udma_mask      = ATA_UDMA6,
                 .port_ops       = &piix_sata_ops,
         },
 
@@ -685,8 +687,14 @@ static void piix_set_piomode (struct ata_port *ap, struct ata_device *adev)
         if (adev->class == ATA_DEV_ATA)
                 control |= 4;   /* PPE enable */
 
+        /* PIO configuration clears DTE unconditionally.  It will be
+         * programmed in set_dmamode which is guaranteed to be called
+         * after set_piomode if any DMA mode is available.
+         */
         pci_read_config_word(dev, master_port, &master_data);
         if (is_slave) {
+                /* clear TIME1|IE1|PPE1|DTE1 */
+                master_data &= 0xff0f;
                 /* Enable SITRE (seperate slave timing register) */
                 master_data |= 0x4000;
                 /* enable PPE1, IE1 and TIME1 as needed */
@@ -694,12 +702,14 @@ static void piix_set_piomode (struct ata_port *ap, struct ata_device *adev)
                 pci_read_config_byte(dev, slave_port, &slave_data);
                 slave_data &= (ap->port_no ? 0x0f : 0xf0);
                 /* Load the timing nibble for this slave */
-                slave_data |= ((timings[pio][0] << 2) | timings[pio][1]) << (ap->port_no ? 4 : 0);
+                slave_data |= ((timings[pio][0] << 2) | timings[pio][1])
+                                                << (ap->port_no ? 4 : 0);
         } else {
-                /* Master keeps the bits in a different format */
-                master_data &= 0xccf8;
+                /* clear ISP|RCT|TIME0|IE0|PPE0|DTE0 */
+                master_data &= 0xccf0;
                 /* Enable PPE, IE and TIME as appropriate */
                 master_data |= control;
+                /* load ISP and RCT */
                 master_data |=
                         (timings[pio][0] << 12) |
                         (timings[pio][1] << 8);
@@ -816,7 +826,7 @@ static void do_pata_set_dmamode (struct ata_port *ap, struct ata_device *adev, i
                         master_data &= 0xFF4F;  /* Mask out IORDY|TIME1|DMAONLY */
                         master_data |= control << 4;
                         pci_read_config_byte(dev, 0x44, &slave_data);
-                        slave_data &= (0x0F + 0xE1 * ap->port_no);
+                        slave_data &= (ap->port_no ? 0x0f : 0xf0);
                         /* Load the matching timing */
                         slave_data |= ((timings[pio][0] << 2) | timings[pio][1]) << (ap->port_no ? 4 : 0);
                         pci_write_config_byte(dev, 0x44, slave_data);
@@ -828,8 +838,11 @@ static void do_pata_set_dmamode (struct ata_port *ap, struct ata_device *adev, i
                                 (timings[pio][0] << 12) |
                                 (timings[pio][1] << 8);
                 }
-                udma_enable &= ~(1 << devid);
-                pci_write_config_word(dev, master_port, master_data);
+
+                if (ap->udma_mask) {
+                        udma_enable &= ~(1 << devid);
+                        pci_write_config_word(dev, master_port, master_data);
+                }
         }
         /* Don't scribble on 0x48 if the controller does not support UDMA */
         if (ap->udma_mask)