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
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
|
#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
/* this shouldn't change */
#define FIFOSZ 16
#define RSBASE 0x3F8
#define RSDATA RSBASE
#define RSINTEN (RSBASE + 1)
#define RSFIFOC (RSBASE + 2)
#define RSINTID (RSBASE + 2)
#define RSLINEC (RSBASE + 3)
#define RSMODEMC (RSBASE + 4)
#define RSLINES (RSBASE + 5)
#define RSMODEMS (RSBASE + 6)
#define RSSCRATCH (RSBASE + 7)
extern void rs_isr(void);
/* internal function prototypes */
void rsint_tx(void);
struct tty_struct tty_rs = {
.init = &serial_init,
.write = &rsint_tx
};
static char present;
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, 0x07);
outb(RSLINEC, 0x03);
outb(RSMODEMC, 0x0B);
outb(RSINTEN, 0x03);
inb(RSDATA);
/* test FIFO functionality */
if(inb(RSINTID) & 0xC0 != 0xC0) {
printk("[rs] Failed to enable FIFO on COM0!\n");
return;
}
/* register the interrupt handler */
register_isr(0x24, 0, &rs_isr);
irq_enable(0x10);
printk("[rs] Serial port COM0 initialized!\n");
present = 1;
}
void rsint_rx(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);
}
/*
* void rsint_tx(void) {
* int copied = 0;
* struct tty_queue *q = &tty_rs.wqueue;
*
* while(q->pread != q->pwrite) {
* [> we're done if the TX FIFO is full <]
* if((inb(RSLINES) & 0x20) == 0)
* break;
*
* outb(RSDATA, q->buf[q->pread]);
* q->pread = (q->pread + 1) % TTY_BUF_SIZE;
*
* copied = 1;
* }
*
* if(copied)
* wake_up(&q->waiting);
* }
*/
void rsint_tx(void) {
int i;
int copied = 0;
struct tty_queue *q = &tty_rs.wqueue;
if((inb(RSLINES) & 0x20) == 0)
return;
for(i = 0; i < FIFOSZ; i++) {
if(q->pread == q->pwrite)
break;
outb(RSDATA, q->buf[q->pread]);
q->pread = (q->pread + 1) % TTY_BUF_SIZE;
copied = 1;
}
if(copied)
wake_up(&q->waiting);
}
|
