Merge branch 'for-linus' of git://git.monstr.eu/linux-2.6-microblaze
[linux-2.6] / arch / sh / lib64 / memset.S
1 /* Cloned and hacked for uClibc by Paul Mundt, December 2003 */
2 /* Modified by SuperH, Inc. September 2003 */
3 !
4 ! Fast SH memset
5 !
6 ! by Toshiyasu Morita (tm@netcom.com)
7 !
8 ! SH5 code by J"orn Rennecke (joern.rennecke@superh.com)
9 ! Copyright 2002 SuperH Ltd.
10 !
11
12 #if __BYTE_ORDER == __LITTLE_ENDIAN
13 #define SHHI shlld
14 #define SHLO shlrd
15 #else
16 #define SHHI shlrd
17 #define SHLO shlld
18 #endif
19
20         .section .text..SHmedia32,"ax"
21         .globl  memset
22         .type   memset, @function
23
24         .align 5
25
26 memset:
27         pta/l multiquad, tr0
28         andi r2, 7, r22
29         ptabs r18, tr2
30         mshflo.b r3,r3,r3
31         add r4, r22, r23
32         mperm.w r3, r63, r3     // Fill pattern now in every byte of r3
33
34         movi 8, r9
35         bgtu/u r23, r9, tr0 // multiquad
36
37         beqi/u r4, 0, tr2       // Return with size 0 - ensures no mem accesses
38         ldlo.q r2, 0, r7
39         shlli r4, 2, r4
40         movi -1, r8
41         SHHI r8, r4, r8
42         SHHI r8, r4, r8
43         mcmv r7, r8, r3
44         stlo.q r2, 0, r3
45         blink tr2, r63
46
47 multiquad:
48         pta/l lastquad, tr0
49         stlo.q r2, 0, r3
50         shlri r23, 3, r24
51         add r2, r4, r5
52         beqi/u r24, 1, tr0 // lastquad
53         pta/l loop, tr1
54         sub r2, r22, r25
55         andi r5, -8, r20   // calculate end address and
56         addi r20, -7*8, r8 // loop end address; This might overflow, so we need
57                            // to use a different test before we start the loop
58         bge/u r24, r9, tr1 // loop
59         st.q r25, 8, r3
60         st.q r20, -8, r3
61         shlri r24, 1, r24
62         beqi/u r24, 1, tr0 // lastquad
63         st.q r25, 16, r3
64         st.q r20, -16, r3
65         beqi/u r24, 2, tr0 // lastquad
66         st.q r25, 24, r3
67         st.q r20, -24, r3
68 lastquad:
69         sthi.q r5, -1, r3
70         blink tr2,r63
71
72 loop:
73 !!!     alloco r25, 32  // QQQ comment out for short-term fix to SHUK #3895.
74                         // QQQ commenting out is locically correct, but sub-optimal
75                         // QQQ Sean McGoogan - 4th April 2003.
76         st.q r25, 8, r3
77         st.q r25, 16, r3
78         st.q r25, 24, r3
79         st.q r25, 32, r3
80         addi r25, 32, r25
81         bgeu/l r8, r25, tr1 // loop
82
83         st.q r20, -40, r3
84         st.q r20, -32, r3
85         st.q r20, -24, r3
86         st.q r20, -16, r3
87         st.q r20, -8, r3
88         sthi.q r5, -1, r3
89         blink tr2,r63
90
91         .size   memset,.-memset