begriffs open source - freertos/blob - Source/portable/IAR/STR91x/ISR_Support.h

   1 /*\r
   2         FreeRTOS.org V4.6.1 - Copyright (C) 2003-2007 Richard Barry.\r
   3 \r
   4         This file is part of the FreeRTOS distribution.\r
   5 \r
   6         FreeRTOS 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
  10 \r
  11         FreeRTOS 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
  15 \r
  16         You should have received a copy of the GNU General Public License\r
  17         along with FreeRTOS; if not, write to the Free Software\r
  18         Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA\r
  19 \r
  20         A special exception to the GPL can be applied should you wish to distribute\r
  21         a combined work that includes FreeRTOS, 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
  24         can be applied.\r
  25 \r
  26         ***************************************************************************\r
  27         See http://www.FreeRTOS.org for documentation, latest information, license\r
  28         and contact details.  Please ensure to read the configuration and relevant\r
  29         port sections of the online documentation.\r
  30 \r
  31         Also see http://www.SafeRTOS.com a version that has been certified for use\r
  32         in safety critical systems, plus commercial licensing, development and\r
  33         support options.\r
  34         ***************************************************************************\r
  35 */\r
  36 \r
  37         EXTERN pxCurrentTCB\r
  38         EXTERN ulCriticalNesting\r
  39 \r
  40 ;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;\r
  41 ; Context save and restore macro definitions\r
  42 ;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;\r
  43 \r
  44 portSAVE_CONTEXT MACRO\r
  45 \r
  46         ; Push R0 as we are going to use the register.                                  \r
  47         STMDB   SP!, {R0}\r
  48 \r
  49         ; Set R0 to point to the task stack pointer.                                    \r
  50         STMDB   SP, {SP}^\r
  51         NOP\r
  52         SUB             SP, SP, #4\r
  53         LDMIA   SP!, {R0}\r
  54 \r
  55         ; Push the return address onto the stack.                                               \r
  56         STMDB   R0!, {LR}\r
  57 \r
  58         ; Now we have saved LR we can use it instead of R0.                             \r
  59         MOV             LR, R0\r
  60 \r
  61         ; Pop R0 so we can save it onto the system mode stack.                  \r
  62         LDMIA   SP!, {R0}\r
  63 \r
  64         ; Push all the system mode registers onto the task stack.               \r
  65         STMDB   LR, {R0-LR}^\r
  66         NOP\r
  67         SUB             LR, LR, #60\r
  68 \r
  69         ; Push the SPSR onto the task stack.                                                    \r
  70         MRS             R0, SPSR\r
  71         STMDB   LR!, {R0}\r
  72 \r
  73         LDR             R0, =ulCriticalNesting \r
  74         LDR             R0, [R0]\r
  75         STMDB   LR!, {R0}\r
  76 \r
  77         ; Store the new top of stack for the task.                                              \r
  78         LDR             R1, =pxCurrentTCB\r
  79         LDR             R0, [R1]\r
  80         STR             LR, [R0]\r
  81 \r
  82         ENDM\r
  83 \r
  84 \r
  85 portRESTORE_CONTEXT MACRO\r
  86 \r
  87         ; Set the LR to the task stack.                                                                         \r
  88         LDR             R1, =pxCurrentTCB\r
  89         LDR             R0, [R1]\r
  90         LDR             LR, [R0]\r
  91 \r
  92         ; The critical nesting depth is the first item on the stack.    \r
  93         ; Load it into the ulCriticalNesting variable.                                  \r
  94         LDR             R0, =ulCriticalNesting\r
  95         LDMFD   LR!, {R1}\r
  96         STR             R1, [R0]\r
  97 \r
  98         ; Get the SPSR from the stack.                                                                  \r
  99         LDMFD   LR!, {R0}\r
 100         MSR             SPSR_cxsf, R0\r
 101 \r
 102         ; Restore all system mode registers for the task.                               \r
 103         LDMFD   LR, {R0-R14}^\r
 104         NOP\r
 105 \r
 106         ; Restore the return address.                                                                   \r
 107         LDR             LR, [LR, #+60]\r
 108 \r
 109         ; And return - correcting the offset in the LR to obtain the    \r
 110         ; correct address.                                                                                              \r
 111         SUBS    PC, LR, #4\r
 112 \r
 113         ENDM\r
 114 \r