mirror of
https://github.com/FreeRTOS/FreeRTOS-Kernel.git
synced 2025-04-22 14:31:59 -04:00
629 lines
12 KiB
ArmAsm
629 lines
12 KiB
ArmAsm
/*
|
|
FreeRTOS V8.1.0 - 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!
|
|
*/
|
|
|
|
|
|
#include <xc.h>
|
|
#include <sys/asm.h>
|
|
|
|
.set nomips16
|
|
.set noreorder
|
|
|
|
|
|
.global vRegTest1
|
|
.global vRegTest2
|
|
|
|
.set noreorder
|
|
.set noat
|
|
.ent error_loop
|
|
|
|
/* Reg test tasks call the error loop when they find an error. Sitting in the
|
|
tight error loop prevents them incrementing their ulRegTestnCycles counter, and
|
|
so allows the check softwate timer to know an error has been found. */
|
|
error_loop:
|
|
b .
|
|
nop
|
|
|
|
.end error_loop
|
|
|
|
|
|
.set noreorder
|
|
.set noat
|
|
.ent vRegTest1
|
|
|
|
vRegTest1:
|
|
/* Fill the registers with known values. */
|
|
addiu $1, $0, 0x11
|
|
addiu $2, $0, 0x12
|
|
addiu $3, $0, 0x13
|
|
/* $4 contains the address of the loop counter - don't mess with $4. */
|
|
addiu $5, $0, 0x15
|
|
addiu $6, $0, 0x16
|
|
addiu $7, $0, 0x17
|
|
addiu $8, $0, 0x18
|
|
addiu $9, $0, 0x19
|
|
addiu $10, $0, 0x110
|
|
addiu $11, $0, 0x111
|
|
addiu $12, $0, 0x112
|
|
addiu $13, $0, 0x113
|
|
addiu $14, $0, 0x114
|
|
addiu $15, $0, 0x115
|
|
addiu $16, $0, 0x116
|
|
addiu $17, $0, 0x117
|
|
addiu $18, $0, 0x118
|
|
addiu $19, $0, 0x119
|
|
addiu $20, $0, 0x120
|
|
addiu $21, $0, 0x121
|
|
addiu $23, $0, 0x123
|
|
addiu $24, $0, 0x124
|
|
addiu $25, $0, 0x125
|
|
addiu $30, $0, 0x130
|
|
addiu $22, $0, 0x131
|
|
mthi $22, $ac1
|
|
addiu $22, $0, 0x132
|
|
mtlo $22, $ac1
|
|
addiu $22, $0, 0x133
|
|
mthi $22, $ac2
|
|
addiu $22, $0, 0x134
|
|
mtlo $22, $ac2
|
|
addiu $22, $0, 0x135
|
|
mthi $22, $ac3
|
|
addiu $22, $0, 0x136
|
|
mtlo $22, $ac3
|
|
|
|
vRegTest1Loop:
|
|
/* Check each register maintains the value assigned to it for the lifetime
|
|
of the task. */
|
|
addiu $22, $0, 0x00
|
|
addiu $22, $1, -0x11
|
|
beq $22, $0, .+16
|
|
nop
|
|
/* The register value was not that expected. Jump to the error loop so the
|
|
cycle counter stops incrementing. */
|
|
b error_loop
|
|
nop
|
|
|
|
addiu $22, $0, 0x00
|
|
addiu $22, $2, -0x12
|
|
beq $22, $0, .+16
|
|
nop
|
|
b error_loop
|
|
nop
|
|
|
|
addiu $22, $0, 0x00
|
|
addiu $22, $3, -0x13
|
|
beq $22, $0, .+16
|
|
nop
|
|
b error_loop
|
|
nop
|
|
|
|
addiu $22, $0, 0x00
|
|
addiu $22, $5, -0x15
|
|
beq $22, $0, .+16
|
|
nop
|
|
b error_loop
|
|
nop
|
|
|
|
addiu $22, $0, 0x00
|
|
addiu $22, $6, -0x16
|
|
beq $22, $0, .+16
|
|
nop
|
|
b error_loop
|
|
nop
|
|
|
|
addiu $22, $0, 0x00
|
|
addiu $22, $7, -0x17
|
|
beq $22, $0, .+16
|
|
nop
|
|
b error_loop
|
|
nop
|
|
|
|
addiu $22, $0, 0x00
|
|
addiu $22, $8, -0x18
|
|
beq $22, $0, .+16
|
|
nop
|
|
b error_loop
|
|
nop
|
|
|
|
addiu $22, $0, 0x00
|
|
addiu $22, $9, -0x19
|
|
beq $22, $0, .+16
|
|
nop
|
|
b error_loop
|
|
nop
|
|
|
|
addiu $22, $0, 0x00
|
|
addiu $22, $10, -0x110
|
|
beq $22, $0, .+16
|
|
nop
|
|
b error_loop
|
|
nop
|
|
|
|
addiu $22, $0, 0x00
|
|
addiu $22, $11, -0x111
|
|
beq $22, $0, .+16
|
|
nop
|
|
b error_loop
|
|
nop
|
|
|
|
addiu $22, $0, 0x00
|
|
addiu $22, $12, -0x112
|
|
beq $22, $0, .+16
|
|
nop
|
|
b error_loop
|
|
nop
|
|
|
|
addiu $22, $0, 0x00
|
|
addiu $22, $13, -0x113
|
|
beq $22, $0, .+16
|
|
nop
|
|
b error_loop
|
|
nop
|
|
|
|
addiu $22, $0, 0x00
|
|
addiu $22, $14, -0x114
|
|
beq $22, $0, .+16
|
|
nop
|
|
b error_loop
|
|
nop
|
|
|
|
addiu $22, $0, 0x00
|
|
addiu $22, $15, -0x115
|
|
beq $22, $0, .+16
|
|
nop
|
|
b error_loop
|
|
nop
|
|
|
|
addiu $22, $0, 0x00
|
|
addiu $22, $16, -0x116
|
|
beq $22, $0, .+16
|
|
nop
|
|
b error_loop
|
|
nop
|
|
|
|
addiu $22, $0, 0x00
|
|
addiu $22, $17, -0x117
|
|
beq $22, $0, .+16
|
|
nop
|
|
b error_loop
|
|
nop
|
|
|
|
addiu $22, $0, 0x00
|
|
addiu $22, $18, -0x118
|
|
beq $22, $0, .+16
|
|
nop
|
|
b error_loop
|
|
nop
|
|
|
|
addiu $22, $0, 0x00
|
|
addiu $22, $19, -0x119
|
|
beq $22, $0, .+16
|
|
nop
|
|
b error_loop
|
|
nop
|
|
|
|
addiu $22, $0, 0x00
|
|
addiu $22, $20, -0x120
|
|
beq $22, $0, .+16
|
|
nop
|
|
b error_loop
|
|
nop
|
|
|
|
addiu $22, $0, 0x00
|
|
addiu $22, $21, -0x121
|
|
beq $22, $0, .+16
|
|
nop
|
|
b error_loop
|
|
nop
|
|
|
|
addiu $22, $0, 0x00
|
|
addiu $22, $23, -0x123
|
|
beq $22, $0, .+16
|
|
nop
|
|
b error_loop
|
|
nop
|
|
|
|
addiu $22, $0, 0x00
|
|
addiu $22, $24, -0x124
|
|
beq $22, $0, .+16
|
|
nop
|
|
b error_loop
|
|
nop
|
|
|
|
addiu $22, $0, 0x00
|
|
addiu $22, $25, -0x125
|
|
beq $22, $0, .+16
|
|
nop
|
|
b error_loop
|
|
nop
|
|
|
|
addiu $22, $0, 0x00
|
|
addiu $22, $30, -0x130
|
|
beq $22, $0, .+16
|
|
nop
|
|
b error_loop
|
|
nop
|
|
|
|
mfhi $22, $ac1
|
|
addiu $22, $22, -0x131
|
|
beq $22, $0, .+16
|
|
nop
|
|
b error_loop
|
|
nop
|
|
|
|
mflo $22, $ac1
|
|
addiu $22, $22, -0x132
|
|
beq $22, $0, .+16
|
|
nop
|
|
b error_loop
|
|
nop
|
|
|
|
mfhi $22, $ac2
|
|
addiu $22, $22, -0x133
|
|
beq $22, $0, .+16
|
|
nop
|
|
b error_loop
|
|
nop
|
|
|
|
mflo $22, $ac2
|
|
addiu $22, $22, -0x134
|
|
beq $22, $0, .+16
|
|
nop
|
|
b error_loop
|
|
nop
|
|
|
|
mfhi $22, $ac3
|
|
addiu $22, $22, -0x135
|
|
beq $22, $0, .+16
|
|
nop
|
|
b error_loop
|
|
nop
|
|
|
|
mflo $22, $ac3
|
|
addiu $22, $22, -0x136
|
|
beq $22, $0, .+16
|
|
nop
|
|
b error_loop
|
|
nop
|
|
|
|
/* No errors detected. Increment the loop count so the check timer knows
|
|
this task is still running without error, then loop back to do it all
|
|
again. The address of the loop counter is in $4. */
|
|
lw $22, 0( $4 )
|
|
addiu $22, $22, 0x01
|
|
sw $22, 0( $4 )
|
|
b vRegTest1Loop
|
|
nop
|
|
|
|
.end vRegTest1
|
|
|
|
|
|
.set noreorder
|
|
.set noat
|
|
.ent vRegTest2
|
|
|
|
vRegTest2:
|
|
addiu $1, $0, 0x21
|
|
addiu $2, $0, 0x22
|
|
addiu $3, $0, 0x23
|
|
/* $4 contains the address of the loop counter - don't mess with $4. */
|
|
addiu $5, $0, 0x25
|
|
addiu $6, $0, 0x26
|
|
addiu $7, $0, 0x27
|
|
addiu $8, $0, 0x28
|
|
addiu $9, $0, 0x29
|
|
addiu $10, $0, 0x210
|
|
addiu $11, $0, 0x211
|
|
addiu $12, $0, 0x212
|
|
addiu $13, $0, 0x213
|
|
addiu $14, $0, 0x214
|
|
addiu $15, $0, 0x215
|
|
addiu $16, $0, 0x216
|
|
addiu $17, $0, 0x217
|
|
addiu $18, $0, 0x218
|
|
addiu $19, $0, 0x219
|
|
addiu $20, $0, 0x220
|
|
addiu $21, $0, 0x221
|
|
addiu $23, $0, 0x223
|
|
addiu $24, $0, 0x224
|
|
addiu $25, $0, 0x225
|
|
addiu $30, $0, 0x230
|
|
addiu $22, $0, 0x231
|
|
mthi $22, $ac1
|
|
addiu $22, $0, 0x232
|
|
mtlo $22, $ac1
|
|
addiu $22, $0, 0x233
|
|
mthi $22, $ac2
|
|
addiu $22, $0, 0x234
|
|
mtlo $22, $ac2
|
|
addiu $22, $0, 0x235
|
|
mthi $22, $ac3
|
|
addiu $22, $0, 0x236
|
|
mtlo $22, $ac3
|
|
|
|
vRegTest2Loop:
|
|
addiu $22, $0, 0x00
|
|
addiu $22, $1, -0x21
|
|
beq $22, $0, .+16
|
|
nop
|
|
b error_loop
|
|
nop
|
|
|
|
addiu $22, $0, 0x00
|
|
addiu $22, $2, -0x22
|
|
beq $22, $0, .+16
|
|
nop
|
|
b error_loop
|
|
nop
|
|
|
|
addiu $22, $0, 0x00
|
|
addiu $22, $3, -0x23
|
|
beq $22, $0, .+16
|
|
nop
|
|
b error_loop
|
|
nop
|
|
|
|
addiu $22, $0, 0x00
|
|
addiu $22, $5, -0x25
|
|
beq $22, $0, .+16
|
|
nop
|
|
b error_loop
|
|
nop
|
|
|
|
addiu $22, $0, 0x00
|
|
addiu $22, $6, -0x26
|
|
beq $22, $0, .+16
|
|
nop
|
|
b error_loop
|
|
nop
|
|
|
|
addiu $22, $0, 0x00
|
|
addiu $22, $7, -0x27
|
|
beq $22, $0, .+16
|
|
nop
|
|
b error_loop
|
|
nop
|
|
|
|
addiu $22, $0, 0x00
|
|
addiu $22, $8, -0x28
|
|
beq $22, $0, .+16
|
|
nop
|
|
b error_loop
|
|
nop
|
|
|
|
addiu $22, $0, 0x00
|
|
addiu $22, $9, -0x29
|
|
beq $22, $0, .+16
|
|
nop
|
|
b error_loop
|
|
nop
|
|
|
|
addiu $22, $0, 0x00
|
|
addiu $22, $10, -0x210
|
|
beq $22, $0, .+16
|
|
nop
|
|
b error_loop
|
|
nop
|
|
|
|
addiu $22, $0, 0x00
|
|
addiu $22, $11, -0x211
|
|
beq $22, $0, .+16
|
|
nop
|
|
b error_loop
|
|
nop
|
|
|
|
addiu $22, $0, 0x00
|
|
addiu $22, $12, -0x212
|
|
beq $22, $0, .+16
|
|
nop
|
|
b error_loop
|
|
nop
|
|
|
|
addiu $22, $0, 0x00
|
|
addiu $22, $13, -0x213
|
|
beq $22, $0, .+16
|
|
nop
|
|
b error_loop
|
|
nop
|
|
|
|
addiu $22, $0, 0x00
|
|
addiu $22, $14, -0x214
|
|
beq $22, $0, .+16
|
|
nop
|
|
b error_loop
|
|
nop
|
|
|
|
addiu $22, $0, 0x00
|
|
addiu $22, $15, -0x215
|
|
beq $22, $0, .+16
|
|
nop
|
|
b error_loop
|
|
nop
|
|
|
|
addiu $22, $0, 0x00
|
|
addiu $22, $16, -0x216
|
|
beq $22, $0, .+16
|
|
nop
|
|
b error_loop
|
|
nop
|
|
|
|
addiu $22, $0, 0x00
|
|
addiu $22, $17, -0x217
|
|
beq $22, $0, .+16
|
|
nop
|
|
b error_loop
|
|
nop
|
|
|
|
addiu $22, $0, 0x00
|
|
addiu $22, $18, -0x218
|
|
beq $22, $0, .+16
|
|
nop
|
|
b error_loop
|
|
nop
|
|
|
|
addiu $22, $0, 0x00
|
|
addiu $22, $19, -0x219
|
|
beq $22, $0, .+16
|
|
nop
|
|
b error_loop
|
|
nop
|
|
|
|
addiu $22, $0, 0x00
|
|
addiu $22, $20, -0x220
|
|
beq $22, $0, .+16
|
|
nop
|
|
b error_loop
|
|
nop
|
|
|
|
addiu $22, $0, 0x00
|
|
addiu $22, $21, -0x221
|
|
beq $22, $0, .+16
|
|
nop
|
|
b error_loop
|
|
nop
|
|
|
|
addiu $22, $0, 0x00
|
|
addiu $22, $23, -0x223
|
|
beq $22, $0, .+16
|
|
nop
|
|
b error_loop
|
|
nop
|
|
|
|
addiu $22, $0, 0x00
|
|
addiu $22, $24, -0x224
|
|
beq $22, $0, .+16
|
|
nop
|
|
b error_loop
|
|
nop
|
|
|
|
addiu $22, $0, 0x00
|
|
addiu $22, $25, -0x225
|
|
beq $22, $0, .+16
|
|
nop
|
|
b error_loop
|
|
nop
|
|
|
|
addiu $22, $0, 0x00
|
|
addiu $22, $30, -0x230
|
|
beq $22, $0, .+16
|
|
nop
|
|
b error_loop
|
|
nop
|
|
|
|
mfhi $22, $ac1
|
|
addiu $22, $22, -0x231
|
|
beq $22, $0, .+16
|
|
nop
|
|
b error_loop
|
|
nop
|
|
|
|
mflo $22, $ac1
|
|
addiu $22, $22, -0x232
|
|
beq $22, $0, .+16
|
|
nop
|
|
b error_loop
|
|
nop
|
|
|
|
mfhi $22, $ac2
|
|
addiu $22, $22, -0x233
|
|
beq $22, $0, .+16
|
|
nop
|
|
b error_loop
|
|
nop
|
|
|
|
mflo $22, $ac2
|
|
addiu $22, $22, -0x234
|
|
beq $22, $0, .+16
|
|
nop
|
|
b error_loop
|
|
nop
|
|
|
|
mfhi $22, $ac3
|
|
addiu $22, $22, -0x235
|
|
beq $22, $0, .+16
|
|
nop
|
|
b error_loop
|
|
nop
|
|
|
|
mflo $22, $ac3
|
|
addiu $22, $22, -0x236
|
|
beq $22, $0, .+16
|
|
nop
|
|
b error_loop
|
|
nop
|
|
|
|
/* No errors detected. Increment the loop count so the check timer knows
|
|
this task is still running without error, then loop back to do it all
|
|
again. The address of the loop counter is in $4. */
|
|
lw $22, 0( $4 )
|
|
addiu $22, $22, 0x01
|
|
sw $22, 0( $4 )
|
|
b vRegTest2Loop
|
|
nop
|
|
|
|
.end vRegTest2
|
|
|
|
|
|
|