arch/x86/boot/compressed/head_64.S

   1 /*
   2  *  linux/boot/head.S
   3  *
   4  *  Copyright (C) 1991, 1992, 1993  Linus Torvalds
   5  */
   6
   7 /*
   8  *  head.S contains the 32-bit startup code.
   9  *
  10  * NOTE!!! Startup happens at absolute address 0x00001000, which is also where
  11  * the page directory will exist. The startup code will be overwritten by
  12  * the page directory. [According to comments etc elsewhere on a compressed
  13  * kernel it will end up at 0x1000 + 1Mb I hope so as I assume this. - AC]
  14  *
  15  * Page 0 is deliberately kept safe, since System Management Mode code in
  16  * laptops may need to access the BIOS data stored there.  This is also
  17  * useful for future device drivers that either access the BIOS via VM86
  18  * mode.
  19  */
  20
  21 /*
  22  * High loaded stuff by Hans Lermen & Werner Almesberger, Feb. 1996
  23  */
  24         .code32
  25         .text
  26
  27 #include <linux/init.h>
  28 #include <linux/linkage.h>
  29 #include <asm/segment.h>
  30 #include <asm/boot.h>
  31 #include <asm/msr.h>
  32 #include <asm/processor-flags.h>
  33 #include <asm/asm-offsets.h>
  34 #include <asm/bootparam.h>
  35
  36 /*
  37  * Locally defined symbols should be marked hidden:
  38  */
  39         .hidden _bss
  40         .hidden _ebss
  41         .hidden _got
  42         .hidden _egot
  43
  44         __HEAD
  45         .code32
  46 ENTRY(startup_32)
  47         /*
  48          * 32bit entry is 0 and it is ABI so immutable!
  49          * If we come here directly from a bootloader,
  50          * kernel(text+data+bss+brk) ramdisk, zero_page, command line
  51          * all need to be under the 4G limit.
  52          */
  53         cld
  54         /*
  55          * Test KEEP_SEGMENTS flag to see if the bootloader is asking
  56          * us to not reload segments
  57          */
  58         testb $KEEP_SEGMENTS, BP_loadflags(%esi)
  59         jnz 1f
  60
  61         cli
  62         movl    $(__BOOT_DS), %eax
  63         movl    %eax, %ds
  64         movl    %eax, %es
  65         movl    %eax, %ss
  66 1:
  67
  68 /*
  69  * Calculate the delta between where we were compiled to run
  70  * at and where we were actually loaded at.  This can only be done
  71  * with a short local call on x86.  Nothing  else will tell us what
  72  * address we are running at.  The reserved chunk of the real-mode
  73  * data at 0x1e4 (defined as a scratch field) are used as the stack
  74  * for this calculation. Only 4 bytes are needed.
  75  */
  76         leal    (BP_scratch+4)(%esi), %esp
  77         call    1f
  78 1:      popl    %ebp
  79         subl    $1b, %ebp
  80
  81 /* setup a stack and make sure cpu supports long mode. */
  82         movl    $boot_stack_end, %eax
  83         addl    %ebp, %eax
  84         movl    %eax, %esp
  85
  86         call    verify_cpu
  87         testl   %eax, %eax
  88         jnz     no_longmode
  89
  90 /*
  91  * Compute the delta between where we were compiled to run at
  92  * and where the code will actually run at.
  93  *
  94  * %ebp contains the address we are loaded at by the boot loader and %ebx
  95  * contains the address where we should move the kernel image temporarily
  96  * for safe in-place decompression.
  97  */
  98
  99 #ifdef CONFIG_RELOCATABLE
 100         movl    %ebp, %ebx
 101         movl    BP_kernel_alignment(%esi), %eax
 102         decl    %eax
 103         addl    %eax, %ebx
 104         notl    %eax
 105         andl    %eax, %ebx
 106         cmpl    $LOAD_PHYSICAL_ADDR, %ebx
 107         jge     1f
 108 #endif
 109         movl    $LOAD_PHYSICAL_ADDR, %ebx
 110 1:
 111
 112         /* Target address to relocate to for decompression */
 113         movl    BP_init_size(%esi), %eax
 114         subl    $_end, %eax
 115         addl    %eax, %ebx
 116
 117 /*
 118  * Prepare for entering 64 bit mode
 119  */
 120
 121         /* Load new GDT with the 64bit segments using 32bit descriptor */
 122         leal    gdt(%ebp), %eax
 123         movl    %eax, gdt+2(%ebp)
 124         lgdt    gdt(%ebp)
 125
 126         /* Enable PAE mode */
 127         movl    %cr4, %eax
 128         orl     $X86_CR4_PAE, %eax
 129         movl    %eax, %cr4
 130
 131  /*
 132   * Build early 4G boot pagetable
 133   */
 134         /* Initialize Page tables to 0 */
 135         leal    pgtable(%ebx), %edi
 136         xorl    %eax, %eax
 137         movl    $(BOOT_INIT_PGT_SIZE/4), %ecx
 138         rep     stosl
 139
 140         /* Build Level 4 */
 141         leal    pgtable + 0(%ebx), %edi
 142         leal    0x1007 (%edi), %eax
 143         movl    %eax, 0(%edi)
 144
 145         /* Build Level 3 */
 146         leal    pgtable + 0x1000(%ebx), %edi
 147         leal    0x1007(%edi), %eax
 148         movl    $4, %ecx
 149 1:      movl    %eax, 0x00(%edi)
 150         addl    $0x00001000, %eax
 151         addl    $8, %edi
 152         decl    %ecx
 153         jnz     1b
 154
 155         /* Build Level 2 */
 156         leal    pgtable + 0x2000(%ebx), %edi
 157         movl    $0x00000183, %eax
 158         movl    $2048, %ecx
 159 1:      movl    %eax, 0(%edi)
 160         addl    $0x00200000, %eax
 161         addl    $8, %edi
 162         decl    %ecx
 163         jnz     1b
 164
 165         /* Enable the boot page tables */
 166         leal    pgtable(%ebx), %eax
 167         movl    %eax, %cr3
 168
 169         /* Enable Long mode in EFER (Extended Feature Enable Register) */
 170         movl    $MSR_EFER, %ecx
 171         rdmsr
 172         btsl    $_EFER_LME, %eax
 173         wrmsr
 174
 175         /* After gdt is loaded */
 176         xorl    %eax, %eax
 177         lldt    %ax
 178         movl    $__BOOT_TSS, %eax
 179         ltr     %ax
 180
 181         /*
 182          * Setup for the jump to 64bit mode
 183          *
 184          * When the jump is performend we will be in long mode but
 185          * in 32bit compatibility mode with EFER.LME = 1, CS.L = 0, CS.D = 1
 186          * (and in turn EFER.LMA = 1).  To jump into 64bit mode we use
 187          * the new gdt/idt that has __KERNEL_CS with CS.L = 1.
 188          * We place all of the values on our mini stack so lret can
 189          * used to perform that far jump.
 190          */
 191         pushl   $__KERNEL_CS
 192         leal    startup_64(%ebp), %eax
 193 #ifdef CONFIG_EFI_MIXED
 194         movl    efi32_config(%ebp), %ebx
 195         cmp     $0, %ebx
 196         jz      1f
 197         leal    handover_entry(%ebp), %eax
 198 1:
 199 #endif
 200         pushl   %eax
 201
 202         /* Enter paged protected Mode, activating Long Mode */
 203         movl    $(X86_CR0_PG | X86_CR0_PE), %eax /* Enable Paging and Protected mode */
 204         movl    %eax, %cr0
 205
 206         /* Jump from 32bit compatibility mode into 64bit mode. */
 207         lret
 208 ENDPROC(startup_32)
 209
 210 #ifdef CONFIG_EFI_MIXED
 211         .org 0x190
 212 ENTRY(efi32_stub_entry)
 213         add     $0x4, %esp              /* Discard return address */
 214         popl    %ecx
 215         popl    %edx
 216         popl    %esi
 217
 218         leal    (BP_scratch+4)(%esi), %esp
 219         call    1f
 220 1:      pop     %ebp
 221         subl    $1b, %ebp
 222
 223         movl    %ecx, efi32_config(%ebp)
 224         movl    %edx, efi32_config+8(%ebp)
 225         sgdtl   efi32_boot_gdt(%ebp)
 226
 227         leal    efi32_config(%ebp), %eax
 228         movl    %eax, efi_config(%ebp)
 229
 230         jmp     startup_32
 231 ENDPROC(efi32_stub_entry)
 232 #endif
 233
 234         .code64
 235         .org 0x200
 236 ENTRY(startup_64)
 237         /*
 238          * 64bit entry is 0x200 and it is ABI so immutable!
 239          * We come here either from startup_32 or directly from a
 240          * 64bit bootloader.
 241          * If we come here from a bootloader, kernel(text+data+bss+brk),
 242          * ramdisk, zero_page, command line could be above 4G.
 243          * We depend on an identity mapped page table being provided
 244          * that maps our entire kernel(text+data+bss+brk), zero page
 245          * and command line.
 246          */
 247 #ifdef CONFIG_EFI_STUB
 248         /*
 249          * The entry point for the PE/COFF executable is efi_pe_entry, so
 250          * only legacy boot loaders will execute this jmp.
 251          */
 252         jmp     preferred_addr
 253
 254 ENTRY(efi_pe_entry)
 255         movq    %rcx, efi64_config(%rip)        /* Handle */
 256         movq    %rdx, efi64_config+8(%rip) /* EFI System table pointer */
 257
 258         leaq    efi64_config(%rip), %rax
 259         movq    %rax, efi_config(%rip)
 260
 261         call    1f
 262 1:      popq    %rbp
 263         subq    $1b, %rbp
 264
 265         /*
 266          * Relocate efi_config->call().
 267          */
 268         addq    %rbp, efi64_config+32(%rip)
 269
 270         movq    %rax, %rdi
 271         call    make_boot_params
 272         cmpq    $0,%rax
 273         je      fail
 274         mov     %rax, %rsi
 275         leaq    startup_32(%rip), %rax
 276         movl    %eax, BP_code32_start(%rsi)
 277         jmp     2f              /* Skip the relocation */
 278
 279 handover_entry:
 280         call    1f
 281 1:      popq    %rbp
 282         subq    $1b, %rbp
 283
 284         /*
 285          * Relocate efi_config->call().
 286          */
 287         movq    efi_config(%rip), %rax
 288         addq    %rbp, 32(%rax)
 289 2:
 290         movq    efi_config(%rip), %rdi
 291         call    efi_main
 292         movq    %rax,%rsi
 293         cmpq    $0,%rax
 294         jne     2f
 295 fail:
 296         /* EFI init failed, so hang. */
 297         hlt
 298         jmp     fail
 299 2:
 300         movl    BP_code32_start(%esi), %eax
 301         leaq    preferred_addr(%rax), %rax
 302         jmp     *%rax
 303
 304 preferred_addr:
 305 #endif
 306
 307         /* Setup data segments. */
 308         xorl    %eax, %eax
 309         movl    %eax, %ds
 310         movl    %eax, %es
 311         movl    %eax, %ss
 312         movl    %eax, %fs
 313         movl    %eax, %gs
 314
 315         /*
 316          * Compute the decompressed kernel start address.  It is where
 317          * we were loaded at aligned to a 2M boundary. %rbp contains the
 318          * decompressed kernel start address.
 319          *
 320          * If it is a relocatable kernel then decompress and run the kernel
 321          * from load address aligned to 2MB addr, otherwise decompress and
 322          * run the kernel from LOAD_PHYSICAL_ADDR
 323          *
 324          * We cannot rely on the calculation done in 32-bit mode, since we
 325          * may have been invoked via the 64-bit entry point.
 326          */
 327
 328         /* Start with the delta to where the kernel will run at. */
 329 #ifdef CONFIG_RELOCATABLE
 330         leaq    startup_32(%rip) /* - $startup_32 */, %rbp
 331         movl    BP_kernel_alignment(%rsi), %eax
 332         decl    %eax
 333         addq    %rax, %rbp
 334         notq    %rax
 335         andq    %rax, %rbp
 336         cmpq    $LOAD_PHYSICAL_ADDR, %rbp
 337         jge     1f
 338 #endif
 339         movq    $LOAD_PHYSICAL_ADDR, %rbp
 340 1:
 341
 342         /* Target address to relocate to for decompression */
 343         movl    BP_init_size(%rsi), %ebx
 344         subl    $_end, %ebx
 345         addq    %rbp, %rbx
 346
 347         /* Set up the stack */
 348         leaq    boot_stack_end(%rbx), %rsp
 349
 350         /* Zero EFLAGS */
 351         pushq   $0
 352         popfq
 353
 354 /*
 355  * Copy the compressed kernel to the end of our buffer
 356  * where decompression in place becomes safe.
 357  */
 358         pushq   %rsi
 359         leaq    (_bss-8)(%rip), %rsi
 360         leaq    (_bss-8)(%rbx), %rdi
 361         movq    $_bss /* - $startup_32 */, %rcx
 362         shrq    $3, %rcx
 363         std
 364         rep     movsq
 365         cld
 366         popq    %rsi
 367
 368 /*
 369  * Jump to the relocated address.
 370  */
 371         leaq    relocated(%rbx), %rax
 372         jmp     *%rax
 373
 374 #ifdef CONFIG_EFI_STUB
 375         .org 0x390
 376 ENTRY(efi64_stub_entry)
 377         movq    %rdi, efi64_config(%rip)        /* Handle */
 378         movq    %rsi, efi64_config+8(%rip) /* EFI System table pointer */
 379
 380         leaq    efi64_config(%rip), %rax
 381         movq    %rax, efi_config(%rip)
 382
 383         movq    %rdx, %rsi
 384         jmp     handover_entry
 385 ENDPROC(efi64_stub_entry)
 386 #endif
 387
 388         .text
 389 relocated:
 390
 391 /*
 392  * Clear BSS (stack is currently empty)
 393  */
 394         xorl    %eax, %eax
 395         leaq    _bss(%rip), %rdi
 396         leaq    _ebss(%rip), %rcx
 397         subq    %rdi, %rcx
 398         shrq    $3, %rcx
 399         rep     stosq
 400
 401 /*
 402  * Adjust our own GOT
 403  */
 404         leaq    _got(%rip), %rdx
 405         leaq    _egot(%rip), %rcx
 406 1:
 407         cmpq    %rcx, %rdx
 408         jae     2f
 409         addq    %rbx, (%rdx)
 410         addq    $8, %rdx
 411         jmp     1b
 412 2:
 413
 414 /*
 415  * Do the extraction, and jump to the new kernel..
 416  */
 417         pushq   %rsi                    /* Save the real mode argument */
 418         movq    %rsi, %rdi              /* real mode address */
 419         leaq    boot_heap(%rip), %rsi   /* malloc area for uncompression */
 420         leaq    input_data(%rip), %rdx  /* input_data */
 421         movl    $z_input_len, %ecx      /* input_len */
 422         movq    %rbp, %r8               /* output target address */
 423         movq    $z_output_len, %r9      /* decompressed length, end of relocs */
 424         call    extract_kernel          /* returns kernel location in %rax */
 425         popq    %rsi
 426
 427 /*
 428  * Jump to the decompressed kernel.
 429  */
 430         jmp     *%rax
 431
 432         .code32
 433 no_longmode:
 434         /* This isn't an x86-64 CPU so hang */
 435 1:
 436         hlt
 437         jmp     1b
 438
 439 #include "../../kernel/verify_cpu.S"
 440
 441         .data
 442 gdt:
 443         .word   gdt_end - gdt
 444         .long   gdt
 445         .word   0
 446         .quad   0x0000000000000000      /* NULL descriptor */
 447         .quad   0x00af9a000000ffff      /* __KERNEL_CS */
 448         .quad   0x00cf92000000ffff      /* __KERNEL_DS */
 449         .quad   0x0080890000000000      /* TS descriptor */
 450         .quad   0x0000000000000000      /* TS continued */
 451 gdt_end:
 452
 453 #ifdef CONFIG_EFI_STUB
 454 efi_config:
 455         .quad   0
 456
 457 #ifdef CONFIG_EFI_MIXED
 458         .global efi32_config
 459 efi32_config:
 460         .fill   4,8,0
 461         .quad   efi64_thunk
 462         .byte   0
 463 #endif
 464
 465         .global efi64_config
 466 efi64_config:
 467         .fill   4,8,0
 468         .quad   efi_call
 469         .byte   1
 470 #endif /* CONFIG_EFI_STUB */
 471
 472 /*
 473  * Stack and heap for uncompression
 474  */
 475         .bss
 476         .balign 4
 477 boot_heap:
 478         .fill BOOT_HEAP_SIZE, 1, 0
 479 boot_stack:
 480         .fill BOOT_STACK_SIZE, 1, 0
 481 boot_stack_end:
 482
 483 /*
 484  * Space for page tables (not in .bss so not zeroed)
 485  */
 486         .section ".pgtable","a",@nobits
 487         .balign 4096
 488 pgtable:
 489         .fill BOOT_PGT_SIZE, 1, 0