Subversion Repositories HelenOS-historic

Rev

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

Rev 1290 Rev 1639
Line 56... Line 56...
56
	movl $START_STACK, %esp			# initialize stack pointer
56
	movl $START_STACK, %esp			# initialize stack pointer
57
	lgdt KA2PA(bootstrap_gdtr)		# initialize Global Descriptor Table register
57
	lgdt KA2PA(bootstrap_gdtr)		# initialize Global Descriptor Table register
58
 
58
 
59
	movw $KDATA, %cx
59
	movw $KDATA, %cx
60
	movw %cx, %es
60
	movw %cx, %es
61
	movw %cx, %gs
-
 
62
	movw %cx, %fs
61
	movw %cx, %fs
-
 
62
	movw %cx, %gs
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 $KTEXT, $multiboot_meeting_point
66
	jmpl $KTEXT, $multiboot_meeting_point
67
	multiboot_meeting_point:
67
	multiboot_meeting_point:
68
	
68
	
69
	pushl %ebx							# save parameters from GRUB
69
	pushl %ebx							# save parameters from GRUB
70
	pushl %eax
70
	pushl %eax
71
 
71
	
72
#ifdef CONFIG_FB
72
#ifdef CONFIG_FB
73
	mov $vesa_init,%esi;
73
	mov $vesa_init, %esi
74
	mov $VESA_INIT_SEGMENT<<4,%edi;
74
	mov $VESA_INIT_SEGMENT << 4, %edi
75
	mov $e_vesa_init-vesa_init,%ecx;
75
	mov $e_vesa_init - vesa_init, %ecx
76
	cld;
76
	cld
77
	rep movsb;
77
	rep movsb
78
 
78
 
79
	mov $VESA_INIT_SEGMENT<<4,%edi;
79
	mov $VESA_INIT_SEGMENT << 4, %edi
80
	call *%edi;
80
	jmpl %edi
-
 
81
	
-
 
82
	vesa_meeting_point:
-
 
83
	
81
	mov %esi,KA2PA(vesa_ph_addr);
84
	mov %esi, KA2PA(vesa_ph_addr)
82
	mov %di,KA2PA(vesa_height);
85
	mov %di, KA2PA(vesa_height)
83
	shr $16,%edi;
86
	shr $16, %edi
84
	mov %di,KA2PA(vesa_width);
87
	mov %di, KA2PA(vesa_width)
85
	mov %bx,KA2PA(vesa_scanline);
88
	mov %bx, KA2PA(vesa_scanline)
86
	shr $16,%ebx;
89
	shr $16, %ebx
87
	mov %bx,KA2PA(vesa_bpp);
90
	mov %bx, KA2PA(vesa_bpp)
88
#endif	
91
#endif	
89
	
92
	
90
	call map_kernel							# map kernel and turn paging on
93
	call map_kernel							# map kernel and turn paging on
91
	
94
	
92
	popl %eax
95
	popl %eax
Line 248... Line 251...
248
	movl %ebx, %cr0
251
	movl %ebx, %cr0
249
	ret
252
	ret
250
 
253
 
251
#ifdef CONFIG_FB
254
#ifdef CONFIG_FB
252
vesa_init:
255
vesa_init:
253
	jmp $selector(VESA_INIT_DES),$vesa_init_real-vesa_init;
256
	jmp $selector(VESA_INIT_DES), $vesa_init_real - vesa_init
-
 
257
	
254
.code16
258
.code16
255
vesa_init_real:	
259
vesa_init_real:
256
 
260
	
257
	mov %cr0,%eax;
261
	mov %cr0, %eax
258
	and $~1,%eax;
262
	and $~1, %eax
259
	mov %eax,%cr0;
263
	mov %eax, %cr0
260
 
-
 
261
 
264
	
262
	jmp $VESA_INIT_SEGMENT,$vesa_init_real2-vesa_init;
265
	jmp $VESA_INIT_SEGMENT, $vesa_init_real2 - vesa_init
263
 
266
	
264
vesa_init_real2:	
267
vesa_init_real2:
265
 
268
	
-
 
269
	mov $VESA_INIT_SEGMENT, %bx
266
 
270
	
267
	mov %esp,%ebp;
271
	mov %bx, %es
268
	mov %ss,%cx;
272
	mov %bx, %fs
269
	mov $VESA_INIT_SEGMENT,%bx;
-
 
270
	mov %bx,%ss;
273
	mov %bx, %gs
271
	mov $0x0000fffc,%esp;
-
 
272
	push %ds;
274
	mov %bx, %ds
273
	push %es;
-
 
274
	push %fs;
-
 
275
	push %gs;
-
 
276
	push %ebp;
-
 
277
	push %cx;
275
	mov %bx, %ss
278
 
276
	
279
	mov %bx,%ds;
277
	movl %esp, %eax
280
	mov %bx,%es;
278
	movl $0x0000fffc, %esp
281
	mov %bx,%fs;
279
	movl $0x0000fffc, %ebp
282
	mov %bx,%gs;
280
	pushl %eax
283
 
-
 
284
	
281
	
285
	mov $vesa_idt-vesa_init,%ebx;
-
 
286
	lidtl (%ebx);
-
 
287
 
-
 
288
#define VESA_INFO_SIZE 1024
282
#define VESA_INFO_SIZE 1024
289
 
283
 
290
#define VESA_MODE_LIST_PTR_OFFSET 14 
284
#define VESA_MODE_LIST_PTR_OFFSET 14
291
#define VESA_MODE_WIDTH_OFFSET 18
285
#define VESA_MODE_WIDTH_OFFSET 18
292
#define VESA_MODE_HEIGHT_OFFSET 20
286
#define VESA_MODE_HEIGHT_OFFSET 20
293
#define VESA_MODE_BPP_OFFSET 25
287
#define VESA_MODE_BPP_OFFSET 25
294
#define VESA_MODE_SCANLINE_OFFSET 16
288
#define VESA_MODE_SCANLINE_OFFSET 16
295
#define VESA_MODE_PHADDR_OFFSET 40
289
#define VESA_MODE_PHADDR_OFFSET 40
296
 
290
 
297
#define VESA_END_OF_MODES 0xffff 
291
#define VESA_END_OF_MODES 0xffff
298
 
292
 
299
#define VESA_OK 0x4f 
293
#define VESA_OK 0x4f
300
 
294
 
301
#define VESA_GET_INFO 0x4f00 
295
#define VESA_GET_INFO 0x4f00
302
#define VESA_GET_MODE_INFO 0x4f01
296
#define VESA_GET_MODE_INFO 0x4f01
303
#define VESA_SET_MODE 0x4f02
297
#define VESA_SET_MODE 0x4f02
304
 
298
 
305
#define CONFIG_VESA_BPP_a 255
299
#define CONFIG_VESA_BPP_a 255
306
 
300
 
307
#if CONFIG_VESA_BPP==24
301
#if CONFIG_VESA_BPP == 24
308
#undef CONFIG_VESA_BPP_a
302
#undef CONFIG_VESA_BPP_a
309
#define CONFIG_VESA_BPP_a 32
303
#define CONFIG_VESA_BPP_a 32
310
#endif
304
#endif
311
 
305
 
312
 
-
 
313
	mov $VESA_GET_INFO,%ax;
306
	mov $VESA_GET_INFO, %ax
314
	mov $e_vesa_init-vesa_init,%di
307
	mov $e_vesa_init - vesa_init, %di
315
	push %di;
308
	push %di
316
	int $0x10;	
309
	int $0x10
-
 
310
	
317
	pop %di;
311
	pop %di
318
	cmp $VESA_OK,%al;
312
	cmp $VESA_OK, %al
319
	jnz 0f;
313
	jnz 0f
-
 
314
	
320
	mov 2+VESA_MODE_LIST_PTR_OFFSET(%di),%si;
315
	mov 2 + VESA_MODE_LIST_PTR_OFFSET(%di), %si
321
	mov %si,%gs;
316
	mov %si, %gs
322
	mov VESA_MODE_LIST_PTR_OFFSET(%di),%si;
317
	mov VESA_MODE_LIST_PTR_OFFSET(%di), %si
323
 
318
	
324
	add $VESA_INFO_SIZE,%di;
319
	add $VESA_INFO_SIZE, %di
325
 
320
 
326
1:# Try next mode
321
1:# Try next mode
327
	mov %gs:(%si),%cx;
322
	mov %gs:(%si), %cx
328
	cmp $VESA_END_OF_MODES,%cx;
323
	cmp $VESA_END_OF_MODES, %cx
329
	jz 0f;
324
	jz 0f
-
 
325
	
330
	inc %si;
326
	inc %si
331
	inc %si;
327
	inc %si
332
	push %cx;
328
	push %cx
333
	push %di;
329
	push %di
334
	push %si;
330
	push %si
335
	mov $VESA_GET_MODE_INFO,%ax;
331
	mov $VESA_GET_MODE_INFO, %ax
336
	int $0x10;
332
	int $0x10
-
 
333
	
337
	pop %si;
334
	pop %si
338
	pop %di;
335
	pop %di
339
	pop %cx;
336
	pop %cx
340
	cmp $VESA_OK,%al;
337
	cmp $VESA_OK, %al
341
	jnz 0f;
338
	jnz 0f
342
 
-
 
343
 
339
	
344
	mov $CONFIG_VESA_WIDTH,%ax;
340
	mov $CONFIG_VESA_WIDTH, %ax
345
	cmp VESA_MODE_WIDTH_OFFSET(%di),%ax;
341
	cmp VESA_MODE_WIDTH_OFFSET(%di), %ax
346
	jnz 1b;
342
	jnz 1b
-
 
343
	
347
	mov $CONFIG_VESA_HEIGHT,%ax;
344
	mov $CONFIG_VESA_HEIGHT,%ax
348
	cmp VESA_MODE_HEIGHT_OFFSET(%di),%ax;
345
	cmp VESA_MODE_HEIGHT_OFFSET(%di), %ax
349
	jnz 1b;
346
	jnz 1b
-
 
347
	
350
	mov $CONFIG_VESA_BPP,%al;
348
	mov $CONFIG_VESA_BPP, %al
351
	cmp VESA_MODE_BPP_OFFSET(%di),%al;
349
	cmp VESA_MODE_BPP_OFFSET(%di), %al
352
	jz 2f;
350
	jz 2f
-
 
351
	
353
	mov $CONFIG_VESA_BPP_a,%al;
352
	mov $CONFIG_VESA_BPP_a, %al
354
	cmp VESA_MODE_BPP_OFFSET(%di),%al;
353
	cmp VESA_MODE_BPP_OFFSET(%di), %al
355
	jnz 1b;
354
	jnz 1b
356
 
355
	
357
2:
356
2:
358
 
-
 
359
	mov %cx,%bx;
-
 
360
	or $0xC000,%bx;
-
 
361
	push %di;
-
 
362
	mov $VESA_SET_MODE,%ax;
-
 
363
	int $0x10;
-
 
364
	pop %di;
-
 
365
	cmp $VESA_OK,%al;
-
 
366
	jnz 0f;
-
 
367
	
-
 
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
	
357
	
-
 
358
	mov %cx, %bx
-
 
359
	or $0xc000, %bx
-
 
360
	push %di
-
 
361
	mov $VESA_SET_MODE, %ax
-
 
362
	int $0x10
-
 
363
	
-
 
364
	pop %di
-
 
365
	cmp $VESA_OK, %al
-
 
366
	jnz 0f
-
 
367
	
-
 
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
378
	
377
	
379
 
-
 
380
8:	
378
8:	
381
 
379
	
382
	mov %cr0,%eax;
380
	mov %cr0, %eax
383
	or $1,%eax;
381
	or $1, %eax
384
	mov %eax,%cr0;
382
	mov %eax,%cr0
385
 
383
	
386
	jmp 9f;
384
	jmp 9f
387
9:
385
9:
-
 
386
	
-
 
387
	ljmpl $KTEXT, $(vesa_init_protect - vesa_init + VESA_INIT_SEGMENT << 4)
388
 
388
 
389
	pop %cx;
-
 
390
	pop %ebp;
-
 
391
	pop %gs;
-
 
392
	pop %fs;
-
 
393
	pop %es;
-
 
394
	pop %ds;
-
 
395
	mov %cx,%ss;
-
 
396
	mov %ebp,%esp;
-
 
397
 
-
 
398
	ljmpl $KTEXT,$(vesa_init_protect-vesa_init+VESA_INIT_SEGMENT<<4);
-
 
399
 
-
 
400
 
-
 
401
0:	#Error no Prefered mode found
389
0:# No prefered mode found
402
	mov $0x111,%cx;
390
	mov $0x111, %cx
403
	push %di;
391
	push %di
404
	push %cx;
392
	push %cx
405
	mov $VESA_GET_MODE_INFO,%ax;
393
	mov $VESA_GET_MODE_INFO, %ax
406
	int $0x10;
394
	int $0x10
-
 
395
	
407
	pop %cx;
396
	pop %cx
408
	pop %di;
397
	pop %di
409
	cmp $VESA_OK,%al;
398
	cmp $VESA_OK, %al
410
	jnz 1f;
399
	jnz 1f
411
	jz 2b;    /* Force relative jump */
400
	jz 2b						# Force relative jump
412
 
401
	
-
 
402
1:
413
1:mov $0x0003,%ax;
403
	mov $0x0003, %ax
414
	int $0x10;
404
	int $0x10
415
	mov $0xffffffff,%edi; /* EGA text mode used, because of problems with VESA */
405
	mov $0xffffffff, %edi		# EGA text mode used, because of problems with VESA
416
	xor %ax,%ax
406
	xor %ax, %ax
417
	jz 8b;    /* Force relative jump */
407
	jz 8b						# Force relative jump
-
 
408
	
418
 
409
 
419
vesa_init_protect:	
-
 
420
.code32
410
.code32
-
 
411
vesa_init_protect:
-
 
412
	popl %esp
-
 
413
 
-
 
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
421
	ret;
420
	
-
 
421
	jmpl $KTEXT, $vesa_meeting_point
422
 
422
 
423
vesa_idt:
-
 
424
.word 0x03ff
-
 
425
.long 0
-
 
426
.align 4
423
.align 4
427
e_vesa_init:
424
e_vesa_init:
428
#endif	
425
#endif	
429
 
426
 
430
.section K_DATA_START, "aw", @progbits
427
.section K_DATA_START, "aw", @progbits