2 ; FreeRTOS.org V5.1.0 - Copyright (C) 2003-2008 Richard Barry.
\r
4 ; This file is part of the FreeRTOS.org distribution.
\r
6 ; FreeRTOS.org is free software; you can redistribute it and/or modify
\r
7 ; it under the terms of the GNU General Public License as published by
\r
8 ; the Free Software Foundation; either version 2 of the License, or
\r
9 ; (at your option) any later version.
\r
11 ; FreeRTOS.org is distributed in the hope that it will be useful,
\r
12 ; but WITHOUT ANY WARRANTY; without even the implied warranty of
\r
13 ; MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
\r
14 ; GNU General Public License for more details.
\r
16 ; You should have received a copy of the GNU General Public License
\r
17 ; along with FreeRTOS.org; if not, write to the Free Software
\r
18 ; Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
\r
20 ; A special exception to the GPL can be applied should you wish to distribute
\r
21 ; a combined work that includes FreeRTOS.org, without being obliged to provide
\r
22 ; the source code for any proprietary components. See the licensing section
\r
23 ; of http://www.FreeRTOS.org for full details of how and when the exception
\r
26 ; ***************************************************************************
\r
27 ; ***************************************************************************
\r
29 ; * SAVE TIME AND MONEY! We can port FreeRTOS.org to your own hardware, *
\r
30 ; * and even write all or part of your application on your behalf. *
\r
31 ; * See http://www.OpenRTOS.com for details of the services we provide to *
\r
32 ; * expedite your project. *
\r
34 ; ***************************************************************************
\r
35 ; ***************************************************************************
\r
37 ; Please ensure to read the configuration and relevant port sections of the
\r
38 ; online documentation.
\r
40 ; http://www.FreeRTOS.org - Documentation, latest information, license and
\r
43 ; http://www.SafeRTOS.com - A version that is certified for use in safety
\r
46 ; http://www.OpenRTOS.com - Commercial support, development, porting,
\r
47 ; licensing and training services.
\r
50 IMPORT ulCriticalNesting ;
\r
51 IMPORT pxCurrentTCB ;
\r
58 LDR R0, =pxCurrentTCB ; Set the LR to the task stack. The location was...
\r
59 LDR R0, [R0] ; ... stored in pxCurrentTCB
\r
62 LDR R0, =ulCriticalNesting ; The critical nesting depth is the first item on...
\r
63 LDMFD LR!, {R1} ; ...the stack. Load it into the ulCriticalNesting var.
\r
66 LDMFD LR!, {R0} ; Get the SPSR from the stack.
\r
69 LDMFD LR, {R0-R14}^ ; Restore all system mode registers for the task.
\r
72 LDR LR, [LR, #+60] ; Restore the return address
\r
74 ; And return - correcting the offset in the LR to obtain ...
\r
75 SUBS PC, LR, #4 ; ...the correct address.
\r
79 ; /**********************************************************************/
\r
85 STMDB SP!, {R0} ; Store R0 first as we need to use it.
\r
87 STMDB SP,{SP}^ ; Set R0 to point to the task stack pointer.
\r
92 STMDB R0!, {LR} ; Push the return address onto the stack.
\r
93 MOV LR, R0 ; Now we have saved LR we can use it instead of R0.
\r
94 LDMIA SP!, {R0} ; Pop R0 so we can save it onto the system mode stack.
\r
96 STMDB LR,{R0-LR}^ ; Push all the system mode registers onto the task stack.
\r
100 MRS R0, SPSR ; Push the SPSR onto the task stack.
\r
103 LDR R0, =ulCriticalNesting ;
\r
107 LDR R0, =pxCurrentTCB ; Store the new top of stack for the task.
\r