/*
* 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 "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 <platform.h>

#include "GeneralsDriver.h"
#include <kern_priv.h>		//temporary

#ifdef __SMP__
#include <e32cia.h>
#include <arm.h>
#include <arm_gic.h>
#include <arm_tmr.h>
#endif

#if defined(__GCC32__)
// CIA symbol macros for Gcc98r2
#define CSM__ZN5NKern14CurrentContextEv " CurrentContext__5NKern"
#elif defined(__ARMCC__)
// CIA symbol macros for RVCT
#define CSM__ZN5NKern14CurrentContextEv " __cpp(NKern::CurrentContext)"
#else
// CIA symbol macros for EABI assemblers
#define CSM__ZN5NKern14CurrentContextEv " _ZN5NKern14CurrentContextEv"
#endif

#ifdef __WINS__
__NAKED__ TUint* IntStackPtr()
{
	return 0;
}

__NAKED__ TUint32 SPSR()
{
	return 0;
}
__NAKED__ void UsrModLr(TUint32* a)
{
	*a = 0;
}
#else

__NAKED__ TUint* IntStackPtr()
{
#ifdef __SMP__
    asm("stmfd sp!, {r0-r12,lr} ");
#endif
	asm("mrs r1, cpsr ");           // copy current program status register (cpsr) to R1 
	asm("bic r3, r1, #0x1f ");      // compare to 0x1f, i.e. make sure that spsr is available? 
#ifdef __SMP__
	__ASM_CLI_MODE(MODE_IRQ);       // disable all interrupts and set to irq mode (we are in NTimer interrupt)
#else
	asm("orr r3, r3, #0xd2 ");		// mode_irq, all interrupts off
	asm("msr cpsr, r3 ");           // write result on R3 back to cpsr, irqs disabled 
#endif
	asm("mov r0, sp ");				// read stack pointer to R0, mode r0=sp_irq
	asm("msr cpsr, r1 ");			// restore interrupts
#ifdef __SMP__
    asm("ldmfd sp!, {r0-r12,pc} ");
#endif
	__JUMP(,lr);
}

__NAKED__ TUint32 SPSR()
{
	asm("mrs r0, spsr ");
	__JUMP(,lr);
}
__NAKED__ void UsrModLr(TUint32*)
{
	// r0 = address to store
	asm ("stmia r0,{lr}^");
	__JUMP(,lr);
}

#endif