|
|
@ -58,8 +58,14 @@
|
|
|
|
* to ensure it gets processor time. Its main function is to check that all the
|
|
|
|
* to ensure it gets processor time. Its main function is to check that all the
|
|
|
|
* standard demo tasks are still operational. While no errors have been
|
|
|
|
* standard demo tasks are still operational. While no errors have been
|
|
|
|
* discovered the check task will toggle an LED every 5 seconds - the toggle
|
|
|
|
* discovered the check task will toggle an LED every 5 seconds - the toggle
|
|
|
|
* rate increasing to 500ms then being a visual indication that at least one
|
|
|
|
* rate increasing to 500ms being a visual indication that at least one task has
|
|
|
|
* task has reported unexpected behaviour.
|
|
|
|
* reported unexpected behaviour.
|
|
|
|
|
|
|
|
*
|
|
|
|
|
|
|
|
* "Reg test" tasks - These fill the registers with known values, then check
|
|
|
|
|
|
|
|
* that each register still contains its expected value. Each task uses
|
|
|
|
|
|
|
|
* different values. The tasks run with very low priority so get preempted very
|
|
|
|
|
|
|
|
* frequently. A register containing an unexpected value is indicative of an
|
|
|
|
|
|
|
|
* error in the context switching mechanism.
|
|
|
|
*
|
|
|
|
*
|
|
|
|
*/
|
|
|
|
*/
|
|
|
|
|
|
|
|
|
|
|
@ -88,18 +94,18 @@
|
|
|
|
|
|
|
|
|
|
|
|
/*-----------------------------------------------------------*/
|
|
|
|
/*-----------------------------------------------------------*/
|
|
|
|
|
|
|
|
|
|
|
|
/* The time between cycles of the 'check' functionality (defined within the
|
|
|
|
/* The time between cycles of the 'check' functionality - as described at the
|
|
|
|
tick hook. */
|
|
|
|
top of this file. */
|
|
|
|
#define mainNO_ERROR_PERIOD ( ( portTickType ) 5000 / portTICK_RATE_MS )
|
|
|
|
#define mainNO_ERROR_PERIOD ( ( portTickType ) 5000 / portTICK_RATE_MS )
|
|
|
|
|
|
|
|
|
|
|
|
/* The rate at which the LED controlled by the 'check' task will flash when an
|
|
|
|
/* The rate at which the LED controlled by the 'check' task will flash should an
|
|
|
|
error has been detected. */
|
|
|
|
error have been detected. */
|
|
|
|
#define mainERROR_PERIOD ( ( portTickType ) 500 / portTICK_RATE_MS )
|
|
|
|
#define mainERROR_PERIOD ( ( portTickType ) 500 / portTICK_RATE_MS )
|
|
|
|
|
|
|
|
|
|
|
|
/* The LED controlled by the 'check' task. */
|
|
|
|
/* The LED controlled by the 'check' task. */
|
|
|
|
#define mainCHECK_LED ( 3 )
|
|
|
|
#define mainCHECK_LED ( 3 )
|
|
|
|
|
|
|
|
|
|
|
|
/* Contest constants - there is no free LED for the comtest. */
|
|
|
|
/* ComTest constants - there is no free LED for the comtest tasks. */
|
|
|
|
#define mainCOM_TEST_BAUD_RATE ( ( unsigned portLONG ) 19200 )
|
|
|
|
#define mainCOM_TEST_BAUD_RATE ( ( unsigned portLONG ) 19200 )
|
|
|
|
#define mainCOM_TEST_LED ( 5 )
|
|
|
|
#define mainCOM_TEST_LED ( 5 )
|
|
|
|
|
|
|
|
|
|
|
@ -123,14 +129,23 @@ static void prvSetupHardware( void );
|
|
|
|
* file.
|
|
|
|
* file.
|
|
|
|
*/
|
|
|
|
*/
|
|
|
|
static void prvCheckTask( void *pvParameters );
|
|
|
|
static void prvCheckTask( void *pvParameters );
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
/*
|
|
|
|
|
|
|
|
* Implement the 'Reg test' functionality as described at the top of this file.
|
|
|
|
|
|
|
|
*/
|
|
|
|
static void vRegTest1Task( void *pvParameters );
|
|
|
|
static void vRegTest1Task( void *pvParameters );
|
|
|
|
static void vRegTest2Task( void *pvParameters );
|
|
|
|
static void vRegTest2Task( void *pvParameters );
|
|
|
|
|
|
|
|
|
|
|
|
/*-----------------------------------------------------------*/
|
|
|
|
/*-----------------------------------------------------------*/
|
|
|
|
static volatile unsigned portLONG ulRegTest1Counter = 0, ulRegTest2Counter = 0;
|
|
|
|
|
|
|
|
|
|
|
|
/* Counters used to detect errors within the reg test tasks. */
|
|
|
|
|
|
|
|
static volatile unsigned portLONG ulRegTest1Counter = 0x11111111, ulRegTest2Counter = 0x22222222;
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
/*-----------------------------------------------------------*/
|
|
|
|
|
|
|
|
|
|
|
|
int main( void )
|
|
|
|
int main( void )
|
|
|
|
{
|
|
|
|
{
|
|
|
|
|
|
|
|
/* Setup the hardware ready for this demo. */
|
|
|
|
prvSetupHardware();
|
|
|
|
prvSetupHardware();
|
|
|
|
|
|
|
|
|
|
|
|
/* Start the standard demo tasks. */
|
|
|
|
/* Start the standard demo tasks. */
|
|
|
@ -145,8 +160,9 @@ int main( void )
|
|
|
|
vAltStartComTestTasks( mainCOM_TEST_PRIORITY, mainCOM_TEST_BAUD_RATE, mainCOM_TEST_LED );
|
|
|
|
vAltStartComTestTasks( mainCOM_TEST_PRIORITY, mainCOM_TEST_BAUD_RATE, mainCOM_TEST_LED );
|
|
|
|
vStartInterruptQueueTasks();
|
|
|
|
vStartInterruptQueueTasks();
|
|
|
|
|
|
|
|
|
|
|
|
xTaskCreate( vRegTest1Task, ( signed portCHAR * ) "Reg1", configMINIMAL_STACK_SIZE, NULL, tskIDLE_PRIORITY, NULL );
|
|
|
|
/* Start the reg test tasks - defined in this file. */
|
|
|
|
xTaskCreate( vRegTest2Task, ( signed portCHAR * ) "Reg2", configMINIMAL_STACK_SIZE, NULL, tskIDLE_PRIORITY, NULL );
|
|
|
|
xTaskCreate( vRegTest1Task, ( signed portCHAR * ) "Reg1", configMINIMAL_STACK_SIZE, ( void * ) &ulRegTest1Counter, tskIDLE_PRIORITY, NULL );
|
|
|
|
|
|
|
|
xTaskCreate( vRegTest2Task, ( signed portCHAR * ) "Reg2", configMINIMAL_STACK_SIZE, ( void * ) &ulRegTest2Counter, tskIDLE_PRIORITY, NULL );
|
|
|
|
|
|
|
|
|
|
|
|
/* Create the check task. */
|
|
|
|
/* Create the check task. */
|
|
|
|
xTaskCreate( prvCheckTask, ( signed portCHAR * ) "Check", configMINIMAL_STACK_SIZE, NULL, mainCHECK_TASK_PRIORITY, NULL );
|
|
|
|
xTaskCreate( prvCheckTask, ( signed portCHAR * ) "Check", configMINIMAL_STACK_SIZE, NULL, mainCHECK_TASK_PRIORITY, NULL );
|
|
|
@ -245,11 +261,14 @@ portTickType xLastExecutionTime;
|
|
|
|
ulLastRegTest1Count = ulRegTest1Counter;
|
|
|
|
ulLastRegTest1Count = ulRegTest1Counter;
|
|
|
|
ulLastRegTest2Count = ulRegTest2Counter;
|
|
|
|
ulLastRegTest2Count = ulRegTest2Counter;
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
/* If an error has been found then increase our cycle rate, and in so
|
|
|
|
|
|
|
|
going increase the rate at which the check task LED toggles. */
|
|
|
|
if( ulError != 0 )
|
|
|
|
if( ulError != 0 )
|
|
|
|
{
|
|
|
|
{
|
|
|
|
ulTicksToWait = mainERROR_PERIOD;
|
|
|
|
ulTicksToWait = mainERROR_PERIOD;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
/* Toggle the LED each itteration. */
|
|
|
|
vParTestToggleLED( mainCHECK_LED );
|
|
|
|
vParTestToggleLED( mainCHECK_LED );
|
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
@ -259,6 +278,8 @@ void prvSetupHardware( void )
|
|
|
|
{
|
|
|
|
{
|
|
|
|
extern void mcf5xxx_wr_cacr( unsigned portLONG );
|
|
|
|
extern void mcf5xxx_wr_cacr( unsigned portLONG );
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
portDISABLE_INTERRUPTS();
|
|
|
|
|
|
|
|
|
|
|
|
/* Enable the cache. */
|
|
|
|
/* Enable the cache. */
|
|
|
|
mcf5xxx_wr_cacr( MCF5XXX_CACR_CENB | MCF5XXX_CACR_CINV | MCF5XXX_CACR_DISD | MCF5XXX_CACR_CEIB | MCF5XXX_CACR_CLNF_00 );
|
|
|
|
mcf5xxx_wr_cacr( MCF5XXX_CACR_CENB | MCF5XXX_CACR_CINV | MCF5XXX_CACR_DISD | MCF5XXX_CACR_CEIB | MCF5XXX_CACR_CLNF_00 );
|
|
|
|
asm volatile( "NOP" ); /* As per errata. */
|
|
|
|
asm volatile( "NOP" ); /* As per errata. */
|
|
|
@ -272,12 +293,18 @@ extern void mcf5xxx_wr_cacr( unsigned portLONG );
|
|
|
|
__asm__ volatile ( "NOP" );
|
|
|
|
__asm__ volatile ( "NOP" );
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
/* Setup the port used to toggle LEDs. */
|
|
|
|
vParTestInitialise();
|
|
|
|
vParTestInitialise();
|
|
|
|
}
|
|
|
|
}
|
|
|
|
/*-----------------------------------------------------------*/
|
|
|
|
/*-----------------------------------------------------------*/
|
|
|
|
|
|
|
|
|
|
|
|
void vApplicationStackOverflowHook( xTaskHandle *pxTask, signed portCHAR *pcTaskName )
|
|
|
|
void vApplicationStackOverflowHook( xTaskHandle *pxTask, signed portCHAR *pcTaskName )
|
|
|
|
{
|
|
|
|
{
|
|
|
|
|
|
|
|
/* This will get called if a stack overflow is detected during the context
|
|
|
|
|
|
|
|
switch. Set configCHECK_FOR_STACK_OVERFLOWS to 2 to also check for stack
|
|
|
|
|
|
|
|
problems within nested interrupts, but only do this for debug purposes as
|
|
|
|
|
|
|
|
it will increase the context switch time. */
|
|
|
|
|
|
|
|
|
|
|
|
( void ) pxTask;
|
|
|
|
( void ) pxTask;
|
|
|
|
( void ) pcTaskName;
|
|
|
|
( void ) pcTaskName;
|
|
|
|
|
|
|
|
|
|
|
@ -287,8 +314,17 @@ void vApplicationStackOverflowHook( xTaskHandle *pxTask, signed portCHAR *pcTask
|
|
|
|
|
|
|
|
|
|
|
|
static void vRegTest1Task( void *pvParameters )
|
|
|
|
static void vRegTest1Task( void *pvParameters )
|
|
|
|
{
|
|
|
|
{
|
|
|
|
( void ) pvParameters;
|
|
|
|
/* Sanity check - did we receive the parameter expected? */
|
|
|
|
|
|
|
|
if( pvParameters != &ulRegTest1Counter )
|
|
|
|
|
|
|
|
{
|
|
|
|
|
|
|
|
/* Change here so the check task can detect that an error occurred. */
|
|
|
|
|
|
|
|
for( ;; );
|
|
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
/* Set all the registers to known values, then check that each retains its
|
|
|
|
|
|
|
|
expected value - as described at the top of this file. If an error is
|
|
|
|
|
|
|
|
found then the loop counter will no longer be incremented allowing the check
|
|
|
|
|
|
|
|
task to recognise the error. */
|
|
|
|
asm volatile ( "reg_test_1_start: \n\t"
|
|
|
|
asm volatile ( "reg_test_1_start: \n\t"
|
|
|
|
" moveq #1, %d0 \n\t"
|
|
|
|
" moveq #1, %d0 \n\t"
|
|
|
|
" moveq #2, %d1 \n\t"
|
|
|
|
" moveq #2, %d1 \n\t"
|
|
|
@ -355,8 +391,17 @@ static void vRegTest1Task( void *pvParameters )
|
|
|
|
|
|
|
|
|
|
|
|
static void vRegTest2Task( void *pvParameters )
|
|
|
|
static void vRegTest2Task( void *pvParameters )
|
|
|
|
{
|
|
|
|
{
|
|
|
|
( void ) pvParameters;
|
|
|
|
/* Sanity check - did we receive the parameter expected? */
|
|
|
|
|
|
|
|
if( pvParameters != &ulRegTest1Counter )
|
|
|
|
|
|
|
|
{
|
|
|
|
|
|
|
|
/* Change here so the check task can detect that an error occurred. */
|
|
|
|
|
|
|
|
for( ;; );
|
|
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
/* Set all the registers to known values, then check that each retains its
|
|
|
|
|
|
|
|
expected value - as described at the top of this file. If an error is
|
|
|
|
|
|
|
|
found then the loop counter will no longer be incremented allowing the check
|
|
|
|
|
|
|
|
task to recognise the error. */
|
|
|
|
asm volatile ( "reg_test_2_start: \n\t"
|
|
|
|
asm volatile ( "reg_test_2_start: \n\t"
|
|
|
|
" moveq #10, %d0 \n\t"
|
|
|
|
" moveq #10, %d0 \n\t"
|
|
|
|
" moveq #20, %d1 \n\t"
|
|
|
|
" moveq #20, %d1 \n\t"
|
|
|
|