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
|
#include <stdbool.h>
#include <stdint.h>
#include "serial.h"
#include "util.h"
enum {
CP_DATA = 0x0,
CP_INT = 0x1,
CP_FIFO = 0x2,
CP_LINE = 0x3,
CP_MODEM = 0x4,
CP_LINE_S = 0x5,
CP_MODEM_S = 0x6,
CP_DIVLOW = 0x0,
CP_DIVHIGH = 0x1,
CP_1 = 0x03f8,
CP_2 = 0x02f8,
CP_3 = 0x03e8,
CP_4 = 0x02e8
};
enum {
CL_BAUD = 0x80,
CL_PODD = 0x08,
CL_PEVEN = 0x0c,
CL_PON = 0x18,
CL_POFF = 0x1c,
CL_LSTOP = 0x4,
CL_5BIT = 0x0,
CL_6BIT = 0x1,
CL_7BIT = 0x2,
CL_8BIT = 0x3
};
enum {
CLS_B_ERR = 0x80,
CLS_IDLE = 0x40,
CLS_WRITE = 0x20,
CLS_BREAK = 0x10,
CLS_FRAME = 0x08,
CLS_PAR = 0x04,
CLS_OVER = 0x02,
CLS_READ = 0x01
};
bool error;
#define SERIAL_SPIN_LIMIT 65535
bool serr() {
return error;
}
void init_serial() {
error = false;
outb(CP_1 | CP_INT, 0);
outb(CP_1 | CP_LINE, CL_BAUD);
outb(CP_1 | CP_DIVLOW, 0x03);//38400
outb(CP_1 | CP_DIVHIGH, 0x00);//baud
outb(CP_1 | CP_LINE, CL_8BIT);
outb(CP_1 | CP_FIFO, 0xc7);//?
}
void sout(char b) {
if (error)
return;
uint16_t s = SERIAL_SPIN_LIMIT;
while (!(inb(CP_1 | CP_LINE_S) & CLS_WRITE))
if (!--s) {
error = true;
return;
}
outb(CP_1 | CP_DATA, (uint8_t)b);
}
void soutsz(const char *s) {
while (*s)
sout(*(s++));
}
void soutsn(const char *s, uint8_t n) {
while (n--)
sout(*(s++));
}
char sin() {
if (error)
return 0;
while (!(inb(CP_1 | CP_LINE_S) & CLS_READ))
;//spin
return (char)inb(CP_1 | CP_DATA);
}
void sinsn(char *s, uint8_t n) {
while (n--)
*(s++) = sin();
}
|