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
|
#include "uart_16550.h"
#include <stddef.h>
int
uart_thre(enum UART port)
{
return inb(port + LineStatus) & THRE;
}
void
uart_putc(const FILE *self, char a)
{
while (uart_thre((enum UART)self->id) == 0) {}
outb(a, self->id);
if (a == '\n') {
while (uart_thre((enum UART)self->id) == 0) {}
outb('\r', self->id);
}
}
int
uart_puts(const FILE *self, const char *string, int length)
{
int i;
int written = 0;
if (length == -1)
while (*string != '\0') {
uart_putc(self, *string);
++string;
++written;
}
else
for (i = 0; i < length; ++i) {
uart_putc(self, string[i]);
++written;
}
return written;
}
void
uart_flush(__attribute__((unused)) const FILE *self)
{
}
FILE uart_stream;
FILE *
uart_init(enum UART port)
{
outb(0x00, port + 1); /* Disable all interrupts */
outb(0x80, port + 3); /* Enable DLAB (set baud rate divisor) */
outb(0x03, port + 0); /* Set divisor to 3 (lo byte) 38400 baud */
outb(0x00, port + 1); /* (hi byte) */
outb(0x03, port + 3); /* 8 bits, no parity, one stop bit */
outb(0xc7, port + 2); /* Enable FIFO, clear them, with 14-byte threshold */
outb(0x0b, port + 4); /* IRQs enabled, RTS/DSR set */
outb(0x1e, port + 4); /* Set in loopback mode, test the serial chip */
outb(0xae, port + 0); /* Test serial chip (send byte 0xAE and check if serial */
/* returns same byte) */
/* Check if serial is faulty (i.e: not same byte as sent) */
if (inb(port + 0) != 0xae) { return NULL; }
/* If serial is not faulty set it in normal operation mode */
/* (not-loopback with IRQs enabled and OUT#1 and OUT#2 bits enabled) */
outb(0x0f, port + 4);
uart_stream.id = port;
uart_stream.putc = &uart_putc;
uart_stream.puts = &uart_puts;
uart_stream.flush = &uart_flush;
return &uart_stream;
}
|
