LXR uboot/tools/gdb/serial.c

   1/*
   2 * (C) Copyright 2000
   3 * Murray Jensen <Murray.Jensen@csiro.au>
   4 *
   5 * See file CREDITS for list of people who contributed to this
   6 * project.
   7 *
   8 * This program is free software; you can redistribute it and/or
   9 * modify it under the terms of the GNU General Public License as
  10 * published by the Free Software Foundation; either version 2 of
  11 * the License, or (at your option) any later version.
  12 *
  13 * This program is distributed in the hope that it will be useful,
  14 * but WITHOUT ANY WARRANTY; without even the implied warranty of
  15 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  16 * GNU General Public License for more details.
  17 *
  18 * You should have received a copy of the GNU General Public License
  19 * along with this program; if not, write to the Free Software
  20 * Foundation, Inc., 59 Temple Place, Suite 330, Boston,
  21 * MA 02111-1307 USA
  22 */
  23
  24#include <unistd.h>
  25#include <string.h>
  26#include <fcntl.h>
  27#include <sys/time.h>
  28#include "serial.h"
  29
  30#if defined(__sun__)     || \
  31    defined(__OpenBSD__) || \
  32    defined(__FreeBSD__) || \
  33    defined(__NetBSD__)  || \
  34    defined(__APPLE__)
  35static struct termios tios = { BRKINT, 0, B115200|CS8|CREAD, 0, { 0 } };
  36#else
  37static struct termios tios = { BRKINT, 0, B115200|CS8|CREAD, 0,   0   };
  38#endif
  39
  40static struct speedmap {
  41    char *str;
  42    speed_t val;
  43} speedmap[] = {
  44    { "50", B50 },              { "75", B75 },          { "110", B110 },
  45    { "134", B134 },            { "150", B150 },        { "200", B200 },
  46    { "300", B300 },            { "600", B600 },        { "1200", B1200 },
  47    { "1800", B1800 },          { "2400", B2400 },      { "4800", B4800 },
  48    { "9600", B9600 },          { "19200", B19200 },    { "38400", B38400 },
  49    { "57600", B57600 },
  50#ifdef  B76800
  51    { "76800", B76800 },
  52#endif
  53    { "115200", B115200 },
  54#ifdef  B153600
  55    { "153600", B153600 },
  56#endif
  57    { "230400", B230400 },
  58#ifdef  B307200
  59    { "307200", B307200 },
  60#endif
  61#ifdef B460800
  62    { "460800", B460800 }
  63#endif
  64};
  65static int nspeeds = sizeof speedmap / sizeof speedmap[0];
  66
  67speed_t
  68cvtspeed(char *str)
  69{
  70    struct speedmap *smp = speedmap, *esmp = &speedmap[nspeeds];
  71
  72    while (smp < esmp) {
  73        if (strcmp(str, smp->str) == 0)
  74            return (smp->val);
  75        smp++;
  76    }
  77    return B0;
  78}
  79
  80int
  81serialopen(char *device, speed_t speed)
  82{
  83    int fd;
  84
  85    if (cfsetospeed(&tios, speed) < 0)
  86        return -1;
  87
  88    if ((fd = open(device, O_RDWR)) < 0)
  89        return -1;
  90
  91    if (tcsetattr(fd, TCSAFLUSH, &tios) < 0) {
  92        (void)close(fd);
  93        return -1;
  94    }
  95
  96    return fd;
  97}
  98
  99int
 100serialreadchar(int fd, int timeout)
 101{
 102    fd_set fds;
 103    struct timeval tv;
 104    int n;
 105    char ch;
 106
 107    tv.tv_sec = timeout;
 108    tv.tv_usec = 0;
 109
 110    FD_ZERO(&fds);
 111    FD_SET(fd, &fds);
 112
 113    /* this is a fucking horrible quick hack - fix this */
 114
 115    if ((n = select(fd + 1, &fds, 0, 0, &tv)) < 0)
 116        return SERIAL_ERROR;
 117
 118    if (n == 0)
 119        return SERIAL_TIMEOUT;
 120
 121    if ((n = read(fd, &ch, 1)) < 0)
 122        return SERIAL_ERROR;
 123
 124    if (n == 0)
 125        return SERIAL_EOF;
 126
 127    return ch;
 128}
 129
 130int
 131serialwrite(int fd, char *buf, int len)
 132{
 133    int n;
 134
 135    do {
 136        n = write(fd, buf, len);
 137        if (n < 0)
 138            return 1;
 139        len -= n;
 140        buf += n;
 141    } while (len > 0);
 142    return 0;
 143}
 144
 145int
 146serialclose(int fd)
 147{
 148    return close(fd);
 149}
 150