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
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
|
/*
* Copyright (C) ST-Ericsson SA 2010
* Author: Jean-Philippe FASSINO <jean-philippe.fassino@stericsson.com> for ST-Ericsson.
* License terms: GNU General Public License (GPL) version 2.
*/
/*
*
*/
#include <cm/engine/utils/inc/swap.h>
/*
* Methods
*/
t_uint16 swap16(t_uint16 x)
{
return ((x >> 8) |
((x << 8) & 0xff00U));
}
#ifdef LINUX
#if defined(__STN_8815) /* __STN_8815 -> ARMv5*/
t_uint32 swap32(t_uint32 x)
{
asm volatile (
"EOR r1, r0, r0, ROR #16 \n\t"
"BIC r1, r1, #0xFF0000 \n\t"
"MOV r0, r0, ROR #8 \n\t"
"EOR r0, r0, r1, LSR #8"
: : : "r3" );
return x;
}
t_uint64 swap64(t_uint64 x)
{
asm volatile (
"MOV r2, r1 \n\t"
" \n\t"
"EOR r3, r0, r0, ROR #16 \n\t"
"BIC r3, r3, #0xFF0000 \n\t"
"MOV r0, r0, ROR #8 \n\t"
"EOR r1, r0, r3, LSR #8 \n\t"
" \n\t"
"EOR r3, r2, r2, ROR #16 \n\t"
"BIC r3, r3, #0xFF0000 \n\t"
"MOV r2, r2, ROR #8 \n\t"
"EOR r0, r2, r3, LSR #8"
: : : "r3", "r2" );
return x;
}
#else /* -> ARMv6 or later */
t_uint32 swap32(t_uint32 x)
{
asm volatile (
"REV %0, %0"
: "+r"(x) : );
return x;
}
t_uint64 swap64(t_uint64 x)
{
asm volatile (
"REV r2, %Q0 \n\t"
"REV %Q0, %R0 \n\t"
"MOV %R0, r2"
: "+&r" (x) : : "r2" );
return x;
}
#endif
#else /* Symbian, Think -> We assume ARMCC */
#if defined(__thumb__)
t_uint32 swap32(t_uint32 x)
{
return ((x >> 24) |
((x >> 8) & 0xff00U) |
((x << 8) & 0xff0000U) |
((x << 24) & 0xff000000U));
}
t_uint64 swap64(t_uint64 x)
{
return ((x >> 56) |
((x >> 40) & 0xff00UL) |
((x >> 24) & 0xff0000UL) |
((x >> 8) & 0xff000000UL) |
((x << 8) & 0xff00000000ULL) |
((x << 24) & 0xff0000000000ULL) |
((x << 40) & 0xff000000000000ULL) |
((x << 56)));
}
#elif (__TARGET_ARCH_ARM < 6)
__asm t_uint32 swap32(t_uint32 x)
{
EOR r1, r0, r0, ROR #16
BIC r1, r1, #0xFF0000
MOV r0, r0, ROR #8
EOR r0, r0, r1, LSR #8
BX lr
}
__asm t_uint64 swap64(t_uint64 x)
{
MOV r2, r1
EOR r3, r0, r0, ROR #16 // Swap low (r0) and store it in high (r1)
BIC r3, r3, #0xFF0000
MOV r0, r0, ROR #8
EOR r1, r0, r3, LSR #8
EOR r3, r2, r2, ROR #16 // Swap high (r2 = ex r1) and store it in low (r0)
BIC r3, r3, #0xFF0000
MOV r2, r2, ROR #8
EOR r0, r2, r3, LSR #8
BX lr
}
#else /* -> ARMv6 or later */
__asm t_uint32 swap32(t_uint32 x)
{
REV r0, r0
BX lr
}
__asm t_uint64 swap64(t_uint64 x)
{
REV r2, r0
REV r0, r1
MOV r1, r2
BX lr
}
#endif
#endif
t_uint32 noswap32(t_uint32 x) {
return x;
}
|