lunaix-os/kernel/asm/x86/i386_isrm.c

   1 #include <hal/acpi/acpi.h>
   2 #include <hal/ioapic.h>
   3
   4 #include <lunaix/isrm.h>
   5 #include <lunaix/spike.h>
   6
   7 /*
   8     total: 256 ivs
   9     0~31: reserved for sys use (x32)
  10     32~47: reserved for os use (x16)
  11     48~  : free to allocate for external hardware use. (x208)
  12 */
  13
  14 static char iv_bmp[(IV_MAX - IV_BASE) / 8];
  15 static isr_cb handlers[IV_MAX];
  16
  17 extern void
  18 intr_routine_fallback(const isr_param* param);
  19
  20 void
  21 isrm_init()
  22 {
  23     for (size_t i = 0; i < 256; i++) {
  24         handlers[i] = intr_routine_fallback;
  25     }
  26 }
  27
  28 static inline uint32_t
  29 __ivalloc_within(size_t a, size_t b, isr_cb handler)
  30 {
  31     a = (a - IV_BASE) / 8;
  32     b = (b - IV_BASE) / 8;
  33     for (size_t i = a; i < b; i++) {
  34         char chunk = iv_bmp[i], j = 0;
  35         if (chunk == 0xff)
  36             continue;
  37         while ((chunk & 0x1)) {
  38             chunk >>= 1;
  39             j++;
  40         }
  41         iv_bmp[i] |= 1 << j;
  42         uint32_t iv = IV_BASE + i * 8 + j;
  43         handlers[iv] = handler ? handler : intr_routine_fallback;
  44         return iv;
  45     }
  46     return 0;
  47 }
  48
  49 uint32_t
  50 isrm_ivosalloc(isr_cb handler)
  51 {
  52     return __ivalloc_within(IV_BASE, IV_EX, handler);
  53 }
  54
  55 uint32_t
  56 isrm_ivexalloc(isr_cb handler)
  57 {
  58     return __ivalloc_within(IV_EX, IV_MAX, handler);
  59 }
  60
  61 void
  62 isrm_ivfree(uint32_t iv)
  63 {
  64     assert(iv < 256);
  65     if (iv >= IV_BASE) {
  66         iv_bmp[(iv - IV_BASE) / 8] &= ~(1 << ((iv - IV_BASE) % 8));
  67     }
  68     handlers[iv] = intr_routine_fallback;
  69 }
  70
  71 uint32_t
  72 isrm_bindirq(uint32_t irq, isr_cb irq_handler)
  73 {
  74     uint32_t iv;
  75     if (!(iv = isrm_ivexalloc(irq_handler))) {
  76         panickf("out of IV resource. (irq=%d)", irq);
  77         return 0; // never reach
  78     }
  79
  80     // PC_AT_IRQ_RTC -> RTC_TIMER_IV, fixed, edge trigged, polarity=high,
  81     // physical, APIC ID 0
  82     ioapic_redirect(acpi_gistranslate(irq), iv, 0, IOAPIC_DELMOD_FIXED);
  83     return iv;
  84 }
  85
  86 uint32_t
  87 isrm_bindiv(uint32_t iv, isr_cb handler)
  88 {
  89     assert(iv < 256);
  90     if (iv >= IV_BASE) {
  91         iv_bmp[(iv - IV_BASE) / 8] |= 1 << ((iv - IV_BASE) % 8);
  92     }
  93     handlers[iv] = handler;
  94 }
  95
  96 isr_cb
  97 isrm_get(uint32_t iv)
  98 {
  99     assert(iv < 256);
 100     return handlers[iv];
 101 }