Pileus Git - ~andy/linux/blob - arch/x86/kernel/head_64.S

   1 /*
   2  *  linux/arch/x86_64/kernel/head.S -- start in 32bit and switch to 64bit
   3  *
   4  *  Copyright (C) 2000 Andrea Arcangeli <andrea@suse.de> SuSE
   5  *  Copyright (C) 2000 Pavel Machek <pavel@suse.cz>
   6  *  Copyright (C) 2000 Karsten Keil <kkeil@suse.de>
   7  *  Copyright (C) 2001,2002 Andi Kleen <ak@suse.de>
   8  *  Copyright (C) 2005 Eric Biederman <ebiederm@xmission.com>
   9  */
  10
  11
  12 #include <linux/linkage.h>
  13 #include <linux/threads.h>
  14 #include <linux/init.h>
  15 #include <asm/segment.h>
  16 #include <asm/pgtable.h>
  17 #include <asm/page.h>
  18 #include <asm/msr.h>
  19 #include <asm/cache.h>
  20 #include <asm/processor-flags.h>
  21 #include <asm/percpu.h>
  22 #include <asm/nops.h>
  23
  24 #ifdef CONFIG_PARAVIRT
  25 #include <asm/asm-offsets.h>
  26 #include <asm/paravirt.h>
  27 #define GET_CR2_INTO(reg) GET_CR2_INTO_RAX ; movq %rax, reg
  28 #else
  29 #define GET_CR2_INTO(reg) movq %cr2, reg
  30 #define INTERRUPT_RETURN iretq
  31 #endif
  32
  33 /* we are not able to switch in one step to the final KERNEL ADDRESS SPACE
  34  * because we need identity-mapped pages.
  35  *
  36  */
  37
  38 #define pud_index(x)    (((x) >> PUD_SHIFT) & (PTRS_PER_PUD-1))
  39
  40 L4_PAGE_OFFSET = pgd_index(__PAGE_OFFSET)
  41 L3_PAGE_OFFSET = pud_index(__PAGE_OFFSET)
  42 L4_START_KERNEL = pgd_index(__START_KERNEL_map)
  43 L3_START_KERNEL = pud_index(__START_KERNEL_map)
  44
  45         .text
  46         __HEAD
  47         .code64
  48         .globl startup_64
  49 startup_64:
  50
  51         /*
  52          * At this point the CPU runs in 64bit mode CS.L = 1 CS.D = 1,
  53          * and someone has loaded an identity mapped page table
  54          * for us.  These identity mapped page tables map all of the
  55          * kernel pages and possibly all of memory.
  56          *
  57          * %esi holds a physical pointer to real_mode_data.
  58          *
  59          * We come here either directly from a 64bit bootloader, or from
  60          * arch/x86_64/boot/compressed/head.S.
  61          *
  62          * We only come here initially at boot nothing else comes here.
  63          *
  64          * Since we may be loaded at an address different from what we were
  65          * compiled to run at we first fixup the physical addresses in our page
  66          * tables and then reload them.
  67          */
  68
  69         /* Compute the delta between the address I am compiled to run at and the
  70          * address I am actually running at.
  71          */
  72         leaq    _text(%rip), %rbp
  73         subq    $_text - __START_KERNEL_map, %rbp
  74
  75         /* Is the address not 2M aligned? */
  76         movq    %rbp, %rax
  77         andl    $~PMD_PAGE_MASK, %eax
  78         testl   %eax, %eax
  79         jnz     bad_address
  80
  81         /* Is the address too large? */
  82         leaq    _text(%rip), %rdx
  83         movq    $PGDIR_SIZE, %rax
  84         cmpq    %rax, %rdx
  85         jae     bad_address
  86
  87         /* Fixup the physical addresses in the page table
  88          */
  89         addq    %rbp, init_level4_pgt + 0(%rip)
  90         addq    %rbp, init_level4_pgt + (L4_PAGE_OFFSET*8)(%rip)
  91         addq    %rbp, init_level4_pgt + (L4_START_KERNEL*8)(%rip)
  92
  93         addq    %rbp, level3_ident_pgt + 0(%rip)
  94
  95         addq    %rbp, level3_kernel_pgt + (510*8)(%rip)
  96         addq    %rbp, level3_kernel_pgt + (511*8)(%rip)
  97
  98         addq    %rbp, level2_fixmap_pgt + (506*8)(%rip)
  99
 100         /* Add an Identity mapping if I am above 1G */
 101         leaq    _text(%rip), %rdi
 102         andq    $PMD_PAGE_MASK, %rdi
 103
 104         movq    %rdi, %rax
 105         shrq    $PUD_SHIFT, %rax
 106         andq    $(PTRS_PER_PUD - 1), %rax
 107         jz      ident_complete
 108
 109         leaq    (level2_spare_pgt - __START_KERNEL_map + _KERNPG_TABLE)(%rbp), %rdx
 110         leaq    level3_ident_pgt(%rip), %rbx
 111         movq    %rdx, 0(%rbx, %rax, 8)
 112
 113         movq    %rdi, %rax
 114         shrq    $PMD_SHIFT, %rax
 115         andq    $(PTRS_PER_PMD - 1), %rax
 116         leaq    __PAGE_KERNEL_IDENT_LARGE_EXEC(%rdi), %rdx
 117         leaq    level2_spare_pgt(%rip), %rbx
 118         movq    %rdx, 0(%rbx, %rax, 8)
 119 ident_complete:
 120
 121         /*
 122          * Fixup the kernel text+data virtual addresses. Note that
 123          * we might write invalid pmds, when the kernel is relocated
 124          * cleanup_highmap() fixes this up along with the mappings
 125          * beyond _end.
 126          */
 127
 128         leaq    level2_kernel_pgt(%rip), %rdi
 129         leaq    4096(%rdi), %r8
 130         /* See if it is a valid page table entry */
 131 1:      testq   $1, 0(%rdi)
 132         jz      2f
 133         addq    %rbp, 0(%rdi)
 134         /* Go to the next page */
 135 2:      addq    $8, %rdi
 136         cmp     %r8, %rdi
 137         jne     1b
 138
 139         /* Fixup phys_base */
 140         addq    %rbp, phys_base(%rip)
 141
 142         /* Due to ENTRY(), sometimes the empty space gets filled with
 143          * zeros. Better take a jmp than relying on empty space being
 144          * filled with 0x90 (nop)
 145          */
 146         jmp secondary_startup_64
 147 ENTRY(secondary_startup_64)
 148         /*
 149          * At this point the CPU runs in 64bit mode CS.L = 1 CS.D = 1,
 150          * and someone has loaded a mapped page table.
 151          *
 152          * %esi holds a physical pointer to real_mode_data.
 153          *
 154          * We come here either from startup_64 (using physical addresses)
 155          * or from trampoline.S (using virtual addresses).
 156          *
 157          * Using virtual addresses from trampoline.S removes the need
 158          * to have any identity mapped pages in the kernel page table
 159          * after the boot processor executes this code.
 160          */
 161
 162         /* Enable PAE mode and PGE */
 163         movl    $(X86_CR4_PAE | X86_CR4_PGE), %eax
 164         movq    %rax, %cr4
 165
 166         /* Setup early boot stage 4 level pagetables. */
 167         movq    $(init_level4_pgt - __START_KERNEL_map), %rax
 168         addq    phys_base(%rip), %rax
 169         movq    %rax, %cr3
 170
 171         /* Ensure I am executing from virtual addresses */
 172         movq    $1f, %rax
 173         jmp     *%rax
 174 1:
 175
 176         /* Check if nx is implemented */
 177         movl    $0x80000001, %eax
 178         cpuid
 179         movl    %edx,%edi
 180
 181         /* Setup EFER (Extended Feature Enable Register) */
 182         movl    $MSR_EFER, %ecx
 183         rdmsr
 184         btsl    $_EFER_SCE, %eax        /* Enable System Call */
 185         btl     $20,%edi                /* No Execute supported? */
 186         jnc     1f
 187         btsl    $_EFER_NX, %eax
 188 1:      wrmsr                           /* Make changes effective */
 189
 190         /* Setup cr0 */
 191 #define CR0_STATE       (X86_CR0_PE | X86_CR0_MP | X86_CR0_ET | \
 192                          X86_CR0_NE | X86_CR0_WP | X86_CR0_AM | \
 193                          X86_CR0_PG)
 194         movl    $CR0_STATE, %eax
 195         /* Make changes effective */
 196         movq    %rax, %cr0
 197
 198         /* Setup a boot time stack */
 199         movq stack_start(%rip),%rsp
 200
 201         /* zero EFLAGS after setting rsp */
 202         pushq $0
 203         popfq
 204
 205         /*
 206          * We must switch to a new descriptor in kernel space for the GDT
 207          * because soon the kernel won't have access anymore to the userspace
 208          * addresses where we're currently running on. We have to do that here
 209          * because in 32bit we couldn't load a 64bit linear address.
 210          */
 211         lgdt    early_gdt_descr(%rip)
 212
 213         /* set up data segments */
 214         xorl %eax,%eax
 215         movl %eax,%ds
 216         movl %eax,%ss
 217         movl %eax,%es
 218
 219         /*
 220          * We don't really need to load %fs or %gs, but load them anyway
 221          * to kill any stale realmode selectors.  This allows execution
 222          * under VT hardware.
 223          */
 224         movl %eax,%fs
 225         movl %eax,%gs
 226
 227         /* Set up %gs.
 228          *
 229          * The base of %gs always points to the bottom of the irqstack
 230          * union.  If the stack protector canary is enabled, it is
 231          * located at %gs:40.  Note that, on SMP, the boot cpu uses
 232          * init data section till per cpu areas are set up.
 233          */
 234         movl    $MSR_GS_BASE,%ecx
 235         movl    initial_gs(%rip),%eax
 236         movl    initial_gs+4(%rip),%edx
 237         wrmsr
 238
 239         /* esi is pointer to real mode structure with interesting info.
 240            pass it to C */
 241         movl    %esi, %edi
 242
 243         /* Finally jump to run C code and to be on real kernel address
 244          * Since we are running on identity-mapped space we have to jump
 245          * to the full 64bit address, this is only possible as indirect
 246          * jump.  In addition we need to ensure %cs is set so we make this
 247          * a far return.
 248          */
 249         movq    initial_code(%rip),%rax
 250         pushq   $0              # fake return address to stop unwinder
 251         pushq   $__KERNEL_CS    # set correct cs
 252         pushq   %rax            # target address in negative space
 253         lretq
 254
 255         /* SMP bootup changes these two */
 256         __REFDATA
 257         .align  8
 258         ENTRY(initial_code)
 259         .quad   x86_64_start_kernel
 260         ENTRY(initial_gs)
 261         .quad   INIT_PER_CPU_VAR(irq_stack_union)
 262
 263         ENTRY(stack_start)
 264         .quad  init_thread_union+THREAD_SIZE-8
 265         .word  0
 266         __FINITDATA
 267
 268 bad_address:
 269         jmp bad_address
 270
 271         .section ".init.text","ax"
 272         .globl early_idt_handlers
 273 early_idt_handlers:
 274         # 104(%rsp) %rflags
 275         #  96(%rsp) %cs
 276         #  88(%rsp) %rip
 277         #  80(%rsp) error code
 278         i = 0
 279         .rept NUM_EXCEPTION_VECTORS
 280         .if (EXCEPTION_ERRCODE_MASK >> i) & 1
 281         ASM_NOP2
 282         .else
 283         pushq $0                # Dummy error code, to make stack frame uniform
 284         .endif
 285         pushq $i                # 72(%rsp) Vector number
 286         jmp early_idt_handler
 287         i = i + 1
 288         .endr
 289
 290 ENTRY(early_idt_handler)
 291         cld
 292
 293         cmpl $2,early_recursion_flag(%rip)
 294         jz  1f
 295         incl early_recursion_flag(%rip)
 296
 297         pushq %rax              # 64(%rsp)
 298         pushq %rcx              # 56(%rsp)
 299         pushq %rdx              # 48(%rsp)
 300         pushq %rsi              # 40(%rsp)
 301         pushq %rdi              # 32(%rsp)
 302         pushq %r8               # 24(%rsp)
 303         pushq %r9               # 16(%rsp)
 304         pushq %r10              #  8(%rsp)
 305         pushq %r11              #  0(%rsp)
 306
 307         cmpl $__KERNEL_CS,96(%rsp)
 308         jne 10f
 309
 310         leaq 88(%rsp),%rdi      # Pointer to %rip
 311         call early_fixup_exception
 312         andl %eax,%eax
 313         jnz 20f                 # Found an exception entry
 314
 315 10:
 316 #ifdef CONFIG_EARLY_PRINTK
 317         GET_CR2_INTO(%r9)       # can clobber any volatile register if pv
 318         movl 80(%rsp),%r8d      # error code
 319         movl 72(%rsp),%esi      # vector number
 320         movl 96(%rsp),%edx      # %cs
 321         movq 88(%rsp),%rcx      # %rip
 322         xorl %eax,%eax
 323         leaq early_idt_msg(%rip),%rdi
 324         call early_printk
 325         cmpl $2,early_recursion_flag(%rip)
 326         jz  1f
 327         call dump_stack
 328 #ifdef CONFIG_KALLSYMS
 329         leaq early_idt_ripmsg(%rip),%rdi
 330         movq 40(%rsp),%rsi      # %rip again
 331         call __print_symbol
 332 #endif
 333 #endif /* EARLY_PRINTK */
 334 1:      hlt
 335         jmp 1b
 336
 337 20:     # Exception table entry found
 338         popq %r11
 339         popq %r10
 340         popq %r9
 341         popq %r8
 342         popq %rdi
 343         popq %rsi
 344         popq %rdx
 345         popq %rcx
 346         popq %rax
 347         addq $16,%rsp           # drop vector number and error code
 348         decl early_recursion_flag(%rip)
 349         INTERRUPT_RETURN
 350
 351         .balign 4
 352 early_recursion_flag:
 353         .long 0
 354
 355 #ifdef CONFIG_EARLY_PRINTK
 356 early_idt_msg:
 357         .asciz "PANIC: early exception %02lx rip %lx:%lx error %lx cr2 %lx\n"
 358 early_idt_ripmsg:
 359         .asciz "RIP %s\n"
 360 #endif /* CONFIG_EARLY_PRINTK */
 361         .previous
 362
 363 #define NEXT_PAGE(name) \
 364         .balign PAGE_SIZE; \
 365 ENTRY(name)
 366
 367 /* Automate the creation of 1 to 1 mapping pmd entries */
 368 #define PMDS(START, PERM, COUNT)                        \
 369         i = 0 ;                                         \
 370         .rept (COUNT) ;                                 \
 371         .quad   (START) + (i << PMD_SHIFT) + (PERM) ;   \
 372         i = i + 1 ;                                     \
 373         .endr
 374
 375         .data
 376         /*
 377          * This default setting generates an ident mapping at address 0x100000
 378          * and a mapping for the kernel that precisely maps virtual address
 379          * 0xffffffff80000000 to physical address 0x000000. (always using
 380          * 2Mbyte large pages provided by PAE mode)
 381          */
 382 NEXT_PAGE(init_level4_pgt)
 383         .quad   level3_ident_pgt - __START_KERNEL_map + _KERNPG_TABLE
 384         .org    init_level4_pgt + L4_PAGE_OFFSET*8, 0
 385         .quad   level3_ident_pgt - __START_KERNEL_map + _KERNPG_TABLE
 386         .org    init_level4_pgt + L4_START_KERNEL*8, 0
 387         /* (2^48-(2*1024*1024*1024))/(2^39) = 511 */
 388         .quad   level3_kernel_pgt - __START_KERNEL_map + _PAGE_TABLE
 389
 390 NEXT_PAGE(level3_ident_pgt)
 391         .quad   level2_ident_pgt - __START_KERNEL_map + _KERNPG_TABLE
 392         .fill   511,8,0
 393
 394 NEXT_PAGE(level3_kernel_pgt)
 395         .fill   L3_START_KERNEL,8,0
 396         /* (2^48-(2*1024*1024*1024)-((2^39)*511))/(2^30) = 510 */
 397         .quad   level2_kernel_pgt - __START_KERNEL_map + _KERNPG_TABLE
 398         .quad   level2_fixmap_pgt - __START_KERNEL_map + _PAGE_TABLE
 399
 400 NEXT_PAGE(level2_fixmap_pgt)
 401         .fill   506,8,0
 402         .quad   level1_fixmap_pgt - __START_KERNEL_map + _PAGE_TABLE
 403         /* 8MB reserved for vsyscalls + a 2MB hole = 4 + 1 entries */
 404         .fill   5,8,0
 405
 406 NEXT_PAGE(level1_fixmap_pgt)
 407         .fill   512,8,0
 408
 409 NEXT_PAGE(level2_ident_pgt)
 410         /* Since I easily can, map the first 1G.
 411          * Don't set NX because code runs from these pages.
 412          */
 413         PMDS(0, __PAGE_KERNEL_IDENT_LARGE_EXEC, PTRS_PER_PMD)
 414
 415 NEXT_PAGE(level2_kernel_pgt)
 416         /*
 417          * 512 MB kernel mapping. We spend a full page on this pagetable
 418          * anyway.
 419          *
 420          * The kernel code+data+bss must not be bigger than that.
 421          *
 422          * (NOTE: at +512MB starts the module area, see MODULES_VADDR.
 423          *  If you want to increase this then increase MODULES_VADDR
 424          *  too.)
 425          */
 426         PMDS(0, __PAGE_KERNEL_LARGE_EXEC,
 427                 KERNEL_IMAGE_SIZE/PMD_SIZE)
 428
 429 NEXT_PAGE(level2_spare_pgt)
 430         .fill   512, 8, 0
 431
 432 #undef PMDS
 433 #undef NEXT_PAGE
 434
 435         .data
 436         .align 16
 437         .globl early_gdt_descr
 438 early_gdt_descr:
 439         .word   GDT_ENTRIES*8-1
 440 early_gdt_descr_base:
 441         .quad   INIT_PER_CPU_VAR(gdt_page)
 442
 443 ENTRY(phys_base)
 444         /* This must match the first entry in level2_kernel_pgt */
 445         .quad   0x0000000000000000
 446
 447 #include "../../x86/xen/xen-head.S"
 448
 449         .section .bss, "aw", @nobits
 450         .align L1_CACHE_BYTES
 451 ENTRY(idt_table)
 452         .skip IDT_ENTRIES * 16
 453
 454         .align L1_CACHE_BYTES
 455 ENTRY(nmi_idt_table)
 456         .skip IDT_ENTRIES * 16
 457
 458         __PAGE_ALIGNED_BSS
 459         .align PAGE_SIZE
 460 ENTRY(empty_zero_page)
 461         .skip PAGE_SIZE