1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
|
#if defined __thumb__
#include "../../string/memset.c"
#else
#include <string.h>
#include "xscale.h"
void *
memset (void *dst, int c, size_t len)
{
int dummy;
asm volatile ("tst %0, #0x3"
#ifndef __OPTIMIZE_SIZE__
"
beq 1f
b 2f
0:
strb %1, [%0], #1
tst %0, #0x3
beq 1f
2:
movs r3, %2
sub %2, %2, #1
bne 0b
1:
cmp %2, #0x3
bls 2f
and %1, %1, #0xff
orr lr, %1, %1, asl #8
cmp %2, #0xf
orr lr, lr, lr, asl #16
bls 1f
mov r3, lr
mov r4, lr
mov r5, lr
0:
sub %2, %2, #16
stmia %0!, { r3, r4, r5, lr }
cmp %2, #0xf
bhi 0b
1:
cmp %2, #0x7
bls 1f
mov r3, lr
0:
sub %2, %2, #8
stmia %0!, { r3, lr }
cmp %2, #0x7
bhi 0b
1:
cmp %2, #0x3
bls 2f
0:
sub %2, %2, #4
str lr, [%0], #4
cmp %2, #0x3
bhi 0b
"
#endif /* !__OPTIMIZE_SIZE__ */
"
2:
movs r3, %2
sub %2, %2, #1
beq 1f
0:
movs r3, %2
sub %2, %2, #1
strb %1, [%0], #1
bne 0b
1:"
: "=&r" (dummy), "=&r" (c), "=&r" (len)
: "0" (dst), "1" (c), "2" (len)
: "memory", "r3", "r4", "r5", "lr");
return dst;
}
#endif
|
