// Copyright (c) 2007-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\x86\x86utils.cia

// 

//

#include <x86.h>

#include <nktest/nkutils.h>

extern "C" {

void __fastcall thread_request_signal(NThread* aThread);

extern TUint64 fcf;

extern TUint32 nfcf;

extern TUint32 nfcfs;

__NAKED__ void __cpu_idle()

	{

	asm("hlt");

	asm("ret");

	}

__NAKED__ void __cpu_yield()

	{

	X86_PAUSE

	asm("ret");

	}

__NAKED__ TLinAddr __stack_pointer()

	{

	asm("mov eax, esp");

	asm("ret");

	}

__NAKED__ TUint32 __cpu_status_reg()

	{

	asm("pushfd");

	asm("pop eax");

	asm("ret");

	}

__NAKED__ TUint32 __cpu_id()

	{

	asm("xor eax, eax");

	asm("str ax");

	asm("ret");

	}

__NAKED__ TUint32 __trace_cpu_num()

	{

	asm("xor eax, eax");

	asm("str ax");

	asm("sub al, 0x28");

	asm("shr al, 3");

	asm("ret");

	}

TUint64 __NAKED__ fast_counter()

	{

	asm("rdtsc");

	asm("ret");

	}

TUint32 __NAKED__ norm_fast_counter()

	{

	asm("mov ecx, [%a0]": :"i"(&nfcfs));

	asm("rdtsc");

	asm("shrd eax, edx, cl");

	asm("ret");

	}

__NAKED__ void nfcfspin(TUint32 aTicks)

	{

	asm("mov ecx, [%a0]": :"i"(&nfcfs));

	asm("push ebx");

	asm("mov ebx, [esp+8]");

	asm("rdtsc");

	asm("shrd eax, edx, cl");

	asm("add ebx, eax");

	asm("nfcfspin1:");

	asm("rdtsc");

	asm("shrd eax, edx, cl");

	asm("sub eax, ebx");

	asm("js nfcfspin1");

	asm("pop ebx");

	asm("ret");

	}

__NAKED__ void fcfspin(TUint64 aTicks)

	{

	asm("mov ecx, [esp+4]");

	asm("push ebx");

	asm("mov ebx, [esp+12]");

	asm("rdtsc");

	asm("add ecx, eax");

	asm("adc ebx, edx");

	asm("fcfspin1:");

	asm("rdtsc");

	asm("sub eax, ecx");

	asm("sbb edx, ebx");

	asm("js fcfspin1");

	asm("pop ebx");

	asm("ret");

	}

__NAKED__ TUint32 set_bit0_if_nonnull(TUint32&)

	{

	asm("mov ecx, [esp+4]");

	asm("mov eax, [ecx]");

	asm("xx1:");

	asm("cmp eax, 0");

	asm("jz short done1");

	asm("mov edx, eax");

	asm("or edx, 1");

	asm("lock cmpxchg [ecx], edx");

	asm("jne short xx1");

	asm("done1:");

	asm("ret");

	}

__NAKED__ void flip_bit0(TUint32&)

	{

	asm("mov ecx, [esp+4]");

	asm("lock xor dword ptr [ecx], 1");

	asm("ret");

	}

__NAKED__ TUint32 swap_out_if_bit0_clear(TUint32&)

	{

	asm("mov ecx, [esp+4]");

	asm("mov eax, [ecx]");

	asm("xx2:");

	asm("test eax, 1");

	asm("jnz short done2");

	asm("xor edx, edx");

	asm("lock cmpxchg [ecx], edx");

	asm("jne short xx2");

	asm("done2:");

	asm("ret");

	}

__NAKED__ TUint32 __eflags()

	{

	asm("pushfd ");

	asm("pop eax ");

	asm("ret ");

	}

}

__NAKED__ void RequestComplete(NThread* /*aThread*/, NRequestStatus*& /*aStatus*/, TInt /*aValue*/)

	{

	asm("mov ecx, [esp+8]");

	asm("xor eax, eax");

	asm("lock xchg eax, [ecx]");

	asm("mov edx, [esp+12]");

	asm("cmp eax, 0");

	asm("jz done3");

	asm("mov ecx, [esp+4]");

	asm("mov [eax], edx");

	asm("call %a0": :"i"(&thread_request_signal));

	asm("done3:");

	asm("ret");

	}