Index: kernel/arch/ia32/src/boot/boot.S =================================================================== --- kernel/arch/ia32/src/boot/boot.S (revision fb45c7be00697b929cb4f8548767ae72242ce60d) +++ (revision ) @@ -1,736 +1,0 @@ -/* - * Copyright (c) 2001 Jakub Jermar - * Copyright (c) 2005 Martin Decky - * Copyright (c) 2011 Martin Sucha - * 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. - */ - -#include -#include -#include -#include -#include - -#define START_STACK (BOOT_OFFSET - BOOT_STACK_SIZE) - -.section K_TEXT_START, "ax" - -.code32 - -.macro pm_error msg - movl \msg, %esi - jmp pm_error_halt -.endm - -.macro pm_status msg -#ifdef CONFIG_EGA - pushl %esi - movl \msg, %esi - call pm_early_puts - popl %esi -#endif -.endm - -.macro pm2_status msg - pushl \msg - call early_puts -.endm - -.align 4 -.global multiboot_image_start -multiboot_header: - .long MULTIBOOT_HEADER_MAGIC - .long MULTIBOOT_HEADER_FLAGS - .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 - - /* Initialize stack pointer */ - movl $START_STACK, %esp - - /* Initialize Global Descriptor Table register */ - lgdtl bootstrap_gdtr - - /* Kernel data + stack */ - movw $GDT_SELECTOR(KDATA_DES), %cx - movw %cx, %es - movw %cx, %fs - movw %cx, %gs - movw %cx, %ds - movw %cx, %ss - - jmpl $GDT_SELECTOR(KTEXT_DES), $multiboot_meeting_point - multiboot_meeting_point: - - /* Save GRUB arguments */ - movl %eax, grub_eax - movl %ebx, grub_ebx - - pm_status $status_prot - -#include "vesa_prot.inc" - -#ifndef PROCESSOR_i486 - - pm_status $status_prot2 - - movl $(INTEL_CPUID_LEVEL), %eax - cpuid - cmp $0x0, %eax /* any function > 0? */ - jbe pse_unsupported - - movl $(INTEL_CPUID_STANDARD), %eax - cpuid - bt $(INTEL_PSE), %edx - jnc pse_unsupported - - /* Map kernel and turn paging on */ - pm_status $status_pse - call map_kernel_pse - jmp stack_init - -#endif /* PROCESSOR_i486 */ - - pse_unsupported: - - /* Map kernel and turn paging on */ - pm_status $status_non_pse - call map_kernel_non_pse - - stack_init: - - /* Create the first stack frame */ - pushl $0 - movl %esp, %ebp - - pm2_status $status_prot3 - - /* Call arch_pre_main(grub_eax, grub_ebx) */ - pushl grub_ebx - pushl grub_eax - call arch_pre_main - - pm2_status $status_main - - /* Call main_bsp() */ - call main_bsp - - /* Not reached */ - cli - hlt0: - hlt - jmp hlt0 - -/** Setup mapping for the kernel (PSE variant) - * - * Setup mapping for both the unmapped and mapped sections - * of the kernel. For simplicity, we map the entire 4G space. - * - */ -.global map_kernel_pse -map_kernel_pse: - /* Paging features */ - movl %cr4, %ecx - orl $(1 << 4), %ecx /* PSE on */ - andl $(~(1 << 5)), %ecx /* PAE off */ - movl %ecx, %cr4 - - movl $(page_directory + 0), %esi - movl $(page_directory + 2048), %edi - xorl %ecx, %ecx - xorl %ebx, %ebx - - floop_pse: - movl $((1 << 7) | (1 << 1) | (1 << 0)), %eax - orl %ebx, %eax - /* Mapping 0x00000000 + %ecx * 4M => 0x00000000 + %ecx * 4M */ - movl %eax, (%esi, %ecx, 4) - /* Mapping 0x80000000 + %ecx * 4M => 0x00000000 + %ecx * 4M */ - movl %eax, (%edi, %ecx, 4) - addl $(4 * 1024 * 1024), %ebx - - incl %ecx - cmpl $512, %ecx - jl floop_pse - - movl %esi, %cr3 - - movl %cr0, %ebx - orl $(1 << 31), %ebx /* paging on */ - movl %ebx, %cr0 - ret - -/** Setup mapping for the kernel (non-PSE variant). - * - * Setup mapping for both the unmapped and mapped sections - * of the kernel. For simplicity, we map the entire 4G space. - * - */ -map_kernel_non_pse: - /* Paging features */ - movl %cr4, %ecx - andl $(~(1 << 5)), %ecx /* PAE off */ - movl %ecx, %cr4 - - call calc_kernel_end - call find_mem_for_pt - - mov kernel_end, %esi - mov free_area, %ecx - - cmpl %esi, %ecx - jbe use_kernel_end - - mov %ecx, %esi - - /* Align address down to 4k */ - andl $(~4095), %esi - - use_kernel_end: - - /* Align address to 4k */ - addl $4095, %esi - andl $(~4095), %esi - - /* Allocate space for page tables */ - movl %esi, pt_loc - movl $ballocs, %edi - andl $0x7fffffff, %edi - - movl %esi, (%edi) - addl $4, %edi - movl $(2 * 1024 * 1024), (%edi) - - /* Fill page tables */ - xorl %ecx, %ecx - xorl %ebx, %ebx - - floop_pt: - movl $((1 << 1) | (1 << 0)), %eax - orl %ebx, %eax - movl %eax, (%esi, %ecx, 4) - addl $(4 * 1024), %ebx - - incl %ecx - cmpl $(512 * 1024), %ecx - - jl floop_pt - - /* Fill page directory */ - movl $(page_directory + 0), %esi - movl $(page_directory + 2048), %edi - xorl %ecx, %ecx - movl pt_loc, %ebx - - floop: - movl $((1 << 1) | (1 << 0)), %eax - orl %ebx, %eax - - /* Mapping 0x00000000 + %ecx * 4M => 0x00000000 + %ecx * 4M */ - movl %eax, (%esi, %ecx, 4) - - /* Mapping 0x80000000 + %ecx * 4M => 0x00000000 + %ecx * 4M */ - movl %eax, (%edi, %ecx, 4) - addl $(4 * 1024), %ebx - - incl %ecx - cmpl $512, %ecx - - jl floop - - movl %esi, %cr3 - - movl %cr0, %ebx - orl $(1 << 31), %ebx /* paging on */ - movl %ebx, %cr0 - - ret - -/** Calculate unmapped address of the end of the kernel. */ -calc_kernel_end: - movl $hardcoded_load_address, %edi - andl $0x7fffffff, %edi - movl (%edi), %esi - andl $0x7fffffff, %esi - - movl $hardcoded_ktext_size, %edi - andl $0x7fffffff, %edi - addl (%edi), %esi - andl $0x7fffffff, %esi - - movl $hardcoded_kdata_size, %edi - andl $0x7fffffff, %edi - addl (%edi), %esi - andl $0x7fffffff, %esi - movl %esi, kernel_end - - ret - -/** Find free 2M (+4k for alignment) region where to store page tables */ -find_mem_for_pt: - /* Check if multiboot info is present */ - cmpl $MULTIBOOT_LOADER_MAGIC, grub_eax - je check_multiboot_map - - ret - - check_multiboot_map: - - /* Copy address of the multiboot info to ebx */ - movl grub_ebx, %ebx - - /* Check if memory map flag is present */ - movl (%ebx), %edx - andl $(1 << 6), %edx - jnz use_multiboot_map - - ret - - use_multiboot_map: - - /* Copy address of the memory map to edx */ - movl 48(%ebx), %edx - movl %edx, %ecx - - addl 44(%ebx), %ecx - - /* Find a free region at least 2M in size */ - check_memmap_loop: - - /* Is this a free region? */ - cmp $1, 20(%edx) - jnz next_region - - /* Check size */ - cmp $0, 16(%edx) - jnz next_region - - cmpl $(2 * 1024 * 1024 + 4 * 1024), 12(%edx) - jbe next_region - - cmp $0, 8(%edx) - jz found_region - - next_region: - - cmp %ecx, %edx - jbe next_region_do - - ret - - next_region_do: - - addl (%edx), %edx - addl $4, %edx - jmp check_memmap_loop - - found_region: - - /* Use end of the found region */ - mov 4(%edx), %ecx - add 12(%edx), %ecx - sub $(2 * 1024 * 1024), %ecx - mov %ecx, free_area - - ret - -/** Print string to EGA display (in light red) and halt. - * - * Should be executed from 32 bit protected mode with paging - * turned off. Stack is not required. This routine is used even - * if CONFIG_EGA is not enabled. Since we are going to halt the - * CPU anyway, it is always better to at least try to print - * some hints. - * - * @param %esi NULL-terminated string to print. - * - */ -pm_error_halt: - movl $0xb8000, %edi /* base of EGA text mode memory */ - xorl %eax, %eax - - /* Read bits 8 - 15 of the cursor address */ - movw $0x3d4, %dx - movb $0xe, %al - outb %al, %dx - - movw $0x3d5, %dx - inb %dx, %al - shl $8, %ax - - /* Read bits 0 - 7 of the cursor address */ - movw $0x3d4, %dx - movb $0xf, %al - outb %al, %dx - - movw $0x3d5, %dx - inb %dx, %al - - /* Sanity check for the cursor on screen */ - cmp $2000, %ax - jb err_cursor_ok - - movw $1998, %ax - - err_cursor_ok: - - movw %ax, %bx - shl $1, %eax - addl %eax, %edi - - err_ploop: - lodsb - - cmp $0, %al - je err_ploop_end - - movb $0x0c, %ah /* black background, light red foreground */ - stosw - - /* Sanity check for the cursor on the last line */ - inc %bx - cmp $2000, %bx - jb err_ploop - - /* Scroll the screen (24 rows) */ - movl %esi, %edx - movl $0xb80a0, %esi - movl $0xb8000, %edi - movl $960, %ecx - rep movsl - - /* Clear the 24th row */ - xorl %eax, %eax - movl $40, %ecx - rep stosl - - /* Go to row 24 */ - movl %edx, %esi - movl $0xb8f00, %edi - movw $1920, %bx - - jmp err_ploop - err_ploop_end: - - /* Write bits 8 - 15 of the cursor address */ - movw $0x3d4, %dx - movb $0xe, %al - outb %al, %dx - - movw $0x3d5, %dx - movb %bh, %al - outb %al, %dx - - /* Write bits 0 - 7 of the cursor address */ - movw $0x3d4, %dx - movb $0xf, %al - outb %al, %dx - - movw $0x3d5, %dx - movb %bl, %al - outb %al, %dx - - cli - hlt1: - hlt - jmp hlt1 - -/** Print string to EGA display (in light green). - * - * Should be called from 32 bit protected mode with paging - * turned off. A stack space of at least 24 bytes is required, - * but the function does not establish a stack frame. - * - * Macros such as pm_status take care that this function - * is used only when CONFIG_EGA is enabled. - * - * @param %esi NULL-terminated string to print. - * - */ -pm_early_puts: - pushl %eax - pushl %ebx - pushl %ecx - pushl %edx - pushl %edi - - movl $0xb8000, %edi /* base of EGA text mode memory */ - xorl %eax, %eax - - /* Read bits 8 - 15 of the cursor address */ - movw $0x3d4, %dx - movb $0xe, %al - outb %al, %dx - - movw $0x3d5, %dx - inb %dx, %al - shl $8, %ax - - /* Read bits 0 - 7 of the cursor address */ - movw $0x3d4, %dx - movb $0xf, %al - outb %al, %dx - - movw $0x3d5, %dx - inb %dx, %al - - /* Sanity check for the cursor on screen */ - cmp $2000, %ax - jb pm_puts_cursor_ok - - movw $1998, %ax - - pm_puts_cursor_ok: - - movw %ax, %bx - shl $1, %eax - addl %eax, %edi - - pm_puts_ploop: - lodsb - - cmp $0, %al - je pm_puts_ploop_end - - movb $0x0a, %ah /* black background, light green foreground */ - stosw - - /* Sanity check for the cursor on the last line */ - inc %bx - cmp $2000, %bx - jb pm_puts_ploop - - /* Scroll the screen (24 rows) */ - movl %esi, %edx - movl $0xb80a0, %esi - movl $0xb8000, %edi - movl $960, %ecx - rep movsl - - /* Clear the 24th row */ - xorl %eax, %eax - movl $40, %ecx - rep stosl - - /* Go to row 24 */ - movl %edx, %esi - movl $0xb8f00, %edi - movw $1920, %bx - - jmp pm_puts_ploop - pm_puts_ploop_end: - - /* Write bits 8 - 15 of the cursor address */ - movw $0x3d4, %dx - movb $0xe, %al - outb %al, %dx - - movw $0x3d5, %dx - movb %bh, %al - outb %al, %dx - - /* Write bits 0 - 7 of the cursor address */ - movw $0x3d4, %dx - movb $0xf, %al - outb %al, %dx - - movw $0x3d5, %dx - movb %bl, %al - outb %al, %dx - - popl %edi - popl %edx - popl %ecx - popl %ebx - popl %eax - - ret - -/** Print string to EGA display. - * - * Should be called from 32 bit protected mode (with paging - * enabled and stack established). This function is ABI compliant. - * - * If CONFIG_EGA is undefined or CONFIG_FB is defined - * then this function does nothing. - * - * @param %ebp+0x08 NULL-terminated string to print. - * - */ -early_puts: - -#if ((defined(CONFIG_EGA)) && (!defined(CONFIG_FB))) - - /* Prologue, save preserved registers */ - pushl %ebp - movl %esp, %ebp - pushl %ebx - pushl %esi - pushl %edi - - movl 0x08(%ebp), %esi - movl $(PA2KA(0xb8000)), %edi /* base of EGA text mode memory */ - xorl %eax, %eax - - /* Read bits 8 - 15 of the cursor address */ - movw $0x3d4, %dx - movb $0xe, %al - outb %al, %dx - - movw $0x3d5, %dx - inb %dx, %al - shl $8, %ax - - /* Read bits 0 - 7 of the cursor address */ - movw $0x3d4, %dx - movb $0xf, %al - outb %al, %dx - - movw $0x3d5, %dx - inb %dx, %al - - /* Sanity check for the cursor on screen */ - cmp $2000, %ax - jb early_puts_cursor_ok - - movw $1998, %ax - - early_puts_cursor_ok: - - movw %ax, %bx - shl $1, %eax - addl %eax, %edi - - early_puts_ploop: - lodsb - - cmp $0, %al - je early_puts_ploop_end - - movb $0x0e, %ah /* black background, yellow foreground */ - stosw - - /* Sanity check for the cursor on the last line */ - inc %bx - cmp $2000, %bx - jb early_puts_ploop - - /* Scroll the screen (24 rows) */ - movl %esi, %edx - movl $(PA2KA(0xb80a0)), %esi - movl $(PA2KA(0xb8000)), %edi - movl $960, %ecx - rep movsl - - /* Clear the 24th row */ - xorl %eax, %eax - movl $40, %ecx - rep stosl - - /* Go to row 24 */ - movl %edx, %esi - movl $(PA2KA(0xb8f00)), %edi - movw $1920, %bx - - jmp early_puts_ploop - early_puts_ploop_end: - - /* Write bits 8 - 15 of the cursor address */ - movw $0x3d4, %dx - movb $0xe, %al - outb %al, %dx - - movw $0x3d5, %dx - movb %bh, %al - outb %al, %dx - - /* Write bits 0 - 7 of the cursor address */ - movw $0x3d4, %dx - movb $0xf, %al - outb %al, %dx - - movw $0x3d5, %dx - movb %bl, %al - outb %al, %dx - - /* Epilogue, restore preserved registers */ - popl %edi - popl %esi - popl %ebx - leave - -#endif - - ret - -#include "vesa_real.inc" - -.section K_DATA_START, "aw", @progbits - -.align 4096 -page_directory: - .space 4096, 0 - -bootstrap_gdtr: - .word GDT_SELECTOR(GDT_ITEMS) - .long KA2PA(gdt) - -grub_eax: - .long 0 -grub_ebx: - .long 0 - -pt_loc: - .long 0 -kernel_end: - .long 0 -free_area: - .long 0 - -status_prot: - .asciz "[prot] " -status_pse: - .asciz "[pse] " -status_non_pse: - .asciz "[non_pse] " -status_vesa_copy: - .asciz "[vesa_copy] " -status_grub_cmdline: - .asciz "[grub_cmdline] " -status_vesa_real: - .asciz "[vesa_real] " -status_prot2: - .asciz "[prot2] " -status_prot3: - .asciz "[prot3] " -status_main: - .asciz "[main] " Index: kernel/arch/ia32/src/boot/memmap.c =================================================================== --- kernel/arch/ia32/src/boot/memmap.c (revision fb45c7be00697b929cb4f8548767ae72242ce60d) +++ kernel/arch/ia32/src/boot/memmap.c (revision c62751ff3deadbe6bd0b11c9e08098340aeb042d) @@ -35,5 +35,5 @@ #include -uint8_t e820counter = 0xffU; +uint8_t e820counter = 0; e820memmap_t e820table[MEMMAP_E820_MAX_RECORDS]; Index: kernel/arch/ia32/src/boot/multiboot.S =================================================================== --- kernel/arch/ia32/src/boot/multiboot.S (revision c62751ff3deadbe6bd0b11c9e08098340aeb042d) +++ kernel/arch/ia32/src/boot/multiboot.S (revision c62751ff3deadbe6bd0b11c9e08098340aeb042d) @@ -0,0 +1,741 @@ +/* + * Copyright (c) 2001 Jakub Jermar + * Copyright (c) 2005 Martin Decky + * Copyright (c) 2011 Martin Sucha + * 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. + */ + +#include +#include +#include +#include +#include + +#define START_STACK (BOOT_OFFSET - BOOT_STACK_SIZE) + +.section K_TEXT_START, "ax" + +.code32 + +.macro pm_error msg + movl \msg, %esi + jmp pm_error_halt +.endm + +.macro pm_status msg +#ifdef CONFIG_EGA + pushl %esi + movl \msg, %esi + call pm_early_puts + popl %esi +#endif +.endm + +.macro pm2_status msg + pushl \msg + call early_puts +.endm + +.align 4 +.global multiboot_image_start +multiboot_header: + .long MULTIBOOT_HEADER_MAGIC + .long MULTIBOOT_HEADER_FLAGS + .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 + + /* Initialize stack pointer */ + movl $START_STACK, %esp + + /* Initialize Global Descriptor Table register */ + lgdtl bootstrap_gdtr + + /* Kernel data + stack */ + movw $GDT_SELECTOR(KDATA_DES), %cx + movw %cx, %es + movw %cx, %fs + movw %cx, %gs + movw %cx, %ds + movw %cx, %ss + + jmpl $GDT_SELECTOR(KTEXT_DES), $multiboot_meeting_point + multiboot_meeting_point: + + /* Save multiboot arguments */ + movl %eax, multiboot_eax + movl %ebx, multiboot_ebx + + pm_status $status_prot + +#include "vesa_prot.inc" + +#ifndef PROCESSOR_i486 + + pm_status $status_prot2 + + movl $(INTEL_CPUID_LEVEL), %eax + cpuid + cmp $0x0, %eax /* any function > 0? */ + jbe pse_unsupported + + movl $(INTEL_CPUID_STANDARD), %eax + cpuid + bt $(INTEL_PSE), %edx + jnc pse_unsupported + + /* Map kernel and turn paging on */ + pm_status $status_pse + call map_kernel_pse + jmp stack_init + +#endif /* PROCESSOR_i486 */ + + pse_unsupported: + + /* Map kernel and turn paging on */ + pm_status $status_non_pse + call map_kernel_non_pse + + stack_init: + + /* Create the first stack frame */ + pushl $0 + movl %esp, %ebp + + pm2_status $status_prot3 + + /* Call arch_pre_main(multiboot_eax, multiboot_ebx) */ + pushl multiboot_ebx + pushl multiboot_eax + call arch_pre_main + + pm2_status $status_main + + /* Call main_bsp() */ + call main_bsp + + /* Not reached */ + cli + hlt0: + hlt + jmp hlt0 + +/** Setup mapping for the kernel (PSE variant) + * + * Setup mapping for both the unmapped and mapped sections + * of the kernel. For simplicity, we map the entire 4G space. + * + */ +.global map_kernel_pse +map_kernel_pse: + /* Paging features */ + movl %cr4, %ecx + orl $(1 << 4), %ecx /* PSE on */ + andl $(~(1 << 5)), %ecx /* PAE off */ + movl %ecx, %cr4 + + movl $(page_directory + 0), %esi + movl $(page_directory + 2048), %edi + xorl %ecx, %ecx + xorl %ebx, %ebx + + floop_pse: + movl $((1 << 7) | (1 << 1) | (1 << 0)), %eax + orl %ebx, %eax + /* Mapping 0x00000000 + %ecx * 4M => 0x00000000 + %ecx * 4M */ + movl %eax, (%esi, %ecx, 4) + /* Mapping 0x80000000 + %ecx * 4M => 0x00000000 + %ecx * 4M */ + movl %eax, (%edi, %ecx, 4) + addl $(4 * 1024 * 1024), %ebx + + incl %ecx + cmpl $512, %ecx + jl floop_pse + + movl %esi, %cr3 + + movl %cr0, %ebx + orl $(1 << 31), %ebx /* paging on */ + movl %ebx, %cr0 + ret + +/** Setup mapping for the kernel (non-PSE variant). + * + * Setup mapping for both the unmapped and mapped sections + * of the kernel. For simplicity, we map the entire 4G space. + * + */ +.global map_kernel_non_pse +map_kernel_non_pse: + /* Paging features */ + movl %cr4, %ecx + andl $(~(1 << 5)), %ecx /* PAE off */ + movl %ecx, %cr4 + + call calc_kernel_end + call find_mem_for_pt + + mov kernel_end, %esi + mov free_area, %ecx + + cmpl %esi, %ecx + jbe use_kernel_end + + mov %ecx, %esi + + /* Align address down to 4k */ + andl $(~4095), %esi + + use_kernel_end: + + /* Align address to 4k */ + addl $4095, %esi + andl $(~4095), %esi + + /* Allocate space for page tables */ + movl %esi, pt_loc + movl $ballocs, %edi + andl $0x7fffffff, %edi + + movl %esi, (%edi) + addl $4, %edi + movl $(2 * 1024 * 1024), (%edi) + + /* Fill page tables */ + xorl %ecx, %ecx + xorl %ebx, %ebx + + floop_pt: + movl $((1 << 1) | (1 << 0)), %eax + orl %ebx, %eax + movl %eax, (%esi, %ecx, 4) + addl $(4 * 1024), %ebx + + incl %ecx + cmpl $(512 * 1024), %ecx + + jl floop_pt + + /* Fill page directory */ + movl $(page_directory + 0), %esi + movl $(page_directory + 2048), %edi + xorl %ecx, %ecx + movl pt_loc, %ebx + + floop: + movl $((1 << 1) | (1 << 0)), %eax + orl %ebx, %eax + + /* Mapping 0x00000000 + %ecx * 4M => 0x00000000 + %ecx * 4M */ + movl %eax, (%esi, %ecx, 4) + + /* Mapping 0x80000000 + %ecx * 4M => 0x00000000 + %ecx * 4M */ + movl %eax, (%edi, %ecx, 4) + addl $(4 * 1024), %ebx + + incl %ecx + cmpl $512, %ecx + + jl floop + + movl %esi, %cr3 + + movl %cr0, %ebx + orl $(1 << 31), %ebx /* paging on */ + movl %ebx, %cr0 + + ret + +/** Calculate unmapped address of the end of the kernel. */ +calc_kernel_end: + movl $hardcoded_load_address, %edi + andl $0x7fffffff, %edi + movl (%edi), %esi + andl $0x7fffffff, %esi + + movl $hardcoded_ktext_size, %edi + andl $0x7fffffff, %edi + addl (%edi), %esi + andl $0x7fffffff, %esi + + movl $hardcoded_kdata_size, %edi + andl $0x7fffffff, %edi + addl (%edi), %esi + andl $0x7fffffff, %esi + movl %esi, kernel_end + + ret + +/** Find free 2M (+4k for alignment) region where to store page tables */ +find_mem_for_pt: + /* Check if multiboot info is present */ + cmpl $MULTIBOOT_LOADER_MAGIC, multiboot_eax + je check_multiboot_map + + ret + + check_multiboot_map: + + /* Copy address of the multiboot info to ebx */ + movl multiboot_ebx, %ebx + + /* Check if memory map flag is present */ + movl (%ebx), %edx + andl $(1 << 6), %edx + jnz use_multiboot_map + + ret + + use_multiboot_map: + + /* Copy address of the memory map to edx */ + movl 48(%ebx), %edx + movl %edx, %ecx + + addl 44(%ebx), %ecx + + /* Find a free region at least 2M in size */ + check_memmap_loop: + + /* Is this a free region? */ + cmp $1, 20(%edx) + jnz next_region + + /* Check size */ + cmp $0, 16(%edx) + jnz next_region + + cmpl $(2 * 1024 * 1024 + 4 * 1024), 12(%edx) + jbe next_region + + cmp $0, 8(%edx) + jz found_region + + next_region: + + cmp %ecx, %edx + jbe next_region_do + + ret + + next_region_do: + + addl (%edx), %edx + addl $4, %edx + jmp check_memmap_loop + + found_region: + + /* Use end of the found region */ + mov 4(%edx), %ecx + add 12(%edx), %ecx + sub $(2 * 1024 * 1024), %ecx + mov %ecx, free_area + + ret + +/** Print string to EGA display (in light red) and halt. + * + * Should be executed from 32 bit protected mode with paging + * turned off. Stack is not required. This routine is used even + * if CONFIG_EGA is not enabled. Since we are going to halt the + * CPU anyway, it is always better to at least try to print + * some hints. + * + * @param %esi NULL-terminated string to print. + * + */ +pm_error_halt: + movl $0xb8000, %edi /* base of EGA text mode memory */ + xorl %eax, %eax + + /* Read bits 8 - 15 of the cursor address */ + movw $0x3d4, %dx + movb $0xe, %al + outb %al, %dx + + movw $0x3d5, %dx + inb %dx, %al + shl $8, %ax + + /* Read bits 0 - 7 of the cursor address */ + movw $0x3d4, %dx + movb $0xf, %al + outb %al, %dx + + movw $0x3d5, %dx + inb %dx, %al + + /* Sanity check for the cursor on screen */ + cmp $2000, %ax + jb err_cursor_ok + + movw $1998, %ax + + err_cursor_ok: + + movw %ax, %bx + shl $1, %eax + addl %eax, %edi + + err_ploop: + lodsb + + cmp $0, %al + je err_ploop_end + + movb $0x0c, %ah /* black background, light red foreground */ + stosw + + /* Sanity check for the cursor on the last line */ + inc %bx + cmp $2000, %bx + jb err_ploop + + /* Scroll the screen (24 rows) */ + movl %esi, %edx + movl $0xb80a0, %esi + movl $0xb8000, %edi + movl $960, %ecx + rep movsl + + /* Clear the 24th row */ + xorl %eax, %eax + movl $40, %ecx + rep stosl + + /* Go to row 24 */ + movl %edx, %esi + movl $0xb8f00, %edi + movw $1920, %bx + + jmp err_ploop + err_ploop_end: + + /* Write bits 8 - 15 of the cursor address */ + movw $0x3d4, %dx + movb $0xe, %al + outb %al, %dx + + movw $0x3d5, %dx + movb %bh, %al + outb %al, %dx + + /* Write bits 0 - 7 of the cursor address */ + movw $0x3d4, %dx + movb $0xf, %al + outb %al, %dx + + movw $0x3d5, %dx + movb %bl, %al + outb %al, %dx + + cli + hlt1: + hlt + jmp hlt1 + +/** Print string to EGA display (in light green). + * + * Should be called from 32 bit protected mode with paging + * turned off. A stack space of at least 24 bytes is required, + * but the function does not establish a stack frame. + * + * Macros such as pm_status take care that this function + * is used only when CONFIG_EGA is enabled. + * + * @param %esi NULL-terminated string to print. + * + */ +pm_early_puts: + pushl %eax + pushl %ebx + pushl %ecx + pushl %edx + pushl %edi + + movl $0xb8000, %edi /* base of EGA text mode memory */ + xorl %eax, %eax + + /* Read bits 8 - 15 of the cursor address */ + movw $0x3d4, %dx + movb $0xe, %al + outb %al, %dx + + movw $0x3d5, %dx + inb %dx, %al + shl $8, %ax + + /* Read bits 0 - 7 of the cursor address */ + movw $0x3d4, %dx + movb $0xf, %al + outb %al, %dx + + movw $0x3d5, %dx + inb %dx, %al + + /* Sanity check for the cursor on screen */ + cmp $2000, %ax + jb pm_puts_cursor_ok + + movw $1998, %ax + + pm_puts_cursor_ok: + + movw %ax, %bx + shl $1, %eax + addl %eax, %edi + + pm_puts_ploop: + lodsb + + cmp $0, %al + je pm_puts_ploop_end + + movb $0x0a, %ah /* black background, light green foreground */ + stosw + + /* Sanity check for the cursor on the last line */ + inc %bx + cmp $2000, %bx + jb pm_puts_ploop + + /* Scroll the screen (24 rows) */ + movl %esi, %edx + movl $0xb80a0, %esi + movl $0xb8000, %edi + movl $960, %ecx + rep movsl + + /* Clear the 24th row */ + xorl %eax, %eax + movl $40, %ecx + rep stosl + + /* Go to row 24 */ + movl %edx, %esi + movl $0xb8f00, %edi + movw $1920, %bx + + jmp pm_puts_ploop + pm_puts_ploop_end: + + /* Write bits 8 - 15 of the cursor address */ + movw $0x3d4, %dx + movb $0xe, %al + outb %al, %dx + + movw $0x3d5, %dx + movb %bh, %al + outb %al, %dx + + /* Write bits 0 - 7 of the cursor address */ + movw $0x3d4, %dx + movb $0xf, %al + outb %al, %dx + + movw $0x3d5, %dx + movb %bl, %al + outb %al, %dx + + popl %edi + popl %edx + popl %ecx + popl %ebx + popl %eax + + ret + +/** Print string to EGA display. + * + * Should be called from 32 bit protected mode (with paging + * enabled and stack established). This function is ABI compliant. + * + * If CONFIG_EGA is undefined or CONFIG_FB is defined + * then this function does nothing. + * + * @param %ebp+0x08 NULL-terminated string to print. + * + */ +early_puts: + +#if ((defined(CONFIG_EGA)) && (!defined(CONFIG_FB))) + + /* Prologue, save preserved registers */ + pushl %ebp + movl %esp, %ebp + pushl %ebx + pushl %esi + pushl %edi + + movl 0x08(%ebp), %esi + movl $(PA2KA(0xb8000)), %edi /* base of EGA text mode memory */ + xorl %eax, %eax + + /* Read bits 8 - 15 of the cursor address */ + movw $0x3d4, %dx + movb $0xe, %al + outb %al, %dx + + movw $0x3d5, %dx + inb %dx, %al + shl $8, %ax + + /* Read bits 0 - 7 of the cursor address */ + movw $0x3d4, %dx + movb $0xf, %al + outb %al, %dx + + movw $0x3d5, %dx + inb %dx, %al + + /* Sanity check for the cursor on screen */ + cmp $2000, %ax + jb early_puts_cursor_ok + + movw $1998, %ax + + early_puts_cursor_ok: + + movw %ax, %bx + shl $1, %eax + addl %eax, %edi + + early_puts_ploop: + lodsb + + cmp $0, %al + je early_puts_ploop_end + + movb $0x0e, %ah /* black background, yellow foreground */ + stosw + + /* Sanity check for the cursor on the last line */ + inc %bx + cmp $2000, %bx + jb early_puts_ploop + + /* Scroll the screen (24 rows) */ + movl %esi, %edx + movl $(PA2KA(0xb80a0)), %esi + movl $(PA2KA(0xb8000)), %edi + movl $960, %ecx + rep movsl + + /* Clear the 24th row */ + xorl %eax, %eax + movl $40, %ecx + rep stosl + + /* Go to row 24 */ + movl %edx, %esi + movl $(PA2KA(0xb8f00)), %edi + movw $1920, %bx + + jmp early_puts_ploop + early_puts_ploop_end: + + /* Write bits 8 - 15 of the cursor address */ + movw $0x3d4, %dx + movb $0xe, %al + outb %al, %dx + + movw $0x3d5, %dx + movb %bh, %al + outb %al, %dx + + /* Write bits 0 - 7 of the cursor address */ + movw $0x3d4, %dx + movb $0xf, %al + outb %al, %dx + + movw $0x3d5, %dx + movb %bl, %al + outb %al, %dx + + /* Epilogue, restore preserved registers */ + popl %edi + popl %esi + popl %ebx + leave + +#endif + + ret + +#include "vesa_real.inc" + +.section K_DATA_START, "aw", @progbits + +.align 4096 +page_directory: + .space 4096, 0 + +.global bootstrap_gdtr +bootstrap_gdtr: + .word GDT_SELECTOR(GDT_ITEMS) + .long KA2PA(gdt) + +.global multiboot_eax +multiboot_eax: + .long 0 + +.global multiboot_ebx +multiboot_ebx: + .long 0 + +pt_loc: + .long 0 +kernel_end: + .long 0 +free_area: + .long 0 + +status_prot: + .asciz "[prot] " +status_pse: + .asciz "[pse] " +status_non_pse: + .asciz "[non_pse] " +status_vesa_copy: + .asciz "[vesa_copy] " +status_multiboot_cmdline: + .asciz "[multiboot_cmdline] " +status_vesa_real: + .asciz "[vesa_real] " +status_prot2: + .asciz "[prot2] " +status_prot3: + .asciz "[prot3] " +status_main: + .asciz "[main] " Index: kernel/arch/ia32/src/boot/multiboot2.S =================================================================== --- kernel/arch/ia32/src/boot/multiboot2.S (revision c62751ff3deadbe6bd0b11c9e08098340aeb042d) +++ kernel/arch/ia32/src/boot/multiboot2.S (revision c62751ff3deadbe6bd0b11c9e08098340aeb042d) @@ -0,0 +1,176 @@ +/* + * Copyright (c) 2011 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. + */ + +#include +#include +#include +#include + +#define START_STACK (BOOT_OFFSET - BOOT_STACK_SIZE) + +.section K_TEXT_START, "ax" + +.code32 + +.align 8 +.global multiboot2_image_start +multiboot2_header_start: + .long MULTIBOOT2_HEADER_MAGIC + .long MULTIBOOT2_HEADER_ARCH_I386 + .long multiboot2_header_end - multiboot2_header_start + .long -(MULTIBOOT2_HEADER_MAGIC + MULTIBOOT2_HEADER_ARCH_I386 + (multiboot2_header_end - multiboot2_header_start)) + + /* Information request tag */ + tag_info_req_start: + .word MULTIBOOT2_TAG_INFO_REQ + .word MULTIBOOT2_FLAGS_REQUIRED + .long tag_info_req_end - tag_info_req_start + .long MULTIBOOT2_TAG_MODULE + .long MULTIBOOT2_TAG_MEMMAP + .long MULTIBOOT2_TAG_FBINFO + tag_info_req_end: + + /* Address tag */ + tag_address_start: + .word MULTIBOOT2_TAG_ADDRESS + .word MULTIBOOT2_FLAGS_REQUIRED + .long tag_address_end - tag_address_start + .long multiboot2_header_start + .long unmapped_ktext_start + .long 0 + .long 0 + tag_address_end: + + /* Entry address tag */ + tag_entry_address_start: + .word MULTIBOOT2_TAG_ENTRY_ADDRESS + .word MULTIBOOT2_FLAGS_REQUIRED + .long tag_entry_address_end - tag_entry_address_start + .long multiboot2_image_start + tag_entry_address_end: + + /* Flags tag */ + tag_flags_start: + .word MULTIBOOT2_TAG_FLAGS + .word MULTIBOOT2_FLAGS_REQUIRED + .long tag_flags_end - tag_flags_start + .long MULTIBOOT2_FLAGS_CONSOLE + tag_flags_end: + + /* Framebuffer tag */ + tag_framebuffer_start: + .word MULTIBOOT2_TAG_FRAMEBUFFER + .word MULTIBOOT2_FLAGS_REQUIRED + .long tag_framebuffer_end - tag_framebuffer_start + .long CONFIG_BFB_WIDTH + .long CONFIG_BFB_HEIGHT + .long CONFIG_BFB_BPP + tag_framebuffer_end: + + /* Module alignment tag */ + tag_module_align_start: + .word MULTIBOOT2_TAG_MODULE_ALIGN + .word MULTIBOOT2_FLAGS_REQUIRED + .long tag_module_align_end - tag_module_align_start + .long 0 + tag_module_align_end: + + /* Tag terminator */ + tag_terminator_start: + .word MULTIBOOT2_TAG_TERMINATOR + .word MULTIBOOT2_FLAGS_REQUIRED + .long tag_terminator_end - tag_terminator_start + tag_terminator_end: +multiboot2_header_end: + +multiboot2_image_start: + cld + + /* Initialize stack pointer */ + movl $START_STACK, %esp + + /* Initialize Global Descriptor Table register */ + lgdtl bootstrap_gdtr + + /* Kernel data + stack */ + movw $GDT_SELECTOR(KDATA_DES), %cx + movw %cx, %es + movw %cx, %fs + movw %cx, %gs + movw %cx, %ds + movw %cx, %ss + + jmpl $GDT_SELECTOR(KTEXT_DES), $multiboot2_meeting_point + multiboot2_meeting_point: + + /* Save multiboot arguments */ + movl %eax, multiboot_eax + movl %ebx, multiboot_ebx + +#ifndef PROCESSOR_i486 + + movl $(INTEL_CPUID_LEVEL), %eax + cpuid + cmp $0x0, %eax /* any function > 0? */ + jbe pse_unsupported + + movl $(INTEL_CPUID_STANDARD), %eax + cpuid + bt $(INTEL_PSE), %edx + jnc pse_unsupported + + /* Map kernel and turn paging on */ + call map_kernel_pse + jmp stack_init + +#endif /* PROCESSOR_i486 */ + + pse_unsupported: + + /* Map kernel and turn paging on */ + call map_kernel_non_pse + + stack_init: + + /* Create the first stack frame */ + pushl $0 + movl %esp, %ebp + + /* Call arch_pre_main(multiboot_eax, multiboot_ebx) */ + pushl multiboot_ebx + pushl multiboot_eax + call arch_pre_main + + /* Call main_bsp() */ + call main_bsp + + /* Not reached */ + cli + hlt0: + hlt + jmp hlt0 Index: kernel/arch/ia32/src/boot/vesa_prot.inc =================================================================== --- kernel/arch/ia32/src/boot/vesa_prot.inc (revision fb45c7be00697b929cb4f8548767ae72242ce60d) +++ kernel/arch/ia32/src/boot/vesa_prot.inc (revision c62751ff3deadbe6bd0b11c9e08098340aeb042d) @@ -1,5 +1,4 @@ #ifdef CONFIG_FB -#define MULTIBOOT_LOADER_MAGIC 0x2BADB002 #define MBINFO_BIT_CMDLINE 2 #define MBINFO_OFFSET_CMDLINE 16 @@ -14,13 +13,13 @@ rep movsb - /* Check for GRUB command line */ + /* Check for multiboot command line */ - pm_status $status_grub_cmdline + pm_status $status_multiboot_cmdline - mov grub_eax, %eax + mov multiboot_eax, %eax cmp $MULTIBOOT_LOADER_MAGIC, %eax jne no_cmdline - mov grub_ebx, %ebx + mov multiboot_ebx, %ebx mov (%ebx), %eax bt $MBINFO_BIT_CMDLINE, %eax @@ -89,25 +88,33 @@ /* Returned back to protected mode */ - mov %ax, KA2PA(vesa_scanline) + movzx %ax, %ecx + mov %ecx, KA2PA(bfb_scanline) + shr $16, %eax - mov %ax, KA2PA(vesa_bpp) + mov %ax, KA2PA(bfb_bpp) - mov %bx, KA2PA(vesa_height) + movzx %bx, %ecx + mov %ecx, KA2PA(bfb_height) + shr $16, %ebx - mov %bx, KA2PA(vesa_width) + mov %ebx, KA2PA(bfb_width) - mov %dl, KA2PA(vesa_green_pos) + mov %dl, KA2PA(bfb_green_pos) + shr $8, %edx - mov %dl, KA2PA(vesa_green_mask) + mov %dl, KA2PA(bfb_green_size) + shr $8, %edx - mov %dl, KA2PA(vesa_red_pos) + mov %dl, KA2PA(bfb_red_pos) + shr $8, %edx - mov %dl, KA2PA(vesa_red_mask) + mov %dl, KA2PA(bfb_red_size) mov %esi, %edx - mov %dl, KA2PA(vesa_blue_pos) + mov %dl, KA2PA(bfb_blue_pos) + shr $8, %edx - mov %dl, KA2PA(vesa_blue_mask) + mov %dl, KA2PA(bfb_blue_size) - mov %edi, KA2PA(vesa_ph_addr) + mov %edi, KA2PA(bfb_addr) #endif Index: kernel/arch/ia32/src/boot/vesa_real.inc =================================================================== --- kernel/arch/ia32/src/boot/vesa_real.inc (revision fb45c7be00697b929cb4f8548767ae72242ce60d) +++ kernel/arch/ia32/src/boot/vesa_real.inc (revision c62751ff3deadbe6bd0b11c9e08098340aeb042d) @@ -304,5 +304,5 @@ /* * Store mode parameters: - * eax = bpp[8] scanline[16] + * eax = bpp[16] scanline[16] * ebx = width[16] height[16] * edx = red_mask[8] red_pos[8] green_mask[8] green_pos[8] @@ -328,4 +328,5 @@ shl $8, %edx mov VESA_MODE_RED_POS_OFFSET(%di), %dl + shl $8, %edx mov VESA_MODE_GREEN_MASK_OFFSET(%di), %dl @@ -369,6 +370,10 @@ mov $0x0003, %ax int $0x10 + + xor %eax, %eax + xor %ebx, %ebx + xor %edx, %edx mov $0xffffffff, %edi - xor %ax, %ax + jz vesa_leave_real /* force relative jump */ @@ -386,7 +391,7 @@ default_mode: - .ascii STRING(CONFIG_VESA_MODE) + .ascii STRING(CONFIG_BFB_MODE) .ascii "-" - .asciz STRING(CONFIG_VESA_BPP) + .asciz STRING(CONFIG_BFB_BPP) .fill 24