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#include <pexpert/protos.h>
29#include <pexpert/pexpert.h>
30
31void serial_putc(char);
32int serial_getc(void);
33int serial_init(void);
34
35
36enum {
37 COM1_PORT_ADDR = 0x3f8,
38 COM2_PORT_ADDR = 0x2f8
39};
40
41
42enum {
43 UART_RBR = 0,
44 UART_THR = 0,
45 UART_DLL = 0,
46 UART_IER = 1,
47 UART_DLM = 1,
48 UART_IIR = 2,
49 UART_FCR = 2,
50 UART_LCR = 3,
51 UART_MCR = 4,
52 UART_LSR = 5,
53 UART_MSR = 6
54};
55
56enum {
57 UART_LCR_8BITS = 0x03,
58 UART_LCR_DLAB = 0x80
59};
60
61enum {
62 UART_MCR_DTR = 0x01,
63 UART_MCR_RTS = 0x02,
64 UART_MCR_OUT1 = 0x04,
65 UART_MCR_OUT2 = 0x08,
66 UART_MCR_LOOP = 0x10
67};
68
69enum {
70 UART_LSR_THRE = 0x20
71};
72
73#define UART_BAUD_RATE 115200
74#define UART_PORT_ADDR COM1_PORT_ADDR
75
76#define WRITE(r, v) outb(UART_PORT_ADDR + UART_##r, v)
77#define READ(r) inb(UART_PORT_ADDR + UART_##r)
78#define DELAY(x) { volatile int _d_; for (_d_ = 0; _d_ < (10000*x); _d_++) ; }
79
80static int uart_initted = 0;
81
82static int
83uart_probe( void )
84{
85
86
87 WRITE( LCR, UART_LCR_DLAB );
88 WRITE( DLL, 0x5a );
89 if (READ(DLL) != 0x5a) return 0;
90 WRITE( DLL, 0xa5 );
91 if (READ(DLL) != 0xa5) return 0;
92 WRITE( LCR, 0x00 );
93 return 1;
94}
95
96static void
97uart_set_baud_rate( unsigned long baud_rate )
98{
99 #define UART_CLOCK 1843200
100
101 const unsigned char lcr = READ( LCR );
102 unsigned long div;
103
104 if (baud_rate == 0) baud_rate = 9600;
105 div = UART_CLOCK / 16 / baud_rate;
106 WRITE( LCR, lcr | UART_LCR_DLAB );
107 WRITE( DLM, (unsigned char)(div >> 8) );
108 WRITE( DLL, (unsigned char) div );
109 WRITE( LCR, lcr & ~UART_LCR_DLAB);
110}
111
112static void
113uart_putc( char c )
114{
115 if (!uart_initted) return;
116
117
118 while ( !(READ(LSR) & UART_LSR_THRE) ) DELAY(1);
119
120 WRITE( THR, c );
121}
122
123int serial_init( void )
124{
125 if ( uart_probe() == 0 ) return 0;
126
127
128
129 WRITE( MCR, 0 );
130 WRITE( IER, 0 );
131
132
133
134 WRITE( FCR, 0 );
135
136
137
138 WRITE( LCR, UART_LCR_8BITS );
139
140
141
142 uart_set_baud_rate( UART_BAUD_RATE );
143
144
145
146 WRITE( MCR, UART_MCR_DTR | UART_MCR_RTS );
147
148
149
150 READ( RBR );
151
152 uart_initted = 1;
153
154 return 1;
155}
156
157void serial_putc( char c )
158{
159 uart_putc(c);
160 if (c == '\n') uart_putc('\r');
161}
162
163int serial_getc( void )
164{
165 return 0;
166}
167