;
; 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