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
32 IMPORT ulCriticalNesting
\r
34 IMPORT ulPortTaskHasFPUContext
\r
35 IMPORT ulAsmAPIPriorityMask
\r
42 ; Save the LR and SPSR onto the system mode stack before switching to
\r
43 ; system mode to save the remaining system mode registers
\r
44 SRSDB sp!, #SYS_MODE
\r
48 ; Push the critical nesting count
\r
49 LDR R2, =ulCriticalNesting
\r
53 ; Does the task have a floating point context that needs saving? If
\r
54 ; ulPortTaskHasFPUContext is 0 then no.
\r
55 LDR R2, =ulPortTaskHasFPUContext
\r
59 ; Save the floating point context, if any
\r
65 ; Save ulPortTaskHasFPUContext itself
\r
68 ; Save the stack pointer in the TCB
\r
69 LDR R0, =pxCurrentTCB
\r
75 ; /**********************************************************************/
\r
80 ; Set the SP to point to the stack of the task being restored.
\r
81 LDR R0, =pxCurrentTCB
\r
85 ; Is there a floating point context to restore? If the restored
\r
86 ; ulPortTaskHasFPUContext is zero then no.
\r
87 LDR R0, =ulPortTaskHasFPUContext
\r
92 ; Restore the floating point context, if any
\r
98 ; Restore the critical section nesting depth
\r
99 LDR R0, =ulCriticalNesting
\r
103 ; Ensure the priority mask is correct for the critical nesting depth
\r
107 LDRNE R4, =ulAsmAPIPriorityMask
\r
110 ; Restore all system mode registers other than the SP (which is already
\r
114 ; Return to the task code, loading CPSR on the way.
\r