1.1 --- /dev/null Thu Jan 01 00:00:00 1970 +0000
1.2 +++ b/os/kernelhwsrv/kerneltest/e32test/nkernsa/arm/armutils.cia Fri Jun 15 03:10:57 2012 +0200
1.3 @@ -0,0 +1,230 @@
1.4 +// Copyright (c) 2008-2009 Nokia Corporation and/or its subsidiary(-ies).
1.5 +// All rights reserved.
1.6 +// This component and the accompanying materials are made available
1.7 +// under the terms of the License "Eclipse Public License v1.0"
1.8 +// which accompanies this distribution, and is available
1.9 +// at the URL "http://www.eclipse.org/legal/epl-v10.html".
1.10 +//
1.11 +// Initial Contributors:
1.12 +// Nokia Corporation - initial contribution.
1.13 +//
1.14 +// Contributors:
1.15 +//
1.16 +// Description:
1.17 +// e32test\nkernsa\arm\armutils.cia
1.18 +//
1.19 +//
1.20 +
1.21 +#include <arm.h>
1.22 +#include <nktest/nkutils.h>
1.23 +#include <e32cia.h>
1.24 +
1.25 +#ifdef __SMP__
1.26 +#include <arm_tmr.h>
1.27 +#endif
1.28 +
1.29 +extern "C" {
1.30 +
1.31 +void thread_request_signal(NThread* aThread);
1.32 +
1.33 +extern TUint64 fcf;
1.34 +extern TUint32 nfcf;
1.35 +extern TUint32 nfcfs;
1.36 +
1.37 +__NAKED__ void __cpu_idle()
1.38 + {
1.39 + ARM_WFI;
1.40 + __JUMP(,lr);
1.41 + }
1.42 +
1.43 +__NAKED__ void __cpu_yield()
1.44 + {
1.45 + ARM_YIELD;
1.46 + __JUMP(,lr);
1.47 + }
1.48 +
1.49 +__NAKED__ TLinAddr __stack_pointer()
1.50 + {
1.51 + asm("mov r0, sp ");
1.52 + __JUMP(,lr);
1.53 + }
1.54 +
1.55 +__NAKED__ TUint32 __cpu_status_reg()
1.56 + {
1.57 + asm("mrs r0, cpsr ");
1.58 + __JUMP(,lr);
1.59 + }
1.60 +
1.61 +__NAKED__ TUint32 __cpu_id()
1.62 + {
1.63 + asm("mrc p15, 0, r0, c0, c0, 5 ");
1.64 + __JUMP(,lr);
1.65 + }
1.66 +
1.67 +__NAKED__ TUint32 __trace_cpu_num()
1.68 + {
1.69 + asm("mrc p15, 0, r0, c0, c0, 5 ");
1.70 + asm("and r0, r0, #15 ");
1.71 + __JUMP(,lr);
1.72 + }
1.73 +
1.74 +__NAKED__ TUint32 __get_rwno_tid()
1.75 + {
1.76 + GET_RWNO_TID(,r0);
1.77 + __JUMP(,lr);
1.78 + }
1.79 +
1.80 +__NAKED__ TUint32 __get_static_data()
1.81 + {
1.82 + asm("ldr r0, 1f ");
1.83 + asm("ldr r0, [r0] ");
1.84 + __JUMP(,lr);
1.85 + asm("1: ");
1.86 + asm(".word %a0" : : "i" ((TInt)&TheScheduler));
1.87 + }
1.88 +
1.89 +#ifdef __SMP__
1.90 +__NAKED__ TUint32 __get_local_timer_address()
1.91 + {
1.92 + GET_RWNO_TID(,r0);
1.93 + asm("nop ");
1.94 + asm("nop ");
1.95 + asm("nop ");
1.96 + asm("ldr r0, [r0, #%a0]" : : "i" _FOFF(TSubScheduler,i_LocalTimerAddr));
1.97 + asm("nop ");
1.98 + asm("nop ");
1.99 + asm("nop ");
1.100 + __JUMP(,lr);
1.101 + }
1.102 +
1.103 +__NAKED__ TUint32 __get_local_timer_count()
1.104 + {
1.105 + GET_RWNO_TID(,r0);
1.106 + asm("nop ");
1.107 + asm("nop ");
1.108 + asm("nop ");
1.109 + asm("ldr r1, [r0, #%a0]" : : "i" _FOFF(TSubScheduler,i_LocalTimerAddr));
1.110 + asm("nop ");
1.111 + asm("nop ");
1.112 + asm("nop ");
1.113 + asm("ldr r0, [r1, #%a0]" : : "i" _FOFF(ArmLocalTimer,iTimerCount));
1.114 + asm("cmp r0, #0 ");
1.115 + __JUMP(,lr);
1.116 + }
1.117 +
1.118 +__NAKED__ TUint32 __set_local_timer_count()
1.119 + {
1.120 + GET_RWNO_TID(,r0);
1.121 + asm("nop ");
1.122 + asm("nop ");
1.123 + asm("nop ");
1.124 + asm("ldr r1, [r0, #%a0]" : : "i" _FOFF(TSubScheduler,i_LocalTimerAddr));
1.125 + asm("nop ");
1.126 + asm("nop ");
1.127 + asm("nop ");
1.128 + asm("ldr r0, [r1, #%a0]" : : "i" _FOFF(ArmLocalTimer,iTimerCount));
1.129 + asm("str r0, [r1, #%a0]" : : "i" _FOFF(ArmLocalTimer,iTimerCount));
1.130 + __JUMP(,lr);
1.131 + }
1.132 +
1.133 +__NAKED__ TUint32 __swp_local_timer_count()
1.134 + {
1.135 + GET_RWNO_TID(,r0);
1.136 + asm("nop ");
1.137 + asm("nop ");
1.138 + asm("nop ");
1.139 + asm("ldr r1, [r0, #%a0]" : : "i" _FOFF(TSubScheduler,i_LocalTimerAddr));
1.140 + asm("nop ");
1.141 + asm("nop ");
1.142 + asm("nop ");
1.143 + asm("ldr r0, [r1, #%a0]!" : : "i" _FOFF(ArmLocalTimer,iTimerCount));
1.144 + asm("swp r0, r0, [r1] ");
1.145 + __JUMP(,lr);
1.146 + }
1.147 +#endif
1.148 +
1.149 +TUint32 __NAKED__ norm_fast_counter()
1.150 + {
1.151 + asm("str lr, [sp, #-4]! ");
1.152 + asm("bl " CSM_CFUNC(fast_counter));
1.153 + asm("ldr r2, __nfcfs ");
1.154 + asm("ldr r2, [r2] ");
1.155 + asm("rsb r3, r2, #32 ");
1.156 + asm("mov r0, r0, lsr r2 ");
1.157 + asm("orr r0, r0, r1, lsl r3 ");
1.158 + __POPRET("");
1.159 +
1.160 + asm("__nfcfs: ");
1.161 + asm(".word nfcfs ");
1.162 + }
1.163 +
1.164 +__NAKED__ TUint32 set_bit0_if_nonnull(TUint32&)
1.165 + {
1.166 + __DATA_MEMORY_BARRIER_Z__(r12);
1.167 + asm("mov r3, r0 ");
1.168 + asm("1: ");
1.169 + LDREX(0,3);
1.170 + asm("movs r1, r0 ");
1.171 + asm("beq 2f ");
1.172 + asm("orr r1, r1, #1 ");
1.173 + STREX(12,1,3);
1.174 + asm("cmp r12, #0 ");
1.175 + asm("bne 1b ");
1.176 + asm("2: ");
1.177 + __DATA_MEMORY_BARRIER_Z__(r12);
1.178 + __JUMP(,lr);
1.179 + }
1.180 +
1.181 +__NAKED__ void flip_bit0(TUint32&)
1.182 + {
1.183 + __DATA_MEMORY_BARRIER_Z__(r12);
1.184 + asm("1: ");
1.185 + LDREX(1,0);
1.186 + asm("eor r1, r1, #1 ");
1.187 + STREX(12,1,0);
1.188 + asm("cmp r12, #0 ");
1.189 + asm("bne 1b ");
1.190 + __DATA_MEMORY_BARRIER__(r12);
1.191 + __JUMP(,lr);
1.192 + }
1.193 +
1.194 +__NAKED__ TUint32 swap_out_if_bit0_clear(TUint32&)
1.195 + {
1.196 + __DATA_MEMORY_BARRIER_Z__(r12);
1.197 + asm("mov r3, r0 ");
1.198 + asm("1: ");
1.199 + LDREX(0,3);
1.200 + asm("tst r0, #1 ");
1.201 + asm("bne 2f ");
1.202 + STREX(2,12,3);
1.203 + asm("cmp r2, #0 ");
1.204 + asm("bne 1b ");
1.205 + asm("2: ");
1.206 + __DATA_MEMORY_BARRIER_Z__(r12);
1.207 + __JUMP(,lr);
1.208 + }
1.209 +
1.210 +__NAKED__ TUint32 __cpsr()
1.211 + {
1.212 + asm("mrs r0, cpsr ");
1.213 + __JUMP(,lr);
1.214 + }
1.215 +}
1.216 +
1.217 +__NAKED__ void RequestComplete(NThread* /*aThread*/, NRequestStatus*& /*aStatus*/, TInt /*aValue*/)
1.218 + {
1.219 + __DATA_MEMORY_BARRIER_Z__(r12);
1.220 + asm("str lr, [sp, #-4]! ");
1.221 + asm("1: ");
1.222 + LDREX(3,1);
1.223 + STREX(14,12,1);
1.224 + asm("cmp r14, #0 ");
1.225 + asm("bne 1b ");
1.226 + asm("cmp r3, #0 ");
1.227 + asm("ldr lr, [sp], #4 ");
1.228 + asm("strne r2, [r3] ");
1.229 + asm("bne " CSM_CFUNC(thread_request_signal));
1.230 + __JUMP(,lr);
1.231 + }
1.232 +
1.233 +