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

   1 /*\r
   2         FreeRTOS.org V5.1.0 - 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 pxCurrentTCB\r
  72         EXTERN vTaskSwitchContext\r
  73 \r
  74         PUBLIC vSetMSP\r
  75         PUBLIC xPortPendSVHandler\r
  76         PUBLIC vPortSetInterruptMask\r
  77         PUBLIC vPortClearInterruptMask\r
  78         PUBLIC vPortSVCHandler\r
  79         PUBLIC vPortStartFirstTask\r
  80 \r
  81 \r
  82 /*-----------------------------------------------------------*/\r
  83 \r
  84 vSetMSP\r
  85         msr msp, r0\r
  86         bx lr\r
  87         \r
  88 /*-----------------------------------------------------------*/\r
  89 \r
  90 xPortPendSVHandler:\r
  91         mrs r0, psp                                             \r
  92         ldr     r3, =pxCurrentTCB                       /* Get the location of the current TCB. */\r
  93         ldr     r2, [r3]                                                \r
  94 \r
  95         stmdb r0!, {r4-r11}                             /* Save the remaining registers. */\r
  96         str r0, [r2]                                    /* Save the new top of stack into the first member of the TCB. */\r
  97 \r
  98         stmdb sp!, {r3, r14}\r
  99         mov r0, #configMAX_SYSCALL_INTERRUPT_PRIORITY\r
 100         msr basepri, r0\r
 101         bl vTaskSwitchContext                   \r
 102         mov r0, #0\r
 103         msr basepri, r0\r
 104         ldmia sp!, {r3, r14}\r
 105 \r
 106         ldr r1, [r3]                                    \r
 107         ldr r0, [r1]                                    /* The first item in pxCurrentTCB is the task top of stack. */\r
 108         ldmia r0!, {r4-r11}                             /* Pop the registers. */\r
 109         msr psp, r0                                             \r
 110         bx r14                                                  \r
 111 \r
 112 \r
 113 /*-----------------------------------------------------------*/\r
 114 \r
 115 vPortSetInterruptMask:\r
 116         push { r0 }\r
 117         mov R0, #configMAX_SYSCALL_INTERRUPT_PRIORITY\r
 118         msr BASEPRI, R0\r
 119         pop { R0 }\r
 120 \r
 121         bx r14\r
 122         \r
 123 /*-----------------------------------------------------------*/\r
 124 \r
 125 vPortClearInterruptMask:\r
 126         PUSH { r0 }\r
 127         MOV R0, #0\r
 128         MSR BASEPRI, R0\r
 129         POP      { R0 }\r
 130 \r
 131         bx r14\r
 132 \r
 133 /*-----------------------------------------------------------*/\r
 134 \r
 135 vPortSVCHandler;\r
 136         ldr     r3, =pxCurrentTCB\r
 137         ldr r1, [r3]\r
 138         ldr r0, [r1]\r
 139         ldmia r0!, {r4-r11}\r
 140         msr psp, r0\r
 141         mov r0, #0\r
 142         msr     basepri, r0\r
 143         orr r14, r14, #13\r
 144         bx r14\r
 145 \r
 146 /*-----------------------------------------------------------*/\r
 147 \r
 148 vPortStartFirstTask\r
 149         /* Use the NVIC offset register to locate the stack. */\r
 150         ldr r0, =0xE000ED08\r
 151         ldr r0, [r0]\r
 152         ldr r0, [r0]\r
 153         /* Set the msp back to the start of the stack. */\r
 154         msr msp, r0\r
 155         /* Call SVC to start the first task. */\r
 156         svc 0\r
 157 \r
 158         END\r
 159