Add the rt linux 4.1.3-rt3 as base
[kvmfornfv.git] / kernel / arch / sparc / lib / bzero.S
1 /* bzero.S: Simple prefetching memset, bzero, and clear_user
2  *          implementations.
3  *
4  * Copyright (C) 2005 David S. Miller <davem@davemloft.net>
5  */
6
7 #include <linux/linkage.h>
8
9         .text
10
11 ENTRY(memset) /* %o0=buf, %o1=pat, %o2=len */
12         and             %o1, 0xff, %o3
13         mov             %o2, %o1
14         sllx            %o3, 8, %g1
15         or              %g1, %o3, %o2
16         sllx            %o2, 16, %g1
17         or              %g1, %o2, %o2
18         sllx            %o2, 32, %g1
19         ba,pt           %xcc, 1f
20          or             %g1, %o2, %o2
21
22 ENTRY(__bzero) /* %o0=buf, %o1=len */
23         clr             %o2
24 1:      mov             %o0, %o3
25         brz,pn          %o1, __bzero_done
26          cmp            %o1, 16
27         bl,pn           %icc, __bzero_tiny
28          prefetch       [%o0 + 0x000], #n_writes
29         andcc           %o0, 0x3, %g0
30         be,pt           %icc, 2f
31 1:       stb            %o2, [%o0 + 0x00]
32         add             %o0, 1, %o0
33         andcc           %o0, 0x3, %g0
34         bne,pn          %icc, 1b
35          sub            %o1, 1, %o1
36 2:      andcc           %o0, 0x7, %g0
37         be,pt           %icc, 3f
38          stw            %o2, [%o0 + 0x00]
39         sub             %o1, 4, %o1
40         add             %o0, 4, %o0
41 3:      and             %o1, 0x38, %g1
42         cmp             %o1, 0x40
43         andn            %o1, 0x3f, %o4
44         bl,pn           %icc, 5f
45          and            %o1, 0x7, %o1
46         prefetch        [%o0 + 0x040], #n_writes
47         prefetch        [%o0 + 0x080], #n_writes
48         prefetch        [%o0 + 0x0c0], #n_writes
49         prefetch        [%o0 + 0x100], #n_writes
50         prefetch        [%o0 + 0x140], #n_writes
51 4:      prefetch        [%o0 + 0x180], #n_writes
52         stx             %o2, [%o0 + 0x00]
53         stx             %o2, [%o0 + 0x08]
54         stx             %o2, [%o0 + 0x10]
55         stx             %o2, [%o0 + 0x18]
56         stx             %o2, [%o0 + 0x20]
57         stx             %o2, [%o0 + 0x28]
58         stx             %o2, [%o0 + 0x30]
59         stx             %o2, [%o0 + 0x38]
60         subcc           %o4, 0x40, %o4
61         bne,pt          %icc, 4b
62          add            %o0, 0x40, %o0
63         brz,pn          %g1, 6f
64          nop
65 5:      stx             %o2, [%o0 + 0x00]
66         subcc           %g1, 8, %g1
67         bne,pt          %icc, 5b
68          add            %o0, 0x8, %o0
69 6:      brz,pt          %o1, __bzero_done
70          nop
71 __bzero_tiny:
72 1:      stb             %o2, [%o0 + 0x00]
73         subcc           %o1, 1, %o1
74         bne,pt          %icc, 1b
75          add            %o0, 1, %o0
76 __bzero_done:
77         retl
78          mov            %o3, %o0
79 ENDPROC(__bzero)
80 ENDPROC(memset)
81
82 #define EX_ST(x,y)              \
83 98:     x,y;                    \
84         .section __ex_table,"a";\
85         .align 4;               \
86         .word 98b, __retl_o1;   \
87         .text;                  \
88         .align 4;
89
90 ENTRY(__clear_user) /* %o0=buf, %o1=len */
91         brz,pn          %o1, __clear_user_done
92          cmp            %o1, 16
93         bl,pn           %icc, __clear_user_tiny
94          EX_ST(prefetcha [%o0 + 0x00] %asi, #n_writes)
95         andcc           %o0, 0x3, %g0
96         be,pt           %icc, 2f
97 1:       EX_ST(stba     %g0, [%o0 + 0x00] %asi)
98         add             %o0, 1, %o0
99         andcc           %o0, 0x3, %g0
100         bne,pn          %icc, 1b
101          sub            %o1, 1, %o1
102 2:      andcc           %o0, 0x7, %g0
103         be,pt           %icc, 3f
104          EX_ST(stwa     %g0, [%o0 + 0x00] %asi)
105         sub             %o1, 4, %o1
106         add             %o0, 4, %o0
107 3:      and             %o1, 0x38, %g1
108         cmp             %o1, 0x40
109         andn            %o1, 0x3f, %o4
110         bl,pn           %icc, 5f
111          and            %o1, 0x7, %o1
112         EX_ST(prefetcha [%o0 + 0x040] %asi, #n_writes)
113         EX_ST(prefetcha [%o0 + 0x080] %asi, #n_writes)
114         EX_ST(prefetcha [%o0 + 0x0c0] %asi, #n_writes)
115         EX_ST(prefetcha [%o0 + 0x100] %asi, #n_writes)
116         EX_ST(prefetcha [%o0 + 0x140] %asi, #n_writes)
117 4:      EX_ST(prefetcha [%o0 + 0x180] %asi, #n_writes)
118         EX_ST(stxa      %g0, [%o0 + 0x00] %asi)
119         EX_ST(stxa      %g0, [%o0 + 0x08] %asi)
120         EX_ST(stxa      %g0, [%o0 + 0x10] %asi)
121         EX_ST(stxa      %g0, [%o0 + 0x18] %asi)
122         EX_ST(stxa      %g0, [%o0 + 0x20] %asi)
123         EX_ST(stxa      %g0, [%o0 + 0x28] %asi)
124         EX_ST(stxa      %g0, [%o0 + 0x30] %asi)
125         EX_ST(stxa      %g0, [%o0 + 0x38] %asi)
126         subcc           %o4, 0x40, %o4
127         bne,pt          %icc, 4b
128          add            %o0, 0x40, %o0
129         brz,pn          %g1, 6f
130          nop
131 5:      EX_ST(stxa      %g0, [%o0 + 0x00] %asi)
132         subcc           %g1, 8, %g1
133         bne,pt          %icc, 5b
134          add            %o0, 0x8, %o0
135 6:      brz,pt          %o1, __clear_user_done
136          nop
137 __clear_user_tiny:
138 1:      EX_ST(stba      %g0, [%o0 + 0x00] %asi)
139         subcc           %o1, 1, %o1
140         bne,pt          %icc, 1b
141          add            %o0, 1, %o0
142 __clear_user_done:
143         retl
144          clr            %o0
145 ENDPROC(__clear_user)