Subversion Repositories hf-risc

#include <string.h>

#include <stdint.h>

void* memcpy(void* aa, const void* bb, size_t n)

{

  #define BODY(a, b, t) { \

    t tt = *b; \

    a++, b++; \

    *(a-1) = tt; \

  }

  char* a = (char*)aa;

  const char* b = (const char*)bb;

  char* end = a+n;

  uintptr_t msk = sizeof(long)-1;

  if (__builtin_expect(((uintptr_t)a & msk) != ((uintptr_t)b & msk) || n < sizeof(long), 0))

  {

small:

    if (__builtin_expect(a < end, 1))

      while (a < end)

        BODY(a, b, char);

    return aa;

  }

  if (__builtin_expect(((uintptr_t)a & msk) != 0, 0))

    while ((uintptr_t)a & msk)

      BODY(a, b, char);

  long* la = (long*)a;

  const long* lb = (const long*)b;

  long* lend = (long*)((uintptr_t)end & ~msk);

  if (__builtin_expect(la < lend-8, 0))

  {

    while (la < lend-8)

    {

      long b0 = *lb++;

      long b1 = *lb++;

      long b2 = *lb++;

      long b3 = *lb++;

      long b4 = *lb++;

      long b5 = *lb++;

      long b6 = *lb++;

      long b7 = *lb++;

      long b8 = *lb++;

      *la++ = b0;

      *la++ = b1;

      *la++ = b2;

      *la++ = b3;

      *la++ = b4;

      *la++ = b5;

      *la++ = b6;

      *la++ = b7;

      *la++ = b8;

    }

  }

  while (la < lend)

    BODY(la, lb, long);

  a = (char*)la;

  b = (const char*)lb;

  if (__builtin_expect(a < end, 0))

    goto small;

  return aa;

}