/*
|
* Copyright (c) 2017 Oticon A/S
|
*
|
* SPDX-License-Identifier: Apache-2.0
|
*
|
* SW side of the IRQ handling
|
*/
|
|
#include <stdint.h>
|
#include "irq_ctrl.h"
|
#include "irq_sources.h"
|
#include "os/sim.h"
|
|
static int currently_running_irq = -1;
|
extern void (* const systemVectors[256])(void);
|
|
/**
|
* When an interrupt is raised, this function is called to handle it and, if
|
* needed, swap to a re-enabled thread
|
*
|
* Note that even that this function is executing in a Zephyr thread, it is
|
* effectively the model of the interrupt controller passing context to the IRQ
|
* handler and therefore its priority handling
|
*/
|
|
void posix_interrupt_raised(void)
|
{
|
uint64_t irq_lock;
|
int irq_nbr;
|
|
irq_lock = hw_irq_ctrl_get_current_lock();
|
|
if (irq_lock) {
|
/* "spurious" wakes can happen with interrupts locked */
|
return;
|
}
|
|
while ((irq_nbr = hw_irq_ctrl_get_highest_prio_irq()) != -1) {
|
int last_current_running_prio = hw_irq_ctrl_get_cur_prio();
|
int last_running_irq = currently_running_irq;
|
|
hw_irq_ctrl_set_cur_prio(hw_irq_ctrl_get_prio(irq_nbr));
|
hw_irq_ctrl_clear_irq(irq_nbr);
|
|
currently_running_irq = irq_nbr;
|
systemVectors[irq_nbr + 16]();
|
currently_running_irq = last_running_irq;
|
|
hw_irq_ctrl_set_cur_prio(last_current_running_prio);
|
}
|
}
|
|
/**
|
* Thru this function the IRQ controller can raise an immediate interrupt which
|
* will interrupt the SW itself
|
* (this function should only be called from the HW model code, from SW threads)
|
*/
|
void posix_irq_handler_im_from_sw(void)
|
{
|
/*
|
* if a higher priority interrupt than the possibly currently running is
|
* pending we go immediately into irq_handler() to vector into its
|
* handler
|
*/
|
if (hw_irq_ctrl_get_highest_prio_irq() != -1) {
|
posix_interrupt_raised();
|
}
|
}
|
