/*

 * 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