X-Git-Url: http://www.dolda2000.com/gitweb/?a=blobdiff_plain;f=lib%2Fmtio.c;h=4211996eb698b2e69ba1c9d82f387d61e73c3515;hb=f2df7a1b1aeeb0cec2309aeb62fae051fd3c687c;hp=2a463690be8e7c8d67c195f85b535c32e39e7173;hpb=83723896cdbe2fb064748e45611e9b9c829c1d72;p=ashd.git

diff --git a/lib/mtio.c b/lib/mtio.c
index 2a46369..4211996 100644
--- a/lib/mtio.c
+++ b/lib/mtio.c
@@ -17,11 +17,14 @@
 */
 
 #include <stdlib.h>
+#include <stdio.h>
+#include <fcntl.h>
 #include <unistd.h>
 #include <string.h>
 #include <time.h>
 #include <errno.h>
 #include <sys/select.h>
+#include <sys/socket.h>
 
 #ifdef HAVE_CONFIG_H
 #include <config.h>
@@ -63,6 +66,7 @@ int block(int fd, int ev, time_t to)
 	bl->p->n = bl->n;
     if(bl == blockers)
 	blockers = bl->n;
+    free(bl);
     return(rv);
 }
 
@@ -115,10 +119,108 @@ void ioloop(void)
 		ev |= EV_WRITE;
 	    if(FD_ISSET(bl->fd, &efds))
 		ev = -1;
-	    if(ev != 0)
+	    if((ev < 0) || (ev & bl->ev))
 		resume(bl->th, ev);
 	    else if((bl->to != 0) && (bl->to <= now))
 		resume(bl->th, 0);
 	}
     }
 }
+
+struct stdiofd {
+    int fd;
+    int sock;
+    int timeout;
+};
+
+static ssize_t mtread(void *cookie, char *buf, size_t len)
+{
+    struct stdiofd *d = cookie;
+    int ev;
+    ssize_t ret;
+    
+    while(1) {
+	ret = read(d->fd, buf, len);
+	if((ret < 0) && (errno == EAGAIN)) {
+	    ev = block(d->fd, EV_READ, d->timeout);
+	    if(ev < 0) {
+		/* If we just go on, we should get the real error. */
+		continue;
+	    } else if(ev == 0) {
+		errno = ETIMEDOUT;
+		return(-1);
+	    } else {
+		continue;
+	    }
+	} else {
+	    return(ret);
+	}
+    }
+}
+
+static ssize_t mtwrite(void *cookie, const char *buf, size_t len)
+{
+    struct stdiofd *d = cookie;
+    int ev;
+    size_t off;
+    ssize_t ret;
+    
+    off = 0;
+    while(off < len) {
+	if(d->sock)
+	    ret = send(d->fd, buf + off, len - off, MSG_DONTWAIT | MSG_NOSIGNAL);
+	else
+	    ret = write(d->fd, buf + off, len - off);
+	if(ret < 0) {
+	    if(errno == EAGAIN) {
+		ev = block(d->fd, EV_WRITE, d->timeout);
+		if(ev < 0) {
+		    /* If we just go on, we should get the real error. */
+		    continue;
+		} else if(ev == 0) {
+		    errno = ETIMEDOUT;
+		    return(off);
+		} else {
+		    continue;
+		}
+	    } else {
+		return(off);
+	    }
+	} else {
+	    off += ret;
+	}
+    }
+    return(off);
+}
+
+static int mtclose(void *cookie)
+{
+    struct stdiofd *d = cookie;
+    
+    close(d->fd);
+    free(d);
+    return(0);
+}
+
+static cookie_io_functions_t iofuns = {
+    .read = mtread,
+    .write = mtwrite,
+    .close = mtclose,
+};
+
+FILE *mtstdopen(int fd, int issock, int timeout, char *mode)
+{
+    struct stdiofd *d;
+    FILE *ret;
+    
+    omalloc(d);
+    d->fd = fd;
+    d->sock = issock;
+    d->timeout = timeout;
+    ret = fopencookie(d, mode, iofuns);
+    if(!ret)
+	free(d);
+    else
+	fcntl(fd, F_SETFL, fcntl(fd, F_GETFL) | O_NONBLOCK);
+    return(ret);
+}