166d83ab3SGreg Ungerer /*
266d83ab3SGreg Ungerer * This file is subject to the terms and conditions of the GNU General Public
366d83ab3SGreg Ungerer * License. See the file COPYING in the main directory of this archive
466d83ab3SGreg Ungerer * for more details.
566d83ab3SGreg Ungerer */
666d857b0SGreg Ungerer
766d83ab3SGreg Ungerer #include <linux/module.h>
866d83ab3SGreg Ungerer #include <linux/string.h>
966d857b0SGreg Ungerer
memcpy(void * to,const void * from,size_t n)1066d857b0SGreg Ungerer void *memcpy(void *to, const void *from, size_t n)
1166d857b0SGreg Ungerer {
1266d857b0SGreg Ungerer void *xto = to;
13*423c01eaSGreg Ungerer size_t temp;
1466d857b0SGreg Ungerer
1566d857b0SGreg Ungerer if (!n)
1666d857b0SGreg Ungerer return xto;
1766d83ab3SGreg Ungerer if ((long)to & 1) {
1866d857b0SGreg Ungerer char *cto = to;
1966d857b0SGreg Ungerer const char *cfrom = from;
2066d857b0SGreg Ungerer *cto++ = *cfrom++;
2166d857b0SGreg Ungerer to = cto;
2266d857b0SGreg Ungerer from = cfrom;
2366d857b0SGreg Ungerer n--;
2466d857b0SGreg Ungerer }
25f230e80bSGreg Ungerer #if defined(CONFIG_M68000)
26f230e80bSGreg Ungerer if ((long)from & 1) {
27f230e80bSGreg Ungerer char *cto = to;
28f230e80bSGreg Ungerer const char *cfrom = from;
29f230e80bSGreg Ungerer for (; n; n--)
30f230e80bSGreg Ungerer *cto++ = *cfrom++;
31f230e80bSGreg Ungerer return xto;
32f230e80bSGreg Ungerer }
33f230e80bSGreg Ungerer #endif
3466d83ab3SGreg Ungerer if (n > 2 && (long)to & 2) {
3566d857b0SGreg Ungerer short *sto = to;
3666d857b0SGreg Ungerer const short *sfrom = from;
3766d857b0SGreg Ungerer *sto++ = *sfrom++;
3866d857b0SGreg Ungerer to = sto;
3966d857b0SGreg Ungerer from = sfrom;
4066d857b0SGreg Ungerer n -= 2;
4166d857b0SGreg Ungerer }
4266d857b0SGreg Ungerer temp = n >> 2;
4366d83ab3SGreg Ungerer if (temp) {
4466d857b0SGreg Ungerer long *lto = to;
4566d857b0SGreg Ungerer const long *lfrom = from;
46734c3ce3SGreg Ungerer #if defined(CONFIG_M68000) || defined(CONFIG_COLDFIRE)
47734c3ce3SGreg Ungerer for (; temp; temp--)
48734c3ce3SGreg Ungerer *lto++ = *lfrom++;
49734c3ce3SGreg Ungerer #else
50*423c01eaSGreg Ungerer size_t temp1;
5166d83ab3SGreg Ungerer asm volatile (
5266d83ab3SGreg Ungerer " movel %2,%3\n"
5366d83ab3SGreg Ungerer " andw #7,%3\n"
5466d83ab3SGreg Ungerer " lsrl #3,%2\n"
5566d83ab3SGreg Ungerer " negw %3\n"
5666d83ab3SGreg Ungerer " jmp %%pc@(1f,%3:w:2)\n"
5766d83ab3SGreg Ungerer "4: movel %0@+,%1@+\n"
5866d83ab3SGreg Ungerer " movel %0@+,%1@+\n"
5966d83ab3SGreg Ungerer " movel %0@+,%1@+\n"
6066d83ab3SGreg Ungerer " movel %0@+,%1@+\n"
6166d83ab3SGreg Ungerer " movel %0@+,%1@+\n"
6266d83ab3SGreg Ungerer " movel %0@+,%1@+\n"
6366d83ab3SGreg Ungerer " movel %0@+,%1@+\n"
6466d83ab3SGreg Ungerer " movel %0@+,%1@+\n"
6566d83ab3SGreg Ungerer "1: dbra %2,4b\n"
6666d83ab3SGreg Ungerer " clrw %2\n"
6766d83ab3SGreg Ungerer " subql #1,%2\n"
6866d83ab3SGreg Ungerer " jpl 4b"
6966d83ab3SGreg Ungerer : "=a" (lfrom), "=a" (lto), "=d" (temp), "=&d" (temp1)
7066d83ab3SGreg Ungerer : "0" (lfrom), "1" (lto), "2" (temp));
7166d83ab3SGreg Ungerer #endif
7266d857b0SGreg Ungerer to = lto;
7366d857b0SGreg Ungerer from = lfrom;
7466d857b0SGreg Ungerer }
7566d83ab3SGreg Ungerer if (n & 2) {
7666d857b0SGreg Ungerer short *sto = to;
7766d857b0SGreg Ungerer const short *sfrom = from;
7866d857b0SGreg Ungerer *sto++ = *sfrom++;
7966d857b0SGreg Ungerer to = sto;
8066d857b0SGreg Ungerer from = sfrom;
8166d857b0SGreg Ungerer }
8266d83ab3SGreg Ungerer if (n & 1) {
8366d857b0SGreg Ungerer char *cto = to;
8466d857b0SGreg Ungerer const char *cfrom = from;
8566d857b0SGreg Ungerer *cto = *cfrom;
8666d857b0SGreg Ungerer }
8766d857b0SGreg Ungerer return xto;
8866d857b0SGreg Ungerer }
8966d83ab3SGreg Ungerer EXPORT_SYMBOL(memcpy);
90