git.sur5r.net Git - freertos/blob - FreeRTOS/Source/portable/GCC/MicroBlaze/portasm.s

   1 /*\r
   2     FreeRTOS V7.4.0 - Copyright (C) 2013 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 \r
  33     >>>>>>NOTE<<<<<< The modification to the GPL is included to allow you to\r
  34     distribute a combined work that includes FreeRTOS without being obliged to\r
  35     provide the source code for proprietary components outside of the FreeRTOS\r
  36     kernel.\r
  37 \r
  38     FreeRTOS is distributed in the hope that it will be useful, but WITHOUT ANY\r
  39     WARRANTY; without even the implied warranty of MERCHANTABILITY or FITNESS\r
  40     FOR A PARTICULAR PURPOSE.  See the GNU General Public License for more\r
  41     details. You should have received a copy of the GNU General Public License\r
  42     and the FreeRTOS license exception along with FreeRTOS; if not itcan be\r
  43     viewed here: http://www.freertos.org/a00114.html and also obtained by\r
  44     writing to Real Time Engineers Ltd., contact details for whom are available\r
  45     on the FreeRTOS WEB site.\r
  46 \r
  47     1 tab == 4 spaces!\r
  48 \r
  49     ***************************************************************************\r
  50      *                                                                       *\r
  51      *    Having a problem?  Start by reading the FAQ "My application does   *\r
  52      *    not run, what could be wrong?"                                     *\r
  53      *                                                                       *\r
  54      *    http://www.FreeRTOS.org/FAQHelp.html                               *\r
  55      *                                                                       *\r
  56     ***************************************************************************\r
  57 \r
  58 \r
  59     http://www.FreeRTOS.org - Documentation, books, training, latest versions, \r
  60     license and Real Time Engineers Ltd. contact details.\r
  61 \r
  62     http://www.FreeRTOS.org/plus - A selection of FreeRTOS ecosystem products,\r
  63     including FreeRTOS+Trace - an indispensable productivity tool, and our new\r
  64     fully thread aware and reentrant UDP/IP stack.\r
  65 \r
  66     http://www.OpenRTOS.com - Real Time Engineers ltd license FreeRTOS to High \r
  67     Integrity Systems, who sell the code with commercial support, \r
  68     indemnification and middleware, under the OpenRTOS brand.\r
  69     \r
  70     http://www.SafeRTOS.com - High Integrity Systems also provide a safety \r
  71     engineered and independently SIL3 certified version for use in safety and \r
  72     mission critical applications that require provable dependability.\r
  73 */\r
  74         .extern pxCurrentTCB\r
  75         .extern vTaskISRHandler\r
  76         .extern vTaskSwitchContext\r
  77         .extern uxCriticalNesting\r
  78         .extern pulISRStack\r
  79 \r
  80         .global __FreeRTOS_interrupt_handler\r
  81         .global VPortYieldASM\r
  82         .global vStartFirstTask\r
  83 \r
  84 \r
  85 .macro portSAVE_CONTEXT\r
  86         /* Make room for the context on the stack. */\r
  87         addik r1, r1, -132\r
  88         /* Save r31 so it can then be used. */\r
  89         swi r31, r1, 4\r
  90         /* Copy the msr into r31 - this is stacked later. */\r
  91         mfs r31, rmsr\r
  92         /* Stack general registers. */\r
  93         swi r30, r1, 12\r
  94         swi r29, r1, 16\r
  95         swi r28, r1, 20\r
  96         swi r27, r1, 24\r
  97         swi r26, r1, 28\r
  98         swi r25, r1, 32\r
  99         swi r24, r1, 36\r
 100         swi r23, r1, 40\r
 101         swi r22, r1, 44\r
 102         swi r21, r1, 48\r
 103         swi r20, r1, 52\r
 104         swi r19, r1, 56\r
 105         swi r18, r1, 60\r
 106         swi r17, r1, 64\r
 107         swi r16, r1, 68\r
 108         swi r15, r1, 72\r
 109         swi r13, r1, 80\r
 110         swi r12, r1, 84\r
 111         swi r11, r1, 88\r
 112         swi r10, r1, 92\r
 113         swi r9, r1, 96\r
 114         swi r8, r1, 100\r
 115         swi r7, r1, 104\r
 116         swi r6, r1, 108\r
 117         swi r5, r1, 112\r
 118         swi r4, r1, 116\r
 119         swi r3, r1, 120\r
 120         swi r2, r1, 124\r
 121         /* Stack the critical section nesting value. */\r
 122         lwi r3, r0, uxCriticalNesting\r
 123         swi r3, r1, 128\r
 124         /* Save the top of stack value to the TCB. */\r
 125         lwi r3, r0, pxCurrentTCB\r
 126         sw      r1, r0, r3\r
 127         \r
 128         .endm\r
 129 \r
 130 .macro portRESTORE_CONTEXT\r
 131         /* Load the top of stack value from the TCB. */\r
 132         lwi r3, r0, pxCurrentTCB\r
 133         lw      r1, r0, r3      \r
 134         /* Restore the general registers. */\r
 135         lwi r31, r1, 4          \r
 136         lwi r30, r1, 12         \r
 137         lwi r29, r1, 16 \r
 138         lwi r28, r1, 20 \r
 139         lwi r27, r1, 24 \r
 140         lwi r26, r1, 28 \r
 141         lwi r25, r1, 32 \r
 142         lwi r24, r1, 36 \r
 143         lwi r23, r1, 40 \r
 144         lwi r22, r1, 44 \r
 145         lwi r21, r1, 48 \r
 146         lwi r20, r1, 52 \r
 147         lwi r19, r1, 56 \r
 148         lwi r18, r1, 60 \r
 149         lwi r17, r1, 64 \r
 150         lwi r16, r1, 68 \r
 151         lwi r15, r1, 72 \r
 152         lwi r14, r1, 76 \r
 153         lwi r13, r1, 80 \r
 154         lwi r12, r1, 84 \r
 155         lwi r11, r1, 88 \r
 156         lwi r10, r1, 92 \r
 157         lwi r9, r1, 96  \r
 158         lwi r8, r1, 100 \r
 159         lwi r7, r1, 104\r
 160         lwi r6, r1, 108\r
 161         lwi r5, r1, 112\r
 162         lwi r4, r1, 116\r
 163         lwi r2, r1, 124\r
 164 \r
 165         /* Load the critical nesting value. */\r
 166         lwi r3, r1, 128\r
 167         swi r3, r0, uxCriticalNesting\r
 168 \r
 169         /* Obtain the MSR value from the stack. */\r
 170         lwi r3, r1, 8\r
 171 \r
 172         /* Are interrupts enabled in the MSR?  If so return using an return from \r
 173         interrupt instruction to ensure interrupts are enabled only once the task\r
 174         is running again. */\r
 175         andi r3, r3, 2\r
 176         beqid r3, 36\r
 177         or r0, r0, r0\r
 178 \r
 179         /* Reload the rmsr from the stack, clear the enable interrupt bit in the\r
 180         value before saving back to rmsr register, then return enabling interrupts\r
 181         as we return. */\r
 182         lwi r3, r1, 8\r
 183         andi r3, r3, ~2\r
 184         mts rmsr, r3\r
 185         lwi r3, r1, 120\r
 186         addik r1, r1, 132\r
 187         rtid r14, 0\r
 188         or r0, r0, r0\r
 189 \r
 190         /* Reload the rmsr from the stack, place it in the rmsr register, and\r
 191         return without enabling interrupts. */\r
 192         lwi r3, r1, 8\r
 193         mts rmsr, r3\r
 194         lwi r3, r1, 120\r
 195         addik r1, r1, 132\r
 196         rtsd r14, 0\r
 197         or r0, r0, r0\r
 198 \r
 199         .endm\r
 200 \r
 201         .text\r
 202         .align  2\r
 203 \r
 204 \r
 205 __FreeRTOS_interrupt_handler:\r
 206         portSAVE_CONTEXT\r
 207         /* Entered via an interrupt so interrupts must be enabled in msr. */\r
 208         ori r31, r31, 2\r
 209         /* Stack msr. */\r
 210         swi r31, r1, 8\r
 211         /* Stack the return address.  As we entered via an interrupt we do\r
 212         not need to modify the return address prior to stacking. */\r
 213         swi r14, r1, 76\r
 214         /* Now switch to use the ISR stack. */\r
 215         lwi r3, r0, pulISRStack\r
 216         add r1, r3, r0\r
 217         bralid r15, vTaskISRHandler\r
 218         or r0, r0, r0\r
 219         portRESTORE_CONTEXT\r
 220 \r
 221 \r
 222 VPortYieldASM:\r
 223         portSAVE_CONTEXT\r
 224         /* Stack msr. */\r
 225         swi r31, r1, 8\r
 226         /* Modify the return address so we return to the instruction after the\r
 227         exception. */\r
 228         addi r14, r14, 8\r
 229         swi r14, r1, 76\r
 230         /* Now switch to use the ISR stack. */\r
 231         lwi r3, r0, pulISRStack\r
 232         add r1, r3, r0\r
 233         bralid r15, vTaskSwitchContext\r
 234         or r0, r0, r0\r
 235         portRESTORE_CONTEXT\r
 236 \r
 237 vStartFirstTask:\r
 238         portRESTORE_CONTEXT\r
 239         \r
 240         \r
 241 \r
 242 \r
 243 \r
 244 \r