]> begriffs open source - freertos/blob - Source/portable/Paradigm/Tern_EE/small/port.c
Update to V4.6.1 - including PIC32MX port.
[freertos] / Source / portable / Paradigm / Tern_EE / small / port.c
1 /*\r
2         FreeRTOS.org V4.6.1 - Copyright (C) 2003-2007 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\r
7         it under the terms of the GNU General Public License as published by\r
8         the Free Software Foundation; either version 2 of the License, or\r
9         (at your option) any later version.\r
10 \r
11         FreeRTOS.org is distributed in the hope that it will be useful,\r
12         but WITHOUT ANY WARRANTY; without even the implied warranty of\r
13         MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the\r
14         GNU General Public License for more details.\r
15 \r
16         You should have received a copy of the GNU General Public License\r
17         along with FreeRTOS.org; if not, write to the Free Software\r
18         Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA\r
19 \r
20         A special exception to the GPL can be applied should you wish to distribute\r
21         a combined work that includes FreeRTOS.org, without being obliged to provide\r
22         the source code for any proprietary components.  See the licensing section\r
23         of http://www.FreeRTOS.org for full details of how and when the exception\r
24         can be applied.\r
25 \r
26         ***************************************************************************\r
27         See http://www.FreeRTOS.org for documentation, latest information, license\r
28         and contact details.  Please ensure to read the configuration and relevant\r
29         port sections of the online documentation.\r
30 \r
31         Also see http://www.SafeRTOS.com a version that has been certified for use\r
32         in safety critical systems, plus commercial licensing, development and\r
33         support options.\r
34         ***************************************************************************\r
35 */\r
36 \r
37 \r
38 /*-----------------------------------------------------------\r
39  * Implementation of functions defined in portable.h for the Tern EE 186\r
40  * port.\r
41  *----------------------------------------------------------*/\r
42 \r
43 /* Library includes. */\r
44 #include <embedded.h>\r
45 #include <ae.h>\r
46 \r
47 /* Scheduler includes. */\r
48 #include "FreeRTOS.h"\r
49 #include "task.h"\r
50 #include "portasm.h"\r
51 \r
52 /* The timer increments every four clocks, hence the divide by 4. */\r
53 #define portPRESCALE_VALUE ( 16 )\r
54 #define portTIMER_COMPARE ( configCPU_CLOCK_HZ  / ( configTICK_RATE_HZ * 4UL ) )\r
55 \r
56 /* From the RDC data sheet. */\r
57 #define portENABLE_TIMER_AND_INTERRUPT  ( unsigned portSHORT ) 0xe00b\r
58 #define portENABLE_TIMER                                ( unsigned portSHORT ) 0xC001\r
59 \r
60 /* Interrupt control. */\r
61 #define portEIO_REGISTER 0xff22\r
62 #define portCLEAR_INTERRUPT 0x0008\r
63 \r
64 /* Setup the hardware to generate the required tick frequency. */\r
65 static void prvSetupTimerInterrupt( void );\r
66 \r
67 /* The ISR used depends on whether the preemptive or cooperative scheduler\r
68 is being used. */\r
69 #if( configUSE_PREEMPTION == 1 )\r
70         /* Tick service routine used by the scheduler when preemptive scheduling is\r
71         being used. */\r
72         static void __interrupt __far prvPreemptiveTick( void );\r
73 #else\r
74         /* Tick service routine used by the scheduler when cooperative scheduling is\r
75         being used. */\r
76         static void __interrupt __far prvNonPreemptiveTick( void );\r
77 #endif\r
78 \r
79 /* Trap routine used by taskYIELD() to manually cause a context switch. */\r
80 static void __interrupt __far prvYieldProcessor( void );\r
81 \r
82 /*-----------------------------------------------------------*/\r
83 /* See header file for description. */\r
84 portSTACK_TYPE *pxPortInitialiseStack( portSTACK_TYPE *pxTopOfStack, pdTASK_CODE pxCode, void *pvParameters )\r
85 {\r
86 portSTACK_TYPE DS_Reg = 0;\r
87 \r
88         /* We need the true data segment. */\r
89         __asm{  MOV DS_Reg, DS };\r
90 \r
91         /* Place a few bytes of known values on the bottom of the stack.\r
92         This is just useful for debugging. */\r
93 \r
94         *pxTopOfStack = 0x1111;\r
95         pxTopOfStack--;\r
96         *pxTopOfStack = 0x2222;\r
97         pxTopOfStack--;\r
98         *pxTopOfStack = 0x3333;\r
99         pxTopOfStack--;\r
100 \r
101         /* We are going to start the scheduler using a return from interrupt\r
102         instruction to load the program counter, so first there would be the\r
103         function call with parameters preamble. */\r
104         \r
105         *pxTopOfStack = FP_OFF( pvParameters );\r
106         pxTopOfStack--;\r
107         *pxTopOfStack = FP_OFF( pxCode );\r
108         pxTopOfStack--;\r
109 \r
110         /* Next the status register and interrupt return address. */\r
111         *pxTopOfStack = portINITIAL_SW;\r
112         pxTopOfStack--;\r
113         *pxTopOfStack = FP_SEG( pxCode );\r
114         pxTopOfStack--;\r
115         *pxTopOfStack = FP_OFF( pxCode );\r
116         pxTopOfStack--;\r
117 \r
118         /* The remaining registers would be pushed on the stack by our context\r
119         switch function.  These are loaded with values simply to make debugging\r
120         easier. */\r
121         *pxTopOfStack = ( portSTACK_TYPE ) 0xAAAA;      /* AX */\r
122         pxTopOfStack--;\r
123         *pxTopOfStack = ( portSTACK_TYPE ) 0xBBBB;      /* BX */\r
124         pxTopOfStack--;\r
125         *pxTopOfStack = ( portSTACK_TYPE ) 0xCCCC;      /* CX */\r
126         pxTopOfStack--;\r
127         *pxTopOfStack = ( portSTACK_TYPE ) 0xDDDD;      /* DX */\r
128         pxTopOfStack--;\r
129         *pxTopOfStack = ( portSTACK_TYPE ) 0xEEEE;      /* ES */\r
130         pxTopOfStack--;\r
131 \r
132         *pxTopOfStack = DS_Reg;                                         /* DS */\r
133         pxTopOfStack--;\r
134         *pxTopOfStack = ( portSTACK_TYPE ) 0x0123;      /* SI */\r
135         pxTopOfStack--;\r
136         *pxTopOfStack = ( portSTACK_TYPE ) 0xDDDD;      /* DI */\r
137         pxTopOfStack--;\r
138         *pxTopOfStack = ( portSTACK_TYPE ) 0xBBBB;      /* BP */\r
139 \r
140         return pxTopOfStack;\r
141 }\r
142 /*-----------------------------------------------------------*/\r
143 \r
144 portBASE_TYPE xPortStartScheduler( void )\r
145 {\r
146         /* This is called with interrupts already disabled. */\r
147 \r
148         /* Put our manual switch (yield) function on a known\r
149         vector. */\r
150         setvect( portSWITCH_INT_NUMBER, prvYieldProcessor );\r
151 \r
152         /* Setup the tick interrupt. */\r
153         prvSetupTimerInterrupt();\r
154 \r
155         /* Kick off the scheduler by setting up the context of the first task. */\r
156         portFIRST_CONTEXT();\r
157 \r
158         /* Should not get here! */\r
159         return pdFALSE;\r
160 }\r
161 /*-----------------------------------------------------------*/\r
162 \r
163 /* The ISR used depends on whether the preemptive or cooperative scheduler\r
164 is being used. */\r
165 #if( configUSE_PREEMPTION == 1 )\r
166         static void __interrupt __far prvPreemptiveTick( void )\r
167         {\r
168                 /* Get the scheduler to update the task states following the tick. */\r
169                 vTaskIncrementTick();\r
170 \r
171                 /* Switch in the context of the next task to be run. */\r
172                 portEND_SWITCHING_ISR();\r
173 \r
174                 /* Reset interrupt. */\r
175                 outport( portEIO_REGISTER, portCLEAR_INTERRUPT );\r
176         }\r
177 #else\r
178         static void __interrupt __far prvNonPreemptiveTick( void )\r
179         {\r
180                 /* Same as preemptive tick, but the cooperative scheduler is being used\r
181                 so we don't have to switch in the context of the next task. */\r
182                 vTaskIncrementTick();\r
183                 /* Reset interrupt. */\r
184                 outport( portEIO_REGISTER, portCLEAR_INTERRUPT );\r
185         }\r
186 #endif\r
187 /*-----------------------------------------------------------*/\r
188 \r
189 static void __interrupt __far prvYieldProcessor( void )\r
190 {\r
191         /* Switch in the context of the next task to be run. */\r
192         portEND_SWITCHING_ISR();\r
193 }\r
194 /*-----------------------------------------------------------*/\r
195 \r
196 void vPortEndScheduler( void )\r
197 {\r
198         /* Not implemented. */\r
199 }\r
200 /*-----------------------------------------------------------*/\r
201 \r
202 static void prvSetupTimerInterrupt( void )\r
203 {\r
204 const unsigned portLONG ulCompareValue = portTIMER_COMPARE;\r
205 unsigned portSHORT usTimerCompare;\r
206 \r
207         usTimerCompare = ( unsigned portSHORT ) ( ulCompareValue >> 4 );\r
208     t2_init( portENABLE_TIMER, portPRESCALE_VALUE, NULL );\r
209 \r
210         #if( configUSE_PREEMPTION == 1 )\r
211                 /* Tick service routine used by the scheduler when preemptive scheduling is\r
212                 being used. */\r
213                 t1_init( portENABLE_TIMER_AND_INTERRUPT, usTimerCompare, usTimerCompare, prvPreemptiveTick );\r
214         #else\r
215                 /* Tick service routine used by the scheduler when cooperative scheduling is\r
216                 being used. */\r
217                 t1_init( portENABLE_TIMER_AND_INTERRUPT, usTimerCompare, usTimerCompare, prvNonPreemptiveTick );\r
218         #endif\r
219 }\r
220 \r
221 \r
222 \r
223 \r
224 \r
225 \r
226 \r