kconfig: Don't leak choice names during parsing
[carl9170fw.git] / carlfw / src / memcpy.S
1 /* $Id: memcpy.S,v 1.3 2001/07/27 11:50:52 gniibe Exp $
2  *
3  * "memcpy" implementation of SuperH
4  *
5  * Copyright (C) 1999  Niibe Yutaka
6  *
7  */
8
9 /*
10  * void *memcpy(void *dst, const void *src, size_t n);
11  * No overlap between the memory of DST and of SRC are assumed.
12  */
13
14         .globl _memcpy
15         .align 2
16         _memcpy:
17         tst     r6,r6
18         bt/s    9f              ! if n=0, do nothing
19          mov    r4,r0
20         sub     r4,r5           ! From here, r5 has the distance to r0
21         add     r6,r0           ! From here, r0 points the end of copying point
22         mov     #12,r1
23         cmp/gt  r6,r1
24         bt/s    7f              ! if it's too small, copy a byte at once
25          add    #-1,r5
26         add     #1,r5
27         !                       From here, r6 is free
28         !
29         !      r4   -->  [ ...  ] DST             [ ...  ] SRC
30         !                [ ...  ]                 [ ...  ]
31         !                  :                        :
32         !      r0   -->  [ ...  ]       r0+r5 --> [ ...  ]
33         !
34         !
35         mov     r5,r1
36         mov     #3,r2
37         and     r2,r1
38         shll2   r1
39         mov     r0,r3           ! Save the value on R0 to R3
40         mova    jmptable,r0
41         add     r1,r0
42         mov.l   @r0,r1
43         jmp     @r1
44          mov    r3,r0           ! and back to R0
45         .balign 4
46 jmptable:
47         .long   case0
48         .long   case1
49         .long   case2
50         .long   case3
51
52         ! copy a byte at once
53 7:      mov     r4,r2
54         add     #1,r2
55 8:
56         cmp/hi  r2,r0
57         mov.b   @(r0,r5),r1
58         bt/s    8b                      ! while (r0>r2)
59          mov.b  r1,@-r0
60 9:
61         rts
62          nop
63
64 case0:
65         !
66         !       GHIJ KLMN OPQR -->  GHIJ KLMN OPQR
67         !
68         ! First, align to long word boundary
69         mov     r0,r3
70         and     r2,r3
71         tst     r3,r3
72         bt/s    2f
73          add    #-4,r5
74         add     #3,r5
75 1:      dt      r3
76         mov.b   @(r0,r5),r1
77         bf/s    1b
78          mov.b  r1,@-r0
79         !
80         add     #-3,r5
81 2:      ! Second, copy a long word at once
82         mov     r4,r2
83         add     #7,r2
84 3:      mov.l   @(r0,r5),r1
85         cmp/hi  r2,r0
86         bt/s    3b
87          mov.l  r1,@-r0
88         !
89         ! Third, copy a byte at once, if necessary
90         cmp/eq  r4,r0
91         bt/s    9b
92          add    #3,r5
93         bra     8b
94          add    #-6,r2
95
96 case1:
97         !
98         !       GHIJ KLMN OPQR -->  ...G HIJK LMNO PQR.
99         !
100         ! First, align to long word boundary
101         mov     r0,r3
102         and     r2,r3
103         tst     r3,r3
104         bt/s    2f
105          add    #-1,r5
106 1:      dt      r3
107         mov.b   @(r0,r5),r1
108         bf/s    1b
109          mov.b  r1,@-r0
110         !
111 2:      ! Second, read a long word and write a long word at once
112         mov.l   @(r0,r5),r1
113         add     #-4,r5
114         mov     r4,r2
115         add     #7,r2
116         !
117 #ifdef __LITTLE_ENDIAN__
118 3:      mov     r1,r3           ! RQPO
119         shll16  r3
120         shll8   r3              ! Oxxx
121         mov.l   @(r0,r5),r1     ! NMLK
122         mov     r1,r6
123         shlr8   r6              ! xNML
124         or      r6,r3           ! ONML
125         cmp/hi  r2,r0
126         bt/s    3b
127          mov.l  r3,@-r0
128 #else
129 3:      mov     r1,r3           ! OPQR
130         shlr16  r3
131         shlr8   r3              ! xxxO
132         mov.l   @(r0,r5),r1     ! KLMN
133         mov     r1,r6
134         shll8   r6              ! LMNx
135         or      r6,r3           ! LMNO
136         cmp/hi  r2,r0
137         bt/s    3b
138          mov.l  r3,@-r0
139 #endif
140         !
141         ! Third, copy a byte at once, if necessary
142         cmp/eq  r4,r0
143         bt/s    9b
144          add    #4,r5
145         bra     8b
146          add    #-6,r2
147
148 case2:
149         !
150         !       GHIJ KLMN OPQR -->  ..GH IJKL MNOP QR..
151         !
152         ! First, align to word boundary
153         tst     #1,r0
154         bt/s    2f
155          add    #-1,r5
156         mov.b   @(r0,r5),r1
157         mov.b   r1,@-r0
158         !
159 2:      ! Second, read a word and write a word at once
160         add     #-1,r5
161         mov     r4,r2
162         add     #3,r2
163         !
164 3:      mov.w   @(r0,r5),r1
165         cmp/hi  r2,r0
166         bt/s    3b
167          mov.w  r1,@-r0
168         !
169         ! Third, copy a byte at once, if necessary
170         cmp/eq  r4,r0
171         bt/s    9b
172          add    #1,r5
173         mov.b   @(r0,r5),r1
174         rts
175          mov.b  r1,@-r0
176
177 case3:
178         !
179         !       GHIJ KLMN OPQR -->  .GHI JKLM NOPQ R...
180         !
181         ! First, align to long word boundary
182         mov     r0,r3
183         and     r2,r3
184         tst     r3,r3
185         bt/s    2f
186          add    #-1,r5
187 1:      dt      r3
188         mov.b   @(r0,r5),r1
189         bf/s    1b
190          mov.b  r1,@-r0
191         !
192 2:      ! Second, read a long word and write a long word at once
193         add     #-2,r5
194         mov.l   @(r0,r5),r1
195         add     #-4,r5
196         mov     r4,r2
197         add     #7,r2
198         !
199 #ifdef __LITTLE_ENDIAN__
200 3:      mov     r1,r3           ! RQPO
201         shll8   r3              ! QPOx
202         mov.l   @(r0,r5),r1     ! NMLK
203         mov     r1,r6
204         shlr16  r6
205         shlr8   r6              ! xxxN
206         or      r6,r3           ! QPON
207         cmp/hi  r2,r0
208         bt/s    3b
209          mov.l  r3,@-r0
210 #else
211 3:      mov     r1,r3           ! OPQR
212         shlr8   r3              ! xOPQ
213         mov.l   @(r0,r5),r1     ! KLMN
214         mov     r1,r6
215         shll16  r6
216         shll8   r6              ! Nxxx
217         or      r6,r3           ! NOPQ
218         cmp/hi  r2,r0
219         bt/s    3b
220          mov.l  r3,@-r0
221 #endif
222         !
223         ! Third, copy a byte at once, if necessary
224         cmp/eq  r4,r0
225         bt/s    9b
226          add    #6,r5
227         bra     8b
228          add    #-6,r2