2 FreeRTOS.org V5.0.4 - Copyright (C) 2003-2008 Richard Barry.
\r
4 This file is part of the FreeRTOS.org distribution.
\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
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
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
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
26 ***************************************************************************
\r
27 ***************************************************************************
\r
29 * SAVE TIME AND MONEY! We can port FreeRTOS.org to your own hardware, *
\r
30 * and even write all or part of your application on your behalf. *
\r
31 * See http://www.OpenRTOS.com for details of the services we provide to *
\r
32 * expedite your project. *
\r
34 ***************************************************************************
\r
35 ***************************************************************************
\r
37 Please ensure to read the configuration and relevant port sections of the
\r
38 online documentation.
\r
40 http://www.FreeRTOS.org - Documentation, latest information, license and
\r
43 http://www.SafeRTOS.com - A version that is certified for use in safety
\r
46 http://www.OpenRTOS.com - Commercial support, development, porting,
\r
47 licensing and training services.
\r
50 /* Kernel includes. */
\r
51 #include "FreeRTOS.h"
\r
55 #define portINITIAL_FORMAT_VECTOR ( ( portSTACK_TYPE ) 0x4000 )
\r
57 /* Supervisor mode set. */
\r
58 #define portINITIAL_STATUS_REGISTER ( ( portSTACK_TYPE ) 0x2000)
\r
60 /* Used to keep track of the number of nested calls to taskENTER_CRITICAL(). This
\r
61 will be set to 0 prior to the first task being started. */
\r
62 static unsigned portLONG ulCriticalNesting = 0x9999UL;
\r
65 #define portSAVE_CONTEXT() \
\r
66 lea.l (-60, %sp), %sp; \
\r
67 movem.l %d0-%fp, (%sp); \
\r
68 move.l pxCurrentTCB, %a0; \
\r
71 #define portRESTORE_CONTEXT() \
\r
72 move.l pxCurrentTCB, %a0; \
\r
73 move.l (%a0), %sp; \
\r
74 movem.l (%sp), %d0-%fp; \
\r
75 lea.l %sp@(60), %sp; \
\r
80 /*-----------------------------------------------------------*/
\r
82 portSTACK_TYPE *pxPortInitialiseStack( portSTACK_TYPE * pxTopOfStack, pdTASK_CODE pxCode, void *pvParameters )
\r
84 *pxTopOfStack = ( portSTACK_TYPE ) pvParameters;
\r
87 *pxTopOfStack = (portSTACK_TYPE) 0xDEADBEEF;
\r
90 /* Exception stack frame starts with the return address. */
\r
91 *pxTopOfStack = ( portSTACK_TYPE ) pxCode;
\r
94 *pxTopOfStack = ( portINITIAL_FORMAT_VECTOR << 16UL ) | ( portINITIAL_STATUS_REGISTER );
\r
97 *pxTopOfStack = ( portSTACK_TYPE ) 0x0; /*FP*/
\r
98 pxTopOfStack -= 14; /* A5 to D0. */
\r
100 return pxTopOfStack;
\r
102 /*-----------------------------------------------------------*/
\r
104 portBASE_TYPE xPortStartScheduler( void )
\r
106 extern void vPortStartFirstTask( void );
\r
108 ulCriticalNesting = 0UL;
\r
110 /* Configure the interrupts used by this port. */
\r
111 vApplicationSetupInterrupts();
\r
113 /* Start the first task executing. */
\r
114 vPortStartFirstTask();
\r
118 /*-----------------------------------------------------------*/
\r
120 void vPortEndScheduler( void )
\r
122 /* Not implemented as there is nothing to return to. */
\r
124 /*-----------------------------------------------------------*/
\r
126 void vPortEnterCritical( void )
\r
128 if( ulCriticalNesting == 0UL )
\r
130 /* Guard against context switches being pended simultaneously with a
\r
131 critical section being entered. */
\r
134 portDISABLE_INTERRUPTS();
\r
135 if( MCF_INTC0_INTFRCH == 0UL )
\r
140 portENABLE_INTERRUPTS();
\r
144 ulCriticalNesting++;
\r
146 /*-----------------------------------------------------------*/
\r
148 void vPortExitCritical( void )
\r
150 ulCriticalNesting--;
\r
151 if( ulCriticalNesting == 0 )
\r
153 portENABLE_INTERRUPTS();
\r
156 /*-----------------------------------------------------------*/
\r
158 void vPortYieldHandler( void )
\r
160 unsigned portLONG ulSavedInterruptMask;
\r
162 ulSavedInterruptMask = portSET_INTERRUPT_MASK_FROM_ISR();
\r
163 /* Note this will clear all forced interrupts - this is done for speed. */
\r
164 MCF_INTC0_INTFRCL = 0;
\r
165 vTaskSwitchContext();
\r
166 portCLEAR_INTERRUPT_MASK_FROM_ISR( ulSavedInterruptMask );
\r
168 /*-----------------------------------------------------------*/
\r