1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16#include "boot.h"
17
18int early_serial_base;
19
20#define XMTRDY 0x20
21
22#define TXR 0
23#define LSR 5
24
25
26
27
28
29
30static void __attribute__((section(".inittext"))) serial_putchar(int ch)
31{
32 unsigned timeout = 0xffff;
33
34 while ((inb(early_serial_base + LSR) & XMTRDY) == 0 && --timeout)
35 cpu_relax();
36
37 outb(ch, early_serial_base + TXR);
38}
39
40static void __attribute__((section(".inittext"))) bios_putchar(int ch)
41{
42 struct biosregs ireg;
43
44 initregs(&ireg);
45 ireg.bx = 0x0007;
46 ireg.cx = 0x0001;
47 ireg.ah = 0x0e;
48 ireg.al = ch;
49 intcall(0x10, &ireg, NULL);
50}
51
52void __attribute__((section(".inittext"))) putchar(int ch)
53{
54 if (ch == '\n')
55 putchar('\r');
56
57 bios_putchar(ch);
58
59 if (early_serial_base != 0)
60 serial_putchar(ch);
61}
62
63void __attribute__((section(".inittext"))) puts(const char *str)
64{
65 while (*str)
66 putchar(*str++);
67}
68
69
70
71
72
73
74static u8 gettime(void)
75{
76 struct biosregs ireg, oreg;
77
78 initregs(&ireg);
79 ireg.ah = 0x02;
80 intcall(0x1a, &ireg, &oreg);
81
82 return oreg.dh;
83}
84
85
86
87
88int getchar(void)
89{
90 struct biosregs ireg, oreg;
91
92 initregs(&ireg);
93
94 intcall(0x16, &ireg, &oreg);
95
96 return oreg.al;
97}
98
99static int kbd_pending(void)
100{
101 struct biosregs ireg, oreg;
102
103 initregs(&ireg);
104 ireg.ah = 0x01;
105 intcall(0x16, &ireg, &oreg);
106
107 return !(oreg.eflags & X86_EFLAGS_ZF);
108}
109
110void kbd_flush(void)
111{
112 for (;;) {
113 if (!kbd_pending())
114 break;
115 getchar();
116 }
117}
118
119int getchar_timeout(void)
120{
121 int cnt = 30;
122 int t0, t1;
123
124 t0 = gettime();
125
126 while (cnt) {
127 if (kbd_pending())
128 return getchar();
129
130 t1 = gettime();
131 if (t0 != t1) {
132 cnt--;
133 t0 = t1;
134 }
135 }
136
137 return 0;
138}
139
140