264 lines
6.7 KiB
NASM
264 lines
6.7 KiB
NASM
|
;
|
||
|
|
; Copyright (c) 2021, Shenzhen Academy of Aerospace Technology
|
||
|
|
;
|
||
|
|
; SPDX-License-Identifier: Apache-2.0
|
||
|
|
;
|
||
|
|
; Change Logs:
|
||
|
|
; Date Author Notes
|
||
|
|
; 2021-11-16 Dystopia the first version
|
||
|
|
;
|
||
|
|
|
||
|
|
;-----------------------------------------------------------
|
||
|
|
; interrupt and execption handler for C6000 DSP
|
||
|
|
;-----------------------------------------------------------
|
||
|
|
|
||
|
|
;-----------------------------------------------------------
|
||
|
|
; macro definition
|
||
|
|
;-----------------------------------------------------------
|
||
|
|
DP .set B14
|
||
|
|
SP .set B15
|
||
|
|
;
|
||
|
|
;-----------------------------------------------------------
|
||
|
|
;
|
||
|
|
.include "contextinc.asm"
|
||
|
|
;-----------------------------------------------------------
|
||
|
|
; global function
|
||
|
|
;-----------------------------------------------------------
|
||
|
|
.global _nmi_handler
|
||
|
|
.global _bad_handler
|
||
|
|
.global _int4_handler
|
||
|
|
.global _int5_handler
|
||
|
|
.global _int6_handler
|
||
|
|
.global _int7_handler
|
||
|
|
.global _int8_handler
|
||
|
|
.global _int9_handler
|
||
|
|
.global _int10_handler
|
||
|
|
.global _int11_handler
|
||
|
|
.global _int12_handler
|
||
|
|
.global _int13_handler
|
||
|
|
.global _int14_handler
|
||
|
|
.global _int15_handler
|
||
|
|
;
|
||
|
|
;-----------------------------------------------------------
|
||
|
|
;
|
||
|
|
|
||
|
|
;-----------------------------------------------------------
|
||
|
|
; extern function
|
||
|
|
;-----------------------------------------------------------
|
||
|
|
.ref hw_nmi_handler
|
||
|
|
.ref hw_bad_handler
|
||
|
|
.ref hw_int4_handler
|
||
|
|
.ref hw_int5_handler
|
||
|
|
.ref hw_int6_handler
|
||
|
|
.ref hw_int7_handler
|
||
|
|
.ref hw_int8_handler
|
||
|
|
.ref hw_int9_handler
|
||
|
|
.ref hw_int10_handler
|
||
|
|
.ref hw_int11_handler
|
||
|
|
.ref hw_int12_handler
|
||
|
|
.ref hw_int13_handler
|
||
|
|
.ref hw_int14_handler
|
||
|
|
.ref hw_int15_handler
|
||
|
|
.ref rt_hw_process_exception
|
||
|
|
.ref rt_interrupt_context_restore
|
||
|
|
;
|
||
|
|
;-----------------------------------------------------------
|
||
|
|
;
|
||
|
|
|
||
|
|
;-----------------------------------------------------------
|
||
|
|
; interrupt macro definition
|
||
|
|
;-----------------------------------------------------------
|
||
|
|
RT_INTERRUPT_ENTRY .macro
|
||
|
|
SAVE_ALL IRP,ITSR
|
||
|
|
.endm
|
||
|
|
|
||
|
|
RT_CALL_INT .macro __isr
|
||
|
|
B __isr
|
||
|
|
ADDKPC $1 ,B3,4
|
||
|
|
$1:
|
||
|
|
B .S1 rt_interrupt_context_restore
|
||
|
|
NOP 5
|
||
|
|
.endm
|
||
|
|
;-----------------------------------------------------------
|
||
|
|
; execption macro definition
|
||
|
|
;-----------------------------------------------------------
|
||
|
|
RT_EXECPTION_ENTRY .macro
|
||
|
|
SAVE_ALL NRP,NTSR
|
||
|
|
.endm
|
||
|
|
|
||
|
|
RT_EXECPTION_EXIT .macro
|
||
|
|
RESTORE_ALL NRP,NTSR
|
||
|
|
B .S2 NRP ; return from execption
|
||
|
|
NOP 5
|
||
|
|
.endm
|
||
|
|
|
||
|
|
;
|
||
|
|
;-----------------------------------------------------------
|
||
|
|
;
|
||
|
|
|
||
|
|
.sect ".text"
|
||
|
|
;
|
||
|
|
;-----------------------------------------------------------
|
||
|
|
;
|
||
|
|
|
||
|
|
;-----------------------------------------------------------
|
||
|
|
; handler NMI interrupt
|
||
|
|
;-----------------------------------------------------------
|
||
|
|
_nmi_handler:
|
||
|
|
;{
|
||
|
|
RT_EXECPTION_ENTRY
|
||
|
|
MVC .S2 EFR,B2
|
||
|
|
CMPEQ .L2 1,B2,B2
|
||
|
|
|| MVC .S2 TSR,B1
|
||
|
|
MV .D1X B2,A2
|
||
|
|
|| CLR .S2 B1,10,10,B1
|
||
|
|
MVC .S2 B1,TSR
|
||
|
|
[!A2] MVKL .S1 rt_hw_process_exception,A0
|
||
|
|
||[B2] MVKL .S2 rt_hw_software_exception,B1
|
||
|
|
[!A2] MVKH .S1 rt_hw_process_exception,A0
|
||
|
|
||[B2] MVKH .S2 rt_hw_software_exception,B1
|
||
|
|
[!B2] B .S2X A0
|
||
|
|
[B2] B .S2 B1
|
||
|
|
[!B2] ADDAW .D2 SP,2,B1
|
||
|
|
[!B2] MV .D1X B1,A4
|
||
|
|
ADDKPC .S2 ret_from_trap,B3,2
|
||
|
|
;
|
||
|
|
; return from trap
|
||
|
|
;
|
||
|
|
ret_from_trap:
|
||
|
|
MV .D2X A4,B0
|
||
|
|
[!B0] MVKL .S2 ret_from_exception,B3
|
||
|
|
[!B0] MVKH .S2 ret_from_exception,B3
|
||
|
|
[!B0] BNOP .S2 B3,5
|
||
|
|
;
|
||
|
|
; return from trap restore exception context
|
||
|
|
;
|
||
|
|
ret_from_exception:
|
||
|
|
RT_EXECPTION_EXIT
|
||
|
|
;
|
||
|
|
rt_hw_software_exception:
|
||
|
|
MVKL .S1 rt_hw_process_exception,A0
|
||
|
|
MVKH .S1 rt_hw_process_exception,A0
|
||
|
|
B .S2X A0
|
||
|
|
ADDAW .D2 SP,2,B1
|
||
|
|
MV .D1X B1,A4
|
||
|
|
ADDKPC .S2 ret_from_trap,B3,2
|
||
|
|
NOP 2
|
||
|
|
;}
|
||
|
|
|
||
|
|
;-----------------------------------------------------------
|
||
|
|
; handler bad interrupt
|
||
|
|
;-----------------------------------------------------------
|
||
|
|
_bad_handler:
|
||
|
|
;{
|
||
|
|
RT_INTERRUPT_ENTRY
|
||
|
|
RT_CALL_INT hw_bad_handler
|
||
|
|
;}
|
||
|
|
|
||
|
|
;-----------------------------------------------------------
|
||
|
|
; handler INT4 interrupt
|
||
|
|
;-----------------------------------------------------------
|
||
|
|
_int4_handler:
|
||
|
|
;{
|
||
|
|
RT_INTERRUPT_ENTRY
|
||
|
|
RT_CALL_INT hw_int4_handler
|
||
|
|
;}
|
||
|
|
|
||
|
|
;-----------------------------------------------------------
|
||
|
|
; handler INT5 interrupt
|
||
|
|
;-----------------------------------------------------------
|
||
|
|
_int5_handler:
|
||
|
|
;{
|
||
|
|
RT_INTERRUPT_ENTRY
|
||
|
|
RT_CALL_INT hw_int5_handler
|
||
|
|
;}
|
||
|
|
|
||
|
|
;-----------------------------------------------------------
|
||
|
|
; handler INT6 interrupt
|
||
|
|
;-----------------------------------------------------------
|
||
|
|
_int6_handler:
|
||
|
|
;{
|
||
|
|
RT_INTERRUPT_ENTRY
|
||
|
|
RT_CALL_INT hw_int6_handler
|
||
|
|
;}
|
||
|
|
|
||
|
|
;-----------------------------------------------------------
|
||
|
|
; handler INT7 interrupt
|
||
|
|
;-----------------------------------------------------------
|
||
|
|
_int7_handler:
|
||
|
|
;{
|
||
|
|
RT_INTERRUPT_ENTRY
|
||
|
|
RT_CALL_INT hw_int7_handler
|
||
|
|
;}
|
||
|
|
;-----------------------------------------------------------
|
||
|
|
; handler INT8 interrupt
|
||
|
|
;-----------------------------------------------------------
|
||
|
|
_int8_handler:
|
||
|
|
;{
|
||
|
|
RT_INTERRUPT_ENTRY
|
||
|
|
RT_CALL_INT hw_int8_handler
|
||
|
|
;}
|
||
|
|
|
||
|
|
;-----------------------------------------------------------
|
||
|
|
; handler INT9 interrupt
|
||
|
|
;-----------------------------------------------------------
|
||
|
|
_int9_handler:
|
||
|
|
;{
|
||
|
|
RT_INTERRUPT_ENTRY
|
||
|
|
RT_CALL_INT hw_int9_handler
|
||
|
|
;}
|
||
|
|
|
||
|
|
;-----------------------------------------------------------
|
||
|
|
; handler INT10 interrupt
|
||
|
|
;-----------------------------------------------------------
|
||
|
|
_int10_handler:
|
||
|
|
;{
|
||
|
|
RT_INTERRUPT_ENTRY
|
||
|
|
RT_CALL_INT hw_int10_handler
|
||
|
|
;}
|
||
|
|
|
||
|
|
;-----------------------------------------------------------
|
||
|
|
; handler INT11 interrupt
|
||
|
|
;-----------------------------------------------------------
|
||
|
|
_int11_handler:
|
||
|
|
;{
|
||
|
|
RT_INTERRUPT_ENTRY
|
||
|
|
RT_CALL_INT hw_int11_handler
|
||
|
|
;}
|
||
|
|
|
||
|
|
;-----------------------------------------------------------
|
||
|
|
; handler INT12 interrupt
|
||
|
|
;-----------------------------------------------------------
|
||
|
|
_int12_handler:
|
||
|
|
;{
|
||
|
|
RT_INTERRUPT_ENTRY
|
||
|
|
RT_CALL_INT hw_int12_handler
|
||
|
|
;}
|
||
|
|
|
||
|
|
;-----------------------------------------------------------
|
||
|
|
; handler INT13 interrupt
|
||
|
|
;-----------------------------------------------------------
|
||
|
|
_int13_handler:
|
||
|
|
;{
|
||
|
|
RT_INTERRUPT_ENTRY
|
||
|
|
RT_CALL_INT hw_int13_handler
|
||
|
|
;}
|
||
|
|
|
||
|
|
;-----------------------------------------------------------
|
||
|
|
; handler INT14 interrupt
|
||
|
|
;-----------------------------------------------------------
|
||
|
|
_int14_handler:
|
||
|
|
;{
|
||
|
|
RT_INTERRUPT_ENTRY
|
||
|
|
RT_CALL_INT hw_int14_handler
|
||
|
|
;}
|
||
|
|
;-----------------------------------------------------------
|
||
|
|
; handler INT15 interrupt
|
||
|
|
;-----------------------------------------------------------
|
||
|
|
_int15_handler:
|
||
|
|
;{
|
||
|
|
RT_INTERRUPT_ENTRY
|
||
|
|
RT_CALL_INT hw_int15_handler
|
||
|
|
;}
|
||
|
|
.end
|