// Copyright (c) 2008-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:
// e32test\nkernsa\arm\armutils.cia
// 
//

#include <arm.h>
#include <nktest/nkutils.h>
#include <e32cia.h>

#ifdef __SMP__
#include <arm_tmr.h>
#endif

extern "C" {

void thread_request_signal(NThread* aThread);

extern TUint64 fcf;
extern TUint32 nfcf;
extern TUint32 nfcfs;

__NAKED__ void __cpu_idle()
	{
	ARM_WFI;
	__JUMP(,lr);
	}

__NAKED__ void __cpu_yield()
	{
	ARM_YIELD;
	__JUMP(,lr);
	}

__NAKED__ TLinAddr __stack_pointer()
	{
	asm("mov	r0, sp ");
	__JUMP(,lr);
	}

__NAKED__ TUint32 __cpu_status_reg()
	{
	asm("mrs	r0, cpsr ");
	__JUMP(,lr);
	}

__NAKED__ TUint32 __cpu_id()
	{
	asm("mrc	p15, 0, r0, c0, c0, 5 ");
	__JUMP(,lr);
	}

__NAKED__ TUint32 __trace_cpu_num()
	{
	asm("mrc	p15, 0, r0, c0, c0, 5 ");
	asm("and	r0, r0, #15 ");
	__JUMP(,lr);
	}

__NAKED__ TUint32 __get_rwno_tid()
	{
	GET_RWNO_TID(,r0);
	__JUMP(,lr);
	}

__NAKED__ TUint32 __get_static_data()
	{
	asm("ldr	r0, 1f ");
	asm("ldr	r0, [r0] ");
	__JUMP(,lr);
	asm("1:		");
	asm(".word	%a0" : : "i" ((TInt)&TheScheduler));
	}

#ifdef __SMP__
__NAKED__ TUint32 __get_local_timer_address()
	{
	GET_RWNO_TID(,r0);
	asm("nop ");
	asm("nop ");
	asm("nop ");
	asm("ldr	r0, [r0, #%a0]" : : "i" _FOFF(TSubScheduler,i_LocalTimerAddr));
	asm("nop ");
	asm("nop ");
	asm("nop ");
	__JUMP(,lr);
	}

__NAKED__ TUint32 __get_local_timer_count()
	{
	GET_RWNO_TID(,r0);
	asm("nop ");
	asm("nop ");
	asm("nop ");
	asm("ldr	r1, [r0, #%a0]" : : "i" _FOFF(TSubScheduler,i_LocalTimerAddr));
	asm("nop ");
	asm("nop ");
	asm("nop ");
	asm("ldr	r0, [r1, #%a0]" : : "i" _FOFF(ArmLocalTimer,iTimerCount));
	asm("cmp	r0, #0 ");
	__JUMP(,lr);
	}

__NAKED__ TUint32 __set_local_timer_count()
	{
	GET_RWNO_TID(,r0);
	asm("nop ");
	asm("nop ");
	asm("nop ");
	asm("ldr	r1, [r0, #%a0]" : : "i" _FOFF(TSubScheduler,i_LocalTimerAddr));
	asm("nop ");
	asm("nop ");
	asm("nop ");
	asm("ldr	r0, [r1, #%a0]" : : "i" _FOFF(ArmLocalTimer,iTimerCount));
	asm("str	r0, [r1, #%a0]" : : "i" _FOFF(ArmLocalTimer,iTimerCount));
	__JUMP(,lr);
	}

__NAKED__ TUint32 __swp_local_timer_count()
	{
	GET_RWNO_TID(,r0);
	asm("nop ");
	asm("nop ");
	asm("nop ");
	asm("ldr	r1, [r0, #%a0]" : : "i" _FOFF(TSubScheduler,i_LocalTimerAddr));
	asm("nop ");
	asm("nop ");
	asm("nop ");
	asm("ldr	r0, [r1, #%a0]!" : : "i" _FOFF(ArmLocalTimer,iTimerCount));
	asm("swp	r0, r0, [r1] ");
	__JUMP(,lr);
	}
#endif

TUint32 __NAKED__ norm_fast_counter()
	{
	asm("str	lr, [sp, #-4]! ");
	asm("bl "	CSM_CFUNC(fast_counter));
	asm("ldr	r2, __nfcfs ");
	asm("ldr	r2, [r2] ");
	asm("rsb	r3, r2, #32 ");
	asm("mov	r0, r0, lsr r2 ");
	asm("orr	r0, r0, r1, lsl r3 ");
	__POPRET("");

	asm("__nfcfs: ");
	asm(".word nfcfs ");
	}

__NAKED__ TUint32 set_bit0_if_nonnull(TUint32&)
	{
	__DATA_MEMORY_BARRIER_Z__(r12);
	asm("mov	r3, r0 ");
	asm("1: ");
	LDREX(0,3);
	asm("movs	r1, r0 ");
	asm("beq	2f ");
	asm("orr	r1, r1, #1 ");
	STREX(12,1,3);
	asm("cmp	r12, #0 ");
	asm("bne	1b ");
	asm("2: ");
	__DATA_MEMORY_BARRIER_Z__(r12);
	__JUMP(,lr);
	}

__NAKED__ void flip_bit0(TUint32&)
	{
	__DATA_MEMORY_BARRIER_Z__(r12);
	asm("1: ");
	LDREX(1,0);
	asm("eor	r1, r1, #1 ");
	STREX(12,1,0);
	asm("cmp	r12, #0 ");
	asm("bne	1b ");
	__DATA_MEMORY_BARRIER__(r12);
	__JUMP(,lr);
	}

__NAKED__ TUint32 swap_out_if_bit0_clear(TUint32&)
	{
	__DATA_MEMORY_BARRIER_Z__(r12);
	asm("mov	r3, r0 ");
	asm("1: ");
	LDREX(0,3);
	asm("tst	r0, #1 ");
	asm("bne	2f ");
	STREX(2,12,3);
	asm("cmp	r2, #0 ");
	asm("bne	1b ");
	asm("2: ");
	__DATA_MEMORY_BARRIER_Z__(r12);
	__JUMP(,lr);
	}

__NAKED__ TUint32 __cpsr()
	{
	asm("mrs	r0, cpsr ");
	__JUMP(,lr);
	}
}

__NAKED__ void RequestComplete(NThread* /*aThread*/, NRequestStatus*& /*aStatus*/, TInt /*aValue*/)
	{
	__DATA_MEMORY_BARRIER_Z__(r12);
	asm("str	lr, [sp, #-4]! ");
	asm("1: ");
	LDREX(3,1);
	STREX(14,12,1);
	asm("cmp	r14, #0 ");
	asm("bne	1b ");
	asm("cmp	r3, #0 ");
	asm("ldr	lr, [sp], #4 ");
	asm("strne	r2, [r3] ");
	asm("bne "	CSM_CFUNC(thread_request_signal));
	__JUMP(,lr);
	}