git.sur5r.net Git - freertos/blob - Source/portable/GCC/STR75x/port.c

   1 /*\r
   2         FreeRTOS.org V5.2.0 - Copyright (C) 2003-2009 Richard Barry.\r
   3 \r
   4         This file is part of the FreeRTOS.org distribution.\r
   5 \r
   6         FreeRTOS.org is free software; you can redistribute it and/or modify it \r
   7         under the terms of the GNU General Public License (version 2) as published\r
   8         by the Free Software Foundation and modified by the FreeRTOS exception.\r
   9 \r
  10         FreeRTOS.org is distributed in the hope that it will be useful, but WITHOUT\r
  11         ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or \r
  12         FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License for \r
  13         more details.\r
  14 \r
  15         You should have received a copy of the GNU General Public License along \r
  16         with FreeRTOS.org; if not, write to the Free Software Foundation, Inc., 59 \r
  17         Temple Place, Suite 330, Boston, MA  02111-1307  USA.\r
  18 \r
  19         A special exception to the GPL is included to allow you to distribute a \r
  20         combined work that includes FreeRTOS.org without being obliged to provide\r
  21         the source code for any proprietary components.  See the licensing section\r
  22         of http://www.FreeRTOS.org for full details.\r
  23 \r
  24 \r
  25         ***************************************************************************\r
  26         *                                                                         *\r
  27         * Get the FreeRTOS eBook!  See http://www.FreeRTOS.org/Documentation      *\r
  28         *                                                                         *\r
  29         * This is a concise, step by step, 'hands on' guide that describes both   *\r
  30         * general multitasking concepts and FreeRTOS specifics. It presents and   *\r
  31         * explains numerous examples that are written using the FreeRTOS API.     *\r
  32         * Full source code for all the examples is provided in an accompanying    *\r
  33         * .zip file.                                                              *\r
  34         *                                                                         *\r
  35         ***************************************************************************\r
  36 \r
  37         1 tab == 4 spaces!\r
  38 \r
  39         Please ensure to read the configuration and relevant port sections of the\r
  40         online documentation.\r
  41 \r
  42         http://www.FreeRTOS.org - Documentation, latest information, license and\r
  43         contact details.\r
  44 \r
  45         http://www.SafeRTOS.com - A version that is certified for use in safety\r
  46         critical systems.\r
  47 \r
  48         http://www.OpenRTOS.com - Commercial support, development, porting,\r
  49         licensing and training services.\r
  50 */\r
  51 \r
  52 /*-----------------------------------------------------------\r
  53  * Implementation of functions defined in portable.h for the ST STR75x ARM7\r
  54  * port.\r
  55  *----------------------------------------------------------*/\r
  56 \r
  57 /* Library includes. */\r
  58 #include "75x_tb.h"\r
  59 #include "75x_eic.h"\r
  60 \r
  61 /* Scheduler includes. */\r
  62 #include "FreeRTOS.h"\r
  63 #include "task.h"\r
  64 \r
  65 /* Constants required to setup the initial stack. */\r
  66 #define portINITIAL_SPSR                                ( ( portSTACK_TYPE ) 0x1f ) /* System mode, ARM mode, interrupts enabled. */\r
  67 #define portTHUMB_MODE_BIT                              ( ( portSTACK_TYPE ) 0x20 )\r
  68 #define portINSTRUCTION_SIZE                    ( ( portSTACK_TYPE ) 4 )\r
  69 \r
  70 /* Constants required to handle critical sections. */\r
  71 #define portNO_CRITICAL_NESTING                 ( ( unsigned portLONG ) 0 )\r
  72 \r
  73 /* Prescale used on the timer clock when calculating the tick period. */\r
  74 #define portPRESCALE 20\r
  75 \r
  76 \r
  77 /*-----------------------------------------------------------*/\r
  78 \r
  79 /* Setup the TB to generate the tick interrupts. */\r
  80 static void prvSetupTimerInterrupt( void );\r
  81 \r
  82 /*-----------------------------------------------------------*/\r
  83 \r
  84 /*\r
  85  * Initialise the stack of a task to look exactly as if a call to\r
  86  * portSAVE_CONTEXT had been called.\r
  87  *\r
  88  * See header file for description.\r
  89  */\r
  90 portSTACK_TYPE *pxPortInitialiseStack( portSTACK_TYPE *pxTopOfStack, pdTASK_CODE pxCode, void *pvParameters )\r
  91 {\r
  92 portSTACK_TYPE *pxOriginalTOS;\r
  93 \r
  94         pxOriginalTOS = pxTopOfStack;\r
  95 \r
  96         /* Setup the initial stack of the task.  The stack is set exactly as\r
  97         expected by the portRESTORE_CONTEXT() macro. */\r
  98 \r
  99         /* First on the stack is the return address - which in this case is the\r
 100         start of the task.  The offset is added to make the return address appear\r
 101         as it would within an IRQ ISR. */\r
 102         *pxTopOfStack = ( portSTACK_TYPE ) pxCode + portINSTRUCTION_SIZE;               \r
 103         pxTopOfStack--;\r
 104 \r
 105         *pxTopOfStack = ( portSTACK_TYPE ) 0xaaaaaaaa;  /* R14 */\r
 106         pxTopOfStack--; \r
 107         *pxTopOfStack = ( portSTACK_TYPE ) pxOriginalTOS; /* Stack used when task starts goes in R13. */\r
 108         pxTopOfStack--;\r
 109         *pxTopOfStack = ( portSTACK_TYPE ) 0x12121212;  /* R12 */\r
 110         pxTopOfStack--; \r
 111         *pxTopOfStack = ( portSTACK_TYPE ) 0x11111111;  /* R11 */\r
 112         pxTopOfStack--; \r
 113         *pxTopOfStack = ( portSTACK_TYPE ) 0x10101010;  /* R10 */\r
 114         pxTopOfStack--; \r
 115         *pxTopOfStack = ( portSTACK_TYPE ) 0x09090909;  /* R9 */\r
 116         pxTopOfStack--; \r
 117         *pxTopOfStack = ( portSTACK_TYPE ) 0x08080808;  /* R8 */\r
 118         pxTopOfStack--; \r
 119         *pxTopOfStack = ( portSTACK_TYPE ) 0x07070707;  /* R7 */\r
 120         pxTopOfStack--; \r
 121         *pxTopOfStack = ( portSTACK_TYPE ) 0x06060606;  /* R6 */\r
 122         pxTopOfStack--; \r
 123         *pxTopOfStack = ( portSTACK_TYPE ) 0x05050505;  /* R5 */\r
 124         pxTopOfStack--; \r
 125         *pxTopOfStack = ( portSTACK_TYPE ) 0x04040404;  /* R4 */\r
 126         pxTopOfStack--; \r
 127         *pxTopOfStack = ( portSTACK_TYPE ) 0x03030303;  /* R3 */\r
 128         pxTopOfStack--; \r
 129         *pxTopOfStack = ( portSTACK_TYPE ) 0x02020202;  /* R2 */\r
 130         pxTopOfStack--; \r
 131         *pxTopOfStack = ( portSTACK_TYPE ) 0x01010101;  /* R1 */\r
 132         pxTopOfStack--; \r
 133 \r
 134         /* When the task starts is will expect to find the function parameter in\r
 135         R0. */\r
 136         *pxTopOfStack = ( portSTACK_TYPE ) pvParameters; /* R0 */\r
 137         pxTopOfStack--;\r
 138 \r
 139         /* The status register is set for system mode, with interrupts enabled. */\r
 140         *pxTopOfStack = ( portSTACK_TYPE ) portINITIAL_SPSR;\r
 141 \r
 142         #ifdef THUMB_INTERWORK\r
 143         {\r
 144                 /* We want the task to start in thumb mode. */\r
 145                 *pxTopOfStack |= portTHUMB_MODE_BIT;\r
 146         }\r
 147         #endif\r
 148 \r
 149         pxTopOfStack--;\r
 150 \r
 151         /* Interrupt flags cannot always be stored on the stack and will\r
 152         instead be stored in a variable, which is then saved as part of the\r
 153         tasks context. */\r
 154         *pxTopOfStack = portNO_CRITICAL_NESTING;\r
 155 \r
 156         return pxTopOfStack;    \r
 157 }\r
 158 /*-----------------------------------------------------------*/\r
 159 \r
 160 portBASE_TYPE xPortStartScheduler( void )\r
 161 {\r
 162 extern void vPortISRStartFirstTask( void );\r
 163 \r
 164         /* Start the timer that generates the tick ISR.  Interrupts are disabled\r
 165         here already. */\r
 166         prvSetupTimerInterrupt();\r
 167 \r
 168         /* Start the first task. */\r
 169         vPortISRStartFirstTask();       \r
 170 \r
 171         /* Should not get here! */\r
 172         return 0;\r
 173 }\r
 174 /*-----------------------------------------------------------*/\r
 175 \r
 176 void vPortEndScheduler( void )\r
 177 {\r
 178         /* It is unlikely that the ARM port will require this function as there\r
 179         is nothing to return to.  */\r
 180 }\r
 181 /*-----------------------------------------------------------*/\r
 182 \r
 183 static void prvSetupTimerInterrupt( void )\r
 184 {\r
 185 EIC_IRQInitTypeDef  EIC_IRQInitStructure;       \r
 186 TB_InitTypeDef      TB_InitStructure;\r
 187 \r
 188         /* Setup the EIC for the TB. */\r
 189         EIC_IRQInitStructure.EIC_IRQChannelCmd = ENABLE;\r
 190         EIC_IRQInitStructure.EIC_IRQChannel = TB_IRQChannel;\r
 191         EIC_IRQInitStructure.EIC_IRQChannelPriority = 1;\r
 192         EIC_IRQInit(&EIC_IRQInitStructure);\r
 193         \r
 194         /* Setup the TB for the generation of the tick interrupt. */\r
 195         TB_InitStructure.TB_Mode = TB_Mode_Timing;\r
 196         TB_InitStructure.TB_CounterMode = TB_CounterMode_Down;\r
 197         TB_InitStructure.TB_Prescaler = portPRESCALE - 1;\r
 198         TB_InitStructure.TB_AutoReload = ( ( configCPU_CLOCK_HZ / ( portPRESCALE + 1 ) ) / configTICK_RATE_HZ ) + 1;\r
 199         TB_Init(&TB_InitStructure);\r
 200         \r
 201         /* Enable TB Update interrupt */\r
 202         TB_ITConfig(TB_IT_Update, ENABLE);\r
 203 \r
 204         /* Clear TB Update interrupt pending bit */\r
 205         TB_ClearITPendingBit(TB_IT_Update);\r
 206 \r
 207         /* Enable TB */\r
 208         TB_Cmd(ENABLE);\r
 209 }\r
 210 /*-----------------------------------------------------------*/\r
 211 \r
 212 \r
 213 \r
 214 \r
 215 \r
 216 \r
 217 \r