195 lines
4.5 KiB
C
195 lines
4.5 KiB
C
/*
|
|
* Copyright (c) 2018 Intel Corporation
|
|
*
|
|
* SPDX-License-Identifier: Apache-2.0
|
|
*/
|
|
|
|
#ifndef INTERRUPT_UTIL_H_
|
|
#define INTERRUPT_UTIL_H_
|
|
|
|
#define MS_TO_US(ms) (ms * USEC_PER_MSEC)
|
|
|
|
#if defined(CONFIG_CPU_CORTEX_M)
|
|
#include <zephyr/arch/arm/aarch32/cortex_m/cmsis.h>
|
|
|
|
static inline uint32_t get_available_nvic_line(uint32_t initial_offset)
|
|
{
|
|
int i;
|
|
|
|
for (i = initial_offset - 1; i >= 0; i--) {
|
|
|
|
if (NVIC_GetEnableIRQ(i) == 0) {
|
|
/*
|
|
* Interrupts configured statically with IRQ_CONNECT(.)
|
|
* are automatically enabled. NVIC_GetEnableIRQ()
|
|
* returning false, here, implies that the IRQ line is
|
|
* either not implemented or it is not enabled, thus,
|
|
* currently not in use by Zephyr.
|
|
*/
|
|
|
|
/* Set the NVIC line to pending. */
|
|
NVIC_SetPendingIRQ(i);
|
|
|
|
if (NVIC_GetPendingIRQ(i)) {
|
|
/*
|
|
* If the NVIC line is pending, it is
|
|
* guaranteed that it is implemented; clear the
|
|
* line.
|
|
*/
|
|
NVIC_ClearPendingIRQ(i);
|
|
|
|
if (!NVIC_GetPendingIRQ(i)) {
|
|
/*
|
|
* If the NVIC line can be successfully
|
|
* un-pended, it is guaranteed that it
|
|
* can be used for software interrupt
|
|
* triggering. Return the NVIC line
|
|
* number.
|
|
*/
|
|
break;
|
|
}
|
|
}
|
|
}
|
|
}
|
|
|
|
zassert_true(i >= 0, "No available IRQ line\n");
|
|
|
|
return i;
|
|
}
|
|
|
|
static inline void trigger_irq(int irq)
|
|
{
|
|
printk("Triggering irq : %d\n", irq);
|
|
#if defined(CONFIG_SOC_TI_LM3S6965_QEMU) || defined(CONFIG_CPU_CORTEX_M0) \
|
|
|| defined(CONFIG_CPU_CORTEX_M0PLUS) || defined(CONFIG_CPU_CORTEX_M1)\
|
|
|| defined(CONFIG_ARMV6_M_ARMV8_M_BASELINE)
|
|
/* QEMU does not simulate the STIR register: this is a workaround */
|
|
NVIC_SetPendingIRQ(irq);
|
|
#else
|
|
NVIC->STIR = irq;
|
|
#endif
|
|
}
|
|
|
|
#elif defined(CONFIG_GIC)
|
|
#include <zephyr/drivers/interrupt_controller/gic.h>
|
|
#include <zephyr/dt-bindings/interrupt-controller/arm-gic.h>
|
|
|
|
static inline void trigger_irq(int irq)
|
|
{
|
|
printk("Triggering irq : %d\n", irq);
|
|
|
|
/* Ensure that the specified IRQ number is a valid SGI interrupt ID */
|
|
zassert_true(irq <= 15, "%u is not a valid SGI interrupt ID", irq);
|
|
|
|
/*
|
|
* Generate a software generated interrupt and forward it to the
|
|
* requesting CPU.
|
|
*/
|
|
#if CONFIG_GIC_VER <= 2
|
|
sys_write32(GICD_SGIR_TGTFILT_REQONLY | GICD_SGIR_SGIINTID(irq),
|
|
GICD_SGIR);
|
|
#else
|
|
gic_raise_sgi(irq, GET_MPIDR(), BIT(MPIDR_TO_CORE(GET_MPIDR())));
|
|
#endif
|
|
}
|
|
|
|
#elif defined(CONFIG_ARC)
|
|
static inline void trigger_irq(int irq)
|
|
{
|
|
printk("Triggering irq : %d\n", irq);
|
|
z_arc_v2_aux_reg_write(_ARC_V2_AUX_IRQ_HINT, irq);
|
|
}
|
|
|
|
#elif defined(CONFIG_X86)
|
|
|
|
#ifdef CONFIG_X2APIC
|
|
#include <zephyr/drivers/interrupt_controller/loapic.h>
|
|
#define VECTOR_MASK 0xFF
|
|
#else
|
|
#include <zephyr/sys/arch_interface.h>
|
|
#define LOAPIC_ICR_IPI_TEST 0x00004000U
|
|
#endif
|
|
|
|
#define TRIGGER_IRQ_INT(vector) __asm__ volatile("int %0" : : "i" (vector) : "memory")
|
|
|
|
/*
|
|
* We can emulate the interrupt by sending the IPI to
|
|
* core itself by the LOAPIC for x86 platform.
|
|
*
|
|
* In APIC mode, Write LOAPIC's ICR to trigger IPI,
|
|
* the LOAPIC_ICR_IPI_TEST 0x00004000U means:
|
|
* Delivery Mode: Fixed
|
|
* Destination Mode: Physical
|
|
* Level: Assert
|
|
* Trigger Mode: Edge
|
|
* Destination Shorthand: No Shorthand
|
|
* Destination: depends on cpu_id
|
|
*
|
|
* In X2APIC mode, this no longer works. We emulate the
|
|
* interrupt by writing the IA32_X2APIC_SELF_IPI MSR
|
|
* to send IPI to the core itself via LOAPIC also.
|
|
* According to SDM vol.3 chapter 10.12.11, the bit[7:0]
|
|
* for setting the vector is only needed.
|
|
*/
|
|
static inline void trigger_irq(int vector)
|
|
{
|
|
#ifdef CONFIG_X2APIC
|
|
x86_write_x2apic(LOAPIC_SELF_IPI, ((VECTOR_MASK & vector)));
|
|
#else
|
|
|
|
#ifdef CONFIG_SMP
|
|
int cpu_id = arch_curr_cpu()->id;
|
|
#else
|
|
int cpu_id = 0;
|
|
#endif
|
|
z_loapic_ipi(cpu_id, LOAPIC_ICR_IPI_TEST, vector);
|
|
#endif /* CONFIG_X2APIC */
|
|
}
|
|
|
|
#elif defined(CONFIG_ARCH_POSIX)
|
|
#include "irq_ctrl.h"
|
|
|
|
static inline void trigger_irq(int irq)
|
|
{
|
|
hw_irq_ctrl_raise_im_from_sw(irq);
|
|
}
|
|
|
|
#elif defined(CONFIG_RISCV)
|
|
static inline void trigger_irq(int irq)
|
|
{
|
|
uint32_t mip;
|
|
|
|
__asm__ volatile ("csrrs %0, mip, %1\n"
|
|
: "=r" (mip)
|
|
: "r" (1 << irq));
|
|
}
|
|
|
|
#elif defined(CONFIG_XTENSA)
|
|
static inline void trigger_irq(int irq)
|
|
{
|
|
z_xt_set_intset(BIT((unsigned int)irq));
|
|
}
|
|
|
|
#elif defined(CONFIG_SPARC)
|
|
extern void z_sparc_enter_irq(int);
|
|
|
|
static inline void trigger_irq(int irq)
|
|
{
|
|
z_sparc_enter_irq(irq);
|
|
}
|
|
|
|
#elif defined(CONFIG_MIPS)
|
|
extern void z_mips_enter_irq(int);
|
|
|
|
static inline void trigger_irq(int irq)
|
|
{
|
|
z_mips_enter_irq(irq);
|
|
}
|
|
|
|
#else
|
|
/* So far, Nios II does not support this */
|
|
#define NO_TRIGGER_FROM_SW
|
|
#endif
|
|
|
|
#endif /* INTERRUPT_UTIL_H_ */
|