/*

* 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 "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:  

* naviengine_assp\uart\uart16550.cia

* PDD for 16550 UART - ARM assembler bits

*

*/

#include <comm.h>

#include <assp.h>

#include "uart16550_ne.h"

#include <e32hal.h>

__NAKED__ void T16550Uart::ModifyFCR(TUint /*aClearMask*/, TUint /*aSetMask*/)

	{

	asm("mrs ip, cpsr ");

	asm("orr r3, ip, #0xc0 ");

	asm("msr cpsr, r3 ");

	asm("ldrb r3, [r0, #4] ");

	asm("bic r3, r3, r1 ");

	asm("ldr r1, [r0, #0] ");

	asm("orr r3, r3, r2 ");

	asm("strb r3, [r0, #4] ");

	asm("strb r3, [r1, #%a0]" : : "i" ((TInt)K16550FCROffset));

	asm("msr cpsr, ip ");

	__JUMP(,lr);

	}

__NAKED__ void T16550Uart::ModifyLCR(TUint /*aClearMask*/, TUint /*aSetMask*/)

	{

	asm("mrs ip, cpsr ");

	asm("orr r3, ip, #0xc0 ");

	asm("msr cpsr, r3 ");

	asm("ldrb r3, [r0, #5] ");

	asm("bic r3, r3, r1 ");

	asm("ldr r1, [r0, #0] ");

	asm("orr r3, r3, r2 ");

	asm("strb r3, [r0, #5] ");

	asm("strb r3, [r1, #%a0]" : : "i" ((TInt)K16550LCROffset));

	asm("msr cpsr, ip ");

	__JUMP(,lr);

	}

__NAKED__ void T16550Uart::ModifyMCR(TUint /*aClearMask*/, TUint /*aSetMask*/)

	{

	asm("mrs ip, cpsr ");

	asm("orr r3, ip, #0xc0 ");

	asm("msr cpsr, r3 ");

	asm("ldrb r3, [r0, #6] ");

	asm("bic r3, r3, r1 ");

	asm("ldr r1, [r0, #0] ");

	asm("orr r3, r3, r2 ");

	asm("strb r3, [r0, #6] ");

	asm("strb r3, [r1, #%a0]" : : "i" ((TInt)K16550MCROffset));

	asm("msr cpsr, ip ");

	__JUMP(,lr);

	}

__NAKED__ void T16550Uart::ModifyIER(TUint /*aClearMask*/, TUint /*aSetMask*/)

	{

	asm("mrs ip, cpsr ");

	asm("orr r3, ip, #0xc0 ");

	asm("msr cpsr, r3 ");

	asm("ldrb r3, [r0, #7] ");

	asm("bic r3, r3, r1 ");

	asm("ldr r1, [r0, #0] ");

	asm("orr r3, r3, r2 ");

	asm("strb r3, [r0, #7] ");

	asm("strb r3, [r1, #%a0]" : : "i" ((TInt)K16550IEROffset));

	asm("msr cpsr, ip ");

	__JUMP(,lr);

	}

__NAKED__ void T16550Uart::SetFCR(TUint /*aValue*/)

	{

	asm("mrs ip, cpsr ");

	asm("ldr r3, [r0, #0] ");

	asm("orr r2, ip, #0xc0 ");

	asm("msr cpsr, r2 ");

	asm("strb r1, [r0, #4] ");

	asm("strb r1, [r3, #%a0]" : : "i" ((TInt)K16550FCROffset));

	asm("msr cpsr, ip ");

	__JUMP(,lr);

	}

__NAKED__ void T16550Uart::SetLCR(TUint /*aValue*/)

	{

	asm("mrs ip, cpsr ");

	asm("ldr r3, [r0, #0] ");

	asm("orr r2, ip, #0xc0 ");

	asm("msr cpsr, r2 ");

	asm("strb r1, [r0, #5] ");

	asm("strb r1, [r3, #%a0]" : : "i" ((TInt)K16550LCROffset));

	asm("msr cpsr, ip ");

	__JUMP(,lr);

	}

__NAKED__ void T16550Uart::SetMCR(TUint /*aValue*/)

	{

	asm("mrs ip, cpsr ");

	asm("ldr r3, [r0, #0] ");

	asm("orr r2, ip, #0xc0 ");

	asm("msr cpsr, r2 ");

	asm("strb r1, [r0, #6] ");

	asm("strb r1, [r3, #%a0]" : : "i" ((TInt)K16550MCROffset));

	asm("msr cpsr, ip ");

	__JUMP(,lr);

	}

__NAKED__ void T16550Uart::SetIER(TUint /*aValue*/)

	{

	asm("mrs ip, cpsr ");

	asm("ldr r3, [r0, #0] ");

	asm("orr r2, ip, #0xc0 ");

	asm("msr cpsr, r2 ");

	asm("strb r1, [r0, #7] ");

	asm("strb r1, [r3, #%a0]" : : "i" ((TInt)K16550IEROffset));

	asm("msr cpsr, ip ");

	__JUMP(,lr);

	}