75 lines
1.5 KiB
C
75 lines
1.5 KiB
C
#include "fb.h"
|
|
#include "mbox.h"
|
|
#include "static_tools.h"
|
|
#include "uart.h"
|
|
#include "utils.h"
|
|
|
|
#define FB_WIDTH 640
|
|
#define FB_HEIGHT 480
|
|
#define BUFF_SIZE 100
|
|
|
|
extern unsigned long int __ld_kernel_begin;
|
|
int kernelmain(void)
|
|
{
|
|
struct fbst *fb;
|
|
unsigned char *ptr;
|
|
|
|
uart_init();
|
|
puts("starting kernel\n");
|
|
char buffer[BUFF_SIZE];
|
|
readline(buffer, BUFF_SIZE);
|
|
|
|
if (strcmp(buffer, "kernel") == 0) {
|
|
if(copy_kernel()){
|
|
puts("Checksum error");
|
|
}
|
|
}
|
|
if (fb_init(FB_WIDTH, FB_HEIGHT) == 0) {
|
|
puts("Fail to init framebuffer");
|
|
}
|
|
mbox[0] = 8 * 4;
|
|
mbox[1] = MBOX_REQUEST;
|
|
mbox[2] = MBOX_TAG_GETVCOREMEM;
|
|
mbox[3] = 8;
|
|
mbox[4] = 0;
|
|
mbox[5] = 0;
|
|
mbox[6] = 0;
|
|
mbox[7] = MBOX_TAG_LAST;
|
|
|
|
if (!mbox_call(MBOX_CH_PROP, mbox)) {
|
|
puts("videocore start at 0x");
|
|
printhex(mbox[5]);
|
|
puts(" - ");
|
|
int mem = mbox[6] / 1024 / 1024;
|
|
printdec(mem);
|
|
puts(" Mo\n");
|
|
} else {
|
|
puts("Error getting videocore mem\n");
|
|
}
|
|
|
|
printclock();
|
|
|
|
int el = get_el();
|
|
puts("Exception leve: ");
|
|
printdec(el);
|
|
fb = fb_get();
|
|
ptr = fb->fbp;
|
|
|
|
for (unsigned int y = 0; y < fb->height; y++) {
|
|
for (unsigned int x = 0; x < fb->width; x++) {
|
|
if (y % 60 == 0)
|
|
*((unsigned int *)ptr) = 0x00FF0000;
|
|
else if (y % 40 == 0)
|
|
*((unsigned int *)ptr) = 0x0000FF00;
|
|
else if (y % 20 == 0)
|
|
*((unsigned int *)ptr) = 0x000000FF;
|
|
else
|
|
*((unsigned int *)ptr) = 0x00000000;
|
|
ptr += 4;
|
|
}
|
|
}
|
|
|
|
fb_print(0, 0, "Hello Dude\n");
|
|
return 0;
|
|
}
|