#include <string.h>

#include <compiler.h>

#undef memcpy

#define ALIGNED(a) ( 0 == ( ((unsigned)(a)) & (sizeof(long)-1) ) )

#define HUBMEM(a) ( 0 == ( ((unsigned)(a)) & 0xFFF00000 ) )

#define MINBLOCKSIZE (2*(sizeof(long)))

#if defined(__PROPELLER_CMM__)

__attribute__((fcache))

void *

memcpy(void *dest_p, const void *src_p, size_t n)

{

void *orig_dest = dest_p;

#if defined(__PROPELLER_USE_XMM__)

extern void *_copy_from_xmm(void *dest, const void *src, size_t n);

if (HUBMEM(dest_p) && !HUBMEM(src_p))

return _copy_from_xmm(dest_p, src_p, n);

/* do a quick copy if src and dest are aligned */

if ( ALIGNED(dest_p) && ALIGNED(src_p) && n > MINBLOCKSIZE) {

long *ldst = dest_p;

const long *lsrc = src_p;

do

{

*ldst++ = *lsrc++;

*ldst++ = *lsrc++;

n -= MINBLOCKSIZE;

}

while (n > MINBLOCKSIZE);

dest_p = ldst;

src_p = lsrc;

}

/* fall through and copy any remaining (non-aligned) data */

/* we may not have finished everything in the loop above */

{

char *dst = dest_p;

const char *src = src_p;

while (n > 0) {

*dst++ = *src++;

--n;

}

}

return orig_dest;

}