|
|
@ -28,9 +28,9 @@
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
/*-----------------------------------------------------------
|
|
|
|
/*-----------------------------------------------------------
|
|
|
|
* Implementation of functions defined in portable.h for the Tern EE 186
|
|
|
|
* Implementation of functions defined in portable.h for the Tern EE 186
|
|
|
|
* port.
|
|
|
|
* port.
|
|
|
|
*----------------------------------------------------------*/
|
|
|
|
*----------------------------------------------------------*/
|
|
|
|
|
|
|
|
|
|
|
|
/* Library includes. */
|
|
|
|
/* Library includes. */
|
|
|
|
#include <embedded.h>
|
|
|
|
#include <embedded.h>
|
|
|
@ -42,29 +42,27 @@
|
|
|
|
#include "portasm.h"
|
|
|
|
#include "portasm.h"
|
|
|
|
|
|
|
|
|
|
|
|
/* The timer increments every four clocks, hence the divide by 4. */
|
|
|
|
/* The timer increments every four clocks, hence the divide by 4. */
|
|
|
|
#define portTIMER_COMPARE ( uint16_t ) ( ( configCPU_CLOCK_HZ / configTICK_RATE_HZ ) / ( uint32_t ) 4 )
|
|
|
|
#define portTIMER_COMPARE ( uint16_t ) ( ( configCPU_CLOCK_HZ / configTICK_RATE_HZ ) / ( uint32_t ) 4 )
|
|
|
|
|
|
|
|
|
|
|
|
/* From the RDC data sheet. */
|
|
|
|
/* From the RDC data sheet. */
|
|
|
|
#define portENABLE_TIMER_AND_INTERRUPT ( uint16_t ) 0xe001
|
|
|
|
#define portENABLE_TIMER_AND_INTERRUPT ( uint16_t ) 0xe001
|
|
|
|
|
|
|
|
|
|
|
|
/* Interrupt control. */
|
|
|
|
/* Interrupt control. */
|
|
|
|
#define portEIO_REGISTER 0xff22
|
|
|
|
#define portEIO_REGISTER 0xff22
|
|
|
|
#define portCLEAR_INTERRUPT 0x0008
|
|
|
|
#define portCLEAR_INTERRUPT 0x0008
|
|
|
|
|
|
|
|
|
|
|
|
/* Setup the hardware to generate the required tick frequency. */
|
|
|
|
/* Setup the hardware to generate the required tick frequency. */
|
|
|
|
static void prvSetupTimerInterrupt( void );
|
|
|
|
static void prvSetupTimerInterrupt( void );
|
|
|
|
|
|
|
|
|
|
|
|
/* The ISR used depends on whether the preemptive or cooperative scheduler
|
|
|
|
/* The ISR used depends on whether the preemptive or cooperative scheduler
|
|
|
|
* is being used. */
|
|
|
|
is being used. */
|
|
|
|
#if ( configUSE_PREEMPTION == 1 )
|
|
|
|
#if( configUSE_PREEMPTION == 1 )
|
|
|
|
|
|
|
|
/* Tick service routine used by the scheduler when preemptive scheduling is
|
|
|
|
/* Tick service routine used by the scheduler when preemptive scheduling is
|
|
|
|
being used. */
|
|
|
|
* being used. */
|
|
|
|
|
|
|
|
static void __interrupt __far prvPreemptiveTick( void );
|
|
|
|
static void __interrupt __far prvPreemptiveTick( void );
|
|
|
|
#else
|
|
|
|
#else
|
|
|
|
|
|
|
|
/* Tick service routine used by the scheduler when cooperative scheduling is
|
|
|
|
/* Tick service routine used by the scheduler when cooperative scheduling is
|
|
|
|
being used. */
|
|
|
|
* being used. */
|
|
|
|
|
|
|
|
static void __interrupt __far prvNonPreemptiveTick( void );
|
|
|
|
static void __interrupt __far prvNonPreemptiveTick( void );
|
|
|
|
#endif
|
|
|
|
#endif
|
|
|
|
|
|
|
|
|
|
|
@ -72,20 +70,18 @@ static void prvSetupTimerInterrupt( void );
|
|
|
|
static void __interrupt __far prvYieldProcessor( void );
|
|
|
|
static void __interrupt __far prvYieldProcessor( void );
|
|
|
|
|
|
|
|
|
|
|
|
/* The timer initialisation functions leave interrupts enabled,
|
|
|
|
/* The timer initialisation functions leave interrupts enabled,
|
|
|
|
* which is not what we want. This ISR is installed temporarily in case
|
|
|
|
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. */
|
|
|
|
the timer fires before we get a change to disable interrupts again. */
|
|
|
|
static void __interrupt __far prvDummyISR( void );
|
|
|
|
static void __interrupt __far prvDummyISR( void );
|
|
|
|
|
|
|
|
|
|
|
|
/*-----------------------------------------------------------*/
|
|
|
|
/*-----------------------------------------------------------*/
|
|
|
|
/* See header file for description. */
|
|
|
|
/* See header file for description. */
|
|
|
|
StackType_t * pxPortInitialiseStack( StackType_t * pxTopOfStack,
|
|
|
|
StackType_t *pxPortInitialiseStack( StackType_t *pxTopOfStack, TaskFunction_t pxCode, void *pvParameters )
|
|
|
|
TaskFunction_t pxCode,
|
|
|
|
|
|
|
|
void * pvParameters )
|
|
|
|
|
|
|
|
{
|
|
|
|
{
|
|
|
|
StackType_t DS_Reg = 0;
|
|
|
|
StackType_t DS_Reg = 0;
|
|
|
|
|
|
|
|
|
|
|
|
/* Place a few bytes of known values on the bottom of the stack.
|
|
|
|
/* 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 = 0x1111;
|
|
|
|
pxTopOfStack--;
|
|
|
|
pxTopOfStack--;
|
|
|
@ -95,8 +91,8 @@ StackType_t * pxPortInitialiseStack( StackType_t * pxTopOfStack,
|
|
|
|
pxTopOfStack--;
|
|
|
|
pxTopOfStack--;
|
|
|
|
|
|
|
|
|
|
|
|
/* We are going to start the scheduler using a return from interrupt
|
|
|
|
/* We are going to start the scheduler using a return from interrupt
|
|
|
|
* instruction to load the program counter, so first there would be the
|
|
|
|
instruction to load the program counter, so first there would be the
|
|
|
|
* function call with parameters preamble. */
|
|
|
|
function call with parameters preamble. */
|
|
|
|
|
|
|
|
|
|
|
|
*pxTopOfStack = FP_SEG( pvParameters );
|
|
|
|
*pxTopOfStack = FP_SEG( pvParameters );
|
|
|
|
pxTopOfStack--;
|
|
|
|
pxTopOfStack--;
|
|
|
@ -116,8 +112,8 @@ StackType_t * pxPortInitialiseStack( StackType_t * pxTopOfStack,
|
|
|
|
pxTopOfStack--;
|
|
|
|
pxTopOfStack--;
|
|
|
|
|
|
|
|
|
|
|
|
/* The remaining registers would be pushed on the stack by our context
|
|
|
|
/* The remaining registers would be pushed on the stack by our context
|
|
|
|
* switch function. These are loaded with values simply to make debugging
|
|
|
|
switch function. These are loaded with values simply to make debugging
|
|
|
|
* easier. */
|
|
|
|
easier. */
|
|
|
|
*pxTopOfStack = ( StackType_t ) 0xAAAA; /* AX */
|
|
|
|
*pxTopOfStack = ( StackType_t ) 0xAAAA; /* AX */
|
|
|
|
pxTopOfStack--;
|
|
|
|
pxTopOfStack--;
|
|
|
|
*pxTopOfStack = ( StackType_t ) 0xBBBB; /* BX */
|
|
|
|
*pxTopOfStack = ( StackType_t ) 0xBBBB; /* BX */
|
|
|
@ -130,11 +126,9 @@ StackType_t * pxPortInitialiseStack( StackType_t * pxTopOfStack,
|
|
|
|
pxTopOfStack--;
|
|
|
|
pxTopOfStack--;
|
|
|
|
|
|
|
|
|
|
|
|
/* We need the true data segment. */
|
|
|
|
/* We need the true data segment. */
|
|
|
|
__asm {
|
|
|
|
__asm{ MOV DS_Reg, DS };
|
|
|
|
MOV DS_Reg, DS
|
|
|
|
|
|
|
|
};
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
*pxTopOfStack = DS_Reg; /* DS */
|
|
|
|
*pxTopOfStack = DS_Reg; /* DS */
|
|
|
|
pxTopOfStack--;
|
|
|
|
pxTopOfStack--;
|
|
|
|
*pxTopOfStack = ( StackType_t ) 0x0123; /* SI */
|
|
|
|
*pxTopOfStack = ( StackType_t ) 0x0123; /* SI */
|
|
|
|
pxTopOfStack--;
|
|
|
|
pxTopOfStack--;
|
|
|
@ -151,7 +145,7 @@ BaseType_t xPortStartScheduler( void )
|
|
|
|
/* This is called with interrupts already disabled. */
|
|
|
|
/* This is called with interrupts already disabled. */
|
|
|
|
|
|
|
|
|
|
|
|
/* Put our manual switch (yield) function on a known
|
|
|
|
/* Put our manual switch (yield) function on a known
|
|
|
|
* vector. */
|
|
|
|
vector. */
|
|
|
|
setvect( portSWITCH_INT_NUMBER, prvYieldProcessor );
|
|
|
|
setvect( portSWITCH_INT_NUMBER, prvYieldProcessor );
|
|
|
|
|
|
|
|
|
|
|
|
/* Setup the tick interrupt. */
|
|
|
|
/* Setup the tick interrupt. */
|
|
|
@ -168,15 +162,15 @@ BaseType_t xPortStartScheduler( void )
|
|
|
|
static void __interrupt __far prvDummyISR( void )
|
|
|
|
static void __interrupt __far prvDummyISR( void )
|
|
|
|
{
|
|
|
|
{
|
|
|
|
/* The timer initialisation functions leave interrupts enabled,
|
|
|
|
/* The timer initialisation functions leave interrupts enabled,
|
|
|
|
* which is not what we want. This ISR is installed temporarily in case
|
|
|
|
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. */
|
|
|
|
the timer fires before we get a change to disable interrupts again. */
|
|
|
|
outport( portEIO_REGISTER, portCLEAR_INTERRUPT );
|
|
|
|
outport( portEIO_REGISTER, portCLEAR_INTERRUPT );
|
|
|
|
}
|
|
|
|
}
|
|
|
|
/*-----------------------------------------------------------*/
|
|
|
|
/*-----------------------------------------------------------*/
|
|
|
|
|
|
|
|
|
|
|
|
/* The ISR used depends on whether the preemptive or cooperative scheduler
|
|
|
|
/* The ISR used depends on whether the preemptive or cooperative scheduler
|
|
|
|
* is being used. */
|
|
|
|
is being used. */
|
|
|
|
#if ( configUSE_PREEMPTION == 1 )
|
|
|
|
#if( configUSE_PREEMPTION == 1 )
|
|
|
|
static void __interrupt __far prvPreemptiveTick( void )
|
|
|
|
static void __interrupt __far prvPreemptiveTick( void )
|
|
|
|
{
|
|
|
|
{
|
|
|
|
/* Get the scheduler to update the task states following the tick. */
|
|
|
|
/* Get the scheduler to update the task states following the tick. */
|
|
|
@ -189,17 +183,17 @@ static void __interrupt __far prvDummyISR( void )
|
|
|
|
/* Reset interrupt. */
|
|
|
|
/* Reset interrupt. */
|
|
|
|
outport( portEIO_REGISTER, portCLEAR_INTERRUPT );
|
|
|
|
outport( portEIO_REGISTER, portCLEAR_INTERRUPT );
|
|
|
|
}
|
|
|
|
}
|
|
|
|
#else /* if ( configUSE_PREEMPTION == 1 ) */
|
|
|
|
#else
|
|
|
|
static void __interrupt __far prvNonPreemptiveTick( void )
|
|
|
|
static void __interrupt __far prvNonPreemptiveTick( void )
|
|
|
|
{
|
|
|
|
{
|
|
|
|
/* Same as preemptive tick, but the cooperative scheduler is being used
|
|
|
|
/* 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();
|
|
|
|
xTaskIncrementTick();
|
|
|
|
|
|
|
|
|
|
|
|
/* Reset interrupt. */
|
|
|
|
/* Reset interrupt. */
|
|
|
|
outport( portEIO_REGISTER, portCLEAR_INTERRUPT );
|
|
|
|
outport( portEIO_REGISTER, portCLEAR_INTERRUPT );
|
|
|
|
}
|
|
|
|
}
|
|
|
|
#endif /* if ( configUSE_PREEMPTION == 1 ) */
|
|
|
|
#endif
|
|
|
|
/*-----------------------------------------------------------*/
|
|
|
|
/*-----------------------------------------------------------*/
|
|
|
|
|
|
|
|
|
|
|
|
static void __interrupt __far prvYieldProcessor( void )
|
|
|
|
static void __interrupt __far prvYieldProcessor( void )
|
|
|
@ -217,25 +211,23 @@ void vPortEndScheduler( void )
|
|
|
|
|
|
|
|
|
|
|
|
static void prvSetupTimerInterrupt( void )
|
|
|
|
static void prvSetupTimerInterrupt( void )
|
|
|
|
{
|
|
|
|
{
|
|
|
|
const uint16_t usTimerACompare = portTIMER_COMPARE, usTimerAMode = portENABLE_TIMER_AND_INTERRUPT;
|
|
|
|
const uint16_t usTimerACompare = portTIMER_COMPARE, usTimerAMode = portENABLE_TIMER_AND_INTERRUPT;
|
|
|
|
const uint16_t usT2_IRQ = 0x13;
|
|
|
|
const uint16_t usT2_IRQ = 0x13;
|
|
|
|
|
|
|
|
|
|
|
|
/* Configure the timer, the dummy handler is used here as the init
|
|
|
|
/* 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 );
|
|
|
|
t2_init( usTimerAMode, usTimerACompare, prvDummyISR );
|
|
|
|
|
|
|
|
|
|
|
|
/* Disable interrupts again before installing the real handlers. */
|
|
|
|
/* Disable interrupts again before installing the real handlers. */
|
|
|
|
portDISABLE_INTERRUPTS();
|
|
|
|
portDISABLE_INTERRUPTS();
|
|
|
|
|
|
|
|
|
|
|
|
#if ( configUSE_PREEMPTION == 1 )
|
|
|
|
#if( configUSE_PREEMPTION == 1 )
|
|
|
|
|
|
|
|
|
|
|
|
/* Tick service routine used by the scheduler when preemptive scheduling is
|
|
|
|
/* Tick service routine used by the scheduler when preemptive scheduling is
|
|
|
|
* being used. */
|
|
|
|
being used. */
|
|
|
|
setvect( usT2_IRQ, prvPreemptiveTick );
|
|
|
|
setvect( usT2_IRQ, prvPreemptiveTick );
|
|
|
|
#else
|
|
|
|
#else
|
|
|
|
|
|
|
|
|
|
|
|
/* Tick service routine used by the scheduler when cooperative scheduling is
|
|
|
|
/* Tick service routine used by the scheduler when cooperative scheduling is
|
|
|
|
* being used. */
|
|
|
|
being used. */
|
|
|
|
setvect( usT2_IRQ, prvNonPreemptiveTick );
|
|
|
|
setvect( usT2_IRQ, prvNonPreemptiveTick );
|
|
|
|
#endif
|
|
|
|
#endif
|
|
|
|
}
|
|
|
|
}
|
|
|
|