| 1 | // SPDX-License-Identifier: GPL-3.0-or-later |
|---|---|
| 2 | |
| 3 | #include "mos/interrupt/interrupt.hpp" |
| 4 | |
| 5 | #include "mos/lib/structures/list.hpp" |
| 6 | |
| 7 | #include <mos/allocator.hpp> |
| 8 | #include <mos_stdlib.hpp> |
| 9 | |
| 10 | struct interrupt_handler_t : mos::NamedType<"InterruptHandler"> |
| 11 | { |
| 12 | as_linked_list; |
| 13 | u32 irq; |
| 14 | irq_serve_t handler; |
| 15 | void *data; |
| 16 | }; |
| 17 | |
| 18 | static spinlock_t irq_handlers_lock; |
| 19 | static list_head irq_handlers; |
| 20 | |
| 21 | void interrupt_entry(u32 irq) |
| 22 | { |
| 23 | // spinlock_acquire(&irq_handlers_lock); |
| 24 | |
| 25 | list_foreach(interrupt_handler_t, handler, irq_handlers) |
| 26 | { |
| 27 | if (handler->irq == irq) |
| 28 | if (handler->handler(irq, handler->data)) |
| 29 | break; // interrupt was handled |
| 30 | } |
| 31 | |
| 32 | // spinlock_release(&irq_handlers_lock); |
| 33 | } |
| 34 | |
| 35 | void interrupt_handler_register(u32 irq, irq_serve_t handler, void *data) |
| 36 | { |
| 37 | interrupt_handler_t *new_handler = mos::create<interrupt_handler_t>(); |
| 38 | new_handler->irq = irq; |
| 39 | new_handler->handler = handler; |
| 40 | new_handler->data = data; |
| 41 | |
| 42 | spinlock_acquire(&irq_handlers_lock); |
| 43 | list_node_append(head: &irq_handlers, item: &new_handler->list_node); |
| 44 | spinlock_release(&irq_handlers_lock); |
| 45 | } |
| 46 |