Subversion Repositories HelenOS

Rev

Rev 4345 | Go to most recent revision | Show entire file | Regard whitespace | Details | Blame | Last modification | View Log | RSS feed

Rev 4345 Rev 4346
Line 52... Line 52...
52 
multiboot_image_start:
 52 
multiboot_image_start:
53 
	cld
 53 
	cld
54 
	movl $START_STACK, %esp			# initialize stack pointer
 54 
	movl $START_STACK, %esp     # initialize stack pointer
55 
	lgdt KA2PA(bootstrap_gdtr)		# initialize Global Descriptor Table register
 55 
	lgdt KA2PA(bootstrap_gdtr)  # initialize Global Descriptor Table register
56 
 
 56
57 
	movw $selector(KDATA_DES), %cx
 57 
	movw $gdtselector(KDATA_DES), %cx
58 
	movw %cx, %es
 58 
	movw %cx, %es
59 
	movw %cx, %fs
 59 
	movw %cx, %fs
60 
	movw %cx, %gs
 60 
	movw %cx, %gs
61 
	movw %cx, %ds					# kernel data + stack
 61 
	movw %cx, %ds               # kernel data + stack
62 
	movw %cx, %ss
 62 
	movw %cx, %ss
63
63
64 
	jmpl $selector(KTEXT_DES), $multiboot_meeting_point
 64 
	jmpl $gdtselector(KTEXT_DES), $multiboot_meeting_point
65 
	multiboot_meeting_point:
 65 
	multiboot_meeting_point:
66
66
67 
	movl %eax, grub_eax					# save parameters from GRUB
 67 
	movl %eax, grub_eax         # save parameters from GRUB
68 
	movl %ebx, grub_ebx
 68 
	movl %ebx, grub_ebx
69
69
70 
	xorl %eax, %eax
70 
	xorl %eax, %eax
71 
 	cpuid
 71 
	cpuid
72 
 	cmp $0x0, %eax						# any function > 0?
 72 
	cmp $0x0, %eax              # any function > 0?
73 
	jbe pse_unsupported
 73 
	jbe pse_unsupported
74 
	movl $0x1, %eax						# Basic function code 1
 74 
	movl $0x1, %eax             # basic function code 1
75 
	cpuid
 75 
	cpuid
76 
	bt $3, %edx							# Test if PSE is supported
 76 
	bt $3, %edx                 # test if PSE is supported
77 
	jc pse_supported
 77 
	jc pse_supported
78 
 
 78
79 
	pse_unsupported:
 79 
	pse_unsupported:
80 
		movl $pse_msg, %esi
 80 
		movl $pse_msg, %esi
81 
		jmp error_halt
 81 
		jmp error_halt
82
82
83 
	pse_supported:
 83 
	pse_supported:
84
84 
 
85 
#ifdef CONFIG_FB
 - 
 
86 
	mov $vesa_init, %esi
 85 
#include "vesa_prot.inc"
87 
	mov $VESA_INIT_SEGMENT << 4, %edi
 - 
 
88 
	mov $e_vesa_init - vesa_init, %ecx
 - 
 
89 
	rep movsb
 - 
 
90 
 
 - 
 
91 
	mov $VESA_INIT_SEGMENT << 4, %edi
 - 
 
92 
	jmpl *%edi
 - 
 
93
- 
 
94 
	vesa_meeting_point:
 - 
 
95
- 
 
96 
	mov %esi, KA2PA(vesa_ph_addr)
 - 
 
97 
	mov %di, KA2PA(vesa_height)
 - 
 
98 
	shr $16, %edi
 - 
 
99 
	mov %di, KA2PA(vesa_width)
 - 
 
100 
	mov %bx, KA2PA(vesa_scanline)
 - 
 
101 
	shr $16, %ebx
 - 
 
102 
	mov %bx, KA2PA(vesa_bpp)
 - 
 
103 
#endif
- 
 
104 
 
 86 
 
105 
	call map_kernel							# map kernel and turn paging on
 87 
	# map kernel and turn paging on
- 
 
 88 
	call map_kernel
106 
 
 89
107 
	# arch_pre_main(grub_eax, grub_ebx)
 90 
	# call arch_pre_main(grub_eax, grub_ebx)
108 
	pushl grub_ebx
 91 
	pushl grub_ebx
109 
	pushl grub_eax
 92 
	pushl grub_eax
110 
	call arch_pre_main
 93 
	call arch_pre_main
111
94
112 
	call main_bsp
 95 
	call main_bsp
113
96
114 
	# Not reached.
 97 
	# not reached
115
- 
 
116 
	cli
 98 
	cli
- 
 
 99 
	hlt0:
117 
	hlt
 100 
		hlt
- 
 
 101 
		jmp hlt0
118 
 
 102 
 
119 
.global map_kernel
 103 
.global map_kernel
120 
map_kernel:
 104 
map_kernel:
121 
	#
 105 
	#
122 
	# Here we setup mapping for both the unmapped and mapped sections of the kernel.
 106 
	# Here we setup mapping for both the unmapped and mapped sections of the kernel.
Line 129... Line 113...
129
113
130 
	movl $(page_directory + 0), %esi
 114 
	movl $(page_directory + 0), %esi
131 
	movl $(page_directory + 2048), %edi
 115 
	movl $(page_directory + 2048), %edi
132 
	xorl %ecx, %ecx
 116 
	xorl %ecx, %ecx
133 
	xorl %ebx, %ebx
 117 
	xorl %ebx, %ebx
134 
0:
 118
- 
 
 119 
	floop:
135 
	movl $((1 << 7) | (1 << 1) | (1 << 0)), %eax
 120 
		movl $((1 << 7) | (1 << 1) | (1 << 0)), %eax
136 
	orl %ebx, %eax
 121 
		orl %ebx, %eax
137 
	movl %eax, (%esi, %ecx, 4)					# mapping 0x00000000 + %ecx * 4M => 0x00000000 + %ecx * 4M
 122 
		movl %eax, (%esi, %ecx, 4)      # mapping 0x00000000 + %ecx * 4M => 0x00000000 + %ecx * 4M
138 
	movl %eax, (%edi, %ecx, 4)					# mapping 0x80000000 + %ecx * 4M => 0x00000000 + %ecx * 4M
 123 
		movl %eax, (%edi, %ecx, 4)      # mapping 0x80000000 + %ecx * 4M => 0x00000000 + %ecx * 4M
139 
	addl $(4 * 1024 * 1024), %ebx
 124 
		addl $(4 * 1024 * 1024), %ebx
140 
 
 125
141 
	incl %ecx
 126 
		incl %ecx
142 
	cmpl $512, %ecx
 127 
		cmpl $512, %ecx
143 
	jl 0b
 128 
		jl floop
144 
 
 129
145 
	movl %esi, %cr3
 130 
	movl %esi, %cr3
146
131
147 
	movl %cr0, %ebx
 132 
	movl %cr0, %ebx
148 
	orl $(1 << 31), %ebx						# turn paging on
 133 
	orl $(1 << 31), %ebx                # turn paging on
Line 169... Line 154...
169 
	movw $0x3d5, %dx
 154 
	movw $0x3d5, %dx
170 
	inb %dx, %al
 155 
	inb %dx, %al
171
156
172 
	cmp $1920, %ax
 157 
	cmp $1920, %ax
173 
	jbe cursor_ok
 158 
	jbe cursor_ok
- 
 
 159
174 
		movw $1920, %ax						# sanity check for the cursor on the last line
 160 
		movw $1920, %ax         # sanity check for the cursor on the last line
- 
 
 161
175 
	cursor_ok:
 162 
	cursor_ok:
176
163
177 
	movw %ax, %bx
 164 
	movw %ax, %bx
178 
	shl $1, %eax
 165 
	shl $1, %eax
179 
	addl %eax, %edi
 166 
	addl %eax, %edi
Line 204... Line 191...
204 
	movw $0x3d5, %dx
 191 
	movw $0x3d5, %dx
205 
	movb %bl, %al
 192 
	movb %bl, %al
206 
	outb %al, %dx
 193 
	outb %al, %dx
207
194
208 
	cli
 195 
	cli
- 
 
 196 
	hlt1:
209 
	hlt
 197 
		hlt
- 
 
 198 
		jmp hlt1
210 
 
 199 
 
211 
#ifdef CONFIG_FB
 - 
 
212 
vesa_init:
 - 
 
213 
	jmp $selector(VESA_INIT_DES), $vesa_init_real - vesa_init
 - 
 
214
- 
 
215 
.code16
 - 
 
216 
vesa_init_real:
 - 
 
217
- 
 
218 
	mov %cr0, %eax
 - 
 
219 
	and $~1, %eax
 - 
 
220 
	mov %eax, %cr0
 - 
 
221
- 
 
222 
	jmp $VESA_INIT_SEGMENT, $vesa_init_real2 - vesa_init
 - 
 
223
- 
 
224 
vesa_init_real2:
 - 
 
225
- 
 
226 
	mov $VESA_INIT_SEGMENT, %bx
 - 
 
227
- 
 
228 
	mov %bx, %es
 - 
 
229 
	mov %bx, %fs
 - 
 
230 
	mov %bx, %gs
 - 
 
231 
	mov %bx, %ds
 - 
 
232 
	mov %bx, %ss
 - 
 
233
- 
 
234 
	movl %esp, %eax
 - 
 
235 
	movl $0x0000fffc, %esp
 - 
 
236 
	movl $0x0000fffc, %ebp
 - 
 
237 
	pushl %eax
 - 
 
238
- 
 
239 
#define VESA_INFO_SIZE 1024
 - 
 
240 
 
 - 
 
241 
#define VESA_MODE_ATTRIBUTES_OFFSET 0
 - 
 
242 
#define VESA_MODE_LIST_PTR_OFFSET 14
 - 
 
243 
#define VESA_MODE_SCANLINE_OFFSET 16
 - 
 
244 
#define VESA_MODE_WIDTH_OFFSET 18
 - 
 
245 
#define VESA_MODE_HEIGHT_OFFSET 20
 - 
 
246 
#define VESA_MODE_BPP_OFFSET 25
 - 
 
247 
#define VESA_MODE_PHADDR_OFFSET 40
 - 
 
248 
 
 - 
 
249 
#define VESA_END_OF_MODES 0xffff
 - 
 
250 
 
 - 
 
251 
#define VESA_OK 0x4f
 - 
 
252 
 
 - 
 
253 
#define VESA_GET_INFO 0x4f00
 - 
 
254 
#define VESA_GET_MODE_INFO 0x4f01
 - 
 
255 
#define VESA_SET_MODE 0x4f02
 - 
 
256 
#define VESA_SET_PALETTE 0x4f09
 - 
 
257 
 
 - 
 
258 
#if CONFIG_VESA_BPP == 24
 - 
 
259 
#define CONFIG_VESA_BPP_VARIANT 32
 - 
 
260 
#endif
 - 
 
261 
 
 - 
 
262 
	mov $VESA_GET_INFO, %ax
 - 
 
263 
	mov $e_vesa_init - vesa_init, %di
 - 
 
264 
	push %di
 - 
 
265 
	int $0x10
 - 
 
266
- 
 
267 
	pop %di
 - 
 
268 
	cmp $VESA_OK, %al
 - 
 
269 
	jnz 0f
 - 
 
270
- 
 
271 
	mov 2 + VESA_MODE_LIST_PTR_OFFSET(%di), %si
 - 
 
272 
	mov %si, %gs
 - 
 
273 
	mov VESA_MODE_LIST_PTR_OFFSET(%di), %si
 - 
 
274
- 
 
275 
	add $VESA_INFO_SIZE, %di
 - 
 
276 
 
 - 
 
277 
1:# Try next mode
 - 
 
278 
	mov %gs:(%si), %cx
 - 
 
279 
	cmp $VESA_END_OF_MODES, %cx
 - 
 
280 
	jz 0f
 - 
 
281
- 
 
282 
	inc %si
 - 
 
283 
	inc %si
 - 
 
284 
	push %cx
 - 
 
285 
	push %di
 - 
 
286 
	push %si
 - 
 
287 
	mov $VESA_GET_MODE_INFO, %ax
 - 
 
288 
	int $0x10
 - 
 
289
- 
 
290 
	pop %si
 - 
 
291 
	pop %di
 - 
 
292 
	pop %cx
 - 
 
293 
	cmp $VESA_OK, %al
 - 
 
294 
	jnz 0f
 - 
 
295
- 
 
296 
	mov $CONFIG_VESA_WIDTH, %ax
 - 
 
297 
	cmp VESA_MODE_WIDTH_OFFSET(%di), %ax
 - 
 
298 
	jnz 1b
 - 
 
299
- 
 
300 
	mov $CONFIG_VESA_HEIGHT, %ax
 - 
 
301 
	cmp VESA_MODE_HEIGHT_OFFSET(%di), %ax
 - 
 
302 
	jnz 1b
 - 
 
303
- 
 
304 
	mov $CONFIG_VESA_BPP, %al
 - 
 
305 
	cmp VESA_MODE_BPP_OFFSET(%di), %al
 - 
 
306 
 
 - 
 
307 
#ifdef CONFIG_VESA_BPP_VARIANT
 - 
 
308 
	jz 2f
 - 
 
309
- 
 
310 
	mov $CONFIG_VESA_BPP_VARIANT, %al
 - 
 
311 
	cmp VESA_MODE_BPP_OFFSET(%di), %al
 - 
 
312 
#endif
 - 
 
313 
	jnz 1b
 - 
 
314 
 
 - 
 
315 
2:
 - 
 
316
- 
 
317 
	mov %cx, %bx
 - 
 
318 
	or $0xc000, %bx
 - 
 
319 
	push %di
 - 
 
320 
	mov $VESA_SET_MODE, %ax
 - 
 
321 
	int $0x10
 - 
 
322
- 
 
323 
	pop %di
 - 
 
324 
	cmp $VESA_OK, %al
 - 
 
325 
	jnz 0f
 - 
 
326 
 
 - 
 
327 
#if CONFIG_VESA_BPP == 8
 - 
 
328
- 
 
329 
	# Set 3:2:3 VGA palette
 - 
 
330
- 
 
331 
	mov VESA_MODE_ATTRIBUTES_OFFSET(%di), %ax
 - 
 
332 
	push %di
 - 
 
333 
	mov $vga323 - vesa_init, %di
 - 
 
334 
	mov $0x100, %ecx
 - 
 
335
- 
 
336 
	bt $5, %ax							# Test if VGA compatible registers are present
 - 
 
337 
	jnc vga_compat
 - 
 
338
- 
 
339 
		# Try VESA routine to set palette
 - 
 
340
- 
 
341 
		mov $VESA_SET_PALETTE, %ax
 - 
 
342 
		xor %bl, %bl
 - 
 
343 
		xor %dx, %dx
 - 
 
344 
		int $0x10
 - 
 
345
- 
 
346 
		cmp $0x00, %ah
 - 
 
347 
		je vga_not_compat
 - 
 
348
- 
 
349 
	vga_compat:
 - 
 
350
- 
 
351 
		# Try VGA registers to set palette
 - 
 
352
- 
 
353 
		movw $0x3c6, %dx						# Set palette mask
 - 
 
354 
		movb $0xff, %al
 - 
 
355 
		outb %al, %dx
 - 
 
356
- 
 
357 
		movw $0x3c8, %dx						# First index to set
 - 
 
358 
		xor %al, %al
 - 
 
359 
		outb %al, %dx
 - 
 
360
- 
 
361 
		movw $0x3c9, %dx						# Data port
 - 
 
362 
		vga_loop:
 - 
 
363 
			movb %es:2(%di), %al
 - 
 
364 
			outb %al, %dx
 - 
 
365
- 
 
366 
			movb %es:1(%di), %al
 - 
 
367 
			outb %al, %dx
 - 
 
368
- 
 
369 
			movb %es:(%di), %al
 - 
 
370 
			outb %al, %dx
 - 
 
371
- 
 
372 
			addw $4, %di
 - 
 
373 
			loop vga_loop
 - 
 
374
- 
 
375 
	vga_not_compat:
 - 
 
376
- 
 
377 
	pop %di
 - 
 
378
- 
 
379 
#endif
 - 
 
380
- 
 
381 
	mov VESA_MODE_PHADDR_OFFSET(%di), %esi
 - 
 
382 
	mov VESA_MODE_WIDTH_OFFSET(%di), %ax
 - 
 
383 
	shl $16, %eax
 - 
 
384 
	mov VESA_MODE_HEIGHT_OFFSET(%di), %ax
 - 
 
385 
	mov VESA_MODE_BPP_OFFSET(%di), %bl
 - 
 
386 
	xor %bh, %bh
 - 
 
387 
	shl $16, %ebx
 - 
 
388 
	mov VESA_MODE_SCANLINE_OFFSET(%di), %bx
 - 
 
389 
	mov %eax, %edi
 - 
 
390
- 
 
391 
8:
- 
 
392
- 
 
393 
	mov %cr0, %eax
 - 
 
394 
	or $1, %eax
 - 
 
395 
	mov %eax, %cr0
 - 
 
396
- 
 
397 
	jmp 9f
 - 
 
398 
9:
 - 
 
399
- 
 
400 
	ljmpl $selector(KTEXT_DES), $(vesa_init_protect - vesa_init + VESA_INIT_SEGMENT << 4)
 - 
 
401 
 
 - 
 
402 
0:# No prefered mode found
 - 
 
403 
	mov $0x111, %cx
 - 
 
404 
	push %di
 - 
 
405 
	push %cx
 - 
 
406 
	mov $VESA_GET_MODE_INFO, %ax
 - 
 
407 
	int $0x10
 - 
 
408
- 
 
409 
	pop %cx
 - 
 
410 
	pop %di
 - 
 
411 
	cmp $VESA_OK, %al
 - 
 
412 
	jnz 1f
 - 
 
413 
	jz 2b						# Force relative jump
 - 
 
414
- 
 
415 
1:
 - 
 
416 
	mov $0x0003, %ax
 - 
 
417 
	int $0x10
 - 
 
418 
	mov $0xffffffff, %edi		# EGA text mode used, because of problems with VESA
 - 
 
419 
	xor %ax, %ax
 - 
 
420 
	jz 8b						# Force relative jump
 - 
 
421 
 
 - 
 
422 
vga323:
 - 
 
423 
#include "vga323.pal"
 200 
#include "vesa_real.inc"
424 
 
 - 
 
425 
.code32
 - 
 
426 
vesa_init_protect:
 - 
 
427 
	movw $selector(KDATA_DES), %cx
 - 
 
428 
	movw %cx, %es
 - 
 
429 
	movw %cx, %fs
 - 
 
430 
	movw %cx, %gs
 - 
 
431 
	movw %cx, %ds					# kernel data + stack
 - 
 
432 
	movw %cx, %ss
 - 
 
433
- 
 
434 
	movl $START_STACK, %esp			# initialize stack pointer
 - 
 
435 
 
 - 
 
436 
	jmpl $selector(KTEXT_DES), $vesa_meeting_point
 - 
 
437 
 
 - 
 
438 
.align 4
 - 
 
439 
e_vesa_init:
 - 
 
440 
#endif
- 
 
441 
 
 201 
 
442 
.section K_DATA_START, "aw", @progbits
 202 
.section K_DATA_START, "aw", @progbits
443 
 
 203 
 
444 
.align 4096
 204 
.align 4096
445 
page_directory:
 205 
page_directory: