mirror of
https://github.com/FreeRTOS/FreeRTOS-Kernel.git
synced 2025-05-01 02:42:13 -04:00
659 lines
14 KiB
ArmAsm
659 lines
14 KiB
ArmAsm
/*
|
|
FreeRTOS V8.2.0rc1 - Copyright (C) 2014 Real Time Engineers Ltd.
|
|
All rights reserved
|
|
|
|
VISIT http://www.FreeRTOS.org TO ENSURE YOU ARE USING THE LATEST VERSION.
|
|
|
|
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 on 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?". Have you defined configASSERT()? *
|
|
* *
|
|
* http://www.FreeRTOS.org/FAQHelp.html *
|
|
* *
|
|
***************************************************************************
|
|
|
|
***************************************************************************
|
|
* *
|
|
* FreeRTOS provides completely free yet professionally developed, *
|
|
* robust, strictly quality controlled, supported, and cross *
|
|
* platform software that is more than just the market leader, it *
|
|
* is the industry's de facto standard. *
|
|
* *
|
|
* Help yourself get started quickly while simultaneously helping *
|
|
* to support the FreeRTOS project by purchasing a FreeRTOS *
|
|
* tutorial book, reference manual, or both: *
|
|
* http://www.FreeRTOS.org/Documentation *
|
|
* *
|
|
***************************************************************************
|
|
|
|
***************************************************************************
|
|
* *
|
|
* Investing in training allows your team to be as productive as *
|
|
* possible as early as possible, lowering your overall development *
|
|
* cost, and enabling you to bring a more robust product to market *
|
|
* earlier than would otherwise be possible. Richard Barry is both *
|
|
* the architect and key author of FreeRTOS, and so also the world's *
|
|
* leading authority on what is the world's most popular real time *
|
|
* kernel for deeply embedded MCU designs. Obtaining your training *
|
|
* from Richard ensures your team will gain directly from his in-depth *
|
|
* product knowledge and years of usage experience. Contact Real Time *
|
|
* Engineers Ltd to enquire about the FreeRTOS Masterclass, presented *
|
|
* by Richard Barry: http://www.FreeRTOS.org/contact
|
|
* *
|
|
***************************************************************************
|
|
|
|
***************************************************************************
|
|
* *
|
|
* You are receiving this top quality software for free. Please play *
|
|
* fair and reciprocate by reporting any suspected issues and *
|
|
* participating in the community forum: *
|
|
* http://www.FreeRTOS.org/support *
|
|
* *
|
|
* Thank you! *
|
|
* *
|
|
***************************************************************************
|
|
|
|
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.FreeRTOS.org/labs - Where new FreeRTOS products go to incubate.
|
|
Come and try FreeRTOS+TCP, our new open source TCP/IP stack for FreeRTOS.
|
|
|
|
http://www.OpenRTOS.com - Real Time Engineers ltd license FreeRTOS to High
|
|
Integrity Systems ltd. to sell under the OpenRTOS brand. Low cost OpenRTOS
|
|
licenses offer ticketed support, indemnification and commercial 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
|
|
|
|
|
|
|