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

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