xen-vtx-unstable
annotate xen/arch/x86/x86_64/traps.c @ 4926:8e3f809f3616
bitkeeper revision 1.1413 (42886cbcgOQRttqbKGwhoGUdvq0jbg)
Fix the watchdog disable/enable interface. This cleans up common code
somewhat.
Signed-off-by: Keir Fraser <keir@xensource.com>
Fix the watchdog disable/enable interface. This cleans up common code
somewhat.
Signed-off-by: Keir Fraser <keir@xensource.com>
author | kaf24@firebug.cl.cam.ac.uk |
---|---|
date | Mon May 16 09:49:48 2005 +0000 (2005-05-16) |
parents | a789d0f55020 |
children | 386956408063 |
rev | line source |
---|---|
kaf24@3602 | 1 |
kaf24@3602 | 2 #include <xen/config.h> |
kaf24@3602 | 3 #include <xen/init.h> |
kaf24@3602 | 4 #include <xen/sched.h> |
kaf24@3602 | 5 #include <xen/lib.h> |
kaf24@3602 | 6 #include <xen/errno.h> |
kaf24@3602 | 7 #include <xen/mm.h> |
kaf24@3602 | 8 #include <xen/irq.h> |
kaf24@3630 | 9 #include <xen/console.h> |
kaf24@3650 | 10 #include <xen/sched.h> |
kaf24@3650 | 11 #include <asm/msr.h> |
kaf24@3602 | 12 |
kaf24@4683 | 13 void show_registers(struct cpu_user_regs *regs) |
kaf24@3602 | 14 { |
kaf24@4654 | 15 printk("CPU: %d\nEIP: %04lx:[<%016lx>] \nEFLAGS: %016lx\n", |
kaf24@3602 | 16 smp_processor_id(), 0xffff & regs->cs, regs->rip, regs->eflags); |
kaf24@4654 | 17 printk("rax: %016lx rbx: %016lx rcx: %016lx rdx: %016lx\n", |
kaf24@3602 | 18 regs->rax, regs->rbx, regs->rcx, regs->rdx); |
kaf24@4654 | 19 printk("rsi: %016lx rdi: %016lx rbp: %016lx rsp: %016lx\n", |
kaf24@3621 | 20 regs->rsi, regs->rdi, regs->rbp, regs->rsp); |
kaf24@4654 | 21 printk("r8: %016lx r9: %016lx r10: %016lx r11: %016lx\n", |
kaf24@3602 | 22 regs->r8, regs->r9, regs->r10, regs->r11); |
kaf24@4654 | 23 printk("r12: %016lx r13: %016lx r14: %016lx r15: %016lx\n", |
kaf24@3602 | 24 regs->r12, regs->r13, regs->r14, regs->r15); |
kaf24@3602 | 25 |
kaf24@3602 | 26 show_stack((unsigned long *)regs->rsp); |
kaf24@4923 | 27 if ( GUEST_MODE(regs) ) |
kaf24@4923 | 28 show_guest_stack(); |
kaf24@3602 | 29 } |
kaf24@3602 | 30 |
kaf24@3630 | 31 void show_page_walk(unsigned long addr) |
kaf24@3630 | 32 { |
kaf24@3630 | 33 unsigned long page = read_cr3(); |
kaf24@3630 | 34 |
kaf24@4654 | 35 printk("Pagetable walk from %016lx:\n", addr); |
kaf24@3630 | 36 |
kaf24@3630 | 37 page &= PAGE_MASK; |
kaf24@3630 | 38 page = ((unsigned long *) __va(page))[l4_table_offset(addr)]; |
kaf24@4654 | 39 printk(" L4 = %016lx\n", page); |
kaf24@3630 | 40 if ( !(page & _PAGE_PRESENT) ) |
kaf24@3630 | 41 return; |
kaf24@3630 | 42 |
kaf24@3630 | 43 page &= PAGE_MASK; |
kaf24@3630 | 44 page = ((unsigned long *) __va(page))[l3_table_offset(addr)]; |
kaf24@4654 | 45 printk(" L3 = %016lx\n", page); |
kaf24@3630 | 46 if ( !(page & _PAGE_PRESENT) ) |
kaf24@3630 | 47 return; |
kaf24@3630 | 48 |
kaf24@3630 | 49 page &= PAGE_MASK; |
kaf24@3630 | 50 page = ((unsigned long *) __va(page))[l2_table_offset(addr)]; |
kaf24@4654 | 51 printk(" L2 = %016lx %s\n", page, (page & _PAGE_PSE) ? "(2MB)" : ""); |
kaf24@3630 | 52 if ( !(page & _PAGE_PRESENT) || (page & _PAGE_PSE) ) |
kaf24@3630 | 53 return; |
kaf24@3630 | 54 |
kaf24@3630 | 55 page &= PAGE_MASK; |
kaf24@3630 | 56 page = ((unsigned long *) __va(page))[l1_table_offset(addr)]; |
kaf24@4654 | 57 printk(" L1 = %016lx\n", page); |
kaf24@3630 | 58 } |
kaf24@3630 | 59 |
kaf24@3630 | 60 asmlinkage void double_fault(void); |
kaf24@4683 | 61 asmlinkage void do_double_fault(struct cpu_user_regs *regs) |
kaf24@3630 | 62 { |
kaf24@4926 | 63 watchdog_disable(); |
kaf24@3630 | 64 |
kaf24@3686 | 65 console_force_unlock(); |
kaf24@3686 | 66 |
kaf24@3630 | 67 /* Find information saved during fault and dump it to the console. */ |
kaf24@3630 | 68 printk("************************************\n"); |
kaf24@3695 | 69 show_registers(regs); |
kaf24@3630 | 70 printk("************************************\n"); |
kaf24@3695 | 71 printk("CPU%d DOUBLE FAULT -- system shutdown\n", smp_processor_id()); |
kaf24@3630 | 72 printk("System needs manual reset.\n"); |
kaf24@3630 | 73 printk("************************************\n"); |
kaf24@3630 | 74 |
kaf24@3630 | 75 /* Lock up the console to prevent spurious output from other CPUs. */ |
kaf24@3630 | 76 console_force_lock(); |
kaf24@3630 | 77 |
kaf24@3630 | 78 /* Wait for manual reset. */ |
kaf24@3630 | 79 for ( ; ; ) |
kaf24@3630 | 80 __asm__ __volatile__ ( "hlt" ); |
kaf24@3630 | 81 } |
kaf24@3630 | 82 |
kaf24@3761 | 83 asmlinkage void syscall_enter(void); |
kaf24@3650 | 84 void __init percpu_traps_init(void) |
kaf24@3650 | 85 { |
kaf24@3761 | 86 char *stack_bottom, *stack; |
kaf24@3761 | 87 int cpu = smp_processor_id(); |
kaf24@3761 | 88 |
kaf24@3774 | 89 if ( cpu == 0 ) |
kaf24@3774 | 90 { |
kaf24@3774 | 91 /* Specify dedicated interrupt stacks for NMIs and double faults. */ |
kaf24@3774 | 92 set_intr_gate(TRAP_double_fault, &double_fault); |
kaf24@3774 | 93 idt_table[TRAP_double_fault].a |= 1UL << 32; /* IST1 */ |
kaf24@3774 | 94 idt_table[TRAP_nmi].a |= 2UL << 32; /* IST2 */ |
kaf24@3774 | 95 } |
kaf24@3774 | 96 |
kaf24@3761 | 97 stack_bottom = (char *)get_stack_bottom(); |
kaf24@3761 | 98 stack = (char *)((unsigned long)stack_bottom & ~(STACK_SIZE - 1)); |
kaf24@3695 | 99 |
kaf24@3695 | 100 /* Double-fault handler has its own per-CPU 1kB stack. */ |
kaf24@3695 | 101 init_tss[cpu].ist[0] = (unsigned long)&stack[1024]; |
kaf24@3695 | 102 |
kaf24@3695 | 103 /* NMI handler has its own per-CPU 1kB stack. */ |
kaf24@3695 | 104 init_tss[cpu].ist[1] = (unsigned long)&stack[2048]; |
kaf24@3695 | 105 |
kaf24@3695 | 106 /* |
kaf24@3695 | 107 * Trampoline for SYSCALL entry from long mode. |
kaf24@3695 | 108 */ |
kaf24@3695 | 109 |
kaf24@3695 | 110 /* Skip the NMI and DF stacks. */ |
kaf24@3695 | 111 stack = &stack[2048]; |
kaf24@3695 | 112 wrmsr(MSR_LSTAR, (unsigned long)stack, ((unsigned long)stack>>32)); |
kaf24@3650 | 113 |
kaf24@3650 | 114 /* movq %rsp, saversp(%rip) */ |
kaf24@3650 | 115 stack[0] = 0x48; |
kaf24@3650 | 116 stack[1] = 0x89; |
kaf24@3650 | 117 stack[2] = 0x25; |
kaf24@3761 | 118 *(u32 *)&stack[3] = (stack_bottom - &stack[7]) - 16; |
kaf24@3650 | 119 |
kaf24@3650 | 120 /* leaq saversp(%rip), %rsp */ |
kaf24@3650 | 121 stack[7] = 0x48; |
kaf24@3650 | 122 stack[8] = 0x8d; |
kaf24@3650 | 123 stack[9] = 0x25; |
kaf24@3761 | 124 *(u32 *)&stack[10] = (stack_bottom - &stack[14]) - 16; |
kaf24@3650 | 125 |
kaf24@3783 | 126 /* pushq %r11 */ |
kaf24@3783 | 127 stack[14] = 0x41; |
kaf24@3783 | 128 stack[15] = 0x53; |
kaf24@3783 | 129 |
kaf24@3783 | 130 /* pushq $__GUEST_CS64 */ |
kaf24@3783 | 131 stack[16] = 0x68; |
kaf24@3783 | 132 *(u32 *)&stack[17] = __GUEST_CS64; |
kaf24@3783 | 133 |
kaf24@3761 | 134 /* jmp syscall_enter */ |
kaf24@3783 | 135 stack[21] = 0xe9; |
kaf24@3783 | 136 *(u32 *)&stack[22] = (char *)syscall_enter - &stack[26]; |
kaf24@3650 | 137 |
kaf24@3695 | 138 /* |
kaf24@3695 | 139 * Trampoline for SYSCALL entry from compatibility mode. |
kaf24@3695 | 140 */ |
kaf24@3695 | 141 |
kaf24@3695 | 142 /* Skip the long-mode entry trampoline. */ |
kaf24@3783 | 143 stack = &stack[26]; |
kaf24@3695 | 144 wrmsr(MSR_CSTAR, (unsigned long)stack, ((unsigned long)stack>>32)); |
kaf24@3695 | 145 |
kaf24@3695 | 146 /* movq %rsp, saversp(%rip) */ |
kaf24@3695 | 147 stack[0] = 0x48; |
kaf24@3695 | 148 stack[1] = 0x89; |
kaf24@3695 | 149 stack[2] = 0x25; |
kaf24@3761 | 150 *(u32 *)&stack[3] = (stack_bottom - &stack[7]) - 16; |
kaf24@3695 | 151 |
kaf24@3695 | 152 /* leaq saversp(%rip), %rsp */ |
kaf24@3695 | 153 stack[7] = 0x48; |
kaf24@3695 | 154 stack[8] = 0x8d; |
kaf24@3695 | 155 stack[9] = 0x25; |
kaf24@3761 | 156 *(u32 *)&stack[10] = (stack_bottom - &stack[14]) - 16; |
kaf24@3695 | 157 |
kaf24@3783 | 158 /* pushq %r11 */ |
kaf24@3783 | 159 stack[14] = 0x41; |
kaf24@3783 | 160 stack[15] = 0x53; |
kaf24@3783 | 161 |
kaf24@3783 | 162 /* pushq $__GUEST_CS32 */ |
kaf24@3783 | 163 stack[16] = 0x68; |
kaf24@3783 | 164 *(u32 *)&stack[17] = __GUEST_CS32; |
kaf24@3783 | 165 |
kaf24@3761 | 166 /* jmp syscall_enter */ |
kaf24@3783 | 167 stack[21] = 0xe9; |
kaf24@3783 | 168 *(u32 *)&stack[22] = (char *)syscall_enter - &stack[26]; |
kaf24@3695 | 169 |
kaf24@3695 | 170 /* |
kaf24@3695 | 171 * Common SYSCALL parameters. |
kaf24@3695 | 172 */ |
kaf24@3695 | 173 |
kaf24@3696 | 174 wrmsr(MSR_STAR, 0, (FLAT_RING3_CS32<<16) | __HYPERVISOR_CS); |
kaf24@3822 | 175 wrmsr(MSR_SYSCALL_MASK, EF_VM|EF_RF|EF_NT|EF_DF|EF_IE|EF_TF, 0U); |
kaf24@3650 | 176 } |
kaf24@3650 | 177 |
kaf24@3780 | 178 long do_set_callbacks(unsigned long event_address, |
kaf24@3780 | 179 unsigned long failsafe_address, |
kaf24@3780 | 180 unsigned long syscall_address) |
kaf24@3780 | 181 { |
kaf24@3780 | 182 struct exec_domain *d = current; |
kaf24@3780 | 183 |
kaf24@4689 | 184 d->arch.guest_context.event_callback_eip = event_address; |
kaf24@4689 | 185 d->arch.guest_context.failsafe_callback_eip = failsafe_address; |
kaf24@4689 | 186 d->arch.guest_context.syscall_callback_eip = syscall_address; |
kaf24@3780 | 187 |
kaf24@3780 | 188 return 0; |
kaf24@3780 | 189 } |