author | Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com> |
Tue, 11 May 2010 17:28:22 +0300 | |
branch | RCL_3 |
changeset 110 | c734af59ce98 |
parent 0 | a41df078684a |
permissions | -rw-r--r-- |
0 | 1 |
// Copyright (c) 1997-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\kernel\arm\cipc.cia |
|
15 |
// |
|
16 |
// |
|
17 |
||
18 |
#include <e32cia.h> |
|
19 |
#include <arm_mem.h> |
|
20 |
#include "execs.h" |
|
21 |
#include <kernel/kern_priv.h> |
|
22 |
||
23 |
#ifdef _DEBUG |
|
24 |
#define ASM_KILL_LINK(rp,rs) asm("mov "#rs", #0xdf ");\ |
|
25 |
asm("orr "#rs", "#rs", "#rs", lsl #8 ");\ |
|
26 |
asm("orr "#rs", "#rs", "#rs", lsl #16 ");\ |
|
27 |
asm("str "#rs", ["#rp"] ");\ |
|
28 |
asm("str "#rs", ["#rp", #4] "); |
|
29 |
#else |
|
30 |
#define ASM_KILL_LINK(rp,rs) |
|
31 |
#endif |
|
32 |
||
33 |
#ifdef __MESSAGE_MACHINE_CODED__ |
|
34 |
||
35 |
#define iMState iWaitLink.iSpare1 |
|
36 |
||
37 |
#ifdef KIPC |
|
38 |
extern "C" void __DebugMsgComplete(TInt, TInt a, TInt b, TInt c); |
|
39 |
extern "C" void __DebugMsgSessionSend(TInt a, TInt b, TInt c); |
|
40 |
#endif //KIPC |
|
41 |
||
42 |
#ifdef _DEBUG |
|
43 |
extern "C" void __FaultBadMsgPool(); |
|
44 |
extern "C" void __FaultMsgNotFree(); |
|
45 |
extern "C" void __FaultMsgInUse(); |
|
46 |
extern "C" void __FaultMsgCompleteDiscNotSent(); |
|
47 |
extern "C" void __DebugMsgAccept(TInt a, TInt b); |
|
48 |
extern "C" void __DebugMsgAccept2(TInt a, TInt b); |
|
49 |
extern "C" void __DebugMsgServerReceive(TInt a, TInt b, TInt c); |
|
50 |
#endif //_DEBUG |
|
51 |
||
52 |
extern "C" void __PanicSyncMsgSentTwice(); |
|
53 |
extern "C" void __PanicRequestAlreadyPending(); |
|
54 |
extern "C" void __PanicSessionAlreadyConnected(); |
|
55 |
extern "C" void __PanicMesAlreadyPending(); |
|
56 |
extern "C" void __SendDiscMsg(DSession*); |
|
57 |
||
58 |
__NAKED__ void ExecHandler::MessageComplete(RMessageK* /*aMsg*/, TInt /*aReason*/) |
|
59 |
{ |
|
110
c734af59ce98
Revision: 201019
Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com>
parents:
0
diff
changeset
|
60 |
asm("ldr ip, [r0, #%a0]" : : "i" _FOFF(RMessageK, iFunction)); // get iFunction, as per preprocessor |
0 | 61 |
|
62 |
// Subroutine MessageComplete |
|
63 |
// Complete an IPC message |
|
64 |
// Enter with r0=message handle, r1=completion code, ip=RMessageK::iFunction |
|
65 |
// Preserve r4-r11 |
|
66 |
// Enter and leave with system lock held |
|
67 |
asm(".global _asm_exec_MessageComplete "); |
|
68 |
asm("_asm_exec_MessageComplete: "); |
|
69 |
||
70 |
#ifdef BTRACE_CLIENT_SERVER |
|
71 |
asm("stmfd sp!,{r0,r1,ip,lr}"); |
|
110
c734af59ce98
Revision: 201019
Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com>
parents:
0
diff
changeset
|
72 |
asm("mov r2,r1"); // arg2 = aReason |
c734af59ce98
Revision: 201019
Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com>
parents:
0
diff
changeset
|
73 |
asm("mov r1,r0"); // arg1 = aMsg |
c734af59ce98
Revision: 201019
Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com>
parents:
0
diff
changeset
|
74 |
asm("ldr r0,_messageCompleteTraceHeader"); // arg0 = header |
0 | 75 |
asm("bl " CSM_ZN6BTrace4OutXEmmmm); |
76 |
asm("ldmfd sp!,{r0,r1,ip,lr}"); |
|
77 |
#endif |
|
78 |
||
79 |
asm("cmp ip, #%a0" : : "i" (RMessage2::EDisConnect)); |
|
80 |
asm("ldreq r0, [r0, #%a0]" : : "i" _FOFF(RMessageK,iSession)); |
|
110
c734af59ce98
Revision: 201019
Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com>
parents:
0
diff
changeset
|
81 |
asm("beq " CSM_ZN8DSession19CloseFromDisconnectEv ); // if disconnect, do it in C++ |
c734af59ce98
Revision: 201019
Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com>
parents:
0
diff
changeset
|
82 |
|
c734af59ce98
Revision: 201019
Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com>
parents:
0
diff
changeset
|
83 |
asm("mov r2, r1 "); // r2 = aReason |
0 | 84 |
ASM_DEBUG2(Complete,r0,r2); |
110
c734af59ce98
Revision: 201019
Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com>
parents:
0
diff
changeset
|
85 |
asm("ldr r3, [r0, #%a0]" : : "i" _FOFF(RMessageK, iSession)); // r3 = iSession |
c734af59ce98
Revision: 201019
Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com>
parents:
0
diff
changeset
|
86 |
asm("subs r1, ip, #%a0" : : "i" (RMessage2::EConnect)); // (m.iFunction == RMessage2::EConnect)? |
c734af59ce98
Revision: 201019
Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com>
parents:
0
diff
changeset
|
87 |
asm("streq r1, [r3, #%a0] " : : "i" _FOFF(DSession, iConnectMsgPtr)); // iSession->iConnectMsgPtr = NULL |
c734af59ce98
Revision: 201019
Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com>
parents:
0
diff
changeset
|
88 |
asm("ldr r1, [r3, #%a0]" : : "i" _FOFF(DSession,iAccessCount)); // r1 = iSession->iAccessCount |
c734af59ce98
Revision: 201019
Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com>
parents:
0
diff
changeset
|
89 |
asm("cmp r1, #0 "); // iAccessCount = 0? |
0 | 90 |
asm("beq 2f "); |
91 |
||
110
c734af59ce98
Revision: 201019
Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com>
parents:
0
diff
changeset
|
92 |
// !s->IsClosing() |
c734af59ce98
Revision: 201019
Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com>
parents:
0
diff
changeset
|
93 |
asm("mov r1, r0"); // r1 = RMessageK ptr |
c734af59ce98
Revision: 201019
Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com>
parents:
0
diff
changeset
|
94 |
asm("ldr r0, [r0, #%a0] " : : "i" _FOFF(RMessageK,iClient)); // r0 = iClient |
c734af59ce98
Revision: 201019
Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com>
parents:
0
diff
changeset
|
95 |
asm("ldrb ip, [r0, #%a0] " : : "i" _FOFF(DThread,iMState)); // ip = iClient->iMState |
c734af59ce98
Revision: 201019
Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com>
parents:
0
diff
changeset
|
96 |
asm("cmp ip, #%a0" : : "i" (DThread::EDead)); // (iMState == EDead)? |
c734af59ce98
Revision: 201019
Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com>
parents:
0
diff
changeset
|
97 |
asm("beq 1f "); |
c734af59ce98
Revision: 201019
Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com>
parents:
0
diff
changeset
|
98 |
|
c734af59ce98
Revision: 201019
Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com>
parents:
0
diff
changeset
|
99 |
// if (!s->IsClosing() && m.iClient->iMState != DThread::EDead) |
0 | 100 |
asm("mov ip, #1"); |
110
c734af59ce98
Revision: 201019
Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com>
parents:
0
diff
changeset
|
101 |
asm("str ip, [r1, #%a0]" : : "i" _FOFF(RMessageK, iServerLink.iNext)); // iServerLink.iNext=1 |
c734af59ce98
Revision: 201019
Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com>
parents:
0
diff
changeset
|
102 |
asm("b " CSM_ZN4Kern20QueueRequestCompleteEP7DThreadP14TClientRequesti); // tail call |
0 | 103 |
|
110
c734af59ce98
Revision: 201019
Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com>
parents:
0
diff
changeset
|
104 |
// m.iClient->iMState == DThread::EDead |
c734af59ce98
Revision: 201019
Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com>
parents:
0
diff
changeset
|
105 |
asm("1: "); // shuffle RMessageK and iFunction back to expected registers |
c734af59ce98
Revision: 201019
Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com>
parents:
0
diff
changeset
|
106 |
asm("ldr ip, [r1, #%a0]" : : "i" _FOFF(RMessageK, iFunction)); // refetch iFunction |
c734af59ce98
Revision: 201019
Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com>
parents:
0
diff
changeset
|
107 |
asm("mov r0, r1"); // r0 = RMessageK ptr |
c734af59ce98
Revision: 201019
Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com>
parents:
0
diff
changeset
|
108 |
|
c734af59ce98
Revision: 201019
Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com>
parents:
0
diff
changeset
|
109 |
// else (closing or dead) |
0 | 110 |
asm("2: "); |
110
c734af59ce98
Revision: 201019
Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com>
parents:
0
diff
changeset
|
111 |
asm("cmp ip, #%a0" : : "i" (RMessage2::EConnect)); // (m.iFunction == RMessage2::EConnect)? |
c734af59ce98
Revision: 201019
Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com>
parents:
0
diff
changeset
|
112 |
asm("bne 3f "); |
0 | 113 |
|
110
c734af59ce98
Revision: 201019
Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com>
parents:
0
diff
changeset
|
114 |
// (closing or dead) and it's a connect msg |
c734af59ce98
Revision: 201019
Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com>
parents:
0
diff
changeset
|
115 |
asm("ldr r2, [r3, #%a0] " : : "i" _FOFF(DSession, iSessionCookie)); // r2=iSession->iSessionCookie |
0 | 116 |
asm("teq r2, #0"); |
117 |
#ifdef _DEBUG |
|
118 |
asm("beq nosession "); |
|
110
c734af59ce98
Revision: 201019
Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com>
parents:
0
diff
changeset
|
119 |
asm("ldr r1, [r3, #%a0] " : : "i" _FOFF(DSession, iServer)); // r1=iSession->iServer |
0 | 120 |
asm("cmp r1, #0 "); |
121 |
asm("beq noserver "); |
|
110
c734af59ce98
Revision: 201019
Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com>
parents:
0
diff
changeset
|
122 |
asm("ldr r2, [r3, #%a0] " : : "i" (_FOFF(DSession, iDisconnectMsgPtr))); // r2=iSession->iDisconnectMsgPtr |
0 | 123 |
asm("ldr r2, [r2, #%a0] " : : "i" (_FOFF(RMessageK, iServerLink.iNext))); // r2=iDisconnectMsgPtr->iServerLink.iNext |
124 |
asm("cmp r2, #0 "); |
|
110
c734af59ce98
Revision: 201019
Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com>
parents:
0
diff
changeset
|
125 |
asm("beq __FaultMsgCompleteDiscNotSent "); // tail call to die if a session has been created and no disc msg sent |
c734af59ce98
Revision: 201019
Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com>
parents:
0
diff
changeset
|
126 |
asm("ldr r2, [r3, #%a0] " : : "i" _FOFF(DSession, iSessionCookie)); // r2=iSession->iSessionCookie |
0 | 127 |
asm("noserver: "); |
128 |
asm("teq r2, #0"); |
|
129 |
asm("nosession: "); |
|
130 |
#endif //_DEBUG |
|
131 |
asm("moveq r0, r3 "); |
|
110
c734af59ce98
Revision: 201019
Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com>
parents:
0
diff
changeset
|
132 |
asm("beq __SendDiscMsg "); // if no session object to clean up, tail call to send disc msg in C++ |
c734af59ce98
Revision: 201019
Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com>
parents:
0
diff
changeset
|
133 |
|
c734af59ce98
Revision: 201019
Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com>
parents:
0
diff
changeset
|
134 |
asm("3: "); |
c734af59ce98
Revision: 201019
Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com>
parents:
0
diff
changeset
|
135 |
asm("stmfd sp!, {r0,lr} "); |
c734af59ce98
Revision: 201019
Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com>
parents:
0
diff
changeset
|
136 |
asm("bl " CSM_ZN14TClientRequest5ResetEv); |
c734af59ce98
Revision: 201019
Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com>
parents:
0
diff
changeset
|
137 |
asm("ldmfd sp!, {r0,lr} "); |
c734af59ce98
Revision: 201019
Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com>
parents:
0
diff
changeset
|
138 |
asm("b " CSM_ZN9RMessageK8CloseRefEv); // tail call |
0 | 139 |
|
140 |
#ifdef BTRACE_CLIENT_SERVER |
|
141 |
asm("_messageCompleteTraceHeader:"); |
|
142 |
asm(".word %a0" : : "i" (BTRACE_HEADER_C(12,BTrace::EClientServer,BTrace::EMessageComplete))); |
|
143 |
asm("_messageDeliverTraceHeader:"); |
|
144 |
asm(".word %a0" : : "i" (BTRACE_HEADER_C(16,BTrace::EClientServer,BTrace::EMessageSend))); |
|
145 |
#endif |
|
146 |
||
147 |
} |
|
148 |
||
149 |
||
150 |
__NAKED__ void DServer::Deliver(RMessageK* /*aMessage*/) |
|
151 |
// |
|
152 |
// Delivers a message to the server. |
|
153 |
// |
|
154 |
{ |
|
155 |
asm("stmfd sp!, {r4-r10,lr} "); |
|
156 |
#ifdef __SMP__ |
|
157 |
GET_RWNO_TID(,r10); // NOTE: Can't migrate because we hold system lock |
|
158 |
asm("ldr r9, [r10, #%a0]" : : "i" _FOFF(TSubScheduler,iCurrentThread)); |
|
159 |
#else |
|
160 |
asm("ldr r10, __TheScheduler "); |
|
161 |
asm("ldr r9, [r10, #%a0]" : : "i" _FOFF(TScheduler,iCurrentThread)); |
|
162 |
#endif |
|
163 |
asm("bl ServerDeliver "); |
|
164 |
asm("ldmfd sp!, {r4-r10,pc} "); |
|
165 |
||
166 |
// Subroutine ServerDeliver |
|
167 |
// Deliver a message to a DServer |
|
168 |
// Enter with r0->DServer, r1->RMessageK, r10->T(Sub)Scheduler |
|
169 |
// Preserve r5,r11 but not r4,r6-r10 |
|
170 |
// Enter and leave with system lock held |
|
171 |
asm("ServerDeliver: "); |
|
172 |
||
173 |
// if (iMessage->IsReady()) { Accept(aMsg); return; } |
|
174 |
asm("ldr r12, [r0, #%a0]" : : "i" _FOFF(DServer, iMessage)); |
|
175 |
asm("ldr r2, [r12, #%a0]" : : "i" _FOFF(TServerMessage, iStatus)); |
|
176 |
asm("teq r2, #0 "); |
|
177 |
asm("beq 1f "); |
|
178 |
asm("tst r2, #%a0 " : : "i" ((TInt)KClientRequestFlagMask)); |
|
179 |
asm("beq ServerAccept "); |
|
180 |
||
181 |
asm("1: "); |
|
182 |
asm("ldr r3, [r0, #%a0]" : : "i" _FOFF(DServer,iDeliveredQ.iA.iPrev)); // r3->last entry in delivered Q |
|
183 |
asm("add r2, r0, #%a0" : : "i" _FOFF(DServer,iDeliveredQ)); // r2->iDeliveredQ |
|
184 |
// Warning: HARDCODED OFFSET(SDblQueLink) - assumes format of this structure |
|
185 |
asm("add r1, r1, #%a0" : : "i" _FOFF(RMessageK,iServerLink)); // r1->message.iServerLink |
|
186 |
asm("str r1, [r2, #4] "); // head->prev = new message |
|
187 |
asm("str r1, [r3, #0] "); // last->next=new message |
|
188 |
asm("stmia r1, {r2,r3} "); // new->next=head entry, new->prev=old last entry |
|
189 |
__JUMP(, lr); |
|
190 |
||
191 |
#ifndef __SMP__ |
|
192 |
asm("__TheScheduler: "); |
|
193 |
asm(".word TheScheduler "); |
|
194 |
#endif |
|
195 |
} |
|
196 |
||
197 |
__NAKED__ void DServer::Receive(TRequestStatus& /*aStatus*/, TAny* /*aMessage*/) |
|
198 |
// |
|
199 |
// Receive a message asynchronously. |
|
200 |
// |
|
201 |
{ |
|
202 |
asm("stmfd sp!, {r4-r10,lr} "); |
|
203 |
#ifdef __SMP__ |
|
204 |
GET_RWNO_TID(,r10); // NOTE: Can't migrate because we hold system lock |
|
205 |
#else |
|
206 |
asm("ldr r10, __TheScheduler "); |
|
207 |
#endif |
|
208 |
asm("bl _asm_exec_ServerReceive "); |
|
209 |
asm("ldmfd sp!, {r4-r10,pc} "); |
|
210 |
} |
|
211 |
||
212 |
__NAKED__ void DServer::Accept(RMessageK* /*aMsg*/) |
|
213 |
// |
|
214 |
// Accepts a message, assumes one is pending. |
|
215 |
// |
|
216 |
{ |
|
217 |
asm("stmfd sp!, {r4-r10,lr} "); |
|
218 |
#ifdef __SMP__ |
|
219 |
GET_RWNO_TID(,r10); // NOTE: Can't migrate because we hold system lock |
|
220 |
#else |
|
221 |
asm("ldr r10, __TheScheduler "); |
|
222 |
#endif |
|
223 |
asm("bl ServerAccept "); |
|
224 |
asm("ldmfd sp!, {r4-r10,pc} "); |
|
225 |
||
226 |
// Subroutine ServerReceive |
|
227 |
// Receive a message on a DServer |
|
228 |
// Enter with r0->DServer, r2=aMessage , r1=&aStatus |
|
229 |
// r10->T(Sub)Scheduler |
|
230 |
// Preserve r5,r11 but not r4,r6-r10 |
|
231 |
// Enter and leave with system lock held |
|
232 |
asm(".global _asm_exec_ServerReceive "); |
|
233 |
asm("_asm_exec_ServerReceive: "); |
|
234 |
ASM_DEBUG3(ServerReceive,r0,r1,r2); |
|
235 |
||
236 |
// if (iMessage->SetStatus(&aStatus) != KErrNone) K::PanicCurrentThread(EMesAlreadyPending); |
|
237 |
asm("ldr r4, [r0, #%a0]" : : "i" _FOFF(DServer, iMessage)); // r4->iMessage |
|
238 |
asm("stmfd sp!, {r0-r2, lr}"); |
|
239 |
asm("mov r0, r4 "); |
|
240 |
asm("bl " CSM_ZN14TClientRequest9SetStatusEP14TRequestStatus); // iMessage->SetStatus(aStatus) |
|
241 |
asm("teq r0, #0 "); |
|
242 |
asm("ldmfd sp!, {r0-r2, lr}"); |
|
243 |
asm("bne __PanicMesAlreadyPending" ); |
|
244 |
||
245 |
asm("add r3, r0, #%a0" : : "i" _FOFF(DServer, iDeliveredQ.iA)); // r3->iDeliveredQ anchor |
|
246 |
asm("ldr r1, [r3, #%a0]" : : "i" _FOFF(SDblQueLink, iNext)); // r1->first entry on delivered queue |
|
247 |
asm("str r2, [r4, #%a0]" : : "i" _FOFF(TServerMessage, iMessagePtr)); // iMessage->iMessagePtr = aMessage |
|
248 |
asm("cmp r1, r3 "); // is queue empty? |
|
249 |
__JUMP(eq, lr); // if it is, nothing else to do |
|
250 |
||
251 |
// else deque first message: NB head->iPrev = &iA for head of list |
|
252 |
asm("ldr r6, [r1, #%a0]" : : "i" _FOFF(SDblQueLink, iNext)); // r6=r1->next |
|
253 |
ASM_KILL_LINK(r1,r7); // kill link |
|
254 |
asm("str r3, [r6, #%a0]" : : "i" _FOFF(SDblQueLink, iPrev)); // r1->next->prev = r1->prev (== &iA) |
|
255 |
asm("str r6, [r3, #%a0]" : : "i" _FOFF(SDblQueLink, iNext)); // r1->prev->next (== iA.iNext) = r1->next |
|
256 |
asm("sub r1, r1, #%a0" : : "i" _FOFF(RMessageK, iServerLink)); // r1 now points to RMessageK |
|
257 |
||
258 |
// Subroutine ServerAccept |
|
259 |
// Accept a message on a DServer |
|
260 |
// Enter with r0->DServer, r1->RMessageK to accept |
|
261 |
// r10->T(Sub)Scheduler |
|
262 |
// Preserve r5,r11 but not r4,r6-r10 |
|
263 |
asm(".global ServerAccept "); |
|
264 |
asm("ServerAccept: "); |
|
265 |
asm("ldr r7, [r0, #%a0]" : : "i" _FOFF(DServer,iOwningThread)); //r7=iOwningThread |
|
266 |
asm("mvn r2, r1 "); // r2 = ~msg address |
|
267 |
asm("ldr r3, [r7, #%a0]" : : "i" _FOFF(DThread,iOwningProcess)); // r3=iOwningThread->iOwningProcess |
|
268 |
#ifdef __SMP__ |
|
269 |
asm("ldr r9, [r10, #%a0]" : : "i" _FOFF(TSubScheduler,iCurrentThread)); |
|
270 |
#else |
|
271 |
asm("ldr r9, [r10, #%a0]" : : "i" _FOFF(TScheduler,iCurrentThread)); |
|
272 |
#endif |
|
273 |
asm("ldrb r6, [r7, #%a0]" : : "i" _FOFF(DThread,iMState)); // r6=iOwningThread->iMState |
|
274 |
asm("mvn r4, r3 "); // r4 = ~owning process address |
|
275 |
asm("add ip, r1, #%a0" : : "i" _FOFF(RMessageK, iServerLink)); |
|
276 |
asm("stmia ip, {r2,r4} "); // set ACCEPTED state |
|
277 |
asm("cmp r6, #%a0" : : "i" (DThread::EDead)); // is thread dead? |
|
278 |
__JUMP(eq, lr); // if it is, exit |
|
279 |
#ifdef BTRACE_CLIENT_SERVER |
|
280 |
asm("stmfd sp!,{r0-r3,r12,lr}"); |
|
281 |
asm("ldr r0,_messageReceiveTraceHeader"); // arg0 = header |
|
282 |
asm("bl " CSM_ZN6BTrace4OutXEmmmm); |
|
283 |
asm("ldmfd sp!,{r0-r3,r12,lr}"); |
|
284 |
#endif |
|
285 |
#ifdef KIPC |
|
286 |
ASM_DEBUG2(Accept,r0,r1); |
|
287 |
#endif |
|
288 |
// iMessage->iMessageData = aMsg; |
|
289 |
asm("ldr r2, [r0, #%a0]" : : "i" _FOFF(DServer, iMessage)); |
|
290 |
asm("str r1, [r2, #%a0]" : : "i" _FOFF(TServerMessage,iMessageData)); |
|
291 |
// Kern::QueueRequestComplete(iOwningThread, iMessage, KErrNone); |
|
292 |
asm("ldr r0, [r0, #%a0]" : : "i" _FOFF(DServer,iOwningThread)); |
|
293 |
asm("mov r1, r2"); |
|
294 |
asm("mov r2, #0"); // KErrNone |
|
295 |
asm("b " CSM_ZN4Kern20QueueRequestCompleteEP7DThreadP14TClientRequesti); |
|
296 |
||
297 |
#ifdef BTRACE_CLIENT_SERVER |
|
298 |
asm("_messageReceiveTraceHeader:"); |
|
299 |
asm(".word %a0" : : "i" (BTRACE_HEADER(8,BTrace::EClientServer,BTrace::EMessageReceive))); |
|
300 |
#endif |
|
301 |
} |
|
302 |
||
303 |
#endif |
|
304 |
||
305 |
#ifdef __MESSAGE_MACHINE_CODED_2__ |
|
306 |
__NAKED__ void ExecHandler::MessageConstructFromPtr(RMessageK*, TAny*) |
|
307 |
{ |
|
308 |
// Enter with: |
|
309 |
// r0->RMessageK, r1->user side message to be populated |
|
310 |
// Can modify r0-r4, r6-r10, r12 |
|
311 |
asm("ldr r2, [r0, #%a0]" : : "i" _FOFF(RMessageK,iFunction)); // r2 = function |
|
312 |
asm("ldr r9, [r0, #%a0]" : : "i" _FOFF(RMessageK,iSession)); // r9->iSession |
|
313 |
asm("subs r3, r2, #%a0" : : "i" ((TInt)RMessage2::EDisConnect)); // is it disconnect ? if so, r3=0 |
|
314 |
asm("ldr r9, [r9, #%a0]" : : "i" _FOFF(DSession,iSessionCookie)); // r9 = user cookie |
|
315 |
asm("beq 2f "); // branch if it is |
|
316 |
||
317 |
asm("add r10, r0, #%a0" : : "i" _FOFF(RMessageK, iMsgArgs.iArgs)); |
|
318 |
// HARDCODED(RMessageK)- this assumes KMaxMessageArguments is 4 |
|
319 |
asm("ldmia r10, {r3,r4,r6,r7} "); // r3,4,6,7=args |
|
320 |
asm("stmfd sp!, {r0-r4,lr} "); |
|
321 |
asm("bl " CSM_ZN5NKern12UnlockSystemEv); |
|
322 |
asm("ldmfd sp!, {r0-r4,lr} "); |
|
323 |
USER_MEMORY_GUARD_OFF(,r8,r8); |
|
324 |
asm("mov r8, #0"); // r8=iSpare1 |
|
325 |
asm("strt r0, [r1], #4 "); // store handle |
|
326 |
asm("strt r2, [r1], #4 "); // store function |
|
327 |
asm("strt r3, [r1], #4 "); // store arg0 |
|
328 |
asm("strt r4, [r1], #4 "); // store arg1 |
|
329 |
asm("strt r6, [r1], #4 "); // store arg2 |
|
330 |
asm("strt r7, [r1], #4 "); // store arg3 |
|
331 |
asm("strt r8, [r1], #4 "); // store iSpare1 |
|
332 |
asm("strt r9, [r1], #4 "); // store user cookie |
|
333 |
USER_MEMORY_GUARD_ON(,r8,r8); |
|
334 |
__JUMP(,lr); |
|
335 |
||
336 |
// get here if disconnect message |
|
337 |
asm("2: "); |
|
338 |
asm("stmfd sp!, {r1-r3,lr} "); |
|
339 |
asm("bl " CSM_ZN5NKern12UnlockSystemEv); |
|
340 |
asm("ldmfd sp!, {r1-r3,lr} "); |
|
341 |
USER_MEMORY_GUARD_OFF(,r8,r8); |
|
342 |
asm("strt r0, [r1], #4 "); // store handle |
|
343 |
asm("strt r2, [r1], #4 "); // store function |
|
344 |
asm("strt r3, [r1], #4 "); // store arg0 = 0 |
|
345 |
asm("strt r3, [r1], #4 "); // store arg1 = 0 |
|
346 |
asm("strt r3, [r1], #4 "); // store arg2 = 0 |
|
347 |
asm("strt r3, [r1], #4 "); // store arg3 = 0 |
|
348 |
asm("strt r3, [r1], #4 "); // store capability = 0 |
|
349 |
asm("strt r9, [r1], #4 "); // store user cookie |
|
350 |
USER_MEMORY_GUARD_ON(,r8,r8); |
|
351 |
__JUMP(,lr); |
|
352 |
} |
|
353 |
||
354 |
EXPORT_C __NAKED__ RMessageK* RMessageK::MessageK(TInt /*aMsgHandle*/) |
|
355 |
{ |
|
356 |
#ifdef __SMP__ |
|
357 |
GET_RWNO_TID(,r1); // NOTE: can't migrate because system lock held |
|
358 |
#else |
|
359 |
asm("ldr r1, __TheScheduler "); |
|
360 |
#endif |
|
361 |
asm("stmfd sp!, {r4,lr} "); |
|
362 |
#ifdef __SMP__ |
|
363 |
asm("ldr r1, [r1, #%a0]" : : "i" _FOFF(TSubScheduler,iCurrentThread)); |
|
364 |
#else |
|
365 |
asm("ldr r1, [r1, #%a0]" : : "i" _FOFF(TScheduler,iCurrentThread)); |
|
366 |
#endif |
|
367 |
asm("ldr r1, [r1, #%a0]" : : "i" (_FOFF(DThread,iOwningProcess)-_FOFF(DThread,iNThread))); // r1->process to check |
|
368 |
asm("bl do_messagek "); |
|
110
c734af59ce98
Revision: 201019
Dremov Kirill (Nokia-D-MSW/Tampere) <kirill.dremov@nokia.com>
parents:
0
diff
changeset
|
369 |
asm("bcc 0f "); // if bad handle, panic |
0 | 370 |
asm("ldr ip, [r0, #%a0]" : : "i" _FOFF(RMessageK,iFunction)); // ip = function |
371 |
asm("cmp ip, #%a0" : : "i" ((TInt)RMessage2::EDisConnect)); // check iFunction != RMessage2::EDisConnect |
|
372 |
asm("ldmnefd sp!, {r4,pc} "); // if not, return OK |
|
373 |
asm("0: "); |
|
374 |
asm("mov r0, #%a0" : : "i" (EBadMessageHandle)); // panic, disconnect not allowed |
|
375 |
asm("b " CSM_ZN1K18PanicCurrentThreadEi); |
|
376 |
} |
|
377 |
||
378 |
__NAKED__ RMessageK* RMessageK::MessageK(TInt /*aMsgHandle*/, DThread* /*aThread*/) |
|
379 |
{ |
|
380 |
asm("ldr r1, [r1, #%a0]" : : "i" _FOFF(DThread,iOwningProcess)); // r1->process to check |
|
381 |
asm("do_messagek: "); |
|
382 |
asm("ldr ip, __K_MsgInfo "); // ip->msg chunk info |
|
383 |
asm("tst r0, #%a0" : : "i" (RMessageK::KMessageSize-1)); // test handle alignment |
|
384 |
asm("bne 0f "); // handle is bad if misaligned |
|
385 |
asm("ldr r2, [ip, #%a0]" : : "i" _FOFF(K::SMsgInfo,iBase)); // r2=base address of kernel msg chunk |
|
386 |
asm("ldr r3, [ip, #%a0]" : : "i" _FOFF(K::SMsgInfo,iMaxSize)); // r3=max size of kernel msg chunk |
|
387 |
asm("subs ip, r0, r2 "); // ip=aMsg-kernel msg chunk base |
|
388 |
asm("subhs r3, r3, #%a0" : : "i" ((TInt)sizeof(RMessageK)-1)); // if >=, r3=max size - (sizeof(RMessageK)-1) |
|
389 |
asm("cmphs r3, ip "); // compare this value to offset |
|
390 |
asm("bls 0f "); // if offset<0 or offset+sizeof(RMessageK)-1>=max size, bad handle |
|
391 |
||
392 |
#ifdef __OBSOLETE_V1_IPC_SUPPORT__ |
|
393 |
asm("lookup_message_client: "); |
|
394 |
#endif |
|
395 |
asm("adds ip, r0, #%a0" : : "i" _FOFF(RMessageK, iServerLink)); |
|
396 |
// NOTE: Z flag clear here after 'adds' above |
|
397 |
asm(".global __magic_address_msg_lookup_2 "); |
|
398 |
asm("__magic_address_msg_lookup_2: "); // this instruction is magically immune from exceptions |
|
399 |
// Warning: HARDCODED OFFSET(RMessageK) - assumes layout of SDblQueLink and wierd use of iServerLink |
|
400 |
asm("ldmia ip, {r2,r3} "); // get message iNext/iPrev, set Z if bad. |
|
401 |
// should have r2=~r0, r3=~r1 if OK |
|
402 |
asm("beq 0f "); // if exception, bad handle |
|
403 |
asm("eor r2, r2, r0 "); // should be 0xffffffff |
|
404 |
asm("eor r3, r3, r1 "); // should be 0xffffffff |
|
405 |
asm("and r2, r2, r3 "); // should be 0xffffffff |
|
406 |
asm("cmn r2, #1 "); |
|
407 |
__JUMP(eq, lr); // if so, message is valid, return (RMessageK*)aMsgHandle and carry=1 |
|
408 |
asm("0: "); |
|
409 |
asm("movs r0, pc, lsl #31 "); // r0=0, carry=0 (since pc is a multiple of 4) |
|
410 |
__JUMP(,lr); // return NULL |
|
411 |
||
412 |
#ifdef __OBSOLETE_V1_IPC_SUPPORT__ |
|
413 |
asm(".global do_lookup_thread_pseudo "); |
|
414 |
asm("do_lookup_thread_pseudo: "); |
|
415 |
// ip = (handle << 1) &~ 0x10000 (no close flag removed) |
|
416 |
// r1 -> current NThread |
|
417 |
asm("ldr r3, __K_MsgInfo "); // r3->msg chunk info |
|
418 |
asm("mov r0, ip, lsl #16 "); |
|
419 |
asm("ldr r1, [r1, #%a0]" : : "i" (_FOFF(DThread,iOwningProcess)-_FOFF(DThread,iNThread))); // r1->current process |
|
420 |
asm("add r0, ip, r0, lsr #16 "); // r0 = offset of RMessageK from kernel msg chunk base |
|
421 |
asm("ldr r2, [r3, #%a0]" : : "i" _FOFF(K::SMsgInfo,iBase)); // r2=base address of kernel msg chunk |
|
422 |
asm("ldr r3, [r3, #%a0]" : : "i" _FOFF(K::SMsgInfo,iMaxSize)); // r3=max size of kernel msg chunk |
|
423 |
asm("add ip, r0, #%a0" : : "i" ((TInt)sizeof(RMessageK)-1) ); // ip = offset + sizeof(RMessageK) - 1 |
|
424 |
asm("add r0, r0, r2 "); // r0 = pointer to RMessageK (if good handle) |
|
425 |
asm("cmp ip, r3 "); // is this off the end of the msg chunk? |
|
426 |
asm("blo lookup_message_client "); // if not, get client |
|
427 |
asm("b 0b "); // if so, bad handle |
|
428 |
#endif |
|
429 |
||
430 |
#if !defined(__SMP__) && !defined(__MESSAGE_MACHINE_CODED__) |
|
431 |
asm("__TheScheduler: "); |
|
432 |
asm(".word TheScheduler "); |
|
433 |
#endif |
|
434 |
asm("__K_MsgInfo: "); |
|
435 |
asm(".word " CSM_ZN1K8MsgInfoE); |
|
436 |
} |
|
437 |
#endif |