WebSVN – HelenOS – Diff – /branches/dd/kernel/arch/ia64/src/ia64.c

 #include <console/console.h>
 #include <proc/uarg.h>
 #include <syscall/syscall.h>
 #include <ddi/irq.h>
 #include <ddi/device.h>
-#include <arch/drivers/ega.h>
 #include <arch/bootinfo.h>
+#include <genarch/drivers/legacy/ia32/io.h>
+#include <genarch/drivers/ega/ega.h>
-#include <genarch/kbd/i8042.h>
+#include <genarch/kbrd/kbrd.h>
+#include <genarch/srln/srln.h>
+#include <genarch/drivers/i8042/i8042.h>
+#include <genarch/drivers/ns16550/ns16550.h>
+#include <arch/drivers/kbd.h>
+#include <smp/smp.h>
+#include <smp/ipi.h>
+#include <arch/atomic.h>
+#include <panic.h>
+#include <print.h>
+#include <sysinfo/sysinfo.h>
+#include <string.h>
+/* NS16550 as a COM 1 */
+#define NS16550_IRQ (4 + LEGACY_INTERRUPT_BASE)
 bootinfo_t *bootinfo;
+static uint64_t iosapic_base = 0xfec00000;
+/** Performs ia64-specific initialization before main_bsp() is called. */
 void arch_pre_main(void)
+{
     /* Setup usermode init tasks. */
-//#ifdef I460GX
     unsigned int i;
     init.cnt = bootinfo->taskmap.count;
     for (i = 0; i < init.cnt; i++) {
+        init.tasks[i].addr =
-        init.tasks[i].addr = ((unsigned long) bootinfo->taskmap.tasks[i].addr) | VRN_MASK;
+            ((unsigned long) bootinfo->taskmap.tasks[i].addr) |
+            VRN_MASK;
         init.tasks[i].size = bootinfo->taskmap.tasks[i].size;
+        strncpy(init.tasks[i].name, bootinfo->taskmap.tasks[i].name,
+            CONFIG_TASK_NAME_BUFLEN);
+    }
-/*
-#else
-    init.cnt = 8;
-    init.tasks[0].addr = INIT0_ADDRESS;
-    init.tasks[0].size = INIT0_SIZE;
-    init.tasks[1].addr = INIT0_ADDRESS + 0x400000;
-    init.tasks[1].size = INIT0_SIZE;
-    init.tasks[2].addr = INIT0_ADDRESS + 0x800000;
-    init.tasks[2].size = INIT0_SIZE;
-    init.tasks[3].addr = INIT0_ADDRESS + 0xc00000;
-    init.tasks[3].size = INIT0_SIZE;
-    init.tasks[4].addr = INIT0_ADDRESS + 0x1000000;
-    init.tasks[4].size = INIT0_SIZE;
-    init.tasks[5].addr = INIT0_ADDRESS + 0x1400000;
-    init.tasks[5].size = INIT0_SIZE;
-    init.tasks[6].addr = INIT0_ADDRESS + 0x1800000;
-    init.tasks[6].size = INIT0_SIZE;
-    init.tasks[7].addr = INIT0_ADDRESS + 0x1c00000;
-    init.tasks[7].size = INIT0_SIZE;
-#endif*/
+}
 void arch_pre_mm_init(void)
+{
+    /*
-    /* Set Interruption Vector Address (i.e. location of interruption vector table). */
+     * Set Interruption Vector Address (i.e. location of interruption vector
+     * table).
+     */
     iva_write((uintptr_t) &ivt);
     srlz_d();
+}
+static void iosapic_init(void)
+{
+    uint64_t IOSAPIC = PA2KA((unative_t)(iosapic_base)) | FW_OFFSET;
+    int i;
+    int myid, myeid;
+    myid = ia64_get_cpu_id();
+    myeid = ia64_get_cpu_eid();
+    for (i = 0; i < 16; i++) {
+        if (i == 2)
+            continue;    /* Disable Cascade interrupt */
+        ((uint32_t *)(IOSAPIC + 0x00))[0] = 0x10 + 2 * i;
+        srlz_d();
+        ((uint32_t *)(IOSAPIC + 0x10))[0] = LEGACY_INTERRUPT_BASE + i;
+        srlz_d();
+        ((uint32_t *)(IOSAPIC + 0x00))[0] = 0x10 + 2 * i + 1;
+        srlz_d();
+        ((uint32_t *)(IOSAPIC + 0x10))[0] = myid << (56 - 32) |
+            myeid << (48 - 32);
+        srlz_d();
+    }
+}
 void arch_post_mm_init(void)
+{
+    if (config.cpu_active == 1) {
+        iosapic_init();
-    irq_init(INR_COUNT, INR_COUNT);
+        irq_init(INR_COUNT, INR_COUNT);
 #ifdef SKI
-    ski_init_console();
+        ski_init_console();
 #else
-    ega_init();
+        ega_init(EGA_BASE, EGA_VIDEORAM);
 #endif
+    }
     it_init();
+}
 void arch_post_cpu_init(void)
+{
+}
 void arch_pre_smp_init(void)
+{
+}
-#ifdef I460GX
-#define POLL_INTERVAL       50000       /* 50 ms */
-/** Kernel thread for polling keyboard. */
-static void i8042_kkbdpoll(void *arg)
-{
-    while (1) {
-        i8042_poll();
-        thread_usleep(POLL_INTERVAL);
-    }
-}
-#endif
 void arch_post_smp_init(void)
+{
-    if (config.cpu_active == 1) {
-        /*
+    /*
-         * Create thread that polls keyboard.
+     * Create thread that polls keyboard.
-         */
+     */
 #ifdef SKI
-        thread_t *t;
-        t = thread_create(kkbdpoll, NULL, TASK, 0, "kkbdpoll", true);
+    thread_t *t = thread_create(kkbdpoll, NULL, TASK, 0, "kkbdpoll", true);
-        if (!t)
+    if (!t)
-            panic("cannot create kkbdpoll\n");
+        panic("Cannot create kkbdpoll.");
-        thread_ready(t);
+    thread_ready(t);
 #endif
 #ifdef I460GX
-        devno_t kbd = device_assign_devno();
-        devno_t mouse = device_assign_devno();
+    devno_t devno = device_assign_devno();
-        /* keyboard controller */
-        i8042_init(kbd, IRQ_KBD, mouse, IRQ_MOUSE);
-        thread_t *t;
+    inr_t inr;
-        t = thread_create(i8042_kkbdpoll, NULL, TASK, 0, "kkbdpoll", true);
-        if (!t)
-            panic("cannot create kkbdpoll\n");
-        thread_ready(t);
+#ifdef CONFIG_NS16550
+    inr = NS16550_IRQ;
+    srln_init(stdin);
+    (void) ns16550_init((ns16550_t *)NS16550_BASE, devno, inr, NULL, NULL,
+        &srlnin);
+    sysinfo_set_item_val("kbd.type", NULL, KBD_NS16550);
+    sysinfo_set_item_val("kbd.address.physical", NULL,
+        (uintptr_t) NS16550_BASE);
+    sysinfo_set_item_val("kbd.address.kernel", NULL,
+        (uintptr_t) NS16550_BASE);
+#else
+    inr = IRQ_KBD;
+    kbrd_init(stdin);
+    (void) i8042_init((i8042_t *)I8042_BASE, devno, inr, &kbrdin);
+    trap_virtual_enable_irqs(1 << inr);
+    sysinfo_set_item_val("kbd.type", NULL, KBD_LEGACY);
+    sysinfo_set_item_val("kbd.address.physical", NULL,
+        (uintptr_t) I8042_BASE);
+    sysinfo_set_item_val("kbd.address.kernel", NULL,
+        (uintptr_t) I8042_BASE);
+#endif
+    sysinfo_set_item_val("kbd", NULL, true);
+    sysinfo_set_item_val("kbd.devno", NULL, devno);
+    sysinfo_set_item_val("kbd.inr", NULL, inr);
 #endif
-    }
+    sysinfo_set_item_val("ia64_iospace", NULL, true);
+    sysinfo_set_item_val("ia64_iospace.address", NULL, true);
+    sysinfo_set_item_val("ia64_iospace.address.virtual", NULL, IO_OFFSET);
+}
 /** Enter userspace and never return. */
 void userspace(uspace_arg_t *kernel_uarg)
+{
     psr_t psr;
     rsc_t rsc;
     psr.value = psr_read();
     psr.cpl = PL_USER;
-    psr.i = true;               /* start with interrupts enabled */
+    psr.i = true;           /* start with interrupts enabled */
     psr.ic = true;
-    psr.ri = 0;             /* start with instruction #0 */
+    psr.ri = 0;         /* start with instruction #0 */
-    psr.bn = 1;             /* start in bank 0 */
+    psr.bn = 1;         /* start in bank 0 */
     asm volatile ("mov %0 = ar.rsc\n" : "=r" (rsc.value));
     rsc.loadrs = 0;
     rsc.be = false;
     rsc.pl = PL_USER;
-    rsc.mode = 3;               /* eager mode */
+    rsc.mode = 3;           /* eager mode */
     switch_to_userspace((uintptr_t) kernel_uarg->uspace_entry,
-                ((uintptr_t) kernel_uarg->uspace_stack)+PAGE_SIZE-ALIGN_UP(STACK_ITEM_SIZE, STACK_ALIGNMENT),
+        ((uintptr_t) kernel_uarg->uspace_stack) + PAGE_SIZE -
-                ((uintptr_t) kernel_uarg->uspace_stack)+PAGE_SIZE,
+        ALIGN_UP(STACK_ITEM_SIZE, STACK_ALIGNMENT),
-                (uintptr_t) kernel_uarg->uspace_uarg,
+        ((uintptr_t) kernel_uarg->uspace_stack) + PAGE_SIZE,
-                psr.value, rsc.value);
+        (uintptr_t) kernel_uarg->uspace_uarg, psr.value, rsc.value);
-    while (1) {
+    while (1)
+        ;
-    }
+}
 /** Set thread-local-storage pointer.
+ *
  * We use r13 (a.k.a. tp) for this purpose.
  */
 void arch_grab_console(void)
+{
 #ifdef SKI
     ski_kbd_grab();
 #endif
+}
 /** Return console to userspace
+ *
  */
 void arch_release_console(void)
+{
 #endif
+}
 void arch_reboot(void)
+{
-    // TODO
+    pio_write_8((ioport8_t *)0x64, 0xfe);
-    while (1);
+    while (1)
+        ;
+}
+/** Construct function pointer
+ *
+ * @param fptr   function pointer structure
+ * @param addr   function address
+ * @param caller calling function address
+ *
+ * @return address of the function pointer
+ *
+ */
+void *arch_construct_function(fncptr_t *fptr, void *addr, void *caller)
+{
+    fptr->fnc = (unative_t) addr;
+    fptr->gp = ((unative_t *) caller)[1];
+    return (void *) fptr;
+}
 /** @}
  */

Subversion Repositories HelenOS

(root)/branches/dd/kernel/arch/ia64/src/ia64.c – Rev 3022 → 4055