// Copyright (c) 1997-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:
//

#define INCLUDED_FROM_ASM

#include <e32cia.h>
#include <arm_mem.h>
#include "xdefs.h"

#ifdef _DEBUG
#define ASM_KILL_LINK(rp,rs)	asm("mov "#rs", #0xdf ");\
								asm("orr "#rs", "#rs", "#rs", lsl #8 ");\
								asm("orr "#rs", "#rs", "#rs", lsl #16 ");\
								asm("str "#rs", ["#rp"] ");\
								asm("str "#rs", ["#rp", #4] ");
#else
#define ASM_KILL_LINK(rp,rs)
#endif

#ifdef _DEBUG
extern "C" void __FaultIpcClientNotNull();  // defined in ckernel.cpp
#endif

#ifdef _DEBUG
__NAKED__ TInt DoThreadReadAndParseDesHeader(DThread* aThread, const TAny* aSrc, TDesHeader& aDest)
#else
__NAKED__ TInt DThread::ReadAndParseDesHeader(const TAny* aSrc, TDesHeader& aDest)
#endif
	{
	ASM_ASSERT_PAGING_SAFE;
	// save state including 'this', aSrc and sDest. Double word aligns the stack 
	// which is required to call c++ functions.
	asm("stmdb sp!, {r0-r2, r4-r8, r10, lr} ");

	// Register use this method:
	// r0 = 'this' until iIpcClient set.
	// r1 = aSrc until read_and_parse_des_header_local.
	// r2 = aDest until read_and_parse_des_header_local.
	// r4 = target process
	// r5 = current nthread
	// r6 = scheduler.
	// r7 = current process 
	// r8 = orig ttbr0
	// r10 = os asid of current process.

	// Open a reference on the target process's os asid as we will be switching to
	// it so it can't be allowed to be freed and/or reused.
	asm("ldr r4, [r0, #%a0]" : : "i" _FOFF(DThread,iOwningProcess));		// r4->target process
	asm("bl " CSM_ZN5NKern13ThreadEnterCSEv);	// First enter a critical section so can't leak os asid reference.
	asm("mov r0, r4");		// r0 = target process ('this' for TryOpenOsAsid() below).
	asm("bl " CSM_ZN16DMemModelProcess13TryOpenOsAsidEv);
	// Check a reference could be opened on target process's os asid, failed if r0 < 0.
	asm("cmp r0, #0");
	asm("bmi readParseDesHeader_ExitErr");
	asm("mov r10, r0");			// r10 = os asid of current process

	asm("ldmia sp!, {r0-r2}");	// r0 = this, r1 = aSrc, r2 = aDest
	
	__ASM_CLI(); // disable all interrupts
#ifdef __SMP__
	GET_RWNO_TID(,r6);														// r6->TSubScheduler
	asm("ldr r7, [r6, #%a0]" : : "i" _FOFF(TSubScheduler,iAddressSpace));	// r7->current process
	asm("ldr r5, [r6, #%a0]" : : "i" _FOFF(TSubScheduler,iCurrentThread));	// r5->current NThreadBase
#else
	asm("ldr r6, __TheScheduler ");											// r6->TheScheduler
	asm("ldr r7, [r6, #%a0]" : : "i" _FOFF(TScheduler,iAddressSpace));		// r7->current process
	asm("ldr r5, [r6, #%a0]" : : "i" _FOFF(TScheduler,iCurrentThread));		// r5->current NThreadBase
#endif

	// set TheCurrentThread->iIpcClient to this (r0) thread
#ifdef _DEBUG
	asm("ldr r12, [r5, #%a0] " : : "i" (_FOFF(DThread, iIpcClient) - _FOFF(DThread, iNThread)));
	asm("teq r12, #0 ");
	asm("bne __FaultIpcClientNotNull ");
#endif
	asm("str r0, [r5, #%a0] " : : "i" (_FOFF(DThread, iIpcClient) - _FOFF(DThread, iNThread)));

	// switch address space to process r4...
	asm("mrc p15, 0, r8, c2, c0, 0 ");		// r8 = original TTBR0
	asm("ldr r0, [r4, #%a0]" : : "i" _FOFF(DMemModelProcess,iPageDir));		// r0->target process page directory
	asm("and lr, r8, #%a0" : : "i" ((TInt)KTTBRExtraBitsMask));	// lr = TTBR0 extra bits
	asm("orr r0, r0, lr ");					// r0 = target process page directory + extra bits

	__ASM_SET_ADDRESS_SPACE(r10,r0,lr);
#ifdef __SMP__
	asm("str r4, [r6, #%a0]" : : "i" _FOFF(TSubScheduler,iAddressSpace));
#else
	asm("str r4, [r6, #%a0]" : : "i" _FOFF(TScheduler,iAddressSpace));
#endif
	asm("str r4, [r5, #%a0]" : : "i" _FOFF(NThread,iAddressSpace));
	__ASM_STI(); // enable all interrupts

	// read and parse descriptor header, r1=aSrc, r2=aDest
	asm("bl read_and_parse_des_header_local");	// defined in e32/kernel/arm/cipc.cia
		
	// restore address space to process r7...
	asm("ldr r12, [r7, #%a0]" : : "i" _FOFF(DMemModelProcess,iOsAsid));		// r12 = current process ASID

	__ASM_CLI(); // disable all interrupts
	__ASM_SET_ADDRESS_SPACE(r12,r8,lr);
#ifdef __SMP__
	GET_RWNO_TID(,r6);														// r6->TSubScheduler
	asm("str r7, [r6, #%a0]" : : "i" _FOFF(TSubScheduler,iAddressSpace));
#else
	asm("str r7, [r6, #%a0]" : : "i" _FOFF(TScheduler,iAddressSpace));
#endif
	asm("str r7, [r5, #%a0]" : : "i" _FOFF(NThread,iAddressSpace));
	__ASM_STI(); // enable all interrupts

	// set TheCurrentThread->iIpcClient to NULL again
	asm("mov r12, #0 ");
	asm("str r12, [r5, #%a0] " : : "i" (_FOFF(DThread, iIpcClient) - _FOFF(DThread, iNThread)));

	// close the reference on the target process's os asid.
	asm("mov r6, r0");	// r6 = return value from read_and_parse_des_header_local
	asm("mov r0, r4");	// r0 = target process
	asm("bl " CSM_ZN16DMemModelProcess11CloseOsAsidEv);
	
	// finished...
	asm("bl " CSM_ZN5NKern13ThreadLeaveCSEv);	// Os asid reference closed so leave critical section.
	asm("mov r0, r6");			// r0 = return value from read_and_parse_des_header_local.
	__POPRET("r4-r8, r10, ");	// Restore the state and return.

	// exit with error...
	asm("readParseDesHeader_ExitErr:");
	asm("bl " CSM_ZN5NKern13ThreadLeaveCSEv);	// Os asid reference not open so leave critical section.
	asm("mov r0, #%a0" : : "i" ((TInt)KErrBadDescriptor));
	asm("add sp, sp, #12");	// pop r0-r2 off the stack.
	__POPRET("r4-r8, r10, ");	// Restore the state and return.

#ifndef __SMP__
	asm("__TheScheduler: ");
	asm(".word TheScheduler ");
#endif
	}