Add the rt linux 4.1.3-rt3 as base

[kvmfornfv.git] / kernel / arch / nios2 / lib / memmove.c

diff --git a/kernel/arch/nios2/lib/memmove.c b/kernel/arch/nios2/lib/memmove.c
new file mode 100644 (file)
index 0000000..c65ef51
--- /dev/null
+++ b/kernel/arch/nios2/lib/memmove.c
@@ -0,0 +1,82 @@
+/*
+ * Copyright (C) 2011 Tobias Klauser <tklauser@distanz.ch>
+ * Copyright (C) 2004 Microtronix Datacom Ltd
+ *
+ * This file is subject to the terms and conditions of the GNU General Public
+ * License.  See the file "COPYING" in the main directory of this archive
+ * for more details.
+ */
+
+#include <linux/types.h>
+#include <linux/string.h>
+
+#ifdef __HAVE_ARCH_MEMMOVE
+void *memmove(void *d, const void *s, size_t count)
+{
+       unsigned long dst, src;
+
+       if (!count)
+               return d;
+
+       if (d < s) {
+               dst = (unsigned long) d;
+               src = (unsigned long) s;
+
+               if ((count < 8) || ((dst ^ src) & 3))
+                       goto restup;
+
+               if (dst & 1) {
+                       *(char *)dst++ = *(char *)src++;
+                       count--;
+               }
+               if (dst & 2) {
+                       *(short *)dst = *(short *)src;
+                       src += 2;
+                       dst += 2;
+                       count -= 2;
+               }
+               while (count > 3) {
+                       *(long *)dst = *(long *)src;
+                       src += 4;
+                       dst += 4;
+                       count -= 4;
+               }
+restup:
+               while (count--)
+                       *(char *)dst++ = *(char *)src++;
+       } else {
+               dst = (unsigned long) d + count;
+               src = (unsigned long) s + count;
+
+               if ((count < 8) || ((dst ^ src) & 3))
+                       goto restdown;
+
+               if (dst & 1) {
+                       src--;
+                       dst--;
+                       count--;
+                       *(char *)dst = *(char *)src;
+               }
+               if (dst & 2) {
+                       src -= 2;
+                       dst -= 2;
+                       count -= 2;
+                       *(short *)dst = *(short *)src;
+               }
+               while (count > 3) {
+                       src -= 4;
+                       dst -= 4;
+                       count -= 4;
+                       *(long *)dst = *(long *)src;
+               }
+restdown:
+               while (count--) {
+                       src--;
+                       dst--;
+                       *(char *)dst = *(char *)src;
+               }
+       }
+
+       return d;
+}
+#endif /* __HAVE_ARCH_MEMMOVE */