Add 'full' demo to the SAMA5 Xplained demo - but so far without interrupt nesting tests or CLI.
Richard Barry
11 years ago
parent
8ad9b75810
commit
5b96cf6eea
@ -0,0 +1,130 @@
|
|||||||
|
/*
|
||||||
|
FreeRTOS V8.0.1 - Copyright (C) 2014 Real Time Engineers Ltd.
|
||||||
|
All rights reserved
|
||||||
|
|
||||||
|
VISIT http://www.FreeRTOS.org TO ENSURE YOU ARE USING THE LATEST VERSION.
|
||||||
|
|
||||||
|
***************************************************************************
|
||||||
|
* *
|
||||||
|
* FreeRTOS provides completely free yet professionally developed, *
|
||||||
|
* robust, strictly quality controlled, supported, and cross *
|
||||||
|
* platform software that has become a de facto standard. *
|
||||||
|
* *
|
||||||
|
* Help yourself get started quickly and support the FreeRTOS *
|
||||||
|
* project by purchasing a FreeRTOS tutorial book, reference *
|
||||||
|
* manual, or both from: http://www.FreeRTOS.org/Documentation *
|
||||||
|
* *
|
||||||
|
* Thank you! *
|
||||||
|
* *
|
||||||
|
***************************************************************************
|
||||||
|
|
||||||
|
This file is part of the FreeRTOS distribution.
|
||||||
|
|
||||||
|
FreeRTOS is free software; you can redistribute it and/or modify it under
|
||||||
|
the terms of the GNU General Public License (version 2) as published by the
|
||||||
|
Free Software Foundation >>!AND MODIFIED BY!<< the FreeRTOS exception.
|
||||||
|
|
||||||
|
>>! NOTE: The modification to the GPL is included to allow you to !<<
|
||||||
|
>>! distribute a combined work that includes FreeRTOS without being !<<
|
||||||
|
>>! obliged to provide the source code for proprietary components !<<
|
||||||
|
>>! outside of the FreeRTOS kernel. !<<
|
||||||
|
|
||||||
|
FreeRTOS is distributed in the hope that it will be useful, but WITHOUT ANY
|
||||||
|
WARRANTY; without even the implied warranty of MERCHANTABILITY or FITNESS
|
||||||
|
FOR A PARTICULAR PURPOSE. Full license text is available from the following
|
||||||
|
link: http://www.freertos.org/a00114.html
|
||||||
|
|
||||||
|
1 tab == 4 spaces!
|
||||||
|
|
||||||
|
***************************************************************************
|
||||||
|
* *
|
||||||
|
* Having a problem? Start by reading the FAQ "My application does *
|
||||||
|
* not run, what could be wrong?" *
|
||||||
|
* *
|
||||||
|
* http://www.FreeRTOS.org/FAQHelp.html *
|
||||||
|
* *
|
||||||
|
***************************************************************************
|
||||||
|
|
||||||
|
http://www.FreeRTOS.org - Documentation, books, training, latest versions,
|
||||||
|
license and Real Time Engineers Ltd. contact details.
|
||||||
|
|
||||||
|
http://www.FreeRTOS.org/plus - A selection of FreeRTOS ecosystem products,
|
||||||
|
including FreeRTOS+Trace - an indispensable productivity tool, a DOS
|
||||||
|
compatible FAT file system, and our tiny thread aware UDP/IP stack.
|
||||||
|
|
||||||
|
http://www.OpenRTOS.com - Real Time Engineers ltd license FreeRTOS to High
|
||||||
|
Integrity Systems to sell under the OpenRTOS brand. Low cost OpenRTOS
|
||||||
|
licenses offer ticketed support, indemnification and middleware.
|
||||||
|
|
||||||
|
http://www.SafeRTOS.com - High Integrity Systems also provide a safety
|
||||||
|
engineered and independently SIL3 certified version for use in safety and
|
||||||
|
mission critical applications that require provable dependability.
|
||||||
|
|
||||||
|
1 tab == 4 spaces!
|
||||||
|
*/
|
||||||
|
|
||||||
|
/*
|
||||||
|
* This file initialises three timers as follows:
|
||||||
|
*
|
||||||
|
* Timer 0 and Timer 1 provide the interrupts that are used with the IntQ
|
||||||
|
* standard demo tasks, which test interrupt nesting and using queues from
|
||||||
|
* interrupts. Both these interrupts operate below the maximum syscall
|
||||||
|
* interrupt priority.
|
||||||
|
*
|
||||||
|
* Timer 2 is a much higher frequency timer that tests the nesting of interrupts
|
||||||
|
* that execute above the maximum syscall interrupt priority.
|
||||||
|
*
|
||||||
|
* All the timers can nest with the tick interrupt - creating a maximum
|
||||||
|
* interrupt nesting depth of 4.
|
||||||
|
*
|
||||||
|
* For convenience, the high frequency timer is also used to provide the time
|
||||||
|
* base for the run time stats.
|
||||||
|
*/
|
||||||
|
|
||||||
|
/* Scheduler includes. */
|
||||||
|
#include "FreeRTOS.h"
|
||||||
|
|
||||||
|
/* Demo includes. */
|
||||||
|
#include "IntQueueTimer.h"
|
||||||
|
#include "IntQueue.h"
|
||||||
|
|
||||||
|
/* The frequencies at which the first two timers expire are slightly offset to
|
||||||
|
ensure they don't remain synchronised. The frequency of the interrupt that
|
||||||
|
operates above the max syscall interrupt priority is 10 times faster so really
|
||||||
|
hammers the interrupt entry and exit code. */
|
||||||
|
#define tmrTIMERS_USED 3
|
||||||
|
#define tmrTIMER_0_FREQUENCY ( 2000UL )
|
||||||
|
#define tmrTIMER_1_FREQUENCY ( 2001UL )
|
||||||
|
#define tmrTIMER_2_FREQUENCY ( 20000UL )
|
||||||
|
|
||||||
|
/*-----------------------------------------------------------*/
|
||||||
|
|
||||||
|
/*
|
||||||
|
* The single interrupt service routines that is used to service all three
|
||||||
|
* timers.
|
||||||
|
*/
|
||||||
|
static void prvTimerHandler( void *CallBackRef );
|
||||||
|
|
||||||
|
/*-----------------------------------------------------------*/
|
||||||
|
|
||||||
|
/* Used to provide a means of ensuring the intended interrupt nesting depth is
|
||||||
|
actually being reached. */
|
||||||
|
extern uint32_t ulPortInterruptNesting;
|
||||||
|
static uint32_t ulMaxRecordedNesting = 0;
|
||||||
|
|
||||||
|
/* For convenience the high frequency timer increments a variable that is then
|
||||||
|
used as the time base for the run time stats. */
|
||||||
|
volatile uint32_t ulHighFrequencyTimerCounts = 0;
|
||||||
|
|
||||||
|
/*-----------------------------------------------------------*/
|
||||||
|
|
||||||
|
void vInitialiseTimerForIntQueueTest( void )
|
||||||
|
{
|
||||||
|
}
|
||||||
|
/*-----------------------------------------------------------*/
|
||||||
|
|
||||||
|
static void prvTimerHandler( void *pvCallBackRef )
|
||||||
|
{
|
||||||
|
( void ) pvCallBackRef;
|
||||||
|
}
|
||||||
|
|
||||||
@ -0,0 +1,74 @@
|
|||||||
|
/*
|
||||||
|
FreeRTOS V8.0.1 - Copyright (C) 2014 Real Time Engineers Ltd.
|
||||||
|
All rights reserved
|
||||||
|
|
||||||
|
VISIT http://www.FreeRTOS.org TO ENSURE YOU ARE USING THE LATEST VERSION.
|
||||||
|
|
||||||
|
***************************************************************************
|
||||||
|
* *
|
||||||
|
* FreeRTOS provides completely free yet professionally developed, *
|
||||||
|
* robust, strictly quality controlled, supported, and cross *
|
||||||
|
* platform software that has become a de facto standard. *
|
||||||
|
* *
|
||||||
|
* Help yourself get started quickly and support the FreeRTOS *
|
||||||
|
* project by purchasing a FreeRTOS tutorial book, reference *
|
||||||
|
* manual, or both from: http://www.FreeRTOS.org/Documentation *
|
||||||
|
* *
|
||||||
|
* Thank you! *
|
||||||
|
* *
|
||||||
|
***************************************************************************
|
||||||
|
|
||||||
|
This file is part of the FreeRTOS distribution.
|
||||||
|
|
||||||
|
FreeRTOS is free software; you can redistribute it and/or modify it under
|
||||||
|
the terms of the GNU General Public License (version 2) as published by the
|
||||||
|
Free Software Foundation >>!AND MODIFIED BY!<< the FreeRTOS exception.
|
||||||
|
|
||||||
|
>>! NOTE: The modification to the GPL is included to allow you to !<<
|
||||||
|
>>! distribute a combined work that includes FreeRTOS without being !<<
|
||||||
|
>>! obliged to provide the source code for proprietary components !<<
|
||||||
|
>>! outside of the FreeRTOS kernel. !<<
|
||||||
|
|
||||||
|
FreeRTOS is distributed in the hope that it will be useful, but WITHOUT ANY
|
||||||
|
WARRANTY; without even the implied warranty of MERCHANTABILITY or FITNESS
|
||||||
|
FOR A PARTICULAR PURPOSE. Full license text is available from the following
|
||||||
|
link: http://www.freertos.org/a00114.html
|
||||||
|
|
||||||
|
1 tab == 4 spaces!
|
||||||
|
|
||||||
|
***************************************************************************
|
||||||
|
* *
|
||||||
|
* Having a problem? Start by reading the FAQ "My application does *
|
||||||
|
* not run, what could be wrong?" *
|
||||||
|
* *
|
||||||
|
* http://www.FreeRTOS.org/FAQHelp.html *
|
||||||
|
* *
|
||||||
|
***************************************************************************
|
||||||
|
|
||||||
|
http://www.FreeRTOS.org - Documentation, books, training, latest versions,
|
||||||
|
license and Real Time Engineers Ltd. contact details.
|
||||||
|
|
||||||
|
http://www.FreeRTOS.org/plus - A selection of FreeRTOS ecosystem products,
|
||||||
|
including FreeRTOS+Trace - an indispensable productivity tool, a DOS
|
||||||
|
compatible FAT file system, and our tiny thread aware UDP/IP stack.
|
||||||
|
|
||||||
|
http://www.OpenRTOS.com - Real Time Engineers ltd license FreeRTOS to High
|
||||||
|
Integrity Systems to sell under the OpenRTOS brand. Low cost OpenRTOS
|
||||||
|
licenses offer ticketed support, indemnification and middleware.
|
||||||
|
|
||||||
|
http://www.SafeRTOS.com - High Integrity Systems also provide a safety
|
||||||
|
engineered and independently SIL3 certified version for use in safety and
|
||||||
|
mission critical applications that require provable dependability.
|
||||||
|
|
||||||
|
1 tab == 4 spaces!
|
||||||
|
*/
|
||||||
|
|
||||||
|
#ifndef INT_QUEUE_TIMER_H
|
||||||
|
#define INT_QUEUE_TIMER_H
|
||||||
|
|
||||||
|
void vInitialiseTimerForIntQueueTest( void );
|
||||||
|
BaseType_t xTimer0Handler( void );
|
||||||
|
BaseType_t xTimer1Handler( void );
|
||||||
|
|
||||||
|
#endif
|
||||||
|
|
||||||
@ -0,0 +1,492 @@
|
|||||||
|
/*
|
||||||
|
FreeRTOS V8.0.1 - Copyright (C) 2014 Real Time Engineers Ltd.
|
||||||
|
All rights reserved
|
||||||
|
|
||||||
|
VISIT http://www.FreeRTOS.org TO ENSURE YOU ARE USING THE LATEST VERSION.
|
||||||
|
|
||||||
|
***************************************************************************
|
||||||
|
* *
|
||||||
|
* FreeRTOS provides completely free yet professionally developed, *
|
||||||
|
* robust, strictly quality controlled, supported, and cross *
|
||||||
|
* platform software that has become a de facto standard. *
|
||||||
|
* *
|
||||||
|
* Help yourself get started quickly and support the FreeRTOS *
|
||||||
|
* project by purchasing a FreeRTOS tutorial book, reference *
|
||||||
|
* manual, or both from: http://www.FreeRTOS.org/Documentation *
|
||||||
|
* *
|
||||||
|
* Thank you! *
|
||||||
|
* *
|
||||||
|
***************************************************************************
|
||||||
|
|
||||||
|
This file is part of the FreeRTOS distribution.
|
||||||
|
|
||||||
|
FreeRTOS is free software; you can redistribute it and/or modify it under
|
||||||
|
the terms of the GNU General Public License (version 2) as published by the
|
||||||
|
Free Software Foundation >>!AND MODIFIED BY!<< the FreeRTOS exception.
|
||||||
|
|
||||||
|
>>! NOTE: The modification to the GPL is included to allow you to !<<
|
||||||
|
>>! distribute a combined work that includes FreeRTOS without being !<<
|
||||||
|
>>! obliged to provide the source code for proprietary components !<<
|
||||||
|
>>! outside of the FreeRTOS kernel. !<<
|
||||||
|
|
||||||
|
FreeRTOS is distributed in the hope that it will be useful, but WITHOUT ANY
|
||||||
|
WARRANTY; without even the implied warranty of MERCHANTABILITY or FITNESS
|
||||||
|
FOR A PARTICULAR PURPOSE. Full license text is available from the following
|
||||||
|
link: http://www.freertos.org/a00114.html
|
||||||
|
|
||||||
|
1 tab == 4 spaces!
|
||||||
|
|
||||||
|
***************************************************************************
|
||||||
|
* *
|
||||||
|
* Having a problem? Start by reading the FAQ "My application does *
|
||||||
|
* not run, what could be wrong?" *
|
||||||
|
* *
|
||||||
|
* http://www.FreeRTOS.org/FAQHelp.html *
|
||||||
|
* *
|
||||||
|
***************************************************************************
|
||||||
|
|
||||||
|
http://www.FreeRTOS.org - Documentation, books, training, latest versions,
|
||||||
|
license and Real Time Engineers Ltd. contact details.
|
||||||
|
|
||||||
|
http://www.FreeRTOS.org/plus - A selection of FreeRTOS ecosystem products,
|
||||||
|
including FreeRTOS+Trace - an indispensable productivity tool, a DOS
|
||||||
|
compatible FAT file system, and our tiny thread aware UDP/IP stack.
|
||||||
|
|
||||||
|
http://www.OpenRTOS.com - Real Time Engineers ltd license FreeRTOS to High
|
||||||
|
Integrity Systems to sell under the OpenRTOS brand. Low cost OpenRTOS
|
||||||
|
licenses offer ticketed support, indemnification and middleware.
|
||||||
|
|
||||||
|
http://www.SafeRTOS.com - High Integrity Systems also provide a safety
|
||||||
|
engineered and independently SIL3 certified version for use in safety and
|
||||||
|
mission critical applications that require provable dependability.
|
||||||
|
|
||||||
|
1 tab == 4 spaces!
|
||||||
|
*/
|
||||||
|
|
||||||
|
/******************************************************************************
|
||||||
|
* NOTE 1: This project provides two demo applications. A simple blinky style
|
||||||
|
* project, and a more comprehensive test and demo application. The
|
||||||
|
* mainCREATE_SIMPLE_BLINKY_DEMO_ONLY setting in main.c is used to select
|
||||||
|
* between the two. See the notes on using mainCREATE_SIMPLE_BLINKY_DEMO_ONLY
|
||||||
|
* in main.c. This file implements the comprehensive test and demo version.
|
||||||
|
*
|
||||||
|
* NOTE 2: This file only contains the source code that is specific to the
|
||||||
|
* full demo. Generic functions, such FreeRTOS hook functions, and functions
|
||||||
|
* required to configure the hardware, are defined in main.c.
|
||||||
|
*
|
||||||
|
******************************************************************************
|
||||||
|
*
|
||||||
|
* main_full() creates all the demo application tasks and software timers, then
|
||||||
|
* starts the scheduler. The web documentation provides more details of the
|
||||||
|
* standard demo application tasks, which provide no particular functionality,
|
||||||
|
* but do provide a good example of how to use the FreeRTOS API.
|
||||||
|
*
|
||||||
|
* In addition to the standard demo tasks, the following tasks and tests are
|
||||||
|
* defined and/or created within this file:
|
||||||
|
*
|
||||||
|
* FreeRTOS+CLI command console. The command console is access through the
|
||||||
|
* UART to USB connector on the _RB_. For
|
||||||
|
* reasons of robustness testing the UART driver is deliberately written to be
|
||||||
|
* inefficient and should not be used as a template for a production driver.
|
||||||
|
* Type "help" to see a list of registered commands. The FreeRTOS+CLI license
|
||||||
|
* is different to the FreeRTOS license, see http://www.FreeRTOS.org/cli for
|
||||||
|
* license and usage details. The default baud rate is 115200.
|
||||||
|
*
|
||||||
|
* "Reg test" tasks - These fill both the core and floating point registers with
|
||||||
|
* known values, then check that each register maintains its expected value for
|
||||||
|
* the lifetime of the task. Each task uses a different set of values. The reg
|
||||||
|
* test tasks execute with a very low priority, so get preempted very
|
||||||
|
* frequently. A register containing an unexpected value is indicative of an
|
||||||
|
* error in the context switching mechanism.
|
||||||
|
*
|
||||||
|
* "Check" task - The check task period is initially set to three seconds. The
|
||||||
|
* task checks that all the standard demo tasks, and the register check tasks,
|
||||||
|
* are not only still executing, but are executing without reporting any errors.
|
||||||
|
* If the check task discovers that a task has either stalled, or reported an
|
||||||
|
* error, then it changes its own execution period from the initial three
|
||||||
|
* seconds, to just 200ms. The check task also toggles an LED each time it is
|
||||||
|
* called. This provides a visual indication of the system status: If the LED
|
||||||
|
* toggles every three seconds, then no issues have been discovered. If the LED
|
||||||
|
* toggles every 200ms, then an issue has been discovered with at least one
|
||||||
|
* task.
|
||||||
|
*/
|
||||||
|
|
||||||
|
/* Standard includes. */
|
||||||
|
#include <stdio.h>
|
||||||
|
|
||||||
|
/* Kernel includes. */
|
||||||
|
#include "FreeRTOS.h"
|
||||||
|
#include "task.h"
|
||||||
|
#include "timers.h"
|
||||||
|
#include "semphr.h"
|
||||||
|
|
||||||
|
/* Standard demo application includes. */
|
||||||
|
#include "flop.h"
|
||||||
|
#include "semtest.h"
|
||||||
|
#include "dynamic.h"
|
||||||
|
#include "BlockQ.h"
|
||||||
|
#include "blocktim.h"
|
||||||
|
#include "countsem.h"
|
||||||
|
#include "GenQTest.h"
|
||||||
|
#include "recmutex.h"
|
||||||
|
#include "death.h"
|
||||||
|
#include "partest.h"
|
||||||
|
#include "comtest2.h"
|
||||||
|
#include "serial.h"
|
||||||
|
#include "TimerDemo.h"
|
||||||
|
#include "QueueOverwrite.h"
|
||||||
|
#include "IntQueue.h"
|
||||||
|
#include "EventGroupsDemo.h"
|
||||||
|
|
||||||
|
/* Priorities for the demo application tasks. */
|
||||||
|
#define mainSEM_TEST_PRIORITY ( tskIDLE_PRIORITY + 1UL )
|
||||||
|
#define mainBLOCK_Q_PRIORITY ( tskIDLE_PRIORITY + 2UL )
|
||||||
|
#define mainCREATOR_TASK_PRIORITY ( tskIDLE_PRIORITY + 3UL )
|
||||||
|
#define mainFLOP_TASK_PRIORITY ( tskIDLE_PRIORITY )
|
||||||
|
#define mainUART_COMMAND_CONSOLE_STACK_SIZE ( configMINIMAL_STACK_SIZE * 3UL )
|
||||||
|
#define mainCOM_TEST_TASK_PRIORITY ( tskIDLE_PRIORITY + 2 )
|
||||||
|
#define mainCHECK_TASK_PRIORITY ( configMAX_PRIORITIES - 1 )
|
||||||
|
#define mainQUEUE_OVERWRITE_PRIORITY ( tskIDLE_PRIORITY )
|
||||||
|
|
||||||
|
/* The priority used by the UART command console task. */
|
||||||
|
#define mainUART_COMMAND_CONSOLE_TASK_PRIORITY ( configMAX_PRIORITIES - 2 )
|
||||||
|
|
||||||
|
/* The LED used by the check timer. */
|
||||||
|
#define mainCHECK_LED ( 0 )
|
||||||
|
|
||||||
|
/* A block time of zero simply means "don't block". */
|
||||||
|
#define mainDONT_BLOCK ( 0UL )
|
||||||
|
|
||||||
|
/* The period after which the check timer will expire, in ms, provided no errors
|
||||||
|
have been reported by any of the standard demo tasks. ms are converted to the
|
||||||
|
equivalent in ticks using the portTICK_PERIOD_MS constant. */
|
||||||
|
#define mainNO_ERROR_CHECK_TASK_PERIOD ( 3000UL / portTICK_PERIOD_MS )
|
||||||
|
|
||||||
|
/* The period at which the check timer will expire, in ms, if an error has been
|
||||||
|
reported in one of the standard demo tasks. ms are converted to the equivalent
|
||||||
|
in ticks using the portTICK_PERIOD_MS constant. */
|
||||||
|
#define mainERROR_CHECK_TASK_PERIOD ( 200UL / portTICK_PERIOD_MS )
|
||||||
|
|
||||||
|
/* Parameters that are passed into the register check tasks solely for the
|
||||||
|
purpose of ensuring parameters are passed into tasks correctly. */
|
||||||
|
#define mainREG_TEST_TASK_1_PARAMETER ( ( void * ) 0x12345678 )
|
||||||
|
#define mainREG_TEST_TASK_2_PARAMETER ( ( void * ) 0x87654321 )
|
||||||
|
|
||||||
|
/* The base period used by the timer test tasks. */
|
||||||
|
#define mainTIMER_TEST_PERIOD ( 50 )
|
||||||
|
|
||||||
|
/*-----------------------------------------------------------*/
|
||||||
|
|
||||||
|
/*
|
||||||
|
* Called by main() to run the full demo (as opposed to the blinky demo) when
|
||||||
|
* mainCREATE_SIMPLE_BLINKY_DEMO_ONLY is set to 0.
|
||||||
|
*/
|
||||||
|
void main_full( void );
|
||||||
|
|
||||||
|
/*
|
||||||
|
* The check task, as described at the top of this file.
|
||||||
|
*/
|
||||||
|
static void prvCheckTask( void *pvParameters );
|
||||||
|
|
||||||
|
/*
|
||||||
|
* Register check tasks, and the tasks used to write over and check the contents
|
||||||
|
* of the FPU registers, as described at the top of this file. The nature of
|
||||||
|
* these files necessitates that they are written in an assembly file, but the
|
||||||
|
* entry points are kept in the C file for the convenience of checking the task
|
||||||
|
* parameter.
|
||||||
|
*/
|
||||||
|
static void prvRegTestTaskEntry1( void *pvParameters );
|
||||||
|
extern void vRegTest1Implementation( void );
|
||||||
|
static void prvRegTestTaskEntry2( void *pvParameters );
|
||||||
|
extern void vRegTest2Implementation( void );
|
||||||
|
|
||||||
|
/*
|
||||||
|
* Register commands that can be used with FreeRTOS+CLI. The commands are
|
||||||
|
* defined in CLI-Commands.c and File-Related-CLI-Command.c respectively.
|
||||||
|
*/
|
||||||
|
extern void vRegisterSampleCLICommands( void );
|
||||||
|
|
||||||
|
/*
|
||||||
|
* The task that manages the FreeRTOS+CLI input and output.
|
||||||
|
*/
|
||||||
|
extern void vUARTCommandConsoleStart( uint16_t usStackSize, UBaseType_t uxPriority );
|
||||||
|
|
||||||
|
/*
|
||||||
|
* A high priority task that does nothing other than execute at a pseudo random
|
||||||
|
* time to ensure the other test tasks don't just execute in a repeating
|
||||||
|
* pattern.
|
||||||
|
*/
|
||||||
|
static void prvPseudoRandomiser( void *pvParameters );
|
||||||
|
|
||||||
|
/*-----------------------------------------------------------*/
|
||||||
|
|
||||||
|
/* The following two variables are used to communicate the status of the
|
||||||
|
register check tasks to the check task. If the variables keep incrementing,
|
||||||
|
then the register check tasks has not discovered any errors. If a variable
|
||||||
|
stops incrementing, then an error has been found. */
|
||||||
|
volatile unsigned long ulRegTest1LoopCounter = 0UL, ulRegTest2LoopCounter = 0UL;
|
||||||
|
|
||||||
|
/*-----------------------------------------------------------*/
|
||||||
|
#warning Check demo and source folders for _RB_
|
||||||
|
void main_full( void )
|
||||||
|
{
|
||||||
|
/* Start all the other standard demo/test tasks. They have not particular
|
||||||
|
functionality, but do demonstrate how to use the FreeRTOS API and test the
|
||||||
|
kernel port. */
|
||||||
|
//_RB_ vStartInterruptQueueTasks();
|
||||||
|
vStartDynamicPriorityTasks();
|
||||||
|
vStartBlockingQueueTasks( mainBLOCK_Q_PRIORITY );
|
||||||
|
vCreateBlockTimeTasks();
|
||||||
|
vStartCountingSemaphoreTasks();
|
||||||
|
vStartGenericQueueTasks( tskIDLE_PRIORITY );
|
||||||
|
vStartRecursiveMutexTasks();
|
||||||
|
vStartSemaphoreTasks( mainSEM_TEST_PRIORITY );
|
||||||
|
vStartMathTasks( mainFLOP_TASK_PRIORITY );
|
||||||
|
vStartTimerDemoTask( mainTIMER_TEST_PERIOD );
|
||||||
|
vStartQueueOverwriteTask( mainQUEUE_OVERWRITE_PRIORITY );
|
||||||
|
vStartEventGroupTasks();
|
||||||
|
|
||||||
|
/* Start the tasks that implements the command console on the UART, as
|
||||||
|
described above. */
|
||||||
|
//_RB_ vUARTCommandConsoleStart( mainUART_COMMAND_CONSOLE_STACK_SIZE, mainUART_COMMAND_CONSOLE_TASK_PRIORITY );
|
||||||
|
|
||||||
|
/* Register the standard CLI commands. */
|
||||||
|
//_RB_ vRegisterSampleCLICommands();
|
||||||
|
|
||||||
|
/* Create the register check tasks, as described at the top of this file */
|
||||||
|
xTaskCreate( prvRegTestTaskEntry1, "Reg1", configMINIMAL_STACK_SIZE, mainREG_TEST_TASK_1_PARAMETER, tskIDLE_PRIORITY, NULL );
|
||||||
|
xTaskCreate( prvRegTestTaskEntry2, "Reg2", configMINIMAL_STACK_SIZE, mainREG_TEST_TASK_2_PARAMETER, tskIDLE_PRIORITY, NULL );
|
||||||
|
|
||||||
|
/* Create the task that just adds a little random behaviour. */
|
||||||
|
xTaskCreate( prvPseudoRandomiser, "Rnd", configMINIMAL_STACK_SIZE, NULL, configMAX_PRIORITIES - 1, NULL );
|
||||||
|
|
||||||
|
/* Create the task that performs the 'check' functionality, as described at
|
||||||
|
the top of this file. */
|
||||||
|
xTaskCreate( prvCheckTask, "Check", configMINIMAL_STACK_SIZE, NULL, mainCHECK_TASK_PRIORITY, NULL );
|
||||||
|
|
||||||
|
/* The set of tasks created by the following function call have to be
|
||||||
|
created last as they keep account of the number of tasks they expect to see
|
||||||
|
running. */
|
||||||
|
vCreateSuicidalTasks( mainCREATOR_TASK_PRIORITY );
|
||||||
|
|
||||||
|
/* Start the scheduler. */
|
||||||
|
vTaskStartScheduler();
|
||||||
|
|
||||||
|
/* If all is well, the scheduler will now be running, and the following
|
||||||
|
line will never be reached. If the following line does execute, then
|
||||||
|
there was either insufficient FreeRTOS heap memory available for the idle
|
||||||
|
and/or timer tasks to be created, or vTaskStartScheduler() was called from
|
||||||
|
User mode. See the memory management section on the FreeRTOS web site for
|
||||||
|
more details on the FreeRTOS heap http://www.freertos.org/a00111.html. The
|
||||||
|
mode from which main() is called is set in the C start up code and must be
|
||||||
|
a privileged mode (not user mode). */
|
||||||
|
for( ;; );
|
||||||
|
}
|
||||||
|
/*-----------------------------------------------------------*/
|
||||||
|
|
||||||
|
static void prvCheckTask( void *pvParameters )
|
||||||
|
{
|
||||||
|
TickType_t xDelayPeriod = mainNO_ERROR_CHECK_TASK_PERIOD;
|
||||||
|
TickType_t xLastExecutionTime;
|
||||||
|
static unsigned long ulLastRegTest1Value = 0, ulLastRegTest2Value = 0;
|
||||||
|
unsigned long ulErrorFound = pdFALSE;
|
||||||
|
|
||||||
|
/* Just to stop compiler warnings. */
|
||||||
|
( void ) pvParameters;
|
||||||
|
|
||||||
|
/* Initialise xLastExecutionTime so the first call to vTaskDelayUntil()
|
||||||
|
works correctly. */
|
||||||
|
xLastExecutionTime = xTaskGetTickCount();
|
||||||
|
|
||||||
|
/* Cycle for ever, delaying then checking all the other tasks are still
|
||||||
|
operating without error. The onboard LED is toggled on each iteration.
|
||||||
|
If an error is detected then the delay period is decreased from
|
||||||
|
mainNO_ERROR_CHECK_TASK_PERIOD to mainERROR_CHECK_TASK_PERIOD. This has the
|
||||||
|
effect of increasing the rate at which the onboard LED toggles, and in so
|
||||||
|
doing gives visual feedback of the system status. */
|
||||||
|
for( ;; )
|
||||||
|
{
|
||||||
|
/* Delay until it is time to execute again. */
|
||||||
|
vTaskDelayUntil( &xLastExecutionTime, xDelayPeriod );
|
||||||
|
|
||||||
|
/* Check all the demo tasks (other than the flash tasks) to ensure
|
||||||
|
that they are all still running, and that none have detected an error. */
|
||||||
|
if( xAreIntQueueTasksStillRunning() != pdTRUE )
|
||||||
|
{
|
||||||
|
//_RB_ ulErrorFound = pdTRUE;
|
||||||
|
}
|
||||||
|
|
||||||
|
if( xAreMathsTaskStillRunning() != pdTRUE )
|
||||||
|
{
|
||||||
|
ulErrorFound = pdTRUE;
|
||||||
|
}
|
||||||
|
|
||||||
|
if( xAreDynamicPriorityTasksStillRunning() != pdTRUE )
|
||||||
|
{
|
||||||
|
ulErrorFound = pdTRUE;
|
||||||
|
}
|
||||||
|
|
||||||
|
if( xAreBlockingQueuesStillRunning() != pdTRUE )
|
||||||
|
{
|
||||||
|
ulErrorFound = pdTRUE;
|
||||||
|
}
|
||||||
|
|
||||||
|
if ( xAreBlockTimeTestTasksStillRunning() != pdTRUE )
|
||||||
|
{
|
||||||
|
ulErrorFound = pdTRUE;
|
||||||
|
}
|
||||||
|
|
||||||
|
if ( xAreGenericQueueTasksStillRunning() != pdTRUE )
|
||||||
|
{
|
||||||
|
ulErrorFound = pdTRUE;
|
||||||
|
}
|
||||||
|
|
||||||
|
if ( xAreRecursiveMutexTasksStillRunning() != pdTRUE )
|
||||||
|
{
|
||||||
|
ulErrorFound = pdTRUE;
|
||||||
|
}
|
||||||
|
|
||||||
|
if( xIsCreateTaskStillRunning() != pdTRUE )
|
||||||
|
{
|
||||||
|
ulErrorFound = pdTRUE;
|
||||||
|
}
|
||||||
|
|
||||||
|
if( xAreSemaphoreTasksStillRunning() != pdTRUE )
|
||||||
|
{
|
||||||
|
ulErrorFound = pdTRUE;
|
||||||
|
}
|
||||||
|
|
||||||
|
if( xAreTimerDemoTasksStillRunning( ( TickType_t ) mainNO_ERROR_CHECK_TASK_PERIOD ) != pdPASS )
|
||||||
|
{
|
||||||
|
ulErrorFound = pdTRUE;
|
||||||
|
}
|
||||||
|
|
||||||
|
if( xAreCountingSemaphoreTasksStillRunning() != pdTRUE )
|
||||||
|
{
|
||||||
|
ulErrorFound = pdTRUE;
|
||||||
|
}
|
||||||
|
|
||||||
|
if( xIsQueueOverwriteTaskStillRunning() != pdPASS )
|
||||||
|
{
|
||||||
|
ulErrorFound = pdTRUE;
|
||||||
|
}
|
||||||
|
|
||||||
|
if( xAreEventGroupTasksStillRunning() != pdPASS )
|
||||||
|
{
|
||||||
|
ulErrorFound = pdTRUE;
|
||||||
|
}
|
||||||
|
|
||||||
|
/* Check that the register test 1 task is still running. */
|
||||||
|
if( ulLastRegTest1Value == ulRegTest1LoopCounter )
|
||||||
|
{
|
||||||
|
ulErrorFound = pdTRUE;
|
||||||
|
}
|
||||||
|
ulLastRegTest1Value = ulRegTest1LoopCounter;
|
||||||
|
|
||||||
|
/* Check that the register test 2 task is still running. */
|
||||||
|
if( ulLastRegTest2Value == ulRegTest2LoopCounter )
|
||||||
|
{
|
||||||
|
ulErrorFound = pdTRUE;
|
||||||
|
}
|
||||||
|
ulLastRegTest2Value = ulRegTest2LoopCounter;
|
||||||
|
|
||||||
|
/* Toggle the check LED to give an indication of the system status. If
|
||||||
|
the LED toggles every mainNO_ERROR_CHECK_TASK_PERIOD milliseconds then
|
||||||
|
everything is ok. A faster toggle indicates an error. */
|
||||||
|
vParTestToggleLED( mainCHECK_LED );
|
||||||
|
|
||||||
|
if( ulErrorFound != pdFALSE )
|
||||||
|
{
|
||||||
|
/* An error has been detected in one of the tasks - flash the LED
|
||||||
|
at a higher frequency to give visible feedback that something has
|
||||||
|
gone wrong (it might just be that the loop back connector required
|
||||||
|
by the comtest tasks has not been fitted). */
|
||||||
|
xDelayPeriod = mainERROR_CHECK_TASK_PERIOD;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
}
|
||||||
|
/*-----------------------------------------------------------*/
|
||||||
|
|
||||||
|
static void prvRegTestTaskEntry1( void *pvParameters )
|
||||||
|
{
|
||||||
|
/* Although the regtest task is written in assembler, its entry point is
|
||||||
|
written in C for convenience of checking the task parameter is being passed
|
||||||
|
in correctly. */
|
||||||
|
if( pvParameters == mainREG_TEST_TASK_1_PARAMETER )
|
||||||
|
{
|
||||||
|
/* The reg test task also tests the floating point registers. Tasks
|
||||||
|
that use the floating point unit must call vPortTaskUsesFPU() before
|
||||||
|
any floating point instructions are executed. */
|
||||||
|
vPortTaskUsesFPU();
|
||||||
|
|
||||||
|
/* Start the part of the test that is written in assembler. */
|
||||||
|
vRegTest1Implementation();
|
||||||
|
}
|
||||||
|
|
||||||
|
/* The following line will only execute if the task parameter is found to
|
||||||
|
be incorrect. The check timer will detect that the regtest loop counter is
|
||||||
|
not being incremented and flag an error. */
|
||||||
|
vTaskDelete( NULL );
|
||||||
|
}
|
||||||
|
/*-----------------------------------------------------------*/
|
||||||
|
|
||||||
|
static void prvRegTestTaskEntry2( void *pvParameters )
|
||||||
|
{
|
||||||
|
/* Although the regtest task is written in assembler, its entry point is
|
||||||
|
written in C for convenience of checking the task parameter is being passed
|
||||||
|
in correctly. */
|
||||||
|
if( pvParameters == mainREG_TEST_TASK_2_PARAMETER )
|
||||||
|
{
|
||||||
|
/* The reg test task also tests the floating point registers. Tasks
|
||||||
|
that use the floating point unit must call vPortTaskUsesFPU() before
|
||||||
|
any floating point instructions are executed. */
|
||||||
|
vPortTaskUsesFPU();
|
||||||
|
|
||||||
|
/* Start the part of the test that is written in assembler. */
|
||||||
|
vRegTest2Implementation();
|
||||||
|
}
|
||||||
|
|
||||||
|
/* The following line will only execute if the task parameter is found to
|
||||||
|
be incorrect. The check timer will detect that the regtest loop counter is
|
||||||
|
not being incremented and flag an error. */
|
||||||
|
vTaskDelete( NULL );
|
||||||
|
}
|
||||||
|
/*-----------------------------------------------------------*/
|
||||||
|
|
||||||
|
static void prvPseudoRandomiser( void *pvParameters )
|
||||||
|
{
|
||||||
|
const uint32_t ulMultiplier = 0x015a4e35UL, ulIncrement = 1UL, ulMinDelay = ( 35 / portTICK_PERIOD_MS );
|
||||||
|
volatile uint32_t ulNextRand = ( uint32_t ) &pvParameters, ulValue;
|
||||||
|
|
||||||
|
/* This task does nothing other than ensure there is a little bit of
|
||||||
|
disruption in the scheduling pattern of the other tasks. Normally this is
|
||||||
|
done by generating interrupts at pseudo random times. */
|
||||||
|
for( ;; )
|
||||||
|
{
|
||||||
|
ulNextRand = ( ulMultiplier * ulNextRand ) + ulIncrement;
|
||||||
|
ulValue = ( ulNextRand >> 16UL ) & 0xffUL;
|
||||||
|
|
||||||
|
if( ulValue < ulMinDelay )
|
||||||
|
{
|
||||||
|
ulValue = ulMinDelay;
|
||||||
|
}
|
||||||
|
|
||||||
|
vTaskDelay( ulValue );
|
||||||
|
|
||||||
|
while( ulValue > 0 )
|
||||||
|
{
|
||||||
|
__asm volatile( "NOP" );
|
||||||
|
__asm volatile( "NOP" );
|
||||||
|
__asm volatile( "NOP" );
|
||||||
|
__asm volatile( "NOP" );
|
||||||
|
|
||||||
|
ulValue--;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
@ -0,0 +1,468 @@
|
|||||||
|
;/*
|
||||||
|
; FreeRTOS V8.0.1 - Copyright (C) 2014 Real Time Engineers Ltd.
|
||||||
|
;
|
||||||
|
; FEATURES AND PORTS ARE ADDED TO FREERTOS ALL THE TIME. PLEASE VISIT
|
||||||
|
; http://www.FreeRTOS.org TO ENSURE YOU ARE USING THE LATEST VERSION.
|
||||||
|
;
|
||||||
|
; ***************************************************************************
|
||||||
|
; * *
|
||||||
|
; * FreeRTOS tutorial books are available in pdf and paperback. *
|
||||||
|
; * Complete, revised, and edited pdf reference manuals are also *
|
||||||
|
; * available. *
|
||||||
|
; * *
|
||||||
|
; * Purchasing FreeRTOS documentation will not only help you, by *
|
||||||
|
; * ensuring you get running as quickly as possible and with an *
|
||||||
|
; * in-depth knowledge of how to use FreeRTOS, it will also help *
|
||||||
|
; * the FreeRTOS project to continue with its mission of providing *
|
||||||
|
; * professional grade, cross platform, de facto standard solutions *
|
||||||
|
; * for microcontrollers - completely free of charge! *
|
||||||
|
; * *
|
||||||
|
; * >>> See http://www.FreeRTOS.org/Documentation for details. <<< *
|
||||||
|
; * *
|
||||||
|
; * Thank you for using FreeRTOS, and thank you for your support! *
|
||||||
|
; * *
|
||||||
|
; ***************************************************************************
|
||||||
|
;
|
||||||
|
;
|
||||||
|
; This file is part of the FreeRTOS distribution.
|
||||||
|
;
|
||||||
|
; FreeRTOS is free software; you can redistribute it and/or modify it under
|
||||||
|
; the terms of the GNU General Public License (version 2) as published by the
|
||||||
|
; Free Software Foundation AND MODIFIED BY the FreeRTOS exception.
|
||||||
|
;
|
||||||
|
; >>>>>>NOTE<<<<<< The modification to the GPL is included to allow you to
|
||||||
|
; distribute a combined work that includes FreeRTOS without being obliged to
|
||||||
|
; provide the source code for proprietary components outside of the FreeRTOS
|
||||||
|
; kernel.
|
||||||
|
;
|
||||||
|
; FreeRTOS is distributed in the hope that it will be useful, but WITHOUT ANY
|
||||||
|
; WARRANTY; without even the implied warranty of MERCHANTABILITY or FITNESS
|
||||||
|
; FOR A PARTICULAR PURPOSE. See the GNU General Public License for more
|
||||||
|
; details. You should have received a copy of the GNU General Public License
|
||||||
|
; and the FreeRTOS license exception along with FreeRTOS; if not itcan be
|
||||||
|
; viewed here: http://www.freertos.org/a00114.html and also obtained by
|
||||||
|
; writing to Real Time Engineers Ltd., contact details for whom are available
|
||||||
|
; on the FreeRTOS WEB site.
|
||||||
|
;
|
||||||
|
; 1 tab == 4 spaces!
|
||||||
|
;
|
||||||
|
; ***************************************************************************
|
||||||
|
; * *
|
||||||
|
; * Having a problem? Start by reading the FAQ "My application does *
|
||||||
|
; * not run, what could be wrong?" *
|
||||||
|
; * *
|
||||||
|
; * http://www.FreeRTOS.org/FAQHelp.html *
|
||||||
|
; * *
|
||||||
|
; ***************************************************************************
|
||||||
|
;
|
||||||
|
;
|
||||||
|
; http://www.FreeRTOS.org - Documentation, books, training, latest versions,
|
||||||
|
; license and Real Time Engineers Ltd. contact details.
|
||||||
|
;
|
||||||
|
; http://www.FreeRTOS.org/plus - A selection of FreeRTOS ecosystem products,
|
||||||
|
; including FreeRTOS+Trace - an indispensable productivity tool, and our new
|
||||||
|
; fully thread aware and reentrant UDP/IP stack.
|
||||||
|
;
|
||||||
|
; http://www.OpenRTOS.com - Real Time Engineers ltd license FreeRTOS to High
|
||||||
|
; Integrity Systems, who sell the code with commercial support,
|
||||||
|
; indemnification and middleware, under the OpenRTOS brand.
|
||||||
|
;
|
||||||
|
; http://www.SafeRTOS.com - High Integrity Systems also provide a safety
|
||||||
|
; engineered and independently SIL3 certified version for use in safety and
|
||||||
|
; mission critical applications that require provable dependability.
|
||||||
|
;*/
|
||||||
|
|
||||||
|
EXPORT vRegTest1Implementation
|
||||||
|
EXPORT vRegTest2Implementation
|
||||||
|
|
||||||
|
; This file is built with IAR and ARM compilers. When the ARM compiler
|
||||||
|
; is used the compiler options must define __IASMARM__ as 0 using the
|
||||||
|
; --predefine "__IASMARM__ SETA 0" command line option. When compiling
|
||||||
|
; with IAR __IASMARM__ is automatically set to 1 so no additional assembler
|
||||||
|
; options are required.
|
||||||
|
SECTION .text:CODE:ROOT(2)
|
||||||
|
ARM
|
||||||
|
|
||||||
|
; This function is explained in the comments at the top of main-full.c.
|
||||||
|
vRegTest1Implementation
|
||||||
|
|
||||||
|
PRESERVE8
|
||||||
|
IMPORT ulRegTest1LoopCounter
|
||||||
|
|
||||||
|
; Fill each general purpose register with a known value.
|
||||||
|
mov r0, #0xFF
|
||||||
|
mov r1, #0x11
|
||||||
|
mov r2, #0x22
|
||||||
|
mov r3, #0x33
|
||||||
|
mov r4, #0x44
|
||||||
|
mov r5, #0x55
|
||||||
|
mov r6, #0x66
|
||||||
|
mov r7, #0x77
|
||||||
|
mov r8, #0x88
|
||||||
|
mov r9, #0x99
|
||||||
|
mov r10, #0xAA
|
||||||
|
mov r11, #0xBB
|
||||||
|
mov r12, #0xCC
|
||||||
|
mov r14, #0xEE
|
||||||
|
|
||||||
|
; Fill each FPU register with a known value.
|
||||||
|
vmov d0, r0, r1
|
||||||
|
vmov d1, r2, r3
|
||||||
|
vmov d2, r4, r5
|
||||||
|
vmov d3, r6, r7
|
||||||
|
vmov d4, r8, r9
|
||||||
|
vmov d5, r10, r11
|
||||||
|
vmov d6, r0, r1
|
||||||
|
vmov d7, r2, r3
|
||||||
|
vmov d8, r4, r5
|
||||||
|
vmov d9, r6, r7
|
||||||
|
vmov d10, r8, r9
|
||||||
|
vmov d11, r10, r11
|
||||||
|
vmov d12, r0, r1
|
||||||
|
vmov d13, r2, r3
|
||||||
|
vmov d14, r4, r5
|
||||||
|
vmov d15, r6, r7
|
||||||
|
|
||||||
|
; Loop, checking each itteration that each register still contains the
|
||||||
|
; expected value.
|
||||||
|
reg1_loop
|
||||||
|
; Yield to increase test coverage
|
||||||
|
svc 0
|
||||||
|
|
||||||
|
; Check all the VFP registers still contain the values set above.
|
||||||
|
; First save registers that are clobbered by the test.
|
||||||
|
push { r0-r1 }
|
||||||
|
|
||||||
|
vmov r0, r1, d0
|
||||||
|
cmp r0, #0xFF
|
||||||
|
bne reg1_error_loopf
|
||||||
|
cmp r1, #0x11
|
||||||
|
bne reg1_error_loopf
|
||||||
|
vmov r0, r1, d1
|
||||||
|
cmp r0, #0x22
|
||||||
|
bne reg1_error_loopf
|
||||||
|
cmp r1, #0x33
|
||||||
|
bne reg1_error_loopf
|
||||||
|
vmov r0, r1, d2
|
||||||
|
cmp r0, #0x44
|
||||||
|
bne reg1_error_loopf
|
||||||
|
cmp r1, #0x55
|
||||||
|
bne reg1_error_loopf
|
||||||
|
vmov r0, r1, d3
|
||||||
|
cmp r0, #0x66
|
||||||
|
bne reg1_error_loopf
|
||||||
|
cmp r1, #0x77
|
||||||
|
bne reg1_error_loopf
|
||||||
|
vmov r0, r1, d4
|
||||||
|
cmp r0, #0x88
|
||||||
|
bne reg1_error_loopf
|
||||||
|
cmp r1, #0x99
|
||||||
|
bne reg1_error_loopf
|
||||||
|
vmov r0, r1, d5
|
||||||
|
cmp r0, #0xAA
|
||||||
|
bne reg1_error_loopf
|
||||||
|
cmp r1, #0xBB
|
||||||
|
bne reg1_error_loopf
|
||||||
|
vmov r0, r1, d6
|
||||||
|
cmp r0, #0xFF
|
||||||
|
bne reg1_error_loopf
|
||||||
|
cmp r1, #0x11
|
||||||
|
bne reg1_error_loopf
|
||||||
|
vmov r0, r1, d7
|
||||||
|
cmp r0, #0x22
|
||||||
|
bne reg1_error_loopf
|
||||||
|
cmp r1, #0x33
|
||||||
|
bne reg1_error_loopf
|
||||||
|
vmov r0, r1, d8
|
||||||
|
cmp r0, #0x44
|
||||||
|
bne reg1_error_loopf
|
||||||
|
cmp r1, #0x55
|
||||||
|
bne reg1_error_loopf
|
||||||
|
vmov r0, r1, d9
|
||||||
|
cmp r0, #0x66
|
||||||
|
bne reg1_error_loopf
|
||||||
|
cmp r1, #0x77
|
||||||
|
bne reg1_error_loopf
|
||||||
|
vmov r0, r1, d10
|
||||||
|
cmp r0, #0x88
|
||||||
|
bne reg1_error_loopf
|
||||||
|
cmp r1, #0x99
|
||||||
|
bne reg1_error_loopf
|
||||||
|
vmov r0, r1, d11
|
||||||
|
cmp r0, #0xAA
|
||||||
|
bne reg1_error_loopf
|
||||||
|
cmp r1, #0xBB
|
||||||
|
bne reg1_error_loopf
|
||||||
|
vmov r0, r1, d12
|
||||||
|
cmp r0, #0xFF
|
||||||
|
bne reg1_error_loopf
|
||||||
|
cmp r1, #0x11
|
||||||
|
bne reg1_error_loopf
|
||||||
|
vmov r0, r1, d13
|
||||||
|
cmp r0, #0x22
|
||||||
|
bne reg1_error_loopf
|
||||||
|
cmp r1, #0x33
|
||||||
|
bne reg1_error_loopf
|
||||||
|
vmov r0, r1, d14
|
||||||
|
cmp r0, #0x44
|
||||||
|
bne reg1_error_loopf
|
||||||
|
cmp r1, #0x55
|
||||||
|
bne reg1_error_loopf
|
||||||
|
vmov r0, r1, d15
|
||||||
|
cmp r0, #0x66
|
||||||
|
bne reg1_error_loopf
|
||||||
|
cmp r1, #0x77
|
||||||
|
bne reg1_error_loopf
|
||||||
|
|
||||||
|
; Restore the registers that were clobbered by the test.
|
||||||
|
pop {r0-r1}
|
||||||
|
|
||||||
|
; VFP register test passed. Jump to the core register test.
|
||||||
|
b reg1_loopf_pass
|
||||||
|
|
||||||
|
reg1_error_loopf
|
||||||
|
; If this line is hit then a VFP register value was found to be
|
||||||
|
; incorrect.
|
||||||
|
b reg1_error_loopf
|
||||||
|
|
||||||
|
reg1_loopf_pass
|
||||||
|
|
||||||
|
; Test each general purpose register to check that it still contains the
|
||||||
|
; expected known value, jumping to reg1_error_loop if any register contains
|
||||||
|
; an unexpected value.
|
||||||
|
cmp r0, #0xFF
|
||||||
|
bne reg1_error_loop
|
||||||
|
cmp r1, #0x11
|
||||||
|
bne reg1_error_loop
|
||||||
|
cmp r2, #0x22
|
||||||
|
bne reg1_error_loop
|
||||||
|
cmp r3, #0x33
|
||||||
|
bne reg1_error_loop
|
||||||
|
cmp r4, #0x44
|
||||||
|
bne reg1_error_loop
|
||||||
|
cmp r5, #0x55
|
||||||
|
bne reg1_error_loop
|
||||||
|
cmp r6, #0x66
|
||||||
|
bne reg1_error_loop
|
||||||
|
cmp r7, #0x77
|
||||||
|
bne reg1_error_loop
|
||||||
|
cmp r8, #0x88
|
||||||
|
bne reg1_error_loop
|
||||||
|
cmp r9, #0x99
|
||||||
|
bne reg1_error_loop
|
||||||
|
cmp r10, #0xAA
|
||||||
|
bne reg1_error_loop
|
||||||
|
cmp r11, #0xBB
|
||||||
|
bne reg1_error_loop
|
||||||
|
cmp r12, #0xCC
|
||||||
|
bne reg1_error_loop
|
||||||
|
cmp r14, #0xEE
|
||||||
|
bne reg1_error_loop
|
||||||
|
|
||||||
|
; Everything passed, increment the loop counter.
|
||||||
|
push { r0-r1 }
|
||||||
|
ldr r0, =ulRegTest1LoopCounter
|
||||||
|
ldr r1, [r0]
|
||||||
|
adds r1, r1, #1
|
||||||
|
str r1, [r0]
|
||||||
|
pop { r0-r1 }
|
||||||
|
|
||||||
|
; Start again.
|
||||||
|
b reg1_loop
|
||||||
|
|
||||||
|
reg1_error_loop
|
||||||
|
; If this line is hit then there was an error in a core register value.
|
||||||
|
; The loop ensures the loop counter stops incrementing.
|
||||||
|
b reg1_error_loop
|
||||||
|
nop
|
||||||
|
|
||||||
|
;/*-----------------------------------------------------------*/
|
||||||
|
|
||||||
|
vRegTest2Implementation
|
||||||
|
|
||||||
|
PRESERVE8
|
||||||
|
IMPORT ulRegTest2LoopCounter
|
||||||
|
|
||||||
|
; Put a known value in each register.
|
||||||
|
mov r0, #0xFF000000
|
||||||
|
mov r1, #0x11000000
|
||||||
|
mov r2, #0x22000000
|
||||||
|
mov r3, #0x33000000
|
||||||
|
mov r4, #0x44000000
|
||||||
|
mov r5, #0x55000000
|
||||||
|
mov r6, #0x66000000
|
||||||
|
mov r7, #0x77000000
|
||||||
|
mov r8, #0x88000000
|
||||||
|
mov r9, #0x99000000
|
||||||
|
mov r10, #0xAA000000
|
||||||
|
mov r11, #0xBB000000
|
||||||
|
mov r12, #0xCC000000
|
||||||
|
mov r14, #0xEE000000
|
||||||
|
|
||||||
|
; Likewise the floating point registers
|
||||||
|
vmov d0, r0, r1
|
||||||
|
vmov d1, r2, r3
|
||||||
|
vmov d2, r4, r5
|
||||||
|
vmov d3, r6, r7
|
||||||
|
vmov d4, r8, r9
|
||||||
|
vmov d5, r10, r11
|
||||||
|
vmov d6, r0, r1
|
||||||
|
vmov d7, r2, r3
|
||||||
|
vmov d8, r4, r5
|
||||||
|
vmov d9, r6, r7
|
||||||
|
vmov d10, r8, r9
|
||||||
|
vmov d11, r10, r11
|
||||||
|
vmov d12, r0, r1
|
||||||
|
vmov d13, r2, r3
|
||||||
|
vmov d14, r4, r5
|
||||||
|
vmov d15, r6, r7
|
||||||
|
|
||||||
|
; Loop, checking each itteration that each register still contains the
|
||||||
|
; expected value.
|
||||||
|
reg2_loop
|
||||||
|
; Check all the VFP registers still contain the values set above.
|
||||||
|
; First save registers that are clobbered by the test.
|
||||||
|
push { r0-r1 }
|
||||||
|
|
||||||
|
vmov r0, r1, d0
|
||||||
|
cmp r0, #0xFF000000
|
||||||
|
bne reg2_error_loopf
|
||||||
|
cmp r1, #0x11000000
|
||||||
|
bne reg2_error_loopf
|
||||||
|
vmov r0, r1, d1
|
||||||
|
cmp r0, #0x22000000
|
||||||
|
bne reg2_error_loopf
|
||||||
|
cmp r1, #0x33000000
|
||||||
|
bne reg2_error_loopf
|
||||||
|
vmov r0, r1, d2
|
||||||
|
cmp r0, #0x44000000
|
||||||
|
bne reg2_error_loopf
|
||||||
|
cmp r1, #0x55000000
|
||||||
|
bne reg2_error_loopf
|
||||||
|
vmov r0, r1, d3
|
||||||
|
cmp r0, #0x66000000
|
||||||
|
bne reg2_error_loopf
|
||||||
|
cmp r1, #0x77000000
|
||||||
|
bne reg2_error_loopf
|
||||||
|
vmov r0, r1, d4
|
||||||
|
cmp r0, #0x88000000
|
||||||
|
bne reg2_error_loopf
|
||||||
|
cmp r1, #0x99000000
|
||||||
|
bne reg2_error_loopf
|
||||||
|
vmov r0, r1, d5
|
||||||
|
cmp r0, #0xAA000000
|
||||||
|
bne reg2_error_loopf
|
||||||
|
cmp r1, #0xBB000000
|
||||||
|
bne reg2_error_loopf
|
||||||
|
vmov r0, r1, d6
|
||||||
|
cmp r0, #0xFF000000
|
||||||
|
bne reg2_error_loopf
|
||||||
|
cmp r1, #0x11000000
|
||||||
|
bne reg2_error_loopf
|
||||||
|
vmov r0, r1, d7
|
||||||
|
cmp r0, #0x22000000
|
||||||
|
bne reg2_error_loopf
|
||||||
|
cmp r1, #0x33000000
|
||||||
|
bne reg2_error_loopf
|
||||||
|
vmov r0, r1, d8
|
||||||
|
cmp r0, #0x44000000
|
||||||
|
bne reg2_error_loopf
|
||||||
|
cmp r1, #0x55000000
|
||||||
|
bne reg2_error_loopf
|
||||||
|
vmov r0, r1, d9
|
||||||
|
cmp r0, #0x66000000
|
||||||
|
bne reg2_error_loopf
|
||||||
|
cmp r1, #0x77000000
|
||||||
|
bne reg2_error_loopf
|
||||||
|
vmov r0, r1, d10
|
||||||
|
cmp r0, #0x88000000
|
||||||
|
bne reg2_error_loopf
|
||||||
|
cmp r1, #0x99000000
|
||||||
|
bne reg2_error_loopf
|
||||||
|
vmov r0, r1, d11
|
||||||
|
cmp r0, #0xAA000000
|
||||||
|
bne reg2_error_loopf
|
||||||
|
cmp r1, #0xBB000000
|
||||||
|
bne reg2_error_loopf
|
||||||
|
vmov r0, r1, d12
|
||||||
|
cmp r0, #0xFF000000
|
||||||
|
bne reg2_error_loopf
|
||||||
|
cmp r1, #0x11000000
|
||||||
|
bne reg2_error_loopf
|
||||||
|
vmov r0, r1, d13
|
||||||
|
cmp r0, #0x22000000
|
||||||
|
bne reg2_error_loopf
|
||||||
|
cmp r1, #0x33000000
|
||||||
|
bne reg2_error_loopf
|
||||||
|
vmov r0, r1, d14
|
||||||
|
cmp r0, #0x44000000
|
||||||
|
bne reg2_error_loopf
|
||||||
|
cmp r1, #0x55000000
|
||||||
|
bne reg2_error_loopf
|
||||||
|
vmov r0, r1, d15
|
||||||
|
cmp r0, #0x66000000
|
||||||
|
bne reg2_error_loopf
|
||||||
|
cmp r1, #0x77000000
|
||||||
|
bne reg2_error_loopf
|
||||||
|
|
||||||
|
; Restore the registers that were clobbered by the test.
|
||||||
|
pop {r0-r1}
|
||||||
|
|
||||||
|
; VFP register test passed. Jump to the core register test.
|
||||||
|
b reg2_loopf_pass
|
||||||
|
|
||||||
|
reg2_error_loopf
|
||||||
|
; If this line is hit then a VFP register value was found to be
|
||||||
|
; incorrect.
|
||||||
|
b reg2_error_loopf
|
||||||
|
|
||||||
|
reg2_loopf_pass
|
||||||
|
|
||||||
|
cmp r0, #0xFF000000
|
||||||
|
bne reg2_error_loop
|
||||||
|
cmp r1, #0x11000000
|
||||||
|
bne reg2_error_loop
|
||||||
|
cmp r2, #0x22000000
|
||||||
|
bne reg2_error_loop
|
||||||
|
cmp r3, #0x33000000
|
||||||
|
bne reg2_error_loop
|
||||||
|
cmp r4, #0x44000000
|
||||||
|
bne reg2_error_loop
|
||||||
|
cmp r5, #0x55000000
|
||||||
|
bne reg2_error_loop
|
||||||
|
cmp r6, #0x66000000
|
||||||
|
bne reg2_error_loop
|
||||||
|
cmp r7, #0x77000000
|
||||||
|
bne reg2_error_loop
|
||||||
|
cmp r8, #0x88000000
|
||||||
|
bne reg2_error_loop
|
||||||
|
cmp r9, #0x99000000
|
||||||
|
bne reg2_error_loop
|
||||||
|
cmp r10, #0xAA000000
|
||||||
|
bne reg2_error_loop
|
||||||
|
cmp r11, #0xBB000000
|
||||||
|
bne reg2_error_loop
|
||||||
|
cmp r12, #0xCC000000
|
||||||
|
bne reg2_error_loop
|
||||||
|
cmp r14, #0xEE000000
|
||||||
|
bne reg2_error_loop
|
||||||
|
|
||||||
|
; Everything passed, increment the loop counter.
|
||||||
|
push { r0-r1 }
|
||||||
|
ldr r0, =ulRegTest2LoopCounter
|
||||||
|
ldr r1, [r0]
|
||||||
|
adds r1, r1, #1
|
||||||
|
str r1, [r0]
|
||||||
|
pop { r0-r1 }
|
||||||
|
|
||||||
|
; Start again.
|
||||||
|
b reg2_loop
|
||||||
|
|
||||||
|
reg2_error_loop
|
||||||
|
; If this line is hit then there was an error in a core register value.
|
||||||
|
; The loop ensures the loop counter stops incrementing.
|
||||||
|
b reg2_error_loop
|
||||||
|
nop
|
||||||
|
|
||||||
|
|
||||||
|
END
|
||||||
Loading…
Reference in New Issue