interrupt.rs 2.6 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990
  1. use super::mem::handle_kernel_page_fault;
  2. use super::timer::timer_interrupt;
  3. use crate::kernel::constants::EINVAL;
  4. use crate::prelude::*;
  5. use alloc::sync::Arc;
  6. use eonix_hal::processor::CPU;
  7. use eonix_hal::traits::fault::Fault;
  8. use eonix_hal::traits::trap::{RawTrapContext, TrapType};
  9. use eonix_hal::trap::TrapContext;
  10. use eonix_mm::address::{Addr as _, VAddr};
  11. use eonix_runtime::scheduler::Scheduler;
  12. use eonix_sync::SpinIrq as _;
  13. static IRQ_HANDLERS: Spin<[Option<Arc<dyn Fn() + Send + Sync>>; 16]> =
  14. Spin::new([const { None }; 16]);
  15. pub fn default_irq_handler(irqno: usize) {
  16. assert!(irqno < 16);
  17. let handler = IRQ_HANDLERS.lock()[irqno as usize].as_ref().cloned();
  18. if let Some(handler) = handler {
  19. handler();
  20. }
  21. #[cfg(target_arch = "x86_64")]
  22. {
  23. use crate::driver::Port8;
  24. const PIC1_COMMAND: Port8 = Port8::new(0x20);
  25. const PIC2_COMMAND: Port8 = Port8::new(0xA0);
  26. PIC1_COMMAND.write(0x20); // EOI
  27. if irqno >= 8 {
  28. PIC2_COMMAND.write(0x20); // EOI
  29. }
  30. }
  31. }
  32. pub fn default_fault_handler(fault_type: Fault, trap_ctx: &mut TrapContext) {
  33. if trap_ctx.is_user_mode() {
  34. unimplemented!("Unhandled user space fault");
  35. }
  36. match fault_type {
  37. Fault::PageFault(error_code) => {
  38. let fault_pc = VAddr::from(trap_ctx.get_program_counter());
  39. let vaddr = arch::get_page_fault_address();
  40. if let Some(new_pc) = handle_kernel_page_fault(fault_pc, vaddr, error_code) {
  41. trap_ctx.set_program_counter(new_pc.addr());
  42. }
  43. }
  44. fault => panic!("Unhandled kernel space fault: {fault:?}"),
  45. }
  46. }
  47. #[eonix_hal::default_trap_handler]
  48. pub fn interrupt_handler(trap_ctx: &mut TrapContext) {
  49. match trap_ctx.trap_type() {
  50. TrapType::Syscall { no, .. } => unreachable!("Syscall {} in kernel space.", no),
  51. TrapType::Fault(fault) => default_fault_handler(fault, trap_ctx),
  52. TrapType::Irq(no) => default_irq_handler(no),
  53. TrapType::Timer => {
  54. timer_interrupt();
  55. if eonix_preempt::count() == 0 {
  56. // To make scheduler satisfied.
  57. eonix_preempt::disable();
  58. Scheduler::schedule();
  59. }
  60. }
  61. }
  62. }
  63. pub fn register_irq_handler<F>(irqno: i32, handler: F) -> Result<(), u32>
  64. where
  65. F: Fn() + Send + Sync + 'static,
  66. {
  67. if irqno < 0 || irqno >= 16 {
  68. return Err(EINVAL);
  69. }
  70. let old = IRQ_HANDLERS.lock_irq()[irqno as usize].replace(Arc::new(handler));
  71. assert!(old.is_none(), "IRQ handler already registered");
  72. Ok(())
  73. }
  74. pub fn end_of_interrupt() {
  75. CPU::local().as_mut().end_of_interrupt();
  76. }