From ed027a9d59e665f14d573d673092906f2ab61f98 Mon Sep 17 00:00:00 2001
From: Björn Stenberg <bjorn@haxx.se>
Date: Wed, 14 Aug 2002 14:34:54 +0000
Subject: Allow (slow) reading to odd address

git-svn-id: svn://svn.rockbox.org/rockbox/trunk@1734 a1c6a512-1295-4272-9138-f99709370657
---
 firmware/drivers/ata.c | 17 +++++++++++++++--
 1 file changed, 15 insertions(+), 2 deletions(-)

(limited to 'firmware')

diff --git a/firmware/drivers/ata.c b/firmware/drivers/ata.c
index 29d2851875..9d5e02dc34 100644
--- a/firmware/drivers/ata.c
+++ b/firmware/drivers/ata.c
@@ -145,6 +145,8 @@ int ata_read_sectors(unsigned long start,
     int i;
     int ret = 0;
 
+    DEBUGF("ata_read(%X,%d,%X)\n",start,count,buf);
+
 #ifndef USE_STANDBY
     if ( sleeping ) {
 #ifdef USE_POWEROFF
@@ -184,8 +186,19 @@ int ata_read_sectors(unsigned long start,
             return -1;
         }
 
-        for (j=0; j<SECTOR_SIZE/2; j++)
-            ((unsigned short*)buf)[j] = SWAB16(ATA_DATA);
+        /* if destination address is odd, use byte copying,
+           otherwise use word copying */
+        if ( (unsigned int)buf & 1 ) {
+            for (j=0; j<SECTOR_SIZE/2; j++) {
+                unsigned short tmp = SWAB16(ATA_DATA);
+                ((unsigned char*)buf)[j*2] = tmp >> 8;
+                ((unsigned char*)buf)[j*2+1] = tmp & 0xff;
+            }
+        }
+        else {
+            for (j=0; j<SECTOR_SIZE/2; j++)
+                ((unsigned short*)buf)[j] = SWAB16(ATA_DATA);
+        }
 
 #ifdef USE_INTERRUPT
         /* reading the status register clears the interrupt */
-- 
cgit v1.2.3