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
28 IMPORT ulCriticalNesting ;
\r
29 IMPORT pxCurrentTCB ;
\r
36 LDR R0, =pxCurrentTCB ; Set the LR to the task stack. The location was...
\r
37 LDR R0, [R0] ; ... stored in pxCurrentTCB
\r
40 LDR R0, =ulCriticalNesting ; The critical nesting depth is the first item on...
\r
41 LDMFD LR!, {R1} ; ...the stack. Load it into the ulCriticalNesting var.
\r
44 LDMFD LR!, {R0} ; Get the SPSR from the stack.
\r
47 LDMFD LR, {R0-R14}^ ; Restore all system mode registers for the task.
\r
50 LDR LR, [LR, #+60] ; Restore the return address
\r
52 ; And return - correcting the offset in the LR to obtain ...
\r
53 SUBS PC, LR, #4 ; ...the correct address.
\r
57 ; /**********************************************************************/
\r
63 STMDB SP!, {R0} ; Store R0 first as we need to use it.
\r
65 STMDB SP,{SP}^ ; Set R0 to point to the task stack pointer.
\r
70 STMDB R0!, {LR} ; Push the return address onto the stack.
\r
71 MOV LR, R0 ; Now we have saved LR we can use it instead of R0.
\r
72 LDMIA SP!, {R0} ; Pop R0 so we can save it onto the system mode stack.
\r
74 STMDB LR,{R0-LR}^ ; Push all the system mode registers onto the task stack.
\r
78 MRS R0, SPSR ; Push the SPSR onto the task stack.
\r
81 LDR R0, =ulCriticalNesting ;
\r
85 LDR R0, =pxCurrentTCB ; Store the new top of stack for the task.
\r