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
|
#include "console.h"
static int posx=0;
static int posy=0;
void scr_clear()
{
int x,y;
for(x=0;x<SCR_WIDTH;x++)
for(y=0;y<SCR_HEIGHT;y++)
{
print_char_col(x,y," ",SCR_BLACK);
}
posx=posy=0;
}
//TODO
void scr_nextline()
{
int i,x;
posx=0;
posy++;
if(posy>SCR_HEIGHT-2)
{
for(i=1;i<SCR_HEIGHT-1;i++)
{
for(x=1;x<SCR_WIDTH;x++)
{
char* video_mem=(char *)SCR_VIDEOMEM+((x)+(i-1)*SCR_WIDTH)*2;
char* video_mem2=(char *)SCR_VIDEOMEM+((x)+i*SCR_WIDTH)*2;
*video_mem=*video_mem2;
}
}
posy--;
}
}
void scr_put_hex(uint16_t val)
{
int i;
print_char_col(posx,posy,'0',SCR_WHITE);
posx++;
print_char_col(posx,posy,'x',SCR_WHITE);
posx++;
for(i=0;i<4;i++)
{
print_single_hex((val&0xf000)>>12);
val=val << 4;
}
}
void scr_put_string(char *str)
{
while(*str!=0)
{
print_char(posx++,posy,*(str++));
}
}
// helper_funcs
void print_single_hex(int i)
{
if(i<10)print_char_col(posx,posy,'0'+i,SCR_GREEN);
else if(i<16)print_char_col(posx,posy,'A'+i-10,SCR_GREEN);
posx++;
}
void print_str(int x,int y,char *str)
{
print_str_col(x,y,str,SCR_WHITE);
}
void print_char(int x, int y, char c)
{
print_char_col(x,y,c,SCR_WHITE);
}
void print_str_col(int x,int y,char *str, char col)
{
while(*str!=0)
{
print_char_col(x++,y,*(str++),col);
}
}
void print_char_col(int x, int y, char c, char col)
{
char* video_mem=(char *)SCR_VIDEOMEM+(x+y*SCR_WIDTH)*2;
video_mem[0]=c;
video_mem[1]=col;
}
|