From 7c1290914960e89e2aba185e098eb36cc0d3ea42 Mon Sep 17 00:00:00 2001
From: midipix <writeonce@midipix.org>
Date: Tue, 26 Jun 2018 14:18:11 +0000
Subject: internals: added sfrt_dprintf(), a signal-resilient dprintf
 implementation.

---
 project/common.mk                  |  1 +
 project/headers.mk                 |  1 +
 src/internal/sofort_dprintf_impl.c | 56 ++++++++++++++++++++++++++++++++++++++
 src/internal/sofort_dprintf_impl.h |  6 ++++
 4 files changed, 64 insertions(+)
 create mode 100644 src/internal/sofort_dprintf_impl.c
 create mode 100644 src/internal/sofort_dprintf_impl.h

diff --git a/project/common.mk b/project/common.mk
index a46a3b0..8850308 100644
--- a/project/common.mk
+++ b/project/common.mk
@@ -10,6 +10,7 @@ API_SRCS = \
 	src/skin/sfrt_skin_default.c \
 
 INTERNAL_SRCS = \
+	src/internal/$(PACKAGE)_dprintf_impl.c \
 	src/internal/$(PACKAGE)_errinfo_impl.c \
 
 APP_SRCS = \
diff --git a/project/headers.mk b/project/headers.mk
index 60a7eb3..2f2512a 100644
--- a/project/headers.mk
+++ b/project/headers.mk
@@ -4,6 +4,7 @@ API_HEADERS = \
 
 INTERNAL_HEADERS = \
 	$(PROJECT_DIR)/src/internal/argv/argv.h \
+	$(PROJECT_DIR)/src/internal/$(PACKAGE)_dprintf_impl.h \
 	$(PROJECT_DIR)/src/internal/$(PACKAGE)_driver_impl.h \
 	$(PROJECT_DIR)/src/internal/$(PACKAGE)_errinfo_impl.h \
 
diff --git a/src/internal/sofort_dprintf_impl.c b/src/internal/sofort_dprintf_impl.c
new file mode 100644
index 0000000..01f1ee1
--- /dev/null
+++ b/src/internal/sofort_dprintf_impl.c
@@ -0,0 +1,56 @@
+#include <stdio.h>
+#include <stdarg.h>
+#include <stdlib.h>
+#include <unistd.h>
+#include <errno.h>
+
+int sfrt_dprintf(int fd, const char * fmt, ...)
+{
+	int	ret;
+	int	cnt;
+	int	size;
+	va_list	ap;
+	char *	ch;
+	char *	buf;
+	char	chbuf[2048];
+
+	va_start(ap,fmt);
+
+	size = sizeof(chbuf);
+	buf  = ((cnt = vsnprintf(chbuf,size,fmt,ap)) < size)
+		? chbuf : malloc(cnt + 1);
+
+	va_end(ap);
+
+	if (buf == chbuf) {
+		(void)0;
+
+	} else if (buf) {
+		va_start(ap,fmt);
+		vsprintf(buf,fmt,ap);
+		va_end(ap);
+
+	} else {
+		return -1;
+	}
+
+	ret = 0;
+	ch  = buf;
+
+	for (; cnt && ret>=0; ) {
+		ret = write(fd,ch,cnt);
+
+		while ((ret < 0) && (errno == EINTR))
+			ret = write(fd,ch,cnt);
+
+		ch  += ret;
+		cnt -= ret;
+	}
+
+	ret = (ret < 0) ? -1 : ch - buf;
+
+	if (buf != chbuf)
+		free(buf);
+
+	return ret;
+}
diff --git a/src/internal/sofort_dprintf_impl.h b/src/internal/sofort_dprintf_impl.h
new file mode 100644
index 0000000..bfcc4ca
--- /dev/null
+++ b/src/internal/sofort_dprintf_impl.h
@@ -0,0 +1,6 @@
+#ifndef SOFORT_DPRINTF_IMPL_H
+#define SOFORT_DPRINTF_IMPL_H
+
+int sfrt_dprintf(int fd, const char * fmt, ...);
+
+#endif
-- 
cgit v1.2.3