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

   1 /*\r
   2     FreeRTOS V7.3.0 - Copyright (C) 2012 Real Time Engineers Ltd.\r
   3 \r
   4     FEATURES AND PORTS ARE ADDED TO FREERTOS ALL THE TIME.  PLEASE VISIT \r
   5     http://www.FreeRTOS.org TO ENSURE YOU ARE USING THE LATEST VERSION.\r
   6 \r
   7     ***************************************************************************\r
   8      *                                                                       *\r
   9      *    FreeRTOS tutorial books are available in pdf and paperback.        *\r
  10      *    Complete, revised, and edited pdf reference manuals are also       *\r
  11      *    available.                                                         *\r
  12      *                                                                       *\r
  13      *    Purchasing FreeRTOS documentation will not only help you, by       *\r
  14      *    ensuring you get running as quickly as possible and with an        *\r
  15      *    in-depth knowledge of how to use FreeRTOS, it will also help       *\r
  16      *    the FreeRTOS project to continue with its mission of providing     *\r
  17      *    professional grade, cross platform, de facto standard solutions    *\r
  18      *    for microcontrollers - completely free of charge!                  *\r
  19      *                                                                       *\r
  20      *    >>> See http://www.FreeRTOS.org/Documentation for details. <<<     *\r
  21      *                                                                       *\r
  22      *    Thank you for using FreeRTOS, and thank you for your support!      *\r
  23      *                                                                       *\r
  24     ***************************************************************************\r
  25 \r
  26 \r
  27     This file is part of the FreeRTOS distribution.\r
  28 \r
  29     FreeRTOS is free software; you can redistribute it and/or modify it under\r
  30     the terms of the GNU General Public License (version 2) as published by the\r
  31     Free Software Foundation AND MODIFIED BY the FreeRTOS exception.\r
  32     >>>NOTE<<< The modification to the GPL is included to allow you to\r
  33     distribute a combined work that includes FreeRTOS without being obliged to\r
  34     provide the source code for proprietary components outside of the FreeRTOS\r
  35     kernel.  FreeRTOS is distributed in the hope that it will be useful, but\r
  36     WITHOUT ANY WARRANTY; without even the implied warranty of MERCHANTABILITY\r
  37     or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License for\r
  38     more details. You should have received a copy of the GNU General Public\r
  39     License and the FreeRTOS license exception along with FreeRTOS; if not it\r
  40     can be viewed here: http://www.freertos.org/a00114.html and also obtained\r
  41     by writing to Richard Barry, contact details for whom are available on the\r
  42     FreeRTOS WEB site.\r
  43 \r
  44     1 tab == 4 spaces!\r
  45     \r
  46     ***************************************************************************\r
  47      *                                                                       *\r
  48      *    Having a problem?  Start by reading the FAQ "My application does   *\r
  49      *    not run, what could be wrong?"                                     *\r
  50      *                                                                       *\r
  51      *    http://www.FreeRTOS.org/FAQHelp.html                               *\r
  52      *                                                                       *\r
  53     ***************************************************************************\r
  54 \r
  55     \r
  56     http://www.FreeRTOS.org - Documentation, training, latest versions, license \r
  57     and contact details.  \r
  58     \r
  59     http://www.FreeRTOS.org/plus - A selection of FreeRTOS ecosystem products,\r
  60     including FreeRTOS+Trace - an indispensable productivity tool.\r
  61 \r
  62     Real Time Engineers ltd license FreeRTOS to High Integrity Systems, who sell \r
  63     the code with commercial support, indemnification, and middleware, under \r
  64     the OpenRTOS brand: http://www.OpenRTOS.com.  High Integrity Systems also\r
  65     provide a safety engineered and independently SIL3 certified version under \r
  66     the SafeRTOS brand: http://www.SafeRTOS.com.\r
  67 */\r
  68 \r
  69 #include <FreeRTOSConfig.h>\r
  70 \r
  71         RSEG    CODE:CODE(2)\r
  72         thumb\r
  73 \r
  74         EXTERN pxCurrentTCB\r
  75         EXTERN vTaskSwitchContext\r
  76 \r
  77         PUBLIC xPortPendSVHandler\r
  78         PUBLIC ulPortSetInterruptMask\r
  79         PUBLIC vPortClearInterruptMask\r
  80         PUBLIC vPortSVCHandler\r
  81         PUBLIC vPortStartFirstTask\r
  82         PUBLIC vPortEnableVFP\r
  83 \r
  84 \r
  85 /*-----------------------------------------------------------*/\r
  86 \r
  87 xPortPendSVHandler:\r
  88         mrs r0, psp                                             \r
  89         \r
  90         /* Get the location of the current TCB. */\r
  91         ldr     r3, =pxCurrentTCB                       \r
  92         ldr     r2, [r3]                                                \r
  93 \r
  94         /* Is the task using the FPU context?  If so, push high vfp registers. */\r
  95         tst r14, #0x10\r
  96         it eq\r
  97         vstmdbeq r0!, {s16-s31}\r
  98 \r
  99         /* Save the core registers. */\r
 100         stmdb r0!, {r4-r11, r14}                                \r
 101         \r
 102         /* Save the new top of stack into the first member of the TCB. */\r
 103         str r0, [r2]\r
 104         \r
 105         stmdb sp!, {r3, r14}\r
 106         mov r0, #configMAX_SYSCALL_INTERRUPT_PRIORITY\r
 107         msr basepri, r0\r
 108         bl vTaskSwitchContext                   \r
 109         mov r0, #0\r
 110         msr basepri, r0\r
 111         ldmia sp!, {r3, r14}\r
 112 \r
 113         /* The first item in pxCurrentTCB is the task top of stack. */\r
 114         ldr r1, [r3]    \r
 115         ldr r0, [r1]\r
 116         \r
 117         /* Pop the core registers. */\r
 118         ldmia r0!, {r4-r11, r14}\r
 119 \r
 120         /* Is the task using the FPU context?  If so, pop the high vfp registers \r
 121         too. */\r
 122         tst r14, #0x10\r
 123         it eq\r
 124         vldmiaeq r0!, {s16-s31}\r
 125         \r
 126         msr psp, r0                                             \r
 127         bx r14                                                  \r
 128 \r
 129 \r
 130 /*-----------------------------------------------------------*/\r
 131 \r
 132 ulPortSetInterruptMask:\r
 133         mrs r0, basepri\r
 134         mov r1, #configMAX_SYSCALL_INTERRUPT_PRIORITY\r
 135         msr basepri, r1\r
 136         bx r14\r
 137         \r
 138 /*-----------------------------------------------------------*/\r
 139 \r
 140 vPortClearInterruptMask:\r
 141         msr basepri, r0\r
 142         bx r14\r
 143 \r
 144 /*-----------------------------------------------------------*/\r
 145 \r
 146 vPortSVCHandler:\r
 147         /* Get the location of the current TCB. */\r
 148         ldr     r3, =pxCurrentTCB\r
 149         ldr r1, [r3]\r
 150         ldr r0, [r1]\r
 151         /* Pop the core registers. */\r
 152         ldmia r0!, {r4-r11, r14}\r
 153         msr psp, r0\r
 154         mov r0, #0\r
 155         msr     basepri, r0     \r
 156         bx r14\r
 157 \r
 158 /*-----------------------------------------------------------*/\r
 159 \r
 160 vPortStartFirstTask\r
 161         /* Use the NVIC offset register to locate the stack. */\r
 162         ldr r0, =0xE000ED08\r
 163         ldr r0, [r0]\r
 164         ldr r0, [r0]\r
 165         /* Set the msp back to the start of the stack. */\r
 166         msr msp, r0\r
 167         /* Call SVC to start the first task. */\r
 168         cpsie i\r
 169         svc 0\r
 170 \r
 171 /*-----------------------------------------------------------*/\r
 172 \r
 173 vPortEnableVFP:\r
 174         /* The FPU enable bits are in the CPACR. */\r
 175         ldr.w r0, =0xE000ED88\r
 176         ldr     r1, [r0]\r
 177         \r
 178         /* Enable CP10 and CP11 coprocessors, then save back. */\r
 179         orr     r1, r1, #( 0xf << 20 )\r
 180         str r1, [r0]\r
 181         bx      r14     \r
 182         \r
 183 \r
 184 \r
 185         END\r
 186         \r