sl@0: // Copyright (c) 2008-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\nkernsmp\arm\nctimer.cia
sl@0: // Fast Millisecond Timer Implementation
sl@0: // 
sl@0: //
sl@0: 
sl@0: #include <e32cia.h>
sl@0: #include <arm.h>
sl@0: 
sl@0: #ifdef __MSTIM_MACHINE_CODED__
sl@0: 
sl@0: 
sl@0: #ifdef _DEBUG
sl@0: #define ASM_KILL_LINK(rp,rs)	asm("mov "#rs", #0xdf ");\
sl@0: 								asm("orr "#rs", "#rs", "#rs", lsl #8 ");\
sl@0: 								asm("orr "#rs", "#rs", "#rs", lsl #16 ");\
sl@0: 								asm("str "#rs", ["#rp"] ");\
sl@0: 								asm("str "#rs", ["#rp", #4] ");
sl@0: 
sl@0: #define ASM_KILL_LINK_OFFSET(rp,rs,offset)	asm("mov "#rs", #0xdf ");\
sl@0: 											asm("orr "#rs", "#rs", "#rs", lsl #8 ");\
sl@0: 											asm("orr "#rs", "#rs", "#rs", lsl #16 ");\
sl@0: 											asm("str "#rs", ["#rp", #"#offset"] ");\
sl@0: 											asm("str "#rs", ["#rp", #"#offset"+4] ");
sl@0: #else
sl@0: #define ASM_KILL_LINK(rp,rs)
sl@0: #define ASM_KILL_LINK_OFFSET(rp,rs,offset)
sl@0: #endif
sl@0: 
sl@0: #ifdef _DEBUG
sl@0: #define __DEBUG_CALLBACK(n)	asm("stmfd sp!, {r0-r3,r12,lr} ");		\
sl@0: 							asm("ldr r0, __TheTimerQ ");			\
sl@0: 							asm("ldr r12, [r0, #%a0]!" : : "i" _FOFF(NTimerQ,iDebugFn));	\
sl@0: 							asm("cmp r12, #0 ");					\
sl@0: 							asm("movne r1, #" #n );					\
sl@0: 							asm("ldrne r0, [r0, #4] ");				\
sl@0: 							asm("movne lr, pc ");					\
sl@0: 							__JUMP(ne,r12);							\
sl@0: 							asm("ldmfd sp!, {r0-r3,r12,lr} ")
sl@0: #else
sl@0: #define __DEBUG_CALLBACK(n)
sl@0: #endif
sl@0: 
sl@0: 
sl@0: /** Start a nanokernel timer in zero-drift periodic mode with ISR or DFC callback.
sl@0: 	Queues the timer to expire in the specified number of nanokernel ticks,
sl@0: 	measured from the time at which it last expired. This allows exact periodic
sl@0: 	timers to be implemented with no drift caused by delays in requeueing the
sl@0: 	timer.
sl@0: 	The expiry handler will be called in the same context as the previous timer
sl@0: 	expiry. Generally the way this is used is that NTimer::OneShot() is used to start 
sl@0: 	the first time interval and this specifies whether the callback is in ISR context 
sl@0: 	or in the context of the nanokernel timer thread (DfcThread1) or other Dfc thread.
sl@0: 	The expiry handler then uses NTimer::Again() to requeue the timer.
sl@0: 
sl@0: 	@param	aTime Timeout in nanokernel ticks
sl@0: 	@return	KErrNone if no error
sl@0: 	@return	KErrInUse if timer is already active
sl@0: 	@return	KErrArgument if the requested expiry time is in the past
sl@0: 	@pre	Any context
sl@0:  */
sl@0: __NAKED__ EXPORT_C TInt NTimer::Again(TInt /*aTime*/)
sl@0: 	{
sl@0: 	asm("mrs r12, cpsr ");
sl@0: 	INTS_OFF(r3, r12, INTS_ALL_OFF);	// all interrupts off
sl@0: 	asm("ldrb r3, [r0, #%a0]" : : "i" _FOFF(NTimer,iState));		// r3=iState
sl@0: 	asm("ldr r2, __TheTimerQ ");
sl@0: 	asm("cmp r3, #%a0" : : "i" ((TInt)EIdle));
sl@0: 	asm("ldreq r3, [r0, #%a0]" : : "i" _FOFF(NTimer,iTriggerTime));	// r3=iTriggerTime
sl@0: 	asm("bne add_mscb_in_use ");		// if already queued return KErrInUse
sl@0: 	asm("add r3, r3, r1 ");				// add requested time interval
sl@0: 	asm("ldr r1, [r2, #%a0]" : : "i" _FOFF(NTimerQ,iMsCount));		// r1=iMsCount
sl@0: 	asm("subs r1, r3, r1 ");			// r1=trigger time-next tick time
sl@0: 	asm("strpl r3, [r0, #%a0]" : : "i" _FOFF(NTimer,iTriggerTime));	// iTriggerTime+=aTime
sl@0: 	asm("bpl AddMsCallBack ");			// if time interval positive, ok
sl@0: 	asm("mov r0, #%a0" : : "i" ((TInt)KErrArgument));	// else return KErrArgument
sl@0: 	asm("b add_mscb_0 ");
sl@0: 	}
sl@0: 
sl@0: 
sl@0: /** Start a nanokernel timer in one-shot mode with ISR callback.
sl@0: 	Queues the timer to expire in the specified number of nanokernel ticks. The
sl@0: 	actual wait time will be at least that much and may be up to one tick more.
sl@0: 	The expiry handler will be called in ISR context.
sl@0: 
sl@0: 	@param	aTime Timeout in nanokernel ticks
sl@0: 	@return	KErrNone if no error
sl@0: 	@return	KErrInUse if timer is already active
sl@0: 	@pre	Any context
sl@0:  */
sl@0: __NAKED__ EXPORT_C TInt NTimer::OneShot(TInt /*aTime*/)
sl@0: 	{
sl@0: 	asm("mov r2, #0 ");
sl@0: 	// fall through
sl@0: 	}
sl@0: 
sl@0: 
sl@0: /** Start a nanokernel timer in one-shot mode with ISR or DFC callback.
sl@0: 	Queues the timer to expire in the specified number of nanokernel ticks. The
sl@0: 	actual wait time will be at least that much and may be up to one tick more.
sl@0: 	The expiry handler will be called in either ISR context or in the context
sl@0: 	of the nanokernel timer thread (DfcThread1).
sl@0: 
sl@0: 	@param	aTime Timeout in nanokernel ticks
sl@0: 	@param	aDfc TRUE if DFC callback required, FALSE if ISR callback required.
sl@0: 	@return	KErrNone if no error
sl@0: 	@return	KErrInUse if timer is already active
sl@0: 	@pre	Any context
sl@0:  */
sl@0: __NAKED__ EXPORT_C TInt NTimer::OneShot(TInt /*aTime*/, TBool /*aDfc*/)
sl@0: 	{
sl@0: 	asm("mrs r12, cpsr ");
sl@0: 	INTS_OFF(r3, r12, INTS_ALL_OFF);	// all interrupts off
sl@0: 	asm("ldrb r3, [r0, #%a0]" : : "i" _FOFF(NTimer,iState));		// r3=iState
sl@0: 	asm("cmp r3, #%a0" : : "i" ((TInt)EIdle));
sl@0: 	asm("bne add_mscb_in_use ");		// if already queued return KErrInUse
sl@0: 	asm("strb r2, [r0, #%a0]" : : "i" _FOFF(NTimer,iCompleteInDfc));	// iCompleteInDfc=aDfc
sl@0: 	asm("ldr r2, __TheTimerQ ");
sl@0: 	asm("ldr r3, [r2, #%a0]" : : "i" _FOFF(NTimerQ,iMsCount));	// r3=iMsCount
sl@0: 	asm("add r3, r3, r1 ");
sl@0: 	asm("str r3, [r0, #%a0]" : : "i" _FOFF(NTimer,iTriggerTime));	// iTriggerTime=ms count + aTime
sl@0: 
sl@0: 	// r0->CallBack, r2=TheTimerQ, r1=time interval, r3=trigger time
sl@0: 	asm("AddMsCallBack: ");
sl@0: 	asm("cmp r1, #32 ");				// compare interval with 32ms
sl@0: 	asm("bge add_mscb_holding ");		// if >=32ms put it on holding queue
sl@0: 	asm("ldrb r1, [r0, #%a0]" : : "i" _FOFF(NTimer,iCompleteInDfc));	// r1=iCompleteInDfc
sl@0: 	asm("and r3, r3, #0x1f ");			// r3=trigger time & 0x1f
sl@0: 	asm("cmp r1, #0 ");
sl@0: 	asm("add r1, r2, r3, lsl #4 ");		// r1->IntQ corresponding to trigger time
sl@0: 	asm("addne r1, r1, #8 ");			// if (iCompleteInDfc), r1 points to DfcQ
sl@0: 	asm("ldr r3, [r1, #4] ");			// r3=pQ->iA.iPrev
sl@0: 	asm("str r0, [r1, #4] ");			// pQ->iA.iPrev=pC
sl@0: 	asm("str r0, [r3, #0] ");			// pQ->iA.iPrev->iNext=pC
sl@0: 	asm("stmia r0, {r1,r3} ");			// pC->iNext=&pQ->iA, pC->iPrev=pQ->iA.iPrev
sl@0: 	asm("mov r1, #%a0" : : "i" ((TInt)EFinal));
sl@0: 	asm("strb r1, [r0, #%a0]" : : "i" _FOFF(NTimer,iState));		// iState=EFinal
sl@0: 	asm("ldr r0, [r0, #%a0]" : : "i" _FOFF(NTimer,iTriggerTime));	// r0=iTriggerTime
sl@0: 	asm("ldr r3, [r2, #%a0]" : : "i" _FOFF(NTimerQ,iPresent));	// r3=TheTimerQ->iPresent
sl@0: 	asm("and r0, r0, #0x1f ");
sl@0: 	asm("mov r1, #1 ");
sl@0: 	asm("orr r3, r3, r1, lsl r0 ");		// iPresent |= (1<<index)
sl@0: 	asm("str r3, [r2, #%a0]" : : "i" _FOFF(NTimerQ,iPresent));
sl@0: 	asm("mov r0, #0 ");					// return KErrNone
sl@0: 	asm("msr cpsr, r12 ");
sl@0: 	__JUMP(,lr);
sl@0: 
sl@0: 	asm("add_mscb_holding: ");
sl@0: 	asm("ldr r3, [r2, #%a0]!" : : "i" _FOFF(NTimerQ,iHoldingQ.iA.iPrev));	// r3=pQ->iPrev, r2=&iHoldingQ.iA.iPrev
sl@0: 	asm("mov r1, #%a0" : : "i" ((TInt)EHolding));
sl@0: 	asm("strb r1, [r0, #%a0]" : : "i" _FOFF(NTimer,iState));	// iState=EHolding
sl@0: 	asm("str r0, [r2], #-4 ");			// pQ->iPrev=pC, r2=&iHoldingQ
sl@0: 	asm("str r0, [r3, #0] ");			// pQ->iPrev->iNext=pC
sl@0: 	asm("stmia r0, {r2,r3} ");			// pC->iNext=pQ, pC->iPrev=pQ->iPrev
sl@0: 	asm("mov r0, #0 ");					// return KErrNone
sl@0: 
sl@0: 	asm("add_mscb_0: ");
sl@0: 	asm("msr cpsr, r12 ");
sl@0: 	__JUMP(,lr);
sl@0: 
sl@0: 	asm("add_mscb_in_use: ");
sl@0: 	asm("mov r0, #%a0" : : "i" ((TInt)KErrInUse));		// return KErrInUse
sl@0: 	asm("msr cpsr, r12 ");
sl@0: 	__JUMP(,lr);
sl@0: 
sl@0: 	asm("__TheTimerQ: ");
sl@0: 	asm(".word TheTimerQ ");
sl@0: 	}
sl@0: 
sl@0: 
sl@0: /** Starts a nanokernel timer in one-shot mode with callback in dfc thread that provided DFC belongs to.
sl@0: 	
sl@0: 	Queues the timer to expire in the specified number of nanokernel ticks. The
sl@0: 	actual wait time will be at least that much and may be up to one tick more.
sl@0: 	On expiry aDfc will be queued in ISR context.
sl@0: 
sl@0:     Note that NKern::TimerTicks() can be used to convert milliseconds to ticks.
sl@0: 
sl@0: 	@param	aTime Timeout in nanokernel ticks
sl@0: 	@param	aDfc - Dfc to be queued when the timer expires.
sl@0: 	
sl@0: 	@return	KErrNone if no error; KErrInUse if timer is already active.
sl@0: 	
sl@0: 	@pre	Any context
sl@0: 	
sl@0: 	@see    NKern::TimerTicks()
sl@0:  */
sl@0: 
sl@0: __NAKED__ EXPORT_C TInt NTimer::OneShot(TInt /*aTime*/, TDfc& /*aDfc*/)
sl@0: 	{
sl@0: 	asm("mrs r12, cpsr ");
sl@0: 	INTS_OFF(r3, r12, INTS_ALL_OFF);	// all interrupts off
sl@0: 	asm("ldrb r3, [r0, #%a0]" : : "i" _FOFF(NTimer,iState));		// r3=iState
sl@0: 	asm("cmp r3, #%a0" : : "i" ((TInt)EIdle));
sl@0: 	asm("bne add_mscb_in_use ");		// if already queued return KErrInUse
sl@0: 	asm("mov r3, #0 ");
sl@0: 	asm("strb r3, [r0, #%a0]" : : "i" _FOFF(NTimer,iCompleteInDfc));	// iCompleteInDfc=0
sl@0: 	asm("str r3,  [r0, #%a0]" : : "i" _FOFF(NTimer,iFunction));			// iFunction=NULL
sl@0: 	asm("str r2,  [r0, #%a0]" : : "i" _FOFF(NTimer,iPtr));				// iPtr= &aDfc
sl@0: 	asm("ldr r2, __TheTimerQ ");
sl@0: 	asm("ldr r3, [r2, #%a0]" : : "i" _FOFF(NTimerQ,iMsCount));	// r3=iMsCount
sl@0: 	asm("add r3, r3, r1 ");
sl@0: 	asm("str r3, [r0, #%a0]" : : "i" _FOFF(NTimer,iTriggerTime));	// iTriggerTime=ms count + aTime
sl@0: 	asm("b AddMsCallBack ");
sl@0: 	}
sl@0: 
sl@0: 
sl@0: /** Cancel a nanokernel timer.
sl@0: 	Removes this timer from the nanokernel timer queue. Does nothing if the
sl@0: 	timer is inactive or has already expired.
sl@0: 	Note that if the timer was queued and DFC callback requested it is possible
sl@0: 	for the expiry handler to run even after Cancel() has been called. This will
sl@0: 	occur in the case where DfcThread1 is preempted just before calling the
sl@0: 	expiry handler for this timer and the preempting thread/ISR/IDFC calls
sl@0: 	Cancel() on the timer.
sl@0: 
sl@0: 	@pre	Any context
sl@0:  */
sl@0: EXPORT_C __NAKED__ void NTimer::Cancel()
sl@0: 	{
sl@0: 	asm("mrs r12, cpsr ");
sl@0: 	INTS_OFF(r3, r12, INTS_ALL_OFF);	// all interrupts off
sl@0: 	asm("ldrb r3, [r0, #%a0]" : : "i" _FOFF(NTimer,iState));
sl@0: 	asm("mov r1, #0 ");
sl@0: 	asm("cmp r3, #%a0" : : "i" ((TInt)ETransferring));
sl@0: 	asm("bcc cancel_idle ");			// if EIdle, nothing to do
sl@0: 	asm("strb r1, [r0, #%a0]" : : "i" _FOFF(NTimer,iState));	// iState=EIdle
sl@0: 	asm("beq cancel_xfer ");			// if ETransferring, branch
sl@0: 	asm("ldmia r0, {r1,r2} ");			// If queued, dequeue - r1=next, r2=prev
sl@0: 	asm("cmp r3, #%a0" : : "i" ((TInt)ECritical));
sl@0: 	asm("str r1, [r2, #0] ");			// if queued, prev->next=next
sl@0: 	asm("str r2, [r1, #4] ");			// and next->prev=prev
sl@0: 	ASM_KILL_LINK(r0,r1);
sl@0: 	asm("ldrcs r1, __TheTimerQ ");
sl@0: 	asm("ldrhi r0, [r0, #%a0]" : : "i" _FOFF(NTimer,iTriggerTime));	// r0=iTriggerTime
sl@0: 	asm("ldrhi r3, [r1, #%a0]" : : "i" _FOFF(NTimerQ,iMsCount));	// r3=iMsCount
sl@0: 	asm("bcc cancel_idle ");			// if EHolding or EOrdered, finished
sl@0: 	asm("beq cancel_critical ");		// if ECritical, branch
sl@0: 										// r1->ms timer, state was EFinal
sl@0: 	asm("subs r3, r0, r3 ");			// r3=trigger time - next tick
sl@0: 	asm("bmi cancel_idle ");			// if trigger time already expired, don't touch iPresent (was on iCompletedQ)
sl@0: 	asm("and r0, r0, #0x1f ");			// r0=iTriggerTime&0x1f = queue index
sl@0: 	asm("mov r3, r1 ");
sl@0: 	asm("ldr r2, [r3, r0, lsl #4]! ");	// r3->iIntQ for this timer, r2=iIntQ head pointer
sl@0: 	asm("cmp r2, r3 ");
sl@0: 	asm("bne cancel_idle ");			// iIntQ not empty so finished
sl@0: 	asm("ldr r2, [r3, #8]! ");			// r2=iDfcQ head pointer
sl@0: 	asm("cmp r2, r3 ");
sl@0: 	asm("bne cancel_idle ");			// iDfcQ not empty so finished
sl@0: 	asm("ldr r2, [r1, #%a0]" : : "i" _FOFF(NTimerQ,iPresent));	// r2=TheTimerQ->iPresent
sl@0: 	asm("mov r3, #1 ");
sl@0: 	asm("bic r2, r2, r3, lsl r0 ");		// iPresent &= ~(1<<index)
sl@0: 	asm("str r2, [r1, #%a0]" : : "i" _FOFF(NTimerQ,iPresent));
sl@0: 
sl@0: 	asm("cancel_idle: ");
sl@0: 	asm("msr cpsr, r12 ");
sl@0: 	__JUMP(,lr);
sl@0: 
sl@0: 	asm("cancel_xfer: ");
sl@0: 	asm("ldr r1, __TheTimerQ ");		// r1->ms timer, state was ETransferring
sl@0: 	asm("strb r3, [r1, #%a0]" : : "i" _FOFF(NTimerQ,iTransferringCancelled));
sl@0: 	asm("msr cpsr, r12 ");
sl@0: 	__JUMP(,lr);
sl@0: 
sl@0: 	asm("cancel_critical: ");			// r1->ms timer, state was ECritical
sl@0: 	asm("strb r3, [r1, #%a0]" : : "i" _FOFF(NTimerQ,iCriticalCancelled));
sl@0: 	asm("msr cpsr, r12 ");
sl@0: 	__JUMP(,lr);
sl@0: 	}
sl@0: 
sl@0: 
sl@0: /** Return the number of ticks before the next nanokernel timer expiry.
sl@0: 	May on occasion return a pessimistic estimate (i.e. too low).
sl@0: 	Used by base port to disable the system tick interrupt when the system
sl@0: 	is idle.
sl@0: 
sl@0: 	@return	The number of ticks before the next nanokernel timer expiry.
sl@0: 	
sl@0: 	@pre	Interrupts must be disabled.
sl@0: 	
sl@0: 	@post	Interrupts are disabled.
sl@0:  */
sl@0: EXPORT_C __NAKED__ TInt NTimerQ::IdleTime()
sl@0: 	{
sl@0: 	ASM_CHECK_PRECONDITIONS(MASK_INTERRUPTS_DISABLED);
sl@0: 
sl@0: 	asm("ldr r12, __TheTimerQ ");
sl@0: 	asm("mvn r0, #0x80000000 ");		// set r0=KMaxTInt initially
sl@0: 	asm("ldr r2, [r12, #%a0]!" : : "i" _FOFF(NTimerQ,iOrderedQ));	// r12->iOrderedQ, r2=iOrderedQ first
sl@0: 	asm("ldr r3, [r12, #-12] ");		// r3=next tick number
sl@0: 	asm("cmp r2, r12 ");				// check if iOrderedQ empty
sl@0: 	asm("ldrne r0, [r2, #%a0]" : : "i" _FOFF(NTimer,iTriggerTime));	// if not, r0=ordered Q first->trigger time
sl@0: 	asm("ldr r1, [r12, #-8]! ");		// r1=iHoldingQ first, r12->iHoldingQ
sl@0: 	asm("bicne r0, r0, #0x0f ");
sl@0: 	asm("subne r0, r0, #16 ");			// r0=tick at which transfer to final queue would occur
sl@0: 	asm("subne r0, r0, r3 ");			// return value = trigger time - iMsCount
sl@0: 	asm("cmp r1, r12 ");				// holding Q empty?
sl@0: 	asm("ldr r1, [r12, #-8] ");			// r1=iPresent
sl@0: 	asm("and r12, r3, #0x1f ");			// r12=next tick mod 32
sl@0: 	asm("beq 1f ");						// branch if holding Q empty
sl@0: 	asm("ands r2, r3, #0x0f ");			// else r2=next tick no. mod 16
sl@0: 	asm("rsbne r2, r2, #16 ");			// if nonzero, subtract from 16 to give #ticks before next multiple of 16
sl@0: 	asm("cmp r2, r0 ");
sl@0: 	asm("movlt r0, r2 ");				// update result if necessary
sl@0: 	asm("1: ");
sl@0: 	asm("movs r1, r1, ror r12 ");		// r1=iPresent rotated so that LSB corresponds to next tick
sl@0: 	__JUMP(eq,lr);						// if iPresent=0, finished
sl@0: 	asm("mov r3, #0 ");					// r3 will accumulate bit number of least significant 1
sl@0: 	asm("movs r2, r1, lsl #16 ");
sl@0: 	asm("movne r1, r2 ");
sl@0: 	asm("addeq r3, r3, #16 ");
sl@0: 	asm("movs r2, r1, lsl #8 ");
sl@0: 	asm("movne r1, r2 ");
sl@0: 	asm("addeq r3, r3, #8 ");
sl@0: 	asm("movs r2, r1, lsl #4 ");
sl@0: 	asm("movne r1, r2 ");
sl@0: 	asm("addeq r3, r3, #4 ");
sl@0: 	asm("movs r2, r1, lsl #2 ");
sl@0: 	asm("movne r1, r2 ");
sl@0: 	asm("addeq r3, r3, #2 ");
sl@0: 	asm("movs r2, r1, lsl #1 ");
sl@0: 	asm("addeq r3, r3, #1 ");
sl@0: 	asm("cmp r3, r0 ");
sl@0: 	asm("movlt r0, r3 ");				// update result if necessary
sl@0: 	__JUMP(,lr);
sl@0: 	}
sl@0: 
sl@0: 
sl@0: /** Tick over the nanokernel timer queue.
sl@0: 	This function should be called by the base port in the system tick timer ISR.
sl@0: 	It should not be called at any other time.
sl@0: 	The value of 'this' to pass is the value returned by NTimerQ::TimerAddress().
sl@0: 
sl@0: 	@see NTimerQ::TimerAddress()
sl@0:  */
sl@0: __NAKED__ EXPORT_C void NTimerQ::Tick()
sl@0: 	{
sl@0: 	// Enter with r0 pointing to NTimerQ
sl@0: 	asm("ldr r1, __TheScheduler ");
sl@0: 	asm("mrs r12, cpsr ");
sl@0: 
sl@0: 	// do the timeslice tick - on ARM __SCHEDULER_MACHINE_CODED is mandatory
sl@0: 	asm("ldr r2, [r1, #%a0]" : : "i" _FOFF(TScheduler,iCurrentThread));
sl@0: 	asm("ldr r3, [r2, #%a0]" : : "i" _FOFF(NThread,iTime));
sl@0: 	asm("subs r3, r3, #1 ");
sl@0: 	asm("strge r3, [r2, #%a0]" : : "i" _FOFF(NThread,iTime));
sl@0: 	asm("streqb r12, [r1, #%a0]" : : "i" _FOFF(TScheduler,iRescheduleNeededFlag));	// r12 lower byte is never 0
sl@0: 	INTS_OFF(r3, r12, INTS_ALL_OFF);	// disable all interrupts
sl@0: 
sl@0: 	asm("ldr r1, [r0, #%a0]" : : "i" _FOFF(NTimerQ,iMsCount));	// r1=iMsCount
sl@0: 	asm("ldr r3, [r0, #%a0]" : : "i" _FOFF(NTimerQ,iPresent));	// r3=iPresent
sl@0: 	asm("and r2, r1, #0x1f ");			// r2=iMsCount & 0x1f
sl@0: 	asm("add r1, r1, #1 ");
sl@0: 	asm("str r1, [r0, #%a0]" : : "i" _FOFF(NTimerQ,iMsCount));	// iMsCount++
sl@0: 	asm("mov r1, #1 ");
sl@0: 	asm("tst r3, r1, lsl r2 ");			// test iPresent bit for this tick
sl@0: 	asm("bic r1, r3, r1, lsl r2 ");		// clear iPresent bit
sl@0: 	asm("strne r1, [r0, #%a0]" : : "i" _FOFF(NTimerQ,iPresent));	// update iPresent if necessary
sl@0: 	asm("bne mstim_tick_1 ");			// if bit was set, we have work to do
sl@0: 	asm("tst r2, #0x0f ");				// else test for tick 0 or 16
sl@0: 	asm("msrne cpsr_c, r12 ");			// if neither return
sl@0: 	__JUMP(ne,lr);
sl@0: 
sl@0: 	asm("mstim_tick_1: ");				// get here if timers complete this tick
sl@0: 	asm("stmfd sp!, {r4-r6,lr} ");
sl@0: 	asm("add r1, r0, r2, lsl #4 ");		// r1->IntQ for this tick
sl@0: 	asm("ldr r3, [r1, #8]! ");			// r1->DfcQ and r3=DfcQ first
sl@0: 	asm("mov r5, #0 ");					// r5=doDfc=FALSE
sl@0: 	asm("cmp r3, r1 ");
sl@0: 	asm("beq mstim_tick_2 ");			// skip if DfcQ empty
sl@0: 
sl@0: 	// Move DFC completions from iDfcQ to iCompletedQ
sl@0: 	asm("ldr lr, [r0, #%a0]" : : "i" _FOFF(NTimerQ,iCompletedQ.iA.iPrev));	// lr=last completed
sl@0: 	asm("ldr r4, [r1, #4] ");			// r4=DfcQ last
sl@0: 	asm("add r5, r0, #%a0" : : "i" _FOFF(NTimerQ,iDfc));	// doDfc=TRUE
sl@0: 	asm("str r3, [lr, #0] ");			// old last pending->next = DfcQ first
sl@0: 	asm("str r4, [r0, #%a0]" : : "i" _FOFF(NTimerQ,iCompletedQ.iA.iPrev));	// last pending=DfcQ last
sl@0: 	asm("str lr, [r3, #4] ");			// DfcQ first->prev = old last pending
sl@0: 	asm("add lr, r0, #%a0" : : "i" _FOFF(NTimerQ,iCompletedQ));				// lr=&iCompletedQ.iA
sl@0: 	asm("str lr, [r4, #0] ");			// DfcQ last->next=&iPending
sl@0: 	asm("str r1, [r1, #0] ");			// DfcQ first=&DfcQ
sl@0: 	asm("str r1, [r1, #4] ");			// DfcQ last=&DfcQ
sl@0: 
sl@0: 	asm("mstim_tick_2: ");
sl@0: 	asm("tst r2, #0x0f ");				// check for tick 0 or 16
sl@0: 	asm("bne mstim_tick_3 ");			// skip if not
sl@0: 
sl@0: 	// Tick 0 or 16 - must check holding queue and ordered queue
sl@0: 	asm("ldr r3, [r0, #%a0]" : : "i" _FOFF(NTimerQ,iHoldingQ));	// r3=iHoldingQ first
sl@0: 	asm("add r6, r0, #%a0" : : "i" _FOFF(NTimerQ,iHoldingQ));	// r6=&iHoldingQ
sl@0: 	asm("cmp r3, r6 ");
sl@0: 	asm("addne r5, r0, #%a0" : : "i" _FOFF(NTimerQ,iDfc));	// if iHoldingQ nonempty, doDfc=TRUE and skip ordered queue check
sl@0: 	asm("bne mstim_tick_3 ");			// skip if iHoldingQ nonempty
sl@0: 	asm("ldr r3, [r0, #%a0]" : : "i" _FOFF(NTimerQ,iOrderedQ));	// r3=iOrderedQ first
sl@0: 	asm("add r6, r0, #%a0" : : "i" _FOFF(NTimerQ,iOrderedQ));	// r6=&iOrderedQ
sl@0: 	asm("cmp r3, r6 ");
sl@0: 	asm("beq mstim_tick_3 ");			// skip if iOrderedQ empty
sl@0: 	asm("ldr r4, [r0, #%a0]" : : "i" _FOFF(NTimerQ,iMsCount));		// else r4=iMsCount
sl@0: 	asm("ldr r3, [r3, #%a0]" : : "i" _FOFF(NTimer,iTriggerTime));	// and r3=trigger time of first on ordered queue
sl@0: 	asm("sub r3, r3, r4 ");				// r3=trigger time-iMsCount
sl@0: 	asm("cmp r3, #31 ");
sl@0: 	asm("addls r5, r0, #%a0" : : "i" _FOFF(NTimerQ,iDfc));	// if first expiry in <=31ms, doDfc=TRUE
sl@0: 
sl@0: 	// Check iIntQ
sl@0: 	asm("mstim_tick_3: ");
sl@0: 	asm("ldr r3, [r1, #-8]! ");			// r1->iIntQ, r3=iIntQ first
sl@0: 	asm("mov r6, r12 ");				// r6=original cpsr
sl@0: 	asm("cmp r3, r1 ");					// test if iIntQ empty
sl@0: 	asm("beq mstim_tick_4 ");			// branch if it is
sl@0: 
sl@0: 	// Transfer iIntQ to a temporary queue
sl@0: 	asm("ldr r4, [r1, #4] ");			// r4=iIntQ last
sl@0: 	asm("str r1, [r1, #0] ");			// clear iIntQ
sl@0: 	asm("str r1, [r1, #4] ");
sl@0: 	asm("stmfd sp!, {r3,r4} ");			// copy queue onto stack
sl@0: 	asm("str sp, [r4, #0] ");			// iIntQ last->next=sp
sl@0: 	asm("str sp, [r3, #4] ");			// iIntQ first->prev=sp
sl@0: 	INTS_OFF_1(r4, r6, INTS_ALL_OFF);	// r4=cpsr with all interrupts off
sl@0: 
sl@0: 	// Walk the temporary queue and complete timers
sl@0: 	asm("mstim_tick_5: ");
sl@0: 	INTS_OFF_2(r4, r6, INTS_ALL_OFF);	// all interrupts off
sl@0: 	asm("ldr r0, [sp, #0] ");			// r0=q.iNext
sl@0: 	asm("mov r3, #%a0" : : "i" ((TInt)NTimer::EIdle));
sl@0: 	asm("cmp r0, sp ");					// end of queue?
sl@0: 	asm("beq mstim_tick_6 ");			// if so, branch out
sl@0: 	asm("ldmia r0!, {r1,r2} ");			// r1=next r2=prev, r0->iPtr
sl@0: 	asm("strb r3, [r0, #%a0]" : : "i" (_FOFF(NTimer,iState)-8));	// iState=EIdle
sl@0: 	ASM_KILL_LINK_OFFSET(r0,r12,-8);
sl@0: 	asm("ldmia r0, {r0,r12} ");			// r0=iPtr, r12=iFunction
sl@0: 	asm("str r1, [r2, #0] ");			// prev->next=next
sl@0: 	asm("str r2, [r1, #4] ");			// next->prev=prev
sl@0: 	asm("adr lr, mstim_tick_5 ");		// return to mstim_tick_5
sl@0: 	asm("msr cpsr, r6 ");				// restore interrupts
sl@0: 	asm("cmp r12, #0 ");				// iFunction==NULL ?
sl@0: 	asm("beq mstim_tick_7 ");			// if so queue Dfc (iPtr is a pointer to TDfc )
sl@0: 	__JUMP(,r12);						// call timer callback with r0=iPtr
sl@0: 	asm("b mstim_tick_6 ");				// skip queuing of Dfc
sl@0: 
sl@0: 	asm("mstim_tick_7: ");
sl@0: 	asm("b  " CSM_ZN4TDfc3AddEv);		// add the DFC with r0=iPtr - a pointer to TDfc
sl@0: 
sl@0: 	asm("mstim_tick_6: ");
sl@0: 	asm("add sp, sp, #8 ");				// take temporary queue off stack
sl@0: 
sl@0: 	asm("mstim_tick_4: ");
sl@0: 	asm("msr cpsr, r6 ");				// restore original interrupt state
sl@0: 	asm("movs r0, r5 ");				// DFC needed? if so, r0->iDfc
sl@0: 	asm("ldmfd sp!, {r4-r6,lr} ");		// restore registers
sl@0: 	asm("bne  " CSM_ZN4TDfc3AddEv);				// add the DFC if required
sl@0: 	__JUMP(,lr);						// if no DFC needed, return
sl@0: 
sl@0: 	asm("__TheScheduler: ");
sl@0: 	asm(".word TheScheduler ");
sl@0: 	}
sl@0: 
sl@0: __NAKED__ void NTimerQ::DfcFn(TAny* /*aPtr*/)
sl@0: 	{
sl@0: 	// Enter with r0 pointing to NTimerQ
sl@0: 	asm("stmfd sp!, {r7-r11,lr} ");
sl@0: 	SET_INTS_1(r11, MODE_SVC, INTS_ALL_ON);		// always called from SVC mode 
sl@0: 	SET_INTS_1(r10, MODE_SVC, INTS_ALL_OFF);	// with interruts enabled
sl@0: 
sl@0: 	// First transfer entries on the Ordered queue to the Final queues
sl@0: 	asm("mstim_dfc_0: ");
sl@0: 	SET_INTS_2(r10, MODE_SVC, INTS_ALL_OFF);	// disable interrupts
sl@0: 	asm("ldr r1, [r0, #%a0]!" : : "i" _FOFF(NTimerQ,iOrderedQ));	// r0->iOrderedQ, r1=orderedQ first
sl@0: 	asm("cmp r1, r0 ");
sl@0: 	asm("beq mstim_dfc_1 ");			// ordered Q empty so move to next stage
sl@0: 	asm("ldr r2, [r1, #%a0]" : : "i" _FOFF(NTimer,iTriggerTime));	// r2=r1->trigger time
sl@0: 	asm("ldr r3, [r0, #-12] ");			// r3=iMsCount
sl@0: 	asm("subs r3, r2, r3 ");			// r3=trigger time-iMsCount
sl@0: 	asm("cmp r3, #31 ");				// test if remaining time <32ms or has already passed
sl@0: 	asm("bgt mstim_dfc_1 ");			// if >31ms, move to next stage (signed comparison to catch already passed case)
sl@0: 	asm("sub r0, r0, #%a0" : : "i" _FOFF(NTimerQ,iOrderedQ));		// r0->NTimerQ
sl@0: 	asm("bl dequeaddfinal ");			// <=31ms, so deque and add to final queue
sl@0: 	SET_INTS_2(r11, MODE_SVC, INTS_ALL_ON);	// let interrupts in
sl@0: 	__DEBUG_CALLBACK(0);
sl@0: 	asm("b mstim_dfc_0 ");
sl@0: 
sl@0: 	asm("mstim_dfc_1: ");
sl@0: 	SET_INTS_2(r11, MODE_SVC, INTS_ALL_ON);	// let interrupts in
sl@0: 	asm("sub r0, r0, #%a0" : : "i" _FOFF(NTimerQ,iOrderedQ));		// r0->NTimerQ
sl@0: 	__DEBUG_CALLBACK(1);
sl@0: 
sl@0: 	// Next transfer entries on the Holding queue to the Ordered queue or final queue
sl@0: 	asm("mstim_dfc_2: ");
sl@0: 	SET_INTS_2(r10, MODE_SVC, INTS_ALL_OFF);	// disable interrupts
sl@0: 	asm("ldr r1, [r0, #%a0]!" : : "i" _FOFF(NTimerQ,iHoldingQ));	// r0->iHoldingQ, r1=holdingQ first
sl@0: 	asm("cmp r1, r0 ");
sl@0: 	asm("beq mstim_dfc_3 ");			// holding Q empty so move to next stage
sl@0: 	asm("ldr r2, [r1, #%a0]" : : "i" _FOFF(NTimer,iTriggerTime));	// r2=r1->trigger time
sl@0: 	asm("ldr r3, [r0, #-4] ");			// r3=iMsCount
sl@0: 	asm("sub r0, r0, #%a0" : : "i" _FOFF(NTimerQ,iHoldingQ));		// r0->NTimerQ
sl@0: 	asm("subs r3, r2, r3 ");			// r3=trigger time-iMsCount
sl@0: 	asm("cmp r3, #31 ");				// test if remaining time <32ms or has already passed
sl@0: 	asm("bgt mstim_dfc_4 ");			// if >31ms, need to put it on the ordered Q (signed comparison to catch late case)
sl@0: 	asm("bl dequeaddfinal ");			// <=31ms or already passed, so deque and add to final queue
sl@0: 
sl@0: 	asm("mstim_dfc_7: ");
sl@0: 	SET_INTS_2(r11, MODE_SVC, INTS_ALL_ON);	// let interrupts in
sl@0: 	__DEBUG_CALLBACK(2);
sl@0: 	asm("b mstim_dfc_2 ");				// process next holding Q entry
sl@0: 
sl@0: 	// need to put entry r1 trigger time r2 on the ordered Q
sl@0: 	asm("mstim_dfc_4: ");
sl@0: 	asm("ldmia r1, {r3,r12} ");			// r3=r1->next, r12=r1->prev
sl@0: 	asm("mov r9, #0 ");
sl@0: 	asm("strb r9, [r0, #%a0]" : : "i" _FOFF(NTimerQ,iTransferringCancelled));	// iTransferringCancelled=0
sl@0: 	asm("str r3, [r12, #0] ");			// prev->next=next
sl@0: 	asm("str r12, [r3, #4] ");			// next->prev=prev
sl@0: 	asm("mov r3, #%a0" : : "i" ((TInt)NTimer::ETransferring));
sl@0: 	asm("strb r3, [r1, #%a0]" : : "i" _FOFF(NTimer,iState));		// r1->iState=ETransferring
sl@0: 
sl@0: 	asm("mstim_dfc_5: ");
sl@0: 	SET_INTS_2(r11, MODE_SVC, INTS_ALL_ON);	// let interrupts in
sl@0: 	asm("add lr, r0, #%a0" : : "i" _FOFF(NTimerQ,iOrderedQ));	// lr=&iOrderedQ.iA
sl@0: 	__DEBUG_CALLBACK(3);
sl@0: 	SET_INTS_2(r10, MODE_SVC, INTS_ALL_OFF);	// disable interrupts
sl@0: 
sl@0: 	asm("mstim_dfc_9: ");
sl@0: 	asm("ldrb r12, [r0, #%a0]" : : "i" _FOFF(NTimerQ,iTransferringCancelled));
sl@0: 	asm("ldr r3, [lr, #0] ");			// r3=iOrderedQ first
sl@0: 	asm("cmp r12, #0 ");
sl@0: 	asm("bne mstim_dfc_7 ");			// Entry r1 has been cancelled so move to next one
sl@0: 	asm("strb r9, [r0, #%a0]" : : "i" _FOFF(NTimerQ,iCriticalCancelled));	// iCriticalCancelled=0
sl@0: 
sl@0: 	// Walk iOrderedQ to find correct position for this entry
sl@0: 	asm("mstim_dfc_6: ");
sl@0: 	asm("cmp r3, lr ");					// reached end of ordered Q?
sl@0: 	asm("ldrne r12, [r3, #%a0]" : : "i" _FOFF(NTimer,iTriggerTime));	// if not, r12=r3->trigger time
sl@0: 	asm("beq mstim_dfc_8 ");			// branch if we have
sl@0: 	asm("mov r8, #%a0" : : "i" ((TInt)NTimer::ECritical));
sl@0: 	asm("subs r12, r12, r2 ");			// r12=r3->trigger - r1->trigger
sl@0: 	asm("bpl mstim_dfc_8 ");			// branch if r3 expires after r1
sl@0: 	asm("strb r8, [r3, #%a0]" : : "i" _FOFF(NTimer,iState));		// r3->iState=ECritical
sl@0: 	SET_INTS_2(r11, MODE_SVC, INTS_ALL_ON);	// let interrupts in
sl@0: 	asm("mov r8, #%a0" : : "i" ((TInt)NTimer::EOrdered));
sl@0: 	__DEBUG_CALLBACK(4);
sl@0: 	SET_INTS_2(r10, MODE_SVC, INTS_ALL_OFF);	// disable interrupts
sl@0: 	asm("ldr r12, [r0, #%a0]" : : "i" _FOFF(NTimerQ,iTransferringCancelled));
sl@0: 	asm("tst r12, #0xff00 ");			// test iCriticalCancelled
sl@0: 	asm("streqb r8, [r3, #%a0]" : : "i" _FOFF(NTimer,iState));	// if not set, r3->iState=EOrdered
sl@0: 	asm("cmp r12, #0 ");				// test iTransferringCancelled and iCriticalCancelled
sl@0: 	asm("ldreq r3, [r3, #0] ");			// if neither set r3=r3->iNext
sl@0: 	asm("beq mstim_dfc_6 ");			// and inspect next ordered Q entry
sl@0: 	asm("b mstim_dfc_9 ");				// if either set, start again from beginning of ordered Q
sl@0: 
sl@0: 	asm("mstim_dfc_8: ");				// if we get to here we need to insert r1 before r3
sl@0: 	asm("ldr r12, [r3, #4] ");			// r12=r3->iPrev
sl@0: 	asm("mov r8, #%a0" : : "i" ((TInt)NTimer::EOrdered));
sl@0: 	asm("strb r8, [r1, #%a0]" : : "i" _FOFF(NTimer,iState));		// r1->iState=EOrdered
sl@0: 	asm("str r1, [r3, #4] ");			// r3->prev=r1
sl@0: 	asm("str r1, [r12, #0] ");			// r3->prev->next=r1
sl@0: 	asm("stmia r1, {r3,r12} ");			// r1->next=r3, r1->prev=r3->prev
sl@0: 	SET_INTS_2(r11, MODE_SVC, INTS_ALL_ON);	// let interrupts in
sl@0: 	__DEBUG_CALLBACK(5);
sl@0: 	asm("b mstim_dfc_2 ");				// process next holding Q entry
sl@0: 
sl@0: 	// Get here when all holding Q entries processed
sl@0: 	asm("mstim_dfc_3: ");
sl@0: 	SET_INTS_2(r11, MODE_SVC, INTS_ALL_ON);	// let interrupts in
sl@0: 	__DEBUG_CALLBACK(6);
sl@0: 	asm("add r8, r0, #16 ");			// r8->iCompletedQ
sl@0: 
sl@0: 	// Finally do call backs for timers which requested DFC callback
sl@0: 	asm("mstim_dfc_10: ");
sl@0: 	SET_INTS_2(r10, MODE_SVC, INTS_ALL_OFF);	// disable interrupts
sl@0: 	asm("ldr r9, [r8, #0] ");			// r9=completed Q first
sl@0: 	asm("mov r3, #%a0" : : "i" ((TInt)NTimer::EIdle));
sl@0: 	asm("cmp r9, r8 ");					// Is completed Q empty?
sl@0: 	asm("beq mstim_dfc_11 ");			// branch out if it is
sl@0: 	asm("ldmia r9!, {r1,r2} ");			// r1=r9->next, r2=r9->prev, r9->iPtr of completed entry
sl@0: 	asm("strb r3, [r9, #%a0]" : : "i" (_FOFF(NTimer,iState)-8));	// iState=EIdle for completed entry
sl@0: 	asm("ldmia r9, {r0,r3} ");			// r0=iPtr, r3=function address
sl@0: 	ASM_KILL_LINK_OFFSET(r9,r12,-8);
sl@0: 	asm("str r1, [r2, #0] ");			// prev->next=next
sl@0: 	asm("str r2, [r1, #4] ");			// next->prev=prev
sl@0: 	SET_INTS_2(r11, MODE_SVC, INTS_ALL_ON);	// let interrupts in
sl@0: 	__DEBUG_CALLBACK(7);
sl@0: 	asm("adr lr, mstim_dfc_10 ");		// return to mstim_dfc_10
sl@0: 	__JUMP(,r3);						// call back with r0=iPtr
sl@0: 
sl@0: 	// All done
sl@0: 	asm("mstim_dfc_11: ");	
sl@0: 	SET_INTS_2(r11, MODE_SVC, INTS_ALL_ON);	// let interrupts in
sl@0: 	asm("ldmfd sp!, {r7-r11,pc} ");		// and return
sl@0: 
sl@0: 	// Subroutine dequeaddfinal
sl@0: 	// Deque the NTimer pointed to by r1 and put it on its final queue
sl@0: 	// Enter with r0->NTimerQ, r1->NTimer, r2=r1->iTriggerTime
sl@0: 	// Enter and leave with interrupts disabled
sl@0: 	// Can modify r1-r3,r8,r9,r12
sl@0: 	asm("dequeaddfinal: ");
sl@0: 	asm("ldmia r1, {r8,r9} ");			// r8=r1->next, r9=r1->prev
sl@0: 	asm("mov r3, #%a0" : : "i" ((TInt)NTimer::EFinal));
sl@0: 	asm("strb r3, [r1, #%a0]" : : "i" _FOFF(NTimer,iState));	// iState=EFinal
sl@0: 	asm("str r8, [r9, #0] ");			// prev->next=next
sl@0: 	asm("str r9, [r8, #4] ");			// next->prev=prev
sl@0: 	asm("ldr r12, [r0, #%a0]" : : "i" _FOFF(NTimerQ,iPresent));	// r12=timer iPresent
sl@0: 	asm("and r2, r2, #0x1f ");			// r2=trigger time & 0x1f
sl@0: 	asm("mov r3, #1 ");
sl@0: 	asm("orr r12, r12, r3, lsl r2 ");	// set bit in iPresent
sl@0: 	asm("ldrb r3, [r1, #%a0]" : : "i" _FOFF(NTimer,iCompleteInDfc));	// r3=iCompleteInDfc
sl@0: 	asm("str r12, [r0, #%a0]" : : "i" _FOFF(NTimerQ,iPresent));
sl@0: 	asm("add r2, r0, r2, lsl #4 ");		// r2->iIntQ for this timer
sl@0: 	asm("cmp r3, #0 ");
sl@0: 	asm("addne r2, r2, #8 ");			// if iCompleteInDfc, r2->iDfcQ for this timer
sl@0: 	asm("ldr r12, [r2, #4] ");			// r12->last on queue
sl@0: 	asm("str r1, [r2, #4] ");			// queue->last=this
sl@0: 	asm("str r1, [r12, #0] ");			// last->next=this
sl@0: 	asm("stmia r1, {r2,r12} ");			// this->next=&queue, this->prev=last on queue
sl@0: 	__JUMP(,lr);
sl@0: 	}
sl@0: #endif
sl@0: