git.sur5r.net Git - freertos/blob - Source/portable/IAR/ARM_CM3/portasm.s

   1 /*\r
   2         FreeRTOS.org V4.7.2 - Copyright (C) 2003-2008 Richard Barry.\r
   3 \r
   4         This file is part of the FreeRTOS.org distribution.\r
   5 \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
  10 \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
  15 \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
  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.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
  24         can be applied.\r
  25 \r
  26         ***************************************************************************\r
  27 \r
  28         Please ensure to read the configuration and relevant port sections of the\r
  29         online documentation.\r
  30 \r
  31         +++ http://www.FreeRTOS.org +++\r
  32         Documentation, latest information, license and contact details.\r
  33 \r
  34         +++ http://www.SafeRTOS.com +++\r
  35         A version that is certified for use in safety critical systems.\r
  36 \r
  37         +++ http://www.OpenRTOS.com +++\r
  38         Commercial support, development, porting, licensing and training services.\r
  39 \r
  40         ***************************************************************************\r
  41 */\r
  42 \r
  43 /*\r
  44         Change from V4.2.1:\r
  45 \r
  46         + Introduced usage of configKERNEL_INTERRUPT_PRIORITY macro to set the\r
  47           interrupt priority used by the kernel.\r
  48 */\r
  49 \r
  50 #include <FreeRTOSConfig.h>\r
  51 \r
  52 /* For backward compatibility, ensure configKERNEL_INTERRUPT_PRIORITY is\r
  53 defined.  The value zero should also ensure backward compatibility.\r
  54 FreeRTOS.org versions prior to V4.3.0 did not include this definition. */\r
  55 #ifndef configKERNEL_INTERRUPT_PRIORITY\r
  56         #define configKERNEL_INTERRUPT_PRIORITY 0\r
  57 #endif\r
  58 \r
  59         \r
  60         RSEG    CODE:CODE(2)\r
  61         thumb\r
  62 \r
  63         EXTERN vPortYieldFromISR\r
  64         EXTERN uxCriticalNesting\r
  65         EXTERN pxCurrentTCB\r
  66         EXTERN vTaskSwitchContext\r
  67 \r
  68         PUBLIC vSetMSP\r
  69         PUBLIC xPortPendSVHandler\r
  70         PUBLIC vPortSetInterruptMask\r
  71         PUBLIC vPortClearInterruptMask\r
  72         PUBLIC vPortSVCHandler\r
  73         PUBLIC vPortStartFirstTask\r
  74 \r
  75 \r
  76 /*-----------------------------------------------------------*/\r
  77 \r
  78 vSetMSP\r
  79         msr msp, r0\r
  80         bx lr\r
  81         \r
  82 /*-----------------------------------------------------------*/\r
  83 \r
  84 xPortPendSVHandler:\r
  85         mrs r0, psp                                             \r
  86         ldr     r3, =pxCurrentTCB                       /* Get the location of the current TCB. */\r
  87         ldr     r2, [r3]                                                \r
  88 \r
  89         ldr r1, =uxCriticalNesting              /* Save the remaining registers and the critical nesting count onto the task stack. */\r
  90         ldr r1, [r1]                                    \r
  91         stmdb r0!, {r1,r4-r11}                  \r
  92         str r0, [r2]                                    /* Save the new top of stack into the first member of the TCB. */\r
  93 \r
  94         stmdb sp!, {r3, r14}                    \r
  95         bl vTaskSwitchContext                   \r
  96         ldmia sp!, {r3, r14}                    \r
  97 \r
  98         ldr r1, [r3]                                    \r
  99         ldr r2, =uxCriticalNesting      \r
 100         ldr r0, [r1]                                    /* The first item in pxCurrentTCB is the task top of stack. */\r
 101         ldmia r0!, {r1, r4-r11}                 /* Pop the registers and the critical nesting count. */\r
 102         str r1, [r2]                                    /* Save the new critical nesting value into ulCriticalNesting. */\r
 103         msr psp, r0                                             \r
 104         orr r14, r14, #13                       \r
 105 \r
 106         cbnz r1, sv_disable_interrupts  /* If the nesting count is greater than 0 we need to exit with interrupts masked. */\r
 107         bx r14                                                  \r
 108 \r
 109 sv_disable_interrupts:                          \r
 110         mov     r1, #configKERNEL_INTERRUPT_PRIORITY\r
 111         msr     basepri, r1\r
 112         bx r14                                                  \r
 113 \r
 114 /*-----------------------------------------------------------*/\r
 115 \r
 116 vPortSetInterruptMask:\r
 117         push { r0 }\r
 118         mov R0, #configKERNEL_INTERRUPT_PRIORITY\r
 119         msr BASEPRI, R0\r
 120         pop { R0 }\r
 121 \r
 122         bx r14\r
 123         \r
 124 /*-----------------------------------------------------------*/\r
 125 \r
 126 vPortClearInterruptMask:\r
 127         PUSH { r0 }\r
 128         MOV R0, #0\r
 129         MSR BASEPRI, R0\r
 130         POP      { R0 }\r
 131 \r
 132         bx r14\r
 133 \r
 134 /*-----------------------------------------------------------*/\r
 135 \r
 136 vPortSVCHandler;\r
 137         ldr     r3, =pxCurrentTCB\r
 138         ldr r1, [r3]\r
 139         ldr r0, [r1]\r
 140         ldmia r0!, {r1, r4-r11}\r
 141         ldr r2, =uxCriticalNesting\r
 142         str r1, [r2]\r
 143         msr psp, r0\r
 144         orr r14, r14, #13\r
 145         bx r14\r
 146 \r
 147 /*-----------------------------------------------------------*/\r
 148 \r
 149 vPortStartFirstTask\r
 150         msr msp, r0\r
 151         svc 0\r
 152 \r
 153 \r
 154         END\r
 155