author | William Roberts <williamr@symbian.org> |
Mon, 28 Jun 2010 11:25:30 +0100 | |
branch | GCC_SURGE |
changeset 184 | 0e2270015475 |
parent 109 | b3a1d9898418 |
permissions | -rw-r--r-- |
// Copyright (c) 1997-2009 Nokia Corporation and/or its subsidiary(-ies). // All rights reserved. // This component and the accompanying materials are made available // under the terms of the License "Eclipse Public License v1.0" // which accompanies this distribution, and is available // at the URL "http://www.eclipse.org/legal/epl-v10.html". // // Initial Contributors: // Nokia Corporation - initial contribution. // // Contributors: // // Description: // e32\kernel\arm\cipc.cia // // #include <e32cia.h> #include <arm_mem.h> #include "execs.h" #include <kernel/kern_priv.h> #ifdef _DEBUG #define ASM_KILL_LINK(rp,rs) asm("mov "#rs", #0xdf ");\ asm("orr "#rs", "#rs", "#rs", lsl #8 ");\ asm("orr "#rs", "#rs", "#rs", lsl #16 ");\ asm("str "#rs", ["#rp"] ");\ asm("str "#rs", ["#rp", #4] "); #else #define ASM_KILL_LINK(rp,rs) #endif #ifdef __MESSAGE_MACHINE_CODED__ #define iMState iWaitLink.iSpare1 #ifdef KIPC extern "C" void __DebugMsgComplete(TInt, TInt a, TInt b, TInt c); extern "C" void __DebugMsgSessionSend(TInt a, TInt b, TInt c); #endif //KIPC #ifdef _DEBUG extern "C" void __FaultBadMsgPool(); extern "C" void __FaultMsgNotFree(); extern "C" void __FaultMsgInUse(); extern "C" void __FaultMsgCompleteDiscNotSent(); extern "C" void __DebugMsgAccept(TInt a, TInt b); extern "C" void __DebugMsgAccept2(TInt a, TInt b); extern "C" void __DebugMsgServerReceive(TInt a, TInt b, TInt c); #endif //_DEBUG extern "C" void __PanicSyncMsgSentTwice(); extern "C" void __PanicRequestAlreadyPending(); extern "C" void __PanicSessionAlreadyConnected(); extern "C" void __PanicMesAlreadyPending(); extern "C" void __SendDiscMsg(DSession*); __NAKED__ void ExecHandler::MessageComplete(RMessageK* /*aMsg*/, TInt /*aReason*/) { asm("ldr ip, [r0, #%a0]" : : "i" _FOFF(RMessageK, iFunction)); // get iFunction, as per preprocessor // Subroutine MessageComplete // Complete an IPC message // Enter with r0=message handle, r1=completion code, ip=RMessageK::iFunction // Preserve r4-r11 // Enter and leave with system lock held asm(".global _asm_exec_MessageComplete "); asm("_asm_exec_MessageComplete: "); #ifdef BTRACE_CLIENT_SERVER asm("stmfd sp!,{r0,r1,ip,lr}"); asm("mov r2,r1"); // arg2 = aReason asm("mov r1,r0"); // arg1 = aMsg asm("ldr r0,_messageCompleteTraceHeader"); // arg0 = header asm("bl " CSM_ZN6BTrace4OutXEmmmm); asm("ldmfd sp!,{r0,r1,ip,lr}"); #endif asm("cmp ip, #%a0" : : "i" (RMessage2::EDisConnect)); asm("ldreq r0, [r0, #%a0]" : : "i" _FOFF(RMessageK,iSession)); asm("beq " CSM_ZN8DSession19CloseFromDisconnectEv ); // if disconnect, do it in C++ asm("mov r2, r1 "); // r2 = aReason ASM_DEBUG2(Complete,r0,r2); asm("ldr r3, [r0, #%a0]" : : "i" _FOFF(RMessageK, iSession)); // r3 = iSession asm("subs r1, ip, #%a0" : : "i" (RMessage2::EConnect)); // (m.iFunction == RMessage2::EConnect)? asm("streq r1, [r3, #%a0] " : : "i" _FOFF(DSession, iConnectMsgPtr)); // iSession->iConnectMsgPtr = NULL asm("ldr r1, [r3, #%a0]" : : "i" _FOFF(DSession,iAccessCount)); // r1 = iSession->iAccessCount asm("cmp r1, #0 "); // iAccessCount = 0? asm("beq 2f "); // !s->IsClosing() asm("mov r1, r0"); // r1 = RMessageK ptr asm("ldr r0, [r0, #%a0] " : : "i" _FOFF(RMessageK,iClient)); // r0 = iClient asm("ldrb ip, [r0, #%a0] " : : "i" _FOFF(DThread,iMState)); // ip = iClient->iMState asm("cmp ip, #%a0" : : "i" (DThread::EDead)); // (iMState == EDead)? asm("beq 1f "); // if (!s->IsClosing() && m.iClient->iMState != DThread::EDead) asm("mov ip, #1"); asm("str ip, [r1, #%a0]" : : "i" _FOFF(RMessageK, iServerLink.iNext)); // iServerLink.iNext=1 asm("b " CSM_ZN4Kern20QueueRequestCompleteEP7DThreadP14TClientRequesti); // tail call // m.iClient->iMState == DThread::EDead asm("1: "); // shuffle RMessageK and iFunction back to expected registers asm("ldr ip, [r1, #%a0]" : : "i" _FOFF(RMessageK, iFunction)); // refetch iFunction asm("mov r0, r1"); // r0 = RMessageK ptr // else (closing or dead) asm("2: "); asm("cmp ip, #%a0" : : "i" (RMessage2::EConnect)); // (m.iFunction == RMessage2::EConnect)? asm("bne 3f "); // (closing or dead) and it's a connect msg asm("ldr r2, [r3, #%a0] " : : "i" _FOFF(DSession, iSessionCookie)); // r2=iSession->iSessionCookie asm("teq r2, #0"); #ifdef _DEBUG asm("beq nosession "); asm("ldr r1, [r3, #%a0] " : : "i" _FOFF(DSession, iServer)); // r1=iSession->iServer asm("cmp r1, #0 "); asm("beq noserver "); asm("ldr r2, [r3, #%a0] " : : "i" (_FOFF(DSession, iDisconnectMsgPtr))); // r2=iSession->iDisconnectMsgPtr asm("ldr r2, [r2, #%a0] " : : "i" (_FOFF(RMessageK, iServerLink.iNext))); // r2=iDisconnectMsgPtr->iServerLink.iNext asm("cmp r2, #0 "); asm("beq __FaultMsgCompleteDiscNotSent "); // tail call to die if a session has been created and no disc msg sent asm("ldr r2, [r3, #%a0] " : : "i" _FOFF(DSession, iSessionCookie)); // r2=iSession->iSessionCookie asm("noserver: "); asm("teq r2, #0"); asm("nosession: "); #endif //_DEBUG asm("moveq r0, r3 "); asm("beq __SendDiscMsg "); // if no session object to clean up, tail call to send disc msg in C++ asm("3: "); asm("stmfd sp!, {r0,lr} "); asm("bl " CSM_ZN14TClientRequest5ResetEv); asm("ldmfd sp!, {r0,lr} "); asm("b " CSM_ZN9RMessageK8CloseRefEv); // tail call #ifdef BTRACE_CLIENT_SERVER asm("_messageCompleteTraceHeader:"); asm(".word %a0" : : "i" (BTRACE_HEADER_C(12,BTrace::EClientServer,BTrace::EMessageComplete))); asm("_messageDeliverTraceHeader:"); asm(".word %a0" : : "i" (BTRACE_HEADER_C(16,BTrace::EClientServer,BTrace::EMessageSend))); #endif } __NAKED__ void DServer::Deliver(RMessageK* /*aMessage*/) // // Delivers a message to the server. // { asm("stmfd sp!, {r4-r10,lr} "); #ifdef __SMP__ GET_RWNO_TID(,r10); // NOTE: Can't migrate because we hold system lock asm("ldr r9, [r10, #%a0]" : : "i" _FOFF(TSubScheduler,iCurrentThread)); #else asm("ldr r10, __TheScheduler "); asm("ldr r9, [r10, #%a0]" : : "i" _FOFF(TScheduler,iCurrentThread)); #endif asm("bl ServerDeliver "); asm("ldmfd sp!, {r4-r10,pc} "); // Subroutine ServerDeliver // Deliver a message to a DServer // Enter with r0->DServer, r1->RMessageK, r10->T(Sub)Scheduler // Preserve r5,r11 but not r4,r6-r10 // Enter and leave with system lock held asm("ServerDeliver: "); // if (iMessage->IsReady()) { Accept(aMsg); return; } asm("ldr r12, [r0, #%a0]" : : "i" _FOFF(DServer, iMessage)); asm("ldr r2, [r12, #%a0]" : : "i" _FOFF(TServerMessage, iStatus)); asm("teq r2, #0 "); asm("beq 1f "); asm("tst r2, #%a0 " : : "i" ((TInt)KClientRequestFlagMask)); asm("beq ServerAccept "); asm("1: "); asm("ldr r3, [r0, #%a0]" : : "i" _FOFF(DServer,iDeliveredQ.iA.iPrev)); // r3->last entry in delivered Q asm("add r2, r0, #%a0" : : "i" _FOFF(DServer,iDeliveredQ)); // r2->iDeliveredQ // Warning: HARDCODED OFFSET(SDblQueLink) - assumes format of this structure asm("add r1, r1, #%a0" : : "i" _FOFF(RMessageK,iServerLink)); // r1->message.iServerLink asm("str r1, [r2, #4] "); // head->prev = new message asm("str r1, [r3, #0] "); // last->next=new message asm("stmia r1, {r2,r3} "); // new->next=head entry, new->prev=old last entry __JUMP(, lr); #ifndef __SMP__ asm("__TheScheduler: "); asm(".word TheScheduler "); #endif } __NAKED__ void DServer::Receive(TRequestStatus& /*aStatus*/, TAny* /*aMessage*/) // // Receive a message asynchronously. // { asm("stmfd sp!, {r4-r10,lr} "); #ifdef __SMP__ GET_RWNO_TID(,r10); // NOTE: Can't migrate because we hold system lock #else asm("ldr r10, __TheScheduler "); #endif asm("bl _asm_exec_ServerReceive "); asm("ldmfd sp!, {r4-r10,pc} "); } __NAKED__ void DServer::Accept(RMessageK* /*aMsg*/) // // Accepts a message, assumes one is pending. // { asm("stmfd sp!, {r4-r10,lr} "); #ifdef __SMP__ GET_RWNO_TID(,r10); // NOTE: Can't migrate because we hold system lock #else asm("ldr r10, __TheScheduler "); #endif asm("bl ServerAccept "); asm("ldmfd sp!, {r4-r10,pc} "); // Subroutine ServerReceive // Receive a message on a DServer // Enter with r0->DServer, r2=aMessage , r1=&aStatus // r10->T(Sub)Scheduler // Preserve r5,r11 but not r4,r6-r10 // Enter and leave with system lock held asm(".global _asm_exec_ServerReceive "); asm("_asm_exec_ServerReceive: "); ASM_DEBUG3(ServerReceive,r0,r1,r2); // if (iMessage->SetStatus(&aStatus) != KErrNone) K::PanicCurrentThread(EMesAlreadyPending); asm("ldr r4, [r0, #%a0]" : : "i" _FOFF(DServer, iMessage)); // r4->iMessage asm("stmfd sp!, {r0-r2, lr}"); asm("mov r0, r4 "); asm("bl " CSM_ZN14TClientRequest9SetStatusEP14TRequestStatus); // iMessage->SetStatus(aStatus) asm("teq r0, #0 "); asm("ldmfd sp!, {r0-r2, lr}"); asm("bne __PanicMesAlreadyPending" ); asm("add r3, r0, #%a0" : : "i" _FOFF(DServer, iDeliveredQ.iA)); // r3->iDeliveredQ anchor asm("ldr r1, [r3, #%a0]" : : "i" _FOFF(SDblQueLink, iNext)); // r1->first entry on delivered queue asm("str r2, [r4, #%a0]" : : "i" _FOFF(TServerMessage, iMessagePtr)); // iMessage->iMessagePtr = aMessage asm("cmp r1, r3 "); // is queue empty? __JUMP(eq, lr); // if it is, nothing else to do // else deque first message: NB head->iPrev = &iA for head of list asm("ldr r6, [r1, #%a0]" : : "i" _FOFF(SDblQueLink, iNext)); // r6=r1->next ASM_KILL_LINK(r1,r7); // kill link asm("str r3, [r6, #%a0]" : : "i" _FOFF(SDblQueLink, iPrev)); // r1->next->prev = r1->prev (== &iA) asm("str r6, [r3, #%a0]" : : "i" _FOFF(SDblQueLink, iNext)); // r1->prev->next (== iA.iNext) = r1->next asm("sub r1, r1, #%a0" : : "i" _FOFF(RMessageK, iServerLink)); // r1 now points to RMessageK // Subroutine ServerAccept // Accept a message on a DServer // Enter with r0->DServer, r1->RMessageK to accept // r10->T(Sub)Scheduler // Preserve r5,r11 but not r4,r6-r10 asm(".global ServerAccept "); asm("ServerAccept: "); asm("ldr r7, [r0, #%a0]" : : "i" _FOFF(DServer,iOwningThread)); //r7=iOwningThread asm("mvn r2, r1 "); // r2 = ~msg address asm("ldr r3, [r7, #%a0]" : : "i" _FOFF(DThread,iOwningProcess)); // r3=iOwningThread->iOwningProcess #ifdef __SMP__ asm("ldr r9, [r10, #%a0]" : : "i" _FOFF(TSubScheduler,iCurrentThread)); #else asm("ldr r9, [r10, #%a0]" : : "i" _FOFF(TScheduler,iCurrentThread)); #endif asm("ldrb r6, [r7, #%a0]" : : "i" _FOFF(DThread,iMState)); // r6=iOwningThread->iMState asm("mvn r4, r3 "); // r4 = ~owning process address asm("add ip, r1, #%a0" : : "i" _FOFF(RMessageK, iServerLink)); asm("stmia ip, {r2,r4} "); // set ACCEPTED state asm("cmp r6, #%a0" : : "i" (DThread::EDead)); // is thread dead? __JUMP(eq, lr); // if it is, exit #ifdef BTRACE_CLIENT_SERVER asm("stmfd sp!,{r0-r3,r12,lr}"); asm("ldr r0,_messageReceiveTraceHeader"); // arg0 = header asm("bl " CSM_ZN6BTrace4OutXEmmmm); asm("ldmfd sp!,{r0-r3,r12,lr}"); #endif #ifdef KIPC ASM_DEBUG2(Accept,r0,r1); #endif // iMessage->iMessageData = aMsg; asm("ldr r2, [r0, #%a0]" : : "i" _FOFF(DServer, iMessage)); asm("str r1, [r2, #%a0]" : : "i" _FOFF(TServerMessage,iMessageData)); // Kern::QueueRequestComplete(iOwningThread, iMessage, KErrNone); asm("ldr r0, [r0, #%a0]" : : "i" _FOFF(DServer,iOwningThread)); asm("mov r1, r2"); asm("mov r2, #0"); // KErrNone asm("b " CSM_ZN4Kern20QueueRequestCompleteEP7DThreadP14TClientRequesti); #ifdef BTRACE_CLIENT_SERVER asm("_messageReceiveTraceHeader:"); asm(".word %a0" : : "i" (BTRACE_HEADER(8,BTrace::EClientServer,BTrace::EMessageReceive))); #endif } #endif #ifdef __MESSAGE_MACHINE_CODED_2__ __NAKED__ void ExecHandler::MessageConstructFromPtr(RMessageK*, TAny*) { // Enter with: // r0->RMessageK, r1->user side message to be populated // Can modify r0-r4, r6-r10, r12 asm("ldr r2, [r0, #%a0]" : : "i" _FOFF(RMessageK,iFunction)); // r2 = function asm("ldr r9, [r0, #%a0]" : : "i" _FOFF(RMessageK,iSession)); // r9->iSession asm("subs r3, r2, #%a0" : : "i" ((TInt)RMessage2::EDisConnect)); // is it disconnect ? if so, r3=0 asm("ldr r9, [r9, #%a0]" : : "i" _FOFF(DSession,iSessionCookie)); // r9 = user cookie asm("beq 2f "); // branch if it is asm("add r10, r0, #%a0" : : "i" _FOFF(RMessageK, iMsgArgs.iArgs)); // HARDCODED(RMessageK)- this assumes KMaxMessageArguments is 4 asm("ldmia r10, {r3,r4,r6,r7} "); // r3,4,6,7=args asm("stmfd sp!, {r0-r4,lr} "); asm("bl " CSM_ZN5NKern12UnlockSystemEv); asm("ldmfd sp!, {r0-r4,lr} "); USER_MEMORY_GUARD_OFF(,r8,r8); asm("mov r8, #0"); // r8=iSpare1 asm("strt r0, [r1], #4 "); // store handle asm("strt r2, [r1], #4 "); // store function asm("strt r3, [r1], #4 "); // store arg0 asm("strt r4, [r1], #4 "); // store arg1 asm("strt r6, [r1], #4 "); // store arg2 asm("strt r7, [r1], #4 "); // store arg3 asm("strt r8, [r1], #4 "); // store iSpare1 asm("strt r9, [r1], #4 "); // store user cookie USER_MEMORY_GUARD_ON(,r8,r8); __JUMP(,lr); // get here if disconnect message asm("2: "); asm("stmfd sp!, {r1-r3,lr} "); asm("bl " CSM_ZN5NKern12UnlockSystemEv); asm("ldmfd sp!, {r1-r3,lr} "); USER_MEMORY_GUARD_OFF(,r8,r8); asm("strt r0, [r1], #4 "); // store handle asm("strt r2, [r1], #4 "); // store function asm("strt r3, [r1], #4 "); // store arg0 = 0 asm("strt r3, [r1], #4 "); // store arg1 = 0 asm("strt r3, [r1], #4 "); // store arg2 = 0 asm("strt r3, [r1], #4 "); // store arg3 = 0 asm("strt r3, [r1], #4 "); // store capability = 0 asm("strt r9, [r1], #4 "); // store user cookie USER_MEMORY_GUARD_ON(,r8,r8); __JUMP(,lr); } EXPORT_C __NAKED__ RMessageK* RMessageK::MessageK(TInt /*aMsgHandle*/) { #ifdef __SMP__ GET_RWNO_TID(,r1); // NOTE: can't migrate because system lock held #else asm("ldr r1, __TheScheduler "); #endif asm("stmfd sp!, {r4,lr} "); #ifdef __SMP__ asm("ldr r1, [r1, #%a0]" : : "i" _FOFF(TSubScheduler,iCurrentThread)); #else asm("ldr r1, [r1, #%a0]" : : "i" _FOFF(TScheduler,iCurrentThread)); #endif asm("ldr r1, [r1, #%a0]" : : "i" (_FOFF(DThread,iOwningProcess)-_FOFF(DThread,iNThread))); // r1->process to check asm("bl do_messagek "); asm("bcc 0f "); // if bad handle, panic asm("ldr ip, [r0, #%a0]" : : "i" _FOFF(RMessageK,iFunction)); // ip = function asm("cmp ip, #%a0" : : "i" ((TInt)RMessage2::EDisConnect)); // check iFunction != RMessage2::EDisConnect asm("ldmnefd sp!, {r4,pc} "); // if not, return OK asm("0: "); asm("mov r0, #%a0" : : "i" (EBadMessageHandle)); // panic, disconnect not allowed asm("b " CSM_ZN1K18PanicCurrentThreadEi); } __NAKED__ RMessageK* RMessageK::MessageK(TInt /*aMsgHandle*/, DThread* /*aThread*/) { asm("ldr r1, [r1, #%a0]" : : "i" _FOFF(DThread,iOwningProcess)); // r1->process to check asm("do_messagek: "); asm("ldr ip, __K_MsgInfo "); // ip->msg chunk info asm("tst r0, #%a0" : : "i" (RMessageK::KMessageSize-1)); // test handle alignment asm("bne 0f "); // handle is bad if misaligned asm("ldr r2, [ip, #%a0]" : : "i" _FOFF(K::SMsgInfo,iBase)); // r2=base address of kernel msg chunk asm("ldr r3, [ip, #%a0]" : : "i" _FOFF(K::SMsgInfo,iMaxSize)); // r3=max size of kernel msg chunk asm("subs ip, r0, r2 "); // ip=aMsg-kernel msg chunk base asm("subhs r3, r3, #%a0" : : "i" ((TInt)sizeof(RMessageK)-1)); // if >=, r3=max size - (sizeof(RMessageK)-1) asm("cmphs r3, ip "); // compare this value to offset asm("bls 0f "); // if offset<0 or offset+sizeof(RMessageK)-1>=max size, bad handle #ifdef __OBSOLETE_V1_IPC_SUPPORT__ asm("lookup_message_client: "); #endif asm("adds ip, r0, #%a0" : : "i" _FOFF(RMessageK, iServerLink)); // NOTE: Z flag clear here after 'adds' above asm(".global __magic_address_msg_lookup_2 "); asm("__magic_address_msg_lookup_2: "); // this instruction is magically immune from exceptions // Warning: HARDCODED OFFSET(RMessageK) - assumes layout of SDblQueLink and wierd use of iServerLink asm("ldmia ip, {r2,r3} "); // get message iNext/iPrev, set Z if bad. // should have r2=~r0, r3=~r1 if OK asm("beq 0f "); // if exception, bad handle asm("eor r2, r2, r0 "); // should be 0xffffffff asm("eor r3, r3, r1 "); // should be 0xffffffff asm("and r2, r2, r3 "); // should be 0xffffffff asm("cmn r2, #1 "); __JUMP(eq, lr); // if so, message is valid, return (RMessageK*)aMsgHandle and carry=1 asm("0: "); asm("movs r0, pc, lsl #31 "); // r0=0, carry=0 (since pc is a multiple of 4) __JUMP(,lr); // return NULL #ifdef __OBSOLETE_V1_IPC_SUPPORT__ asm(".global do_lookup_thread_pseudo "); asm("do_lookup_thread_pseudo: "); // ip = (handle << 1) &~ 0x10000 (no close flag removed) // r1 -> current NThread asm("ldr r3, __K_MsgInfo "); // r3->msg chunk info asm("mov r0, ip, lsl #16 "); asm("ldr r1, [r1, #%a0]" : : "i" (_FOFF(DThread,iOwningProcess)-_FOFF(DThread,iNThread))); // r1->current process asm("add r0, ip, r0, lsr #16 "); // r0 = offset of RMessageK from kernel msg chunk base asm("ldr r2, [r3, #%a0]" : : "i" _FOFF(K::SMsgInfo,iBase)); // r2=base address of kernel msg chunk asm("ldr r3, [r3, #%a0]" : : "i" _FOFF(K::SMsgInfo,iMaxSize)); // r3=max size of kernel msg chunk asm("add ip, r0, #%a0" : : "i" ((TInt)sizeof(RMessageK)-1) ); // ip = offset + sizeof(RMessageK) - 1 asm("add r0, r0, r2 "); // r0 = pointer to RMessageK (if good handle) asm("cmp ip, r3 "); // is this off the end of the msg chunk? asm("blo lookup_message_client "); // if not, get client asm("b 0b "); // if so, bad handle #endif #if !defined(__SMP__) && !defined(__MESSAGE_MACHINE_CODED__) asm("__TheScheduler: "); asm(".word TheScheduler "); #endif asm("__K_MsgInfo: "); asm(".word " CSM_ZN1K7MsgInfoE); } #endif