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
|
#include <lib.h>
#include <memory.h>
#include <serial.h>
#include <stdint.h>
#include <stddef.h>
#include "bindings.h"
#define INDEX 0x1CE
#define DATA 0x1CF
#define FB_ADDR 0xE0000000
#define FB_MAX 0xFF000000
#define FB_LEN (FB_MAX - FB_ADDR)
#define PREFERRED_VY 4096
#define PREFERRED_B 32
uint16_t fb_res_x = 0;
uint16_t fb_res_y = 0;
uint16_t fb_res_b = 0;
uint8_t *fb_buffer = NULL;
int fb_init(uint16_t res_x, uint16_t res_y) {
outw(INDEX, 0x00);
uint16_t i = inw(DATA);
if (i < 0xB0C0 || i > 0xB0C6) {
return -1;
}
outw(DATA, 0xB0C4);
i = inw(DATA);
/* Disable VBE */
outw(INDEX, 0x04);
outw(DATA, 0x00);
/* Set X resolution to 1024 */
outw(INDEX, 0x01);
outw(DATA, res_x);
/* Set Y resolution to 768 */
outw(INDEX, 0x02);
outw(DATA, res_y);
/* Set bpp to 32 */
outw(INDEX, 0x03);
outw(DATA, PREFERRED_B);
/* Set Virtual Height to stuff */
outw(INDEX, 0x07);
outw(DATA, PREFERRED_VY);
/* Re-enable VBE */
outw(INDEX, 0x04);
outw(DATA, 0x41);
// uint32_t * text_vid_mem = (uint32_t *)0xA0000;
// text_vid_mem[0] = 0xA5ADFACE;
//
// void *temp = mmap((void *) FB_ADDR, 0xFF1000);
//
// for (uintptr_t fb_offset = FB_ADDR; fb_offset < FB_MAX; fb_offset += 0x01000000) {
// /* Enable the higher memory */
// remap(temp, (void *)fb_offset, 0xFF1000);
//
// /* Go find it */
// for (uintptr_t offset = 0; offset < 0xFF0000; offset += 0x1000) {
// uintptr_t x = (uintptr_t)temp + offset;
// if (((uintptr_t *)x)[0] == 0xA5ADFACE) {
// fb_buffer = (uint8_t *) (fb_offset + offset);
// goto mem_found;
// }
// }
// }
//
// unmap(temp);
//
//mem_found:
//
// fb_res_x = res_x;
// fb_res_y = res_y;
// fb_res_b = PREFERRED_B;
//
// fb_buffer = mmap(fb_buffer, 0xFF0000);
// memset(fb_buffer, 7, 0xFF0000);
//
return 0;
}
|
