This repository has been archived by the owner on May 6, 2020. It is now read-only.
/
io.c
116 lines (99 loc) · 2.24 KB
/
io.c
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
#include <stdio.h>
#include <stdlib.h>
#include <string.h>
#include <termios.h>
#include <unistd.h>
#include <fcntl.h>
#define IOBSZ 0x100000
static char *iobuffer = NULL;
static int iofd, head, tail;
int io_get_word(char *word)
{
char buf[64], *delim = " ,\n\r\002\003\005\006", *p;
int ret, i, j;
// read new input
while(1) {
// while(ret = read(iofd, buf, 64) > 0) {
ret = read(iofd, buf, 64);
if(ret <= 0)
break;
// else
// ui_print("io_in %d::[%c] [%c] [%c] [%c] [%c] [%c] [%c] [%c]\n", ret,
// buf[0], buf[1], buf[2], buf[3], buf[4], buf[5], buf[6], buf[7]);
// ui_print("head=%d, tail=%d\n", head, tail);
if(tail + ret > IOBSZ) {
memcpy(&iobuffer[tail], buf, IOBSZ - tail);
memcpy(&iobuffer[0], buf + IOBSZ - tail, ret + tail - IOBSZ);
} else
memcpy(&iobuffer[tail], buf, ret);
tail = (tail + ret) % IOBSZ;
// ui_print("head=%d, tail=%d\n", head, tail);
}
// provide word output
// ret is used as word begin flag
ret = 0;
for(i = head, j = 0; i != tail; i = (i + 1) % IOBSZ) {
// ui_print("\\\\ %d::%d ", i, iobuffer[i]);
for(p = delim; *p; p++)
if(iobuffer[i] == *p) {
// ui_print("skip\n");
break;
}
if(!*p) {
ret = 1;
buf[j++] = iobuffer[i];
// ui_print("log->%d\n", j);
} else if(ret == 1) {
buf[j] = 0;
strcpy(word, buf);
head = i;
// ui_print("return \n");
return j;
} else if(iobuffer[i] == '\005' ||
iobuffer[i] == '\006') {
word[0] = iobuffer[i];
word[1] = 0;
head = i + 1;
// ui_print("return 0506 \n");
return 1;
}
}
return 0;
}
int io_send(const char *word)
{
return write(iofd, word, strlen(word));
}
#define TTYDEV "/dev/ptmx"
int io_init(void)
{
struct termios io;
if(!iobuffer) {
iobuffer = malloc(IOBSZ);
head = tail = 0;
}
// init serial
bzero(&io, sizeof(struct termios));
io.c_cflag |= CLOCAL | CREAD;
io.c_cflag &= ~CSIZE;
io.c_cflag |= CS8;
io.c_cflag &= ~PARENB;
io.c_cflag &= ~CSTOPB;
cfsetispeed(&io, B115200);
cfsetospeed(&io, B115200);
iofd = open(TTYDEV, O_RDWR | O_NOCTTY | O_NDELAY);
unlockpt(iofd);
grantpt(iofd);
if(iofd >= 0) {
tcflush(iofd, TCIFLUSH);
if(tcsetattr(iofd, TCSANOW, &io) != 0)
return -2;
}
return iofd;
}
int io_deinit(void)
{
if(iobuffer) free(iobuffer);
if(iofd >= 0) close(iofd);
return 0;
}