WebSVN – HelenOS – Path Comparison – / – /branches/tracing/kernel/arch/ Rev 4376 and /branches/tracing/kernel/arch/ Rev 4377

Ignore whitespace Rev 4376 → Rev 4377

/branches/tracing/kernel/arch/ia32xen/include/cpuid.h
File deleted
\ No newline at end of file
Property changes:
Deleted: svn:special
-*
\ No newline at end of property

/branches/tracing/kernel/arch/ia32xen/include/elf.h
File deleted
\ No newline at end of file
Property changes:
Deleted: svn:special
-*
\ No newline at end of property

/branches/tracing/kernel/arch/ia32xen/include/bios
File deleted
\ No newline at end of file
Property changes:
Deleted: svn:special
-*
\ No newline at end of property

/branches/tracing/kernel/arch/ia32xen/include/memstr.h
File deleted
\ No newline at end of file
Property changes:
Deleted: svn:special
-*
\ No newline at end of property

/branches/tracing/kernel/arch/ia32xen/include/smp
File deleted
\ No newline at end of file
Property changes:
Deleted: svn:special
-*
\ No newline at end of property

/branches/tracing/kernel/arch/ia32xen/include/arg.h
File deleted
\ No newline at end of file
Property changes:
Deleted: svn:special
-*
\ No newline at end of property

/branches/tracing/kernel/arch/ia32xen/include/ddi
File deleted
\ No newline at end of file
Property changes:
Deleted: svn:special
-*
\ No newline at end of property

/branches/tracing/kernel/arch/ia32xen/include/atomic.h
File deleted
\ No newline at end of file
Property changes:
Deleted: svn:special
-*
\ No newline at end of property

/branches/tracing/kernel/arch/ia32xen/include/arch.h
File deleted
\ No newline at end of file
Property changes:
Deleted: svn:special
-*
\ No newline at end of property

/branches/tracing/kernel/arch/ia32xen/include/proc
File deleted
\ No newline at end of file
Property changes:
Deleted: svn:special
-*
\ No newline at end of property

/branches/tracing/kernel/arch/ia32xen/include/faddr.h
File deleted
\ No newline at end of file
Property changes:
Deleted: svn:special
-*
\ No newline at end of property

/branches/tracing/kernel/arch/ia32xen/include/debugger.h
File deleted
\ No newline at end of file
Property changes:
Deleted: svn:special
-*
\ No newline at end of property

/branches/tracing/kernel/arch/ia32xen/include/context.h
File deleted
\ No newline at end of file
Property changes:
Deleted: svn:special
-*
\ No newline at end of property

/branches/tracing/kernel/arch/ia32xen/include/barrier.h
File deleted
\ No newline at end of file
Property changes:
Deleted: svn:special
-*
\ No newline at end of property

/branches/tracing/kernel/arch/ia32xen/include/debug.h
File deleted
\ No newline at end of file
Property changes:
Deleted: svn:special
-*
\ No newline at end of property

/branches/tracing/kernel/arch/ia32xen/include/cpu.h
File deleted
\ No newline at end of file
Property changes:
Deleted: svn:special
-*
\ No newline at end of property

/branches/tracing/kernel/arch/ia32xen/include/context_offset.h
File deleted
\ No newline at end of file
Property changes:
Deleted: svn:special
-*
\ No newline at end of property

/branches/tracing/kernel/arch/ia32xen/include/interrupt.h
File deleted
\ No newline at end of file
Property changes:
Deleted: svn:special
-*
\ No newline at end of property

/branches/tracing/kernel/arch/ia32xen/include/fpu_context.h
File deleted
\ No newline at end of file
Property changes:
Deleted: svn:special
-*
\ No newline at end of property

/branches/tracing/kernel/arch/ia32xen/include/cycle.h
File deleted
\ No newline at end of file
Property changes:
Deleted: svn:special
-*
\ No newline at end of property

/branches/tracing/kernel/arch/ia32xen/include/byteorder.h
File deleted
\ No newline at end of file
Property changes:
Deleted: svn:special
-*
\ No newline at end of property

/branches/tracing/kernel/arch/ia32xen/src/atomic.S
File deleted
\ No newline at end of file
Property changes:
Deleted: svn:special
-*
\ No newline at end of property

/branches/tracing/kernel/arch/ia32xen/src/fpu_context.c
File deleted
\ No newline at end of file
Property changes:
Deleted: svn:special
-*
\ No newline at end of property

/branches/tracing/kernel/arch/ia32xen/src/context.S
File deleted
\ No newline at end of file
Property changes:
Deleted: svn:special
-*
\ No newline at end of property

/branches/tracing/kernel/arch/ia32xen/src/debug
File deleted
\ No newline at end of file
Property changes:
Deleted: svn:special
-*
\ No newline at end of property

/branches/tracing/kernel/arch/ia32xen/src/cpu
File deleted
\ No newline at end of file
Property changes:
Deleted: svn:special
-*
\ No newline at end of property

/branches/tracing/kernel/arch/ia32xen/src/bios
File deleted
\ No newline at end of file
Property changes:
Deleted: svn:special
-*
\ No newline at end of property

/branches/tracing/kernel/arch/ia32xen/src/delay.s
File deleted
\ No newline at end of file
Property changes:
Deleted: svn:special
-*
\ No newline at end of property

/branches/tracing/kernel/arch/ia32xen/src/ddi
File deleted
\ No newline at end of file
Property changes:
Deleted: svn:special
-*
\ No newline at end of property

/branches/tracing/kernel/arch/ia32xen/src/debugger.c
File deleted
\ No newline at end of file
Property changes:
Deleted: svn:special
-*
\ No newline at end of property

 /branches/tracing/kernel/arch/sparc64/_link.ld.in
 ,8 → 1,8
 /** SPARC64 linker script
  *
  *  It is ELF format, but its only section looks like this:
- *  kernel text
- *  kernel data
+ *   kernel text
+ *   kernel data
  *
  */
 ,7 → 11,7
 ENTRY(kernel_image_start)
 SECTIONS {
-    .image VMA: AT (LMA) {
+    .image VMA: AT (LMA) {
         ktext_start = .;
         *(K_TEXT_START)
         *(.text);
 ,23 → 21,23
         *(K_DATA_START)
         *(.rodata);
         *(.rodata.*);
-        *(.data);       /* initialized data */
+        *(.data);                   /* initialized data */
         *(.sdata);
         *(.sdata2);
         *(.sbss);
         . = ALIGN(8);
         hardcoded_ktext_size = .;
-        QUAD(ktext_end - ktext_start);
+        QUAD(ktext_end - ktext_start);
         hardcoded_kdata_size = .;
         QUAD(kdata_end - kdata_start);
         hardcoded_load_address = .;
         QUAD(VMA);
-        *(.bss);        /* uninitialized static variables */
-        *(COMMON);      /* global variables */
+        *(.bss);                    /* uninitialized static variables */
+        *(COMMON);                  /* global variables */
         symbol_table = .;
-                *(symtab.*);            /* Symbol table, must be LAST symbol!*/
+        *(symtab.*);                /* Symbol table, must be LAST symbol!*/
         kdata_end = .;
     }
 ,5 → 44,5
     /DISCARD/ : {
         *(*);
     }
 }

/branches/tracing/kernel/arch/sparc64/include/fpu_context.h
37,7 → 37,6

#include <arch/types.h>

#define ARCH_HAS_FPU
#define FPU_CONTEXT_ALIGN 8

typedef struct {

 /branches/tracing/kernel/arch/sparc64/include/types.h
 ,11 → 54,12
 typedef uint64_t ipl_t;
-typedef uint64_t ioport_t;
 typedef uint64_t unative_t;
 typedef int64_t native_t;
+typedef struct {
+} fncptr_t;
 /**< Formats for uintptr_t, size_t, count_t and index_t */
 #define PRIp "llx"
 #define PRIs "llu"

 /branches/tracing/kernel/arch/sparc64/include/memstr.h
 ,7 → 26,7
  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
  */
-/** @addtogroup sparc64
+/** @addtogroup sparc64
  * @{
  */
 /** @file

 /branches/tracing/kernel/arch/sparc64/include/atomic.h
 ,7 → 123,7
         "ldx %0, %2\n"
         "brz %2, 0b\n"
         "nop\n"
-        "ba 1b\n"
+        "ba %xcc, 1b\n"
         "nop\n"
     "2:\n"
         : "+m" (*((uint64_t *) x)), "+r" (tmp1), "+r" (tmp2) : "r" (0)

 /branches/tracing/kernel/arch/sparc64/include/arch.h
 ,6 → 45,12
 #define NWINDOWS        8   /** Number of register window sets. */
+#ifndef __ASM__
+extern void arch_pre_main(void);
+#endif /* __ASM__ */
 #endif
 /** @}

 /branches/tracing/kernel/arch/sparc64/include/boot/boot.h
 ,9 → 48,12
 #define TASKMAP_MAX_RECORDS 32
 #define MEMMAP_MAX_RECORDS  32
+#define BOOTINFO_TASK_NAME_BUFLEN 32
 typedef struct {
     void * addr;
     uint32_t size;
+    char name[BOOTINFO_TASK_NAME_BUFLEN];
 } utask_t;
 typedef struct {

 /branches/tracing/kernel/arch/sparc64/include/asm.h
 ,49 → 44,49
 #include <arch/stack.h>
 #include <arch/barrier.h>
-static inline void outb(ioport_t port, uint8_t v)
+static inline void pio_write_8(ioport8_t *port, uint8_t v)
 {
-    *((volatile uint8_t *)(port)) = v;
+    *port = v;
     memory_barrier();
 }
-static inline void outw(ioport_t port, uint16_t v)
+static inline void pio_write_16(ioport16_t *port, uint16_t v)
 {
-    *((volatile uint16_t *)(port)) = v;
+    *port = v;
     memory_barrier();
 }
-static inline void outl(ioport_t port, uint32_t v)
+static inline void pio_write_32(ioport32_t *port, uint32_t v)
 {
-    *((volatile uint32_t *)(port)) = v;
+    *port = v;
     memory_barrier();
 }
-static inline uint8_t inb(ioport_t port)
+static inline uint8_t pio_read_8(ioport8_t *port)
 {
     uint8_t rv;
-    rv = *((volatile uint8_t *)(port));
+    rv = *port;
     memory_barrier();
     return rv;
 }
-static inline uint16_t inw(ioport_t port)
+static inline uint16_t pio_read_16(ioport16_t *port)
 {
     uint16_t rv;
-    rv = *((volatile uint16_t *)(port));
+    rv = *port;
     memory_barrier();
     return rv;
 }
-static inline uint32_t inl(ioport_t port)
+static inline uint32_t pio_read_32(ioport32_t *port)
 {
     uint32_t rv;
-    rv = *((volatile uint32_t *)(port));
+    rv = *port;
     memory_barrier();
     return rv;

 /branches/tracing/kernel/arch/sparc64/include/trap/trap_table.h
 ,7 → 100,7
 .macro PREEMPTIBLE_HANDLER f
     sethi %hi(\f), %g1
-    b preemptible_handler
+    ba %xcc, preemptible_handler
     or %g1, %lo(\f), %g1
 .endm

 /branches/tracing/kernel/arch/sparc64/include/trap/mmu.h
 ,17 → 103,20
      * Note that branch-delay slots are used in order to save space.
      */
 :
-    mov VA_DMMU_TAG_ACCESS, %g1
-    ldxa [%g1] ASI_DMMU, %g1            ! read the faulting Context and VPN
+    sethi %hi(fast_data_access_mmu_miss_data_hi), %g7
+    wr %g0, ASI_DMMU, %asi
+    ldxa [VA_DMMU_TAG_ACCESS] %asi, %g1     ! read the faulting Context and VPN
     set TLB_TAG_ACCESS_CONTEXT_MASK, %g2
     andcc %g1, %g2, %g3             ! get Context
-    bnz 0f                      ! Context is non-zero
+    bnz %xcc, 0f                    ! Context is non-zero
     andncc %g1, %g2, %g3                ! get page address into %g3
-    bz 0f                       ! page address is zero
+    bz  %xcc, 0f                    ! page address is zero
+    ldx [%g7 + %lo(end_of_identity)], %g4
+    cmp %g3, %g4
+    bgeu %xcc, 0f
-    sethi %hi(kernel_8k_tlb_data_template), %g2
-    ldx [%g2 + %lo(kernel_8k_tlb_data_template)], %g2
-    or %g3, %g2, %g2
+    ldx [%g7 + %lo(kernel_8k_tlb_data_template)], %g2
+    add %g3, %g2, %g2
     stxa %g2, [%g0] ASI_DTLB_DATA_IN_REG        ! identity map the kernel page
     retry
 ,8 → 141,7
      * Read the Tag Access register for the higher-level handler.
      * This is necessary to survive nested DTLB misses.
      */
-    mov VA_DMMU_TAG_ACCESS, %g2
-    ldxa [%g2] ASI_DMMU, %g2
+    ldxa [VA_DMMU_TAG_ACCESS] %asi, %g2
     /*
      * g2 will be passed as an argument to fast_data_access_mmu_miss().

 /branches/tracing/kernel/arch/sparc64/include/mm/frame.h
 ,6 → 73,8
 typedef union frame_address frame_address_t;
 extern uintptr_t last_frame;
+extern uintptr_t end_of_identity;
 extern void frame_arch_init(void);
 #define physmem_print()

 /branches/tracing/kernel/arch/sparc64/include/barrier.h
 ,6 → 82,8
     asm volatile ("membar #Sync\n");
 }
+#if defined (US)
 #define smc_coherence(a)    \
 {               \
     write_barrier();    \
 ,6 → 99,22
         flush((void *)(a) + i);         \
 }
+#elif defined (US3)
+#define smc_coherence(a)    \
+{               \
+    write_barrier();    \
+    flush_pipeline();   \
+}
+#define smc_coherence_block(a, l)   \
+{                   \
+    write_barrier();        \
+    flush_pipeline();       \
+}
+#endif  /* defined(US3) */
 #endif
 /** @}

 /branches/tracing/kernel/arch/sparc64/include/drivers/sgcn.h
 ,17 → 36,19
 #define KERN_sparc64_SGCN_H_
 #include <arch/types.h>
+#include <console/chardev.h>
+#include <proc/thread.h>
-/* number of bytes in the TOC magic, including the terminating '\0' */
+/* number of bytes in the TOC magic, including the NULL-terminator */
 #define TOC_MAGIC_BYTES     8
-/* number of bytes in the TOC key, including the terminating '\0' */
+/* number of bytes in the TOC key, including the NULL-terminator */
 #define TOC_KEY_SIZE        8
 /* maximum number of entries in the SRAM table of contents */
 #define MAX_TOC_ENTRIES     32
-/* number of bytes in the SGCN buffer magic, including the terminating '\0' */
+/* number of bytes in the SGCN buffer magic, including the NULL-terminator */
 #define SGCN_MAGIC_BYTES    4
 /**
 ,11 → 117,17
     uint32_t out_wrptr;
 } __attribute__ ((packed)) sgcn_buffer_header_t;
-void sgcn_grab(void);
-void sgcn_release(void);
-void sgcn_poll(void);
-void sgcn_init(void);
+typedef struct {
+    thread_t *thread;
+    indev_t *srlnin;
+} sgcn_instance_t;
+extern void sgcn_grab(void);
+extern void sgcn_release(void);
+extern sgcn_instance_t *sgcnin_init(void);
+extern void sgcnin_wire(sgcn_instance_t *, indev_t *);
+extern void sgcnout_init(void);
 #endif
 /** @}

 /branches/tracing/kernel/arch/sparc64/include/drivers/kbd.h
 ,7 → 26,7
  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
  */
-/** @addtogroup sparc64
+/** @addtogroup sparc64
  * @{
  */
 /** @file
 ,15 → 38,6
 #include <arch/types.h>
 #include <genarch/ofw/ofw_tree.h>
-typedef enum {
-    KBD_UNKNOWN,
-    KBD_Z8530,
-    KBD_NS16550,
-    KBD_SGCN
-} kbd_type_t;
-extern kbd_type_t kbd_type;
 extern void kbd_init(ofw_tree_node_t *node);
 #endif

/branches/tracing/kernel/arch/sparc64/include/drivers/scr.h
49,6 → 49,7
extern scr_type_t scr_type;

extern void scr_init(ofw_tree_node_t *node);
extern void scr_redraw(void);

#endif

 /branches/tracing/kernel/arch/sparc64/Makefile.inc
 ,10 → 29,6
 ## Toolchain configuration
 #
-ifndef CROSS_PREFIX
-    CROSS_PREFIX = /usr/local
-endif
 BFD_NAME = elf64-sparc
 BFD_ARCH = sparc
 BFD = binary
 ,94 → 42,55
 DEFS += -D__64_BITS__
-## Own configuration directives
-#
-## Compile with page hash table support.
-#
-CONFIG_PAGE_HT = y
-DEFS += -DCONFIG_PAGE_HT
-## Compile with support for address space identifiers.
-#
-CONFIG_ASID = y
-CONFIG_ASID_FIFO = y
-## Compile with support for framebuffer.
-#
-CONFIG_FB = y
-## Compile with support for Sun keyboard.
-#
-CONFIG_SUN_KBD = y
-## Compile with support for OpenFirmware device tree.
-#
-CONFIG_OFW_TREE = y
-ifeq ($(CONFIG_SMP),y)
-    DEFS += -DCONFIG_SMP
+ifeq ($(PROCESSOR),us)
+    DEFS += -DUS
 endif
-ifeq ($(CONFIG_SGCN),y)
-        DEFS += -DCONFIG_SGCN
-endif
-ifeq ($(MACHINE),us)
-    DEFS += -DUS
-endif
-ifeq ($(MACHINE),us3)
+ifeq ($(PROCESSOR),us3)
     DEFS += -DUS3
 endif
 ARCH_SOURCES = \
-    arch/$(ARCH)/src/cpu/cpu.c \
-    arch/$(ARCH)/src/asm.S \
-    arch/$(ARCH)/src/panic.S \
-    arch/$(ARCH)/src/console.c \
-    arch/$(ARCH)/src/context.S \
-    arch/$(ARCH)/src/fpu_context.c \
-    arch/$(ARCH)/src/dummy.s \
-    arch/$(ARCH)/src/mm/as.c \
-    arch/$(ARCH)/src/mm/cache.S \
-    arch/$(ARCH)/src/mm/frame.c \
-    arch/$(ARCH)/src/mm/page.c \
-    arch/$(ARCH)/src/mm/tlb.c \
-    arch/$(ARCH)/src/sparc64.c \
-    arch/$(ARCH)/src/start.S \
-    arch/$(ARCH)/src/proc/scheduler.c \
-    arch/$(ARCH)/src/proc/thread.c \
-    arch/$(ARCH)/src/trap/mmu.S \
-    arch/$(ARCH)/src/trap/trap_table.S \
-    arch/$(ARCH)/src/trap/trap.c \
-    arch/$(ARCH)/src/trap/exception.c \
-    arch/$(ARCH)/src/trap/interrupt.c \
-    arch/$(ARCH)/src/ddi/ddi.c \
-    arch/$(ARCH)/src/drivers/tick.c \
-    arch/$(ARCH)/src/drivers/kbd.c \
-    arch/$(ARCH)/src/drivers/scr.c \
-    arch/$(ARCH)/src/drivers/sgcn.c \
-    arch/$(ARCH)/src/drivers/pci.c
+    arch/$(KARCH)/src/cpu/cpu.c \
+    arch/$(KARCH)/src/asm.S \
+    arch/$(KARCH)/src/panic.S \
+    arch/$(KARCH)/src/console.c \
+    arch/$(KARCH)/src/context.S \
+    arch/$(KARCH)/src/fpu_context.c \
+    arch/$(KARCH)/src/dummy.s \
+    arch/$(KARCH)/src/mm/as.c \
+    arch/$(KARCH)/src/mm/cache.S \
+    arch/$(KARCH)/src/mm/frame.c \
+    arch/$(KARCH)/src/mm/page.c \
+    arch/$(KARCH)/src/mm/tlb.c \
+    arch/$(KARCH)/src/sparc64.c \
+    arch/$(KARCH)/src/start.S \
+    arch/$(KARCH)/src/proc/scheduler.c \
+    arch/$(KARCH)/src/proc/thread.c \
+    arch/$(KARCH)/src/trap/mmu.S \
+    arch/$(KARCH)/src/trap/trap_table.S \
+    arch/$(KARCH)/src/trap/trap.c \
+    arch/$(KARCH)/src/trap/exception.c \
+    arch/$(KARCH)/src/trap/interrupt.c \
+    arch/$(KARCH)/src/ddi/ddi.c \
+    arch/$(KARCH)/src/drivers/tick.c \
+    arch/$(KARCH)/src/drivers/kbd.c \
+    arch/$(KARCH)/src/drivers/sgcn.c \
+    arch/$(KARCH)/src/drivers/pci.c \
+    arch/$(KARCH)/src/drivers/fhc.c
+ifeq ($(CONFIG_FB),y)
+    ARCH_SOURCES += \
+        arch/$(KARCH)/src/drivers/scr.c
+endif
 ifeq ($(CONFIG_SMP),y)
-ARCH_SOURCES += \
-    arch/$(ARCH)/src/smp/ipi.c \
-    arch/$(ARCH)/src/smp/smp.c
+    ARCH_SOURCES += \
+        arch/$(KARCH)/src/smp/ipi.c \
+        arch/$(KARCH)/src/smp/smp.c
 endif
 ifeq ($(CONFIG_TSB),y)
-ARCH_SOURCES += \
-    arch/$(ARCH)/src/mm/tsb.c
+    ARCH_SOURCES += \
+        arch/$(KARCH)/src/mm/tsb.c
 endif
-ifdef CONFIG_Z8530
-ARCH_SOURCES += \
-    arch/$(ARCH)/src/drivers/fhc.c
-endif

 /branches/tracing/kernel/arch/sparc64/src/smp/ipi.c
 ,7 → 98,7
     status = asi_u64_read(ASI_INTR_DISPATCH_STATUS, 0);
     if (status & INTR_DISPATCH_STATUS_BUSY)
-        panic("Interrupt Dispatch Status busy bit set\n");
+        panic("Interrupt Dispatch Status busy bit set.");
     ASSERT(!(pstate_read() & PSTATE_IE_BIT));
 ,7 → 151,7
         func = tlb_shootdown_ipi_recv;
         break;
     default:
-        panic("Unknown IPI (%d).\n", ipi);
+        panic("Unknown IPI (%d).", ipi);
         break;
     }

 /branches/tracing/kernel/arch/sparc64/src/asm.S
 ,10 → 225,15
 .global memsetb
 memsetb:
-    b _memsetb
+    ba %xcc, _memsetb
     nop
+.global memsetw
+memsetw:
+    ba %xcc, _memsetw
+    nop
 .macro WRITE_ALTERNATE_REGISTER reg, bit
     rdpr %pstate, %g1               ! save PSTATE.PEF
     wrpr %g0, (\bit | PSTATE_PRIV_BIT), %pstate

 /branches/tracing/kernel/arch/sparc64/src/console.c
 ,7 → 26,7
  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
  */
-/** @addtogroup sparc64
+/** @addtogroup sparc64
  * @{
  */
 /** @file
 ,16 → 37,8
 #include <arch/drivers/scr.h>
 #include <arch/drivers/kbd.h>
 #include <arch/drivers/sgcn.h>
-#ifdef CONFIG_Z8530
-#include <genarch/kbd/z8530.h>
-#endif
-#ifdef CONFIG_NS16550
-#include <genarch/kbd/ns16550.h>
-#endif
+#include <genarch/srln/srln.h>
 #include <console/chardev.h>
 #include <console/console.h>
 #include <arch/asm.h>
 ,7 → 48,7
 #include <genarch/ofw/ofw_tree.h>
 #include <arch.h>
 #include <panic.h>
-#include <func.h>
+#include <string.h>
 #include <print.h>
 #define KEYBOARD_POLL_PAUSE 50000   /* 50ms */
 ,39 → 61,50
  */
 static void standard_console_init(ofw_tree_node_t *aliases)
 {
-    stdin = NULL;
-    ofw_tree_property_t *prop;
-    ofw_tree_node_t *screen;
-    ofw_tree_node_t *keyboard;
+#ifdef CONFIG_FB
+    ofw_tree_property_t *prop_scr = ofw_tree_getprop(aliases, "screen");
+    if (!prop_scr)
+        panic("Cannot find property 'screen'.");
+    if (!prop_scr->value)
+        panic("Cannot find screen alias.");
+    ofw_tree_node_t *screen = ofw_tree_lookup(prop_scr->value);
+    if (!screen)
+        panic("Cannot find %s.", prop_scr->value);
-    prop = ofw_tree_getprop(aliases, "screen");
-    if (!prop)
-        panic("Can't find property \"screen\".\n");
-    if (!prop->value)
-        panic("Can't find screen alias.\n");
-    screen = ofw_tree_lookup(prop->value);
-    if (!screen)
-        panic("Can't find %s\n", prop->value);
     scr_init(screen);
+#endif
-    prop = ofw_tree_getprop(aliases, "keyboard");
-    if (!prop)
-        panic("Can't find property \"keyboard\".\n");
-    if (!prop->value)
-        panic("Can't find keyboard alias.\n");
-    keyboard = ofw_tree_lookup(prop->value);
+#ifdef CONFIG_SUN_KBD
+    ofw_tree_property_t *prop_kbd = ofw_tree_getprop(aliases, "keyboard");
+    if (!prop_kbd)
+        panic("Cannot find property 'keyboard'.");
+    if (!prop_kbd->value)
+        panic("Cannot find keyboard alias.");
+    ofw_tree_node_t *keyboard = ofw_tree_lookup(prop_kbd->value);
     if (!keyboard)
-        panic("Can't find %s\n", prop->value);
+        panic("Cannot find %s.", prop_kbd->value);
     kbd_init(keyboard);
+#endif
 }
 /** Initilize I/O on the Serengeti machine. */
 static void serengeti_init(void)
 {
-    sgcn_init();
+#ifdef CONFIG_SGCN_KBD
+    sgcn_instance_t *sgcn_instance = sgcnin_init();
+    if (sgcn_instance) {
+        srln_instance_t *srln_instance = srln_init();
+        if (srln_instance) {
+            indev_t *sink = stdin_wire();
+            indev_t *srln = srln_wire(srln_instance, sink);
+            sgcnin_wire(sgcn_instance, srln);
+        }
+    }
+#endif
+#ifdef CONFIG_SGCN_PRN
+    sgcnout_init();
+#endif
 }
 /**
 ,12 → 118,12
     aliases = ofw_tree_lookup("/aliases");
     if (!aliases)
-        panic("Can't find /aliases.\n");
+        panic("Cannot find '/aliases'.");
     /* "def-cn" = "default console" */
     prop = ofw_tree_getprop(aliases, "def-cn");
-    if ((!prop) || (!prop->value) || (strcmp(prop->value, "/sgcn") != 0)) {
+    if ((!prop) || (!prop->value) || (str_cmp(prop->value, "/sgcn") != 0)) {
         standard_console_init(aliases);
     } else {
         serengeti_init();
 ,72 → 131,18
 }
-/** Kernel thread for polling keyboard.
- *
- * @param arg Ignored.
- */
-void kkbdpoll(void *arg)
-{
-    thread_detach(THREAD);
-#ifdef CONFIG_Z8530
-    if (kbd_type == KBD_Z8530) {
-        /*
-         * The z8530 driver is interrupt-driven.
-         */
-        return;
-    }
-#endif
-#ifdef CONFIG_NS16550
-#ifdef CONFIG_NS16550_INTERRUPT_DRIVEN
-    if (kbd_type == KBD_NS16550) {
-        /*
-         * The ns16550 driver is interrupt-driven.
-         */
-        return;
-    }
-#endif
-#endif
-    while (1) {
-#ifdef CONFIG_NS16550
-#ifndef CONFIG_NS16550_INTERRUPT_DRIVEN
-        if (kbd_type == KBD_NS16550)
-            ns16550_poll();
-#endif
-#endif
-#ifdef CONFIG_SGCN
-        if (kbd_type == KBD_SGCN)
-            sgcn_poll();
-#endif
-        thread_usleep(KEYBOARD_POLL_PAUSE);
-    }
-}
 /** Acquire console back for kernel
  *
  */
 void arch_grab_console(void)
 {
-    switch (kbd_type) {
-#ifdef CONFIG_Z8530
-    case KBD_Z8530:
-        z8530_grab();
-        break;
+#ifdef CONFIG_FB
+    scr_redraw();
 #endif
-#ifdef CONFIG_NS16550
-    case KBD_NS16550:
-        ns16550_grab();
-        break;
+#ifdef CONFIG_SGCN_KBD
+    sgcn_grab();
 #endif
-#ifdef CONFIG_SGCN
-    case KBD_SGCN:
-        sgcn_grab();
-        break;
-#endif
-    default:
-        break;
-    }
 }
 /** Return console to userspace
 ,25 → 150,9
  */
 void arch_release_console(void)
 {
-    switch (kbd_type) {
-#ifdef CONFIG_Z8530
-    case KBD_Z8530:
-        z8530_release();
-        break;
+#ifdef CONFIG_SGCN_KBD
+    sgcn_release();
 #endif
-#ifdef CONFIG_NS16550
-    case KBD_NS16550:
-        ns16550_release();
-        break;
-#endif
-#ifdef CONFIG_SGCN
-    case KBD_SGCN:
-        sgcn_release();
-        break;
-#endif
-    default:
-        break;
-    }
 }
 /** @}

 /branches/tracing/kernel/arch/sparc64/src/sparc64.c
 ,7 → 37,6
 #include <config.h>
 #include <arch/trap/trap.h>
 #include <arch/console.h>
-#include <proc/thread.h>
 #include <console/console.h>
 #include <arch/boot/boot.h>
 #include <arch/arch.h>
 ,10 → 46,11
 #include <genarch/ofw/ofw_tree.h>
 #include <userspace.h>
 #include <ddi/irq.h>
+#include <string.h>
 bootinfo_t bootinfo;
-/** Perform sparc64 specific initialization before main_bsp() is called. */
+/** Perform sparc64-specific initialization before main_bsp() is called. */
 void arch_pre_main(void)
 {
     /* Copy init task info. */
 ,6 → 61,8
     for (i = 0; i < bootinfo.taskmap.count; i++) {
         init.tasks[i].addr = (uintptr_t) bootinfo.taskmap.tasks[i].addr;
         init.tasks[i].size = bootinfo.taskmap.tasks[i].size;
+        str_cpy(init.tasks[i].name, CONFIG_TASK_NAME_BUFLEN,
+            bootinfo.taskmap.tasks[i].name);
     }
     /* Copy boot allocations info. */
 ,8 → 88,6
          * But we only create 128 buckets.
          */
         irq_init(1 << 11, 128);
-        standalone_sparc64_console_init();
     }
 }
 ,18 → 101,7
 void arch_post_smp_init(void)
 {
-    static thread_t *t = NULL;
-    if (!t) {
-        /*
-             * Create thread that polls keyboard.
-             */
-        t = thread_create(kkbdpoll, NULL, TASK, 0, "kkbdpoll", true);
-        if (!t)
-            panic("cannot create kkbdpoll\n");
-        thread_ready(t);
-    }
+    standalone_sparc64_console_init();
 }
 /** Calibrate delay loop.
 ,5 → 150,19
     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)
+{
+    return addr;
+}
 /** @}
  */

 /branches/tracing/kernel/arch/sparc64/src/trap/exception.c
 ,62 → 40,67
 #include <arch/asm.h>
 #include <arch/register.h>
 #include <debug.h>
+#include <print.h>
 #include <symtab.h>
-#include <print.h>
 void dump_istate(istate_t *istate)
 {
+    char *tpcs, *tnpcs;
+    tpcs = symtab_fmt_name_lookup(istate->tpc);
+    tnpcs = symtab_fmt_name_lookup(istate->tnpc);
     printf("TSTATE=%#" PRIx64 "\n", istate->tstate);
-    printf("TPC=%#" PRIx64 " (%s)\n", istate->tpc, get_symtab_entry(istate->tpc));
-    printf("TNPC=%#" PRIx64 " (%s)\n", istate->tnpc, get_symtab_entry(istate->tnpc));
+    printf("TPC=%#" PRIx64 " (%s)\n", istate->tpc, tpcs);
+    printf("TNPC=%#" PRIx64 " (%s)\n", istate->tnpc, tnpcs);
 }
 /** Handle instruction_access_exception. (0x8) */
 void instruction_access_exception(int n, istate_t *istate)
 {
-    fault_if_from_uspace(istate, "%s\n", __func__);
+    fault_if_from_uspace(istate, "%s.", __func__);
     dump_istate(istate);
-    panic("%s\n", __func__);
+    panic("%s.", __func__);
 }
 /** Handle instruction_access_error. (0xa) */
 void instruction_access_error(int n, istate_t *istate)
 {
-    fault_if_from_uspace(istate, "%s\n", __func__);
+    fault_if_from_uspace(istate, "%s.", __func__);
     dump_istate(istate);
-    panic("%s\n", __func__);
+    panic("%s.", __func__);
 }
 /** Handle illegal_instruction. (0x10) */
 void illegal_instruction(int n, istate_t *istate)
 {
-    fault_if_from_uspace(istate, "%s\n", __func__);
+    fault_if_from_uspace(istate, "%s.", __func__);
     dump_istate(istate);
-    panic("%s\n", __func__);
+    panic("%s.", __func__);
 }
 /** Handle privileged_opcode. (0x11) */
 void privileged_opcode(int n, istate_t *istate)
 {
-    fault_if_from_uspace(istate, "%s\n", __func__);
+    fault_if_from_uspace(istate, "%s.", __func__);
     dump_istate(istate);
-    panic("%s\n", __func__);
+    panic("%s.", __func__);
 }
 /** Handle unimplemented_LDD. (0x12) */
 void unimplemented_LDD(int n, istate_t *istate)
 {
-    fault_if_from_uspace(istate, "%s\n", __func__);
+    fault_if_from_uspace(istate, "%s.", __func__);
     dump_istate(istate);
-    panic("%s\n", __func__);
+    panic("%s.", __func__);
 }
 /** Handle unimplemented_STD. (0x13) */
 void unimplemented_STD(int n, istate_t *istate)
 {
-    fault_if_from_uspace(istate, "%s\n", __func__);
+    fault_if_from_uspace(istate, "%s.", __func__);
     dump_istate(istate);
-    panic("%s\n", __func__);
+    panic("%s.", __func__);
 }
 /** Handle fp_disabled. (0x20) */
 ,9 → 118,9
 #ifdef CONFIG_FPU_LAZY
     scheduler_fpu_lazy_request();
 #else
-    fault_if_from_uspace(istate, "%s\n", __func__);
+    fault_if_from_uspace(istate, "%s.", __func__);
     dump_istate(istate);
-    panic("%s\n", __func__);
+    panic("%s.", __func__);
 #endif
 }
 ,98 → 127,98
 /** Handle fp_exception_ieee_754. (0x21) */
 void fp_exception_ieee_754(int n, istate_t *istate)
 {
-    fault_if_from_uspace(istate, "%s\n", __func__);
+    fault_if_from_uspace(istate, "%s.", __func__);
     dump_istate(istate);
-    panic("%s\n", __func__);
+    panic("%s.", __func__);
 }
 /** Handle fp_exception_other. (0x22) */
 void fp_exception_other(int n, istate_t *istate)
 {
-    fault_if_from_uspace(istate, "%s\n", __func__);
+    fault_if_from_uspace(istate, "%s.", __func__);
     dump_istate(istate);
-    panic("%s\n", __func__);
+    panic("%s.", __func__);
 }
 /** Handle tag_overflow. (0x23) */
 void tag_overflow(int n, istate_t *istate)
 {
-    fault_if_from_uspace(istate, "%s\n", __func__);
+    fault_if_from_uspace(istate, "%s.", __func__);
     dump_istate(istate);
-    panic("%s\n", __func__);
+    panic("%s.", __func__);
 }
 /** Handle division_by_zero. (0x28) */
 void division_by_zero(int n, istate_t *istate)
 {
-    fault_if_from_uspace(istate, "%s\n", __func__);
+    fault_if_from_uspace(istate, "%s.", __func__);
     dump_istate(istate);
-    panic("%s\n", __func__);
+    panic("%s.", __func__);
 }
 /** Handle data_access_exception. (0x30) */
 void data_access_exception(int n, istate_t *istate)
 {
-    fault_if_from_uspace(istate, "%s\n", __func__);
+    fault_if_from_uspace(istate, "%s.", __func__);
     dump_istate(istate);
     dump_sfsr_and_sfar();
-    panic("%s\n", __func__);
+    panic("%s.", __func__);
 }
 /** Handle data_access_error. (0x32) */
 void data_access_error(int n, istate_t *istate)
 {
-    fault_if_from_uspace(istate, "%s\n", __func__);
+    fault_if_from_uspace(istate, "%s.", __func__);
     dump_istate(istate);
-    panic("%s\n", __func__);
+    panic("%s.", __func__);
 }
 /** Handle mem_address_not_aligned. (0x34) */
 void mem_address_not_aligned(int n, istate_t *istate)
 {
-    fault_if_from_uspace(istate, "%s\n", __func__);
+    fault_if_from_uspace(istate, "%s.", __func__);
     dump_istate(istate);
-    panic("%s\n", __func__);
+    panic("%s.", __func__);
 }
 /** Handle LDDF_mem_address_not_aligned. (0x35) */
 void LDDF_mem_address_not_aligned(int n, istate_t *istate)
 {
-    fault_if_from_uspace(istate, "%s\n", __func__);
+    fault_if_from_uspace(istate, "%s.", __func__);
     dump_istate(istate);
-    panic("%s\n", __func__);
+    panic("%s.", __func__);
 }
 /** Handle STDF_mem_address_not_aligned. (0x36) */
 void STDF_mem_address_not_aligned(int n, istate_t *istate)
 {
-    fault_if_from_uspace(istate, "%s\n", __func__);
+    fault_if_from_uspace(istate, "%s.", __func__);
     dump_istate(istate);
-    panic("%s\n", __func__);
+    panic("%s.", __func__);
 }
 /** Handle privileged_action. (0x37) */
 void privileged_action(int n, istate_t *istate)
 {
-    fault_if_from_uspace(istate, "%s\n", __func__);
+    fault_if_from_uspace(istate, "%s.", __func__);
     dump_istate(istate);
-    panic("%s\n", __func__);
+    panic("%s.", __func__);
 }
 /** Handle LDQF_mem_address_not_aligned. (0x38) */
 void LDQF_mem_address_not_aligned(int n, istate_t *istate)
 {
-    fault_if_from_uspace(istate, "%s\n", __func__);
+    fault_if_from_uspace(istate, "%s.", __func__);
     dump_istate(istate);
-    panic("%s\n", __func__);
+    panic("%s.", __func__);
 }
 /** Handle STQF_mem_address_not_aligned. (0x39) */
 void STQF_mem_address_not_aligned(int n, istate_t *istate)
 {
-    fault_if_from_uspace(istate, "%s\n", __func__);
+    fault_if_from_uspace(istate, "%s.", __func__);
     dump_istate(istate);
-    panic("%s\n", __func__);
+    panic("%s.", __func__);
 }
 /** @}

 /branches/tracing/kernel/arch/sparc64/src/trap/interrupt.c
 ,7 → 72,7
     uint64_t data0;
     status = asi_u64_read(ASI_INTR_DISPATCH_STATUS, 0);
     if (status & (!INTR_DISPATCH_STATUS_BUSY))
-        panic("Interrupt Dispatch Status busy bit not set\n");
+        panic("Interrupt Dispatch Status busy bit not set.");
     intrcv = asi_u64_read(ASI_INTR_RECEIVE, 0);
 #if defined (US)
 ,7 → 86,7
         /*
          * The IRQ handler was found.
          */
-        irq->handler(irq, irq->arg);
+        irq->handler(irq);
         /*
          * See if there is a clear-interrupt-routine and call it.
          */

 /branches/tracing/kernel/arch/sparc64/src/trap/trap_table.S
 ,7 → 341,7
 .org trap_table + (TT_TRAP_INSTRUCTION_0+\cur)*ENTRY_SIZE
 .global trap_instruction_\cur\()_tl0
 trap_instruction_\cur\()_tl0:
-    ba trap_instruction_handler
+    ba %xcc, trap_instruction_handler
     mov \cur, %g2
 .endr
 ,9 → 478,9
      */
     rdpr %tl, %g3
     cmp %g3, 1
-    be 1f
+    be %xcc, 1f
     nop
-:  ba 0b                   ! this is for debugging, if we ever get here
+:  ba %xcc, 0b             ! this is for debugging, if we ever get here
     nop                 ! it will be easy to find
 :
 ,7 → 499,7
     wrpr %g4, 0, %cwp           ! resynchronize CWP
     andcc %g3, TSTATE_PRIV_BIT, %g0     ! if this trap came from the privileged mode...
-    bnz 0f                  ! ...skip setting of kernel stack and primary context
+    bnz %xcc, 0f                ! ...skip setting of kernel stack and primary context
     nop
 .endif
 ,7 → 545,7
     flush %l0
 .if NOT(\is_syscall)
-    ba 1f
+    ba %xcc, 1f
     nop
 :
     save %sp, -PREEMPTIBLE_HANDLER_STACK_FRAME_SIZE, %sp
 ,10 → 606,10
     add %sp, PREEMPTIBLE_HANDLER_STACK_FRAME_SIZE + STACK_BIAS + SAVED_TNPC, %o1
 .else
     /*
-     * Call the higher-level syscall handler.
+     * Call the higher-level syscall handler and enable interrupts.
      */
     call syscall_handler
-    nop
+    wrpr %g0, PSTATE_PRIV_BIT | PSTATE_PEF_BIT | PSTATE_IE_BIT, %pstate
     mov %o0, %i0                ! copy the value returned by the syscall
 .endif
 ,7 → 672,7
     and %l0, NWINDOWS - 1, %l0  ! %l0 mod NWINDOWS
     rdpr %cwp, %l1
     cmp %l0, %l1
-    bz 0f               ! CWP is ok
+    bz %xcc, 0f         ! CWP is ok
     nop
     /*
 ,7 → 712,7
 .if NOT(\is_syscall)
     rdpr %tstate, %g1
     andcc %g1, TSTATE_PRIV_BIT, %g0     ! if we are not returning to userspace...,
-    bnz 1f                  ! ...skip restoring userspace windows
+    bnz %xcc, 1f                ! ...skip restoring userspace windows
     nop
 .endif
 ,7 → 749,7
      */
     clr %g4
 :  andcc %g7, UWB_ALIGNMENT - 1, %g0   ! alignment check
-    bz 0f                   ! %g7 is UWB_ALIGNMENT-aligned, no more windows to refill
+    bz %xcc, 0f             ! %g7 is UWB_ALIGNMENT-aligned, no more windows to refill
     nop
     add %g7, -STACK_WINDOW_SAVE_AREA_SIZE, %g7
 ,7 → 774,7
     and %g3, NWINDOWS - 1, %g3
     wrpr %g3, 0, %cwp           ! switch to the preceeding window
-    ba 0b
+    ba %xcc, 0b
     inc %g4
 :
 ,7 → 785,7
     wrpr %g1, 0, %cwp
     add %g4, %g2, %g2
     cmp %g2, NWINDOWS - 2
-    bg 2f                   ! fix the CANRESTORE=NWINDOWS-1 anomaly
+    bg %xcc, 2f             ! fix the CANRESTORE=NWINDOWS-1 anomaly
     mov NWINDOWS - 2, %g1           ! use dealy slot for both cases
     sub %g1, %g2, %g1

 /branches/tracing/kernel/arch/sparc64/src/mm/tlb.c
 ,12 → 199,12
 /** ITLB miss handler. */
 void fast_instruction_access_mmu_miss(unative_t unused, istate_t *istate)
 {
-    uintptr_t va = ALIGN_DOWN(istate->tpc, PAGE_SIZE);
+    uintptr_t page_16k = ALIGN_DOWN(istate->tpc, PAGE_SIZE);
     index_t index = (istate->tpc >> MMU_PAGE_WIDTH) % MMU_PAGES_PER_PAGE;
     pte_t *t;
     page_table_lock(AS, true);
-    t = page_mapping_find(AS, va);
+    t = page_mapping_find(AS, page_16k);
     if (t && PTE_EXECUTABLE(t)) {
         /*
          * The mapping was found in the software page hash table.
 ,7 → 222,8
          * handler.
          */
         page_table_unlock(AS, true);
-        if (as_page_fault(va, PF_ACCESS_EXEC, istate) == AS_PF_FAULT) {
+        if (as_page_fault(page_16k, PF_ACCESS_EXEC, istate) ==
+            AS_PF_FAULT) {
             do_fast_instruction_access_mmu_miss_fault(istate,
                 __func__);
         }
 ,11 → 243,13
  */
 void fast_data_access_mmu_miss(tlb_tag_access_reg_t tag, istate_t *istate)
 {
-    uintptr_t va;
+    uintptr_t page_8k;
+    uintptr_t page_16k;
     index_t index;
     pte_t *t;
-    va = ALIGN_DOWN((uint64_t) tag.vpn << MMU_PAGE_WIDTH, PAGE_SIZE);
+    page_8k = (uint64_t) tag.vpn << MMU_PAGE_WIDTH;
+    page_16k = ALIGN_DOWN(page_8k, PAGE_SIZE);
     index = tag.vpn % MMU_PAGES_PER_PAGE;
     if (tag.context == ASID_KERNEL) {
 ,6 → 257,15
             /* NULL access in kernel */
             do_fast_data_access_mmu_miss_fault(istate, tag,
                 __func__);
+        } else if (page_8k >= end_of_identity) {
+            /*
+             * The kernel is accessing the I/O space.
+             * We still do identity mapping for I/O,
+             * but without caching.
+             */
+            dtlb_insert_mapping(page_8k, KA2PA(page_8k),
+                PAGESIZE_8K, false, false);
+            return;
         }
         do_fast_data_access_mmu_miss_fault(istate, tag, "Unexpected "
             "kernel page fault.");
 ,7 → 272,7
     }
     page_table_lock(AS, true);
-    t = page_mapping_find(AS, va);
+    t = page_mapping_find(AS, page_16k);
     if (t) {
         /*
          * The mapping was found in the software page hash table.
 ,7 → 290,8
          * handler.
          */
         page_table_unlock(AS, true);
-        if (as_page_fault(va, PF_ACCESS_READ, istate) == AS_PF_FAULT) {
+        if (as_page_fault(page_16k, PF_ACCESS_READ, istate) ==
+            AS_PF_FAULT) {
             do_fast_data_access_mmu_miss_fault(istate, tag,
                 __func__);
         }
 ,15 → 308,15
  */
 void fast_data_access_protection(tlb_tag_access_reg_t tag, istate_t *istate)
 {
-    uintptr_t va;
+    uintptr_t page_16k;
     index_t index;
     pte_t *t;
-    va = ALIGN_DOWN((uint64_t) tag.vpn << MMU_PAGE_WIDTH, PAGE_SIZE);
+    page_16k = ALIGN_DOWN((uint64_t) tag.vpn << MMU_PAGE_WIDTH, PAGE_SIZE);
     index = tag.vpn % MMU_PAGES_PER_PAGE;   /* 16K-page emulation */
     page_table_lock(AS, true);
-    t = page_mapping_find(AS, va);
+    t = page_mapping_find(AS, page_16k);
     if (t && PTE_WRITABLE(t)) {
         /*
          * The mapping was found in the software page hash table and is
 ,7 → 326,7
         t->a = true;
         t->d = true;
         dtlb_demap(TLB_DEMAP_PAGE, TLB_DEMAP_SECONDARY,
-            va + index * MMU_PAGE_SIZE);
+            page_16k + index * MMU_PAGE_SIZE);
         dtlb_pte_copy(t, index, false);
 #ifdef CONFIG_TSB
         dtsb_pte_copy(t, index, false);
 ,7 → 338,8
          * handler.
          */
         page_table_unlock(AS, true);
-        if (as_page_fault(va, PF_ACCESS_WRITE, istate) == AS_PF_FAULT) {
+        if (as_page_fault(page_16k, PF_ACCESS_WRITE, istate) ==
+            AS_PF_FAULT) {
             do_fast_data_access_protection_fault(istate, tag,
                 __func__);
         }
 ,9 → 438,9
 void do_fast_instruction_access_mmu_miss_fault(istate_t *istate,
     const char *str)
 {
-    fault_if_from_uspace(istate, "%s\n", str);
+    fault_if_from_uspace(istate, "%s.", str);
     dump_istate(istate);
-    panic("%s\n", str);
+    panic("%s.", str);
 }
 void do_fast_data_access_mmu_miss_fault(istate_t *istate,
 ,12 → 450,12
     va = tag.vpn << MMU_PAGE_WIDTH;
     if (tag.context) {
-        fault_if_from_uspace(istate, "%s, Page=%p (ASID=%d)\n", str, va,
+        fault_if_from_uspace(istate, "%s, Page=%p (ASID=%d).", str, va,
             tag.context);
     }
     dump_istate(istate);
-    printf("Faulting page: %p, ASID=%d\n", va, tag.context);
-    panic("%s\n", str);
+    printf("Faulting page: %p, ASID=%d.\n", va, tag.context);
+    panic("%s.", str);
 }
 void do_fast_data_access_protection_fault(istate_t *istate,
 ,12 → 466,12
     va = tag.vpn << MMU_PAGE_WIDTH;
     if (tag.context) {
-        fault_if_from_uspace(istate, "%s, Page=%p (ASID=%d)\n", str, va,
+        fault_if_from_uspace(istate, "%s, Page=%p (ASID=%d).", str, va,
             tag.context);
     }
     printf("Faulting page: %p, ASID=%d\n", va, tag.context);
     dump_istate(istate);
-    panic("%s\n", str);
+    panic("%s.", str);
 }
 void dump_sfsr_and_sfar(void)

 /branches/tracing/kernel/arch/sparc64/src/mm/frame.c
 ,7 → 26,7
  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
  */
-/** @addtogroup sparc64mm
+/** @addtogroup sparc64mm
  * @{
  */
 /** @file
 ,7 → 79,8
          */
         frame_mark_unavailable(ADDR2PFN(KA2PA(PFN2ADDR(0))), 1);
     }
+    end_of_identity = PA2KA(last_frame);
 }
 /** @}

 /branches/tracing/kernel/arch/sparc64/src/mm/page.c
 ,5 → 1,5
 /*
- * Copyright (c) 2005 Jakub Jermar
+ * Copyright (c) 2009 Jakub Jermar
  * All rights reserved.
  *
  * Redistribution and use in source and binary forms, with or without
 ,7 → 26,7
  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
  */
-/** @addtogroup sparc64mm
+/** @addtogroup sparc64mm
  * @{
  */
 /** @file
 ,128 → 42,28
 #include <align.h>
 #include <config.h>
-#ifdef CONFIG_SMP
-/** Entries locked in DTLB of BSP.
- *
- * Application processors need to have the same locked entries in their DTLBs as
- * the bootstrap processor.
- */
-static struct {
-    uintptr_t virt_page;
-    uintptr_t phys_page;
-    int pagesize_code;
-} bsp_locked_dtlb_entry[DTLB_MAX_LOCKED_ENTRIES];
-/** Number of entries in bsp_locked_dtlb_entry array. */
-static count_t bsp_locked_dtlb_entries = 0;
-#endif /* CONFIG_SMP */
 /** Perform sparc64 specific initialization of paging. */
 void page_arch_init(void)
 {
-    if (config.cpu_active == 1) {
+    if (config.cpu_active == 1)
         page_mapping_operations = &ht_mapping_operations;
-    } else {
-#ifdef CONFIG_SMP
-        unsigned int i;
-        /*
-         * Copy locked DTLB entries from the BSP.
-         */
-        for (i = 0; i < bsp_locked_dtlb_entries; i++) {
-            dtlb_insert_mapping(bsp_locked_dtlb_entry[i].virt_page,
-                bsp_locked_dtlb_entry[i].phys_page,
-                bsp_locked_dtlb_entry[i].pagesize_code, true,
-                false);
-        }
-#endif
-    }
 }
 /** Map memory-mapped device into virtual memory.
  *
- * So far, only DTLB is used to map devices into memory. Chances are that there
- * will be only a limited amount of devices that the kernel itself needs to
- * lock in DTLB.
+ * We are currently using identity mapping for mapping device registers.
  *
- * @param physaddr Physical address of the page where the device is located.
- *  Must be at least page-aligned.
- * @param size Size of the device's registers. Must not exceed 4M and must
- *  include extra space caused by the alignment.
+ * @param physaddr Physical address of the page where the device is
+ *                 located.
+ * @param size     Size of the device's registers.
  *
  * @return Virtual address of the page where the device is mapped.
+ *
  */
 uintptr_t hw_map(uintptr_t physaddr, size_t size)
 {
-    unsigned int order;
-    unsigned int i;
-    ASSERT(config.cpu_active == 1);
-    struct {
-        int pagesize_code;
-        size_t increment;
-        count_t count;
-    } sizemap[] = {
-        { PAGESIZE_8K, 0, 1 },              /* 8K */
-        { PAGESIZE_8K, MMU_PAGE_SIZE, 2 },      /* 16K */
-        { PAGESIZE_8K, MMU_PAGE_SIZE, 4 },      /* 32K */
-        { PAGESIZE_64K, 0, 1},              /* 64K */
-        { PAGESIZE_64K, 8 * MMU_PAGE_SIZE, 2 },     /* 128K */
-        { PAGESIZE_64K, 8 * MMU_PAGE_SIZE, 4 },     /* 256K */
-        { PAGESIZE_512K, 0, 1 },            /* 512K */
-        { PAGESIZE_512K, 64 * MMU_PAGE_SIZE, 2 },   /* 1M */
-        { PAGESIZE_512K, 64 * MMU_PAGE_SIZE, 4 },   /* 2M */
-        { PAGESIZE_4M, 0, 1 },              /* 4M */
-        { PAGESIZE_4M, 512 * MMU_PAGE_SIZE, 2 }     /* 8M */
-    };
-    ASSERT(ALIGN_UP(physaddr, MMU_PAGE_SIZE) == physaddr);
-    ASSERT(size <= 8 * 1024 * 1024);
-    if (size <= MMU_FRAME_SIZE)
-        order = 0;
-    else
-        order = (fnzb64(size - 1) + 1) - MMU_FRAME_WIDTH;
-    /*
-     * Use virtual addresses that are beyond the limit of physical memory.
-     * Thus, the physical address space will not be wasted by holes created
-     * by frame_alloc().
-     */
-    ASSERT(PA2KA(last_frame));
-    uintptr_t virtaddr = ALIGN_UP(PA2KA(last_frame),
-<< (order + FRAME_WIDTH));
-    last_frame = ALIGN_UP(KA2PA(virtaddr) + size,
-<< (order + FRAME_WIDTH));
-    for (i = 0; i < sizemap[order].count; i++) {
-        /*
-         * First, insert the mapping into DTLB.
-         */
-        dtlb_insert_mapping(virtaddr + i * sizemap[order].increment,
-            physaddr + i * sizemap[order].increment,
-            sizemap[order].pagesize_code, true, false);
-#ifdef CONFIG_SMP
-        /*
-         * Second, save the information about the mapping for APs.
-         */
-        bsp_locked_dtlb_entry[bsp_locked_dtlb_entries].virt_page =
-            virtaddr + i * sizemap[order].increment;
-        bsp_locked_dtlb_entry[bsp_locked_dtlb_entries].phys_page =
-            physaddr + i * sizemap[order].increment;
-        bsp_locked_dtlb_entry[bsp_locked_dtlb_entries].pagesize_code =
-            sizemap[order].pagesize_code;
-        bsp_locked_dtlb_entries++;
-#endif
-    }
-    return virtaddr;
+    return PA2KA(physaddr);
 }
 /** @}
  */

/branches/tracing/kernel/arch/sparc64/src/dummy.s
42,5 → 42,5

.global cpu_halt
cpu_halt:
b cpu_halt
ba %xcc, cpu_halt
nop

 /branches/tracing/kernel/arch/sparc64/src/drivers/fhc.c
 ,6 → 45,7
 #include <mm/slab.h>
 #include <arch/types.h>
 #include <genarch/ofw/ofw_tree.h>
+#include <sysinfo/sysinfo.h>
 fhc_t *central_fhc = NULL;
 ,6 → 87,13
     fhc->uart_imap = (uint32_t *) hw_map(paddr, reg->size);
+    /*
+     * Set sysinfo data needed by the uspace FHC driver.
+     */
+    sysinfo_set_item_val("fhc.uart.size", NULL, reg->size);
+    sysinfo_set_item_val("fhc.uart.physical", NULL, paddr);
+    sysinfo_set_item_val("kbd.cir.fhc", NULL, 1);
     return fhc;
 }
 ,7 → 104,7
         fhc->uart_imap[FHC_UART_IMAP] |= IMAP_V_MASK;
         break;
     default:
-        panic("Unexpected INR (%d)\n", inr);
+        panic("Unexpected INR (%d).", inr);
         break;
     }
 }
 ,7 → 119,7
         fhc->uart_imap[FHC_UART_ICLR] = 0;
         break;
     default:
-        panic("Unexpected INR (%d)\n", inr);
+        panic("Unexpected INR (%d).", inr);
         break;
     }
 }

 /branches/tracing/kernel/arch/sparc64/src/drivers/kbd.c
 ,7 → 26,7
  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
  */
-/** @addtogroup sparc64
+/** @addtogroup sparc64
  * @{
  */
 /** @file
 ,107 → 34,160
 #include <arch/drivers/kbd.h>
 #include <genarch/ofw/ofw_tree.h>
+#ifdef CONFIG_SUN_KBD
+#include <genarch/kbrd/kbrd.h>
+#endif
 #ifdef CONFIG_Z8530
-#include <genarch/kbd/z8530.h>
+#include <genarch/drivers/z8530/z8530.h>
 #endif
 #ifdef CONFIG_NS16550
-#include <genarch/kbd/ns16550.h>
+#include <genarch/drivers/ns16550/ns16550.h>
 #endif
-#include <ddi/device.h>
+#include <console/console.h>
 #include <ddi/irq.h>
 #include <arch/mm/page.h>
 #include <arch/types.h>
 #include <align.h>
-#include <func.h>
+#include <string.h>
 #include <print.h>
+#include <sysinfo/sysinfo.h>
-kbd_type_t kbd_type = KBD_UNKNOWN;
+#ifdef CONFIG_SUN_KBD
-/** Initialize keyboard.
- *
- * Traverse OpenFirmware device tree in order to find necessary
- * info about the keyboard device.
- *
- * @param node Keyboard device node.
- */
-void kbd_init(ofw_tree_node_t *node)
+#ifdef CONFIG_Z8530
+static bool kbd_z8530_init(ofw_tree_node_t *node)
 {
-    size_t offset;
-    uintptr_t aligned_addr;
-    ofw_tree_property_t *prop;
-    const char *name;
+    const char *name = ofw_tree_node_name(node);
+    if (str_cmp(name, "zs") != 0)
+        return false;
+    /*
+     * Read 'interrupts' property.
+     */
+    ofw_tree_property_t *prop = ofw_tree_getprop(node, "interrupts");
+    if ((!prop) || (!prop->value)) {
+        printf("z8530: Unable to find interrupts property\n");
+        return false;
+    }
+    uint32_t interrupts = *((uint32_t *) prop->value);
+    /*
+     * Read 'reg' property.
+     */
+    prop = ofw_tree_getprop(node, "reg");
+    if ((!prop) || (!prop->value)) {
+        printf("z8530: Unable to find reg property\n");
+        return false;
+    }
+    size_t size = ((ofw_fhc_reg_t *) prop->value)->size;
+    uintptr_t pa;
+    if (!ofw_fhc_apply_ranges(node->parent,
+        ((ofw_fhc_reg_t *) prop->value), &pa)) {
+        printf("z8530: Failed to determine address\n");
+        return false;
+    }
+    inr_t inr;
     cir_t cir;
     void *cir_arg;
+    if (!ofw_fhc_map_interrupt(node->parent,
+        ((ofw_fhc_reg_t *) prop->value), interrupts, &inr, &cir,
+        &cir_arg)) {
+        printf("z8530: Failed to determine interrupt\n");
+        return false;
+    }
-    name = ofw_tree_node_name(node);
     /*
-     * Determine keyboard serial controller type.
+     * We need to pass aligned address to hw_map().
+     * However, the physical keyboard address can
+     * be pretty much unaligned, depending on the
+     * underlying controller.
      */
-    if (strcmp(name, "zs") == 0)
-        kbd_type = KBD_Z8530;
-    else if (strcmp(name, "su") == 0)
-        kbd_type = KBD_NS16550;
+    uintptr_t aligned_addr = ALIGN_DOWN(pa, PAGE_SIZE);
+    size_t offset = pa - aligned_addr;
-    if (kbd_type == KBD_UNKNOWN) {
-        printf("Unknown keyboard device.\n");
-        return;
+    z8530_t *z8530 = (z8530_t *)
+        (hw_map(aligned_addr, offset + size) + offset);
+    z8530_instance_t *z8530_instance = z8530_init(z8530, inr, cir, cir_arg);
+    if (z8530_instance) {
+        kbrd_instance_t *kbrd_instance = kbrd_init();
+        if (kbrd_instance) {
+            indev_t *sink = stdin_wire();
+            indev_t *kbrd = kbrd_wire(kbrd_instance, sink);
+            z8530_wire(z8530_instance, kbrd);
+        }
     }
     /*
-     * Read 'interrupts' property.
+     * This is the necessary evil until the userspace drivers are
+     * entirely self-sufficient.
      */
-    uint32_t interrupts;
-    prop = ofw_tree_getprop(node, "interrupts");
-    if (!prop || !prop->value)
-        panic("Can't find \"interrupts\" property.\n");
-    interrupts = *((uint32_t *) prop->value);
+    sysinfo_set_item_val("kbd", NULL, true);
+    sysinfo_set_item_val("kbd.inr", NULL, inr);
+    sysinfo_set_item_val("kbd.address.kernel", NULL,
+        (uintptr_t) z8530);
+    sysinfo_set_item_val("kbd.address.physical", NULL, pa);
+    sysinfo_set_item_val("kbd.type.z8530", NULL, true);
+    return true;
+}
+#endif /* CONFIG_Z8530 */
+#ifdef CONFIG_NS16550
+static bool kbd_ns16550_init(ofw_tree_node_t *node)
+{
+    const char *name = ofw_tree_node_name(node);
+    if (str_cmp(name, "su") != 0)
+        return false;
     /*
+     * Read 'interrupts' property.
+     */
+    ofw_tree_property_t *prop = ofw_tree_getprop(node, "interrupts");
+    if ((!prop) || (!prop->value)) {
+        printf("ns16550: Unable to find interrupts property\n");
+        return false;
+    }
+    uint32_t interrupts = *((uint32_t *) prop->value);
+    /*
      * Read 'reg' property.
      */
     prop = ofw_tree_getprop(node, "reg");
-    if (!prop || !prop->value)
-        panic("Can't find \"reg\" property.\n");
+    if ((!prop) || (!prop->value)) {
+        printf("ns16550: Unable to find reg property\n");
+        return false;
+    }
+    size_t size = ((ofw_ebus_reg_t *) prop->value)->size;
     uintptr_t pa;
-    size_t size;
+    if (!ofw_ebus_apply_ranges(node->parent,
+        ((ofw_ebus_reg_t *) prop->value), &pa)) {
+        printf("ns16550: Failed to determine address\n");
+        return false;
+    }
     inr_t inr;
-    devno_t devno = device_assign_devno();
-    switch (kbd_type) {
-    case KBD_Z8530:
-        size = ((ofw_fhc_reg_t *) prop->value)->size;
-        if (!ofw_fhc_apply_ranges(node->parent,
-            ((ofw_fhc_reg_t *) prop->value), &pa)) {
-            printf("Failed to determine keyboard address.\n");
-            return;
-        }
-        if (!ofw_fhc_map_interrupt(node->parent,
-            ((ofw_fhc_reg_t *) prop->value), interrupts, &inr, &cir,
-            &cir_arg)) {
-            printf("Failed to determine keyboard interrupt.\n");
-            return;
-        }
-        break;
-    case KBD_NS16550:
-        size = ((ofw_ebus_reg_t *) prop->value)->size;
-        if (!ofw_ebus_apply_ranges(node->parent,
-            ((ofw_ebus_reg_t *) prop->value), &pa)) {
-            printf("Failed to determine keyboard address.\n");
-            return;
-        }
-        if (!ofw_ebus_map_interrupt(node->parent,
-            ((ofw_ebus_reg_t *) prop->value), interrupts, &inr, &cir,
-            &cir_arg)) {
-            printf("Failed to determine keyboard interrupt.\n");
-            return;
-        };
-        break;
-    default:
-        panic("Unexpected type.\n");
+    cir_t cir;
+    void *cir_arg;
+    if (!ofw_ebus_map_interrupt(node->parent,
+        ((ofw_ebus_reg_t *) prop->value), interrupts, &inr, &cir,
+        &cir_arg)) {
+        printf("ns16550: Failed to determine interrupt\n");
+        return false;
     }
     /*
 ,26 → 196,58
      * be pretty much unaligned, depending on the
      * underlying controller.
      */
-    aligned_addr = ALIGN_DOWN(pa, PAGE_SIZE);
-    offset = pa - aligned_addr;
-    uintptr_t vaddr = hw_map(aligned_addr, offset + size) + offset;
+    uintptr_t aligned_addr = ALIGN_DOWN(pa, PAGE_SIZE);
+    size_t offset = pa - aligned_addr;
+    ns16550_t *ns16550 = (ns16550_t *)
+       (hw_map(aligned_addr, offset + size) + offset);
+    ns16550_instance_t *ns16550_instance = ns16550_init(ns16550, inr, cir, cir_arg);
+    if (ns16550_instance) {
+        kbrd_instance_t *kbrd_instance = kbrd_init();
+        if (kbrd_instance) {
+            indev_t *sink = stdin_wire();
+            indev_t *kbrd = kbrd_wire(kbrd_instance, sink);
+            ns16550_wire(ns16550_instance, kbrd);
+        }
+    }
+    /*
+     * This is the necessary evil until the userspace drivers are
+     * entirely self-sufficient.
+     */
+    sysinfo_set_item_val("kbd", NULL, true);
+    sysinfo_set_item_val("kbd.inr", NULL, inr);
+    sysinfo_set_item_val("kbd.address.kernel", NULL,
+        (uintptr_t) ns16550);
+    sysinfo_set_item_val("kbd.address.physical", NULL, pa);
+    sysinfo_set_item_val("kbd.type.ns16550", NULL, true);
+    return true;
+}
-    switch (kbd_type) {
+#endif /* CONFIG_NS16550 */
+/** Initialize keyboard.
+ *
+ * Traverse OpenFirmware device tree in order to find necessary
+ * info about the keyboard device.
+ *
+ * @param node Keyboard device node.
+ *
+ */
+void kbd_init(ofw_tree_node_t *node)
+{
 #ifdef CONFIG_Z8530
-    case KBD_Z8530:
-        z8530_init(devno, vaddr, inr, cir, cir_arg);
-        break;
+    kbd_z8530_init(node);
 #endif
 #ifdef CONFIG_NS16550
-    case KBD_NS16550:
-        ns16550_init(devno, (ioport_t)vaddr, inr, cir, cir_arg);
-        break;
+    kbd_ns16550_init(node);
 #endif
-    default:
-        printf("Kernel is not compiled with the necessary keyboard "
-            "driver this machine requires.\n");
-    }
 }
+#endif /* CONFIG_SUN_KBD */
 /** @}
  */

 /branches/tracing/kernel/arch/sparc64/src/drivers/scr.c
 ,7 → 37,7
 #include <genarch/fb/fb.h>
 #include <genarch/fb/visuals.h>
 #include <arch/types.h>
-#include <func.h>
+#include <string.h>
 #include <align.h>
 #include <print.h>
 ,13 → 63,13
     name = ofw_tree_node_name(node);
-    if (strcmp(name, "SUNW,m64B") == 0)
+    if (str_cmp(name, "SUNW,m64B") == 0)
         scr_type = SCR_ATYFB;
-    else if (strcmp(name, "SUNW,XVR-100") == 0)
+    else if (str_cmp(name, "SUNW,XVR-100") == 0)
         scr_type = SCR_XVR;
-    else if (strcmp(name, "SUNW,ffb") == 0)
+    else if (str_cmp(name, "SUNW,ffb") == 0)
         scr_type = SCR_FFB;
-    else if (strcmp(name, "cgsix") == 0)
+    else if (str_cmp(name, "cgsix") == 0)
         scr_type = SCR_CGSIX;
     if (scr_type == SCR_UNKNOWN) {
 ,7 → 104,7
     prop = ofw_tree_getprop(node, "reg");
     if (!prop)
-        panic("Can't find \"reg\" property.\n");
+        panic("Cannot find 'reg' property.");
     switch (scr_type) {
     case SCR_ATYFB:
 ,7 → 223,7
         break;
     default:
-        panic("Unexpected type.\n");
+        panic("Unexpected type.");
     }
     fb_properties_t props = {
 ,5 → 237,10
     fb_init(&props);
 }
+void scr_redraw(void)
+{
+    fb_redraw();
+}
 /** @}
  */

 /branches/tracing/kernel/arch/sparc64/src/drivers/sgcn.c
 ,25 → 31,25
  */
 /**
  * @file
- * @brief   SGCN driver.
+ * @brief SGCN driver.
  */
+#include <arch.h>
 #include <arch/drivers/sgcn.h>
 #include <arch/drivers/kbd.h>
 #include <genarch/ofw/ofw_tree.h>
 #include <debug.h>
-#include <func.h>
+#include <string.h>
 #include <print.h>
 #include <mm/page.h>
-#include <ipc/irq.h>
-#include <ddi/ddi.h>
-#include <ddi/device.h>
+#include <proc/thread.h>
 #include <console/chardev.h>
 #include <console/console.h>
-#include <ddi/device.h>
 #include <sysinfo/sysinfo.h>
 #include <synch/spinlock.h>
+#define POLL_INTERVAL       10000
 /*
  * Physical address at which the SBBC starts. This value has been obtained
  * by inspecting (using Simics) memory accesses made by OBP. It is valid
 ,7 → 73,7
  * that the OBP console buffer is not the only console buffer
  * which can be used. It is, however, used because when the kernel
  * is running, the OBP buffer is not used by OBP any more but OBP
- * has already made neccessary arangements so that the output will
+ * has already made necessary arrangements so that the output will
  * be read from the OBP buffer and input will go to the OBP buffer.
  * Therefore HelenOS needs to make no such arrangements any more.
  */
 ,16 → 82,6
 /* magic string contained at the beginning of the console buffer */
 #define SGCN_BUFFER_MAGIC   "CON"
-/**
- * The driver is polling based, but in order to notify the userspace
- * of a key being pressed, we need to supply the interface with some
- * interrupt number. The interrupt number can be arbitrary as it it
- * will never be used for identifying HW interrupts, but only in
- * notifying the userspace.
- */
-#define FICTIONAL_INR       1
 /*
  * Returns a pointer to the object of a given type which is placed at the given
  * offset from the SRAM beginning.
 ,14 → 96,11
  * offset from the console buffer beginning.
  */
 #define SGCN_BUFFER(type, offset) \
-                ((type *) (sgcn_buffer_begin + (offset)))
+    ((type *) (sgcn_buffer_begin + (offset)))
 /** Returns a pointer to the console buffer header. */
 #define SGCN_BUFFER_HEADER  (SGCN_BUFFER(sgcn_buffer_header_t, 0))
-/** defined in drivers/kbd.c */
-extern kbd_type_t kbd_type;
 /** starting address of SRAM, will be set by the init_sram_begin function */
 static uintptr_t sram_begin;
 ,14 → 110,9
  */
 static uintptr_t sgcn_buffer_begin;
-/**
- * SGCN IRQ structure. So far used only for notifying the userspace of the
- * key being pressed, not for kernel being informed about keyboard interrupts.
- */
-static irq_t sgcn_irq;
+/* true iff the kernel driver should ignore pressed keys */
+static bool kbd_disabled;
-// TODO think of a way how to synchronize accesses to SGCN buffer between the kernel and the userspace
 /*
  * Ensures that writing to the buffer and consequent update of the write pointer
  * are together one atomic operation.
 ,38 → 127,23
 /* functions referenced from definitions of I/O operations structures */
-static void sgcn_noop(chardev_t *);
-static void sgcn_putchar(chardev_t *, const char);
-static char sgcn_key_read(chardev_t *);
+static void sgcn_putchar(outdev_t *, const wchar_t, bool);
-/** character device operations */
-static chardev_operations_t sgcn_ops = {
-    .suspend = sgcn_noop,
-    .resume = sgcn_noop,
-    .read = sgcn_key_read,
+/** SGCN output device operations */
+static outdev_operations_t sgcnout_ops = {
     .write = sgcn_putchar
 };
-/** SGCN character device */
-chardev_t sgcn_io;
+static outdev_t sgcnout;    /**< SGCN output device. */
 /**
- * Registers the physical area of the SRAM so that the userspace SGCN
- * driver can map it. Moreover, it sets some sysinfo values (SRAM address
- * and SRAM size).
+ * Set some sysinfo values (SRAM address and SRAM size).
  */
-static void register_sram_parea(uintptr_t sram_begin_physical)
+static void register_sram(uintptr_t sram_begin_physical)
 {
-    static parea_t sram_parea;
-    sram_parea.pbase = sram_begin_physical;
-    sram_parea.vbase = (uintptr_t) sram_begin;
-    sram_parea.frames = MAPPED_AREA_SIZE / FRAME_SIZE;
-    sram_parea.cacheable = false;
-    ddi_parea_register(&sram_parea);
     sysinfo_set_item_val("sram.area.size", NULL, MAPPED_AREA_SIZE);
     sysinfo_set_item_val("sram.address.physical", NULL,
-        sram_begin_physical);
+        sram_begin_physical);
 }
 /**
 ,9 → 154,6
  * property of the "/chosen" OBP node. The sram_begin variable will
  * be set to the virtual address which maps to the SRAM physical
  * address.
- *
- * It also registers the physical area of SRAM and sets some sysinfo
- * values (SRAM address and SRAM size).
  */
 static void init_sram_begin(void)
 {
 ,19 → 163,19
     chosen = ofw_tree_lookup("/chosen");
     if (!chosen)
-        panic("Can't find /chosen.\n");
+        panic("Cannot find '/chosen'.");
     iosram_toc = ofw_tree_getprop(chosen, "iosram-toc");
     if (!iosram_toc)
-        panic("Can't find property \"iosram-toc\".\n");
+        panic("Cannot find property 'iosram-toc'.");
     if (!iosram_toc->value)
-        panic("Can't find SRAM TOC.\n");
+        panic("Cannot find SRAM TOC.");
     sram_begin_physical = SBBC_START + SBBC_SRAM_OFFSET
-        + *((uint32_t *) iosram_toc->value);
+        + *((uint32_t *) iosram_toc->value);
     sram_begin = hw_map(sram_begin_physical, MAPPED_AREA_SIZE);
-    register_sram_parea(sram_begin_physical);
+    register_sram(sram_begin_physical);
 }
 /**
 ,14 → 191,19
  */
 static void sgcn_buffer_begin_init(void)
 {
+    static bool initialized;
+    if (initialized)
+        return;
     init_sram_begin();
-    ASSERT(strcmp(SRAM_TOC->magic, SRAM_TOC_MAGIC) == 0);
+    ASSERT(str_cmp(SRAM_TOC->magic, SRAM_TOC_MAGIC) == 0);
     /* lookup TOC entry with the correct key */
     uint32_t i;
     for (i = 0; i < MAX_TOC_ENTRIES; i++) {
-        if (strcmp(SRAM_TOC->keys[i].key, CONSOLE_KEY) == 0)
+        if (str_cmp(SRAM_TOC->keys[i].key, CONSOLE_KEY) == 0)
             break;
     }
     ASSERT(i < MAX_TOC_ENTRIES);
 ,17 → 211,12
     sgcn_buffer_begin = sram_begin + SRAM_TOC->keys[i].offset;
     sysinfo_set_item_val("sram.buffer.offset", NULL,
-        SRAM_TOC->keys[i].offset);
+        SRAM_TOC->keys[i].offset);
+    initialized = true;
 }
 /**
- * Default suspend/resume operation for the input device.
- */
-static void sgcn_noop(chardev_t *d)
-{
-}
-/**
  * Writes a single character to the SGCN (circular) output buffer
  * and updates the output write pointer so that SGCN gets to know
  * that the character has been written.
 ,7 → 229,7
     /* we need pointers to volatile variables */
     volatile char *buf_ptr = (volatile char *)
-        SGCN_BUFFER(char, SGCN_BUFFER_HEADER->out_wrptr);
+        SGCN_BUFFER(char, SGCN_BUFFER_HEADER->out_wrptr);
     volatile uint32_t *out_wrptr_ptr = &(SGCN_BUFFER_HEADER->out_wrptr);
     volatile uint32_t *out_rdptr_ptr = &(SGCN_BUFFER_HEADER->out_rdptr);
 ,66 → 255,31
 }
 /**
- * SGCN output operation. Prints a single character to the SGCN. If the line
- * feed character is written ('\n'), the carriage return character ('\r') is
- * written straight away.
+ * SGCN output operation. Prints a single character to the SGCN. Newline
+ * character is converted to CRLF.
  */
-static void sgcn_putchar(struct chardev * cd, const char c)
+static void sgcn_putchar(outdev_t *od, const wchar_t ch, bool silent)
 {
-    spinlock_lock(&sgcn_output_lock);
-    sgcn_do_putchar(c);
-    if (c == '\n') {
-        sgcn_do_putchar('\r');
+    if (!silent) {
+        spinlock_lock(&sgcn_output_lock);
+        if (ascii_check(ch)) {
+            if (ch == '\n')
+                sgcn_do_putchar('\r');
+            sgcn_do_putchar(ch);
+        } else
+            sgcn_do_putchar(U_SPECIAL);
+        spinlock_unlock(&sgcn_output_lock);
     }
-    spinlock_unlock(&sgcn_output_lock);
 }
 /**
- * Called when actively reading the character. Not implemented yet.
- */
-static char sgcn_key_read(chardev_t *d)
-{
-    return (char) 0;
-}
-/**
- * The driver works in polled mode, so no interrupt should be handled by it.
- */
-static irq_ownership_t sgcn_claim(void)
-{
-    return IRQ_DECLINE;
-}
-/**
- * The driver works in polled mode, so no interrupt should be handled by it.
- */
-static void sgcn_irq_handler(irq_t *irq, void *arg, ...)
-{
-    panic("Not yet implemented, SGCN works in polled mode.\n");
-}
-/**
  * Grabs the input for kernel.
  */
 void sgcn_grab(void)
 {
-    ipl_t ipl = interrupts_disable();
-    volatile uint32_t *in_wrptr_ptr = &(SGCN_BUFFER_HEADER->in_wrptr);
-    volatile uint32_t *in_rdptr_ptr = &(SGCN_BUFFER_HEADER->in_rdptr);
-    /* skip all the user typed before the grab and hasn't been processed */
-    spinlock_lock(&sgcn_input_lock);
-    *in_rdptr_ptr = *in_wrptr_ptr;
-    spinlock_unlock(&sgcn_input_lock);
-    spinlock_lock(&sgcn_irq.lock);
-    sgcn_irq.notif_cfg.notify = false;
-    spinlock_unlock(&sgcn_irq.lock);
-    interrupts_restore(ipl);
+    kbd_disabled = false;
 }
 /**
 ,12 → 287,7
  */
 void sgcn_release(void)
 {
-    ipl_t ipl = interrupts_disable();
-    spinlock_lock(&sgcn_irq.lock);
-    if (sgcn_irq.notif_cfg.answerbox)
-        sgcn_irq.notif_cfg.notify = true;
-    spinlock_unlock(&sgcn_irq.lock);
-    interrupts_restore(ipl);
+    kbd_disabled = true;
 }
 /**
 ,79 → 295,92
  * there are some unread characters in the input queue. If so, it picks them up
  * and sends them to the upper layers of HelenOS.
  */
-void sgcn_poll(void)
+static void sgcn_poll(sgcn_instance_t *instance)
 {
     uint32_t begin = SGCN_BUFFER_HEADER->in_begin;
     uint32_t end = SGCN_BUFFER_HEADER->in_end;
     uint32_t size = end - begin;
+    if (kbd_disabled)
+        return;
     spinlock_lock(&sgcn_input_lock);
-    ipl_t ipl = interrupts_disable();
-    spinlock_lock(&sgcn_irq.lock);
     /* we need pointers to volatile variables */
     volatile char *buf_ptr = (volatile char *)
-        SGCN_BUFFER(char, SGCN_BUFFER_HEADER->in_rdptr);
+        SGCN_BUFFER(char, SGCN_BUFFER_HEADER->in_rdptr);
     volatile uint32_t *in_wrptr_ptr = &(SGCN_BUFFER_HEADER->in_wrptr);
     volatile uint32_t *in_rdptr_ptr = &(SGCN_BUFFER_HEADER->in_rdptr);
-    if (*in_rdptr_ptr != *in_wrptr_ptr) {
-        if (sgcn_irq.notif_cfg.notify && sgcn_irq.notif_cfg.answerbox) {
-            ipc_irq_send_notif(&sgcn_irq);
-            spinlock_unlock(&sgcn_irq.lock);
-            interrupts_restore(ipl);
-            spinlock_unlock(&sgcn_input_lock);
-            return;
-        }
-    }
-    spinlock_unlock(&sgcn_irq.lock);
-    interrupts_restore(ipl);
     while (*in_rdptr_ptr != *in_wrptr_ptr) {
         buf_ptr = (volatile char *)
-            SGCN_BUFFER(char, SGCN_BUFFER_HEADER->in_rdptr);
+            SGCN_BUFFER(char, SGCN_BUFFER_HEADER->in_rdptr);
         char c = *buf_ptr;
         *in_rdptr_ptr = (((*in_rdptr_ptr) - begin + 1) % size) + begin;
-        if (c == '\r') {
-            c = '\n';
-        }
-        chardev_push_character(&sgcn_io, c);
+        indev_push_character(instance->srlnin, c);
     }
     spinlock_unlock(&sgcn_input_lock);
 }
 /**
- * A public function which initializes I/O from/to Serengeti console
- * and sets it as a default input/output.
+ * Polling thread function.
  */
-void sgcn_init(void)
+static void ksgcnpoll(void *instance) {
+    while (1) {
+        if (!silent)
+            sgcn_poll(instance);
+        thread_usleep(POLL_INTERVAL);
+    }
+}
+/**
+ * A public function which initializes input from the Serengeti console.
+ */
+sgcn_instance_t *sgcnin_init(void)
 {
     sgcn_buffer_begin_init();
+    sgcn_instance_t *instance =
+        malloc(sizeof(sgcn_instance_t), FRAME_ATOMIC);
+    if (instance) {
+        instance->srlnin = NULL;
+        instance->thread = thread_create(ksgcnpoll, instance, TASK, 0,
+            "ksgcnpoll", true);
+        if (!instance->thread) {
+            free(instance);
+            return NULL;
+        }
+    }
+    return instance;
+}
-    kbd_type = KBD_SGCN;
+void sgcnin_wire(sgcn_instance_t *instance, indev_t *srlnin)
+{
+    ASSERT(instance);
+    ASSERT(srlnin);
-    devno_t devno = device_assign_devno();
-    irq_initialize(&sgcn_irq);
-    sgcn_irq.devno = devno;
-    sgcn_irq.inr = FICTIONAL_INR;
-    sgcn_irq.claim = sgcn_claim;
-    sgcn_irq.handler = sgcn_irq_handler;
-    irq_register(&sgcn_irq);
+    instance->srlnin = srlnin;
+    thread_ready(instance->thread);
     sysinfo_set_item_val("kbd", NULL, true);
-    sysinfo_set_item_val("kbd.type", NULL, KBD_SGCN);
-    sysinfo_set_item_val("kbd.devno", NULL, devno);
-    sysinfo_set_item_val("kbd.inr", NULL, FICTIONAL_INR);
+}
+/**
+ * A public function which initializes output to the Serengeti console.
+ */
+void sgcnout_init(void)
+{
+    sgcn_buffer_begin_init();
     sysinfo_set_item_val("fb.kind", NULL, 4);
-    chardev_initialize("sgcn_io", &sgcn_io, &sgcn_ops);
-    stdin = &sgcn_io;
-    stdout = &sgcn_io;
+    outdev_initialize("sgcnout", &sgcnout, &sgcnout_ops);
+    stdout = &sgcnout;
 }
 /** @}

 /branches/tracing/kernel/arch/sparc64/src/drivers/pci.c
 ,8 → 42,9
 #include <arch/types.h>
 #include <debug.h>
 #include <print.h>
-#include <func.h>
+#include <string.h>
 #include <arch/asm.h>
+#include <sysinfo/sysinfo.h>
 #define SABRE_INTERNAL_REG  0
 #define PSYCHO_INTERNAL_REG 2
 ,6 → 109,12
     pci->op = &pci_sabre_ops;
     pci->reg = (uint64_t *) hw_map(paddr, reg[SABRE_INTERNAL_REG].size);
+    /*
+     * Set sysinfo data needed by the uspace OBIO driver.
+     */
+    sysinfo_set_item_val("obio.base.physical", NULL, paddr);
+    sysinfo_set_item_val("kbd.cir.obio", NULL, 1);
     return pci;
 }
 ,6 → 156,12
     pci->op = &pci_psycho_ops;
     pci->reg = (uint64_t *) hw_map(paddr, reg[PSYCHO_INTERNAL_REG].size);
+    /*
+     * Set sysinfo data needed by the uspace OBIO driver.
+     */
+    sysinfo_set_item_val("obio.base.physical", NULL, paddr);
+    sysinfo_set_item_val("kbd.cir.obio", NULL, 1);
     return pci;
 }
 ,7 → 183,7
     /*
      * First, verify this is a PCI node.
      */
-    ASSERT(strcmp(ofw_tree_node_name(node), "pci") == 0);
+    ASSERT(str_cmp(ofw_tree_node_name(node), "pci") == 0);
     /*
      * Determine PCI controller model.
 ,13 → 192,13
     if (!prop || !prop->value)
         return NULL;
-    if (strcmp(prop->value, "SUNW,sabre") == 0) {
+    if (str_cmp(prop->value, "SUNW,sabre") == 0) {
         /*
          * PCI controller Sabre.
          * This model is found on UltraSPARC IIi based machines.
          */
         return pci_sabre_init(node);
-    } else if (strcmp(prop->value, "SUNW,psycho") == 0) {
+    } else if (str_cmp(prop->value, "SUNW,psycho") == 0) {
         /*
          * PCI controller Psycho.
          * Used on UltraSPARC II based processors, for instance,

 /branches/tracing/kernel/arch/sparc64/src/start.S
 ,7 → 84,7
     ! l5 <= physmem_base[(PHYSMEM_ADDR_SIZE - 1):13]
     sllx %l5, 13 + (63 - (PHYSMEM_ADDR_SIZE - 1)), %l5
     srlx %l5, 63 - (PHYSMEM_ADDR_SIZE - 1), %l5
     /*
      * Setup basic runtime environment.
      */
 ,7 → 294,7
     /* Not reached. */
 :
-    ba 0b
+    ba %xcc, 0b
     nop
 ,7 → 333,7
 :
     ldx [%g2], %g3
     cmp %g3, %g1
-    bne 2b
+    bne %xcc, 2b
     nop
     /*
 ,7 → 352,7
 #endif
 :
-    ba 0b
+    ba %xcc, 0b
     nop
 ,10 → 381,31
     .quad 0
 /*
- * This variable is used by the fast_data_MMU_miss trap handler. In runtime, it
- * is further modified to reflect the starting address of physical memory.
+ * The fast_data_access_mmu_miss_data_hi label and the end_of_identity and
+ * kernel_8k_tlb_data_template variables are meant to stay together,
+ * aligned on 16B boundary.
  */
+.global fast_data_access_mmu_miss_data_hi
+.global end_of_identity
 .global kernel_8k_tlb_data_template
+.align 16
+/*
+ * This label is used by the fast_data_access_MMU_miss trap handler.
+ */
+fast_data_access_mmu_miss_data_hi:
+/*
+ * This variable is used by the fast_data_access_MMU_miss trap handler.
+ * In runtime, it is modified to contain the address of the end of physical
+ * memory.
+ */
+end_of_identity:
+    .quad -1
+/*
+ * This variable is used by the fast_data_access_MMU_miss trap handler.
+ * In runtime, it is further modified to reflect the starting address of
+ * physical memory.
+ */
 kernel_8k_tlb_data_template:
 #ifdef CONFIG_VIRT_IDX_DCACHE
     .quad ((1 << TTE_V_SHIFT) | (PAGESIZE_8K << TTE_SIZE_SHIFT) | TTE_CP | \

 /branches/tracing/kernel/arch/ia64/include/interrupt.h
 ,10 → 53,10
 #define VECTOR_TLB_SHOOTDOWN_IPI 0xf0
 #define INTERRUPT_TIMER     255
-#define IRQ_KBD         (0x01+LAGACY_INTERRUPT_BASE)
-#define IRQ_MOUSE       (0x0c+LAGACY_INTERRUPT_BASE)
+#define IRQ_KBD         (0x01 + LEGACY_INTERRUPT_BASE)
+#define IRQ_MOUSE       (0x0c + LEGACY_INTERRUPT_BASE)
 #define INTERRUPT_SPURIOUS  15
-#define LAGACY_INTERRUPT_BASE   0x20
+#define LEGACY_INTERRUPT_BASE   0x20
 /** General Exception codes. */
 #define GE_ILLEGALOP        0
 ,7 → 117,7
     /*
      * The following variables are defined only for break_instruction
-     * handler.
+     * handler.
      */
     uint64_t in0;
     uint64_t in1;
 ,6 → 153,7
 extern void external_interrupt(uint64_t vector, istate_t *istate);
 extern void disabled_fp_register(uint64_t vector, istate_t *istate);
+extern void trap_virtual_enable_irqs(uint16_t irqmask);
 #endif

/branches/tracing/kernel/arch/ia64/include/fpu_context.h
35,7 → 35,6
#ifndef KERN_ia64_FPU_CONTEXT_H_
#define KERN_ia64_FPU_CONTEXT_H_

#define ARCH_HAS_FPU 1
#define FPU_CONTEXT_ALIGN 16

#include <arch/types.h>

 /branches/tracing/kernel/arch/ia64/include/types.h
 ,6 → 65,11
 typedef uint64_t unative_t;
 typedef int64_t native_t;
+typedef struct {
+    unative_t fnc;
+    unative_t gp;
+} fncptr_t;
 #define PRIp "lx"   /**< Format for uintptr_t. */
 #define PRIs "lu"   /**< Format for size_t. */
 #define PRIc "lu"   /**< Format for count_t. */

 /branches/tracing/kernel/arch/ia64/include/atomic.h
 ,16 → 37,17
 /** Atomic addition.
  *
- * @param val Atomic value.
- * @param imm Value to add.
+ * @param val       Atomic value.
+ * @param imm       Value to add.
  *
- * @return Value before addition.
+ * @return      Value before addition.
  */
 static inline long atomic_add(atomic_t *val, int imm)
 {
     long v;
-    asm volatile ("fetchadd8.rel %0 = %1, %2\n" : "=r" (v), "+m" (val->count) : "i" (imm));
+    asm volatile ("fetchadd8.rel %0 = %1, %2\n" : "=r" (v),
+        "+m" (val->count) : "i" (imm));
     return v;
 }
 ,9 → 57,9
     uint64_t v;
     asm volatile (
-        "movl %0=0x01;;\n"
-        "xchg8 %0=%1,%0;;\n"
-        : "=r" (v),"+m" (val->count)
+        "movl %0 = 0x01;;\n"
+        "xchg8 %0 = %1, %0;;\n"
+        : "=r" (v), "+m" (val->count)
     );
     return v;
 ,15 → 66,36
 }
-static inline void atomic_inc(atomic_t *val) { atomic_add(val, 1); }
-static inline void atomic_dec(atomic_t *val) { atomic_add(val, -1); }
+static inline void atomic_inc(atomic_t *val)
+{
+    atomic_add(val, 1);
+}
-static inline long atomic_preinc(atomic_t *val) { return atomic_add(val, 1) + 1; }
-static inline long atomic_predec(atomic_t *val) { return atomic_add(val, -1) - 1; }
+static inline void atomic_dec(atomic_t *val)
+{
+    atomic_add(val, -1);
+}
-static inline long atomic_postinc(atomic_t *val) { return atomic_add(val, 1); }
-static inline long atomic_postdec(atomic_t *val) { return atomic_add(val, -1); }
+static inline long atomic_preinc(atomic_t *val)
+{
+    return atomic_add(val, 1) + 1;
+}
+static inline long atomic_predec(atomic_t *val)
+{
+    return atomic_add(val, -1) - 1;
+}
+static inline long atomic_postinc(atomic_t *val)
+{
+    return atomic_add(val, 1);
+}
+static inline long atomic_postdec(atomic_t *val)
+{
+    return atomic_add(val, -1);
+}
 #endif
 /** @}

 /branches/tracing/kernel/arch/ia64/include/proc/task.h
 ,7 → 43,7
 } task_arch_t;
-#define task_create_arch(t) {(t)->arch.iomap=NULL;}
+#define task_create_arch(t) { (t)->arch.iomap = NULL; }
 #define task_destroy_arch(t)
 #endif

 /branches/tracing/kernel/arch/ia64/include/arch.h
 ,7 → 26,7
  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
  */
-/** @addtogroup ia64
+/** @addtogroup ia64
  * @{
  */
 /** @file
 ,8 → 37,10
 #define LOADED_PROG_STACK_PAGES_NO 2
-#include <arch/ski/ski.h>
+#include <arch/drivers/ski.h>
+extern void arch_pre_main(void);
 #endif
 /** @}

 /branches/tracing/kernel/arch/ia64/include/bootinfo.h
 ,10 → 39,13
 #define EFI_MEMMAP_IO 1
 #define EFI_MEMMAP_IO_PORTS 2
+/** Size of buffer for storing task name in binit_task_t. */
+#define BOOTINFO_TASK_NAME_BUFLEN 32
 typedef struct {
     void *addr;
     unsigned long size;
+    char name[BOOTINFO_TASK_NAME_BUFLEN];
 } binit_task_t;
 typedef struct {
 ,7 → 71,6
     unsigned long freq_scale;
     unsigned int wakeup_intno;
     int hello_configured;
 } bootinfo_t;
 extern bootinfo_t *bootinfo;

 /branches/tracing/kernel/arch/ia64/include/asm.h
 ,59 → 36,72
 #define KERN_ia64_ASM_H_
 #include <config.h>
+#include <typedefs.h>
 #include <arch/types.h>
 #include <arch/register.h>
-typedef uint64_t ioport_t;
 #define IA64_IOSPACE_ADDRESS 0xE001000000000000ULL
-static inline void  outb(ioport_t port,uint8_t v)
+static inline void pio_write_8(ioport8_t *port, uint8_t v)
 {
-    *((uint8_t *)(IA64_IOSPACE_ADDRESS + ( (port & 0xfff) | ( (port >> 2) << 12 )))) = v;
+    uintptr_t prt = (uintptr_t) port;
+    *((ioport8_t *)(IA64_IOSPACE_ADDRESS +
+        ((prt & 0xfff) | ((prt >> 2) << 12)))) = v;
     asm volatile ("mf\n" ::: "memory");
 }
-static inline void  outw(ioport_t port,uint16_t v)
+static inline void pio_write_16(ioport16_t *port, uint16_t v)
 {
-    *((uint16_t *)(IA64_IOSPACE_ADDRESS + ( (port & 0xfff) | ( (port >> 2) << 12 )))) = v;
+    uintptr_t prt = (uintptr_t) port;
+    *((ioport16_t *)(IA64_IOSPACE_ADDRESS +
+        ((prt & 0xfff) | ((prt >> 2) << 12)))) = v;
     asm volatile ("mf\n" ::: "memory");
 }
-static inline void  outl(ioport_t port,uint32_t v)
+static inline void pio_write_32(ioport32_t *port, uint32_t v)
 {
-    *((uint32_t *)(IA64_IOSPACE_ADDRESS + ( (port & 0xfff) | ( (port >> 2) << 12 )))) = v;
+    uintptr_t prt = (uintptr_t) port;
+    *((ioport32_t *)(IA64_IOSPACE_ADDRESS +
+        ((prt & 0xfff) | ((prt >> 2) << 12)))) = v;
     asm volatile ("mf\n" ::: "memory");
 }
+static inline uint8_t pio_read_8(ioport8_t *port)
+{
+    uintptr_t prt = (uintptr_t) port;
-static inline uint8_t inb(ioport_t port)
-{
     asm volatile ("mf\n" ::: "memory");
-    return *((uint8_t *)(IA64_IOSPACE_ADDRESS + ( (port & 0xfff) | ( (port >> 2) << 12 ))));
+    return *((ioport8_t *)(IA64_IOSPACE_ADDRESS +
+        ((prt & 0xfff) | ((prt >> 2) << 12))));
 }
-static inline uint16_t inw(ioport_t port)
+static inline uint16_t pio_read_16(ioport16_t *port)
 {
+    uintptr_t prt = (uintptr_t) port;
     asm volatile ("mf\n" ::: "memory");
-    return *((uint16_t *)(IA64_IOSPACE_ADDRESS + ( (port & 0xffE) | ( (port >> 2) << 12 ))));
+    return *((ioport16_t *)(IA64_IOSPACE_ADDRESS +
+        ((prt & 0xfff) | ((prt >> 2) << 12))));
 }
-static inline uint32_t inl(ioport_t port)
+static inline uint32_t pio_read_32(ioport32_t *port)
 {
+    uintptr_t prt = (uintptr_t) port;
     asm volatile ("mf\n" ::: "memory");
-    return *((uint32_t *)(IA64_IOSPACE_ADDRESS + ( (port & 0xfff) | ( (port >> 2) << 12 ))));
+    return *((ioport32_t *)(IA64_IOSPACE_ADDRESS +
+        ((prt & 0xfff) | ((prt >> 2) << 12))));
 }
 /** Return base address of current stack
  *
  * Return the base address of the current stack.
 ,7 → 355,8
 extern void cpu_sleep(void);
 extern void asm_delay_loop(uint32_t t);
-extern void switch_to_userspace(uintptr_t entry, uintptr_t sp, uintptr_t bsp, uintptr_t uspace_uarg, uint64_t ipsr, uint64_t rsc);
+extern void switch_to_userspace(uintptr_t, uintptr_t, uintptr_t, uintptr_t,
+    uint64_t, uint64_t);
 #endif

 /branches/tracing/kernel/arch/ia64/include/mm/frame.h
 ,7 → 26,7
  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
  */
-/** @addtogroup ia64mm
+/** @addtogroup ia64mm
  * @{
  */
 /** @file
 ,12 → 35,16
 #ifndef KERN_ia64_FRAME_H_
 #define KERN_ia64_FRAME_H_
-#define FRAME_WIDTH     14  /* 16K */
-#define FRAME_SIZE      (1 << FRAME_WIDTH)
+#define FRAME_WIDTH  14  /* 16K */
+#define FRAME_SIZE   (1 << FRAME_WIDTH)
 #ifdef KERNEL
 #ifndef __ASM__
+#include <arch/types.h>
+extern uintptr_t last_frame;
 extern void frame_arch_init(void);
 #define physmem_print()

 /branches/tracing/kernel/arch/ia64/include/mm/page.h
 ,22 → 51,20
 #define USPACE_IO_PAGE_WIDTH        12  /* 4K */
+/*
+ * Statically mapped IO spaces - offsets to 0xe...00 of virtual addresses
+ * because of "minimal virtual bits implemented is 51" it is possible to
+ * have values up to 0x0007000000000000
+ */
-/** Staticly mapped IO spaces - offsets to 0xe...00 of virtual adresses
-becauce of "minimal virtual bits implemented is 51"
-it is possible to have here values up to 0x0007000000000000
-*/
 /* Firmware area (bellow 4GB in phys mem) */
 #define FW_OFFSET             0x00000000F0000000
 /* Legacy IO space */
 #define IO_OFFSET             0x0001000000000000
-/* Videoram - now mapped to 0 as VGA text mode vram on 0xb8000*/
+/* Videoram - now mapped to 0 as VGA text mode vram on 0xb8000 */
 #define VIO_OFFSET            0x0002000000000000
 #define PPN_SHIFT           12
 #define VRN_SHIFT           61
 ,8 → 79,8
 #define REGION_REGISTERS        8
-#define KA2PA(x)    ((uintptr_t) (x-(VRN_KERNEL<<VRN_SHIFT)))
-#define PA2KA(x)    ((uintptr_t) (x+(VRN_KERNEL<<VRN_SHIFT)))
+#define KA2PA(x)    ((uintptr_t) (x - (VRN_KERNEL << VRN_SHIFT)))
+#define PA2KA(x)    ((uintptr_t) (x + (VRN_KERNEL << VRN_SHIFT)))
 #define VHPT_WIDTH          20  /* 1M */
 #define VHPT_SIZE           (1 << VHPT_WIDTH)

 /branches/tracing/kernel/arch/ia64/include/mm/tlb.h
 ,9 → 35,6
 #ifndef KERN_ia64_TLB_H_
 #define KERN_ia64_TLB_H_
-#define tlb_arch_init()
-#define tlb_print()
 #include <arch/mm/page.h>
 #include <arch/mm/asid.h>
 #include <arch/interrupt.h>

 /branches/tracing/kernel/arch/ia64/include/mm/vhpt.h
 ,8 → 44,8
 {
     vhpt_entry_t ventry;
-    ventry.word[0]=tentry.word[0];
-    ventry.word[1]=tentry.word[1];
+    ventry.word[0] = tentry.word[0];
+    ventry.word[1] = tentry.word[1];
     return ventry;
 }

 /branches/tracing/kernel/arch/ia64/include/register.h
 ,11 → 40,11
 #define PSR_I_MASK  0x4000
 #define PSR_PK_MASK 0x8000
-#define PSR_DT_MASK (1<<17)
-#define PSR_RT_MASK (1<<27)
+#define PSR_DT_MASK (1 << 17)
+#define PSR_RT_MASK (1 << 27)
-#define PSR_DFL_MASK    (1<<18)
-#define PSR_DFH_MASK    (1<<19)
+#define PSR_DFL_MASK    (1 << 18)
+#define PSR_DFH_MASK    (1 << 19)
 #define PSR_IT_MASK 0x0000001000000000

/branches/tracing/kernel/arch/ia64/include/debug.h
1,5 → 1,5
/*
* Copyright (c) 2005
* Copyright (c) 2005 Ondrej Palkovsky
* All rights reserved.
*
* Redistribution and use in source and binary forms, with or without

 /branches/tracing/kernel/arch/ia64/include/cpu.h
 ,16 → 83,13
 }
-static inline void ipi_send_ipi(int id,int eid,int intno)
+static inline void ipi_send_ipi(int id, int eid, int intno)
 {
-    (bootinfo->sapic)[2*(id*256+eid)]=intno;
+    (bootinfo->sapic)[2 * (id * 256 + eid)] = intno;
     srlz_d();
 }
 #endif
 /** @}

 /branches/tracing/kernel/arch/ia64/include/drivers/kbd.h
 ,13 → 35,11
 #ifndef KERN_ia64_KBD_H_
 #define KERN_ia64_KBD_H_
+#define KBD_UNKNOWN  0
+#define KBD_SKI      1
+#define KBD_LEGACY   2
+#define KBD_NS16550  3
-#define KBD_UNKNOWN 0
-#define KBD_SKI 1
-#define KBD_LEGACY 2
-#define KBD_NS16550 3
 #endif
 /** @}

 /branches/tracing/kernel/arch/ia64/include/drivers/ski.h
 ,0 → 1,56
+/*
+ * Copyright (c) 2005 Jakub Jermar
+ * All rights reserved.
+ *
+ * Redistribution and use in source and binary forms, with or without
+ * modification, are permitted provided that the following conditions
+ * are met:
+ *
+ * - Redistributions of source code must retain the above copyright
+ *   notice, this list of conditions and the following disclaimer.
+ * - Redistributions in binary form must reproduce the above copyright
+ *   notice, this list of conditions and the following disclaimer in the
+ *   documentation and/or other materials provided with the distribution.
+ * - The name of the author may not be used to endorse or promote products
+ *   derived from this software without specific prior written permission.
+ *
+ * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
+ * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
+ * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
+ * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
+ * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
+ * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
+ * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
+ * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
+ * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
+ * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+ */
+/** @addtogroup ia64
+ * @{
+ */
+/** @file
+ */
+#ifndef KERN_ia64_SKI_H_
+#define KERN_ia64_SKI_H_
+#include <console/chardev.h>
+#include <proc/thread.h>
+typedef struct {
+    thread_t *thread;
+    indev_t *srlnin;
+} ski_instance_t;
+extern void skiout_init(void);
+extern ski_instance_t *skiin_init(void);
+extern void skiin_wire(ski_instance_t *, indev_t *);
+extern void ski_kbd_grab(void);
+extern void ski_kbd_release(void);
+#endif
+/** @}
+ */

 /branches/tracing/kernel/arch/ia64/Makefile.inc
 ,10 → 29,6
 ## Toolchain configuration
 #
-ifndef CROSS_PREFIX
-    CROSS_PREFIX = /usr/local
-endif
 BFD_NAME = elf64-little
 BFD_ARCH = ia64-elf64
 TARGET = ia64-pc-linux-gnu
 ,61 → 41,34
 LFLAGS += -EL
 AFLAGS += -mconstant-gp
-DEFS += -D__64_BITS__ -D$(MACHINE)
+DEFS += -D__64_BITS__
-## Compile with page hash table support.
-#
-CONFIG_PAGE_HT = y
-DEFS += -DCONFIG_PAGE_HT
-## Compile with support for address space identifiers.
-#
-CONFIG_ASID = y
-CONFIG_ASID_FIFO = y
-## Compile with support for software integer division.
-#
-CONFIG_SOFTINT = y
 ARCH_SOURCES = \
-    arch/$(ARCH)/src/start.S \
-    arch/$(ARCH)/src/asm.S \
-    arch/$(ARCH)/src/dummy.s \
-    arch/$(ARCH)/src/ia64.c \
-    arch/$(ARCH)/src/fpu_context.c \
-    arch/$(ARCH)/src/context.S \
-    arch/$(ARCH)/src/cpu/cpu.c \
-    arch/$(ARCH)/src/ivt.S \
-    arch/$(ARCH)/src/interrupt.c \
-    arch/$(ARCH)/src/mm/as.c \
-    arch/$(ARCH)/src/mm/frame.c \
-    arch/$(ARCH)/src/mm/page.c \
-    arch/$(ARCH)/src/mm/tlb.c \
-    arch/$(ARCH)/src/mm/vhpt.c \
-    arch/$(ARCH)/src/proc/scheduler.c \
-    arch/$(ARCH)/src/ddi/ddi.c \
-    arch/$(ARCH)/src/smp/smp.c \
-    arch/$(ARCH)/src/drivers/it.c
+    arch/$(KARCH)/src/start.S \
+    arch/$(KARCH)/src/asm.S \
+    arch/$(KARCH)/src/dummy.s \
+    arch/$(KARCH)/src/ia64.c \
+    arch/$(KARCH)/src/fpu_context.c \
+    arch/$(KARCH)/src/context.S \
+    arch/$(KARCH)/src/cpu/cpu.c \
+    arch/$(KARCH)/src/ivt.S \
+    arch/$(KARCH)/src/interrupt.c \
+    arch/$(KARCH)/src/mm/as.c \
+    arch/$(KARCH)/src/mm/frame.c \
+    arch/$(KARCH)/src/mm/page.c \
+    arch/$(KARCH)/src/mm/tlb.c \
+    arch/$(KARCH)/src/mm/vhpt.c \
+    arch/$(KARCH)/src/proc/scheduler.c \
+    arch/$(KARCH)/src/ddi/ddi.c \
+    arch/$(KARCH)/src/smp/smp.c \
+    arch/$(KARCH)/src/drivers/it.c
 ifeq ($(MACHINE),ski)
-    ARCH_SOURCES += arch/$(ARCH)/src/ski/ski.c
-    DEFS += -DSKI
-#   BFD = elf64-ia64-little
+    ARCH_SOURCES += arch/$(KARCH)/src/drivers/ski.c
     BFD = binary
 endif
 ifeq ($(MACHINE),i460GX)
-    ARCH_SOURCES += arch/$(ARCH)/src/drivers/ega.c
-    CONFIG_I8042 = y
-    DEFS += -DI460GX -DCONFIG_I8042
+    DEFS += -DI460GX
     BFD = binary
 endif
-ifeq ($(CONFIG_SMP),y)
-    DEFS += -DCONFIG_SMP
-endif

 /branches/tracing/kernel/arch/ia64/src/fpu_context.c
 ,8 → 149,10
         "stf.spill [%7] = f127, 0x80\n;;"
         :
-        : "r" (&((fctx->fr)[0])), "r" (&((fctx->fr)[1])), "r" (&((fctx->fr)[2])), "r" (&((fctx->fr)[3])),
-          "r" (&((fctx->fr)[4])), "r" (&((fctx->fr)[5])), "r" (&((fctx->fr)[6])), "r" (&((fctx->fr)[7]))
+        : "r" (&((fctx->fr)[0])), "r" (&((fctx->fr)[1])),
+          "r" (&((fctx->fr)[2])), "r" (&((fctx->fr)[3])),
+          "r" (&((fctx->fr)[4])), "r" (&((fctx->fr)[5])),
+          "r" (&((fctx->fr)[6])), "r" (&((fctx->fr)[7]))
     );
 }
 ,14 → 269,16
         "ldf.fill f127 = [%7], 0x80\n;;"
         :
-        : "r" (&((fctx->fr)[0])), "r" (&((fctx->fr)[1])), "r" (&((fctx->fr)[2])), "r" (&((fctx->fr)[3])),
-          "r" (&((fctx->fr)[4])), "r" (&((fctx->fr)[5])), "r" (&((fctx->fr)[6])), "r" (&((fctx->fr)[7]))
+        : "r" (&((fctx->fr)[0])), "r" (&((fctx->fr)[1])),
+          "r" (&((fctx->fr)[2])), "r" (&((fctx->fr)[3])),
+          "r" (&((fctx->fr)[4])), "r" (&((fctx->fr)[5])),
+          "r" (&((fctx->fr)[6])), "r" (&((fctx->fr)[7]))
     );
 }
 void fpu_enable(void)
 {
-    uint64_t a = 0 ;
+    uint64_t a = 0;
     asm volatile (
         "rsm %0 ;;"

 /branches/tracing/kernel/arch/ia64/src/smp/smp.c
 ,7 → 33,7
  */
 #include <arch.h>
-#include <arch/ski/ski.h>
+#include <arch/drivers/ski.h>
 #include <arch/drivers/it.h>
 #include <arch/interrupt.h>
 #include <arch/barrier.h>
 ,10 → 51,7
 #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/kbd/ns16550.h>
 #include <smp/smp.h>
 #include <smp/ipi.h>
 #include <arch/atomic.h>
 ,126 → 58,108
 #include <panic.h>
 #include <print.h>
 #ifdef CONFIG_SMP
 extern char cpu_by_id_eid_list[256][256];
 static void sapic_init(void)
 {
-    bootinfo->sapic=(unative_t *)(PA2KA((unative_t)(bootinfo->sapic))|FW_OFFSET);
+    bootinfo->sapic = (unative_t *)(PA2KA((unative_t)(bootinfo->sapic)) |
+        FW_OFFSET);
 }
-static void ipi_broadcast_arch_all(int ipi )
+static void ipi_broadcast_arch_all(int ipi)
 {
-    int id,eid;
-    int myid,myeid;
+    int id, eid;
+    int myid, myeid;
-    myid=ia64_get_cpu_id();
-    myeid=ia64_get_cpu_eid();
+    myid = ia64_get_cpu_id();
+    myeid = ia64_get_cpu_eid();
-    for(id=0;id<256;id++)
-        for(eid=0;eid<256;eid++)
-            if((id!=myid) || (eid!=myeid))
-                ipi_send_ipi(id,eid,ipi);
+    for (id = 0; id < 256; id++)
+        for (eid = 0; eid < 256; eid++)
+            if ((id != myid) || (eid != myeid))
+                ipi_send_ipi(id, eid, ipi);
 }
 void ipi_broadcast_arch(int ipi )
 {
-    int id,eid;
-    int myid,myeid;
+    int id, eid;
+    int myid, myeid;
-    myid=ia64_get_cpu_id();
-    myeid=ia64_get_cpu_eid();
+    myid = ia64_get_cpu_id();
+    myeid = ia64_get_cpu_eid();
-    //printf("Sending ipi %d on %d\n",ipi,CPU->id);
-    for(id=0;id<256;id++)
-        for(eid=0;eid<256;eid++)
-            if((id!=myid) || (eid!=myeid))
-                if(cpu_by_id_eid_list[id][eid])
-                    ipi_send_ipi(id,eid,ipi);
+    for (id = 0; id < 256; id++)
+        for (eid = 0; eid < 256; eid++)
+            if ((id != myid) || (eid != myeid))
+                if (cpu_by_id_eid_list[id][eid])
+                    ipi_send_ipi(id, eid, ipi);
 }
 void smp_init(void)
 {
-    if(!bootinfo->hello_configured) return;
-    //If we have not system prepared by hello, we are not able to start AP's
-    //this means we are running on simulator
+    if (!bootinfo->hello_configured)
+        return;
+    /*
+     * If we have not got system prepared by hello, we are not able to start
+     * AP's. This means we are running on a simulator.
+     */
     sapic_init();
     ipi_broadcast_arch_all(bootinfo->wakeup_intno);
     volatile long long brk;
-        for(brk=0;brk<100LL*1024LL*1024LL;brk++); //wait a while before CPUs starts
+        for (brk = 0; brk < 100LL * 1024LL * 1024LL; brk++)
+        ;   /* wait a while before CPUs starts */
-    config.cpu_count=0;
-    int id,eid;
+    config.cpu_count = 0;
+    int id, eid;
-    for(id=0;id<256;id++)
-        for(eid=0;eid<256;eid++)
-                if(cpu_by_id_eid_list[id][eid]==1){
+    for (id = 0; id < 256; id++)
+        for (eid = 0; eid < 256; eid++)
+                if (cpu_by_id_eid_list[id][eid] == 1) {
                     config.cpu_count++;
-                    cpu_by_id_eid_list[id][eid]=2;
+                    cpu_by_id_eid_list[id][eid] = 2;
             }
 }
 void kmp(void *arg __attribute__((unused)))
 {
-    int id,eid;
-    int myid,myeid;
+    int id, eid;
+    int myid, myeid;
-    myid=ia64_get_cpu_id();
-    myeid=ia64_get_cpu_eid();
+    myid = ia64_get_cpu_id();
+    myeid = ia64_get_cpu_eid();
-    for(id=0;id<256;id++)
-        for(eid=0;eid<256;eid++)
-                if((id!=myid) || (eid!=myeid))
-                    if(cpu_by_id_eid_list[id][eid]!=0){
-                        if(cpu_by_id_eid_list[id][eid]==1){
-                            //config.cpu_count++;
-                            //cpu_by_id_eid_list[id][eid]=2;
-                            printf("Found Late CPU ID:%d EDI:%d Not added to system!!!\n",id,eid);
+    for (id = 0; id < 256; id++)
+        for (eid = 0; eid < 256; eid++)
+                if ((id != myid) || (eid != myeid))
+                    if (cpu_by_id_eid_list[id][eid] != 0) {
+                        if (cpu_by_id_eid_list[id][eid] == 1) {
+                            printf("Found Late CPU ID:%d "
+                            "EDI:%d Not added to "
+                            "system!!!\n", id, eid);
                             continue;
-                            }
-                    cpu_by_id_eid_list[id][eid]=3;
+                    }
+                    cpu_by_id_eid_list[id][eid] = 3;
                     /*
-                     * There may be just one AP being initialized at
-                     * the time. After it comes completely up, it is
+                     * There may be just one AP being
+                     * initialized at the time. After
+                     * it comes completely up, it is
                      * supposed to wake us up.
                      */
-                    if (waitq_sleep_timeout(&ap_completion_wq, 1000000,
-                        SYNCH_FLAGS_NONE) == ESYNCH_TIMEOUT) {
-                        printf("%s: waiting for cpu ID:%d EID:%d"
-                            "timed out\n", __FUNCTION__,
-                            id, eid);
-                        }
+                    if (waitq_sleep_timeout(
+                        &ap_completion_wq, 1000000,
+                        SYNCH_FLAGS_NONE) ==
+                        ESYNCH_TIMEOUT) {
+                        printf("%s: waiting for cpu "
+                            "ID:%d EID:%d timed out\n",
+                            __FUNCTION__, id, eid);
+                        }
                 }
 }
-#endif
-/*This is just a hack for linking with assembler - may be removed in future*/
-#ifndef CONFIG_SMP
-void main_ap(void);
-void main_ap(void)
-{
-    while(1);
-}
 #endif
 /** @}

 /branches/tracing/kernel/arch/ia64/src/ddi/ddi.c
 ,5 → 1,6
 /*
- * Copyright (c) 2006 Jakub Jermar, Jakub vana
+ * Copyright (c) 2006 Jakub Jermar
+ * Copyright (c) 2008 Jakub vana
  * All rights reserved.
  *
  * Redistribution and use in source and binary forms, with or without
 ,38 → 39,36
 #include <mm/slab.h>
 #include <errno.h>
-#define IO_MEMMAP_PAGES 16384
-#define PORTS_PER_PAGE 4
+#define IO_MEMMAP_PAGES 16384
+#define PORTS_PER_PAGE  4
 /** Enable I/O space range for task.
  *
  * Interrupts are disabled and task is locked.
  *
- * @param task Task.
- * @param ioaddr Startign I/O space address.
- * @param size Size of the enabled I/O range.
+ * @param task      Task.
+ * @param ioaddr    Starting I/O space address.
+ * @param size      Size of the enabled I/O range.
  *
  * @return 0 on success or an error code from errno.h.
  */
 int ddi_iospace_enable_arch(task_t *task, uintptr_t ioaddr, size_t size)
 {
+    if (!task->arch.iomap) {
+        uint8_t *map;
-    if(!task->arch.iomap)
-    {
-        uint8_t *map;
-        task->arch.iomap=malloc(sizeof(bitmap_t),0);
-        map=malloc(BITS2BYTES(IO_MEMMAP_PAGES),0);
+        task->arch.iomap = malloc(sizeof(bitmap_t), 0);
+        map = malloc(BITS2BYTES(IO_MEMMAP_PAGES), 0);
         if(!map)
             return ENOMEM;
-        bitmap_initialize(task->arch.iomap,map,IO_MEMMAP_PAGES);
-        bitmap_clear_range(task->arch.iomap,0,IO_MEMMAP_PAGES);
+        bitmap_initialize(task->arch.iomap, map, IO_MEMMAP_PAGES);
+        bitmap_clear_range(task->arch.iomap, 0, IO_MEMMAP_PAGES);
     }
     uintptr_t iopage = ioaddr / PORTS_PER_PAGE;
-    size = ALIGN_UP (size+ioaddr-4*iopage,PORTS_PER_PAGE);
-    bitmap_set_range(task->arch.iomap,iopage,size/4);
+    size = ALIGN_UP(size + ioaddr - 4 * iopage, PORTS_PER_PAGE);
+    bitmap_set_range(task->arch.iomap, iopage, size / 4);
     return 0;
 }

 /branches/tracing/kernel/arch/ia64/src/asm.S
 ,7 → 51,7
     adds r14 = 7, in1
     mov r2 = ar.lc
-    mov r8 = in0
+    mov r8 = in0 ;;
     and r14 = -8, r14 ;;
     cmp.ne p6, p7 = r14, in1
 (p7)    br.cond.dpnt 3f ;;
 ,6 → 128,10
 memsetb:
     br _memsetb
+.global memsetw
+memsetw:
+    br _memsetw
 .global cpu_halt
 cpu_halt:
     br cpu_halt

 /branches/tracing/kernel/arch/ia64/src/proc/scheduler.c
 ,14 → 47,17
 {
 }
-/** Prepare kernel stack pointers in bank 0 r22 and r23 and make sure the stack is mapped in DTR. */
+/** Prepare kernel stack pointers in bank 0 r22 and r23 and make sure the stack
+ * is mapped in DTR.
+ */
 void before_thread_runs_arch(void)
 {
     uintptr_t base;
-    base = ALIGN_DOWN(config.base, 1<<KERNEL_PAGE_WIDTH);
+    base = ALIGN_DOWN(config.base, 1 << KERNEL_PAGE_WIDTH);
-    if ((uintptr_t) THREAD->kstack < base || (uintptr_t) THREAD->kstack > base + (1<<(KERNEL_PAGE_WIDTH))) {
+    if ((uintptr_t) THREAD->kstack < base ||
+        (uintptr_t) THREAD->kstack > base + (1 << (KERNEL_PAGE_WIDTH))) {
         /*
          * Kernel stack of this thread is not mapped by DTR[TR_KERNEL].
          * Use DTR[TR_KSTACK1] and DTR[TR_KSTACK2] to map it.
 ,8 → 67,11
         dtr_purge((uintptr_t) THREAD->kstack, PAGE_WIDTH+1);
         /* insert DTR[TR_STACK1] and DTR[TR_STACK2] */
-        dtlb_kernel_mapping_insert((uintptr_t) THREAD->kstack, KA2PA(THREAD->kstack), true, DTR_KSTACK1);
-        dtlb_kernel_mapping_insert((uintptr_t) THREAD->kstack + PAGE_SIZE, KA2PA(THREAD->kstack) + FRAME_SIZE, true, DTR_KSTACK2);
+        dtlb_kernel_mapping_insert((uintptr_t) THREAD->kstack,
+            KA2PA(THREAD->kstack), true, DTR_KSTACK1);
+        dtlb_kernel_mapping_insert((uintptr_t) THREAD->kstack +
+            PAGE_SIZE, KA2PA(THREAD->kstack) + FRAME_SIZE, true,
+            DTR_KSTACK2);
     }
     /*

 /branches/tracing/kernel/arch/ia64/src/ia64.c
 ,7 → 33,7
  */
 #include <arch.h>
-#include <arch/ski/ski.h>
+#include <arch/drivers/ski.h>
 #include <arch/drivers/it.h>
 #include <arch/interrupt.h>
 #include <arch/barrier.h>
 ,11 → 50,14
 #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/kbd/i8042.h>
-#include <genarch/kbd/ns16550.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>
 ,53 → 64,40
 #include <panic.h>
 #include <print.h>
 #include <sysinfo/sysinfo.h>
+#include <string.h>
-/*NS16550 as a COM 1*/
-#define NS16550_IRQ (4+LAGACY_INTERRUPT_BASE)
-#define NS16550_PORT 0x3f8
+/* NS16550 as a COM 1 */
+#define NS16550_IRQ  (4 + LEGACY_INTERRUPT_BASE)
 bootinfo_t *bootinfo;
-static uint64_t iosapic_base=0xfec00000;
+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;
+        str_cpy(init.tasks[i].name, CONFIG_TASK_NAME_BUFLEN,
+            bootinfo->taskmap.tasks[i].name);
     }
-/*
-#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();
 ,47 → 105,37
 static void iosapic_init(void)
 {
-    uint64_t IOSAPIC = PA2KA((unative_t)(iosapic_base))|FW_OFFSET;
+    uint64_t IOSAPIC = PA2KA((unative_t)(iosapic_base)) | FW_OFFSET;
     int i;
-    int myid,myeid;
+    int myid, myeid;
-    myid=ia64_get_cpu_id();
-    myeid=ia64_get_cpu_eid();
+    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;
+    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]=LAGACY_INTERRUPT_BASE+i;
+        ((uint32_t *)(IOSAPIC + 0x10))[0] = LEGACY_INTERRUPT_BASE + i;
         srlz_d();
-        ((uint32_t*)(IOSAPIC+0x00))[0]=0x10+2*i+1;
+        ((uint32_t *)(IOSAPIC + 0x00))[0] = 0x10 + 2 * i + 1;
         srlz_d();
-        ((uint32_t*)(IOSAPIC+0x10))[0]=myid<<(56-32) | myeid<<(48-32);
+        ((uint32_t *)(IOSAPIC + 0x10))[0] = myid << (56 - 32) |
+            myeid << (48 - 32);
         srlz_d();
     }
 }
 void arch_post_mm_init(void)
 {
-    if(config.cpu_active==1)
-    {
+    if (config.cpu_active == 1) {
         iosapic_init();
         irq_init(INR_COUNT, INR_COUNT);
-#ifdef SKI
-        ski_init_console();
-#else
-        ega_init();
-#endif
     }
-    it_init();
+    it_init();
 }
 void arch_post_cpu_init(void)
 ,78 → 146,70
 {
 }
-#ifdef I460GX
-#define POLL_INTERVAL       50000       /* 50 ms */
-/** Kernel thread for polling keyboard. */
-static void i8042_kkbdpoll(void *arg)
+void arch_post_smp_init(void)
 {
-    while (1) {
-#ifdef CONFIG_NS16550
-    #ifndef CONFIG_NS16550_INTERRUPT_DRIVEN
-        ns16550_poll();
-    #endif
-#else
-    #ifndef CONFIG_I8042_INTERRUPT_DRIVEN
-        i8042_poll();
-    #endif
-#endif
-        thread_usleep(POLL_INTERVAL);
+#ifdef MACHINE_ski
+    ski_instance_t *ski_instance = skiin_init();
+    if (ski_instance) {
+        srln_instance_t *srln_instance = srln_init();
+        if (srln_instance) {
+            indev_t *sink = stdin_wire();
+            indev_t *srln = srln_wire(srln_instance, sink);
+            skiin_wire(ski_instance, srln);
+        }
     }
-}
+    skiout_init();
 #endif
-void end_of_irq_void(void *cir_arg __attribute__((unused)),inr_t inr __attribute__((unused)));
-void end_of_irq_void(void *cir_arg __attribute__((unused)),inr_t inr __attribute__((unused)))
-{
-    return;
-}
-void arch_post_smp_init(void)
-{
-    {
-        /*
-         * 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);
-#endif
-#ifdef I460GX
-        devno_t kbd = device_assign_devno();
-        /* keyboard controller */
+#ifdef CONFIG_EGA
+    ega_init(EGA_BASE, EGA_VIDEORAM);
+#endif
 #ifdef CONFIG_NS16550
-        ns16550_init(kbd, NS16550_PORT, NS16550_IRQ,end_of_irq_void,NULL); // as a COM 1
-#else
-        devno_t mouse = device_assign_devno();
-        i8042_init(kbd, IRQ_KBD, mouse, IRQ_MOUSE);
+    ns16550_instance_t *ns16550_instance
+        = ns16550_init((ns16550_t *) NS16550_BASE, NS16550_IRQ, NULL, NULL);
+    if (ns16550_instance) {
+        srln_instance_t *srln_instance = srln_init();
+        if (srln_instance) {
+            indev_t *sink = stdin_wire();
+            indev_t *srln = srln_wire(srln_instance, sink);
+            ns16550_wire(ns16550_instance, srln);
+        }
+    }
+    sysinfo_set_item_val("kbd", NULL, true);
+    sysinfo_set_item_val("kbd.inr", NULL, NS16550_IRQ);
+    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);
 #endif
-        thread_t *t;
-        t = thread_create(i8042_kkbdpoll, NULL, TASK, 0, "kkbdpoll", true);
-        if (!t)
-            panic("cannot create kkbdpoll\n");
-        thread_ready(t);
-#endif
+#ifdef CONFIG_I8042
+    i8042_instance_t *i8042_instance = i8042_init((i8042_t *) I8042_BASE, IRQ_KBD);
+    if (i8042_instance) {
+        kbrd_instance_t *kbrd_instance = kbrd_init();
+        if (kbrd_instance) {
+            indev_t *sink = stdin_wire();
+            indev_t *kbrd = kbrd_wire(kbrd_instance, sink);
+            i8042_wire(i8042_instance, kbrd);
+        }
     }
+    sysinfo_set_item_val("kbd", NULL, true);
+    sysinfo_set_item_val("kbd.inr", NULL, IRQ_KBD);
+    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("ia64_iospace", NULL, true);
     sysinfo_set_item_val("ia64_iospace.address", NULL, true);
     sysinfo_set_item_val("ia64_iospace.address.virtual", NULL, IO_OFFSET);
 }
 ,26 → 221,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.
 ,38 → 256,44
  */
 void arch_grab_console(void)
 {
-#ifdef SKI
+#ifdef MACHINE_ski
     ski_kbd_grab();
-#else
-    #ifdef CONFIG_NS16550
-        ns16550_grab();
-    #else
-        i8042_grab();
-    #endif
-#endif
+#endif
 }
 /** Return console to userspace
  *
  */
 void arch_release_console(void)
 {
-#ifdef SKI
+#ifdef MACHINE_ski
     ski_kbd_release();
-#else
-    #ifdef CONFIG_NS16550
-        ns16550_release();
-    #else
-        i8042_release();
-    #endif
 #endif
 }
 void arch_reboot(void)
 {
-    outb(0x64,0xfe);
-    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;
+}
 /** @}
  */

 /branches/tracing/kernel/arch/ia64/src/cpu/cpu.c
 ,7 → 55,7
     *((uint64_t *) &vendor[0 * sizeof(uint64_t)]) = CPU->arch.cpuid0;
     *((uint64_t *) &vendor[1 * sizeof(uint64_t)]) = CPU->arch.cpuid1;
-    vendor[sizeof(vendor) - 1] = '\0';
+    vendor[sizeof(vendor) - 1] = 0;
     switch(m->arch.cpuid3.family) {
     case FAMILY_ITANIUM:
 ,8 → 70,8
     }
     printf("cpu%d: %s (%s), archrev=%d, model=%d, revision=%d\n", CPU->id,
-        family_str, vendor, CPU->arch.cpuid3.archrev, CPU->arch.cpuid3.model,
-        CPU->arch.cpuid3.revision);
+        family_str, vendor, CPU->arch.cpuid3.archrev,
+        CPU->arch.cpuid3.model, CPU->arch.cpuid3.revision);
 }
 /** @}

 /branches/tracing/kernel/arch/ia64/src/mm/tlb.c
 ,7 → 92,7
 /** Invalidate entries belonging to an address space.
  *
- * @param asid Address space identifier.
+ * @param asid      Address space identifier.
  */
 void tlb_invalidate_asid(asid_t asid)
 {
 ,59 → 131,45
     uint64_t ps;
     switch (b) {
-    case 0: /*cnt 1-3*/
+    case 0: /* cnt 1 - 3 */
         ps = PAGE_WIDTH;
         break;
-    case 1: /*cnt 4-15*/
-        /*cnt=((cnt-1)/4)+1;*/
-        ps = PAGE_WIDTH+2;
-        va &= ~((1<<ps)-1);
+    case 1: /* cnt 4 - 15 */
+        ps = PAGE_WIDTH + 2;
+        va &= ~((1 << ps) - 1);
         break;
-    case 2: /*cnt 16-63*/
-        /*cnt=((cnt-1)/16)+1;*/
-        ps = PAGE_WIDTH+4;
-        va &= ~((1<<ps)-1);
+    case 2: /* cnt 16 - 63 */
+        ps = PAGE_WIDTH + 4;
+        va &= ~((1 << ps) - 1);
         break;
-    case 3: /*cnt 64-255*/
-        /*cnt=((cnt-1)/64)+1;*/
-        ps = PAGE_WIDTH+6;
-        va &= ~((1<<ps)-1);
+    case 3: /* cnt 64 - 255 */
+        ps = PAGE_WIDTH + 6;
+        va &= ~((1 << ps) - 1);
         break;
-    case 4: /*cnt 256-1023*/
-        /*cnt=((cnt-1)/256)+1;*/
-        ps = PAGE_WIDTH+8;
-        va &= ~((1<<ps)-1);
+    case 4: /* cnt 256 - 1023 */
+        ps = PAGE_WIDTH + 8;
+        va &= ~((1 << ps) - 1);
         break;
-    case 5: /*cnt 1024-4095*/
-        /*cnt=((cnt-1)/1024)+1;*/
-        ps = PAGE_WIDTH+10;
-        va &= ~((1<<ps)-1);
+    case 5: /* cnt 1024 - 4095 */
+        ps = PAGE_WIDTH + 10;
+        va &= ~((1 << ps) - 1);
         break;
-    case 6: /*cnt 4096-16383*/
-        /*cnt=((cnt-1)/4096)+1;*/
-        ps = PAGE_WIDTH+12;
-        va &= ~((1<<ps)-1);
+    case 6: /* cnt 4096 - 16383 */
+        ps = PAGE_WIDTH + 12;
+        va &= ~((1 << ps) - 1);
         break;
-    case 7: /*cnt 16384-65535*/
-    case 8: /*cnt 65536-(256K-1)*/
-        /*cnt=((cnt-1)/16384)+1;*/
-        ps = PAGE_WIDTH+14;
-        va &= ~((1<<ps)-1);
+    case 7: /* cnt 16384 - 65535 */
+    case 8: /* cnt 65536 - (256K - 1) */
+        ps = PAGE_WIDTH + 14;
+        va &= ~((1 << ps) - 1);
         break;
     default:
-        /*cnt=((cnt-1)/(16384*16))+1;*/
-        ps=PAGE_WIDTH+18;
-        va&=~((1<<ps)-1);
+        ps = PAGE_WIDTH + 18;
+        va &= ~((1 << ps) - 1);
         break;
     }
-    /*cnt+=(page!=va);*/
-    for(; va<(page+cnt*(PAGE_SIZE)); va += (1<<ps)) {
-        asm volatile (
-            "ptc.l %0,%1;;"
-            :
-            : "r" (va), "r" (ps<<2)
-        );
-    }
+    for(; va < (page + cnt * PAGE_SIZE); va += (1 << ps))
+        asm volatile ("ptc.l %0, %1;;" :: "r" (va), "r" (ps << 2));
     srlz_d();
     srlz_i();
 ,9 → 182,10
 /** Insert data into data translation cache.
  *
- * @param va Virtual page address.
- * @param asid Address space identifier.
- * @param entry The rest of TLB entry as required by TLB insertion format.
+ * @param va        Virtual page address.
+ * @param asid      Address space identifier.
+ * @param entry     The rest of TLB entry as required by TLB insertion
+ *          format.
  */
 void dtc_mapping_insert(uintptr_t va, asid_t asid, tlb_entry_t entry)
 {
 ,9 → 194,10
 /** Insert data into instruction translation cache.
  *
- * @param va Virtual page address.
- * @param asid Address space identifier.
- * @param entry The rest of TLB entry as required by TLB insertion format.
+ * @param va        Virtual page address.
+ * @param asid      Address space identifier.
+ * @param entry     The rest of TLB entry as required by TLB insertion
+ *          format.
  */
 void itc_mapping_insert(uintptr_t va, asid_t asid, tlb_entry_t entry)
 {
 ,10 → 206,12
 /** Insert data into instruction or data translation cache.
  *
- * @param va Virtual page address.
- * @param asid Address space identifier.
- * @param entry The rest of TLB entry as required by TLB insertion format.
- * @param dtc If true, insert into data translation cache, use instruction translation cache otherwise.
+ * @param va        Virtual page address.
+ * @param asid      Address space identifier.
+ * @param entry     The rest of TLB entry as required by TLB insertion
+ *          format.
+ * @param dtc       If true, insert into data translation cache, use
+ *          instruction translation cache otherwise.
  */
 void tc_mapping_insert(uintptr_t va, asid_t asid, tlb_entry_t entry, bool dtc)
 {
 ,19 → 234,20
     }
     asm volatile (
-        "mov r8=psr;;\n"
+        "mov r8 = psr;;\n"
         "rsm %0;;\n"            /* PSR_IC_MASK */
         "srlz.d;;\n"
         "srlz.i;;\n"
-        "mov cr.ifa=%1\n"       /* va */
-        "mov cr.itir=%2;;\n"        /* entry.word[1] */
-        "cmp.eq p6,p7 = %4,r0;;\n"  /* decide between itc and dtc */
+        "mov cr.ifa = %1\n"     /* va */
+        "mov cr.itir = %2;;\n"      /* entry.word[1] */
+        "cmp.eq p6,p7 = %4,r0;;\n"  /* decide between itc and dtc */
         "(p6) itc.i %3;;\n"
         "(p7) itc.d %3;;\n"
-        "mov psr.l=r8;;\n"
+        "mov psr.l = r8;;\n"
         "srlz.d;;\n"
         :
-        : "i" (PSR_IC_MASK), "r" (va), "r" (entry.word[1]), "r" (entry.word[0]), "r" (dtc)
+        : "i" (PSR_IC_MASK), "r" (va), "r" (entry.word[1]),
+            "r" (entry.word[0]), "r" (dtc)
         : "p6", "p7", "r8"
     );
 ,12 → 260,14
 /** Insert data into instruction translation register.
  *
- * @param va Virtual page address.
- * @param asid Address space identifier.
- * @param entry The rest of TLB entry as required by TLB insertion format.
- * @param tr Translation register.
+ * @param va        Virtual page address.
+ * @param asid      Address space identifier.
+ * @param entry     The rest of TLB entry as required by TLB insertion
+ *          format.
+ * @param tr        Translation register.
  */
-void itr_mapping_insert(uintptr_t va, asid_t asid, tlb_entry_t entry, index_t tr)
+void
+itr_mapping_insert(uintptr_t va, asid_t asid, tlb_entry_t entry, index_t tr)
 {
     tr_mapping_insert(va, asid, entry, false, tr);
 }
 ,12 → 274,14
 /** Insert data into data translation register.
  *
- * @param va Virtual page address.
- * @param asid Address space identifier.
- * @param entry The rest of TLB entry as required by TLB insertion format.
- * @param tr Translation register.
+ * @param va        Virtual page address.
+ * @param asid      Address space identifier.
+ * @param entry     The rest of TLB entry as required by TLB insertion
+ *          format.
+ * @param tr        Translation register.
  */
-void dtr_mapping_insert(uintptr_t va, asid_t asid, tlb_entry_t entry, index_t tr)
+void
+dtr_mapping_insert(uintptr_t va, asid_t asid, tlb_entry_t entry, index_t tr)
 {
     tr_mapping_insert(va, asid, entry, true, tr);
 }
 ,13 → 288,17
 /** Insert data into instruction or data translation register.
  *
- * @param va Virtual page address.
- * @param asid Address space identifier.
- * @param entry The rest of TLB entry as required by TLB insertion format.
- * @param dtr If true, insert into data translation register, use instruction translation register otherwise.
- * @param tr Translation register.
+ * @param va        Virtual page address.
+ * @param asid      Address space identifier.
+ * @param entry     The rest of TLB entry as required by TLB insertion
+ *          format.
+ * @param dtr       If true, insert into data translation register, use
+ *          instruction translation register otherwise.
+ * @param tr        Translation register.
  */
-void tr_mapping_insert(uintptr_t va, asid_t asid, tlb_entry_t entry, bool dtr, index_t tr)
+void
+tr_mapping_insert(uintptr_t va, asid_t asid, tlb_entry_t entry, bool dtr,
+    index_t tr)
 {
     region_register rr;
     bool restore_rr = false;
 ,19 → 319,20
     }
     asm volatile (
-        "mov r8=psr;;\n"
+        "mov r8 = psr;;\n"
         "rsm %0;;\n"            /* PSR_IC_MASK */
         "srlz.d;;\n"
         "srlz.i;;\n"
-        "mov cr.ifa=%1\n"           /* va */
-        "mov cr.itir=%2;;\n"        /* entry.word[1] */
-        "cmp.eq p6,p7=%5,r0;;\n"    /* decide between itr and dtr */
-        "(p6) itr.i itr[%4]=%3;;\n"
-        "(p7) itr.d dtr[%4]=%3;;\n"
-        "mov psr.l=r8;;\n"
+        "mov cr.ifa = %1\n"         /* va */
+        "mov cr.itir = %2;;\n"      /* entry.word[1] */
+        "cmp.eq p6,p7 = %5,r0;;\n"  /* decide between itr and dtr */
+        "(p6) itr.i itr[%4] = %3;;\n"
+        "(p7) itr.d dtr[%4] = %3;;\n"
+        "mov psr.l = r8;;\n"
         "srlz.d;;\n"
         :
-        : "i" (PSR_IC_MASK), "r" (va), "r" (entry.word[1]), "r" (entry.word[0]), "r" (tr), "r" (dtr)
+        : "i" (PSR_IC_MASK), "r" (va), "r" (entry.word[1]),
+            "r" (entry.word[0]), "r" (tr), "r" (dtr)
         : "p6", "p7", "r8"
     );
 ,12 → 345,15
 /** Insert data into DTLB.
  *
- * @param page Virtual page address including VRN bits.
- * @param frame Physical frame address.
- * @param dtr If true, insert into data translation register, use data translation cache otherwise.
- * @param tr Translation register if dtr is true, ignored otherwise.
+ * @param page      Virtual page address including VRN bits.
+ * @param frame     Physical frame address.
+ * @param dtr       If true, insert into data translation register, use data
+ *          translation cache otherwise.
+ * @param tr        Translation register if dtr is true, ignored otherwise.
  */
-void dtlb_kernel_mapping_insert(uintptr_t page, uintptr_t frame, bool dtr, index_t tr)
+void
+dtlb_kernel_mapping_insert(uintptr_t page, uintptr_t frame, bool dtr,
+    index_t tr)
 {
     tlb_entry_t entry;
 ,18 → 379,18
  *
  * Purge DTR entries used by the kernel.
  *
- * @param page Virtual page address including VRN bits.
- * @param width Width of the purge in bits.
+ * @param page      Virtual page address including VRN bits.
+ * @param width     Width of the purge in bits.
  */
 void dtr_purge(uintptr_t page, count_t width)
 {
-    asm volatile ("ptr.d %0, %1\n" : : "r" (page), "r" (width<<2));
+    asm volatile ("ptr.d %0, %1\n" : : "r" (page), "r" (width << 2));
 }
 /** Copy content of PTE into data translation cache.
  *
- * @param t PTE.
+ * @param t     PTE.
  */
 void dtc_pte_copy(pte_t *t)
 {
 ,7 → 416,7
 /** Copy content of PTE into instruction translation cache.
  *
- * @param t PTE.
+ * @param t     PTE.
  */
 void itc_pte_copy(pte_t *t)
 {
 ,8 → 443,8
 /** Instruction TLB fault handler for faults with VHPT turned off.
  *
- * @param vector Interruption vector.
- * @param istate Structure with saved interruption state.
+ * @param vector        Interruption vector.
+ * @param istate        Structure with saved interruption state.
  */
 void alternate_instruction_tlb_fault(uint64_t vector, istate_t *istate)
 {
 ,83 → 472,77
          */
         page_table_unlock(AS, true);
         if (as_page_fault(va, PF_ACCESS_EXEC, istate) == AS_PF_FAULT) {
-            fault_if_from_uspace(istate,"Page fault at %p",va);
-            panic("%s: va=%p, rid=%d, iip=%p\n", __func__, va, rid, istate->cr_iip);
+            fault_if_from_uspace(istate,"Page fault at %p.",va);
+            panic("%s: va=%p, rid=%d, iip=%p.", __func__, va, rid,
+                istate->cr_iip);
         }
     }
 }
 static int is_io_page_accessible(int page)
 {
-    if(TASK->arch.iomap) return bitmap_get(TASK->arch.iomap,page);
-    else return 0;
+    if (TASK->arch.iomap)
+        return bitmap_get(TASK->arch.iomap, page);
+    else
+        return 0;
 }
 #define IO_FRAME_BASE 0xFFFFC000000
-/** There is special handling of memmaped lagacy io, because
- * of 4KB sized access
- * only for userspace
+/**
+ * There is special handling of memory mapped legacy io, because of 4KB sized
+ * access for userspace.
  *
- * @param va virtual address of page fault
- * @param istate Structure with saved interruption state.
+ * @param va        Virtual address of page fault.
+ * @param istate    Structure with saved interruption state.
  *
- *
- * @return 1 on success, 0 on fail
+ * @return      One on success, zero on failure.
  */
 static int try_memmap_io_insertion(uintptr_t va, istate_t *istate)
 {
-    if((va >= IO_OFFSET ) && (va < IO_OFFSET + (1<<IO_PAGE_WIDTH)))
-        if(TASK){
-            uint64_t io_page=(va &  ((1<<IO_PAGE_WIDTH)-1)) >> (USPACE_IO_PAGE_WIDTH);
-            if(is_io_page_accessible(io_page)){
-                //printf("Insert %llX\n",va);
+    if ((va >= IO_OFFSET ) && (va < IO_OFFSET + (1 << IO_PAGE_WIDTH))) {
+        if (TASK) {
+            uint64_t io_page = (va & ((1 << IO_PAGE_WIDTH) - 1)) >>
+                USPACE_IO_PAGE_WIDTH;
-                uint64_t page,frame;
+            if (is_io_page_accessible(io_page)) {
+                uint64_t page, frame;
-                page = IO_OFFSET + (1 << USPACE_IO_PAGE_WIDTH) * io_page;
-                frame = IO_FRAME_BASE + (1 << USPACE_IO_PAGE_WIDTH) * io_page;
+                page = IO_OFFSET +
+                    (1 << USPACE_IO_PAGE_WIDTH) * io_page;
+                frame = IO_FRAME_BASE +
+                    (1 << USPACE_IO_PAGE_WIDTH) * io_page;
                 tlb_entry_t entry;
                 entry.word[0] = 0;
                 entry.word[1] = 0;
-                entry.p = true;         /* present */
+                entry.p = true;     /* present */
                 entry.ma = MA_UNCACHEABLE;
-                entry.a = true;         /* already accessed */
-                entry.d = true;         /* already dirty */
+                entry.a = true;     /* already accessed */
+                entry.d = true;     /* already dirty */
                 entry.pl = PL_USER;
                 entry.ar = AR_READ | AR_WRITE;
-                entry.ppn = frame >> PPN_SHIFT;    //MUSIM spocitat frame
+                entry.ppn = frame >> PPN_SHIFT;
                 entry.ps = USPACE_IO_PAGE_WIDTH;
-                dtc_mapping_insert(page, TASK->as->asid, entry); //Musim zjistit ASID
+                dtc_mapping_insert(page, TASK->as->asid, entry);
                 return 1;
-            }else {
-                fault_if_from_uspace(istate,"IO access fault at %p",va);
-                return 0;
-            }
-        } else
-            return 0;
-    else
-        return 0;
+            } else {
+                fault_if_from_uspace(istate,
+                    "IO access fault at %p.", va);
+            }
+        }
+    }
     return 0;
 }
 /** Data TLB fault handler for faults with VHPT turned off.
  *
- * @param vector Interruption vector.
- * @param istate Structure with saved interruption state.
+ * @param vector    Interruption vector.
+ * @param istate    Structure with saved interruption state.
  */
 void alternate_data_tlb_fault(uint64_t vector, istate_t *istate)
 {
 ,13 → 576,16
         page_table_unlock(AS, true);
     } else {
         page_table_unlock(AS, true);
-        if (try_memmap_io_insertion(va,istate)) return;
+        if (try_memmap_io_insertion(va, istate))
+            return;
         /*
-         * Forward the page fault to the address space page fault handler.
+         * Forward the page fault to the address space page fault
+         * handler.
          */
         if (as_page_fault(va, PF_ACCESS_READ, istate) == AS_PF_FAULT) {
-            fault_if_from_uspace(istate,"Page fault at %p",va);
-            panic("%s: va=%p, rid=%d, iip=%p\n", __func__, va, rid, istate->cr_iip);
+            fault_if_from_uspace(istate,"Page fault at %p.",va);
+            panic("%s: va=%p, rid=%d, iip=%p.", __func__, va, rid,
+                istate->cr_iip);
         }
     }
 }
 ,18 → 594,18
  *
  * This fault should not occur.
  *
- * @param vector Interruption vector.
- * @param istate Structure with saved interruption state.
+ * @param vector    Interruption vector.
+ * @param istate    Structure with saved interruption state.
  */
 void data_nested_tlb_fault(uint64_t vector, istate_t *istate)
 {
-    panic("%s\n", __func__);
+    panic("%s.", __func__);
 }
 /** Data Dirty bit fault handler.
  *
- * @param vector Interruption vector.
- * @param istate Structure with saved interruption state.
+ * @param vector    Interruption vector.
+ * @param istate    Structure with saved interruption state.
  */
 void data_dirty_bit_fault(uint64_t vector, istate_t *istate)
 {
 ,10 → 630,9
         dtc_pte_copy(t);
     } else {
         if (as_page_fault(va, PF_ACCESS_WRITE, istate) == AS_PF_FAULT) {
-            fault_if_from_uspace(istate,"Page fault at %p",va);
-            panic("%s: va=%p, rid=%d, iip=%p\n", __func__, va, rid, istate->cr_iip);
-            t->d = true;
-            dtc_pte_copy(t);
+            fault_if_from_uspace(istate,"Page fault at %p.",va);
+            panic("%s: va=%p, rid=%d, iip=%p.", __func__, va, rid,
+                istate->cr_iip);
         }
     }
     page_table_unlock(AS, true);
 ,8 → 640,8
 /** Instruction access bit fault handler.
  *
- * @param vector Interruption vector.
- * @param istate Structure with saved interruption state.
+ * @param vector    Interruption vector.
+ * @param istate    Structure with saved interruption state.
  */
 void instruction_access_bit_fault(uint64_t vector, istate_t *istate)
 {
 ,10 → 666,9
         itc_pte_copy(t);
     } else {
         if (as_page_fault(va, PF_ACCESS_EXEC, istate) == AS_PF_FAULT) {
-            fault_if_from_uspace(istate,"Page fault at %p",va);
-            panic("%s: va=%p, rid=%d, iip=%p\n", __func__, va, rid, istate->cr_iip);
-            t->a = true;
-            itc_pte_copy(t);
+            fault_if_from_uspace(istate, "Page fault at %p.", va);
+            panic("%s: va=%p, rid=%d, iip=%p.", __func__, va, rid,
+                istate->cr_iip);
         }
     }
     page_table_unlock(AS, true);
 ,10 → 702,9
         dtc_pte_copy(t);
     } else {
         if (as_page_fault(va, PF_ACCESS_READ, istate) == AS_PF_FAULT) {
-            fault_if_from_uspace(istate,"Page fault at %p",va);
-            panic("%s: va=%p, rid=%d, iip=%p\n", __func__, va, rid, istate->cr_iip);
-            t->a = true;
-            itc_pte_copy(t);
+            fault_if_from_uspace(istate, "Page fault at %p.", va);
+            panic("%s: va=%p, rid=%d, iip=%p.", __func__, va, rid,
+                istate->cr_iip);
         }
     }
     page_table_unlock(AS, true);
 ,11 → 743,19
     } else {
         page_table_unlock(AS, true);
         if (as_page_fault(va, PF_ACCESS_READ, istate) == AS_PF_FAULT) {
-            fault_if_from_uspace(istate,"Page fault at %p",va);
-            panic("%s: va=%p, rid=%d\n", __func__, va, rid);
+            fault_if_from_uspace(istate, "Page fault at %p.", va);
+            panic("%s: va=%p, rid=%d.", __func__, va, rid);
         }
     }
 }
+void tlb_arch_init(void)
+{
+}
+void tlb_print(void)
+{
+}
 /** @}
  */

 /branches/tracing/kernel/arch/ia64/src/mm/vhpt.c
 ,7 → 41,8
 uintptr_t vhpt_set_up(void)
 {
-    vhpt_base = frame_alloc(VHPT_WIDTH - FRAME_WIDTH, FRAME_KA | FRAME_ATOMIC);
+    vhpt_base = frame_alloc(VHPT_WIDTH - FRAME_WIDTH,
+        FRAME_KA | FRAME_ATOMIC);
     if (!vhpt_base)
         panic("Kernel configured with VHPT but no memory for table.");
     vhpt_invalidate_all();

 /branches/tracing/kernel/arch/ia64/src/mm/as.c
 ,7 → 68,7
             continue;
         rr.word = rr_read(i);
-        rr.map.ve = false;          /* disable VHPT walker */
+        rr.map.ve = false;      /* disable VHPT walker */
         rr.map.rid = ASID2RID(as->asid, i);
         rr.map.ps = PAGE_WIDTH;
         rr_write(i, rr.word);

 /branches/tracing/kernel/arch/ia64/src/mm/frame.c
 ,7 → 26,7
  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
  */
-/** @addtogroup ia64mm
+/** @addtogroup ia64mm
  * @{
  */
 /** @file
 ,57 → 40,50
 #include <align.h>
 #include <macros.h>
-/*
- * This is Ski-specific and certainly not sufficient
- * for real ia64 systems that provide memory map.
- */
-#define MEMORY_SIZE (256 * 1024 * 1024)
-#define MEMORY_BASE (0 * 64 * 1024 * 1024)
+#define KERNEL_RESERVED_AREA_BASE   (0x4400000)
+#define KERNEL_RESERVED_AREA_SIZE   (16 * 1024 * 1024)
-#define KERNEL_RESERVED_AREA_BASE (0x4400000)
-#define KERNEL_RESERVED_AREA_SIZE (16*1024*1024)
+#define ROM_BASE    0xa0000               /* for simulators */
+#define ROM_SIZE    (384 * 1024)          /* for simulators */
-#define ONE_TO_ONE_MAPPING_SIZE (256*1048576) // Mapped at start
+#define MIN_ZONE_SIZE   (64 * 1024)
-#define ROM_BASE    0xa0000               //For ski
-#define ROM_SIZE    (384 * 1024)          //For ski
-void poke_char(int x,int y,char ch, char c);
+#define MINCONF 1
-#define MIN_ZONE_SIZE (64*1024)
+uintptr_t last_frame = 0;
-uintptr_t last_frame;
-#define MINCONF 1
 void frame_arch_init(void)
 {
-    if(config.cpu_active==1){
+    if (config.cpu_active == 1) {
         unsigned int i;
-        for(i=0;i<bootinfo->memmap_items;i++){
-            if (bootinfo->memmap[i].type==EFI_MEMMAP_FREE_MEM){
-                uint64_t base=bootinfo->memmap[i].base;
-                uint64_t size=bootinfo->memmap[i].size;
-                uint64_t abase=ALIGN_UP(base,FRAME_SIZE);
-                if(size>FRAME_SIZE) size -=abase-base;
+        for (i = 0; i < bootinfo->memmap_items; i++) {
+            if (bootinfo->memmap[i].type == EFI_MEMMAP_FREE_MEM) {
+                uint64_t base = bootinfo->memmap[i].base;
+                uint64_t size = bootinfo->memmap[i].size;
+                uint64_t abase = ALIGN_UP(base, FRAME_SIZE);
-                if(size>MIN_ZONE_SIZE)  {
-                    zone_create(abase >> FRAME_WIDTH, (size) >> FRAME_WIDTH, max(MINCONF,((abase) >> FRAME_WIDTH)), 0);
-                }
+                if (size > FRAME_SIZE)
+                    size -= abase - base;
+                if (size > MIN_ZONE_SIZE) {
+                    zone_create(abase >> FRAME_WIDTH,
+                        size >> FRAME_WIDTH,
+                        max(MINCONF, abase >> FRAME_WIDTH),
+);
+                }
+                if (abase + size > last_frame)
+                    last_frame = abase + size;
             }
         }
-        //zone_create(MEMORY_BASE >> FRAME_WIDTH, SIZE2FRAMES(MEMORY_SIZE), (MEMORY_SIZE) >> FRAME_WIDTH, 0);
         /*
-        * Blacklist ROM regions.
-        */
-        frame_mark_unavailable(ADDR2PFN(ROM_BASE), SIZE2FRAMES(ROM_SIZE));
+         * Blacklist ROM regions.
+         */
+        frame_mark_unavailable(ADDR2PFN(ROM_BASE),
+            SIZE2FRAMES(ROM_SIZE));
-        frame_mark_unavailable(ADDR2PFN(KERNEL_RESERVED_AREA_BASE), SIZE2FRAMES(KERNEL_RESERVED_AREA_SIZE));
+        frame_mark_unavailable(ADDR2PFN(KERNEL_RESERVED_AREA_BASE),
+            SIZE2FRAMES(KERNEL_RESERVED_AREA_SIZE));
     }
 }

 /branches/tracing/kernel/arch/ia64/src/mm/page.c
 ,7 → 27,7
  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
  */
-/** @addtogroup ia64mm
+/** @addtogroup ia64mm
  * @{
  */
 /** @file
 ,9 → 63,9
 void set_environment(void)
 {
     region_register rr;
-    pta_register pta;
+    pta_register pta;
     int i;
-#ifdef CONFIG_VHPT
+#ifdef CONFIG_VHPT
     uintptr_t vhpt_base;
 #endif
 ,10 → 123,10
  *
  * Interrupts must be disabled.
  *
- * @param page Address of virtual page including VRN bits.
- * @param asid Address space identifier.
+ * @param page      Address of virtual page including VRN bits.
+ * @param asid      Address space identifier.
  *
- * @return VHPT entry address.
+ * @return      VHPT entry address.
  */
 vhpt_entry_t *vhpt_hash(uintptr_t page, asid_t asid)
 {
 ,10 → 167,11
  *
  * Interrupts must be disabled.
  *
- * @param page Address of virtual page including VRN bits.
- * @param asid Address space identifier.
+ * @param page      Address of virtual page including VRN bits.
+ * @param asid      Address space identifier.
  *
- * @return True if page and asid match the page and asid of t, false otherwise.
+ * @return      True if page and asid match the page and asid of t,
+ *          false otherwise.
  */
 bool vhpt_compare(uintptr_t page, asid_t asid, vhpt_entry_t *v)
 {
 ,12 → 212,15
 /** Set up one VHPT entry.
  *
  * @param v VHPT entry to be set up.
- * @param page Virtual address of the page mapped by the entry.
- * @param asid Address space identifier of the address space to which page belongs.
- * @param frame Physical address of the frame to wich page is mapped.
- * @param flags Different flags for the mapping.
+ * @param page      Virtual address of the page mapped by the entry.
+ * @param asid      Address space identifier of the address space to which
+ *          page belongs.
+ * @param frame     Physical address of the frame to wich page is mapped.
+ * @param flags     Different flags for the mapping.
  */
-void vhpt_set_record(vhpt_entry_t *v, uintptr_t page, asid_t asid, uintptr_t frame, int flags)
+void
+vhpt_set_record(vhpt_entry_t *v, uintptr_t page, asid_t asid, uintptr_t frame,
+    int flags)
 {
     region_register rr_save, rr;
     index_t vrn;
 ,7 → 254,8
     v->word[3] = 0;
     v->present.p = true;
-    v->present.ma = (flags & PAGE_CACHEABLE) ? MA_WRITEBACK : MA_UNCACHEABLE;
+    v->present.ma = (flags & PAGE_CACHEABLE) ?
+        MA_WRITEBACK : MA_UNCACHEABLE;
     v->present.a = false;   /* not accessed */
     v->present.d = false;   /* not dirty */
     v->present.pl = (flags & PAGE_USER) ? PL_USER : PL_KERNEL;
 ,27 → 268,11
     v->present.tag.tag_word = tag;
 }
-extern uintptr_t last_frame;
-uintptr_t hw_map(uintptr_t physaddr, size_t size)
+uintptr_t hw_map(uintptr_t physaddr, size_t size __attribute__ ((unused)))
 {
-    if (last_frame + ALIGN_UP(size, PAGE_SIZE) > KA2PA(KERNEL_ADDRESS_SPACE_END_ARCH))
-        panic("Unable to map physical memory %p (%d bytes)", physaddr, size)
-    uintptr_t virtaddr = PA2KA(last_frame);
-    pfn_t i;
-    for (i = 0; i < ADDR2PFN(ALIGN_UP(size, PAGE_SIZE)); i++) {
-        uintptr_t addr = PFN2ADDR(i);
-        page_mapping_insert(AS_KERNEL, virtaddr + addr, physaddr + addr, PAGE_NOT_CACHEABLE | PAGE_WRITE);
-    }
-    last_frame = ALIGN_UP(last_frame + size, FRAME_SIZE);
-    return virtaddr;
+    /* THIS is a dirty hack. */
+    return (uintptr_t)((uint64_t)(PA2KA(physaddr)) + VIO_OFFSET);
 }
 /** @}
  */

 /branches/tracing/kernel/arch/ia64/src/interrupt.c
 ,7 → 38,6
 #include <ddi/irq.h>
 #include <panic.h>
 #include <print.h>
-#include <symtab.h>
 #include <debug.h>
 #include <console/console.h>
 #include <arch/types.h>
 ,6 → 53,8
 #include <ipc/ipc.h>
 #include <synch/spinlock.h>
 #include <mm/tlb.h>
+#include <symtab.h>
+#include <putchar.h>
 #define VECTORS_64_BUNDLE   20
 #define VECTORS_16_BUNDLE   48
 ,9 → 138,9
 {
     char *ifa, *iipa, *iip;
-    ifa = get_symtab_entry(istate->cr_ifa);
-    iipa = get_symtab_entry(istate->cr_iipa);
-    iip = get_symtab_entry(istate->cr_iip);
+    ifa = symtab_fmt_name_lookup(istate->cr_ifa);
+    iipa = symtab_fmt_name_lookup(istate->cr_iipa);
+    iip = symtab_fmt_name_lookup(istate->cr_iip);
     putchar('\n');
     printf("Interrupted context dump:\n");
 ,21 → 187,21
         break;
     }
-    fault_if_from_uspace(istate, "General Exception (%s)", desc);
+    fault_if_from_uspace(istate, "General Exception (%s).", desc);
     dump_interrupted_context(istate);
-    panic("General Exception (%s)\n", desc);
+    panic("General Exception (%s).", desc);
 }
 void disabled_fp_register(uint64_t vector, istate_t *istate)
 {
-#ifdef CONFIG_FPU_LAZY
-    scheduler_fpu_lazy_request();
+#ifdef CONFIG_FPU_LAZY
+    scheduler_fpu_lazy_request();
 #else
-    fault_if_from_uspace(istate, "Interruption: %#hx (%s)",
+    fault_if_from_uspace(istate, "Interruption: %#hx (%s).",
         (uint16_t) vector, vector_to_string(vector));
     dump_interrupted_context(istate);
-    panic("Interruption: %#hx (%s)\n", (uint16_t) vector,
+    panic("Interruption: %#hx (%s).", (uint16_t) vector,
         vector_to_string(vector));
 #endif
 }
 ,10 → 229,10
 void universal_handler(uint64_t vector, istate_t *istate)
 {
-    fault_if_from_uspace(istate, "Interruption: %#hx (%s)\n",
+    fault_if_from_uspace(istate, "Interruption: %#hx (%s).",
         (uint16_t) vector, vector_to_string(vector));
     dump_interrupted_context(istate);
-    panic("Interruption: %#hx (%s)\n", (uint16_t) vector,
+    panic("Interruption: %#hx (%s).", (uint16_t) vector,
         vector_to_string(vector));
 }
 ,72 → 245,66
 void external_interrupt(uint64_t vector, istate_t *istate)
 {
     cr_ivr_t ivr;
+    irq_t *irq;
     ivr.value = ivr_read();
     srlz_d();
-        switch (ivr.vector) {
-        case INTERRUPT_SPURIOUS:
+    switch (ivr.vector) {
+    case INTERRUPT_SPURIOUS:
 #ifdef CONFIG_DEBUG
-            printf("cpu%d: spurious interrupt\n", CPU->id);
+        printf("cpu%d: spurious interrupt\n", CPU->id);
 #endif
-            break;
+        break;
 #ifdef CONFIG_SMP
-        case VECTOR_TLB_SHOOTDOWN_IPI:
-            tlb_shootdown_ipi_recv();
-            end_of_local_irq();
-            break;
+    case VECTOR_TLB_SHOOTDOWN_IPI:
+        tlb_shootdown_ipi_recv();
+        end_of_local_irq();
+        break;
 #endif
-        case INTERRUPT_TIMER:
-            {
-                irq_t *irq = irq_dispatch_and_lock(ivr.vector);
-                if (irq) {
-                    irq->handler(irq, irq->arg);
-                    spinlock_unlock(&irq->lock);
-                } else {
-                    panic("\nUnhandled Internal Timer Interrupt (%d)\n",ivr.vector);
-                }
-            }
-            break;
-        default:
-            {
-                int ack=false;
-                irq_t *irq = irq_dispatch_and_lock(ivr.vector);
-                if (irq) {
-                    /*
-                     * The IRQ handler was found.
-                     */
-                    if (irq->preack) {
-                        /* Send EOI before processing the interrupt */
-                        end_of_local_irq();
-                        ack=true;
-                    }
-                    irq->handler(irq, irq->arg);
-                    spinlock_unlock(&irq->lock);
-                } else {
-                    /*
-                     * Unhandled interrupt.
-                     */
-                    end_of_local_irq();
-                    ack=true;
+    case INTERRUPT_TIMER:
+        irq = irq_dispatch_and_lock(ivr.vector);
+        if (irq) {
+            irq->handler(irq);
+            spinlock_unlock(&irq->lock);
+        } else {
+            panic("Unhandled Internal Timer Interrupt (%d).",
+                ivr.vector);
+        }
+        break;
+    default:
+        irq = irq_dispatch_and_lock(ivr.vector);
+        if (irq) {
+            /*
+             * The IRQ handler was found.
+             */
+            if (irq->preack) {
+                /* Send EOI before processing the interrupt */
+                end_of_local_irq();
+            }
+            irq->handler(irq);
+            if (!irq->preack)
+                end_of_local_irq();
+            spinlock_unlock(&irq->lock);
+        } else {
+            /*
+             * Unhandled interrupt.
+             */
+            end_of_local_irq();
 #ifdef CONFIG_DEBUG
-                    printf("\nUnhandled External Interrupt Vector %d\n",ivr.vector);
+            printf("\nUnhandled External Interrupt Vector %d\n",
+                ivr.vector);
 #endif
-                }
-                if(!ack) end_of_local_irq();
-            }
-            break;
         }
+        break;
+    }
 }
+void trap_virtual_enable_irqs(uint16_t irqmask)
+{
+}
 /** @}
  */

 /branches/tracing/kernel/arch/ia64/src/start.S
 ,17 → 32,15
 #include <mm/asid.h>
 #define RR_MASK (0xFFFFFFFF00000002)
-#define RID_SHIFT 8
-#define PS_SHIFT 2
+#define RID_SHIFT   8
+#define PS_SHIFT    2
-#define KERNEL_TRANSLATION_I  0x0010000000000661
-#define KERNEL_TRANSLATION_D  0x0010000000000661
-#define KERNEL_TRANSLATION_VIO 0x0010000000000671
-#define KERNEL_TRANSLATION_IO 0x00100FFFFC000671
-#define KERNEL_TRANSLATION_FW 0x00100000F0000671
+#define KERNEL_TRANSLATION_I    0x0010000000000661
+#define KERNEL_TRANSLATION_D    0x0010000000000661
+#define KERNEL_TRANSLATION_VIO  0x0010000000000671
+#define KERNEL_TRANSLATION_IO   0x00100FFFFC000671
+#define KERNEL_TRANSLATION_FW   0x00100000F0000671
 .section K_TEXT_START, "ax"
 .global kernel_image_start
 ,18 → 49,19
 kernel_image_start:
     .auto
-#identifi self(CPU) in OS structures by ID / EID
-    mov r9=cr64
-    mov r10=1
-    movl r12=0xffffffff
-    movl r8=cpu_by_id_eid_list
-    and r8=r8,r12
-    shr r9=r9,16
-    add r8=r8,r9
-    st1 [r8]=r10
+#ifdef CONFIG_SMP
+    # Identify self(CPU) in OS structures by ID / EID
+    mov r9 = cr64
+    mov r10 = 1
+    movl r12 = 0xffffffff
+    movl r8 = cpu_by_id_eid_list
+    and r8 = r8, r12
+    shr r9 = r9, 16
+    add r8 = r8, r9
+    st1 [r8] = r10
+#endif
     mov psr.l = r0
     srlz.i
     srlz.d
 ,39 → 68,29
     # Fill TR.i and TR.d using Region Register #VRN_KERNEL
     movl r8 = (VRN_KERNEL << VRN_SHIFT)
     mov r9 = rr[r8]
     movl r10 = (RR_MASK)
     and r9 = r10, r9
     movl r10 = ((RID_KERNEL << RID_SHIFT) | (KERNEL_PAGE_WIDTH << PS_SHIFT))
     or  r9 = r10, r9
     mov rr[r8] = r9
     movl r8 = (VRN_KERNEL << VRN_SHIFT)
     mov cr.ifa = r8
-    mov r11 = cr.itir ;;
-    movl r10 = (KERNEL_PAGE_WIDTH << PS_SHIFT);;
-    or r10 =r10 , r11  ;;
-    mov cr.itir = r10;;
+    mov r11 = cr.itir
+    movl r10 = (KERNEL_PAGE_WIDTH << PS_SHIFT)
+    or r10 = r10, r11
+    mov cr.itir = r10
     movl r10 = (KERNEL_TRANSLATION_I)
     itr.i itr[r0] = r10
     movl r10 = (KERNEL_TRANSLATION_D)
     itr.d dtr[r0] = r10
     movl r7 = 1
     movl r8 = (VRN_KERNEL << VRN_SHIFT) | VIO_OFFSET
     mov cr.ifa = r8
 ,15 → 97,13
     movl r10 = (KERNEL_TRANSLATION_VIO)
     itr.d dtr[r7] = r10
+    mov r11 = cr.itir
+    movl r10 = ~0xfc
+    and r10 = r10, r11
+    movl r11 = (IO_PAGE_WIDTH << PS_SHIFT)
+    or r10 = r10, r11
+    mov cr.itir = r10
-    mov r11 = cr.itir ;;
-    movl r10 = ~0xfc;;
-    and r10 =r10 , r11  ;;
-    movl r11 = (IO_PAGE_WIDTH << PS_SHIFT);;
-    or r10 =r10 , r11  ;;
-    mov cr.itir = r10;;
     movl r7 = 2
     movl r8 = (VRN_KERNEL << VRN_SHIFT) | IO_OFFSET
     mov cr.ifa = r8
 ,16 → 110,15
     movl r10 = (KERNEL_TRANSLATION_IO)
     itr.d dtr[r7] = r10
+    # Setup mapping for fimware arrea (also SAPIC)
-#setup mapping for fimware arrea (also SAPIC)
-    mov r11 = cr.itir ;;
-    movl r10 = ~0xfc;;
-    and r10 =r10 , r11  ;;
-    movl r11 = (FW_PAGE_WIDTH << PS_SHIFT);;
-    or r10 =r10 , r11  ;;
-    mov cr.itir = r10;;
+    mov r11 = cr.itir
+    movl r10 = ~0xfc
+    and r10 = r10, r11
+    movl r11 = (FW_PAGE_WIDTH << PS_SHIFT)
+    or r10 = r10, r11
+    mov cr.itir = r10
     movl r7 = 3
     movl r8 = (VRN_KERNEL << VRN_SHIFT) | FW_OFFSET
     mov cr.ifa = r8
 ,13 → 125,11
     movl r10 = (KERNEL_TRANSLATION_FW)
     itr.d dtr[r7] = r10
+    # Initialize PSR
-    # initialize PSR
     movl r10 = (PSR_DT_MASK | PSR_RT_MASK | PSR_IT_MASK | PSR_IC_MASK)  /* Enable paging */
     mov r9 = psr
     or r10 = r10, r9
     mov cr.ipsr = r10
     mov cr.ifs = r0
 ,11 → 139,14
     srlz.i
     .explicit
     /*
-     * Return From Interupt is the only the way to fill upper half word of PSR.
+     * Return From Interrupt is the only way to
+     * fill the upper half word of PSR.
      */
-    rfi;;
+    rfi ;;
 .global paging_start
 paging_start:
 ,27 → 154,29
      * Now we are paging.
      */
-    # switch to register bank 1
+    # Switch to register bank 1
     bsw.1
-#Am'I BSP or AP
-    movl r20=bsp_started;;
-    ld8 r20=[r20];;
-    cmp.eq p3,p2=r20,r0;;
+#ifdef CONFIG_SMP
+    # Am I BSP or AP?
+    movl r20 = bsp_started ;;
+    ld8 r20 = [r20] ;;
+    cmp.eq p3, p2 = r20, r0 ;;
+#else
+    cmp.eq p3, p2 = r0, r0 ;;   /* you are BSP */
+#endif  /* CONFIG_SMP */
-    # initialize register stack
+    # Initialize register stack
     mov ar.rsc = r0
     movl r8 = (VRN_KERNEL << VRN_SHIFT) ;;
     mov ar.bspstore = r8
     loadrs
-    # initialize memory stack to some sane value
+    # Initialize memory stack to some sane value
     movl r12 = stack0 ;;
     add r12 = -16, r12  /* allocate a scratch area on the stack */
-    # initialize gp (Global Pointer) register
+    # Initialize gp (Global Pointer) register
     movl r20 = (VRN_KERNEL << VRN_SHIFT);;
     or r20 = r20,r1;;
     movl r1 = _hardcoded_load_address
 ,16 → 201,17
     srlz.i
     srlz.d ;;
+#ifdef CONFIG_SMP
 (p2)    movl r18 = main_ap ;;
 (p2)    mov b1 = r18 ;;
 (p2)    br.call.sptk.many b0 = b1
-#Mark that BSP is on
-    mov r20=1;;
-    movl r21=bsp_started;;
-    st8 [r21]=r20;;
+    # Mark that BSP is on
+    mov r20 = 1 ;;
+    movl r21 = bsp_started ;;
+    st8 [r21] = r20 ;;
+#endif
     br.call.sptk.many b0 = arch_pre_main
     movl r18 = main_bsp ;;
 ,49 → 218,51
     mov b1 = r18 ;;
     br.call.sptk.many b0 = b1
 :
     br 0b
+#ifdef CONFIG_SMP
 .align 4096
 kernel_image_ap_start:
     .auto
-#identifi self(CPU) in OS structures by ID / EID
-    mov r9=cr64
-    mov r10=1
-    movl r12=0xffffffff
-    movl r8=cpu_by_id_eid_list
-    and r8=r8,r12
-    shr r9=r9,16
-    add r8=r8,r9
-    st1 [r8]=r10
+    # Identify self(CPU) in OS structures by ID / EID
+    mov r9 = cr64
+    mov r10 = 1
+    movl r12 = 0xffffffff
+    movl r8 = cpu_by_id_eid_list
+    and r8 = r8, r12
+    shr r9 = r9, 16
+    add r8 = r8, r9
+    st1 [r8] = r10
-#wait for wakeup sychro signal (#3 in cpu_by_id_eid_list)
+    # Wait for wakeup synchro signal (#3 in cpu_by_id_eid_list)
 kernel_image_ap_start_loop:
-    movl r11=kernel_image_ap_start_loop
-    and r11=r11,r12
+    movl r11 = kernel_image_ap_start_loop
+    and r11 = r11, r12
     mov b1 = r11
-    ld1 r20=[r8];;
-    movl r21=3;;
-    cmp.eq p2,p3=r20,r21;;
-(p3)br.call.sptk.many b0 = b1
+    ld1 r20 = [r8] ;;
+    movl r21 = 3 ;;
+    cmp.eq p2, p3 = r20, r21 ;;
+(p3)    br.call.sptk.many b0 = b1
-    movl r11=kernel_image_start
-    and r11=r11,r12
-    mov b1 = r11
+    movl r11 = kernel_image_start
+    and r11 = r11, r12
+    mov b1 = r11
     br.call.sptk.many b0 = b1
 .align 16
 .global bsp_started
 bsp_started:
 .space 8
 .align 4096
 .global cpu_by_id_eid_list
 cpu_by_id_eid_list:
 .space 65536
+#endif  /* CONFIG_SMP */

 /branches/tracing/kernel/arch/ia64/src/drivers/ski.c
 ,0 → 1,246
+/*
+ * Copyright (c) 2005 Jakub Jermar
+ * All rights reserved.
+ *
+ * Redistribution and use in source and binary forms, with or without
+ * modification, are permitted provided that the following conditions
+ * are met:
+ *
+ * - Redistributions of source code must retain the above copyright
+ *   notice, this list of conditions and the following disclaimer.
+ * - Redistributions in binary form must reproduce the above copyright
+ *   notice, this list of conditions and the following disclaimer in the
+ *   documentation and/or other materials provided with the distribution.
+ * - The name of the author may not be used to endorse or promote products
+ *   derived from this software without specific prior written permission.
+ *
+ * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
+ * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
+ * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
+ * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
+ * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
+ * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
+ * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
+ * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
+ * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
+ * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+ */
+/** @addtogroup ia64
+ * @{
+ */
+/** @file
+ */
+#include <arch/drivers/ski.h>
+#include <console/console.h>
+#include <console/chardev.h>
+#include <sysinfo/sysinfo.h>
+#include <arch/types.h>
+#include <proc/thread.h>
+#include <synch/spinlock.h>
+#include <arch/asm.h>
+#include <arch/drivers/kbd.h>
+#include <string.h>
+#include <arch.h>
+enum {
+    /** Interval between polling in microseconds */
+    POLL_INTERVAL =  10000,  /* 0.01 s */
+    /** Max. number of characters to pull out at a time */
+    POLL_LIMIT    =     30,
+    SKI_INIT_CONSOLE  = 20,
+    SKI_GETCHAR       = 21,
+    SKI_PUTCHAR       = 31
+};
+static void ski_putchar(outdev_t *, const wchar_t, bool);
+static outdev_operations_t skiout_ops = {
+    .write = ski_putchar
+};
+static outdev_t skiout;            /**< Ski output device. */
+static bool initialized = false;
+static bool kbd_disabled = false;
+/** Initialize debug console
+ *
+ * Issue SSC (Simulator System Call) to
+ * to open debug console.
+ *
+ */
+static void ski_init(void)
+{
+    if (initialized)
+        return;
+    asm volatile (
+        "mov r15 = %0\n"
+        "break 0x80000\n"
+        :
+        : "i" (SKI_INIT_CONSOLE)
+        : "r15", "r8"
+    );
+    initialized = true;
+}
+static void ski_do_putchar(const wchar_t ch)
+{
+    asm volatile (
+        "mov r15 = %[cmd]\n"
+        "mov r32 = %[ch]\n"   /* r32 is in0 */
+        "break 0x80000\n"     /* modifies r8 */
+        :
+        : [cmd] "i" (SKI_PUTCHAR), [ch] "r" (ch)
+        : "r15", "in0", "r8"
+    );
+}
+/** Display character on debug console
+ *
+ * Use SSC (Simulator System Call) to
+ * display character on debug console.
+ *
+ * @param dev    Character device.
+ * @param ch     Character to be printed.
+ * @param silent Whether the output should be silenced.
+ *
+ */
+static void ski_putchar(outdev_t *dev, const wchar_t ch, bool silent)
+{
+    if (!silent) {
+        if (ascii_check(ch)) {
+            if (ch == '\n')
+                ski_do_putchar('\r');
+            ski_do_putchar(ch);
+        } else
+            ski_do_putchar(U_SPECIAL);
+    }
+}
+void skiout_init(void)
+{
+    ski_init();
+    outdev_initialize("skiout", &skiout, &skiout_ops);
+    stdout = &skiout;
+    sysinfo_set_item_val("fb", NULL, false);
+}
+/** Ask debug console if a key was pressed.
+ *
+ * Use SSC (Simulator System Call) to
+ * get character from debug console.
+ *
+ * This call is non-blocking.
+ *
+ * @return ASCII code of pressed key or 0 if no key pressed.
+ *
+ */
+static wchar_t ski_getchar(void)
+{
+    uint64_t ch;
+    asm volatile (
+        "mov r15 = %1\n"
+        "break 0x80000;;\n"  /* modifies r8 */
+        "mov %0 = r8;;\n"
+        : "=r" (ch)
+        : "i" (SKI_GETCHAR)
+        : "r15", "r8"
+    );
+    return (wchar_t) ch;
+}
+/** Ask keyboard if a key was pressed.
+ *
+ * If so, it will repeat and pull up to POLL_LIMIT characters.
+ */
+static void poll_keyboard(ski_instance_t *instance)
+{
+    wchar_t ch;
+    int count;
+    if (kbd_disabled)
+        return;
+    count = POLL_LIMIT;
+    while (count > 0) {
+        ch = ski_getchar();
+        if (ch == '\0')
+            break;
+        indev_push_character(instance->srlnin, ch);
+        --count;
+    }
+}
+/** Kernel thread for polling keyboard. */
+static void kskipoll(void *arg)
+{
+    ski_instance_t *instance = (ski_instance_t *) arg;
+    while (true) {
+        if (!silent)
+            poll_keyboard(instance);
+        thread_usleep(POLL_INTERVAL);
+    }
+}
+ski_instance_t *skiin_init(void)
+{
+    ski_init();
+    ski_instance_t *instance =
+        malloc(sizeof(ski_instance_t), FRAME_ATOMIC);
+    if (instance) {
+        instance->thread = thread_create(kskipoll, instance, TASK, 0,
+            "kskipoll", true);
+        if (!instance->thread) {
+            free(instance);
+            return NULL;
+        }
+        instance->srlnin = NULL;
+    }
+    return instance;
+}
+void skiin_wire(ski_instance_t *instance, indev_t *srlnin)
+{
+    ASSERT(instance);
+    ASSERT(srlnin);
+    instance->srlnin = srlnin;
+    thread_ready(instance->thread);
+    sysinfo_set_item_val("kbd", NULL, true);
+    sysinfo_set_item_val("kbd.type", NULL, KBD_SKI);
+}
+void ski_kbd_grab(void)
+{
+    kbd_disabled = false;
+}
+void ski_kbd_release(void)
+{
+    kbd_disabled = true;
+}
+/** @}
+ */

 /branches/tracing/kernel/arch/ia64/src/drivers/it.c
 ,7 → 26,7
  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
  */
-/** @addtogroup ia64
+/** @addtogroup ia64
  * @{
  */
 /** @file
 ,22 → 44,20
 #include <ddi/device.h>
 #include <arch.h>
-#define IT_SERVICE_CLOCKS 64
+#define IT_SERVICE_CLOCKS   64
-#define FREQ_NUMERATOR_SHIFT 32
-#define FREQ_NUMERATOR_MASK 0xffffffff00000000LL
+#define FREQ_NUMERATOR_SHIFT    32
+#define FREQ_NUMERATOR_MASK 0xffffffff00000000ULL
-#define FREQ_DENOMINATOR_SHIFT 0
-#define FREQ_DENOMINATOR_MASK 0xffffffffLL
+#define FREQ_DENOMINATOR_SHIFT  0
+#define FREQ_DENOMINATOR_MASK   0xffffffffULL
 uint64_t it_delta;
 static irq_t it_irq;
-static irq_ownership_t it_claim(void);
-static void it_interrupt(irq_t *irq, void *arg, ...);
+static irq_ownership_t it_claim(irq_t *);
+static void it_interrupt(irq_t *);
 /** Initialize Interval Timer. */
 void it_init(void)
 ,8 → 64,7
 {
     cr_itv_t itv;
-    if(config.cpu_active==1)
-    {
+    if (config.cpu_active == 1) {
         irq_initialize(&it_irq);
         it_irq.inr = INTERRUPT_TIMER;
         it_irq.devno = device_assign_devno();
 ,12 → 73,13
         irq_register(&it_irq);
         uint64_t base_freq;
-        base_freq  = ((bootinfo->freq_scale) & FREQ_NUMERATOR_MASK) >> FREQ_NUMERATOR_SHIFT;
+        base_freq  = ((bootinfo->freq_scale) & FREQ_NUMERATOR_MASK) >>
+            FREQ_NUMERATOR_SHIFT;
         base_freq *= bootinfo->sys_freq;
-        base_freq /= ((bootinfo->freq_scale) & FREQ_DENOMINATOR_MASK) >> FREQ_DENOMINATOR_SHIFT;
+        base_freq /= ((bootinfo->freq_scale) & FREQ_DENOMINATOR_MASK) >>
+            FREQ_DENOMINATOR_SHIFT;
-        it_delta = base_freq /HZ;
+        it_delta = base_freq / HZ;
     }
     /* initialize Interval Timer external interrupt vector */
 ,13 → 104,13
  *
  * @return Always IRQ_ACCEPT.
  */
-irq_ownership_t it_claim(void)
+irq_ownership_t it_claim(irq_t *irq)
 {
     return IRQ_ACCEPT;
 }
 /** Process Interval Timer interrupt. */
-void it_interrupt(irq_t *irq, void *arg, ...)
+void it_interrupt(irq_t *irq)
 {
     int64_t c;
     int64_t m;

 /branches/tracing/kernel/arch/arm32/_link.ld.in
 ,15 → 1,16
 /*
- *  ARM linker script
- *
+ * ARM linker script
+ *
  *  kernel text
  *  kernel data
- *
+ *
  */
+#define KERNEL_LOAD_ADDRESS 0x80200000
 OUTPUT_ARCH(arm)
-ENTRY(kernel_image_start)
+ENTRY(kernel_image_start)
 SECTIONS {
     . = KERNEL_LOAD_ADDRESS;
     .text : {
 ,29 → 20,29
     }
     .data : {
         kdata_start = .;
-        *(.data);       /* initialized data */
+        *(.data);                       /* initialized data */
         hardcoded_ktext_size = .;
-        LONG(ktext_end - ktext_start);
+        LONG(ktext_end - ktext_start);
         hardcoded_kdata_size = .;
         LONG(kdata_end - kdata_start);
         hardcoded_load_address = .;
         LONG(KERNEL_LOAD_ADDRESS);
-        *(.bss);        /* uninitialized static variables */
-        *(COMMON);      /* global variables */
+        *(.bss);                        /* uninitialized static variables */
+        *(COMMON);                      /* global variables */
         *(.rodata*);
         *(.sdata);
         *(.reginfo);
         symbol_table = .;
-        *(symtab.*);
+        *(symtab.*);
     }
     .sbss : {
         *(.sbss);
         *(.scommon);
     }
     kdata_end = .;
     /DISCARD/ : {
       *(.mdebug*);
       *(.pdr);
 ,5 → 49,4
       *(.comment);
       *(.note);
     }
 }

 /branches/tracing/kernel/arch/arm32/include/asm/boot.h
 ,7 → 26,7
  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
  */
-/** @addtogroup arm32
+/** @addtogroup arm32
  * @{
  */
 /** @file
 ,26 → 37,9
 #define KERN_arm32_ASM_BOOT_H_
 /** Size of a temporary stack used for initial kernel start. */
-#define TEMP_STACK_SIZE 0x100
+#define TEMP_STACK_SIZE  0x100
-#ifndef __ASM__
-/** Kernel entry point.
- *
- * Implemented in assembly. Copies boot_bootinfo (declared as bootinfo in
- * boot/arch/arm32/loader/main.c) to #bootinfo struct. Then jumps to
- * #arch_pre_main and #main_bsp.
- *
- * @param entry          Entry point address (not used).
- * @param boot_bootinfo  Struct holding information about loaded tasks.
- * @param bootinfo_size  Size of the bootinfo structure.
- */
-extern void kernel_image_start(void *entry, void *boot_bootinfo,
-    unsigned int bootinfo_size);
 #endif
-#endif
 /** @}
  */

 /branches/tracing/kernel/arch/arm32/include/regutils.h
 ,7 → 26,7
  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
  */
-/** @addtogroup arm32
+/** @addtogroup arm32
  * @{
  */
 /**
 ,7 → 57,10
 static inline uint32_t nm## _status_reg_read(void) \
 { \
     uint32_t retval; \
-    asm volatile("mrs %0, " #reg : "=r" (retval)); \
+    asm volatile( \
+        "mrs %[retval], " #reg \
+        : [retval] "=r" (retval) \
+    ); \
     return retval; \
 }
 ,7 → 67,10
 #define GEN_STATUS_WRITE(nm,reg,fieldname, field) \
 static inline void nm## _status_reg_ ##fieldname## _write(uint32_t value) \
 { \
-    asm volatile("msr " #reg "_" #field ", %0" : : "r" (value)); \
+    asm volatile( \
+        "msr " #reg "_" #field ", %[value]" \
+        :: [value] "r" (value) \
+    ); \
 }

 /branches/tracing/kernel/arch/arm32/include/types.h
 ,6 → 64,9
 typedef uint32_t unative_t;
 typedef int32_t native_t;
+typedef struct {
+} fncptr_t;
 #define PRIp "x"    /**< Format for uintptr_t. */
 #define PRIs "u"    /**< Format for size_t. */
 #define PRIc "u"    /**< Format for count_t. */

 /branches/tracing/kernel/arch/arm32/include/atomic.h
 ,10 → 26,10
  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
  */
-/** @addtogroup arm32
+/** @addtogroup arm32
  * @{
  */
-/** @file
+/** @file
  *  @brief Atomic operations.
  */
 ,26 → 42,26
  * @param i   Value to be added.
  *
  * @return Value after addition.
+ *
  */
 static inline long atomic_add(atomic_t *val, int i)
 {
     int ret;
     volatile long *mem = &(val->count);
     asm volatile (
-    "1:\n"
-        "ldr r2, [%1]       \n"
-        "add r3, r2, %2     \n"
-        "str r3, %0         \n"
-        "swp r3, r3, [%1]   \n"
-        "cmp r3, r2         \n"
-        "bne 1b             \n"
-        : "=m" (ret)
-        : "r" (mem), "r" (i)
+        "1:\n"
+            "ldr r2, [%[mem]]\n"
+            "add r3, r2, %[i]\n"
+            "str r3, %[ret]\n"
+            "swp r3, r3, [%[mem]]\n"
+            "cmp r3, r2\n"
+            "bne 1b\n"
+        : [ret] "=m" (ret)
+        : [mem] "r" (mem), [i] "r" (i)
         : "r3", "r2"
     );
     return ret;
 }

 /branches/tracing/kernel/arch/arm32/include/arch.h
 ,7 → 26,7
  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
  */
-/** @addtogroup arm32
+/** @addtogroup arm32
  * @{
  */
 /** @file
 ,6 → 36,26
 #ifndef KERN_arm32_ARCH_H_
 #define KERN_arm32_ARCH_H_
+#define TASKMAP_MAX_RECORDS  32
+#define CPUMAP_MAX_RECORDS   32
+#define BOOTINFO_TASK_NAME_BUFLEN 32
+#include <typedefs.h>
+typedef struct {
+    uintptr_t addr;
+    uint32_t size;
+    char name[BOOTINFO_TASK_NAME_BUFLEN];
+} utask_t;
+typedef struct {
+    uint32_t cnt;
+    utask_t tasks[TASKMAP_MAX_RECORDS];
+} bootinfo_t;
+extern void arch_pre_main(void *entry, bootinfo_t *bootinfo);
 #endif
 /** @}

 /branches/tracing/kernel/arch/arm32/include/asm.h
 ,10 → 26,10
  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
  */
-/** @addtogroup arm32
+/** @addtogroup arm32
  * @{
  */
-/** @file
+/** @file
  *  @brief Declarations of functions implemented in assembly.
  */
 ,6 → 36,7
 #ifndef KERN_arm32_ASM_H_
 #define KERN_arm32_ASM_H_
+#include <typedefs.h>
 #include <arch/types.h>
 #include <arch/stack.h>
 #include <config.h>
 ,19 → 47,50
 {
 }
+static inline void pio_write_8(ioport8_t *port, uint8_t v)
+{
+    *port = v;
+}
+static inline void pio_write_16(ioport16_t *port, uint16_t v)
+{
+    *port = v;
+}
+static inline void pio_write_32(ioport32_t *port, uint32_t v)
+{
+    *port = v;
+}
+static inline uint8_t pio_read_8(ioport8_t *port)
+{
+    return *port;
+}
+static inline uint16_t pio_read_16(ioport16_t *port)
+{
+    return *port;
+}
+static inline uint32_t pio_read_32(ioport32_t *port)
+{
+    return *port;
+}
 /** Return base address of current stack.
- *
+ *
  * Return the base address of the current stack.
  * The stack is assumed to be STACK_SIZE bytes long.
  * The stack must start on page boundary.
+ *
  */
 static inline uintptr_t get_stack_base(void)
 {
     uintptr_t v;
     asm volatile (
-        "and %0, sp, %1\n"
-        : "=r" (v)
-        : "r" (~(STACK_SIZE - 1))
+        "and %[v], sp, %[size]\n"
+        : [v] "=r" (v)
+        : [size] "r" (~(STACK_SIZE - 1))
     );
     return v;
 }

 /branches/tracing/kernel/arch/arm32/include/mm/frame.h
 ,7 → 26,7
  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
  */
-/** @addtogroup arm32mm
+/** @addtogroup arm32mm
  * @{
  */
 /** @file
 ,8 → 36,8
 #ifndef KERN_arm32_FRAME_H_
 #define KERN_arm32_FRAME_H_
-#define FRAME_WIDTH     12 /* 4KB frames */
-#define FRAME_SIZE      (1 << FRAME_WIDTH)
+#define FRAME_WIDTH  12  /* 4KB frames */
+#define FRAME_SIZE   (1 << FRAME_WIDTH)
 #ifdef KERNEL
 #ifndef __ASM__
 ,8 → 44,8
 #include <arch/types.h>
-#define BOOT_PAGE_TABLE_SIZE    0x4000
-#define BOOT_PAGE_TABLE_ADDRESS 0x4000
+#define BOOT_PAGE_TABLE_SIZE     0x4000
+#define BOOT_PAGE_TABLE_ADDRESS  0x4000
 #define BOOT_PAGE_TABLE_START_FRAME     (BOOT_PAGE_TABLE_ADDRESS >> FRAME_WIDTH)
 #define BOOT_PAGE_TABLE_SIZE_IN_FRAMES  (BOOT_PAGE_TABLE_SIZE >> FRAME_WIDTH)

 /branches/tracing/kernel/arch/arm32/include/mm/page.h
 ,9 → 193,8
 static inline void set_ptl0_addr(pte_level0_t *pt)
 {
     asm volatile (
-        "mcr p15, 0, %0, c2, c0, 0 \n"
-        :
-        : "r"(pt)
+        "mcr p15, 0, %[pt], c2, c0, 0\n"
+        :: [pt] "r" (pt)
     );
 }

 /branches/tracing/kernel/arch/arm32/include/mm/tlb.h
 ,9 → 36,6
 #ifndef KERN_arm32_TLB_H_
 #define KERN_arm32_TLB_H_
-#define tlb_arch_init()
-#define tlb_print()
 #endif
 /** @}

 /branches/tracing/kernel/arch/arm32/include/barrier.h
 ,7 → 26,7
  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
  */
-/** @addtogroup arm32
+/** @addtogroup arm32
  * @{
  */
 /** @file
 ,12 → 39,12
 /*
  * TODO: implement true ARM memory barriers for macros below.
  */
-#define CS_ENTER_BARRIER()  asm volatile ("" ::: "memory")
-#define CS_LEAVE_BARRIER()  asm volatile ("" ::: "memory")
+#define CS_ENTER_BARRIER()  asm volatile ("" ::: "memory")
+#define CS_LEAVE_BARRIER()  asm volatile ("" ::: "memory")
-#define memory_barrier()        asm volatile ("" ::: "memory")
-#define read_barrier()          asm volatile ("" ::: "memory")
-#define write_barrier()         asm volatile ("" ::: "memory")
+#define memory_barrier()  asm volatile ("" ::: "memory")
+#define read_barrier()    asm volatile ("" ::: "memory")
+#define write_barrier()   asm volatile ("" ::: "memory")
 #define smc_coherence(a)
 #define smc_coherence_block(a, l)

 /branches/tracing/kernel/arch/arm32/include/drivers/gxemul.h
 ,41 → 38,33
 #ifndef KERN_arm32_GXEMUL_H_
 #define KERN_arm32_GXEMUL_H_
-#include <console/chardev.h>
-/** Last interrupt number (beginning from 0) whose status is probed
+/** Last interrupt number (beginning from 0) whose status is probed
  * from interrupt controller
  */
-#define GXEMUL_IRQC_MAX_IRQ     8
+#define GXEMUL_IRQC_MAX_IRQ  8
+#define GXEMUL_KBD_IRQ       2
+#define GXEMUL_TIMER_IRQ     4
 /** Timer frequency */
-#define GXEMUL_TIMER_FREQ       100
+#define GXEMUL_TIMER_FREQ  100
-/** Struct containing mappings of gxemul HW devices into kernel part
- *  of virtual address space.
- */
-typedef struct {
-    uintptr_t videoram;
-    uintptr_t kbd;
-    uintptr_t rtc;
-    uintptr_t rtc_freq;
-    uintptr_t rtc_ack;
-    uintptr_t irqc;
-    uintptr_t irqc_mask;
-    uintptr_t irqc_unmask;
-} gxemul_hw_map_t;
+#define GXEMUL_KBD_ADDRESS   0x10000000
+#define GXEMUL_MP_ADDRESS    0x11000000
+#define GXEMUL_FB_ADDRESS    0x12000000
+#define GXEMUL_RTC_ADDRESS   0x15000000
+#define GXEMUL_IRQC_ADDRESS  0x16000000
-extern void gxemul_hw_map_init(void);
-extern void gxemul_console_init(devno_t devno);
-extern void gxemul_release_console(void);
-extern void gxemul_grab_console(void);
-extern void gxemul_timer_irq_start(void);
-extern void gxemul_debug_putc(char ch);
-extern void gxemul_cpu_halt(void);
-extern void gxemul_irq_exception(int exc_no, istate_t *istate);
-extern size_t gxemul_get_memory_size(void);
-extern uintptr_t gxemul_get_fb_address(void);
+extern void *gxemul_kbd;
+extern void *gxemul_rtc;
+extern void *gxemul_irqc;
+#define GXEMUL_HALT_OFFSET        0x010
+#define GXEMUL_RTC_FREQ_OFFSET    0x100
+#define GXEMUL_MP_MEMSIZE_OFFSET  0x090
+#define GXEMUL_RTC_ACK_OFFSET     0x110
+extern void gxemul_init(void);
 #endif
 /** @}

 /branches/tracing/kernel/arch/arm32/Makefile.inc
 ,10 → 29,6
 ## Toolchain configuration
 #
-ifndef CROSS_PREFIX
-    CROSS_PREFIX = /usr/local
-endif
 BFD_NAME = elf32-littlearm
 BFD_ARCH = arm
 BFD = binary
 ,62 → 35,27
 TARGET = arm-linux-gnu
 TOOLCHAIN_DIR = $(CROSS_PREFIX)/arm
-KERNEL_LOAD_ADDRESS = 0x80200000
-# ifeq ($(MACHINE), gxemul_testarm)
-    DMACHINE = MACHINE_GXEMUL_TESTARM
-# endif
 ATSIGN = %
 GCC_CFLAGS += -fno-zero-initialized-in-bss
-DEFS += -D__32_BITS__ -DKERNEL_LOAD_ADDRESS=$(KERNEL_LOAD_ADDRESS) -D$(DMACHINE)
+DEFS += -D__32_BITS__
-# Compile with framebuffer support
-ifeq ($(CONFIG_FB), y)
-    DEFS += -DCONFIG_FB -DFB_INVERT_ENDIAN
-endif
-## Compile with hierarchical page tables support.
-#
-CONFIG_PAGE_PT = y
-DEFS += -DCONFIG_PAGE_PT
-## Compile with support for address space identifiers.
-#
-# no HW support for ASIDs
-#CONFIG_ASID = y
-#CONFIG_ASID_FIFO = y
-## Compile with support with software division and multiplication.
-#
-CONFIG_SOFTINT = y
 ARCH_SOURCES = \
-    arch/$(ARCH)/src/start.S \
-    arch/$(ARCH)/src/asm.S \
-    arch/$(ARCH)/src/arm32.c \
-    arch/$(ARCH)/src/context.S \
-    arch/$(ARCH)/src/dummy.S \
-    arch/$(ARCH)/src/panic.S \
-    arch/$(ARCH)/src/cpu/cpu.c \
-    arch/$(ARCH)/src/ddi/ddi.c \
-    arch/$(ARCH)/src/interrupt.c \
-    arch/$(ARCH)/src/debug/print.c \
-    arch/$(ARCH)/src/console.c \
-    arch/$(ARCH)/src/exception.c \
-    arch/$(ARCH)/src/userspace.c \
-    arch/$(ARCH)/src/mm/as.c \
-    arch/$(ARCH)/src/mm/frame.c \
-    arch/$(ARCH)/src/mm/page.c \
-    arch/$(ARCH)/src/mm/tlb.c \
-    arch/$(ARCH)/src/mm/page_fault.c
-# ifeq ($(MACHINE), gxemul_testarm)
-    ARCH_SOURCES += arch/$(ARCH)/src/drivers/gxemul.c
-# endif
+    arch/$(KARCH)/src/start.S \
+    arch/$(KARCH)/src/asm.S \
+    arch/$(KARCH)/src/arm32.c \
+    arch/$(KARCH)/src/context.S \
+    arch/$(KARCH)/src/dummy.S \
+    arch/$(KARCH)/src/panic.S \
+    arch/$(KARCH)/src/cpu/cpu.c \
+    arch/$(KARCH)/src/ddi/ddi.c \
+    arch/$(KARCH)/src/interrupt.c \
+    arch/$(KARCH)/src/exception.c \
+    arch/$(KARCH)/src/userspace.c \
+    arch/$(KARCH)/src/mm/as.c \
+    arch/$(KARCH)/src/mm/frame.c \
+    arch/$(KARCH)/src/mm/page.c \
+    arch/$(KARCH)/src/mm/tlb.c \
+    arch/$(KARCH)/src/mm/page_fault.c \
+    arch/$(KARCH)/src/drivers/gxemul.c

 /branches/tracing/kernel/arch/arm32/src/exception.c
 ,13 → 34,12
  */
 #include <arch/exception.h>
-#include <arch/debug/print.h>
 #include <arch/memstr.h>
 #include <arch/regutils.h>
 #include <interrupt.h>
-#include <arch/machine.h>
 #include <arch/mm/page_fault.h>
 #include <arch/barrier.h>
+#include <arch/drivers/gxemul.h>
 #include <print.h>
 #include <syscall/syscall.h>
 #include <udebug/udebug.h>
 ,57 → 63,60
  *
  * Temporary exception stack is used to save a few registers
  * before stack switch takes place.
+ *
  */
 inline static void setup_stack_and_save_regs()
 {
-    asm volatile(
-        "ldr r13, =exc_stack        \n"
-        "stmfd r13!, {r0}       \n"
-        "mrs r0, spsr           \n"
-        "and r0, r0, #0x1f      \n"
-        "cmp r0, #0x10          \n"
-        "bne 1f             \n"
+    asm volatile (
+        "ldr r13, =exc_stack\n"
+        "stmfd r13!, {r0}\n"
+        "mrs r0, spsr\n"
+        "and r0, r0, #0x1f\n"
+        "cmp r0, #0x10\n"
+        "bne 1f\n"
         /* prev mode was usermode */
-        "ldmfd r13!, {r0}       \n"
-        "ldr r13, =supervisor_sp    \n"
-        "ldr r13, [r13]         \n"
-        "stmfd r13!, {lr}       \n"
-        "stmfd r13!, {r0-r12}       \n"
-        "stmfd r13!, {r13, lr}^     \n"
-        "mrs r0, spsr           \n"
-        "stmfd r13!, {r0}       \n"
-        "b 2f               \n"
+        "ldmfd r13!, {r0}\n"
+        "ldr r13, =supervisor_sp\n"
+        "ldr r13, [r13]\n"
+        "stmfd r13!, {lr}\n"
+        "stmfd r13!, {r0-r12}\n"
+        "stmfd r13!, {r13, lr}^\n"
+        "mrs r0, spsr\n"
+        "stmfd r13!, {r0}\n"
+        "b 2f\n"
         /* mode was not usermode */
-    "1:\n"
-        "stmfd r13!, {r1, r2, r3}   \n"
-        "mrs r1, cpsr           \n"
-        "mov r2, lr         \n"
-        "bic r1, r1, #0x1f      \n"
-        "orr r1, r1, r0         \n"
-        "mrs r0, cpsr           \n"
-        "msr cpsr_c, r1         \n"
-        "mov r3, r13            \n"
-        "stmfd r13!, {r2}       \n"
-        "mov r2, lr         \n"
-        "stmfd r13!, {r4-r12}       \n"
-        "mov r1, r13            \n"
-        /* the following two lines are for debugging */
-        "mov sp, #0         \n"
-        "mov lr, #0         \n"
-        "msr cpsr_c, r0         \n"
-        "ldmfd r13!, {r4, r5, r6, r7}   \n"
-        "stmfd r1!, {r4, r5, r6}    \n"
-        "stmfd r1!, {r7}        \n"
-        "stmfd r1!, {r2}        \n"
-        "stmfd r1!, {r3}        \n"
-        "mrs r0, spsr           \n"
-        "stmfd r1!, {r0}        \n"
-        "mov r13, r1            \n"
-    "2:\n"
+        "1:\n"
+            "stmfd r13!, {r1, r2, r3}\n"
+            "mrs r1, cpsr\n"
+            "mov r2, lr\n"
+            "bic r1, r1, #0x1f\n"
+            "orr r1, r1, r0\n"
+            "mrs r0, cpsr\n"
+            "msr cpsr_c, r1\n"
+            "mov r3, r13\n"
+            "stmfd r13!, {r2}\n"
+            "mov r2, lr\n"
+            "stmfd r13!, {r4-r12}\n"
+            "mov r1, r13\n"
+            /* the following two lines are for debugging */
+            "mov sp, #0\n"
+            "mov lr, #0\n"
+            "msr cpsr_c, r0\n"
+            "ldmfd r13!, {r4, r5, r6, r7}\n"
+            "stmfd r1!, {r4, r5, r6}\n"
+            "stmfd r1!, {r7}\n"
+            "stmfd r1!, {r2}\n"
+            "stmfd r1!, {r3}\n"
+            "mrs r0, spsr\n"
+            "stmfd r1!, {r0}\n"
+            "mov r13, r1\n"
+        "2:\n"
     );
 }
 ,10 → 192,13
 }
 /** Calls exception dispatch routine. */
-#define CALL_EXC_DISPATCH(exception)        \
-    asm("mov r0, %0" : : "i" (exception));  \
-    asm("mov r1, r13");         \
-    asm("bl exc_dispatch");
+#define CALL_EXC_DISPATCH(exception) \
+    asm volatile ( \
+        "mov r0, %[exc]\n" \
+        "mov r1, r13\n" \
+        "bl exc_dispatch\n" \
+        :: [exc] "i" (exception) \
+    );\
 /** General exception handler.
  *
 ,9 → 207,9
  *
  *  @param exception Exception number.
  */
-#define PROCESS_EXCEPTION(exception)        \
-    setup_stack_and_save_regs();        \
-    CALL_EXC_DISPATCH(exception)        \
+#define PROCESS_EXCEPTION(exception) \
+    setup_stack_and_save_regs(); \
+    CALL_EXC_DISPATCH(exception) \
     load_regs();
 /** Updates specified exception vector to jump to given handler.
 ,7 → 260,10
 /** Low-level Prefetch Abort Exception handler. */
 static void prefetch_abort_exception_entry(void)
 {
-    asm("sub lr, lr, #4");
+    asm volatile (
+        "sub lr, lr, #4"
+    );
     PROCESS_EXCEPTION(EXC_PREFETCH_ABORT);
 }
 ,7 → 270,10
 /** Low-level Data Abort Exception handler. */
 static void data_abort_exception_entry(void)
 {
-    asm("sub lr, lr, #8");
+    asm volatile (
+        "sub lr, lr, #8"
+    );
     PROCESS_EXCEPTION(EXC_DATA_ABORT);
 }
 ,7 → 285,10
  */
 static void irq_exception_entry(void)
 {
-    asm("sub lr, lr, #4");
+    asm volatile (
+        "sub lr, lr, #4"
+    );
     setup_stack_and_save_regs();
     switch_to_irq_servicing_mode();
 ,6 → 308,12
         istate->r3, istate->r4, istate->r5, istate->r6);
 }
+/** Returns the mask of active interrupts. */
+static inline uint32_t gxemul_irqc_get_sources(void)
+{
+    return *((uint32_t *) gxemul_irqc);
+}
 /** Interrupt Exception handler.
  *
  * Determines the sources of interrupt and calls their handlers.
 ,7 → 320,23
  */
 static void irq_exception(int exc_no, istate_t *istate)
 {
-    machine_irq_exception(exc_no, istate);
+    uint32_t sources = gxemul_irqc_get_sources();
+    unsigned int i;
+    for (i = 0; i < GXEMUL_IRQC_MAX_IRQ; i++) {
+        if (sources & (1 << i)) {
+            irq_t *irq = irq_dispatch_and_lock(i);
+            if (irq) {
+                /* The IRQ handler was found. */
+                irq->handler(irq);
+                spinlock_unlock(&irq->lock);
+            } else {
+                /* Spurious interrupt.*/
+                printf("cpu%d: spurious interrupt (inum=%d)\n",
+                    CPU->id, i);
+            }
+        }
+    }
 }
 /** Fills exception vectors with appropriate exception handlers. */
 ,7 → 360,7
     install_handler((unsigned) irq_exception_entry,
         (unsigned *) EXC_IRQ_VEC);
-    install_handler((unsigned)fiq_exception_entry,
+    install_handler((unsigned) fiq_exception_entry,
         (unsigned *) EXC_FIQ_VEC);
 }
 ,17 → 370,23
 {
     uint32_t control_reg;
-    asm volatile("mrc p15, 0, %0, c1, c1" : "=r" (control_reg));
+    asm volatile (
+        "mrc p15, 0, %[control_reg], c1, c1"
+        : [control_reg] "=r" (control_reg)
+    );
     /* switch on the high vectors bit */
     control_reg |= CP15_R1_HIGH_VECTORS_BIT;
-    asm volatile("mcr p15, 0, %0, c1, c1" : : "r" (control_reg));
+    asm volatile (
+        "mcr p15, 0, %[control_reg], c1, c1"
+        :: [control_reg] "r" (control_reg)
+    );
 }
 #endif
 /** Initializes exception handling.
- *
+ *
  * Installs low-level exception handlers and then registers
  * exceptions and their handlers to kernel exception dispatcher.
  */
 ,18 → 410,18
  */
 void print_istate(istate_t *istate)
 {
-    dprintf("istate dump:\n");
-    dprintf(" r0: %x    r1: %x    r2: %x    r3: %x\n",
+    printf("istate dump:\n");
+    printf(" r0: %x    r1: %x    r2: %x    r3: %x\n",
         istate->r0, istate->r1, istate->r2, istate->r3);
-    dprintf(" r4: %x    r5: %x    r6: %x    r7: %x\n",
+    printf(" r4: %x    r5: %x    r6: %x    r7: %x\n",
         istate->r4, istate->r5, istate->r6, istate->r7);
-    dprintf(" r8: %x    r8: %x   r10: %x   r11: %x\n",
+    printf(" r8: %x    r8: %x   r10: %x   r11: %x\n",
         istate->r8, istate->r9, istate->r10, istate->r11);
-    dprintf(" r12: %x    sp: %x    lr: %x  spsr: %x\n",
+    printf(" r12: %x    sp: %x    lr: %x  spsr: %x\n",
         istate->r12, istate->sp, istate->lr, istate->spsr);
-    dprintf(" pc: %x\n", istate->pc);
+    printf(" pc: %x\n", istate->pc);
 }
 /** @}

 /branches/tracing/kernel/arch/arm32/src/asm.S
 ,6 → 30,7
 .text
 .global memsetb
+.global memsetw
 .global memcpy
 .global memcpy_from_uspace
 .global memcpy_to_uspace
 ,6 → 40,9
 memsetb:
     b _memsetb
+memsetw:
+    b _memsetw
 memcpy:
 memcpy_from_uspace:
 memcpy_to_uspace:

 /branches/tracing/kernel/arch/arm32/src/arm32.c
 ,36 → 34,37
  */
 #include <arch.h>
-#include <arch/boot.h>
 #include <config.h>
-#include <arch/console.h>
-#include <ddi/device.h>
 #include <genarch/fb/fb.h>
 #include <genarch/fb/visuals.h>
+#include <genarch/drivers/dsrln/dsrlnin.h>
+#include <genarch/drivers/dsrln/dsrlnout.h>
+#include <genarch/srln/srln.h>
+#include <sysinfo/sysinfo.h>
+#include <console/console.h>
 #include <ddi/irq.h>
-#include <arch/debug/print.h>
+#include <arch/drivers/gxemul.h>
 #include <print.h>
 #include <config.h>
 #include <interrupt.h>
 #include <arch/regutils.h>
-#include <arch/machine.h>
 #include <userspace.h>
+#include <macros.h>
+#include <string.h>
-/** Information about loaded tasks. */
-bootinfo_t bootinfo;
-/** Performs arm32 specific initialization before main_bsp() is called. */
-void arch_pre_main(void)
+/** Performs arm32-specific initialization before main_bsp() is called. */
+void arch_pre_main(void *entry __attribute__((unused)), bootinfo_t *bootinfo)
 {
     unsigned int i;
-    init.cnt = bootinfo.cnt;
-    for (i = 0; i < bootinfo.cnt; ++i) {
-        init.tasks[i].addr = bootinfo.tasks[i].addr;
-        init.tasks[i].size = bootinfo.tasks[i].size;
+    init.cnt = bootinfo->cnt;
+    for (i = 0; i < min3(bootinfo->cnt, TASKMAP_MAX_RECORDS, CONFIG_INIT_TASKS); ++i) {
+        init.tasks[i].addr = bootinfo->tasks[i].addr;
+        init.tasks[i].size = bootinfo->tasks[i].size;
+        str_cpy(init.tasks[i].name, CONFIG_TASK_NAME_BUFLEN,
+            bootinfo->tasks[i].name);
     }
 }
 /** Performs arm32 specific initialization before mm is initialized. */
 ,26 → 77,27
 /** Performs arm32 specific initialization afterr mm is initialized. */
 void arch_post_mm_init(void)
 {
-    machine_hw_map_init();
+    gxemul_init();
     /* Initialize exception dispatch table */
     exception_init();
     interrupt_init();
-    console_init(device_assign_devno());
 #ifdef CONFIG_FB
     fb_properties_t prop = {
-        .addr = machine_get_fb_address(),
+        .addr = GXEMUL_FB_ADDRESS,
         .offset = 0,
         .x = 640,
         .y = 480,
         .scan = 1920,
-        .visual = VISUAL_RGB_8_8_8,
+        .visual = VISUAL_BGR_8_8_8,
     };
     fb_init(&prop);
-#endif
+#else
+#ifdef CONFIG_ARM_PRN
+    dsrlnout_init((ioport8_t *) gxemul_kbd);
+#endif /* CONFIG_ARM_PRN */
+#endif /* CONFIG_FB */
 }
 /** Performs arm32 specific tasks needed after cpu is initialized.
 ,6 → 126,30
  */
 void arch_post_smp_init(void)
 {
+#ifdef CONFIG_ARM_KBD
+    /*
+     * Initialize the GXemul keyboard port. Then initialize the serial line
+     * module and connect it to the GXemul keyboard.
+     */
+    dsrlnin_instance_t *dsrlnin_instance
+        = dsrlnin_init((dsrlnin_t *) gxemul_kbd, GXEMUL_KBD_IRQ);
+    if (dsrlnin_instance) {
+        srln_instance_t *srln_instance = srln_init();
+        if (srln_instance) {
+            indev_t *sink = stdin_wire();
+            indev_t *srln = srln_wire(srln_instance, sink);
+            dsrlnin_wire(dsrlnin_instance, srln);
+        }
+    }
+    /*
+     * This is the necessary evil until the userspace driver is entirely
+     * self-sufficient.
+     */
+    sysinfo_set_item_val("kbd", NULL, true);
+    sysinfo_set_item_val("kbd.inr", NULL, GXEMUL_KBD_IRQ);
+    sysinfo_set_item_val("kbd.address.virtual", NULL, (unative_t) gxemul_kbd);
+#endif
 }
 ,7 → 183,8
 /** Halts CPU. */
 void cpu_halt(void)
 {
-    machine_cpu_halt();
+    *((char *) (gxemul_kbd + GXEMUL_HALT_OFFSET))
+        = 0;
 }
 /** Reboot. */
 ,9 → 191,35
 void arch_reboot()
 {
     /* not implemented */
-    for (;;)
-        ;
+    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)
+{
+    return addr;
+}
+/** Acquire console back for kernel. */
+void arch_grab_console(void)
+{
+#ifdef CONFIG_FB
+    fb_redraw();
+#endif
+}
+/** Return console to userspace. */
+void arch_release_console(void)
+{
+}
 /** @}
  */

 /branches/tracing/kernel/arch/arm32/src/cpu/cpu.c
 ,7 → 36,7
 #include <arch/cpu.h>
 #include <cpu.h>
 #include <arch.h>
-#include <print.h>
+#include <print.h>
 /** Number of indexes left out in the #imp_data array */
 #define IMP_DATA_START_OFFSET 0x40
 ,10 → 82,10
 {
     uint32_t ident;
     asm volatile (
-        "mrc p15, 0, %0, c0, c0, 0\n"
-        : "=r" (ident)
+        "mrc p15, 0, %[ident], c0, c0, 0\n"
+        : [ident] "=r" (ident)
     );
     cpu->imp_num = ident >> 24;
     cpu->variant_num = (ident << 8) >> 28;
     cpu->arch_num = (ident << 12) >> 28;

 /branches/tracing/kernel/arch/arm32/src/mm/tlb.c
 ,7 → 48,7
     asm volatile (
         "eor r1, r1\n"
         "mcr p15, 0, r1, c8, c7, 0\n"
-        : : : "r1"
+        ::: "r1"
     );
 }
 ,9 → 68,8
 static inline void invalidate_page(uintptr_t page)
 {
     asm volatile (
-        "mcr p15, 0, %0, c8, c7, 1"
-        :
-        : "r" (page)
+        "mcr p15, 0, %[page], c8, c7, 1\n"
+        :: [page] "r" (page)
     );
 }
 ,7 → 80,7
  * @param page Address of the first page whose entry is to be invalidated.
  * @param cnt Number of entries to invalidate.
  */
-void tlb_invalidate_pages(asid_t asid, uintptr_t page, count_t cnt)
+void tlb_invalidate_pages(asid_t asid __attribute__((unused)), uintptr_t page, count_t cnt)
 {
     unsigned int i;
 ,5 → 88,13
         invalidate_page(page + i * PAGE_SIZE);
 }
+void tlb_arch_init(void)
+{
+}
+void tlb_print(void)
+{
+}
 /** @}
  */

 /branches/tracing/kernel/arch/arm32/src/mm/page_fault.c
 ,7 → 34,6
  */
 #include <panic.h>
 #include <arch/exception.h>
-#include <arch/debug/print.h>
 #include <arch/mm/page_fault.h>
 #include <mm/as.h>
 #include <genarch/mm/page_pt.h>
 ,12 → 48,13
 static inline fault_status_t read_fault_status_register(void)
 {
     fault_status_union_t fsu;
     /* fault status is stored in CP15 register 5 */
     asm volatile (
-        "mrc p15, 0, %0, c5, c0, 0"
-        : "=r"(fsu.dummy)
+        "mrc p15, 0, %[dummy], c5, c0, 0"
+        : [dummy] "=r" (fsu.dummy)
     );
     return fsu.fs;
 }
 ,17 → 61,18
 /** Returns FAR (fault address register) content.
  *
  * @return FAR (fault address register) content (address that caused a page
- *     fault)
+ *         fault)
  */
 static inline uintptr_t read_fault_address_register(void)
 {
     uintptr_t ret;
     /* fault adress is stored in CP15 register 6 */
     asm volatile (
-        "mrc p15, 0, %0, c6, c0, 0"
-        : "=r"(ret)
+        "mrc p15, 0, %[ret], c6, c0, 0"
+        : [ret] "=r" (ret)
     );
     return ret;
 }
 ,29 → 81,26
  * @param instr Instruction
  *
  * @return true when instruction is load/store, false otherwise
+ *
  */
 static inline bool is_load_store_instruction(instruction_t instr)
 {
     /* load store immediate offset */
-    if (instr.type == 0x2) {
+    if (instr.type == 0x2)
         return true;
-    }
     /* load store register offset */
-    if (instr.type == 0x3 && instr.bit4 == 0) {
+    if ((instr.type == 0x3) && (instr.bit4 == 0))
         return true;
-    }
     /* load store multiple */
-    if (instr.type == 0x4) {
+    if (instr.type == 0x4)
         return true;
-    }
     /* oprocessor load/store */
-    if (instr.type == 0x6) {
+    if (instr.type == 0x6)
         return true;
-    }
     return false;
 }
 ,12 → 113,11
 static inline bool is_swap_instruction(instruction_t instr)
 {
     /* swap, swapb instruction */
-    if (instr.type == 0x0 &&
-        (instr.opcode == 0x8 || instr.opcode == 0xa) &&
-        instr.access == 0x0 && instr.bits567 == 0x4 && instr.bit4 == 1) {
+    if ((instr.type == 0x0) &&
+        ((instr.opcode == 0x8) || (instr.opcode == 0xa)) &&
+        (instr.access == 0x0) && (instr.bits567 == 0x4) && (instr.bit4 == 1))
         return true;
-    }
     return false;
 }
 ,8 → 139,8
     /* undefined instructions */
     if (instr.condition == 0xf) {
-        panic("page_fault - instruction doesn't access memory "
-            "(instr_code: %x, badvaddr:%x)", instr, badvaddr);
+        panic("page_fault - instruction does not access memory "
+            "(instr_code: %x, badvaddr:%x).", instr, badvaddr);
         return PF_ACCESS_EXEC;
     }
 ,7 → 159,7
     }
     panic("page_fault - instruction doesn't access memory "
-        "(instr_code: %x, badvaddr:%x)", instr, badvaddr);
+        "(instr_code: %x, badvaddr:%x).", instr, badvaddr);
     return PF_ACCESS_EXEC;
 }
 ,12 → 181,12
     if (ret == AS_PF_FAULT) {
         print_istate(istate);
-        dprintf("page fault - pc: %x, va: %x, status: %x(%x), "
+        printf("page fault - pc: %x, va: %x, status: %x(%x), "
             "access:%d\n", istate->pc, badvaddr, fsr.status, fsr,
             access);
-        fault_if_from_uspace(istate, "Page fault: %#x", badvaddr);
-        panic("page fault\n");
+        fault_if_from_uspace(istate, "Page fault: %#x.", badvaddr);
+        panic("Page fault.");
     }
 }
 ,9 → 229,9
     int ret = as_page_fault(istate->pc, PF_ACCESS_EXEC, istate);
     if (ret == AS_PF_FAULT) {
-        dprintf("prefetch_abort\n");
+        printf("prefetch_abort\n");
         print_istate(istate);
-        panic("page fault - prefetch_abort at address: %x\n",
+        panic("page fault - prefetch_abort at address: %x.",
             istate->pc);
     }

 /branches/tracing/kernel/arch/arm32/src/mm/frame.c
 ,7 → 26,7
  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
  */
-/** @addtogroup arm32mm
+/** @addtogroup arm32mm
  * @{
  */
 /** @file
 ,9 → 35,8
 #include <mm/frame.h>
 #include <arch/mm/frame.h>
-#include <arch/machine.h>
+#include <arch/drivers/gxemul.h>
 #include <config.h>
-#include <arch/debug/print.h>
 /** Address of the last frame in the memory. */
 uintptr_t last_frame = 0;
 ,11 → 44,12
 /** Creates memory zones. */
 void frame_arch_init(void)
 {
-    /* all memory as one zone */
-    zone_create(0, ADDR2PFN(machine_get_memory_size()),
+    last_frame = *((uintptr_t *) (GXEMUL_MP_ADDRESS + GXEMUL_MP_MEMSIZE_OFFSET));
+    /* All memory as one zone */
+    zone_create(0, ADDR2PFN(last_frame),
         BOOT_PAGE_TABLE_START_FRAME + BOOT_PAGE_TABLE_SIZE_IN_FRAMES, 0);
-    last_frame = machine_get_memory_size();
     /* blacklist boot page table */
     frame_mark_unavailable(BOOT_PAGE_TABLE_START_FRAME,
         BOOT_PAGE_TABLE_SIZE_IN_FRAMES);
 ,10 → 58,9
 /** Frees the boot page table. */
 void boot_page_table_free(void)
 {
-    int i;
-    for (i = 0; i < BOOT_PAGE_TABLE_SIZE_IN_FRAMES; i++) {
+    unsigned int i;
+    for (i = 0; i < BOOT_PAGE_TABLE_SIZE_IN_FRAMES; i++)
         frame_free(i * FRAME_SIZE + BOOT_PAGE_TABLE_ADDRESS);
-    }
 }
 /** @}

 /branches/tracing/kernel/arch/arm32/src/mm/page.c
 ,19 → 51,15
  */
 void page_arch_init(void)
 {
+    int flags = PAGE_CACHEABLE;
+    page_mapping_operations = &pt_mapping_operations;
     uintptr_t cur;
-    int flags;
-    page_mapping_operations = &pt_mapping_operations;
-    flags = PAGE_CACHEABLE;
-    /* PA2KA(identity) mapping for all frames until last_frame */
-    for (cur = 0; cur < last_frame; cur += FRAME_SIZE) {
+    /* Kernel identity mapping */
+    for (cur = 0; cur < last_frame; cur += FRAME_SIZE)
         page_mapping_insert(AS_KERNEL, PA2KA(cur), cur, flags);
-    }
-    /* create mapping for exception table at high offset */
+    /* Create mapping for exception table at high offset */
 #ifdef HIGH_EXCEPTION_VECTORS
     void *virtaddr = frame_alloc(ONE_FRAME, FRAME_KA);
     page_mapping_insert(AS_KERNEL, EXC_BASE_ADDRESS, KA2PA(virtaddr), flags);
 ,9 → 66,9
 #else
 #error "Only high exception vector supported now"
 #endif
     as_switch(NULL, AS_KERNEL);
     boot_page_table_free();
 }
 ,10 → 86,10
 {
     if (last_frame + ALIGN_UP(size, PAGE_SIZE) >
         KA2PA(KERNEL_ADDRESS_SPACE_END_ARCH)) {
-        panic("Unable to map physical memory %p (%d bytes)",
+        panic("Unable to map physical memory %p (%d bytes).",
             physaddr, size)
     }
     uintptr_t virtaddr = PA2KA(last_frame);
     pfn_t i;
     for (i = 0; i < ADDR2PFN(ALIGN_UP(size, PAGE_SIZE)); i++) {
 ,7 → 97,7
             physaddr + PFN2ADDR(i),
             PAGE_NOT_CACHEABLE | PAGE_READ | PAGE_WRITE | PAGE_KERNEL);
     }
     last_frame = ALIGN_UP(last_frame + size, FRAME_SIZE);
     return virtaddr;
 }

/branches/tracing/kernel/arch/arm32/src/panic.S
31,5 → 31,5
.global panic_printf

panic_printf:
bl debug_printf
bl printf
bl cpu_halt

 /branches/tracing/kernel/arch/arm32/src/userspace.c
 ,12 → 90,11
     /* set user mode, set registers, jump */
     asm volatile (
-        "mov sp, %0         \n"
-        "msr spsr_c, %1         \n"
-        "ldmfd sp!, {r0-r12, sp, lr}^   \n"
+        "mov sp, %[ustate]\n"
+        "msr spsr_c, %[user_mode]\n"
+        "ldmfd sp!, {r0-r12, sp, lr}^\n"
         "ldmfd sp!, {pc}^\n"
-        :
-        : "r" (&ustate), "r" (user_mode)
+        :: [ustate] "r" (&ustate), [user_mode] "r" (user_mode)
     );
     /* unreachable */

 /branches/tracing/kernel/arch/arm32/src/interrupt.c
 ,13 → 35,16
 #include <arch/asm.h>
 #include <arch/regutils.h>
+#include <arch/drivers/gxemul.h>
 #include <ddi/irq.h>
-#include <arch/machine.h>
+#include <ddi/device.h>
 #include <interrupt.h>
 /** Initial size of a table holding interrupt handlers. */
 #define IRQ_COUNT 8
+static irq_t gxemul_timer_irq;
 /** Disable interrupts.
  *
  * @return Old interrupt priority level.
 ,7 → 52,7
 ipl_t interrupts_disable(void)
 {
     ipl_t ipl = current_status_reg_read();
     current_status_reg_control_write(STATUS_REG_IRQ_DISABLED_BIT | ipl);
     return ipl;
 ,9 → 65,9
 ipl_t interrupts_enable(void)
 {
     ipl_t ipl = current_status_reg_read();
     current_status_reg_control_write(ipl & ~STATUS_REG_IRQ_DISABLED_BIT);
     return ipl;
 }
 ,6 → 91,41
     return current_status_reg_read();
 }
+/** Starts gxemul Real Time Clock device, which asserts regular interrupts.
+ *
+ * @param frequency Interrupts frequency (0 disables RTC).
+ */
+static void gxemul_timer_start(uint32_t frequency)
+{
+    *((uint32_t *) (gxemul_rtc + GXEMUL_RTC_FREQ_OFFSET))
+        = frequency;
+}
+static irq_ownership_t gxemul_timer_claim(irq_t *irq)
+{
+    return IRQ_ACCEPT;
+}
+/** Timer interrupt handler.
+ *
+ * @param irq Interrupt information.
+ * @param arg Not used.
+ */
+static void gxemul_timer_irq_handler(irq_t *irq)
+{
+    /*
+    * We are holding a lock which prevents preemption.
+    * Release the lock, call clock() and reacquire the lock again.
+    */
+    spinlock_unlock(&irq->lock);
+    clock();
+    spinlock_lock(&irq->lock);
+    /* acknowledge tick */
+    *((uint32_t *) (gxemul_rtc + GXEMUL_RTC_ACK_OFFSET))
+        = 0;
+}
 /** Initialize basic tables for exception dispatching
  * and starts the timer.
  */
 ,7 → 132,16
 void interrupt_init(void)
 {
     irq_init(IRQ_COUNT, IRQ_COUNT);
-    machine_timer_irq_start();
+    irq_initialize(&gxemul_timer_irq);
+    gxemul_timer_irq.devno = device_assign_devno();
+    gxemul_timer_irq.inr = GXEMUL_TIMER_IRQ;
+    gxemul_timer_irq.claim = gxemul_timer_claim;
+    gxemul_timer_irq.handler = gxemul_timer_irq_handler;
+    irq_register(&gxemul_timer_irq);
+    gxemul_timer_start(GXEMUL_TIMER_FREQ);
 }
 /** @}

 /branches/tracing/kernel/arch/arm32/src/drivers/gxemul.c
 ,361 → 33,19
  *  @brief GXemul drivers.
  */
-#include <interrupt.h>
-#include <ipc/irq.h>
-#include <console/chardev.h>
 #include <arch/drivers/gxemul.h>
-#include <console/console.h>
-#include <sysinfo/sysinfo.h>
-#include <print.h>
-#include <ddi/device.h>
 #include <mm/page.h>
-#include <arch/machine.h>
-#include <arch/debug/print.h>
-/* Addresses of devices. */
-#define GXEMUL_VIDEORAM            0x10000000
-#define GXEMUL_KBD                 0x10000000
-#define GXEMUL_HALT_OFFSET         0x10
-#define GXEMUL_RTC                 0x15000000
-#define GXEMUL_RTC_FREQ_OFFSET     0x100
-#define GXEMUL_RTC_ACK_OFFSET      0x110
-#define GXEMUL_IRQC                0x16000000
-#define GXEMUL_IRQC_MASK_OFFSET    0x4
-#define GXEMUL_IRQC_UNMASK_OFFSET  0x8
-#define GXEMUL_MP                  0x11000000
-#define GXEMUL_MP_MEMSIZE_OFFSET   0x0090
-#define GXEMUL_FB                  0x12000000
+void *gxemul_kbd;
+void *gxemul_rtc;
+void *gxemul_irqc;
-/* IRQs */
-#define GXEMUL_KBD_IRQ      2
-#define GXEMUL_TIMER_IRQ    4
-static gxemul_hw_map_t gxemul_hw_map;
-static chardev_t console;
-static irq_t gxemul_console_irq;
-static irq_t gxemul_timer_irq;
-static bool hw_map_init_called = false;
-static void gxemul_kbd_enable(chardev_t *dev);
-static void gxemul_kbd_disable(chardev_t *dev);
-static void gxemul_write(chardev_t *dev, const char ch);
-static char gxemul_do_read(chardev_t *dev);
-static chardev_operations_t gxemul_ops = {
-    .resume = gxemul_kbd_enable,
-    .suspend = gxemul_kbd_disable,
-    .write = gxemul_write,
-    .read = gxemul_do_read,
-};
-/** Returns the mask of active interrupts. */
-static inline uint32_t gxemul_irqc_get_sources(void)
+void gxemul_init(void)
 {
-    return *((uint32_t *) gxemul_hw_map.irqc);
+    gxemul_kbd = (void *) hw_map(GXEMUL_KBD_ADDRESS, PAGE_SIZE);
+    gxemul_rtc = (void *) hw_map(GXEMUL_RTC_ADDRESS, PAGE_SIZE);
+    gxemul_irqc = (void *) hw_map(GXEMUL_IRQC_ADDRESS, PAGE_SIZE);
 }
-/** Masks interrupt.
- *
- * @param irq interrupt number
- */
-static inline void gxemul_irqc_mask(uint32_t irq)
-{
-    *((uint32_t *) gxemul_hw_map.irqc_mask) = irq;
-}
-/** Unmasks interrupt.
- *
- * @param irq interrupt number
- */
-static inline void gxemul_irqc_unmask(uint32_t irq)
-{
-    *((uint32_t *) gxemul_hw_map.irqc_unmask) = irq;
-}
-/** Initializes #gxemul_hw_map. */
-void gxemul_hw_map_init(void)
-{
-    gxemul_hw_map.videoram = hw_map(GXEMUL_VIDEORAM, PAGE_SIZE);
-    gxemul_hw_map.kbd = hw_map(GXEMUL_KBD, PAGE_SIZE);
-    gxemul_hw_map.rtc = hw_map(GXEMUL_RTC, PAGE_SIZE);
-    gxemul_hw_map.irqc = hw_map(GXEMUL_IRQC, PAGE_SIZE);
-    gxemul_hw_map.rtc_freq = gxemul_hw_map.rtc + GXEMUL_RTC_FREQ_OFFSET;
-    gxemul_hw_map.rtc_ack = gxemul_hw_map.rtc + GXEMUL_RTC_ACK_OFFSET;
-    gxemul_hw_map.irqc_mask = gxemul_hw_map.irqc + GXEMUL_IRQC_MASK_OFFSET;
-    gxemul_hw_map.irqc_unmask = gxemul_hw_map.irqc +
-        GXEMUL_IRQC_UNMASK_OFFSET;
-    hw_map_init_called = true;
-}
-/** Putchar that works with gxemul.
- *
- * @param dev Not used.
- * @param ch Characted to be printed.
- */
-static void gxemul_write(chardev_t *dev, const char ch)
-{
-    *((char *) gxemul_hw_map.videoram) = ch;
-}
-/** Enables gxemul keyboard (interrupt unmasked).
- *
- * @param dev Not used.
- *
- * Called from getc().
- */
-static void gxemul_kbd_enable(chardev_t *dev)
-{
-    gxemul_irqc_unmask(GXEMUL_KBD_IRQ);
-}
-/** Disables gxemul keyboard (interrupt masked).
- *
- * @param dev not used
- *
- * Called from getc().
- */
-static void gxemul_kbd_disable(chardev_t *dev)
-{
-    gxemul_irqc_mask(GXEMUL_KBD_IRQ);
-}
-/** Read character using polling, assume interrupts disabled.
- *
- *  @param dev Not used.
- */
-static char gxemul_do_read(chardev_t *dev)
-{
-    char ch;
-    while (1) {
-        ch = *((volatile char *) gxemul_hw_map.kbd);
-        if (ch) {
-            if (ch == '\r')
-                return '\n';
-            if (ch == 0x7f)
-                return '\b';
-            return ch;
-        }
-    }
-}
-/** Process keyboard interrupt.
- *
- *  @param irq IRQ information.
- *  @param arg Not used.
- */
-static void gxemul_irq_handler(irq_t *irq, void *arg, ...)
-{
-    if ((irq->notif_cfg.notify) && (irq->notif_cfg.answerbox)) {
-        ipc_irq_send_notif(irq);
-    } else {
-        char ch = 0;
-        ch = *((char *) gxemul_hw_map.kbd);
-        if (ch == '\r') {
-            ch = '\n';
-        }
-        if (ch == 0x7f) {
-            ch = '\b';
-        }
-        chardev_push_character(&console, ch);
-    }
-}
-static irq_ownership_t gxemul_claim(void)
-{
-    return IRQ_ACCEPT;
-}
-/** Acquire console back for kernel. */
-void gxemul_grab_console(void)
-{
-    ipl_t ipl = interrupts_disable();
-    spinlock_lock(&gxemul_console_irq.lock);
-    gxemul_console_irq.notif_cfg.notify = false;
-    spinlock_unlock(&gxemul_console_irq.lock);
-    interrupts_restore(ipl);
-}
-/** Return console to userspace. */
-void gxemul_release_console(void)
-{
-    ipl_t ipl = interrupts_disable();
-    spinlock_lock(&gxemul_console_irq.lock);
-    if (gxemul_console_irq.notif_cfg.answerbox) {
-        gxemul_console_irq.notif_cfg.notify = true;
-    }
-    spinlock_unlock(&gxemul_console_irq.lock);
-    interrupts_restore(ipl);
-}
-/** Initializes console object representing gxemul console.
- *
- *  @param devno device number.
- */
-void gxemul_console_init(devno_t devno)
-{
-    chardev_initialize("gxemul_console", &console, &gxemul_ops);
-    stdin = &console;
-    stdout = &console;
-    irq_initialize(&gxemul_console_irq);
-    gxemul_console_irq.devno = devno;
-    gxemul_console_irq.inr = GXEMUL_KBD_IRQ;
-    gxemul_console_irq.claim = gxemul_claim;
-    gxemul_console_irq.handler = gxemul_irq_handler;
-    irq_register(&gxemul_console_irq);
-    gxemul_irqc_unmask(GXEMUL_KBD_IRQ);
-    sysinfo_set_item_val("kbd", NULL, true);
-    sysinfo_set_item_val("kbd.devno", NULL, devno);
-    sysinfo_set_item_val("kbd.inr", NULL, GXEMUL_KBD_IRQ);
-    sysinfo_set_item_val("kbd.address.virtual", NULL, gxemul_hw_map.kbd);
-}
-/** Starts gxemul Real Time Clock device, which asserts regular interrupts.
- *
- * @param frequency Interrupts frequency (0 disables RTC).
- */
-static void gxemul_timer_start(uint32_t frequency)
-{
-    *((uint32_t*) gxemul_hw_map.rtc_freq) = frequency;
-}
-static irq_ownership_t gxemul_timer_claim(void)
-{
-    return IRQ_ACCEPT;
-}
-/** Timer interrupt handler.
- *
- * @param irq Interrupt information.
- * @param arg Not used.
- */
-static void gxemul_timer_irq_handler(irq_t *irq, void *arg, ...)
-{
-    /*
-    * We are holding a lock which prevents preemption.
-    * Release the lock, call clock() and reacquire the lock again.
-    */
-    spinlock_unlock(&irq->lock);
-    clock();
-    spinlock_lock(&irq->lock);
-    /* acknowledge tick */
-    *((uint32_t*) gxemul_hw_map.rtc_ack) = 0;
-}
-/** Initializes and registers timer interrupt handler. */
-static void gxemul_timer_irq_init(void)
-{
-    irq_initialize(&gxemul_timer_irq);
-    gxemul_timer_irq.devno = device_assign_devno();
-    gxemul_timer_irq.inr = GXEMUL_TIMER_IRQ;
-    gxemul_timer_irq.claim = gxemul_timer_claim;
-    gxemul_timer_irq.handler = gxemul_timer_irq_handler;
-    irq_register(&gxemul_timer_irq);
-}
-/** Starts timer.
- *
- * Initiates regular timer interrupts after initializing
- * corresponding interrupt handler.
- */
-void gxemul_timer_irq_start(void)
-{
-    gxemul_timer_irq_init();
-    gxemul_timer_start(GXEMUL_TIMER_FREQ);
-}
-/** Returns the size of emulated memory.
- *
- * @return Size in bytes.
- */
-size_t gxemul_get_memory_size(void)
-{
-    return  *((int *) (GXEMUL_MP + GXEMUL_MP_MEMSIZE_OFFSET));
-}
-/** Prints a character.
- *
- *  @param ch Character to be printed.
- */
-void gxemul_debug_putc(char ch)
-{
-    char *addr = 0;
-    if (!hw_map_init_called) {
-        addr = (char *) GXEMUL_KBD;
-    } else {
-        addr = (char *) gxemul_hw_map.videoram;
-    }
-    *(addr) = ch;
-}
-/** Stops gxemul. */
-void gxemul_cpu_halt(void)
-{
-    char * addr = 0;
-    if (!hw_map_init_called) {
-        addr = (char *) GXEMUL_KBD;
-    } else {
-        addr = (char *) gxemul_hw_map.videoram;
-    }
-    *(addr + GXEMUL_HALT_OFFSET) = '\0';
-}
-/** Gxemul specific interrupt exception handler.
- *
- * Determines sources of the interrupt from interrupt controller and
- * calls high-level handlers for them.
- *
- * @param exc_no Interrupt exception number.
- * @param istate Saved processor state.
- */
-void gxemul_irq_exception(int exc_no, istate_t *istate)
-{
-    uint32_t sources = gxemul_irqc_get_sources();
-    int i;
-    for (i = 0; i < GXEMUL_IRQC_MAX_IRQ; i++) {
-        if (sources & (1 << i)) {
-            irq_t *irq = irq_dispatch_and_lock(i);
-            if (irq) {
-                /* The IRQ handler was found. */
-                irq->handler(irq, irq->arg);
-                spinlock_unlock(&irq->lock);
-            } else {
-                /* Spurious interrupt.*/
-                dprintf("cpu%d: spurious interrupt (inum=%d)\n",
-                    CPU->id, i);
-            }
-        }
-    }
-}
-/** Returns address of framebuffer device.
- *
- *  @return Address of framebuffer device.
- */
-uintptr_t gxemul_get_fb_address(void)
-{
-    return (uintptr_t) GXEMUL_FB;
-}
 /** @}
  */

 /branches/tracing/kernel/arch/arm32/src/start.S
 ,30 → 40,12
     mrs r3, cpsr
     bic r3, r3, #0x1f
     orr r3, r3, #0x13
-    msr cpsr_c, r3
+    msr cpsr_c, r3
     ldr sp, =temp_stack
-    cmp r2, #0
-    beq bootinfo_end
-    ldr r3, =bootinfo
-    bootinfo_loop:
-        ldr r4, [r1]
-        str r4, [r3]
-        add r1, r1, #4
-        add r3, r3, #4
-        add r2, r2, #-4
-        cmp r2, #0
-        bne bootinfo_loop
-    bootinfo_end:
     bl arch_pre_main
     bl main_bsp
     .space TEMP_STACK_SIZE
 ,4 → 56,3
 supervisor_sp:
     .space 4

 /branches/tracing/kernel/arch/ppc32/_link.ld.in
 ,11 → 1,11
 /** PPC32 linker script
  *
  * umapped section:
- *  kernel text
- *  kernel data
+ *  kernel text
+ *  kernel data
  * mapped section:
- *  kernel text
- *  kernel data
+ *  kernel text
+ *  kernel data
  *
  */
 ,7 → 27,7
         unmapped_kdata_start = .;
     }
-    .mapped PA2KA(BOOT_OFFSET): AT (BOOT_OFFSET) {
+    .mapped PA2KA(BOOT_OFFSET): AT (BOOT_OFFSET) {
         ktext_start = .;
         *(K_TEXT_START);
         *(.text);
 ,22 → 37,22
         *(K_DATA_START);
         *(.rodata);
         *(.rodata.*);
-        *(.data);       /* initialized data */
+        *(.data);       /* initialized data */
         *(.sdata);
         *(.sdata2);
         *(.sbss);
         hardcoded_ktext_size = .;
-        LONG(ktext_end - ktext_start);
+        LONG(ktext_end - ktext_start);
         hardcoded_kdata_size = .;
         LONG(kdata_end - kdata_start);
         hardcoded_load_address = .;
         LONG(PA2KA(BOOT_OFFSET));
-        *(.bss);        /* uninitialized static variables */
-        *(COMMON);      /* global variables */
+        *(.bss);        /* uninitialized static variables */
+        *(COMMON);      /* global variables */
         symbol_table = .;
-        *(symtab.*);            /* Symbol table, must be LAST symbol!*/
+        *(symtab.*);    /* Symbol table, must be LAST symbol!*/
         kdata_end = .;
     }
 }

 /branches/tracing/kernel/arch/ppc32/include/asm/regname.h
 ,6 → 211,9
 #define dbat2l  541
 #define dbat3u  542
 #define dbat3l  543
+#define tlbmiss 980
+#define ptehi   981
+#define ptelo   982
 #define hid0    1008
 /* MSR bits */
 ,6 → 223,7
 #define msr_ee  (1 << 15)
 /* HID0 bits */
+#define hid0_sten   (1 << 24)
 #define hid0_ice    (1 << 15)
 #define hid0_dce    (1 << 14)
 #define hid0_icfi   (1 << 11)

/branches/tracing/kernel/arch/ppc32/include/exception.h
75,6 → 75,7
uint32_t lr;
uint32_t ctr;
uint32_t xer;
uint32_t dar;
uint32_t r12;
uint32_t sp;
} istate_t;

 /branches/tracing/kernel/arch/ppc32/include/types.h
 ,6 → 57,9
 typedef uint32_t unative_t;
 typedef int32_t native_t;
+typedef struct {
+} fncptr_t;
 /**< Formats for uintptr_t, size_t, count_t and index_t */
 #define PRIp "x"
 #define PRIs "u"
 ,11 → 87,13
 /** Page Table Entry. */
 typedef struct {
-    unsigned p : 1;       /**< Present bit. */
-    unsigned a : 1;       /**< Accessed bit. */
-    unsigned g : 1;       /**< Global bit. */
-    unsigned valid : 1;   /**< Valid content even if not present. */
-    unsigned pfn : 20;    /**< Physical frame number. */
+    unsigned present : 1;             /**< Present bit. */
+    unsigned page_write_through : 1;  /**< Write thought caching. */
+    unsigned page_cache_disable : 1;  /**< No caching. */
+    unsigned accessed : 1;            /**< Accessed bit. */
+    unsigned global : 1;              /**< Global bit. */
+    unsigned valid : 1;               /**< Valid content even if not present. */
+    unsigned pfn : 20;                /**< Physical frame number. */
 } pte_t;
 #endif

 /branches/tracing/kernel/arch/ppc32/include/arch.h
 ,7 → 26,7
  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
  */
-/** @addtogroup ppc32
+/** @addtogroup ppc32
  * @{
  */
 /** @file
 ,7 → 35,7
 #ifndef KERN_ppc32_ARCH_H_
 #define KERN_ppc32_ARCH_H_
-#include <arch/drivers/cuda.h>
+extern void arch_pre_main(void);
 #endif

 /branches/tracing/kernel/arch/ppc32/include/boot/boot.h
 ,7 → 26,7
  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
  */
-/** @addtogroup ppc32
+/** @addtogroup ppc32
  * @{
  */
 /** @file
 ,21 → 35,24
 #ifndef KERN_ppc32_BOOT_H_
 #define KERN_ppc32_BOOT_H_
-#define BOOT_OFFSET     0x8000
+#define BOOT_OFFSET  0x8000
 /* Temporary stack size for boot process */
-#define TEMP_STACK_SIZE 0x1000
+#define TEMP_STACK_SIZE  0x1000
-#define TASKMAP_MAX_RECORDS 32
-#define MEMMAP_MAX_RECORDS 32
+#define TASKMAP_MAX_RECORDS  32
+#define MEMMAP_MAX_RECORDS   32
 #ifndef __ASM__
+#define BOOTINFO_TASK_NAME_BUFLEN 32
 #include <arch/types.h>
 typedef struct {
     uintptr_t addr;
     uint32_t size;
+    char name[BOOTINFO_TASK_NAME_BUFLEN];
 } utask_t;
 typedef struct {
 ,13 → 82,13
 typedef struct {
     uintptr_t addr;
     unsigned int size;
-} keyboard_t;
+} macio_t;
 typedef struct {
     memmap_t memmap;
     taskmap_t taskmap;
     screen_t screen;
-    keyboard_t keyboard;
+    macio_t macio;
 } bootinfo_t;
 extern bootinfo_t bootinfo;

 /branches/tracing/kernel/arch/ppc32/include/asm.h
 ,6 → 36,7
 #define KERN_ppc32_ASM_H_
 #include <arch/types.h>
+#include <typedefs.h>
 #include <config.h>
 /** Enable interrupts.
 ,6 → 150,36
 extern void userspace_asm(uintptr_t uspace_uarg, uintptr_t stack, uintptr_t entry);
+static inline void pio_write_8(ioport8_t *port, uint8_t v)
+{
+    *port = v;
+}
+static inline void pio_write_16(ioport16_t *port, uint16_t v)
+{
+    *port = v;
+}
+static inline void pio_write_32(ioport32_t *port, uint32_t v)
+{
+    *port = v;
+}
+static inline uint8_t pio_read_8(ioport8_t *port)
+{
+    return *port;
+}
+static inline uint16_t pio_read_16(ioport16_t *port)
+{
+    return *port;
+}
+static inline uint32_t pio_read_32(ioport32_t *port)
+{
+    return *port;
+}
 #endif
 /** @}

 /branches/tracing/kernel/arch/ppc32/include/mm/frame.h
 ,7 → 26,7
  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
  */
-/** @addtogroup ppc32mm
+/** @addtogroup ppc32mm
  * @{
  */
 /** @file
 ,13 → 35,13
 #ifndef KERN_ppc32_FRAME_H_
 #define KERN_ppc32_FRAME_H_
-#define FRAME_WIDTH     12  /* 4K */
-#define FRAME_SIZE      (1 << FRAME_WIDTH)
+#define FRAME_WIDTH  12  /* 4K */
+#define FRAME_SIZE   (1 << FRAME_WIDTH)
 #ifdef KERNEL
 #ifndef __ASM__
-#include <arch/types.h>
+#include <arch/types.h>
 extern uintptr_t last_frame;

 /branches/tracing/kernel/arch/ppc32/include/mm/page.h
 ,7 → 120,7
 /* Macros for querying the last-level PTEs. */
 #define PTE_VALID_ARCH(pte)         (*((uint32_t *) (pte)) != 0)
-#define PTE_PRESENT_ARCH(pte)           ((pte)->p != 0)
+#define PTE_PRESENT_ARCH(pte)           ((pte)->present != 0)
 #define PTE_GET_FRAME_ARCH(pte)         ((pte)->pfn << 12)
 #define PTE_WRITABLE_ARCH(pte)          1
 #define PTE_EXECUTABLE_ARCH(pte)        1
 ,13 → 134,13
 {
     pte_t *p = &pt[i];
-    return ((1 << PAGE_CACHEABLE_SHIFT) |
-        ((!p->p) << PAGE_PRESENT_SHIFT) |
+    return (((!p->page_cache_disable) << PAGE_CACHEABLE_SHIFT) |
+        ((!p->present) << PAGE_PRESENT_SHIFT) |
         (1 << PAGE_USER_SHIFT) |
         (1 << PAGE_READ_SHIFT) |
         (1 << PAGE_WRITE_SHIFT) |
         (1 << PAGE_EXEC_SHIFT) |
-        (p->g << PAGE_GLOBAL_SHIFT));
+        (p->global << PAGE_GLOBAL_SHIFT));
 }
 static inline void set_pt_flags(pte_t *pt, index_t i, int flags)
 ,8 → 147,9
 {
     pte_t *p = &pt[i];
-    p->p = !(flags & PAGE_NOT_PRESENT);
-    p->g = (flags & PAGE_GLOBAL) != 0;
+    p->page_cache_disable = !(flags & PAGE_CACHEABLE);
+    p->present = !(flags & PAGE_NOT_PRESENT);
+    p->global = (flags & PAGE_GLOBAL) != 0;
     p->valid = 1;
 }

 /branches/tracing/kernel/arch/ppc32/include/mm/tlb.h
 ,6 → 39,11
 #include <arch/types.h>
 #include <typedefs.h>
+#define WIMG_GUARDED    0x01
+#define WIMG_COHERENT   0x02
+#define WIMG_NO_CACHE   0x04
+#define WIMG_WRITETHRU  0x08
 typedef struct {
     unsigned v : 1;          /**< Valid */
     unsigned vsid : 24;      /**< Virtual Segment ID */
 ,9 → 58,27
     unsigned pp : 2;         /**< Page protection */
 } phte_t;
+typedef struct {
+    unsigned v : 1;
+    unsigned vsid : 24;
+    unsigned reserved0 : 1;
+    unsigned api : 6;
+} ptehi_t;
+typedef struct {
+    unsigned rpn : 20;
+    unsigned xpn : 3;
+    unsigned reserved0 : 1;
+    unsigned c : 1;
+    unsigned wimg : 4;
+    unsigned x : 1;
+    unsigned pp : 2;
+} ptelo_t;
+extern void pht_init(void);
 extern void pht_refill(int n, istate_t *istate);
-extern bool pht_real_refill(int n, istate_t *istate) __attribute__ ((section("K_UNMAPPED_TEXT_START")));
-extern void pht_init(void);
+extern bool pht_refill_real(int n, istate_t *istate) __attribute__ ((section("K_UNMAPPED_TEXT_START")));
+extern void tlb_refill_real(int n, uint32_t tlbmiss, ptehi_t ptehi, ptelo_t ptelo, istate_t *istate) __attribute__ ((section("K_UNMAPPED_TEXT_START")));
 #endif

 /branches/tracing/kernel/arch/ppc32/include/barrier.h
 ,6 → 55,7
         "dcbst 0, %0\n"
         "sync\n"
         "icbi 0, %0\n"
+        "sync\n"
         "isync\n"
         :: "r" (addr)
     );
 ,7 → 77,10
         asm volatile ("icbi 0, %0\n" :: "r" (addr + i));
     }
-    asm volatile ("isync");
+    asm volatile (
+        "sync\n"
+        "isync\n"
+    );
 }
 #endif

 /branches/tracing/kernel/arch/ppc32/include/drivers/pic.h
 ,7 → 26,7
  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
  */
-/** @addtogroup ppc32
+/** @addtogroup ppc32
  * @{
  */
 /** @file
 ,6 → 36,7
 #define KERN_ppc32_PIC_H_
 #include <arch/types.h>
+#include <ddi/irq.h>
 #define PIC_PENDING_LOW    8
 #define PIC_PENDING_HIGH   4
 ,11 → 45,11
 #define PIC_ACK_LOW        10
 #define PIC_ACK_HIGH       6
-void pic_init(uintptr_t base, size_t size);
-void pic_enable_interrupt(int intnum);
-void pic_disable_interrupt(int intnum);
-void pic_ack_interrupt(int intnum);
-int pic_get_pending(void);
+extern void pic_init(uintptr_t base, size_t size, cir_t *cir, void **cir_arg);
+extern void pic_enable_interrupt(inr_t intnum);
+extern void pic_disable_interrupt(inr_t intnum);
+extern void pic_ack_interrupt(void *arg, inr_t intnum);
+extern int pic_get_pending(void);
 #endif

 /branches/tracing/kernel/arch/ppc32/Makefile.inc
 ,10 → 29,6
 ## Toolchain configuration
 #
-ifndef CROSS_PREFIX
-    CROSS_PREFIX = /usr/local
-endif
 BFD_NAME = elf32-powerpc
 BFD_ARCH = powerpc:common
 BFD = binary
 ,44 → 41,21
 DEFS += -D__32_BITS__
-## Own configuration directives
-#
-CONFIG_FB = y
-## Compile with hierarchical page tables support.
-#
-CONFIG_PAGE_PT = y
-DEFS += -DCONFIG_PAGE_PT
-## Compile with support for address space identifiers.
-#
-CONFIG_ASID = y
-CONFIG_ASID_FIFO = y
-## Compile with support for software integer division.
-#
-CONFIG_SOFTINT = y
 ARCH_SOURCES = \
-    arch/$(ARCH)/src/context.S \
-    arch/$(ARCH)/src/debug/panic.s \
-    arch/$(ARCH)/src/fpu_context.S \
-    arch/$(ARCH)/src/boot/boot.S \
-    arch/$(ARCH)/src/ppc32.c \
-    arch/$(ARCH)/src/dummy.s \
-    arch/$(ARCH)/src/exception.S \
-    arch/$(ARCH)/src/interrupt.c \
-    arch/$(ARCH)/src/asm.S \
-    arch/$(ARCH)/src/cpu/cpu.c \
-    arch/$(ARCH)/src/proc/scheduler.c \
-    arch/$(ARCH)/src/ddi/ddi.c \
-    arch/$(ARCH)/src/drivers/cuda.c \
-    arch/$(ARCH)/src/mm/as.c \
-    arch/$(ARCH)/src/mm/frame.c \
-    arch/$(ARCH)/src/mm/page.c \
-    arch/$(ARCH)/src/mm/tlb.c \
-    arch/$(ARCH)/src/drivers/pic.c
+    arch/$(KARCH)/src/context.S \
+    arch/$(KARCH)/src/debug/panic.s \
+    arch/$(KARCH)/src/fpu_context.S \
+    arch/$(KARCH)/src/boot/boot.S \
+    arch/$(KARCH)/src/ppc32.c \
+    arch/$(KARCH)/src/dummy.s \
+    arch/$(KARCH)/src/exception.S \
+    arch/$(KARCH)/src/interrupt.c \
+    arch/$(KARCH)/src/asm.S \
+    arch/$(KARCH)/src/cpu/cpu.c \
+    arch/$(KARCH)/src/proc/scheduler.c \
+    arch/$(KARCH)/src/ddi/ddi.c \
+    arch/$(KARCH)/src/mm/as.c \
+    arch/$(KARCH)/src/mm/frame.c \
+    arch/$(KARCH)/src/mm/page.c \
+    arch/$(KARCH)/src/mm/tlb.c \
+    arch/$(KARCH)/src/drivers/pic.c

 /branches/tracing/kernel/arch/ppc32/src/exception.S
 ,7 → 60,7
 :
-    subi sp, sp, 160
+    subi sp, sp, 164
     stw r0, 8(sp)
     stw r2, 12(sp)
     stw r3, 16(sp)
 ,11 → 109,14
     mfxer r12
     stw r12, 148(sp)
-    mfsprg1 r12
+    mfdar r12
     stw r12, 152(sp)
+    mfsprg1 r12
+    stw r12, 156(sp)
     mfsprg2 r12
-    stw r12, 156(sp)
+    stw r12, 160(sp)
 .endm
 .org 0x100
 ,16 → 140,7
 exc_data_storage:
     CONTEXT_STORE
-    li r3, 2
-    mr r4, sp
-    addi r4, r4, 8
-    bl pht_real_refill
-    cmpwi r3, 0
-    bne iret_real
-    li r3, 2
-    b jump_to_kernel
+    b data_storage
 .org 0x400
 .global exc_instruction_storage
 ,17 → 147,8
 exc_instruction_storage:
     CONTEXT_STORE
-    li r3, 3
-    mr r4, sp
-    addi r4, r4, 8
-    bl pht_real_refill
-    cmpwi r3, 0
-    bne iret_real
+    b instruction_storage
-    li r3, 3
-    b jump_to_kernel
 .org 0x500
 .global exc_external
 exc_external:
 ,7 → 208,7
 .org 0xc00
 .global exc_syscall
 exc_syscall:
-    CONTEXT_STORE
+    CONTEXT_STORE
     b jump_to_kernel_syscall
 ,7 → 220,63
     li r3, 12
     b jump_to_kernel
+.org 0x1000
+.global exc_itlb_miss
+exc_itlb_miss:
+    CONTEXT_STORE
+    b tlb_miss
+.org 0x1100
+.global exc_dtlb_miss_load
+exc_dtlb_miss_load:
+    CONTEXT_STORE
+    b tlb_miss
+.org 0x1200
+.global exc_dtlb_miss_store
+exc_dtlb_miss_store:
+    CONTEXT_STORE
+    b tlb_miss
 .org 0x4000
+data_storage:
+    li r3, 2
+    mr r4, sp
+    addi r4, r4, 8
+    bl pht_refill_real
+    cmpwi r3, 0
+    bne iret_real
+    li r3, 2
+    b jump_to_kernel
+instruction_storage:
+    li r3, 3
+    mr r4, sp
+    addi r4, r4, 8
+    bl pht_refill_real
+    cmpwi r3, 0
+    bne iret_real
+    li r3, 3
+    b jump_to_kernel
+tlb_miss:
+    li r3, 16
+    mfspr r4, tlbmiss
+    mfspr r5, ptehi
+    mfspr r6, ptelo
+    mr r7, sp
+    addi r7, r7, 20
+    bl tlb_refill_real
+    b iret_real
 jump_to_kernel:
     lis r12, iret@ha
     addi r12, r12, iret@l
 ,7 → 313,6
     rfi
 iret_real:
     lwz r0, 8(sp)
     lwz r2, 12(sp)
     lwz r3, 16(sp)
 ,7 → 362,7
     lwz r12, 148(sp)
     mtxer r12
-    lwz r12, 152(sp)
-    lwz sp, 156(sp)
+    lwz r12, 156(sp)
+    lwz sp, 160(sp)
     rfi

 /branches/tracing/kernel/arch/ppc32/src/asm.S
 ,6 → 34,7
 .global iret
 .global iret_syscall
 .global memsetb
+.global memsetw
 .global memcpy
 .global memcpy_from_uspace
 .global memcpy_to_uspace
 ,8 → 132,8
     lwz r12, 148(sp)
     mtxer r12
-    lwz r12, 152(sp)
-    lwz sp, 156(sp)
+    lwz r12, 156(sp)
+    lwz sp, 160(sp)
     rfi
 ,14 → 198,17
     lwz r12, 148(sp)
     mtxer r12
-    lwz r12, 152(sp)
-    lwz sp, 156(sp)
+    lwz r12, 156(sp)
+    lwz sp, 160(sp)
     rfi
 memsetb:
     b _memsetb
+memsetw:
+    b _memsetw
 memcpy:
 memcpy_from_uspace:
 memcpy_to_uspace:

 /branches/tracing/kernel/arch/ppc32/src/boot/boot.S
 ,7 → 33,7
 .global kernel_image_start
 kernel_image_start:
     # load temporal kernel stack
     lis sp, kernel_stack@ha
 ,7 → 52,7
     beq bootinfo_end
     addis r3, r3, 0x8000
     lis r31, bootinfo@ha
     addi r31, r31, bootinfo@l  # r31 = bootinfo

 /branches/tracing/kernel/arch/ppc32/src/ppc32.c
 ,7 → 35,7
 #include <config.h>
 #include <arch.h>
 #include <arch/boot/boot.h>
-#include <arch/drivers/cuda.h>
+#include <genarch/drivers/via-cuda/cuda.h>
 #include <arch/interrupt.h>
 #include <genarch/fb/fb.h>
 #include <genarch/fb/visuals.h>
 ,24 → 42,29
 #include <userspace.h>
 #include <proc/uarg.h>
 #include <console/console.h>
-#include <ddi/device.h>
 #include <ddi/irq.h>
 #include <arch/drivers/pic.h>
+#include <align.h>
+#include <macros.h>
+#include <string.h>
-#define IRQ_COUNT   64
+#define IRQ_COUNT  64
+#define IRQ_CUDA   10
 bootinfo_t bootinfo;
+/** Performs ppc32-specific initialization before main_bsp() is called. */
 void arch_pre_main(void)
 {
-    /* Setup usermode */
     init.cnt = bootinfo.taskmap.count;
     uint32_t i;
-    for (i = 0; i < bootinfo.taskmap.count; i++) {
+    for (i = 0; i < min3(bootinfo.taskmap.count, TASKMAP_MAX_RECORDS, CONFIG_INIT_TASKS); i++) {
         init.tasks[i].addr = PA2KA(bootinfo.taskmap.tasks[i].addr);
         init.tasks[i].size = bootinfo.taskmap.tasks[i].size;
+        str_cpy(init.tasks[i].name, CONFIG_TASK_NAME_BUFLEN,
+            bootinfo.taskmap.tasks[i].name);
     }
 }
 ,44 → 80,67
 void arch_post_mm_init(void)
 {
     if (config.cpu_active == 1) {
+#ifdef CONFIG_FB
         /* Initialize framebuffer */
-        unsigned int visual;
-        switch (bootinfo.screen.bpp) {
-        case 8:
-            visual = VISUAL_INDIRECT_8;
-            break;
-        case 16:
-            visual = VISUAL_RGB_5_5_5;
-            break;
-        case 24:
-            visual = VISUAL_RGB_8_8_8;
-            break;
-        case 32:
-            visual = VISUAL_RGB_0_8_8_8;
-            break;
-        default:
-            panic("Unsupported bits per pixel");
+        if (bootinfo.screen.addr) {
+            unsigned int visual;
+            switch (bootinfo.screen.bpp) {
+            case 8:
+                visual = VISUAL_INDIRECT_8;
+                break;
+            case 16:
+                visual = VISUAL_RGB_5_5_5;
+                break;
+            case 24:
+                visual = VISUAL_RGB_8_8_8;
+                break;
+            case 32:
+                visual = VISUAL_RGB_0_8_8_8;
+                break;
+            default:
+                panic("Unsupported bits per pixel.");
+            }
+            fb_properties_t prop = {
+                .addr = bootinfo.screen.addr,
+                .offset = 0,
+                .x = bootinfo.screen.width,
+                .y = bootinfo.screen.height,
+                .scan = bootinfo.screen.scanline,
+                .visual = visual,
+            };
+            fb_init(&prop);
         }
-        fb_properties_t prop = {
-            .addr = bootinfo.screen.addr,
-            .offset = 0,
-            .x = bootinfo.screen.width,
-            .y = bootinfo.screen.height,
-            .scan = bootinfo.screen.scanline,
-            .visual = visual,
-        };
-        fb_init(&prop);
+#endif
         /* Initialize IRQ routing */
         irq_init(IRQ_COUNT, IRQ_COUNT);
-        /* Initialize PIC */
-        pic_init(bootinfo.keyboard.addr, PAGE_SIZE);
-        /* Initialize I/O controller */
-        cuda_init(device_assign_devno(),
-            bootinfo.keyboard.addr + 0x16000, 2 * PAGE_SIZE);
+        if (bootinfo.macio.addr) {
+            /* Initialize PIC */
+            cir_t cir;
+            void *cir_arg;
+            pic_init(bootinfo.macio.addr, PAGE_SIZE, &cir, &cir_arg);
+#ifdef CONFIG_VIA_CUDA
+            uintptr_t pa = bootinfo.macio.addr + 0x16000;
+            uintptr_t aligned_addr = ALIGN_DOWN(pa, PAGE_SIZE);
+            size_t offset = pa - aligned_addr;
+            size_t size = 2 * PAGE_SIZE;
+            cuda_t *cuda = (cuda_t *)
+                (hw_map(aligned_addr, offset + size) + offset);
+            /* Initialize I/O controller */
+            cuda_instance_t *cuda_instance =
+                cuda_init(cuda, IRQ_CUDA, cir, cir_arg);
+            if (cuda_instance) {
+                indev_t *sink = stdin_wire();
+                cuda_wire(cuda_instance, sink);
+            }
+#endif
+        }
         /* Merge all zones to 1 big zone */
         zone_merge_all();
 ,8 → 171,7
         (uintptr_t) kernel_uarg->uspace_entry);
     /* Unreachable */
-    for (;;)
-        ;
+    while (true);
 }
 /** Acquire console back for kernel
 ,7 → 179,9
  */
 void arch_grab_console(void)
 {
-    cuda_grab();
+#ifdef CONFIG_FB
+    fb_redraw();
+#endif
 }
 /** Return console to userspace
 ,8 → 189,27
  */
 void arch_release_console(void)
 {
-    cuda_release();
 }
+/** 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)
+{
+    return addr;
+}
+void arch_reboot(void)
+{
+    // TODO
+    while (1);
+}
 /** @}
  */

 /branches/tracing/kernel/arch/ppc32/src/mm/tlb.c
 ,7 → 26,7
  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
  */
-/** @addtogroup ppc32mm
+/** @addtogroup ppc32mm
  * @{
  */
 /** @file
 ,9 → 39,18
 #include <mm/as.h>
 #include <arch.h>
 #include <print.h>
+#include <macros.h>
 #include <symtab.h>
+static unsigned int seed = 10;
+static unsigned int seed_real __attribute__ ((section("K_UNMAPPED_DATA_START"))) = 42;
+#define TLB_FLUSH \
+    "tlbie %0\n" \
+    "addi %0, %0, 0x1000\n"
 /** Try to find PTE for faulting address
  *
  * Try to find PTE for faulting address.
 ,7 → 75,7
      * Check if the mapping exists in page tables.
      */
     pte_t *pte = page_mapping_find(as, badvaddr);
-    if ((pte) && (pte->p)) {
+    if ((pte) && (pte->present)) {
         /*
          * Mapping found in page tables.
          * Immediately succeed.
 ,7 → 97,7
              */
             page_table_lock(as, lock);
             pte = page_mapping_find(as, badvaddr);
-            ASSERT((pte) && (pte->p));
+            ASSERT((pte) && (pte->present));
             *pfrc = 0;
             return pte;
         case AS_PF_DEFER:
 ,7 → 109,7
             *pfrc = rc;
             return NULL;
         default:
-            panic("unexpected rc (%d)\n", rc);
+            panic("Unexpected rc (%d).", rc);
         }
     }
 }
 ,25 → 117,20
 static void pht_refill_fail(uintptr_t badvaddr, istate_t *istate)
 {
-    char *symbol = "";
-    char *sym2 = "";
+    char *symbol;
+    char *sym2;
-    char *s = get_symtab_entry(istate->pc);
-    if (s)
-        symbol = s;
-    s = get_symtab_entry(istate->lr);
-    if (s)
-        sym2 = s;
+    symbol = symtab_fmt_name_lookup(istate->pc);
+    sym2 = symtab_fmt_name_lookup(istate->lr);
     fault_if_from_uspace(istate,
-        "%p: PHT Refill Exception at %p (%s<-%s)\n", badvaddr,
+        "PHT Refill Exception on %p.", badvaddr);
+    panic("%p: PHT Refill Exception at %p (%s<-%s).", badvaddr,
         istate->pc, symbol, sym2);
-    panic("%p: PHT Refill Exception at %p (%s<-%s)\n", badvaddr,
-        istate->pc, symbol, sym2);
 }
-static void pht_insert(const uintptr_t vaddr, const pfn_t pfn)
+static void pht_insert(const uintptr_t vaddr, const pte_t *pte)
 {
     uint32_t page = (vaddr >> 12) & 0xffff;
     uint32_t api = (vaddr >> 22) & 0x3f;
 ,11 → 156,12
     uint32_t i;
     bool found = false;
-    /* Find unused or colliding
-       PTE in PTEG */
+    /* Find colliding PTE in PTEG */
     for (i = 0; i < 8; i++) {
-        if ((!phte[base + i].v) || ((phte[base + i].vsid == vsid) &&
-            (phte[base + i].api == api))) {
+        if ((phte[base + i].v)
+            && (phte[base + i].vsid == vsid)
+            && (phte[base + i].api == api)
+            && (phte[base + i].h == 0)) {
             found = true;
             break;
         }
 ,86 → 168,25
     }
     if (!found) {
-        /* Secondary hash (not) */
-        uint32_t base2 = (~hash & 0x3ff) << 3;
-        /* Find unused or colliding
-           PTE in PTEG */
+        /* Find unused PTE in PTEG */
         for (i = 0; i < 8; i++) {
-            if ((!phte[base2 + i].v) ||
-                ((phte[base2 + i].vsid == vsid) &&
-                (phte[base2 + i].api == api))) {
+            if (!phte[base + i].v) {
                 found = true;
-                base = base2;
-                h = 1;
                 break;
             }
         }
-        if (!found) {
-            // TODO: A/C precedence groups
-            i = page % 8;
-        }
     }
-    phte[base + i].v = 1;
-    phte[base + i].vsid = vsid;
-    phte[base + i].h = h;
-    phte[base + i].api = api;
-    phte[base + i].rpn = pfn;
-    phte[base + i].r = 0;
-    phte[base + i].c = 0;
-    phte[base + i].pp = 2; // FIXME
-}
-static void pht_real_insert(const uintptr_t vaddr, const pfn_t pfn)
-{
-    uint32_t page = (vaddr >> 12) & 0xffff;
-    uint32_t api = (vaddr >> 22) & 0x3f;
-    uint32_t vsid;
-    asm volatile (
-        "mfsrin %0, %1\n"
-        : "=r" (vsid)
-        : "r" (vaddr)
-    );
-    uint32_t sdr1;
-    asm volatile (
-        "mfsdr1 %0\n"
-        : "=r" (sdr1)
-    );
-    phte_t *phte_physical = (phte_t *) (sdr1 & 0xffff0000);
-    /* Primary hash (xor) */
-    uint32_t h = 0;
-    uint32_t hash = vsid ^ page;
-    uint32_t base = (hash & 0x3ff) << 3;
-    uint32_t i;
-    bool found = false;
-    /* Find unused or colliding
-       PTE in PTEG */
-    for (i = 0; i < 8; i++) {
-        if ((!phte_physical[base + i].v) ||
-            ((phte_physical[base + i].vsid == vsid) &&
-            (phte_physical[base + i].api == api))) {
-            found = true;
-            break;
-        }
-    }
     if (!found) {
         /* Secondary hash (not) */
         uint32_t base2 = (~hash & 0x3ff) << 3;
-        /* Find unused or colliding
-           PTE in PTEG */
+        /* Find colliding PTE in PTEG */
         for (i = 0; i < 8; i++) {
-            if ((!phte_physical[base2 + i].v) ||
-                ((phte_physical[base2 + i].vsid == vsid) &&
-                (phte_physical[base2 + i].api == api))) {
+            if ((phte[base2 + i].v)
+                && (phte[base2 + i].vsid == vsid)
+                && (phte[base2 + i].api == api)
+                && (phte[base2 + i].h == 1)) {
                 found = true;
                 base = base2;
                 h = 1;
 ,26 → 195,37
         }
         if (!found) {
-            // TODO: A/C precedence groups
-            i = page % 8;
+            /* Find unused PTE in PTEG */
+            for (i = 0; i < 8; i++) {
+                if (!phte[base2 + i].v) {
+                    found = true;
+                    base = base2;
+                    h = 1;
+                    break;
+                }
+            }
         }
+        if (!found)
+            i = RANDI(seed) % 8;
     }
-    phte_physical[base + i].v = 1;
-    phte_physical[base + i].vsid = vsid;
-    phte_physical[base + i].h = h;
-    phte_physical[base + i].api = api;
-    phte_physical[base + i].rpn = pfn;
-    phte_physical[base + i].r = 0;
-    phte_physical[base + i].c = 0;
-    phte_physical[base + i].pp = 2; // FIXME
+    phte[base + i].v = 1;
+    phte[base + i].vsid = vsid;
+    phte[base + i].h = h;
+    phte[base + i].api = api;
+    phte[base + i].rpn = pte->pfn;
+    phte[base + i].r = 0;
+    phte[base + i].c = 0;
+    phte[base + i].wimg = (pte->page_cache_disable ? WIMG_NO_CACHE : 0);
+    phte[base + i].pp = 2; // FIXME
 }
-/** Process Instruction/Data Storage Interrupt
+/** Process Instruction/Data Storage Exception
  *
- * @param n     Interrupt vector number.
- * @param istate    Interrupted register context.
+ * @param n      Exception vector number.
+ * @param istate Interrupted register context.
  *
  */
 void pht_refill(int n, istate_t *istate)
 ,12 → 244,9
         lock = true;
     }
-    if (n == VECTOR_DATA_STORAGE) {
-        asm volatile (
-            "mfdar %0\n"
-            : "=r" (badvaddr)
-        );
-    } else
+    if (n == VECTOR_DATA_STORAGE)
+        badvaddr = istate->dar;
+    else
         badvaddr = istate->pc;
     page_table_lock(as, lock);
 ,12 → 266,12
             page_table_unlock(as, lock);
             return;
         default:
-            panic("Unexpected pfrc (%d)\n", pfrc);
+            panic("Unexpected pfrc (%d).", pfrc);
         }
     }
-    pte->a = 1; /* Record access to PTE */
-    pht_insert(badvaddr, pte->pfn);
+    pte->accessed = 1; /* Record access to PTE */
+    pht_insert(badvaddr, pte);
     page_table_unlock(as, lock);
     return;
 ,22 → 282,19
 }
-/** Process Instruction/Data Storage Interrupt in Real Mode
+/** Process Instruction/Data Storage Exception in Real Mode
  *
- * @param n     Interrupt vector number.
- * @param istate    Interrupted register context.
+ * @param n      Exception vector number.
+ * @param istate Interrupted register context.
  *
  */
-bool pht_real_refill(int n, istate_t *istate)
+bool pht_refill_real(int n, istate_t *istate)
 {
     uintptr_t badvaddr;
-    if (n == VECTOR_DATA_STORAGE) {
-        asm volatile (
-            "mfdar %0\n"
-            : "=r" (badvaddr)
-        );
-    } else
+    if (n == VECTOR_DATA_STORAGE)
+        badvaddr = istate->dar;
+    else
         badvaddr = istate->pc;
     uint32_t physmem;
 ,15 → 303,140
         : "=r" (physmem)
     );
-    if ((badvaddr >= PA2KA(0)) && (badvaddr < PA2KA(physmem))) {
-        pht_real_insert(badvaddr, KA2PA(badvaddr) >> 12);
-        return true;
+    if ((badvaddr < PA2KA(0)) || (badvaddr >= PA2KA(physmem)))
+        return false;
+    uint32_t page = (badvaddr >> 12) & 0xffff;
+    uint32_t api = (badvaddr >> 22) & 0x3f;
+    uint32_t vsid;
+    asm volatile (
+        "mfsrin %0, %1\n"
+        : "=r" (vsid)
+        : "r" (badvaddr)
+    );
+    uint32_t sdr1;
+    asm volatile (
+        "mfsdr1 %0\n"
+        : "=r" (sdr1)
+    );
+    phte_t *phte_real = (phte_t *) (sdr1 & 0xffff0000);
+    /* Primary hash (xor) */
+    uint32_t h = 0;
+    uint32_t hash = vsid ^ page;
+    uint32_t base = (hash & 0x3ff) << 3;
+    uint32_t i;
+    bool found = false;
+    /* Find colliding PTE in PTEG */
+    for (i = 0; i < 8; i++) {
+        if ((phte_real[base + i].v)
+            && (phte_real[base + i].vsid == vsid)
+            && (phte_real[base + i].api == api)
+            && (phte_real[base + i].h == 0)) {
+            found = true;
+            break;
+        }
     }
-    return false;
+    if (!found) {
+        /* Find unused PTE in PTEG */
+        for (i = 0; i < 8; i++) {
+            if (!phte_real[base + i].v) {
+                found = true;
+                break;
+            }
+        }
+    }
+    if (!found) {
+        /* Secondary hash (not) */
+        uint32_t base2 = (~hash & 0x3ff) << 3;
+        /* Find colliding PTE in PTEG */
+        for (i = 0; i < 8; i++) {
+            if ((phte_real[base2 + i].v)
+                && (phte_real[base2 + i].vsid == vsid)
+                && (phte_real[base2 + i].api == api)
+                && (phte_real[base2 + i].h == 1)) {
+                found = true;
+                base = base2;
+                h = 1;
+                break;
+            }
+        }
+        if (!found) {
+            /* Find unused PTE in PTEG */
+            for (i = 0; i < 8; i++) {
+                if (!phte_real[base2 + i].v) {
+                    found = true;
+                    base = base2;
+                    h = 1;
+                    break;
+                }
+            }
+        }
+        if (!found) {
+            /* Use secondary hash to avoid collisions
+               with usual PHT refill handler. */
+            i = RANDI(seed_real) % 8;
+            base = base2;
+            h = 1;
+        }
+    }
+    phte_real[base + i].v = 1;
+    phte_real[base + i].vsid = vsid;
+    phte_real[base + i].h = h;
+    phte_real[base + i].api = api;
+    phte_real[base + i].rpn = KA2PA(badvaddr) >> 12;
+    phte_real[base + i].r = 0;
+    phte_real[base + i].c = 0;
+    phte_real[base + i].wimg = 0;
+    phte_real[base + i].pp = 2; // FIXME
+    return true;
 }
+/** Process ITLB/DTLB Miss Exception in Real Mode
+ *
+ *
+ */
+void tlb_refill_real(int n, uint32_t tlbmiss, ptehi_t ptehi, ptelo_t ptelo, istate_t *istate)
+{
+    uint32_t badvaddr = tlbmiss & 0xfffffffc;
+    uint32_t physmem;
+    asm volatile (
+        "mfsprg3 %0\n"
+        : "=r" (physmem)
+    );
+    if ((badvaddr < PA2KA(0)) || (badvaddr >= PA2KA(physmem)))
+        return; // FIXME
+    ptelo.rpn = KA2PA(badvaddr) >> 12;
+    ptelo.wimg = 0;
+    ptelo.pp = 2; // FIXME
+    uint32_t index = 0;
+    asm volatile (
+        "mtspr 981, %0\n"
+        "mtspr 982, %1\n"
+        "tlbld %2\n"
+        "tlbli %2\n"
+        : "=r" (index)
+        : "r" (ptehi),
+          "r" (ptelo)
+    );
+}
 void tlb_arch_init(void)
 {
     tlb_invalidate_all();
 ,9 → 445,87
 void tlb_invalidate_all(void)
 {
+    uint32_t index;
     asm volatile (
-        "tlbia\n"
+        "li %0, 0\n"
+        "sync\n"
+        TLB_FLUSH
+        TLB_FLUSH
+        TLB_FLUSH
+        TLB_FLUSH
+        TLB_FLUSH
+        TLB_FLUSH
+        TLB_FLUSH
+        TLB_FLUSH
+        TLB_FLUSH
+        TLB_FLUSH
+        TLB_FLUSH
+        TLB_FLUSH
+        TLB_FLUSH
+        TLB_FLUSH
+        TLB_FLUSH
+        TLB_FLUSH
+        TLB_FLUSH
+        TLB_FLUSH
+        TLB_FLUSH
+        TLB_FLUSH
+        TLB_FLUSH
+        TLB_FLUSH
+        TLB_FLUSH
+        TLB_FLUSH
+        TLB_FLUSH
+        TLB_FLUSH
+        TLB_FLUSH
+        TLB_FLUSH
+        TLB_FLUSH
+        TLB_FLUSH
+        TLB_FLUSH
+        TLB_FLUSH
+        TLB_FLUSH
+        TLB_FLUSH
+        TLB_FLUSH
+        TLB_FLUSH
+        TLB_FLUSH
+        TLB_FLUSH
+        TLB_FLUSH
+        TLB_FLUSH
+        TLB_FLUSH
+        TLB_FLUSH
+        TLB_FLUSH
+        TLB_FLUSH
+        TLB_FLUSH
+        TLB_FLUSH
+        TLB_FLUSH
+        TLB_FLUSH
+        TLB_FLUSH
+        TLB_FLUSH
+        TLB_FLUSH
+        TLB_FLUSH
+        TLB_FLUSH
+        TLB_FLUSH
+        TLB_FLUSH
+        TLB_FLUSH
+        TLB_FLUSH
+        TLB_FLUSH
+        TLB_FLUSH
+        TLB_FLUSH
+        TLB_FLUSH
+        TLB_FLUSH
+        TLB_FLUSH
+        TLB_FLUSH
+        "eieio\n"
         "tlbsync\n"
+        "sync\n"
+        : "=r" (index)
     );
 }
 ,7 → 594,7
             : "=r" (vsid)
             : "r" (sr << 28)
         );
-        printf("vsid[%d]: VSID=%.*p (ASID=%d)%s%s\n", sr,
+        printf("sr[%02u]: vsid=%.*p (asid=%u)%s%s\n", sr,
             sizeof(vsid) * 2, vsid & 0xffffff, (vsid & 0xffffff) >> 4,
             ((vsid >> 30) & 1) ? " supervisor" : "",
             ((vsid >> 29) & 1) ? " user" : "");

 /branches/tracing/kernel/arch/ppc32/src/mm/frame.c
 ,7 → 74,7
         if (last_frame < ALIGN_UP(bootinfo.memmap.zones[i].start + bootinfo.memmap.zones[i].size, FRAME_SIZE))
             last_frame = ALIGN_UP(bootinfo.memmap.zones[i].start + bootinfo.memmap.zones[i].size, FRAME_SIZE);
     }
     /* First is exception vector, second is 'implementation specific',
        third and fourth is reserved, other contain real mode code */
     frame_mark_unavailable(0, 8);

 /branches/tracing/kernel/arch/ppc32/src/mm/page.c
 ,7 → 26,7
  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
  */
-/** @addtogroup ppc32mm
+/** @addtogroup ppc32mm
  * @{
  */
 /** @file
 ,7 → 49,7
 {
     if (last_frame + ALIGN_UP(size, PAGE_SIZE) >
         KA2PA(KERNEL_ADDRESS_SPACE_END_ARCH))
-        panic("Unable to map physical memory %p (%" PRIs " bytes)",
+        panic("Unable to map physical memory %p (%" PRIs " bytes).",
             physaddr, size)
     uintptr_t virtaddr = PA2KA(last_frame);

 /branches/tracing/kernel/arch/ppc32/src/dummy.s
 ,6 → 30,7
 .global asm_delay_loop
 .global sys_tls_set
+.global cpu_halt
 sys_tls_set:
     b sys_tls_set
 ,3 → 37,6
 asm_delay_loop:
     blr
+cpu_halt:
+    b cpu_halt

 /branches/tracing/kernel/arch/ppc32/src/interrupt.c
 ,7 → 60,6
     int inum;
     while ((inum = pic_get_pending()) != -1) {
-        bool ack = false;
         irq_t *irq = irq_dispatch_and_lock(inum);
         if (irq) {
             /*
 ,11 → 68,17
             if (irq->preack) {
                 /* Acknowledge the interrupt before processing */
-                pic_ack_interrupt(inum);
-                ack = true;
+                if (irq->cir)
+                    irq->cir(irq->cir_arg, irq->inr);
             }
-            irq->handler(irq, irq->arg);
+            irq->handler(irq);
+            if (!irq->preack) {
+                if (irq->cir)
+                    irq->cir(irq->cir_arg, irq->inr);
+            }
             spinlock_unlock(&irq->lock);
         } else {
             /*
 ,9 → 88,6
             printf("cpu%u: spurious interrupt (inum=%d)\n", CPU->id, inum);
 #endif
         }
-        if (!ack)
-            pic_ack_interrupt(inum);
     }
 }
 ,8 → 94,8
 static void exception_decrementer(int n, istate_t *istate)
 {
+    start_decrementer();
     clock();
-    start_decrementer();
 }
 #ifdef CONFIG_UDEBUG

 /branches/tracing/kernel/arch/ppc32/src/drivers/pic.c
 ,7 → 26,7
  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
  */
-/** @addtogroup ppc32
+/** @addtogroup ppc32
  * @{
  */
 /** @file
 ,53 → 38,61
 #include <byteorder.h>
 #include <bitops.h>
-static volatile uint32_t *pic;
+static volatile uint32_t *pic = NULL;
-void pic_init(uintptr_t base, size_t size)
+void pic_init(uintptr_t base, size_t size, cir_t *cir, void **cir_arg)
 {
     pic = (uint32_t *) hw_map(base, size);
+    *cir = pic_ack_interrupt;
+    *cir_arg = NULL;
 }
-void pic_enable_interrupt(int intnum)
+void pic_enable_interrupt(inr_t intnum)
 {
-    if (intnum < 32) {
-        pic[PIC_MASK_LOW] = pic[PIC_MASK_LOW] | (1 << intnum);
-    } else {
-        pic[PIC_MASK_HIGH] = pic[PIC_MASK_HIGH] | (1 << (intnum - 32));
+    if (pic) {
+        if (intnum < 32)
+            pic[PIC_MASK_LOW] = pic[PIC_MASK_LOW] | (1 << intnum);
+        else
+            pic[PIC_MASK_HIGH] = pic[PIC_MASK_HIGH] | (1 << (intnum - 32));
     }
 }
-void pic_disable_interrupt(int intnum)
+void pic_disable_interrupt(inr_t intnum)
 {
-    if (intnum < 32) {
-        pic[PIC_MASK_LOW] = pic[PIC_MASK_LOW] & (~(1 << intnum));
-    } else {
-        pic[PIC_MASK_HIGH] = pic[PIC_MASK_HIGH] & (~(1 << (intnum - 32)));
+    if (pic) {
+        if (intnum < 32)
+            pic[PIC_MASK_LOW] = pic[PIC_MASK_LOW] & (~(1 << intnum));
+        else
+            pic[PIC_MASK_HIGH] = pic[PIC_MASK_HIGH] & (~(1 << (intnum - 32)));
     }
 }
-void pic_ack_interrupt(int intnum)
+void pic_ack_interrupt(void *arg, inr_t intnum)
 {
-    if (intnum < 32)
-        pic[PIC_ACK_LOW] = 1 << intnum;
-    else
-        pic[PIC_ACK_HIGH] = 1 << (intnum - 32);
+    if (pic) {
+        if (intnum < 32)
+            pic[PIC_ACK_LOW] = 1 << intnum;
+        else
+            pic[PIC_ACK_HIGH] = 1 << (intnum - 32);
+    }
 }
 /** Return number of pending interrupt */
 int pic_get_pending(void)
 {
-    int pending;
-    pending = pic[PIC_PENDING_LOW];
-    if (pending)
-        return fnzb32(pending);
+    if (pic) {
+        int pending;
+        pending = pic[PIC_PENDING_LOW];
+        if (pending)
+            return fnzb32(pending);
+        pending = pic[PIC_PENDING_HIGH];
+        if (pending)
+            return fnzb32(pending) + 32;
+    }
-    pending = pic[PIC_PENDING_HIGH];
-    if (pending)
-        return fnzb32(pending) + 32;
     return -1;
 }

 /branches/tracing/kernel/arch/amd64/_link.ld.in
 ,8 → 43,6
         QUAD(unmapped_kdata_end - unmapped_kdata_start);
         *(COMMON);      /* global variables */
-        *(.eh_frame);
         symbol_table = .;
         *(symtab.*);            /* Symbol table, must be LAST symbol!*/
 ,6 → 50,10
         kdata_end = .;
     }
+    /DISCARD/ : {
+        *(*);
+    }
 #ifdef CONFIG_SMP
     _hardcoded_unmapped_size = (unmapped_ktext_end - unmapped_ktext_start) + (unmapped_kdata_end - unmapped_kdata_start);

/branches/tracing/kernel/arch/amd64/include/drivers/i8259.h
File deleted
\ No newline at end of file
Property changes:
Deleted: svn:special
-*
\ No newline at end of property

/branches/tracing/kernel/arch/amd64/include/drivers/i8042.h
File deleted
\ No newline at end of file
Property changes:
Deleted: svn:special
-*
\ No newline at end of property

/branches/tracing/kernel/arch/amd64/include/drivers/i8254.h
File deleted
\ No newline at end of file
Property changes:
Deleted: svn:special
-*
\ No newline at end of property

/branches/tracing/kernel/arch/amd64/include/drivers/ega.h
File deleted
\ No newline at end of file
Property changes:
Deleted: svn:special
-*
\ No newline at end of property

 /branches/tracing/kernel/arch/amd64/include/interrupt.h
 ,7 → 71,6
 /** This is passed to interrupt handlers */
 typedef struct {
     uint64_t rax;
-    uint64_t rbx;
     uint64_t rcx;
     uint64_t rdx;
     uint64_t rsi;
 ,11 → 79,6
     uint64_t r9;
     uint64_t r10;
     uint64_t r11;
-    uint64_t r12;
-    uint64_t r13;
-    uint64_t r14;
-    uint64_t r15;
-    uint64_t rbp;
     uint64_t error_word;
     uint64_t rip;
     uint64_t cs;

 /branches/tracing/kernel/arch/amd64/include/types.h
 ,7 → 26,7
  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
  */
-/** @addtogroup amd64
+/** @addtogroup amd64
  * @{
  */
 /** @file
 ,6 → 57,9
 typedef uint64_t unative_t;
 typedef int64_t native_t;
+typedef struct {
+} fncptr_t;
 /**< Formats for uintptr_t, size_t, count_t and index_t */
 #define PRIp "llx"
 #define PRIs "llu"

 /branches/tracing/kernel/arch/amd64/include/cpuid.h
 ,14 → 35,15
 #ifndef KERN_amd64_CPUID_H_
 #define KERN_amd64_CPUID_H_
-#define AMD_CPUID_EXTENDED   0x80000001
-#define AMD_EXT_NOEXECUTE    20
-#define AMD_EXT_LONG_MODE    29
+#define AMD_CPUID_EXTENDED  0x80000001
+#define AMD_EXT_NOEXECUTE   20
+#define AMD_EXT_LONG_MODE   29
-#define INTEL_CPUID_STANDARD 0x00000001
-#define INTEL_CPUID_EXTENDED 0x80000000
-#define INTEL_SSE2           26
-#define INTEL_FXSAVE         24
+#define INTEL_CPUID_LEVEL     0x00000000
+#define INTEL_CPUID_STANDARD  0x00000001
+#define INTEL_CPUID_EXTENDED  0x80000000
+#define INTEL_SSE2            26
+#define INTEL_FXSAVE          24
 #ifndef __ASM__

 /branches/tracing/kernel/arch/amd64/include/pm.h
 ,7 → 26,7
  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
  */
-/** @addtogroup amd64
+/** @addtogroup amd64
  * @{
  */
 /** @file
 ,63 → 36,60
 #define KERN_amd64_PM_H_
 #ifndef __ASM__
-#   include <arch/types.h>
-#   include <arch/context.h>
+    #include <arch/types.h>
+    #include <arch/context.h>
 #endif
-#define IDT_ITEMS 64
-#define GDT_ITEMS 8
+#define IDT_ITEMS  64
+#define GDT_ITEMS  8
-#define NULL_DES    0
-/* Warning: Do not reorder next items, unless you look into syscall.c!!! */
-#define KTEXT_DES   1
-#define KDATA_DES   2
-#define UDATA_DES   3
-#define UTEXT_DES   4
-#define KTEXT32_DES     5
-/* EndOfWarning */
-#define TSS_DES     6
+#define NULL_DES     0
+/* Warning: Do not reorder the following items, unless you look into syscall.c! */
+#define KTEXT_DES    1
+#define KDATA_DES    2
+#define UDATA_DES    3
+#define UTEXT_DES    4
+#define KTEXT32_DES  5
+/* End of warning */
+#define TSS_DES      6
 #ifdef CONFIG_FB
-#define VESA_INIT_DES       8
-#define VESA_INIT_SEGMENT 0x8000
-#undef GDT_ITEMS
-#define GDT_ITEMS 9
+#define VESA_INIT_DES      8
+#define VESA_INIT_SEGMENT  0x8000
-#endif /*CONFIG_FB*/
+#undef GDT_ITEMS
+#define GDT_ITEMS  9
+#endif /* CONFIG_FB */
+#define gdtselector(des)  ((des) << 3)
+#define idtselector(des)  ((des) << 4)
-#define gdtselector(des)    ((des) << 3)
-#define idtselector(des)    ((des) << 4)
+#define PL_KERNEL  0
+#define PL_USER    3
-#define PL_KERNEL   0
-#define PL_USER     3
+#define AR_PRESENT   ( 1 << 7)
+#define AR_DATA       (2 << 3)
+#define AR_CODE       (3 << 3)
+#define AR_WRITABLE   (1 << 1)
+#define AR_READABLE   (1 << 1)
+#define AR_TSS        (0x09)
+#define AR_INTERRUPT  (0x0e)
+#define AR_TRAP       (0x0f)
-#define AR_PRESENT  (1<<7)
-#define AR_DATA     (2<<3)
-#define AR_CODE     (3<<3)
-#define AR_WRITABLE (1<<1)
-#define AR_READABLE     (1<<1)
-#define AR_TSS      (0x9)
-#define AR_INTERRUPT    (0xe)
-#define AR_TRAP         (0xf)
+#define DPL_KERNEL  (PL_KERNEL << 5)
+#define DPL_USER    (PL_USER << 5)
-#define DPL_KERNEL  (PL_KERNEL<<5)
-#define DPL_USER    (PL_USER<<5)
+#define TSS_BASIC_SIZE  104
+#define TSS_IOMAP_SIZE  (16 * 1024 + 1)  /* 16K for bitmap + 1 terminating byte for convenience */
-#define TSS_BASIC_SIZE  104
-#define TSS_IOMAP_SIZE  (16*1024+1) /* 16K for bitmap + 1 terminating byte for convenience */
+#define IO_PORTS  (64 * 1024)
-#define IO_PORTS    (64*1024)
 #ifndef __ASM__
-struct descriptor {
+typedef struct {
     unsigned limit_0_15: 16;
     unsigned base_0_15: 16;
     unsigned base_16_23: 8;
 ,10 → 100,9
     unsigned special: 1;
     unsigned granularity : 1;
     unsigned base_24_31: 8;
-} __attribute__ ((packed));
-typedef struct descriptor descriptor_t;
+} __attribute__ ((packed)) descriptor_t;
-struct tss_descriptor {
+typedef struct {
     unsigned limit_0_15: 16;
     unsigned base_0_15: 16;
     unsigned base_16_23: 8;
 ,10 → 117,9
     unsigned base_24_31: 8;
     unsigned base_32_63 : 32;
     unsigned  : 32;
-} __attribute__ ((packed));
-typedef struct tss_descriptor tss_descriptor_t;
+} __attribute__ ((packed)) tss_descriptor_t;
-struct idescriptor {
+typedef struct {
     unsigned offset_0_15: 16;
     unsigned selector: 16;
     unsigned ist:3;
 ,22 → 130,19
     unsigned offset_16_31: 16;
     unsigned offset_32_63: 32;
     unsigned  : 32;
-} __attribute__ ((packed));
-typedef struct idescriptor idescriptor_t;
+} __attribute__ ((packed)) idescriptor_t;
-struct ptr_16_64 {
+typedef struct {
     uint16_t limit;
     uint64_t base;
-} __attribute__ ((packed));
-typedef struct ptr_16_64 ptr_16_64_t;
+} __attribute__ ((packed)) ptr_16_64_t;
-struct ptr_16_32 {
+typedef struct {
     uint16_t limit;
     uint32_t base;
-} __attribute__ ((packed));
-typedef struct ptr_16_32 ptr_16_32_t;
+} __attribute__ ((packed)) ptr_16_32_t;
-struct tss {
+typedef struct {
     uint32_t reserve1;
     uint64_t rsp0;
     uint64_t rsp1;
 ,8 → 159,7
     uint16_t reserve4;
     uint16_t iomap_base;
     uint8_t iomap[TSS_IOMAP_SIZE];
-} __attribute__ ((packed));
-typedef struct tss tss_t;
+} __attribute__ ((packed)) tss_t;
 extern tss_t *tss_p;

 /branches/tracing/kernel/arch/amd64/include/atomic.h
 ,7 → 26,7
  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
  */
-/** @addtogroup amd64
+/** @addtogroup amd64
  * @{
  */
 /** @file
 ,17 → 41,29
 static inline void atomic_inc(atomic_t *val) {
 #ifdef CONFIG_SMP
-    asm volatile ("lock incq %0\n" : "+m" (val->count));
+    asm volatile (
+        "lock incq %[count]\n"
+        : [count] "+m" (val->count)
+    );
 #else
-    asm volatile ("incq %0\n" : "+m" (val->count));
+    asm volatile (
+        "incq %[count]\n"
+        : [count] "+m" (val->count)
+    );
 #endif /* CONFIG_SMP */
 }
 static inline void atomic_dec(atomic_t *val) {
 #ifdef CONFIG_SMP
-    asm volatile ("lock decq %0\n" : "+m" (val->count));
+    asm volatile (
+        "lock decq %[count]\n"
+        : [count] "+m" (val->count)
+    );
 #else
-    asm volatile ("decq %0\n" : "+m" (val->count));
+    asm volatile (
+        "decq %[count]\n"
+        : [count] "+m" (val->count)
+    );
 #endif /* CONFIG_SMP */
 }
 ,12 → 70,12
 static inline long atomic_postinc(atomic_t *val)
 {
     long r = 1;
     asm volatile (
-        "lock xaddq %1, %0\n"
-        : "+m" (val->count), "+r" (r)
+        "lock xaddq %[r], %[count]\n"
+        : [count] "+m" (val->count), [r] "+r" (r)
     );
     return r;
 }
 ,23 → 84,23
     long r = -1;
     asm volatile (
-        "lock xaddq %1, %0\n"
-        : "+m" (val->count), "+r" (r)
+        "lock xaddq %[r], %[count]\n"
+        : [count] "+m" (val->count), [r] "+r" (r)
     );
     return r;
 }
-#define atomic_preinc(val) (atomic_postinc(val) + 1)
-#define atomic_predec(val) (atomic_postdec(val) - 1)
+#define atomic_preinc(val)  (atomic_postinc(val) + 1)
+#define atomic_predec(val)  (atomic_postdec(val) - 1)
 static inline uint64_t test_and_set(atomic_t *val) {
     uint64_t v;
     asm volatile (
-        "movq $1, %0\n"
-        "xchgq %0, %1\n"
-        : "=r" (v), "+m" (val->count)
+        "movq $1, %[v]\n"
+        "xchgq %[v], %[count]\n"
+        : [v] "=r" (v), [count] "+m" (val->count)
     );
     return v;
 ,7 → 111,7
 static inline void atomic_lock_arch(atomic_t *val)
 {
     uint64_t tmp;
     preemption_disable();
     asm volatile (
         "0:\n"
 ,15 → 118,15
 #ifdef CONFIG_HT
         "pause\n"
 #endif
-        "mov %0, %1\n"
-        "testq %1, %1\n"
+        "mov %[count], %[tmp]\n"
+        "testq %[tmp], %[tmp]\n"
         "jnz 0b\n"       /* lightweight looping on locked spinlock */
-        "incq %1\n"      /* now use the atomic operation */
-        "xchgq %0, %1\n"
-        "testq %1, %1\n"
+        "incq %[tmp]\n"  /* now use the atomic operation */
+        "xchgq %[count], %[tmp]\n"
+        "testq %[tmp], %[tmp]\n"
         "jnz 0b\n"
-                : "+m" (val->count), "=&r" (tmp)
+        : [count] "+m" (val->count), [tmp] "=&r" (tmp)
     );
     /*
      * Prevent critical section code from bleeding out this way up.

 /branches/tracing/kernel/arch/amd64/include/boot/boot.h
 ,8 → 42,17
 #define MULTIBOOT_HEADER_MAGIC  0x1BADB002
 #define MULTIBOOT_HEADER_FLAGS  0x00010003
-#define MULTIBOOT_LOADER_MAGIC  0x2BADB002
+#ifndef __ASM__
+#ifdef CONFIG_SMP
+/* This is only a symbol so the type is dummy. Obtain the value using &. */
+extern int _hardcoded_unmapped_size;
+#endif /* CONFIG_SMP */
+#endif /* __ASM__ */
 #endif
 /** @}

 /branches/tracing/kernel/arch/amd64/include/arch.h
 ,6 → 35,10
 #ifndef KERN_amd64_ARCH_H_
 #define KERN_amd64_ARCH_H_
+#include <genarch/multiboot/multiboot.h>
+extern void arch_pre_main(uint32_t, const multiboot_info_t *);
 #endif
 /** @}

 /branches/tracing/kernel/arch/amd64/include/asm.h
 ,7 → 26,7
  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
  */
-/** @addtogroup amd64
+/** @addtogroup amd64
  * @{
  */
 /** @file
 ,6 → 36,8
 #define KERN_amd64_ASM_H_
 #include <config.h>
+#include <arch/types.h>
+#include <typedefs.h>
 extern void asm_delay_loop(uint32_t t);
 extern void asm_fake_loop(uint32_t t);
 ,12 → 47,17
  * Return the base address of the current stack.
  * The stack is assumed to be STACK_SIZE bytes long.
  * The stack must start on page boundary.
+ *
  */
 static inline uintptr_t get_stack_base(void)
 {
     uintptr_t v;
-    asm volatile ("andq %%rsp, %0\n" : "=r" (v) : "0" (~((uint64_t)STACK_SIZE-1)));
+    asm volatile (
+        "andq %%rsp, %[v]\n"
+        : [v] "=r" (v)
+        : "0" (~((uint64_t) STACK_SIZE-1))
+    );
     return v;
 }
 ,7 → 69,11
 static inline void cpu_halt(void)
 {
-    asm volatile ("hlt\n");
+    asm volatile (
+        "0:\n"
+        "   hlt\n"
+        "   jmp 0b\n"
+    );
 }
 ,15 → 83,63
  *
  * @param port Port to read from
  * @return Value read
+ *
  */
-static inline uint8_t inb(uint16_t port)
+static inline uint8_t pio_read_8(ioport8_t *port)
 {
     uint8_t val;
+    asm volatile (
+        "inb %w[port], %b[val]\n"
+        : [val] "=a" (val)
+        : [port] "d" (port)
+    );
+    return val;
+}
-    asm volatile ("inb %w1, %b0 \n" : "=a" (val) : "d" (port));
+/** Word from port
+ *
+ * Get word from port
+ *
+ * @param port Port to read from
+ * @return Value read
+ *
+ */
+static inline uint16_t pio_read_16(ioport16_t *port)
+{
+    uint16_t val;
+    asm volatile (
+        "inw %w[port], %w[val]\n"
+        : [val] "=a" (val)
+        : [port] "d" (port)
+    );
     return val;
 }
+/** Double word from port
+ *
+ * Get double word from port
+ *
+ * @param port Port to read from
+ * @return Value read
+ *
+ */
+static inline uint32_t pio_read_32(ioport32_t *port)
+{
+    uint32_t val;
+    asm volatile (
+        "inl %w[port], %[val]\n"
+        : [val] "=a" (val)
+        : [port] "d" (port)
+    );
+    return val;
+}
 /** Byte to port
  *
  * Output byte to port
 ,12 → 146,48
  *
  * @param port Port to write to
  * @param val Value to write
+ *
  */
-static inline void outb(uint16_t port, uint8_t val)
+static inline void pio_write_8(ioport8_t *port, uint8_t val)
 {
-    asm volatile ("outb %b0, %w1\n" : : "a" (val), "d" (port));
+    asm volatile (
+        "outb %b[val], %w[port]\n"
+        :: [val] "a" (val), [port] "d" (port)
+    );
 }
+/** Word to port
+ *
+ * Output word to port
+ *
+ * @param port Port to write to
+ * @param val Value to write
+ *
+ */
+static inline void pio_write_16(ioport16_t *port, uint16_t val)
+{
+    asm volatile (
+        "outw %w[val], %w[port]\n"
+        :: [val] "a" (val), [port] "d" (port)
+    );
+}
+/** Double word to port
+ *
+ * Output double word to port
+ *
+ * @param port Port to write to
+ * @param val Value to write
+ *
+ */
+static inline void pio_write_32(ioport32_t *port, uint32_t val)
+{
+    asm volatile (
+        "outl %[val], %w[port]\n"
+        :: [val] "a" (val), [port] "d" (port)
+    );
+}
 /** Swap Hidden part of GS register with visible one */
 static inline void swapgs(void)
 {
 ,15 → 200,18
  * value of EFLAGS.
  *
  * @return Old interrupt priority level.
+ *
  */
 static inline ipl_t interrupts_enable(void) {
     ipl_t v;
-    __asm__ volatile (
+    asm volatile (
         "pushfq\n"
-        "popq %0\n"
+        "popq %[v]\n"
         "sti\n"
-        : "=r" (v)
+        : [v] "=r" (v)
     );
     return v;
 }
 ,15 → 221,18
  * value of EFLAGS.
  *
  * @return Old interrupt priority level.
+ *
  */
 static inline ipl_t interrupts_disable(void) {
     ipl_t v;
-    __asm__ volatile (
+    asm volatile (
         "pushfq\n"
-        "popq %0\n"
+        "popq %[v]\n"
         "cli\n"
-        : "=r" (v)
-        );
+        : [v] "=r" (v)
+    );
     return v;
 }
 ,13 → 241,14
  * Restore EFLAGS.
  *
  * @param ipl Saved interrupt priority level.
+ *
  */
 static inline void interrupts_restore(ipl_t ipl) {
-    __asm__ volatile (
-        "pushq %0\n"
+    asm volatile (
+        "pushq %[ipl]\n"
         "popfq\n"
-        : : "r" (ipl)
-        );
+        :: [ipl] "r" (ipl)
+    );
 }
 /** Return interrupt priority level.
 ,14 → 256,17
  * Return EFLAFS.
  *
  * @return Current interrupt priority level.
+ *
  */
 static inline ipl_t interrupts_read(void) {
     ipl_t v;
-    __asm__ volatile (
+    asm volatile (
         "pushfq\n"
-        "popq %0\n"
-        : "=r" (v)
+        "popq %[v]\n"
+        : [v] "=r" (v)
     );
     return v;
 }
 ,21 → 273,25
 /** Write to MSR */
 static inline void write_msr(uint32_t msr, uint64_t value)
 {
-    __asm__ volatile (
-        "wrmsr;" : : "c" (msr),
-        "a" ((uint32_t)(value)),
-        "d" ((uint32_t)(value >> 32))
-        );
+    asm volatile (
+        "wrmsr\n"
+        :: "c" (msr),
+           "a" ((uint32_t) (value)),
+           "d" ((uint32_t) (value >> 32))
+    );
 }
 static inline unative_t read_msr(uint32_t msr)
 {
     uint32_t ax, dx;
-    __asm__ volatile (
-        "rdmsr;" : "=a"(ax), "=d"(dx) : "c" (msr)
-        );
-    return ((uint64_t)dx << 32) | ax;
+    asm volatile (
+        "rdmsr\n"
+        : "=a" (ax), "=d" (dx)
+        : "c" (msr)
+    );
+    return ((uint64_t) dx << 32) | ax;
 }
 ,29 → 298,29
 /** Enable local APIC
  *
  * Enable local APIC in MSR.
+ *
  */
 static inline void enable_l_apic_in_msr()
 {
-    __asm__ volatile (
+    asm volatile (
         "movl $0x1b, %%ecx\n"
         "rdmsr\n"
-        "orl $(1<<11),%%eax\n"
+        "orl $(1 << 11),%%eax\n"
         "orl $(0xfee00000),%%eax\n"
         "wrmsr\n"
-        :
-        :
-        :"%eax","%ecx","%edx"
-        );
+        ::: "%eax","%ecx","%edx"
+    );
 }
 static inline uintptr_t * get_ip()
 {
     uintptr_t *ip;
-    __asm__ volatile (
-        "mov %%rip, %0"
-        : "=r" (ip)
-        );
+    asm volatile (
+        "mov %%rip, %[ip]"
+        : [ip] "=r" (ip)
+    );
     return ip;
 }
 ,59 → 327,84
 /** Invalidate TLB Entry.
  *
  * @param addr Address on a page whose TLB entry is to be invalidated.
+ *
  */
 static inline void invlpg(uintptr_t addr)
 {
-    __asm__ volatile ("invlpg %0\n" :: "m" (*((unative_t *)addr)));
+    asm volatile (
+        "invlpg %[addr]\n"
+        :: [addr] "m" (*((unative_t *) addr))
+    );
 }
 /** Load GDTR register from memory.
  *
  * @param gdtr_reg Address of memory from where to load GDTR.
+ *
  */
-static inline void gdtr_load(struct ptr_16_64 *gdtr_reg)
+static inline void gdtr_load(ptr_16_64_t *gdtr_reg)
 {
-    __asm__ volatile ("lgdtq %0\n" : : "m" (*gdtr_reg));
+    asm volatile (
+        "lgdtq %[gdtr_reg]\n"
+        :: [gdtr_reg] "m" (*gdtr_reg)
+    );
 }
 /** Store GDTR register to memory.
  *
  * @param gdtr_reg Address of memory to where to load GDTR.
+ *
  */
-static inline void gdtr_store(struct ptr_16_64 *gdtr_reg)
+static inline void gdtr_store(ptr_16_64_t *gdtr_reg)
 {
-    __asm__ volatile ("sgdtq %0\n" : : "m" (*gdtr_reg));
+    asm volatile (
+        "sgdtq %[gdtr_reg]\n"
+        :: [gdtr_reg] "m" (*gdtr_reg)
+    );
 }
 /** Load IDTR register from memory.
  *
  * @param idtr_reg Address of memory from where to load IDTR.
+ *
  */
-static inline void idtr_load(struct ptr_16_64 *idtr_reg)
+static inline void idtr_load(ptr_16_64_t *idtr_reg)
 {
-    __asm__ volatile ("lidtq %0\n" : : "m" (*idtr_reg));
+    asm volatile (
+        "lidtq %[idtr_reg]\n"
+        :: [idtr_reg] "m" (*idtr_reg));
 }
 /** Load TR from descriptor table.
  *
  * @param sel Selector specifying descriptor of TSS segment.
+ *
  */
 static inline void tr_load(uint16_t sel)
 {
-    __asm__ volatile ("ltr %0" : : "r" (sel));
+    asm volatile (
+        "ltr %[sel]"
+        :: [sel] "r" (sel)
+    );
 }
 #define GEN_READ_REG(reg) static inline unative_t read_ ##reg (void) \
-    { \
-    unative_t res; \
-    __asm__ volatile ("movq %%" #reg ", %0" : "=r" (res) ); \
-    return res; \
-    }
+    { \
+        unative_t res; \
+        asm volatile ( \
+            "movq %%" #reg ", %[res]" \
+            : [res] "=r" (res) \
+        ); \
+        return res; \
+    }
 #define GEN_WRITE_REG(reg) static inline void write_ ##reg (unative_t regn) \
-    { \
-    __asm__ volatile ("movq %0, %%" #reg : : "r" (regn)); \
-    }
+    { \
+        asm volatile ( \
+            "movq %[regn], %%" #reg \
+            :: [regn] "r" (regn) \
+        ); \
+    }
 GEN_READ_REG(cr0)
 GEN_READ_REG(cr2)

 /branches/tracing/kernel/arch/amd64/include/mm/frame.h
 ,7 → 26,7
  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
  */
-/** @addtogroup amd64mm
+/** @addtogroup amd64mm
  * @{
  */
 /** @file
 ,8 → 39,8
 #include <arch/types.h>
 #endif /* __ASM__ */
-#define FRAME_WIDTH     12  /* 4K */
-#define FRAME_SIZE      (1 << FRAME_WIDTH)
+#define FRAME_WIDTH  12  /* 4K */
+#define FRAME_SIZE   (1 << FRAME_WIDTH)
 #ifndef __ASM__
 extern uintptr_t last_frame;

 /branches/tracing/kernel/arch/amd64/include/mm/tlb.h
 ,9 → 35,6
 #ifndef KERN_amd64_TLB_H_
 #define KERN_amd64_TLB_H_
-#define tlb_arch_init()
-#define tlb_print()
 #endif
 /** @}

 /branches/tracing/kernel/arch/amd64/include/cpu.h
 ,9 → 35,9
 #ifndef KERN_amd64_CPU_H_
 #define KERN_amd64_CPU_H_
-#define RFLAGS_IF   (1 << 9)
-#define RFLAGS_DF   (1 << 10)
-#define RFLAGS_RF   (1 << 16)
+#define RFLAGS_IF  (1 << 9)
+#define RFLAGS_DF  (1 << 10)
+#define RFLAGS_RF  (1 << 16)
 #define EFER_MSR_NUM    0xc0000080
 #define AMD_SCE_FLAG    0
 ,17 → 62,15
     int family;
     int model;
     int stepping;
-    struct tss *tss;
+    tss_t *tss;
-    count_t iomapver_copy;  /** Copy of TASK's I/O Permission bitmap generation count. */
+    count_t iomapver_copy;  /** Copy of TASK's I/O Permission bitmap generation count. */
 } cpu_arch_t;
 struct star_msr {
 };
 struct lstar_msr {
 };
 extern void set_efer_flag(int flag);

 /branches/tracing/kernel/arch/amd64/Makefile.inc
 ,10 → 29,6
 ## Toolchain configuration
 #
-ifndef CROSS_PREFIX
-    CROSS_PREFIX = /usr/local
-endif
 BFD_NAME = elf64-x86-64
 BFD_ARCH = i386:x86-64
 BFD = binary
 ,83 → 41,50
 ICC_CFLAGS += $(CMN1)
 SUNCC_CFLAGS += -m64 -xmodel=kernel
-DEFS += -DMACHINE=$(MACHINE) -D__64_BITS__
+DEFS += -D__64_BITS__
 ## Accepted CPUs
 #
-ifeq ($(MACHINE),opteron)
+ifeq ($(PROCESSOR),opteron)
     CMN2 := -march=opteron
     GCC_CFLAGS += $(CMN2)
     ICC_CFLAGS += $(CMN2)
     SUNCC_CFLAGS += -xtarget=opteron
-    DEFS += -DFENCES=p4
 endif
-## Own configuration directives
-#
-CONFIG_ACPI = y
-## Compile with hierarchical page tables support.
-#
-CONFIG_PAGE_PT = y
-DEFS += -DCONFIG_PAGE_PT
-## Compile with i8042 support.
-#
-CONFIG_I8042 = y
-DEFS += -DCONFIG_I8042
-## Accepted configuration directives
-#
-ifeq ($(CONFIG_SMP),y)
-    DEFS += -DCONFIG_SMP
-endif
-ifeq ($(CONFIG_HT),y)
-    DEFS += -DCONFIG_HT
-endif
-ifeq ($(CONFIG_SIMICS_FIX),y)
-    DEFS += -DCONFIG_SIMICS_FIX
-endif
 ARCH_SOURCES = \
-    arch/$(ARCH)/src/fpu_context.c \
-    arch/$(ARCH)/src/boot/boot.S \
-    arch/$(ARCH)/src/boot/memmap.c \
-    arch/$(ARCH)/src/pm.c \
-    arch/$(ARCH)/src/context.S \
-    arch/$(ARCH)/src/ddi/ddi.c \
-    arch/$(ARCH)/src/drivers/ega.c \
-    arch/$(ARCH)/src/drivers/vesa.c \
-    arch/$(ARCH)/src/drivers/i8254.c \
-    arch/$(ARCH)/src/drivers/i8259.c \
-    arch/$(ARCH)/src/delay.S \
-    arch/$(ARCH)/src/amd64.c \
-    arch/$(ARCH)/src/bios/bios.c \
-    arch/$(ARCH)/src/interrupt.c \
-    arch/$(ARCH)/src/mm/as.c \
-    arch/$(ARCH)/src/mm/frame.c \
-    arch/$(ARCH)/src/mm/page.c \
-    arch/$(ARCH)/src/mm/tlb.c \
-    arch/$(ARCH)/src/asm_utils.S \
-    arch/$(ARCH)/src/cpu/cpu.c \
-    arch/$(ARCH)/src/proc/scheduler.c \
-    arch/$(ARCH)/src/proc/task.c \
-    arch/$(ARCH)/src/proc/thread.c \
-    arch/$(ARCH)/src/userspace.c \
-    arch/$(ARCH)/src/syscall.c \
-    arch/$(ARCH)/src/debugger.c
+    arch/$(KARCH)/src/fpu_context.c \
+    arch/$(KARCH)/src/boot/boot.S \
+    arch/$(KARCH)/src/boot/memmap.c \
+    arch/$(KARCH)/src/pm.c \
+    arch/$(KARCH)/src/context.S \
+    arch/$(KARCH)/src/ddi/ddi.c \
+    arch/$(KARCH)/src/drivers/vesa.c \
+    arch/$(KARCH)/src/drivers/i8254.c \
+    arch/$(KARCH)/src/drivers/i8259.c \
+    arch/$(KARCH)/src/delay.S \
+    arch/$(KARCH)/src/amd64.c \
+    arch/$(KARCH)/src/bios/bios.c \
+    arch/$(KARCH)/src/interrupt.c \
+    arch/$(KARCH)/src/mm/as.c \
+    arch/$(KARCH)/src/mm/frame.c \
+    arch/$(KARCH)/src/mm/page.c \
+    arch/$(KARCH)/src/mm/tlb.c \
+    arch/$(KARCH)/src/asm_utils.S \
+    arch/$(KARCH)/src/cpu/cpu.c \
+    arch/$(KARCH)/src/proc/scheduler.c \
+    arch/$(KARCH)/src/proc/task.c \
+    arch/$(KARCH)/src/proc/thread.c \
+    arch/$(KARCH)/src/userspace.c \
+    arch/$(KARCH)/src/syscall.c \
+    arch/$(KARCH)/src/debugger.c
 ifeq ($(CONFIG_SMP),y)
     ARCH_SOURCES += \
-        arch/$(ARCH)/src/smp/ap.S \
-        arch/$(ARCH)/src/smp/apic.c \
-        arch/$(ARCH)/src/smp/ipi.c \
-        arch/$(ARCH)/src/smp/mps.c \
-        arch/$(ARCH)/src/smp/smp.c
+        arch/$(KARCH)/src/smp/ap.S \
+        arch/$(KARCH)/src/smp/apic.c \
+        arch/$(KARCH)/src/smp/ipi.c \
+        arch/$(KARCH)/src/smp/mps.c \
+        arch/$(KARCH)/src/smp/smp.c
 endif

 /branches/tracing/kernel/arch/amd64/src/fpu_context.c
 ,9 → 39,9
 void fpu_context_save(fpu_context_t *fctx)
 {
     asm volatile (
-        "fxsave %0"
-        : "=m"(*fctx)
-        );
+        "fxsave %[fctx]\n"
+        : [fctx] "=m" (*fctx)
+    );
 }
 /** Restore FPU (mmx,sse) context using fxrstor instruction */
 ,9 → 48,9
 void fpu_context_restore(fpu_context_t *fctx)
 {
     asm volatile (
-        "fxrstor %0"
-        : "=m"(*fctx)
-        );
+        "fxrstor %[fctx]\n"
+        : [fctx] "=m" (*fctx)
+    );
 }
 void fpu_init()
 ,7 → 57,7
 {
     /* TODO: Zero all SSE, MMX etc. registers */
     asm volatile (
-        "fninit;"
+        "fninit\n"
     );
 }

 /branches/tracing/kernel/arch/amd64/src/cpu/cpu.c
 ,21 → 77,19
 void cpu_setup_fpu(void)
 {
     asm volatile (
-        "movq %%cr0, %%rax;"
-        "btsq $1, %%rax;" /* cr0.mp */
-        "btrq $2, %%rax;"  /* cr0.em */
-        "movq %%rax, %%cr0;"
-        "movq %%cr4, %%rax;"
-        "bts $9, %%rax;" /* cr4.osfxsr */
-        "movq %%rax, %%cr4;"
-        :
-        :
-        :"%rax"
-        );
+        "movq %%cr0, %%rax\n"
+        "btsq $1, %%rax\n"  /* cr0.mp */
+        "btrq $2, %%rax\n"  /* cr0.em */
+        "movq %%rax, %%cr0\n"
+        "movq %%cr4, %%rax\n"
+        "bts $9, %%rax\n"   /* cr4.osfxsr */
+        "movq %%rax, %%cr4\n"
+        ::: "%rax"
+    );
 }
-/** Set the TS flag to 1.
+/** Set the TS flag to 1.
  *
  * If a thread accesses coprocessor, exception is run, which
  * does a lazy fpu context switch.
 ,26 → 97,22
  */
 void fpu_disable(void)
 {
-    asm volatile (
-        "mov %%cr0,%%rax;"
-        "bts $3,%%rax;"
-        "mov %%rax,%%cr0;"
-        :
-        :
-        :"%rax"
-        );
+    asm volatile (
+        "mov %%cr0, %%rax\n"
+        "bts $3, %%rax\n"
+        "mov %%rax, %%cr0\n"
+        ::: "%rax"
+    );
 }
 void fpu_enable(void)
 {
-    asm volatile (
-        "mov %%cr0,%%rax;"
-        "btr $3,%%rax;"
-        "mov %%rax,%%cr0;"
-        :
-        :
-        :"%rax"
-        );
+    asm volatile (
+        "mov %%cr0, %%rax\n"
+        "btr $3, %%rax\n"
+        "mov %%rax, %%cr0\n"
+        ::: "%rax"
+    );
 }
 void cpu_arch_init(void)

 /branches/tracing/kernel/arch/amd64/src/amd64.c
 ,11 → 39,15
 #include <config.h>
 #include <proc/thread.h>
-#include <arch/drivers/ega.h>
+#include <genarch/multiboot/multiboot.h>
+#include <genarch/drivers/legacy/ia32/io.h>
+#include <genarch/drivers/ega/ega.h>
 #include <arch/drivers/vesa.h>
-#include <genarch/kbd/i8042.h>
+#include <genarch/drivers/i8042/i8042.h>
+#include <genarch/kbrd/kbrd.h>
 #include <arch/drivers/i8254.h>
 #include <arch/drivers/i8259.h>
+#include <arch/boot/boot.h>
 #ifdef CONFIG_SMP
 #include <arch/smp/apic.h>
 ,9 → 65,8
 #include <syscall/syscall.h>
 #include <console/console.h>
 #include <ddi/irq.h>
-#include <ddi/device.h>
+#include <sysinfo/sysinfo.h>
 /** Disable I/O on non-privileged levels
  *
  * Clean IOPL(12,13) and NT(14) flags in EFLAGS register
 ,15 → 73,13
  */
 static void clean_IOPL_NT_flags(void)
 {
-    asm (
+    asm volatile (
         "pushfq\n"
         "pop %%rax\n"
         "and $~(0x7000), %%rax\n"
         "pushq %%rax\n"
         "popfq\n"
-        :
-        :
-        : "%rax"
+        ::: "%rax"
     );
 }
 ,16 → 89,31
  */
 static void clean_AM_flag(void)
 {
-    asm (
+    asm volatile (
         "mov %%cr0, %%rax\n"
         "and $~(0x40000), %%rax\n"
         "mov %%rax, %%cr0\n"
-        :
-        :
-        : "%rax"
+        ::: "%rax"
     );
 }
+/** Perform amd64-specific initialization before main_bsp() is called.
+ *
+ * @param signature Should contain the multiboot signature.
+ * @param mi        Pointer to the multiboot information structure.
+ */
+void arch_pre_main(uint32_t signature, const multiboot_info_t *mi)
+{
+    /* Parse multiboot information obtained from the bootloader. */
+    multiboot_info_parse(signature, mi);
+#ifdef CONFIG_SMP
+    /* Copy AP bootstrap routines below 1 MB. */
+    memcpy((void *) AP_BOOT_OFFSET, (void *) BOOT_OFFSET,
+        (size_t) &_hardcoded_unmapped_size);
+#endif
+}
 void arch_pre_mm_init(void)
 {
     /* Enable no-execute pages */
 ,13 → 149,17
         /* hard clock */
         i8254_init();
 #ifdef CONFIG_FB
         if (vesa_present())
             vesa_init();
         else
 #endif
-            ega_init(); /* video */
+#ifdef CONFIG_EGA
+            ega_init(EGA_BASE, EGA_VIDEORAM);  /* video */
+#else
+            {}
+#endif
         /* Enable debugger */
         debugger_init();
 ,8 → 192,33
 void arch_post_smp_init(void)
 {
-    /* keyboard controller */
-    i8042_init(device_assign_devno(), IRQ_KBD, device_assign_devno(), IRQ_MOUSE);
+#ifdef CONFIG_PC_KBD
+    /*
+     * Initialize the i8042 controller. Then initialize the keyboard
+     * module and connect it to i8042. Enable keyboard interrupts.
+     */
+    i8042_instance_t *i8042_instance = i8042_init((i8042_t *) I8042_BASE, IRQ_KBD);
+    if (i8042_instance) {
+        kbrd_instance_t *kbrd_instance = kbrd_init();
+        if (kbrd_instance) {
+            indev_t *sink = stdin_wire();
+            indev_t *kbrd = kbrd_wire(kbrd_instance, sink);
+            i8042_wire(i8042_instance, kbrd);
+            trap_virtual_enable_irqs(1 << IRQ_KBD);
+        }
+    }
+    /*
+     * This is the necessary evil until the userspace driver is entirely
+     * self-sufficient.
+     */
+    sysinfo_set_item_val("kbd", NULL, true);
+    sysinfo_set_item_val("kbd.inr", NULL, IRQ_KBD);
+    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
 }
 void calibrate_delay_loop(void)
 ,15 → 253,45
  */
 void arch_grab_console(void)
 {
-    i8042_grab();
+#ifdef CONFIG_FB
+    if (vesa_present())
+        vesa_redraw();
+    else
+#endif
+#ifdef CONFIG_EGA
+        ega_redraw();
+#else
+        {}
+#endif
 }
 /** Return console to userspace
  *
  */
 void arch_release_console(void)
 {
-    i8042_release();
 }
+/** 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)
+{
+    return addr;
+}
+void arch_reboot(void)
+{
+#ifdef CONFIG_PC_KBD
+    i8042_cpu_reset((i8042_t *) I8042_BASE);
+#endif
+}
 /** @}
  */

 /branches/tracing/kernel/arch/amd64/src/pm.c
 ,8 → 137,8
 void gdt_tss_setlimit(descriptor_t *d, uint32_t limit)
 {
-    struct tss_descriptor *td = (tss_descriptor_t *) d;
+    tss_descriptor_t *td = (tss_descriptor_t *) d;
     td->limit_0_15 = limit & 0xffff;
     td->limit_16_19 = (limit >> 16) & 0xf;
 }
 ,14 → 185,14
  */
 void pm_init(void)
 {
-    descriptor_t *gdt_p = (struct descriptor *) gdtr.base;
+    descriptor_t *gdt_p = (descriptor_t *) gdtr.base;
     tss_descriptor_t *tss_desc;
     /*
      * Each CPU has its private GDT and TSS.
      * All CPUs share one IDT.
      */
     if (config.cpu_active == 1) {
         idt_init();
         /*
 ,20 → 200,19
          * the heap hasn't been initialized so far.
          */
         tss_p = &tss;
-    }
-    else {
+    } else {
         /* We are going to use malloc, which may return
          * non boot-mapped pointer, initialize the CR3 register
          * ahead of page_init */
         write_cr3((uintptr_t) AS_KERNEL->genarch.page_table);
-        tss_p = (struct tss *) malloc(sizeof(tss_t), FRAME_ATOMIC);
+        tss_p = (tss_t *) malloc(sizeof(tss_t), FRAME_ATOMIC);
         if (!tss_p)
-            panic("could not allocate TSS\n");
+            panic("Cannot allocate TSS.");
     }
     tss_initialize(tss_p);
     tss_desc = (tss_descriptor_t *) (&gdt_p[TSS_DES]);
     tss_desc->present = 1;
     tss_desc->type = AR_TSS;
 ,7 → 220,7
     gdt_tss_setbase(&gdt_p[TSS_DES], (uintptr_t) tss_p);
     gdt_tss_setlimit(&gdt_p[TSS_DES], TSS_BASIC_SIZE - 1);
     gdtr_load(&gdtr);
     idtr_load(&idtr);
     /*
 ,24 → 230,5
     tr_load(gdtselector(TSS_DES));
 }
-/* Reboot the machine by initiating
- * a triple fault
- */
-void arch_reboot(void)
-{
-    preemption_disable();
-    ipl_t ipl = interrupts_disable();
-    memsetb(idt, sizeof(idt), 0);
-    idtr_load(&idtr);
-    interrupts_restore(ipl);
-    asm volatile (
-        "int $0x03\n"
-        "cli\n"
-        "hlt\n"
-    );
-}
 /** @}
  */

 /branches/tracing/kernel/arch/amd64/src/ddi/ddi.c
 ,15 → 57,15
 int ddi_iospace_enable_arch(task_t *task, uintptr_t ioaddr, size_t size)
 {
     count_t bits;
     bits = ioaddr + size;
     if (bits > IO_PORTS)
         return ENOENT;
     if (task->arch.iomap.bits < bits) {
         bitmap_t oldiomap;
         uint8_t *newmap;
         /*
          * The I/O permission bitmap is too small and needs to be grown.
          */
 ,17 → 77,17
         bitmap_initialize(&oldiomap, task->arch.iomap.map,
             task->arch.iomap.bits);
         bitmap_initialize(&task->arch.iomap, newmap, bits);
         /*
          * Mark the new range inaccessible.
          */
         bitmap_set_range(&task->arch.iomap, oldiomap.bits,
             bits - oldiomap.bits);
         /*
          * In case there really existed smaller iomap,
          * copy its contents and deallocate it.
-         */
+         */
         if (oldiomap.bits) {
             bitmap_copy(&task->arch.iomap, &oldiomap,
                 oldiomap.bits);
 ,17 → 94,17
             free(oldiomap.map);
         }
     }
     /*
      * Enable the range and we are done.
      */
     bitmap_clear_range(&task->arch.iomap, (index_t) ioaddr, (count_t) size);
     /*
      * Increment I/O Permission bitmap generation counter.
      */
     task->arch.iomapver++;
     return 0;
 }
 ,7 → 122,7
     descriptor_t *gdt_p;
     tss_descriptor_t *tss_desc;
     count_t ver;
     /* First, copy the I/O Permission Bitmap. */
     spinlock_lock(&TASK->lock);
     ver = TASK->arch.iomapver;
 ,7 → 140,7
         bitmap_set_range(&iomap, ALIGN_UP(TASK->arch.iomap.bits, 8), 8);
     }
     spinlock_unlock(&TASK->lock);
     /*
      * Second, adjust TSS segment limit.
      * Take the extra ending byte will all bits set into account.
 ,10 → 151,10
     gdtr_load(&cpugdtr);
     /*
-         * Before we load new TSS limit, the current TSS descriptor
-         * type must be changed to describe inactive TSS.
-         */
-    tss_desc = (tss_descriptor_t *) &gdt_p[TSS_DES];
+     * Before we load new TSS limit, the current TSS descriptor
+     * type must be changed to describe inactive TSS.
+     */
+    tss_desc = (tss_descriptor_t *) &gdt_p[TSS_DES];
     tss_desc->type = AR_TSS;
     tr_load(gdtselector(TSS_DES));

 /branches/tracing/kernel/arch/amd64/src/asm_utils.S
 ,23 → 26,17
 # THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
 #
-#define IREGISTER_SPACE 120
+#define IREGISTER_SPACE 72
-#define IOFFSET_RAX 0x0
-#define IOFFSET_RBX 0x8
-#define IOFFSET_RCX 0x10
-#define IOFFSET_RDX 0x18
-#define IOFFSET_RSI 0x20
-#define IOFFSET_RDI 0x28
-#define IOFFSET_R8 0x30
-#define IOFFSET_R9 0x38
-#define IOFFSET_R10 0x40
-#define IOFFSET_R11 0x48
-#define IOFFSET_R12 0x50
-#define IOFFSET_R13 0x58
-#define IOFFSET_R14 0x60
-#define IOFFSET_R15 0x68
-#define IOFFSET_RBP 0x70
+#define IOFFSET_RAX 0x0
+#define IOFFSET_RCX 0x8
+#define IOFFSET_RDX 0x10
+#define IOFFSET_RSI 0x18
+#define IOFFSET_RDI 0x20
+#define IOFFSET_R8  0x28
+#define IOFFSET_R9  0x30
+#define IOFFSET_R10 0x38
+#define IOFFSET_R11 0x40
 #  Mask for interrupts 0 - 31 (bits 0 - 31) where 0 means that int has no error word
 # and 1 means interrupt with error word
 ,7 → 167,7
     rdmsr
     ret
-# Push all general purpose registers on stack except %rbp, %rsp
+# Push all volatile general purpose registers on stack
 .macro save_all_gpr
     movq %rax, IOFFSET_RAX(%rsp)
     movq %rcx, IOFFSET_RCX(%rsp)
 ,14 → 178,6
     movq %r9, IOFFSET_R9(%rsp)
     movq %r10, IOFFSET_R10(%rsp)
     movq %r11, IOFFSET_R11(%rsp)
-#ifdef CONFIG_DEBUG_ALLREGS
-    movq %rbx, IOFFSET_RBX(%rsp)
-    movq %rbp, IOFFSET_RBP(%rsp)
-    movq %r12, IOFFSET_R12(%rsp)
-    movq %r13, IOFFSET_R13(%rsp)
-    movq %r14, IOFFSET_R14(%rsp)
-    movq %r15, IOFFSET_R15(%rsp)
-#endif
 .endm
 .macro restore_all_gpr
 ,21 → 190,9
     movq IOFFSET_R9(%rsp), %r9
     movq IOFFSET_R10(%rsp), %r10
     movq IOFFSET_R11(%rsp), %r11
-#ifdef CONFIG_DEBUG_ALLREGS
-    movq IOFFSET_RBX(%rsp), %rbx
-    movq IOFFSET_RBP(%rsp), %rbp
-    movq IOFFSET_R12(%rsp), %r12
-    movq IOFFSET_R13(%rsp), %r13
-    movq IOFFSET_R14(%rsp), %r14
-    movq IOFFSET_R15(%rsp), %r15
-#endif
 .endm
-#ifdef CONFIG_DEBUG_ALLREGS
-# define INTERRUPT_ALIGN 256
-#else
-# define INTERRUPT_ALIGN 128
-#endif
+#define INTERRUPT_ALIGN 128
 ## Declare interrupt handlers
 #

 /branches/tracing/kernel/arch/amd64/src/boot/vesa_ret.inc
 ,0 → 1,19
+.code32
+vesa_init_protected:
+    movw $gdtselector(KDATA_DES), %cx
+    movw %cx, %es
+    movw %cx, %ds                       # kernel data + stack
+    movw %cx, %ss
+    #
+    # Simics seems to remove hidden part of GS on entering user mode
+    # when _visible_ part of GS does not point to user-mode segment.
+    #
+    movw $gdtselector(UDATA_DES), %cx
+    movw %cx, %fs
+    movw %cx, %gs
+    movl $START_STACK, %esp             # initialize stack pointer
+    jmpl $gdtselector(KTEXT32_DES), $vesa_meeting_point

 /branches/tracing/kernel/arch/amd64/src/boot/boot.S
 ,4 → 1,4
+#
 # Copyright (c) 2005 Ondrej Palkovsky
 # Copyright (c) 2006 Martin Decky
 # Copyright (c) 2008 Jakub Jermar
 ,7 → 37,7
 #include <arch/cpuid.h>
 #define START_STACK (BOOT_OFFSET - BOOT_STACK_SIZE)
 .section K_TEXT_START, "ax"
 .code32
 ,7 → 46,7
 multiboot_header:
     .long MULTIBOOT_HEADER_MAGIC
     .long MULTIBOOT_HEADER_FLAGS
-    .long -(MULTIBOOT_HEADER_MAGIC + MULTIBOOT_HEADER_FLAGS)    # checksum
+    .long -(MULTIBOOT_HEADER_MAGIC + MULTIBOOT_HEADER_FLAGS)  # checksum
     .long multiboot_header
     .long unmapped_ktext_start
     .long 0
 ,15 → 55,19
 multiboot_image_start:
     cld
-    movl $START_STACK, %esp         # initialize stack pointer
-    lgdtl bootstrap_gdtr            # initialize Global Descriptor Table register
+    movl $START_STACK, %esp             # initialize stack pointer
+    lgdtl bootstrap_gdtr                # initialize Global Descriptor Table register
     movw $gdtselector(KDATA_DES), %cx
     movw %cx, %es
-    movw %cx, %ds                           # kernel data + stack
+    movw %cx, %ds                       # kernel data + stack
     movw %cx, %ss
+    #
     # Simics seems to remove hidden part of GS on entering user mode
-    #  when _visible_ part of GS does not point to user-mode segment
+    # when _visible_ part of GS does not point to user-mode segment.
+    #
     movw $gdtselector(UDATA_DES), %cx
     movw %cx, %fs
     movw %cx, %gs
 ,17 → 75,19
     jmpl $gdtselector(KTEXT32_DES), $multiboot_meeting_point
     multiboot_meeting_point:
-    movl %eax, grub_eax                     # save parameters from GRUB
+    movl %eax, grub_eax                 # save parameters from GRUB
     movl %ebx, grub_ebx
+    #
     # Protected 32-bit. We want to reuse the code-seg descriptor,
-    # the Default operand size must not be 1 when entering long mode
+    # the Default operand size must not be 1 when entering long mode.
+    #
-    movl $(INTEL_CPUID_EXTENDED), %eax
-    cpuid
-    cmp $(INTEL_CPUID_EXTENDED), %eax
+    movl $(INTEL_CPUID_EXTENDED), %eax
+    cpuid
+    cmp $(INTEL_CPUID_EXTENDED), %eax
     ja extended_cpuid_supported
         movl $extended_cpuid_msg, %esi
         jmp error_halt
 ,11 → 96,11
     movl $(AMD_CPUID_EXTENDED), %eax
     cpuid
     bt $(AMD_EXT_LONG_MODE), %edx
-    jc long_mode_supported
+    jc long_mode_supported
         movl $long_mode_msg, %esi
         jmp error_halt
     long_mode_supported:
     bt $(AMD_EXT_NOEXECUTE), %edx
 ,7 → 114,7
     movl $(INTEL_CPUID_STANDARD), %eax
     cpuid
     bt $(INTEL_FXSAVE), %edx
-    jc fx_supported
+    jc fx_supported
         movl $fx_msg, %esi
         jmp error_halt
 ,59 → 122,43
     fx_supported:
     bt $(INTEL_SSE2), %edx
-    jc sse2_supported
+    jc sse2_supported
         movl $sse2_msg, %esi
         jmp error_halt
     sse2_supported:
-#ifdef CONFIG_FB
-    mov $vesa_init, %esi
-    mov $VESA_INIT_SEGMENT << 4, %edi
-    mov $e_vesa_init - vesa_init, %ecx
-    rep movsb
-    mov $VESA_INIT_SEGMENT << 4, %edi
-    jmpl *%edi
-    vesa_meeting_point:
-    mov %esi, KA2PA(vesa_ph_addr)
-    mov %di, KA2PA(vesa_height)
-    shr $16, %edi
-    mov %di, KA2PA(vesa_width)
-    mov %bx, KA2PA(vesa_scanline)
-    shr $16, %ebx
-    mov %bx, KA2PA(vesa_bpp)
-#endif
+#include "vesa_prot.inc"
+    #
     # Enable 64-bit page translation entries - CR4.PAE = 1.
-    # Paging is not enabled until after long mode is enabled
+    # Paging is not enabled until after long mode is enabled.
+    #
     movl %cr4, %eax
     btsl $5, %eax
     movl %eax, %cr4
-    # Set up paging tables
+    # set up paging tables
     leal ptl_0, %eax
     movl %eax, %cr3
-    # Enable long mode
+    # enable long mode
-    movl $EFER_MSR_NUM, %ecx            # EFER MSR number
-    rdmsr                       # Read EFER
-    btsl $AMD_LME_FLAG, %eax            # Set LME = 1
-    wrmsr                       # Write EFER
+    movl $EFER_MSR_NUM, %ecx            # EFER MSR number
+    rdmsr                               # read EFER
+    btsl $AMD_LME_FLAG, %eax            # set LME = 1
+    wrmsr                               # write EFER
-    # Enable paging to activate long mode (set CR0.PG = 1)
+    # enable paging to activate long mode (set CR0.PG = 1)
     movl %cr0, %eax
     btsl $31, %eax
     movl %eax, %cr0
-    # At this point we are in compatibility mode
+    # at this point we are in compatibility mode
     jmpl $gdtselector(KTEXT_DES), $start64
 ,362 → 165,29
 .code64
 start64:
     movq $(PA2KA(START_STACK)), %rsp
-    movl grub_eax, %eax
-    movl grub_ebx, %ebx
-    cmpl $MULTIBOOT_LOADER_MAGIC, %eax          # compare GRUB signature
-    je valid_boot
-        xorl %ecx, %ecx                 # no memory size or map available
-        movl %ecx, e820counter
-        jmp invalid_boot
-    valid_boot:
-        movl (%ebx), %eax               # ebx = physical address of struct multiboot_info
-        bt $3, %eax                 # mbi->flags[3] (mods_count, mods_addr valid)
-        jc mods_valid
-            xorq %rcx, %rcx
-            movq %rcx, init
-            jmp mods_end
-        mods_valid:
-        xorq %rcx, %rcx
-        movl 20(%ebx), %ecx             # mbi->mods_count
-        movq %rcx, init
-        cmpl $0, %ecx
-        je mods_end
-        movl 24(%ebx), %esi             # mbi->mods_addr
-        movq $init, %rdi
-        mods_loop:
-            xorq %rdx, %rdx
-            movl 0(%esi), %edx          # mods->mod_start
-            movq $0xffff800000000000, %r10
-            addq %r10, %rdx
-            movq %rdx, 8(%rdi)
-            xorq %rdx, %rdx
-            movl 4(%esi), %edx
-            subl 0(%esi), %edx          # mods->mod_end - mods->mod_start
-            movq %rdx, 16(%rdi)
-            addl $16, %esi
-            addq $16, %rdi
-            loop mods_loop
-        mods_end:
-        bt $6, %eax                 # mbi->flags[6] (mmap_length, mmap_addr valid)
-        jc mmap_valid
-            xorl %edx, %edx
-            jmp mmap_invalid
-        mmap_valid:
-        movl 44(%ebx), %ecx             # mbi->mmap_length
-        movl 48(%ebx), %esi             # mbi->mmap_addr
-        movq $e820table, %rdi
-        xorl %edx, %edx
-        mmap_loop:
-            cmpl $0, %ecx
-            jle mmap_end
-            movl 4(%esi), %eax          # mmap->base_addr_low
-            movl %eax, (%rdi)
-            movl 8(%esi), %eax          # mmap->base_addr_high
-            movl %eax, 4(%rdi)
-            movl 12(%esi), %eax         # mmap->length_low
-            movl %eax, 8(%rdi)
-            movl 16(%esi), %eax         # mmap->length_high
-            movl %eax, 12(%rdi)
-            movl 20(%esi), %eax         # mmap->type
-            movl %eax, 16(%rdi)
-            movl (%esi), %eax           # mmap->size
-            addl $0x4, %eax
-            addl %eax, %esi
-            subl %eax, %ecx
-            addq $MEMMAP_E820_RECORD_SIZE, %rdi
-            incl %edx
-            jmp mmap_loop
-        mmap_end:
-        mmap_invalid:
-        movl %edx, e820counter
-    invalid_boot:
+    # call arch_pre_main(grub_eax, grub_ebx)
+    xorq %rdi, %rdi
+    movl grub_eax, %edi
+    xorq %rsi, %rsi
+    movl grub_ebx, %esi
+    call arch_pre_main
-#ifdef CONFIG_SMP
+    call main_bsp
-    # copy AP bootstrap routines below 1 MB
+    # not reached
-    movq $BOOT_OFFSET, %rsi
-    movq $AP_BOOT_OFFSET, %rdi
-    movq $_hardcoded_unmapped_size, %rcx
-    rep movsb
-#endif
-    call main_bsp   # never returns
     cli
-    hlt
+    hlt0:
+        hlt
+        jmp hlt0
-#ifdef CONFIG_FB
-.code32
-vesa_init:
-    jmp $gdtselector(VESA_INIT_DES), $vesa_init_real - vesa_init
-.code16
-vesa_init_real:
-    mov %cr0, %eax
-    and $~1, %eax
-    mov %eax, %cr0
-    jmp $VESA_INIT_SEGMENT, $vesa_init_real2 - vesa_init
-vesa_init_real2:
-    mov $VESA_INIT_SEGMENT, %bx
-    mov %bx, %es
-    mov %bx, %fs
-    mov %bx, %gs
-    mov %bx, %ds
-    mov %bx, %ss
-    movl $0x0000fffc, %esp
-    movl $0x0000fffc, %ebp
-#define VESA_INFO_SIZE 1024
-#define VESA_MODE_ATTRIBUTES_OFFSET 0
-#define VESA_MODE_LIST_PTR_OFFSET 14
-#define VESA_MODE_SCANLINE_OFFSET 16
-#define VESA_MODE_WIDTH_OFFSET 18
-#define VESA_MODE_HEIGHT_OFFSET 20
-#define VESA_MODE_BPP_OFFSET 25
-#define VESA_MODE_PHADDR_OFFSET 40
-#define VESA_END_OF_MODES 0xffff
-#define VESA_OK 0x4f
-#define VESA_GET_INFO 0x4f00
-#define VESA_GET_MODE_INFO 0x4f01
-#define VESA_SET_MODE 0x4f02
-#define VESA_SET_PALETTE 0x4f09
-#define CONFIG_VESA_BPP_a 255
-#if CONFIG_VESA_BPP == 24
-#define CONFIG_VESA_BPP_VARIANT 32
-#endif
-    mov $VESA_GET_INFO, %ax
-    mov $e_vesa_init - vesa_init, %di
-    push %di
-    int $0x10
-    pop %di
-    cmp $VESA_OK, %al
-    jnz 0f
-    mov 2 + VESA_MODE_LIST_PTR_OFFSET(%di), %si
-    mov %si, %gs
-    mov VESA_MODE_LIST_PTR_OFFSET(%di), %si
-    add $VESA_INFO_SIZE, %di
-:# Try next mode
-    mov %gs:(%si), %cx
-    cmp $VESA_END_OF_MODES, %cx
-    jz 0f
-    inc %si
-    inc %si
-    push %cx
-    push %di
-    push %si
-    mov $VESA_GET_MODE_INFO, %ax
-    int $0x10
-    pop %si
-    pop %di
-    pop %cx
-    cmp $VESA_OK, %al
-    jnz 0f
-    mov $CONFIG_VESA_WIDTH, %ax
-    cmp VESA_MODE_WIDTH_OFFSET(%di), %ax
-    jnz 1b
-    mov $CONFIG_VESA_HEIGHT, %ax
-    cmp VESA_MODE_HEIGHT_OFFSET(%di), %ax
-    jnz 1b
-    mov $CONFIG_VESA_BPP, %al
-    cmp VESA_MODE_BPP_OFFSET(%di), %al
-#ifdef CONFIG_VESA_BPP_VARIANT
-    jz 2f
-    mov $CONFIG_VESA_BPP_VARIANT, %al
-    cmp VESA_MODE_BPP_OFFSET(%di), %al
-#endif
-    jnz 1b
-:
-    mov %cx, %bx
-    or $0xc000, %bx
-    push %di
-    mov $VESA_SET_MODE, %ax
-    int $0x10
-    pop %di
-    cmp $VESA_OK, %al
-    jnz 0f
-#if CONFIG_VESA_BPP == 8
-    # Set 3:2:3 VGA palette
-    mov VESA_MODE_ATTRIBUTES_OFFSET(%di), %ax
-    push %di
-    mov $vga323 - vesa_init, %di
-    mov $0x100, %ecx
-    bt $5, %ax                      # Test if VGA compatible registers are present
-    jnc vga_compat
-        # Try VESA routine to set palette
-        mov $VESA_SET_PALETTE, %ax
-        xor %bl, %bl
-        xor %dx, %dx
-        int $0x10
-        jmp vga_not_compat
-    vga_compat:
-        # Try VGA registers to set palette
-        movw $0x3c6, %dx                # Set palette mask
-        movb $0xff, %al
-        outb %al, %dx
-        movw $0x3c8, %dx                # First index to set
-        xor %al, %al
-        outb %al, %dx
-        movw $0x3c9, %dx                # Data port
-        vga_loop:
-            movb %es:2(%di), %al
-            outb %al, %dx
-            movb %es:1(%di), %al
-            outb %al, %dx
-            movb %es:(%di), %al
-            outb %al, %dx
-            addw $4, %di
-            loop vga_loop
-    vga_not_compat:
-    pop %di
-#endif
-    mov VESA_MODE_PHADDR_OFFSET(%di), %esi
-    mov VESA_MODE_WIDTH_OFFSET(%di), %ax
-    shl $16, %eax
-    mov VESA_MODE_HEIGHT_OFFSET(%di), %ax
-    mov VESA_MODE_BPP_OFFSET(%di), %bl
-    xor %bh, %bh
-    shl $16, %ebx
-    mov VESA_MODE_SCANLINE_OFFSET(%di), %bx
-    mov %eax, %edi
-:
-    mov %cr0, %eax
-    or $1, %eax
-    mov %eax, %cr0
-    jmp 9f
-:
-    ljmpl $gdtselector(KTEXT32_DES), $(vesa_init_protect - vesa_init + VESA_INIT_SEGMENT << 4)
-:# No prefered mode found
-    mov $0x111, %cx
-    push %di
-    push %cx
-    mov $VESA_GET_MODE_INFO, %ax
-    int $0x10
-    pop %cx
-    pop %di
-    cmp $VESA_OK, %al
-    jnz 1f
-    jz 2b                       # Force relative jump
-:
-    mov $0x0003, %ax
-    int $0x10
-    mov $0xffffffff, %edi               # EGA text mode used, because of problems with VESA
-    xor %ax, %ax
-    jz 8b                       # Force relative jump
-vga323:
-#include "vga323.pal"
-.code32
-vesa_init_protect:
-    movw $gdtselector(KDATA_DES), %cx
-    movw %cx, %es
-    movw %cx, %ds                   # kernel data + stack
-    movw %cx, %ss
-    # Simics seems to remove hidden part of GS on entering user mode
-    #  when _visible_ part of GS does not point to user-mode segment
-    movw $gdtselector(UDATA_DES), %cx
-    movw %cx, %fs
-    movw %cx, %gs
-    movl $START_STACK, %esp             # initialize stack pointer
-    jmpl $gdtselector(KTEXT32_DES), $vesa_meeting_point
-.align 4
-e_vesa_init:
-#endif
 # Print string from %esi to EGA display (in red) and halt
 error_halt:
-    movl $0xb8000, %edi             # base of EGA text mode memory
+    movl $0xb8000, %edi       # base of EGA text mode memory
     xorl %eax, %eax
-    movw $0x3d4, %dx                # read bits 8 - 15 of the cursor address
+    movw $0x3d4, %dx          # read bits 8 - 15 of the cursor address
     movb $0xe, %al
     outb %al, %dx
 ,7 → 195,7
     inb %dx, %al
     shl $8, %ax
-    movw $0x3d4, %dx                # read bits 0 - 7 of the cursor address
+    movw $0x3d4, %dx          # read bits 0 - 7 of the cursor address
     movb $0xf, %al
     outb %al, %dx
 ,7 → 204,9
     cmp $1920, %ax
     jbe cursor_ok
-        movw $1920, %ax             # sanity check for the cursor on the last line
+        movw $1920, %ax       # sanity check for the cursor on the last line
     cursor_ok:
     movw %ax, %bx
 ,7 → 213,7
     shl $1, %eax
     addl %eax, %edi
-    movw $0x0c00, %ax               # black background, light red foreground
+    movw $0x0c00, %ax         # black background, light red foreground
     ploop:
         lodsb
 ,11 → 220,11
         cmp $0, %al
         je ploop_end
         stosw
-        inc %bx
+        inc %bx
         jmp ploop
     ploop_end:
-    movw $0x3d4, %dx                # write bits 8 - 15 of the cursor address
+    movw $0x3d4, %dx          # write bits 8 - 15 of the cursor address
     movb $0xe, %al
     outb %al, %dx
 ,7 → 232,7
     movb %bh, %al
     outb %al, %dx
-    movw $0x3d4, %dx                # write bits 0 - 7 of the cursor address
+    movw $0x3d4, %dx          # write bits 0 - 7 of the cursor address
     movb $0xf, %al
     outb %al, %dx
 ,17 → 239,20
     movw $0x3d5, %dx
     movb %bl, %al
     outb %al, %dx
     cli
-    hlt
+    hlt1:
+        hlt
+        jmp hlt1
+#include "vesa_real.inc"
 .section K_INI_PTLS, "aw", @progbits
 #
 # Macro for generating initial page table contents.
-# @param cnt    Number of entries to generat. Must be multiple of 8.
-# @param g  Number of GB that will be added to the mapping.
+# @param cnt Number of entries to generat. Must be multiple of 8.
+# @param g   Number of GB that will be added to the mapping.
 #
 .macro ptl2gen cnt g
 .if \cnt
 ,7 → 304,7
     # Mapping of [0; 1G) at -2G
     .quad ptl_2_0g + (PTL_WRITABLE | PTL_PRESENT)
     .fill 1, 8, 0
 .align 4096
 .global ptl_0
 ptl_0:

 /branches/tracing/kernel/arch/amd64/src/boot/memmap.c
 ,7 → 26,7
  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
  */
-/** @addtogroup amd64mm
+/** @addtogroup amd64mm
  * @{
  */
 /** @file

 /branches/tracing/kernel/arch/amd64/src/proc/scheduler.c
 ,7 → 39,6
 #include <arch.h>
 #include <arch/context.h>   /* SP_DELTA */
 #include <arch/asm.h>
-#include <arch/debugger.h>
 #include <print.h>
 #include <arch/pm.h>
 #include <arch/ddi/ddi.h>
 ,13 → 67,6
     /* TLS support - set FS to thread local storage */
     write_msr(AMD_MSR_FS, THREAD->arch.tls);
-#ifdef CONFIG_DEBUG_AS_WATCHPOINT
-    /* Set watchpoint on AS to ensure that nobody sets it to zero */
-    if (CPU->id < BKPOINTS_MAX)
-        breakpoint_add(&((the_t *) THREAD->kstack)->as,
-            BKPOINT_WRITE | BKPOINT_CHECK_ZERO, CPU->id);
-#endif
 }
 void after_thread_ran_arch(void)

 /branches/tracing/kernel/arch/amd64/src/debugger.c
 ,7 → 35,6
 #include <arch/debugger.h>
 #include <console/kconsole.h>
 #include <console/cmd.h>
-#include <symtab.h>
 #include <print.h>
 #include <panic.h>
 #include <interrupt.h>
 ,6 → 43,7
 #include <debug.h>
 #include <func.h>
 #include <smp/ipi.h>
+#include <symtab.h>
 typedef struct  {
     uintptr_t address;      /**< Breakpoint address */
 ,6 → 54,8
 static bpinfo_t breakpoints[BKPOINTS_MAX];
 SPINLOCK_INITIALIZE(bkpoint_lock);
+#ifdef CONFIG_KCONSOLE
 static int cmd_print_breakpoints(cmd_arg_t *argv);
 static cmd_info_t bkpts_info = {
     .name = "bkpts",
 ,8 → 64,6
     .argc = 0,
 };
-#ifndef CONFIG_DEBUG_AS_WATCHPOINT
 static int cmd_del_breakpoint(cmd_arg_t *argv);
 static cmd_arg_t del_argv = {
     .type = ARG_TYPE_INT
 ,44 → 99,8
     .argv = &addw_argv
 };
-#endif
+#endif /* CONFIG_KCONSOLE */
-/** Print table of active breakpoints */
-int cmd_print_breakpoints(cmd_arg_t *argv __attribute__((unused)))
-{
-    unsigned int i;
-    char *symbol;
-#ifdef __32_BITS__
-    printf("#  Count Address    In symbol\n");
-    printf("-- ----- ---------- ---------\n");
-#endif
-#ifdef __64_BITS__
-    printf("#  Count Address            In symbol\n");
-    printf("-- ----- ------------------ ---------\n");
-#endif
-    for (i = 0; i < BKPOINTS_MAX; i++)
-        if (breakpoints[i].address) {
-            symbol = get_symtab_entry(breakpoints[i].address);
-#ifdef __32_BITS__
-            printf("%-2u %-5d %#10zx %s\n", i,
-                breakpoints[i].counter, breakpoints[i].address,
-                symbol);
-#endif
-#ifdef __64_BITS__
-            printf("%-2u %-5d %#18zx %s\n", i,
-                breakpoints[i].counter, breakpoints[i].address,
-                symbol);
-#endif
-        }
-    return 1;
-}
 /* Setup DR register according to table */
 static void setup_dr(int curidx)
 {
 ,16 → 201,16
     /* Send IPI */
 #ifdef CONFIG_SMP
-//  ipi_broadcast(VECTOR_DEBUG_IPI);
+//  ipi_broadcast(VECTOR_DEBUG_IPI);
 #endif
     return curidx;
 }
-#ifdef amd64
-#   define getip(x) ((x)->rip)
+#ifdef __64_BITS__
+    #define getip(x)  ((x)->rip)
 #else
-#   define getip(x) ((x)->eip)
+    #define getip(x)  ((x)->eip)
 #endif
 static void handle_exception(int slot, istate_t *istate)
 ,12 → 229,15
                 *((unative_t *) breakpoints[slot].address));
         }
     }
-    printf("Reached breakpoint %d:%lx(%s)\n", slot, getip(istate),
-        get_symtab_entry(getip(istate)));
-    printf("***Type 'exit' to exit kconsole.\n");
-    atomic_set(&haltstate,1);
-    kconsole((void *) "debug");
-    atomic_set(&haltstate,0);
+    printf("Reached breakpoint %d:%lx (%s)\n", slot, getip(istate),
+        symtab_fmt_name_lookup(getip(istate)));
+#ifdef CONFIG_KCONSOLE
+    atomic_set(&haltstate, 1);
+    kconsole("debug", "Debug console ready.\n", false);
+    atomic_set(&haltstate, 0);
+#endif
 }
 void breakpoint_del(int slot)
 ,42 → 266,8
 #endif
 }
-#ifndef CONFIG_DEBUG_AS_WATCHPOINT
-/** Remove breakpoint from table */
-int cmd_del_breakpoint(cmd_arg_t *argv)
-{
-    unative_t bpno = argv->intval;
-    if (bpno > BKPOINTS_MAX) {
-        printf("Invalid breakpoint number.\n");
-        return 0;
-    }
-    breakpoint_del(argv->intval);
-    return 1;
-}
-/** Add new breakpoint to table */
-static int cmd_add_breakpoint(cmd_arg_t *argv)
-{
-    int flags;
-    int id;
-    if (argv == &add_argv) {
-        flags = BKPOINT_INSTR;
-    } else { /* addwatchp */
-        flags = BKPOINT_WRITE;
-    }
-    printf("Adding breakpoint on address: %p\n", argv->intval);
-    id = breakpoint_add((void *)argv->intval, flags, -1);
-    if (id < 0)
-        printf("Add breakpoint failed.\n");
-    else
-        printf("Added breakpoint %d.\n", id);
-    return 1;
-}
-#endif
 static void debug_exception(int n __attribute__((unused)), istate_t *istate)
 {
     unative_t dr6;
 ,7 → 289,7
 #endif
     /* Set RF to restart the instruction  */
-#ifdef amd64
+#ifdef __64_BITS__
     istate->rflags |= RFLAGS_RF;
 #else
     istate->eflags |= EFLAGS_RF;
 ,24 → 326,24
     for (i = 0; i < BKPOINTS_MAX; i++)
         breakpoints[i].address = NULL;
+#ifdef CONFIG_KCONSOLE
     cmd_initialize(&bkpts_info);
     if (!cmd_register(&bkpts_info))
-        panic("could not register command %s\n", bkpts_info.name);
+        printf("Cannot register command %s\n", bkpts_info.name);
-#ifndef CONFIG_DEBUG_AS_WATCHPOINT
     cmd_initialize(&delbkpt_info);
     if (!cmd_register(&delbkpt_info))
-        panic("could not register command %s\n", delbkpt_info.name);
+        printf("Cannot register command %s\n", delbkpt_info.name);
     cmd_initialize(&addbkpt_info);
     if (!cmd_register(&addbkpt_info))
-        panic("could not register command %s\n", addbkpt_info.name);
+        printf("Cannot register command %s\n", addbkpt_info.name);
     cmd_initialize(&addwatchp_info);
     if (!cmd_register(&addwatchp_info))
-        panic("could not register command %s\n", addwatchp_info.name);
-#endif
+        printf("Cannot register command %s\n", addwatchp_info.name);
+#endif /* CONFIG_KCONSOLE */
     exc_register(VECTOR_DEBUG, "debugger", debug_exception);
 #ifdef CONFIG_SMP
 ,5 → 351,77
 #endif
 }
+#ifdef CONFIG_KCONSOLE
+/** Print table of active breakpoints */
+int cmd_print_breakpoints(cmd_arg_t *argv __attribute__((unused)))
+{
+    unsigned int i;
+    char *symbol;
+#ifdef __32_BITS__
+    printf("#  Count Address    In symbol\n");
+    printf("-- ----- ---------- ---------\n");
+#endif
+#ifdef __64_BITS__
+    printf("#  Count Address            In symbol\n");
+    printf("-- ----- ------------------ ---------\n");
+#endif
+    for (i = 0; i < BKPOINTS_MAX; i++)
+        if (breakpoints[i].address) {
+            symbol = symtab_fmt_name_lookup(
+                breakpoints[i].address);
+#ifdef __32_BITS__
+            printf("%-2u %-5d %#10zx %s\n", i,
+                breakpoints[i].counter, breakpoints[i].address,
+                symbol);
+#endif
+#ifdef __64_BITS__
+            printf("%-2u %-5d %#18zx %s\n", i,
+                breakpoints[i].counter, breakpoints[i].address,
+                symbol);
+#endif
+        }
+    return 1;
+}
+/** Remove breakpoint from table */
+int cmd_del_breakpoint(cmd_arg_t *argv)
+{
+    unative_t bpno = argv->intval;
+    if (bpno > BKPOINTS_MAX) {
+        printf("Invalid breakpoint number.\n");
+        return 0;
+    }
+    breakpoint_del(argv->intval);
+    return 1;
+}
+/** Add new breakpoint to table */
+static int cmd_add_breakpoint(cmd_arg_t *argv)
+{
+    int flags;
+    int id;
+    if (argv == &add_argv) {
+        flags = BKPOINT_INSTR;
+    } else { /* addwatchp */
+        flags = BKPOINT_WRITE;
+    }
+    printf("Adding breakpoint on address: %p\n", argv->intval);
+    id = breakpoint_add((void *)argv->intval, flags, -1);
+    if (id < 0)
+        printf("Add breakpoint failed.\n");
+    else
+        printf("Added breakpoint %d.\n", id);
+    return 1;
+}
+#endif /* CONFIG_KCONSOLE */
 /** @}
  */

 /branches/tracing/kernel/arch/amd64/src/mm/page.c
 ,7 → 180,7
     page = read_cr2();
     if (istate->error_word & PFERR_CODE_RSVD)
-        panic("Reserved bit set in page table entry.\n");
+        panic("Reserved bit set in page table entry.");
     if (istate->error_word & PFERR_CODE_RW)
         access = PF_ACCESS_WRITE;
 ,11 → 190,11
         access = PF_ACCESS_READ;
     if (as_page_fault(page, access, istate) == AS_PF_FAULT) {
-        fault_if_from_uspace(istate, "Page fault: %#x", page);
+        fault_if_from_uspace(istate, "Page fault: %#x.", page);
         decode_istate(n, istate);
-        printf("Page fault address: %llx\n", page);
-        panic("page fault\n");
+        printf("Page fault address: %llx.\n", page);
+        panic("Page fault.");
     }
 }
 ,7 → 202,7
 uintptr_t hw_map(uintptr_t physaddr, size_t size)
 {
     if (last_frame + ALIGN_UP(size, PAGE_SIZE) > KA2PA(KERNEL_ADDRESS_SPACE_END_ARCH))
-        panic("Unable to map physical memory %p (%d bytes)", physaddr, size)
+        panic("Unable to map physical memory %p (%d bytes).", physaddr, size)
     uintptr_t virtaddr = PA2KA(last_frame);
     pfn_t i;

 /branches/tracing/kernel/arch/amd64/src/userspace.c
 ,7 → 26,7
  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
  */
-/** @addtogroup amd64
+/** @addtogroup amd64
  * @{
  */
 /** @file
 ,36 → 47,33
  */
 void userspace(uspace_arg_t *kernel_uarg)
 {
-    ipl_t ipl;
+    ipl_t ipl = interrupts_disable();
-    ipl = interrupts_disable();
-    /* Clear CF,PF,AF,ZF,SF,DF,OF */
+    /* Clear CF, PF, AF, ZF, SF, DF, OF */
     ipl &= ~(0xcd4);
-    asm volatile (""
-              "pushq %0\n"
-              "pushq %1\n"
-              "pushq %2\n"
-              "pushq %3\n"
-              "pushq %4\n"
-              "movq %5, %%rax\n"
-              /* %rdi is defined to hold pcb_ptr - set it to 0 */
-              "xorq %%rdi, %%rdi\n"
-              "iretq\n"
-              : :
-              "i" (gdtselector(UDATA_DES) | PL_USER),
-              "r" (kernel_uarg->uspace_stack+THREAD_STACK_SIZE),
-              "r" (ipl),
-              "i" (gdtselector(UTEXT_DES) | PL_USER),
-              "r" (kernel_uarg->uspace_entry),
-              "r" (kernel_uarg->uspace_uarg)
-              : "rax"
-              );
+    asm volatile (
+            "pushq %[udata_des]\n"
+            "pushq %[stack_size]\n"
+            "pushq %[ipl]\n"
+            "pushq %[utext_des]\n"
+            "pushq %[entry]\n"
+            "movq %[uarg], %%rax\n"
+            /* %rdi is defined to hold pcb_ptr - set it to 0 */
+            "xorq %%rdi, %%rdi\n"
+            "iretq\n"
+            :: [udata_des] "i" (gdtselector(UDATA_DES) | PL_USER),
+               [stack_size] "r" (kernel_uarg->uspace_stack + THREAD_STACK_SIZE),
+               [ipl] "r" (ipl),
+               [utext_des] "i" (gdtselector(UTEXT_DES) | PL_USER),
+               [entry] "r" (kernel_uarg->uspace_entry),
+               [uarg] "r" (kernel_uarg->uspace_uarg)
+            : "rax"
+        );
     /* Unreachable */
-    for(;;)
-        ;
+    while (1);
 }
 /** @}

 /branches/tracing/kernel/arch/amd64/src/interrupt.c
 ,7 → 43,6
 #include <mm/tlb.h>
 #include <mm/as.h>
 #include <arch.h>
-#include <symtab.h>
 #include <arch/asm.h>
 #include <proc/scheduler.h>
 #include <proc/thread.h>
 ,6 → 51,7
 #include <arch/ddi/ddi.h>
 #include <interrupt.h>
 #include <ddi/irq.h>
+#include <symtab.h>
 /*
  * Interrupt and exception dispatching.
 ,10 → 64,8
 void decode_istate(int n, istate_t *istate)
 {
     char *symbol;
-/*  uint64_t *x = &istate->stack[0]; */
-    if (!(symbol = get_symtab_entry(istate->rip)))
-        symbol = "";
+    symbol = symtab_fmt_name_lookup(istate->rip);
     printf("-----EXCEPTION(%d) OCCURED----- ( %s )\n", n, __func__);
     printf("%%rip: %#llx (%s)\n", istate->rip, symbol);
 ,12 → 78,6
         istate->rdi, istate->r8);
     printf("%%r9=%#llx, %%r10=%#llx, %%r11=%#llx\n", istate->r9,
         istate->r10, istate->r11);
-#ifdef CONFIG_DEBUG_ALLREGS
-    printf("%%r12=%#llx, %%r13=%#llx, %%r14=%#llx\n", istate->r12,
-        istate->r13, istate->r14);
-    printf("%%r15=%#llx, %%rbx=%#llx, %%rbp=%#llx\n", istate->r15,
-        istate->rbx, &istate->rbp);
-#endif
     printf("%%rsp=%#llx\n", &istate->stack[0]);
 }
 ,15 → 86,15
     if (eoi_function)
         eoi_function();
     else
-        panic("no eoi_function\n");
+        panic("No eoi_function.");
 }
 static void null_interrupt(int n, istate_t *istate)
 {
-    fault_if_from_uspace(istate, "unserviced interrupt: %d", n);
+    fault_if_from_uspace(istate, "Unserviced interrupt: %d.", n);
     decode_istate(n, istate);
-    panic("unserviced interrupt\n");
+    panic("Unserviced interrupt.");
 }
 /** General Protection Fault. */
 ,35 → 118,37
             io_perm_bitmap_install();
             return;
         }
-        fault_if_from_uspace(istate, "general protection fault");
+        fault_if_from_uspace(istate, "General protection fault.");
     }
     decode_istate(n, istate);
-    panic("general protection fault\n");
+    panic("General protection fault.");
 }
 static void ss_fault(int n, istate_t *istate)
 {
-    fault_if_from_uspace(istate, "stack fault");
+    fault_if_from_uspace(istate, "Stack fault.");
     decode_istate(n, istate);
-    panic("stack fault\n");
+    panic("Stack fault.");
 }
 static void nm_fault(int n, istate_t *istate)
 {
-#ifdef CONFIG_FPU_LAZY
+#ifdef CONFIG_FPU_LAZY
     scheduler_fpu_lazy_request();
 #else
-    fault_if_from_uspace(istate, "fpu fault");
-    panic("fpu fault");
+    fault_if_from_uspace(istate, "FPU fault.");
+    panic("FPU fault.");
 #endif
 }
+#ifdef CONFIG_SMP
 static void tlb_shootdown_ipi(int n, istate_t *istate)
 {
     trap_virtual_eoi();
     tlb_shootdown_ipi_recv();
 }
+#endif
 /** Handler of IRQ exceptions */
 static void irq_interrupt(int n, istate_t *istate)
 ,7 → 171,7
             trap_virtual_eoi();
             ack = true;
         }
-        irq->handler(irq, irq->arg);
+        irq->handler(irq);
         spinlock_unlock(&irq->lock);
     } else {
         /*
 ,7 → 215,7
     if (enable_irqs_function)
         enable_irqs_function(irqmask);
     else
-        panic("no enable_irqs_function\n");
+        panic("No enable_irqs_function.");
 }
 void trap_virtual_disable_irqs(uint16_t irqmask)
 ,7 → 223,7
     if (disable_irqs_function)
         disable_irqs_function(irqmask);
     else
-        panic("no disable_irqs_function\n");
+        panic("No disable_irqs_function.");
 }
 /** @}

 /branches/tracing/kernel/arch/mips32/_link.ld.in
 ,15 → 1,17
 /*
- *  MIPS32 linker script
- *
+ * MIPS32 linker script
+ *
  *  kernel text
  *  kernel data
- *
+ *
  */
 #undef mips
 #define mips mips
+#define KERNEL_LOAD_ADDRESS 0x80100000
 OUTPUT_ARCH(mips)
 ENTRY(kernel_image_start)
 SECTIONS {
 ,9 → 23,9
     }
     .data : {
         kdata_start = .;
-        *(.data);       /* initialized data */
+        *(.data);                       /* initialized data */
         hardcoded_ktext_size = .;
-        LONG(ktext_end - ktext_start);
+        LONG(ktext_end - ktext_start);
         hardcoded_kdata_size = .;
         LONG(kdata_end - kdata_start);
         hardcoded_load_address = .;
 ,21 → 35,21
         *(.reginfo);
         *(.sbss);
         *(.scommon);
-        *(.bss);        /* uninitialized static variables */
-        *(COMMON);      /* global variables */
+        *(.bss);                        /* uninitialized static variables */
+        *(COMMON);                      /* global variables */
         symbol_table = .;
-        *(symtab.*);
+        *(symtab.*);
     }
     _gp = . + 0x8000;
     .lit8 : { *(.lit8) }
     .lit4 : { *(.lit4) }
     kdata_end = .;
     /DISCARD/ : {
-      *(.mdebug*);
-      *(.pdr);
-      *(.comment);
-      *(.note);
+        *(.mdebug*);
+        *(.pdr);
+        *(.comment);
+        *(.note);
     }
 }

 /branches/tracing/kernel/arch/mips32/include/asm/boot.h
 ,7 → 26,7
  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
  */
-/** @addtogroup mips32
+/** @addtogroup mips32
  * @{
  */
 /** @file

 /branches/tracing/kernel/arch/mips32/include/context_offset.h
 ,26 → 76,17
 #define EOFFSET_T5     0x30
 #define EOFFSET_T6     0x34
 #define EOFFSET_T7     0x38
-#define EOFFSET_S0     0x3c
-#define EOFFSET_S1     0x40
-#define EOFFSET_S2     0x44
-#define EOFFSET_S3     0x48
-#define EOFFSET_S4     0x4c
-#define EOFFSET_S5     0x50
-#define EOFFSET_S6     0x54
-#define EOFFSET_S7     0x58
-#define EOFFSET_T8     0x5c
-#define EOFFSET_T9     0x60
-#define EOFFSET_GP     0x64
-#define EOFFSET_SP     0x68
-#define EOFFSET_S8     0x6c
-#define EOFFSET_RA     0x70
-#define EOFFSET_LO     0x74
-#define EOFFSET_HI     0x78
-#define EOFFSET_STATUS 0x7c
-#define EOFFSET_EPC    0x80
-#define EOFFSET_K1     0x84
-#define REGISTER_SPACE 136
+#define EOFFSET_T8     0x3c
+#define EOFFSET_T9     0x40
+#define EOFFSET_GP     0x44
+#define EOFFSET_SP     0x48
+#define EOFFSET_RA     0x4c
+#define EOFFSET_LO     0x50
+#define EOFFSET_HI     0x54
+#define EOFFSET_STATUS 0x58
+#define EOFFSET_EPC    0x5c
+#define EOFFSET_K1     0x60
+#define REGISTER_SPACE 100
 #ifdef __ASM__
 ,10 → 105,10
     sw $s8,OFFSET_S8(\ctx)
     sw $gp,OFFSET_GP(\ctx)
-#ifndef KERNEL
+#ifndef KERNEL
     sw $k1,OFFSET_TLS(\ctx)
-# ifdef CONFIG_MIPS_FPU
+#ifdef CONFIG_FPU
     mfc1 $t0,$20
     sw $t0, OFFSET_F20(\ctx)
 ,7 → 141,7
     mfc1 $t0,$30
     sw $t0, OFFSET_F30(\ctx)
-# endif /* CONFIG_MIPS_FPU */
+#endif /* CONFIG_FPU */
 #endif /* KERNEL */
     sw $ra,OFFSET_PC(\ctx)
 ,7 → 163,7
 #ifndef KERNEL
     lw $k1,OFFSET_TLS(\ctx)
-# ifdef CONFIG_MIPS_FPU
+#ifdef CONFIG_FPU
     lw $t0, OFFSET_F20(\ctx)
     mtc1 $t0,$20
 ,9 → 196,9
     lw $t0, OFFSET_F30(\ctx)
     mtc1 $t0,$30
-# endif /* CONFIG_MIPS_FPU */
+#endif /* CONFIG_FPU */
 #endif /* KERNEL */
     lw $ra,OFFSET_PC(\ctx)
     lw $sp,OFFSET_SP(\ctx)
 .endm

 /branches/tracing/kernel/arch/mips32/include/interrupt.h
 ,9 → 38,11
 #include <typedefs.h>
 #include <arch/exception.h>
-#define IVT_ITEMS 32
-#define IVT_FIRST 0
+#define IVT_ITEMS  32
+#define IVT_FIRST  0
+#define VECTOR_TLB_SHOOTDOWN_IPI  EXC_Int
 extern function virtual_timer_fnc;
 extern uint32_t count_hi;

 /branches/tracing/kernel/arch/mips32/include/exception.h
 ,19 → 73,10
     uint32_t t5;
     uint32_t t6;
     uint32_t t7;
-    uint32_t s0;
-    uint32_t s1;
-    uint32_t s2;
-    uint32_t s3;
-    uint32_t s4;
-    uint32_t s5;
-    uint32_t s6;
-    uint32_t s7;
     uint32_t t8;
     uint32_t t9;
     uint32_t gp;
     uint32_t sp;
-    uint32_t s8;
     uint32_t ra;
     uint32_t lo;

 /branches/tracing/kernel/arch/mips32/include/types.h
 ,6 → 57,9
 typedef uint32_t unative_t;
 typedef int32_t native_t;
+typedef struct {
+} fncptr_t;
 #define PRIp "x"    /**< Format for uintptr_t. */
 #define PRIs "u"    /**< Format for size_t. */
 #define PRIc "u"    /**< Format for count_t. */

 /branches/tracing/kernel/arch/mips32/include/elf.h
 ,9 → 35,11
 #ifndef KERN_mips32_ELF_H_
 #define KERN_mips32_ELF_H_
+#include <byteorder.h>
 #define ELF_MACHINE     EM_MIPS
-#ifdef BIG_ENDIAN
+#ifdef ARCH_IS_BIG_ENDIAN
 #  define ELF_DATA_ENCODING ELFDATA2MSB
 #else
 #  define ELF_DATA_ENCODING ELFDATA2LSB

 /branches/tracing/kernel/arch/mips32/include/smp/dorder.h
 ,0 → 1,34
+/*
+ * Copyright (c) 2007 Martin Decky
+ * All rights reserved.
+ *
+ * Redistribution and use in source and binary forms, with or without
+ * modification, are permitted provided that the following conditions
+ * are met:
+ *
+ * - Redistributions of source code must retain the above copyright
+ *   notice, this list of conditions and the following disclaimer.
+ * - Redistributions in binary form must reproduce the above copyright
+ *   notice, this list of conditions and the following disclaimer in the
+ *   documentation and/or other materials provided with the distribution.
+ * - The name of the author may not be used to endorse or promote products
+ *   derived from this software without specific prior written permission.
+ *
+ * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
+ * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
+ * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
+ * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
+ * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
+ * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
+ * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
+ * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
+ * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
+ * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+ */
+#ifndef KERN_mips32_DORDER_H_
+#define KERN_mips32_DORDER_H_
+extern void ipi_broadcast_arch(int ipi);
+#endif

 /branches/tracing/kernel/arch/mips32/include/atomic.h
 ,14 → 35,14
 #ifndef KERN_mips32_ATOMIC_H_
 #define KERN_mips32_ATOMIC_H_
-#define atomic_inc(x)   ((void) atomic_add(x, 1))
-#define atomic_dec(x)   ((void) atomic_add(x, -1))
+#define atomic_inc(x)  ((void) atomic_add(x, 1))
+#define atomic_dec(x)  ((void) atomic_add(x, -1))
-#define atomic_postinc(x) (atomic_add(x, 1) - 1)
-#define atomic_postdec(x) (atomic_add(x, -1) + 1)
+#define atomic_postinc(x)  (atomic_add(x, 1) - 1)
+#define atomic_postdec(x)  (atomic_add(x, -1) + 1)
-#define atomic_preinc(x) atomic_add(x, 1)
-#define atomic_predec(x) atomic_add(x, -1)
+#define atomic_preinc(x)  atomic_add(x, 1)
+#define atomic_predec(x)  atomic_add(x, -1)
 /* Atomic addition of immediate value.
  *
 ,19 → 54,37
 static inline long atomic_add(atomic_t *val, int i)
 {
     long tmp, v;
     asm volatile (
         "1:\n"
         "   ll %0, %1\n"
-        "   addu %0, %0, %3\n"  /* same as addi, but never traps on overflow */
-        "       move %2, %0\n"
+        "   addu %0, %0, %3\n"  /* same as addi, but never traps on overflow */
+        "   move %2, %0\n"
         "   sc %0, %1\n"
-        "   beq %0, %4, 1b\n"   /* if the atomic operation failed, try again */
+        "   beq %0, %4, 1b\n"   /* if the atomic operation failed, try again */
         "   nop\n"
         : "=&r" (tmp), "+m" (val->count), "=&r" (v)
         : "r" (i), "i" (0)
-        );
+    );
+    return v;
+}
+static inline uint32_t test_and_set(atomic_t *val) {
+    uint32_t tmp, v;
+    asm volatile (
+        "1:\n"
+        "   ll %2, %1\n"
+        "   bnez %2, 2f\n"
+        "   li %0, %3\n"
+        "   sc %0, %1\n"
+        "   beqz %0, 1b\n"
+        "2:\n"
+        : "=&r" (tmp), "+m" (val->count), "=&r" (v)
+        : "i" (1)
+    );
     return v;
 }

 /branches/tracing/kernel/arch/mips32/include/arch.h
 ,7 → 26,7
  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
  */
-/** @addtogroup mips32
+/** @addtogroup mips32
  * @{
  */
 /** @file
 ,6 → 35,29
 #ifndef KERN_mips32_ARCH_H_
 #define KERN_mips32_ARCH_H_
+#define TASKMAP_MAX_RECORDS  32
+#define CPUMAP_MAX_RECORDS   32
+#define BOOTINFO_TASK_NAME_BUFLEN 32
+#include <typedefs.h>
+extern count_t cpu_count;
+typedef struct {
+    uintptr_t addr;
+    uint32_t size;
+    char name[BOOTINFO_TASK_NAME_BUFLEN];
+} utask_t;
+typedef struct {
+    uint32_t cpumap;
+    uint32_t cnt;
+    utask_t tasks[TASKMAP_MAX_RECORDS];
+} bootinfo_t;
+extern void arch_pre_main(void *entry, bootinfo_t *bootinfo);
 #endif
 /** @}

 /branches/tracing/kernel/arch/mips32/include/asm.h
 ,6 → 36,7
 #define KERN_mips32_ASM_H_
 #include <arch/types.h>
+#include <typedefs.h>
 #include <config.h>
 ,7 → 56,11
 {
     uintptr_t v;
-    asm volatile ("and %0, $29, %1\n" : "=r" (v) : "r" (~(STACK_SIZE-1)));
+    asm volatile (
+        "and %0, $29, %1\n"
+        : "=r" (v)
+        : "r" (~(STACK_SIZE-1))
+    );
     return v;
 }
 ,13 → 68,44
 extern void cpu_halt(void);
 extern void asm_delay_loop(uint32_t t);
 extern void userspace_asm(uintptr_t ustack, uintptr_t uspace_uarg,
-              uintptr_t entry);
+    uintptr_t entry);
 extern ipl_t interrupts_disable(void);
 extern ipl_t interrupts_enable(void);
 extern void interrupts_restore(ipl_t ipl);
 extern ipl_t interrupts_read(void);
+extern void asm_delay_loop(uint32_t t);
+static inline void pio_write_8(ioport8_t *port, uint8_t v)
+{
+    *port = v;
+}
+static inline void pio_write_16(ioport16_t *port, uint16_t v)
+{
+    *port = v;
+}
+static inline void pio_write_32(ioport32_t *port, uint32_t v)
+{
+    *port = v;
+}
+static inline uint8_t pio_read_8(ioport8_t *port)
+{
+    return *port;
+}
+static inline uint16_t pio_read_16(ioport16_t *port)
+{
+    return *port;
+}
+static inline uint32_t pio_read_32(ioport32_t *port)
+{
+    return *port;
+}
 #endif
 /** @}

 /branches/tracing/kernel/arch/mips32/include/mm/frame.h
 ,7 → 26,7
  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
  */
-/** @addtogroup mips32mm
+/** @addtogroup mips32mm
  * @{
  */
 /** @file
 ,12 → 35,14
 #ifndef KERN_mips32_FRAME_H_
 #define KERN_mips32_FRAME_H_
-#define FRAME_WIDTH     14  /* 16K */
-#define FRAME_SIZE      (1 << FRAME_WIDTH)
+#define FRAME_WIDTH  14  /* 16K */
+#define FRAME_SIZE   (1 << FRAME_WIDTH)
 #ifdef KERNEL
 #ifndef __ASM__
+#include <typedefs.h>
 extern void frame_arch_init(void);
 extern void physmem_print(void);

 /branches/tracing/kernel/arch/mips32/include/mm/asid.h
 ,7 → 37,7
 #include <arch/types.h>
-#define ASID_MAX_ARCH       255 /* 2^8 - 1 */
+#define ASID_MAX_ARCH  255    /* 2^8 - 1 */
 typedef uint8_t asid_t;

 /branches/tracing/kernel/arch/mips32/include/mm/tlb.h
 ,7 → 26,7
  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
  */
-/** @addtogroup mips32mm
+/** @addtogroup mips32mm
  * @{
  */
 /** @file
 ,42 → 40,38
 #include <arch/mm/asid.h>
 #include <arch/exception.h>
-#ifdef TLBCNT
-#   define TLB_ENTRY_COUNT      TLBCNT
-#else
-#   define TLB_ENTRY_COUNT      48
-#endif
+#define TLB_ENTRY_COUNT  48
-#define TLB_WIRED       1
-#define TLB_KSTACK_WIRED_INDEX  0
+#define TLB_WIRED               1
+#define TLB_KSTACK_WIRED_INDEX  0
-#define TLB_PAGE_MASK_4K    (0x000 << 13)
-#define TLB_PAGE_MASK_16K   (0x003 << 13)
-#define TLB_PAGE_MASK_64K   (0x00f << 13)
-#define TLB_PAGE_MASK_256K  (0x03f << 13)
-#define TLB_PAGE_MASK_1M    (0x0ff << 13)
-#define TLB_PAGE_MASK_4M    (0x3ff << 13)
-#define TLB_PAGE_MASK_16M   (0xfff << 13)
+#define TLB_PAGE_MASK_4K    (0x000 << 13)
+#define TLB_PAGE_MASK_16K   (0x003 << 13)
+#define TLB_PAGE_MASK_64K   (0x00f << 13)
+#define TLB_PAGE_MASK_256K  (0x03f << 13)
+#define TLB_PAGE_MASK_1M    (0x0ff << 13)
+#define TLB_PAGE_MASK_4M    (0x3ff << 13)
+#define TLB_PAGE_MASK_16M   (0xfff << 13)
-#define PAGE_UNCACHED           2
-#define PAGE_CACHEABLE_EXC_WRITE    5
+#define PAGE_UNCACHED             2
+#define PAGE_CACHEABLE_EXC_WRITE  5
 typedef union {
     struct {
 #ifdef BIG_ENDIAN
-        unsigned : 2;       /* zero */
-        unsigned pfn : 24;  /* frame number */
-        unsigned c : 3;     /* cache coherency attribute */
-        unsigned d : 1;     /* dirty/write-protect bit */
-        unsigned v : 1;     /* valid bit */
-        unsigned g : 1;     /* global bit */
+        unsigned : 2;       /* zero */
+        unsigned pfn : 24;  /* frame number */
+        unsigned c : 3;     /* cache coherency attribute */
+        unsigned d : 1;     /* dirty/write-protect bit */
+        unsigned v : 1;     /* valid bit */
+        unsigned g : 1;     /* global bit */
 #else
-        unsigned g : 1;     /* global bit */
-        unsigned v : 1;     /* valid bit */
-        unsigned d : 1;     /* dirty/write-protect bit */
-        unsigned c : 3;     /* cache coherency attribute */
-        unsigned pfn : 24;  /* frame number */
-        unsigned : 2;       /* zero */
+        unsigned g : 1;     /* global bit */
+        unsigned v : 1;     /* valid bit */
+        unsigned d : 1;     /* dirty/write-protect bit */
+        unsigned c : 3;     /* cache coherency attribute */
+        unsigned pfn : 24;  /* frame number */
+        unsigned : 2;       /* zero */
 #endif
     } __attribute__ ((packed));
     uint32_t value;
 ,7 → 159,7
     asm volatile ("tlbwr\n\t");
 }
-#define tlb_invalidate(asid)    tlb_invalidate_asid(asid)
+#define tlb_invalidate(asid)  tlb_invalidate_asid(asid)
 extern void tlb_invalid(istate_t *istate);
 extern void tlb_refill(istate_t *istate);

 /branches/tracing/kernel/arch/mips32/include/cpu.h
 ,7 → 42,7
     uint32_t imp_num;
     uint32_t rev_num;
 } cpu_arch_t;
 #endif
 /** @}

 /branches/tracing/kernel/arch/mips32/include/drivers/msim.h
 ,7 → 26,7
  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
  */
-/** @addtogroup mips32
+/** @addtogroup mips32
  * @{
  */
 /** @file
 ,16 → 36,10
 #define KERN_mips32_MSIM_H_
 /** Address of devices. */
-#define MSIM_VIDEORAM       0x90000000
-#define MSIM_KBD_ADDRESS    0x90000000
-#define MSIM_KBD_IRQ        2
+#define MSIM_VIDEORAM     0x90000000
+#define MSIM_KBD_ADDRESS  0x90000000
+#define MSIM_KBD_IRQ      2
-#include <console/chardev.h>
-void msim_console(devno_t devno);
-void msim_kbd_release(void);
-void msim_kbd_grab(void);
 #endif
 /** @}

 /branches/tracing/kernel/arch/mips32/Makefile.inc
 ,87 → 29,48
 ## Toolchain configuration
 #
-ifndef CROSS_PREFIX
-    CROSS_PREFIX = /usr/local
-endif
 BFD_ARCH = mips
+BFD = binary
 TARGET = mipsel-linux-gnu
 TOOLCHAIN_DIR = $(CROSS_PREFIX)/mipsel
-KERNEL_LOAD_ADDRESS = 0x80100000
+GCC_CFLAGS += -mno-abicalls -G 0 -fno-zero-initialized-in-bss -mips3
-GCC_CFLAGS += -mno-abicalls -G 0 -fno-zero-initialized-in-bss
+DEFS += -D__32_BITS__
-DEFS += -D__32_BITS__ -DMACHINE=$(MACHINE) -DKERNEL_LOAD_ADDRESS=${KERNEL_LOAD_ADDRESS}
-## Compile with hierarchical page tables support.
-#
-CONFIG_PAGE_PT = y
-DEFS += -DCONFIG_PAGE_PT
-## Compile with support for address space identifiers.
-#
-CONFIG_ASID = y
-CONFIG_ASID_FIFO = y
 ## Accepted MACHINEs
 #
 ifeq ($(MACHINE),lgxemul)
     BFD_NAME = elf32-tradlittlemips
-    BFD = binary
-    GCC_CFLAGS += -DFB_INVERT_ENDIAN -DARCH_HAS_FPU -mips3
 endif
 ifeq ($(MACHINE),bgxemul)
-    BFD_NAME = elf32-bigmips
-    BFD = ecoff-bigmips
-    TARGET = mips-sgi-irix5
-    TOOLCHAIN_DIR = $(CROSS_PREFIX)/mips/bin
-    GCC_CFLAGS += -EB -DBIG_ENDIAN -DARCH_HAS_FPU -mips3
+    BFD_NAME = elf32-tradbigmips
+    TOOLCHAIN_DIR = $(CROSS_PREFIX)/mips
+    TARGET = mips-linux-gnu
+    GCC_CFLAGS += -DBIG_ENDIAN
 endif
-ifeq ($(MACHINE),simics)
-    # SIMICS 4kc emulation is broken, although for instructions
-    # that do not bother us
-    BFD_NAME = elf32-tradlittlemips
-    BFD = elf32-tradlittlemips
-    GCC_CFLAGS += -mhard-float -mips3 -DTLBCNT=16
-    TLBCNT = 16
-endif
 ifeq ($(MACHINE),msim)
     BFD_NAME = elf32-tradlittlemips
-    BFD = binary
-    GCC_CFLAGS += -mhard-float -mips3
+    GCC_CFLAGS += -mhard-float
 endif
-## Compile with support for software integer division.
-#
-CONFIG_SOFTINT = y
 ARCH_SOURCES = \
-    arch/$(ARCH)/src/start.S \
-    arch/$(ARCH)/src/context.S \
-    arch/$(ARCH)/src/panic.S \
-    arch/$(ARCH)/src/mips32.c \
-    arch/$(ARCH)/src/dummy.S \
-    arch/$(ARCH)/src/console.c \
-    arch/$(ARCH)/src/asm.S \
-    arch/$(ARCH)/src/exception.c \
-    arch/$(ARCH)/src/interrupt.c \
-    arch/$(ARCH)/src/cache.c \
-    arch/$(ARCH)/src/debugger.c \
-    arch/$(ARCH)/src/cpu/cpu.c \
-    arch/$(ARCH)/src/mm/frame.c \
-    arch/$(ARCH)/src/mm/page.c \
-    arch/$(ARCH)/src/mm/tlb.c \
-    arch/$(ARCH)/src/mm/as.c \
-    arch/$(ARCH)/src/fpu_context.c \
-    arch/$(ARCH)/src/ddi/ddi.c \
-    arch/$(ARCH)/src/drivers/msim.c \
-    arch/$(ARCH)/src/drivers/serial.c \
-    arch/$(ARCH)/src/smp/order.c
+    arch/$(KARCH)/src/start.S \
+    arch/$(KARCH)/src/context.S \
+    arch/$(KARCH)/src/panic.S \
+    arch/$(KARCH)/src/mips32.c \
+    arch/$(KARCH)/src/asm.S \
+    arch/$(KARCH)/src/exception.c \
+    arch/$(KARCH)/src/interrupt.c \
+    arch/$(KARCH)/src/cache.c \
+    arch/$(KARCH)/src/debugger.c \
+    arch/$(KARCH)/src/cpu/cpu.c \
+    arch/$(KARCH)/src/mm/frame.c \
+    arch/$(KARCH)/src/mm/page.c \
+    arch/$(KARCH)/src/mm/tlb.c \
+    arch/$(KARCH)/src/mm/as.c \
+    arch/$(KARCH)/src/fpu_context.c \
+    arch/$(KARCH)/src/ddi/ddi.c \
+    arch/$(KARCH)/src/smp/dorder.c \
+    arch/$(KARCH)/src/smp/smp.c

 /branches/tracing/kernel/arch/mips32/src/fpu_context.c
 ,7 → 40,7
 void fpu_disable(void)
 {
-#ifdef ARCH_HAS_FPU
+#ifdef CONFIG_FPU
     cp0_status_write(cp0_status_read() & ~cp0_status_fpu_bit);
 #endif
 }
 ,7 → 47,7
 void fpu_enable(void)
 {
-#ifdef ARCH_HAS_FPU
+#ifdef CONFIG_FPU
     cp0_status_write(cp0_status_read() | cp0_status_fpu_bit);
 #endif
 }

 /branches/tracing/kernel/arch/mips32/src/exception.c
 ,14 → 41,13
 #include <arch.h>
 #include <debug.h>
 #include <proc/thread.h>
-#include <symtab.h>
 #include <print.h>
 #include <interrupt.h>
 #include <func.h>
-#include <console/kconsole.h>
 #include <ddi/irq.h>
 #include <arch/debugger.h>
 #include <udebug/udebug.h>
+#include <symtab.h>
 static char * exctable[] = {
     "Interrupt",
 ,25 → 74,21
 static void print_regdump(istate_t *istate)
 {
-    char *pcsymbol = "";
-    char *rasymbol = "";
+    char *pcsymbol, *rasymbol;
-    char *s = get_symtab_entry(istate->epc);
-    if (s)
-        pcsymbol = s;
-    s = get_symtab_entry(istate->ra);
-    if (s)
-        rasymbol = s;
-    printf("PC: %#x(%s) RA: %#x(%s), SP(%p)\n", istate->epc, pcsymbol, istate->ra, rasymbol, istate->sp);
+    pcsymbol = symtab_fmt_name_lookup(istate->epc);
+    rasymbol = symtab_fmt_name_lookup(istate->ra);
+    printf("PC: %#x(%s) RA: %#x(%s), SP(%p)\n", istate->epc, pcsymbol,
+        istate->ra, rasymbol, istate->sp);
 }
 static void unhandled_exception(int n, istate_t *istate)
 {
-    fault_if_from_uspace(istate, "unhandled exception %s", exctable[n]);
+    fault_if_from_uspace(istate, "Unhandled exception %s.", exctable[n]);
     print_regdump(istate);
-    panic("unhandled exception %s\n", exctable[n]);
+    panic("Unhandled exception %s.", exctable[n]);
 }
 static void reserved_instr_exception(int n, istate_t *istate)
 ,8 → 137,8
     if (cp0_cause_coperr(cp0_cause_read()) == fpu_cop_id)
         scheduler_fpu_lazy_request();
     else {
-        fault_if_from_uspace(istate, "unhandled Coprocessor Unusable Exception");
-        panic("unhandled Coprocessor Unusable Exception\n");
+        fault_if_from_uspace(istate, "Unhandled Coprocessor Unusable Exception.");
+        panic("Unhandled Coprocessor Unusable Exception.");
     }
 }
 #endif
 ,7 → 149,7
     int i;
     /* decode interrupt number and process the interrupt */
-    cause = (cp0_cause_read() >> 8) &0xff;
+    cause = (cp0_cause_read() >> 8) & 0xff;
     for (i = 0; i < 8; i++) {
         if (cause & (1 << i)) {
 ,7 → 158,7
                 /*
                  * The IRQ handler was found.
                  */
-                irq->handler(irq, irq->arg);
+                irq->handler(irq);
                 spinlock_unlock(&irq->lock);
             } else {
                 /*
 ,7 → 165,8
                  * Spurious interrupt.
                  */
 #ifdef CONFIG_DEBUG
-                printf("cpu%u: spurious interrupt (inum=%d)\n", CPU->id, i);
+                printf("cpu%u: spurious interrupt (inum=%d)\n",
+                    CPU->id, i);
 #endif
             }
         }
 ,7 → 176,7
 /** Handle syscall userspace call */
 static void syscall_exception(int n, istate_t *istate)
 {
-    panic("Syscall is handled through shortcut");
+    panic("Syscall is handled through shortcut.");
 }
 void exception_init(void)

 /branches/tracing/kernel/arch/mips32/src/smp/dorder.c
 ,0 → 1,47
+/*
+ * Copyright (c) 2007 Martin Decky
+ * All rights reserved.
+ *
+ * Redistribution and use in source and binary forms, with or without
+ * modification, are permitted provided that the following conditions
+ * are met:
+ *
+ * - Redistributions of source code must retain the above copyright
+ *   notice, this list of conditions and the following disclaimer.
+ * - Redistributions in binary form must reproduce the above copyright
+ *   notice, this list of conditions and the following disclaimer in the
+ *   documentation and/or other materials provided with the distribution.
+ * - The name of the author may not be used to endorse or promote products
+ *   derived from this software without specific prior written permission.
+ *
+ * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
+ * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
+ * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
+ * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
+ * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
+ * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
+ * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
+ * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
+ * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
+ * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+ */
+/** @addtogroup mips32
+ * @{
+ */
+/** @file
+ */
+#include <arch/smp/dorder.h>
+#define MSIM_DORDER_ADDRESS  0xB0000004
+void ipi_broadcast_arch(int ipi)
+{
+#ifdef CONFIG_SMP
+    *((volatile unsigned int *) MSIM_DORDER_ADDRESS) = 0x7FFFFFFF;
+#endif
+}
+/** @}
+ */

 /branches/tracing/kernel/arch/mips32/src/smp/smp.c
 ,0 → 1,53
+/*
+ * Copyright (c) 2009 Martin Decky
+ * All rights reserved.
+ *
+ * Redistribution and use in source and binary forms, with or without
+ * modification, are permitted provided that the following conditions
+ * are met:
+ *
+ * - Redistributions of source code must retain the above copyright
+ *   notice, this list of conditions and the following disclaimer.
+ * - Redistributions in binary form must reproduce the above copyright
+ *   notice, this list of conditions and the following disclaimer in the
+ *   documentation and/or other materials provided with the distribution.
+ * - The name of the author may not be used to endorse or promote products
+ *   derived from this software without specific prior written permission.
+ *
+ * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
+ * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
+ * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
+ * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
+ * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
+ * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
+ * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
+ * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
+ * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
+ * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+ */
+/** @addtogroup mips32
+ * @{
+ */
+/** @file
+ */
+#include <config.h>
+#include <smp/smp.h>
+#include <arch/arch.h>
+#ifdef CONFIG_SMP
+void smp_init(void)
+{
+    config.cpu_count = cpu_count;
+}
+void kmp(void *arg __attribute__((unused)))
+{
+}
+#endif /* CONFIG_SMP */
+/** @}
+ */

 /branches/tracing/kernel/arch/mips32/src/asm.S
 ,17 → 27,17
 #
 #include <arch/asm/regname.h>
 .text
 .macro cp0_read reg
-    mfc0 $2,\reg
+    mfc0 $2, \reg
     j $31
     nop
 .endm
 .macro cp0_write reg
-    mtc0 $4,\reg
+    mtc0 $4, \reg
     j $31
     nop
 .endm
 ,6 → 46,11
 .set noreorder
 .set nomacro
+.global asm_delay_loop
+asm_delay_loop:
+    j $31
+    nop
 .global cpu_halt
 cpu_halt:
     j cpu_halt
 ,6 → 63,12
     nop
+.global memsetw
+memsetw:
+    j _memsetw
+    nop
 .global memcpy
 .global memcpy_from_uspace
 .global memcpy_to_uspace
 ,235 → 77,238
 memcpy:
 memcpy_from_uspace:
 memcpy_to_uspace:
-    addiu   $v0,$a1,3
-    li  $v1,-4          # 0xfffffffffffffffc
-    and $v0,$v0,$v1
-    beq $a1,$v0,3f
-    move    $t0,$a0
-    move    $t2,$a0         # save dst
+    move $t2, $a0      # save dst
+    addiu $v0, $a1, 3
+    li $v1, -4         # 0xfffffffffffffffc
+    and $v0, $v0, $v1
+    beq $a1, $v0, 3f
+    move $t0, $a0
+:
+        beq $a2, $zero, 2f
+        move $a3, $zero
+:
+        addu $v0, $a1, $a3
+        lbu $a0, 0($v0)
+        addu $v1, $t0, $a3
+        addiu $a3, $a3, 1
+        bne $a3, $a2, 1b
+        sb $a0, 0($v1)
+:
+        jr $ra
+        move $v0, $t2
+:
+        addiu $v0, $a0, 3
+        and $v0, $v0, $v1
+        bne $a0, $v0, 0b
+        srl $t1, $a2, 2
+        beq $t1, $zero, 5f
+        move $a3, $zero
+        move $a3, $zero
+        move $a0, $zero
+:
+        addu $v0, $a1, $a0
+        lw $v1, 0($v0)
+        addiu $a3, $a3, 1
+        addu $v0, $t0, $a0
+        sw $v1, 0($v0)
+        bne $a3, $t1, 4b
+        addiu $a0, $a0, 4
+:
+        andi $a2, $a2, 0x3
+        beq $a2, $zero, 2b
+        nop
+        sll $v0, $a3, 2
+        addu $t1, $v0, $t0
+        move $a3, $zero
+        addu $t0, $v0, $a1
+:
+        addu $v0, $t0, $a3
+        lbu $a0, 0($v0)
+        addu $v1, $t1, $a3
+        addiu $a3, $a3, 1
+        bne $a3, $a2, 6b
+        sb $a0, 0($v1)
+        jr $ra
+        move $v0, $t2
-:
-    beq $a2,$zero,2f
-    move    $a3,$zero
-:
-    addu    $v0,$a1,$a3
-    lbu $a0,0($v0)
-    addu    $v1,$t0,$a3
-    addiu   $a3,$a3,1
-    bne $a3,$a2,1b
-    sb  $a0,0($v1)
-:
-    jr  $ra
-    move    $v0,$t2
-:
-    addiu   $v0,$a0,3
-    and $v0,$v0,$v1
-    bne $a0,$v0,0b
-    srl $t1,$a2,2
-    beq $t1,$zero,5f
-    move    $a3,$zero
-    move    $a3,$zero
-    move    $a0,$zero
-:
-    addu    $v0,$a1,$a0
-    lw  $v1,0($v0)
-    addiu   $a3,$a3,1
-    addu    $v0,$t0,$a0
-    sw  $v1,0($v0)
-    bne $a3,$t1,4b
-    addiu   $a0,$a0,4
-:
-    andi    $a2,$a2,0x3
-    beq $a2,$zero,2b
-    nop
-    sll $v0,$a3,2
-    addu    $t1,$v0,$t0
-    move    $a3,$zero
-    addu    $t0,$v0,$a1
-:
-    addu    $v0,$t0,$a3
-    lbu $a0,0($v0)
-    addu    $v1,$t1,$a3
-    addiu   $a3,$a3,1
-    bne $a3,$a2,6b
-    sb  $a0,0($v1)
-    jr  $ra
-    move    $v0,$t2
 memcpy_from_uspace_failover_address:
 memcpy_to_uspace_failover_address:
-    jr  $ra
-    move    $v0, $zero
+    jr $ra
+    move $v0, $zero
 .macro fpu_gp_save reg ctx
-    mfc1 $t0,$\reg
-    sw $t0, \reg*4(\ctx)
+    mfc1 $t0, $\reg
+    sw $t0, \reg * 4(\ctx)
 .endm
 .macro fpu_gp_restore reg ctx
-    lw $t0, \reg*4(\ctx)
-    mtc1 $t0,$\reg
+    lw $t0, \reg * 4(\ctx)
+    mtc1 $t0, $\reg
 .endm
 .macro fpu_ct_save reg ctx
-    cfc1 $t0,$1
-    sw $t0, (\reg+32)*4(\ctx)
+    cfc1 $t0, $1
+    sw $t0, (\reg + 32) * 4(\ctx)
 .endm
 .macro fpu_ct_restore reg ctx
-    lw $t0, (\reg+32)*4(\ctx)
-    ctc1 $t0,$\reg
+    lw $t0, (\reg + 32) * 4(\ctx)
+    ctc1 $t0, $\reg
 .endm
 .global fpu_context_save
 fpu_context_save:
-#ifdef ARCH_HAS_FPU
-    fpu_gp_save 0,$a0
-    fpu_gp_save 1,$a0
-    fpu_gp_save 2,$a0
-    fpu_gp_save 3,$a0
-    fpu_gp_save 4,$a0
-    fpu_gp_save 5,$a0
-    fpu_gp_save 6,$a0
-    fpu_gp_save 7,$a0
-    fpu_gp_save 8,$a0
-    fpu_gp_save 9,$a0
-    fpu_gp_save 10,$a0
-    fpu_gp_save 11,$a0
-    fpu_gp_save 12,$a0
-    fpu_gp_save 13,$a0
-    fpu_gp_save 14,$a0
-    fpu_gp_save 15,$a0
-    fpu_gp_save 16,$a0
-    fpu_gp_save 17,$a0
-    fpu_gp_save 18,$a0
-    fpu_gp_save 19,$a0
-    fpu_gp_save 20,$a0
-    fpu_gp_save 21,$a0
-    fpu_gp_save 22,$a0
-    fpu_gp_save 23,$a0
-    fpu_gp_save 24,$a0
-    fpu_gp_save 25,$a0
-    fpu_gp_save 26,$a0
-    fpu_gp_save 27,$a0
-    fpu_gp_save 28,$a0
-    fpu_gp_save 29,$a0
-    fpu_gp_save 30,$a0
-    fpu_gp_save 31,$a0
-    fpu_ct_save 1,$a0
-    fpu_ct_save 2,$a0
-    fpu_ct_save 3,$a0
-    fpu_ct_save 4,$a0
-    fpu_ct_save 5,$a0
-    fpu_ct_save 6,$a0
-    fpu_ct_save 7,$a0
-    fpu_ct_save 8,$a0
-    fpu_ct_save 9,$a0
-    fpu_ct_save 10,$a0
-    fpu_ct_save 11,$a0
-    fpu_ct_save 12,$a0
-    fpu_ct_save 13,$a0
-    fpu_ct_save 14,$a0
-    fpu_ct_save 15,$a0
-    fpu_ct_save 16,$a0
-    fpu_ct_save 17,$a0
-    fpu_ct_save 18,$a0
-    fpu_ct_save 19,$a0
-    fpu_ct_save 20,$a0
-    fpu_ct_save 21,$a0
-    fpu_ct_save 22,$a0
-    fpu_ct_save 23,$a0
-    fpu_ct_save 24,$a0
-    fpu_ct_save 25,$a0
-    fpu_ct_save 26,$a0
-    fpu_ct_save 27,$a0
-    fpu_ct_save 28,$a0
-    fpu_ct_save 29,$a0
-    fpu_ct_save 30,$a0
-    fpu_ct_save 31,$a0
-#endif
+#ifdef CONFIG_FPU
+    fpu_gp_save 0, $a0
+    fpu_gp_save 1, $a0
+    fpu_gp_save 2, $a0
+    fpu_gp_save 3, $a0
+    fpu_gp_save 4, $a0
+    fpu_gp_save 5, $a0
+    fpu_gp_save 6, $a0
+    fpu_gp_save 7, $a0
+    fpu_gp_save 8, $a0
+    fpu_gp_save 9, $a0
+    fpu_gp_save 10, $a0
+    fpu_gp_save 11, $a0
+    fpu_gp_save 12, $a0
+    fpu_gp_save 13, $a0
+    fpu_gp_save 14, $a0
+    fpu_gp_save 15, $a0
+    fpu_gp_save 16, $a0
+    fpu_gp_save 17, $a0
+    fpu_gp_save 18, $a0
+    fpu_gp_save 19, $a0
+    fpu_gp_save 20, $a0
+    fpu_gp_save 21, $a0
+    fpu_gp_save 22, $a0
+    fpu_gp_save 23, $a0
+    fpu_gp_save 24, $a0
+    fpu_gp_save 25, $a0
+    fpu_gp_save 26, $a0
+    fpu_gp_save 27, $a0
+    fpu_gp_save 28, $a0
+    fpu_gp_save 29, $a0
+    fpu_gp_save 30, $a0
+    fpu_gp_save 31, $a0
+    fpu_ct_save 1, $a0
+    fpu_ct_save 2, $a0
+    fpu_ct_save 3, $a0
+    fpu_ct_save 4, $a0
+    fpu_ct_save 5, $a0
+    fpu_ct_save 6, $a0
+    fpu_ct_save 7, $a0
+    fpu_ct_save 8, $a0
+    fpu_ct_save 9, $a0
+    fpu_ct_save 10, $a0
+    fpu_ct_save 11, $a0
+    fpu_ct_save 12, $a0
+    fpu_ct_save 13, $a0
+    fpu_ct_save 14, $a0
+    fpu_ct_save 15, $a0
+    fpu_ct_save 16, $a0
+    fpu_ct_save 17, $a0
+    fpu_ct_save 18, $a0
+    fpu_ct_save 19, $a0
+    fpu_ct_save 20, $a0
+    fpu_ct_save 21, $a0
+    fpu_ct_save 22, $a0
+    fpu_ct_save 23, $a0
+    fpu_ct_save 24, $a0
+    fpu_ct_save 25, $a0
+    fpu_ct_save 26, $a0
+    fpu_ct_save 27, $a0
+    fpu_ct_save 28, $a0
+    fpu_ct_save 29, $a0
+    fpu_ct_save 30, $a0
+    fpu_ct_save 31, $a0
+#endif
     j $ra
     nop
 .global fpu_context_restore
 fpu_context_restore:
-#ifdef ARCH_HAS_FPU
-    fpu_gp_restore 0,$a0
-    fpu_gp_restore 1,$a0
-    fpu_gp_restore 2,$a0
-    fpu_gp_restore 3,$a0
-    fpu_gp_restore 4,$a0
-    fpu_gp_restore 5,$a0
-    fpu_gp_restore 6,$a0
-    fpu_gp_restore 7,$a0
-    fpu_gp_restore 8,$a0
-    fpu_gp_restore 9,$a0
-    fpu_gp_restore 10,$a0
-    fpu_gp_restore 11,$a0
-    fpu_gp_restore 12,$a0
-    fpu_gp_restore 13,$a0
-    fpu_gp_restore 14,$a0
-    fpu_gp_restore 15,$a0
-    fpu_gp_restore 16,$a0
-    fpu_gp_restore 17,$a0
-    fpu_gp_restore 18,$a0
-    fpu_gp_restore 19,$a0
-    fpu_gp_restore 20,$a0
-    fpu_gp_restore 21,$a0
-    fpu_gp_restore 22,$a0
-    fpu_gp_restore 23,$a0
-    fpu_gp_restore 24,$a0
-    fpu_gp_restore 25,$a0
-    fpu_gp_restore 26,$a0
-    fpu_gp_restore 27,$a0
-    fpu_gp_restore 28,$a0
-    fpu_gp_restore 29,$a0
-    fpu_gp_restore 30,$a0
-    fpu_gp_restore 31,$a0
-    fpu_ct_restore 1,$a0
-    fpu_ct_restore 2,$a0
-    fpu_ct_restore 3,$a0
-    fpu_ct_restore 4,$a0
-    fpu_ct_restore 5,$a0
-    fpu_ct_restore 6,$a0
-    fpu_ct_restore 7,$a0
-    fpu_ct_restore 8,$a0
-    fpu_ct_restore 9,$a0
-    fpu_ct_restore 10,$a0
-    fpu_ct_restore 11,$a0
-    fpu_ct_restore 12,$a0
-    fpu_ct_restore 13,$a0
-    fpu_ct_restore 14,$a0
-    fpu_ct_restore 15,$a0
-    fpu_ct_restore 16,$a0
-    fpu_ct_restore 17,$a0
-    fpu_ct_restore 18,$a0
-    fpu_ct_restore 19,$a0
-    fpu_ct_restore 20,$a0
-    fpu_ct_restore 21,$a0
-    fpu_ct_restore 22,$a0
-    fpu_ct_restore 23,$a0
-    fpu_ct_restore 24,$a0
-    fpu_ct_restore 25,$a0
-    fpu_ct_restore 26,$a0
-    fpu_ct_restore 27,$a0
-    fpu_ct_restore 28,$a0
-    fpu_ct_restore 29,$a0
-    fpu_ct_restore 30,$a0
-    fpu_ct_restore 31,$a0
-#endif
+#ifdef CONFIG_FPU
+    fpu_gp_restore 0, $a0
+    fpu_gp_restore 1, $a0
+    fpu_gp_restore 2, $a0
+    fpu_gp_restore 3, $a0
+    fpu_gp_restore 4, $a0
+    fpu_gp_restore 5, $a0
+    fpu_gp_restore 6, $a0
+    fpu_gp_restore 7, $a0
+    fpu_gp_restore 8, $a0
+    fpu_gp_restore 9, $a0
+    fpu_gp_restore 10, $a0
+    fpu_gp_restore 11, $a0
+    fpu_gp_restore 12, $a0
+    fpu_gp_restore 13, $a0
+    fpu_gp_restore 14, $a0
+    fpu_gp_restore 15, $a0
+    fpu_gp_restore 16, $a0
+    fpu_gp_restore 17, $a0
+    fpu_gp_restore 18, $a0
+    fpu_gp_restore 19, $a0
+    fpu_gp_restore 20, $a0
+    fpu_gp_restore 21, $a0
+    fpu_gp_restore 22, $a0
+    fpu_gp_restore 23, $a0
+    fpu_gp_restore 24, $a0
+    fpu_gp_restore 25, $a0
+    fpu_gp_restore 26, $a0
+    fpu_gp_restore 27, $a0
+    fpu_gp_restore 28, $a0
+    fpu_gp_restore 29, $a0
+    fpu_gp_restore 30, $a0
+    fpu_gp_restore 31, $a0
+    fpu_ct_restore 1, $a0
+    fpu_ct_restore 2, $a0
+    fpu_ct_restore 3, $a0
+    fpu_ct_restore 4, $a0
+    fpu_ct_restore 5, $a0
+    fpu_ct_restore 6, $a0
+    fpu_ct_restore 7, $a0
+    fpu_ct_restore 8, $a0
+    fpu_ct_restore 9, $a0
+    fpu_ct_restore 10, $a0
+    fpu_ct_restore 11, $a0
+    fpu_ct_restore 12, $a0
+    fpu_ct_restore 13, $a0
+    fpu_ct_restore 14, $a0
+    fpu_ct_restore 15, $a0
+    fpu_ct_restore 16, $a0
+    fpu_ct_restore 17, $a0
+    fpu_ct_restore 18, $a0
+    fpu_ct_restore 19, $a0
+    fpu_ct_restore 20, $a0
+    fpu_ct_restore 21, $a0
+    fpu_ct_restore 22, $a0
+    fpu_ct_restore 23, $a0
+    fpu_ct_restore 24, $a0
+    fpu_ct_restore 25, $a0
+    fpu_ct_restore 26, $a0
+    fpu_ct_restore 27, $a0
+    fpu_ct_restore 28, $a0
+    fpu_ct_restore 29, $a0
+    fpu_ct_restore 30, $a0
+    fpu_ct_restore 31, $a0
+#endif
     j $ra
     nop

 /branches/tracing/kernel/arch/mips32/src/cache.c
 ,7 → 38,7
 void cache_error(istate_t *istate)
 {
-    panic("cache_error exception (epc=%p)\n", istate->epc);
+    panic("cache_error exception (epc=%p).", istate->epc);
 }
 /** @}

 /branches/tracing/kernel/arch/mips32/src/debugger.c
 ,16 → 37,18
 #include <memstr.h>
 #include <console/kconsole.h>
 #include <console/cmd.h>
-#include <symtab.h>
 #include <print.h>
 #include <panic.h>
 #include <arch.h>
 #include <arch/cp0.h>
 #include <func.h>
+#include <symtab.h>
 bpinfo_t breakpoints[BKPOINTS_MAX];
 SPINLOCK_INITIALIZE(bkpoint_lock);
+#ifdef CONFIG_KCONSOLE
 static int cmd_print_breakpoints(cmd_arg_t *argv);
 static cmd_info_t bkpts_info = {
     .name = "bkpts",
 ,10 → 125,12
     {0, 0} /* EndOfTable */
 };
 /** Test, if the given instruction is a jump or branch instruction
  *
  * @param instr Instruction code
  * @return true - it is jump instruction, false otherwise
+ *
  */
 static bool is_jump(unative_t instr)
 {
 ,7 → 162,7
     for (i = 0; i < BKPOINTS_MAX; i++) {
         if (breakpoints[i].address == (uintptr_t)argv->intval) {
             printf("Duplicate breakpoint %d.\n", i);
-            spinlock_unlock(&bkpoints_lock);
+            spinlock_unlock(&bkpoint_lock);
             return 0;
         } else if (breakpoints[i].address == (uintptr_t)argv->intval +
             sizeof(unative_t) || breakpoints[i].address ==
 ,10 → 169,10
             (uintptr_t)argv->intval - sizeof(unative_t)) {
             printf("Adjacent breakpoints not supported, conflict "
                 "with %d.\n", i);
-            spinlock_unlock(&bkpoints_lock);
+            spinlock_unlock(&bkpoint_lock);
             return 0;
         }
     }
     for (i = 0; i < BKPOINTS_MAX; i++)
 ,8 → 259,9
     for (i = 0; i < BKPOINTS_MAX; i++)
         if (breakpoints[i].address) {
-            symbol = get_symtab_entry(breakpoints[i].address);
+            symbol = symtab_fmt_name_lookup(
+                breakpoints[i].address);
             printf("%-2u %-5d %#10zx %-6s %-7s %-8s %s\n", i,
                 breakpoints[i].counter, breakpoints[i].address,
                 ((breakpoints[i].flags & BKPOINT_INPROG) ? "true" :
 ,6 → 272,8
     return 1;
 }
+#endif
 /** Initialize debugger */
 void debugger_init()
 {
 ,22 → 281,24
     for (i = 0; i < BKPOINTS_MAX; i++)
         breakpoints[i].address = NULL;
+#ifdef CONFIG_KCONSOLE
     cmd_initialize(&bkpts_info);
     if (!cmd_register(&bkpts_info))
-        panic("could not register command %s\n", bkpts_info.name);
+        printf("Cannot register command %s\n", bkpts_info.name);
     cmd_initialize(&delbkpt_info);
     if (!cmd_register(&delbkpt_info))
-        panic("could not register command %s\n", delbkpt_info.name);
+        printf("Cannot register command %s\n", delbkpt_info.name);
     cmd_initialize(&addbkpt_info);
     if (!cmd_register(&addbkpt_info))
-        panic("could not register command %s\n", addbkpt_info.name);
+        printf("Cannot register command %s\n", addbkpt_info.name);
     cmd_initialize(&addbkpte_info);
     if (!cmd_register(&addbkpte_info))
-        panic("could not register command %s\n", addbkpte_info.name);
+        printf("Cannot register command %s\n", addbkpte_info.name);
+#endif
 }
 /** Handle breakpoint
 ,7 → 317,7
     /* test branch delay slot */
     if (cp0_cause_read() & 0x80000000)
-        panic("Breakpoint in branch delay slot not supported.\n");
+        panic("Breakpoint in branch delay slot not supported.");
     spinlock_lock(&bkpoint_lock);
     for (i = 0; i < BKPOINTS_MAX; i++) {
 ,9 → 349,10
         if (cur->flags & BKPOINT_INPROG)
             printf("Warning: breakpoint recursion\n");
-        if (!(cur->flags & BKPOINT_FUNCCALL))
+        if (!(cur->flags & BKPOINT_FUNCCALL)) {
             printf("***Breakpoint %d: %p in %s.\n", i, fireaddr,
-                get_symtab_entry(istate->epc));
+                symtab_fmt_name_lookup(istate->epc));
+        }
         /* Return first instruction back */
         ((uint32_t *)cur->address)[0] = cur->instruction;
 ,8 → 365,9
         }
         cur->flags |= BKPOINT_INPROG;
     } else {
-        printf("***Breakpoint %p in %s.\n", fireaddr,
-               get_symtab_entry(fireaddr));
+        printf("***Breakpoint %d: %p in %s.\n", i, fireaddr,
+            symtab_fmt_name_lookup(fireaddr));
         /* Move on to next instruction */
         istate->epc += 4;
     }
 ,19 → 378,20
         if (cur->bkfunc)
             cur->bkfunc(cur, istate);
     } else {
-        printf("***Type 'exit' to exit kconsole.\n");
+#ifdef CONFIG_KCONSOLE
         /* This disables all other processors - we are not SMP,
          * actually this gets us to cpu_halt, if scheduler() is run
          * - we generally do not want scheduler to be run from debug,
          *   so this is a good idea
          */
-        atomic_set(&haltstate,1);
+        atomic_set(&haltstate, 1);
         spinlock_unlock(&bkpoint_lock);
-        kconsole("debug");
+        kconsole("debug", "Debug console ready.\n", false);
         spinlock_lock(&bkpoint_lock);
-        atomic_set(&haltstate,0);
+        atomic_set(&haltstate, 0);
+#endif
     }
     if (cur && cur->address == fireaddr && (cur->flags & BKPOINT_INPROG)) {
         /* Remove one-shot breakpoint */

 /branches/tracing/kernel/arch/mips32/src/cpu/cpu.c
 ,7 → 48,7
     { "MIPS", "R2000" },        /* 0x01 */
     { "MIPS", "R3000" },        /* 0x02 */
     { "MIPS", "R6000" },        /* 0x03 */
-    { "MIPS", " R4000/R4400" },     /* 0x04 */
+    { "MIPS", "R4000/R4400" },  /* 0x04 */
     { "LSI Logic", "R3000" },   /* 0x05 */
     { "MIPS", "R6000A" },       /* 0x06 */
     { "IDT", "3051/3052" },     /* 0x07 */
 ,9 → 123,9
         data = &imp_data[m->arch.imp_num];
     }
-    printf("cpu%d: %s %s (rev=%d.%d, imp=%d)\n",
+    printf("cpu%u: %s %s (rev=%d.%d, imp=%d)\n",
         m->id, data->vendor, data->model, m->arch.rev_num >> 4,
-        m->arch.rev_num & 0xf, m->arch.imp_num);
+        m->arch.rev_num & 0x0f, m->arch.imp_num);
 }
 /** @}

 /branches/tracing/kernel/arch/mips32/src/mm/tlb.c
 ,7 → 26,7
  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
  */
-/** @addtogroup mips32mm
+/** @addtogroup mips32mm
  * @{
  */
 /** @file
 ,12 → 40,12
 #include <arch/cp0.h>
 #include <panic.h>
 #include <arch.h>
-#include <symtab.h>
-#include <synch/spinlock.h>
+#include <synch/mutex.h>
 #include <print.h>
 #include <debug.h>
 #include <align.h>
 #include <interrupt.h>
+#include <symtab.h>
 static void tlb_refill_fail(istate_t *);
 static void tlb_invalid_fail(istate_t *);
 ,15 → 92,15
     uintptr_t badvaddr;
     pte_t *pte;
     int pfrc;
     badvaddr = cp0_badvaddr_read();
-    spinlock_lock(&AS->lock);
+    mutex_lock(&AS->lock);
     asid = AS->asid;
-    spinlock_unlock(&AS->lock);
+    mutex_unlock(&AS->lock);
     page_table_lock(AS, true);
     pte = find_mapping_and_check(badvaddr, PF_ACCESS_READ, istate, &pfrc);
     if (!pte) {
         switch (pfrc) {
 ,7 → 115,7
             page_table_unlock(AS, true);
             return;
         default:
-            panic("unexpected pfrc (%d)\n", pfrc);
+            panic("Unexpected pfrc (%d).", pfrc);
         }
     }
 ,7 → 199,7
             page_table_unlock(AS, true);
             return;
         default:
-            panic("unexpected pfrc (%d)\n", pfrc);
+            panic("Unexpected pfrc (%d).", pfrc);
         }
     }
 ,7 → 282,7
             page_table_unlock(AS, true);
             return;
         default:
-            panic("unexpected pfrc (%d)\n", pfrc);
+            panic("Unexpected pfrc (%d).", pfrc);
         }
     }
 ,19 → 320,14
 void tlb_refill_fail(istate_t *istate)
 {
-    char *symbol = "";
-    char *sym2 = "";
+    char *symbol, *sym2;
-    char *s = get_symtab_entry(istate->epc);
-    if (s)
-        symbol = s;
-    s = get_symtab_entry(istate->ra);
-    if (s)
-        sym2 = s;
-    fault_if_from_uspace(istate, "TLB Refill Exception on %p",
+    symbol = symtab_fmt_name_lookup(istate->epc);
+    sym2 = symtab_fmt_name_lookup(istate->ra);
+    fault_if_from_uspace(istate, "TLB Refill Exception on %p.",
         cp0_badvaddr_read());
-    panic("%x: TLB Refill Exception at %x(%s<-%s)\n", cp0_badvaddr_read(),
+    panic("%x: TLB Refill Exception at %x (%s<-%s).", cp0_badvaddr_read(),
         istate->epc, symbol, sym2);
 }
 ,27 → 334,25
 void tlb_invalid_fail(istate_t *istate)
 {
-    char *symbol = "";
+    char *symbol;
-    char *s = get_symtab_entry(istate->epc);
-    if (s)
-        symbol = s;
-    fault_if_from_uspace(istate, "TLB Invalid Exception on %p",
+    symbol = symtab_fmt_name_lookup(istate->epc);
+    fault_if_from_uspace(istate, "TLB Invalid Exception on %p.",
         cp0_badvaddr_read());
-    panic("%x: TLB Invalid Exception at %x(%s)\n", cp0_badvaddr_read(),
+    panic("%x: TLB Invalid Exception at %x (%s).", cp0_badvaddr_read(),
         istate->epc, symbol);
 }
 void tlb_modified_fail(istate_t *istate)
 {
-    char *symbol = "";
+    char *symbol;
-    char *s = get_symtab_entry(istate->epc);
-    if (s)
-        symbol = s;
-    fault_if_from_uspace(istate, "TLB Modified Exception on %p",
+    symbol = symtab_fmt_name_lookup(istate->epc);
+    fault_if_from_uspace(istate, "TLB Modified Exception on %p.",
         cp0_badvaddr_read());
-    panic("%x: TLB Modified Exception at %x(%s)\n", cp0_badvaddr_read(),
+    panic("%x: TLB Modified Exception at %x (%s).", cp0_badvaddr_read(),
         istate->epc, symbol);
 }
 ,7 → 426,7
             return NULL;
             break;
         default:
-            panic("unexpected rc (%d)\n", rc);
+            panic("Unexpected rc (%d).", rc);
         }
     }

 /branches/tracing/kernel/arch/mips32/src/mm/frame.c
 ,7 → 26,7
  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
  */
-/** @addtogroup mips32mm
+/** @addtogroup mips32mm
  * @{
  */
 /** @file
 ,22 → 40,22
 #include <mm/asid.h>
 #include <config.h>
 #include <arch/drivers/msim.h>
-#include <arch/drivers/serial.h>
 #include <print.h>
-#define ZERO_PAGE_MASK      TLB_PAGE_MASK_256K
-#define ZERO_FRAMES         2048
-#define ZERO_PAGE_WIDTH     18  /* 256K */
-#define ZERO_PAGE_SIZE      (1 << ZERO_PAGE_WIDTH)
-#define ZERO_PAGE_ASID      ASID_INVALID
-#define ZERO_PAGE_TLBI      0
-#define ZERO_PAGE_ADDR      0
-#define ZERO_PAGE_OFFSET    (ZERO_PAGE_SIZE / sizeof(uint32_t) - 1)
-#define ZERO_PAGE_VALUE     (((volatile uint32_t *) ZERO_PAGE_ADDR)[ZERO_PAGE_OFFSET])
+#define ZERO_PAGE_MASK    TLB_PAGE_MASK_256K
+#define ZERO_FRAMES       2048
+#define ZERO_PAGE_WIDTH   18  /* 256K */
+#define ZERO_PAGE_SIZE    (1 << ZERO_PAGE_WIDTH)
+#define ZERO_PAGE_ASID    ASID_INVALID
+#define ZERO_PAGE_TLBI    0
+#define ZERO_PAGE_ADDR    0
+#define ZERO_PAGE_OFFSET  (ZERO_PAGE_SIZE / sizeof(uint32_t) - 1)
+#define ZERO_PAGE_VALUE   (((volatile uint32_t *) ZERO_PAGE_ADDR)[ZERO_PAGE_OFFSET])
-#define ZERO_PAGE_VALUE_KSEG1(frame) (((volatile uint32_t *) (0xa0000000 + (frame << ZERO_PAGE_WIDTH)))[ZERO_PAGE_OFFSET])
+#define ZERO_PAGE_VALUE_KSEG1(frame) \
+    (((volatile uint32_t *) (0xa0000000 + (frame << ZERO_PAGE_WIDTH)))[ZERO_PAGE_OFFSET])
-#define MAX_REGIONS         32
+#define MAX_REGIONS  32
 typedef struct {
     pfn_t start;
 ,7 → 65,6
 static count_t phys_regions_count = 0;
 static phys_region_t phys_regions[MAX_REGIONS];
 /** Check whether frame is available
  *
  * Returns true if given frame is generally available for use.
 ,7 → 74,7
  */
 static bool frame_available(pfn_t frame)
 {
-#if MACHINE == msim
+#ifdef MACHINE_msim
     /* MSIM device (dprinter) */
     if (frame == (KA2PA(MSIM_VIDEORAM) >> ZERO_PAGE_WIDTH))
         return false;
 ,14 → 83,8
     if (frame == (KA2PA(MSIM_KBD_ADDRESS) >> ZERO_PAGE_WIDTH))
         return false;
 #endif
-#if MACHINE == simics
-    /* Simics device (serial line) */
-    if (frame == (KA2PA(SERIAL_ADDRESS) >> ZERO_PAGE_WIDTH))
-        return false;
-#endif
-#if (MACHINE == lgxemul) || (MACHINE == bgxemul)
+#if defined(MACHINE_lgxemul) || defined(MACHINE_bgxemul)
     /* gxemul devices */
     if (overlaps(frame << ZERO_PAGE_WIDTH, ZERO_PAGE_SIZE,
 x10000000, MB2SIZE(256)))
 ,7 → 211,7
                     ZERO_PAGE_VALUE = 0xdeadbeef;
                     if (ZERO_PAGE_VALUE != 0xdeadbeef)
                         avail = false;
-#if (MACHINE == lgxemul) || (MACHINE == bgxemul)
+#if defined(MACHINE_lgxemul) || defined(MACHINE_bgxemul)
                     else {
                         ZERO_PAGE_VALUE_KSEG1(frame) = 0xaabbccdd;
                         if (ZERO_PAGE_VALUE_KSEG1(frame) != 0xaabbccdd)

 /branches/tracing/kernel/arch/mips32/src/mm/page.c
 ,7 → 26,7
  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
  */
-/** @addtogroup mips32mm
+/** @addtogroup mips32mm
  * @{
  */
 /** @file
 ,6 → 35,7
 #include <arch/mm/page.h>
 #include <genarch/mm/page_pt.h>
 #include <mm/page.h>
+#include <mm/frame.h>
 void page_arch_init(void)
 {

 /branches/tracing/kernel/arch/mips32/src/interrupt.c
 ,8 → 41,9
 #include <ipc/sysipc.h>
 #include <ddi/device.h>
-#define IRQ_COUNT 8
-#define TIMER_IRQ 7
+#define IRQ_COUNT   8
+#define TIMER_IRQ   7
+#define DORDER_IRQ  5
 function virtual_timer_fnc = NULL;
 static irq_t timer_irq;
 ,12 → 101,12
     cp0_compare_write(nextcount);
 }
-static irq_ownership_t timer_claim(void)
+static irq_ownership_t timer_claim(irq_t *irq)
 {
     return IRQ_ACCEPT;
 }
-static void timer_irq_handler(irq_t *irq, void *arg, ...)
+static void timer_irq_handler(irq_t *irq)
 {
     unsigned long drift;

 /branches/tracing/kernel/arch/mips32/src/mips32.c
 ,20 → 33,17
  */
 #include <arch.h>
-#include <arch/boot.h>
 #include <arch/cp0.h>
 #include <arch/exception.h>
 #include <mm/as.h>
 #include <userspace.h>
-#include <arch/console.h>
 #include <memstr.h>
 #include <proc/thread.h>
 #include <proc/uarg.h>
 #include <print.h>
+#include <console/console.h>
 #include <syscall/syscall.h>
 #include <sysinfo/sysinfo.h>
 #include <arch/interrupt.h>
 #include <console/chardev.h>
 #include <arch/barrier.h>
 ,39 → 50,51
 #include <arch/debugger.h>
 #include <genarch/fb/fb.h>
 #include <genarch/fb/visuals.h>
+#include <genarch/drivers/dsrln/dsrlnin.h>
+#include <genarch/drivers/dsrln/dsrlnout.h>
+#include <genarch/srln/srln.h>
 #include <macros.h>
-#include <ddi/device.h>
+#include <config.h>
+#include <string.h>
+#include <arch/drivers/msim.h>
 #include <arch/asm/regname.h>
-/* Size of the code jumping to the exception handler code
- * - J+NOP
+/* Size of the code jumping to the exception handler code
+ * - J+NOP
  */
-#define EXCEPTION_JUMP_SIZE    8
+#define EXCEPTION_JUMP_SIZE  8
-#define TLB_EXC ((char *) 0x80000000)
-#define NORM_EXC ((char *) 0x80000180)
-#define CACHE_EXC ((char *) 0x80000100)
+#define TLB_EXC    ((char *) 0x80000000)
+#define NORM_EXC   ((char *) 0x80000180)
+#define CACHE_EXC  ((char *) 0x80000100)
 /* Why the linker moves the variable 64K away in assembler
- * when not in .text section ????????
+ * when not in .text section?
  */
+/* Stack pointer saved when entering user mode */
 uintptr_t supervisor_sp __attribute__ ((section (".text")));
-/* Stack pointer saved when entering user mode */
-/* TODO: How do we do it on SMP system???? */
-bootinfo_t bootinfo __attribute__ ((section (".text")));
-void arch_pre_main(void)
+count_t cpu_count = 0;
+/** Performs mips32-specific initialization before main_bsp() is called. */
+void arch_pre_main(void *entry __attribute__((unused)), bootinfo_t *bootinfo)
 {
     /* Setup usermode */
-    init.cnt = bootinfo.cnt;
+    init.cnt = bootinfo->cnt;
-    uint32_t i;
+    count_t i;
+    for (i = 0; i < min3(bootinfo->cnt, TASKMAP_MAX_RECORDS, CONFIG_INIT_TASKS); i++) {
+        init.tasks[i].addr = bootinfo->tasks[i].addr;
+        init.tasks[i].size = bootinfo->tasks[i].size;
+        str_cpy(init.tasks[i].name, CONFIG_TASK_NAME_BUFLEN,
+            bootinfo->tasks[i].name);
+    }
-    for (i = 0; i < bootinfo.cnt; i++) {
-        init.tasks[i].addr = bootinfo.tasks[i].addr;
-        init.tasks[i].size = bootinfo.tasks[i].size;
+    for (i = 0; i < CPUMAP_MAX_RECORDS; i++) {
+        if ((bootinfo->cpumap & (1 << i)) != 0)
+            cpu_count++;
     }
 }
 ,12 → 120,12
      */
     cp0_status_write(cp0_status_read() &
         ~(cp0_status_bev_bootstrap_bit | cp0_status_erl_error_bit));
-    /*
-     * Mask all interrupts
+    /*
+     * Mask all interrupts
      */
     cp0_mask_all_int();
     debugger_init();
 }
 ,7 → 132,7
 void arch_post_mm_init(void)
 {
     interrupt_init();
-    console_init(device_assign_devno());
 #ifdef CONFIG_FB
     /* GXemul framebuffer */
     fb_properties_t gxemul_prop = {
 ,11 → 141,14
         .x = 640,
         .y = 480,
         .scan = 1920,
-        .visual = VISUAL_RGB_8_8_8,
+        .visual = VISUAL_BGR_8_8_8,
     };
     fb_init(&gxemul_prop);
-#endif
-    sysinfo_set_item_val("machine." STRING(MACHINE), NULL, 1);
+#else
+#ifdef CONFIG_MIPS_PRN
+    dsrlnout_init((ioport8_t *) MSIM_KBD_ADDRESS);
+#endif /* CONFIG_MIPS_PRN */
+#endif /* CONFIG_FB */
 }
 void arch_post_cpu_init(void)
 ,8 → 161,37
 void arch_post_smp_init(void)
 {
+#ifdef CONFIG_MIPS_KBD
+    /*
+     * Initialize the msim/GXemul keyboard port. Then initialize the serial line
+     * module and connect it to the msim/GXemul keyboard. Enable keyboard interrupts.
+     */
+    dsrlnin_instance_t *dsrlnin_instance
+        = dsrlnin_init((dsrlnin_t *) MSIM_KBD_ADDRESS, MSIM_KBD_IRQ);
+    if (dsrlnin_instance) {
+        srln_instance_t *srln_instance = srln_init();
+        if (srln_instance) {
+            indev_t *sink = stdin_wire();
+            indev_t *srln = srln_wire(srln_instance, sink);
+            dsrlnin_wire(dsrlnin_instance, srln);
+            cp0_unmask_int(MSIM_KBD_IRQ);
+        }
+    }
+    /*
+     * This is the necessary evil until the userspace driver is entirely
+     * self-sufficient.
+     */
+    sysinfo_set_item_val("kbd", NULL, true);
+    sysinfo_set_item_val("kbd.inr", NULL, MSIM_KBD_IRQ);
+    sysinfo_set_item_val("kbd.address.virtual", NULL, MSIM_KBD_ADDRESS);
+#endif
 }
+void calibrate_delay_loop(void)
+{
+}
 void userspace(uspace_arg_t *kernel_uarg)
 {
     /* EXL = 1, UM = 1, IE = 1 */
 ,8 → 202,7
         (uintptr_t) kernel_uarg->uspace_uarg,
         (uintptr_t) kernel_uarg->uspace_entry);
-    while (1)
-        ;
+    while (1);
 }
 /** Perform mips32 specific tasks needed before the new task is run. */
 ,10 → 234,36
 void arch_reboot(void)
 {
     ___halt();
-    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)
+{
+    return addr;
+}
+void arch_grab_console(void)
+{
+#ifdef CONFIG_FB
+    fb_redraw();
+#endif
+}
+/** Return console to userspace
+ *
+ */
+void arch_release_console(void)
+{
+}
 /** @}
  */

 /branches/tracing/kernel/arch/mips32/src/start.S
 ,7 → 31,7
 #include <arch/asm/boot.h>
 #include <arch/context_offset.h>
 #include <arch/stack.h>
 .text
 .set noat
 ,18 → 75,6
     mfhi $at
     sw $at, EOFFSET_HI(\r)
-#ifdef CONFIG_DEBUG_ALLREGS
-    sw $s0, EOFFSET_S0(\r)
-    sw $s1, EOFFSET_S1(\r)
-    sw $s2, EOFFSET_S2(\r)
-    sw $s3, EOFFSET_S3(\r)
-    sw $s4, EOFFSET_S4(\r)
-    sw $s5, EOFFSET_S5(\r)
-    sw $s6, EOFFSET_S6(\r)
-    sw $s7, EOFFSET_S7(\r)
-    sw $s8, EOFFSET_S8(\r)
-#endif
     sw $gp, EOFFSET_GP(\r)
     sw $ra, EOFFSET_RA(\r)
     sw $k1, EOFFSET_K1(\r)
 ,17 → 120,6
     lw $t8, EOFFSET_T8(\r)
     lw $t9, EOFFSET_T9(\r)
-#ifdef CONFIG_DEBUG_ALLREGS
-    lw $s0, EOFFSET_S0(\r)
-    lw $s1, EOFFSET_S1(\r)
-    lw $s2, EOFFSET_S2(\r)
-    lw $s3, EOFFSET_S3(\r)
-    lw $s4, EOFFSET_S4(\r)
-    lw $s5, EOFFSET_S5(\r)
-    lw $s6, EOFFSET_S6(\r)
-    lw $s7, EOFFSET_S7(\r)
-    lw $s8, EOFFSET_S8(\r)
-#endif
     lw $gp, EOFFSET_GP(\r)
     lw $ra, EOFFSET_RA(\r)
     lw $k1, EOFFSET_K1(\r)
 ,9 → 152,9
     ori $k0, $k0, %lo(supervisor_sp)
     # Move $k0 (superveisor_sp)
     lw $k0, 0($k0)
-:
+:
 .endm
 .org 0x0
 kernel_image_start:
     /* Load temporary stack */
 ,31 → 161,12
     lui $sp, %hi(end_stack)
     ori $sp, $sp, %lo(end_stack)
-    /* $a1 contains physical address of bootinfo_t */
-    /* $a2 contains size of bootinfo_t */
-    beq $a2, $0, bootinfo_end
-    /* Not sure about this, but might be needed for PIC code???? */
+    /* Not sure about this, but might
+       be needed for PIC code */
     lui $gp, 0x8000
-    lui $a3, %hi(bootinfo)
-    ori $a3, $a3, %lo(bootinfo)
+    /* $a1 contains physical address of bootinfo_t */
-    bootinfo_loop:
-        lw $v0, 0($a1)
-        sw $v0, 0($a3)
-        addi $a1, $a1, 4
-        addi $a3, $a3, 4
-        addi $a2, $a2, -4
-        bgtz $a2, bootinfo_loop
-        nop
-    bootinfo_end:
     jal arch_pre_main
     nop
 ,8 → 186,8
 exception_entry:
     j exception_handler
-    nop
+    nop
 exception_handler:
     KERNEL_STACK_TO_K0
     sub $k0, REGISTER_SPACE
 ,17 → 196,17
     mfc0 $k0, $cause
-    sra $k0, $k0, 0x2       # cp0_exc_cause() part 1
-    andi $k0, $k0, 0x1f     # cp0_exc_cause() part 2
-    sub $k0, 8          # 8 = SYSCALL
+    sra $k0, $k0, 0x2    # cp0_exc_cause() part 1
+    andi $k0, $k0, 0x1f  # cp0_exc_cause() part 2
+    sub $k0, 8           # 8 = SYSCALL
     beqz $k0, syscall_shortcut
-    add $k0, 8          # Revert $k0 back to correct exc number
+    add $k0, 8           # Revert $k0 back to correct exc number
     REGISTERS_STORE_AND_EXC_RESET $sp
     move $a1, $sp
-    jal exc_dispatch        # exc_dispatch(excno, register_space)
+    jal exc_dispatch     # exc_dispatch(excno, register_space)
     move $a0, $k0
     REGISTERS_LOAD $sp

 /branches/tracing/kernel/arch/ia32/_link.ld.in
 ,11 → 1,11
 /** IA-32 linker script
- *
+ *
  * umapped section:
- *  kernel text
- *  kernel data
+ *  kernel text
+ *  kernel data
  * mapped section:
- *  kernel text
- *  kernel data
+ *  kernel text
+ *  kernel data
  */
 #include <arch/boot/boot.h>
 ,9 → 28,9
         ktext_end = .;
         kdata_start = .;
-        *(.data);           /* initialized data */
-        *(.rodata*);            /* string literals */
-        *(COMMON);          /* global variables */
+        *(.data);               /* initialized data */
+        *(.rodata*);            /* string literals */
+        *(COMMON);              /* global variables */
         hardcoded_load_address = .;
         LONG(PA2KA(BOOT_OFFSET));
         hardcoded_ktext_size = .;
 ,23 → 42,23
         hardcoded_unmapped_kdata_size = .;
         LONG(unmapped_kdata_end - unmapped_kdata_start);
         symbol_table = .;
-        *(symtab.*);                /* Symbol table, must be LAST symbol! */
-        *(.bss);            /* uninitialized static variables */
+        *(symtab.*);            /* Symbol table, must be LAST symbol! */
+        *(.bss);                /* uninitialized static variables */
         kdata_end = .;
     }
     /DISCARD/ : {
-        *(.note.GNU-stack);
+        *(.note.GNU-stack);
         *(.comment);
     }
-#ifdef CONFIG_SMP
+#ifdef CONFIG_SMP
     _hardcoded_unmapped_size = (unmapped_ktext_end - unmapped_ktext_start) + (unmapped_kdata_end - unmapped_kdata_start);
     ap_boot = unmapped_ap_boot - BOOT_OFFSET + AP_BOOT_OFFSET;
     ap_gdtr = unmapped_ap_gdtr - BOOT_OFFSET + AP_BOOT_OFFSET;
     protected_ap_gdtr = PA2KA(ap_gdtr);
 #endif /* CONFIG_SMP */
 }

 /branches/tracing/kernel/arch/ia32/include/interrupt.h
 ,10 → 73,6
     uint32_t eax;
     uint32_t ecx;
     uint32_t edx;
-    uint32_t esi;
-    uint32_t edi;
-    uint32_t ebp;
-    uint32_t ebx;
     uint32_t gs;
     uint32_t fs;

/branches/tracing/kernel/arch/ia32/include/fpu_context.h
37,7 → 37,6

#include <arch/types.h>

#define ARCH_HAS_FPU
#define FPU_CONTEXT_ALIGN 16

void fpu_fxsr(void);

 /branches/tracing/kernel/arch/ia32/include/types.h
 ,6 → 57,9
 typedef uint32_t unative_t;
 typedef int32_t native_t;
+typedef struct {
+} fncptr_t;
 #define PRIp "x"    /**< Format for uintptr_t. */
 #define PRIs "u"    /**< Format for size_t. */
 #define PRIc "u"    /**< Format for count_t. */

 /branches/tracing/kernel/arch/ia32/include/cpuid.h
 ,6 → 35,13
 #ifndef KERN_ia32_CPUID_H_
 #define KERN_ia32_CPUID_H_
+#define INTEL_CPUID_LEVEL     0x00000000
+#define INTEL_CPUID_STANDARD  0x00000001
+#define INTEL_PSE             3
+#define INTEL_SEP             11
+#ifndef __ASM__
 #include <arch/types.h>
 typedef struct {
 ,21 → 81,21
     uint32_t val, ret;
     asm volatile (
-        "pushf\n"               /* read flags */
-        "popl %0\n"
-        "movl %0, %1\n"
+        "pushf\n"                    /* read flags */
+        "popl %[ret]\n"
+        "movl %[ret], %[val]\n"
-        "btcl $21, %1\n"        /* swap the ID bit */
+        "btcl $21, %[val]\n"         /* swap the ID bit */
-        "pushl %1\n"            /* propagate the change into flags */
+        "pushl %[val]\n"             /* propagate the change into flags */
         "popf\n"
         "pushf\n"
-        "popl %1\n"
+        "popl %[val]\n"
-        "andl $(1 << 21), %0\n" /* interrested only in ID bit */
-        "andl $(1 << 21), %1\n"
-        "xorl %1, %0\n"
-        : "=r" (ret), "=r" (val)
+        "andl $(1 << 21), %[ret]\n"  /* interrested only in ID bit */
+        "andl $(1 << 21), %[val]\n"
+        "xorl %[val], %[ret]\n"
+        : [ret] "=r" (ret), [val] "=r" (val)
     );
     return ret;
 ,11 → 105,13
 {
     asm volatile (
         "cpuid\n"
-        : "=a" (info->cpuid_eax), "=b" (info->cpuid_ebx), "=c" (info->cpuid_ecx), "=d" (info->cpuid_edx)
+        : "=a" (info->cpuid_eax), "=b" (info->cpuid_ebx),
+          "=c" (info->cpuid_ecx), "=d" (info->cpuid_edx)
         : "a" (cmd)
     );
 }
+#endif /* !def __ASM__ */
 #endif
 /** @}

 /branches/tracing/kernel/arch/ia32/include/atomic.h
 ,7 → 26,7
  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
  */
-/** @addtogroup ia32
+/** @addtogroup ia32
  * @{
  */
 /** @file
 ,17 → 41,29
 static inline void atomic_inc(atomic_t *val) {
 #ifdef CONFIG_SMP
-    asm volatile ("lock incl %0\n" : "+m" (val->count));
+    asm volatile (
+        "lock incl %[count]\n"
+        : [count] "+m" (val->count)
+    );
 #else
-    asm volatile ("incl %0\n" : "+m" (val->count));
+    asm volatile (
+        "incl %[count]\n"
+        : [count] "+m" (val->count)
+    );
 #endif /* CONFIG_SMP */
 }
 static inline void atomic_dec(atomic_t *val) {
 #ifdef CONFIG_SMP
-    asm volatile ("lock decl %0\n" : "+m" (val->count));
+    asm volatile (
+        "lock decl %[count]\n"
+        : [count] "+m" (val->count)
+    );
 #else
-    asm volatile ("decl %0\n" : "+m" (val->count));
+    asm volatile (
+        "decl %[count]\n"
+        : [count] "+m" (val->count)
+    );
 #endif /* CONFIG_SMP */
 }
 ,12 → 70,12
 static inline long atomic_postinc(atomic_t *val)
 {
     long r = 1;
     asm volatile (
-        "lock xaddl %1, %0\n"
-        : "+m" (val->count), "+r" (r)
+        "lock xaddl %[r], %[count]\n"
+        : [count] "+m" (val->count), [r] "+r" (r)
     );
     return r;
 }
 ,23 → 84,23
     long r = -1;
     asm volatile (
-        "lock xaddl %1, %0\n"
-        : "+m" (val->count), "+r"(r)
+        "lock xaddl %[r], %[count]\n"
+        : [count] "+m" (val->count), [r] "+r"(r)
     );
     return r;
 }
-#define atomic_preinc(val) (atomic_postinc(val) + 1)
-#define atomic_predec(val) (atomic_postdec(val) - 1)
+#define atomic_preinc(val)  (atomic_postinc(val) + 1)
+#define atomic_predec(val)  (atomic_postdec(val) - 1)
 static inline uint32_t test_and_set(atomic_t *val) {
     uint32_t v;
     asm volatile (
-        "movl $1, %0\n"
-        "xchgl %0, %1\n"
-        : "=r" (v),"+m" (val->count)
+        "movl $1, %[v]\n"
+        "xchgl %[v], %[count]\n"
+        : [v] "=r" (v), [count] "+m" (val->count)
     );
     return v;
 ,22 → 110,22
 static inline void atomic_lock_arch(atomic_t *val)
 {
     uint32_t tmp;
     preemption_disable();
     asm volatile (
         "0:\n"
 #ifdef CONFIG_HT
-        "pause\n" /* Pentium 4's HT love this instruction */
+        "pause\n"        /* Pentium 4's HT love this instruction */
 #endif
-        "mov %0, %1\n"
-        "testl %1, %1\n"
+        "mov %[count], %[tmp]\n"
+        "testl %[tmp], %[tmp]\n"
         "jnz 0b\n"       /* lightweight looping on locked spinlock */
-        "incl %1\n"      /* now use the atomic operation */
-        "xchgl %0, %1\n"
-        "testl %1, %1\n"
+        "incl %[tmp]\n"  /* now use the atomic operation */
+        "xchgl %[count], %[tmp]\n"
+        "testl %[tmp], %[tmp]\n"
         "jnz 0b\n"
-                : "+m" (val->count), "=&r"(tmp)
+        : [count] "+m" (val->count), [tmp] "=&r" (tmp)
     );
     /*
      * Prevent critical section code from bleeding out this way up.

 /branches/tracing/kernel/arch/ia32/include/pm.h
 ,7 → 26,7
  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
  */
-/** @addtogroup ia32
+/** @addtogroup ia32
  * @{
  */
 /** @file
 ,61 → 35,59
 #ifndef KERN_ia32_PM_H_
 #define KERN_ia32_PM_H_
-#define IDT_ITEMS   64
-#define GDT_ITEMS   7
+#define IDT_ITEMS  64
+#define GDT_ITEMS  7
-#define VESA_INIT_SEGMENT 0x8000
+#define NULL_DES   0
+#define KTEXT_DES  1
+#define KDATA_DES  2
+#define UTEXT_DES  3
+#define UDATA_DES  4
+#define TSS_DES    5
+#define TLS_DES    6  /* Pointer to Thread-Local-Storage data */
-#define NULL_DES    0
-#define KTEXT_DES   1
-#define KDATA_DES   2
-#define UTEXT_DES   3
-#define UDATA_DES   4
-#define TSS_DES     5
-#define TLS_DES     6 /* Pointer to Thread-Local-Storage data */
 #ifdef CONFIG_FB
-#define VESA_INIT_SEGMENT 0x8000
-#define VESA_INIT_DES 7
+#define VESA_INIT_SEGMENT  0x8000
+#define VESA_INIT_DES      7
+#define KTEXT32_DES        KTEXT_DES
 #undef GDT_ITEMS
-#define GDT_ITEMS 8
+#define GDT_ITEMS  8
 #endif /* CONFIG_FB */
+#define gdtselector(des)  ((des) << 3)
-#define selector(des)   ((des) << 3)
+#define PL_KERNEL  0
+#define PL_USER    3
-#define PL_KERNEL   0
-#define PL_USER     3
+#define AR_PRESENT    (1 << 7)
+#define AR_DATA       (2 << 3)
+#define AR_CODE       (3 << 3)
+#define AR_WRITABLE   (1 << 1)
+#define AR_INTERRUPT  (0x0e)
+#define AR_TSS        (0x09)
-#define AR_PRESENT  (1 << 7)
-#define AR_DATA     (2 << 3)
-#define AR_CODE     (3 << 3)
-#define AR_WRITABLE (1 << 1)
-#define AR_INTERRUPT    (0xe)
-#define AR_TSS      (0x9)
+#define DPL_KERNEL  (PL_KERNEL << 5)
+#define DPL_USER    (PL_USER << 5)
-#define DPL_KERNEL  (PL_KERNEL << 5)
-#define DPL_USER    (PL_USER << 5)
+#define TSS_BASIC_SIZE  104
+#define TSS_IOMAP_SIZE  (16 * 1024 + 1)  /* 16K for bitmap + 1 terminating byte for convenience */
-#define TSS_BASIC_SIZE  104
-#define TSS_IOMAP_SIZE  (16 * 1024 + 1) /* 16K for bitmap + 1 terminating byte for convenience */
+#define IO_PORTS  (64 * 1024)
-#define IO_PORTS    (64 * 1024)
 #ifndef __ASM__
 #include <arch/types.h>
 #include <arch/context.h>
-struct ptr_16_32 {
+typedef struct {
     uint16_t limit;
     uint32_t base;
-} __attribute__ ((packed));
-typedef struct ptr_16_32 ptr_16_32_t;
+} __attribute__ ((packed)) ptr_16_32_t;
-struct descriptor {
+typedef struct {
     unsigned limit_0_15: 16;
     unsigned base_0_15: 16;
     unsigned base_16_23: 8;
 ,19 → 98,17
     unsigned special: 1;
     unsigned granularity : 1;
     unsigned base_24_31: 8;
-} __attribute__ ((packed));
-typedef struct descriptor  descriptor_t;
+} __attribute__ ((packed)) descriptor_t;
-struct idescriptor {
+typedef struct {
     unsigned offset_0_15: 16;
     unsigned selector: 16;
     unsigned unused: 8;
     unsigned access: 8;
     unsigned offset_16_31: 16;
-} __attribute__ ((packed));
-typedef struct idescriptor idescriptor_t;
+} __attribute__ ((packed)) idescriptor_t;
-struct tss {
+typedef struct {
     uint16_t link;
     unsigned : 16;
     uint32_t esp0;
 ,13 → 148,12
     unsigned : 16;
     uint16_t iomap_base;
     uint8_t iomap[TSS_IOMAP_SIZE];
-} __attribute__ ((packed));
-typedef struct tss tss_t;
+} __attribute__ ((packed)) tss_t;
 extern ptr_16_32_t gdtr;
 extern ptr_16_32_t bootstrap_gdtr;
 extern ptr_16_32_t protected_ap_gdtr;
-extern struct tss *tss_p;
+extern tss_t *tss_p;
 extern descriptor_t gdt[];

 /branches/tracing/kernel/arch/ia32/include/boot/memmap.h
 ,7 → 26,7
  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
  */
-/** @addtogroup ia32
+/** @addtogroup ia32
  * @{
  */
 /** @file
 ,24 → 35,29
 #ifndef KERN_ia32_MEMMAP_H_
 #define KERN_ia32_MEMMAP_H_
-/* E820h memory range types - other values*/
-    /* Free memory */
-#define MEMMAP_MEMORY_AVAILABLE 1
-    /* Not available for OS */
-#define MEMMAP_MEMORY_RESERVED  2
-    /* OS may use it after reading ACPI table */
-#define MEMMAP_MEMORY_ACPI  3
-    /* Unusable, required to be saved and restored across an NVS sleep */
-#define MEMMAP_MEMORY_NVS   4
-    /* Corrupted memory */
-#define MEMMAP_MEMORY_UNUSABLE  5
+/* E820h memory range types */
-     /* size of one entry */
-#define MEMMAP_E820_RECORD_SIZE 20
-    /* maximum entries */
-#define MEMMAP_E820_MAX_RECORDS 32
+/* Free memory */
+#define MEMMAP_MEMORY_AVAILABLE  1
+/* Not available for OS */
+#define MEMMAP_MEMORY_RESERVED   2
+/* OS may use it after reading ACPI table */
+#define MEMMAP_MEMORY_ACPI       3
+/* Unusable, required to be saved and restored across an NVS sleep */
+#define MEMMAP_MEMORY_NVS        4
+/* Corrupted memory */
+#define MEMMAP_MEMORY_UNUSABLE   5
+/* Size of one entry */
+#define MEMMAP_E820_RECORD_SIZE  20
+/* Maximum entries */
+#define MEMMAP_E820_MAX_RECORDS  32
 #ifndef __ASM__
 #include <arch/types.h>

 /branches/tracing/kernel/arch/ia32/include/boot/boot.h
 ,7 → 26,7
  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
  */
-/** @addtogroup ia32
+/** @addtogroup ia32
  * @{
  */
 /** @file
 ,15 → 35,24
 #ifndef KERN_ia32_BOOT_H_
 #define KERN_ia32_BOOT_H_
-#define BOOT_OFFSET     0x108000
-#define AP_BOOT_OFFSET      0x8000
-#define BOOT_STACK_SIZE 0x400
+#define BOOT_OFFSET      0x108000
+#define AP_BOOT_OFFSET   0x8000
+#define BOOT_STACK_SIZE  0x400
-#define MULTIBOOT_HEADER_MAGIC  0x1BADB002
-#define MULTIBOOT_HEADER_FLAGS  0x00010003
+#define MULTIBOOT_HEADER_MAGIC  0x1BADB002
+#define MULTIBOOT_HEADER_FLAGS  0x00010003
-#define MULTIBOOT_LOADER_MAGIC  0x2BADB002
+#ifndef __ASM__
+#ifdef CONFIG_SMP
+/* This is only a symbol so the type is dummy. Obtain the value using &. */
+extern int _hardcoded_unmapped_size;
+#endif /* CONFIG_SMP */
+#endif /* __ASM__ */
 #endif
 /** @}

 /branches/tracing/kernel/arch/ia32/include/arch.h
 ,5 → 1,5
 /*
- * Copyright (c) 2005 Martin Decky
+ * Copyright (c) 2009 Martin Decky
  * All rights reserved.
  *
  * Redistribution and use in source and binary forms, with or without
 ,7 → 26,7
  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
  */
-/** @addtogroup ia32
+/** @addtogroup ia32
  * @{
  */
 /** @file
 ,6 → 35,10
 #ifndef KERN_ia32_ARCH_H_
 #define KERN_ia32_ARCH_H_
+#include <genarch/multiboot/multiboot.h>
+extern void arch_pre_main(uint32_t, const multiboot_info_t *);
 #endif
 /** @}

 /branches/tracing/kernel/arch/ia32/include/asm.h
 ,7 → 27,7
  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
  */
-/** @addtogroup ia32
+/** @addtogroup ia32
  * @{
  */
 /** @file
 ,6 → 38,7
 #include <arch/pm.h>
 #include <arch/types.h>
+#include <typedefs.h>
 #include <config.h>
 extern uint32_t interrupt_handler_size;
 ,11 → 56,16
 /** Halt CPU
  *
- * Halt the current CPU until interrupt event.
+ * Halt the current CPU.
+ *
  */
 static inline void cpu_halt(void)
 {
-    asm volatile ("hlt\n");
+    asm volatile (
+        "0:\n"
+        "   hlt\n"
+        "   jmp 0b\n"
+    );
 }
 static inline void cpu_sleep(void)
 ,16 → 74,22
 }
 #define GEN_READ_REG(reg) static inline unative_t read_ ##reg (void) \
-    { \
-    unative_t res; \
-    asm volatile ("movl %%" #reg ", %0" : "=r" (res) ); \
-    return res; \
-    }
+    { \
+        unative_t res; \
+        asm volatile ( \
+            "movl %%" #reg ", %[res]" \
+            : [res] "=r" (res) \
+        ); \
+        return res; \
+    }
 #define GEN_WRITE_REG(reg) static inline void write_ ##reg (unative_t regn) \
-    { \
-    asm volatile ("movl %0, %%" #reg : : "r" (regn)); \
-    }
+    { \
+        asm volatile ( \
+            "movl %[regn], %%" #reg \
+            :: [regn] "r" (regn) \
+        ); \
+    }
 GEN_READ_REG(cr0)
 GEN_READ_REG(cr2)
 ,10 → 116,14
  *
  * @param port Port to write to
  * @param val Value to write
+ *
  */
-static inline void outb(uint16_t port, uint8_t val)
+static inline void pio_write_8(ioport8_t *port, uint8_t val)
 {
-    asm volatile ("outb %b0, %w1\n" : : "a" (val), "d" (port) );
+    asm volatile (
+        "outb %b[val], %w[port]\n"
+        :: [val] "a" (val), [port] "d" (port)
+    );
 }
 /** Word to port
 ,10 → 132,14
  *
  * @param port Port to write to
  * @param val Value to write
+ *
  */
-static inline void outw(uint16_t port, uint16_t val)
+static inline void pio_write_16(ioport16_t *port, uint16_t val)
 {
-    asm volatile ("outw %w0, %w1\n" : : "a" (val), "d" (port) );
+    asm volatile (
+        "outw %w[val], %w[port]\n"
+        :: [val] "a" (val), [port] "d" (port)
+    );
 }
 /** Double word to port
 ,10 → 148,14
  *
  * @param port Port to write to
  * @param val Value to write
+ *
  */
-static inline void outl(uint16_t port, uint32_t val)
+static inline void pio_write_32(ioport32_t *port, uint32_t val)
 {
-    asm volatile ("outl %l0, %w1\n" : : "a" (val), "d" (port) );
+    asm volatile (
+        "outl %[val], %w[port]\n"
+        :: [val] "a" (val), [port] "d" (port)
+    );
 }
 /** Byte from port
 ,12 → 164,18
  *
  * @param port Port to read from
  * @return Value read
+ *
  */
-static inline uint8_t inb(uint16_t port)
+static inline uint8_t pio_read_8(ioport8_t *port)
 {
     uint8_t val;
-    asm volatile ("inb %w1, %b0 \n" : "=a" (val) : "d" (port) );
+    asm volatile (
+        "inb %w[port], %b[val]\n"
+        : [val] "=a" (val)
+        : [port] "d" (port)
+    );
     return val;
 }
 ,12 → 185,18
  *
  * @param port Port to read from
  * @return Value read
+ *
  */
-static inline uint16_t inw(uint16_t port)
+static inline uint16_t pio_read_16(ioport16_t *port)
 {
     uint16_t val;
-    asm volatile ("inw %w1, %w0 \n" : "=a" (val) : "d" (port) );
+    asm volatile (
+        "inw %w[port], %w[val]\n"
+        : [val] "=a" (val)
+        : [port] "d" (port)
+    );
     return val;
 }
 ,12 → 206,18
  *
  * @param port Port to read from
  * @return Value read
+ *
  */
-static inline uint32_t inl(uint16_t port)
+static inline uint32_t pio_read_32(ioport32_t *port)
 {
     uint32_t val;
-    asm volatile ("inl %w1, %l0 \n" : "=a" (val) : "d" (port) );
+    asm volatile (
+        "inl %w[port], %[val]\n"
+        : [val] "=a" (val)
+        : [port] "d" (port)
+    );
     return val;
 }
 ,16 → 227,19
  * value of EFLAGS.
  *
  * @return Old interrupt priority level.
+ *
  */
 static inline ipl_t interrupts_enable(void)
 {
     ipl_t v;
     asm volatile (
-        "pushf\n\t"
-        "popl %0\n\t"
+        "pushf\n"
+        "popl %[v]\n"
         "sti\n"
-        : "=r" (v)
+        : [v] "=r" (v)
     );
     return v;
 }
 ,16 → 249,19
  * value of EFLAGS.
  *
  * @return Old interrupt priority level.
+ *
  */
 static inline ipl_t interrupts_disable(void)
 {
     ipl_t v;
     asm volatile (
-        "pushf\n\t"
-        "popl %0\n\t"
+        "pushf\n"
+        "popl %[v]\n"
         "cli\n"
-        : "=r" (v)
+        : [v] "=r" (v)
     );
     return v;
 }
 ,13 → 270,14
  * Restore EFLAGS.
  *
  * @param ipl Saved interrupt priority level.
+ *
  */
 static inline void interrupts_restore(ipl_t ipl)
 {
     asm volatile (
-        "pushl %0\n\t"
+        "pushl %[ipl]\n"
         "popf\n"
-        : : "r" (ipl)
+        :: [ipl] "r" (ipl)
     );
 }
 ,15 → 284,18
 /** Return interrupt priority level.
  *
  * @return EFLAFS.
+ *
  */
 static inline ipl_t interrupts_read(void)
 {
     ipl_t v;
     asm volatile (
-        "pushf\n\t"
-        "popl %0\n"
-        : "=r" (v)
+        "pushf\n"
+        "popl %[v]\n"
+        : [v] "=r" (v)
     );
     return v;
 }
 ,16 → 302,24
 /** Write to MSR */
 static inline void write_msr(uint32_t msr, uint64_t value)
 {
-    asm volatile ("wrmsr" : : "c" (msr), "a" ((uint32_t)(value)),
-        "d" ((uint32_t)(value >> 32)));
+    asm volatile (
+        "wrmsr"
+        :: "c" (msr), "a" ((uint32_t) (value)),
+           "d" ((uint32_t) (value >> 32))
+    );
 }
 static inline uint64_t read_msr(uint32_t msr)
 {
     uint32_t ax, dx;
-    asm volatile ("rdmsr" : "=a"(ax), "=d"(dx) : "c" (msr));
-    return ((uint64_t)dx << 32) | ax;
+    asm volatile (
+        "rdmsr"
+        : "=a" (ax), "=d" (dx)
+        : "c" (msr)
+    );
+    return ((uint64_t) dx << 32) | ax;
 }
 ,6 → 328,7
  * Return the base address of the current stack.
  * The stack is assumed to be STACK_SIZE bytes long.
  * The stack must start on page boundary.
+ *
  */
 static inline uintptr_t get_stack_base(void)
 {
 ,8 → 335,8
     uintptr_t v;
     asm volatile (
-        "andl %%esp, %0\n"
-        : "=r" (v)
+        "andl %%esp, %[v]\n"
+        : [v] "=r" (v)
         : "0" (~(STACK_SIZE - 1))
     );
 ,11 → 347,12
 static inline uintptr_t * get_ip()
 {
     uintptr_t *ip;
     asm volatile (
-        "mov %%eip, %0"
-        : "=r" (ip)
-        );
+        "mov %%eip, %[ip]"
+        : [ip] "=r" (ip)
+    );
     return ip;
 }
 ,46 → 359,66
 /** Invalidate TLB Entry.
  *
  * @param addr Address on a page whose TLB entry is to be invalidated.
+ *
  */
 static inline void invlpg(uintptr_t addr)
 {
-    asm volatile ("invlpg %0\n" :: "m" (*(unative_t *)addr));
+    asm volatile (
+        "invlpg %[addr]\n"
+        :: [addr] "m" (*(unative_t *) addr)
+    );
 }
 /** Load GDTR register from memory.
  *
  * @param gdtr_reg Address of memory from where to load GDTR.
+ *
  */
 static inline void gdtr_load(ptr_16_32_t *gdtr_reg)
 {
-    asm volatile ("lgdtl %0\n" : : "m" (*gdtr_reg));
+    asm volatile (
+        "lgdtl %[gdtr_reg]\n"
+        :: [gdtr_reg] "m" (*gdtr_reg)
+    );
 }
 /** Store GDTR register to memory.
  *
  * @param gdtr_reg Address of memory to where to load GDTR.
+ *
  */
 static inline void gdtr_store(ptr_16_32_t *gdtr_reg)
 {
-    asm volatile ("sgdtl %0\n" : : "m" (*gdtr_reg));
+    asm volatile (
+        "sgdtl %[gdtr_reg]\n"
+        :: [gdtr_reg] "m" (*gdtr_reg)
+    );
 }
 /** Load IDTR register from memory.
  *
  * @param idtr_reg Address of memory from where to load IDTR.
+ *
  */
 static inline void idtr_load(ptr_16_32_t *idtr_reg)
 {
-    asm volatile ("lidtl %0\n" : : "m" (*idtr_reg));
+    asm volatile (
+        "lidtl %[idtr_reg]\n"
+        :: [idtr_reg] "m" (*idtr_reg)
+    );
 }
 /** Load TR from descriptor table.
  *
  * @param sel Selector specifying descriptor of TSS segment.
+ *
  */
 static inline void tr_load(uint16_t sel)
 {
-    asm volatile ("ltr %0" : : "r" (sel));
+    asm volatile (
+        "ltr %[sel]"
+        :: [sel] "r" (sel)
+    );
 }
 #endif

 /branches/tracing/kernel/arch/ia32/include/mm/frame.h
 ,7 → 26,7
  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
  */
-/** @addtogroup ia32mm
+/** @addtogroup ia32mm
  * @{
  */
 /** @file
 ,8 → 35,8
 #ifndef KERN_ia32_FRAME_H_
 #define KERN_ia32_FRAME_H_
-#define FRAME_WIDTH 12  /* 4K */
-#define FRAME_SIZE  (1 << FRAME_WIDTH)
+#define FRAME_WIDTH  12  /* 4K */
+#define FRAME_SIZE   (1 << FRAME_WIDTH)
 #ifdef KERNEL
 #ifndef __ASM__

 /branches/tracing/kernel/arch/ia32/include/mm/tlb.h
 ,7 → 26,7
  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
  */
-/** @addtogroup ia32mm
+/** @addtogroup ia32mm
  * @{
  */
 /** @file
 ,9 → 35,6
 #ifndef KERN_ia32_TLB_H_
 #define KERN_ia32_TLB_H_
-#define tlb_arch_init()
-#define tlb_print()
 #endif
 /** @}

 /branches/tracing/kernel/arch/ia32/include/mm/as.h
 ,7 → 42,7
 #define USER_ADDRESS_SPACE_START_ARCH       ((unsigned long) 0x00000000)
 #define USER_ADDRESS_SPACE_END_ARCH     ((unsigned long) 0x7fffffff)
-#define USTACK_ADDRESS_ARCH (USER_ADDRESS_SPACE_END_ARCH-(PAGE_SIZE-1))
+#define USTACK_ADDRESS_ARCH (USER_ADDRESS_SPACE_END_ARCH - (PAGE_SIZE - 1))
 typedef struct {
 } as_arch_t;

 /branches/tracing/kernel/arch/ia32/include/barrier.h
 ,7 → 26,7
  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
  */
-/** @addtogroup ia32
+/** @addtogroup ia32
  * @{
  */
 /** @file
 ,8 → 46,8
  * Provisions are made to prevent compiler from reordering instructions itself.
  */
-#define CS_ENTER_BARRIER()  asm volatile ("" ::: "memory")
-#define CS_LEAVE_BARRIER()  asm volatile ("" ::: "memory")
+#define CS_ENTER_BARRIER()  asm volatile ("" ::: "memory")
+#define CS_LEAVE_BARRIER()  asm volatile ("" ::: "memory")
 static inline void cpuid_serialization(void)
 {
 ,30 → 58,30
     );
 }
-#ifdef CONFIG_FENCES_P4
-#   define memory_barrier()     asm volatile ("mfence\n" ::: "memory")
-#   define read_barrier()       asm volatile ("lfence\n" ::: "memory")
-#   ifdef CONFIG_WEAK_MEMORY
-#       define write_barrier()  asm volatile ("sfence\n" ::: "memory")
-#   else
-#       define write_barrier()  asm volatile( "" ::: "memory");
-#   endif
-#elif CONFIG_FENCES_P3
-#   define memory_barrier()     cpuid_serialization()
-#   define read_barrier()       cpuid_serialization()
-#   ifdef CONFIG_WEAK_MEMORY
-#       define write_barrier()  asm volatile ("sfence\n" ::: "memory")
-#   else
-#       define write_barrier()  asm volatile( "" ::: "memory");
-#   endif
+#if defined(CONFIG_FENCES_P4)
+    #define memory_barrier()  asm volatile ("mfence\n" ::: "memory")
+    #define read_barrier()    asm volatile ("lfence\n" ::: "memory")
+    #ifdef CONFIG_WEAK_MEMORY
+        #define write_barrier()  asm volatile ("sfence\n" ::: "memory")
+    #else
+        #define write_barrier()  asm volatile ("" ::: "memory");
+    #endif
+#elif defined(CONFIG_FENCES_P3)
+    #define memory_barrier()  cpuid_serialization()
+    #define read_barrier()    cpuid_serialization()
+    #ifdef CONFIG_WEAK_MEMORY
+        #define write_barrier()  asm volatile ("sfence\n" ::: "memory")
+    #else
+        #define write_barrier()  asm volatile ("" ::: "memory");
+    #endif
 #else
-#   define memory_barrier()     cpuid_serialization()
-#   define read_barrier()       cpuid_serialization()
-#   ifdef CONFIG_WEAK_MEMORY
-#       define write_barrier()  cpuid_serialization()
-#   else
-#       define write_barrier()  asm volatile( "" ::: "memory");
-#   endif
+    #define memory_barrier()  cpuid_serialization()
+    #define read_barrier()    cpuid_serialization()
+    #ifdef CONFIG_WEAK_MEMORY
+        #define write_barrier()  cpuid_serialization()
+    #else
+        #define write_barrier()  asm volatile ("" ::: "memory");
+    #endif
 #endif
 /*
 ,8 → 90,8
  * queueing in the store buffer drain to the memory (even though it would be
  * sufficient for them to drain to the D-cache).
  */
-#define smc_coherence(a)        write_barrier()
-#define smc_coherence_block(a, l)   write_barrier()
+#define smc_coherence(a)           write_barrier()
+#define smc_coherence_block(a, l)  write_barrier()
 #endif

 /branches/tracing/kernel/arch/ia32/include/cpu.h
 ,11 → 51,11
 #include <arch/asm.h>
 typedef struct {
-    int vendor;
-    int family;
-    int model;
-    int stepping;
-    struct tss *tss;
+    unsigned int vendor;
+    unsigned int family;
+    unsigned int model;
+    unsigned int stepping;
+    tss_t *tss;
     count_t iomapver_copy;  /** Copy of TASK's I/O Permission bitmap generation count. */
 } cpu_arch_t;

 /branches/tracing/kernel/arch/ia32/include/drivers/i8254.h
 ,7 → 26,7
  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
  */
-/** @addtogroup ia32
+/** @addtogroup ia32
  * @{
  */
 /** @file

 /branches/tracing/kernel/arch/ia32/include/drivers/vesa.h
 ,7 → 26,7
  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
  */
-/** @addtogroup ia32
+/** @addtogroup ia32
  * @{
  */
 /** @file
 ,6 → 36,7
 #define KERN_ia32_VESA_H_
 extern int vesa_present(void);
+extern void vesa_redraw(void);
 extern void vesa_init(void);
 #endif

 /branches/tracing/kernel/arch/ia32/include/drivers/i8259.h
 ,7 → 26,7
  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
  */
-/** @addtogroup ia32
+/** @addtogroup ia32
  * @{
  */
 /** @file
 ,13 → 38,13
 #include <arch/types.h>
 #include <arch/interrupt.h>
-#define PIC_PIC0PORT1   0x20
-#define PIC_PIC0PORT2   0x21
-#define PIC_PIC1PORT1   0xa0
-#define PIC_PIC1PORT2   0xa1
+#define PIC_PIC0PORT1  ((ioport8_t *) 0x20)
+#define PIC_PIC0PORT2  ((ioport8_t *) 0x21)
+#define PIC_PIC1PORT1  ((ioport8_t *) 0xa0)
+#define PIC_PIC1PORT2  ((ioport8_t *) 0xa1)
-#define PIC_NEEDICW4    (1<<0)
-#define PIC_ICW1    (1<<4)
+#define PIC_NEEDICW4  (1 << 0)
+#define PIC_ICW1      (1 << 4)
 extern void i8259_init(void);
 extern void pic_enable_irqs(uint16_t irqmask);

 /branches/tracing/kernel/arch/ia32/Makefile.inc
 ,10 → 29,6
 ## Toolchain configuration
 #
-ifndef CROSS_PREFIX
-    CROSS_PREFIX = /usr/local
-endif
 BFD_NAME = elf32-i386
 BFD_ARCH = i386
 BFD = binary
 ,7 → 35,7
 TARGET = i686-pc-linux-gnu
 TOOLCHAIN_DIR = $(CROSS_PREFIX)/i686
-DEFS += -DMACHINE=$(MACHINE) -D__32_BITS__
+DEFS += -D__32_BITS__
 CMN1 = -m32
 GCC_CFLAGS += $(CMN1)
 ,121 → 45,66
 ## Accepted CPUs
 #
-ifeq ($(MACHINE),athlon-xp)
-    FPU_NO_CFLAGS = -mno-mmx -mno-sse -mno-3dnow
+ifeq ($(PROCESSOR),athlon_xp)
     CMN2 = -march=athlon-xp
-    GCC_CFLAGS += $(CMN2)
-    ICC_CFLAGS += $(CMN2)
     SUNCC_CFLAGS += -xarch=ssea
-    DEFS += -DCONFIG_FENCES_P3
-    CONFIG_SMP = n
-    CONFIG_HT = n
 endif
-ifeq ($(MACHINE),athlon-mp)
-    FPU_NO_CFLAGS = -mno-mmx -mno-sse -mno-3dnow
+ifeq ($(PROCESSOR),athlon_mp)
     CMN2 = -march=athlon-mp
-    GCC_CFLAGS += $(CMN2)
-    ICC_CFLAGS += $(CMN2)
     SUNCC_CFLAGS += xarch=ssea
-    DEFS += -DCONFIG_FENCES_P3
-    CONFIG_HT = n
 endif
-ifeq ($(MACHINE),pentium3)
-    FPU_NO_CFLAGS = -mno-mmx -mno-sse
+ifeq ($(PROCESSOR),pentium3)
     CMN2 = -march=pentium3
-    GCC_CFLAGS += $(CMN2)
-    ICC_CFLAGS += $(CMN2)
     SUNCC_CFLAGS += -xarch=sse
-    DEFS += -DCONFIG_FENCES_P3
-    CONFIG_HT = n
 endif
-ifeq ($(MACHINE),core)
-    FPU_NO_CFLAGS = -mno-mmx -mno-sse -mno-sse2 -mno-sse3
+ifeq ($(PROCESSOR),pentium4)
+    CMN2 = -march=pentium4
+    SUNCC_CFLAGS += -xarch=sse2
+endif
+ifeq ($(PROCESSOR),core)
     CMN2 = -march=prescott
-    GCC_CFLAGS += $(CMN2)
-    ICC_CFLAGS += $(CMN2)
     SUNCC_CFLAGS += -xarch=sse3
-    DEFS += -DCONFIG_FENCES_P4
 endif
-ifeq ($(MACHINE),pentium4)
-    FPU_NO_CFLAGS = -mno-mmx -mno-sse -mno-sse2
-    GCC_CFLAGS += -march=pentium4
-    ICC_CFLAGS += -march=pentium4
-    SUNCC_CFLAGS += -xarch=sse2
-    DEFS += -DCONFIG_FENCES_P4
-endif
-## Own configuration directives
-#
+FPU_NO_CFLAGS = -mno-mmx -mno-sse -mno-sse2 -mno-sse3 -mno-3dnow
+GCC_CFLAGS += $(CMN2)
+ICC_CFLAGS += $(CMN2)
-CONFIG_ACPI = y
-## Compile with hierarchical page tables support.
-#
-CONFIG_PAGE_PT = y
-DEFS += -DCONFIG_PAGE_PT
-## Compile with i8042 controller support
-#
-CONFIG_I8042 = y
-DEFS += -DCONFIG_I8042
-## Accepted configuration directives
-#
-ifeq ($(CONFIG_SMP),y)
-    DEFS += -DCONFIG_SMP
-endif
-ifeq ($(CONFIG_HT),y)
-    DEFS += -DCONFIG_HT
-endif
-ifeq ($(CONFIG_SIMICS_FIX),y)
-    DEFS += -DCONFIG_SIMICS_FIX
-endif
-## Compile with support for software integer division.
-#
-CONFIG_SOFTINT = y
 ARCH_SOURCES = \
-    arch/$(ARCH)/src/context.S \
-    arch/$(ARCH)/src/debug/panic.s \
-    arch/$(ARCH)/src/delay.s \
-    arch/$(ARCH)/src/asm.S \
-    arch/$(ARCH)/src/proc/scheduler.c \
-    arch/$(ARCH)/src/proc/task.c \
-    arch/$(ARCH)/src/proc/thread.c \
-    arch/$(ARCH)/src/bios/bios.c \
-    arch/$(ARCH)/src/smp/ap.S \
-    arch/$(ARCH)/src/smp/apic.c \
-    arch/$(ARCH)/src/smp/mps.c \
-    arch/$(ARCH)/src/smp/smp.c \
-    arch/$(ARCH)/src/atomic.S \
-    arch/$(ARCH)/src/smp/ipi.c \
-    arch/$(ARCH)/src/ia32.c \
-    arch/$(ARCH)/src/interrupt.c \
-    arch/$(ARCH)/src/pm.c \
-    arch/$(ARCH)/src/userspace.c \
-    arch/$(ARCH)/src/cpu/cpu.c \
-    arch/$(ARCH)/src/mm/as.c \
-    arch/$(ARCH)/src/mm/frame.c \
-    arch/$(ARCH)/src/mm/page.c \
-    arch/$(ARCH)/src/mm/tlb.c \
-    arch/$(ARCH)/src/ddi/ddi.c \
-    arch/$(ARCH)/src/drivers/i8254.c \
-    arch/$(ARCH)/src/drivers/i8259.c \
-    arch/$(ARCH)/src/drivers/ega.c \
-    arch/$(ARCH)/src/drivers/vesa.c \
-    arch/$(ARCH)/src/boot/boot.S \
-    arch/$(ARCH)/src/boot/memmap.c \
-    arch/$(ARCH)/src/fpu_context.c \
-    arch/$(ARCH)/src/debugger.c \
-    arch/$(ARCH)/src/syscall.c
+    arch/$(KARCH)/src/context.S \
+    arch/$(KARCH)/src/debug/panic.s \
+    arch/$(KARCH)/src/delay.s \
+    arch/$(KARCH)/src/asm.S \
+    arch/$(KARCH)/src/proc/scheduler.c \
+    arch/$(KARCH)/src/proc/task.c \
+    arch/$(KARCH)/src/proc/thread.c \
+    arch/$(KARCH)/src/bios/bios.c \
+    arch/$(KARCH)/src/smp/ap.S \
+    arch/$(KARCH)/src/smp/apic.c \
+    arch/$(KARCH)/src/smp/mps.c \
+    arch/$(KARCH)/src/smp/smp.c \
+    arch/$(KARCH)/src/atomic.S \
+    arch/$(KARCH)/src/smp/ipi.c \
+    arch/$(KARCH)/src/ia32.c \
+    arch/$(KARCH)/src/interrupt.c \
+    arch/$(KARCH)/src/pm.c \
+    arch/$(KARCH)/src/userspace.c \
+    arch/$(KARCH)/src/cpu/cpu.c \
+    arch/$(KARCH)/src/mm/as.c \
+    arch/$(KARCH)/src/mm/frame.c \
+    arch/$(KARCH)/src/mm/page.c \
+    arch/$(KARCH)/src/mm/tlb.c \
+    arch/$(KARCH)/src/ddi/ddi.c \
+    arch/$(KARCH)/src/drivers/i8254.c \
+    arch/$(KARCH)/src/drivers/i8259.c \
+    arch/$(KARCH)/src/drivers/vesa.c \
+    arch/$(KARCH)/src/boot/boot.S \
+    arch/$(KARCH)/src/boot/memmap.c \
+    arch/$(KARCH)/src/fpu_context.c \
+    arch/$(KARCH)/src/debugger.c \
+    arch/$(KARCH)/src/syscall.c
 ifeq ($(CONFIG_UDEBUG),y)
-ARCH_SOURCES += \
-    arch/$(ARCH)/src/breakpoint.c
+    ARCH_SOURCES += \
+        arch/$(KARCH)/src/breakpoint.c
 endif

 /branches/tracing/kernel/arch/ia32/src/fpu_context.c
 ,46 → 44,43
 static void fpu_context_f_save(fpu_context_t *fctx)
 {
     asm volatile (
-        "fnsave %0"
-        : "=m"(*fctx)
-        );
+        "fnsave %[fctx]"
+        : [fctx] "=m" (*fctx)
+    );
 }
 static void fpu_context_f_restore(fpu_context_t *fctx)
 {
     asm volatile (
-        "frstor %0"
-        : "=m"(*fctx)
-        );
+        "frstor %[fctx]"
+        : [fctx] "=m" (*fctx)
+    );
 }
 static void fpu_context_fx_save(fpu_context_t *fctx)
 {
     asm volatile (
-        "fxsave %0"
-        : "=m"(*fctx)
-        );
+        "fxsave %[fctx]"
+        : [fctx] "=m" (*fctx)
+    );
 }
 static void fpu_context_fx_restore(fpu_context_t *fctx)
 {
     asm volatile (
-        "fxrstor %0"
-        : "=m"(*fctx)
-        );
+        "fxrstor %[fctx]"
+        : [fctx] "=m" (*fctx)
+    );
 }
-/*
-    Setup using fxsr instruction
-*/
+/* Setup using fxsr instruction */
 void fpu_fxsr(void)
 {
     fpu_save=fpu_context_fx_save;
     fpu_restore=fpu_context_fx_restore;
 }
-/*
-    Setup using not fxsr instruction
-*/
+/* Setup using not fxsr instruction */
 void fpu_fsr(void)
 {
     fpu_save = fpu_context_f_save;
 ,16 → 99,18
 void fpu_init()
 {
-    uint32_t help0 = 0, help1 = 0;
+    uint32_t help0 = 0;
+    uint32_t help1 = 0;
     asm volatile (
-        "fninit;\n"
-        "stmxcsr %0\n"
-        "mov %0,%1;\n"
-        "or %2,%1;\n"
-        "mov %1,%0;\n"
-        "ldmxcsr %0;\n"
-        : "+m" (help0), "+r" (help1)
-        : "i" (0x1f80)
+        "fninit\n"
+        "stmxcsr %[help0]\n"
+        "mov %[help0], %[help1]\n"
+        "or %[magic], %[help1]\n"
+        "mov %[help1], %[help0]\n"
+        "ldmxcsr %[help0]\n"
+        : [help0] "+m" (help0), [help1] "+r" (help1)
+        : [magic] "i" (0x1f80)
     );
 }

 /branches/tracing/kernel/arch/ia32/src/ia32.c
 ,5 → 1,7
 /*
  * Copyright (c) 2001-2004 Jakub Jermar
+ * Copyright (c) 2009 Jiri Svoboda
+ * Copyright (c) 2009 Martin Decky
  * All rights reserved.
  *
  * Redistribution and use in source and binary forms, with or without
 ,9 → 40,12
 #include <arch/pm.h>
-#include <arch/drivers/ega.h>
+#include <genarch/multiboot/multiboot.h>
+#include <genarch/drivers/legacy/ia32/io.h>
+#include <genarch/drivers/ega/ega.h>
 #include <arch/drivers/vesa.h>
-#include <genarch/kbd/i8042.h>
+#include <genarch/drivers/i8042/i8042.h>
+#include <genarch/kbrd/kbrd.h>
 #include <arch/drivers/i8254.h>
 #include <arch/drivers/i8259.h>
 ,12 → 66,30
 #include <proc/thread.h>
 #include <syscall/syscall.h>
 #include <console/console.h>
-#include <ddi/device.h>
+#include <sysinfo/sysinfo.h>
+#include <arch/boot/boot.h>
 #ifdef CONFIG_SMP
 #include <arch/smp/apic.h>
 #endif
+/** Perform ia32-specific initialization before main_bsp() is called.
+ *
+ * @param signature Should contain the multiboot signature.
+ * @param mi        Pointer to the multiboot information structure.
+ */
+void arch_pre_main(uint32_t signature, const multiboot_info_t *mi)
+{
+    /* Parse multiboot information obtained from the bootloader. */
+    multiboot_info_parse(signature, mi);
+#ifdef CONFIG_SMP
+    /* Copy AP bootstrap routines below 1 MB. */
+    memcpy((void *) AP_BOOT_OFFSET, (void *) BOOT_OFFSET,
+        (size_t) &_hardcoded_unmapped_size);
+#endif
+}
 void arch_pre_mm_init(void)
 {
     pm_init();
 ,13 → 111,17
         /* hard clock */
         i8254_init();
 #ifdef CONFIG_FB
-        if (vesa_present())
+        if (vesa_present())
             vesa_init();
         else
 #endif
-            ega_init(); /* video */
+#ifdef CONFIG_EGA
+            ega_init(EGA_BASE, EGA_VIDEORAM);  /* video */
+#else
+            {}
+#endif
         /* Enable debugger */
         debugger_init();
 ,10 → 156,33
 void arch_post_smp_init(void)
 {
-    devno_t kbd = device_assign_devno();
-    devno_t mouse = device_assign_devno();
-    /* keyboard controller */
-    i8042_init(kbd, IRQ_KBD, mouse, IRQ_MOUSE);
+#ifdef CONFIG_PC_KBD
+    /*
+     * Initialize the i8042 controller. Then initialize the keyboard
+     * module and connect it to i8042. Enable keyboard interrupts.
+     */
+    i8042_instance_t *i8042_instance = i8042_init((i8042_t *) I8042_BASE, IRQ_KBD);
+    if (i8042_instance) {
+        kbrd_instance_t *kbrd_instance = kbrd_init();
+        if (kbrd_instance) {
+            indev_t *sink = stdin_wire();
+            indev_t *kbrd = kbrd_wire(kbrd_instance, sink);
+            i8042_wire(i8042_instance, kbrd);
+            trap_virtual_enable_irqs(1 << IRQ_KBD);
+        }
+    }
+    /*
+     * This is the necessary evil until the userspace driver is entirely
+     * self-sufficient.
+     */
+    sysinfo_set_item_val("kbd", NULL, true);
+    sysinfo_set_item_val("kbd.inr", NULL, IRQ_KBD);
+    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
 }
 void calibrate_delay_loop(void)
 ,15 → 215,45
  */
 void arch_grab_console(void)
 {
-    i8042_grab();
+#ifdef CONFIG_FB
+    if (vesa_present())
+        vesa_redraw();
+    else
+#endif
+#ifdef CONFIG_EGA
+        ega_redraw();
+#else
+        {}
+#endif
 }
 /** Return console to userspace
  *
  */
 void arch_release_console(void)
 {
-    i8042_release();
 }
+/** 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)
+{
+    return addr;
+}
+void arch_reboot(void)
+{
+#ifdef CONFIG_PC_KBD
+    i8042_cpu_reset((i8042_t *) I8042_BASE);
+#endif
+}
 /** @}
  */

 /branches/tracing/kernel/arch/ia32/src/asm.S
 ,14 → 268,6
     pushl %fs
     pushl %gs
-#ifdef CONFIG_DEBUG_ALLREGS
-    pushl %ebx
-    pushl %ebp
-    pushl %edi
-    pushl %esi
-#else
-    subl $16, %esp
-#endif
     pushl %edx
     pushl %ecx
     pushl %eax
 ,14 → 289,6
     popl %eax
     popl %ecx
     popl %edx
-#ifdef CONFIG_DEBUG_ALLREGS
-    popl %esi
-    popl %edi
-    popl %ebp
-    popl %ebx
-#else
-    addl $16, %esp
-#endif
     popl %gs
     popl %fs

 /branches/tracing/kernel/arch/ia32/src/cpu/cpu.c
 ,17 → 48,17
  * Identification of CPUs.
  * Contains only non-MP-Specification specific SMP code.
  */
-#define AMD_CPUID_EBX   0x68747541
-#define AMD_CPUID_ECX   0x444d4163
-#define AMD_CPUID_EDX   0x69746e65
+#define AMD_CPUID_EBX  0x68747541
+#define AMD_CPUID_ECX  0x444d4163
+#define AMD_CPUID_EDX  0x69746e65
-#define INTEL_CPUID_EBX 0x756e6547
-#define INTEL_CPUID_ECX 0x6c65746e
-#define INTEL_CPUID_EDX 0x49656e69
+#define INTEL_CPUID_EBX  0x756e6547
+#define INTEL_CPUID_ECX  0x6c65746e
+#define INTEL_CPUID_EDX  0x49656e69
 enum vendor {
-    VendorUnknown=0,
+    VendorUnknown = 0,
     VendorAMD,
     VendorIntel
 };
 ,19 → 65,17
 static char *vendor_str[] = {
     "Unknown Vendor",
-    "AuthenticAMD",
-    "GenuineIntel"
+    "AMD",
+    "Intel"
 };
 void fpu_disable(void)
 {
     asm volatile (
-        "mov %%cr0,%%eax;"
-        "or $8,%%eax;"
-        "mov %%eax,%%cr0;"
-        :
-        :
-        :"%eax"
+        "mov %%cr0, %%eax\n"
+        "or $8, %%eax\n"
+        "mov %%eax, %%cr0\n"
+        ::: "%eax"
     );
 }
 ,13 → 82,11
 void fpu_enable(void)
 {
     asm volatile (
-        "mov %%cr0,%%eax;"
-        "and $0xffFFffF7,%%eax;"
-        "mov %%eax,%%cr0;"
-        :
-        :
-        :"%eax"
-    );
+        "mov %%cr0, %%eax\n"
+        "and $0xffFFffF7, %%eax\n"
+        "mov %%eax,%%cr0\n"
+        ::: "%eax"
+    );
 }
 void cpu_arch_init(void)
 ,11 → 98,11
     CPU->arch.tss = tss_p;
     CPU->arch.tss->iomap_base = &CPU->arch.tss->iomap[0] - ((uint8_t *) CPU->arch.tss);
     CPU->fpu_owner = NULL;
     cpuid(1, &info);
     fi.word = info.cpuid_edx;
     efi.word = info.cpuid_ecx;
 ,15 → 109,15
     if (fi.bits.fxsr)
         fpu_fxsr();
     else
-        fpu_fsr();
+        fpu_fsr();
     if (fi.bits.sse) {
         asm volatile (
-            "mov %%cr4,%0\n"
-            "or %1,%0\n"
-            "mov %0,%%cr4\n"
-            : "+r" (help)
-            : "i" (CR4_OSFXSR_MASK|(1<<10))
+            "mov %%cr4, %[help]\n"
+            "or %[mask], %[help]\n"
+            "mov %[help], %%cr4\n"
+            : [help] "+r" (help)
+            : [mask] "i" (CR4_OSFXSR_MASK | (1 << 10))
         );
     }
 ,29 → 136,31
         /*
          * Check for AMD processor.
          */
-        if (info.cpuid_ebx==AMD_CPUID_EBX && info.cpuid_ecx==AMD_CPUID_ECX && info.cpuid_edx==AMD_CPUID_EDX) {
+        if ((info.cpuid_ebx == AMD_CPUID_EBX)
+            && (info.cpuid_ecx == AMD_CPUID_ECX)
+            && (info.cpuid_edx == AMD_CPUID_EDX))
             CPU->arch.vendor = VendorAMD;
-        }
         /*
          * Check for Intel processor.
          */
-        if (info.cpuid_ebx==INTEL_CPUID_EBX && info.cpuid_ecx==INTEL_CPUID_ECX && info.cpuid_edx==INTEL_CPUID_EDX) {
+        if ((info.cpuid_ebx == INTEL_CPUID_EBX)
+            && (info.cpuid_ecx == INTEL_CPUID_ECX)
+            && (info.cpuid_edx == INTEL_CPUID_EDX))
             CPU->arch.vendor = VendorIntel;
-        }
         cpuid(1, &info);
-        CPU->arch.family = (info.cpuid_eax>>8)&0xf;
-        CPU->arch.model = (info.cpuid_eax>>4)&0xf;
-        CPU->arch.stepping = (info.cpuid_eax>>0)&0xf;
+        CPU->arch.family = (info.cpuid_eax >> 8) & 0x0f;
+        CPU->arch.model = (info.cpuid_eax >> 4) & 0x0f;
+        CPU->arch.stepping = (info.cpuid_eax >> 0) & 0x0f;
     }
 }
-void cpu_print_report(cpu_t* m)
+void cpu_print_report(cpu_t* cpu)
 {
-    printf("cpu%d: (%s family=%d model=%d stepping=%d) %dMHz\n",
-        m->id, vendor_str[m->arch.vendor], m->arch.family, m->arch.model, m->arch.stepping,
-        m->frequency_mhz);
+    printf("cpu%u: (%s family=%u model=%u stepping=%u) %" PRIu16 " MHz\n",
+        cpu->id, vendor_str[cpu->arch.vendor], cpu->arch.family,
+        cpu->arch.model, cpu->arch.stepping, cpu->frequency_mhz);
 }
 /** @}

 /branches/tracing/kernel/arch/ia32/src/syscall.c
 ,7 → 44,7
     extern void sysenter_handler(void);
     /* set kernel mode CS selector */
-    write_msr(IA32_MSR_SYSENTER_CS, selector(KTEXT_DES));
+    write_msr(IA32_MSR_SYSENTER_CS, gdtselector(KTEXT_DES));
     /* set kernel mode entry point */
     write_msr(IA32_MSR_SYSENTER_EIP, (uint32_t) sysenter_handler);
 }

 /branches/tracing/kernel/arch/ia32/src/pm.c
 ,7 → 26,7
  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
  */
-/** @addtogroup ia32
+/** @addtogroup ia32
  * @{
  */
 /** @file
 ,7 → 112,7
 void tss_initialize(tss_t *t)
 {
-    memsetb(t, sizeof(struct tss), 0);
+    memsetb(t, sizeof(tss_t), 0);
 }
 /*
 ,7 → 127,7
         d = &idt[i];
         d->unused = 0;
-        d->selector = selector(KTEXT_DES);
+        d->selector = gdtselector(KTEXT_DES);
         d->access = AR_PRESENT | AR_INTERRUPT;  /* masking interrupt */
 ,7 → 154,7
         "and $0xffff8fff, %%eax\n"
         "push %%eax\n"
         "popfl\n"
-        : : : "eax"
+        ::: "eax"
     );
 }
 ,7 → 165,7
         "mov %%cr0, %%eax\n"
         "and $0xfffbffff, %%eax\n"
         "mov %%eax, %%cr0\n"
-        : : : "eax"
+        ::: "eax"
     );
 }
 ,7 → 198,7
     else {
         tss_p = (tss_t *) malloc(sizeof(tss_t), FRAME_ATOMIC);
         if (!tss_p)
-            panic("could not allocate TSS\n");
+            panic("Cannot allocate TSS.");
     }
     tss_initialize(tss_p);
 ,7 → 214,7
      * As of this moment, the current CPU has its own GDT pointing
      * to its own TSS. We just need to load the TR register.
      */
-    tr_load(selector(TSS_DES));
+    tr_load(gdtselector(TSS_DES));
     clean_IOPL_NT_flags();    /* Disable I/O on nonprivileged levels and clear NT flag. */
     clean_AM_flag();          /* Disable alignment check */
 ,28 → 232,5
     gdtr_load(&cpugdtr);
 }
-/* Reboot the machine by initiating
- * a triple fault
- */
-void arch_reboot(void)
-{
-    preemption_disable();
-    ipl_t ipl = interrupts_disable();
-    memsetb(idt, sizeof(idt), 0);
-    ptr_16_32_t idtr;
-    idtr.limit = sizeof(idt);
-    idtr.base = (uintptr_t) idt;
-    idtr_load(&idtr);
-    interrupts_restore(ipl);
-    asm volatile (
-        "int $0x03\n"
-        "cli\n"
-        "hlt\n"
-    );
-}
 /** @}
  */

 /branches/tracing/kernel/arch/ia32/src/smp/smp.c
 ,7 → 26,7
  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
  */
-/** @addtogroup ia32
+/** @addtogroup ia32
  * @{
  */
 /** @file
 ,12 → 75,12
     l_apic_address = (uintptr_t) frame_alloc(ONE_FRAME,
         FRAME_ATOMIC | FRAME_KA);
     if (!l_apic_address)
-        panic("cannot allocate address for l_apic\n");
+        panic("Cannot allocate address for l_apic.");
     io_apic_address = (uintptr_t) frame_alloc(ONE_FRAME,
         FRAME_ATOMIC | FRAME_KA);
     if (!io_apic_address)
-        panic("cannot allocate address for io_apic\n");
+        panic("Cannot allocate address for io_apic.");
     if (config.cpu_count > 1) {
         page_mapping_insert(AS_KERNEL, l_apic_address,
 ,8 → 122,8
      * Save 0xa to address 0xf of the CMOS RAM.
      * BIOS will not do the POST after the INIT signal.
      */
-    outb(0x70, 0xf);
-    outb(0x71, 0xa);
+    pio_write_8((ioport8_t *)0x70, 0xf);
+    pio_write_8((ioport8_t *)0x71, 0xa);
     pic_disable_irqs(0xffff);
     apic_init();
 ,8 → 131,8
     uint8_t apic = l_apic_id();
     for (i = 0; i < ops->cpu_count(); i++) {
-        struct descriptor *gdt_new;
+        descriptor_t *gdt_new;
         /*
          * Skip processors marked unusable.
          */
 ,14 → 154,19
         /*
          * Prepare new GDT for CPU in question.
          */
-        gdt_new = (struct descriptor *) malloc(GDT_ITEMS *
-            sizeof(struct descriptor), FRAME_ATOMIC | FRAME_LOW_4_GiB);
+        /* XXX Flag FRAME_LOW_4_GiB was removed temporarily,
+         * it needs to be replaced by a generic fuctionality of
+         * the memory subsystem
+         */
+        gdt_new = (descriptor_t *) malloc(GDT_ITEMS *
+            sizeof(descriptor_t), FRAME_ATOMIC);
         if (!gdt_new)
-            panic("couldn't allocate memory for GDT\n");
+            panic("Cannot allocate memory for GDT.");
-        memcpy(gdt_new, gdt, GDT_ITEMS * sizeof(struct descriptor));
-        memsetb(&gdt_new[TSS_DES], sizeof(struct descriptor), 0);
-        protected_ap_gdtr.limit = GDT_ITEMS * sizeof(struct descriptor);
+        memcpy(gdt_new, gdt, GDT_ITEMS * sizeof(descriptor_t));
+        memsetb(&gdt_new[TSS_DES], sizeof(descriptor_t), 0);
+        protected_ap_gdtr.limit = GDT_ITEMS * sizeof(descriptor_t);
         protected_ap_gdtr.base = KA2PA((uintptr_t) gdt_new);
         gdtr.base = (uintptr_t) gdt_new;

 /branches/tracing/kernel/arch/ia32/src/smp/apic.c
 ,7 → 26,7
  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
  */
-/** @addtogroup ia32
+/** @addtogroup ia32
  * @{
  */
 /** @file
 ,12 → 132,12
 #endif
 }
-static irq_ownership_t l_apic_timer_claim(void)
+static irq_ownership_t l_apic_timer_claim(irq_t *irq)
 {
     return IRQ_ACCEPT;
 }
-static void l_apic_timer_irq_handler(irq_t *irq, void *arg __attribute__((unused)), ...)
+static void l_apic_timer_irq_handler(irq_t *irq)
 {
     /*
      * Holding a spinlock could prevent clock() from preempting

 /branches/tracing/kernel/arch/ia32/src/ddi/ddi.c
 ,7 → 156,7
      * type must be changed to describe inactive TSS.
      */
     gdt_p[TSS_DES].access = AR_PRESENT | AR_TSS | DPL_KERNEL;
-    tr_load(selector(TSS_DES));
+    tr_load(gdtselector(TSS_DES));
     /*
      * Update the generation count so that faults caused by

 /branches/tracing/kernel/arch/ia32/src/proc/scheduler.c
 ,7 → 38,6
 #include <proc/thread.h>
 #include <arch.h>
 #include <arch/context.h>   /* SP_DELTA */
-#include <arch/debugger.h>
 #include <arch/pm.h>
 #include <arch/asm.h>
 #include <arch/ddi/ddi.h>
 ,25 → 59,16
 {
     uintptr_t kstk = (uintptr_t) &THREAD->kstack[THREAD_STACK_SIZE -
         SP_DELTA];
     /* Set kernel stack for CP3 -> CPL0 switch via SYSENTER */
     write_msr(IA32_MSR_SYSENTER_ESP, kstk);
     /* Set kernel stack for CPL3 -> CPL0 switch via interrupt */
     CPU->arch.tss->esp0 = kstk;
-    CPU->arch.tss->ss0 = selector(KDATA_DES);
+    CPU->arch.tss->ss0 = gdtselector(KDATA_DES);
     /* Set up TLS in GS register */
     set_tls_desc(THREAD->arch.tls);
-#ifdef CONFIG_DEBUG_AS_WATCHPOINT
-    /* Set watchpoint on AS to ensure that nobody sets it to zero */
-    if (CPU->id < BKPOINTS_MAX) {
-        the_t *the = THE;
-        breakpoint_add(&((the_t *) the->thread->kstack)->as,
-            BKPOINT_WRITE | BKPOINT_CHECK_ZERO, the->cpu->id);
-    }
-#endif
 }
 void after_thread_ran_arch(void)

 /branches/tracing/kernel/arch/ia32/src/boot/vga323.pal
 ,256 → 1,256
+    .byte 0x3f, 0x3f, 0x3f, 0x00
+    .byte 0x36, 0x3f, 0x3f, 0x00
+    .byte 0x2d, 0x3f, 0x3f, 0x00
+    .byte 0x24, 0x3f, 0x3f, 0x00
+    .byte 0x1b, 0x3f, 0x3f, 0x00
+    .byte 0x12, 0x3f, 0x3f, 0x00
+    .byte 0x09, 0x3f, 0x3f, 0x00
+    .byte 0x00, 0x3f, 0x3f, 0x00
+    .byte 0x3f, 0x2a, 0x3f, 0x00
+    .byte 0x36, 0x2a, 0x3f, 0x00
+    .byte 0x2d, 0x2a, 0x3f, 0x00
+    .byte 0x24, 0x2a, 0x3f, 0x00
+    .byte 0x1b, 0x2a, 0x3f, 0x00
+    .byte 0x12, 0x2a, 0x3f, 0x00
+    .byte 0x09, 0x2a, 0x3f, 0x00
+    .byte 0x00, 0x2a, 0x3f, 0x00
+    .byte 0x3f, 0x15, 0x3f, 0x00
+    .byte 0x36, 0x15, 0x3f, 0x00
+    .byte 0x2d, 0x15, 0x3f, 0x00
+    .byte 0x24, 0x15, 0x3f, 0x00
+    .byte 0x1b, 0x15, 0x3f, 0x00
+    .byte 0x12, 0x15, 0x3f, 0x00
+    .byte 0x09, 0x15, 0x3f, 0x00
+    .byte 0x00, 0x15, 0x3f, 0x00
+    .byte 0x3f, 0x00, 0x3f, 0x00
+    .byte 0x36, 0x00, 0x3f, 0x00
+    .byte 0x2d, 0x00, 0x3f, 0x00
+    .byte 0x24, 0x00, 0x3f, 0x00
+    .byte 0x1b, 0x00, 0x3f, 0x00
+    .byte 0x12, 0x00, 0x3f, 0x00
+    .byte 0x09, 0x00, 0x3f, 0x00
+    .byte 0x00, 0x00, 0x3f, 0x00
+    .byte 0x3f, 0x3f, 0x36, 0x00
+    .byte 0x36, 0x3f, 0x36, 0x00
+    .byte 0x2d, 0x3f, 0x36, 0x00
+    .byte 0x24, 0x3f, 0x36, 0x00
+    .byte 0x1b, 0x3f, 0x36, 0x00
+    .byte 0x12, 0x3f, 0x36, 0x00
+    .byte 0x09, 0x3f, 0x36, 0x00
+    .byte 0x00, 0x3f, 0x36, 0x00
+    .byte 0x3f, 0x2a, 0x36, 0x00
+    .byte 0x36, 0x2a, 0x36, 0x00
+    .byte 0x2d, 0x2a, 0x36, 0x00
+    .byte 0x24, 0x2a, 0x36, 0x00
+    .byte 0x1b, 0x2a, 0x36, 0x00
+    .byte 0x12, 0x2a, 0x36, 0x00
+    .byte 0x09, 0x2a, 0x36, 0x00
+    .byte 0x00, 0x2a, 0x36, 0x00
+    .byte 0x3f, 0x15, 0x36, 0x00
+    .byte 0x36, 0x15, 0x36, 0x00
+    .byte 0x2d, 0x15, 0x36, 0x00
+    .byte 0x24, 0x15, 0x36, 0x00
+    .byte 0x1b, 0x15, 0x36, 0x00
+    .byte 0x12, 0x15, 0x36, 0x00
+    .byte 0x09, 0x15, 0x36, 0x00
+    .byte 0x00, 0x15, 0x36, 0x00
+    .byte 0x3f, 0x00, 0x36, 0x00
+    .byte 0x36, 0x00, 0x36, 0x00
+    .byte 0x2d, 0x00, 0x36, 0x00
+    .byte 0x24, 0x00, 0x36, 0x00
+    .byte 0x1b, 0x00, 0x36, 0x00
+    .byte 0x12, 0x00, 0x36, 0x00
+    .byte 0x09, 0x00, 0x36, 0x00
+    .byte 0x00, 0x00, 0x36, 0x00
+    .byte 0x3f, 0x3f, 0x2d, 0x00
+    .byte 0x36, 0x3f, 0x2d, 0x00
+    .byte 0x2d, 0x3f, 0x2d, 0x00
+    .byte 0x24, 0x3f, 0x2d, 0x00
+    .byte 0x1b, 0x3f, 0x2d, 0x00
+    .byte 0x12, 0x3f, 0x2d, 0x00
+    .byte 0x09, 0x3f, 0x2d, 0x00
+    .byte 0x00, 0x3f, 0x2d, 0x00
+    .byte 0x3f, 0x2a, 0x2d, 0x00
+    .byte 0x36, 0x2a, 0x2d, 0x00
+    .byte 0x2d, 0x2a, 0x2d, 0x00
+    .byte 0x24, 0x2a, 0x2d, 0x00
+    .byte 0x1b, 0x2a, 0x2d, 0x00
+    .byte 0x12, 0x2a, 0x2d, 0x00
+    .byte 0x09, 0x2a, 0x2d, 0x00
+    .byte 0x00, 0x2a, 0x2d, 0x00
+    .byte 0x3f, 0x15, 0x2d, 0x00
+    .byte 0x36, 0x15, 0x2d, 0x00
+    .byte 0x2d, 0x15, 0x2d, 0x00
+    .byte 0x24, 0x15, 0x2d, 0x00
+    .byte 0x1b, 0x15, 0x2d, 0x00
+    .byte 0x12, 0x15, 0x2d, 0x00
+    .byte 0x09, 0x15, 0x2d, 0x00
+    .byte 0x00, 0x15, 0x2d, 0x00
+    .byte 0x3f, 0x00, 0x2d, 0x00
+    .byte 0x36, 0x00, 0x2d, 0x00
+    .byte 0x2d, 0x00, 0x2d, 0x00
+    .byte 0x24, 0x00, 0x2d, 0x00
+    .byte 0x1b, 0x00, 0x2d, 0x00
+    .byte 0x12, 0x00, 0x2d, 0x00
+    .byte 0x09, 0x00, 0x2d, 0x00
+    .byte 0x00, 0x00, 0x2d, 0x00
+    .byte 0x3f, 0x3f, 0x24, 0x00
+    .byte 0x36, 0x3f, 0x24, 0x00
+    .byte 0x2d, 0x3f, 0x24, 0x00
+    .byte 0x24, 0x3f, 0x24, 0x00
+    .byte 0x1b, 0x3f, 0x24, 0x00
+    .byte 0x12, 0x3f, 0x24, 0x00
+    .byte 0x09, 0x3f, 0x24, 0x00
+    .byte 0x00, 0x3f, 0x24, 0x00
+    .byte 0x3f, 0x2a, 0x24, 0x00
+    .byte 0x36, 0x2a, 0x24, 0x00
+    .byte 0x2d, 0x2a, 0x24, 0x00
+    .byte 0x24, 0x2a, 0x24, 0x00
+    .byte 0x1b, 0x2a, 0x24, 0x00
+    .byte 0x12, 0x2a, 0x24, 0x00
+    .byte 0x09, 0x2a, 0x24, 0x00
+    .byte 0x00, 0x2a, 0x24, 0x00
+    .byte 0x3f, 0x15, 0x24, 0x00
+    .byte 0x36, 0x15, 0x24, 0x00
+    .byte 0x2d, 0x15, 0x24, 0x00
+    .byte 0x24, 0x15, 0x24, 0x00
+    .byte 0x1b, 0x15, 0x24, 0x00
+    .byte 0x12, 0x15, 0x24, 0x00
+    .byte 0x09, 0x15, 0x24, 0x00
+    .byte 0x00, 0x15, 0x24, 0x00
+    .byte 0x3f, 0x00, 0x24, 0x00
+    .byte 0x36, 0x00, 0x24, 0x00
+    .byte 0x2d, 0x00, 0x24, 0x00
+    .byte 0x24, 0x00, 0x24, 0x00
+    .byte 0x1b, 0x00, 0x24, 0x00
+    .byte 0x12, 0x00, 0x24, 0x00
+    .byte 0x09, 0x00, 0x24, 0x00
+    .byte 0x00, 0x00, 0x24, 0x00
+    .byte 0x3f, 0x3f, 0x1b, 0x00
+    .byte 0x36, 0x3f, 0x1b, 0x00
+    .byte 0x2d, 0x3f, 0x1b, 0x00
+    .byte 0x24, 0x3f, 0x1b, 0x00
+    .byte 0x1b, 0x3f, 0x1b, 0x00
+    .byte 0x12, 0x3f, 0x1b, 0x00
+    .byte 0x09, 0x3f, 0x1b, 0x00
+    .byte 0x00, 0x3f, 0x1b, 0x00
+    .byte 0x3f, 0x2a, 0x1b, 0x00
+    .byte 0x36, 0x2a, 0x1b, 0x00
+    .byte 0x2d, 0x2a, 0x1b, 0x00
+    .byte 0x24, 0x2a, 0x1b, 0x00
+    .byte 0x1b, 0x2a, 0x1b, 0x00
+    .byte 0x12, 0x2a, 0x1b, 0x00
+    .byte 0x09, 0x2a, 0x1b, 0x00
+    .byte 0x00, 0x2a, 0x1b, 0x00
+    .byte 0x3f, 0x15, 0x1b, 0x00
+    .byte 0x36, 0x15, 0x1b, 0x00
+    .byte 0x2d, 0x15, 0x1b, 0x00
+    .byte 0x24, 0x15, 0x1b, 0x00
+    .byte 0x1b, 0x15, 0x1b, 0x00
+    .byte 0x12, 0x15, 0x1b, 0x00
+    .byte 0x09, 0x15, 0x1b, 0x00
+    .byte 0x00, 0x15, 0x1b, 0x00
+    .byte 0x3f, 0x00, 0x1b, 0x00
+    .byte 0x36, 0x00, 0x1b, 0x00
+    .byte 0x2d, 0x00, 0x1b, 0x00
+    .byte 0x24, 0x00, 0x1b, 0x00
+    .byte 0x1b, 0x00, 0x1b, 0x00
+    .byte 0x12, 0x00, 0x1b, 0x00
+    .byte 0x09, 0x00, 0x1b, 0x00
+    .byte 0x00, 0x00, 0x1b, 0x00
+    .byte 0x3f, 0x3f, 0x12, 0x00
+    .byte 0x36, 0x3f, 0x12, 0x00
+    .byte 0x2d, 0x3f, 0x12, 0x00
+    .byte 0x24, 0x3f, 0x12, 0x00
+    .byte 0x1b, 0x3f, 0x12, 0x00
+    .byte 0x12, 0x3f, 0x12, 0x00
+    .byte 0x09, 0x3f, 0x12, 0x00
+    .byte 0x00, 0x3f, 0x12, 0x00
+    .byte 0x3f, 0x2a, 0x12, 0x00
+    .byte 0x36, 0x2a, 0x12, 0x00
+    .byte 0x2d, 0x2a, 0x12, 0x00
+    .byte 0x24, 0x2a, 0x12, 0x00
+    .byte 0x1b, 0x2a, 0x12, 0x00
+    .byte 0x12, 0x2a, 0x12, 0x00
+    .byte 0x09, 0x2a, 0x12, 0x00
+    .byte 0x00, 0x2a, 0x12, 0x00
+    .byte 0x3f, 0x15, 0x12, 0x00
+    .byte 0x36, 0x15, 0x12, 0x00
+    .byte 0x2d, 0x15, 0x12, 0x00
+    .byte 0x24, 0x15, 0x12, 0x00
+    .byte 0x1b, 0x15, 0x12, 0x00
+    .byte 0x12, 0x15, 0x12, 0x00
+    .byte 0x09, 0x15, 0x12, 0x00
+    .byte 0x00, 0x15, 0x12, 0x00
+    .byte 0x3f, 0x00, 0x12, 0x00
+    .byte 0x36, 0x00, 0x12, 0x00
+    .byte 0x2d, 0x00, 0x12, 0x00
+    .byte 0x24, 0x00, 0x12, 0x00
+    .byte 0x1b, 0x00, 0x12, 0x00
+    .byte 0x12, 0x00, 0x12, 0x00
+    .byte 0x09, 0x00, 0x12, 0x00
+    .byte 0x00, 0x00, 0x12, 0x00
+    .byte 0x3f, 0x3f, 0x09, 0x00
+    .byte 0x36, 0x3f, 0x09, 0x00
+    .byte 0x2d, 0x3f, 0x09, 0x00
+    .byte 0x24, 0x3f, 0x09, 0x00
+    .byte 0x1b, 0x3f, 0x09, 0x00
+    .byte 0x12, 0x3f, 0x09, 0x00
+    .byte 0x09, 0x3f, 0x09, 0x00
+    .byte 0x00, 0x3f, 0x09, 0x00
+    .byte 0x3f, 0x2a, 0x09, 0x00
+    .byte 0x36, 0x2a, 0x09, 0x00
+    .byte 0x2d, 0x2a, 0x09, 0x00
+    .byte 0x24, 0x2a, 0x09, 0x00
+    .byte 0x1b, 0x2a, 0x09, 0x00
+    .byte 0x12, 0x2a, 0x09, 0x00
+    .byte 0x09, 0x2a, 0x09, 0x00
+    .byte 0x00, 0x2a, 0x09, 0x00
+    .byte 0x3f, 0x15, 0x09, 0x00
+    .byte 0x36, 0x15, 0x09, 0x00
+    .byte 0x2d, 0x15, 0x09, 0x00
+    .byte 0x24, 0x15, 0x09, 0x00
+    .byte 0x1b, 0x15, 0x09, 0x00
+    .byte 0x12, 0x15, 0x09, 0x00
+    .byte 0x09, 0x15, 0x09, 0x00
+    .byte 0x00, 0x15, 0x09, 0x00
+    .byte 0x3f, 0x00, 0x09, 0x00
+    .byte 0x36, 0x00, 0x09, 0x00
+    .byte 0x2d, 0x00, 0x09, 0x00
+    .byte 0x24, 0x00, 0x09, 0x00
+    .byte 0x1b, 0x00, 0x09, 0x00
+    .byte 0x12, 0x00, 0x09, 0x00
+    .byte 0x09, 0x00, 0x09, 0x00
+    .byte 0x00, 0x00, 0x09, 0x00
+    .byte 0x3f, 0x3f, 0x00, 0x00
+    .byte 0x36, 0x3f, 0x00, 0x00
+    .byte 0x2d, 0x3f, 0x00, 0x00
+    .byte 0x24, 0x3f, 0x00, 0x00
+    .byte 0x1b, 0x3f, 0x00, 0x00
+    .byte 0x12, 0x3f, 0x00, 0x00
+    .byte 0x09, 0x3f, 0x00, 0x00
+    .byte 0x00, 0x3f, 0x00, 0x00
+    .byte 0x3f, 0x2a, 0x00, 0x00
+    .byte 0x36, 0x2a, 0x00, 0x00
+    .byte 0x2d, 0x2a, 0x00, 0x00
+    .byte 0x24, 0x2a, 0x00, 0x00
+    .byte 0x1b, 0x2a, 0x00, 0x00
+    .byte 0x12, 0x2a, 0x00, 0x00
+    .byte 0x09, 0x2a, 0x00, 0x00
+    .byte 0x00, 0x2a, 0x00, 0x00
+    .byte 0x3f, 0x15, 0x00, 0x00
+    .byte 0x36, 0x15, 0x00, 0x00
+    .byte 0x2d, 0x15, 0x00, 0x00
+    .byte 0x24, 0x15, 0x00, 0x00
+    .byte 0x1b, 0x15, 0x00, 0x00
+    .byte 0x12, 0x15, 0x00, 0x00
+    .byte 0x09, 0x15, 0x00, 0x00
+    .byte 0x00, 0x15, 0x00, 0x00
+    .byte 0x3f, 0x00, 0x00, 0x00
+    .byte 0x36, 0x00, 0x00, 0x00
+    .byte 0x2d, 0x00, 0x00, 0x00
+    .byte 0x24, 0x00, 0x00, 0x00
+    .byte 0x1b, 0x00, 0x00, 0x00
+    .byte 0x12, 0x00, 0x00, 0x00
+    .byte 0x09, 0x00, 0x00, 0x00
     .byte 0x00, 0x00, 0x00, 0x00
-    .byte 0x09, 0x00, 0x00, 0x00
-    .byte 0x12, 0x00, 0x00, 0x00
-    .byte 0x1b, 0x00, 0x00, 0x00
-    .byte 0x24, 0x00, 0x00, 0x00
-    .byte 0x2d, 0x00, 0x00, 0x00
-    .byte 0x36, 0x00, 0x00, 0x00
-    .byte 0x3f, 0x00, 0x00, 0x00
-    .byte 0x00, 0x15, 0x00, 0x00
-    .byte 0x09, 0x15, 0x00, 0x00
-    .byte 0x12, 0x15, 0x00, 0x00
-    .byte 0x1b, 0x15, 0x00, 0x00
-    .byte 0x24, 0x15, 0x00, 0x00
-    .byte 0x2d, 0x15, 0x00, 0x00
-    .byte 0x36, 0x15, 0x00, 0x00
-    .byte 0x3f, 0x15, 0x00, 0x00
-    .byte 0x00, 0x2a, 0x00, 0x00
-    .byte 0x09, 0x2a, 0x00, 0x00
-    .byte 0x12, 0x2a, 0x00, 0x00
-    .byte 0x1b, 0x2a, 0x00, 0x00
-    .byte 0x24, 0x2a, 0x00, 0x00
-    .byte 0x2d, 0x2a, 0x00, 0x00
-    .byte 0x36, 0x2a, 0x00, 0x00
-    .byte 0x3f, 0x2a, 0x00, 0x00
-    .byte 0x00, 0x3f, 0x00, 0x00
-    .byte 0x09, 0x3f, 0x00, 0x00
-    .byte 0x12, 0x3f, 0x00, 0x00
-    .byte 0x1b, 0x3f, 0x00, 0x00
-    .byte 0x24, 0x3f, 0x00, 0x00
-    .byte 0x2d, 0x3f, 0x00, 0x00
-    .byte 0x36, 0x3f, 0x00, 0x00
-    .byte 0x3f, 0x3f, 0x00, 0x00
-    .byte 0x00, 0x00, 0x09, 0x00
-    .byte 0x09, 0x00, 0x09, 0x00
-    .byte 0x12, 0x00, 0x09, 0x00
-    .byte 0x1b, 0x00, 0x09, 0x00
-    .byte 0x24, 0x00, 0x09, 0x00
-    .byte 0x2d, 0x00, 0x09, 0x00
-    .byte 0x36, 0x00, 0x09, 0x00
-    .byte 0x3f, 0x00, 0x09, 0x00
-    .byte 0x00, 0x15, 0x09, 0x00
-    .byte 0x09, 0x15, 0x09, 0x00
-    .byte 0x12, 0x15, 0x09, 0x00
-    .byte 0x1b, 0x15, 0x09, 0x00
-    .byte 0x24, 0x15, 0x09, 0x00
-    .byte 0x2d, 0x15, 0x09, 0x00
-    .byte 0x36, 0x15, 0x09, 0x00
-    .byte 0x3f, 0x15, 0x09, 0x00
-    .byte 0x00, 0x2a, 0x09, 0x00
-    .byte 0x09, 0x2a, 0x09, 0x00
-    .byte 0x12, 0x2a, 0x09, 0x00
-    .byte 0x1b, 0x2a, 0x09, 0x00
-    .byte 0x24, 0x2a, 0x09, 0x00
-    .byte 0x2d, 0x2a, 0x09, 0x00
-    .byte 0x36, 0x2a, 0x09, 0x00
-    .byte 0x3f, 0x2a, 0x09, 0x00
-    .byte 0x00, 0x3f, 0x09, 0x00
-    .byte 0x09, 0x3f, 0x09, 0x00
-    .byte 0x12, 0x3f, 0x09, 0x00
-    .byte 0x1b, 0x3f, 0x09, 0x00
-    .byte 0x24, 0x3f, 0x09, 0x00
-    .byte 0x2d, 0x3f, 0x09, 0x00
-    .byte 0x36, 0x3f, 0x09, 0x00
-    .byte 0x3f, 0x3f, 0x09, 0x00
-    .byte 0x00, 0x00, 0x12, 0x00
-    .byte 0x09, 0x00, 0x12, 0x00
-    .byte 0x12, 0x00, 0x12, 0x00
-    .byte 0x1b, 0x00, 0x12, 0x00
-    .byte 0x24, 0x00, 0x12, 0x00
-    .byte 0x2d, 0x00, 0x12, 0x00
-    .byte 0x36, 0x00, 0x12, 0x00
-    .byte 0x3f, 0x00, 0x12, 0x00
-    .byte 0x00, 0x15, 0x12, 0x00
-    .byte 0x09, 0x15, 0x12, 0x00
-    .byte 0x12, 0x15, 0x12, 0x00
-    .byte 0x1b, 0x15, 0x12, 0x00
-    .byte 0x24, 0x15, 0x12, 0x00
-    .byte 0x2d, 0x15, 0x12, 0x00
-    .byte 0x36, 0x15, 0x12, 0x00
-    .byte 0x3f, 0x15, 0x12, 0x00
-    .byte 0x00, 0x2a, 0x12, 0x00
-    .byte 0x09, 0x2a, 0x12, 0x00
-    .byte 0x12, 0x2a, 0x12, 0x00
-    .byte 0x1b, 0x2a, 0x12, 0x00
-    .byte 0x24, 0x2a, 0x12, 0x00
-    .byte 0x2d, 0x2a, 0x12, 0x00
-    .byte 0x36, 0x2a, 0x12, 0x00
-    .byte 0x3f, 0x2a, 0x12, 0x00
-    .byte 0x00, 0x3f, 0x12, 0x00
-    .byte 0x09, 0x3f, 0x12, 0x00
-    .byte 0x12, 0x3f, 0x12, 0x00
-    .byte 0x1b, 0x3f, 0x12, 0x00
-    .byte 0x24, 0x3f, 0x12, 0x00
-    .byte 0x2d, 0x3f, 0x12, 0x00
-    .byte 0x36, 0x3f, 0x12, 0x00
-    .byte 0x3f, 0x3f, 0x12, 0x00
-    .byte 0x00, 0x00, 0x1b, 0x00
-    .byte 0x09, 0x00, 0x1b, 0x00
-    .byte 0x12, 0x00, 0x1b, 0x00
-    .byte 0x1b, 0x00, 0x1b, 0x00
-    .byte 0x24, 0x00, 0x1b, 0x00
-    .byte 0x2d, 0x00, 0x1b, 0x00
-    .byte 0x36, 0x00, 0x1b, 0x00
-    .byte 0x3f, 0x00, 0x1b, 0x00
-    .byte 0x00, 0x15, 0x1b, 0x00
-    .byte 0x09, 0x15, 0x1b, 0x00
-    .byte 0x12, 0x15, 0x1b, 0x00
-    .byte 0x1b, 0x15, 0x1b, 0x00
-    .byte 0x24, 0x15, 0x1b, 0x00
-    .byte 0x2d, 0x15, 0x1b, 0x00
-    .byte 0x36, 0x15, 0x1b, 0x00
-    .byte 0x3f, 0x15, 0x1b, 0x00
-    .byte 0x00, 0x2a, 0x1b, 0x00
-    .byte 0x09, 0x2a, 0x1b, 0x00
-    .byte 0x12, 0x2a, 0x1b, 0x00
-    .byte 0x1b, 0x2a, 0x1b, 0x00
-    .byte 0x24, 0x2a, 0x1b, 0x00
-    .byte 0x2d, 0x2a, 0x1b, 0x00
-    .byte 0x36, 0x2a, 0x1b, 0x00
-    .byte 0x3f, 0x2a, 0x1b, 0x00
-    .byte 0x00, 0x3f, 0x1b, 0x00
-    .byte 0x09, 0x3f, 0x1b, 0x00
-    .byte 0x12, 0x3f, 0x1b, 0x00
-    .byte 0x1b, 0x3f, 0x1b, 0x00
-    .byte 0x24, 0x3f, 0x1b, 0x00
-    .byte 0x2d, 0x3f, 0x1b, 0x00
-    .byte 0x36, 0x3f, 0x1b, 0x00
-    .byte 0x3f, 0x3f, 0x1b, 0x00
-    .byte 0x00, 0x00, 0x24, 0x00
-    .byte 0x09, 0x00, 0x24, 0x00
-    .byte 0x12, 0x00, 0x24, 0x00
-    .byte 0x1b, 0x00, 0x24, 0x00
-    .byte 0x24, 0x00, 0x24, 0x00
-    .byte 0x2d, 0x00, 0x24, 0x00
-    .byte 0x36, 0x00, 0x24, 0x00
-    .byte 0x3f, 0x00, 0x24, 0x00
-    .byte 0x00, 0x15, 0x24, 0x00
-    .byte 0x09, 0x15, 0x24, 0x00
-    .byte 0x12, 0x15, 0x24, 0x00
-    .byte 0x1b, 0x15, 0x24, 0x00
-    .byte 0x24, 0x15, 0x24, 0x00
-    .byte 0x2d, 0x15, 0x24, 0x00
-    .byte 0x36, 0x15, 0x24, 0x00
-    .byte 0x3f, 0x15, 0x24, 0x00
-    .byte 0x00, 0x2a, 0x24, 0x00
-    .byte 0x09, 0x2a, 0x24, 0x00
-    .byte 0x12, 0x2a, 0x24, 0x00
-    .byte 0x1b, 0x2a, 0x24, 0x00
-    .byte 0x24, 0x2a, 0x24, 0x00
-    .byte 0x2d, 0x2a, 0x24, 0x00
-    .byte 0x36, 0x2a, 0x24, 0x00
-    .byte 0x3f, 0x2a, 0x24, 0x00
-    .byte 0x00, 0x3f, 0x24, 0x00
-    .byte 0x09, 0x3f, 0x24, 0x00
-    .byte 0x12, 0x3f, 0x24, 0x00
-    .byte 0x1b, 0x3f, 0x24, 0x00
-    .byte 0x24, 0x3f, 0x24, 0x00
-    .byte 0x2d, 0x3f, 0x24, 0x00
-    .byte 0x36, 0x3f, 0x24, 0x00
-    .byte 0x3f, 0x3f, 0x24, 0x00
-    .byte 0x00, 0x00, 0x2d, 0x00
-    .byte 0x09, 0x00, 0x2d, 0x00
-    .byte 0x12, 0x00, 0x2d, 0x00
-    .byte 0x1b, 0x00, 0x2d, 0x00
-    .byte 0x24, 0x00, 0x2d, 0x00
-    .byte 0x2d, 0x00, 0x2d, 0x00
-    .byte 0x36, 0x00, 0x2d, 0x00
-    .byte 0x3f, 0x00, 0x2d, 0x00
-    .byte 0x00, 0x15, 0x2d, 0x00
-    .byte 0x09, 0x15, 0x2d, 0x00
-    .byte 0x12, 0x15, 0x2d, 0x00
-    .byte 0x1b, 0x15, 0x2d, 0x00
-    .byte 0x24, 0x15, 0x2d, 0x00
-    .byte 0x2d, 0x15, 0x2d, 0x00
-    .byte 0x36, 0x15, 0x2d, 0x00
-    .byte 0x3f, 0x15, 0x2d, 0x00
-    .byte 0x00, 0x2a, 0x2d, 0x00
-    .byte 0x09, 0x2a, 0x2d, 0x00
-    .byte 0x12, 0x2a, 0x2d, 0x00
-    .byte 0x1b, 0x2a, 0x2d, 0x00
-    .byte 0x24, 0x2a, 0x2d, 0x00
-    .byte 0x2d, 0x2a, 0x2d, 0x00
-    .byte 0x36, 0x2a, 0x2d, 0x00
-    .byte 0x3f, 0x2a, 0x2d, 0x00
-    .byte 0x00, 0x3f, 0x2d, 0x00
-    .byte 0x09, 0x3f, 0x2d, 0x00
-    .byte 0x12, 0x3f, 0x2d, 0x00
-    .byte 0x1b, 0x3f, 0x2d, 0x00
-    .byte 0x24, 0x3f, 0x2d, 0x00
-    .byte 0x2d, 0x3f, 0x2d, 0x00
-    .byte 0x36, 0x3f, 0x2d, 0x00
-    .byte 0x3f, 0x3f, 0x2d, 0x00
-    .byte 0x00, 0x00, 0x36, 0x00
-    .byte 0x09, 0x00, 0x36, 0x00
-    .byte 0x12, 0x00, 0x36, 0x00
-    .byte 0x1b, 0x00, 0x36, 0x00
-    .byte 0x24, 0x00, 0x36, 0x00
-    .byte 0x2d, 0x00, 0x36, 0x00
-    .byte 0x36, 0x00, 0x36, 0x00
-    .byte 0x3f, 0x00, 0x36, 0x00
-    .byte 0x00, 0x15, 0x36, 0x00
-    .byte 0x09, 0x15, 0x36, 0x00
-    .byte 0x12, 0x15, 0x36, 0x00
-    .byte 0x1b, 0x15, 0x36, 0x00
-    .byte 0x24, 0x15, 0x36, 0x00
-    .byte 0x2d, 0x15, 0x36, 0x00
-    .byte 0x36, 0x15, 0x36, 0x00
-    .byte 0x3f, 0x15, 0x36, 0x00
-    .byte 0x00, 0x2a, 0x36, 0x00
-    .byte 0x09, 0x2a, 0x36, 0x00
-    .byte 0x12, 0x2a, 0x36, 0x00
-    .byte 0x1b, 0x2a, 0x36, 0x00
-    .byte 0x24, 0x2a, 0x36, 0x00
-    .byte 0x2d, 0x2a, 0x36, 0x00
-    .byte 0x36, 0x2a, 0x36, 0x00
-    .byte 0x3f, 0x2a, 0x36, 0x00
-    .byte 0x00, 0x3f, 0x36, 0x00
-    .byte 0x09, 0x3f, 0x36, 0x00
-    .byte 0x12, 0x3f, 0x36, 0x00
-    .byte 0x1b, 0x3f, 0x36, 0x00
-    .byte 0x24, 0x3f, 0x36, 0x00
-    .byte 0x2d, 0x3f, 0x36, 0x00
-    .byte 0x36, 0x3f, 0x36, 0x00
-    .byte 0x3f, 0x3f, 0x36, 0x00
-    .byte 0x00, 0x00, 0x3f, 0x00
-    .byte 0x09, 0x00, 0x3f, 0x00
-    .byte 0x12, 0x00, 0x3f, 0x00
-    .byte 0x1b, 0x00, 0x3f, 0x00
-    .byte 0x24, 0x00, 0x3f, 0x00
-    .byte 0x2d, 0x00, 0x3f, 0x00
-    .byte 0x36, 0x00, 0x3f, 0x00
-    .byte 0x3f, 0x00, 0x3f, 0x00
-    .byte 0x00, 0x15, 0x3f, 0x00
-    .byte 0x09, 0x15, 0x3f, 0x00
-    .byte 0x12, 0x15, 0x3f, 0x00
-    .byte 0x1b, 0x15, 0x3f, 0x00
-    .byte 0x24, 0x15, 0x3f, 0x00
-    .byte 0x2d, 0x15, 0x3f, 0x00
-    .byte 0x36, 0x15, 0x3f, 0x00
-    .byte 0x3f, 0x15, 0x3f, 0x00
-    .byte 0x00, 0x2a, 0x3f, 0x00
-    .byte 0x09, 0x2a, 0x3f, 0x00
-    .byte 0x12, 0x2a, 0x3f, 0x00
-    .byte 0x1b, 0x2a, 0x3f, 0x00
-    .byte 0x24, 0x2a, 0x3f, 0x00
-    .byte 0x2d, 0x2a, 0x3f, 0x00
-    .byte 0x36, 0x2a, 0x3f, 0x00
-    .byte 0x3f, 0x2a, 0x3f, 0x00
-    .byte 0x00, 0x3f, 0x3f, 0x00
-    .byte 0x09, 0x3f, 0x3f, 0x00
-    .byte 0x12, 0x3f, 0x3f, 0x00
-    .byte 0x1b, 0x3f, 0x3f, 0x00
-    .byte 0x24, 0x3f, 0x3f, 0x00
-    .byte 0x2d, 0x3f, 0x3f, 0x00
-    .byte 0x36, 0x3f, 0x3f, 0x00
-    .byte 0x3f, 0x3f, 0x3f, 0x00

 /branches/tracing/kernel/arch/ia32/src/boot/vesa_ret.inc
 ,0 → 1,12
+.code32
+vesa_init_protected:
+    movw $gdtselector(KDATA_DES), %cx
+    movw %cx, %es
+    movw %cx, %fs
+    movw %cx, %gs
+    movw %cx, %ds               # kernel data + stack
+    movw %cx, %ss
+    movl $START_STACK, %esp     # initialize stack pointer
+    jmpl $gdtselector(KTEXT_DES), $vesa_meeting_point

 /branches/tracing/kernel/arch/ia32/src/boot/boot.S
 ,6 → 31,7
 #include <arch/boot/memmap.h>
 #include <arch/mm/page.h>
 #include <arch/pm.h>
+#include <arch/cpuid.h>
 #define START_STACK (BOOT_OFFSET - BOOT_STACK_SIZE)
 ,40 → 43,41
 multiboot_header:
     .long MULTIBOOT_HEADER_MAGIC
     .long MULTIBOOT_HEADER_FLAGS
-    .long -(MULTIBOOT_HEADER_MAGIC + MULTIBOOT_HEADER_FLAGS)    # checksum
+    .long -(MULTIBOOT_HEADER_MAGIC + MULTIBOOT_HEADER_FLAGS)  # checksum
     .long multiboot_header
     .long unmapped_ktext_start
     .long 0
     .long 0
     .long multiboot_image_start
 multiboot_image_start:
     cld
-    movl $START_STACK, %esp         # initialize stack pointer
-    lgdt KA2PA(bootstrap_gdtr)      # initialize Global Descriptor Table register
-    movw $selector(KDATA_DES), %cx
+    movl $START_STACK, %esp     # initialize stack pointer
+    lgdt KA2PA(bootstrap_gdtr)  # initialize Global Descriptor Table register
+    movw $gdtselector(KDATA_DES), %cx
     movw %cx, %es
     movw %cx, %fs
     movw %cx, %gs
-    movw %cx, %ds                   # kernel data + stack
+    movw %cx, %ds               # kernel data + stack
     movw %cx, %ss
-    jmpl $selector(KTEXT_DES), $multiboot_meeting_point
+    jmpl $gdtselector(KTEXT_DES), $multiboot_meeting_point
     multiboot_meeting_point:
-    movl %eax, grub_eax                 # save parameters from GRUB
+    movl %eax, grub_eax         # save parameters from GRUB
     movl %ebx, grub_ebx
-    xorl %eax, %eax
-    cpuid
-    cmp $0x0, %eax                      # any function > 0?
+    movl $(INTEL_CPUID_LEVEL), %eax
+    cpuid
+    cmp $0x0, %eax              # any function > 0?
     jbe pse_unsupported
-    movl $0x1, %eax                     # Basic function code 1
+    movl $(INTEL_CPUID_STANDARD), %eax
     cpuid
-    bt $3, %edx                         # Test if PSE is supported
+    bt $(INTEL_PSE), %edx
     jc pse_supported
     pse_unsupported:
         movl $pse_msg, %esi
         jmp error_halt
 ,138 → 84,31
     pse_supported:
-#ifdef CONFIG_FB
-    mov $vesa_init, %esi
-    mov $VESA_INIT_SEGMENT << 4, %edi
-    mov $e_vesa_init - vesa_init, %ecx
-    rep movsb
-    mov $VESA_INIT_SEGMENT << 4, %edi
-    jmpl *%edi
+    bt $(INTEL_SEP), %edx
+    jc sep_supported
-    vesa_meeting_point:
+        movl $sep_msg, %esi
+        jmp error_halt
-    mov %esi, KA2PA(vesa_ph_addr)
-    mov %di, KA2PA(vesa_height)
-    shr $16, %edi
-    mov %di, KA2PA(vesa_width)
-    mov %bx, KA2PA(vesa_scanline)
-    shr $16, %ebx
-    mov %bx, KA2PA(vesa_bpp)
-#endif
+    sep_supported:
+#include "vesa_prot.inc"
+    # map kernel and turn paging on
+    call map_kernel
-    call map_kernel                         # map kernel and turn paging on
+    # call arch_pre_main(grub_eax, grub_ebx)
+    pushl grub_ebx
+    pushl grub_eax
+    call arch_pre_main
-    movl grub_eax, %eax
-    movl grub_ebx, %ebx
-    cmpl $MULTIBOOT_LOADER_MAGIC, %eax              # compare GRUB signature
-    je valid_boot
-        xorl %ecx, %ecx                         # no memory map available
-        movl %ecx, e820counter
-        jmp invalid_boot
-    valid_boot:
-        movl (%ebx), %eax                       # ebx = physical address of struct multiboot_info
-        bt $3, %eax                             # mbi->flags[3] (mods_count, mods_addr valid)
-        jc mods_valid
-            xorl %ecx, %ecx
-            movl %ecx, init
-            jmp mods_end
-        mods_valid:
-        movl 20(%ebx), %ecx                     # mbi->mods_count
-        movl %ecx, init
-        cmpl $0, %ecx
-        je mods_end
-        movl 24(%ebx), %esi                     # mbi->mods_addr
-        movl $init, %edi
-        mods_loop:
-            movl 0(%esi), %edx                  # mods->mod_start
-            addl $0x80000000, %edx
-            movl %edx, 4(%edi)
-            movl 4(%esi), %edx
-            subl 0(%esi), %edx                  # mods->mod_end - mods->mod_start
-            movl %edx, 8(%edi)
-            addl $16, %esi
-            addl $8 , %edi
-            loop mods_loop
-        mods_end:
-        bt $6, %eax                             # mbi->flags[6] (mmap_length, mmap_addr valid)
-        jc mmap_valid
-            xorl %edx, %edx
-            jmp mmap_invalid
-        mmap_valid:
-        movl 44(%ebx), %ecx                     # mbi->mmap_length
-        movl 48(%ebx), %esi                     # mbi->mmap_addr
-        movl $e820table, %edi
-        xorl %edx, %edx
-        mmap_loop:
-            cmpl $0, %ecx
-            jle mmap_end
-            movl 4(%esi), %eax                  # mmap->base_addr_low
-            movl %eax, (%edi)
-            movl 8(%esi), %eax                  # mmap->base_addr_high
-            movl %eax, 4(%edi)
-            movl 12(%esi), %eax                 # mmap->length_low
-            movl %eax, 8(%edi)
-            movl 16(%esi), %eax                 # mmap->length_high
-            movl %eax, 12(%edi)
-            movl 20(%esi), %eax                 # mmap->type
-            movl %eax, 16(%edi)
-            movl (%esi), %eax                   # mmap->size
-            addl $0x4, %eax
-            addl %eax, %esi
-            subl %eax, %ecx
-            addl $MEMMAP_E820_RECORD_SIZE, %edi
-            incl %edx
-            jmp mmap_loop
-        mmap_end:
-        mmap_invalid:
-        movl %edx, e820counter
-    invalid_boot:
+    call main_bsp
-#ifdef CONFIG_SMP
-    # copy AP bootstrap routines below 1 MB
-    movl $BOOT_OFFSET, %esi
-    movl $AP_BOOT_OFFSET, %edi
-    movl $_hardcoded_unmapped_size, %ecx
-    rep movsb
-#endif
-    call main_bsp                               # never returns
+    # not reached
     cli
-    hlt
+    hlt0:
+        hlt
+        jmp hlt0
 .global map_kernel
 map_kernel:
 ,8 → 117,8
     # For simplicity, we map the entire 4G space.
     #
     movl %cr4, %ecx
-    orl $(1 << 4), %ecx                         # turn PSE on
-    andl $(~(1 << 5)), %ecx                     # turn PAE off
+    orl $(1 << 4), %ecx                 # turn PSE on
+    andl $(~(1 << 5)), %ecx             # turn PAE off
     movl %ecx, %cr4
     movl $(page_directory + 0), %esi
 ,30 → 125,31
     movl $(page_directory + 2048), %edi
     xorl %ecx, %ecx
     xorl %ebx, %ebx
-:
-    movl $((1 << 7) | (1 << 1) | (1 << 0)), %eax
-    orl %ebx, %eax
-    movl %eax, (%esi, %ecx, 4)                  # mapping 0x00000000 + %ecx * 4M => 0x00000000 + %ecx * 4M
-    movl %eax, (%edi, %ecx, 4)                  # mapping 0x80000000 + %ecx * 4M => 0x00000000 + %ecx * 4M
-    addl $(4 * 1024 * 1024), %ebx
-    incl %ecx
-    cmpl $512, %ecx
-    jl 0b
+    floop:
+        movl $((1 << 7) | (1 << 1) | (1 << 0)), %eax
+        orl %ebx, %eax
+        movl %eax, (%esi, %ecx, 4)      # mapping 0x00000000 + %ecx * 4M => 0x00000000 + %ecx * 4M
+        movl %eax, (%edi, %ecx, 4)      # mapping 0x80000000 + %ecx * 4M => 0x00000000 + %ecx * 4M
+        addl $(4 * 1024 * 1024), %ebx
+        incl %ecx
+        cmpl $512, %ecx
+        jl floop
     movl %esi, %cr3
     movl %cr0, %ebx
-    orl $(1 << 31), %ebx                        # turn paging on
+    orl $(1 << 31), %ebx                # turn paging on
     movl %ebx, %cr0
     ret
 # Print string from %esi to EGA display (in red) and halt
 error_halt:
-    movl $0xb8000, %edi                     # base of EGA text mode memory
+    movl $0xb8000, %edi         # base of EGA text mode memory
     xorl %eax, %eax
-    movw $0x3d4, %dx                        # read bits 8 - 15 of the cursor address
+    movw $0x3d4, %dx            # read bits 8 - 15 of the cursor address
     movb $0xe, %al
     outb %al, %dx
 ,7 → 157,7
     inb %dx, %al
     shl $8, %ax
-    movw $0x3d4, %dx                        # read bits 0 - 7 of the cursor address
+    movw $0x3d4, %dx            # read bits 0 - 7 of the cursor address
     movb $0xf, %al
     outb %al, %dx
 ,7 → 166,9
     cmp $1920, %ax
     jbe cursor_ok
-        movw $1920, %ax                     # sanity check for the cursor on the last line
+        movw $1920, %ax         # sanity check for the cursor on the last line
     cursor_ok:
     movw %ax, %bx
 ,7 → 175,7
     shl $1, %eax
     addl %eax, %edi
-    movw $0x0c00, %ax                       # black background, light red foreground
+    movw $0x0c00, %ax           # black background, light red foreground
     ploop:
         lodsb
 ,11 → 182,11
         cmp $0, %al
         je ploop_end
         stosw
-        inc %bx
+        inc %bx
         jmp ploop
     ploop_end:
-    movw $0x3d4, %dx                        # write bits 8 - 15 of the cursor address
+    movw $0x3d4, %dx            # write bits 8 - 15 of the cursor address
     movb $0xe, %al
     outb %al, %dx
 ,7 → 194,7
     movb %bh, %al
     outb %al, %dx
-    movw $0x3d4, %dx                        # write bits 0 - 7 of the cursor address
+    movw $0x3d4, %dx            # write bits 0 - 7 of the cursor address
     movb $0xf, %al
     outb %al, %dx
 ,240 → 201,14
     movw $0x3d5, %dx
     movb %bl, %al
     outb %al, %dx
     cli
-    hlt
+    hlt1:
+        hlt
+        jmp hlt1
-#ifdef CONFIG_FB
-vesa_init:
-    jmp $selector(VESA_INIT_DES), $vesa_init_real - vesa_init
-.code16
-vesa_init_real:
-    mov %cr0, %eax
-    and $~1, %eax
-    mov %eax, %cr0
-    jmp $VESA_INIT_SEGMENT, $vesa_init_real2 - vesa_init
-vesa_init_real2:
-    mov $VESA_INIT_SEGMENT, %bx
-    mov %bx, %es
-    mov %bx, %fs
-    mov %bx, %gs
-    mov %bx, %ds
-    mov %bx, %ss
-    movl %esp, %eax
-    movl $0x0000fffc, %esp
-    movl $0x0000fffc, %ebp
-    pushl %eax
-#define VESA_INFO_SIZE 1024
+#include "vesa_real.inc"
-#define VESA_MODE_ATTRIBUTES_OFFSET 0
-#define VESA_MODE_LIST_PTR_OFFSET 14
-#define VESA_MODE_SCANLINE_OFFSET 16
-#define VESA_MODE_WIDTH_OFFSET 18
-#define VESA_MODE_HEIGHT_OFFSET 20
-#define VESA_MODE_BPP_OFFSET 25
-#define VESA_MODE_PHADDR_OFFSET 40
-#define VESA_END_OF_MODES 0xffff
-#define VESA_OK 0x4f
-#define VESA_GET_INFO 0x4f00
-#define VESA_GET_MODE_INFO 0x4f01
-#define VESA_SET_MODE 0x4f02
-#define VESA_SET_PALETTE 0x4f09
-#if CONFIG_VESA_BPP == 24
-#define CONFIG_VESA_BPP_VARIANT 32
-#endif
-    mov $VESA_GET_INFO, %ax
-    mov $e_vesa_init - vesa_init, %di
-    push %di
-    int $0x10
-    pop %di
-    cmp $VESA_OK, %al
-    jnz 0f
-    mov 2 + VESA_MODE_LIST_PTR_OFFSET(%di), %si
-    mov %si, %gs
-    mov VESA_MODE_LIST_PTR_OFFSET(%di), %si
-    add $VESA_INFO_SIZE, %di
-:# Try next mode
-    mov %gs:(%si), %cx
-    cmp $VESA_END_OF_MODES, %cx
-    jz 0f
-    inc %si
-    inc %si
-    push %cx
-    push %di
-    push %si
-    mov $VESA_GET_MODE_INFO, %ax
-    int $0x10
-    pop %si
-    pop %di
-    pop %cx
-    cmp $VESA_OK, %al
-    jnz 0f
-    mov $CONFIG_VESA_WIDTH, %ax
-    cmp VESA_MODE_WIDTH_OFFSET(%di), %ax
-    jnz 1b
-    mov $CONFIG_VESA_HEIGHT, %ax
-    cmp VESA_MODE_HEIGHT_OFFSET(%di), %ax
-    jnz 1b
-    mov $CONFIG_VESA_BPP, %al
-    cmp VESA_MODE_BPP_OFFSET(%di), %al
-#ifdef CONFIG_VESA_BPP_VARIANT
-    jz 2f
-    mov $CONFIG_VESA_BPP_VARIANT, %al
-    cmp VESA_MODE_BPP_OFFSET(%di), %al
-#endif
-    jnz 1b
-:
-    mov %cx, %bx
-    or $0xc000, %bx
-    push %di
-    mov $VESA_SET_MODE, %ax
-    int $0x10
-    pop %di
-    cmp $VESA_OK, %al
-    jnz 0f
-#if CONFIG_VESA_BPP == 8
-    # Set 3:2:3 VGA palette
-    mov VESA_MODE_ATTRIBUTES_OFFSET(%di), %ax
-    push %di
-    mov $vga323 - vesa_init, %di
-    mov $0x100, %ecx
-    bt $5, %ax                          # Test if VGA compatible registers are present
-    jnc vga_compat
-        # Try VESA routine to set palette
-        mov $VESA_SET_PALETTE, %ax
-        xor %bl, %bl
-        xor %dx, %dx
-        int $0x10
-        jmp vga_not_compat
-    vga_compat:
-        # Try VGA registers to set palette
-        movw $0x3c6, %dx                        # Set palette mask
-        movb $0xff, %al
-        outb %al, %dx
-        movw $0x3c8, %dx                        # First index to set
-        xor %al, %al
-        outb %al, %dx
-        movw $0x3c9, %dx                        # Data port
-        vga_loop:
-            movb %es:2(%di), %al
-            outb %al, %dx
-            movb %es:1(%di), %al
-            outb %al, %dx
-            movb %es:(%di), %al
-            outb %al, %dx
-            addw $4, %di
-            loop vga_loop
-    vga_not_compat:
-    pop %di
-#endif
-    mov VESA_MODE_PHADDR_OFFSET(%di), %esi
-    mov VESA_MODE_WIDTH_OFFSET(%di), %ax
-    shl $16, %eax
-    mov VESA_MODE_HEIGHT_OFFSET(%di), %ax
-    mov VESA_MODE_BPP_OFFSET(%di), %bl
-    xor %bh, %bh
-    shl $16, %ebx
-    mov VESA_MODE_SCANLINE_OFFSET(%di), %bx
-    mov %eax, %edi
-:
-    mov %cr0, %eax
-    or $1, %eax
-    mov %eax, %cr0
-    jmp 9f
-:
-    ljmpl $selector(KTEXT_DES), $(vesa_init_protect - vesa_init + VESA_INIT_SEGMENT << 4)
-:# No prefered mode found
-    mov $0x111, %cx
-    push %di
-    push %cx
-    mov $VESA_GET_MODE_INFO, %ax
-    int $0x10
-    pop %cx
-    pop %di
-    cmp $VESA_OK, %al
-    jnz 1f
-    jz 2b                       # Force relative jump
-:
-    mov $0x0003, %ax
-    int $0x10
-    mov $0xffffffff, %edi       # EGA text mode used, because of problems with VESA
-    xor %ax, %ax
-    jz 8b                       # Force relative jump
-vga323:
-#include "vga323.pal"
-.code32
-vesa_init_protect:
-    movw $selector(KDATA_DES), %cx
-    movw %cx, %es
-    movw %cx, %fs
-    movw %cx, %gs
-    movw %cx, %ds                   # kernel data + stack
-    movw %cx, %ss
-    movl $START_STACK, %esp         # initialize stack pointer
-    jmpl $selector(KTEXT_DES), $vesa_meeting_point
-.align 4
-e_vesa_init:
-#endif
 .section K_DATA_START, "aw", @progbits
 .align 4096
 ,3 → 223,6
 pse_msg:
     .asciz "Page Size Extension not supported. System halted."
+sep_msg:
+    .asciz "SYSENTER/SYSEXIT not supported. System halted."

 /branches/tracing/kernel/arch/ia32/src/boot/vesa_real.inc
 ,0 → 1,373
+#ifdef CONFIG_FB
+#include <macros.h>
+#define VESA_INFO_SIZE 1024
+#define VESA_MODE_ATTRIBUTES_OFFSET  0
+#define VESA_MODE_LIST_PTR_OFFSET    14
+#define VESA_MODE_SCANLINE_OFFSET    16
+#define VESA_MODE_WIDTH_OFFSET       18
+#define VESA_MODE_HEIGHT_OFFSET      20
+#define VESA_MODE_BPP_OFFSET         25
+#define VESA_MODE_RED_MASK_OFFSET    31
+#define VESA_MODE_RED_POS_OFFSET     32
+#define VESA_MODE_GREEN_MASK_OFFSET  33
+#define VESA_MODE_GREEN_POS_OFFSET   34
+#define VESA_MODE_BLUE_MASK_OFFSET   35
+#define VESA_MODE_BLUE_POS_OFFSET    36
+#define VESA_MODE_PHADDR_OFFSET      40
+#define VESA_END_OF_MODES  0xffff
+#define VESA_OK  0x4f
+#define VESA_GET_INFO       0x4f00
+#define VESA_GET_MODE_INFO  0x4f01
+#define VESA_SET_MODE       0x4f02
+#define VESA_SET_PALETTE    0x4f09
+.code32
+vesa_init:
+    jmp $gdtselector(VESA_INIT_DES), $vesa_init_real - vesa_init
+.code16
+vesa_init_real:
+    mov %cr0, %eax
+    and $~1, %eax
+    mov %eax, %cr0
+    jmp $VESA_INIT_SEGMENT, $vesa_init_real2 - vesa_init
+vesa_init_real2:
+    mov $VESA_INIT_SEGMENT, %bx
+    mov %bx, %es
+    mov %bx, %fs
+    mov %bx, %gs
+    mov %bx, %ds
+    mov %bx, %ss
+    movl %esp, %eax
+    movl $0x0000fffc, %esp
+    movl $0x0000fffc, %ebp
+    pushl %eax
+    # parse default mode string
+    mov $default_mode - vesa_init, %di
+    xor %eax, %eax
+    xor %ebx, %ebx
+    mov $8, %ecx
+    parse_width:
+        mov (%di), %al
+        # check for digit
+        cmp $'0', %al
+        jb parse_width_done
+        cmp $'9', %al
+        ja parse_width_done
+        sub $'0', %al
+        # multiply default_width by 10 and add digit
+        mov default_width - vesa_init, %bx
+        lea (%ebx, %ebx, 4), %ebx
+        shl $1, %ebx
+        add %ax, %bx
+        mov %bx, default_width - vesa_init
+        inc %di
+        loop parse_width
+    parse_width_done:
+    mov (%di), %al
+    cmp $0, %al
+    jz parse_done
+    inc %di
+    mov $8, %ecx
+    parse_height:
+        mov (%di), %al
+        # check for digit
+        cmp $'0', %al
+        jb parse_height_done
+        cmp $'9', %al
+        ja parse_height_done
+        sub $'0', %al
+        # multiply default_height by 10 and add digit
+        mov default_height - vesa_init, %bx
+        lea (%ebx, %ebx, 4), %ebx
+        shl $1, %ebx
+        add %ax, %bx
+        mov %bx, default_height - vesa_init
+        inc %di
+        loop parse_height
+    parse_height_done:
+    mov (%di), %al
+    cmp $0, %al
+    jz parse_done
+    inc %di
+    mov $4, %ecx
+    parse_bpp:
+        mov (%di), %al
+        # check for digit
+        cmp $'0', %al
+        jb parse_bpp_done
+        cmp $'9', %al
+        ja parse_bpp_done
+        sub $'0', %al
+        # multiply default_bpp by 10 and add digit
+        mov default_bpp - vesa_init, %bx
+        lea (%ebx, %ebx, 4), %ebx
+        shl $1, %ebx
+        add %ax, %bx
+        mov %bx, default_bpp - vesa_init
+        inc %di
+        loop parse_bpp
+    parse_bpp_done:
+    parse_done:
+    mov $VESA_GET_INFO, %ax
+    mov $e_vesa_init - vesa_init, %di
+    push %di
+    int $0x10
+    pop %di
+    cmp $VESA_OK, %al
+    jnz no_mode
+    mov 2 + VESA_MODE_LIST_PTR_OFFSET(%di), %si
+    mov %si, %gs
+    mov VESA_MODE_LIST_PTR_OFFSET(%di), %si
+    add $VESA_INFO_SIZE, %di
+    next_mode:
+        # try next mode
+        mov %gs:(%si), %cx
+        cmp $VESA_END_OF_MODES, %cx
+        je no_mode
+        inc %si
+        inc %si
+        push %cx
+        push %di
+        push %si
+        mov $VESA_GET_MODE_INFO, %ax
+        int $0x10
+        pop %si
+        pop %di
+        pop %cx
+        cmp $VESA_OK, %al
+        jne no_mode
+        # check for proper attributes (supported, color, graphics, linear framebuffer)
+        mov VESA_MODE_ATTRIBUTES_OFFSET(%di), %ax
+        and $0x99, %ax
+        cmp $0x99, %ax
+        jne next_mode
+        # check for proper resolution
+        mov default_width - vesa_init, %ax
+        cmp VESA_MODE_WIDTH_OFFSET(%di), %ax
+        jne next_mode
+        mov default_height - vesa_init, %ax
+        cmp VESA_MODE_HEIGHT_OFFSET(%di), %ax
+        jne next_mode
+        # check for proper bpp
+        mov default_bpp - vesa_init, %al
+        cmp VESA_MODE_BPP_OFFSET(%di), %al
+        je set_mode
+        mov $24, %al
+        cmp default_bpp - vesa_init, %al
+        jne next_mode
+        # for 24 bpp modes accept also 32 bit bpp
+        mov $32, %al
+        cmp VESA_MODE_BPP_OFFSET(%di), %al
+        jne next_mode
+    set_mode:
+        mov %cx, %bx
+        or $0xc000, %bx
+        push %di
+        mov $VESA_SET_MODE, %ax
+        int $0x10
+        pop %di
+        cmp $VESA_OK, %al
+        jnz no_mode
+        # set 3:2:3 VGA palette
+        mov VESA_MODE_BPP_OFFSET(%di), %al
+        cmp $8, %al
+        jnz vga_not_set
+        mov VESA_MODE_ATTRIBUTES_OFFSET(%di), %ax
+        push %di
+        mov $vga323 - vesa_init, %di
+        mov $0x100, %ecx
+        bt $5, %ax              # test if VGA compatible registers are present
+        jnc vga_compat
+            # try VESA routine to set palette
+            mov $VESA_SET_PALETTE, %ax
+            xor %bl, %bl
+            xor %dx, %dx
+            int $0x10
+            cmp $0x00, %ah
+            je vga_not_compat
+        vga_compat:
+            # try VGA registers to set palette
+            movw $0x3c6, %dx    # set palette mask
+            movb $0xff, %al
+            outb %al, %dx
+            movw $0x3c8, %dx    # first index to set
+            xor %al, %al
+            outb %al, %dx
+            movw $0x3c9, %dx    # data port
+            vga_loop:
+                movb %es:2(%di), %al
+                outb %al, %dx
+                movb %es:1(%di), %al
+                outb %al, %dx
+                movb %es:(%di), %al
+                outb %al, %dx
+                addw $4, %di
+            loop vga_loop
+        vga_not_compat:
+            pop %di
+        vga_not_set:
+        # store mode parameters
+        #  eax = bpp[8] scanline[16]
+        #  ebx = width[16]  height[16]
+        #  edx = red_mask[8] red_pos[8] green_mask[8] green_pos[8]
+        #  esi = blue_mask[8] blue_pos[8]
+        #  edi = linear frame buffer
+        mov VESA_MODE_BPP_OFFSET(%di), %al
+        xor %ah, %ah
+        shl $16, %eax
+        mov VESA_MODE_SCANLINE_OFFSET(%di), %ax
+        mov VESA_MODE_WIDTH_OFFSET(%di), %bx
+        shl $16, %ebx
+        mov VESA_MODE_HEIGHT_OFFSET(%di), %bx
+        mov VESA_MODE_BLUE_MASK_OFFSET(%di), %dl
+        shl $8, %edx
+        mov VESA_MODE_BLUE_POS_OFFSET(%di), %dl
+        mov %edx, %esi
+        mov VESA_MODE_RED_MASK_OFFSET(%di), %dl
+        shl $8, %edx
+        mov VESA_MODE_RED_POS_OFFSET(%di), %dl
+        shl $8, %edx
+        mov VESA_MODE_GREEN_MASK_OFFSET(%di), %dl
+        shl $8, %edx
+        mov VESA_MODE_GREEN_POS_OFFSET(%di), %dl
+        mov VESA_MODE_PHADDR_OFFSET(%di), %edi
+        vesa_leave_real:
+            mov %cr0, %ecx
+            or $1, %ecx
+            mov %ecx, %cr0
+            jmp vesa_leave_real2
+        vesa_leave_real2:
+            ljmpl $gdtselector(KTEXT32_DES), $(vesa_init_protected - vesa_init + VESA_INIT_SEGMENT << 4)
+    no_mode:
+        # no prefered mode found
+        mov $0x111, %cx
+        push %di
+        push %cx
+        mov $VESA_GET_MODE_INFO, %ax
+        int $0x10
+        pop %cx
+        pop %di
+        cmp $VESA_OK, %al
+        jnz text_mode
+        jz set_mode             # force relative jump
+    text_mode:
+        # reset to EGA text mode (because of problems with VESA)
+        mov $0x0003, %ax
+        int $0x10
+        mov $0xffffffff, %edi
+        xor %ax, %ax
+        jz vesa_leave_real      # force relative jump
+vga323:
+#include "vga323.pal"
+default_width:
+    .word 0
+default_height:
+    .word 0
+default_bpp:
+    .byte 0
+default_mode:
+    .ascii STRING(CONFIG_VESA_MODE)
+    .ascii "-"
+    .asciz STRING(CONFIG_VESA_BPP)
+    .fill 24
+#include "vesa_ret.inc"
+.align 4
+e_vesa_init:
+#endif

 /branches/tracing/kernel/arch/ia32/src/boot/vesa_prot.inc
 ,0 → 1,107
+#ifdef CONFIG_FB
+#define MULTIBOOT_LOADER_MAGIC  0x2BADB002
+#define MBINFO_BIT_CMDLINE      2
+#define MBINFO_OFFSET_CMDLINE   16
+    # copy real mode VESA initialization code
+    mov $vesa_init, %esi
+    mov $VESA_INIT_SEGMENT << 4, %edi
+    mov $e_vesa_init - vesa_init, %ecx
+    rep movsb
+    # check for GRUB command line
+    mov grub_eax, %eax
+    cmp $MULTIBOOT_LOADER_MAGIC, %eax
+    jne no_cmdline
+    mov grub_ebx, %ebx
+    mov (%ebx), %eax
+    bt $MBINFO_BIT_CMDLINE, %eax
+    jnc no_cmdline
+    # skip the kernel path in command line
+    mov MBINFO_OFFSET_CMDLINE(%ebx), %esi
+    skip_loop:
+        lodsb
+        cmp $0, %al
+        je no_cmdline
+        cmp $' ', %al
+        je skip_loop_done
+        jmp skip_loop
+    skip_loop_done:
+    space_loop:
+        mov (%esi), %al
+        cmp $0, %al
+        je no_cmdline
+        cmp $' ', %al
+        jne space_loop_done
+        inc %esi
+        jmp space_loop
+    space_loop_done:
+    # copy at most 23 characters from command line
+    mov $VESA_INIT_SEGMENT << 4, %edi
+    add $default_mode - vesa_init, %edi
+    mov $23, %ecx
+    cmd_loop:
+        lodsb
+        stosb
+        cmp $0, %al
+        je cmd_loop_done
+        loop cmd_loop
+    cmd_loop_done:
+    # zero termination
+    xor %eax, %eax
+    stosb
+    no_cmdline:
+    # jump to the real mode
+    mov $VESA_INIT_SEGMENT << 4, %edi
+    jmpl *%edi
+    vesa_meeting_point:
+        # returned back to protected mode
+        mov %ax, KA2PA(vesa_scanline)
+        shr $16, %eax
+        mov %ax, KA2PA(vesa_bpp)
+        mov %bx, KA2PA(vesa_height)
+        shr $16, %ebx
+        mov %bx, KA2PA(vesa_width)
+        mov %dl, KA2PA(vesa_green_pos)
+        shr $8, %edx
+        mov %dl, KA2PA(vesa_green_mask)
+        shr $8, %edx
+        mov %dl, KA2PA(vesa_red_pos)
+        shr $8, %edx
+        mov %dl, KA2PA(vesa_red_mask)
+        mov %esi, %edx
+        mov %dl, KA2PA(vesa_blue_pos)
+        shr $8, %edx
+        mov %dl, KA2PA(vesa_blue_mask)
+        mov %edi, KA2PA(vesa_ph_addr)
+#endif

 /branches/tracing/kernel/arch/ia32/src/mm/tlb.c
 ,5 → 67,13
         invlpg(page + i * PAGE_SIZE);
 }
+void tlb_arch_init(void)
+{
+}
+void tlb_print(void)
+{
+}
 /** @}
  */

 /branches/tracing/kernel/arch/ia32/src/mm/frame.c
 ,26 → 54,57
 static void init_e820_memory(pfn_t minconf)
 {
     unsigned int i;
-    pfn_t start, conf;
-    size_t size;
     for (i = 0; i < e820counter; i++) {
+        uint64_t base = e820table[i].base_address;
+        uint64_t size = e820table[i].size;
+#ifdef __32_BITS__
+        /* Ignore physical memory above 4 GB */
+        if ((base >> 32) != 0)
+            continue;
+        /* Clip regions above 4 GB */
+        if (((base + size) >> 32) != 0)
+            size = 0xffffffff - base;
+#endif
+        pfn_t pfn;
+        count_t count;
         if (e820table[i].type == MEMMAP_MEMORY_AVAILABLE) {
-            start = ADDR2PFN(ALIGN_UP(e820table[i].base_address, FRAME_SIZE));
-            size = SIZE2FRAMES(ALIGN_DOWN(e820table[i].size, FRAME_SIZE));
+            /* To be safe, make available zone possibly smaller */
+            pfn = ADDR2PFN(ALIGN_UP(base, FRAME_SIZE));
+            count = SIZE2FRAMES(ALIGN_DOWN(size, FRAME_SIZE));
-            if ((minconf < start) || (minconf >= start + size))
-                conf = start;
+            pfn_t conf;
+            if ((minconf < pfn) || (minconf >= pfn + count))
+                conf = pfn;
             else
                 conf = minconf;
-            zone_create(start, size, conf, 0);
+            zone_create(pfn, count, conf, ZONE_AVAILABLE);
-            if (last_frame < ALIGN_UP(e820table[i].base_address +
-                e820table[i].size, FRAME_SIZE))
-                last_frame =
-                    ALIGN_UP(e820table[i].base_address + e820table[i].size, FRAME_SIZE);
-        }
+            // XXX this has to be removed
+            if (last_frame < ALIGN_UP(base + size, FRAME_SIZE))
+                last_frame = ALIGN_UP(base + size, FRAME_SIZE);
+        }
+        if (e820table[i].type == MEMMAP_MEMORY_RESERVED) {
+            /* To be safe, make reserved zone possibly larger */
+            pfn = ADDR2PFN(ALIGN_DOWN(base, FRAME_SIZE));
+            count = SIZE2FRAMES(ALIGN_UP(size, FRAME_SIZE));
+            zone_create(pfn, count, 0, ZONE_RESERVED);
+        }
+        if (e820table[i].type == MEMMAP_MEMORY_ACPI) {
+            /* To be safe, make firmware zone possibly larger */
+            pfn = ADDR2PFN(ALIGN_DOWN(base, (uintptr_t) FRAME_SIZE));
+            count = SIZE2FRAMES(ALIGN_UP(size, (uintptr_t) FRAME_SIZE));
+            zone_create(pfn, count, 0, ZONE_FIRMWARE);
+        }
     }
 }
 ,16 → 144,14
     if (config.cpu_active == 1) {
         minconf = 1;
 #ifdef CONFIG_SMP
         minconf = max(minconf,
             ADDR2PFN(AP_BOOT_OFFSET + hardcoded_unmapped_ktext_size +
             hardcoded_unmapped_kdata_size));
 #endif
-#ifdef CONFIG_SIMICS_FIX
-        minconf = max(minconf, ADDR2PFN(0x10000));
-#endif
         init_e820_memory(minconf);
         /* Reserve frame 0 (BIOS data) */
         frame_mark_unavailable(0, 1);
 ,12 → 160,7
         frame_mark_unavailable(AP_BOOT_OFFSET >> FRAME_WIDTH,
             (hardcoded_unmapped_ktext_size +
             hardcoded_unmapped_kdata_size) >> FRAME_WIDTH);
-#ifdef CONFIG_SIMICS_FIX
-        /* Don't know why, but these addresses help */
-        frame_mark_unavailable(0xd000 >> FRAME_WIDTH, 3);
 #endif
-#endif
     }
 }

 /branches/tracing/kernel/arch/ia32/src/mm/page.c
 ,7 → 53,7
 {
     uintptr_t cur;
     int flags;
     if (config.cpu_active == 1) {
         page_mapping_operations = &pt_mapping_operations;
 ,12 → 66,12
                 flags |= PAGE_GLOBAL;
             page_mapping_insert(AS_KERNEL, PA2KA(cur), cur, flags);
         }
         exc_register(14, "page_fault", (iroutine) page_fault);
         write_cr3((uintptr_t) AS_KERNEL->genarch.page_table);
     } else
         write_cr3((uintptr_t) AS_KERNEL->genarch.page_table);
     paging_on();
 }
 ,7 → 79,7
 uintptr_t hw_map(uintptr_t physaddr, size_t size)
 {
     if (last_frame + ALIGN_UP(size, PAGE_SIZE) > KA2PA(KERNEL_ADDRESS_SPACE_END_ARCH))
-        panic("Unable to map physical memory %p (%d bytes)", physaddr, size)
+        panic("Unable to map physical memory %p (%d bytes).", physaddr, size)
     uintptr_t virtaddr = PA2KA(last_frame);
     pfn_t i;
 ,8 → 101,8
     page = read_cr2();
     if (istate->error_word & PFERR_CODE_RSVD)
-        panic("Reserved bit set in page directory.\n");
+        panic("Reserved bit set in page directory.");
     if (istate->error_word & PFERR_CODE_RW)
         access = PF_ACCESS_WRITE;
     else
 ,11 → 109,11
         access = PF_ACCESS_READ;
     if (as_page_fault(page, access, istate) == AS_PF_FAULT) {
-        fault_if_from_uspace(istate, "Page fault: %#x", page);
+        fault_if_from_uspace(istate, "Page fault: %#x.", page);
         decode_istate(istate);
         printf("page fault address: %#lx\n", page);
-        panic("page fault\n");
+        panic("Page fault.");
     }
 }

 /branches/tracing/kernel/arch/ia32/src/userspace.c
 ,7 → 26,7
  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
  */
-/** @addtogroup ia32
+/** @addtogroup ia32
  * @{
  */
 /** @file
 ,10 → 47,8
  */
 void userspace(uspace_arg_t *kernel_uarg)
 {
-    ipl_t ipl;
-    ipl = interrupts_disable();
+    ipl_t ipl = interrupts_disable();
     asm volatile (
         /*
          * Clear nested task flag.
 ,35 → 58,33
         "and $0xffffbfff, %%eax\n"
         "push %%eax\n"
         "popfl\n"
         /* Set up GS register (TLS) */
-        "movl %6, %%gs\n"
-        "pushl %0\n"
-        "pushl %1\n"
-        "pushl %2\n"
-        "pushl %3\n"
-        "pushl %4\n"
-        "movl %5, %%eax\n"
+        "movl %[tls_des], %%gs\n"
+        "pushl %[udata_des]\n"
+        "pushl %[stack_size]\n"
+        "pushl %[ipl]\n"
+        "pushl %[utext_des]\n"
+        "pushl %[entry]\n"
+        "movl %[uarg], %%eax\n"
         /* %ebx is defined to hold pcb_ptr - set it to 0 */
-        "xorl %%ebx, %%ebx\n"
+        "xorl %%ebx, %%ebx\n"
         "iret\n"
-        :
-        : "i" (selector(UDATA_DES) | PL_USER),
-          "r" ((uint8_t *) kernel_uarg->uspace_stack +
-              THREAD_STACK_SIZE),
-          "r" (ipl),
-          "i" (selector(UTEXT_DES) | PL_USER),
-          "r" (kernel_uarg->uspace_entry),
-          "r" (kernel_uarg->uspace_uarg),
-          "r" (selector(TLS_DES))
+        :
+        : [udata_des] "i" (gdtselector(UDATA_DES) | PL_USER),
+          [stack_size] "r" ((uint8_t *) kernel_uarg->uspace_stack + THREAD_STACK_SIZE),
+          [ipl] "r" (ipl),
+          [utext_des] "i" (gdtselector(UTEXT_DES) | PL_USER),
+          [entry] "r" (kernel_uarg->uspace_entry),
+          [uarg] "r" (kernel_uarg->uspace_uarg),
+          [tls_des] "r" (gdtselector(TLS_DES))
         : "eax");
     /* Unreachable */
-    for(;;)
-        ;
+    while (1);
 }
 /** @}

 /branches/tracing/kernel/arch/ia32/src/interrupt.c
 ,7 → 44,6
 #include <mm/tlb.h>
 #include <mm/as.h>
 #include <arch.h>
-#include <symtab.h>
 #include <proc/thread.h>
 #include <proc/task.h>
 #include <synch/spinlock.h>
 ,6 → 51,7
 #include <ipc/sysipc.h>
 #include <interrupt.h>
 #include <ddi/irq.h>
+#include <symtab.h>
 /*
  * Interrupt and exception dispatching.
 ,10 → 63,9
 void decode_istate(istate_t *istate)
 {
-    char *symbol = get_symtab_entry(istate->eip);
+    char *symbol;
-    if (!symbol)
-        symbol = "";
+    symbol = symtab_fmt_name_lookup(istate->eip);
     if (CPU)
         printf("----------------EXCEPTION OCCURED (cpu%u)----------------\n", CPU->id);
 ,9 → 76,6
     printf("ERROR_WORD=%#lx\n", istate->error_word);
     printf("%%cs=%#lx,flags=%#lx\n", istate->cs, istate->eflags);
     printf("%%eax=%#lx, %%ecx=%#lx, %%edx=%#lx, %%esp=%p\n", istate->eax, istate->ecx, istate->edx, &istate->stack[0]);
-#ifdef CONFIG_DEBUG_ALLREGS
-    printf("%%esi=%#lx, %%edi=%#lx, %%ebp=%#lx, %%ebx=%#lx\n", istate->esi, istate->edi, istate->ebp, istate->ebx);
-#endif
     printf("stack: %#lx, %#lx, %#lx, %#lx\n", istate->stack[0], istate->stack[1], istate->stack[2], istate->stack[3]);
     printf("       %#lx, %#lx, %#lx, %#lx\n", istate->stack[4], istate->stack[5], istate->stack[6], istate->stack[7]);
 }
 ,16 → 85,16
     if (eoi_function)
         eoi_function();
     else
-        panic("no eoi_function\n");
+        panic("No eoi_function.");
 }
 static void null_interrupt(int n, istate_t *istate)
 {
-    fault_if_from_uspace(istate, "unserviced interrupt: %d", n);
+    fault_if_from_uspace(istate, "Unserviced interrupt: %d.", n);
     decode_istate(istate);
-    panic("unserviced interrupt: %d\n", n);
+    panic("Unserviced interrupt: %d.", n);
 }
 /** General Protection Fault. */
 ,19 → 118,19
             io_perm_bitmap_install();
             return;
         }
-        fault_if_from_uspace(istate, "general protection fault");
+        fault_if_from_uspace(istate, "General protection fault.");
     }
     decode_istate(istate);
-    panic("general protection fault\n");
+    panic("General protection fault.");
 }
 static void ss_fault(int n __attribute__((unused)), istate_t *istate)
 {
-    fault_if_from_uspace(istate, "stack fault");
+    fault_if_from_uspace(istate, "Stack fault.");
     decode_istate(istate);
-    panic("stack fault\n");
+    panic("Stack fault.");
 }
 static void simd_fp_exception(int n __attribute__((unused)), istate_t *istate)
 ,15 → 137,15
 {
     uint32_t mxcsr;
     asm (
-        "stmxcsr %0;\n"
-        : "=m" (mxcsr)
+        "stmxcsr %[mxcsr]\n"
+        : [mxcsr] "=m" (mxcsr)
     );
-    fault_if_from_uspace(istate, "SIMD FP exception(19), MXCSR: %#zx",
+    fault_if_from_uspace(istate, "SIMD FP exception(19), MXCSR: %#zx.",
         (unative_t) mxcsr);
     decode_istate(istate);
     printf("MXCSR: %#lx\n", mxcsr);
-    panic("SIMD FP exception(19)\n");
+    panic("SIMD FP exception(19).");
 }
 static void nm_fault(int n __attribute__((unused)), istate_t *istate __attribute__((unused)))
 ,8 → 153,8
 #ifdef CONFIG_FPU_LAZY
     scheduler_fpu_lazy_request();
 #else
-    fault_if_from_uspace(istate, "fpu fault");
-    panic("fpu fault");
+    fault_if_from_uspace(istate, "FPU fault.");
+    panic("FPU fault.");
 #endif
 }
 ,7 → 187,7
             trap_virtual_eoi();
             ack = true;
         }
-        irq->handler(irq, irq->arg);
+        irq->handler(irq);
         spinlock_unlock(&irq->lock);
     } else {
         /*
 ,7 → 229,7
     if (enable_irqs_function)
         enable_irqs_function(irqmask);
     else
-        panic("no enable_irqs_function\n");
+        panic("No enable_irqs_function.");
 }
 void trap_virtual_disable_irqs(uint16_t irqmask)
 ,7 → 237,7
     if (disable_irqs_function)
         disable_irqs_function(irqmask);
     else
-        panic("no disable_irqs_function\n");
+        panic("No disable_irqs_function.");
 }
 /** @}

 /branches/tracing/kernel/arch/ia32/src/drivers/vesa.c
 ,12 → 56,20
 uint16_t vesa_bpp;
 uint16_t vesa_scanline;
+uint8_t vesa_red_mask;
+uint8_t vesa_red_pos;
+uint8_t vesa_green_mask;
+uint8_t vesa_green_pos;
+uint8_t vesa_blue_mask;
+uint8_t vesa_blue_pos;
 int vesa_present(void)
 {
-    if (vesa_width != 0xffff)
+    if ((vesa_width != 0xffff) && (vesa_height != 0xffff))
         return true;
-    if (vesa_height != 0xffff)
-        return true;
     return false;
 }
 ,7 → 82,12
         visual = VISUAL_INDIRECT_8;
         break;
     case 16:
-        visual = VISUAL_RGB_5_6_5;
+        if ((vesa_red_mask == 5) && (vesa_red_pos == 10)
+            && (vesa_green_mask == 5) && (vesa_green_pos == 5)
+            && (vesa_blue_mask == 5) && (vesa_blue_pos == 0))
+            visual = VISUAL_RGB_5_5_5;
+        else
+            visual = VISUAL_RGB_5_6_5;
         break;
     case 24:
         visual = VISUAL_RGB_8_8_8;
 ,7 → 96,7
         visual = VISUAL_RGB_0_8_8_8;
         break;
     default:
-        panic("Unsupported bits per pixel");
+        panic("Unsupported bits per pixel.");
     }
     fb_properties_t vesa_props = {
 ,6 → 110,11
     fb_init(&vesa_props);
 }
+void vesa_redraw(void)
+{
+    fb_redraw();
+}
 #endif
 /** @}

 /branches/tracing/kernel/arch/ia32/src/drivers/i8259.c
 ,28 → 49,28
 void i8259_init(void)
 {
     /* ICW1: this is ICW1, ICW4 to follow */
-    outb(PIC_PIC0PORT1, PIC_ICW1 | PIC_NEEDICW4);
+    pio_write_8(PIC_PIC0PORT1, PIC_ICW1 | PIC_NEEDICW4);
     /* ICW2: IRQ 0 maps to INT IRQBASE */
-    outb(PIC_PIC0PORT2, IVT_IRQBASE);
+    pio_write_8(PIC_PIC0PORT2, IVT_IRQBASE);
     /* ICW3: pic1 using IRQ IRQ_PIC1 */
-    outb(PIC_PIC0PORT2, 1 << IRQ_PIC1);
+    pio_write_8(PIC_PIC0PORT2, 1 << IRQ_PIC1);
     /* ICW4: i8086 mode */
-    outb(PIC_PIC0PORT2, 1);
+    pio_write_8(PIC_PIC0PORT2, 1);
     /* ICW1: ICW1, ICW4 to follow */
-    outb(PIC_PIC1PORT1, PIC_ICW1 | PIC_NEEDICW4);
+    pio_write_8(PIC_PIC1PORT1, PIC_ICW1 | PIC_NEEDICW4);
     /* ICW2: IRQ 8 maps to INT (IVT_IRQBASE + 8) */
-    outb(PIC_PIC1PORT2, IVT_IRQBASE + 8);
+    pio_write_8(PIC_PIC1PORT2, IVT_IRQBASE + 8);
     /* ICW3: pic1 is known as IRQ_PIC1 */
-    outb(PIC_PIC1PORT2, IRQ_PIC1);
+    pio_write_8(PIC_PIC1PORT2, IRQ_PIC1);
     /* ICW4: i8086 mode */
-    outb(PIC_PIC1PORT2, 1);
+    pio_write_8(PIC_PIC1PORT2, 1);
     /*
      * Register interrupt handler for the PIC spurious interrupt.
 ,12 → 94,12
     uint8_t x;
     if (irqmask & 0xff) {
-        x = inb(PIC_PIC0PORT2);
-        outb(PIC_PIC0PORT2, (uint8_t) (x & (~(irqmask & 0xff))));
+        x = pio_read_8(PIC_PIC0PORT2);
+        pio_write_8(PIC_PIC0PORT2, (uint8_t) (x & (~(irqmask & 0xff))));
     }
     if (irqmask >> 8) {
-        x = inb(PIC_PIC1PORT2);
-        outb(PIC_PIC1PORT2, (uint8_t) (x & (~(irqmask >> 8))));
+        x = pio_read_8(PIC_PIC1PORT2);
+        pio_write_8(PIC_PIC1PORT2, (uint8_t) (x & (~(irqmask >> 8))));
     }
 }
 ,19 → 108,19
     uint8_t x;
     if (irqmask & 0xff) {
-        x = inb(PIC_PIC0PORT2);
-        outb(PIC_PIC0PORT2, (uint8_t) (x | (irqmask & 0xff)));
+        x = pio_read_8(PIC_PIC0PORT2);
+        pio_write_8(PIC_PIC0PORT2, (uint8_t) (x | (irqmask & 0xff)));
     }
     if (irqmask >> 8) {
-        x = inb(PIC_PIC1PORT2);
-        outb(PIC_PIC1PORT2, (uint8_t) (x | (irqmask >> 8)));
+        x = pio_read_8(PIC_PIC1PORT2);
+        pio_write_8(PIC_PIC1PORT2, (uint8_t) (x | (irqmask >> 8)));
     }
 }
 void pic_eoi(void)
 {
-    outb(0x20, 0x20);
-    outb(0xa0, 0x20);
+    pio_write_8((ioport8_t *)0x20, 0x20);
+    pio_write_8((ioport8_t *)0xa0, 0x20);
 }
 void pic_spurious(int n __attribute__((unused)), istate_t *istate __attribute__((unused)))

 /branches/tracing/kernel/arch/ia32/src/drivers/i8254.c
 ,12 → 26,12
  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
  */
-/** @addtogroup ia32
+/** @addtogroup ia32
  * @{
  */
 /**
  * @file
- * @brief   i8254 chip driver.
+ * @brief i8254 chip driver.
  *
  * Low level time functions.
  */
 ,8 → 53,8
 #include <ddi/irq.h>
 #include <ddi/device.h>
-#define CLK_PORT1   0x40
-#define CLK_PORT4   0x43
+#define CLK_PORT1   ((ioport8_t *)0x40)
+#define CLK_PORT4   ((ioport8_t *)0x43)
 #define CLK_CONST   1193180
 #define MAGIC_NUMBER    1194
 ,12 → 61,12
 static irq_t i8254_irq;
-static irq_ownership_t i8254_claim(void)
+static irq_ownership_t i8254_claim(irq_t *irq)
 {
     return IRQ_ACCEPT;
 }
-static void i8254_irq_handler(irq_t *irq, void *arg __attribute__((unused)), ...)
+static void i8254_irq_handler(irq_t *irq)
 {
     /*
      * This IRQ is responsible for kernel preemption.
 ,10 → 94,10
 void i8254_normal_operation(void)
 {
-    outb(CLK_PORT4, 0x36);
+    pio_write_8(CLK_PORT4, 0x36);
     pic_disable_irqs(1 << IRQ_CLK);
-    outb(CLK_PORT1, (CLK_CONST / HZ) & 0xf);
-    outb(CLK_PORT1, (CLK_CONST / HZ) >> 8);
+    pio_write_8(CLK_PORT1, (CLK_CONST / HZ) & 0xf);
+    pio_write_8(CLK_PORT1, (CLK_CONST / HZ) >> 8);
     pic_enable_irqs(1 << IRQ_CLK);
 }
 ,36 → 114,36
      * One-shot timer. Count-down from 0xffff at 1193180Hz
      * MAGIC_NUMBER is the magic value for 1ms.
      */
-    outb(CLK_PORT4, 0x30);
-    outb(CLK_PORT1, 0xff);
-    outb(CLK_PORT1, 0xff);
+    pio_write_8(CLK_PORT4, 0x30);
+    pio_write_8(CLK_PORT1, 0xff);
+    pio_write_8(CLK_PORT1, 0xff);
     do {
         /* will read both status and count */
-        outb(CLK_PORT4, 0xc2);
-        not_ok = (uint8_t) ((inb(CLK_PORT1) >> 6) & 1);
-        t1 = inb(CLK_PORT1);
-        t1 |= inb(CLK_PORT1) << 8;
+        pio_write_8(CLK_PORT4, 0xc2);
+        not_ok = (uint8_t) ((pio_read_8(CLK_PORT1) >> 6) & 1);
+        t1 = pio_read_8(CLK_PORT1);
+        t1 |= pio_read_8(CLK_PORT1) << 8;
     } while (not_ok);
     asm_delay_loop(LOOPS);
-    outb(CLK_PORT4, 0xd2);
-    t2 = inb(CLK_PORT1);
-    t2 |= inb(CLK_PORT1) << 8;
+    pio_write_8(CLK_PORT4, 0xd2);
+    t2 = pio_read_8(CLK_PORT1);
+    t2 |= pio_read_8(CLK_PORT1) << 8;
     /*
      * We want to determine the overhead of the calibrating mechanism.
      */
-    outb(CLK_PORT4, 0xd2);
-    o1 = inb(CLK_PORT1);
-    o1 |= inb(CLK_PORT1) << 8;
+    pio_write_8(CLK_PORT4, 0xd2);
+    o1 = pio_read_8(CLK_PORT1);
+    o1 |= pio_read_8(CLK_PORT1) << 8;
     asm_fake_loop(LOOPS);
-    outb(CLK_PORT4, 0xd2);
-    o2 = inb(CLK_PORT1);
-    o2 |= inb(CLK_PORT1) << 8;
+    pio_write_8(CLK_PORT4, 0xd2);
+    o2 = pio_read_8(CLK_PORT1);
+    o2 |= pio_read_8(CLK_PORT1) << 8;
     CPU->delay_loop_const =
         ((MAGIC_NUMBER * LOOPS) / 1000) / ((t1 - t2) - (o1 - o2)) +

Subversion Repositories HelenOS

Compare Revisions

Ignore whitespace Rev 4376 → Rev 4377