Rev 1291 | Show entire file | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed
| Rev 1291 | Rev 1641 | ||
|---|---|---|---|
| Line 71... | Line 71... | ||
| 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 | #ifdef CONFIG_FB |
75 | #ifdef CONFIG_FB |
| 76 | mov $vesa_init,%esi; |
76 | mov $vesa_init, %esi; |
| 77 | mov $VESA_INIT_SEGMENT<<4,%edi; |
77 | mov $VESA_INIT_SEGMENT << 4, %edi |
| 78 | mov $e_vesa_init-vesa_init,%ecx; |
78 | mov $e_vesa_init - vesa_init, %ecx |
| 79 | cld; |
79 | cld |
| 80 | rep movsb; |
80 | rep movsb |
| 81 | 81 | ||
| 82 | mov $VESA_INIT_SEGMENT<<4,%edi; |
82 | mov $VESA_INIT_SEGMENT << 4, %edi |
| 83 | call *%edi; |
83 | jmpl *%edi |
| - | 84 | ||
| - | 85 | vesa_meeting_point: |
|
| - | 86 | ||
| 84 | mov %esi,KA2PA(vesa_ph_addr); |
87 | mov %esi, KA2PA(vesa_ph_addr) |
| 85 | mov %di,KA2PA(vesa_height); |
88 | mov %di, KA2PA(vesa_height) |
| 86 | shr $16,%edi; |
89 | shr $16, %edi |
| 87 | mov %di,KA2PA(vesa_width); |
90 | mov %di, KA2PA(vesa_width) |
| 88 | mov %bx,KA2PA(vesa_scanline); |
91 | mov %bx, KA2PA(vesa_scanline) |
| 89 | shr $16,%ebx; |
92 | shr $16, %ebx |
| 90 | mov %bx,KA2PA(vesa_bpp); |
93 | mov %bx, KA2PA(vesa_bpp) |
| 91 | #endif |
94 | #endif |
| 92 | 95 | ||
| 93 | # Protected 32-bit. We want to reuse the code-seg descriptor, |
96 | # Protected 32-bit. We want to reuse the code-seg descriptor, |
| 94 | # the Default operand size must not be 1 when entering long mode |
97 | # the Default operand size must not be 1 when entering long mode |
| 95 | 98 | ||
| Line 272... | Line 275... | ||
| 272 | hlt |
275 | hlt |
| 273 | 276 | ||
| 274 | #ifdef CONFIG_FB |
277 | #ifdef CONFIG_FB |
| 275 | .code32 |
278 | .code32 |
| 276 | vesa_init: |
279 | vesa_init: |
| 277 | jmp $gdtselector(VESA_INIT_DES),$vesa_init_real-vesa_init; |
280 | jmp $gdtselector(VESA_INIT_DES), $vesa_init_real - vesa_init |
| - | 281 | ||
| 278 | .code16 |
282 | .code16 |
| 279 | vesa_init_real: |
283 | vesa_init_real: |
| 280 | 284 | ||
| 281 | mov %cr0,%eax; |
285 | mov %cr0, %eax |
| 282 | and $~1,%eax; |
286 | and $~1, %eax |
| 283 | mov %eax,%cr0; |
287 | mov %eax, %cr0 |
| 284 | - | ||
| 285 | 288 | ||
| 286 | jmp $VESA_INIT_SEGMENT,$vesa_init_real2-vesa_init; |
289 | jmp $VESA_INIT_SEGMENT, $vesa_init_real2 - vesa_init |
| 287 | 290 | ||
| 288 | vesa_init_real2: |
291 | vesa_init_real2: |
| 289 | - | ||
| 290 | 292 | ||
| 291 | mov %esp,%ebp; |
- | |
| 292 | mov %ss,%cx; |
- | |
| 293 | mov $VESA_INIT_SEGMENT,%bx; |
293 | mov $VESA_INIT_SEGMENT, %bx |
| - | 294 | ||
| 294 | mov %bx,%ss; |
295 | mov %bx, %es |
| 295 | mov $0x0000fffc,%esp; |
- | |
| 296 | push %ds; |
- | |
| 297 | push %es; |
- | |
| 298 | push %fs; |
- | |
| 299 | push %gs; |
- | |
| 300 | push %ebp; |
- | |
| 301 | push %cx; |
- | |
| 302 | - | ||
| 303 | mov %bx,%ds; |
296 | mov %bx, %fs |
| 304 | mov %bx,%es; |
297 | mov %bx, %gs |
| 305 | mov %bx,%fs; |
298 | mov %bx, %ds |
| 306 | mov %bx,%gs; |
299 | mov %bx, %ss |
| 307 | 300 | ||
| - | 301 | movl $0x0000fffc, %esp |
|
| - | 302 | movl $0x0000fffc, %ebp |
|
| 308 | 303 | ||
| 309 | mov $vesa_idt-vesa_init,%ebx; |
- | |
| 310 | lidtl (%ebx); |
- | |
| 311 | - | ||
| 312 | #define VESA_INFO_SIZE 1024 |
304 | #define VESA_INFO_SIZE 1024 |
| 313 | 305 | ||
| 314 | #define VESA_MODE_LIST_PTR_OFFSET 14 |
306 | #define VESA_MODE_LIST_PTR_OFFSET 14 |
| 315 | #define VESA_MODE_WIDTH_OFFSET 18 |
307 | #define VESA_MODE_WIDTH_OFFSET 18 |
| 316 | #define VESA_MODE_HEIGHT_OFFSET 20 |
308 | #define VESA_MODE_HEIGHT_OFFSET 20 |
| 317 | #define VESA_MODE_BPP_OFFSET 25 |
309 | #define VESA_MODE_BPP_OFFSET 25 |
| 318 | #define VESA_MODE_SCANLINE_OFFSET 16 |
310 | #define VESA_MODE_SCANLINE_OFFSET 16 |
| 319 | #define VESA_MODE_PHADDR_OFFSET 40 |
311 | #define VESA_MODE_PHADDR_OFFSET 40 |
| 320 | 312 | ||
| 321 | #define VESA_END_OF_MODES 0xffff |
313 | #define VESA_END_OF_MODES 0xffff |
| 322 | 314 | ||
| 323 | #define VESA_OK 0x4f |
315 | #define VESA_OK 0x4f |
| 324 | 316 | ||
| 325 | #define VESA_GET_INFO 0x4f00 |
317 | #define VESA_GET_INFO 0x4f00 |
| 326 | #define VESA_GET_MODE_INFO 0x4f01 |
318 | #define VESA_GET_MODE_INFO 0x4f01 |
| 327 | #define VESA_SET_MODE 0x4f02 |
319 | #define VESA_SET_MODE 0x4f02 |
| 328 | 320 | ||
| 329 | #define CONFIG_VESA_BPP_a 255 |
321 | #define CONFIG_VESA_BPP_a 255 |
| 330 | 322 | ||
| 331 | #if CONFIG_VESA_BPP==24 |
323 | #if CONFIG_VESA_BPP == 24 |
| 332 | #undef CONFIG_VESA_BPP_a |
324 | #undef CONFIG_VESA_BPP_a |
| 333 | #define CONFIG_VESA_BPP_a 32 |
325 | #define CONFIG_VESA_BPP_a 32 |
| 334 | #endif |
326 | #endif |
| 335 | - | ||
| 336 | 327 | ||
| 337 | mov $VESA_GET_INFO,%ax; |
328 | mov $VESA_GET_INFO, %ax |
| 338 | mov $e_vesa_init-vesa_init,%di |
329 | mov $e_vesa_init - vesa_init, %di |
| 339 | push %di; |
330 | push %di |
| 340 | int $0x10; |
331 | int $0x10 |
| - | 332 | ||
| 341 | pop %di; |
333 | pop %di |
| 342 | cmp $VESA_OK,%al; |
334 | cmp $VESA_OK, %al |
| 343 | jnz 0f; |
335 | jnz 0f |
| - | 336 | ||
| 344 | mov 2+VESA_MODE_LIST_PTR_OFFSET(%di),%si; |
337 | mov 2 + VESA_MODE_LIST_PTR_OFFSET(%di), %si |
| 345 | mov %si,%gs; |
338 | mov %si, %gs |
| 346 | mov VESA_MODE_LIST_PTR_OFFSET(%di),%si; |
339 | mov VESA_MODE_LIST_PTR_OFFSET(%di), %si |
| 347 | 340 | ||
| 348 | add $VESA_INFO_SIZE,%di; |
341 | add $VESA_INFO_SIZE, %di |
| 349 | 342 | ||
| 350 | 1:# Try next mode |
343 | 1:# Try next mode |
| 351 | mov %gs:(%si),%cx; |
344 | mov %gs:(%si), %cx |
| 352 | cmp $VESA_END_OF_MODES,%cx; |
345 | cmp $VESA_END_OF_MODES, %cx |
| 353 | jz 0f; |
346 | jz 0f |
| - | 347 | ||
| 354 | inc %si; |
348 | inc %si |
| 355 | inc %si; |
349 | inc %si |
| 356 | push %cx; |
350 | push %cx |
| 357 | push %di; |
351 | push %di |
| 358 | push %si; |
352 | push %si |
| 359 | mov $VESA_GET_MODE_INFO,%ax; |
353 | mov $VESA_GET_MODE_INFO, %ax |
| 360 | int $0x10; |
354 | int $0x10 |
| - | 355 | ||
| 361 | pop %si; |
356 | pop %si |
| 362 | pop %di; |
357 | pop %di |
| 363 | pop %cx; |
358 | pop %cx |
| 364 | cmp $VESA_OK,%al; |
359 | cmp $VESA_OK, %al |
| 365 | jnz 0f; |
360 | jnz 0f |
| 366 | - | ||
| 367 | 361 | ||
| 368 | mov $CONFIG_VESA_WIDTH,%ax; |
362 | mov $CONFIG_VESA_WIDTH, %ax |
| 369 | cmp VESA_MODE_WIDTH_OFFSET(%di),%ax; |
363 | cmp VESA_MODE_WIDTH_OFFSET(%di), %ax |
| 370 | jnz 1b; |
364 | jnz 1b |
| - | 365 | ||
| 371 | mov $CONFIG_VESA_HEIGHT,%ax; |
366 | mov $CONFIG_VESA_HEIGHT, %ax |
| 372 | cmp VESA_MODE_HEIGHT_OFFSET(%di),%ax; |
367 | cmp VESA_MODE_HEIGHT_OFFSET(%di), %ax |
| 373 | jnz 1b; |
368 | jnz 1b |
| - | 369 | ||
| 374 | mov $CONFIG_VESA_BPP,%al; |
370 | mov $CONFIG_VESA_BPP, %al |
| 375 | cmp VESA_MODE_BPP_OFFSET(%di),%al; |
371 | cmp VESA_MODE_BPP_OFFSET(%di), %al |
| 376 | jz 2f; |
372 | jz 2f |
| - | 373 | ||
| 377 | mov $CONFIG_VESA_BPP_a,%al; |
374 | mov $CONFIG_VESA_BPP_a, %al |
| 378 | cmp VESA_MODE_BPP_OFFSET(%di),%al; |
375 | cmp VESA_MODE_BPP_OFFSET(%di), %al |
| 379 | jnz 1b; |
376 | jnz 1b |
| 380 | 377 | ||
| 381 | 2: |
378 | 2: |
| 382 | - | ||
| 383 | mov %cx,%bx; |
- | |
| 384 | or $0xC000,%bx; |
- | |
| 385 | push %di; |
- | |
| 386 | mov $VESA_SET_MODE,%ax; |
- | |
| 387 | int $0x10; |
- | |
| 388 | pop %di; |
- | |
| 389 | cmp $VESA_OK,%al; |
- | |
| 390 | jnz 0f; |
- | |
| 391 | - | ||
| 392 | mov VESA_MODE_PHADDR_OFFSET(%di),%esi; |
- | |
| 393 | mov VESA_MODE_WIDTH_OFFSET(%di),%ax; |
- | |
| 394 | shl $16,%eax; |
- | |
| 395 | mov VESA_MODE_HEIGHT_OFFSET(%di),%ax; |
- | |
| 396 | mov VESA_MODE_BPP_OFFSET(%di),%bl; |
- | |
| 397 | xor %bh,%bh; |
- | |
| 398 | shl $16,%ebx; |
- | |
| 399 | mov VESA_MODE_SCANLINE_OFFSET(%di),%bx; |
- | |
| 400 | mov %eax,%edi; |
- | |
| 401 | 379 | ||
| - | 380 | mov %cx, %bx |
|
| - | 381 | or $0xc000, %bx |
|
| - | 382 | push %di |
|
| - | 383 | mov $VESA_SET_MODE, %ax |
|
| - | 384 | int $0x10 |
|
| - | 385 | ||
| - | 386 | pop %di |
|
| - | 387 | cmp $VESA_OK, %al |
|
| - | 388 | jnz 0f |
|
| - | 389 | ||
| - | 390 | mov VESA_MODE_PHADDR_OFFSET(%di), %esi |
|
| - | 391 | mov VESA_MODE_WIDTH_OFFSET(%di), %ax |
|
| - | 392 | shl $16, %eax |
|
| - | 393 | mov VESA_MODE_HEIGHT_OFFSET(%di), %ax |
|
| - | 394 | mov VESA_MODE_BPP_OFFSET(%di), %bl |
|
| - | 395 | xor %bh, %bh |
|
| - | 396 | shl $16, %ebx |
|
| - | 397 | mov VESA_MODE_SCANLINE_OFFSET(%di), %bx |
|
| - | 398 | mov %eax, %edi |
|
| - | 399 | ||
| - | 400 | 8: |
|
| - | 401 | ||
| - | 402 | mov %cr0, %eax |
|
| - | 403 | or $1, %eax |
|
| - | 404 | mov %eax, %cr0 |
|
| 402 | 405 | ||
| 403 | - | ||
| 404 | 8: |
- | |
| 405 | - | ||
| 406 | mov %cr0,%eax; |
- | |
| 407 | or $1,%eax; |
- | |
| 408 | mov %eax,%cr0; |
- | |
| 409 | - | ||
| 410 | jmp 9f; |
406 | jmp 9f |
| 411 | 9: |
407 | 9: |
| 412 | 408 | ||
| 413 | pop %cx; |
- | |
| 414 | pop %ebp; |
- | |
| 415 | pop %gs; |
- | |
| 416 | pop %fs; |
- | |
| 417 | pop %es; |
- | |
| 418 | pop %ds; |
- | |
| 419 | mov %cx,%ss; |
- | |
| 420 | mov %ebp,%esp; |
- | |
| 421 | - | ||
| 422 | ljmpl $gdtselector(KTEXT32_DES),$(vesa_init_protect-vesa_init+VESA_INIT_SEGMENT<<4); |
409 | ljmpl $gdtselector(KTEXT32_DES), $(vesa_init_protect - vesa_init + VESA_INIT_SEGMENT << 4) |
| 423 | 410 | ||
| 424 | - | ||
| 425 | 0:#Error no Prefered mode found |
411 | 0:# No prefered mode found |
| 426 | mov $0x111,%cx; |
412 | mov $0x111, %cx |
| 427 | push %di; |
413 | push %di |
| 428 | push %cx; |
414 | push %cx |
| 429 | mov $VESA_GET_MODE_INFO,%ax; |
415 | mov $VESA_GET_MODE_INFO, %ax |
| 430 | int $0x10; |
416 | int $0x10 |
| - | 417 | ||
| 431 | pop %cx; |
418 | pop %cx |
| 432 | pop %di; |
419 | pop %di |
| 433 | cmp $VESA_OK,%al; |
420 | cmp $VESA_OK, %al |
| 434 | jnz 1f; |
421 | jnz 1f |
| 435 | jz 2b; /* Force relative jump */ |
422 | jz 2b # Force relative jump |
| 436 | 423 | ||
| 437 | - | ||
| - | 424 | 1: |
|
| 438 | 1:mov $0x0003,%ax; |
425 | mov $0x0003, %ax |
| 439 | int $0x10; |
426 | int $0x10 |
| 440 | mov $0xffffffff,%edi; /* EGA text mode used, because of problems with VESA */ |
427 | mov $0xffffffff, %edi # EGA text mode used, because of problems with VESA |
| 441 | xor %ax,%ax |
428 | xor %ax, %ax |
| 442 | jz 8b; /* Force relative jump */ |
429 | jz 8b # Force relative jump |
| 443 | - | ||
| 444 | 430 | ||
| 445 | vesa_init_protect: |
431 | |
| 446 | .code32 |
432 | .code32 |
| 447 | ret; |
433 | vesa_init_protect: |
| - | 434 | movw $gdtselector(KDATA_DES), %cx |
|
| - | 435 | movw %cx, %es |
|
| - | 436 | movw %cx, %ds # kernel data + stack |
|
| - | 437 | movw %cx, %ss |
|
| - | 438 | # Simics seems to remove hidden part of GS on entering user mode |
|
| - | 439 | # when _visible_ part of GS does not point to user-mode segment |
|
| - | 440 | movw $gdtselector(UDATA_DES), %cx |
|
| - | 441 | movw %cx, %fs |
|
| - | 442 | movw %cx, %gs |
|
| 448 | 443 | ||
| - | 444 | jmpl $gdtselector(KTEXT32_DES), $vesa_meeting_point |
|
| 449 | 445 | ||
| 450 | vesa_idt: |
- | |
| 451 | .word 0x03ff |
- | |
| 452 | .long 0 |
- | |
| 453 | .align 4 |
446 | .align 4 |
| 454 | e_vesa_init: |
447 | e_vesa_init: |
| 455 | #endif |
448 | #endif |
| 456 | - | ||
| 457 | - | ||
| 458 | 449 | ||
| 459 | .section K_DATA_START, "aw", @progbits |
450 | .section K_DATA_START, "aw", @progbits |
| 460 | .align 4096 |
451 | .align 4096 |
| 461 | 452 | ||
| 462 | # Identical mapping of first 64MB and the same of -2GB -> 0 |
453 | # Identical mapping of first 64MB and the same of -2GB -> 0 |