330 lines
7.1 KiB
ArmAsm
330 lines
7.1 KiB
ArmAsm
|
;
|
||
|
|
; Copyright (c) 2006-2018, RT-Thread Development Team
|
||
|
|
;
|
||
|
|
; SPDX-License-Identifier: Apache-2.0
|
||
|
|
;
|
||
|
|
; Change Logs:
|
||
|
|
; Date Author Notes
|
||
|
|
; 2018-09-01 xuzhuoyi the first version.
|
||
|
|
; 2019-06-17 zhaoxiaowei fix bugs of old c28x interrupt api.
|
||
|
|
; 2019-07-03 zhaoxiaowei add _rt_hw_calc_csb function to support __rt_ffs.
|
||
|
|
; 2019-12-05 xiaolifan add support for hardware fpu32
|
||
|
|
;
|
||
|
|
|
||
|
|
.ref _rt_interrupt_to_thread
|
||
|
|
.ref _rt_interrupt_from_thread
|
||
|
|
.ref _rt_thread_switch_interrupt_flag
|
||
|
|
|
||
|
|
.def _RTOSINT_Handler
|
||
|
|
.def _rt_hw_get_st0
|
||
|
|
.def _rt_hw_get_st1
|
||
|
|
.def _rt_hw_calc_csb
|
||
|
|
.def _rt_hw_context_switch_interrupt
|
||
|
|
.def _rt_hw_context_switch
|
||
|
|
.def _rt_hw_context_switch_to
|
||
|
|
.def _rt_hw_interrupt_thread_switch
|
||
|
|
.def _rt_hw_interrupt_disable
|
||
|
|
.def _rt_hw_interrupt_enable
|
||
|
|
|
||
|
|
;workaround for importing fpu settings from the compiler
|
||
|
|
.cdecls C,NOLIST
|
||
|
|
%{
|
||
|
|
#ifdef __TMS320C28XX_FPU32__
|
||
|
|
#define __FPU32__ 1
|
||
|
|
#else
|
||
|
|
#define __FPU32__ 0
|
||
|
|
#endif
|
||
|
|
%}
|
||
|
|
|
||
|
|
|
||
|
|
RT_CTX_SAVE .macro
|
||
|
|
|
||
|
|
|
||
|
|
PUSH AR1H:AR0H
|
||
|
|
PUSH XAR2
|
||
|
|
PUSH XAR3
|
||
|
|
PUSH XAR4
|
||
|
|
PUSH XAR5
|
||
|
|
PUSH XAR6
|
||
|
|
PUSH XAR7
|
||
|
|
PUSH XT
|
||
|
|
PUSH RPC
|
||
|
|
|
||
|
|
.if __FPU32__
|
||
|
|
PUSH RB
|
||
|
|
MOV32 *SP++, STF
|
||
|
|
MOV32 *SP++, R0H
|
||
|
|
MOV32 *SP++, R1H
|
||
|
|
MOV32 *SP++, R2H
|
||
|
|
MOV32 *SP++, R3H
|
||
|
|
MOV32 *SP++, R4H
|
||
|
|
MOV32 *SP++, R5H
|
||
|
|
MOV32 *SP++, R6H
|
||
|
|
MOV32 *SP++, R7H
|
||
|
|
.endif
|
||
|
|
|
||
|
|
.endm
|
||
|
|
|
||
|
|
|
||
|
|
RT_CTX_RESTORE .macro
|
||
|
|
|
||
|
|
.if __FPU32__
|
||
|
|
MOV32 R7H, *--SP, UNCF
|
||
|
|
MOV32 R6H, *--SP, UNCF
|
||
|
|
MOV32 R5H, *--SP, UNCF
|
||
|
|
MOV32 R4H, *--SP, UNCF
|
||
|
|
MOV32 R3H, *--SP, UNCF
|
||
|
|
MOV32 R2H, *--SP, UNCF
|
||
|
|
MOV32 R1H, *--SP, UNCF
|
||
|
|
MOV32 R0H, *--SP, UNCF
|
||
|
|
MOV32 STF, *--SP
|
||
|
|
POP RB
|
||
|
|
.endif
|
||
|
|
|
||
|
|
POP RPC
|
||
|
|
POP XT
|
||
|
|
POP XAR7
|
||
|
|
POP XAR6
|
||
|
|
POP XAR5
|
||
|
|
POP XAR4
|
||
|
|
POP XAR3
|
||
|
|
POP XAR2
|
||
|
|
|
||
|
|
|
||
|
|
MOVZ AR0 , @SP
|
||
|
|
SUBB XAR0, #6
|
||
|
|
MOVL ACC , *XAR0
|
||
|
|
AND ACC, #0xFFFF << 16
|
||
|
|
MOV AL, IER
|
||
|
|
MOVL *XAR0, ACC
|
||
|
|
|
||
|
|
|
||
|
|
POP AR1H:AR0H
|
||
|
|
|
||
|
|
.endm
|
||
|
|
|
||
|
|
|
||
|
|
.text
|
||
|
|
.newblock
|
||
|
|
|
||
|
|
;
|
||
|
|
; rt_base_t rt_hw_interrupt_disable();
|
||
|
|
;
|
||
|
|
.asmfunc
|
||
|
|
_rt_hw_interrupt_disable:
|
||
|
|
PUSH ST1
|
||
|
|
SETC INTM,DBGM
|
||
|
|
MOV AL, *--SP
|
||
|
|
LRETR
|
||
|
|
.endasmfunc
|
||
|
|
|
||
|
|
;
|
||
|
|
; void rt_hw_interrupt_enable(rt_base_t level);
|
||
|
|
;
|
||
|
|
.asmfunc
|
||
|
|
_rt_hw_interrupt_enable:
|
||
|
|
MOV *SP++, AL
|
||
|
|
POP ST1
|
||
|
|
LRETR
|
||
|
|
.endasmfunc
|
||
|
|
|
||
|
|
;
|
||
|
|
; void rt_hw_context_switch(rt_uint32 from, rt_uint32 to);
|
||
|
|
; r0 --> from
|
||
|
|
; r4 --> to
|
||
|
|
|
||
|
|
|
||
|
|
.asmfunc
|
||
|
|
_rt_hw_context_switch_interrupt:
|
||
|
|
MOVL XAR0, #0
|
||
|
|
MOV AR0, AL
|
||
|
|
MOVL XAR4, *-SP[4]
|
||
|
|
; set rt_thread_switch_interrupt_flag to 1
|
||
|
|
MOVL XAR5, #_rt_thread_switch_interrupt_flag
|
||
|
|
MOVL XAR6, *XAR5
|
||
|
|
MOVL ACC, XAR6
|
||
|
|
CMPB AL, #1
|
||
|
|
B _reswitch, EQ
|
||
|
|
MOVL XAR6, #1
|
||
|
|
MOVL *XAR5, XAR6
|
||
|
|
|
||
|
|
MOVL XAR5, #_rt_interrupt_from_thread ; set rt_interrupt_from_thread
|
||
|
|
MOVL *XAR5, XAR0
|
||
|
|
|
||
|
|
_reswitch:
|
||
|
|
MOVL XAR5, #_rt_interrupt_to_thread ; set rt_interrupt_to_thread
|
||
|
|
MOVL *XAR5, XAR4
|
||
|
|
|
||
|
|
LRETR
|
||
|
|
.endasmfunc
|
||
|
|
|
||
|
|
;
|
||
|
|
; void rt_hw_context_switch(rt_uint32 from, rt_uint32 to);
|
||
|
|
; r0 --> from
|
||
|
|
; r4 --> to
|
||
|
|
|
||
|
|
|
||
|
|
.asmfunc
|
||
|
|
_rt_hw_context_switch:
|
||
|
|
MOVL XAR0, #0
|
||
|
|
MOV AR0, AL
|
||
|
|
MOVL XAR4, *-SP[4]
|
||
|
|
; set rt_thread_switch_interrupt_flag to 1
|
||
|
|
MOVL XAR5, #_rt_thread_switch_interrupt_flag
|
||
|
|
MOVL XAR6, *XAR5
|
||
|
|
MOVL ACC, XAR6
|
||
|
|
CMPB AL, #1
|
||
|
|
B _reswitch2, EQ
|
||
|
|
MOVL XAR6, #1
|
||
|
|
MOVL *XAR5, XAR6
|
||
|
|
|
||
|
|
MOVL XAR5, #_rt_interrupt_from_thread ; set rt_interrupt_from_thread
|
||
|
|
MOVL *XAR5, XAR0
|
||
|
|
|
||
|
|
_reswitch2:
|
||
|
|
MOVL XAR5, #_rt_interrupt_to_thread ; set rt_interrupt_to_thread
|
||
|
|
MOVL *XAR5, XAR4
|
||
|
|
|
||
|
|
TRAP #16
|
||
|
|
LRETR
|
||
|
|
.endasmfunc
|
||
|
|
|
||
|
|
.asmfunc
|
||
|
|
_RTOSINT_Handler:
|
||
|
|
; disable interrupt to protect context switch
|
||
|
|
DINT
|
||
|
|
|
||
|
|
; get rt_thread_switch_interrupt_flag
|
||
|
|
MOV AR0, #_rt_thread_switch_interrupt_flag
|
||
|
|
MOV AL, *AR0
|
||
|
|
MOV AR1, AL
|
||
|
|
CMP AR1, #0
|
||
|
|
B rtosint_exit, EQ ; pendsv already handled
|
||
|
|
|
||
|
|
; clear rt_thread_switch_interrupt_flag to 0
|
||
|
|
MOV AR1, #0x00
|
||
|
|
MOV *AR0, AR1
|
||
|
|
|
||
|
|
MOV AR0, #_rt_interrupt_from_thread
|
||
|
|
MOV AL, *AR0
|
||
|
|
MOV AR1, AL
|
||
|
|
CMP AR1, #0
|
||
|
|
B switch_to_thread, EQ ; skip register save at the first time
|
||
|
|
|
||
|
|
;#if defined (__VFP_FP__) && !defined(__SOFTFP__)
|
||
|
|
; TST lr, #0x10 ; if(!EXC_RETURN[4])
|
||
|
|
; VSTMDBEQ r1!, {d8 - d15} ; push FPU register s16~s31
|
||
|
|
;#endif
|
||
|
|
|
||
|
|
RT_CTX_SAVE ; push r4 - r11 register
|
||
|
|
|
||
|
|
;#if defined (__VFP_FP__) && !defined(__SOFTFP__)
|
||
|
|
; MOV r4, #0x00 ; flag = 0
|
||
|
|
|
||
|
|
; TST lr, #0x10 ; if(!EXC_RETURN[4])
|
||
|
|
; MOVEQ r4, #0x01 ; flag = 1
|
||
|
|
|
||
|
|
; STMFD r1!, {r4} ; push flag
|
||
|
|
;#endif
|
||
|
|
|
||
|
|
MOV AL, *AR0
|
||
|
|
MOV AR0, AL
|
||
|
|
MOVZ AR1, @SP ; get from thread stack pointer
|
||
|
|
MOV *AR0, AR1 ; update from thread stack pointer
|
||
|
|
|
||
|
|
switch_to_thread:
|
||
|
|
MOV AR1, #_rt_interrupt_to_thread
|
||
|
|
MOV AL, *AR1
|
||
|
|
MOV AR1, AL
|
||
|
|
MOV AL, *AR1
|
||
|
|
MOV AR1, AL ; load thread stack pointer
|
||
|
|
|
||
|
|
;#if defined (__VFP_FP__) && !defined(__SOFTFP__)
|
||
|
|
; LDMFD r1!, {r3} ; pop flag
|
||
|
|
;#endif
|
||
|
|
|
||
|
|
MOV @SP, AR1
|
||
|
|
|
||
|
|
RT_CTX_RESTORE ; pop r4 - r11 register
|
||
|
|
|
||
|
|
rtosint_exit:
|
||
|
|
; restore interrupt
|
||
|
|
EINT
|
||
|
|
|
||
|
|
IRET
|
||
|
|
.endasmfunc
|
||
|
|
|
||
|
|
.asmfunc
|
||
|
|
_rt_hw_get_st0:
|
||
|
|
PUSH ST0
|
||
|
|
POP AL
|
||
|
|
LRETR
|
||
|
|
.endasmfunc
|
||
|
|
|
||
|
|
.asmfunc
|
||
|
|
_rt_hw_get_st1:
|
||
|
|
PUSH ST1
|
||
|
|
POP AL
|
||
|
|
LRETR
|
||
|
|
.endasmfunc
|
||
|
|
|
||
|
|
; C28x do not have a build-in "__ffs" func in its C compiler.
|
||
|
|
; We can use the "Count Sign Bits" (CSB) instruction to make one.
|
||
|
|
; CSB will return the number of 0's minus 1 above the highest set bit.
|
||
|
|
; The count is placed in T. For example:
|
||
|
|
; ACC T maxbit
|
||
|
|
; 0x00000001 30 0
|
||
|
|
; 0x00000010 26 4
|
||
|
|
; 0x000001FF 22 8
|
||
|
|
; 0x000001F0 22 8
|
||
|
|
.asmfunc
|
||
|
|
_rt_hw_calc_csb:
|
||
|
|
MOV AH, #0
|
||
|
|
CSB ACC ; T = no. of sign bits - 1
|
||
|
|
MOVU ACC, T ; ACC = no. of sign bits - 1
|
||
|
|
SUBB ACC, #30 ; ACC = ACC - 30
|
||
|
|
ABS ACC ; ACC = |ACC|
|
||
|
|
lretr
|
||
|
|
.endasmfunc
|
||
|
|
|
||
|
|
;
|
||
|
|
; * void rt_hw_context_switch_to(rt_uint32 to);
|
||
|
|
; * r0 --> to
|
||
|
|
|
||
|
|
.asmfunc
|
||
|
|
_rt_hw_context_switch_to:
|
||
|
|
MOV AR1, #_rt_interrupt_to_thread
|
||
|
|
MOV *AR1, AL
|
||
|
|
|
||
|
|
;#if defined (__VFP_FP__) && !defined(__SOFTFP__)
|
||
|
|
; CLEAR CONTROL.FPCA
|
||
|
|
; MRS r2, CONTROL ; read
|
||
|
|
; BIC r2, #0x04 ; modify
|
||
|
|
; MSR CONTROL, r2 ; write-back
|
||
|
|
;#endif
|
||
|
|
|
||
|
|
; set from thread to 0
|
||
|
|
MOV AR1, #_rt_interrupt_from_thread
|
||
|
|
MOV AR0, #0x0
|
||
|
|
MOV *AR1, AR0
|
||
|
|
|
||
|
|
; set interrupt flag to 1
|
||
|
|
MOV AR1, #_rt_thread_switch_interrupt_flag
|
||
|
|
MOV AR0, #1
|
||
|
|
MOV *AR1, AR0
|
||
|
|
|
||
|
|
TRAP #16
|
||
|
|
|
||
|
|
|
||
|
|
; never reach here!
|
||
|
|
.endasmfunc
|
||
|
|
|
||
|
|
; compatible with old version
|
||
|
|
.asmfunc
|
||
|
|
_rt_hw_interrupt_thread_switch:
|
||
|
|
LRETR
|
||
|
|
NOP
|
||
|
|
.endasmfunc
|
||
|
|
|
||
|
|
.end
|