2020-02-22 14:56:55 -03:00
|
|
|
/*
|
|
|
|
|
* Copyright (c) 2020, Liav A. <liavalb@hotmail.co.il>
|
|
|
|
|
*
|
2021-04-22 05:24:48 -03:00
|
|
|
* SPDX-License-Identifier: BSD-2-Clause
|
2020-02-22 14:56:55 -03:00
|
|
|
*/
|
|
|
|
|
|
2022-05-30 04:04:37 -03:00
|
|
|
#include <Kernel/Arch/InterruptManagement.h>
|
2021-01-25 12:07:10 -03:00
|
|
|
#include <Kernel/Debug.h>
|
2020-02-22 14:56:55 -03:00
|
|
|
#include <Kernel/Interrupts/IRQHandler.h>
|
|
|
|
|
#include <Kernel/Interrupts/SharedIRQHandler.h>
|
2023-02-24 15:10:59 -03:00
|
|
|
#include <Kernel/Library/Assertions.h>
|
2021-06-22 12:40:16 -03:00
|
|
|
#include <Kernel/Sections.h>
|
2020-02-22 14:56:55 -03:00
|
|
|
|
|
|
|
|
namespace Kernel {
|
|
|
|
|
|
2021-02-19 17:29:46 -03:00
|
|
|
UNMAP_AFTER_INIT void SharedIRQHandler::initialize(u8 interrupt_number)
|
2020-02-22 14:56:55 -03:00
|
|
|
{
|
2021-02-26 21:17:57 -03:00
|
|
|
auto* handler = new SharedIRQHandler(interrupt_number);
|
|
|
|
|
handler->register_interrupt_handler();
|
|
|
|
|
handler->disable_interrupt_vector();
|
2020-02-22 14:56:55 -03:00
|
|
|
}
|
|
|
|
|
|
|
|
|
|
void SharedIRQHandler::register_handler(GenericInterruptHandler& handler)
|
|
|
|
|
{
|
2021-03-12 09:50:55 -03:00
|
|
|
dbgln_if(INTERRUPT_DEBUG, "Interrupt Handler registered @ Shared Interrupt Handler {}", interrupt_number());
|
2023-04-12 17:49:07 -03:00
|
|
|
m_handlers.with([&handler](auto& list) { list.append(handler); });
|
2020-02-22 14:56:55 -03:00
|
|
|
enable_interrupt_vector();
|
|
|
|
|
}
|
|
|
|
|
void SharedIRQHandler::unregister_handler(GenericInterruptHandler& handler)
|
|
|
|
|
{
|
2021-03-12 09:50:55 -03:00
|
|
|
dbgln_if(INTERRUPT_DEBUG, "Interrupt Handler unregistered @ Shared Interrupt Handler {}", interrupt_number());
|
2023-04-12 17:49:07 -03:00
|
|
|
m_handlers.with([&handler, this](auto& list) {
|
|
|
|
|
list.remove(handler);
|
|
|
|
|
if (list.is_empty())
|
|
|
|
|
disable_interrupt_vector();
|
|
|
|
|
});
|
2020-02-22 14:56:55 -03:00
|
|
|
}
|
|
|
|
|
|
|
|
|
|
bool SharedIRQHandler::eoi()
|
|
|
|
|
{
|
2021-02-07 09:03:24 -03:00
|
|
|
dbgln_if(INTERRUPT_DEBUG, "EOI IRQ {}", interrupt_number());
|
2020-03-08 07:47:33 -03:00
|
|
|
m_responsible_irq_controller->eoi(*this);
|
2020-02-22 14:56:55 -03:00
|
|
|
return true;
|
|
|
|
|
}
|
|
|
|
|
|
2021-06-05 01:50:27 -03:00
|
|
|
void SharedIRQHandler::enumerate_handlers(Function<void(GenericInterruptHandler&)>& callback)
|
|
|
|
|
{
|
2023-04-12 17:49:07 -03:00
|
|
|
m_handlers.for_each([&](auto& handler) { callback(handler); });
|
2021-06-05 01:50:27 -03:00
|
|
|
}
|
|
|
|
|
|
2020-02-22 14:56:55 -03:00
|
|
|
SharedIRQHandler::SharedIRQHandler(u8 irq)
|
|
|
|
|
: GenericInterruptHandler(irq)
|
2020-02-28 17:33:41 -03:00
|
|
|
, m_responsible_irq_controller(InterruptManagement::the().get_responsible_irq_controller(irq))
|
2020-02-22 14:56:55 -03:00
|
|
|
{
|
2021-03-12 09:50:55 -03:00
|
|
|
dbgln_if(INTERRUPT_DEBUG, "Shared Interrupt Handler registered @ {}", interrupt_number());
|
2020-02-22 14:56:55 -03:00
|
|
|
}
|
|
|
|
|
|
|
|
|
|
SharedIRQHandler::~SharedIRQHandler()
|
|
|
|
|
{
|
2021-03-12 09:50:55 -03:00
|
|
|
dbgln_if(INTERRUPT_DEBUG, "Shared Interrupt Handler unregistered @ {}", interrupt_number());
|
2020-02-22 14:56:55 -03:00
|
|
|
disable_interrupt_vector();
|
|
|
|
|
}
|
|
|
|
|
|
2022-04-01 14:58:27 -03:00
|
|
|
bool SharedIRQHandler::handle_interrupt(RegisterState const& regs)
|
2020-02-22 14:56:55 -03:00
|
|
|
{
|
2021-02-23 16:42:32 -03:00
|
|
|
VERIFY_INTERRUPTS_DISABLED();
|
2021-01-13 20:21:21 -03:00
|
|
|
|
2021-01-23 19:59:27 -03:00
|
|
|
if constexpr (INTERRUPT_DEBUG) {
|
2021-01-13 20:21:21 -03:00
|
|
|
dbgln("Interrupt @ {}", interrupt_number());
|
2023-04-12 17:49:07 -03:00
|
|
|
dbgln("Interrupt Handlers registered - {}", sharing_devices_count());
|
2021-01-13 20:21:21 -03:00
|
|
|
}
|
2020-02-22 14:56:55 -03:00
|
|
|
int i = 0;
|
2021-06-05 03:00:18 -03:00
|
|
|
bool was_handled = false;
|
2023-04-12 17:49:07 -03:00
|
|
|
m_handlers.for_each([&](auto& handler) {
|
2021-02-07 09:03:24 -03:00
|
|
|
dbgln_if(INTERRUPT_DEBUG, "Going for Interrupt Handling @ {}, Shared Interrupt {}", i, interrupt_number());
|
2021-07-21 15:21:29 -03:00
|
|
|
if (handler.handle_interrupt(regs)) {
|
2022-11-18 17:39:49 -03:00
|
|
|
handler.increment_call_count();
|
2021-06-05 03:00:18 -03:00
|
|
|
was_handled = true;
|
|
|
|
|
}
|
2021-02-07 09:03:24 -03:00
|
|
|
dbgln_if(INTERRUPT_DEBUG, "Going for Interrupt Handling @ {}, Shared Interrupt {} - End", i, interrupt_number());
|
2020-02-22 14:56:55 -03:00
|
|
|
i++;
|
2023-04-12 17:49:07 -03:00
|
|
|
});
|
|
|
|
|
|
2021-06-05 03:00:18 -03:00
|
|
|
return was_handled;
|
2020-02-22 14:56:55 -03:00
|
|
|
}
|
|
|
|
|
|
|
|
|
|
void SharedIRQHandler::enable_interrupt_vector()
|
|
|
|
|
{
|
|
|
|
|
if (m_enabled)
|
|
|
|
|
return;
|
|
|
|
|
m_enabled = true;
|
2020-03-08 07:47:33 -03:00
|
|
|
m_responsible_irq_controller->enable(*this);
|
2020-02-22 14:56:55 -03:00
|
|
|
}
|
|
|
|
|
|
|
|
|
|
void SharedIRQHandler::disable_interrupt_vector()
|
|
|
|
|
{
|
|
|
|
|
if (!m_enabled)
|
|
|
|
|
return;
|
|
|
|
|
m_enabled = false;
|
2020-03-08 07:47:33 -03:00
|
|
|
m_responsible_irq_controller->disable(*this);
|
2020-02-22 14:56:55 -03:00
|
|
|
}
|
|
|
|
|
|
|
|
|
|
}
|