risc-v-tlm/tests/FreeRTOS/portasm.S

300 lines
9.4 KiB
ArmAsm
Raw Normal View History

/*
FreeRTOS V8.2.3 - Copyright (C) 2015 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 and was contributed
to the project by Technolution B.V. (www.technolution.nl,
freertos-riscv@technolution.eu) under the terms of the FreeRTOS
contributors license.
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
***************************************************************************
* *
* 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 *
* *
***************************************************************************
http://www.FreeRTOS.org/FAQHelp.html - Having a problem? Start by reading
the FAQ page "My application does not run, what could be wrong?". Have you
defined configASSERT()?
http://www.FreeRTOS.org/support - In return for receiving this top quality
embedded software for free we request you assist our global community by
participating in the support forum.
http://www.FreeRTOS.org/training - Investing in training allows your team to
be as productive as possible as early as possible. Now you can receive
FreeRTOS training directly from Richard Barry, CEO of Real Time Engineers
Ltd, and the world's leading authority on the world's leading RTOS.
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!
*/
#ifdef __riscv64
# define STORE sd
# define LOAD ld
# define REGBYTES 8
#else
# define STORE sw
# define LOAD lw
# define REGBYTES 4
#endif
#define MSTATUS_PRV1 0x30
//#define MSTATUS_PRV1 0x1880
.global portSAVE_CONTEXT
.global portRESTORE_CONTEXT
.global TIMER_CMP_INT
.global xPortStartScheduler
.global vPortYield
.global vTaskIncrementTick
.global vPortEndScheduler
.global xExitStack
/* Macro for saving task context */
.macro portSAVE_CONTEXT
.global pxCurrentTCB
/* make room in stack */
addi sp, sp, -REGBYTES * 32
/* Save Context */
STORE x1, 0x0(sp)
STORE x2, 1 * REGBYTES(sp)
STORE x3, 2 * REGBYTES(sp)
STORE x4, 3 * REGBYTES(sp)
STORE x5, 4 * REGBYTES(sp)
STORE x6, 5 * REGBYTES(sp)
STORE x7, 6 * REGBYTES(sp)
STORE x8, 7 * REGBYTES(sp)
STORE x9, 8 * REGBYTES(sp)
STORE x10, 9 * REGBYTES(sp)
STORE x11, 10 * REGBYTES(sp)
STORE x12, 11 * REGBYTES(sp)
STORE x13, 12 * REGBYTES(sp)
STORE x14, 13 * REGBYTES(sp)
STORE x15, 14 * REGBYTES(sp)
STORE x16, 15 * REGBYTES(sp)
STORE x17, 16 * REGBYTES(sp)
STORE x18, 17 * REGBYTES(sp)
STORE x19, 18 * REGBYTES(sp)
STORE x20, 19 * REGBYTES(sp)
STORE x21, 20 * REGBYTES(sp)
STORE x22, 21 * REGBYTES(sp)
STORE x23, 22 * REGBYTES(sp)
STORE x24, 23 * REGBYTES(sp)
STORE x25, 24 * REGBYTES(sp)
STORE x26, 25 * REGBYTES(sp)
STORE x27, 26 * REGBYTES(sp)
STORE x28, 27 * REGBYTES(sp)
STORE x29, 28 * REGBYTES(sp)
STORE x30, 29 * REGBYTES(sp)
STORE x31, 30 * REGBYTES(sp)
/* Store current stackpointer in task control block (TCB) */
LOAD t0, pxCurrentTCB //pointer
STORE sp, 0x0(t0)
.endm
/* Saves current error program counter (EPC) as task program counter */
.macro portSAVE_EPC
csrr t0, mepc
STORE t0, 31 * REGBYTES(sp)
.endm
/* Saves current return adress (RA) as task program counter */
.macro portSAVE_RA
STORE ra, 31 * REGBYTES(sp)
.endm
/* Macro for restoring task context */
.macro portRESTORE_CONTEXT
.global pxCurrentTCB
/* Load stack pointer from the current TCB */
LOAD sp, pxCurrentTCB
LOAD sp, 0x0(sp)
/* Load task program counter */
LOAD t0, 31 * REGBYTES(sp)
csrw mepc, t0
/* Run in machine mode */
li t0, MSTATUS_PRV1
csrs mstatus, t0
/* Restore registers,
Skip global pointer because that does not change */
LOAD x1, 0x0(sp)
LOAD x4, 3 * REGBYTES(sp)
LOAD x5, 4 * REGBYTES(sp)
LOAD x6, 5 * REGBYTES(sp)
LOAD x7, 6 * REGBYTES(sp)
LOAD x8, 7 * REGBYTES(sp)
LOAD x9, 8 * REGBYTES(sp)
LOAD x10, 9 * REGBYTES(sp)
LOAD x11, 10 * REGBYTES(sp)
LOAD x12, 11 * REGBYTES(sp)
LOAD x13, 12 * REGBYTES(sp)
LOAD x14, 13 * REGBYTES(sp)
LOAD x15, 14 * REGBYTES(sp)
LOAD x16, 15 * REGBYTES(sp)
LOAD x17, 16 * REGBYTES(sp)
LOAD x18, 17 * REGBYTES(sp)
LOAD x19, 18 * REGBYTES(sp)
LOAD x20, 19 * REGBYTES(sp)
LOAD x21, 20 * REGBYTES(sp)
LOAD x22, 21 * REGBYTES(sp)
LOAD x23, 22 * REGBYTES(sp)
LOAD x24, 23 * REGBYTES(sp)
LOAD x25, 24 * REGBYTES(sp)
LOAD x26, 25 * REGBYTES(sp)
LOAD x27, 26 * REGBYTES(sp)
LOAD x28, 27 * REGBYTES(sp)
LOAD x29, 28 * REGBYTES(sp)
LOAD x30, 29 * REGBYTES(sp)
LOAD x31, 30 * REGBYTES(sp)
addi sp, sp, REGBYTES * 32
mret
.endm
/* Macro for restoring task context */
.align 2
TIMER_CMP_INT:
portSAVE_CONTEXT
portSAVE_EPC
jal vPortSysTickHandler
portRESTORE_CONTEXT
xPortStartScheduler:
#ifdef __gracefulExit
/* Stores context when starting the scheduler in xStartContext.
This is used for when you want to gracefully exit the scheduler.
For example if you want to test multiple instances after each other in one test suite.
*/
la t0, xStartContext
STORE x1, 0x0(t0)
STORE x2, 1 * REGBYTES(t0)
STORE x3, 2 * REGBYTES(t0)
STORE x4, 3 * REGBYTES(t0)
STORE x5, 4 * REGBYTES(t0)
STORE x6, 5 * REGBYTES(t0)
STORE x7, 6 * REGBYTES(t0)
STORE x8, 7 * REGBYTES(t0)
STORE x9, 8 * REGBYTES(t0)
STORE x10, 9 * REGBYTES(t0)
STORE x11, 10 * REGBYTES(t0)
STORE x12, 11 * REGBYTES(t0)
STORE x13, 12 * REGBYTES(t0)
STORE x14, 13 * REGBYTES(t0)
STORE x15, 14 * REGBYTES(t0)
STORE x16, 15 * REGBYTES(t0)
STORE x17, 16 * REGBYTES(t0)
STORE x18, 17 * REGBYTES(t0)
STORE x19, 18 * REGBYTES(t0)
STORE x20, 19 * REGBYTES(t0)
STORE x21, 20 * REGBYTES(t0)
STORE x22, 21 * REGBYTES(t0)
STORE x23, 22 * REGBYTES(t0)
STORE x24, 23 * REGBYTES(t0)
STORE x25, 24 * REGBYTES(t0)
STORE x26, 25 * REGBYTES(t0)
STORE x27, 26 * REGBYTES(t0)
STORE x28, 27 * REGBYTES(t0)
STORE x29, 28 * REGBYTES(t0)
STORE x30, 29 * REGBYTES(t0)
STORE x31, 30 * REGBYTES(t0)
#endif
jal vPortSetupTimer
portRESTORE_CONTEXT
.align 2
vPortEndScheduler:
#ifdef __gracefulExit
/* Load current context from xStartContext */
la t0, xStartContext
LOAD x1, 0x0(t0)
LOAD x2, 1 * REGBYTES(t0)
LOAD x3, 2 * REGBYTES(t0)
LOAD x4, 3 * REGBYTES(t0)
LOAD x5, 4 * REGBYTES(t0)
LOAD x6, 5 * REGBYTES(t0)
LOAD x7, 6 * REGBYTES(t0)
LOAD x8, 7 * REGBYTES(t0)
LOAD x9, 8 * REGBYTES(t0)
LOAD x10, 9 * REGBYTES(t0)
LOAD x11, 10 * REGBYTES(t0)
LOAD x12, 11 * REGBYTES(t0)
LOAD x13, 12 * REGBYTES(t0)
LOAD x14, 13 * REGBYTES(t0)
LOAD x15, 14 * REGBYTES(t0)
LOAD x16, 15 * REGBYTES(t0)
LOAD x17, 16 * REGBYTES(t0)
LOAD x18, 17 * REGBYTES(t0)
LOAD x19, 18 * REGBYTES(t0)
LOAD x20, 19 * REGBYTES(t0)
LOAD x21, 20 * REGBYTES(t0)
LOAD x22, 21 * REGBYTES(t0)
LOAD x23, 22 * REGBYTES(t0)
LOAD x24, 23 * REGBYTES(t0)
LOAD x25, 24 * REGBYTES(t0)
LOAD x26, 25 * REGBYTES(t0)
LOAD x27, 26 * REGBYTES(t0)
LOAD x28, 27 * REGBYTES(t0)
LOAD x29, 28 * REGBYTES(t0)
LOAD x30, 39 * REGBYTES(t0)
LOAD x31, 30 * REGBYTES(t0)
#endif
ret
.align 2
vPortYield:
csrci mstatus, 8
portSAVE_CONTEXT
portSAVE_RA
jal vTaskSwitchContext
portRESTORE_CONTEXT