kerneltest/e32test/realtime/d_latncy.cia
changeset 9 96e5fb8b040d
--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/kerneltest/e32test/realtime/d_latncy.cia	Thu Dec 17 09:24:54 2009 +0200
@@ -0,0 +1,115 @@
+// Copyright (c) 1999-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:
+// e32test\realtime\d_latncy.cia
+// 
+//
+
+#include <platform.h>
+
+#if defined(__MEIG__)
+#include <cl7211.h>
+#elif defined(__MAWD__)
+#include <windermere.h>
+#elif defined(__MISA__)
+#include <sa1100.h>
+#elif defined(__MCOT__)
+#include <cotulla.h>
+#elif defined(__MI920__) || defined(__NI1136__)
+#include <integratorap.h>
+#elif defined(__RVEMUBOARD__)
+#include <rvemuboard.h>
+#endif
+
+#include <kernel/kern_priv.h>		//temporary
+#include "d_latncy.h"
+
+#if !defined(__SMP__)
+#if !defined(__EPOC32__) || !defined(__CPU_X86)
+__NAKED__ TUint IntStackPtr()
+	{
+	asm("mrs r1, cpsr ");
+	asm("bic r3, r1, #0x1f ");
+#ifdef __MISA__
+	asm("orr r3, r3, #0xd1 ");		// mode_fiq, all interrupts off
+#else
+	asm("orr r3, r3, #0xd2 ");		// mode_irq, all interrupts off
+#endif
+	asm("msr cpsr, r3 ");
+	asm("mov r0, sp ");				// r0=sp_irq or sp_fiq
+	asm("msr cpsr, r1 ");			// restore interrupts
+	__JUMP(,lr);
+	}
+#endif
+
+#ifdef __CAPTURE_EXTRAS
+#include <arm.h>
+
+__NAKED__ void CaptureExtras(SLatencyResults&)
+	{
+	asm("mrs r1, spsr ");			// r1=interrupted mode
+	asm("mrs r2, cpsr ");			// r2=current PSR
+	asm("tst r1, #0x0f ");			// check if we interrupted user mode
+	asm("orr ip, r1, #%a0" : : "i" ((TInt)KAllInterruptsMask));		// ip=interrupted mode with interrupts off
+	asm("orreq ip, ip, #0x1f ");	// if we interrupted user mode, go to system mode instead
+	asm("bic ip, ip, #0x20 ");		// make sure we don't go into THUMB mode
+	asm("msr cpsr, ip ");			// switch to interrupted mode with ints off
+	asm("mov r3, lr ");				// r3=interrupted mode R14
+	asm("msr cpsr, r2 ");			// back to interrupt mode
+	asm("str r1, [r0, #%a0]" : : "i" _FOFF(SLatencyResults,iIntSpsr));
+	asm("str r3, [r0, #%a0]" : : "i" _FOFF(SLatencyResults,iIntR14));
+	__JUMP(,lr);
+	}
+#endif
+#endif	// __SMP__
+
+#if defined (__MISA__) || defined (__MCOT__)
+__NAKED__ void DLatency::MsCallBack(TAny* aPtr)
+	{
+	asm("ldr ip, __KHwBaseOst");
+	asm("ldr r3, [r0, #%a0]" : : "i" _FOFF(DLatency,iTickIncrement));
+	asm("ldr r1, [ip, #0x10] ");		// r1=OSCR
+	asm("ldr r2, [ip, #0x00] ");		// r2=OSMR0
+	asm("sub r1, r1, r2 ");				// r1=int latency in ticks
+	asm("str r1, [r0, #%a0]" : : "i" _FOFF(DLatency,iResults.iIntTicks));
+	asm("str r2, [r0, #%a0]" : : "i" _FOFF(DLatency,iTriggerTime));
+	asm("add r2, r2, r3 ");				// add increment to OSMR0
+	asm("ldr r1, [r0, #%a0]" : : "i" _FOFF(DLatency,iIntStackTop));
+	asm("ldrb r3, [r0, #%a0]" : : "i" _FOFF(DLatency,iOff));
+	asm("str r2, [ip, #0x00] ");
+	asm("ldr r1, [r1, #-4] ");			// r1=interrupt return address
+	asm("mov r2, #1 ");
+	asm("cmp r3, #0 ");
+	asm("str r1, [r0, #%a0]" : : "i" _FOFF(DLatency,iResults.iIntRetAddr));
+	asm("str r2, [ip, #0x14] ");		// clear interrupt
+	asm("add r0, r0, #%a0" : : "i" _FOFF(DLatency,iMsDfc));
+	asm("beq Add__4TDfc ");
+	__JUMP(,lr);
+
+	asm("__KHwBaseOst: ");	//OS timer register locations
+#ifdef __MISA__
+	#ifdef __MEMMODEL_DIRECT__
+		asm(".word 0x90000000");		//Assabet direct MM
+	#else
+		asm(".word 0x63008000");		//Assabet non-direct MM
+	#endif
+#else
+	#ifdef __MEMMODEL_DIRECT__
+		asm(".word 0x40A00000");		//Lubbock direct MM
+	#else
+		asm(".word 0x6300A000");		//Lubbock non-direct MM
+	#endif
+#endif
+	}
+#endif
+