82 lines
1.8 KiB
ArmAsm
82 lines
1.8 KiB
ArmAsm
/*
|
|
* Copyright (c) 2006-2019, RT-Thread Development Team
|
|
*
|
|
* SPDX-License-Identifier: Apache-2.0
|
|
*
|
|
* Change Logs:
|
|
* Date Author Notes
|
|
* 2016-09-07 Urey first version
|
|
*/
|
|
|
|
#ifndef __ASSEMBLY__
|
|
#define __ASSEMBLY__
|
|
#endif
|
|
|
|
#include "../common/mips.h"
|
|
|
|
.global rt_thread_switch_interrupt_flag
|
|
.global rt_interrupt_from_thread
|
|
.global rt_interrupt_to_thread
|
|
|
|
.section .text,"ax",@progbits
|
|
.set noreorder
|
|
.set noat
|
|
|
|
.globl rt_hw_interrupt_disable
|
|
rt_hw_interrupt_disable:
|
|
mfc0 v0,CP0_STATUS
|
|
srl v1,v0,1
|
|
sll v1,v1,1
|
|
# and v1,v0,0xfffffffe
|
|
mtc0 v1,CP0_STATUS
|
|
jr ra
|
|
nop
|
|
|
|
LEAF(rt_hw_interrupt_enable)
|
|
mtc0 a0,CP0_STATUS
|
|
jr ra
|
|
nop
|
|
END(rt_hw_interrupt_enable)
|
|
|
|
/*
|
|
* void rt_hw_context_switch_to(rt_uint32 to)/*
|
|
* a0 --> to
|
|
*/
|
|
LEAF(rt_hw_context_switch_to)
|
|
lw sp , 0(a0) /* switch to the new stack */
|
|
RESTORE_CONTEXT
|
|
END(rt_hw_context_switch_to)
|
|
|
|
/*
|
|
* void rt_hw_context_switch(rt_uint32 from, rt_uint32 to)
|
|
* a0 --> from
|
|
* a1 --> to
|
|
*/
|
|
LEAF(rt_hw_context_switch)
|
|
mtc0 ra, CP0_EPC
|
|
SAVE_CONTEXT
|
|
|
|
sw sp, 0(a0) /* store sp in preempted tasks TCB */
|
|
lw sp, 0(a1) /* get new task stack pointer */
|
|
|
|
RESTORE_CONTEXT
|
|
END(rt_hw_context_switch)
|
|
|
|
LEAF(rt_hw_context_switch_interrupt)
|
|
la t0, rt_thread_switch_interrupt_flag
|
|
lw t1, 0(t0)
|
|
nop
|
|
bnez t1, _reswitch
|
|
nop
|
|
li t1, 0x01 /* set rt_thread_switch_interrupt_flag to 1 */
|
|
sw t1, 0(t0)
|
|
la t0, rt_interrupt_from_thread /* set rt_interrupt_from_thread */
|
|
sw a0, 0(t0)
|
|
_reswitch:
|
|
la t0, rt_interrupt_to_thread /* set rt_interrupt_to_thread */
|
|
sw a1, 0(t0)
|
|
jr ra
|
|
nop
|
|
END(rt_hw_context_switch_interrupt)
|
|
|