Subversion Repositories HelenOS

Rev

Rev 1290 | Rev 1641 | Go to most recent revision | Details | Compare with Previous | Last modification | View Log | RSS feed

Rev Author Line No. Line
1 jermar 1
#
2
# Copyright (C) 2001-2004 Jakub Jermar
693 decky 3
# Copyright (C) 2005-2006 Martin Decky
1 jermar 4
# All rights reserved.
5
#
6
# Redistribution and use in source and binary forms, with or without
7
# modification, are permitted provided that the following conditions
8
# are met:
9
#
10
# - Redistributions of source code must retain the above copyright
11
#   notice, this list of conditions and the following disclaimer.
12
# - Redistributions in binary form must reproduce the above copyright
13
#   notice, this list of conditions and the following disclaimer in the
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
16
#   derived from this software without specific prior written permission.
17
#
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
20
# OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
21
# IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
22
# INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
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
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
27
# THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
28
#
29
 
222 decky 30
#include <arch/boot/boot.h>
506 decky 31
#include <arch/boot/memmap.h>
300 palkovsky 32
#include <arch/mm/page.h>
33
#include <arch/pm.h>
222 decky 34
 
693 decky 35
#define START_STACK (BOOT_OFFSET - BOOT_STACK_SIZE)
36
 
406 jermar 37
.section K_TEXT_START, "ax"
1 jermar 38
 
267 decky 39
KTEXT=8
40
KDATA=16
41
 
112 jermar 42
.code32
222 decky 43
.align 4
693 decky 44
.global multiboot_image_start
222 decky 45
multiboot_header:
46
	.long MULTIBOOT_HEADER_MAGIC
47
	.long MULTIBOOT_HEADER_FLAGS
48
	.long -(MULTIBOOT_HEADER_MAGIC + MULTIBOOT_HEADER_FLAGS)	# checksum
693 decky 49
	.long multiboot_header
50
	.long unmapped_ktext_start
222 decky 51
	.long 0
52
	.long 0
693 decky 53
	.long multiboot_image_start
222 decky 54
 
55
multiboot_image_start:
693 decky 56
	movl $START_STACK, %esp			# initialize stack pointer
57
	lgdt KA2PA(bootstrap_gdtr)		# initialize Global Descriptor Table register
112 jermar 58
 
280 decky 59
	movw $KDATA, %cx
60
	movw %cx, %es
1639 decky 61
	movw %cx, %fs
280 decky 62
	movw %cx, %gs
693 decky 63
	movw %cx, %ds					# kernel data + stack
280 decky 64
	movw %cx, %ss
235 decky 65
 
693 decky 66
	jmpl $KTEXT, $multiboot_meeting_point
271 decky 67
	multiboot_meeting_point:
68
 
323 jermar 69
	pushl %ebx							# save parameters from GRUB
280 decky 70
	pushl %eax
1639 decky 71
 
1287 vana 72
#ifdef CONFIG_FB
1639 decky 73
	mov $vesa_init, %esi
74
	mov $VESA_INIT_SEGMENT << 4, %edi
75
	mov $e_vesa_init - vesa_init, %ecx
76
	cld
77
	rep movsb
1287 vana 78
 
1639 decky 79
	mov $VESA_INIT_SEGMENT << 4, %edi
80
	jmpl %edi
81
 
82
	vesa_meeting_point:
83
 
84
	mov %esi, KA2PA(vesa_ph_addr)
85
	mov %di, KA2PA(vesa_height)
86
	shr $16, %edi
87
	mov %di, KA2PA(vesa_width)
88
	mov %bx, KA2PA(vesa_scanline)
89
	shr $16, %ebx
90
	mov %bx, KA2PA(vesa_bpp)
1287 vana 91
#endif	
280 decky 92
 
323 jermar 93
	call map_kernel							# map kernel and turn paging on
235 decky 94
 
280 decky 95
	popl %eax
96
	popl %ebx
323 jermar 97
	cmpl $MULTIBOOT_LOADER_MAGIC, %eax				# compare GRUB signature
280 decky 98
	je valid_boot
99
 
285 decky 100
		xorl %ecx, %ecx							# no memory size or map available
101
		movl %ecx, e801memorysize
102
		movl %ecx, e820counter
103
 
280 decky 104
		jmp invalid_boot
285 decky 105
 
280 decky 106
	valid_boot:
107
 
285 decky 108
		movl (%ebx), %eax						# ebx = physical address of struct multiboot_info
280 decky 109
 
285 decky 110
		bt $0, %eax								# mbi->flags[0] (mem_lower, mem_upper valid)
111
		jc mem_valid
112
 
113
			xorl %ecx, %ecx
114
			jmp mem_invalid
115
 
116
		mem_valid:
117
		movl 4(%ebx), %ecx						# mbi->mem_lower
118
		addl 8(%ebx), %ecx						# mbi->mem_upper
280 decky 119
 
285 decky 120
		mem_invalid:
280 decky 121
		movl %ecx, e801memorysize
122
 
1037 decky 123
		bt $3, %eax								# mbi->flags[3] (mods_count, mods_addr valid)
506 decky 124
		jc mods_valid
125
 
126
			xorl %ecx, %ecx
1037 decky 127
			movl %ecx, init
128
			jmp mods_end
506 decky 129
 
130
		mods_valid:
1037 decky 131
 
628 decky 132
		movl 20(%ebx), %ecx						# mbi->mods_count
1037 decky 133
		movl %ecx, init
134
 
628 decky 135
		cmpl $0, %ecx
1037 decky 136
		je mods_end
506 decky 137
 
628 decky 138
		movl 24(%ebx), %esi						# mbi->mods_addr
1037 decky 139
		movl $init, %edi
628 decky 140
 
1037 decky 141
		mods_loop:
506 decky 142
 
1037 decky 143
			movl 0(%esi), %edx					# mods->mod_start
144
			addl $0x80000000, %edx
145
			movl %edx, 4(%edi)
146
 
147
			movl 4(%esi), %edx
148
			subl 0(%esi), %edx					# mods->mod_end - mods->mod_start
149
			movl %edx, 8(%edi)
150
 
151
			addl $16, %esi
152
			addl $8	, %edi
153
 
154
			loop mods_loop
155
 
156
		mods_end:
157
 
285 decky 158
		bt $6, %eax								# mbi->flags[6] (mmap_length, mmap_addr valid)	
159
		jc mmap_valid
160
 
161
			xorl %edx, %edx
162
			jmp mmap_invalid
163
 
164
		mmap_valid:
165
		movl 44(%ebx), %ecx						# mbi->mmap_length
166
		movl 48(%ebx), %esi						# mbi->mmap_addr
167
		movl $e820table, %edi
168
		xorl %edx, %edx
280 decky 169
 
285 decky 170
		mmap_loop:
171
			cmpl $0, %ecx
172
			jle mmap_end
173
 
174
			movl 4(%esi), %eax					# mmap->base_addr_low
175
			movl %eax, (%edi)
176
 
177
			movl 8(%esi), %eax					# mmap->base_addr_high
178
			movl %eax, 4(%edi)
179
 
180
			movl 12(%esi), %eax					# mmap->length_low
181
			movl %eax, 8(%edi)
182
 
183
			movl 16(%esi), %eax					# mmap->length_high
184
			movl %eax, 12(%edi)
185
 
186
			movl 20(%esi), %eax					# mmap->type
187
			movl %eax, 16(%edi)
188
 
189
			movl (%esi), %eax					# mmap->size
190
			addl $0x4, %eax
191
			addl %eax, %esi
192
			subl %eax, %ecx
193
			addl $MEMMAP_E820_RECORD_SIZE, %edi
194
			incl %edx
195
			jmp mmap_loop
196
 
197
		mmap_end:
198
 
199
		mmap_invalid:
200
		movl %edx, e820counter
201
 
280 decky 202
	invalid_boot:
203
 
693 decky 204
#ifdef CONFIG_SMP
205
 
206
	# copy AP bootstrap routines below 1 MB
207
 
208
	movl $BOOT_OFFSET, %esi
209
	movl $AP_BOOT_OFFSET, %edi
210
	movl $_hardcoded_unmapped_size, %ecx
211
	cld
212
	rep movsb
213
 
214
#endif
215
 
216
	call main_bsp								# never returns
110 jermar 217
 
218
	cli
219
	hlt
220
 
221
.global map_kernel
222
map_kernel:
105 jermar 223
	#
224
	# Here we setup mapping for both the unmapped and mapped sections of the kernel.
371 jermar 225
	# For simplicity, we map the entire 4G space.
105 jermar 226
	#
227
	movl %cr4, %ecx
228
	orl $(1<<4), %ecx
323 jermar 229
	movl %ecx, %cr4							# turn PSE on
1 jermar 230
 
371 jermar 231
	movl $(page_directory+0), %esi
232
	movl $(page_directory+2048), %edi
233
	xorl %ecx, %ecx
234
	xorl %ebx, %ebx
235
0:
105 jermar 236
	movl $((1<<7)|(1<<0)), %eax
371 jermar 237
	orl %ebx, %eax
238
	movl %eax, (%esi,%ecx,4)					# mapping 0x00000000+%ecx*4M => 0x00000000+%ecx*4M
239
	movl %eax, (%edi,%ecx,4)					# mapping 0x80000000+%ecx*4M => 0x00000000+%ecx*4M
240
	addl $(4*1024*1024), %ebx
1 jermar 241
 
371 jermar 242
	incl %ecx
243
	cmpl $512, %ecx
244
	jl 0b
105 jermar 245
 
371 jermar 246
	movl %esi, %cr3
105 jermar 247
 
177 jermar 248
	# turn paging on
105 jermar 249
	movl %cr0, %ebx
250
	orl $(1<<31), %ebx
251
	movl %ebx, %cr0
110 jermar 252
	ret
105 jermar 253
 
1287 vana 254
#ifdef CONFIG_FB
255
vesa_init:
1639 decky 256
	jmp $selector(VESA_INIT_DES), $vesa_init_real - vesa_init
257
 
1287 vana 258
.code16
1639 decky 259
vesa_init_real:
1287 vana 260
 
1639 decky 261
	mov %cr0, %eax
262
	and $~1, %eax
263
	mov %eax, %cr0
264
 
265
	jmp $VESA_INIT_SEGMENT, $vesa_init_real2 - vesa_init
266
 
267
vesa_init_real2:
268
 
269
	mov $VESA_INIT_SEGMENT, %bx
270
 
271
	mov %bx, %es
272
	mov %bx, %fs
273
	mov %bx, %gs
274
	mov %bx, %ds
275
	mov %bx, %ss
276
 
277
	movl %esp, %eax
278
	movl $0x0000fffc, %esp
279
	movl $0x0000fffc, %ebp
280
	pushl %eax
281
 
1287 vana 282
#define VESA_INFO_SIZE 1024
283
 
1639 decky 284
#define VESA_MODE_LIST_PTR_OFFSET 14
1287 vana 285
#define VESA_MODE_WIDTH_OFFSET 18
286
#define VESA_MODE_HEIGHT_OFFSET 20
287
#define VESA_MODE_BPP_OFFSET 25
288
#define VESA_MODE_SCANLINE_OFFSET 16
289
#define VESA_MODE_PHADDR_OFFSET 40
290
 
1639 decky 291
#define VESA_END_OF_MODES 0xffff
1287 vana 292
 
1639 decky 293
#define VESA_OK 0x4f
1287 vana 294
 
1639 decky 295
#define VESA_GET_INFO 0x4f00
1287 vana 296
#define VESA_GET_MODE_INFO 0x4f01
297
#define VESA_SET_MODE 0x4f02
298
 
299
#define CONFIG_VESA_BPP_a 255
300
 
1639 decky 301
#if CONFIG_VESA_BPP == 24
1287 vana 302
#undef CONFIG_VESA_BPP_a
303
#define CONFIG_VESA_BPP_a 32
304
#endif
305
 
1639 decky 306
	mov $VESA_GET_INFO, %ax
307
	mov $e_vesa_init - vesa_init, %di
308
	push %di
309
	int $0x10
310
 
311
	pop %di
312
	cmp $VESA_OK, %al
313
	jnz 0f
314
 
315
	mov 2 + VESA_MODE_LIST_PTR_OFFSET(%di), %si
316
	mov %si, %gs
317
	mov VESA_MODE_LIST_PTR_OFFSET(%di), %si
318
 
319
	add $VESA_INFO_SIZE, %di
1287 vana 320
 
321
1:# Try next mode
1639 decky 322
	mov %gs:(%si), %cx
323
	cmp $VESA_END_OF_MODES, %cx
324
	jz 0f
325
 
326
	inc %si
327
	inc %si
328
	push %cx
329
	push %di
330
	push %si
331
	mov $VESA_GET_MODE_INFO, %ax
332
	int $0x10
333
 
334
	pop %si
335
	pop %di
336
	pop %cx
337
	cmp $VESA_OK, %al
338
	jnz 0f
339
 
340
	mov $CONFIG_VESA_WIDTH, %ax
341
	cmp VESA_MODE_WIDTH_OFFSET(%di), %ax
342
	jnz 1b
343
 
344
	mov $CONFIG_VESA_HEIGHT,%ax
345
	cmp VESA_MODE_HEIGHT_OFFSET(%di), %ax
346
	jnz 1b
347
 
348
	mov $CONFIG_VESA_BPP, %al
349
	cmp VESA_MODE_BPP_OFFSET(%di), %al
350
	jz 2f
351
 
352
	mov $CONFIG_VESA_BPP_a, %al
353
	cmp VESA_MODE_BPP_OFFSET(%di), %al
354
	jnz 1b
355
 
1287 vana 356
2:
357
 
1639 decky 358
	mov %cx, %bx
359
	or $0xc000, %bx
360
	push %di
361
	mov $VESA_SET_MODE, %ax
362
	int $0x10
1287 vana 363
 
1639 decky 364
	pop %di
365
	cmp $VESA_OK, %al
366
	jnz 0f
1287 vana 367
 
1639 decky 368
	mov VESA_MODE_PHADDR_OFFSET(%di), %esi
369
	mov VESA_MODE_WIDTH_OFFSET(%di), %ax
370
	shl $16, %eax
371
	mov VESA_MODE_HEIGHT_OFFSET(%di), %ax
372
	mov VESA_MODE_BPP_OFFSET(%di), %bl
373
	xor %bh, %bh
374
	shl $16, %ebx
375
	mov VESA_MODE_SCANLINE_OFFSET(%di), %bx
376
	mov %eax, %edi
377
 
1287 vana 378
8:	
1639 decky 379
 
380
	mov %cr0, %eax
381
	or $1, %eax
382
	mov %eax,%cr0
383
 
384
	jmp 9f
1287 vana 385
9:
1639 decky 386
 
387
	ljmpl $KTEXT, $(vesa_init_protect - vesa_init + VESA_INIT_SEGMENT << 4)
1287 vana 388
 
1639 decky 389
0:# No prefered mode found
390
	mov $0x111, %cx
391
	push %di
392
	push %cx
393
	mov $VESA_GET_MODE_INFO, %ax
394
	int $0x10
395
 
396
	pop %cx
397
	pop %di
398
	cmp $VESA_OK, %al
399
	jnz 1f
400
	jz 2b						# Force relative jump
401
 
402
1:
403
	mov $0x0003, %ax
404
	int $0x10
405
	mov $0xffffffff, %edi		# EGA text mode used, because of problems with VESA
406
	xor %ax, %ax
407
	jz 8b						# Force relative jump
408
 
1287 vana 409
 
1639 decky 410
.code32
411
vesa_init_protect:
412
	popl %esp
1287 vana 413
 
1639 decky 414
	movw $KDATA, %cx
415
	movw %cx, %es
416
	movw %cx, %fs
417
	movw %cx, %gs
418
	movw %cx, %ds					# kernel data + stack
419
	movw %cx, %ss
420
 
421
	jmpl $KTEXT, $vesa_meeting_point
1287 vana 422
 
423
.align 4
424
e_vesa_init:
425
#endif	
426
 
406 jermar 427
.section K_DATA_START, "aw", @progbits
105 jermar 428
 
429
.align 4096
430
page_directory:
431
	.space 4096, 0