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
124
125
126
127
|
#include "u.h"
#include "../port/lib.h"
#include "mem.h"
#include "dat.h"
#include "fns.h"
#include "../port/error.h"
enum {
Black,
Blue,
Green,
Cyan,
Red,
Magenta,
Brown,
Grey,
Bright = 0x08,
Blinking = 0x80,
Yellow = Bright|Brown,
White = Bright|Grey,
};
enum {
Width = 80*2,
Height = 25,
Attr = (Black<<4)|Grey, /* high nibble background
* low foreground
*/
};
#define CGASCREENBASE ((uchar*)KADDR(0xB8000))
static int cgapos;
static Lock cgascreenlock;
static uchar
cgaregr(int index)
{
outb(0x3D4, index);
return inb(0x3D4+1) & 0xFF;
}
static void
cgaregw(int index, int data)
{
outb(0x3D4, index);
outb(0x3D4+1, data);
}
static void
movecursor(void)
{
cgaregw(0x0E, (cgapos/2>>8) & 0xFF);
cgaregw(0x0F, cgapos/2 & 0xFF);
CGASCREENBASE[cgapos+1] = Attr;
}
static void
cgascreenputc(int c)
{
int i;
uchar *p;
if(c == '\n'){
cgapos = cgapos/Width;
cgapos = (cgapos+1)*Width;
}
else if(c == '\t'){
i = 8 - ((cgapos/2)&7);
while(i-->0)
cgascreenputc(' ');
}
else if(c == '\b'){
if(cgapos >= 2)
cgapos -= 2;
cgascreenputc(' ');
cgapos -= 2;
}
else{
CGASCREENBASE[cgapos++] = c;
CGASCREENBASE[cgapos++] = Attr;
}
if(cgapos >= Width*Height){
memmove(CGASCREENBASE, &CGASCREENBASE[Width], Width*(Height-1));
p = &CGASCREENBASE[Width*(Height-1)];
for(i=0; i<Width/2; i++){
*p++ = ' ';
*p++ = Attr;
}
cgapos = Width*(Height-1);
}
movecursor();
}
static void
cgascreenputs(char* s, int n)
{
if(!islo()){
/*
* Don't deadlock trying to
* print in an interrupt.
*/
if(!canlock(&cgascreenlock))
return;
}
else
lock(&cgascreenlock);
while(n-- > 0)
cgascreenputc(*s++);
unlock(&cgascreenlock);
}
void
screeninit(void)
{
cgapos = cgaregr(0x0E)<<8;
cgapos |= cgaregr(0x0F);
cgapos *= 2;
screenputs = cgascreenputs;
}
|
