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