xref: /openbmc/u-boot/tools/gdb/serial.c (revision 83d290c56fab2d38cd1ab4c4cc7099559c1d5046)
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