| |
| #include "apic-defs.h" |
| |
| ipi_vector = 0x20 |
| |
| max_cpus = MAX_TEST_CPUS |
| |
| .bss |
| |
| . = . + 4096 * max_cpus |
| .align 16 |
| stacktop: |
| |
| .data |
| |
| .align 4096 |
| ptl2: |
| i = 0 |
| .rept 512 * 4 |
| .quad 0x1e7 | (i << 21) |
| i = i + 1 |
| .endr |
| |
| .align 4096 |
| ptl3: |
| .quad ptl2 + 7 + 0 * 4096 |
| .quad ptl2 + 7 + 1 * 4096 |
| .quad ptl2 + 7 + 2 * 4096 |
| .quad ptl2 + 7 + 3 * 4096 |
| |
| .align 4096 |
| ptl4: |
| .quad ptl3 + 7 |
| |
| .align 4096 |
| ptl5: |
| .quad ptl4 + 7 |
| |
| .align 4096 |
| |
| mb_boot_info: .quad 0 |
| |
| pt_root: .quad ptl4 |
| |
| #include "trampolines.S" |
| |
| .section .init |
| .code32 |
| |
| mb_magic = 0x1BADB002 |
| mb_flags = 0x0 |
| |
| # multiboot header |
| .long mb_magic, mb_flags, 0 - (mb_magic + mb_flags) |
| mb_cmdline = 16 |
| |
| .macro load_tss |
| movq %rsp, %rdi |
| call setup_tss |
| ltr %ax |
| .endm |
| |
| .globl start |
| start: |
| mov %ebx, mb_boot_info |
| mov $stacktop, %esp |
| setup_percpu_area |
| call prepare_64 |
| jmpl $8, $start64 |
| |
| switch_to_5level: |
| /* Disable CR4.PCIDE */ |
| mov %cr4, %eax |
| btr $17, %eax |
| mov %eax, %cr4 |
| |
| mov %cr0, %eax |
| btr $31, %eax |
| mov %eax, %cr0 |
| |
| mov $ptl5, %eax |
| mov %eax, pt_root |
| |
| /* Enable CR4.LA57 */ |
| mov %cr4, %eax |
| bts $12, %eax |
| mov %eax, %cr4 |
| |
| mov $0x10, %ax |
| mov %ax, %ss |
| |
| call enter_long_mode |
| jmpl $8, $lvl5 |
| |
| smp_stacktop: .long stacktop - 4096 |
| |
| .align 16 |
| |
| gdt32: |
| .quad 0 |
| .quad 0x00cf9b000000ffff // flat 32-bit code segment |
| .quad 0x00cf93000000ffff // flat 32-bit data segment |
| gdt32_end: |
| |
| .code64 |
| start64: |
| call load_idt |
| load_tss |
| call reset_apic |
| call mask_pic_interrupts |
| call enable_apic |
| call save_id |
| mov mb_boot_info(%rip), %rbx |
| mov %rbx, %rdi |
| call setup_multiboot |
| call setup_libcflat |
| mov mb_cmdline(%rbx), %eax |
| mov %rax, __args(%rip) |
| call __setup_args |
| |
| call bsp_rest_init |
| |
| mov __argc(%rip), %edi |
| lea __argv(%rip), %rsi |
| lea __environ(%rip), %rdx |
| call main |
| mov %eax, %edi |
| call exit |
| |
| .globl setup_5level_page_table |
| setup_5level_page_table: |
| /* Check if 5-level paging has already enabled */ |
| mov %cr4, %rax |
| test $0x1000, %eax |
| jnz lvl5 |
| |
| pushq $32 |
| pushq $switch_to_5level |
| lretq |
| lvl5: |
| retq |