WebSVN – HelenOS-historic – Diff – /kernel/trunk/arch/amd64/src/boot/boot.S


#
# Copyright (C) 2005 Ondrej Palkovsky
# Copyright (C) 2006 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 <arch/boot/boot.h>
#include <arch/boot/memmap.h>
#include <arch/mm/page.h>	
#include <arch/mm/ptl.h>
#include <arch/pm.h>
#include <arch/cpu.h>
#include <arch/cpuid.h>
 
#define START_STACK	(BOOT_OFFSET - BOOT_STACK_SIZE)
	
.section K_TEXT_START, "ax"
 
.code32
.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:
	movl $START_STACK, %esp			# initialize stack pointer
	lgdt bootstrap_gdtr				# initialize Global Descriptor Table register
 
	movw $gdtselector(KDATA_DES), %cx
	movw %cx, %es
	movw %cx, %ds							# kernel data + stack
	movw %cx, %ss
	# Simics seems to remove hidden part of GS on entering user mode
	#  when _visible_ part of GS does not point to user-mode segment
	movw $gdtselector(UDATA_DES), %cx
	movw %cx, %fs
	movw %cx, %gs
	
	jmpl $gdtselector(KTEXT32_DES), $multiboot_meeting_point
	multiboot_meeting_point:
	
	movl %eax, grub_eax							# save parameters from GRUB
	movl %ebx, grub_ebx
	
	# Protected 32-bit. We want to reuse the code-seg descriptor,
	# the Default operand size must not be 1 when entering long mode
	
	movl $0x80000000, %eax  
 	cpuid
 	cmp $0x80000000, %eax						# any function > 80000000h?
	jbe long_mode_unsupported
	movl $(AMD_CPUID_EXTENDED), %eax			# Extended function code 80000001
	cpuid
	bt $29, %edx								# Test if long mode is supported.
 	jc long_mode_supported
 
	long_mode_unsupported:
		cli
		hlt
	
	long_mode_supported:
	
	# Enable 64-bit page transaltion entries - CR4.PAE = 1.
	# Paging is not enabled until after long mode is enabled
	
	movl %cr4, %eax
	btsl $5, %eax
	movl %eax, %cr4
 
	# Set up paging tables
	
	leal ptl_0, %eax
	movl %eax, %cr3
	
	# Enable long mode
	
	movl $EFER_MSR_NUM, %ecx	# EFER MSR number
	rdmsr						# Read EFER
	btsl $AMD_LME_FLAG, %eax	# Set LME=1
	wrmsr						# Write EFER
	
	# Enable paging to activate long mode (set CR0.PG=1)
	
	movl %cr0, %eax
	btsl $31, %eax
	movl %eax, %cr0
	
	# At this point we are in compatibility mode
	
	jmpl $gdtselector(KTEXT_DES), $start64
 
.code64
start64:
	movq $(PA2KA(START_STACK)), %rsp
	movl grub_eax, %eax
	movl grub_ebx, %ebx
	
	cmpl $MULTIBOOT_LOADER_MAGIC, %eax				# compare GRUB signature
	je valid_boot
		
		xorl %ecx, %ecx							# no memory size or map available
		movl %ecx, e801memorysize
		movl %ecx, e820counter
		
		jmp invalid_boot
		
	valid_boot:
		
		movl (%ebx), %eax						# ebx = physical address of struct multiboot_info
		
		bt $0, %eax								# mbi->flags[0] (mem_lower, mem_upper valid)
		jc mem_valid
			
			xorl %ecx, %ecx
			jmp mem_invalid
			
		mem_valid:
		movl 4(%ebx), %ecx						# mbi->mem_lower
		addl 8(%ebx), %ecx						# mbi->mem_upper
		
		mem_invalid:
		movl %ecx, e801memorysize
		
		bt $3, %eax								# mbi->flags[3] (mods_count, mods_addr valid)	
		jc mods_valid
			
			xorl %ecx, %ecx
			xorl %edx, %edx
			jmp mods_invalid
		
		mods_valid:
		movl 20(%ebx), %ecx						# mbi->mods_count
		cmpl $0, %ecx
		je mods_invalid
		
		xorq %rdx, %rdx
		movq %rdx, %rcx
		movl 24(%ebx), %esi						# mbi->mods_addr
		movl 0(%esi), %edx						# mods->mod_start
		movl 4(%esi), %ecx						# mods->mod_end
		subl %edx, %ecx
		addq $0xffffffff80000000, %rdx
		
		mods_invalid:
		movq %rcx, init_size
		movq %rdx, init_addr
		
		bt $6, %eax								# mbi->flags[6] (mmap_length, mmap_addr valid)	
		jc mmap_valid
			
			xorl %edx, %edx
			jmp mmap_invalid
			
		mmap_valid:
		movl 44(%ebx), %ecx						# mbi->mmap_length
		movl 48(%ebx), %esi						# mbi->mmap_addr
		movq $e820table, %rdi
		xorl %edx, %edx
		
		mmap_loop:
			cmpl $0, %ecx
			jle mmap_end
			
			movl 4(%esi), %eax					# mmap->base_addr_low
			movl %eax, (%rdi)
			
			movl 8(%esi), %eax					# mmap->base_addr_high
			movl %eax, 4(%rdi)
			
			movl 12(%esi), %eax					# mmap->length_low
			movl %eax, 8(%rdi)
			
			movl 16(%esi), %eax					# mmap->length_high
			movl %eax, 12(%rdi)
			
			movl 20(%esi), %eax					# mmap->type
			movl %eax, 16(%rdi)
			
			movl (%esi), %eax					# mmap->size
			addl $0x4, %eax
			addl %eax, %esi
			subl %eax, %ecx
			addq $MEMMAP_E820_RECORD_SIZE, %rdi
			incl %edx
			jmp mmap_loop
		
		mmap_end:
		
		mmap_invalid:
		movl %edx, e820counter
		
	invalid_boot:
	
#ifdef CONFIG_SMP
	
	# copy AP bootstrap routines below 1 MB
	
	movq $BOOT_OFFSET, %rsi
	movq $AP_BOOT_OFFSET, %rdi
	movq $_hardcoded_unmapped_size, %rcx
	cld
	rep movsb
	
#endif
	
	call main_bsp   # never returns
	
	cli
	hlt
				
.section K_DATA_START, "aw", @progbits
.align 4096
 
# Identical mapping of first 64MB and the same of -2GB -> 0	
.global ptl_2
ptl_2:	
	.quad 0x0 | (PTL_WRITABLE | PTL_PRESENT | PTL_2MB_PAGE)
	.quad 0x200000 | (PTL_WRITABLE | PTL_PRESENT | PTL_2MB_PAGE)
	.quad 0x400000 | (PTL_WRITABLE | PTL_PRESENT | PTL_2MB_PAGE)
	.quad 0x600000 | (PTL_WRITABLE | PTL_PRESENT | PTL_2MB_PAGE)
	.quad 0x800000 | (PTL_WRITABLE | PTL_PRESENT | PTL_2MB_PAGE)
	.quad 0xa00000 | (PTL_WRITABLE | PTL_PRESENT | PTL_2MB_PAGE)
	.quad 0xc00000 | (PTL_WRITABLE | PTL_PRESENT | PTL_2MB_PAGE)
	.quad 0xe00000 | (PTL_WRITABLE | PTL_PRESENT | PTL_2MB_PAGE)
	.quad 0x1000000 | (PTL_WRITABLE | PTL_PRESENT | PTL_2MB_PAGE)
	.quad 0x1200000 | (PTL_WRITABLE | PTL_PRESENT | PTL_2MB_PAGE)
	.quad 0x1400000 | (PTL_WRITABLE | PTL_PRESENT | PTL_2MB_PAGE)
	.quad 0x1600000 | (PTL_WRITABLE | PTL_PRESENT | PTL_2MB_PAGE)
	.quad 0x1800000 | (PTL_WRITABLE | PTL_PRESENT | PTL_2MB_PAGE)
	.quad 0x1a00000 | (PTL_WRITABLE | PTL_PRESENT | PTL_2MB_PAGE)
	.quad 0x1c00000 | (PTL_WRITABLE | PTL_PRESENT | PTL_2MB_PAGE)
	.quad 0x1e00000 | (PTL_WRITABLE | PTL_PRESENT | PTL_2MB_PAGE)
	.quad 0x2000000 | (PTL_WRITABLE | PTL_PRESENT | PTL_2MB_PAGE)
	.quad 0x2200000 | (PTL_WRITABLE | PTL_PRESENT | PTL_2MB_PAGE)
	.quad 0x2400000 | (PTL_WRITABLE | PTL_PRESENT | PTL_2MB_PAGE)
	.quad 0x2600000 | (PTL_WRITABLE | PTL_PRESENT | PTL_2MB_PAGE)
	.quad 0x2800000 | (PTL_WRITABLE | PTL_PRESENT | PTL_2MB_PAGE)
	.quad 0x2a00000 | (PTL_WRITABLE | PTL_PRESENT | PTL_2MB_PAGE)
	.quad 0x2c00000 | (PTL_WRITABLE | PTL_PRESENT | PTL_2MB_PAGE)
	.quad 0x2e00000 | (PTL_WRITABLE | PTL_PRESENT | PTL_2MB_PAGE)
	.quad 0x3000000 | (PTL_WRITABLE | PTL_PRESENT | PTL_2MB_PAGE)
	.quad 0x3200000 | (PTL_WRITABLE | PTL_PRESENT | PTL_2MB_PAGE)
	.quad 0x3400000 | (PTL_WRITABLE | PTL_PRESENT | PTL_2MB_PAGE)
	.quad 0x3600000 | (PTL_WRITABLE | PTL_PRESENT | PTL_2MB_PAGE)
	.quad 0x3800000 | (PTL_WRITABLE | PTL_PRESENT | PTL_2MB_PAGE)
	.quad 0x3a00000 | (PTL_WRITABLE | PTL_PRESENT | PTL_2MB_PAGE)
	.quad 0x3c00000 | (PTL_WRITABLE | PTL_PRESENT | PTL_2MB_PAGE)
	.quad 0x3e00000 | (PTL_WRITABLE | PTL_PRESENT | PTL_2MB_PAGE)
	
.align 4096
.global ptl_1
ptl_1:
	.quad ptl_2 + (PTL_WRITABLE | PTL_PRESENT)
	.fill 509,8,0
	.quad ptl_2 + (PTL_WRITABLE | PTL_PRESENT)
	.fill 1,8,0
	
.align 4096
.global ptl_0
ptl_0:
	.quad ptl_1 + (PTL_WRITABLE | PTL_PRESENT)
	.fill 510,8,0
	.quad ptl_1 + (PTL_WRITABLE | PTL_PRESENT)
 
.global bootstrap_gdtr
bootstrap_gdtr:
	.word gdtselector(GDT_ITEMS)
	.long KA2PA(gdt)
 
grub_eax:
	.long 0
 
grub_ebx:
	.long 0
 

Rev 807	Rev 820
1	#	1	#
2	# Copyright (C) 2005 Ondrej Palkovsky	2	# Copyright (C) 2005 Ondrej Palkovsky
3	# Copyright (C) 2006 Martin Decky	3	# Copyright (C) 2006 Martin Decky
4	# All rights reserved.	4	# All rights reserved.
5	#	5	#
6	# Redistribution and use in source and binary forms, with or without	6	# Redistribution and use in source and binary forms, with or without
7	# modification, are permitted provided that the following conditions	7	# modification, are permitted provided that the following conditions
8	# are met:	8	# are met:
9	#	9	#
10	# - Redistributions of source code must retain the above copyright	10	# - Redistributions of source code must retain the above copyright
11	# notice, this list of conditions and the following disclaimer.	11	# notice, this list of conditions and the following disclaimer.
12	# - Redistributions in binary form must reproduce the above copyright	12	# - Redistributions in binary form must reproduce the above copyright
13	# notice, this list of conditions and the following disclaimer in the	13	# notice, this list of conditions and the following disclaimer in the
14	# documentation and/or other materials provided with the distribution.	14	# documentation and/or other materials provided with the distribution.
15	# - The name of the author may not be used to endorse or promote products	15	# - The name of the author may not be used to endorse or promote products
16	# derived from this software without specific prior written permission.	16	# derived from this software without specific prior written permission.
17	#	17	#
18	# THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR	18	# THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
19	# IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES	19	# IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
20	# OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.	20	# OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
21	# IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,	21	# IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
22	# INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT	22	# INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
23	# NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,	23	# NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
24	# DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY	24	# DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
25	# THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT	25	# THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
26	# (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF	26	# (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
27	# THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.	27	# THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
28	#	28	#
29		29
30	#include <arch/boot/boot.h>	30	#include <arch/boot/boot.h>
31	#include <arch/boot/memmap.h>	31	#include <arch/boot/memmap.h>
32	#include <arch/mm/page.h>	32	#include <arch/mm/page.h>
33	#include <arch/mm/ptl.h>	33	#include <arch/mm/ptl.h>
34	#include <arch/pm.h>	34	#include <arch/pm.h>
35	#include <arch/cpu.h>	35	#include <arch/cpu.h>
36	#include <arch/cpuid.h>	36	#include <arch/cpuid.h>
37		37
38	#define START_STACK (BOOT_OFFSET - BOOT_STACK_SIZE)	38	#define START_STACK (BOOT_OFFSET - BOOT_STACK_SIZE)
39		39
40	.section K_TEXT_START, "ax"	40	.section K_TEXT_START, "ax"
41		41
42	.code32	42	.code32
43	.align 4	43	.align 4
44	.global multiboot_image_start	44	.global multiboot_image_start
45	multiboot_header:	45	multiboot_header:
46	.long MULTIBOOT_HEADER_MAGIC	46	.long MULTIBOOT_HEADER_MAGIC
47	.long MULTIBOOT_HEADER_FLAGS	47	.long MULTIBOOT_HEADER_FLAGS
48	.long -(MULTIBOOT_HEADER_MAGIC + MULTIBOOT_HEADER_FLAGS) # checksum	48	.long -(MULTIBOOT_HEADER_MAGIC + MULTIBOOT_HEADER_FLAGS) # checksum
49	.long multiboot_header	49	.long multiboot_header
50	.long unmapped_ktext_start	50	.long unmapped_ktext_start
51	.long 0	51	.long 0
52	.long 0	52	.long 0
53	.long multiboot_image_start	53	.long multiboot_image_start
54		54
55	multiboot_image_start:	55	multiboot_image_start:
56	movl $START_STACK, %esp # initialize stack pointer	56	movl $START_STACK, %esp # initialize stack pointer
57	lgdt bootstrap_gdtr # initialize Global Descriptor Table register	57	lgdt bootstrap_gdtr # initialize Global Descriptor Table register
58		58
59	movw $gdtselector(KDATA_DES), %cx	59	movw $gdtselector(KDATA_DES), %cx
60	movw %cx, %es	60	movw %cx, %es
61	movw %cx, %ds # kernel data + stack	61	movw %cx, %ds # kernel data + stack
62	movw %cx, %ss	62	movw %cx, %ss
63	# Simics seems to remove hidden part of GS on entering user mode	63	# Simics seems to remove hidden part of GS on entering user mode
64	# when _visible_ part of GS does not point to user-mode segment	64	# when _visible_ part of GS does not point to user-mode segment
65	movw $gdtselector(UDATA_DES), %cx	65	movw $gdtselector(UDATA_DES), %cx
66	movw %cx, %fs	66	movw %cx, %fs
67	movw %cx, %gs	67	movw %cx, %gs
68		68
69	jmpl $gdtselector(KTEXT32_DES), $multiboot_meeting_point	69	jmpl $gdtselector(KTEXT32_DES), $multiboot_meeting_point
70	multiboot_meeting_point:	70	multiboot_meeting_point:
71		71
72	movl %eax, grub_eax # save parameters from GRUB	72	movl %eax, grub_eax # save parameters from GRUB
73	movl %ebx, grub_ebx	73	movl %ebx, grub_ebx
74		74
75	# Protected 32-bit. We want to reuse the code-seg descriptor,	75	# Protected 32-bit. We want to reuse the code-seg descriptor,
76	# the Default operand size must not be 1 when entering long mode	76	# the Default operand size must not be 1 when entering long mode
77		77
78	movl $0x80000000, %eax	78	movl $0x80000000, %eax
79	cpuid	79	cpuid
80	cmp $0x80000000, %eax # any function > 80000000h?	80	cmp $0x80000000, %eax # any function > 80000000h?
81	jbe long_mode_unsupported	81	jbe long_mode_unsupported
82	movl $(AMD_CPUID_EXTENDED), %eax # Extended function code 80000001	82	movl $(AMD_CPUID_EXTENDED), %eax # Extended function code 80000001
83	cpuid	83	cpuid
84	bt $29, %edx # Test if long mode is supported.	84	bt $29, %edx # Test if long mode is supported.
85	jc long_mode_supported	85	jc long_mode_supported
86		86
87	long_mode_unsupported:	87	long_mode_unsupported:
88	cli	88	cli
89	hlt	89	hlt
90		90
91	long_mode_supported:	91	long_mode_supported:
92		92
93	# Enable 64-bit page transaltion entries - CR4.PAE = 1.	93	# Enable 64-bit page transaltion entries - CR4.PAE = 1.
94	# Paging is not enabled until after long mode is enabled	94	# Paging is not enabled until after long mode is enabled
95		95
96	movl %cr4, %eax	96	movl %cr4, %eax
97	btsl $5, %eax	97	btsl $5, %eax
98	movl %eax, %cr4	98	movl %eax, %cr4
99		99
100	# Set up paging tables	100	# Set up paging tables
101		101
102	leal ptl_0, %eax	102	leal ptl_0, %eax
103	movl %eax, %cr3	103	movl %eax, %cr3
104		104
105	# Enable long mode	105	# Enable long mode
106		106
107	movl $EFER_MSR_NUM, %ecx # EFER MSR number	107	movl $EFER_MSR_NUM, %ecx # EFER MSR number
108	rdmsr # Read EFER	108	rdmsr # Read EFER
109	btsl $AMD_LME_FLAG, %eax # Set LME=1	109	btsl $AMD_LME_FLAG, %eax # Set LME=1
110	wrmsr # Write EFER	110	wrmsr # Write EFER
111		111
112	# Enable paging to activate long mode (set CR0.PG=1)	112	# Enable paging to activate long mode (set CR0.PG=1)
113		113
114	movl %cr0, %eax	114	movl %cr0, %eax
115	btsl $31, %eax	115	btsl $31, %eax
116	movl %eax, %cr0	116	movl %eax, %cr0
117		117
118	# At this point we are in compatibility mode	118	# At this point we are in compatibility mode
119		119
120	jmpl $gdtselector(KTEXT_DES), $start64	120	jmpl $gdtselector(KTEXT_DES), $start64
121		121
122	.code64	122	.code64
123	start64:	123	start64:
124	movq $(PA2KA(START_STACK)), %rsp	124	movq $(PA2KA(START_STACK)), %rsp
125	movl grub_eax, %eax	125	movl grub_eax, %eax
126	movl grub_ebx, %ebx	126	movl grub_ebx, %ebx
127		127
128	cmpl $MULTIBOOT_LOADER_MAGIC, %eax # compare GRUB signature	128	cmpl $MULTIBOOT_LOADER_MAGIC, %eax # compare GRUB signature
129	je valid_boot	129	je valid_boot
130		130
131	xorl %ecx, %ecx # no memory size or map available	131	xorl %ecx, %ecx # no memory size or map available
132	movl %ecx, e801memorysize	132	movl %ecx, e801memorysize
133	movl %ecx, e820counter	133	movl %ecx, e820counter
134		134
135	jmp invalid_boot	135	jmp invalid_boot
136		136
137	valid_boot:	137	valid_boot:
138		138
139	movl (%ebx), %eax # ebx = physical address of struct multiboot_info	139	movl (%ebx), %eax # ebx = physical address of struct multiboot_info
140		140
141	bt $0, %eax # mbi->flags[0] (mem_lower, mem_upper valid)	141	bt $0, %eax # mbi->flags[0] (mem_lower, mem_upper valid)
142	jc mem_valid	142	jc mem_valid
143		143
144	xorl %ecx, %ecx	144	xorl %ecx, %ecx
145	jmp mem_invalid	145	jmp mem_invalid
146		146
147	mem_valid:	147	mem_valid:
148	movl 4(%ebx), %ecx # mbi->mem_lower	148	movl 4(%ebx), %ecx # mbi->mem_lower
149	addl 8(%ebx), %ecx # mbi->mem_upper	149	addl 8(%ebx), %ecx # mbi->mem_upper
150		150
151	mem_invalid:	151	mem_invalid:
152	movl %ecx, e801memorysize	152	movl %ecx, e801memorysize
153		153
154	bt $3, %eax # mbi->flags[3] (mods_count, mods_addr valid)	154	bt $3, %eax # mbi->flags[3] (mods_count, mods_addr valid)
155	jc mods_valid	155	jc mods_valid
156		156
157	xorl %ecx, %ecx	157	xorl %ecx, %ecx
158	xorl %edx, %edx	158	xorl %edx, %edx
159	jmp mods_invalid	159	jmp mods_invalid
160		160
161	mods_valid:	161	mods_valid:
162	movl 20(%ebx), %ecx # mbi->mods_count	162	movl 20(%ebx), %ecx # mbi->mods_count
163	cmpl $0, %ecx	163	cmpl $0, %ecx
164	je mods_invalid	164	je mods_invalid
165		165
166	xorq %rdx, %rdx	166	xorq %rdx, %rdx
-		167	movq %rdx, %rcx
167	movl 24(%ebx), %esi # mbi->mods_addr	168	movl 24(%ebx), %esi # mbi->mods_addr
168	movl 0(%esi), %edx # mods->mod_start	169	movl 0(%esi), %edx # mods->mod_start
169	movl 4(%esi), %ecx # mods->mod_end	170	movl 4(%esi), %ecx # mods->mod_end
170	subl %edx, %ecx	171	subl %edx, %ecx
171	addq $0xffffffff80000000, %rdx	172	addq $0xffffffff80000000, %rdx
172		173
173	mods_invalid:	174	mods_invalid:
174	movl %ecx, init_size	175	movq %rcx, init_size
175	movq %rdx, init_addr	176	movq %rdx, init_addr
176		177
177	bt $6, %eax # mbi->flags[6] (mmap_length, mmap_addr valid)	178	bt $6, %eax # mbi->flags[6] (mmap_length, mmap_addr valid)
178	jc mmap_valid	179	jc mmap_valid
179		180
180	xorl %edx, %edx	181	xorl %edx, %edx
181	jmp mmap_invalid	182	jmp mmap_invalid
182		183
183	mmap_valid:	184	mmap_valid:
184	movl 44(%ebx), %ecx # mbi->mmap_length	185	movl 44(%ebx), %ecx # mbi->mmap_length
185	movl 48(%ebx), %esi # mbi->mmap_addr	186	movl 48(%ebx), %esi # mbi->mmap_addr
186	movq $e820table, %rdi	187	movq $e820table, %rdi
187	xorl %edx, %edx	188	xorl %edx, %edx
188		189
189	mmap_loop:	190	mmap_loop:
190	cmpl $0, %ecx	191	cmpl $0, %ecx
191	jle mmap_end	192	jle mmap_end
192		193
193	movl 4(%esi), %eax # mmap->base_addr_low	194	movl 4(%esi), %eax # mmap->base_addr_low
194	movl %eax, (%rdi)	195	movl %eax, (%rdi)
195		196
196	movl 8(%esi), %eax # mmap->base_addr_high	197	movl 8(%esi), %eax # mmap->base_addr_high
197	movl %eax, 4(%rdi)	198	movl %eax, 4(%rdi)
198		199
199	movl 12(%esi), %eax # mmap->length_low	200	movl 12(%esi), %eax # mmap->length_low
200	movl %eax, 8(%rdi)	201	movl %eax, 8(%rdi)
201		202
202	movl 16(%esi), %eax # mmap->length_high	203	movl 16(%esi), %eax # mmap->length_high
203	movl %eax, 12(%rdi)	204	movl %eax, 12(%rdi)
204		205
205	movl 20(%esi), %eax # mmap->type	206	movl 20(%esi), %eax # mmap->type
206	movl %eax, 16(%rdi)	207	movl %eax, 16(%rdi)
207		208
208	movl (%esi), %eax # mmap->size	209	movl (%esi), %eax # mmap->size
209	addl $0x4, %eax	210	addl $0x4, %eax
210	addl %eax, %esi	211	addl %eax, %esi
211	subl %eax, %ecx	212	subl %eax, %ecx
212	addq $MEMMAP_E820_RECORD_SIZE, %rdi	213	addq $MEMMAP_E820_RECORD_SIZE, %rdi
213	incl %edx	214	incl %edx
214	jmp mmap_loop	215	jmp mmap_loop
215		216
216	mmap_end:	217	mmap_end:
217		218
218	mmap_invalid:	219	mmap_invalid:
219	movl %edx, e820counter	220	movl %edx, e820counter
220		221
221	invalid_boot:	222	invalid_boot:
222		223
223	#ifdef CONFIG_SMP	224	#ifdef CONFIG_SMP
224		225
225	# copy AP bootstrap routines below 1 MB	226	# copy AP bootstrap routines below 1 MB
226		227
227	movq $BOOT_OFFSET, %rsi	228	movq $BOOT_OFFSET, %rsi
228	movq $AP_BOOT_OFFSET, %rdi	229	movq $AP_BOOT_OFFSET, %rdi
229	movq $_hardcoded_unmapped_size, %rcx	230	movq $_hardcoded_unmapped_size, %rcx
230	cld	231	cld
231	rep movsb	232	rep movsb
232		233
233	#endif	234	#endif
234		235
235	call main_bsp # never returns	236	call main_bsp # never returns
236		237
237	cli	238	cli
238	hlt	239	hlt
239		240
240	.section K_DATA_START, "aw", @progbits	241	.section K_DATA_START, "aw", @progbits
241	.align 4096	242	.align 4096
242		243
243	# Identical mapping of first 64MB and the same of -2GB -> 0	244	# Identical mapping of first 64MB and the same of -2GB -> 0
244	.global ptl_2	245	.global ptl_2
245	ptl_2:	246	ptl_2:
246	.quad 0x0 \| (PTL_WRITABLE \| PTL_PRESENT \| PTL_2MB_PAGE)	247	.quad 0x0 \| (PTL_WRITABLE \| PTL_PRESENT \| PTL_2MB_PAGE)
247	.quad 0x200000 \| (PTL_WRITABLE \| PTL_PRESENT \| PTL_2MB_PAGE)	248	.quad 0x200000 \| (PTL_WRITABLE \| PTL_PRESENT \| PTL_2MB_PAGE)
248	.quad 0x400000 \| (PTL_WRITABLE \| PTL_PRESENT \| PTL_2MB_PAGE)	249	.quad 0x400000 \| (PTL_WRITABLE \| PTL_PRESENT \| PTL_2MB_PAGE)
249	.quad 0x600000 \| (PTL_WRITABLE \| PTL_PRESENT \| PTL_2MB_PAGE)	250	.quad 0x600000 \| (PTL_WRITABLE \| PTL_PRESENT \| PTL_2MB_PAGE)
250	.quad 0x800000 \| (PTL_WRITABLE \| PTL_PRESENT \| PTL_2MB_PAGE)	251	.quad 0x800000 \| (PTL_WRITABLE \| PTL_PRESENT \| PTL_2MB_PAGE)
251	.quad 0xa00000 \| (PTL_WRITABLE \| PTL_PRESENT \| PTL_2MB_PAGE)	252	.quad 0xa00000 \| (PTL_WRITABLE \| PTL_PRESENT \| PTL_2MB_PAGE)
252	.quad 0xc00000 \| (PTL_WRITABLE \| PTL_PRESENT \| PTL_2MB_PAGE)	253	.quad 0xc00000 \| (PTL_WRITABLE \| PTL_PRESENT \| PTL_2MB_PAGE)
253	.quad 0xe00000 \| (PTL_WRITABLE \| PTL_PRESENT \| PTL_2MB_PAGE)	254	.quad 0xe00000 \| (PTL_WRITABLE \| PTL_PRESENT \| PTL_2MB_PAGE)
254	.quad 0x1000000 \| (PTL_WRITABLE \| PTL_PRESENT \| PTL_2MB_PAGE)	255	.quad 0x1000000 \| (PTL_WRITABLE \| PTL_PRESENT \| PTL_2MB_PAGE)
255	.quad 0x1200000 \| (PTL_WRITABLE \| PTL_PRESENT \| PTL_2MB_PAGE)	256	.quad 0x1200000 \| (PTL_WRITABLE \| PTL_PRESENT \| PTL_2MB_PAGE)
256	.quad 0x1400000 \| (PTL_WRITABLE \| PTL_PRESENT \| PTL_2MB_PAGE)	257	.quad 0x1400000 \| (PTL_WRITABLE \| PTL_PRESENT \| PTL_2MB_PAGE)
257	.quad 0x1600000 \| (PTL_WRITABLE \| PTL_PRESENT \| PTL_2MB_PAGE)	258	.quad 0x1600000 \| (PTL_WRITABLE \| PTL_PRESENT \| PTL_2MB_PAGE)
258	.quad 0x1800000 \| (PTL_WRITABLE \| PTL_PRESENT \| PTL_2MB_PAGE)	259	.quad 0x1800000 \| (PTL_WRITABLE \| PTL_PRESENT \| PTL_2MB_PAGE)
259	.quad 0x1a00000 \| (PTL_WRITABLE \| PTL_PRESENT \| PTL_2MB_PAGE)	260	.quad 0x1a00000 \| (PTL_WRITABLE \| PTL_PRESENT \| PTL_2MB_PAGE)
260	.quad 0x1c00000 \| (PTL_WRITABLE \| PTL_PRESENT \| PTL_2MB_PAGE)	261	.quad 0x1c00000 \| (PTL_WRITABLE \| PTL_PRESENT \| PTL_2MB_PAGE)
261	.quad 0x1e00000 \| (PTL_WRITABLE \| PTL_PRESENT \| PTL_2MB_PAGE)	262	.quad 0x1e00000 \| (PTL_WRITABLE \| PTL_PRESENT \| PTL_2MB_PAGE)
262	.quad 0x2000000 \| (PTL_WRITABLE \| PTL_PRESENT \| PTL_2MB_PAGE)	263	.quad 0x2000000 \| (PTL_WRITABLE \| PTL_PRESENT \| PTL_2MB_PAGE)
263	.quad 0x2200000 \| (PTL_WRITABLE \| PTL_PRESENT \| PTL_2MB_PAGE)	264	.quad 0x2200000 \| (PTL_WRITABLE \| PTL_PRESENT \| PTL_2MB_PAGE)
264	.quad 0x2400000 \| (PTL_WRITABLE \| PTL_PRESENT \| PTL_2MB_PAGE)	265	.quad 0x2400000 \| (PTL_WRITABLE \| PTL_PRESENT \| PTL_2MB_PAGE)
265	.quad 0x2600000 \| (PTL_WRITABLE \| PTL_PRESENT \| PTL_2MB_PAGE)	266	.quad 0x2600000 \| (PTL_WRITABLE \| PTL_PRESENT \| PTL_2MB_PAGE)
266	.quad 0x2800000 \| (PTL_WRITABLE \| PTL_PRESENT \| PTL_2MB_PAGE)	267	.quad 0x2800000 \| (PTL_WRITABLE \| PTL_PRESENT \| PTL_2MB_PAGE)
267	.quad 0x2a00000 \| (PTL_WRITABLE \| PTL_PRESENT \| PTL_2MB_PAGE)	268	.quad 0x2a00000 \| (PTL_WRITABLE \| PTL_PRESENT \| PTL_2MB_PAGE)
268	.quad 0x2c00000 \| (PTL_WRITABLE \| PTL_PRESENT \| PTL_2MB_PAGE)	269	.quad 0x2c00000 \| (PTL_WRITABLE \| PTL_PRESENT \| PTL_2MB_PAGE)
269	.quad 0x2e00000 \| (PTL_WRITABLE \| PTL_PRESENT \| PTL_2MB_PAGE)	270	.quad 0x2e00000 \| (PTL_WRITABLE \| PTL_PRESENT \| PTL_2MB_PAGE)
270	.quad 0x3000000 \| (PTL_WRITABLE \| PTL_PRESENT \| PTL_2MB_PAGE)	271	.quad 0x3000000 \| (PTL_WRITABLE \| PTL_PRESENT \| PTL_2MB_PAGE)
271	.quad 0x3200000 \| (PTL_WRITABLE \| PTL_PRESENT \| PTL_2MB_PAGE)	272	.quad 0x3200000 \| (PTL_WRITABLE \| PTL_PRESENT \| PTL_2MB_PAGE)
272	.quad 0x3400000 \| (PTL_WRITABLE \| PTL_PRESENT \| PTL_2MB_PAGE)	273	.quad 0x3400000 \| (PTL_WRITABLE \| PTL_PRESENT \| PTL_2MB_PAGE)
273	.quad 0x3600000 \| (PTL_WRITABLE \| PTL_PRESENT \| PTL_2MB_PAGE)	274	.quad 0x3600000 \| (PTL_WRITABLE \| PTL_PRESENT \| PTL_2MB_PAGE)
274	.quad 0x3800000 \| (PTL_WRITABLE \| PTL_PRESENT \| PTL_2MB_PAGE)	275	.quad 0x3800000 \| (PTL_WRITABLE \| PTL_PRESENT \| PTL_2MB_PAGE)
275	.quad 0x3a00000 \| (PTL_WRITABLE \| PTL_PRESENT \| PTL_2MB_PAGE)	276	.quad 0x3a00000 \| (PTL_WRITABLE \| PTL_PRESENT \| PTL_2MB_PAGE)
276	.quad 0x3c00000 \| (PTL_WRITABLE \| PTL_PRESENT \| PTL_2MB_PAGE)	277	.quad 0x3c00000 \| (PTL_WRITABLE \| PTL_PRESENT \| PTL_2MB_PAGE)
277	.quad 0x3e00000 \| (PTL_WRITABLE \| PTL_PRESENT \| PTL_2MB_PAGE)	278	.quad 0x3e00000 \| (PTL_WRITABLE \| PTL_PRESENT \| PTL_2MB_PAGE)
278		279
279	.align 4096	280	.align 4096
280	.global ptl_1	281	.global ptl_1
281	ptl_1:	282	ptl_1:
282	.quad ptl_2 + (PTL_WRITABLE \| PTL_PRESENT)	283	.quad ptl_2 + (PTL_WRITABLE \| PTL_PRESENT)
283	.fill 509,8,0	284	.fill 509,8,0
284	.quad ptl_2 + (PTL_WRITABLE \| PTL_PRESENT)	285	.quad ptl_2 + (PTL_WRITABLE \| PTL_PRESENT)
285	.fill 1,8,0	286	.fill 1,8,0
286		287
287	.align 4096	288	.align 4096
288	.global ptl_0	289	.global ptl_0
289	ptl_0:	290	ptl_0:
290	.quad ptl_1 + (PTL_WRITABLE \| PTL_PRESENT)	291	.quad ptl_1 + (PTL_WRITABLE \| PTL_PRESENT)
291	.fill 510,8,0	292	.fill 510,8,0
292	.quad ptl_1 + (PTL_WRITABLE \| PTL_PRESENT)	293	.quad ptl_1 + (PTL_WRITABLE \| PTL_PRESENT)
293		294
294	.global bootstrap_gdtr	295	.global bootstrap_gdtr
295	bootstrap_gdtr:	296	bootstrap_gdtr:
296	.word gdtselector(GDT_ITEMS)	297	.word gdtselector(GDT_ITEMS)
297	.long KA2PA(gdt)	298	.long KA2PA(gdt)
298		299
299	grub_eax:	300	grub_eax:
300	.long 0	301	.long 0
301		302
302	grub_ebx:	303	grub_ebx:
303	.long 0	304	.long 0
304		305

Subversion Repositories HelenOS-historic

(root)/kernel/trunk/arch/amd64/src/boot/boot.S – Rev 807 → 820