1042 lines
27 KiB
C
1042 lines
27 KiB
C
/*
|
|
* Copyright (c) 2021-2023 HPMicro
|
|
*
|
|
* SPDX-License-Identifier: BSD-3-Clause
|
|
*
|
|
*/
|
|
|
|
#ifndef HPM_INTERRUPT_H
|
|
#define HPM_INTERRUPT_H
|
|
#include "riscv/riscv_core.h"
|
|
#include "hpm_common.h"
|
|
#include "hpm_plic_drv.h"
|
|
|
|
/**
|
|
* @brief INTERRUPT driver APIs
|
|
* @defgroup irq_interface INTERRUPT driver APIs
|
|
* @{
|
|
*/
|
|
|
|
#define M_MODE 0 /*!< Machine mode */
|
|
#define S_MODE 1 /*!< Supervisor mode */
|
|
|
|
#ifdef __cplusplus
|
|
extern "C" {
|
|
#endif
|
|
|
|
/* Machine mode API: these APIs are supposed to be called at machine mode */
|
|
|
|
/**
|
|
* @brief Enable global IRQ with mask
|
|
*
|
|
* @param[in] mask interrupt mask to be enabaled
|
|
*/
|
|
ATTR_ALWAYS_INLINE static inline void enable_global_irq(uint32_t mask)
|
|
{
|
|
set_csr(CSR_MSTATUS, mask);
|
|
}
|
|
|
|
/**
|
|
* @brief Disable global IRQ with mask return mstatus
|
|
*
|
|
* @param[in] mask interrupt mask to be disabled
|
|
* @retval current mstatus value before irq disabled
|
|
*/
|
|
ATTR_ALWAYS_INLINE static inline uint32_t disable_global_irq(uint32_t mask)
|
|
{
|
|
return read_clear_csr(CSR_MSTATUS, mask);
|
|
}
|
|
|
|
/**
|
|
* @brief Restore global IRQ with mask
|
|
*
|
|
* @param[in] mask interrupt mask to be restored
|
|
*/
|
|
ATTR_ALWAYS_INLINE static inline void restore_global_irq(uint32_t mask)
|
|
{
|
|
set_csr(CSR_MSTATUS, mask);
|
|
}
|
|
|
|
/**
|
|
* @brief Enable IRQ from interrupt controller
|
|
*
|
|
*/
|
|
ATTR_ALWAYS_INLINE static inline void enable_irq_from_intc(void)
|
|
{
|
|
set_csr(CSR_MIE, CSR_MIE_MEIE_MASK);
|
|
}
|
|
|
|
/**
|
|
* @brief Disable IRQ from interrupt controller
|
|
*
|
|
*/
|
|
ATTR_ALWAYS_INLINE static inline void disable_irq_from_intc(void)
|
|
{
|
|
clear_csr(CSR_MIE, CSR_MIE_MEIE_MASK);
|
|
}
|
|
|
|
/**
|
|
* @brief Enable machine timer IRQ
|
|
*/
|
|
ATTR_ALWAYS_INLINE static inline void enable_mchtmr_irq(void)
|
|
{
|
|
set_csr(CSR_MIE, CSR_MIE_MTIE_MASK);
|
|
}
|
|
|
|
/**
|
|
* @brief Disable machine timer IRQ
|
|
*
|
|
*/
|
|
ATTR_ALWAYS_INLINE static inline void disable_mchtmr_irq(void)
|
|
{
|
|
clear_csr(CSR_MIE, CSR_MIE_MTIE_MASK);
|
|
}
|
|
|
|
/**
|
|
* @brief Delegate IRQ handling
|
|
*
|
|
* @param[in] mask interrupt mask to be delegated
|
|
*/
|
|
ATTR_ALWAYS_INLINE static inline void delegate_irq(uint32_t mask)
|
|
{
|
|
set_csr(CSR_MIDELEG, mask);
|
|
}
|
|
|
|
/**
|
|
* @brief Undelegate IRQ handling
|
|
*
|
|
* @param[in] mask interrupt mask to be undelegated
|
|
*/
|
|
ATTR_ALWAYS_INLINE static inline void undelegate_irq(uint32_t mask)
|
|
{
|
|
clear_csr(CSR_MIDELEG, mask);
|
|
}
|
|
|
|
|
|
/* Supervisor mode API: these APIs are supposed to be called at supervisor mode */
|
|
|
|
/**
|
|
* @brief Enable global IRQ with mask for supervisor mode
|
|
*
|
|
* @param[in] mask interrupt mask to be enabaled
|
|
*/
|
|
ATTR_ALWAYS_INLINE static inline void enable_s_global_irq(uint32_t mask)
|
|
{
|
|
set_csr(CSR_SSTATUS, mask);
|
|
}
|
|
|
|
/**
|
|
* @brief Disable global IRQ with mask and return sstatus for supervisor mode
|
|
*
|
|
* @param[in] mask interrupt mask to be disabled
|
|
* @retval current sstatus value before irq mask is disabled
|
|
*/
|
|
ATTR_ALWAYS_INLINE static inline uint32_t disable_s_global_irq(uint32_t mask)
|
|
{
|
|
return read_clear_csr(CSR_SSTATUS, mask);
|
|
}
|
|
|
|
/**
|
|
* @brief Restore global IRQ with mask for supervisor mode
|
|
*
|
|
* @param[in] mask interrupt mask to be restored
|
|
*/
|
|
ATTR_ALWAYS_INLINE static inline void restore_s_global_irq(uint32_t mask)
|
|
{
|
|
set_csr(CSR_SSTATUS, mask);
|
|
}
|
|
|
|
|
|
/**
|
|
* @brief Disable IRQ from interrupt controller for supervisor mode
|
|
*
|
|
*/
|
|
ATTR_ALWAYS_INLINE static inline void disable_s_irq_from_intc(void)
|
|
{
|
|
clear_csr(CSR_SIE, CSR_SIE_SEIE_MASK);
|
|
}
|
|
|
|
/**
|
|
* @brief Enable IRQ from interrupt controller for supervisor mode
|
|
*
|
|
*/
|
|
ATTR_ALWAYS_INLINE static inline void enable_s_irq_from_intc(void)
|
|
{
|
|
set_csr(CSR_SIE, CSR_SIE_SEIE_MASK);
|
|
}
|
|
|
|
/**
|
|
* @brief Enable machine timer IRQ for supervisor mode
|
|
*/
|
|
ATTR_ALWAYS_INLINE static inline void enable_s_mchtmr_irq(void)
|
|
{
|
|
set_csr(CSR_SIE, CSR_SIE_STIE_MASK);
|
|
}
|
|
|
|
/**
|
|
* @brief Disable machine timer IRQ
|
|
*
|
|
*/
|
|
ATTR_ALWAYS_INLINE static inline void disable_s_mchtmr_irq(void)
|
|
{
|
|
clear_csr(CSR_SIE, CSR_SIE_STIE_MASK);
|
|
}
|
|
|
|
|
|
/*
|
|
* CPU Machine SWI control
|
|
*
|
|
* Machine SWI (MSIP) is connected to PLICSW irq 1.
|
|
*/
|
|
#define PLICSWI 1
|
|
|
|
/**
|
|
* @brief Initialize software interrupt
|
|
*
|
|
*/
|
|
ATTR_ALWAYS_INLINE static inline void intc_m_init_swi(void)
|
|
{
|
|
__plic_enable_irq(HPM_PLICSW_BASE, HPM_PLIC_TARGET_M_MODE, PLICSWI);
|
|
}
|
|
|
|
|
|
/**
|
|
* @brief Enable software interrupt
|
|
*
|
|
*/
|
|
ATTR_ALWAYS_INLINE static inline void intc_m_enable_swi(void)
|
|
{
|
|
set_csr(CSR_MIE, CSR_MIE_MSIE_MASK);
|
|
}
|
|
|
|
|
|
/**
|
|
* @brief Disable software interrupt
|
|
*
|
|
*/
|
|
ATTR_ALWAYS_INLINE static inline void intc_m_disable_swi(void)
|
|
{
|
|
clear_csr(CSR_MIE, CSR_MIE_MSIE_MASK);
|
|
}
|
|
|
|
|
|
/**
|
|
* @brief Trigger software interrupt
|
|
*
|
|
*/
|
|
ATTR_ALWAYS_INLINE static inline void intc_m_trigger_swi(void)
|
|
{
|
|
__plic_set_irq_pending(HPM_PLICSW_BASE, PLICSWI);
|
|
}
|
|
|
|
/**
|
|
* @brief Claim software interrupt
|
|
*
|
|
*/
|
|
ATTR_ALWAYS_INLINE static inline void intc_m_claim_swi(void)
|
|
{
|
|
__plic_claim_irq(HPM_PLICSW_BASE, 0);
|
|
}
|
|
|
|
/**
|
|
* @brief Complete software interrupt
|
|
*
|
|
*/
|
|
ATTR_ALWAYS_INLINE static inline void intc_m_complete_swi(void)
|
|
{
|
|
__plic_complete_irq(HPM_PLICSW_BASE, HPM_PLIC_TARGET_M_MODE, PLICSWI);
|
|
}
|
|
|
|
/*
|
|
* @brief Enable IRQ for machine mode
|
|
*
|
|
* @param[in] irq Interrupt number
|
|
*/
|
|
#define intc_m_enable_irq(irq) \
|
|
intc_enable_irq(HPM_PLIC_TARGET_M_MODE, irq)
|
|
|
|
/*
|
|
* @brief Disable IRQ for machine mode
|
|
*
|
|
* @param[in] irq Interrupt number
|
|
*/
|
|
#define intc_m_disable_irq(irq) \
|
|
intc_disable_irq(HPM_PLIC_TARGET_M_MODE, irq)
|
|
|
|
#define intc_m_set_threshold(threshold) \
|
|
intc_set_threshold(HPM_PLIC_TARGET_M_MODE, threshold)
|
|
|
|
/*
|
|
* @brief Complete IRQ for machine mode
|
|
*
|
|
* @param[in] irq Interrupt number
|
|
*/
|
|
#define intc_m_complete_irq(irq) \
|
|
intc_complete_irq(HPM_PLIC_TARGET_M_MODE, irq)
|
|
|
|
/*
|
|
* @brief Claim IRQ for machine mode
|
|
*
|
|
*/
|
|
#define intc_m_claim_irq() intc_claim_irq(HPM_PLIC_TARGET_M_MODE)
|
|
|
|
/*
|
|
* @brief Enable IRQ for machine mode with priority
|
|
*
|
|
* @param[in] irq Interrupt number
|
|
* @param[in] priority Priority of interrupt
|
|
*/
|
|
#define intc_m_enable_irq_with_priority(irq, priority) \
|
|
do { \
|
|
intc_set_irq_priority(irq, priority); \
|
|
intc_m_enable_irq(irq); \
|
|
} while (0)
|
|
|
|
|
|
|
|
/* Supervisor mode */
|
|
|
|
/**
|
|
* @brief Enable software interrupt for supervisor mode
|
|
*
|
|
*/
|
|
ATTR_ALWAYS_INLINE static inline void intc_s_enable_swi(void)
|
|
{
|
|
set_csr(CSR_SIE, CSR_SIE_SSIE_MASK);
|
|
}
|
|
|
|
|
|
/**
|
|
* @brief Disable software interrupt for supervisor mode
|
|
*
|
|
*/
|
|
ATTR_ALWAYS_INLINE static inline void intc_s_disable_swi(void)
|
|
{
|
|
clear_csr(CSR_SIE, CSR_SIE_SSIE_MASK);
|
|
}
|
|
|
|
|
|
/**
|
|
* @brief Trigger software interrupt for supervisor mode
|
|
*
|
|
*/
|
|
ATTR_ALWAYS_INLINE static inline void intc_s_trigger_swi(void)
|
|
{
|
|
set_csr(CSR_SIP, CSR_SIP_SSIP_MASK);
|
|
}
|
|
|
|
|
|
/**
|
|
* @brief Complete software interrupt for supervisor mode
|
|
*
|
|
*/
|
|
ATTR_ALWAYS_INLINE static inline void intc_s_complete_swi(void)
|
|
{
|
|
clear_csr(CSR_SIP, CSR_SIP_SSIP_MASK);
|
|
}
|
|
|
|
/*
|
|
* @brief Enable IRQ for supervisor mode
|
|
*
|
|
* @param[in] irq Interrupt number
|
|
*/
|
|
#define intc_s_enable_irq(irq) \
|
|
intc_enable_irq(HPM_PLIC_TARGET_S_MODE, irq)
|
|
|
|
/*
|
|
* @brief Disable IRQ for supervisor mode
|
|
*
|
|
* @param[in] irq Interrupt number
|
|
*/
|
|
#define intc_s_disable_irq(irq) \
|
|
intc_disable_irq(HPM_PLIC_TARGET_S_MODE, irq)
|
|
|
|
#define intc_set_s_threshold(threshold) \
|
|
intc_set_threshold(HPM_PLIC_TARGET_S_MODE, threshold)
|
|
|
|
/*
|
|
* @brief Complete IRQ for supervisor mode
|
|
*
|
|
* @param[in] irq Interrupt number
|
|
*/
|
|
#define intc_s_complete_irq(irq) \
|
|
intc_complete_irq(HPM_PLIC_TARGET_S_MODE, irq)
|
|
|
|
/*
|
|
* @brief Claim IRQ for supervisor mode
|
|
*
|
|
*/
|
|
#define intc_s_claim_irq() intc_claim_irq(HPM_PLIC_TARGET_S_MODE)
|
|
|
|
/*
|
|
* @brief Enable IRQ for supervisor mode with priority
|
|
*
|
|
* @param[in] irq Interrupt number
|
|
* @param[in] priority Priority of interrupt
|
|
*/
|
|
#define intc_s_enable_irq_with_priority(irq, priority) \
|
|
do { \
|
|
intc_set_irq_priority(irq, priority); \
|
|
intc_s_enable_irq(irq); \
|
|
} while (0)
|
|
|
|
|
|
/*
|
|
* @brief Enable specific interrupt
|
|
*
|
|
* @param[in] target Target to handle specific interrupt
|
|
* @param[in] irq Interrupt number
|
|
*/
|
|
ATTR_ALWAYS_INLINE static inline void intc_enable_irq(uint32_t target, uint32_t irq)
|
|
{
|
|
__plic_enable_irq(HPM_PLIC_BASE, target, irq);
|
|
}
|
|
|
|
/**
|
|
* @brief Set interrupt priority
|
|
*
|
|
* @param[in] irq Interrupt number
|
|
* @param[in] priority Priority of interrupt
|
|
*/
|
|
ATTR_ALWAYS_INLINE static inline void intc_set_irq_priority(uint32_t irq, uint32_t priority)
|
|
{
|
|
__plic_set_irq_priority(HPM_PLIC_BASE, irq, priority);
|
|
}
|
|
|
|
/**
|
|
* @brief Disable specific interrupt
|
|
*
|
|
* @param[in] target Target to handle specific interrupt
|
|
* @param[in] irq Interrupt number
|
|
*/
|
|
ATTR_ALWAYS_INLINE static inline void intc_disable_irq(uint32_t target, uint32_t irq)
|
|
{
|
|
__plic_disable_irq(HPM_PLIC_BASE, target, irq);
|
|
}
|
|
|
|
/**
|
|
* @brief Set interrupt threshold
|
|
*
|
|
* @param[in] target Target to handle specific interrupt
|
|
* @param[in] threshold Threshold of IRQ can be serviced
|
|
*/
|
|
ATTR_ALWAYS_INLINE static inline void intc_set_threshold(uint32_t target, uint32_t threshold)
|
|
{
|
|
__plic_set_threshold(HPM_PLIC_BASE, target, threshold);
|
|
}
|
|
|
|
/**
|
|
* @brief Claim IRQ
|
|
*
|
|
* @param[in] target Target to handle specific interrupt
|
|
*
|
|
*/
|
|
ATTR_ALWAYS_INLINE static inline uint32_t intc_claim_irq(uint32_t target)
|
|
{
|
|
return __plic_claim_irq(HPM_PLIC_BASE, target);
|
|
}
|
|
|
|
/**
|
|
* @brief Complete IRQ
|
|
*
|
|
* @param[in] target Target to handle specific interrupt
|
|
* @param[in] irq Specific IRQ to be completed
|
|
*
|
|
*/
|
|
ATTR_ALWAYS_INLINE static inline void intc_complete_irq(uint32_t target, uint32_t irq)
|
|
{
|
|
__plic_complete_irq(HPM_PLIC_BASE, target, irq);
|
|
}
|
|
|
|
/*
|
|
* Vectored based irq install and uninstall
|
|
*/
|
|
/* Machine mode */
|
|
extern int __vector_table[];
|
|
extern void default_irq_entry(void);
|
|
|
|
/**
|
|
* @brief Install ISR for certain IRQ for ram based vector table
|
|
*
|
|
* @param[in] irq Target interrupt number
|
|
* @param[in] isr Interrupt service routine
|
|
*
|
|
*/
|
|
ATTR_ALWAYS_INLINE static inline void install_isr(uint32_t irq, uint32_t isr)
|
|
{
|
|
__vector_table[irq] = isr;
|
|
}
|
|
|
|
/**
|
|
* @brief Uninstall ISR for certain IRQ for ram based vector table
|
|
*
|
|
* @param[in] irq Target interrupt number
|
|
*
|
|
*/
|
|
ATTR_ALWAYS_INLINE static inline void uninstall_isr(uint32_t irq)
|
|
{
|
|
__vector_table[irq] = (int) default_irq_entry;
|
|
}
|
|
|
|
/* Supervisor mode */
|
|
extern int __vector_s_table[];
|
|
extern void default_s_irq_entry(void);
|
|
/**
|
|
* @brief Install ISR for certain IRQ for ram based vector table for supervisor mode
|
|
*
|
|
* @param[in] irq Target interrupt number
|
|
* @param[in] isr Interrupt service routine
|
|
*
|
|
*/
|
|
ATTR_ALWAYS_INLINE static inline void install_s_isr(uint32_t irq, uint32_t isr)
|
|
{
|
|
__vector_s_table[irq] = isr;
|
|
}
|
|
|
|
/**
|
|
* @brief Uninstall ISR for certain IRQ for ram based vector table for supervisor mode
|
|
*
|
|
* @param[in] irq Target interrupt number
|
|
*
|
|
*/
|
|
ATTR_ALWAYS_INLINE static inline void uninstall_s_isr(uint32_t irq)
|
|
{
|
|
__vector_s_table[irq] = (int) default_s_irq_entry;
|
|
}
|
|
|
|
|
|
/*
|
|
* Inline nested irq entry/exit macros
|
|
*/
|
|
/*
|
|
* @brief Save CSR
|
|
* @param[in] r Target CSR to be saved
|
|
*/
|
|
#define SAVE_CSR(r) register long __##r = read_csr(r);
|
|
|
|
/*
|
|
* @brief Restore macro
|
|
*
|
|
* @param[in] r Target CSR to be restored
|
|
*/
|
|
#define RESTORE_CSR(r) write_csr(r, __##r);
|
|
|
|
#if defined(SUPPORT_PFT_ARCH) && SUPPORT_PFT_ARCH
|
|
#define SAVE_MXSTATUS() SAVE_CSR(CSR_MXSTATUS)
|
|
#define RESTORE_MXSTATUS() RESTORE_CSR(CSR_MXSTATUS)
|
|
#else
|
|
#define SAVE_MXSTATUS()
|
|
#define RESTORE_MXSTATUS()
|
|
#endif
|
|
|
|
#ifdef __riscv_flen
|
|
#define SAVE_FCSR() register int __fcsr = read_fcsr();
|
|
#define RESTORE_FCSR() write_fcsr(__fcsr);
|
|
#else
|
|
#define SAVE_FCSR()
|
|
#define RESTORE_FCSR()
|
|
#endif
|
|
|
|
#ifdef __riscv_dsp
|
|
#define SAVE_UCODE() SAVE_CSR(CSR_UCODE)
|
|
#define RESTORE_UCODE() RESTORE_CSR(CSR_UCODE)
|
|
#else
|
|
#define SAVE_UCODE()
|
|
#define RESTORE_UCODE()
|
|
#endif
|
|
|
|
#ifdef __riscv_flen
|
|
#if __riscv_flen == 32
|
|
/* RV32I caller registers + MCAUSE + MEPC + MSTATUS +MXSTATUS + 20 FPU caller registers +FCSR + UCODE (DSP) */
|
|
#define CONTEXT_REG_NUM (4 * (16 + 4 + 20))
|
|
#else /* __riscv_flen = 64 */
|
|
/* RV32I caller registers + MCAUSE + MEPC + MSTATUS +MXSTATUS + 20 DFPU caller + FCSR registers + UCODE (DSP) */
|
|
#define CONTEXT_REG_NUM (4 * (16 + 4 + 20 * 2))
|
|
#endif
|
|
|
|
#else
|
|
/* RV32I caller registers + MCAUSE + MEPC + MSTATUS +MXSTATUS + UCODE (DSP)*/
|
|
#define CONTEXT_REG_NUM (4 * (16 + 4))
|
|
#endif
|
|
|
|
#ifdef __riscv_flen
|
|
/*
|
|
* Save FPU caller registers:
|
|
* NOTE: To simplify the logic, the FPU caller registers are always stored at word offset 20 in the stack
|
|
*/
|
|
#if __riscv_flen == 32
|
|
#define SAVE_FPU_CONTEXT() { \
|
|
__asm volatile("\n\
|
|
c.fswsp ft0, 20*4(sp)\n\
|
|
c.fswsp ft1, 21*4(sp) \n\
|
|
c.fswsp ft2, 22*4(sp) \n\
|
|
c.fswsp ft3, 23*4(sp) \n\
|
|
c.fswsp ft4, 24*4(sp) \n\
|
|
c.fswsp ft5, 25*4(sp) \n\
|
|
c.fswsp ft6, 26*4(sp) \n\
|
|
c.fswsp ft7, 27*4(sp) \n\
|
|
c.fswsp fa0, 28*4(sp) \n\
|
|
c.fswsp fa1, 29*4(sp) \n\
|
|
c.fswsp fa2, 30*4(sp) \n\
|
|
c.fswsp fa3, 31*4(sp) \n\
|
|
c.fswsp fa4, 32*4(sp) \n\
|
|
c.fswsp fa5, 33*4(sp) \n\
|
|
c.fswsp fa6, 34*4(sp) \n\
|
|
c.fswsp fa7, 35*4(sp) \n\
|
|
c.fswsp ft8, 36*4(sp) \n\
|
|
c.fswsp ft9, 37*4(sp) \n\
|
|
c.fswsp ft10, 38*4(sp) \n\
|
|
c.fswsp ft11, 39*4(sp) \n");\
|
|
}
|
|
|
|
/*
|
|
* Restore FPU caller registers:
|
|
* NOTE: To simplify the logic, the FPU caller registers are always stored at word offset 20 in the stack
|
|
*/
|
|
#define RESTORE_FPU_CONTEXT() { \
|
|
__asm volatile("\n\
|
|
c.flwsp ft0, 20*4(sp)\n\
|
|
c.flwsp ft1, 21*4(sp) \n\
|
|
c.flwsp ft2, 22*4(sp) \n\
|
|
c.flwsp ft3, 23*4(sp) \n\
|
|
c.flwsp ft4, 24*4(sp) \n\
|
|
c.flwsp ft5, 25*4(sp) \n\
|
|
c.flwsp ft6, 26*4(sp) \n\
|
|
c.flwsp ft7, 27*4(sp) \n\
|
|
c.flwsp fa0, 28*4(sp) \n\
|
|
c.flwsp fa1, 29*4(sp) \n\
|
|
c.flwsp fa2, 30*4(sp) \n\
|
|
c.flwsp fa3, 31*4(sp) \n\
|
|
c.flwsp fa4, 32*4(sp) \n\
|
|
c.flwsp fa5, 33*4(sp) \n\
|
|
c.flwsp fa6, 34*4(sp) \n\
|
|
c.flwsp fa7, 35*4(sp) \n\
|
|
c.flwsp ft8, 36*4(sp) \n\
|
|
c.flwsp ft9, 37*4(sp) \n\
|
|
c.flwsp ft10, 38*4(sp) \n\
|
|
c.flwsp ft11, 39*4(sp) \n");\
|
|
}
|
|
#else /*__riscv_flen == 64*/
|
|
#define SAVE_FPU_CONTEXT() { \
|
|
__asm volatile("\n\
|
|
c.fsdsp ft0, 20*4(sp)\n\
|
|
c.fsdsp ft1, 22*4(sp) \n\
|
|
c.fsdsp ft2, 24*4(sp) \n\
|
|
c.fsdsp ft3, 26*4(sp) \n\
|
|
c.fsdsp ft4, 28*4(sp) \n\
|
|
c.fsdsp ft5, 30*4(sp) \n\
|
|
c.fsdsp ft6, 32*4(sp) \n\
|
|
c.fsdsp ft7, 34*4(sp) \n\
|
|
c.fsdsp fa0, 36*4(sp) \n\
|
|
c.fsdsp fa1, 38*4(sp) \n\
|
|
c.fsdsp fa2, 40*4(sp) \n\
|
|
c.fsdsp fa3, 42*4(sp) \n\
|
|
c.fsdsp fa4, 44*4(sp) \n\
|
|
c.fsdsp fa5, 46*4(sp) \n\
|
|
c.fsdsp fa6, 48*4(sp) \n\
|
|
c.fsdsp fa7, 50*4(sp) \n\
|
|
c.fsdsp ft8, 52*4(sp) \n\
|
|
c.fsdsp ft9, 54*4(sp) \n\
|
|
c.fsdsp ft10, 56*4(sp) \n\
|
|
c.fsdsp ft11, 58*4(sp) \n");\
|
|
}
|
|
|
|
/*
|
|
* Restore FPU caller registers:
|
|
* NOTE: To simplify the logic, the FPU caller registers are always stored at word offset 20 in the stack
|
|
*/
|
|
#define RESTORE_FPU_CONTEXT() { \
|
|
__asm volatile("\n\
|
|
c.fldsp ft0, 20*4(sp)\n\
|
|
c.fldsp ft1, 22*4(sp) \n\
|
|
c.fldsp ft2, 24*4(sp) \n\
|
|
c.fldsp ft3, 26*4(sp) \n\
|
|
c.fldsp ft4, 28*4(sp) \n\
|
|
c.fldsp ft5, 30*4(sp) \n\
|
|
c.fldsp ft6, 32*4(sp) \n\
|
|
c.fldsp ft7, 34*4(sp) \n\
|
|
c.fldsp fa0, 36*4(sp) \n\
|
|
c.fldsp fa1, 38*4(sp) \n\
|
|
c.fldsp fa2, 40*4(sp) \n\
|
|
c.fldsp fa3, 42*4(sp) \n\
|
|
c.fldsp fa4, 44*4(sp) \n\
|
|
c.fldsp fa5, 46*4(sp) \n\
|
|
c.fldsp fa6, 48*4(sp) \n\
|
|
c.fldsp fa7, 50*4(sp) \n\
|
|
c.fldsp ft8, 52*4(sp) \n\
|
|
c.fldsp ft9, 54*4(sp) \n\
|
|
c.fldsp ft10, 56*4(sp) \n\
|
|
c.fldsp ft11, 58*4(sp) \n");\
|
|
}
|
|
#endif
|
|
#else
|
|
#define SAVE_FPU_CONTEXT()
|
|
#define RESTORE_FPU_CONTEXT()
|
|
#endif
|
|
|
|
/**
|
|
* @brief Save the caller registers based on the RISC-V ABI specification
|
|
*/
|
|
#define SAVE_CALLER_CONTEXT() { \
|
|
__asm volatile("addi sp, sp, %0" : : "i"(-CONTEXT_REG_NUM) :);\
|
|
__asm volatile("\n\
|
|
c.swsp ra, 0*4(sp) \n\
|
|
c.swsp t0, 1*4(sp) \n\
|
|
c.swsp t1, 2*4(sp) \n\
|
|
c.swsp t2, 3*4(sp) \n\
|
|
c.swsp s0, 4*4(sp) \n\
|
|
c.swsp s1, 5*4(sp) \n\
|
|
c.swsp a0, 6*4(sp) \n\
|
|
c.swsp a1, 7*4(sp) \n\
|
|
c.swsp a2, 8*4(sp) \n\
|
|
c.swsp a3, 9*4(sp) \n\
|
|
c.swsp a4, 10*4(sp) \n\
|
|
c.swsp a5, 11*4(sp) \n\
|
|
c.swsp a6, 12*4(sp) \n\
|
|
c.swsp a7, 13*4(sp) \n\
|
|
c.swsp s2, 14*4(sp) \n\
|
|
c.swsp s3, 15*4(sp) \n\
|
|
c.swsp t3, 16*4(sp) \n\
|
|
c.swsp t4, 17*4(sp) \n\
|
|
c.swsp t5, 18*4(sp) \n\
|
|
c.swsp t6, 19*4(sp)"); \
|
|
SAVE_FPU_CONTEXT(); \
|
|
}
|
|
|
|
/**
|
|
* @brief Restore the caller registers based on the RISC-V ABI specification
|
|
*/
|
|
#define RESTORE_CALLER_CONTEXT() { \
|
|
__asm volatile("\n\
|
|
c.lwsp ra, 0*4(sp) \n\
|
|
c.lwsp t0, 1*4(sp) \n\
|
|
c.lwsp t1, 2*4(sp) \n\
|
|
c.lwsp t2, 3*4(sp) \n\
|
|
c.lwsp s0, 4*4(sp) \n\
|
|
c.lwsp s1, 5*4(sp) \n\
|
|
c.lwsp a0, 6*4(sp) \n\
|
|
c.lwsp a1, 7*4(sp) \n\
|
|
c.lwsp a2, 8*4(sp) \n\
|
|
c.lwsp a3, 9*4(sp) \n\
|
|
c.lwsp a4, 10*4(sp) \n\
|
|
c.lwsp a5, 11*4(sp) \n\
|
|
c.lwsp a6, 12*4(sp) \n\
|
|
c.lwsp a7, 13*4(sp) \n\
|
|
c.lwsp s2, 14*4(sp) \n\
|
|
c.lwsp s3, 15*4(sp) \n\
|
|
c.lwsp t3, 16*4(sp) \n\
|
|
c.lwsp t4, 17*4(sp) \n\
|
|
c.lwsp t5, 18*4(sp) \n\
|
|
c.lwsp t6, 19*4(sp) \n");\
|
|
RESTORE_FPU_CONTEXT(); \
|
|
__asm volatile("addi sp, sp, %0" : : "i"(CONTEXT_REG_NUM) :);\
|
|
}
|
|
|
|
#ifdef __riscv_flen
|
|
#define SAVE_FPU_STATE() { \
|
|
__asm volatile("frsr s1\n"); \
|
|
}
|
|
|
|
#define RESTORE_FPU_STATE() { \
|
|
__asm volatile("fssr s1\n"); \
|
|
}
|
|
#else
|
|
#define SAVE_FPU_STATE()
|
|
#define RESTORE_FPU_STATE()
|
|
#endif
|
|
|
|
#ifdef __riscv_dsp
|
|
/*
|
|
* Save DSP context
|
|
* NOTE: DSP context registers are stored at word offset 41 in the stack
|
|
*/
|
|
#define SAVE_DSP_CONTEXT() { \
|
|
__asm volatile("rdov s0\n"); \
|
|
}
|
|
/*
|
|
* @brief Restore DSP context
|
|
* @note DSP context registers are stored at word offset 41 in the stack
|
|
*/
|
|
#define RESTORE_DSP_CONTEXT() {\
|
|
__asm volatile("csrw ucode, s0\n"); \
|
|
}
|
|
|
|
#else
|
|
#define SAVE_DSP_CONTEXT()
|
|
#define RESTORE_DSP_CONTEXT()
|
|
#endif
|
|
|
|
/*
|
|
* @brief Enter Nested IRQ Handling
|
|
* @note To simplify the logic, Nested IRQ related registers are stored in the stack as below:
|
|
* MCAUSE - word offset 16 (not used in the vectored mode)
|
|
* EPC - word offset 17
|
|
* MSTATUS = word offset 18
|
|
* MXSTATUS = word offset 19
|
|
*/
|
|
#define ENTER_NESTED_IRQ_HANDLING_M() { \
|
|
__asm volatile("\n\
|
|
csrr s2, mepc \n\
|
|
csrr s3, mstatus \n");\
|
|
SAVE_FPU_STATE(); \
|
|
SAVE_DSP_CONTEXT(); \
|
|
__asm volatile ("\n\
|
|
c.li a5, 8\n\
|
|
csrs mstatus, a5\n"); \
|
|
}
|
|
|
|
/*
|
|
* @brief Complete IRQ Handling
|
|
*/
|
|
#define COMPLETE_IRQ_HANDLING_M(irq_num) { \
|
|
__asm volatile("\n\
|
|
lui a5, 0x1\n\
|
|
addi a5, a5, -2048\n\
|
|
csrc mie, a5\n"); \
|
|
__asm volatile("\n\
|
|
lui a4, 0xe4200\n");\
|
|
__asm volatile("li a3, %0" : : "i" (irq_num) :); \
|
|
__asm volatile("sw a3, 4(a4)\n\
|
|
fence io, io\n"); \
|
|
__asm volatile("csrs mie, a5"); \
|
|
}
|
|
|
|
/*
|
|
* @brief Exit Nested IRQ Handling
|
|
* @note To simplify the logic, Nested IRQ related registers are stored in the stack as below:
|
|
* MCAUSE - word offset 16 (not used in the vectored mode)
|
|
* EPC - word offset 17
|
|
* MSTATUS = word offset 18
|
|
* MXSTATUS = word offset 19
|
|
*/
|
|
#define EXIT_NESTED_IRQ_HANDLING_M() { \
|
|
__asm volatile("\n\
|
|
csrw mstatus, s3 \n\
|
|
csrw mepc, s2 \n");\
|
|
RESTORE_FPU_STATE(); \
|
|
RESTORE_DSP_CONTEXT(); \
|
|
}
|
|
|
|
|
|
#define ENTER_NESTED_IRQ_HANDLING_S() {\
|
|
__asm volatile("\n\
|
|
csrr s2, sepc \n\
|
|
csrr s3, sstatus \n");\
|
|
SAVE_FPU_STATE(); \
|
|
SAVE_DSP_CONTEXT(); \
|
|
__asm volatile ("\n\
|
|
c.li a5, 8\n\
|
|
csrs sstatus, a5\n"); \
|
|
}
|
|
#define COMPLETE_IRQ_HANDLING_S(irq_num) {\
|
|
__asm volatile("\n\
|
|
lui a5, 0x1\n\
|
|
addi a5, a5, -2048\n\
|
|
csrc sie, a5\n"); \
|
|
__asm volatile("\n\
|
|
lui a4, 0xe4201\n");\
|
|
__asm volatile("li a3, %0" : : "i" (irq_num) :); \
|
|
__asm volatile("sw a3, 4(a4)\n\
|
|
fence io, io\n"); \
|
|
__asm volatile("csrs sie, a5"); \
|
|
}
|
|
|
|
|
|
/*
|
|
* @brief Exit Nested IRQ Handling at supervisor mode
|
|
* @note To simplify the logic, Nested IRQ related registers are stored in the stack as below:
|
|
* SCAUSE - word offset 16 (not used in the vectored mode)
|
|
* EPC - word offset 17
|
|
* SSTATUS = word offset 18
|
|
*/
|
|
#define EXIT_NESTED_IRQ_HANDLING_S() { \
|
|
__asm volatile("\n\
|
|
csrw sstatus, s3 \n\
|
|
csrw sepc, s2 \n");\
|
|
RESTORE_FPU_STATE(); \
|
|
RESTORE_DSP_CONTEXT(); \
|
|
}
|
|
|
|
/* @brief Nested IRQ entry macro : Save CSRs and enable global irq. */
|
|
#define NESTED_IRQ_ENTER() \
|
|
SAVE_CSR(CSR_MEPC) \
|
|
SAVE_CSR(CSR_MSTATUS) \
|
|
SAVE_MXSTATUS() \
|
|
SAVE_FCSR() \
|
|
SAVE_UCODE() \
|
|
set_csr(CSR_MSTATUS, CSR_MSTATUS_MIE_MASK);
|
|
|
|
/* @brief Nested IRQ exit macro : Restore CSRs */
|
|
#define NESTED_IRQ_EXIT() \
|
|
RESTORE_CSR(CSR_MSTATUS) \
|
|
RESTORE_CSR(CSR_MEPC) \
|
|
RESTORE_MXSTATUS() \
|
|
RESTORE_FCSR() \
|
|
RESTORE_UCODE()
|
|
|
|
/*
|
|
* @brief Nested IRQ exit macro : Restore CSRs
|
|
* @param[in] irq Target interrupt number
|
|
*/
|
|
#define NESTED_VPLIC_COMPLETE_INTERRUPT(irq) \
|
|
do { \
|
|
clear_csr(CSR_MIE, CSR_MIP_MEIP_MASK); \
|
|
__plic_complete_irq(HPM_PLIC_BASE, HPM_PLIC_TARGET_M_MODE, irq); \
|
|
__asm volatile("fence io, io"); \
|
|
set_csr(CSR_MIE, CSR_MIP_MEIP_MASK); \
|
|
} while (0)
|
|
|
|
#ifdef __cplusplus
|
|
#define EXTERN_C extern "C"
|
|
#else
|
|
#define EXTERN_C
|
|
#endif
|
|
|
|
#define ISR_NAME_M(irq_num) default_isr_##irq_num
|
|
#define ISR_NAME_S(irq_num) default_isr_s_##irq_num
|
|
/**
|
|
* @brief Declare an external interrupt handler for machine mode
|
|
*
|
|
* @param[in] irq_num - IRQ number index
|
|
* @param[in] isr - Application IRQ handler function pointer
|
|
*/
|
|
#ifndef USE_NONVECTOR_MODE
|
|
|
|
#define SDK_DECLARE_EXT_ISR_M(irq_num, isr) \
|
|
void isr(void) __attribute__((section(".isr_vector")));\
|
|
EXTERN_C void ISR_NAME_M(irq_num)(void) __attribute__((section(".isr_vector")));\
|
|
void ISR_NAME_M(irq_num)(void) \
|
|
{ \
|
|
SAVE_CALLER_CONTEXT(); \
|
|
ENTER_NESTED_IRQ_HANDLING_M();\
|
|
__asm volatile("la t1, %0\n\t" : : "i" (isr) : );\
|
|
__asm volatile("jalr t1\n");\
|
|
COMPLETE_IRQ_HANDLING_M(irq_num);\
|
|
EXIT_NESTED_IRQ_HANDLING_M();\
|
|
RESTORE_CALLER_CONTEXT();\
|
|
__asm volatile("mret\n");\
|
|
}
|
|
|
|
/**
|
|
* @brief Declare an external interrupt handler for supervisor mode
|
|
*
|
|
* @param[in] irq_num - IRQ number index
|
|
* @param[in] isr - Application IRQ handler function pointer
|
|
*/
|
|
#define SDK_DECLARE_EXT_ISR_S(irq_num, isr) \
|
|
void isr(void) __attribute__((section(".isr_s_vector")));\
|
|
EXTERN_C void ISR_NAME_S(irq_num)(void) __attribute__((section(".isr_s_vector")));\
|
|
void ISR_NAME_S(irq_num)(void) {\
|
|
SAVE_CALLER_CONTEXT(); \
|
|
ENTER_NESTED_IRQ_HANDLING_S();\
|
|
__asm volatile("la t1, %0\n\t" : : "i" (isr) : );\
|
|
__asm volatile("jalr t1\n");\
|
|
COMPLETE_IRQ_HANDLING_S(irq_num);\
|
|
EXIT_NESTED_IRQ_HANDLING_S();\
|
|
RESTORE_CALLER_CONTEXT();\
|
|
__asm volatile("sret\n");\
|
|
}
|
|
|
|
#else
|
|
|
|
#define SDK_DECLARE_EXT_ISR_M(irq_num, isr) \
|
|
void isr(void) __attribute__((section(".isr_vector")));\
|
|
EXTERN_C void ISR_NAME_M(irq_num)(void) __attribute__((section(".isr_vector")));\
|
|
void ISR_NAME_M(irq_num)(void) { \
|
|
isr(); \
|
|
}
|
|
|
|
#define SDK_DECLARE_EXT_ISR_S(irq_num, isr) \
|
|
void isr(void) __attribute__((section(".isr_vector")));\
|
|
EXTERN_C void ISR_NAME_S(irq_num)(void) __attribute__((section(".isr_vector")));\
|
|
void ISR_NAME_S(irq_num)(void) { \
|
|
isr(); \
|
|
}
|
|
|
|
#endif
|
|
|
|
|
|
/**
|
|
* @brief Declare machine timer interrupt handler
|
|
*
|
|
* @param[in] isr - MCHTMR IRQ handler function pointer
|
|
*/
|
|
#define SDK_DECLARE_MCHTMR_ISR(isr) \
|
|
void isr(void) __attribute__((section(".isr_vector")));\
|
|
EXTERN_C void mchtmr_isr(void) __attribute__((section(".isr_vector"))); \
|
|
void mchtmr_isr(void) {\
|
|
isr();\
|
|
}
|
|
|
|
/**
|
|
* @brief Declare machine software interrupt handler
|
|
*
|
|
* @param[in] isr - SWI IRQ handler function pointer
|
|
*/
|
|
#define SDK_DECLARE_SWI_ISR(isr)\
|
|
void isr(void) __attribute__((section(".isr_vector")));\
|
|
EXTERN_C void swi_isr(void) __attribute__((section(".isr_vector"))); \
|
|
void swi_isr(void) {\
|
|
isr();\
|
|
}
|
|
|
|
/* Supervisor mode */
|
|
|
|
/**
|
|
* @brief Declare machine timer interrupt handler
|
|
*
|
|
* @param[in] isr - MCHTMR IRQ handler function pointer
|
|
*/
|
|
#define SDK_DECLARE_MCHTMR_ISR_S(isr) \
|
|
void isr(void) __attribute__((section(".isr_vector")));\
|
|
EXTERN_C void mchtmr_s_isr(void) __attribute__((section(".isr_vector"))); \
|
|
void mchtmr_s_isr(void) {\
|
|
isr();\
|
|
}
|
|
|
|
/**
|
|
* @brief Declare machine software interrupt handler
|
|
*
|
|
* @param[in] isr - SWI IRQ handler function pointer
|
|
*/
|
|
#define SDK_DECLARE_SWI_ISR_S(isr)\
|
|
void isr(void) __attribute__((section(".isr_vector")));\
|
|
EXTERN_C void swi_s_isr(void) __attribute__((section(".isr_vector"))); \
|
|
void swi_s_isr(void) {\
|
|
isr();\
|
|
}
|
|
|
|
#define CSR_MSTATUS_MPP_S_MODE (0x1)
|
|
#define MODE_SWITCH_FROM_M(mstatus, mepc, label, mode) \
|
|
do { \
|
|
if (label) { \
|
|
write_csr(mepc, label); \
|
|
} \
|
|
clear_csr(mstatus, CSR_MSTATUS_MPP_MASK); \
|
|
set_csr(mstatus, CSR_MSTATUS_MPP_SET(mode)); \
|
|
} while(0)
|
|
|
|
typedef void (*s_mode_entry)(void);
|
|
|
|
/**
|
|
* @brief Switch mode to supervisor from machine
|
|
*
|
|
* @param[in] entry - entry point after mode is switched
|
|
*/
|
|
static inline void switch_to_s_mode(s_mode_entry entry)
|
|
{
|
|
write_csr(CSR_SEPC, entry);
|
|
MODE_SWITCH_FROM_M(CSR_MSTATUS, CSR_MEPC, entry, CSR_MSTATUS_MPP_S_MODE);
|
|
if (entry) {
|
|
__asm("mret");
|
|
}
|
|
}
|
|
#ifdef __cplusplus
|
|
}
|
|
#endif
|
|
|
|
/**
|
|
* @}
|
|
*/
|
|
#endif /* HPM_INTERRUPT_H */
|