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

   1 /*\r
   2     FreeRTOS V6.1.0 - Copyright (C) 2010 Real Time Engineers Ltd.\r
   3 \r
   4     ***************************************************************************\r
   5     *                                                                         *\r
   6     * If you are:                                                             *\r
   7     *                                                                         *\r
   8     *    + New to FreeRTOS,                                                   *\r
   9     *    + Wanting to learn FreeRTOS or multitasking in general quickly       *\r
  10     *    + Looking for basic training,                                        *\r
  11     *    + Wanting to improve your FreeRTOS skills and productivity           *\r
  12     *                                                                         *\r
  13     * then take a look at the FreeRTOS books - available as PDF or paperback  *\r
  14     *                                                                         *\r
  15     *        "Using the FreeRTOS Real Time Kernel - a Practical Guide"        *\r
  16     *                  http://www.FreeRTOS.org/Documentation                  *\r
  17     *                                                                         *\r
  18     * A pdf reference manual is also available.  Both are usually delivered   *\r
  19     * to your inbox within 20 minutes to two hours when purchased between 8am *\r
  20     * and 8pm GMT (although please allow up to 24 hours in case of            *\r
  21     * exceptional circumstances).  Thank you for your support!                *\r
  22     *                                                                         *\r
  23     ***************************************************************************\r
  24 \r
  25     This file is part of the FreeRTOS distribution.\r
  26 \r
  27     FreeRTOS is free software; you can redistribute it and/or modify it under\r
  28     the terms of the GNU General Public License (version 2) as published by the\r
  29     Free Software Foundation AND MODIFIED BY the FreeRTOS exception.\r
  30     ***NOTE*** The exception to the GPL is included to allow you to distribute\r
  31     a combined work that includes FreeRTOS without being obliged to provide the\r
  32     source code for proprietary components outside of the FreeRTOS kernel.\r
  33     FreeRTOS is distributed in the hope that it will be useful, but WITHOUT\r
  34     ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or\r
  35     FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License for\r
  36     more details. You should have received a copy of the GNU General Public\r
  37     License and the FreeRTOS license exception along with FreeRTOS; if not it\r
  38     can be viewed here: http://www.freertos.org/a00114.html and also obtained\r
  39     by writing to Richard Barry, contact details for whom are available on the\r
  40     FreeRTOS WEB site.\r
  41 \r
  42     1 tab == 4 spaces!\r
  43 \r
  44     http://www.FreeRTOS.org - Documentation, latest information, license and\r
  45     contact details.\r
  46 \r
  47     http://www.SafeRTOS.com - A version that is certified for use in safety\r
  48     critical systems.\r
  49 \r
  50     http://www.OpenRTOS.com - Commercial support, development, porting,\r
  51     licensing and training services.\r
  52 */\r
  53 \r
  54 #include <FreeRTOSConfig.h>\r
  55 \r
  56 /* For backward compatibility, ensure configKERNEL_INTERRUPT_PRIORITY is\r
  57 defined.  The value zero should also ensure backward compatibility.\r
  58 FreeRTOS.org versions prior to V4.3.0 did not include this definition. */\r
  59 #ifndef configKERNEL_INTERRUPT_PRIORITY\r
  60         #define configKERNEL_INTERRUPT_PRIORITY 0\r
  61 #endif\r
  62 \r
  63         \r
  64         RSEG    CODE:CODE(2)\r
  65         thumb\r
  66 \r
  67         EXTERN vPortYieldFromISR\r
  68         EXTERN pxCurrentTCB\r
  69         EXTERN vTaskSwitchContext\r
  70 \r
  71         PUBLIC vSetMSP\r
  72         PUBLIC xPortPendSVHandler\r
  73         PUBLIC vPortSetInterruptMask\r
  74         PUBLIC vPortClearInterruptMask\r
  75         PUBLIC vPortSVCHandler\r
  76         PUBLIC vPortStartFirstTask\r
  77 \r
  78 \r
  79 /*-----------------------------------------------------------*/\r
  80 \r
  81 vSetMSP\r
  82         msr msp, r0\r
  83         bx lr\r
  84         \r
  85 /*-----------------------------------------------------------*/\r
  86 \r
  87 xPortPendSVHandler:\r
  88         mrs r0, psp                                             \r
  89         ldr     r3, =pxCurrentTCB                       /* Get the location of the current TCB. */\r
  90         ldr     r2, [r3]                                                \r
  91 \r
  92         stmdb r0!, {r4-r11}                             /* Save the remaining registers. */\r
  93         str r0, [r2]                                    /* Save the new top of stack into the first member of the TCB. */\r
  94 \r
  95         stmdb sp!, {r3, r14}\r
  96         mov r0, #configMAX_SYSCALL_INTERRUPT_PRIORITY\r
  97         msr basepri, r0\r
  98         bl vTaskSwitchContext                   \r
  99         mov r0, #0\r
 100         msr basepri, r0\r
 101         ldmia sp!, {r3, r14}\r
 102 \r
 103         ldr r1, [r3]                                    \r
 104         ldr r0, [r1]                                    /* The first item in pxCurrentTCB is the task top of stack. */\r
 105         ldmia r0!, {r4-r11}                             /* Pop the registers. */\r
 106         msr psp, r0                                             \r
 107         bx r14                                                  \r
 108 \r
 109 \r
 110 /*-----------------------------------------------------------*/\r
 111 \r
 112 vPortSetInterruptMask:\r
 113         push { r0 }\r
 114         mov R0, #configMAX_SYSCALL_INTERRUPT_PRIORITY\r
 115         msr BASEPRI, R0\r
 116         pop { R0 }\r
 117 \r
 118         bx r14\r
 119         \r
 120 /*-----------------------------------------------------------*/\r
 121 \r
 122 vPortClearInterruptMask:\r
 123         PUSH { r0 }\r
 124         MOV R0, #0\r
 125         MSR BASEPRI, R0\r
 126         POP      { R0 }\r
 127 \r
 128         bx r14\r
 129 \r
 130 /*-----------------------------------------------------------*/\r
 131 \r
 132 vPortSVCHandler;\r
 133         ldr     r3, =pxCurrentTCB\r
 134         ldr r1, [r3]\r
 135         ldr r0, [r1]\r
 136         ldmia r0!, {r4-r11}\r
 137         msr psp, r0\r
 138         mov r0, #0\r
 139         msr     basepri, r0\r
 140         orr r14, r14, #13\r
 141         bx r14\r
 142 \r
 143 /*-----------------------------------------------------------*/\r
 144 \r
 145 vPortStartFirstTask\r
 146         /* Use the NVIC offset register to locate the stack. */\r
 147         ldr r0, =0xE000ED08\r
 148         ldr r0, [r0]\r
 149         ldr r0, [r0]\r
 150         /* Set the msp back to the start of the stack. */\r
 151         msr msp, r0\r
 152         /* Call SVC to start the first task. */\r
 153         cpsie i\r
 154         svc 0\r
 155 \r
 156         END\r
 157