1*83d290c5STom Rini // SPDX-License-Identifier: GPL-2.0+
26dd652faSwdenk /*
36dd652faSwdenk * (C) Copyright 2000
46dd652faSwdenk * Murray Jensen <Murray.Jensen@csiro.au>
56dd652faSwdenk */
66dd652faSwdenk
7bca52d65Swdenk #include <unistd.h>
8bca52d65Swdenk #include <string.h>
9bca52d65Swdenk #include <fcntl.h>
10bca52d65Swdenk #include <sys/time.h>
11bca52d65Swdenk #include "serial.h"
12bca52d65Swdenk
13bca52d65Swdenk #if defined(__sun__) || \
14bca52d65Swdenk defined(__OpenBSD__) || \
15bca52d65Swdenk defined(__FreeBSD__) || \
16bca52d65Swdenk defined(__NetBSD__) || \
17bca52d65Swdenk defined(__APPLE__)
18bca52d65Swdenk static struct termios tios = { BRKINT, 0, B115200|CS8|CREAD, 0, { 0 } };
19bca52d65Swdenk #else
20bca52d65Swdenk static struct termios tios = { BRKINT, 0, B115200|CS8|CREAD, 0, 0 };
21bca52d65Swdenk #endif
22bca52d65Swdenk
23bca52d65Swdenk static struct speedmap {
24bca52d65Swdenk char *str;
25bca52d65Swdenk speed_t val;
26bca52d65Swdenk } speedmap[] = {
27bca52d65Swdenk { "50", B50 }, { "75", B75 }, { "110", B110 },
28bca52d65Swdenk { "134", B134 }, { "150", B150 }, { "200", B200 },
29bca52d65Swdenk { "300", B300 }, { "600", B600 }, { "1200", B1200 },
30bca52d65Swdenk { "1800", B1800 }, { "2400", B2400 }, { "4800", B4800 },
31bca52d65Swdenk { "9600", B9600 }, { "19200", B19200 }, { "38400", B38400 },
32bca52d65Swdenk { "57600", B57600 },
33bca52d65Swdenk #ifdef B76800
34bca52d65Swdenk { "76800", B76800 },
35bca52d65Swdenk #endif
36bca52d65Swdenk { "115200", B115200 },
37bca52d65Swdenk #ifdef B153600
38bca52d65Swdenk { "153600", B153600 },
39bca52d65Swdenk #endif
40bca52d65Swdenk { "230400", B230400 },
41bca52d65Swdenk #ifdef B307200
42bca52d65Swdenk { "307200", B307200 },
43bca52d65Swdenk #endif
44bca52d65Swdenk #ifdef B460800
45bca52d65Swdenk { "460800", B460800 }
46bca52d65Swdenk #endif
47bca52d65Swdenk };
48bca52d65Swdenk static int nspeeds = sizeof speedmap / sizeof speedmap[0];
49bca52d65Swdenk
50bca52d65Swdenk speed_t
cvtspeed(char * str)51bca52d65Swdenk cvtspeed(char *str)
52bca52d65Swdenk {
53bca52d65Swdenk struct speedmap *smp = speedmap, *esmp = &speedmap[nspeeds];
54bca52d65Swdenk
55bca52d65Swdenk while (smp < esmp) {
56bca52d65Swdenk if (strcmp(str, smp->str) == 0)
57bca52d65Swdenk return (smp->val);
58bca52d65Swdenk smp++;
59bca52d65Swdenk }
60bca52d65Swdenk return B0;
61bca52d65Swdenk }
62bca52d65Swdenk
63bca52d65Swdenk int
serialopen(char * device,speed_t speed)64bca52d65Swdenk serialopen(char *device, speed_t speed)
65bca52d65Swdenk {
66bca52d65Swdenk int fd;
67bca52d65Swdenk
68bca52d65Swdenk if (cfsetospeed(&tios, speed) < 0)
69bca52d65Swdenk return -1;
70bca52d65Swdenk
71bca52d65Swdenk if ((fd = open(device, O_RDWR)) < 0)
72bca52d65Swdenk return -1;
73bca52d65Swdenk
74bca52d65Swdenk if (tcsetattr(fd, TCSAFLUSH, &tios) < 0) {
75bca52d65Swdenk (void)close(fd);
76bca52d65Swdenk return -1;
77bca52d65Swdenk }
78bca52d65Swdenk
79bca52d65Swdenk return fd;
80bca52d65Swdenk }
81bca52d65Swdenk
82bca52d65Swdenk int
serialreadchar(int fd,int timeout)83bca52d65Swdenk serialreadchar(int fd, int timeout)
84bca52d65Swdenk {
85bca52d65Swdenk fd_set fds;
86bca52d65Swdenk struct timeval tv;
87bca52d65Swdenk int n;
88bca52d65Swdenk char ch;
89bca52d65Swdenk
90bca52d65Swdenk tv.tv_sec = timeout;
91bca52d65Swdenk tv.tv_usec = 0;
92bca52d65Swdenk
93bca52d65Swdenk FD_ZERO(&fds);
94bca52d65Swdenk FD_SET(fd, &fds);
95bca52d65Swdenk
96bca52d65Swdenk /* this is a fucking horrible quick hack - fix this */
97bca52d65Swdenk
98bca52d65Swdenk if ((n = select(fd + 1, &fds, 0, 0, &tv)) < 0)
99bca52d65Swdenk return SERIAL_ERROR;
100bca52d65Swdenk
101bca52d65Swdenk if (n == 0)
102bca52d65Swdenk return SERIAL_TIMEOUT;
103bca52d65Swdenk
104bca52d65Swdenk if ((n = read(fd, &ch, 1)) < 0)
105bca52d65Swdenk return SERIAL_ERROR;
106bca52d65Swdenk
107bca52d65Swdenk if (n == 0)
108bca52d65Swdenk return SERIAL_EOF;
109bca52d65Swdenk
110bca52d65Swdenk return ch;
111bca52d65Swdenk }
112bca52d65Swdenk
113bca52d65Swdenk int
serialwrite(int fd,char * buf,int len)114bca52d65Swdenk serialwrite(int fd, char *buf, int len)
115bca52d65Swdenk {
116bca52d65Swdenk int n;
117bca52d65Swdenk
118bca52d65Swdenk do {
119bca52d65Swdenk n = write(fd, buf, len);
120bca52d65Swdenk if (n < 0)
121bca52d65Swdenk return 1;
122bca52d65Swdenk len -= n;
123bca52d65Swdenk buf += n;
124bca52d65Swdenk } while (len > 0);
125bca52d65Swdenk return 0;
126bca52d65Swdenk }
127bca52d65Swdenk
128bca52d65Swdenk int
serialclose(int fd)129bca52d65Swdenk serialclose(int fd)
130bca52d65Swdenk {
131bca52d65Swdenk return close(fd);
132bca52d65Swdenk }
133