WebSVN – HelenOS – 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, %gs
	movw %cx, %fs
	movw %cx, %ds							# kernel data + stack
	movw %cx, %ss
	
	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
		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:
		movl %ecx, 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 696	Rev 798
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, %gs	61	movw %cx, %gs
62	movw %cx, %fs	62	movw %cx, %fs
63	movw %cx, %ds # kernel data + stack	63	movw %cx, %ds # kernel data + stack
64	movw %cx, %ss	64	movw %cx, %ss
65		65
66	jmpl $gdtselector(KTEXT32_DES), $multiboot_meeting_point	66	jmpl $gdtselector(KTEXT32_DES), $multiboot_meeting_point
67	multiboot_meeting_point:	67	multiboot_meeting_point:
68		68
69	movl %eax, grub_eax # save parameters from GRUB	69	movl %eax, grub_eax # save parameters from GRUB
70	movl %ebx, grub_ebx	70	movl %ebx, grub_ebx
71		71
72	# Protected 32-bit. We want to reuse the code-seg descriptor,	72	# Protected 32-bit. We want to reuse the code-seg descriptor,
73	# the Default operand size must not be 1 when entering long mode	73	# the Default operand size must not be 1 when entering long mode
74		74
75	movl $0x80000000, %eax	75	movl $0x80000000, %eax
76	cpuid	76	cpuid
77	cmp $0x80000000, %eax # any function > 80000000h?	77	cmp $0x80000000, %eax # any function > 80000000h?
78	jbe long_mode_unsupported	78	jbe long_mode_unsupported
79	movl $(AMD_CPUID_EXTENDED), %eax # Extended function code 80000001	79	movl $(AMD_CPUID_EXTENDED), %eax # Extended function code 80000001
80	cpuid	80	cpuid
81	bt $29, %edx # Test if long mode is supported.	81	bt $29, %edx # Test if long mode is supported.
82	jc long_mode_supported	82	jc long_mode_supported
83		83
84	long_mode_unsupported:	84	long_mode_unsupported:
85	cli	85	cli
86	hlt	86	hlt
87		87
88	long_mode_supported:	88	long_mode_supported:
89		89
90	# Enable 64-bit page transaltion entries - CR4.PAE = 1.	90	# Enable 64-bit page transaltion entries - CR4.PAE = 1.
91	# Paging is not enabled until after long mode is enabled	91	# Paging is not enabled until after long mode is enabled
92		92
93	movl %cr4, %eax	93	movl %cr4, %eax
94	btsl $5, %eax	94	btsl $5, %eax
95	movl %eax, %cr4	95	movl %eax, %cr4
96		96
97	# Set up paging tables	97	# Set up paging tables
98		98
99	leal ptl_0, %eax	99	leal ptl_0, %eax
100	movl %eax, %cr3	100	movl %eax, %cr3
101		101
102	# Enable long mode	102	# Enable long mode
103		103
104	movl $EFER_MSR_NUM, %ecx # EFER MSR number	104	movl $EFER_MSR_NUM, %ecx # EFER MSR number
105	rdmsr # Read EFER	105	rdmsr # Read EFER
106	btsl $AMD_LME_FLAG, %eax # Set LME=1	106	btsl $AMD_LME_FLAG, %eax # Set LME=1
107	wrmsr # Write EFER	107	wrmsr # Write EFER
108		108
109	# Enable paging to activate long mode (set CR0.PG=1)	109	# Enable paging to activate long mode (set CR0.PG=1)
110		110
111	movl %cr0, %eax	111	movl %cr0, %eax
112	btsl $31, %eax	112	btsl $31, %eax
113	movl %eax, %cr0	113	movl %eax, %cr0
114		114
115	# At this point we are in compatibility mode	115	# At this point we are in compatibility mode
116		116
117	jmpl $gdtselector(KTEXT_DES), $start64	117	jmpl $gdtselector(KTEXT_DES), $start64
118		118
119	.code64	119	.code64
120	start64:	120	start64:
121	movq $(PA2KA(START_STACK)), %rsp	121	movq $(PA2KA(START_STACK)), %rsp
122	movl grub_eax, %eax	122	movl grub_eax, %eax
123	movl grub_ebx, %ebx	123	movl grub_ebx, %ebx
124		124
125	cmpl $MULTIBOOT_LOADER_MAGIC, %eax # compare GRUB signature	125	cmpl $MULTIBOOT_LOADER_MAGIC, %eax # compare GRUB signature
126	je valid_boot	126	je valid_boot
127		127
128	xorl %ecx, %ecx # no memory size or map available	128	xorl %ecx, %ecx # no memory size or map available
129	movl %ecx, e801memorysize	129	movl %ecx, e801memorysize
130	movl %ecx, e820counter	130	movl %ecx, e820counter
131		131
132	jmp invalid_boot	132	jmp invalid_boot
133		133
134	valid_boot:	134	valid_boot:
135		135
136	movl (%ebx), %eax # ebx = physical address of struct multiboot_info	136	movl (%ebx), %eax # ebx = physical address of struct multiboot_info
137		137
138	bt $0, %eax # mbi->flags[0] (mem_lower, mem_upper valid)	138	bt $0, %eax # mbi->flags[0] (mem_lower, mem_upper valid)
139	jc mem_valid	139	jc mem_valid
140		140
141	xorl %ecx, %ecx	141	xorl %ecx, %ecx
142	jmp mem_invalid	142	jmp mem_invalid
143		143
144	mem_valid:	144	mem_valid:
145	movl 4(%ebx), %ecx # mbi->mem_lower	145	movl 4(%ebx), %ecx # mbi->mem_lower
146	addl 8(%ebx), %ecx # mbi->mem_upper	146	addl 8(%ebx), %ecx # mbi->mem_upper
147		147
148	mem_invalid:	148	mem_invalid:
149	movl %ecx, e801memorysize	149	movl %ecx, e801memorysize
150		150
151	bt $3, %eax # mbi->flags[3] (mods_count, mods_addr valid)	151	bt $3, %eax # mbi->flags[3] (mods_count, mods_addr valid)
152	jc mods_valid	152	jc mods_valid
153		153
154	xorl %ecx, %ecx	154	xorl %ecx, %ecx
155	xorl %edx, %edx	155	xorl %edx, %edx
156	jmp mods_invalid	156	jmp mods_invalid
157		157
158	mods_valid:	158	mods_valid:
159	movl 20(%ebx), %ecx # mbi->mods_count	159	movl 20(%ebx), %ecx # mbi->mods_count
160	cmpl $0, %ecx	160	cmpl $0, %ecx
161	je mods_invalid	161	je mods_invalid
162		162
-		163	xorq %rdx, %rdx
163	movl 24(%ebx), %esi # mbi->mods_addr	164	movl 24(%ebx), %esi # mbi->mods_addr
164	movl 0(%esi), %edx # mods->mod_start	165	movl 0(%esi), %edx # mods->mod_start
165	movl 4(%esi), %ecx # mods->mod_end	166	movl 4(%esi), %ecx # mods->mod_end
166	subl %edx, %ecx	167	subl %edx, %ecx
167	addl $0x80000000, %edx	168	addq $0xffffffff80000000, %rdx
168		169
169	mods_invalid:	170	mods_invalid:
170	movl %ecx, init_size	171	movl %ecx, init_size
171	movl %edx, init_addr	172	movq %rdx, init_addr
172		173
173	bt $6, %eax # mbi->flags[6] (mmap_length, mmap_addr valid)	174	bt $6, %eax # mbi->flags[6] (mmap_length, mmap_addr valid)
174	jc mmap_valid	175	jc mmap_valid
175		176
176	xorl %edx, %edx	177	xorl %edx, %edx
177	jmp mmap_invalid	178	jmp mmap_invalid
178		179
179	mmap_valid:	180	mmap_valid:
180	movl 44(%ebx), %ecx # mbi->mmap_length	181	movl 44(%ebx), %ecx # mbi->mmap_length
181	movl 48(%ebx), %esi # mbi->mmap_addr	182	movl 48(%ebx), %esi # mbi->mmap_addr
182	movq $e820table, %rdi	183	movq $e820table, %rdi
183	xorl %edx, %edx	184	xorl %edx, %edx
184		185
185	mmap_loop:	186	mmap_loop:
186	cmpl $0, %ecx	187	cmpl $0, %ecx
187	jle mmap_end	188	jle mmap_end
188		189
189	movl 4(%esi), %eax # mmap->base_addr_low	190	movl 4(%esi), %eax # mmap->base_addr_low
190	movl %eax, (%rdi)	191	movl %eax, (%rdi)
191		192
192	movl 8(%esi), %eax # mmap->base_addr_high	193	movl 8(%esi), %eax # mmap->base_addr_high
193	movl %eax, 4(%rdi)	194	movl %eax, 4(%rdi)
194		195
195	movl 12(%esi), %eax # mmap->length_low	196	movl 12(%esi), %eax # mmap->length_low
196	movl %eax, 8(%rdi)	197	movl %eax, 8(%rdi)
197		198
198	movl 16(%esi), %eax # mmap->length_high	199	movl 16(%esi), %eax # mmap->length_high
199	movl %eax, 12(%rdi)	200	movl %eax, 12(%rdi)
200		201
201	movl 20(%esi), %eax # mmap->type	202	movl 20(%esi), %eax # mmap->type
202	movl %eax, 16(%rdi)	203	movl %eax, 16(%rdi)
203		204
204	movl (%esi), %eax # mmap->size	205	movl (%esi), %eax # mmap->size
205	addl $0x4, %eax	206	addl $0x4, %eax
206	addl %eax, %esi	207	addl %eax, %esi
207	subl %eax, %ecx	208	subl %eax, %ecx
208	addq $MEMMAP_E820_RECORD_SIZE, %rdi	209	addq $MEMMAP_E820_RECORD_SIZE, %rdi
209	incl %edx	210	incl %edx
210	jmp mmap_loop	211	jmp mmap_loop
211		212
212	mmap_end:	213	mmap_end:
213		214
214	mmap_invalid:	215	mmap_invalid:
215	movl %edx, e820counter	216	movl %edx, e820counter
216		217
217	invalid_boot:	218	invalid_boot:
218		219
219	#ifdef CONFIG_SMP	220	#ifdef CONFIG_SMP
220		221
221	# copy AP bootstrap routines below 1 MB	222	# copy AP bootstrap routines below 1 MB
222		223
223	movq $BOOT_OFFSET, %rsi	224	movq $BOOT_OFFSET, %rsi
224	movq $AP_BOOT_OFFSET, %rdi	225	movq $AP_BOOT_OFFSET, %rdi
225	movq $_hardcoded_unmapped_size, %rcx	226	movq $_hardcoded_unmapped_size, %rcx
226	cld	227	cld
227	rep movsb	228	rep movsb
228		229
229	#endif	230	#endif
230		231
231	call main_bsp # never returns	232	call main_bsp # never returns
232		233
233	cli	234	cli
234	hlt	235	hlt
235		236
236	.section K_DATA_START, "aw", @progbits	237	.section K_DATA_START, "aw", @progbits
237	.align 4096	238	.align 4096
238		239
239	# Identical mapping of first 64MB and the same of -2GB -> 0	240	# Identical mapping of first 64MB and the same of -2GB -> 0
240	.global ptl_2	241	.global ptl_2
241	ptl_2:	242	ptl_2:
242	.quad 0x0 \| (PTL_WRITABLE \| PTL_PRESENT \| PTL_2MB_PAGE)	243	.quad 0x0 \| (PTL_WRITABLE \| PTL_PRESENT \| PTL_2MB_PAGE)
243	.quad 0x200000 \| (PTL_WRITABLE \| PTL_PRESENT \| PTL_2MB_PAGE)	244	.quad 0x200000 \| (PTL_WRITABLE \| PTL_PRESENT \| PTL_2MB_PAGE)
244	.quad 0x400000 \| (PTL_WRITABLE \| PTL_PRESENT \| PTL_2MB_PAGE)	245	.quad 0x400000 \| (PTL_WRITABLE \| PTL_PRESENT \| PTL_2MB_PAGE)
245	.quad 0x600000 \| (PTL_WRITABLE \| PTL_PRESENT \| PTL_2MB_PAGE)	246	.quad 0x600000 \| (PTL_WRITABLE \| PTL_PRESENT \| PTL_2MB_PAGE)
246	.quad 0x800000 \| (PTL_WRITABLE \| PTL_PRESENT \| PTL_2MB_PAGE)	247	.quad 0x800000 \| (PTL_WRITABLE \| PTL_PRESENT \| PTL_2MB_PAGE)
247	.quad 0xa00000 \| (PTL_WRITABLE \| PTL_PRESENT \| PTL_2MB_PAGE)	248	.quad 0xa00000 \| (PTL_WRITABLE \| PTL_PRESENT \| PTL_2MB_PAGE)
248	.quad 0xc00000 \| (PTL_WRITABLE \| PTL_PRESENT \| PTL_2MB_PAGE)	249	.quad 0xc00000 \| (PTL_WRITABLE \| PTL_PRESENT \| PTL_2MB_PAGE)
249	.quad 0xe00000 \| (PTL_WRITABLE \| PTL_PRESENT \| PTL_2MB_PAGE)	250	.quad 0xe00000 \| (PTL_WRITABLE \| PTL_PRESENT \| PTL_2MB_PAGE)
250	.quad 0x1000000 \| (PTL_WRITABLE \| PTL_PRESENT \| PTL_2MB_PAGE)	251	.quad 0x1000000 \| (PTL_WRITABLE \| PTL_PRESENT \| PTL_2MB_PAGE)
251	.quad 0x1200000 \| (PTL_WRITABLE \| PTL_PRESENT \| PTL_2MB_PAGE)	252	.quad 0x1200000 \| (PTL_WRITABLE \| PTL_PRESENT \| PTL_2MB_PAGE)
252	.quad 0x1400000 \| (PTL_WRITABLE \| PTL_PRESENT \| PTL_2MB_PAGE)	253	.quad 0x1400000 \| (PTL_WRITABLE \| PTL_PRESENT \| PTL_2MB_PAGE)
253	.quad 0x1600000 \| (PTL_WRITABLE \| PTL_PRESENT \| PTL_2MB_PAGE)	254	.quad 0x1600000 \| (PTL_WRITABLE \| PTL_PRESENT \| PTL_2MB_PAGE)
254	.quad 0x1800000 \| (PTL_WRITABLE \| PTL_PRESENT \| PTL_2MB_PAGE)	255	.quad 0x1800000 \| (PTL_WRITABLE \| PTL_PRESENT \| PTL_2MB_PAGE)
255	.quad 0x1a00000 \| (PTL_WRITABLE \| PTL_PRESENT \| PTL_2MB_PAGE)	256	.quad 0x1a00000 \| (PTL_WRITABLE \| PTL_PRESENT \| PTL_2MB_PAGE)
256	.quad 0x1c00000 \| (PTL_WRITABLE \| PTL_PRESENT \| PTL_2MB_PAGE)	257	.quad 0x1c00000 \| (PTL_WRITABLE \| PTL_PRESENT \| PTL_2MB_PAGE)
257	.quad 0x1e00000 \| (PTL_WRITABLE \| PTL_PRESENT \| PTL_2MB_PAGE)	258	.quad 0x1e00000 \| (PTL_WRITABLE \| PTL_PRESENT \| PTL_2MB_PAGE)
258	.quad 0x2000000 \| (PTL_WRITABLE \| PTL_PRESENT \| PTL_2MB_PAGE)	259	.quad 0x2000000 \| (PTL_WRITABLE \| PTL_PRESENT \| PTL_2MB_PAGE)
259	.quad 0x2200000 \| (PTL_WRITABLE \| PTL_PRESENT \| PTL_2MB_PAGE)	260	.quad 0x2200000 \| (PTL_WRITABLE \| PTL_PRESENT \| PTL_2MB_PAGE)
260	.quad 0x2400000 \| (PTL_WRITABLE \| PTL_PRESENT \| PTL_2MB_PAGE)	261	.quad 0x2400000 \| (PTL_WRITABLE \| PTL_PRESENT \| PTL_2MB_PAGE)
261	.quad 0x2600000 \| (PTL_WRITABLE \| PTL_PRESENT \| PTL_2MB_PAGE)	262	.quad 0x2600000 \| (PTL_WRITABLE \| PTL_PRESENT \| PTL_2MB_PAGE)
262	.quad 0x2800000 \| (PTL_WRITABLE \| PTL_PRESENT \| PTL_2MB_PAGE)	263	.quad 0x2800000 \| (PTL_WRITABLE \| PTL_PRESENT \| PTL_2MB_PAGE)
263	.quad 0x2a00000 \| (PTL_WRITABLE \| PTL_PRESENT \| PTL_2MB_PAGE)	264	.quad 0x2a00000 \| (PTL_WRITABLE \| PTL_PRESENT \| PTL_2MB_PAGE)
264	.quad 0x2c00000 \| (PTL_WRITABLE \| PTL_PRESENT \| PTL_2MB_PAGE)	265	.quad 0x2c00000 \| (PTL_WRITABLE \| PTL_PRESENT \| PTL_2MB_PAGE)
265	.quad 0x2e00000 \| (PTL_WRITABLE \| PTL_PRESENT \| PTL_2MB_PAGE)	266	.quad 0x2e00000 \| (PTL_WRITABLE \| PTL_PRESENT \| PTL_2MB_PAGE)
266	.quad 0x3000000 \| (PTL_WRITABLE \| PTL_PRESENT \| PTL_2MB_PAGE)	267	.quad 0x3000000 \| (PTL_WRITABLE \| PTL_PRESENT \| PTL_2MB_PAGE)
267	.quad 0x3200000 \| (PTL_WRITABLE \| PTL_PRESENT \| PTL_2MB_PAGE)	268	.quad 0x3200000 \| (PTL_WRITABLE \| PTL_PRESENT \| PTL_2MB_PAGE)
268	.quad 0x3400000 \| (PTL_WRITABLE \| PTL_PRESENT \| PTL_2MB_PAGE)	269	.quad 0x3400000 \| (PTL_WRITABLE \| PTL_PRESENT \| PTL_2MB_PAGE)
269	.quad 0x3600000 \| (PTL_WRITABLE \| PTL_PRESENT \| PTL_2MB_PAGE)	270	.quad 0x3600000 \| (PTL_WRITABLE \| PTL_PRESENT \| PTL_2MB_PAGE)
270	.quad 0x3800000 \| (PTL_WRITABLE \| PTL_PRESENT \| PTL_2MB_PAGE)	271	.quad 0x3800000 \| (PTL_WRITABLE \| PTL_PRESENT \| PTL_2MB_PAGE)
271	.quad 0x3a00000 \| (PTL_WRITABLE \| PTL_PRESENT \| PTL_2MB_PAGE)	272	.quad 0x3a00000 \| (PTL_WRITABLE \| PTL_PRESENT \| PTL_2MB_PAGE)
272	.quad 0x3c00000 \| (PTL_WRITABLE \| PTL_PRESENT \| PTL_2MB_PAGE)	273	.quad 0x3c00000 \| (PTL_WRITABLE \| PTL_PRESENT \| PTL_2MB_PAGE)
273	.quad 0x3e00000 \| (PTL_WRITABLE \| PTL_PRESENT \| PTL_2MB_PAGE)	274	.quad 0x3e00000 \| (PTL_WRITABLE \| PTL_PRESENT \| PTL_2MB_PAGE)
274		275
275	.align 4096	276	.align 4096
276	.global ptl_1	277	.global ptl_1
277	ptl_1:	278	ptl_1:
278	.quad ptl_2 + (PTL_WRITABLE \| PTL_PRESENT)	279	.quad ptl_2 + (PTL_WRITABLE \| PTL_PRESENT)
279	.fill 509,8,0	280	.fill 509,8,0
280	.quad ptl_2 + (PTL_WRITABLE \| PTL_PRESENT)	281	.quad ptl_2 + (PTL_WRITABLE \| PTL_PRESENT)
281	.fill 1,8,0	282	.fill 1,8,0
282		283
283	.align 4096	284	.align 4096
284	.global ptl_0	285	.global ptl_0
285	ptl_0:	286	ptl_0:
286	.quad ptl_1 + (PTL_WRITABLE \| PTL_PRESENT)	287	.quad ptl_1 + (PTL_WRITABLE \| PTL_PRESENT)
287	.fill 510,8,0	288	.fill 510,8,0
288	.quad ptl_1 + (PTL_WRITABLE \| PTL_PRESENT)	289	.quad ptl_1 + (PTL_WRITABLE \| PTL_PRESENT)
289		290
290	.global bootstrap_gdtr	291	.global bootstrap_gdtr
291	bootstrap_gdtr:	292	bootstrap_gdtr:
292	.word gdtselector(GDT_ITEMS)	293	.word gdtselector(GDT_ITEMS)
293	.long KA2PA(gdt)	294	.long KA2PA(gdt)
294		295
295	grub_eax:	296	grub_eax:
296	.long 0	297	.long 0
297		298
298	grub_ebx:	299	grub_ebx:
299	.long 0	300	.long 0
300		301

Subversion Repositories HelenOS

(root)/kernel/trunk/arch/amd64/src/boot/boot.S @ 1020 – Rev 696 → 798