xref: /openbmc/linux/arch/alpha/lib/memcpy.c (revision b34e08d5)
1 /*
2  *  linux/arch/alpha/lib/memcpy.c
3  *
4  *  Copyright (C) 1995  Linus Torvalds
5  */
6 
7 /*
8  * This is a reasonably optimized memcpy() routine.
9  */
10 
11 /*
12  * Note that the C code is written to be optimized into good assembly. However,
13  * at this point gcc is unable to sanely compile "if (n >= 0)", resulting in a
14  * explicit compare against 0 (instead of just using the proper "blt reg, xx" or
15  * "bge reg, xx"). I hope alpha-gcc will be fixed to notice this eventually..
16  */
17 
18 #include <linux/types.h>
19 
20 /*
21  * This should be done in one go with ldq_u*2/mask/stq_u. Do it
22  * with a macro so that we can fix it up later..
23  */
24 #define ALIGN_DEST_TO8_UP(d,s,n) \
25 	while (d & 7) { \
26 		if (n <= 0) return; \
27 		n--; \
28 		*(char *) d = *(char *) s; \
29 		d++; s++; \
30 	}
31 #define ALIGN_DEST_TO8_DN(d,s,n) \
32 	while (d & 7) { \
33 		if (n <= 0) return; \
34 		n--; \
35 		d--; s--; \
36 		*(char *) d = *(char *) s; \
37 	}
38 
39 /*
40  * This should similarly be done with ldq_u*2/mask/stq. The destination
41  * is aligned, but we don't fill in a full quad-word
42  */
43 #define DO_REST_UP(d,s,n) \
44 	while (n > 0) { \
45 		n--; \
46 		*(char *) d = *(char *) s; \
47 		d++; s++; \
48 	}
49 #define DO_REST_DN(d,s,n) \
50 	while (n > 0) { \
51 		n--; \
52 		d--; s--; \
53 		*(char *) d = *(char *) s; \
54 	}
55 
56 /*
57  * This should be done with ldq/mask/stq. The source and destination are
58  * aligned, but we don't fill in a full quad-word
59  */
60 #define DO_REST_ALIGNED_UP(d,s,n) DO_REST_UP(d,s,n)
61 #define DO_REST_ALIGNED_DN(d,s,n) DO_REST_DN(d,s,n)
62 
63 /*
64  * This does unaligned memory copies. We want to avoid storing to
65  * an unaligned address, as that would do a read-modify-write cycle.
66  * We also want to avoid double-reading the unaligned reads.
67  *
68  * Note the ordering to try to avoid load (and address generation) latencies.
69  */
70 static inline void __memcpy_unaligned_up (unsigned long d, unsigned long s,
71 					  long n)
72 {
73 	ALIGN_DEST_TO8_UP(d,s,n);
74 	n -= 8;			/* to avoid compare against 8 in the loop */
75 	if (n >= 0) {
76 		unsigned long low_word, high_word;
77 		__asm__("ldq_u %0,%1":"=r" (low_word):"m" (*(unsigned long *) s));
78 		do {
79 			unsigned long tmp;
80 			__asm__("ldq_u %0,%1":"=r" (high_word):"m" (*(unsigned long *)(s+8)));
81 			n -= 8;
82 			__asm__("extql %1,%2,%0"
83 				:"=r" (low_word)
84 				:"r" (low_word), "r" (s));
85 			__asm__("extqh %1,%2,%0"
86 				:"=r" (tmp)
87 				:"r" (high_word), "r" (s));
88 			s += 8;
89 			*(unsigned long *) d = low_word | tmp;
90 			d += 8;
91 			low_word = high_word;
92 		} while (n >= 0);
93 	}
94 	n += 8;
95 	DO_REST_UP(d,s,n);
96 }
97 
98 static inline void __memcpy_unaligned_dn (unsigned long d, unsigned long s,
99 					  long n)
100 {
101 	/* I don't understand AXP assembler well enough for this. -Tim */
102 	s += n;
103 	d += n;
104 	while (n--)
105 		* (char *) --d = * (char *) --s;
106 }
107 
108 /*
109  * Hmm.. Strange. The __asm__ here is there to make gcc use an integer register
110  * for the load-store. I don't know why, but it would seem that using a floating
111  * point register for the move seems to slow things down (very small difference,
112  * though).
113  *
114  * Note the ordering to try to avoid load (and address generation) latencies.
115  */
116 static inline void __memcpy_aligned_up (unsigned long d, unsigned long s,
117 					long n)
118 {
119 	ALIGN_DEST_TO8_UP(d,s,n);
120 	n -= 8;
121 	while (n >= 0) {
122 		unsigned long tmp;
123 		__asm__("ldq %0,%1":"=r" (tmp):"m" (*(unsigned long *) s));
124 		n -= 8;
125 		s += 8;
126 		*(unsigned long *) d = tmp;
127 		d += 8;
128 	}
129 	n += 8;
130 	DO_REST_ALIGNED_UP(d,s,n);
131 }
132 static inline void __memcpy_aligned_dn (unsigned long d, unsigned long s,
133 					long n)
134 {
135 	s += n;
136 	d += n;
137 	ALIGN_DEST_TO8_DN(d,s,n);
138 	n -= 8;
139 	while (n >= 0) {
140 		unsigned long tmp;
141 		s -= 8;
142 		__asm__("ldq %0,%1":"=r" (tmp):"m" (*(unsigned long *) s));
143 		n -= 8;
144 		d -= 8;
145 		*(unsigned long *) d = tmp;
146 	}
147 	n += 8;
148 	DO_REST_ALIGNED_DN(d,s,n);
149 }
150 
151 void * memcpy(void * dest, const void *src, size_t n)
152 {
153 	if (!(((unsigned long) dest ^ (unsigned long) src) & 7)) {
154 		__memcpy_aligned_up ((unsigned long) dest, (unsigned long) src,
155 				     n);
156 		return dest;
157 	}
158 	__memcpy_unaligned_up ((unsigned long) dest, (unsigned long) src, n);
159 	return dest;
160 }
161 
162 /* For backward modules compatibility, define __memcpy.  */
163 asm("__memcpy = memcpy; .globl __memcpy");
164