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
|
#include <kernel/vga.h>
#include <kernel/paging.h>
#include <kernel/pic.h>
#include <kernel/string.h>
#include <stddef.h>
#include <stdint.h>
static const size_t VGA_WIDTH = 80;
static const size_t VGA_HEIGHT = 25;
static uint16_t *const VGA_MEMORY = (uint16_t*)0xC03FF000;
static size_t fb_row;
static size_t fb_column;
static uint8_t fb_color;
static uint16_t *framebuffer;
void _enable_cursor(uint8_t cursor_start, uint8_t cursor_end) {
outb(0x3D4, 0x0A);
outb(0x3D5, (inb(0x3D5) & 0xC0) | cursor_start);
outb(0x3D4, 0x0B);
outb(0x3D5, (inb(0x3D5) & 0xE0) | cursor_end);
}
void _update_cursor(size_t x, size_t y) {
uint16_t pos = y * VGA_WIDTH + x;
outb(0x3D4, 0x0F);
outb(0x3D5, (uint8_t)(pos & 0xFF));
outb(0x3D4, 0x0E);
outb(0x3D5, (uint8_t)((pos >> 8) & 0xFF));
}
void _fb_putentryat(unsigned char c, uint8_t color, size_t x, size_t y) {
const size_t index = y * VGA_WIDTH + x;
framebuffer[index] = vga_entry(c, color);
}
void _fb_scroll(void) {
for (size_t i = 0; i < VGA_HEIGHT-1; i++) {
for (size_t j = 0; j < VGA_WIDTH; j++)
framebuffer[i * VGA_WIDTH + j] = VGA_MEMORY[(i+1) * VGA_WIDTH + j];
}
}
void fb_init(void) {
map_page(NULL, 0xB8000, (uintptr_t)VGA_MEMORY, 0x003);
fb_row = 0;
fb_column = 0;
fb_color = vga_entry_color(VGA_COLOR_LIGHT_GREY, VGA_COLOR_BLACK);
framebuffer = VGA_MEMORY;
for (size_t y = 0; y < VGA_HEIGHT; y++) {
for (size_t x = 0; x < VGA_WIDTH; x++)
_fb_putentryat(' ', fb_color, x, y);
}
_enable_cursor(0, 0);
_update_cursor(0, 0);
}
void fb_setcolor(uint8_t color) {
fb_color = color;
}
void fb_setpos(int x, int y) {
fb_row = y;
fb_column = x;
}
void fb_putchar(char c) {
unsigned char uc = c;
switch (uc) {
case '\r':
fb_column = 0;
break;
case '\n':
fb_column = 0;
if (++fb_row == VGA_HEIGHT) {
fb_row--;
_fb_scroll();
}
break;
case '\t':
fb_column += 4;
if (++fb_column == VGA_WIDTH) {
fb_column = 4;
if (++fb_row == VGA_HEIGHT) {
fb_row--;
_fb_scroll();
}
}
break;
default:
_fb_putentryat(uc, fb_color, fb_column, fb_row);
if (++fb_column == VGA_WIDTH) {
fb_column = 0;
if (++fb_row == VGA_HEIGHT) {
fb_row--;
_fb_scroll();
}
}
break;
}
_update_cursor(fb_column, fb_row+1);
}
|
