107 lines
2.0 KiB
C
107 lines
2.0 KiB
C
|
/*
|
||
|
|
* Copyright (c) 2020 Antony Pavlov <antonynpavlov@gmail.com>
|
||
|
|
*
|
||
|
|
* based on arch/nios2/core/irq_manage.c
|
||
|
|
*
|
||
|
|
* SPDX-License-Identifier: Apache-2.0
|
||
|
|
*/
|
||
|
|
|
||
|
|
#include <kernel.h>
|
||
|
|
#include <kswap.h>
|
||
|
|
#include <logging/log.h>
|
||
|
|
LOG_MODULE_DECLARE(os, CONFIG_KERNEL_LOG_LEVEL);
|
||
|
|
|
||
|
|
|
||
|
|
uint32_t mips_cp0_status_int_mask;
|
||
|
|
|
||
|
|
|
||
|
|
FUNC_NORETURN void z_irq_spurious(const void *unused)
|
||
|
|
{
|
||
|
|
ulong_t cause;
|
||
|
|
|
||
|
|
ARG_UNUSED(unused);
|
||
|
|
cause = (read_c0_cause() & CAUSE_EXP_MASK) >> CAUSE_EXP_SHIFT;
|
||
|
|
|
||
|
|
LOG_ERR("Spurious interrupt detected! CAUSE: %ld", cause);
|
||
|
|
|
||
|
|
z_mips_fatal_error(K_ERR_SPURIOUS_IRQ, NULL);
|
||
|
|
}
|
||
|
|
|
||
|
|
void arch_irq_enable(unsigned int irq)
|
||
|
|
{
|
||
|
|
unsigned int key;
|
||
|
|
uint32_t irq_mask;
|
||
|
|
|
||
|
|
key = irq_lock();
|
||
|
|
|
||
|
|
irq_mask = ST0_IP0 << irq;
|
||
|
|
mips_cp0_status_int_mask |= irq_mask;
|
||
|
|
write_c0_status(read_c0_status() | irq_mask);
|
||
|
|
|
||
|
|
irq_unlock(key);
|
||
|
|
}
|
||
|
|
|
||
|
|
void arch_irq_disable(unsigned int irq)
|
||
|
|
{
|
||
|
|
unsigned int key;
|
||
|
|
uint32_t irq_mask;
|
||
|
|
|
||
|
|
key = irq_lock();
|
||
|
|
|
||
|
|
irq_mask = ST0_IP0 << irq;
|
||
|
|
mips_cp0_status_int_mask &= ~irq_mask;
|
||
|
|
write_c0_status(read_c0_status() & ~irq_mask);
|
||
|
|
|
||
|
|
irq_unlock(key);
|
||
|
|
};
|
||
|
|
|
||
|
|
int arch_irq_is_enabled(unsigned int irq)
|
||
|
|
{
|
||
|
|
return read_c0_status() & (ST0_IP0 << irq);
|
||
|
|
}
|
||
|
|
|
||
|
|
void z_mips_enter_irq(uint32_t ipending)
|
||
|
|
{
|
||
|
|
_current_cpu->nested++;
|
||
|
|
|
||
|
|
#ifdef CONFIG_IRQ_OFFLOAD
|
||
|
|
z_irq_do_offload();
|
||
|
|
#endif
|
||
|
|
|
||
|
|
while (ipending) {
|
||
|
|
int index;
|
||
|
|
struct _isr_table_entry *ite;
|
||
|
|
|
||
|
|
if (IS_ENABLED(CONFIG_TRACING_ISR))
|
||
|
|
sys_trace_isr_enter();
|
||
|
|
|
||
|
|
index = find_lsb_set(ipending) - 1;
|
||
|
|
ipending &= ~BIT(index);
|
||
|
|
|
||
|
|
ite = &_sw_isr_table[index];
|
||
|
|
|
||
|
|
ite->isr(ite->arg);
|
||
|
|
|
||
|
|
if (IS_ENABLED(CONFIG_TRACING_ISR))
|
||
|
|
sys_trace_isr_exit();
|
||
|
|
}
|
||
|
|
|
||
|
|
_current_cpu->nested--;
|
||
|
|
|
||
|
|
if (IS_ENABLED(CONFIG_STACK_SENTINEL))
|
||
|
|
z_check_stack_sentinel();
|
||
|
|
}
|
||
|
|
|
||
|
|
#ifdef CONFIG_DYNAMIC_INTERRUPTS
|
||
|
|
int arch_irq_connect_dynamic(unsigned int irq, unsigned int priority,
|
||
|
|
void (*routine)(const void *parameter),
|
||
|
|
const void *parameter, uint32_t flags)
|
||
|
|
{
|
||
|
|
ARG_UNUSED(flags);
|
||
|
|
ARG_UNUSED(priority);
|
||
|
|
|
||
|
|
z_isr_install(irq, routine, parameter);
|
||
|
|
return irq;
|
||
|
|
}
|
||
|
|
#endif /* CONFIG_DYNAMIC_INTERRUPTS */
|