1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
|
#include <stdint.h>
#include <stdio.h>
#include <stdlib.h>
#include "gdt.h"
#include "gfx.h"
#include "idt.h"
#include "isr.h"
#include "irq.h"
#include "log.h"
#include "multiboot.h"
#include "panic.h"
#include "pcspkr.h"
#include "ps2.h"
#include "fpu.h"
#include "timer.h"
#include "tty.h"
void gpf(struct regs_t regs)
{
printf("General protection fault!\n");
printf("EIP before fault: 0x%x\n", regs.eip);
printf("Error code: %d\n", regs.err_code);
panic("GPF");
}
void main(struct multiboot_info_t *hdr, uint32_t magic)
{
fpu_enable();
asm("movq %xmm0, %xmm0");
/* this should go to port e9, which is the Bochs debug port */
printf("Testing early I/O\n");
printf("GFX init\n");
bool gfx_status = gfx_init((struct vbe_info_t*)hdr->vbe_mode_info);
/* if graphical initialization fails, fall back to text mode */
if(!gfx_status)
{
tty_init();
printf("Graphics init failed, fell back to text mode.\n");
}
if(magic != 0x2BADB002)
{
panic("Multiboot magic invalid");
}
/* then the descriptor tables so we can do more useful stuff */
gdt_init();
idt_init();
/* install all the interrupt stubs */
isr_init();
irq_init();
/* initialize other drivers */
timer_init(HZ);
ps2_init();
set_interrupt_handler(0xd, gpf);
asm("sti");
printf("Boot finished.\n");
printf("Testing RNG...\n");
srand(*current_tick);
if(gfx_status)
{
int startpix = *current_tick;
for(int i=0;i<1000000;++i)
{
int rx = rand() % *gfx_width;
int ry = rand() % *gfx_height;
gfx_set_foreground(rand() % 0x1000000);
gfx_drawpixel(rx, ry);
}
int endpix = *current_tick;
int startfill = *current_tick;
for(int i=0;i<1000;++i)
{
gfx_set_background(rand() % 0x1000000);
gfx_clear();
}
int endfill = *current_tick;
gfx_set_background(0);
gfx_set_foreground(0xFFFFFF);
gfx_clear();
int starttext = *current_tick;
for(int i=0;i<1000000;++i)
{
int rx = rand() % *gfx_width;
int ry = rand() % *gfx_height;
gfx_drawchar(rx, ry, rand()%127+1);
}
int endtext = *current_tick;
gfx_reset();
printf("--- Graphics benchmark results ---\n");
printf("Ticks for 1,000,000 random pixels: %d\n", endpix-startpix);
printf("Ticks for 1,000 random fills: %d\n", endfill-startfill);
printf("Ticks for 1,000,000 random chars: %d\n", endtext-starttext);
printf("Ticks per second: %d\n", HZ);
printf("Resolution: %dx%dx%d\n", *gfx_width, *gfx_height, *gfx_bpp * 8);
}
printf("Testing keyboard LED's...\n");
while(1)
{
ps2_set_leds(PS2_NUM_LOCK);
timer_delay(HZ/4);
ps2_set_leds(PS2_CAPS_LOCK);
timer_delay(HZ/4);
ps2_set_leds(PS2_SCROLL_LOCK);
timer_delay(HZ/4);
ps2_set_leds(PS2_CAPS_LOCK);
timer_delay(HZ/4);
}
while(1);
}
|
