2 ; * FreeRTOS Kernel V10.2.1
\r
3 ; * Copyright (C) 2019 Amazon.com, Inc. or its affiliates. All Rights Reserved.
\r
5 ; * Permission is hereby granted, free of charge, to any person obtaining a copy of
\r
6 ; * this software and associated documentation files (the "Software"), to deal in
\r
7 ; * the Software without restriction, including without limitation the rights to
\r
8 ; * use, copy, modify, merge, publish, distribute, sublicense, and/or sell copies of
\r
9 ; * the Software, and to permit persons to whom the Software is furnished to do so,
\r
10 ; * subject to the following conditions:
\r
12 ; * The above copyright notice and this permission notice shall be included in all
\r
13 ; * copies or substantial portions of the Software.
\r
15 ; * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
\r
16 ; * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, FITNESS
\r
17 ; * FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR
\r
18 ; * COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER
\r
19 ; * IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN
\r
20 ; * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE.
\r
22 ; * http://www.FreeRTOS.org
\r
23 ; * http://aws.amazon.com/freertos
\r
25 ; * 1 tab == 4 spaces!
\r
31 .ref vTaskSwitchContext
\r
32 .ref ulMaxSyscallInterruptPriority
\r
34 .def xPortPendSVHandler
\r
36 .def vPortSVCHandler
\r
37 .def vPortStartFirstTask
\r
40 NVICOffsetConst: .word 0xE000ED08
\r
41 CPACRConst: .word 0xE000ED88
\r
42 pxCurrentTCBConst: .word pxCurrentTCB
\r
43 ulMaxSyscallInterruptPriorityConst: .word ulMaxSyscallInterruptPriority
\r
45 ; -----------------------------------------------------------
\r
48 ulPortGetIPSR: .asmfunc
\r
52 ; -----------------------------------------------------------
\r
55 vPortSetInterruptMask: .asmfunc
\r
57 ldr r0, ulMaxSyscallInterruptPriorityConst
\r
62 ; -----------------------------------------------------------
\r
65 xPortPendSVHandler: .asmfunc
\r
69 ;/* Get the location of the current TCB. */
\r
70 ldr r3, pxCurrentTCBConst
\r
73 ;/* Is the task using the FPU context? If so, push high vfp registers. */
\r
76 vstmdbeq r0!, {s16-s31}
\r
78 ;/* Save the core registers. */
\r
79 stmdb r0!, {r4-r11, r14}
\r
81 ;/* Save the new top of stack into the first member of the TCB. */
\r
85 ldr r0, ulMaxSyscallInterruptPriorityConst
\r
90 bl vTaskSwitchContext
\r
95 ;/* The first item in pxCurrentTCB is the task top of stack. */
\r
99 ;/* Pop the core registers. */
\r
100 ldmia r0!, {r4-r11, r14}
\r
102 ;/* Is the task using the FPU context? If so, pop the high vfp registers
\r
106 vldmiaeq r0!, {s16-s31}
\r
113 ; -----------------------------------------------------------
\r
116 vPortSVCHandler: .asmfunc
\r
117 ;/* Get the location of the current TCB. */
\r
118 ldr r3, pxCurrentTCBConst
\r
121 ;/* Pop the core registers. */
\r
122 ldmia r0!, {r4-r11, r14}
\r
130 ; -----------------------------------------------------------
\r
133 vPortStartFirstTask: .asmfunc
\r
134 ;/* Use the NVIC offset register to locate the stack. */
\r
135 ldr r0, NVICOffsetConst
\r
138 ;/* Set the msp back to the start of the stack. */
\r
140 ;/* Clear the bit that indicates the FPU is in use in case the FPU was used
\r
141 ;before the scheduler was started - which would otherwise result in the
\r
142 ;unnecessary leaving of space in the SVC stack for lazy saving of FPU
\r
146 ;/* Call SVC to start the first task. */
\r
154 ; -----------------------------------------------------------
\r
157 vPortEnableVFP: .asmfunc
\r
158 ;/* The FPU enable bits are in the CPACR. */
\r
159 ldr.w r0, CPACRConst
\r
162 ;/* Enable CP10 and CP11 coprocessors, then save back. */
\r
163 orr r1, r1, #( 0xf << 20 )
\r
170 ; -----------------------------------------------------------
\r