/*
* Copyright (c) 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:
*
*/
#include "plat_priv.h"
#include "d_mstim.h"

#if defined(__X86__)
typedef TUint TCounter;
TUint32* TickCountPtr;

const TLinAddr NTimerQ_TimerAddress = (TLinAddr)&NTimerQ::TimerAddress;

__NAKED__ TCounter TIMER()
	{
	asm("mov eax, [%a0]": :"i"(&TickCountPtr));
	asm("pushfd");
	asm("mov eax, [eax]");
	asm("cli");
	asm("shl eax, 16");
	asm("mov al, 0x80");	// channel 2 latch cmd
	asm("out 0x43, al");
	asm("in al, 0x42");		// get ls byte
	asm("mov ah, al");
	asm("in al, 0x42");		// get ms byte
	asm("xchg al, ah");
	asm("popfd");
	asm("ret");
	}

__NAKED__ void SetUpTimerChannel2()
	{
	asm("pushfd");
	asm("cli");
	asm("in al, 0x61");
	asm("and al, 0xfc");	// disable speaker
	asm("or al, 1");		// enable timer channel 2
	asm("out 0x61, al");
	asm("mov al, 0xb4");
	asm("out 0x43, al");	// timer chan 2 mode 2
	asm("mov al, 0");
	asm("out 0x42, al");	// initial count 0 = free running
	asm("out 0x42, al");
	asm("popfd");
	asm("call %a0": :"i"(NTimerQ_TimerAddress));
	asm("lea eax, [eax+%0]": :"i"_FOFF(NTimerQ,iMsCount));
	asm("mov [%a0], eax": :"i"(&TickCountPtr));
	asm("ret");
	}
#endif