ide-iops: only clear DMA words on setting DMA mode

The bytes indicating current DMA mode in the identify data words 62, 63, and 88
should only change on setting a DMA mode, so stop clearing them  on setting PIO
mode in ide_config_drive_speed().  While at it, correct SW/MW DMA mode masks...

Signed-off-by: Sergei Shtylyov <sshtylyov@ru.mvista.com>
Signed-off-by: Bartlomiej Zolnierkiewicz <bzolnier@gmail.com>

1 files changed, 5 insertions, 3 deletions

diff --git a/drivers/ide/ide-iops.c b/drivers/ide/ide-iops.c
index 5403e4a44be4..0e62698146b6 100644
--- a/drivers/ide/ide-iops.c
+++ b/drivers/ide/ide-iops.c
@@ -386,9 +386,11 @@ int ide_config_drive_speed(ide_drive_t *drive, u8 speed)
                 return error;
         }
 
-        id[ATA_ID_UDMA_MODES]  &= ~0xFF00;
-        id[ATA_ID_MWDMA_MODES] &= ~0x0F00;
-        id[ATA_ID_SWDMA_MODES] &= ~0x0F00;
+        if (speed >= XFER_SW_DMA_0) {
+                id[ATA_ID_UDMA_MODES]  &= ~0xFF00;
+                id[ATA_ID_MWDMA_MODES] &= ~0x0700;
+                id[ATA_ID_SWDMA_MODES] &= ~0x0700;
+        }
 
  skip:
 #ifdef CONFIG_BLK_DEV_IDEDMA