Rev 4345 | Go to most recent revision | Show entire file | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed
Rev 4345 | Rev 4346 | ||
---|---|---|---|
Line 40... | Line 40... | ||
40 | .align 4 |
40 | .align 4 |
41 | .global multiboot_image_start |
41 | .global multiboot_image_start |
42 | multiboot_header: |
42 | multiboot_header: |
43 | .long MULTIBOOT_HEADER_MAGIC |
43 | .long MULTIBOOT_HEADER_MAGIC |
44 | .long MULTIBOOT_HEADER_FLAGS |
44 | .long MULTIBOOT_HEADER_FLAGS |
45 | .long -(MULTIBOOT_HEADER_MAGIC + MULTIBOOT_HEADER_FLAGS) # checksum |
45 | .long -(MULTIBOOT_HEADER_MAGIC + MULTIBOOT_HEADER_FLAGS) # checksum |
46 | .long multiboot_header |
46 | .long multiboot_header |
47 | .long unmapped_ktext_start |
47 | .long unmapped_ktext_start |
48 | .long 0 |
48 | .long 0 |
49 | .long 0 |
49 | .long 0 |
50 | .long multiboot_image_start |
50 | .long multiboot_image_start |
51 | 51 | ||
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 | - | ||
85 | #ifdef CONFIG_FB |
- | |
86 | mov $vesa_init, %esi |
- | |
87 | mov $VESA_INIT_SEGMENT << 4, %edi |
- | |
88 | mov $e_vesa_init - vesa_init, %ecx |
- | |
89 | rep movsb |
- | |
90 | 84 | ||
91 | mov $VESA_INIT_SEGMENT << 4, %edi |
- | |
92 | jmpl *%edi |
- | |
93 | - | ||
94 | vesa_meeting_point: |
85 | #include "vesa_prot.inc" |
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 | - | ||
105 | call map_kernel # map kernel and turn paging on |
- | |
106 | 86 | ||
- | 87 | # map kernel and turn paging on |
|
- | 88 | call map_kernel |
|
- | 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. |
123 | # For simplicity, we map the entire 4G space. |
107 | # For simplicity, we map the entire 4G space. |
124 | # |
108 | # |
125 | movl %cr4, %ecx |
109 | movl %cr4, %ecx |
126 | orl $(1 << 4), %ecx # turn PSE on |
110 | orl $(1 << 4), %ecx # turn PSE on |
127 | andl $(~(1 << 5)), %ecx # turn PAE off |
111 | andl $(~(1 << 5)), %ecx # turn PAE off |
128 | movl %ecx, %cr4 |
112 | movl %ecx, %cr4 |
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 |
149 | movl %ebx, %cr0 |
134 | movl %ebx, %cr0 |
150 | ret |
135 | ret |
151 | 136 | ||
152 | # Print string from %esi to EGA display (in red) and halt |
137 | # Print string from %esi to EGA display (in red) and halt |
153 | error_halt: |
138 | error_halt: |
154 | movl $0xb8000, %edi # base of EGA text mode memory |
139 | movl $0xb8000, %edi # base of EGA text mode memory |
155 | xorl %eax, %eax |
140 | xorl %eax, %eax |
156 | 141 | ||
157 | movw $0x3d4, %dx # read bits 8 - 15 of the cursor address |
142 | movw $0x3d4, %dx # read bits 8 - 15 of the cursor address |
158 | movb $0xe, %al |
143 | movb $0xe, %al |
159 | outb %al, %dx |
144 | outb %al, %dx |
160 | 145 | ||
161 | movw $0x3d5, %dx |
146 | movw $0x3d5, %dx |
162 | inb %dx, %al |
147 | inb %dx, %al |
163 | shl $8, %ax |
148 | shl $8, %ax |
164 | 149 | ||
165 | movw $0x3d4, %dx # read bits 0 - 7 of the cursor address |
150 | movw $0x3d4, %dx # read bits 0 - 7 of the cursor address |
166 | movb $0xf, %al |
151 | movb $0xf, %al |
167 | outb %al, %dx |
152 | outb %al, %dx |
168 | 153 | ||
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 |
180 | 167 | ||
181 | movw $0x0c00, %ax # black background, light red foreground |
168 | movw $0x0c00, %ax # black background, light red foreground |
182 | 169 | ||
183 | ploop: |
170 | ploop: |
184 | lodsb |
171 | lodsb |
185 | cmp $0, %al |
172 | cmp $0, %al |
186 | je ploop_end |
173 | je ploop_end |
187 | stosw |
174 | stosw |
188 | inc %bx |
175 | inc %bx |
189 | jmp ploop |
176 | jmp ploop |
190 | ploop_end: |
177 | ploop_end: |
191 | 178 | ||
192 | movw $0x3d4, %dx # write bits 8 - 15 of the cursor address |
179 | movw $0x3d4, %dx # write bits 8 - 15 of the cursor address |
193 | movb $0xe, %al |
180 | movb $0xe, %al |
194 | outb %al, %dx |
181 | outb %al, %dx |
195 | 182 | ||
196 | movw $0x3d5, %dx |
183 | movw $0x3d5, %dx |
197 | movb %bh, %al |
184 | movb %bh, %al |
198 | outb %al, %dx |
185 | outb %al, %dx |
199 | 186 | ||
200 | movw $0x3d4, %dx # write bits 0 - 7 of the cursor address |
187 | movw $0x3d4, %dx # write bits 0 - 7 of the cursor address |
201 | movb $0xf, %al |
188 | movb $0xf, %al |
202 | outb %al, %dx |
189 | outb %al, %dx |
203 | 190 | ||
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 | - | ||
208 | cli |
- | |
209 | hlt |
- | |
210 | - | ||
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 | 194 | ||
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 |
195 | cli |
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 |
196 | hlt1: |
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 | 197 | hlt |
|
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 |
198 | jmp hlt1 |
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" |
- | |
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 | 199 | ||
438 | .align 4 |
- | |
439 | e_vesa_init: |
200 | #include "vesa_real.inc" |
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: |