git.sur5r.net Git - freertos/blob - FreeRTOS/Source/portable/IAR/V850ES/ISR_Support.h

   1 /*\r
   2     FreeRTOS V8.1.2 - Copyright (C) 2014 Real Time Engineers Ltd. \r
   3     All rights reserved\r
   4 \r
   5     VISIT http://www.FreeRTOS.org TO ENSURE YOU ARE USING THE LATEST VERSION.\r
   6 \r
   7     ***************************************************************************\r
   8      *                                                                       *\r
   9      *    FreeRTOS provides completely free yet professionally developed,    *\r
  10      *    robust, strictly quality controlled, supported, and cross          *\r
  11      *    platform software that has become a de facto standard.             *\r
  12      *                                                                       *\r
  13      *    Help yourself get started quickly and support the FreeRTOS         *\r
  14      *    project by purchasing a FreeRTOS tutorial book, reference          *\r
  15      *    manual, or both from: http://www.FreeRTOS.org/Documentation        *\r
  16      *                                                                       *\r
  17      *    Thank you!                                                         *\r
  18      *                                                                       *\r
  19     ***************************************************************************\r
  20 \r
  21     This file is part of the FreeRTOS distribution.\r
  22 \r
  23     FreeRTOS is free software; you can redistribute it and/or modify it under\r
  24     the terms of the GNU General Public License (version 2) as published by the\r
  25     Free Software Foundation >>!AND MODIFIED BY!<< the FreeRTOS exception.\r
  26 \r
  27     >>!   NOTE: The modification to the GPL is included to allow you to     !<<\r
  28     >>!   distribute a combined work that includes FreeRTOS without being   !<<\r
  29     >>!   obliged to provide the source code for proprietary components     !<<\r
  30     >>!   outside of the FreeRTOS kernel.                                   !<<\r
  31 \r
  32     FreeRTOS is distributed in the hope that it will be useful, but WITHOUT ANY\r
  33     WARRANTY; without even the implied warranty of MERCHANTABILITY or FITNESS\r
  34     FOR A PARTICULAR PURPOSE.  Full license text is available from the following\r
  35     link: http://www.freertos.org/a00114.html\r
  36 \r
  37     1 tab == 4 spaces!\r
  38 \r
  39     ***************************************************************************\r
  40      *                                                                       *\r
  41      *    Having a problem?  Start by reading the FAQ "My application does   *\r
  42      *    not run, what could be wrong?"                                     *\r
  43      *                                                                       *\r
  44      *    http://www.FreeRTOS.org/FAQHelp.html                               *\r
  45      *                                                                       *\r
  46     ***************************************************************************\r
  47 \r
  48     http://www.FreeRTOS.org - Documentation, books, training, latest versions,\r
  49     license and Real Time Engineers Ltd. contact details.\r
  50 \r
  51     http://www.FreeRTOS.org/plus - A selection of FreeRTOS ecosystem products,\r
  52     including FreeRTOS+Trace - an indispensable productivity tool, a DOS\r
  53     compatible FAT file system, and our tiny thread aware UDP/IP stack.\r
  54 \r
  55     http://www.OpenRTOS.com - Real Time Engineers ltd license FreeRTOS to High\r
  56     Integrity Systems to sell under the OpenRTOS brand.  Low cost OpenRTOS\r
  57     licenses offer ticketed support, indemnification and middleware.\r
  58 \r
  59     http://www.SafeRTOS.com - High Integrity Systems also provide a safety\r
  60     engineered and independently SIL3 certified version for use in safety and\r
  61     mission critical applications that require provable dependability.\r
  62 \r
  63     1 tab == 4 spaces!\r
  64 */\r
  65 \r
  66         EXTERN pxCurrentTCB\r
  67         EXTERN usCriticalNesting\r
  68 \r
  69 #include "FreeRTOSConfig.h"\r
  70 \r
  71 ;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;\r
  72 ; Context save and restore macro definitions\r
  73 ;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;\r
  74 \r
  75 portSAVE_CONTEXT MACRO\r
  76 \r
  77     add     -0x0C,sp                    ; prepare stack to save necessary values\r
  78     st.w    lp,8[sp]                    ; store LP to stack\r
  79     stsr    0,r31\r
  80     st.w    lp,4[sp]                    ; store EIPC to stack\r
  81     stsr    1,lp\r
  82     st.w    lp,0[sp]                    ; store EIPSW to stack\r
  83 #if configDATA_MODE == 1                                        ; Using the Tiny data model\r
  84     prepare {r20,r21,r22,r23,r24,r25,r26,r27,r28,r29,r30},76,sp ; save general purpose registers\r
  85     sst.w   r19,72[ep]\r
  86     sst.w   r18,68[ep]\r
  87     sst.w   r17,64[ep]\r
  88     sst.w   r16,60[ep]\r
  89     sst.w   r15,56[ep]\r
  90     sst.w   r14,52[ep]\r
  91     sst.w   r13,48[ep]\r
  92     sst.w   r12,44[ep]\r
  93     sst.w   r11,40[ep]\r
  94     sst.w   r10,36[ep]\r
  95     sst.w   r9,32[ep]\r
  96     sst.w   r8,28[ep]\r
  97     sst.w   r7,24[ep]\r
  98     sst.w   r6,20[ep]\r
  99     sst.w   r5,16[ep]\r
 100     sst.w   r4,12[ep]\r
 101 #else                                                           ; Using the Small/Large data model\r
 102     prepare {r20,r21,r22,r23,r24,r26,r27,r28,r29,r30},72,sp     ; save general purpose registers\r
 103     sst.w   r19,68[ep]\r
 104     sst.w   r18,64[ep]\r
 105     sst.w   r17,60[ep]\r
 106     sst.w   r16,56[ep]\r
 107     sst.w   r15,52[ep]\r
 108     sst.w   r14,48[ep]\r
 109     sst.w   r13,44[ep]\r
 110     sst.w   r12,40[ep]\r
 111     sst.w   r11,36[ep]\r
 112     sst.w   r10,32[ep]\r
 113     sst.w   r9,28[ep]\r
 114     sst.w   r8,24[ep]\r
 115     sst.w   r7,20[ep]\r
 116     sst.w   r6,16[ep]\r
 117     sst.w   r5,12[ep]\r
 118 #endif /* configDATA_MODE */\r
 119     sst.w   r2,8[ep]\r
 120     sst.w   r1,4[ep]\r
 121     MOVHI   hi1(usCriticalNesting),r0,r1        ; save usCriticalNesting value to stack\r
 122     ld.w    lw1(usCriticalNesting)[r1],r2\r
 123     sst.w   r2,0[ep]\r
 124     MOVHI   hi1(pxCurrentTCB),r0,r1                     ; save SP to top of current TCB\r
 125     ld.w    lw1(pxCurrentTCB)[r1],r2\r
 126     st.w    sp,0[r2]\r
 127     ENDM\r
 128 \r
 129 \r
 130 portRESTORE_CONTEXT MACRO\r
 131 \r
 132     MOVHI   hi1(pxCurrentTCB),r0,r1                     ; get Stackpointer address\r
 133     ld.w    lw1(pxCurrentTCB)[r1],sp\r
 134     MOV     sp,r1\r
 135     ld.w    0[r1],sp                                            ; load stackpointer\r
 136     MOV     sp,ep                                                       ; set stack pointer to element pointer\r
 137     sld.w   0[ep],r1                                            ; load usCriticalNesting value from stack\r
 138     MOVHI   hi1(usCriticalNesting),r0,r2\r
 139     st.w    r1,lw1(usCriticalNesting)[r2]\r
 140     sld.w   4[ep],r1                                            ; restore general purpose registers\r
 141     sld.w   8[ep],r2\r
 142 #if configDATA_MODE == 1                                        ; Using Tiny data model\r
 143     sld.w   12[ep],r4\r
 144     sld.w   16[ep],r5\r
 145     sld.w   20[ep],r6\r
 146     sld.w   24[ep],r7\r
 147     sld.w   28[ep],r8\r
 148     sld.w   32[ep],r9\r
 149     sld.w   36[ep],r10\r
 150     sld.w   40[ep],r11\r
 151     sld.w   44[ep],r12\r
 152     sld.w   48[ep],r13\r
 153     sld.w   52[ep],r14\r
 154     sld.w   56[ep],r15\r
 155     sld.w   60[ep],r16\r
 156     sld.w   64[ep],r17\r
 157     sld.w   68[ep],r18\r
 158     sld.w   72[ep],r19\r
 159     dispose 76,{r20,r21,r22,r23,r24,r25,r26,r27,r28,r29,r30}\r
 160 #else                                                                           ; Using Small/Large data model\r
 161     sld.w   12[ep],r5\r
 162     sld.w   16[ep],r6\r
 163     sld.w   20[ep],r7\r
 164     sld.w   24[ep],r8\r
 165     sld.w   28[ep],r9\r
 166     sld.w   32[ep],r10\r
 167     sld.w   36[ep],r11\r
 168     sld.w   40[ep],r12\r
 169     sld.w   44[ep],r13\r
 170     sld.w   48[ep],r14\r
 171     sld.w   52[ep],r15\r
 172     sld.w   56[ep],r16\r
 173     sld.w   60[ep],r17\r
 174     sld.w   64[ep],r18\r
 175     sld.w   68[ep],r19\r
 176     dispose 72,{r20,r21,r22,r23,r24,r26,r27,r28,r29,r30}\r
 177 #endif /* configDATA_MODE */\r
 178     ld.w    0[sp],lp                                            ; restore EIPSW from stack\r
 179     ldsr    lp,1\r
 180     ld.w    4[sp],lp                                            ; restore EIPC from stack\r
 181     ldsr    lp,0\r
 182     ld.w    8[sp],lp                                            ; restore LP from stack\r
 183     add     0x0C,sp                                                     ; set SP to right position\r
 184 \r
 185     RETI\r
 186 \r
 187     ENDM\r