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: // e32test\nkernsa\arm\armutils.cia
sl@0: // 
sl@0: //
sl@0: 
sl@0: #include <arm.h>
sl@0: #include <nktest/nkutils.h>
sl@0: #include <e32cia.h>
sl@0: 
sl@0: #ifdef __SMP__
sl@0: #include <arm_tmr.h>
sl@0: #endif
sl@0: 
sl@0: extern "C" {
sl@0: 
sl@0: void thread_request_signal(NThread* aThread);
sl@0: 
sl@0: extern TUint64 fcf;
sl@0: extern TUint32 nfcf;
sl@0: extern TUint32 nfcfs;
sl@0: 
sl@0: __NAKED__ void __cpu_idle()
sl@0: 	{
sl@0: 	ARM_WFI;
sl@0: 	__JUMP(,lr);
sl@0: 	}
sl@0: 
sl@0: __NAKED__ void __cpu_yield()
sl@0: 	{
sl@0: 	ARM_YIELD;
sl@0: 	__JUMP(,lr);
sl@0: 	}
sl@0: 
sl@0: __NAKED__ TLinAddr __stack_pointer()
sl@0: 	{
sl@0: 	asm("mov	r0, sp ");
sl@0: 	__JUMP(,lr);
sl@0: 	}
sl@0: 
sl@0: __NAKED__ TUint32 __cpu_status_reg()
sl@0: 	{
sl@0: 	asm("mrs	r0, cpsr ");
sl@0: 	__JUMP(,lr);
sl@0: 	}
sl@0: 
sl@0: __NAKED__ TUint32 __cpu_id()
sl@0: 	{
sl@0: 	asm("mrc	p15, 0, r0, c0, c0, 5 ");
sl@0: 	__JUMP(,lr);
sl@0: 	}
sl@0: 
sl@0: __NAKED__ TUint32 __trace_cpu_num()
sl@0: 	{
sl@0: 	asm("mrc	p15, 0, r0, c0, c0, 5 ");
sl@0: 	asm("and	r0, r0, #15 ");
sl@0: 	__JUMP(,lr);
sl@0: 	}
sl@0: 
sl@0: __NAKED__ TUint32 __get_rwno_tid()
sl@0: 	{
sl@0: 	GET_RWNO_TID(,r0);
sl@0: 	__JUMP(,lr);
sl@0: 	}
sl@0: 
sl@0: __NAKED__ TUint32 __get_static_data()
sl@0: 	{
sl@0: 	asm("ldr	r0, 1f ");
sl@0: 	asm("ldr	r0, [r0] ");
sl@0: 	__JUMP(,lr);
sl@0: 	asm("1:		");
sl@0: 	asm(".word	%a0" : : "i" ((TInt)&TheScheduler));
sl@0: 	}
sl@0: 
sl@0: #ifdef __SMP__
sl@0: __NAKED__ TUint32 __get_local_timer_address()
sl@0: 	{
sl@0: 	GET_RWNO_TID(,r0);
sl@0: 	asm("nop ");
sl@0: 	asm("nop ");
sl@0: 	asm("nop ");
sl@0: 	asm("ldr	r0, [r0, #%a0]" : : "i" _FOFF(TSubScheduler,i_LocalTimerAddr));
sl@0: 	asm("nop ");
sl@0: 	asm("nop ");
sl@0: 	asm("nop ");
sl@0: 	__JUMP(,lr);
sl@0: 	}
sl@0: 
sl@0: __NAKED__ TUint32 __get_local_timer_count()
sl@0: 	{
sl@0: 	GET_RWNO_TID(,r0);
sl@0: 	asm("nop ");
sl@0: 	asm("nop ");
sl@0: 	asm("nop ");
sl@0: 	asm("ldr	r1, [r0, #%a0]" : : "i" _FOFF(TSubScheduler,i_LocalTimerAddr));
sl@0: 	asm("nop ");
sl@0: 	asm("nop ");
sl@0: 	asm("nop ");
sl@0: 	asm("ldr	r0, [r1, #%a0]" : : "i" _FOFF(ArmLocalTimer,iTimerCount));
sl@0: 	asm("cmp	r0, #0 ");
sl@0: 	__JUMP(,lr);
sl@0: 	}
sl@0: 
sl@0: __NAKED__ TUint32 __set_local_timer_count()
sl@0: 	{
sl@0: 	GET_RWNO_TID(,r0);
sl@0: 	asm("nop ");
sl@0: 	asm("nop ");
sl@0: 	asm("nop ");
sl@0: 	asm("ldr	r1, [r0, #%a0]" : : "i" _FOFF(TSubScheduler,i_LocalTimerAddr));
sl@0: 	asm("nop ");
sl@0: 	asm("nop ");
sl@0: 	asm("nop ");
sl@0: 	asm("ldr	r0, [r1, #%a0]" : : "i" _FOFF(ArmLocalTimer,iTimerCount));
sl@0: 	asm("str	r0, [r1, #%a0]" : : "i" _FOFF(ArmLocalTimer,iTimerCount));
sl@0: 	__JUMP(,lr);
sl@0: 	}
sl@0: 
sl@0: __NAKED__ TUint32 __swp_local_timer_count()
sl@0: 	{
sl@0: 	GET_RWNO_TID(,r0);
sl@0: 	asm("nop ");
sl@0: 	asm("nop ");
sl@0: 	asm("nop ");
sl@0: 	asm("ldr	r1, [r0, #%a0]" : : "i" _FOFF(TSubScheduler,i_LocalTimerAddr));
sl@0: 	asm("nop ");
sl@0: 	asm("nop ");
sl@0: 	asm("nop ");
sl@0: 	asm("ldr	r0, [r1, #%a0]!" : : "i" _FOFF(ArmLocalTimer,iTimerCount));
sl@0: 	asm("swp	r0, r0, [r1] ");
sl@0: 	__JUMP(,lr);
sl@0: 	}
sl@0: #endif
sl@0: 
sl@0: TUint32 __NAKED__ norm_fast_counter()
sl@0: 	{
sl@0: 	asm("str	lr, [sp, #-4]! ");
sl@0: 	asm("bl "	CSM_CFUNC(fast_counter));
sl@0: 	asm("ldr	r2, __nfcfs ");
sl@0: 	asm("ldr	r2, [r2] ");
sl@0: 	asm("rsb	r3, r2, #32 ");
sl@0: 	asm("mov	r0, r0, lsr r2 ");
sl@0: 	asm("orr	r0, r0, r1, lsl r3 ");
sl@0: 	__POPRET("");
sl@0: 
sl@0: 	asm("__nfcfs: ");
sl@0: 	asm(".word nfcfs ");
sl@0: 	}
sl@0: 
sl@0: __NAKED__ TUint32 set_bit0_if_nonnull(TUint32&)
sl@0: 	{
sl@0: 	__DATA_MEMORY_BARRIER_Z__(r12);
sl@0: 	asm("mov	r3, r0 ");
sl@0: 	asm("1: ");
sl@0: 	LDREX(0,3);
sl@0: 	asm("movs	r1, r0 ");
sl@0: 	asm("beq	2f ");
sl@0: 	asm("orr	r1, r1, #1 ");
sl@0: 	STREX(12,1,3);
sl@0: 	asm("cmp	r12, #0 ");
sl@0: 	asm("bne	1b ");
sl@0: 	asm("2: ");
sl@0: 	__DATA_MEMORY_BARRIER_Z__(r12);
sl@0: 	__JUMP(,lr);
sl@0: 	}
sl@0: 
sl@0: __NAKED__ void flip_bit0(TUint32&)
sl@0: 	{
sl@0: 	__DATA_MEMORY_BARRIER_Z__(r12);
sl@0: 	asm("1: ");
sl@0: 	LDREX(1,0);
sl@0: 	asm("eor	r1, r1, #1 ");
sl@0: 	STREX(12,1,0);
sl@0: 	asm("cmp	r12, #0 ");
sl@0: 	asm("bne	1b ");
sl@0: 	__DATA_MEMORY_BARRIER__(r12);
sl@0: 	__JUMP(,lr);
sl@0: 	}
sl@0: 
sl@0: __NAKED__ TUint32 swap_out_if_bit0_clear(TUint32&)
sl@0: 	{
sl@0: 	__DATA_MEMORY_BARRIER_Z__(r12);
sl@0: 	asm("mov	r3, r0 ");
sl@0: 	asm("1: ");
sl@0: 	LDREX(0,3);
sl@0: 	asm("tst	r0, #1 ");
sl@0: 	asm("bne	2f ");
sl@0: 	STREX(2,12,3);
sl@0: 	asm("cmp	r2, #0 ");
sl@0: 	asm("bne	1b ");
sl@0: 	asm("2: ");
sl@0: 	__DATA_MEMORY_BARRIER_Z__(r12);
sl@0: 	__JUMP(,lr);
sl@0: 	}
sl@0: 
sl@0: __NAKED__ TUint32 __cpsr()
sl@0: 	{
sl@0: 	asm("mrs	r0, cpsr ");
sl@0: 	__JUMP(,lr);
sl@0: 	}
sl@0: }
sl@0: 
sl@0: __NAKED__ void RequestComplete(NThread* /*aThread*/, NRequestStatus*& /*aStatus*/, TInt /*aValue*/)
sl@0: 	{
sl@0: 	__DATA_MEMORY_BARRIER_Z__(r12);
sl@0: 	asm("str	lr, [sp, #-4]! ");
sl@0: 	asm("1: ");
sl@0: 	LDREX(3,1);
sl@0: 	STREX(14,12,1);
sl@0: 	asm("cmp	r14, #0 ");
sl@0: 	asm("bne	1b ");
sl@0: 	asm("cmp	r3, #0 ");
sl@0: 	asm("ldr	lr, [sp], #4 ");
sl@0: 	asm("strne	r2, [r3] ");
sl@0: 	asm("bne "	CSM_CFUNC(thread_request_signal));
sl@0: 	__JUMP(,lr);
sl@0: 	}
sl@0: 
sl@0: