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