Now runs SET_MULTIPLE_MODE after usb disconnect, since the windows driver sets it to a non-default value.

git-svn-id: svn://svn.rockbox.org/rockbox/trunk@2214 a1c6a512-1295-4272-9138-f99709370657

1 files changed, 22 insertions, 0 deletions

diff --git a/firmware/drivers/ata.c b/firmware/drivers/ata.c
index 32048ef53d..9f025588ff 100644
--- a/firmware/drivers/ata.c
+++ b/firmware/drivers/ata.c
@@ -661,6 +661,26 @@ static int identify(void)
     return 0;
 }
 
+static int set_multiple_mode(int sectors)
+{
+    if(!wait_for_rdy()) {
+        DEBUGF("set_multiple_mode() - not RDY\n");
+        return -1;
+    }
+
+    ATA_SELECT = ata_device;
+    ATA_NSECTOR = sectors;
+    ATA_COMMAND = CMD_SET_MULTIPLE_MODE;
+
+    if (!wait_for_rdy())
+    {
+        DEBUGF("set_multiple_mode() - CMD failed\n");
+        return -2;
+    }
+
+    return 0;
+}
+
 int ata_init(void)
 {
     mutex_init(&ata_mtx);
@@ -692,6 +712,8 @@ int ata_init(void)
                       sizeof(ata_stack), ata_thread_name);
         initialized = true;
     }
+    if (set_multiple_mode(multisectors))
+       return -6;
 
     ATA_SELECT = SELECT_LBA;
     ATA_CONTROL = CONTROL_nIEN;