sl@0: // Copyright (c) 1998-2009 Nokia Corporation and/or its subsidiary(-ies).
sl@0: // All rights reserved.
sl@0: // This component and the accompanying materials are made available
sl@0: // under the terms of the License "Eclipse Public License v1.0"
sl@0: // which accompanies this distribution, and is available
sl@0: // at the URL "http://www.eclipse.org/legal/epl-v10.html".
sl@0: //
sl@0: // Initial Contributors:
sl@0: // Nokia Corporation - initial contribution.
sl@0: //
sl@0: // Contributors:
sl@0: //
sl@0: // Description:
sl@0: // e32\nkern\arm\vectors.cia
sl@0: // 
sl@0: //
sl@0: 
sl@0: #define __INCLUDE_NTHREADBASE_DEFINES__
sl@0: #include <e32cia.h>
sl@0: #include <arm.h>
sl@0: 
sl@0: void FastMutexNestAttempt();
sl@0: void FastMutexSignalError();
sl@0: extern "C" void ExcFault(TAny*);
sl@0: 
sl@0: #ifdef __CPU_HAS_MMU
sl@0: #define __USE_CP15_FAULT_INFO__
sl@0: #endif
sl@0: 
sl@0: #ifdef _DEBUG
sl@0: #define __CHECK_LOCK_STATE__
sl@0: #endif
sl@0: 
sl@0: //#define __FAULT_ON_FIQ__
sl@0: 
sl@0: #ifdef __CHECK_LOCK_STATE__
sl@0: // Check that the kernel is unlocked, no fast mutexes are held and that the thread is not in a
sl@0: // critical section.  Called when returning to user mode
sl@0: __NAKED__ void CheckLockState()
sl@0: 	{
sl@0: 	asm("stmfd sp!, {r14}");
sl@0: 	asm("ldr r12, __TheScheduler ");
sl@0: 	asm("ldr r14, [r12, #%a0]" : : "i" _FOFF(TScheduler,iKernCSLocked));
sl@0: 	asm("cmp r14, #0 ");
sl@0: 	asm("movne r12, #0xdd000000 ");
sl@0: 	asm("strne r12, [r12, #1] ");
sl@0: 	asm("ldr r12, [r12, #%a0]" : : "i" _FOFF(TScheduler,iCurrentThread));
sl@0: 	asm("ldr r14, [r12, #%a0]" : : "i" _FOFF(NThread,iHeldFastMutex));
sl@0: 	asm("cmp r14, #0 ");
sl@0: 	__CPOPRET(eq, "");
sl@0: 	asm("badLockState: ");
sl@0: 	asm("mov r12, #0xd7 ");
sl@0: 	asm("msr cpsr, r12 ");
sl@0: 	asm("mov r12, #0xdd000000 ");
sl@0: 	asm("str r12, [r12, #3] ");
sl@0: 	}
sl@0: #endif
sl@0: 
sl@0: __ASSERT_COMPILE(EUserModeCallbackRun == 0);
sl@0: 
sl@0: __NAKED__ void CallUserModeCallbacks()
sl@0: 	{
sl@0: 	// called with interrupts disabled
sl@0: 	// preserves r0 and r1 in additional to usual registers
sl@0: 	// leaves current thread in r2
sl@0: 	// the vast majority of times this is called with zero or one callback pending
sl@0: 
sl@0: 	asm(".global callUserModeCallbacks ");
sl@0: 	asm("callUserModeCallbacks: ");
sl@0: 	
sl@0: 	asm("ldr ip, __TheScheduler ");
sl@0: 	asm("ldr r2, [ip, #%a0]" : : "i" _FOFF(TScheduler, iCurrentThread));
sl@0: 
sl@0: 	asm("callUserModeCallbacks2: ");
sl@0: 
sl@0: 	USER_MEMORY_GUARD_ASSERT_ON(ip);
sl@0: 
sl@0: #ifdef __CHECK_LOCK_STATE__
sl@0: 	asm("ldr ip, [r2, #%a0]" : : "i" _FOFF(NThread,iCsCount));
sl@0: 	asm("cmp ip, #0 ");
sl@0: 	asm("bne badLockState ");
sl@0: #endif
sl@0: 		
sl@0: 	asm("ldr ip, [r2, #%a0]" : : "i" _FOFF(NThread, iUserModeCallbacks));
sl@0: 	asm("teq ip, #0");
sl@0: 	asm("bne 1f");
sl@0: 	__JUMP(,lr);
sl@0: 
sl@0: 	asm("1: ");
sl@0: 	asm("stmfd sp!, {r0-r2, r4-r11, lr}");
sl@0: 	asm("movs r4, r3");
sl@0: 	// if r3 != 0 it is the user context type to set the thread to
sl@0: 	asm("strneb r3, [r2, #%a0]" : : "i" _FOFF(NThread, iUserContextType));
sl@0: 	
sl@0: 	// Remove first callback and enter critical section - we can just set iCsCount to 1 as we are
sl@0: 	// guaranteed not be be in a critical section already
sl@0: 	asm("ldmia ip, {r1, r3} ");		// HARDCODED: TUserModeCallback layout
sl@0:     asm("mov r0, #1");
sl@0: 	asm("str r0, [r2, #%a0]" : : "i" _FOFF(NThread, iCsCount));
sl@0: 	asm("str r1, [r2, #%a0]" : : "i" _FOFF(NThread,iUserModeCallbacks));
sl@0: 	
sl@0: 	// Re-enable interrupts and call callback
sl@0: 	SET_MODE(r0, MODE_SVC, INTS_ALL_ON);
sl@0: 	asm("mov r1, #%a0 " : : "i" ((TInt)KUserModeCallbackUnqueued));
sl@0: 	asm("str r1, [ip, #%a0]" : : "i" _FOFF(TUserModeCallback, iNext));
sl@0: 	asm("mov r0, ip");
sl@0: 	asm("mov r1, #0 ");				// 0 == EUserModeCallbackRun
sl@0: 	__JUMPL(3);
sl@0: 
sl@0: 	SET_MODE(r0, MODE_SVC, INTS_ALL_OFF);
sl@0: 
sl@0: 	asm("movs r3, r4");
sl@0: 	// Leave critical section, avoid calling NKern::ThreadLeaveCS unless we have to
sl@0: 	asm("ldmfd sp!, {r0-r2, r4-r11, lr}");
sl@0: 	// reset user context type to undefined if r3 != 0
sl@0: 	asm("mov ip, #%a0" : : "i" (NThread::EContextUndefined));
sl@0: 	asm("strneb ip, [r2, #%a0]" : : "i" _FOFF(NThread, iUserContextType));
sl@0: 	asm("ldr ip, [r2, #%a0]" : : "i" _FOFF(NThread, iCsFunction));
sl@0: 	asm("teq ip, #0");
sl@0: 	asm("streq ip, [r2, #%a0]" : : "i" _FOFF(NThread, iCsCount));
sl@0: 	asm("beq callUserModeCallbacks2 ");
sl@0: 
sl@0: 	asm("leaveCS:");
sl@0: 	asm("sub sp, sp, #48 ");
sl@0: 	SET_MODE(r0, MODE_SVC, INTS_ALL_ON);
sl@0: 	asm("bl " CSM_ZN5NKern13ThreadLeaveCSEv);
sl@0: 	SET_MODE(r0, MODE_SVC, INTS_ALL_OFF);
sl@0: 	asm("ldmfd sp!, {r0-r2, r4-r11, lr}");
sl@0: 	asm("b callUserModeCallbacks2 ");
sl@0: 	}
sl@0: 
sl@0: /***************************************************************************
sl@0:  * SWI Handler
sl@0:  ***************************************************************************/
sl@0: 
sl@0: extern "C" __NAKED__ void __ArmVectorSwi()
sl@0: 	{
sl@0: 	// IRQs disabled, FIQs enabled here
sl@0: 	asm("ldr r12, [lr, #-4] ");				// get SWI opcode
sl@0: 	asm("stmfd sp!, {r11, lr} ");			// save return address, r11 for 8 byte align
sl@0: 	USER_MEMORY_GUARD_ON_IF_MODE_USR(r11);
sl@0: 	asm("ldr r11, __TheScheduler ");	
sl@0: 	asm("adr lr, fast_swi_exit ");
sl@0: 	asm("movs r12, r12, lsl #9 ");			// 512*SWI number into r12
sl@0: 	asm("bcc slow_swi ");					// bit 23=0 for slow/unprot
sl@0: 	asm("ldr r1, [r11, #%a0]" : : "i" _FOFF(TScheduler,iCurrentThread));
sl@0: 	asm("beq wait_for_any_request ");		// special case for Exec::WaitForAnyRequest
sl@0: #ifdef __CPU_ARM_HAS_CPS
sl@0: 	asm("ldr r2, [r1, #%a0]" : : "i" _FOFF(NThread,iFastExecTable));
sl@0: 	CPSIDIF;								// all interrupts off
sl@0: 	asm("ldr r3, [r2], r12, lsr #7 ");		// r3=limit, r2->dispatch table entry
sl@0: 	asm("ldr r2, [r2] ");					// r2->kernel function
sl@0: 	asm("cmp r3, r12, lsr #9 ");			// r3-SWI number
sl@0: 	__JUMP(hi, r2);							// if SWI number valid, call kernel function
sl@0: #else
sl@0: 	SET_INTS(r2, MODE_SVC, INTS_ALL_OFF);
sl@0: 	asm("ldr r2, [r1, #%a0]" : : "i" _FOFF(NThread,iFastExecTable));
sl@0: 	asm("ldr r3, [r2], r12, lsr #7 ");		// r3=limit, r2->dispatch table entry
sl@0: 	asm("cmp r3, r12, lsr #9 ");			// r3-SWI number
sl@0: 	asm("ldrhi pc, [r2] ");					// if SWI number valid, call kernel function
sl@0: #endif
sl@0: 	asm("mvn r12, #0 ");					// put invalid SWI number into r12
sl@0: 	asm("b slow_swi ");						// go through slow SWI routine to call invalid SWI handler
sl@0: 
sl@0: 	asm("fast_swi_exit: ");
sl@0: #ifdef __CHECK_LOCK_STATE__
sl@0: 	asm("mrs r12, spsr ");
sl@0: 	asm("tst r12, #0x0f ");
sl@0: 	asm("bleq  " CSM_Z14CheckLockStatev);
sl@0: #endif
sl@0: 	USER_MEMORY_GUARD_OFF_IF_MODE_USR(r11);
sl@0: 	ERRATUM_353494_MODE_CHANGE(,r11);
sl@0: 	asm("ldmfd sp!, {r11, pc}^ ");			// return and restore cpsr
sl@0: 
sl@0: 	
sl@0: 	asm("slow_swi: ");						// IRQs off, FIQs on here
sl@0: 	asm("stmfd sp!, {r3-r10} ");			// save nonvolatile registers, r3 for 8 byte align
sl@0: 	asm("ldr r9, [r11, #%a0]" : : "i" _FOFF(TScheduler,iCurrentThread));	// r9->current thread
sl@0: 	SET_INTS(lr, MODE_SVC, INTS_ALL_ON);	// all interrupts on
sl@0: 	asm("mov r10, r11 ");					// r10->scheduler
sl@0: 	asm("ldr r4, [r9, #%a0]" : : "i" _FOFF(NThread,iSlowExecTable));
sl@0: 	asm("mrs r11, spsr ");					// spsr_svc into r11
sl@0: 	asm("adr lr, slow_swi_exit ");
sl@0: 	asm("add r6, r4, r12, lsr #6 ");		// r6->dispatch table entry
sl@0: 	asm("ldr r5, [r4, #-12] ");				// r5=limit
sl@0: 	SET_INTS_1(r7, MODE_SVC, INTS_ALL_OFF);
sl@0: 	asm("cmp r5, r12, lsr #9 ");			// r5-SWI number
sl@0: 	asm("ldmhiia r6, {r5,r6} ");			// if SWI number OK, flags into r5, function addr into r6
sl@0: 	asm("ldrls pc, [r4, #-8] ");			// if SWI number invalid, call invalid handler
sl@0: 	asm("tst r5, #%a0" : : "i" ((TInt)KExecFlagExtraArgMask));	// extra arguments needed?
sl@0: 	asm("addne r2, sp, #4 ");				// if so, point r2 at saved registers on stack
sl@0: 	asm("tst r5, #%a0" : : "i" ((TInt)KExecFlagClaim));			// claim system lock?
sl@0: 	asm("beq slow_swi_no_wait ");			// skip if not
sl@0: 
sl@0: 	SET_INTS_2(r7, MODE_SVC, INTS_ALL_OFF);	// interrupts off
sl@0: #ifdef _DEBUG
sl@0: 	asm("ldr r12, [r9, #%a0]" : : "i" _FOFF(NThread,iHeldFastMutex));
sl@0: 	asm("cmp r12, #0 ");
sl@0: 	asm("bne  " CSM_Z20FastMutexNestAttemptv);	// debug check that current thread doesn't already hold a fast mutex
sl@0: #endif
sl@0: 	asm("ldr r12, [r10, #%a0]!" : : "i" _FOFF(TScheduler,iLock.iHoldingThread));	// r12=iLock.iHoldingThread
sl@0: 	SET_INTS_1(r7, MODE_SVC, INTS_ALL_ON);
sl@0: 	asm("cmp r12, #0 ");					// is system lock already held?
sl@0: 	asm("bne ss_fast_mutex_held ");			// branch if it is
sl@0: 	asm("ss_fast_mutex_obtained: ");
sl@0: 	asm("str r10, [r9, #%a0]" : : "i" _FOFF(NThread,iHeldFastMutex));	// current thread->iHeldFastMutex=&iLock
sl@0: 	asm("str r9, [r10], #-%a0" : : "i" _FOFF(TScheduler,iLock));		// iLock.iHoldingThread=current thread, r10->scheduler
sl@0: #ifdef BTRACE_FAST_MUTEX
sl@0: 	asm("ldrb r12, [r10,#%a0]" : : "i" (_FOFF(TScheduler,iFastMutexFilter)));
sl@0: 	asm("cmp r12, #0");
sl@0: 	asm("bne syslock_trace_wait");
sl@0: 	asm("syslock_trace_wait_done:");
sl@0: #endif
sl@0: 	SET_INTS_2(r7, MODE_SVC, INTS_ALL_ON);	// all interrupts on
sl@0: 
sl@0: 	asm("slow_swi_no_wait: ");
sl@0: 	asm("tst r5, #%a0" : : "i" ((TInt)KExecFlagPreprocess));	// preprocess (handle lookup)? can use r4, r7, r8, r12, r0
sl@0: 	asm("mov lr, pc ");
sl@0: 	asm("ldrne pc, [r4, #-4] ");			// call preprocess handler if required
sl@0: 	asm("mov lr, pc ");
sl@0: 	__JUMP(,r6);							// call exec function, preserve r5,r11 if release syslock not required
sl@0: 											// preserve r5,r9,r10,r11 if release required
sl@0: 	asm("tst r5, #%a0" : : "i" ((TInt)KExecFlagRelease));		// release system lock?
sl@0: 	asm("beq slow_swi_exit ");				// skip if not
sl@0: 
sl@0: 	SET_INTS(r12, MODE_SVC, INTS_ALL_OFF);	// disable interrupts
sl@0: #ifdef _DEBUG
sl@0: 	asm("add r8, r10, #%a0" : : "i" _FOFF(TScheduler,iLock));
sl@0: 	asm("ldr r12, [r9, #%a0]" : : "i" _FOFF(NThread,iHeldFastMutex));
sl@0: 	asm("cmp r12, r8 ");
sl@0: 	asm("bne  " CSM_Z20FastMutexSignalErrorv);	// debug check that current thread holds system lock
sl@0: #endif
sl@0: #ifdef BTRACE_FAST_MUTEX
sl@0: 	asm("ldrb r12, [r10,#%a0]" : : "i" (_FOFF(TScheduler,iFastMutexFilter)));
sl@0: 	asm("cmp r12, #0");
sl@0: 	asm("bne syslock_trace_signal");
sl@0: 	asm("syslock_trace_signal_done:");
sl@0: #endif
sl@0: 	asm("mov r12, #0 ");
sl@0: 	asm("str r12, [r10, #%a0]" : : "i" _FOFF(TScheduler,iLock.iHoldingThread));	// iLock.iHoldingThread=NULL
sl@0: 	asm("str r12, [r9, #%a0]" : : "i" _FOFF(NThread,iHeldFastMutex));			// current thread->iHeldFastMutex=NULL
sl@0: 	asm("ldr r3, [r10, #%a0]" : : "i" _FOFF(TScheduler,iLock.iWaiting));		// r3=iLock.iWaiting
sl@0: 	asm("str r12, [r10, #%a0]" : : "i" _FOFF(TScheduler,iLock.iWaiting));		// iLock.iWaiting=0
sl@0: 	SET_INTS_1(r8, MODE_SVC, INTS_ALL_ON);
sl@0: 	asm("cmp r3, #0 ");						// check waiting flag
sl@0: 	asm("bne ss_signal_check ");			// branch if set
sl@0: 	asm("ss_signal_done: ");
sl@0: 	SET_INTS_2(r8, MODE_SVC, INTS_ALL_ON);	// otherwise reenable interrupts
sl@0: 	
sl@0: 	asm("slow_swi_exit: ");
sl@0: #ifdef __CHECK_LOCK_STATE__
sl@0: 	asm("tst r11, #0x0f ");
sl@0: 	asm("bleq  " CSM_Z14CheckLockStatev);
sl@0: #endif
sl@0: 	SET_INTS(r12, MODE_SVC, INTS_ALL_OFF);	// disable interrupts
sl@0: 	asm("msr spsr, r11 ");					// restore spsr_svc
sl@0: 	asm("tst r11, #0x0f ");
sl@0: 	asm("mov r3, #0 ");
sl@0: #if defined(__CPU_CORTEX_A9__) && !defined(__CPU_ARM_A9_ERRATUM_571622_FIXED)
sl@0: 	asm("nop ");							// ARM Cortex-A9 MPCore erratum 571622 workaround
sl@0: 											// Insert nops so branch doesn't occur in 2nd or 3rd position after a msr spsr
sl@0: #endif
sl@0: 	asm("bleq callUserModeCallbacks ");		// call user-mode callbacks	
sl@0: 	USER_MEMORY_GUARD_OFF_IF_MODE_USR(r11);
sl@0: 	ERRATUM_353494_MODE_CHANGE(,r11);
sl@0: 	asm("ldmfd sp!, {r3-r11,pc}^ ");		// return from EXEC function
sl@0: 
sl@0: 
sl@0: 	// Come here if we need to wait for the system lock
sl@0: 	// r9->current thread, r10=&iLock, r12=iLock.iHoldingThread
sl@0: 	asm("ss_fast_mutex_held: ");
sl@0: 	asm("mov r8, #1 ");
sl@0: 	asm("str r8, [r10, #%a0]" : : "i" (_FOFF(TScheduler,iKernCSLocked)-_FOFF(TScheduler,iLock)));	// lock the kernel
sl@0: 	SET_INTS_2(r7, MODE_SVC, INTS_ALL_ON);	// enable interrupts
sl@0: 	asm("str r8, [r10, #4] ");				// iWaiting=1
sl@0: 	asm("str r10, [r9, #%a0]" : : "i" _FOFF(NThread,iWaitFastMutex));	// current thread->iWaitFastMutex=&iLock
sl@0: 	asm("stmfd sp!, {r0-r3} ");				// save exec call arguments
sl@0: 	asm("mov r0, r12 ");					// parameter for YieldTo
sl@0: 	ASM_DEBUG1(NKFMWaitYield,r0);
sl@0: 	asm("bl  " CSM_ZN10TScheduler7YieldToEP11NThreadBase);		// yield to the mutex holding thread
sl@0: 	// will not return until the mutex is free
sl@0: 	// on return r0=Scheduler,r1=0,r2!=0,r3=current thread, kernel unlocked, interrupts disabled
sl@0: 	asm("str r1, [r9, #%a0]" : : "i" _FOFF(NThread,iWaitFastMutex));	// iWaitFastMutex=NULL
sl@0: 	asm("ldmfd sp!, {r0-r3} ");				// retrieve exec call arguments
sl@0: 	asm("b ss_fast_mutex_obtained ");		// branch back to main code path
sl@0: 
sl@0: 	// Come here if we need to reschedule after releasing the system lock
sl@0: 	// kernel unlocked, interrupts enabled, r0 contains return value from Exec call
sl@0: 	// r9->current thread, r10=&TheScheduler, r3=1, r8=0x13
sl@0: 	asm("ss_signal_check: ");
sl@0: 	asm("str r3, [r10, #%a0]" : : "i" _FOFF(TScheduler,iKernCSLocked));	// lock the kernel (assumes iWaiting always 0 or 1)
sl@0: 	SET_INTS_2(r8, MODE_SVC, INTS_ALL_ON);	// reenable interrupts
sl@0: 	asm("strb r3, [r10, #%a0]" : : "i" _FOFF(TScheduler,iRescheduleNeededFlag));
sl@0: 	asm("ldr r3, [r9, #%a0]" : : "i" _FOFF(NThread,iCsFunction));	// r3=current thread->iCsFunction
sl@0: 	asm("ldr r2, [r9, #%a0]" : : "i" _FOFF(NThread,iCsCount));		// r2=current thread->iCsCount
sl@0: 	asm("mov r4, r0 ");						// save return value
sl@0: 	asm("cmp r3, #0 ");						// outstanding CS function?
sl@0: 	asm("beq 2f ");							// branch if not
sl@0: 	asm("cmp r2, #0 ");						// iCsCount!=0 ?
sl@0: 	asm("moveq r0, r9 ");					// if iCsCount=0, DoCsFunction()
sl@0: 	asm("bleq  " CSM_ZN11NThreadBase12DoCsFunctionEv);
sl@0: 	asm("2: ");
sl@0: 	asm("bl  " CSM_ZN10TScheduler10RescheduleEv);	// reschedule to allow waiting thread in
sl@0: 	asm("mov r0, r4 ");						// recover return value
sl@0: 	asm("b ss_signal_done ");				// branch back to main code path
sl@0: 
sl@0: #ifdef BTRACE_FAST_MUTEX
sl@0: 	asm("syslock_trace_wait:");
sl@0: 	asm("ldr r12, [sp,#9*4]"); // r12 = return address from SWI
sl@0: 	asm("mov r8, r3"); // save r3
sl@0: 	asm("stmdb sp!,{r0-r2,r12}"); // 4th item on stack is PC value for trace
sl@0: 	asm("ldr r0, fmwait_trace_header");
sl@0: 	asm("mov r2, r9"); // current thread
sl@0: 	asm("add r3, r10, #%a0" : : "i" _FOFF(TScheduler,iLock));
sl@0: 	asm("mov lr, pc");
sl@0: 	asm("ldr pc, [r10, #%a0]" : : "i" _FOFF(TScheduler,iBTraceHandler));	
sl@0: 	asm("ldmia sp!,{r0-r2,r12}");
sl@0: 	asm("mov r3, r8"); // restore r3
sl@0: 	asm("b syslock_trace_wait_done");
sl@0: 
sl@0: 	asm("syslock_trace_signal:");
sl@0: 	asm("ldr r12, [sp,#9*4]"); // r12 = return address from SWI
sl@0: 	asm("stmdb sp!,{r0-r2,r12}"); // 4th item on stack is PC value for trace
sl@0: 	asm("ldr r0, fmsignal_trace_header");
sl@0: 	asm("mov r2, r9"); // current thread
sl@0: 	asm("add r3, r10, #%a0" : : "i" _FOFF(TScheduler,iLock));
sl@0: 	asm("mov lr, pc");
sl@0: 	asm("ldr pc, [r10, #%a0]" : : "i" _FOFF(TScheduler,iBTraceHandler));	
sl@0: 	asm("ldmia sp!,{r0-r2,r12}");
sl@0: 	asm("b syslock_trace_signal_done");
sl@0: 
sl@0: 	asm("fmsignal_trace_header:");
sl@0: 	asm(".word %a0" : : "i" ((TInt)(16<<BTrace::ESizeIndex) + ((BTrace::EContextIdPresent|BTrace::EPcPresent) << BTrace::EFlagsIndex*8) + (BTrace::EFastMutex<< BTrace::ECategoryIndex*8) + (BTrace::EFastMutexSignal << BTrace::ESubCategoryIndex*8)) );
sl@0: 	
sl@0: 	asm("fmwait_trace_header:");
sl@0: 	asm(".word %a0" : : "i" ((TInt)(16<<BTrace::ESizeIndex) + ((BTrace::EContextIdPresent|BTrace::EPcPresent) << BTrace::EFlagsIndex*8) + (BTrace::EFastMutex << BTrace::ECategoryIndex*8) + (BTrace::EFastMutexWait << BTrace::ESubCategoryIndex*8)) );
sl@0: #endif
sl@0: 
sl@0: 	}
sl@0: 
sl@0: /***************************************************************************
sl@0:  * IRQ Postamble
sl@0:  * This routine is called after the IRQ has been dispatched
sl@0:  * spsr_irq, r4-r11 are unmodified
sl@0:  * spsr_irq,r0-r3,r12,return address are on the top of the IRQ stack
sl@0:  ***************************************************************************/
sl@0: 
sl@0: extern "C" __NAKED__ void __ArmVectorIrq()
sl@0: 	{
sl@0: 	// FIQs enabled here but not IRQs
sl@0: 	asm("ldr r1, __TheScheduler ");
sl@0: 	asm("mrs r0, spsr ");														// check interrupted mode
sl@0: 	asm("add r12, sp, #%a0 " : : "i" (4*(6+USER_MEMORY_GUARD_SAVE_WORDS)));		// r12=sp_irq+6 or 8 words
sl@0: 	asm("and r2, r0, #0x1f ");
sl@0: 	asm("ldr r3, [r1, #%a0]" : : "i" _FOFF(TScheduler,iKernCSLocked));			// r3=KernCSLocked
sl@0: 	asm("cmp r2, #0x10 ");														// check for mode_usr
sl@0: 	asm("cmpne r2, #0x13 ");													// or mode_svc
sl@0: 	asm("cmpeq r3, #0 ");														// and then check if kernel locked
sl@0: 	asm("bne IrqExit0 ");														// if wrong mode or locked, return immediately
sl@0: 	SET_INTS(r2, MODE_IRQ, INTS_ALL_OFF);										// disable FIQs before we check for reschedule
sl@0: 	asm("ldr r2, [r1, #%a0]" : : "i" _FOFF(TScheduler,iRescheduleNeededFlag));	// r2=DfcPendingFlag/RescheduleNeededFlag
sl@0: 	asm("add r3, r3, #1 ");
sl@0: 	SET_MODE_1(lr, MODE_SVC, INTS_ALL_ON);
sl@0: 	asm("cmp r2, #0 ");															// check if reschedule needed
sl@0: 	asm("beq IrqExit0 ");														// if not, return immediately
sl@0: 	asm("str r3, [r1, #%a0]" : : "i" _FOFF(TScheduler,iKernCSLocked));	// lock the kernel
sl@0: 	SET_MODE_2(lr, MODE_SVC, INTS_ALL_ON);										// mode_svc, interrupts back on
sl@0: 
sl@0: 	asm("ldmdb r12!, {r1-r3} ");												// move saved registers (r0-r3,r12,pc) over to mode_svc stack
sl@0: 	asm("stmfd sp!, {r1-r3} ");
sl@0: 	asm("ldmdb r12!, {r1-r3} ");
sl@0: 	asm("stmfd sp!, {r1-r3} ");
sl@0: 	asm("stmfd sp!, {r0,lr} ");													// store lr_svc and interrupted cpsr on current mode_svc stack
sl@0: #ifdef __USER_MEMORY_GUARDS_ENABLED__
sl@0: 	asm("ldmdb r12, {r1-r2} ");
sl@0: 	asm("stmfd sp!, {r1-r2} ");													// move user guard over to mode_svc stack
sl@0: #endif
sl@0: 
sl@0: 	SET_MODE_1(r2, MODE_SVC, INTS_ALL_ON);
sl@0: 	SET_MODE(lr, MODE_IRQ, INTS_IRQ_OFF);										// mode_irq, IRQs off
sl@0: 	asm("add sp, r12, #24 ");													// restore mode_irq stack balance
sl@0: 	SET_MODE_2(r2, MODE_SVC, INTS_ALL_ON);										// back to mode_svc, IRQs on
sl@0: 
sl@0: 	// reschedule - this also switches context if necessary
sl@0: 	// enter this function in mode_svc, interrupts on, kernel locked
sl@0: 	// exit this function in mode_svc, all interrupts off, kernel unlocked
sl@0: 	asm("irq_do_resched: ");
sl@0: 	asm("bl  " CSM_ZN10TScheduler10RescheduleEv);
sl@0: 	asm(".global irq_resched_return ");
sl@0: 	asm("irq_resched_return: ");
sl@0: 
sl@0: 	SET_MODE(r2, MODE_SVC, INTS_ALL_OFF);										// all interrupts off
sl@0: 	asm("ldr r1, [sp, #%a0] " : : "i" (4*USER_MEMORY_GUARD_SAVE_WORDS));		// get interrupted cpsr, don't unbalance stack
sl@0: 
sl@0: #ifdef __CHECK_LOCK_STATE__
sl@0: 	asm("mov r2, r12 ");
sl@0: 	asm("tst r1, #0x0f ");
sl@0: 	asm("bleq  " CSM_Z14CheckLockStatev);
sl@0: 	asm("mov r12, r2 ");
sl@0: #endif
sl@0: 
sl@0: 	asm("tst r1, #0x0f ");
sl@0: 	asm("mov r3, #%a0 " : : "i" (NThread::EContextUserIntrCallback));
sl@0: 	asm("bleq callUserModeCallbacks ");											// call user-mode callbacks		
sl@0: 	
sl@0: #ifdef __USER_MEMORY_GUARDS_ENABLED__
sl@0: 	asm("ldr r1, [sp], #%a0 " : : "i" (4*USER_MEMORY_GUARD_SAVE_WORDS));		// pop saved DACR, adjust sp
sl@0: 	USER_MEMORY_GUARD_RESTORE(r1,lr);
sl@0: #endif
sl@0: 
sl@0: 	asm("ldmfd sp!, {r1, lr} ");												// restore lr_svc
sl@0: 	asm("add sp, sp, #24 ");													// restore mode_svc stack balance
sl@0: 	asm("mov r12, sp ");														// r12=address of remaining saved registers
sl@0: 
sl@0: 	SET_MODE(r2, MODE_IRQ, INTS_ALL_OFF);										// back into mode_irq, all interrupts off
sl@0: 	
sl@0: 	asm("msr spsr, r1 ");														// interrupted cpsr into spsr_irq
sl@0: 	ERRATUM_353494_MODE_CHANGE(,r12);
sl@0: 	asm("ldmdb r12, {r0-r3,r12,pc}^ ");											// return from interrupt
sl@0: 
sl@0: 
sl@0: 	asm("IrqExit0: ");
sl@0: #ifdef __CHECK_LOCK_STATE__
sl@0: 	asm("tst r0, #0x0f ");
sl@0: 	asm("bleq  " CSM_Z14CheckLockStatev);
sl@0: #endif
sl@0: 
sl@0: 	asm("IrqExit1: ");															// entry point for __ArmVectorIrqPostambleNoResched()
sl@0: #ifdef __USER_MEMORY_GUARDS_ENABLED__
sl@0: 	asm("ldr lr, [sp], #%a0 " : : "i" (4*USER_MEMORY_GUARD_SAVE_WORDS));		// pop saved DACR, adjust sp
sl@0: 	USER_MEMORY_GUARD_RESTORE(lr,r12);
sl@0: #endif
sl@0: 
sl@0: #ifdef BTRACE_CPU_USAGE
sl@0: 	asm("ldrb r2, [r1,#%a0]" : : "i" _FOFF(TScheduler,iCpuUsageFilter));
sl@0: 	asm("mov r0, #%a0" : : "i" ((TInt)4 ) );
sl@0: 	asm("add r0, r0, #%a0" : : "i" ((TInt)(BTrace::ECpuUsage<<BTrace::ECategoryIndex*8)+(BTrace::EIrqEnd<<BTrace::ESubCategoryIndex*8)) );
sl@0: 	asm("cmp r2, #0");
sl@0: 	asm("movne lr, pc");
sl@0: 	asm("ldrne pc, [r1,#%a0]" : : "i" _FOFF(TScheduler,iBTraceHandler));
sl@0: #endif
sl@0: 	ERRATUM_353494_MODE_CHANGE(,r12);
sl@0: 	asm("ldmfd sp!, {r0-r3,r12,pc}^ ");											// return from interrupt
sl@0: 	}
sl@0: 
sl@0: /***************************************************************************
sl@0:  * IRQ Postamble which will not reschedule (can be returned to by co-resident OS).
sl@0:  * This routine is called after the IRQ has been dispatched
sl@0:  * spsr_irq, r4-r11 are unmodified
sl@0:  * spsr_irq,r0-r3,r12,return address are on the top of the IRQ stack
sl@0:  ***************************************************************************/
sl@0: 
sl@0: extern "C" EXPORT_C __NAKED__ void __ArmVectorIrqPostambleNoResched()
sl@0: 	{
sl@0: 	// FIQs enabled here but not IRQs
sl@0: 	asm("ldr r1, __TheScheduler ");
sl@0: 	asm("b IrqExit1 ");
sl@0: 	}
sl@0: 
sl@0: 
sl@0: /***************************************************************************
sl@0:  * FIQ Postamble
sl@0:  * This routine is called after the FIQ has been dispatched
sl@0:  * spsr_fiq, r0-r3 are unmodified
sl@0:  * Return address is on the top of the FIQ stack
sl@0:  ***************************************************************************/
sl@0: 
sl@0: extern "C" __NAKED__ void __ArmVectorFiq()
sl@0: 	{
sl@0: #ifdef __FAULT_ON_FIQ__
sl@0: 	asm(".word 0xe7f10f10 ");
sl@0: #endif
sl@0: 	// IRQs and FIQs disabled here
sl@0: 	// r0-r7 are unaltered from when FIQ occurred
sl@0: 	asm("ldr r9, __TheScheduler ");
sl@0: #ifdef __USER_MEMORY_GUARDS_ENABLED__
sl@0: 	asm("ldr r12, [sp], #4 ");													// pop saved DACR
sl@0: #endif
sl@0: 	asm("mrs r8, spsr ");														// check interrupted mode
sl@0: 	asm("and r10, r8, #0x1f ");
sl@0: 	asm("cmp r10, #0x10 ");														// check for mode_usr
sl@0: 	asm("ldr r11, [r9, #%a0]" : : "i" _FOFF(TScheduler,iKernCSLocked));
sl@0: 	asm("cmpne r10, #0x13 ");													// or mode_svc
sl@0: 	asm("ldreq r10, [r9, #%a0]" : : "i" _FOFF(TScheduler,iRescheduleNeededFlag));
sl@0: 	asm("cmpeq r11, #0 ");														// and check if kernel locked
sl@0: 	asm("bne FiqExit0 ");														// if wrong mode or kernel locked, return immediately
sl@0: 	asm("cmp r10, #0 ");														// check if reschedule needed
sl@0: 	asm("beq FiqExit0 ");														// if not, return from interrupt
sl@0: 
sl@0: 	// we interrupted mode_usr or mode_svc, kernel unlocked, reschedule needed
sl@0: 	asm("add r11, r11, #1 ");
sl@0: 	asm("str r11, [r9, #%a0]" : : "i" _FOFF(TScheduler,iKernCSLocked));			// lock the kernel
sl@0: 	asm("stmfd sp!, {r1-r3} ");													// save interrupted r1-r3 on FIQ stack
sl@0: 	asm("mov r1, r8 ");															// r1=interrupted cpsr
sl@0: 	asm("mov r3, sp ");															// r3 points to saved registers
sl@0: #ifdef __USER_MEMORY_GUARDS_ENABLED__
sl@0: 	asm("mov r2, r12 ");														// saved DACR into R2
sl@0: #endif
sl@0: 	SET_MODE(lr, MODE_SVC, INTS_ALL_ON);										// switch to mode_svc, IRQs and FIQs back on
sl@0: #ifdef __USER_MEMORY_GUARDS_ENABLED__
sl@0: 	asm("str r2, [sp, #%a0]! " : : "i" (-4*(8+USER_MEMORY_GUARD_SAVE_WORDS)));	// save DACR and leave room for spare, cpsr, lr_svc, r0-r3, r12, pc
sl@0: #else
sl@0: 	asm("sub sp, sp, #32 ");													// make room for saved registers on mode_svc stack
sl@0: #endif
sl@0: 	asm("ldr r2, [r3, #12] ");													// r2=return address
sl@0: 	asm("str r12, [sp, #%a0] " : : "i" (4*(6+USER_MEMORY_GUARD_SAVE_WORDS)));	// save r12 on mode_svc stack
sl@0: 	asm("str r2, [sp, #%a0] " : : "i" (4*(7+USER_MEMORY_GUARD_SAVE_WORDS)));	// save return address on mode_svc stack
sl@0: 	asm("add r12, sp, #%a0 " : : "i" (4*(USER_MEMORY_GUARD_SAVE_WORDS)));
sl@0: 
sl@0: 	asm("stmia r12!, {r1,lr} ");												// save interrupted cpsr and lr_svc
sl@0: 	asm("ldmia r3, {r1,r2,lr} ");												// retrieve original r1-r3 from mode_fiq stack
sl@0: 	asm("stmia r12, {r0-r2,lr} ");												// save original r0-r3 - saved register order is now cpsr,lr_svc,r0-r3,r12,pc
sl@0: 	SET_MODE_1(r2, MODE_SVC, INTS_ALL_ON);
sl@0: 	SET_MODE(lr, MODE_FIQ, INTS_ALL_OFF);										// mode_fiq, IRQs and FIQs off
sl@0: 	asm("add sp, r3, #16 ");													// restore mode_fiq stack balance
sl@0: 	SET_MODE_2(r2, MODE_SVC, INTS_ALL_ON);										// back to mode_svc, IRQs on
sl@0: 	asm("adr lr, irq_resched_return ");
sl@0: 	asm("b  " CSM_ZN10TScheduler10RescheduleEv);								// do reschedule and return to irq_resched_return
sl@0: 
sl@0: 	asm("FiqExit0:");															// also entry point for __ArmVectorFiqPostambleNoResched()
sl@0: 	USER_MEMORY_GUARD_RESTORE(r12,lr);
sl@0: 
sl@0: #ifndef BTRACE_CPU_USAGE
sl@0: 	ERRATUM_353494_MODE_CHANGE(,r11);
sl@0: 	asm("ldmfd sp!, {pc}^ ");													// return from interrupt
sl@0: #else
sl@0: 	asm("ldrb r8, [r9,#%a0]" : : "i" _FOFF(TScheduler,iCpuUsageFilter));
sl@0: 	asm("mov r10, #%a0" : : "i" ((TInt)(BTrace::ECpuUsage<<BTrace::ECategoryIndex*8)+(BTrace::EFiqEnd<<BTrace::ESubCategoryIndex*8)) );
sl@0: 	asm("adr lr, FiqTraceExit0");
sl@0: 	asm("cmp r8, #0");
sl@0: 	ERRATUM_353494_MODE_CHANGE(eq,r8);
sl@0: 	asm("ldmeqfd sp!, {pc}^ ");													// return from interrupt if trace not enabled
sl@0: 	asm("stmfd sp!, {r0-r3} ");
sl@0: 	asm("add r0, r10, #%a0" : : "i" ((TInt)4 ) );
sl@0: 	asm("ldr pc, [r9,#%a0]" : : "i" _FOFF(TScheduler,iBTraceHandler));
sl@0: 	asm("FiqTraceExit0:");
sl@0: 	ERRATUM_353494_MODE_CHANGE(,r3);
sl@0: 	asm("ldmfd sp!, {r0-r3,pc}^ ");												// return from interrupt
sl@0: #endif
sl@0: 
sl@0: 	asm("__TheScheduler: ");
sl@0: 	asm(".word TheScheduler ");
sl@0: 	}
sl@0: 
sl@0: /***************************************************************************
sl@0:  * FIQ Postamble which will not reschedule (can be returned to by co-resident OS).
sl@0:  * This routine is called after the FIQ has been dispatched
sl@0:  * spsr_fiq, r0-r3 are unmodified
sl@0:  * Return address is on the top of the FIQ stack
sl@0:  ***************************************************************************/
sl@0: 
sl@0: extern "C" EXPORT_C __NAKED__ void __ArmVectorFiqPostambleNoResched()
sl@0: 	{
sl@0: #ifdef __FAULT_ON_FIQ__
sl@0: 	asm(".word 0xe7f10f10 ");
sl@0: #endif
sl@0: 	// IRQs and FIQs disabled here
sl@0: 	// r0-r7 are unaltered from when FIQ occurred
sl@0: 	asm("ldr r9, __TheScheduler ");
sl@0: #ifdef __USER_MEMORY_GUARDS_ENABLED__
sl@0: 	asm("ldr r12, [sp], #4 ");													// pop saved DACR
sl@0: #endif
sl@0: 	asm("b FiqExit0 ");
sl@0: 	}
sl@0: 
sl@0: 
sl@0: extern "C" __NAKED__ void __ArmVectorAbortData()
sl@0: //
sl@0: // Data abort
sl@0: //
sl@0: 	{
sl@0: #if defined(__CPU_CORTEX_A8__) && (!defined(__CPU_ARM_A8_ERRATUM_447862_FIXED) || !defined(__CPU_ARM_A8_ERRATUM_451027_FIXED))
sl@0: 	ARM_DMBSH;								// ARM Cortex-A8 erratum 447862/451027 workaround
sl@0: #endif
sl@0: 	asm("sub lr, lr, #8");					// lr now points to aborted instruction
sl@0: 	asm("stmfd	sp!, {r0-r4,r12,lr}");		// save it along with r0-r4,r12
sl@0: #if defined(__CPU_ARM_HAS_WORKING_CLREX)
sl@0: 	CLREX									// reset exclusive monitor 	
sl@0: #elif defined(__CPU_ARM_HAS_LDREX_STREX)
sl@0: 	STREX(12,0,13);							// dummy STREX to reset exclusivity monitor
sl@0: #endif
sl@0: 	asm("mov r1, #%a0 " : : "i" ((TInt)EArmExceptionDataAbort));
sl@0: 	// generic exception handler
sl@0: 	// come here with r1=exception code, lr points to aborted instruction, r0-r4,r12,lr saved
sl@0: 	asm("handle_exception: ");
sl@0: 	asm("mrs r0, spsr ");					// r0=value of cpsr when abort occurred
sl@0: 
sl@0: 	asm("handle_exception2: ");
sl@0: 	asm("mrs r12, cpsr ");
sl@0: 	asm("and r3, r0, #0x1f ");				// r3=processor mode when abort occurred
sl@0: 	asm("bic r12, r12, #0xc0 ");
sl@0: 	asm("cmp r3, #0x10 ");					// aborted in user mode?
sl@0: 	asm("cmpne r3, #0x13 ");				// if not, aborted in mode_svc?
sl@0: 	asm("bne fatal_exception_mode ");		// if neither, fault
sl@0: 	asm("msr cpsr, r12 ");					// reenable interrupts - rescheduling disabled by mode_abt/mode_und
sl@0: 	asm("ldr r2, __TheScheduler ");
sl@0: 	asm("mov r3, sp ");						// r3 points to saved registers
sl@0: 	asm("ldr r4, [r2, #%a0]" : : "i" _FOFF(TScheduler,iKernCSLocked));
sl@0: 	asm("cmp r4, #0 ");						// exception with kernel locked?
sl@0: 	asm("bne fatal_exception_mode ");		// if so, fault
sl@0: 	asm("add r4, r4, #1 ");					// lock the kernel
sl@0: 	asm("str r4, [r2, #%a0]" : : "i" _FOFF(TScheduler,iKernCSLocked));
sl@0: 	asm("mov r4, #0x13 ");
sl@0: 	asm("msr cpsr, r4 ");					// mode_svc, interrupts on, kernel locked
sl@0: 
sl@0: 	asm("ldr r4, [r2, #%a0]" : : "i" _FOFF(TScheduler,iCurrentThread));
sl@0: 	asm("tst r0, #0x0f ");					// check if exception in mode_usr
sl@0: 	asm("mov r2, #%a0 " : : "i" ((TInt)NThread::EContextException));
sl@0:  	asm("streqb r2, [r4, #%a0]" : : "i" _FOFF(NThread,iSpare3));	// if so, set iUserContextType = EContextException
sl@0: 	asm("add r4, r4, #%a0" : : "i" _FOFF(NThread,iStackBase));
sl@0: 	asm("ldmia r4, {r2,r4} ");				// r2=supervisor stack area base, r4=size
sl@0: 	asm("subs r2, sp, r2 ");				// r2=amount of mode_svc stack remaining
sl@0: 	asm("blo fatal_exception_stack ");		// if stack pointer invalid, fault
sl@0: 	asm("cmp r2, r4 ");
sl@0: 	asm("bhi fatal_exception_stack ");
sl@0: 	asm("cmp r2, #128 ");					// check enough stack to handle exception
sl@0: 	asm("blo fatal_exception_stack ");		// if not, fault
sl@0: 
sl@0: 	// At this point we are in mode_svc with interrupts enabled and the kernel locked.
sl@0: 	// We know the supervisor stack is valid and has enough free space to store the exception info.
sl@0: 	// Registers: R0=aborted cpsr, R1=exception type, R2,R4 scratch, R3 points to saved registers
sl@0: 	// on mode_abt or mode_und stack, R12 holds mode of exception (mode_abt or mode_und).
sl@0: 
sl@0: 	asm("ldr r4, [r3, #16] ");				// restore original r4
sl@0: 	asm("mov r2, sp ");						// r2=sp_svc when abort occurred
sl@0: 	asm("sub sp, sp, #92 ");				// push 23 words onto mode_svc stack
sl@0: 	asm("stmia sp, {r0-r2,r4-r11,lr} ");	// save cpsr, exc id, sp_svc, r4-r11, lr_svc
sl@0: 	asm("ldmia r3!, {r4-r10} ");			// get registers from mode_abt or mode_und stack
sl@0: 	asm("stmdb r2!, {r4-r7,r9,r10} ");		// transfer saved registers from exception stack except r4
sl@0: 	asm("stmdb r2, {r13,r14}^ ");			// save sp_usr and lr_usr
sl@0: 	asm("sub r2, r2, #20 ");
sl@0: 
sl@0: // Set r0 = fault address and r1 = fault status.
sl@0: // For prefetch aborts use IFAR if it exists otherwise use the return address.
sl@0: #ifdef __USE_CP15_FAULT_INFO__
sl@0: 	asm("cmp r1, #%a0 " : : "i" ((TInt)EArmExceptionPrefetchAbort));
sl@0: #ifdef __CPU_ARM_HAS_SPLIT_FSR
sl@0: 	asm("mrcne p15, 0, r1, c5, c0, 0");		// r1 = data fault status
sl@0: 	asm("mrcne p15, 0, r0, c6, c0, 0");		// r0 = DFAR fault address
sl@0: 	asm("mrceq p15, 0, r1, c5, c0, 1");		// r1 = instruction fault status
sl@0: #ifdef __CPU_ARM_HAS_CP15_IFAR
sl@0: 	asm("mrceq p15, 0, r0, c6, c0, 2");		// r0 = IFAR fault address
sl@0: #else 
sl@0: 	asm("moveq r0, r10");					// r0 = return address.
sl@0: #endif // __CPU_ARM_HAS_CP15_IFAR
sl@0: #else
sl@0: 	asm("mrcne p15, 0, r0, c6, c0");		// r0 = fault address
sl@0: 	asm("moveq r0, r10");					// r0 = return address.
sl@0: 	asm("mrc p15, 0, r1, c5, c0");			// r1 = fault status
sl@0: #endif // __CPU_ARM_HAS_SPLIT_FSR
sl@0: #endif // __USE_CP15_FAULT_INFO__
sl@0: 
sl@0: 	asm("mrs r3, spsr ");					// r3=spsr_svc
sl@0: 	asm("stmia r2, {r0,r1,r3} ");			// save these
sl@0: 	asm("msr cpsr, r12 ");					// back into exception mode
sl@0: 	asm("add sp, sp, #28 ");				// restore exception stack balance
sl@0: 	asm("mov r5, #0x13 ");
sl@0: 	asm("msr cpsr, r5 ");					// back into mode_svc
sl@0: 
sl@0: 	// Now we can unlock the kernel and process the exception
sl@0: 	asm("bl  " CSM_ZN10TScheduler10RescheduleEv);
sl@0: 	asm("msr cpsr, r5 ");					// enable interrupts
sl@0: 
sl@0: 	// call the exception dispatcher, r3 is the current thread
sl@0: 	asm("ldr r12, [r3, #%a0]" : : "i" _FOFF(NThread,iHandlers));
sl@0: 	asm("mov r1, r3 "); 
sl@0: 	asm("mov r0, sp ");						// r0 points to saved exception information
sl@0: 	asm("sub sp, sp, #4 ");					// make room for r0
sl@0: 	asm("bic sp, sp, #4 ");					// align stack to 8 byte boundary
sl@0: 	asm("str r0, [sp] ");					// save original stack pointer
sl@0: 
sl@0: 	USER_MEMORY_GUARD_ON(,r11,lr);
sl@0: 	asm("ldr r12, [r12, #%a0]" : : "i" _FOFF(SNThreadHandlers,iExceptionHandler));
sl@0: 	asm("mov lr, pc ");
sl@0: 	__JUMP(,r12);							// call exception handler
sl@0: 	USER_MEMORY_GUARD_RESTORE(r11,lr);
sl@0: 	asm("ldr sp, [sp, #0] ");				// restore stack pointer
sl@0: 
sl@0: 	// return from exception
sl@0: 	asm("ldr r0, __TheScheduler ");
sl@0: 	asm("mov r3, sp ");
sl@0: 	asm("ldr r2, [r0, #%a0]" : : "i" _FOFF(TScheduler,iCurrentThread));
sl@0: 	asm("ldr r0, [r3], #12 ");				// r0=cpsr, skip exc id and sp_svc
sl@0: 	asm("ldmfd r3!, {r4-r11,lr} ");			// restore r4-r11 and lr_svc
sl@0: 	asm("ldr r12, [r3, #8]! ");				// skip fault address and fault status, r12=spsr_svc
sl@0: 	asm("ldmib r3, {r13,r14}^ ");			// restore sp_usr and lr_usr
sl@0: 	asm("add r1, r3, #12 ");				// r3 points to saved r0-r3,r12,pc
sl@0: 	asm("mov r3, #0xd3 ");
sl@0: 	asm("msr cpsr, r3 ");					// mode_svc, all interrupts off
sl@0: 	asm("msr spsr, r12 ");					// restore spsr_svc
sl@0: 	asm("tst r0, #0x0f ");					// check if exception in mode_usr
sl@0: #if defined(__CPU_CORTEX_A9__) && !defined(__CPU_ARM_A9_ERRATUM_571622_FIXED)
sl@0: 	asm("nop ");							// ARM Cortex-A9 MPCore erratum 571622 workaround
sl@0: 	asm("nop ");							// Insert nops so branch doesn't occur in 2nd or 3rd position after a msr spsr
sl@0: #endif
sl@0: #ifdef __CHECK_LOCK_STATE__
sl@0: 	asm("bleq  " CSM_Z14CheckLockStatev);
sl@0: 	asm("tst r0, #0x0f ");					// recheck if exception in mode_usr
sl@0: #endif
sl@0: 	asm("bne 1f ");
sl@0: 
sl@0: #ifdef __USER_MEMORY_GUARDS_ENABLED__
sl@0: 	USER_MEMORY_GUARD_ON(,lr,r12);
sl@0: 	asm("tst lr, #0xc0000000 ");			// user memory enabled?
sl@0: 	asm("adrne lr, 2f ");					// yes - enable it after callbacks
sl@0: #endif
sl@0: 	asm("adreq lr, 1f ");					// no - leave it disabled after callbacks
sl@0: 	asm("mov r3, #0 ");
sl@0: 	asm("b callUserModeCallbacks2 ");		// call user-mode callbacks
sl@0: 	asm("2: ");
sl@0: 	USER_MEMORY_GUARD_OFF(,lr,lr);
sl@0: 
sl@0: 	asm("1: ");
sl@0: 	asm("tst r0, #0x0f ");					// check if exception in mode_usr
sl@0: 	asm("mov r3, #%a0 " : : "i" ((TInt)NThread::EContextUndefined));
sl@0: 	asm("streqb r3, [r2, #%a0]" : : "i" _FOFF(NThread,iSpare3)); // if so, set iUserContextType = EContextUndefined
sl@0: 	asm("add sp, r1, #24 ");				// restore mode_svc stack balance
sl@0: 	asm("mov r2, #0xd7 ");
sl@0: 	asm("msr cpsr, r2 ");					// mode_abt, all interrupts off
sl@0: 	asm("msr spsr, r0 ");					// spsr_abt=aborted cpsr
sl@0: 	ERRATUM_353494_MODE_CHANGE(,r12);
sl@0: 	asm("ldmia r1, {r0-r3,r12,pc}^ ");		// restore r0-r3,r12 and return from exception
sl@0: 
sl@0: 	// get here if exception occurred in mode other than usr or svc
sl@0: 	// we are in mode_abt or mode_und with IRQs disabled
sl@0: 	asm("fatal_exception_mode: ");
sl@0: 	asm("ldr r2, __TheScheduler ");
sl@0: 	asm("ldr lr, [r2, #%a0]" : : "i" _FOFF(TScheduler,iMonitorExceptionHandler));
sl@0: 	asm("cmp lr, #0 ");
sl@0: 	__JUMP(ne,lr);							// if crash debugger running, let it handle exception
sl@0: 
sl@0: 	// get here if mode_svc stack has overflowed
sl@0: 	// we are in mode_svc with interrupts enabled and the kernel locked
sl@0: 	// R0=original CPSR R1=exc code R12=mode of exception
sl@0: 	asm("fatal_exception_stack: ");
sl@0: 	asm("orr r3, r12, #0xC0 ");
sl@0: 	asm("msr cpsr, r3 ");		// back to exception mode, all interrupts off
sl@0: 	asm("mov r2, r0 ");
sl@0: 	asm("ldr r0, __TheScheduler ");
sl@0: 	asm("ldr r0, [r0, #%a0]" : : "i" _FOFF(TScheduler,i_Regs));	// pass in address of stored registers
sl@0: 	asm("bl "	CSM_ZN3Arm9SaveStateER14SFullArmRegSet );
sl@0: 	asm("str r1, [r0, #%a0]" : : "i" _FOFF(SFullArmRegSet,iExcCode));
sl@0: 	asm("str r2, [r0, #%a0]" : : "i" _FOFF(SFullArmRegSet,iN.iFlags));
sl@0: 	asm("ldmia sp!, {r3-r7} ");	// get original R0-R4
sl@0: 	asm("stmia r0, {r1-r5} ");	// save original R0-R4
sl@0: 	asm("ldmia sp!, {r6,r7} ");	// get original R12 and aborted instruction address
sl@0: 	asm("str r6, [r0, #%a0]" : : "i" _FOFF(SFullArmRegSet,iN.iR12));
sl@0: 	asm("str r7, [r0, #%a0]" : : "i" _FOFF(SFullArmRegSet,iN.iR15));
sl@0: 	asm("mov r1, #13 ");		// r1 = regnum
sl@0: 	asm("mrs r2, cpsr ");		// r2 = mode
sl@0: 	asm("mov r4, r0 ");
sl@0: 	asm("bl " CSM_ZN3Arm3RegER14SFullArmRegSetim );	// r0 = pointer to exception mode R13
sl@0: 	asm("str sp, [r0] ");		// save correct original value for exception mode R13
sl@0: 
sl@0: 	// call the exception fault dispatcher
sl@0: 	asm("mov r0, #0 ");
sl@0: 	asm("b ExcFault ");
sl@0: 	}
sl@0: 
sl@0: extern "C" __NAKED__ void __ArmVectorAbortPrefetch()
sl@0: //
sl@0: // Prefetch abort
sl@0: //
sl@0: 	{
sl@0: 	asm("sub lr, lr, #4");					// lr now points to instruction whose prefetch was aborted
sl@0: 	asm("stmfd	sp!, {r0-r4,r12,lr}");		// save it along with r0-r4,r12
sl@0: #if defined(__CPU_ARM_HAS_WORKING_CLREX)
sl@0: 	CLREX									// reset exclusive monitor 	
sl@0: #elif defined(__CPU_ARM_HAS_LDREX_STREX)
sl@0: 	STREX(12,0,13);							// dummy STREX to reset exclusivity monitor
sl@0: #endif
sl@0: 	asm("mov r1, #%a0 " : : "i" ((TInt)EArmExceptionPrefetchAbort));
sl@0: 	asm("b handle_exception ");
sl@0: 	}
sl@0: 
sl@0: extern "C" __NAKED__ void __ArmVectorUndef()
sl@0: //
sl@0: // Undefined instruction exception
sl@0: //
sl@0: 	{
sl@0: 	asm("sub lr, lr, #4");					// lr now points to undefined instruction
sl@0: 	asm("stmfd	sp!, {r0-r4,r12,lr}");		// save it along with r0-r4,r12
sl@0: #if defined(__CPU_ARM_HAS_WORKING_CLREX)
sl@0: 	CLREX									// reset exclusive monitor 	
sl@0: #elif defined(__CPU_ARM_HAS_LDREX_STREX)
sl@0: 	STREX(12,0,13);							// dummy STREX to reset exclusivity monitor
sl@0: #endif
sl@0: 	asm("mrs r0, spsr ");					// r0=CPSR at time of exception
sl@0: 	asm("mov r1, #%a0 " : : "i" ((TInt)EArmExceptionUndefinedOpcode));
sl@0: 	asm("tst r0, #0x20 ");					// exception in THUMB mode?
sl@0: 	asm("addne lr, lr, #2 ");				// if so, correct saved return address
sl@0: 	asm("strne lr, [sp, #24] ");
sl@0: 	asm("b handle_exception2 ");
sl@0: 	}
sl@0: