You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
106 lines
2.0 KiB
106 lines
2.0 KiB
/* |
|
* 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 */
|
|
|