|
|
|
@ -55,16 +55,14 @@
|
|
|
|
|
static void prvSetupTimerInterrupt( void );
|
|
|
|
|
|
|
|
|
|
/* The ISR used depends on whether the preemptive or cooperative scheduler
|
|
|
|
|
* is being used. */
|
|
|
|
|
is being used. */
|
|
|
|
|
#if( configUSE_PREEMPTION == 1 )
|
|
|
|
|
|
|
|
|
|
/* Tick service routine used by the scheduler when preemptive scheduling is
|
|
|
|
|
* being used. */
|
|
|
|
|
being used. */
|
|
|
|
|
static void __interrupt __far prvPreemptiveTick( void );
|
|
|
|
|
#else
|
|
|
|
|
|
|
|
|
|
/* Tick service routine used by the scheduler when cooperative scheduling is
|
|
|
|
|
* being used. */
|
|
|
|
|
being used. */
|
|
|
|
|
static void __interrupt __far prvNonPreemptiveTick( void );
|
|
|
|
|
#endif
|
|
|
|
|
|
|
|
|
@ -72,20 +70,18 @@ static void prvSetupTimerInterrupt( void );
|
|
|
|
|
static void __interrupt __far prvYieldProcessor( void );
|
|
|
|
|
|
|
|
|
|
/* The timer initialisation functions leave interrupts enabled,
|
|
|
|
|
* which is not what we want. This ISR is installed temporarily in case
|
|
|
|
|
* the timer fires before we get a change to disable interrupts again. */
|
|
|
|
|
which is not what we want. This ISR is installed temporarily in case
|
|
|
|
|
the timer fires before we get a change to disable interrupts again. */
|
|
|
|
|
static void __interrupt __far prvDummyISR( void );
|
|
|
|
|
|
|
|
|
|
/*-----------------------------------------------------------*/
|
|
|
|
|
/* See header file for description. */
|
|
|
|
|
StackType_t * pxPortInitialiseStack( StackType_t * pxTopOfStack,
|
|
|
|
|
TaskFunction_t pxCode,
|
|
|
|
|
void * pvParameters )
|
|
|
|
|
StackType_t *pxPortInitialiseStack( StackType_t *pxTopOfStack, TaskFunction_t pxCode, void *pvParameters )
|
|
|
|
|
{
|
|
|
|
|
StackType_t DS_Reg = 0;
|
|
|
|
|
|
|
|
|
|
/* Place a few bytes of known values on the bottom of the stack.
|
|
|
|
|
* This is just useful for debugging. */
|
|
|
|
|
This is just useful for debugging. */
|
|
|
|
|
|
|
|
|
|
*pxTopOfStack = 0x1111;
|
|
|
|
|
pxTopOfStack--;
|
|
|
|
@ -95,8 +91,8 @@ StackType_t * pxPortInitialiseStack( StackType_t * pxTopOfStack,
|
|
|
|
|
pxTopOfStack--;
|
|
|
|
|
|
|
|
|
|
/* We are going to start the scheduler using a return from interrupt
|
|
|
|
|
* instruction to load the program counter, so first there would be the
|
|
|
|
|
* function call with parameters preamble. */
|
|
|
|
|
instruction to load the program counter, so first there would be the
|
|
|
|
|
function call with parameters preamble. */
|
|
|
|
|
|
|
|
|
|
*pxTopOfStack = FP_SEG( pvParameters );
|
|
|
|
|
pxTopOfStack--;
|
|
|
|
@ -116,8 +112,8 @@ StackType_t * pxPortInitialiseStack( StackType_t * pxTopOfStack,
|
|
|
|
|
pxTopOfStack--;
|
|
|
|
|
|
|
|
|
|
/* The remaining registers would be pushed on the stack by our context
|
|
|
|
|
* switch function. These are loaded with values simply to make debugging
|
|
|
|
|
* easier. */
|
|
|
|
|
switch function. These are loaded with values simply to make debugging
|
|
|
|
|
easier. */
|
|
|
|
|
*pxTopOfStack = ( StackType_t ) 0xAAAA; /* AX */
|
|
|
|
|
pxTopOfStack--;
|
|
|
|
|
*pxTopOfStack = ( StackType_t ) 0xBBBB; /* BX */
|
|
|
|
@ -130,9 +126,7 @@ StackType_t * pxPortInitialiseStack( StackType_t * pxTopOfStack,
|
|
|
|
|
pxTopOfStack--;
|
|
|
|
|
|
|
|
|
|
/* We need the true data segment. */
|
|
|
|
|
__asm {
|
|
|
|
|
MOV DS_Reg, DS
|
|
|
|
|
};
|
|
|
|
|
__asm{ MOV DS_Reg, DS };
|
|
|
|
|
|
|
|
|
|
*pxTopOfStack = DS_Reg; /* DS */
|
|
|
|
|
pxTopOfStack--;
|
|
|
|
@ -151,7 +145,7 @@ BaseType_t xPortStartScheduler( void )
|
|
|
|
|
/* This is called with interrupts already disabled. */
|
|
|
|
|
|
|
|
|
|
/* Put our manual switch (yield) function on a known
|
|
|
|
|
* vector. */
|
|
|
|
|
vector. */
|
|
|
|
|
setvect( portSWITCH_INT_NUMBER, prvYieldProcessor );
|
|
|
|
|
|
|
|
|
|
/* Setup the tick interrupt. */
|
|
|
|
@ -168,14 +162,14 @@ BaseType_t xPortStartScheduler( void )
|
|
|
|
|
static void __interrupt __far prvDummyISR( void )
|
|
|
|
|
{
|
|
|
|
|
/* The timer initialisation functions leave interrupts enabled,
|
|
|
|
|
* which is not what we want. This ISR is installed temporarily in case
|
|
|
|
|
* the timer fires before we get a change to disable interrupts again. */
|
|
|
|
|
which is not what we want. This ISR is installed temporarily in case
|
|
|
|
|
the timer fires before we get a change to disable interrupts again. */
|
|
|
|
|
outport( portEIO_REGISTER, portCLEAR_INTERRUPT );
|
|
|
|
|
}
|
|
|
|
|
/*-----------------------------------------------------------*/
|
|
|
|
|
|
|
|
|
|
/* The ISR used depends on whether the preemptive or cooperative scheduler
|
|
|
|
|
* is being used. */
|
|
|
|
|
is being used. */
|
|
|
|
|
#if( configUSE_PREEMPTION == 1 )
|
|
|
|
|
static void __interrupt __far prvPreemptiveTick( void )
|
|
|
|
|
{
|
|
|
|
@ -189,17 +183,17 @@ static void __interrupt __far prvDummyISR( void )
|
|
|
|
|
/* Reset interrupt. */
|
|
|
|
|
outport( portEIO_REGISTER, portCLEAR_INTERRUPT );
|
|
|
|
|
}
|
|
|
|
|
#else /* if ( configUSE_PREEMPTION == 1 ) */
|
|
|
|
|
#else
|
|
|
|
|
static void __interrupt __far prvNonPreemptiveTick( void )
|
|
|
|
|
{
|
|
|
|
|
/* Same as preemptive tick, but the cooperative scheduler is being used
|
|
|
|
|
* so we don't have to switch in the context of the next task. */
|
|
|
|
|
so we don't have to switch in the context of the next task. */
|
|
|
|
|
xTaskIncrementTick();
|
|
|
|
|
|
|
|
|
|
/* Reset interrupt. */
|
|
|
|
|
outport( portEIO_REGISTER, portCLEAR_INTERRUPT );
|
|
|
|
|
}
|
|
|
|
|
#endif /* if ( configUSE_PREEMPTION == 1 ) */
|
|
|
|
|
#endif
|
|
|
|
|
/*-----------------------------------------------------------*/
|
|
|
|
|
|
|
|
|
|
static void __interrupt __far prvYieldProcessor( void )
|
|
|
|
@ -221,21 +215,19 @@ static void prvSetupTimerInterrupt( void )
|
|
|
|
|
const uint16_t usT2_IRQ = 0x13;
|
|
|
|
|
|
|
|
|
|
/* Configure the timer, the dummy handler is used here as the init
|
|
|
|
|
* function leaves interrupts enabled. */
|
|
|
|
|
function leaves interrupts enabled. */
|
|
|
|
|
t2_init( usTimerAMode, usTimerACompare, prvDummyISR );
|
|
|
|
|
|
|
|
|
|
/* Disable interrupts again before installing the real handlers. */
|
|
|
|
|
portDISABLE_INTERRUPTS();
|
|
|
|
|
|
|
|
|
|
#if( configUSE_PREEMPTION == 1 )
|
|
|
|
|
|
|
|
|
|
/* Tick service routine used by the scheduler when preemptive scheduling is
|
|
|
|
|
* being used. */
|
|
|
|
|
being used. */
|
|
|
|
|
setvect( usT2_IRQ, prvPreemptiveTick );
|
|
|
|
|
#else
|
|
|
|
|
|
|
|
|
|
/* Tick service routine used by the scheduler when cooperative scheduling is
|
|
|
|
|
* being used. */
|
|
|
|
|
being used. */
|
|
|
|
|
setvect( usT2_IRQ, prvNonPreemptiveTick );
|
|
|
|
|
#endif
|
|
|
|
|
}
|
|
|
|
|