X-Git-Url: https://git.xandkar.net/?p=khatus.git;a=blobdiff_plain;f=x5%2Fkhatus_lib_sensor.c;fp=x5%2Fkhatus_lib_sensor.c;h=e3e2cb3ed9fb4adf97bd4852a2a4aebbb433b656;hp=0000000000000000000000000000000000000000;hb=55883d9a0ab2ca4956bda685c219557f8bd940f1;hpb=d03cabfe3c0e1d5f937318d653f5da01e1340b56

diff --git a/x5/khatus_lib_sensor.c b/x5/khatus_lib_sensor.c
new file mode 100644
index 0000000..e3e2cb3
--- /dev/null
+++ b/x5/khatus_lib_sensor.c
@@ -0,0 +1,54 @@
+#include <errno.h>
+#include <fcntl.h>
+#include <stdio.h>
+#include <stdlib.h>
+#include <string.h>
+#include <unistd.h>
+
+#include "khatus_lib_log.h"
+#include "khatus_lib_sensor.h"
+#include "khatus_lib_time.h"
+
+void
+loop(struct timespec *ti, char *fifo, char *buf, int fun(char *))
+{
+	int fd = -1;
+	int w  = -1;  /* written */
+	int r  = -1;  /* remaining */
+	int i  = -1;  /* buffer position */
+
+	for (;;) {
+		debug("openning \"%s\"\n", fifo);
+		fd = open(fifo, O_WRONLY);
+		if (fd < 0)
+			fatal("Failed to open FIFO file: \"%s\". Error: %s\n",
+			    fifo,
+			    strerror(errno));
+		debug("openned. fd: %d\n", fd);
+		r = fun(buf);
+		buf[r] = END_OF_MESSAGE;
+		for (i = 0; (w = write(fd, buf + i++, 1)) && r; r--)
+			;
+		if (w < 0)
+			switch (errno) {
+			case EPIPE:
+				error("Broken pipe. Msg buf: %s\n", buf);
+				break;
+			default:
+				fatal(
+				    "Failed to write to %s. "
+				    "Err num: %d, Err msg: %s\n",
+				    fifo,
+				    errno,
+				    strerror(errno));
+			}
+		if (close(fd) < 0)
+			fatal("Failed to close %s. Err num: %d, Err msg: %s\n",
+			    fifo,
+			    errno,
+			    strerror(errno));
+		fd = -1;
+		debug("closed. fd: %d\n", fd);
+		snooze(ti);
+	}
+}