0
|
1 |
// Copyright (c) 2008-2009 Nokia Corporation and/or its subsidiary(-ies).
|
|
2 |
// All rights reserved.
|
|
3 |
// This component and the accompanying materials are made available
|
|
4 |
// under the terms of the License "Eclipse Public License v1.0"
|
|
5 |
// which accompanies this distribution, and is available
|
|
6 |
// at the URL "http://www.eclipse.org/legal/epl-v10.html".
|
|
7 |
//
|
|
8 |
// Initial Contributors:
|
|
9 |
// Nokia Corporation - initial contribution.
|
|
10 |
//
|
|
11 |
// Contributors:
|
|
12 |
//
|
|
13 |
// Description:
|
|
14 |
// e32\common\arm\atomic_8_16_32_irq.h
|
|
15 |
// 8, 16 and 32 bit kernel side atomic operations on V5 or V6 processors
|
|
16 |
// These work by disabling interrupts
|
|
17 |
//
|
|
18 |
//
|
|
19 |
|
|
20 |
#include "atomic_ops.h"
|
|
21 |
|
|
22 |
#if defined(__OP_LOAD__)
|
|
23 |
#error Load operation not defined
|
|
24 |
#elif defined(__OP_STORE__)
|
|
25 |
#error Store operation not defined
|
|
26 |
#elif defined(__OP_RMW1__)
|
|
27 |
|
|
28 |
#if defined(__OP_SWP__)
|
|
29 |
#define __DO_PROCESSING__
|
|
30 |
#elif defined(__OP_ADD__)
|
|
31 |
#define __DO_PROCESSING__ asm("add r1, r0, r1 ");
|
|
32 |
#elif defined(__OP_AND__)
|
|
33 |
#define __DO_PROCESSING__ asm("and r1, r0, r1 ");
|
|
34 |
#elif defined(__OP_IOR__)
|
|
35 |
#define __DO_PROCESSING__ asm("orr r1, r0, r1 ");
|
|
36 |
#elif defined(__OP_XOR__)
|
|
37 |
#define __DO_PROCESSING__ asm("eor r1, r0, r1 ");
|
|
38 |
#endif
|
|
39 |
|
|
40 |
extern "C" EXPORT_C __NAKED__ __TYPE__ __fname__(__OPERATION__,rel,__DATA_SIZE__)(volatile TAny* /*a*/, __TYPE__ /*v*/)
|
|
41 |
{
|
|
42 |
// R0=a, R1=v
|
|
43 |
// return value in R0
|
|
44 |
// just fall through
|
|
45 |
}
|
|
46 |
|
|
47 |
extern "C" EXPORT_C __NAKED__ __TYPE__ __fname__(__OPERATION__,rlx,__DATA_SIZE__)(volatile TAny* /*a*/, __TYPE__ /*v*/)
|
|
48 |
{
|
|
49 |
// R0=a, R1=v
|
|
50 |
// return value in R0
|
|
51 |
// just fall through
|
|
52 |
}
|
|
53 |
|
|
54 |
extern "C" EXPORT_C __NAKED__ __TYPE__ __fname__(__OPERATION__,ord,__DATA_SIZE__)(volatile TAny* /*a*/, __TYPE__ /*v*/)
|
|
55 |
{
|
|
56 |
// R0=a, R1=v
|
|
57 |
// return value in R0
|
|
58 |
// just fall through
|
|
59 |
}
|
|
60 |
|
|
61 |
extern "C" EXPORT_C __NAKED__ __TYPE__ __fname__(__OPERATION__,acq,__DATA_SIZE__)(volatile TAny* /*a*/, __TYPE__ /*v*/)
|
|
62 |
{
|
|
63 |
// R0=a, R1=v
|
|
64 |
// return value in R0
|
|
65 |
asm("mov r3, r0 ");
|
|
66 |
__DISABLE_INTERRUPTS__(r12,r2);
|
|
67 |
__LDR_INST__( ," r0, [r3] ");
|
|
68 |
__DO_PROCESSING__
|
|
69 |
__STR_INST__( ," r1, [r3] ");
|
|
70 |
__RESTORE_INTERRUPTS__(r12);
|
|
71 |
__JUMP(,lr);
|
|
72 |
}
|
|
73 |
|
|
74 |
#undef __DO_PROCESSING__
|
|
75 |
|
|
76 |
|
|
77 |
#elif defined(__OP_CAS__)
|
|
78 |
extern "C" EXPORT_C __NAKED__ TBool __fname__(__OPERATION__,rel,__DATA_SIZE__)(volatile TAny* /*a*/, __TYPE__ * /*q*/, __TYPE__ /*v*/)
|
|
79 |
{
|
|
80 |
// R0=a, R1=q, R2=v
|
|
81 |
// return value in R0
|
|
82 |
// just fall through
|
|
83 |
}
|
|
84 |
|
|
85 |
extern "C" EXPORT_C __NAKED__ TBool __fname__(__OPERATION__,rlx,__DATA_SIZE__)(volatile TAny* /*a*/, __TYPE__ * /*q*/, __TYPE__ /*v*/)
|
|
86 |
{
|
|
87 |
// R0=a, R1=q, R2=v
|
|
88 |
// return value in R0
|
|
89 |
// just fall through
|
|
90 |
}
|
|
91 |
|
|
92 |
extern "C" EXPORT_C __NAKED__ TBool __fname__(__OPERATION__,ord,__DATA_SIZE__)(volatile TAny* /*a*/, __TYPE__ * /*q*/, __TYPE__ /*v*/)
|
|
93 |
{
|
|
94 |
// R0=a, R1=q, R2=v
|
|
95 |
// return value in R0
|
|
96 |
// just fall through
|
|
97 |
}
|
|
98 |
|
|
99 |
extern "C" EXPORT_C __NAKED__ TBool __fname__(__OPERATION__,acq,__DATA_SIZE__)(volatile TAny* /*a*/, __TYPE__ * /*q*/, __TYPE__ /*v*/)
|
|
100 |
{
|
|
101 |
// R0=a, R1=q, R2=v
|
|
102 |
// return value in R0
|
|
103 |
asm("str r4, [sp, #-4]! ");
|
|
104 |
__LDR_INST__( ," r4, [r1] ");
|
|
105 |
__DISABLE_INTERRUPTS__(r12,r3);
|
|
106 |
__LDR_INST__( ," r3, [r0] ");
|
|
107 |
asm("cmp r3, r4 ");
|
|
108 |
__STR_INST__(eq," r2, [r0] ");
|
|
109 |
__RESTORE_INTERRUPTS__(r12);
|
|
110 |
__STR_INST__(ne," r3, [r1] ");
|
|
111 |
asm("ldr r4, [sp], #4 ");
|
|
112 |
asm("movne r0, #0 ");
|
|
113 |
asm("moveq r0, #1 ");
|
|
114 |
__JUMP(,lr);
|
|
115 |
}
|
|
116 |
|
|
117 |
|
|
118 |
#elif defined(__OP_AXO__)
|
|
119 |
extern "C" EXPORT_C __NAKED__ __TYPE__ __fname__(__OPERATION__,rel,__DATA_SIZE__)(volatile TAny* /*a*/, __TYPE__ /*u*/, __TYPE__ /*v*/)
|
|
120 |
{
|
|
121 |
// R0=a, R1=u, R2=v
|
|
122 |
// return value in R0
|
|
123 |
// just fall through
|
|
124 |
}
|
|
125 |
|
|
126 |
extern "C" EXPORT_C __NAKED__ __TYPE__ __fname__(__OPERATION__,rlx,__DATA_SIZE__)(volatile TAny* /*a*/, __TYPE__ /*u*/, __TYPE__ /*v*/)
|
|
127 |
{
|
|
128 |
// R0=a, R1=u, R2=v
|
|
129 |
// return value in R0
|
|
130 |
// just fall through
|
|
131 |
}
|
|
132 |
|
|
133 |
extern "C" EXPORT_C __NAKED__ __TYPE__ __fname__(__OPERATION__,ord,__DATA_SIZE__)(volatile TAny* /*a*/, __TYPE__ /*u*/, __TYPE__ /*v*/)
|
|
134 |
{
|
|
135 |
// R0=a, R1=u, R2=v
|
|
136 |
// return value in R0
|
|
137 |
// just fall through
|
|
138 |
}
|
|
139 |
|
|
140 |
extern "C" EXPORT_C __NAKED__ __TYPE__ __fname__(__OPERATION__,acq,__DATA_SIZE__)(volatile TAny* /*a*/, __TYPE__ /*u*/, __TYPE__ /*v*/)
|
|
141 |
{
|
|
142 |
// R0=a, R1=u, R2=v
|
|
143 |
// return value in R0
|
|
144 |
asm("mov r3, r0 ");
|
|
145 |
__DISABLE_INTERRUPTS__(r12,r0);
|
|
146 |
__LDR_INST__( ," r0, [r3] ");
|
|
147 |
asm("and r1, r0, r1 ");
|
|
148 |
asm("eor r1, r1, r2 ");
|
|
149 |
__STR_INST__( ," r1, [r3] ");
|
|
150 |
__RESTORE_INTERRUPTS__(r12);
|
|
151 |
__JUMP(,lr);
|
|
152 |
}
|
|
153 |
|
|
154 |
|
|
155 |
#elif defined(__OP_RMW3__)
|
|
156 |
extern "C" EXPORT_C __NAKED__ __TYPE__ __fname__(__OPERATION__,rel,__DATA_SIZE__)(volatile TAny* /*a*/, __TYPE__ /*t*/, __TYPE__ /*u*/, __TYPE__ /*v*/)
|
|
157 |
{
|
|
158 |
// R0=a, R1=t, R2=u, R3=v
|
|
159 |
// return value in R0
|
|
160 |
// just fall through
|
|
161 |
}
|
|
162 |
|
|
163 |
extern "C" EXPORT_C __NAKED__ __TYPE__ __fname__(__OPERATION__,rlx,__DATA_SIZE__)(volatile TAny* /*a*/, __TYPE__ /*t*/, __TYPE__ /*u*/, __TYPE__ /*v*/)
|
|
164 |
{
|
|
165 |
// R0=a, R1=t, R2=u, R3=v
|
|
166 |
// return value in R0
|
|
167 |
// just fall through
|
|
168 |
}
|
|
169 |
|
|
170 |
extern "C" EXPORT_C __NAKED__ __TYPE__ __fname__(__OPERATION__,ord,__DATA_SIZE__)(volatile TAny* /*a*/, __TYPE__ /*t*/, __TYPE__ /*u*/, __TYPE__ /*v*/)
|
|
171 |
{
|
|
172 |
// R0=a, R1=t, R2=u, R3=v
|
|
173 |
// return value in R0
|
|
174 |
// just fall through
|
|
175 |
}
|
|
176 |
|
|
177 |
extern "C" EXPORT_C __NAKED__ __TYPE__ __fname__(__OPERATION__,acq,__DATA_SIZE__)(volatile TAny* /*a*/, __TYPE__ /*t*/, __TYPE__ /*u*/, __TYPE__ /*v*/)
|
|
178 |
{
|
|
179 |
// R0=a, R1=t, R2=u, R3=v
|
|
180 |
// return value in R0
|
|
181 |
asm("mov r12, r0 ");
|
|
182 |
asm("str r4, [sp, #-4]! ");
|
|
183 |
__DISABLE_INTERRUPTS__(r4,r0);
|
|
184 |
#if defined(__OP_TAU__)
|
|
185 |
__LDR_INST__( ," r0, [r12] ");
|
|
186 |
asm("cmp r0, r1 ");
|
|
187 |
asm("addcs r1, r0, r2 ");
|
|
188 |
asm("addcc r1, r0, r3 ");
|
|
189 |
#elif defined(__OP_TAS__)
|
|
190 |
__LDRS_INST__( ," r0, [r12] ");
|
|
191 |
asm("cmp r0, r1 ");
|
|
192 |
asm("addge r1, r0, r2 ");
|
|
193 |
asm("addlt r1, r0, r3 ");
|
|
194 |
#endif
|
|
195 |
__STR_INST__( ," r1, [r12] ");
|
|
196 |
__RESTORE_INTERRUPTS__(r4);
|
|
197 |
asm("ldr r4, [sp], #4 ");
|
|
198 |
__JUMP(,lr);
|
|
199 |
}
|
|
200 |
|
|
201 |
|
|
202 |
#endif
|
|
203 |
|
|
204 |
// Second inclusion undefines temporaries
|
|
205 |
#include "atomic_ops.h"
|