Please see my note book http://mbed.org/users/kenjiArai/notebook/freertos-on-mbed-board-with-mbed-cloud-ide--never-/
This is too old.
Below is another FreeRTOS on mbed.
http://developer.mbed.org/users/rgrover1/code/FreeRTOS/
I don't know it works well or not.
I have not evaluated it.
FreeRTOS/Source/portable/GCC/ARM_CM3/port.c@0:d4960fcea8ff, 2011-01-01 (annotated)
- Committer:
- kenjiArai
- Date:
- Sat Jan 01 11:17:45 2011 +0000
- Revision:
- 0:d4960fcea8ff
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
kenjiArai | 0:d4960fcea8ff | 1 | /* |
kenjiArai | 0:d4960fcea8ff | 2 | FreeRTOS V6.0.3 - Copyright (C) 2010 Real Time Engineers Ltd. |
kenjiArai | 0:d4960fcea8ff | 3 | |
kenjiArai | 0:d4960fcea8ff | 4 | *************************************************************************** |
kenjiArai | 0:d4960fcea8ff | 5 | * * |
kenjiArai | 0:d4960fcea8ff | 6 | * If you are: * |
kenjiArai | 0:d4960fcea8ff | 7 | * * |
kenjiArai | 0:d4960fcea8ff | 8 | * + New to FreeRTOS, * |
kenjiArai | 0:d4960fcea8ff | 9 | * + Wanting to learn FreeRTOS or multitasking in general quickly * |
kenjiArai | 0:d4960fcea8ff | 10 | * + Looking for basic training, * |
kenjiArai | 0:d4960fcea8ff | 11 | * + Wanting to improve your FreeRTOS skills and productivity * |
kenjiArai | 0:d4960fcea8ff | 12 | * * |
kenjiArai | 0:d4960fcea8ff | 13 | * then take a look at the FreeRTOS eBook * |
kenjiArai | 0:d4960fcea8ff | 14 | * * |
kenjiArai | 0:d4960fcea8ff | 15 | * "Using the FreeRTOS Real Time Kernel - a Practical Guide" * |
kenjiArai | 0:d4960fcea8ff | 16 | * http://www.FreeRTOS.org/Documentation * |
kenjiArai | 0:d4960fcea8ff | 17 | * * |
kenjiArai | 0:d4960fcea8ff | 18 | * A pdf reference manual is also available. Both are usually delivered * |
kenjiArai | 0:d4960fcea8ff | 19 | * to your inbox within 20 minutes to two hours when purchased between 8am * |
kenjiArai | 0:d4960fcea8ff | 20 | * and 8pm GMT (although please allow up to 24 hours in case of * |
kenjiArai | 0:d4960fcea8ff | 21 | * exceptional circumstances). Thank you for your support! * |
kenjiArai | 0:d4960fcea8ff | 22 | * * |
kenjiArai | 0:d4960fcea8ff | 23 | *************************************************************************** |
kenjiArai | 0:d4960fcea8ff | 24 | |
kenjiArai | 0:d4960fcea8ff | 25 | This file is part of the FreeRTOS distribution. |
kenjiArai | 0:d4960fcea8ff | 26 | |
kenjiArai | 0:d4960fcea8ff | 27 | FreeRTOS is free software; you can redistribute it and/or modify it under |
kenjiArai | 0:d4960fcea8ff | 28 | the terms of the GNU General Public License (version 2) as published by the |
kenjiArai | 0:d4960fcea8ff | 29 | Free Software Foundation AND MODIFIED BY the FreeRTOS exception. |
kenjiArai | 0:d4960fcea8ff | 30 | ***NOTE*** The exception to the GPL is included to allow you to distribute |
kenjiArai | 0:d4960fcea8ff | 31 | a combined work that includes FreeRTOS without being obliged to provide the |
kenjiArai | 0:d4960fcea8ff | 32 | source code for proprietary components outside of the FreeRTOS kernel. |
kenjiArai | 0:d4960fcea8ff | 33 | FreeRTOS is distributed in the hope that it will be useful, but WITHOUT |
kenjiArai | 0:d4960fcea8ff | 34 | ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or |
kenjiArai | 0:d4960fcea8ff | 35 | FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for |
kenjiArai | 0:d4960fcea8ff | 36 | more details. You should have received a copy of the GNU General Public |
kenjiArai | 0:d4960fcea8ff | 37 | License and the FreeRTOS license exception along with FreeRTOS; if not it |
kenjiArai | 0:d4960fcea8ff | 38 | can be viewed here: http://www.freertos.org/a00114.html and also obtained |
kenjiArai | 0:d4960fcea8ff | 39 | by writing to Richard Barry, contact details for whom are available on the |
kenjiArai | 0:d4960fcea8ff | 40 | FreeRTOS WEB site. |
kenjiArai | 0:d4960fcea8ff | 41 | |
kenjiArai | 0:d4960fcea8ff | 42 | 1 tab == 4 spaces! |
kenjiArai | 0:d4960fcea8ff | 43 | |
kenjiArai | 0:d4960fcea8ff | 44 | http://www.FreeRTOS.org - Documentation, latest information, license and |
kenjiArai | 0:d4960fcea8ff | 45 | contact details. |
kenjiArai | 0:d4960fcea8ff | 46 | |
kenjiArai | 0:d4960fcea8ff | 47 | http://www.SafeRTOS.com - A version that is certified for use in safety |
kenjiArai | 0:d4960fcea8ff | 48 | critical systems. |
kenjiArai | 0:d4960fcea8ff | 49 | |
kenjiArai | 0:d4960fcea8ff | 50 | http://www.OpenRTOS.com - Commercial support, development, porting, |
kenjiArai | 0:d4960fcea8ff | 51 | licensing and training services. |
kenjiArai | 0:d4960fcea8ff | 52 | */ |
kenjiArai | 0:d4960fcea8ff | 53 | |
kenjiArai | 0:d4960fcea8ff | 54 | /*----------------------------------------------------------- |
kenjiArai | 0:d4960fcea8ff | 55 | * Implementation of functions defined in portable.h for the ARM CM3 port. |
kenjiArai | 0:d4960fcea8ff | 56 | *----------------------------------------------------------*/ |
kenjiArai | 0:d4960fcea8ff | 57 | |
kenjiArai | 0:d4960fcea8ff | 58 | // Modified by Kenji Arai / JH1PJL, October 30th,2010 |
kenjiArai | 0:d4960fcea8ff | 59 | // Some functions go to port_asm.c |
kenjiArai | 0:d4960fcea8ff | 60 | |
kenjiArai | 0:d4960fcea8ff | 61 | /* Scheduler includes. */ |
kenjiArai | 0:d4960fcea8ff | 62 | #include "FreeRTOS.h" |
kenjiArai | 0:d4960fcea8ff | 63 | #include "task.h" |
kenjiArai | 0:d4960fcea8ff | 64 | |
kenjiArai | 0:d4960fcea8ff | 65 | /* For backward compatibility, ensure configKERNEL_INTERRUPT_PRIORITY is |
kenjiArai | 0:d4960fcea8ff | 66 | defined. The value should also ensure backward compatibility. |
kenjiArai | 0:d4960fcea8ff | 67 | FreeRTOS.org versions prior to V4.4.0 did not include this definition. */ |
kenjiArai | 0:d4960fcea8ff | 68 | #ifndef configKERNEL_INTERRUPT_PRIORITY |
kenjiArai | 0:d4960fcea8ff | 69 | #define configKERNEL_INTERRUPT_PRIORITY 255 |
kenjiArai | 0:d4960fcea8ff | 70 | #endif |
kenjiArai | 0:d4960fcea8ff | 71 | |
kenjiArai | 0:d4960fcea8ff | 72 | /* Constants required to manipulate the NVIC. */ |
kenjiArai | 0:d4960fcea8ff | 73 | #define portNVIC_SYSTICK_CTRL ( ( volatile unsigned long *) 0xe000e010 ) |
kenjiArai | 0:d4960fcea8ff | 74 | #define portNVIC_SYSTICK_LOAD ( ( volatile unsigned long *) 0xe000e014 ) |
kenjiArai | 0:d4960fcea8ff | 75 | #define portNVIC_INT_CTRL ( ( volatile unsigned long *) 0xe000ed04 ) |
kenjiArai | 0:d4960fcea8ff | 76 | #define portNVIC_SYSPRI2 ( ( volatile unsigned long *) 0xe000ed20 ) |
kenjiArai | 0:d4960fcea8ff | 77 | #define portNVIC_SYSTICK_CLK 0x00000004 |
kenjiArai | 0:d4960fcea8ff | 78 | #define portNVIC_SYSTICK_INT 0x00000002 |
kenjiArai | 0:d4960fcea8ff | 79 | #define portNVIC_SYSTICK_ENABLE 0x00000001 |
kenjiArai | 0:d4960fcea8ff | 80 | #define portNVIC_PENDSVSET 0x10000000 |
kenjiArai | 0:d4960fcea8ff | 81 | #define portNVIC_PENDSV_PRI ( ( ( unsigned long ) configKERNEL_INTERRUPT_PRIORITY ) << 16 ) |
kenjiArai | 0:d4960fcea8ff | 82 | #define portNVIC_SYSTICK_PRI ( ( ( unsigned long ) configKERNEL_INTERRUPT_PRIORITY ) << 24 ) |
kenjiArai | 0:d4960fcea8ff | 83 | |
kenjiArai | 0:d4960fcea8ff | 84 | /* Constants required to set up the initial stack. */ |
kenjiArai | 0:d4960fcea8ff | 85 | #define portINITIAL_XPSR ( 0x01000000 ) |
kenjiArai | 0:d4960fcea8ff | 86 | |
kenjiArai | 0:d4960fcea8ff | 87 | /* The priority used by the kernel is assigned to a variable to make access |
kenjiArai | 0:d4960fcea8ff | 88 | from inline assembler easier. */ |
kenjiArai | 0:d4960fcea8ff | 89 | //const unsigned long ulKernelPriority = configKERNEL_INTERRUPT_PRIORITY; |
kenjiArai | 0:d4960fcea8ff | 90 | |
kenjiArai | 0:d4960fcea8ff | 91 | /* Each task maintains its own interrupt status in the critical nesting |
kenjiArai | 0:d4960fcea8ff | 92 | variable. */ |
kenjiArai | 0:d4960fcea8ff | 93 | #if 0 |
kenjiArai | 0:d4960fcea8ff | 94 | static unsigned portBASE_TYPE uxCriticalNesting = 0xaaaaaaaa; |
kenjiArai | 0:d4960fcea8ff | 95 | #else |
kenjiArai | 0:d4960fcea8ff | 96 | unsigned portBASE_TYPE uxCriticalNesting = 0xaaaaaaaa; |
kenjiArai | 0:d4960fcea8ff | 97 | #endif |
kenjiArai | 0:d4960fcea8ff | 98 | /* |
kenjiArai | 0:d4960fcea8ff | 99 | * Setup the timer to generate the tick interrupts. |
kenjiArai | 0:d4960fcea8ff | 100 | */ |
kenjiArai | 0:d4960fcea8ff | 101 | static void prvSetupTimerInterrupt( void ); |
kenjiArai | 0:d4960fcea8ff | 102 | |
kenjiArai | 0:d4960fcea8ff | 103 | /* |
kenjiArai | 0:d4960fcea8ff | 104 | * Exception handlers. |
kenjiArai | 0:d4960fcea8ff | 105 | */ |
kenjiArai | 0:d4960fcea8ff | 106 | #if 0 |
kenjiArai | 0:d4960fcea8ff | 107 | void xPortPendSVHandler( void ) __attribute__ (( naked )); |
kenjiArai | 0:d4960fcea8ff | 108 | #else |
kenjiArai | 0:d4960fcea8ff | 109 | extern void xPortPendSVHandler( void ); |
kenjiArai | 0:d4960fcea8ff | 110 | #endif |
kenjiArai | 0:d4960fcea8ff | 111 | void xPortSysTickHandler( void ); |
kenjiArai | 0:d4960fcea8ff | 112 | #if 0 |
kenjiArai | 0:d4960fcea8ff | 113 | void vPortSVCHandler( void ) __attribute__ (( naked )); |
kenjiArai | 0:d4960fcea8ff | 114 | #else |
kenjiArai | 0:d4960fcea8ff | 115 | extern void vPortSVCHandler( void ); |
kenjiArai | 0:d4960fcea8ff | 116 | #endif |
kenjiArai | 0:d4960fcea8ff | 117 | |
kenjiArai | 0:d4960fcea8ff | 118 | /* |
kenjiArai | 0:d4960fcea8ff | 119 | * Start first task is a separate function so it can be tested in isolation. |
kenjiArai | 0:d4960fcea8ff | 120 | */ |
kenjiArai | 0:d4960fcea8ff | 121 | #ifdef __cplusplus |
kenjiArai | 0:d4960fcea8ff | 122 | extern "C" { |
kenjiArai | 0:d4960fcea8ff | 123 | #endif |
kenjiArai | 0:d4960fcea8ff | 124 | #if 0 |
kenjiArai | 0:d4960fcea8ff | 125 | void vPortStartFirstTask( void ) __attribute__ (( naked )); |
kenjiArai | 0:d4960fcea8ff | 126 | #else |
kenjiArai | 0:d4960fcea8ff | 127 | extern void vPortStartFirstTask( void ); |
kenjiArai | 0:d4960fcea8ff | 128 | #endif |
kenjiArai | 0:d4960fcea8ff | 129 | #ifdef __cplusplus |
kenjiArai | 0:d4960fcea8ff | 130 | } |
kenjiArai | 0:d4960fcea8ff | 131 | #endif |
kenjiArai | 0:d4960fcea8ff | 132 | /*-----------------------------------------------------------*/ |
kenjiArai | 0:d4960fcea8ff | 133 | |
kenjiArai | 0:d4960fcea8ff | 134 | /* |
kenjiArai | 0:d4960fcea8ff | 135 | * See header file for description. |
kenjiArai | 0:d4960fcea8ff | 136 | */ |
kenjiArai | 0:d4960fcea8ff | 137 | portSTACK_TYPE *pxPortInitialiseStack( portSTACK_TYPE *pxTopOfStack, pdTASK_CODE pxCode, void *pvParameters ) |
kenjiArai | 0:d4960fcea8ff | 138 | { |
kenjiArai | 0:d4960fcea8ff | 139 | /* Simulate the stack frame as it would be created by a context switch |
kenjiArai | 0:d4960fcea8ff | 140 | interrupt. */ |
kenjiArai | 0:d4960fcea8ff | 141 | pxTopOfStack--; /* Offset added to account for the way the MCU uses the stack on entry/exit of interrupts. */ |
kenjiArai | 0:d4960fcea8ff | 142 | *pxTopOfStack = portINITIAL_XPSR; /* xPSR */ |
kenjiArai | 0:d4960fcea8ff | 143 | pxTopOfStack--; |
kenjiArai | 0:d4960fcea8ff | 144 | *pxTopOfStack = ( portSTACK_TYPE ) pxCode; /* PC */ |
kenjiArai | 0:d4960fcea8ff | 145 | pxTopOfStack--; |
kenjiArai | 0:d4960fcea8ff | 146 | *pxTopOfStack = 0; /* LR */ |
kenjiArai | 0:d4960fcea8ff | 147 | pxTopOfStack -= 5; /* R12, R3, R2 and R1. */ |
kenjiArai | 0:d4960fcea8ff | 148 | *pxTopOfStack = ( portSTACK_TYPE ) pvParameters; /* R0 */ |
kenjiArai | 0:d4960fcea8ff | 149 | pxTopOfStack -= 8; /* R11, R10, R9, R8, R7, R6, R5 and R4. */ |
kenjiArai | 0:d4960fcea8ff | 150 | |
kenjiArai | 0:d4960fcea8ff | 151 | return pxTopOfStack; |
kenjiArai | 0:d4960fcea8ff | 152 | } |
kenjiArai | 0:d4960fcea8ff | 153 | /*-----------------------------------------------------------*/ |
kenjiArai | 0:d4960fcea8ff | 154 | |
kenjiArai | 0:d4960fcea8ff | 155 | #if 0 |
kenjiArai | 0:d4960fcea8ff | 156 | void vPortSVCHandler( void ) |
kenjiArai | 0:d4960fcea8ff | 157 | { |
kenjiArai | 0:d4960fcea8ff | 158 | __asm volatile ( |
kenjiArai | 0:d4960fcea8ff | 159 | " ldr r3, pxCurrentTCBConst2 \n" /* Restore the context. */ |
kenjiArai | 0:d4960fcea8ff | 160 | " ldr r1, [r3] \n" /* Use pxCurrentTCBConst to get the pxCurrentTCB address. */ |
kenjiArai | 0:d4960fcea8ff | 161 | " ldr r0, [r1] \n" /* The first item in pxCurrentTCB is the task top of stack. */ |
kenjiArai | 0:d4960fcea8ff | 162 | " ldmia r0!, {r4-r11} \n" /* Pop the registers that are not automatically saved on exception entry and the critical nesting count. */ |
kenjiArai | 0:d4960fcea8ff | 163 | " msr psp, r0 \n" /* Restore the task stack pointer. */ |
kenjiArai | 0:d4960fcea8ff | 164 | " mov r0, #0 \n" |
kenjiArai | 0:d4960fcea8ff | 165 | " msr basepri, r0 \n" |
kenjiArai | 0:d4960fcea8ff | 166 | " orr r14, #0xd \n" |
kenjiArai | 0:d4960fcea8ff | 167 | " bx r14 \n" |
kenjiArai | 0:d4960fcea8ff | 168 | " \n" |
kenjiArai | 0:d4960fcea8ff | 169 | " .align 2 \n" |
kenjiArai | 0:d4960fcea8ff | 170 | "pxCurrentTCBConst2: .word pxCurrentTCB \n" |
kenjiArai | 0:d4960fcea8ff | 171 | ); |
kenjiArai | 0:d4960fcea8ff | 172 | } |
kenjiArai | 0:d4960fcea8ff | 173 | /*-----------------------------------------------------------*/ |
kenjiArai | 0:d4960fcea8ff | 174 | #endif |
kenjiArai | 0:d4960fcea8ff | 175 | |
kenjiArai | 0:d4960fcea8ff | 176 | #if 0 |
kenjiArai | 0:d4960fcea8ff | 177 | void vPortStartFirstTask( void ) |
kenjiArai | 0:d4960fcea8ff | 178 | { |
kenjiArai | 0:d4960fcea8ff | 179 | __asm volatile( |
kenjiArai | 0:d4960fcea8ff | 180 | " ldr r0, =0xE000ED08 \n" /* Use the NVIC offset register to locate the stack. */ |
kenjiArai | 0:d4960fcea8ff | 181 | " ldr r0, [r0] \n" |
kenjiArai | 0:d4960fcea8ff | 182 | " ldr r0, [r0] \n" |
kenjiArai | 0:d4960fcea8ff | 183 | " msr msp, r0 \n" /* Set the msp back to the start of the stack. */ |
kenjiArai | 0:d4960fcea8ff | 184 | " svc 0 \n" /* System call to start first task. */ |
kenjiArai | 0:d4960fcea8ff | 185 | ); |
kenjiArai | 0:d4960fcea8ff | 186 | } |
kenjiArai | 0:d4960fcea8ff | 187 | /*-----------------------------------------------------------*/ |
kenjiArai | 0:d4960fcea8ff | 188 | #endif |
kenjiArai | 0:d4960fcea8ff | 189 | |
kenjiArai | 0:d4960fcea8ff | 190 | /* |
kenjiArai | 0:d4960fcea8ff | 191 | * See header file for description. |
kenjiArai | 0:d4960fcea8ff | 192 | */ |
kenjiArai | 0:d4960fcea8ff | 193 | portBASE_TYPE xPortStartScheduler( void ) |
kenjiArai | 0:d4960fcea8ff | 194 | { |
kenjiArai | 0:d4960fcea8ff | 195 | /* Make PendSV, CallSV and SysTick the same priroity as the kernel. */ |
kenjiArai | 0:d4960fcea8ff | 196 | *(portNVIC_SYSPRI2) |= portNVIC_PENDSV_PRI; |
kenjiArai | 0:d4960fcea8ff | 197 | *(portNVIC_SYSPRI2) |= portNVIC_SYSTICK_PRI; |
kenjiArai | 0:d4960fcea8ff | 198 | |
kenjiArai | 0:d4960fcea8ff | 199 | /* Start the timer that generates the tick ISR. Interrupts are disabled |
kenjiArai | 0:d4960fcea8ff | 200 | here already. */ |
kenjiArai | 0:d4960fcea8ff | 201 | prvSetupTimerInterrupt(); |
kenjiArai | 0:d4960fcea8ff | 202 | |
kenjiArai | 0:d4960fcea8ff | 203 | /* Initialise the critical nesting count ready for the first task. */ |
kenjiArai | 0:d4960fcea8ff | 204 | uxCriticalNesting = 0; |
kenjiArai | 0:d4960fcea8ff | 205 | |
kenjiArai | 0:d4960fcea8ff | 206 | /* Start the first task. */ |
kenjiArai | 0:d4960fcea8ff | 207 | vPortStartFirstTask(); |
kenjiArai | 0:d4960fcea8ff | 208 | |
kenjiArai | 0:d4960fcea8ff | 209 | /* Should not get here! */ |
kenjiArai | 0:d4960fcea8ff | 210 | return 0; |
kenjiArai | 0:d4960fcea8ff | 211 | } |
kenjiArai | 0:d4960fcea8ff | 212 | /*-----------------------------------------------------------*/ |
kenjiArai | 0:d4960fcea8ff | 213 | |
kenjiArai | 0:d4960fcea8ff | 214 | void vPortEndScheduler( void ) |
kenjiArai | 0:d4960fcea8ff | 215 | { |
kenjiArai | 0:d4960fcea8ff | 216 | /* It is unlikely that the CM3 port will require this function as there |
kenjiArai | 0:d4960fcea8ff | 217 | is nothing to return to. */ |
kenjiArai | 0:d4960fcea8ff | 218 | } |
kenjiArai | 0:d4960fcea8ff | 219 | /*-----------------------------------------------------------*/ |
kenjiArai | 0:d4960fcea8ff | 220 | |
kenjiArai | 0:d4960fcea8ff | 221 | void vPortYieldFromISR( void ) |
kenjiArai | 0:d4960fcea8ff | 222 | { |
kenjiArai | 0:d4960fcea8ff | 223 | /* Set a PendSV to request a context switch. */ |
kenjiArai | 0:d4960fcea8ff | 224 | *(portNVIC_INT_CTRL) = portNVIC_PENDSVSET; |
kenjiArai | 0:d4960fcea8ff | 225 | } |
kenjiArai | 0:d4960fcea8ff | 226 | /*-----------------------------------------------------------*/ |
kenjiArai | 0:d4960fcea8ff | 227 | |
kenjiArai | 0:d4960fcea8ff | 228 | #if 0 |
kenjiArai | 0:d4960fcea8ff | 229 | void vPortEnterCritical( void ) |
kenjiArai | 0:d4960fcea8ff | 230 | { |
kenjiArai | 0:d4960fcea8ff | 231 | portDISABLE_INTERRUPTS(); |
kenjiArai | 0:d4960fcea8ff | 232 | uxCriticalNesting++; |
kenjiArai | 0:d4960fcea8ff | 233 | } |
kenjiArai | 0:d4960fcea8ff | 234 | /*-----------------------------------------------------------*/ |
kenjiArai | 0:d4960fcea8ff | 235 | |
kenjiArai | 0:d4960fcea8ff | 236 | void vPortExitCritical( void ) |
kenjiArai | 0:d4960fcea8ff | 237 | { |
kenjiArai | 0:d4960fcea8ff | 238 | uxCriticalNesting--; |
kenjiArai | 0:d4960fcea8ff | 239 | if( uxCriticalNesting == 0 ) |
kenjiArai | 0:d4960fcea8ff | 240 | { |
kenjiArai | 0:d4960fcea8ff | 241 | portENABLE_INTERRUPTS(); |
kenjiArai | 0:d4960fcea8ff | 242 | } |
kenjiArai | 0:d4960fcea8ff | 243 | } |
kenjiArai | 0:d4960fcea8ff | 244 | /*-----------------------------------------------------------*/ |
kenjiArai | 0:d4960fcea8ff | 245 | |
kenjiArai | 0:d4960fcea8ff | 246 | |
kenjiArai | 0:d4960fcea8ff | 247 | void xPortPendSVHandler( void ) |
kenjiArai | 0:d4960fcea8ff | 248 | { |
kenjiArai | 0:d4960fcea8ff | 249 | /* This is a naked function. */ |
kenjiArai | 0:d4960fcea8ff | 250 | |
kenjiArai | 0:d4960fcea8ff | 251 | __asm volatile |
kenjiArai | 0:d4960fcea8ff | 252 | ( |
kenjiArai | 0:d4960fcea8ff | 253 | " mrs r0, psp \n" |
kenjiArai | 0:d4960fcea8ff | 254 | " \n" |
kenjiArai | 0:d4960fcea8ff | 255 | " ldr r3, pxCurrentTCBConst \n" /* Get the location of the current TCB. */ |
kenjiArai | 0:d4960fcea8ff | 256 | " ldr r2, [r3] \n" |
kenjiArai | 0:d4960fcea8ff | 257 | " \n" |
kenjiArai | 0:d4960fcea8ff | 258 | " stmdb r0!, {r4-r11} \n" /* Save the remaining registers. */ |
kenjiArai | 0:d4960fcea8ff | 259 | " str r0, [r2] \n" /* Save the new top of stack into the first member of the TCB. */ |
kenjiArai | 0:d4960fcea8ff | 260 | " \n" |
kenjiArai | 0:d4960fcea8ff | 261 | " stmdb sp!, {r3, r14} \n" |
kenjiArai | 0:d4960fcea8ff | 262 | " mov r0, %0 \n" |
kenjiArai | 0:d4960fcea8ff | 263 | " msr basepri, r0 \n" |
kenjiArai | 0:d4960fcea8ff | 264 | " bl vTaskSwitchContext \n" |
kenjiArai | 0:d4960fcea8ff | 265 | " mov r0, #0 \n" |
kenjiArai | 0:d4960fcea8ff | 266 | " msr basepri, r0 \n" |
kenjiArai | 0:d4960fcea8ff | 267 | " ldmia sp!, {r3, r14} \n" |
kenjiArai | 0:d4960fcea8ff | 268 | " \n" /* Restore the context, including the critical nesting count. */ |
kenjiArai | 0:d4960fcea8ff | 269 | " ldr r1, [r3] \n" |
kenjiArai | 0:d4960fcea8ff | 270 | " ldr r0, [r1] \n" /* The first item in pxCurrentTCB is the task top of stack. */ |
kenjiArai | 0:d4960fcea8ff | 271 | " ldmia r0!, {r4-r11} \n" /* Pop the registers. */ |
kenjiArai | 0:d4960fcea8ff | 272 | " msr psp, r0 \n" |
kenjiArai | 0:d4960fcea8ff | 273 | " bx r14 \n" |
kenjiArai | 0:d4960fcea8ff | 274 | " \n" |
kenjiArai | 0:d4960fcea8ff | 275 | " .align 2 \n" |
kenjiArai | 0:d4960fcea8ff | 276 | "pxCurrentTCBConst: .word pxCurrentTCB \n" |
kenjiArai | 0:d4960fcea8ff | 277 | ::"i"(configMAX_SYSCALL_INTERRUPT_PRIORITY) |
kenjiArai | 0:d4960fcea8ff | 278 | ); |
kenjiArai | 0:d4960fcea8ff | 279 | } |
kenjiArai | 0:d4960fcea8ff | 280 | /*-----------------------------------------------------------*/ |
kenjiArai | 0:d4960fcea8ff | 281 | |
kenjiArai | 0:d4960fcea8ff | 282 | void xPortSysTickHandler( void ) |
kenjiArai | 0:d4960fcea8ff | 283 | { |
kenjiArai | 0:d4960fcea8ff | 284 | unsigned long ulDummy; |
kenjiArai | 0:d4960fcea8ff | 285 | |
kenjiArai | 0:d4960fcea8ff | 286 | /* If using preemption, also force a context switch. */ |
kenjiArai | 0:d4960fcea8ff | 287 | #if configUSE_PREEMPTION == 1 |
kenjiArai | 0:d4960fcea8ff | 288 | *(portNVIC_INT_CTRL) = portNVIC_PENDSVSET; |
kenjiArai | 0:d4960fcea8ff | 289 | #endif |
kenjiArai | 0:d4960fcea8ff | 290 | |
kenjiArai | 0:d4960fcea8ff | 291 | // Modified by Kenji Arai / JH1PJL, October 30th,2010 |
kenjiArai | 0:d4960fcea8ff | 292 | ulDummy = 0; |
kenjiArai | 0:d4960fcea8ff | 293 | portSET_INTERRUPT_MASK_FROM_ISR(); |
kenjiArai | 0:d4960fcea8ff | 294 | { |
kenjiArai | 0:d4960fcea8ff | 295 | vTaskIncrementTick(); |
kenjiArai | 0:d4960fcea8ff | 296 | } |
kenjiArai | 0:d4960fcea8ff | 297 | portCLEAR_INTERRUPT_MASK_FROM_ISR( ulDummy ); |
kenjiArai | 0:d4960fcea8ff | 298 | } |
kenjiArai | 0:d4960fcea8ff | 299 | /*-----------------------------------------------------------*/ |
kenjiArai | 0:d4960fcea8ff | 300 | #endif |
kenjiArai | 0:d4960fcea8ff | 301 | |
kenjiArai | 0:d4960fcea8ff | 302 | /* |
kenjiArai | 0:d4960fcea8ff | 303 | * Setup the systick timer to generate the tick interrupts at the required |
kenjiArai | 0:d4960fcea8ff | 304 | * frequency. |
kenjiArai | 0:d4960fcea8ff | 305 | */ |
kenjiArai | 0:d4960fcea8ff | 306 | void prvSetupTimerInterrupt( void ) |
kenjiArai | 0:d4960fcea8ff | 307 | { |
kenjiArai | 0:d4960fcea8ff | 308 | /* Configure SysTick to interrupt at the requested rate. */ |
kenjiArai | 0:d4960fcea8ff | 309 | *(portNVIC_SYSTICK_LOAD) = ( configCPU_CLOCK_HZ / configTICK_RATE_HZ ) - 1UL; |
kenjiArai | 0:d4960fcea8ff | 310 | *(portNVIC_SYSTICK_CTRL) = portNVIC_SYSTICK_CLK | portNVIC_SYSTICK_INT | portNVIC_SYSTICK_ENABLE; |
kenjiArai | 0:d4960fcea8ff | 311 | } |
kenjiArai | 0:d4960fcea8ff | 312 | /*-----------------------------------------------------------*/ |
kenjiArai | 0:d4960fcea8ff | 313 |