Protocol: attempted to fix stupids.

Signed-off-by: Ramūnas Mažeikis <ramunasnezinomas@gmail.com>

1 files changed, 25 insertions, 0 deletions

diff --git a/src/device/udp.c b/src/device/udp.c
new file mode 100644
index 0000000..b88f314
--- /dev/null
+++ b/src/device/udp.c
@@ -0,0 +1,25 @@
+#include "udp.h"
+#include <ESP8266WiFi.h>
+#include <WiFiUdp.h>
+
+static char udppacketbuffer[32] = {0};
+static char *udppacketcursor = NULL;
+
+void udp_init_packet(IPAddress ip, const int port)
+{
+	Udp.beginPacket(ip, port);
+	memset(udppacketbuffer, 0, sizeof(udppacketbuffer));
+	udppacketcursor = udppacketbuffer;
+}
+
+void udp_push(const void * const data, const size_t size)
+{
+	memcpy(udppacketcursor, data, size);
+	udppacketcursor += size;
+}
+
+int udp_flush(void)
+{
+	Udp.write((const uint8_t *) udppacketbuffer, udppacketcursor - udppacketbuffer);
+	return Udp.endPacket();
+}