Decoupling Architectural-specific Code (#35)

[lunaix-os.git] / lunaix-os / arch / i386 / exceptions / i386_isrm.c

diff --git a/lunaix-os/arch/i386/exceptions/i386_isrm.c b/lunaix-os/arch/i386/exceptions/i386_isrm.c
index a45ce7e2dfcc4d7f8a03389f445df3628225499e..89ff616bd0f9b9d0ef4a7b0698f6483329f46ecb 100644 (file)
--- a/lunaix-os/arch/i386/exceptions/i386_isrm.c
+++ b/lunaix-os/arch/i386/exceptions/i386_isrm.c
@@ -1,8 +1,10 @@
-#include <hal/acpi/acpi.h>
-#include <hal/ioapic.h>
-
-#include <lunaix/isrm.h>
+#include <lunaix/generic/isrm.h>

 #include <lunaix/spike.h>
 #include <lunaix/spike.h>

+#include <lunaix/owloysius.h>
+
+#include "sys/x86_isa.h"
+#include "sys/ioapic.h"
+#include "sys/apic.h"

 
 /*
     total: 256 ivs
 
 /*
     total: 256 ivs


@@ -11,16 +13,19 @@
     48~  : free to allocate for external hardware use. (x208)
 */
 
     48~  : free to allocate for external hardware use. (x208)
 */
 

-static char iv_bmp[(IV_MAX - IV_BASE) / 8];
-static isr_cb handlers[IV_MAX];
+static char iv_bmp[(IV_EX_END - IV_BASE_END) / 8];
+static isr_cb handlers[TOTAL_IV];
+static ptr_t ivhand_payload[TOTAL_IV];
+
+static struct x86_intc arch_intc_ctx;

 
 extern void
 
 extern void

-intr_routine_fallback(const isr_param* param);
+intr_routine_fallback(const struct hart_state* state);

 
 void
 isrm_init()
 {
 
 void
 isrm_init()
 {

-    for (size_t i = 0; i < 256; i++) {
+    for (size_t i = 0; i < TOTAL_IV; i++) {

         handlers[i] = intr_routine_fallback;
     }
 }
         handlers[i] = intr_routine_fallback;
     }
 }


@@ -28,23 +33,31 @@ isrm_init()
 static inline int
 __ivalloc_within(size_t a, size_t b, isr_cb handler)
 {
 static inline int
 __ivalloc_within(size_t a, size_t b, isr_cb handler)
 {

-    a = (a - IV_BASE) / 8;
-    b = (b - IV_BASE) / 8;
+    a = (a - IV_BASE_END);
+    b = (b - IV_BASE_END);
+    u8_t j = a % 8;
+    u8_t k = 0;

 
 

-    for (size_t i = a; i < b; i++) {
-        u8_t chunk = iv_bmp[i], j = 0;
+    for (size_t i = a / 8; i < b / 8; i++, k += 8) {
+        u8_t chunk = iv_bmp[i];

 
         if (chunk == 0xff)
             continue;
 
 
         if (chunk == 0xff)
             continue;
 

-        while ((chunk & 0x1)) {
+        chunk >>= j;
+        while ((chunk & 0x1) && k <= b) {

             chunk >>= 1;
             j++;
             chunk >>= 1;
             j++;

+            k++;
+        }
+
+        if (k > b) {
+            break;

         }
 
         iv_bmp[i] |= 1 << j;
 
         }
 
         iv_bmp[i] |= 1 << j;
 

-        int iv = IV_BASE + i * 8 + j;
+        int iv = IV_BASE_END + i * 8 + j;

         handlers[iv] = handler ? handler : intr_routine_fallback;
 
         return iv;
         handlers[iv] = handler ? handler : intr_routine_fallback;
 
         return iv;


@@ -56,13 +69,13 @@ __ivalloc_within(size_t a, size_t b, isr_cb handler)
 int
 isrm_ivosalloc(isr_cb handler)
 {
 int
 isrm_ivosalloc(isr_cb handler)
 {

-    return __ivalloc_within(IV_BASE, IV_EX, handler);
+    return __ivalloc_within(IV_BASE_END, IV_EX_BEGIN, handler);

 }
 
 int
 isrm_ivexalloc(isr_cb handler)
 {
 }
 
 int
 isrm_ivexalloc(isr_cb handler)
 {

-    return __ivalloc_within(IV_EX, IV_MAX, handler);
+    return __ivalloc_within(IV_EX_BEGIN, IV_EX_END, handler);

 }
 
 void
 }
 
 void


@@ -70,8 +83,8 @@ isrm_ivfree(int iv)
 {
     assert(iv < 256);
 
 {
     assert(iv < 256);
 

-    if (iv >= IV_BASE) {
-        iv_bmp[(iv - IV_BASE) / 8] &= ~(1 << ((iv - IV_BASE) % 8));
+    if (iv >= IV_BASE_END) {
+        iv_bmp[(iv - IV_BASE_END) / 8] &= ~(1 << ((iv - IV_BASE_END) % 8));

     }
 
     handlers[iv] = intr_routine_fallback;
     }
 
     handlers[iv] = intr_routine_fallback;


@@ -82,13 +95,12 @@ isrm_bindirq(int irq, isr_cb irq_handler)
 {
     int iv;
     if (!(iv = isrm_ivexalloc(irq_handler))) {
 {
     int iv;
     if (!(iv = isrm_ivexalloc(irq_handler))) {

-        panickf("out of IV resource. (irq=%d)", irq);
+        fail("out of IV resource.");

         return 0; // never reach
     }
 
         return 0; // never reach
     }
 

-    // PC_AT_IRQ_RTC -> RTC_TIMER_IV, fixed, edge trigged, polarity=high,
-    // physical, APIC ID 0
-    ioapic_redirect(acpi_gistranslate(irq), iv, 0, IOAPIC_DELMOD_FIXED);
+    // fixed, edge trigged, polarity=high
+    isrm_irq_attach(irq, iv, 0, IRQ_DEFAULT);

 
     return iv;
 }
 
     return iv;
 }


@@ -98,8 +110,8 @@ isrm_bindiv(int iv, isr_cb handler)
 {
     assert(iv < 256);
 
 {
     assert(iv < 256);
 

-    if (iv >= IV_BASE) {
-        iv_bmp[(iv - IV_BASE) / 8] |= 1 << ((iv - IV_BASE) % 8);
+    if (iv >= IV_BASE_END) {
+        iv_bmp[(iv - IV_BASE_END) / 8] |= 1 << ((iv - IV_BASE_END) % 8);

     }
 
     handlers[iv] = handler;
     }
 
     handlers[iv] = handler;


@@ -111,4 +123,52 @@ isrm_get(int iv)
     assert(iv < 256);
 
     return handlers[iv];
     assert(iv < 256);
 
     return handlers[iv];

-}
\ No newline at end of file
+}
+
+ptr_t
+isrm_get_payload(const struct hart_state* state)
+{
+    int iv = state->execp->vector;
+    assert(iv < 256);
+
+    return ivhand_payload[iv];
+}
+
+void
+isrm_set_payload(int iv, ptr_t payload)
+{
+    assert(iv < 256);
+
+    ivhand_payload[iv] = payload;
+}
+
+void
+isrm_irq_attach(int irq, int iv, cpu_t dest, u32_t flags)
+{
+    arch_intc_ctx.irq_attach(&arch_intc_ctx, irq, iv, dest, flags);
+}
+
+void
+isrm_notify_eoi(cpu_t id, int iv)
+{
+    arch_intc_ctx.notify_eoi(&arch_intc_ctx, id, iv);
+}
+
+void
+isrm_notify_eos(cpu_t id)
+{
+    isrm_notify_eoi(id, LUNAIX_SCHED);
+}
+
+
+static void
+__intc_init()
+{
+    apic_init();
+    ioapic_init();
+
+    arch_intc_ctx.name = "i386_apic";
+    arch_intc_ctx.irq_attach = ioapic_irq_remap;
+    arch_intc_ctx.notify_eoi = apic_on_eoi;
+}
+owloysius_fetch_init(__intc_init, on_earlyboot);
\ No newline at end of file