SharedIRQHandler.cpp 4.0 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114
  1. /*
  2. * Copyright (c) 2020, Liav A. <liavalb@hotmail.co.il>
  3. * All rights reserved.
  4. *
  5. * Redistribution and use in source and binary forms, with or without
  6. * modification, are permitted provided that the following conditions are met:
  7. *
  8. * 1. Redistributions of source code must retain the above copyright notice, this
  9. * list of conditions and the following disclaimer.
  10. *
  11. * 2. Redistributions in binary form must reproduce the above copyright notice,
  12. * this list of conditions and the following disclaimer in the documentation
  13. * and/or other materials provided with the distribution.
  14. *
  15. * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
  16. * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
  17. * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
  18. * DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE
  19. * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
  20. * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
  21. * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
  22. * CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
  23. * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
  24. * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
  25. */
  26. #include <Kernel/Arch/x86/CPU.h>
  27. #include <Kernel/Assertions.h>
  28. #include <Kernel/Debug.h>
  29. #include <Kernel/Interrupts/IRQHandler.h>
  30. #include <Kernel/Interrupts/InterruptManagement.h>
  31. #include <Kernel/Interrupts/PIC.h>
  32. #include <Kernel/Interrupts/SharedIRQHandler.h>
  33. namespace Kernel {
  34. UNMAP_AFTER_INIT void SharedIRQHandler::initialize(u8 interrupt_number)
  35. {
  36. auto* handler = new SharedIRQHandler(interrupt_number);
  37. handler->register_interrupt_handler();
  38. handler->disable_interrupt_vector();
  39. }
  40. void SharedIRQHandler::register_handler(GenericInterruptHandler& handler)
  41. {
  42. dbgln_if(INTERRUPT_DEBUG, "Interrupt Handler registered @ Shared Interrupt Handler {}", interrupt_number());
  43. m_handlers.set(&handler);
  44. enable_interrupt_vector();
  45. }
  46. void SharedIRQHandler::unregister_handler(GenericInterruptHandler& handler)
  47. {
  48. dbgln_if(INTERRUPT_DEBUG, "Interrupt Handler unregistered @ Shared Interrupt Handler {}", interrupt_number());
  49. m_handlers.remove(&handler);
  50. if (m_handlers.is_empty())
  51. disable_interrupt_vector();
  52. }
  53. bool SharedIRQHandler::eoi()
  54. {
  55. dbgln_if(INTERRUPT_DEBUG, "EOI IRQ {}", interrupt_number());
  56. m_responsible_irq_controller->eoi(*this);
  57. return true;
  58. }
  59. SharedIRQHandler::SharedIRQHandler(u8 irq)
  60. : GenericInterruptHandler(irq)
  61. , m_responsible_irq_controller(InterruptManagement::the().get_responsible_irq_controller(irq))
  62. {
  63. dbgln_if(INTERRUPT_DEBUG, "Shared Interrupt Handler registered @ {}", interrupt_number());
  64. }
  65. SharedIRQHandler::~SharedIRQHandler()
  66. {
  67. dbgln_if(INTERRUPT_DEBUG, "Shared Interrupt Handler unregistered @ {}", interrupt_number());
  68. disable_interrupt_vector();
  69. }
  70. void SharedIRQHandler::handle_interrupt(const RegisterState& regs)
  71. {
  72. VERIFY_INTERRUPTS_DISABLED();
  73. if constexpr (INTERRUPT_DEBUG) {
  74. dbgln("Interrupt @ {}", interrupt_number());
  75. dbgln("Interrupt Handlers registered - {}", m_handlers.size());
  76. }
  77. int i = 0;
  78. for (auto* handler : m_handlers) {
  79. dbgln_if(INTERRUPT_DEBUG, "Going for Interrupt Handling @ {}, Shared Interrupt {}", i, interrupt_number());
  80. VERIFY(handler != nullptr);
  81. handler->increment_invoking_counter();
  82. handler->handle_interrupt(regs);
  83. dbgln_if(INTERRUPT_DEBUG, "Going for Interrupt Handling @ {}, Shared Interrupt {} - End", i, interrupt_number());
  84. i++;
  85. }
  86. }
  87. void SharedIRQHandler::enable_interrupt_vector()
  88. {
  89. if (m_enabled)
  90. return;
  91. m_enabled = true;
  92. m_responsible_irq_controller->enable(*this);
  93. }
  94. void SharedIRQHandler::disable_interrupt_vector()
  95. {
  96. if (!m_enabled)
  97. return;
  98. m_enabled = false;
  99. m_responsible_irq_controller->disable(*this);
  100. }
  101. }