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
|
#include <asm/interrupt.h>
#include <asm/io.h>
#include <errno.h>
#include <kernel/con.h>
#include <kernel/sched.h>
#include <kernel/serial.h>
#include <kernel/tty.h>
#include <sys/types.h>
#include <unistd.h>
/* 115200 baud */
#define DIVISOR 1
#define RSBASE 0x3F8
#define RSDATA RSBASE
#define RSINTEN (RSBASE + 1)
#define RSFIFOC (RSBASE + 2)
#define RSLINEC (RSBASE + 3)
#define RSMODEMC (RSBASE + 4)
#define RSLINES (RSBASE + 5)
#define RSMODEMS (RSBASE + 6)
#define RSSCRATCH (RSBASE + 7)
#define rswait()\
while((inb(RSLINES) & 0x20) == 0);
extern void rs_isr(void);
struct tty_struct tty_rs = {
.init = &serial_init
};
static char present;
int rsputs(char *s) {
if(!present)
return -ENXIO;
while(*s) {
rswait();
if(*s == '\n' || *s == '\r') {
outb(RSDATA, '\n');
rswait();
outb(RSDATA, '\r');
s++;
} else {
outb(RSDATA, *s++);
}
}
return 0;
}
void serial_init(void) {
present = 0;
outb(RSSCRATCH, 0x00);
outb(RSSCRATCH, 0xAA);
if(inb(RSSCRATCH) != 0xAA) {
printk("[rs] COM0 not detected!\n");
return;
}
/* enable access to the divisor */
outb(RSLINEC, inb(RSLINEC) | 0x80);
/* write the divisor */
outb(RSBASE, DIVISOR);
outb(RSBASE + 1, DIVISOR >> 8);
/* restore access to the divisor */
outb(RSLINEC, inb(RSLINEC) & 0x7F);
/* configure port parameters */
outb(RSFIFOC, 0x06);
outb(RSLINEC, 0x03);
outb(RSMODEMC, 0x0B);
outb(RSINTEN, 0x01);
inb(RSDATA);
/* register the interrupt handler */
register_isr(0x24, 0, &rs_isr);
irq_enable(0x10);
rsputs("[kernel] Serial monitor initialized!\n\r");
printk("[rs] Serial port COM0 initialized!\n");
present = 1;
}
void rs_handler(void) {
struct tty_queue *q = &tty_rs.rqueue;
if((inb(RSLINES) & 1) == 0)
return;
if(q->pwrite == (q->pread - 1 % sizeof(q->buf)))
return;
q->buf[q->pwrite] = inb(RSDATA);
q->pwrite = q->pwrite + 1 % sizeof(q->buf);
wake_up(&q->waiting);
}
|
