| 51,64 → 51,99 |
|---|
| #include <syscall/syscall.h> |
| #include <ddi/irq.h> |
| #include <ddi/device.h> |
| #include <arch/drivers/ega.h> |
| #include <arch/bootinfo.h> |
| #include <genarch/kbd/i8042.h> |
| #include <genarch/drivers/legacy/ia32/io.h> |
| #include <genarch/drivers/ega/ega.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 = ((unsigned long) bootinfo->taskmap.tasks[i].addr) | VRN_MASK; |
| init.tasks[i].addr = |
| ((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) |
| { |
| irq_init(INR_COUNT, INR_COUNT); |
| if (config.cpu_active == 1) { |
| iosapic_init(); |
| irq_init(INR_COUNT, INR_COUNT); |
| #ifdef SKI |
| ski_init_console(); |
| #else |
| ega_init(); |
| #endif |
| it_init(); |
| ski_init_console(); |
| #else |
| ega_init(EGA_BASE, EGA_VIDEORAM); |
| #endif |
| } |
| it_init(); |
| |
| } |
| |
| void arch_post_cpu_init(void) |
| 119,51 → 154,54 |
|---|
| { |
| } |
| |
| |
| #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); |
| if (!t) |
| panic("cannot create kkbdpoll\n"); |
| thread_ready(t); |
| thread_t *t = thread_create(kkbdpoll, NULL, TASK, 0, "kkbdpoll", true); |
| if (!t) |
| panic("Cannot create kkbdpoll."); |
| thread_ready(t); |
| #endif |
| |
| #ifdef I460GX |
| devno_t kbd = device_assign_devno(); |
| devno_t mouse = device_assign_devno(); |
| /* keyboard controller */ |
| i8042_init(kbd, IRQ_KBD, mouse, IRQ_MOUSE); |
| devno_t devno = device_assign_devno(); |
| inr_t inr; |
| |
| thread_t *t; |
| 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) |
| { |
| 172,26 → 210,25 |
|---|
| |
| 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.bn = 1; /* start in bank 0 */ |
| psr.ri = 0; /* start with instruction #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_uarg, |
| psr.value, rsc.value); |
| ((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_uarg, psr.value, rsc.value); |
| |
| while (1) { |
| while (1) |
| ; |
| } |
| } |
| |
| /** Set thread-local-storage pointer. |
| 210,8 → 247,9 |
|---|
| { |
| #ifdef SKI |
| ski_kbd_grab(); |
| #endif |
| #endif |
| } |
| |
| /** Return console to userspace |
| * |
| */ |
| 224,9 → 262,27 |
|---|
| |
| void arch_reboot(void) |
| { |
| // TODO |
| while (1); |
| pio_write_8((ioport8_t *)0x64, 0xfe); |
| 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; |
| } |
| |
| /** @} |
| */ |