9 files changed, 890 insertions, 745 deletions

diff --git a/firmware/SOURCES b/firmware/SOURCES
index beb51bef42..77c257879a 100644
--- a/firmware/SOURCES
+++ b/firmware/SOURCES
@@ -284,6 +284,8 @@ drivers/i2c.c
 
 #ifdef ARCHOS_PLAYER
 #ifndef SIMULATOR
+target/sh/archos/ata-archos.c
+target/sh/archos/ata-as-archos.S
 target/sh/archos/player/button-player.c
 target/sh/archos/player/lcd-as-player.S
 #endif /* SIMULATOR */
@@ -291,6 +293,8 @@ target/sh/archos/player/lcd-as-player.S
 
 #ifdef ARCHOS_RECORDER
 #ifndef SIMULATOR
+target/sh/archos/ata-archos.c
+target/sh/archos/ata-as-archos.S
 target/sh/archos/lcd-archos-bitmap.c
 target/sh/archos/lcd-as-archos-bitmap.S
 target/sh/archos/recorder/button-recorder.c
@@ -299,6 +303,8 @@ target/sh/archos/recorder/button-recorder.c
 
 #if defined(ARCHOS_FMRECORDER) || defined(ARCHOS_RECORDERV2)
 #ifndef SIMULATOR
+target/sh/archos/ata-archos.c
+target/sh/archos/ata-as-archos.S
 target/sh/archos/lcd-archos-bitmap.c
 target/sh/archos/lcd-as-archos-bitmap.S
 target/sh/archos/fm_v2/button-fm_v2.c
@@ -328,6 +334,7 @@ target/arm/sandisk/sansa-e200/power-e200.c
 #ifdef IAUDIO_X5
 target/coldfire/iaudio/x5/power-x5.c
 #ifndef SIMULATOR
+target/coldfire/ata-as-coldfire.S
 target/coldfire/pcf50606-coldfire.c
 target/coldfire/iaudio/x5/adc-x5.c
 target/coldfire/iaudio/x5/ata-x5.c
@@ -356,6 +363,7 @@ common/sscanf.c
 #ifdef IRIVER_H300_SERIES
 target/coldfire/iriver/h300/power-h300.c
 #ifndef SIMULATOR
+target/coldfire/ata-as-coldfire.S
 target/coldfire/pcf50606-coldfire.c
 target/coldfire/iriver/ata-iriver.c
 target/coldfire/iriver/system-iriver.c
@@ -375,6 +383,7 @@ target/coldfire/iriver/audio-iriver.c
 #ifdef IRIVER_H100_SERIES
 target/coldfire/iriver/h100/power-h100.c
 #ifndef SIMULATOR
+target/coldfire/ata-as-coldfire.S
 target/coldfire/iriver/ata-iriver.c
 target/coldfire/iriver/system-iriver.c
 target/coldfire/iriver/h100/adc-h100.c
diff --git a/firmware/drivers/ata.c b/firmware/drivers/ata.c
index d0cca2e148..72194db8da 100644
--- a/firmware/drivers/ata.c
+++ b/firmware/drivers/ata.c
@@ -30,66 +30,10 @@
 #include "string.h"
 #include "hwcompat.h"
 #include "ata_idle_notify.h"
-#ifdef TARGET_TREE
 #include "ata-target.h"
-#endif
 
 #define SECTOR_SIZE     (512)
 
-#if CONFIG_CPU == SH7034
-
-/* asm optimised read & write loops */
-
-#define NOINLINE_ATTR __attribute__((noinline)) /* don't inline the loops */
-
-#define SWAP_WORDS
-
-#define ATA_IOBASE      0x06100100
-#define ATA_DATA        (*((volatile unsigned short*)0x06104100))
-#define ATA_CONTROL1    ((volatile unsigned char*)0x06200206)
-#define ATA_CONTROL2    ((volatile unsigned char*)0x06200306)
-#define ATA_CONTROL     (*ata_control)
-
-#define ATA_ERROR       (*((volatile unsigned char*)ATA_IOBASE + 1))
-#define ATA_NSECTOR     (*((volatile unsigned char*)ATA_IOBASE + 2))
-#define ATA_SECTOR      (*((volatile unsigned char*)ATA_IOBASE + 3))
-#define ATA_LCYL        (*((volatile unsigned char*)ATA_IOBASE + 4))
-#define ATA_HCYL        (*((volatile unsigned char*)ATA_IOBASE + 5))
-#define ATA_SELECT      (*((volatile unsigned char*)ATA_IOBASE + 6))
-#define ATA_COMMAND     (*((volatile unsigned char*)ATA_IOBASE + 7))
-
-#define STATUS_BSY      0x80
-#define STATUS_RDY      0x40
-#define STATUS_DF       0x20
-#define STATUS_DRQ      0x08
-#define STATUS_ERR      0x01
-
-#define ERROR_ABRT      0x04
-
-#define WRITE_PATTERN1 0xa5
-#define WRITE_PATTERN2 0x5a
-#define WRITE_PATTERN3 0xaa
-#define WRITE_PATTERN4 0x55
-
-#define READ_PATTERN1 0xa5
-#define READ_PATTERN2 0x5a
-#define READ_PATTERN3 0xaa
-#define READ_PATTERN4 0x55
-
-#define READ_PATTERN1_MASK 0xff
-#define READ_PATTERN2_MASK 0xff
-#define READ_PATTERN3_MASK 0xff
-#define READ_PATTERN4_MASK 0xff
-
-#define SET_REG(reg,val) reg = (val)
-#define SET_16BITREG(reg,val) reg = (val)
-
-#endif
-
-#ifndef NOINLINE_ATTR
-#define NOINLINE_ATTR
-#endif
-
 #define ATA_FEATURE     ATA_ERROR
 
 #define ATA_STATUS      ATA_COMMAND
@@ -118,11 +62,7 @@
 #define READ_TIMEOUT 5*HZ
 
 static struct mutex ata_mtx;
-char ata_device; /* device 0 (master) or 1 (slave) */
-int ata_io_address; /* 0x300 or 0x200, only valid on recorder */
-#if CONFIG_CPU == SH7034
-static volatile unsigned char* ata_control;
-#endif
+int ata_device; /* device 0 (master) or 1 (slave) */
 
 int ata_spinup_time = 0;
 #if CONFIG_LED == LED_REAL
@@ -131,8 +71,8 @@ static bool ata_led_on = false;
 #endif
 static bool spinup = false;
 static bool sleeping = true;
-static long sleep_timeout = 5*HZ;
 static bool poweroff = false;
+static long sleep_timeout = 5*HZ;
 #ifdef HAVE_ATA_POWER_OFF
 static int poweroff_timeout = 2*HZ;
 #endif
@@ -206,25 +146,30 @@ static int wait_for_end_of_transfer(void)
     return (ATA_ALT_STATUS & (STATUS_RDY|STATUS_DRQ)) == STATUS_RDY;
 }    
 
-/* Optimization: don't do 256 calls to ddma_transfer; fuse with it
- * as in the Archos firmware.
- * It actually possible to do a single dma transfer to copy a whole sector between ATA
- * controller & cpu internal memory.
- */
-/* the tight loop of ata_read_sectors(), to avoid the whole in IRAM */
-static void copy_read_sectors(unsigned char* buf, int wordcount)
-                              ICODE_ATTR NOINLINE_ATTR;
+#if CONFIG_LED == LED_REAL
+/* Conditionally block LED access for the ATA driver, so the LED can be
+ * (mis)used for other purposes */
+static void ata_led(bool on) 
+{
+    ata_led_on = on;
+    if (ata_led_enabled)
+        led(ata_led_on);
+}
+#else
+#define ata_led(on) led(on)
+#endif
+
+#ifndef ATA_OPTIMIZED_READING
+static void copy_read_sectors(unsigned char* buf, int wordcount) ICODE_ATTR;
 static void copy_read_sectors(unsigned char* buf, int wordcount)
 {
-#ifdef PREFER_C_READING
     unsigned short tmp = 0;
 
     if ( (unsigned long)buf & 1)
     {   /* not 16-bit aligned, copy byte by byte */
         unsigned char* bufend = buf + wordcount*2;
         do
-        {   /* loop compiles to 9 assembler instructions */
-            /* takes 14 clock cycles (2 pipeline stalls, 1 wait) */
+        {
             tmp = ATA_DATA;
 #if defined(SWAP_WORDS) || defined(ROCKBOX_LITTLE_ENDIAN)
             *buf++ = tmp & 0xff; /* I assume big endian */
@@ -240,8 +185,7 @@ static void copy_read_sectors(unsigned char* buf, int wordcount)
         unsigned short* wbuf = (unsigned short*)buf;
         unsigned short* wbufend = wbuf + wordcount;
         do
-        {   /* loop compiles to 7 assembler instructions */
-            /* takes 12 clock cycles (2 pipeline stalls, 1 wait) */
+        {
 #ifdef SWAP_WORDS
             *wbuf = swap16(ATA_DATA);
 #else
@@ -249,304 +193,8 @@ static void copy_read_sectors(unsigned char* buf, int wordcount)
 #endif
         } while (++wbuf < wbufend); /* tail loop is faster */
     }
-#else /* !PREFER_C_READING */
-#if defined(CPU_COLDFIRE)
-    unsigned char* bufend = buf + 2 * wordcount;
-    /* coldfire asm reading, utilising line bursts */
-    /* this assumes there is at least one full line to copy */
-    asm volatile (
-        "move.l  %[buf],%%d0     \n"
-        "btst.l  #0,%%d0         \n" /* 16-bit aligned? */
-        "jeq     .aligned        \n" /* yes, do word copy */
-
-        /* not 16-bit aligned */
-        "subq.l  #1,%[end]       \n" /* last byte is done unconditionally */
-        "moveq.l #24,%%d1        \n" /* preload shift count */
-
-        "move.w  (%[ata]),%%d2   \n" /* load initial word */
-        "move.l  %%d2,%%d3       \n"
-        "lsr.l   #8,%%d3         \n"
-        "move.b  %%d3,(%[buf])+  \n" /* write high byte of it, aligns dest addr */
-        
-        "btst.l  #1,%%d0         \n" /* longword aligned? */
-        "beq.b   .end_u_w1       \n" /* yes, skip leading word handling */
-        
-        "swap    %%d2            \n" /* move initial word up */
-        "move.w  (%[ata]),%%d2   \n" /* combine with second word */
-        "move.l  %%d2,%%d3       \n"
-        "lsr.l   #8,%%d3         \n"
-        "move.w  %%d3,(%[buf])+  \n" /* write bytes 2 and 3 as word */
-
-    ".end_u_w1:                  \n"
-        "moveq.l #12,%%d0        \n"
-        "add.l   %[buf],%%d0     \n"
-        "and.l   #0xFFFFFFF0,%%d0\n" /* d0 == first line bound */
-        "cmp.l   %[buf],%%d0     \n" /* any leading longwords? */
-        "bls.b   .end_u_l1       \n" /* no: skip loop */
-        
-    ".loop_u_l1:                 \n"
-        "move.w  (%[ata]),%%d3   \n" /* load first word */
-        "swap    %%d3            \n" /* move to upper 16 bit */
-        "move.w  (%[ata]),%%d3   \n" /* load second word */
-        "move.l  %%d3,%%d4       \n"
-        "lsl.l   %%d1,%%d2       \n"
-        "lsr.l   #8,%%d3         \n"
-        "or.l    %%d3,%%d2       \n" /* combine old low byte with new top 3 bytes */
-        "move.l  %%d2,(%[buf])+  \n" /* store as long */
-        "move.l  %%d4,%%d2       \n"
-        "cmp.l   %[buf],%%d0     \n" /* run up to first line bound */
-        "bhi.b   .loop_u_l1      \n"
-
-    ".end_u_l1:                  \n"
-        "lea.l   (-14,%[end]),%[end] \n" /* adjust end addr. to 16 bytes/pass */
-
-    ".loop_u_line:               \n"
-        "move.w  (%[ata]),%%d3   \n" /* load 1st word */
-        "swap    %%d3            \n" /* move to upper 16 bit */
-        "move.w  (%[ata]),%%d3   \n" /* load 2nd word */
-        "move.l  %%d3,%%d0       \n"
-        "lsl.l   %%d1,%%d2       \n"
-        "lsr.l   #8,%%d0         \n"
-        "or.l    %%d0,%%d2       \n" /* combine old low byte with new top 3 bytes */
-        "move.w  (%[ata]),%%d4   \n" /* load 3rd word */
-        "swap    %%d4            \n" /* move to upper 16 bit */
-        "move.w  (%[ata]),%%d4   \n" /* load 4th word */
-        "move.l  %%d4,%%d0       \n"
-        "lsl.l   %%d1,%%d3       \n"
-        "lsr.l   #8,%%d0         \n"
-        "or.l    %%d0,%%d3       \n" /* combine old low byte with new top 3 bytes */
-        "move.w  (%[ata]),%%d5   \n" /* load 5th word */
-        "swap    %%d5            \n" /* move to upper 16 bit */
-        "move.w  (%[ata]),%%d5   \n" /* load 6th word */
-        "move.l  %%d5,%%d0       \n"
-        "lsl.l   %%d1,%%d4       \n"
-        "lsr.l   #8,%%d0         \n"
-        "or.l    %%d0,%%d4       \n" /* combine old low byte with new top 3 bytes */
-        "move.w  (%[ata]),%%d6   \n" /* load 7th word */
-        "swap    %%d6            \n" /* move to upper 16 bit */
-        "move.w  (%[ata]),%%d6   \n" /* load 8th word */
-        "move.l  %%d6,%%d0       \n"
-        "lsl.l   %%d1,%%d5       \n"
-        "lsr.l   #8,%%d0         \n"
-        "or.l    %%d0,%%d5       \n" /* combine old low byte with new top 3 bytes */
-        "movem.l %%d2-%%d5,(%[buf])  \n"  /* store line */
-        "lea.l   (16,%[buf]),%[buf]  \n"
-        "move.l  %%d6,%%d2       \n"
-        "cmp.l   %[buf],%[end]   \n" /* run up to last line bound */
-        "bhi.b   .loop_u_line    \n"
-
-        "lea.l   (12,%[end]),%[end]  \n"  /* readjust for longword loop */
-        "cmp.l   %[buf],%[end]   \n" /* any trailing longwords? */
-        "bls.b   .end_u_l2       \n" /* no: skip loop */
-
-    ".loop_u_l2:                 \n"
-        "move.w  (%[ata]),%%d3   \n" /* load first word */
-        "swap    %%d3            \n" /* move to upper 16 bit */
-        "move.w  (%[ata]),%%d3   \n" /* load second word */
-        "move.l  %%d3,%%d4       \n"
-        "lsl.l   %%d1,%%d2       \n"
-        "lsr.l   #8,%%d3         \n"
-        "or.l    %%d3,%%d2       \n" /* combine old low byte with new top 3 bytes */
-        "move.l  %%d2,(%[buf])+  \n" /* store as long */
-        "move.l  %%d4,%%d2       \n"
-        "cmp.l   %[buf],%[end]   \n" /* run up to last long bound */
-        "bhi.b   .loop_u_l2      \n"
-        
-    ".end_u_l2:                  \n"
-        "addq.l  #2,%[end]       \n" /* back to final end address */
-        "cmp.l   %[buf],%[end]   \n" /* one word left? */
-        "bls.b   .end_u_w2       \n"
-
-        "swap    %%d2            \n" /* move old word to upper 16 bits */
-        "move.w  (%[ata]),%%d2   \n" /* load final word */
-        "move.l  %%d2,%%d3       \n"
-        "lsr.l   #8,%%d3         \n"
-        "move.w  %%d3,(%[buf])+  \n" /* write bytes 2 and 3 as word */
-
-    ".end_u_w2:                  \n"
-        "move.b  %%d2,(%[buf])+  \n" /* store final byte */
-        "bra.b   .exit           \n"
-
-        /* 16-bit aligned */
-    ".aligned:                   \n"
-        "btst.l  #1,%%d0         \n" /* longword aligned? */
-        "beq.b   .end_a_w1       \n" /* yes, skip leading word handling */
-
-        "move.w  (%[ata]),(%[buf])+  \n"  /* copy initial word */
-
-    ".end_a_w1:                  \n"
-        "moveq.l #12,%%d0        \n"
-        "add.l   %[buf],%%d0     \n"
-        "and.l   #0xFFFFFFF0,%%d0\n" /* d0 == first line bound */
-        "cmp.l   %[buf],%%d0     \n" /* any leading longwords? */
-        "bls.b   .end_a_l1       \n" /* no: skip loop */
-
-    ".loop_a_l1:                 \n"
-        "move.w  (%[ata]),%%d1   \n" /* load first word */
-        "swap    %%d1            \n" /* move it to upper 16 bits */
-        "move.w  (%[ata]),%%d1   \n" /* load second word */
-        "move.l  %%d1,(%[buf])+  \n" /* store as long */
-        "cmp.l   %[buf],%%d0     \n" /* run up to first line bound */
-        "bhi.b   .loop_a_l1      \n"
-
-    ".end_a_l1:                  \n"
-        "lea.l   (-14,%[end]),%[end] \n" /* adjust end addr. to 16 bytes/pass */
-
-    ".loop_a_line:               \n"
-        "move.w  (%[ata]),%%d0   \n" /* load 1st word */
-        "swap    %%d0            \n" /* move it to upper 16 bits */
-        "move.w  (%[ata]),%%d0   \n" /* load 2nd word */
-        "move.w  (%[ata]),%%d1   \n" /* load 3rd word */
-        "swap    %%d1            \n" /* move it to upper 16 bits */
-        "move.w  (%[ata]),%%d1   \n" /* load 4th word */
-        "move.w  (%[ata]),%%d2   \n" /* load 5th word */
-        "swap    %%d2            \n" /* move it to upper 16 bits */
-        "move.w  (%[ata]),%%d2   \n" /* load 6th word */
-        "move.w  (%[ata]),%%d3   \n" /* load 7th word */
-        "swap    %%d3            \n" /* move it to upper 16 bits */
-        "move.w  (%[ata]),%%d3   \n" /* load 8th word */
-        "movem.l %%d0-%%d3,(%[buf])  \n"  /* store line */
-        "lea.l   (16,%[buf]),%[buf]  \n"
-        "cmp.l   %[buf],%[end]   \n" /* run up to last line bound */
-        "bhi.b   .loop_a_line    \n"
-        
-        "lea.l   (12,%[end]),%[end]  \n"  /* readjust for longword loop */
-        "cmp.l   %[buf],%[end]   \n" /* any trailing longwords? */
-        "bls.b   .end_a_l2       \n" /* no: skip loop */
-
-    ".loop_a_l2:                 \n"
-        "move.w  (%[ata]),%%d1   \n" /* read first word */
-        "swap    %%d1            \n" /* move it to upper 16 bits */
-        "move.w  (%[ata]),%%d1   \n" /* read second word */
-        "move.l  %%d1,(%[buf])+  \n" /* store as long */
-        "cmp.l   %[buf],%[end]   \n" /* run up to last long bound */
-        "bhi.b   .loop_a_l2      \n"
-        
-    ".end_a_l2:                  \n"
-        "addq.l  #2,%[end]       \n" /* back to final end address */
-        "cmp.l   %[buf],%[end]   \n" /* one word left? */
-        "bls.b   .end_a_w2       \n"
-
-        "move.w  (%[ata]),(%[buf])+  \n"  /* copy final word */
-
-    ".end_a_w2:                  \n"
-
-    ".exit:                      \n"
-        : /* outputs */
-        [buf]"+a"(buf),
-        [end]"+a"(bufend)
-        : /* inputs */
-        [ata]"a"(&ATA_DATA)
-        : /*trashed */
-        "d0", "d1", "d2", "d3", "d4", "d5", "d6"
-    );
-#else
-    /* SH1 turbo-charged assembler reading */
-    /* this assumes wordcount to be a multiple of 4 */
-    asm volatile (
-        "mov     %[buf],r0       \n"
-        "tst     #1,r0           \n"  /* 16-bit aligned ? */
-        "bt      .aligned        \n"  /* yes, do word copy */
-
-        /* not 16-bit aligned */
-        "mov     #-1,r3          \n"  /* prepare a bit mask for high byte */
-        "shll8   r3              \n"  /* r3 = 0xFFFFFF00 */
-
-        "mov.w   @%[ata],r2      \n"  /* read first word (1st round) */
-        "mov.b   r2,@%[buf]      \n"  /* store low byte of first word */
-        "bra     .start4_b       \n"  /* jump into loop after next instr. */
-        "add     #-5,%[buf]      \n"  /* adjust for dest. offsets; now even */
-
-        ".align  2               \n"
-    ".loop4_b:                   \n"  /* main loop: copy 4 words in a row */
-        "mov.w   @%[ata],r2      \n"  /* read first word (2+ round) */
-        "and     r3,r1           \n"  /* get high byte of fourth word (2+ round) */
-        "extu.b  r2,r0           \n"  /* get low byte of first word (2+ round) */
-        "or      r1,r0           \n"  /* combine with high byte of fourth word */
-        "mov.w   r0,@(4,%[buf])  \n"  /* store at buf[4] */
-        "nop                     \n"  /* maintain alignment */
-    ".start4_b:                  \n"
-        "mov.w   @%[ata],r1      \n"  /* read second word */
-        "and     r3,r2           \n"  /* get high byte of first word */
-        "extu.b  r1,r0           \n"  /* get low byte of second word */
-        "or      r2,r0           \n"  /* combine with high byte of first word */
-        "mov.w   r0,@(6,%[buf])  \n"  /* store at buf[6] */
-        "add     #8,%[buf]       \n"  /* buf += 8 */
-        "mov.w   @%[ata],r2      \n"  /* read third word */
-        "and     r3,r1           \n"  /* get high byte of second word */
-        "extu.b  r2,r0           \n"  /* get low byte of third word */
-        "or      r1,r0           \n"  /* combine with high byte of second word */
-        "mov.w   r0,@%[buf]      \n"  /* store at buf[0] */
-        "cmp/hi  %[buf],%[end]   \n"  /* check for end */
-        "mov.w   @%[ata],r1      \n"  /* read fourth word */
-        "and     r3,r2           \n"  /* get high byte of third word */
-        "extu.b  r1,r0           \n"  /* get low byte of fourth word */
-        "or      r2,r0           \n"  /* combine with high byte of third word */
-        "mov.w   r0,@(2,%[buf])  \n"  /* store at buf[2] */
-        "bt      .loop4_b        \n"
-        /* 24 instructions for 4 copies, takes 30 clock cycles (4 wait) */
-        /* avg. 7.5 cycles per word - 86% faster */
-
-        "swap.b  r1,r0           \n"  /* get high byte of last word */
-        "bra     .exit           \n"
-        "mov.b   r0,@(4,%[buf])  \n"  /* and store it */
-
-        /* 16-bit aligned, loop(read and store word) */
-    ".aligned:                   \n"
-        "mov.w   @%[ata],r2      \n"  /* read first word (1st round) */
-        "bra     .start4_w       \n"  /* jump into loop after next instr. */
-        "add     #-6,%[buf]      \n"  /* adjust for destination offsets */
-
-        ".align  2               \n"
-    ".loop4_w:                   \n"  /* main loop: copy 4 words in a row */
-        "mov.w   @%[ata],r2      \n"  /* read first word (2+ round) */
-        "swap.b  r1,r0           \n"  /* swap fourth word (2+ round) */
-        "mov.w   r0,@(4,%[buf])  \n"  /* store fourth word (2+ round) */
-        "nop                     \n"  /* maintain alignment */
-    ".start4_w:                  \n"
-        "mov.w   @%[ata],r1      \n"  /* read second word */
-        "swap.b  r2,r0           \n"  /* swap first word */
-        "mov.w   r0,@(6,%[buf])  \n"  /* store first word in buf[6] */
-        "add     #8,%[buf]       \n"  /* buf += 8 */
-        "mov.w   @%[ata],r2      \n"  /* read third word */
-        "swap.b  r1,r0           \n"  /* swap second word */
-        "mov.w   r0,@%[buf]      \n"  /* store second word in buf[0] */
-        "cmp/hi  %[buf],%[end]   \n"  /* check for end */
-        "mov.w   @%[ata],r1      \n"  /* read fourth word */
-        "swap.b  r2,r0           \n"  /* swap third word */
-        "mov.w   r0,@(2,%[buf])  \n"  /* store third word */
-        "bt      .loop4_w        \n"
-        /* 16 instructions for 4 copies, takes 22 clock cycles (4 wait) */
-        /* avg. 5.5 cycles per word - 118% faster */
-
-        "swap.b  r1,r0           \n"  /* swap fourth word (last round) */
-        "mov.w   r0,@(4,%[buf])  \n"  /* and store it */
-
-    ".exit:                      \n"
-        : /* outputs */
-        [buf]"+r"(buf)
-        : /* inputs */
-        [end]"r"(buf + 2 * wordcount - 12), /* adjusted for offsets */
-        [ata]"r"(&ATA_DATA)
-        : /*trashed */
-        "r0","r1","r2","r3"
-    );
-#endif /* CPU */
-#endif /* !PREFER_C_READING */
-}
-
-#if CONFIG_LED == LED_REAL
-/* Conditionally block LED access for the ATA driver, so the LED can be
- * (mis)used for other purposes */
-static void ata_led(bool on) {
-    ata_led_on = on;
-    if (ata_led_enabled) {
-        led(ata_led_on);
-    }
 }
-#else
-#define ata_led(on) led(on)
-#endif
+#endif /* !ATA_OPTIMIZED_READING */
 
 int ata_read_sectors(IF_MV2(int drive,)
                      unsigned long start,
@@ -696,13 +344,10 @@ int ata_read_sectors(IF_MV2(int drive,)
     return ret;
 }
 
-/* the tight loop of ata_write_sectors(), to avoid the whole in IRAM */
-static void copy_write_sectors(const unsigned char* buf, int wordcount) 
-                               ICODE_ATTR NOINLINE_ATTR;
+#ifndef ATA_OPTIMIZED_WRITING
+static void copy_write_sectors(const unsigned char* buf, int wordcount) ICODE_ATTR;
 static void copy_write_sectors(const unsigned char* buf, int wordcount)
 {
-#ifdef PREFER_C_WRITING
-
     if ( (unsigned long)buf & 1)
     {   /* not 16-bit aligned, copy byte by byte */
         unsigned short tmp = 0;
@@ -710,11 +355,9 @@ static void copy_write_sectors(const unsigned char* buf, int wordcount)
         do
         {
 #if defined(SWAP_WORDS) || defined(ROCKBOX_LITTLE_ENDIAN)
-            /* SH1: loop compiles to 9 assembler instructions */
-            /* takes 13 clock cycles (2 pipeline stalls) */
             tmp = (unsigned short) *buf++;
-            tmp |= (unsigned short) *buf++ << 8; /* I assume big endian */
-            SET_16BITREG(ATA_DATA, tmp);  /* and don't use the SWAB16 macro */
+            tmp |= (unsigned short) *buf++ << 8;
+            SET_16BITREG(ATA_DATA, tmp);
 #else
             tmp = (unsigned short) *buf++ << 8;
             tmp |= (unsigned short) *buf++;
@@ -729,298 +372,14 @@ static void copy_write_sectors(const unsigned char* buf, int wordcount)
         do
         {
 #ifdef SWAP_WORDS
-            /* loop compiles to 6 assembler instructions */
-            /* takes 10 clock cycles (2 pipeline stalls) */
             SET_16BITREG(ATA_DATA, swap16(*wbuf));
 #else
             SET_16BITREG(ATA_DATA, *wbuf);
 #endif
         } while (++wbuf < wbufend); /* tail loop is faster */
     }
-#else /* !PREFER_C_WRITING */
-#ifdef CPU_COLDFIRE
-    const unsigned char* bufend = buf + 2 * wordcount;
-    /* coldfire asm writing, utilising line bursts */
-    asm volatile (
-        "move.l  %[buf],%%d0     \n"
-        "btst.l  #0,%%d0         \n" /* 16-bit aligned? */
-        "jeq     .w_aligned      \n" /* yes, do word copy */
-
-        /* not 16-bit aligned */
-        "subq.l  #1,%[end]       \n" /* last byte is done unconditionally */
-        "moveq.l #24,%%d1        \n" /* preload shift count */
-
-        "move.b  (%[buf])+,%%d2  \n"
-
-        "btst.l  #1,%%d0         \n" /* longword aligned? */
-        "beq.b   .w_end_u_w1     \n" /* yes, skip leading word handling */
-
-        "swap    %%d2            \n"
-        "move.w  (%[buf])+,%%d2  \n"
-        "move.l  %%d2,%%d3       \n"
-        "lsr.l   #8,%%d3         \n"
-        "move.w  %%d3,(%[ata])   \n"
-        
-    ".w_end_u_w1:                \n"
-        "moveq.l #12,%%d0        \n"
-        "add.l   %[buf],%%d0     \n"
-        "and.l   #0xFFFFFFF0,%%d0\n" /* d0 == first line bound */
-        "cmp.l   %[buf],%%d0     \n" /* any leading longwords? */
-        "bls.b   .w_end_u_l1     \n" /* no: skip loop */
-        
-    ".w_loop_u_l1:               \n"
-        "move.l  (%[buf])+,%%d3  \n"
-        "move.l  %%d3,%%d4       \n"
-        "lsl.l   %%d1,%%d2       \n"
-        "lsr.l   #8,%%d3         \n"
-        "or.l    %%d3,%%d2       \n"
-        "swap    %%d2            \n"
-        "move.w  %%d2,(%[ata])   \n"
-        "swap    %%d2            \n"
-        "move.w  %%d2,(%[ata])   \n"
-        "move.l  %%d4,%%d2       \n"
-        "cmp.l   %[buf],%%d0     \n" /* run up to first line bound */
-        "bhi.b   .w_loop_u_l1    \n"
-
-    ".w_end_u_l1:                \n"
-        "lea.l   (-14,%[end]),%[end] \n" /* adjust end addr. to 16 bytes/pass */
-
-    ".w_loop_u_line:             \n"
-        "movem.l (%[buf]),%%d3-%%d6  \n"
-        "lea.l   (16,%[buf]),%[buf]  \n"
-        "move.l  %%d3,%%d0       \n"
-        "lsl.l   %%d1,%%d2       \n"
-        "lsr.l   #8,%%d0         \n"
-        "or.l    %%d0,%%d2       \n"
-        "swap    %%d2            \n"
-        "move.w  %%d2,(%[ata])   \n"
-        "swap    %%d2            \n"
-        "move.w  %%d2,(%[ata])   \n"
-        "move.l  %%d4,%%d0       \n"
-        "lsl.l   %%d1,%%d3       \n"
-        "lsr.l   #8,%%d0         \n"
-        "or.l    %%d0,%%d3       \n"
-        "swap    %%d3            \n"
-        "move.w  %%d3,(%[ata])   \n"
-        "swap    %%d3            \n"
-        "move.w  %%d3,(%[ata])   \n"
-        "move.l  %%d5,%%d0       \n"
-        "lsl.l   %%d1,%%d4       \n"
-        "lsr.l   #8,%%d0         \n"
-        "or.l    %%d0,%%d4       \n"
-        "swap    %%d4            \n"
-        "move.w  %%d4,(%[ata])   \n"
-        "swap    %%d4            \n"
-        "move.w  %%d4,(%[ata])   \n"
-        "move.l  %%d6,%%d0       \n"
-        "lsl.l   %%d1,%%d5       \n"
-        "lsr.l   #8,%%d0         \n"
-        "or.l    %%d0,%%d5       \n"
-        "swap    %%d5            \n"
-        "move.w  %%d5,(%[ata])   \n"
-        "swap    %%d5            \n"
-        "move.w  %%d5,(%[ata])   \n"
-        "move.l  %%d6,%%d2       \n"
-        "cmp.l   %[buf],%[end]   \n" /* run up to last line bound */
-        "bhi.b   .w_loop_u_line  \n"
-
-        "lea.l   (12,%[end]),%[end]  \n"  /* readjust for longword loop */
-        "cmp.l   %[buf],%[end]   \n" /* any trailing longwords? */
-        "bls.b   .w_end_u_l2     \n" /* no: skip loop */
-
-    ".w_loop_u_l2:               \n"
-        "move.l  (%[buf])+,%%d3  \n"
-        "move.l  %%d3,%%d4       \n"
-        "lsl.l   %%d1,%%d2       \n"
-        "lsr.l   #8,%%d3         \n"
-        "or.l    %%d3,%%d2       \n"
-        "swap    %%d2            \n"
-        "move.w  %%d2,(%[ata])   \n"
-        "swap    %%d2            \n"
-        "move.w  %%d2,(%[ata])   \n"
-        "move.l  %%d4,%%d2       \n"
-        "cmp.l   %[buf],%[end]   \n" /* run up to first line bound */
-        "bhi.b   .w_loop_u_l2    \n"
-
-    ".w_end_u_l2:                \n"
-        "addq.l  #2,%[end]       \n" /* back to final end address */
-        "cmp.l   %[buf],%[end]   \n" /* one word left? */
-        "bls.b   .w_end_u_w2     \n"
-
-        "swap    %%d2            \n"
-        "move.w  (%[buf])+,%%d2  \n"
-        "move.l  %%d2,%%d3       \n"
-        "lsr.l   #8,%%d3         \n"
-        "move.w  %%d3,(%[ata])   \n"
-
-    ".w_end_u_w2:                \n"
-        "lsl.l   #8,%%d2         \n"
-        "move.b  (%[buf])+,%%d2  \n"
-        "move.w  %%d2,(%[ata])   \n"
-        "bra.b    .w_exit        \n"
-
-        /* 16-bit aligned */
-    ".w_aligned:                 \n"
-        "btst.l  #1,%%d0         \n"
-        "beq.b   .w_end_a_w1     \n"
-
-        "move.w  (%[buf])+,(%[ata])  \n"  /* copy initial word */
-
-    ".w_end_a_w1:                \n"
-        "moveq.l #12,%%d0        \n"
-        "add.l   %[buf],%%d0     \n"
-        "and.l   #0xFFFFFFF0,%%d0\n" /* d0 == first line bound */
-        "cmp.l   %[buf],%%d0     \n" /* any leading longwords? */
-        "bls.b   .w_end_a_l1     \n" /* no: skip loop */
-
-    ".w_loop_a_l1:               \n"
-        "move.l  (%[buf])+,%%d1  \n"
-        "swap    %%d1            \n"
-        "move.w  %%d1,(%[ata])   \n"
-        "swap    %%d1            \n"
-        "move.w  %%d1,(%[ata])   \n"
-        "cmp.l   %[buf],%%d0     \n" /* run up to first line bound */
-        "bhi.b   .w_loop_a_l1    \n"
-
-    ".w_end_a_l1:                \n"
-        "lea.l   (-14,%[end]),%[end] \n" /* adjust end addr. to 16 bytes/pass */
-
-    ".w_loop_a_line:             \n"
-        "movem.l (%[buf]),%%d0-%%d3  \n"
-        "lea.l   (16,%[buf]),%[buf]  \n"
-        "swap    %%d0            \n"
-        "move.w  %%d0,(%[ata])   \n"
-        "swap    %%d0            \n"
-        "move.w  %%d0,(%[ata])   \n"
-        "swap    %%d1            \n"
-        "move.w  %%d1,(%[ata])   \n"
-        "swap    %%d1            \n"
-        "move.w  %%d1,(%[ata])   \n"
-        "swap    %%d2            \n"
-        "move.w  %%d2,(%[ata])   \n"
-        "swap    %%d2            \n"
-        "move.w  %%d2,(%[ata])   \n"
-        "swap    %%d3            \n"
-        "move.w  %%d3,(%[ata])   \n"
-        "swap    %%d3            \n"
-        "move.w  %%d3,(%[ata])   \n"
-        "cmp.l   %[buf],%[end]   \n" /* run up to last line bound */
-        "bhi.b   .w_loop_a_line  \n"
-        
-        "lea.l   (12,%[end]),%[end]  \n"  /* readjust for longword loop */
-        "cmp.l   %[buf],%[end]   \n" /* any trailing longwords? */
-        "bls.b   .w_end_a_l2     \n" /* no: skip loop */
-
-    ".w_loop_a_l2:               \n"
-        "move.l  (%[buf])+,%%d1  \n"
-        "swap    %%d1            \n"
-        "move.w  %%d1,(%[ata])   \n"
-        "swap    %%d1            \n"
-        "move.w  %%d1,(%[ata])   \n"
-        "cmp.l   %[buf],%[end]   \n" /* run up to first line bound */
-        "bhi.b   .w_loop_a_l2    \n"
-
-    ".w_end_a_l2:                \n"
-        "addq.l  #2,%[end]       \n" /* back to final end address */
-        "cmp.l   %[buf],%[end]   \n" /* one word left? */
-        "bls.b   .w_end_a_w2     \n"
-
-        "move.w  (%[buf])+,(%[ata])  \n"  /* copy final word */
-
-    ".w_end_a_w2:                \n"
-
-    ".w_exit:                    \n"
-        : /* outputs */
-        [buf]"+a"(buf),
-        [end]"+a"(bufend)
-        : /* inputs */
-        [ata]"a"(&ATA_DATA)
-        : /*trashed */
-        "d0", "d1", "d2", "d3", "d4", "d5", "d6"
-    );
-#else
-    /* SH1 optimized assembler version */
-    /* this assumes wordcount to be a multiple of 2 */
-
-/* writing is not unrolled as much as reading, for several reasons:
- * - a similar instruction sequence is faster for writing than for reading
- *   because the auto-incrementing load inctructions can be used
- * - writing profits from warp mode
- * Both of these add up to have writing faster than the more unrolled reading.
- */
-    asm volatile (
-        "mov     %[buf],r0       \n"
-        "tst     #1,r0           \n"  /* 16-bit aligned ? */
-        "bt      .w_aligned      \n"  /* yes, do word copy */
-
-        /* not 16-bit aligned */
-        "mov     #-1,r6          \n"  /* prepare a bit mask for high byte */
-        "shll8   r6              \n"  /* r6 = 0xFFFFFF00 */
-
-        "mov.b   @%[buf]+,r2     \n"  /* load (initial old second) first byte */
-        "mov.w   @%[buf]+,r3     \n"  /* load (initial) first word */
-        "bra     .w_start2_b     \n"
-        "extu.b  r2,r0           \n"  /* extend unsigned */
-
-        ".align  2               \n"
-    ".w_loop2_b:                 \n"  /* main loop: copy 2 words in a row */
-        "mov.w   @%[buf]+,r3     \n"  /* load first word (2+ round) */
-        "extu.b  r2,r0           \n"  /* put away low byte of second word (2+ round) */
-        "and     r6,r2           \n"  /* get high byte of second word (2+ round) */
-        "or      r1,r2           \n"  /* combine with low byte of old first word */
-        "mov.w   r2,@%[ata]      \n"  /* write that */
-    ".w_start2_b:                \n"
-        "cmp/hi  %[buf],%[end]   \n"  /* check for end */
-        "mov.w   @%[buf]+,r2     \n"  /* load second word */
-        "extu.b  r3,r1           \n"  /* put away low byte of first word */
-        "and     r6,r3           \n"  /* get high byte of first word */
-        "or      r0,r3           \n"  /* combine with high byte of old second word */
-        "mov.w   r3,@%[ata]      \n"  /* write that */
-        "bt      .w_loop2_b      \n"
-        /* 12 instructions for 2 copies, takes 14 clock cycles */
-        /* avg. 7 cycles per word - 85% faster */
-
-        /* the loop "overreads" 1 byte past the buffer end, however, the last */
-        /* byte is not written to disk */
-        "and     r6,r2           \n"  /* get high byte of last word */
-        "or      r1,r2           \n"  /* combine with low byte of old first word */
-        "bra     .w_exit         \n"
-        "mov.w   r2,@%[ata]      \n"  /* write last word */
-
-        /* 16-bit aligned, loop(load and write word) */
-    ".w_aligned:                 \n"
-        "bra     .w_start2_w     \n"  /* jump into loop after next instr. */
-        "mov.w   @%[buf]+,r2     \n"  /* load first word (1st round) */
-
-        ".align  2               \n"
-    ".w_loop2_w:                 \n"  /* main loop: copy 2 words in a row */
-        "mov.w   @%[buf]+,r2     \n"  /* load first word (2+ round) */
-        "swap.b  r1,r0           \n"  /* swap second word (2+ round) */
-        "mov.w   r0,@%[ata]      \n"  /* write second word (2+ round) */
-    ".w_start2_w:                \n"
-        "cmp/hi  %[buf],%[end]   \n"  /* check for end */
-        "mov.w   @%[buf]+,r1     \n"  /* load second word */
-        "swap.b  r2,r0           \n"  /* swap first word */
-        "mov.w   r0,@%[ata]      \n"  /* write first word */
-        "bt      .w_loop2_w      \n"
-        /* 8 instructions for 2 copies, takes 10 clock cycles */
-        /* avg. 5 cycles per word - 100% faster */
-
-        "swap.b  r1,r0           \n"  /* swap second word (last round) */
-        "mov.w   r0,@%[ata]      \n"  /* and write it */
-
-    ".w_exit:                    \n"
-        : /* outputs */
-        [buf]"+r"(buf)
-        : /* inputs */
-        [end]"r"(buf + 2 * wordcount - 4), /* adjusted for earl check */
-        [ata]"r"(&ATA_DATA)
-        : /*trashed */
-        "r0","r1","r2","r3","r6"
-    );
-#endif /* CPU */
-#endif /* !PREFER_C_WRITING */
 }
+#endif /* !ATA_OPTIMIZED_WRITING */
 
 int ata_write_sectors(IF_MV2(int drive,)
                       unsigned long start,
@@ -1306,17 +665,7 @@ int ata_hard_reset(void)
 {
     int ret;
 
-#ifdef TARGET_TREE
     ata_reset();
-#elif CONFIG_CPU == SH7034
-    /* state HRR0 */
-    and_b(~0x02, &PADRH); /* assert _RESET */
-    sleep(1); /* > 25us */
-
-    /* state HRR1 */
-    or_b(0x02, &PADRH); /* negate _RESET */
-    sleep(1); /* > 2ms */
-#endif
 
     /* state HRR2 */
     SET_REG(ATA_SELECT, ata_device); /* select the right device */
@@ -1416,36 +765,6 @@ static int master_slave_detect(void)
     return 0;
 }
 
-#if CONFIG_CPU == SH7034 /* special archos quirk */
-static void io_address_detect(void)
-{   /* now, use the HW mask instead of probing */
-    if (read_hw_mask() & ATA_ADDRESS_200)
-    {
-        ata_io_address = 0x200; /* For debug purposes only */
-        ata_control = ATA_CONTROL1;
-    }
-    else
-    {
-        ata_io_address = 0x300; /* For debug purposes only */
-        ata_control = ATA_CONTROL2;
-    }
-}
-#endif
-
-#ifndef TARGET_TREE
-void ata_enable(bool on)
-{
-#if CONFIG_CPU == SH7034
-    if(on)
-        and_b(~0x80, &PADRL); /* enable ATA */
-    else
-        or_b(0x80, &PADRL); /* disable ATA */
-
-    or_b(0x80, &PAIORL);
-#endif
-}
-#endif
-
 static int identify(void)
 {
     int i;
@@ -1589,39 +908,12 @@ static int init_and_check(bool hard_reset)
 int ata_init(void)
 {
     int rc;
-#ifdef TARGET_TREE
     bool coldstart = ata_is_coldstart();
-#else
-    bool coldstart = (PACR2 & 0x4000) != 0;
-#endif
 
     mutex_init(&ata_mtx);
 
     ata_led(false);
-
-#ifdef TARGET_TREE
     ata_device_init();
-#elif CONFIG_CPU == SH7034
-    /* Port A setup */
-    or_b(0x02, &PAIORH); /* output for ATA reset */
-    or_b(0x02, &PADRH); /* release ATA reset */
-    PACR2 &= 0xBFFF; /* GPIO function for PA7 (IDE enable) */
-#elif CONFIG_CPU == MCF5249
-#ifdef HAVE_ATA_LED_CTRL
-    /* Enable disk LED & ISD chip power control */
-    and_l(~0x0000240, &GPIO_OUT);
-    or_l(0x00000240, &GPIO_ENABLE);
-    or_l(0x00000200, &GPIO_FUNCTION);
-#endif
-    
-    /* ATA reset */
-    or_l(0x00080000, &GPIO_OUT);
-    or_l(0x00080000, &GPIO_ENABLE);
-    or_l(0x00080000, &GPIO_FUNCTION);
-
-    /* FYI: The IDECONFIGx registers are set by set_cpu_frequency() */
-#endif
-
     sleeping = false;
     ata_enable(true);
 
@@ -1632,8 +924,8 @@ int ata_init(void)
             sleep(HZ); /* allow voltage to build up */
         }
 
-#if CONFIG_CPU == SH7034
-        io_address_detect();
+#ifdef ATA_ADDRESS_DETECT
+        ata_address_detect();
 #endif  
         /* first try, hard reset at cold start only */
         rc = init_and_check(coldstart);  
@@ -1680,12 +972,12 @@ int ata_init(void)
 }
 
 #if CONFIG_LED == LED_REAL
-void ata_set_led_enabled(bool enabled) {
+void ata_set_led_enabled(bool enabled) 
+{
     ata_led_enabled = enabled;
-    if (ata_led_enabled) {
+    if (ata_led_enabled)
         led(ata_led_on);
-    } else {
+    else
         led(false);
-    }
 }
 #endif
diff --git a/firmware/target/arm/ata-target.h b/firmware/target/arm/ata-target.h
index 0e4c187e27..0f25f89d6b 100644
--- a/firmware/target/arm/ata-target.h
+++ b/firmware/target/arm/ata-target.h
@@ -20,8 +20,6 @@
 #if (CONFIG_CPU == PP5002) || (CONFIG_CPU == PP5020)
 
 /* Plain C read & write loops */
-#define PREFER_C_READING
-#define PREFER_C_WRITING
 
 #if (CONFIG_CPU == PP5002)
 #define ATA_IOBASE      0xc00031e0
diff --git a/firmware/target/arm/gigabeat/meg-fx/ata-target.h b/firmware/target/arm/gigabeat/meg-fx/ata-target.h
index 95b66ab1bd..1d49a1b874 100644
--- a/firmware/target/arm/gigabeat/meg-fx/ata-target.h
+++ b/firmware/target/arm/gigabeat/meg-fx/ata-target.h
@@ -20,8 +20,6 @@
 #define ATA_TARGET_H
 
 /* Plain C read & write loops */
-#define PREFER_C_READING
-#define PREFER_C_WRITING
 
 #define ATA_IOBASE      0x18000000
 #define ATA_DATA        (*((volatile unsigned short*)(ATA_IOBASE)))
diff --git a/firmware/target/coldfire/ata-as-coldfire.S b/firmware/target/coldfire/ata-as-coldfire.S
new file mode 100755
index 0000000000..3b0d67f8e4
--- /dev/null
+++ b/firmware/target/coldfire/ata-as-coldfire.S
@@ -0,0 +1,459 @@
+/***************************************************************************
+ *             __________               __   ___.
+ *   Open      \______   \ ____   ____ |  | _\_ |__   _______  ___
+ *   Source     |       _//  _ \_/ ___\|  |/ /| __ \ /  _ \  \/  /
+ *   Jukebox    |    |   (  <_> )  \___|    < | \_\ (  <_> > <  <
+ *   Firmware   |____|_  /\____/ \___  >__|_ \|___  /\____/__/\_ \
+ *                     \/            \/     \/    \/            \/
+ * $Id$
+ *
+ * Copyright (C) 2006 by Jens Arnold
+ *
+ * All files in this archive are subject to the GNU General Public License.
+ * See the file COPYING in the source tree root for full license agreement.
+ *
+ * This software is distributed on an "AS IS" basis, WITHOUT WARRANTY OF ANY
+ * KIND, either express or implied.
+ *
+ ****************************************************************************/
+
+    .section    .icode,"ax",@progbits
+
+    .equ    .ata_port, 0x20000020
+
+    .align  2
+    .global copy_read_sectors
+    .type   copy_read_sectors,@function
+    
+/* Read a number of words from the ATA data port
+ *
+ * Utilises line bursts, assumes there is at least one full line to copy.
+ *
+ * Arguments:
+ *   (4,%sp) - buffer address
+ *   (8,%sp) - word count
+ *
+ * Register usage:
+ *   %a0 - current address
+ *   %a1 - end address
+ *   %a2 - ata port
+ *   %d0 - scratch
+ *   %d1 - shift count
+ *   %d2-%d6 - read buffers
+ */
+
+copy_read_sectors:
+    lea.l   (-24, %sp), %sp
+    movem.l %d2-%d6/%a2, (%sp)
+    movem.l (28, %sp), %a0-%a1
+    add.l   %a1, %a1
+    add.l   %a0, %a1
+    lea.l   .ata_port, %a2
+
+    move.l  %a0, %d0
+    btst.l  #0, %d0         /* 16-bit aligned? */
+    jeq     .r_aligned      /* yes, do word copy */
+
+    /* not 16-bit aligned */
+    subq.l  #1, %a1         /* last byte is done unconditionally */
+    moveq.l #24, %d1        /* preload shift count */
+
+    move.w  (%a2), %d2      /* load initial word */
+    move.l  %d2, %d3
+    lsr.l   #8, %d3
+    move.b  %d3, (%a0)+     /* write high byte of it, aligns dest addr */
+        
+    btst.l  #1, %d0         /* longword aligned? */
+    beq.b   .r_end_u_w1     /* yes, skip leading word handling */
+
+    swap    %d2             /* move initial word up */
+    move.w  (%a2), %d2      /* combine with second word */
+    move.l  %d2, %d3
+    lsr.l   #8, %d3
+    move.w  %d3, (%a0)+     /* write bytes 2 and 3 as word */
+
+.r_end_u_w1:
+    moveq.l #12, %d0
+    add.l   %a0, %d0
+    and.l   #0xFFFFFFF0,%d0 /* d0 == first line bound */
+    cmp.l   %a0, %d0        /* any leading longwords? */
+    bls.b   .r_end_u_l1     /* no: skip loop */
+        
+.r_loop_u_l1:
+    move.w  (%a2), %d3      /* load first word */
+    swap    %d3             /* move to upper 16 bit */
+    move.w  (%a2), %d3      /* load second word */
+    move.l  %d3, %d4
+    lsl.l   %d1, %d2
+    lsr.l   #8, %d3
+    or.l    %d3, %d2        /* combine old low byte with new top 3 bytes */
+    move.l  %d2, (%a0)+     /* store as long */
+    move.l  %d4, %d2
+    cmp.l   %a0, %d0        /* run up to first line bound */
+    bhi.b   .r_loop_u_l1
+
+.r_end_u_l1:
+    lea.l   (-14, %a1), %a1 /* adjust end addr. to 16 bytes/pass */
+
+.r_loop_u_line:
+    move.w  (%a2), %d3      /* load 1st word */
+    swap    %d3             /* move to upper 16 bit */
+    move.w  (%a2), %d3      /* load 2nd word */
+    move.l  %d3, %d0
+    lsl.l   %d1, %d2
+    lsr.l   #8, %d0
+    or.l    %d0, %d2        /* combine old low byte with new top 3 bytes */
+    move.w  (%a2), %d4      /* load 3rd word */
+    swap    %d4             /* move to upper 16 bit */
+    move.w  (%a2), %d4      /* load 4th word */
+    move.l  %d4, %d0
+    lsl.l   %d1, %d3
+    lsr.l   #8, %d0
+    or.l    %d0, %d3        /* combine old low byte with new top 3 bytes */
+    move.w  (%a2), %d5      /* load 5th word */
+    swap    %d5             /* move to upper 16 bit */
+    move.w  (%a2), %d5      /* load 6th word */
+    move.l  %d5, %d0
+    lsl.l   %d1, %d4
+    lsr.l   #8, %d0
+    or.l    %d0, %d4        /* combine old low byte with new top 3 bytes */
+    move.w  (%a2), %d6      /* load 7th word */
+    swap    %d6             /* move to upper 16 bit */
+    move.w  (%a2), %d6      /* load 8th word */
+    move.l  %d6, %d0
+    lsl.l   %d1, %d5
+    lsr.l   #8, %d0
+    or.l    %d0, %d5        /* combine old low byte with new top 3 bytes */
+    movem.l %d2-%d5, (%a0)  /* store line */
+    lea.l   (16, %a0), %a0
+    move.l  %d6, %d2
+    cmp.l   %a0, %a1        /* run up to last line bound */
+    bhi.b   .r_loop_u_line
+
+    lea.l   (12, %a1), %a1  /* readjust for longword loop */
+    cmp.l   %a0, %a1        /* any trailing longwords? */
+    bls.b   .r_end_u_l2     /* no: skip loop */
+
+.r_loop_u_l2:
+    move.w  (%a2), %d3      /* load first word */
+    swap    %d3             /* move to upper 16 bit */
+    move.w  (%a2), %d3      /* load second word */
+    move.l  %d3, %d4
+    lsl.l   %d1, %d2
+    lsr.l   #8, %d3
+    or.l    %d3, %d2        /* combine old low byte with new top 3 bytes */
+    move.l  %d2, (%a0)+     /* store as long */
+    move.l  %d4, %d2
+    cmp.l   %a0, %a1        /* run up to last long bound */
+    bhi.b   .r_loop_u_l2
+        
+.r_end_u_l2:
+    addq.l  #2, %a1         /* back to final end address */
+    cmp.l   %a0, %a1        /* one word left? */
+    bls.b   .r_end_u_w2
+
+    swap    %d2             /* move old word to upper 16 bits */
+    move.w  (%a2), %d2      /* load final word */
+    move.l  %d2, %d3
+    lsr.l   #8, %d3
+    move.w  %d3, (%a0)+     /* write bytes 2 and 3 as word */
+
+.r_end_u_w2:
+    move.b  %d2, (%a0)+     /* store final byte */
+    bra.b   .r_exit
+
+    /* 16-bit aligned */
+.r_aligned:
+    btst.l  #1, %d0         /* longword aligned? */
+    beq.b   .r_end_a_w1     /* yes, skip leading word handling */
+
+    move.w  (%a2), (%a0)+   /* copy initial word */
+
+.r_end_a_w1:
+    moveq.l #12, %d0
+    add.l   %a0, %d0
+    and.l   #0xFFFFFFF0,%d0 /* d0 == first line bound */
+    cmp.l   %a0, %d0        /* any leading longwords? */
+    bls.b   .r_end_a_l1     /* no: skip loop */
+
+.r_loop_a_l1:
+    move.w  (%a2), %d1      /* load first word */
+    swap    %d1             /* move it to upper 16 bits */
+    move.w  (%a2), %d1      /* load second word */
+    move.l  %d1, (%a0)+     /* store as long */
+    cmp.l   %a0, %d0        /* run up to first line bound */
+    bhi.b   .r_loop_a_l1
+
+.r_end_a_l1:
+    lea.l   (-14, %a1), %a1 /* adjust end addr. to 16 bytes/pass */
+
+.r_loop_a_line:
+    move.w  (%a2), %d0      /* load 1st word */
+    swap    %d0             /* move it to upper 16 bits */
+    move.w  (%a2), %d0      /* load 2nd word */
+    move.w  (%a2), %d1      /* load 3rd word */
+    swap    %d1             /* move it to upper 16 bits */
+    move.w  (%a2), %d1      /* load 4th word */
+    move.w  (%a2), %d2      /* load 5th word */
+    swap    %d2             /* move it to upper 16 bits */
+    move.w  (%a2), %d2      /* load 6th word */
+    move.w  (%a2), %d3      /* load 7th word */
+    swap    %d3             /* move it to upper 16 bits */
+    move.w  (%a2), %d3      /* load 8th word */
+    movem.l %d0-%d3, (%a0)  /* store line */
+    lea.l   (16, %a0), %a0
+    cmp.l   %a0, %a1        /* run up to last line bound */
+    bhi.b   .r_loop_a_line
+
+    lea.l   (12, %a1), %a1  /* readjust for longword loop */
+    cmp.l   %a0, %a1        /* any trailing longwords? */
+    bls.b   .r_end_a_l2     /* no: skip loop */
+
+.r_loop_a_l2:
+    move.w  (%a2), %d1      /* read first word */
+    swap    %d1             /* move it to upper 16 bits */
+    move.w  (%a2), %d1      /* read second word */
+    move.l  %d1, (%a0)+     /* store as long */
+    cmp.l   %a0, %a1        /* run up to last long bound */
+    bhi.b   .r_loop_a_l2
+        
+.r_end_a_l2:
+    addq.l  #2, %a1         /* back to final end address */
+    cmp.l   %a0, %a1        /* one word left? */
+    bls.b   .r_end_a_w2
+
+    move.w  (%a2), (%a0)+   /* copy final word */
+
+.r_end_a_w2:
+
+.r_exit:
+    movem.l (%sp), %d2-%d6/%a2
+    lea.l   (24, %sp), %sp
+    rts
+
+.r_end:
+    .size   copy_read_sectors,.r_end-copy_read_sectors
+
+    .align  2
+    .global copy_write_sectors
+    .type   copy_write_sectors,@function
+    
+/* Write a number of words to the ATA data port
+ *
+ * Utilises line bursts, assumes there is at least one full line to copy.
+ *
+ * Arguments:
+ *   (4,%sp) - buffer address
+ *   (8,%sp) - word count
+ *
+ * Register usage:
+ *   %a0 - current address
+ *   %a1 - end address
+ *   %a2 - ata port
+ *   %d0 - scratch
+ *   %d1 - shift count
+ *   %d2-%d6 - read buffers
+ */
+
+copy_write_sectors:
+    lea.l   (-24, %sp), %sp
+    movem.l %d2-%d6/%a2, (%sp)
+    movem.l (28, %sp), %a0-%a1
+    add.l   %a1, %a1
+    add.l   %a0, %a1
+    lea.l   .ata_port, %a2
+
+    move.l  %a0, %d0
+    btst.l  #0, %d0         /* 16-bit aligned? */
+    jeq     .w_aligned      /* yes, do word copy */
+
+    /* not 16-bit aligned */
+    subq.l  #1, %a1         /* last byte is done unconditionally */
+    moveq.l #24, %d1        /* preload shift count */
+
+    move.b  (%a0)+, %d2
+
+    btst.l  #1, %d0         /* longword aligned? */
+    beq.b   .w_end_u_w1     /* yes, skip leading word handling */
+
+    swap    %d2
+    move.w  (%a0)+, %d2
+    move.l  %d2, %d3
+    lsr.l   #8, %d3
+    move.w  %d3, (%a2)
+        
+.w_end_u_w1:
+    moveq.l #12, %d0
+    add.l   %a0, %d0
+    and.l   #0xFFFFFFF0,%d0 /* d0 == first line bound */
+    cmp.l   %a0, %d0        /* any leading longwords? */
+    bls.b   .w_end_u_l1     /* no: skip loop */
+        
+.w_loop_u_l1:
+    move.l  (%a0)+, %d3
+    move.l  %d3, %d4
+    lsl.l   %d1, %d2
+    lsr.l   #8, %d3
+    or.l    %d3, %d2
+    swap    %d2
+    move.w  %d2, (%a2)
+    swap    %d2
+    move.w  %d2, (%a2)
+    move.l  %d4, %d2
+    cmp.l   %a0, %d0        /* run up to first line bound */
+    bhi.b   .w_loop_u_l1
+
+.w_end_u_l1:
+    lea.l   (-14, %a1), %a1 /* adjust end addr. to 16 bytes/pass */
+
+.w_loop_u_line:
+    movem.l (%a0), %d3-%d6
+    lea.l   (16, %a0), %a0
+    move.l  %d3, %d0
+    lsl.l   %d1, %d2
+    lsr.l   #8, %d0
+    or.l    %d0, %d2
+    swap    %d2
+    move.w  %d2, (%a2)
+    swap    %d2
+    move.w  %d2, (%a2)
+    move.l  %d4, %d0
+    lsl.l   %d1, %d3
+    lsr.l   #8, %d0
+    or.l    %d0, %d3
+    swap    %d3
+    move.w  %d3, (%a2)
+    swap    %d3
+    move.w  %d3, (%a2)
+    move.l  %d5, %d0
+    lsl.l   %d1, %d4
+    lsr.l   #8, %d0
+    or.l    %d0, %d4
+    swap    %d4
+    move.w  %d4, (%a2)
+    swap    %d4
+    move.w  %d4, (%a2)
+    move.l  %d6, %d0
+    lsl.l   %d1, %d5
+    lsr.l   #8, %d0
+    or.l    %d0, %d5
+    swap    %d5
+    move.w  %d5, (%a2)
+    swap    %d5
+    move.w  %d5, (%a2)
+    move.l  %d6, %d2
+    cmp.l   %a0, %a1        /* run up to last line bound */
+    bhi.b   .w_loop_u_line
+
+    lea.l   (12, %a1), %a1  /* readjust for longword loop */
+    cmp.l   %a0, %a1        /* any trailing longwords? */
+    bls.b   .w_end_u_l2     /* no: skip loop */
+
+.w_loop_u_l2:
+    move.l  (%a0)+, %d3
+    move.l  %d3, %d4
+    lsl.l   %d1, %d2
+    lsr.l   #8, %d3
+    or.l    %d3, %d2
+    swap    %d2
+    move.w  %d2, (%a2)
+    swap    %d2
+    move.w  %d2, (%a2)
+    move.l  %d4, %d2
+    cmp.l   %a0, %a1        /* run up to first line bound */
+    bhi.b   .w_loop_u_l2
+
+.w_end_u_l2:
+    addq.l  #2, %a1         /* back to final end address */
+    cmp.l   %a0, %a1        /* one word left? */
+    bls.b   .w_end_u_w2
+
+    swap    %d2
+    move.w  (%a0)+, %d2
+    move.l  %d2, %d3
+    lsr.l   #8, %d3
+    move.w  %d3, (%a2)
+
+.w_end_u_w2:
+    lsl.l   #8, %d2
+    move.b  (%a0)+, %d2
+    move.w  %d2, (%a2)
+    bra.b    .w_exit
+
+    /* 16-bit aligned */
+.w_aligned:
+    btst.l  #1, %d0
+    beq.b   .w_end_a_w1
+
+    move.w  (%a0)+, (%a2)   /* copy initial word */
+
+.w_end_a_w1:
+    moveq.l #12, %d0
+    add.l   %a0, %d0
+    and.l   #0xFFFFFFF0,%d0 /* d0 == first line bound */
+    cmp.l   %a0, %d0        /* any leading longwords? */
+    bls.b   .w_end_a_l1     /* no: skip loop */
+
+.w_loop_a_l1:
+    move.l  (%a0)+, %d1
+    swap    %d1
+    move.w  %d1, (%a2)
+    swap    %d1
+    move.w  %d1, (%a2)
+    cmp.l   %a0, %d0        /* run up to first line bound */
+    bhi.b   .w_loop_a_l1
+
+.w_end_a_l1:
+    lea.l   (-14, %a1), %a1 /* adjust end addr. to 16 bytes/pass */
+
+.w_loop_a_line:
+    movem.l (%a0), %d0-%d3
+    lea.l   (16, %a0), %a0
+    swap    %d0
+    move.w  %d0, (%a2)
+    swap    %d0
+    move.w  %d0, (%a2)
+    swap    %d1
+    move.w  %d1, (%a2)
+    swap    %d1
+    move.w  %d1, (%a2)
+    swap    %d2
+    move.w  %d2, (%a2)
+    swap    %d2
+    move.w  %d2, (%a2)
+    swap    %d3
+    move.w  %d3, (%a2)
+    swap    %d3
+    move.w  %d3, (%a2)
+    cmp.l   %a0, %a1        /* run up to last line bound */
+    bhi.b   .w_loop_a_line
+        
+    lea.l   (12, %a1), %a1  /* readjust for longword loop */
+    cmp.l   %a0, %a1        /* any trailing longwords? */
+    bls.b   .w_end_a_l2     /* no: skip loop */
+
+.w_loop_a_l2:
+    move.l  (%a0)+, %d1
+    swap    %d1
+    move.w  %d1, (%a2)
+    swap    %d1
+    move.w  %d1, (%a2)
+    cmp.l   %a0, %a1        /* run up to first line bound */
+    bhi.b   .w_loop_a_l2
+
+.w_end_a_l2:
+    addq.l  #2, %a1         /* back to final end address */
+    cmp.l   %a0, %a1        /* one word left? */
+    bls.b   .w_end_a_w2
+
+    move.w  (%a0)+, (%a2)   /* copy final word */
+
+.w_end_a_w2:
+
+.w_exit:
+    movem.l (%sp), %d2-%d6/%a2
+    lea.l   (24, %sp), %sp
+    rts
+
+.w_end:
+    .size   copy_write_sectors,.w_end-copy_write_sectors
diff --git a/firmware/target/coldfire/ata-target.h b/firmware/target/coldfire/ata-target.h
index 4a28c3ae3f..e246dc7af1 100755
--- a/firmware/target/coldfire/ata-target.h
+++ b/firmware/target/coldfire/ata-target.h
@@ -20,8 +20,8 @@
 #define ATA_TARGET_H
 
 /* asm optimised read & write loops */
-
-#define NOINLINE_ATTR __attribute__((noinline)) /* don't inline the loops */
+#define ATA_OPTIMIZED_READING
+#define ATA_OPTIMIZED_WRITING
 
 #define ATA_IOBASE      0x20000000
 #define ATA_DATA        (*((volatile unsigned short*)(ATA_IOBASE + 0x20)))
@@ -65,4 +65,6 @@ void ata_reset(void);
 void ata_device_init(void);
 bool ata_is_coldstart(void);
 
+void copy_read_sectors(unsigned char* buf, int wordcount);
+void copy_write_sectors(const unsigned char* buf, int wordcount);
 #endif
diff --git a/firmware/target/sh/archos/ata-archos.c b/firmware/target/sh/archos/ata-archos.c
new file mode 100755
index 0000000000..73e56b8d84
--- /dev/null
+++ b/firmware/target/sh/archos/ata-archos.c
@@ -0,0 +1,76 @@
+/***************************************************************************
+ *             __________               __   ___.
+ *   Open      \______   \ ____   ____ |  | _\_ |__   _______  ___
+ *   Source     |       _//  _ \_/ ___\|  |/ /| __ \ /  _ \  \/  /
+ *   Jukebox    |    |   (  <_> )  \___|    < | \_\ (  <_> > <  <
+ *   Firmware   |____|_  /\____/ \___  >__|_ \|___  /\____/__/\_ \
+ *                     \/            \/     \/    \/            \/
+ * $Id$
+ *
+ * Copyright (C) 2006 by Jens Arnold
+ *
+ * All files in this archive are subject to the GNU General Public License.
+ * See the file COPYING in the source tree root for full license agreement.
+ *
+ * This software is distributed on an "AS IS" basis, WITHOUT WARRANTY OF ANY
+ * KIND, either express or implied.
+ *
+ ****************************************************************************/
+
+#include "config.h"
+#include "cpu.h"
+#include <stdbool.h>
+#include "kernel.h"
+#include "system.h"
+#include "ata-target.h"
+#include "hwcompat.h"
+
+volatile unsigned char* ata_control;
+int ata_io_address; /* 0x300 or 0x200 */
+
+void ata_reset(void)
+{
+    /* state HRR0 */
+    and_b(~0x02, &PADRH); /* assert _RESET */
+    sleep(1); /* > 25us */
+
+    /* state HRR1 */
+    or_b(0x02, &PADRH); /* negate _RESET */
+    sleep(1); /* > 2ms */
+}
+
+void ata_address_detect(void)
+{
+    if (read_hw_mask() & ATA_ADDRESS_200)
+    {
+        ata_io_address = 0x200; /* For debug purposes only */
+        ata_control = ATA_CONTROL1;
+    }
+    else
+    {
+        ata_io_address = 0x300; /* For debug purposes only */
+        ata_control = ATA_CONTROL2;
+    }
+}
+
+void ata_enable(bool on)
+{
+    if(on)
+        and_b(~0x80, &PADRL); /* enable ATA */
+    else
+        or_b(0x80, &PADRL); /* disable ATA */
+
+    or_b(0x80, &PAIORL);
+}
+
+void ata_device_init(void)
+{
+    or_b(0x02, &PAIORH); /* output for ATA reset */
+    or_b(0x02, &PADRH);  /* release ATA reset */
+    PACR2 &= 0xBFFF; /* GPIO function for PA7 (IDE enable) */
+}
+
+bool ata_is_coldstart(void)
+{
+    return (PACR2 & 0x4000) != 0;
+}
diff --git a/firmware/target/sh/archos/ata-as-archos.S b/firmware/target/sh/archos/ata-as-archos.S
new file mode 100755
index 0000000000..4a4e7e4b94
--- /dev/null
+++ b/firmware/target/sh/archos/ata-as-archos.S
@@ -0,0 +1,231 @@
+/***************************************************************************
+ *             __________               __   ___.
+ *   Open      \______   \ ____   ____ |  | _\_ |__   _______  ___
+ *   Source     |       _//  _ \_/ ___\|  |/ /| __ \ /  _ \  \/  /
+ *   Jukebox    |    |   (  <_> )  \___|    < | \_\ (  <_> > <  <
+ *   Firmware   |____|_  /\____/ \___  >__|_ \|___  /\____/__/\_ \
+ *                     \/            \/     \/    \/            \/
+ * $Id$
+ *
+ * Copyright (C) 2004-2006 by Jens Arnold
+ *
+ * All files in this archive are subject to the GNU General Public License.
+ * See the file COPYING in the source tree root for full license agreement.
+ *
+ * This software is distributed on an "AS IS" basis, WITHOUT WARRANTY OF ANY
+ * KIND, either express or implied.
+ *
+ ****************************************************************************/
+
+    .section    .icode,"ax",@progbits
+
+    .align  2
+    .global _copy_read_sectors
+    .type   _copy_read_sectors,@function
+    
+/* Read a number of words from the ATA data port
+ *
+ * Assumes wordcount to be a multiple of 4
+ *
+ * Arguments:
+ *   r4 - buffer address
+ *   r5 - word count
+ *
+ * Register usage:
+ *   r0 - scratch
+ *   r1/r2 - read buffers
+ *   r3 - mask (if unaligned)
+ *   r4 - current address
+ *   r5 - end address
+ *   r6 - ata port
+ */
+
+_copy_read_sectors:
+    add     r5, r5          /* words -> bytes */
+    add     r4, r5          /* bytes -> end address */
+    add     #-12, r5        /* adjust for offsets */
+    mov.l   .ata_data, r6
+
+    mov     r4, r0
+    tst     #1, r0          /* 16-bit aligned ? */
+    bt      .r_aligned      /* yes, do word copy */
+
+    /* not 16-bit aligned */
+    mov     #-1, r3         /* prepare a bit mask for high byte */
+    shll8   r3              /* r3 = 0xFFFFFF00 */
+    
+    mov.w   @r6, r2         /* read first word (1st round) */
+    mov.b   r2, @r4         /* store low byte of first word */
+    bra     .r_start_b      /* jump into loop after next instr. */
+    add     #-5, r4         /* adjust for dest. offsets; now even */
+
+    .align  2
+.r_loop_b:                  /* main loop: copy 4 words in a row */
+    mov.w   @r6, r2         /* read first word (2+ round) */
+    and     r3, r1          /* get high byte of fourth word (2+ round) */
+    extu.b  r2, r0          /* get low byte of first word (2+ round) */
+    or      r1, r0          /* combine with high byte of fourth word */
+    mov.w   r0, @(4, r4)    /* store at buf[4] */
+    nop                     /* maintain alignment */
+.r_start_b:
+    mov.w   @r6, r1         /* read second word */
+    and     r3, r2          /* get high byte of first word */
+    extu.b  r1, r0          /* get low byte of second word */
+    or      r2, r0          /* combine with high byte of first word */
+    mov.w   r0, @(6, r4)    /* store at buf[6] */
+    add     #8, r4          /* buf += 8 */
+    mov.w   @r6, r2         /* read third word */
+    and     r3, r1          /* get high byte of second word */
+    extu.b  r2, r0          /* get low byte of third word */
+    or      r1, r0          /* combine with high byte of second word */
+    mov.w   r0, @r4         /* store at buf[0] */
+    cmp/hi  r4, r5          /* check for end */
+    mov.w   @r6, r1         /* read fourth word */
+    and     r3, r2          /* get high byte of third word */
+    extu.b  r1, r0          /* get low byte of fourth word */
+    or      r2, r0          /* combine with high byte of third word */
+    mov.w   r0, @(2, r4)    /* store at buf[2] */
+    bt      .r_loop_b
+    /* 24 instructions for 4 copies, takes 30 clock cycles (4 wait) */
+    /* avg. 7.5 cycles per word */
+
+    swap.b  r1, r0          /* get high byte of last word */
+    rts
+    mov.b   r0, @(4, r4)    /* and store it */
+
+    /* 16-bit aligned, loop(read and store word) */
+.r_aligned:
+    mov.w   @r6, r2         /* read first word (1st round) */
+    bra     .r_start_w      /* jump into loop after next instr. */
+    add     #-6, r4         /* adjust for destination offsets */
+
+    .align  2
+.r_loop_w:                  /* main loop: copy 4 words in a row */
+    mov.w   @r6, r2         /* read first word (2+ round) */
+    swap.b  r1, r0          /* swap fourth word (2+ round) */
+    mov.w   r0, @(4, r4)    /* store fourth word (2+ round) */
+    nop                     /* maintain alignment */
+.r_start_w:
+    mov.w   @r6, r1         /* read second word */
+    swap.b  r2, r0          /* swap first word */
+    mov.w   r0, @(6, r4)    /* store first word in buf[6] */
+    add     #8, r4          /* buf += 8 */
+    mov.w   @r6, r2         /* read third word */
+    swap.b  r1, r0          /* swap second word */
+    mov.w   r0, @r4         /* store second word in buf[0] */
+    cmp/hi  r4, r5          /* check for end */
+    mov.w   @r6, r1         /* read fourth word */
+    swap.b  r2, r0          /* swap third word */
+    mov.w   r0, @(2, r4)    /* store third word */
+    bt      .r_loop_w
+    /* 16 instructions for 4 copies, takes 22 clock cycles (4 wait) */
+    /* avg. 5.5 cycles per word */
+
+    swap.b  r1, r0          /* swap fourth word (last round) */
+    rts
+    mov.w   r0, @(4, r4)    /* and store it */
+
+.r_end:
+    .size   _copy_read_sectors,.r_end-_copy_read_sectors
+
+    .align  2
+    .global _copy_write_sectors
+    .type   _copy_write_sectors,@function
+    
+/* Write a number of words to the ATA data port
+ *
+ * Assumes wordcount to be a multiple of 2.
+ * Writing is not unrolled as much as reading, for several reasons:
+ *
+ * - a similar instruction sequence is faster for writing than for reading
+ *   because the auto-incrementing load inctructions can be used
+ * - writing profits from warp mode
+ *
+ * Both of these add up to have writing faster than the more unrolled reading.
+ *
+ * Arguments:
+ *   r4 - buffer address
+ *   r5 - word count
+ *
+ * Register usage:
+ *   r0/r1 - scratch
+ *   r2/r3 - write buffers
+ *   r4 - current address
+ *   r5 - end address
+ *   r6 - mask (if unaligned)
+ *   r7 - ata port
+ */
+
+_copy_write_sectors:
+    add     r5, r5          /* words -> bytes */
+    add     r4, r5          /* bytes -> end address */
+    add     #-4, r5         /* adjust for offsets */
+    mov.l   .ata_data, r7
+
+    mov     r4, r0
+    tst     #1, r0          /* 16-bit aligned ? */
+    bt      .w_aligned      /* yes, do word copy */
+
+    /* not 16-bit aligned */
+    mov     #-1, r6         /* prepare a bit mask for high byte */
+    shll8   r6              /* r6 = 0xFFFFFF00 */
+
+    mov.b   @r4+, r2        /* load (initial old second) first byte */
+    mov.w   @r4+, r3        /* load (initial) first word */
+    bra     .w_start_b
+    extu.b  r2, r0          /* extend unsigned */
+
+    .align  2
+.w_loop_b:                  /* main loop: copy 2 words in a row */
+    mov.w   @r4+, r3        /* load first word (2+ round) */
+    extu.b  r2, r0          /* put away low byte of second word (2+ round) */
+    and     r6, r2          /* get high byte of second word (2+ round) */
+    or      r1, r2          /* combine with low byte of old first word */
+    mov.w   r2, @r7         /* write that */
+.w_start_b:
+    cmp/hi  r4, r5          /* check for end */
+    mov.w   @r4+, r2        /* load second word */
+    extu.b  r3, r1          /* put away low byte of first word */
+    and     r6, r3          /* get high byte of first word */
+    or      r0, r3          /* combine with high byte of old second word */
+    mov.w   r3, @r7         /* write that */
+    bt      .w_loop_b
+    /* 12 instructions for 2 copies, takes 14 clock cycles */
+    /* avg. 7 cycles per word */
+
+    /* the loop "overreads" 1 byte past the buffer end, however, the last */
+    /* byte is not written to disk */
+    and     r6, r2          /* get high byte of last word */
+    or      r1, r2          /* combine with low byte of old first word */
+    rts
+    mov.w   r2, @r7         /* write last word */
+
+    /* 16-bit aligned, loop(load and write word) */
+.w_aligned:
+    bra     .w_start_w      /* jump into loop after next instr. */
+    mov.w   @r4+, r2        /* load first word (1st round) */
+
+    .align  2
+.w_loop_w:                  /* main loop: copy 2 words in a row */
+    mov.w   @r4+, r2        /* load first word (2+ round) */
+    swap.b  r1, r0          /* swap second word (2+ round) */
+    mov.w   r0, @r7         /* write second word (2+ round) */
+.w_start_w:
+    cmp/hi  r4, r5          /* check for end */
+    mov.w   @r4+, r1        /* load second word */
+    swap.b  r2, r0          /* swap first word */
+    mov.w   r0, @r7         /* write first word */
+    bt      .w_loop_w
+    /* 8 instructions for 2 copies, takes 10 clock cycles */
+    /* avg. 5 cycles per word */
+
+    swap.b  r1, r0          /* swap second word (last round) */
+    rts
+    mov.w   r0, @r7         /* and write it */
+
+.w_end:
+    .size   _copy_write_sectors,.w_end-_copy_write_sectors
+
+    .align  2
+.ata_data:
+    .long   0x06104100      /* ATA data port */
diff --git a/firmware/target/sh/archos/ata-target.h b/firmware/target/sh/archos/ata-target.h
new file mode 100755
index 0000000000..ddffb34f5a
--- /dev/null
+++ b/firmware/target/sh/archos/ata-target.h
@@ -0,0 +1,80 @@
+/***************************************************************************
+ *             __________               __   ___.
+ *   Open      \______   \ ____   ____ |  | _\_ |__   _______  ___
+ *   Source     |       _//  _ \_/ ___\|  |/ /| __ \ /  _ \  \/  /
+ *   Jukebox    |    |   (  <_> )  \___|    < | \_\ (  <_> > <  <
+ *   Firmware   |____|_  /\____/ \___  >__|_ \|___  /\____/__/\_ \
+ *                     \/            \/     \/    \/            \/
+ * $Id$
+ *
+ * Copyright (C) 2006 by Jens Arnold
+ *
+ * All files in this archive are subject to the GNU General Public License.
+ * See the file COPYING in the source tree root for full license agreement.
+ *
+ * This software is distributed on an "AS IS" basis, WITHOUT WARRANTY OF ANY
+ * KIND, either express or implied.
+ *
+ ****************************************************************************/
+#ifndef ATA_TARGET_H
+#define ATA_TARGET_H
+
+/* asm optimised read & write loops */
+#define ATA_OPTIMIZED_READING
+#define ATA_OPTIMIZED_WRITING
+#define ATA_ADDRESS_DETECT /* need address detection */
+
+#define SWAP_WORDS
+
+#define ATA_IOBASE      0x06100100
+#define ATA_DATA        (*((volatile unsigned short*)0x06104100))
+#define ATA_CONTROL1    ((volatile unsigned char*)0x06200206)
+#define ATA_CONTROL2    ((volatile unsigned char*)0x06200306)
+#define ATA_CONTROL     (*ata_control)
+
+#define ATA_ERROR       (*((volatile unsigned char*)ATA_IOBASE + 1))
+#define ATA_NSECTOR     (*((volatile unsigned char*)ATA_IOBASE + 2))
+#define ATA_SECTOR      (*((volatile unsigned char*)ATA_IOBASE + 3))
+#define ATA_LCYL        (*((volatile unsigned char*)ATA_IOBASE + 4))
+#define ATA_HCYL        (*((volatile unsigned char*)ATA_IOBASE + 5))
+#define ATA_SELECT      (*((volatile unsigned char*)ATA_IOBASE + 6))
+#define ATA_COMMAND     (*((volatile unsigned char*)ATA_IOBASE + 7))
+
+#define STATUS_BSY      0x80
+#define STATUS_RDY      0x40
+#define STATUS_DF       0x20
+#define STATUS_DRQ      0x08
+#define STATUS_ERR      0x01
+
+#define ERROR_ABRT      0x04
+
+#define WRITE_PATTERN1 0xa5
+#define WRITE_PATTERN2 0x5a
+#define WRITE_PATTERN3 0xaa
+#define WRITE_PATTERN4 0x55
+
+#define READ_PATTERN1 0xa5
+#define READ_PATTERN2 0x5a
+#define READ_PATTERN3 0xaa
+#define READ_PATTERN4 0x55
+
+#define READ_PATTERN1_MASK 0xff
+#define READ_PATTERN2_MASK 0xff
+#define READ_PATTERN3_MASK 0xff
+#define READ_PATTERN4_MASK 0xff
+
+#define SET_REG(reg,val) reg = (val)
+#define SET_16BITREG(reg,val) reg = (val)
+
+extern volatile unsigned char* ata_control;
+extern int ata_io_address;
+
+void ata_reset(void);
+void ata_address_detect(void);
+void ata_enable(bool on);
+void ata_device_init(void);
+bool ata_is_coldstart(void);
+
+void copy_read_sectors(unsigned char* buf, int wordcount);
+void copy_write_sectors(const unsigned char* buf, int wordcount);
+#endif