git.sur5r.net Git - freertos/blob - FreeRTOS/Source/portable/CCS/ARM_Cortex-R4/port.c

   1 /*\r
   2  * FreeRTOS Kernel V10.1.1\r
   3  * Copyright (C) 2018 Amazon.com, Inc. or its affiliates.  All Rights Reserved.\r
   4  *\r
   5  * Permission is hereby granted, free of charge, to any person obtaining a copy of\r
   6  * this software and associated documentation files (the "Software"), to deal in\r
   7  * the Software without restriction, including without limitation the rights to\r
   8  * use, copy, modify, merge, publish, distribute, sublicense, and/or sell copies of\r
   9  * the Software, and to permit persons to whom the Software is furnished to do so,\r
  10  * subject to the following conditions:\r
  11  *\r
  12  * The above copyright notice and this permission notice shall be included in all\r
  13  * copies or substantial portions of the Software.\r
  14  *\r
  15  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR\r
  16  * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, FITNESS\r
  17  * FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR\r
  18  * COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER\r
  19  * IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN\r
  20  * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE.\r
  21  *\r
  22  * http://www.FreeRTOS.org\r
  23  * http://aws.amazon.com/freertos\r
  24  *\r
  25  * 1 tab == 4 spaces!\r
  26  */\r
  27 \r
  28 /* FreeRTOS includes. */\r
  29 #include "FreeRTOS.h"\r
  30 #include "task.h"\r
  31 \r
  32 /*-----------------------------------------------------------*/\r
  33 \r
  34 /* Count of the critical section nesting depth. */\r
  35 uint32_t ulCriticalNesting = 9999;\r
  36 \r
  37 /*-----------------------------------------------------------*/\r
  38 \r
  39 /* Registers required to configure the RTI. */\r
  40 #define portRTI_GCTRL_REG               ( * ( ( volatile uint32_t * ) 0xFFFFFC00 ) )\r
  41 #define portRTI_TBCTRL_REG      ( * ( ( volatile uint32_t * ) 0xFFFFFC04 ) )\r
  42 #define portRTI_COMPCTRL_REG    ( * ( ( volatile uint32_t * ) 0xFFFFFC0C ) )\r
  43 #define portRTI_CNT0_FRC0_REG   ( * ( ( volatile uint32_t * ) 0xFFFFFC10 ) )\r
  44 #define portRTI_CNT0_UC0_REG    ( * ( ( volatile uint32_t * ) 0xFFFFFC14 ) )\r
  45 #define portRTI_CNT0_CPUC0_REG  ( * ( ( volatile uint32_t * ) 0xFFFFFC18 ) )\r
  46 #define portRTI_CNT0_COMP0_REG  ( * ( ( volatile uint32_t * ) 0xFFFFFC50 ) )\r
  47 #define portRTI_CNT0_UDCP0_REG  ( * ( ( volatile uint32_t * ) 0xFFFFFC54 ) )\r
  48 #define portRTI_SETINTENA_REG   ( * ( ( volatile uint32_t * ) 0xFFFFFC80 ) )\r
  49 #define portRTI_CLEARINTENA_REG ( * ( ( volatile uint32_t * ) 0xFFFFFC84 ) )\r
  50 #define portRTI_INTFLAG_REG     ( * ( ( volatile uint32_t * ) 0xFFFFFC88 ) )\r
  51 \r
  52 \r
  53 /* Constants required to set up the initial stack of each task. */\r
  54 #define portINITIAL_SPSR                ( ( StackType_t ) 0x1F )\r
  55 #define portINITIAL_FPSCR               ( ( StackType_t ) 0x00 )\r
  56 #define portINSTRUCTION_SIZE    ( ( StackType_t ) 0x04 )\r
  57 #define portTHUMB_MODE_BIT              ( ( StackType_t ) 0x20 )\r
  58 \r
  59 /* The number of words on the stack frame between the saved Top Of Stack and\r
  60 R0 (in which the parameters are passed. */\r
  61 #define portSPACE_BETWEEN_TOS_AND_PARAMETERS    ( 12 )\r
  62 \r
  63 /*-----------------------------------------------------------*/\r
  64 \r
  65 /* vPortStartFirstSTask() is defined in portASM.asm */\r
  66 extern void vPortStartFirstTask( void );\r
  67 \r
  68 /*-----------------------------------------------------------*/\r
  69 \r
  70 /* Saved as part of the task context.  Set to pdFALSE if the task does not\r
  71 require an FPU context. */\r
  72 uint32_t ulTaskHasFPUContext = 0;\r
  73 \r
  74 /*-----------------------------------------------------------*/\r
  75 \r
  76 \r
  77 /*\r
  78  * See header file for description.\r
  79  */\r
  80 StackType_t *pxPortInitialiseStack( StackType_t *pxTopOfStack, TaskFunction_t pxCode, void *pvParameters )\r
  81 {\r
  82 StackType_t *pxOriginalTOS;\r
  83 \r
  84         pxOriginalTOS = pxTopOfStack;\r
  85 \r
  86         #if __TI_VFP_SUPPORT__\r
  87         {\r
  88                 /* Ensure the stack is correctly aligned on exit. */\r
  89                 pxTopOfStack--;\r
  90         }\r
  91         #endif\r
  92 \r
  93         /* Setup the initial stack of the task.  The stack is set exactly as\r
  94         expected by the portRESTORE_CONTEXT() macro. */\r
  95 \r
  96         /* First on the stack is the return address - which is the start of the as\r
  97         the task has not executed yet.  The offset is added to make the return\r
  98         address appear as it would within an IRQ ISR. */\r
  99         *pxTopOfStack = ( StackType_t ) pxCode + portINSTRUCTION_SIZE;\r
 100         pxTopOfStack--;\r
 101 \r
 102         *pxTopOfStack = ( StackType_t ) 0x00000000;     /* R14 */\r
 103         pxTopOfStack--;\r
 104         *pxTopOfStack = ( StackType_t ) pxOriginalTOS; /* Stack used when task starts goes in R13. */\r
 105         pxTopOfStack--;\r
 106 \r
 107         #ifdef portPRELOAD_TASK_REGISTERS\r
 108         {\r
 109                 *pxTopOfStack = ( StackType_t ) 0x12121212;     /* R12 */\r
 110                 pxTopOfStack--;\r
 111                 *pxTopOfStack = ( StackType_t ) 0x11111111;     /* R11 */\r
 112                 pxTopOfStack--;\r
 113                 *pxTopOfStack = ( StackType_t ) 0x10101010;     /* R10 */\r
 114                 pxTopOfStack--;\r
 115                 *pxTopOfStack = ( StackType_t ) 0x09090909;     /* R9 */\r
 116                 pxTopOfStack--;\r
 117                 *pxTopOfStack = ( StackType_t ) 0x08080808;     /* R8 */\r
 118                 pxTopOfStack--;\r
 119                 *pxTopOfStack = ( StackType_t ) 0x07070707;     /* R7 */\r
 120                 pxTopOfStack--;\r
 121                 *pxTopOfStack = ( StackType_t ) 0x06060606;     /* R6 */\r
 122                 pxTopOfStack--;\r
 123                 *pxTopOfStack = ( StackType_t ) 0x05050505;     /* R5 */\r
 124                 pxTopOfStack--;\r
 125                 *pxTopOfStack = ( StackType_t ) 0x04040404;     /* R4 */\r
 126                 pxTopOfStack--;\r
 127                 *pxTopOfStack = ( StackType_t ) 0x03030303;     /* R3 */\r
 128                 pxTopOfStack--;\r
 129                 *pxTopOfStack = ( StackType_t ) 0x02020202;     /* R2 */\r
 130                 pxTopOfStack--;\r
 131                 *pxTopOfStack = ( StackType_t ) 0x01010101;     /* R1 */\r
 132                 pxTopOfStack--;\r
 133         }\r
 134         #else\r
 135         {\r
 136                 pxTopOfStack -= portSPACE_BETWEEN_TOS_AND_PARAMETERS;\r
 137         }\r
 138         #endif\r
 139 \r
 140         /* Function parameters are passed in R0. */\r
 141         *pxTopOfStack = ( StackType_t ) pvParameters; /* R0 */\r
 142         pxTopOfStack--;\r
 143 \r
 144         /* Set the status register for system mode, with interrupts enabled. */\r
 145         *pxTopOfStack = ( StackType_t ) ( ( _get_CPSR() & ~0xFF ) | portINITIAL_SPSR );\r
 146 \r
 147         if( ( ( uint32_t ) pxCode & 0x01UL ) != 0x00 )\r
 148         {\r
 149                 /* The task will start in thumb mode. */\r
 150                 *pxTopOfStack |= portTHUMB_MODE_BIT;\r
 151         }\r
 152 \r
 153         #ifdef __TI_VFP_SUPPORT__\r
 154         {\r
 155                 pxTopOfStack--;\r
 156 \r
 157                 /* The last thing on the stack is the tasks ulUsingFPU value, which by\r
 158                 default is set to indicate that the stack frame does not include FPU\r
 159                 registers. */\r
 160                 *pxTopOfStack = pdFALSE;\r
 161         }\r
 162         #endif\r
 163 \r
 164         return pxTopOfStack;\r
 165 }\r
 166 /*-----------------------------------------------------------*/\r
 167 \r
 168 static void prvSetupTimerInterrupt(void)\r
 169 {\r
 170         /* Disable timer 0. */\r
 171         portRTI_GCTRL_REG &= 0xFFFFFFFEUL;\r
 172 \r
 173         /* Use the internal counter. */\r
 174         portRTI_TBCTRL_REG = 0x00000000U;\r
 175 \r
 176         /* COMPSEL0 will use the RTIFRC0 counter. */\r
 177         portRTI_COMPCTRL_REG = 0x00000000U;\r
 178 \r
 179         /* Initialise the counter and the prescale counter registers. */\r
 180         portRTI_CNT0_UC0_REG =  0x00000000U;\r
 181         portRTI_CNT0_FRC0_REG =  0x00000000U;\r
 182 \r
 183         /* Set Prescalar for RTI clock. */\r
 184         portRTI_CNT0_CPUC0_REG = 0x00000001U;\r
 185         portRTI_CNT0_COMP0_REG = ( configCPU_CLOCK_HZ / 2 ) / configTICK_RATE_HZ;\r
 186         portRTI_CNT0_UDCP0_REG = ( configCPU_CLOCK_HZ / 2 ) / configTICK_RATE_HZ;\r
 187 \r
 188         /* Clear interrupts. */\r
 189         portRTI_INTFLAG_REG =  0x0007000FU;\r
 190         portRTI_CLEARINTENA_REG = 0x00070F0FU;\r
 191 \r
 192         /* Enable the compare 0 interrupt. */\r
 193         portRTI_SETINTENA_REG = 0x00000001U;\r
 194         portRTI_GCTRL_REG |= 0x00000001U;\r
 195 }\r
 196 /*-----------------------------------------------------------*/\r
 197 \r
 198 /*\r
 199  * See header file for description.\r
 200  */\r
 201 BaseType_t xPortStartScheduler(void)\r
 202 {\r
 203         /* Start the timer that generates the tick ISR. */\r
 204         prvSetupTimerInterrupt();\r
 205 \r
 206         /* Reset the critical section nesting count read to execute the first task. */\r
 207         ulCriticalNesting = 0;\r
 208 \r
 209         /* Start the first task.  This is done from portASM.asm as ARM mode must be\r
 210         used. */\r
 211         vPortStartFirstTask();\r
 212 \r
 213         /* Should not get here! */\r
 214         return pdFAIL;\r
 215 }\r
 216 /*-----------------------------------------------------------*/\r
 217 \r
 218 /*\r
 219  * See header file for description.\r
 220  */\r
 221 void vPortEndScheduler(void)\r
 222 {\r
 223         /* Not implemented in ports where there is nothing to return to.\r
 224         Artificially force an assert. */\r
 225         configASSERT( ulCriticalNesting == 1000UL );\r
 226 }\r
 227 /*-----------------------------------------------------------*/\r
 228 \r
 229 #if configUSE_PREEMPTION == 0\r
 230 \r
 231         /* The cooperative scheduler requires a normal IRQ service routine to\r
 232          * simply increment the system tick. */\r
 233         __interrupt void vPortNonPreemptiveTick( void )\r
 234         {\r
 235                 /* clear clock interrupt flag */\r
 236                 portRTI_INTFLAG_REG = 0x00000001;\r
 237 \r
 238                 /* Increment the tick count - this may make a delaying task ready\r
 239                 to run - but a context switch is not performed. */\r
 240                 xTaskIncrementTick();\r
 241         }\r
 242 \r
 243  #else\r
 244 \r
 245         /*\r
 246          **************************************************************************\r
 247          * The preemptive scheduler ISR is written in assembler and can be found\r
 248          * in the portASM.asm file. This will only get used if portUSE_PREEMPTION\r
 249          * is set to 1 in portmacro.h\r
 250          **************************************************************************\r
 251          */\r
 252         void vPortPreemptiveTick( void );\r
 253 \r
 254 #endif\r
 255 /*-----------------------------------------------------------*/\r
 256 \r
 257 \r
 258 /*\r
 259  * Disable interrupts, and keep a count of the nesting depth.\r
 260  */\r
 261 void vPortEnterCritical( void )\r
 262 {\r
 263         /* Disable interrupts as per portDISABLE_INTERRUPTS(); */\r
 264         portDISABLE_INTERRUPTS();\r
 265 \r
 266         /* Now interrupts are disabled ulCriticalNesting can be accessed\r
 267         directly.  Increment ulCriticalNesting to keep a count of how many times\r
 268         portENTER_CRITICAL() has been called. */\r
 269         ulCriticalNesting++;\r
 270 }\r
 271 /*-----------------------------------------------------------*/\r
 272 \r
 273 /*\r
 274  * Decrement the critical nesting count, and if it has reached zero, re-enable\r
 275  * interrupts.\r
 276  */\r
 277 void vPortExitCritical( void )\r
 278 {\r
 279         if( ulCriticalNesting > 0 )\r
 280         {\r
 281                 /* Decrement the nesting count as we are leaving a critical section. */\r
 282                 ulCriticalNesting--;\r
 283 \r
 284                 /* If the nesting level has reached zero then interrupts should be\r
 285                 re-enabled. */\r
 286                 if( ulCriticalNesting == 0 )\r
 287                 {\r
 288                         /* Enable interrupts as per portENABLE_INTERRUPTS(). */\r
 289                         portENABLE_INTERRUPTS();\r
 290                 }\r
 291         }\r
 292 }\r
 293 /*-----------------------------------------------------------*/\r
 294 \r
 295 #if __TI_VFP_SUPPORT__\r
 296 \r
 297         void vPortTaskUsesFPU( void )\r
 298         {\r
 299         extern void vPortInitialiseFPSCR( void );\r
 300 \r
 301                 /* A task is registering the fact that it needs an FPU context.  Set the\r
 302                 FPU flag (saved as part of the task context. */\r
 303                 ulTaskHasFPUContext = pdTRUE;\r
 304 \r
 305                 /* Initialise the floating point status register. */\r
 306                 vPortInitialiseFPSCR();\r
 307         }\r
 308 \r
 309 #endif /* __TI_VFP_SUPPORT__ */\r
 310 \r
 311 /*-----------------------------------------------------------*/\r
 312 \r