FreeCalypso > hg > freecalypso-reveng
diff fluid-mnf/serial.c @ 344:2bd27d940023
fluid-mnf/serial.c: serial_recv() implemented
author | Mychaela Falconia <falcon@freecalypso.org> |
---|---|
date | Fri, 13 Mar 2020 05:53:20 +0000 |
parents | 917e05f03ad2 |
children | 37b5f94de802 |
line wrap: on
line diff
--- a/fluid-mnf/serial.c Fri Mar 13 05:40:23 2020 +0000 +++ b/fluid-mnf/serial.c Fri Mar 13 05:53:20 2020 +0000 @@ -29,11 +29,14 @@ #include <sys/ioctl.h> #include <asm/ioctls.h> #include <asm/termbits.h> +#include <sys/errno.h> #include <stdio.h> #include <stdlib.h> #include <string.h> #include <unistd.h> +extern int errno; + /****************************************************************************** * Linux Driver @@ -208,7 +211,29 @@ int serial_recv(char *buf, int size, int timeout) { - /* to be filled */ + fd_set fds; + struct timeval tv; + int cc; + + for (;;) { + FD_ZERO(&fds); + FD_SET(target_fd, &fds); + tv.tv_sec = timeout / 1000; + tv.tv_usec = (timeout % 1000) * 1000; + cc = select(target_fd+1, &fds, NULL, NULL, &tv); + if (cc < 0) { + if (errno == EINTR) + continue; + return E_OS + E_UART_DRV_RECV; + } + break; + } + if (cc == 0) + return cc; + cc = read(target_fd, buf, size); + if (cc <= 0) + cc = E_OS + E_UART_DRV_RECV; + return cc; }