From 13ddd88c8990a76741bae1834d8a5043c3effea5 Mon Sep 17 00:00:00 2001
From: =?UTF-8?q?Florian=20M=C3=A4rkl?= <info@florianmaerkl.de>
Date: Fri, 14 Jun 2019 13:18:40 +0200
Subject: [PATCH] Implement Discovery Thread

---
 lib/src/discovery.c | 33 ++++++++++++++++++++++++++++++++-
 1 file changed, 32 insertions(+), 1 deletion(-)

diff --git a/lib/src/discovery.c b/lib/src/discovery.c
index b94b43e..2fc4979 100644
--- a/lib/src/discovery.c
+++ b/lib/src/discovery.c
@@ -144,8 +144,39 @@ CHIAKI_EXPORT ChiakiErrorCode chiaki_discovery_thread_stop(ChiakiDiscoveryThread
 static void *discovery_thread_func(void *user)
 {
 	ChiakiDiscoveryThread *thread = user;
+	ChiakiDiscovery *discovery = thread->discovery;
 
-	// TODO
+	while(1)
+	{
+		ChiakiErrorCode err = chiaki_stop_pipe_select_single(&thread->stop_pipe, discovery->socket, NULL);
+		if(err == CHIAKI_ERR_CANCELED)
+			break;
+		if(err != CHIAKI_ERR_SUCCESS)
+		{
+			CHIAKI_LOGE(discovery->log, "Discovery thread failed to select\n");
+			break;
+		}
+
+		char buf[512];
+		struct sockaddr client_addr;
+		socklen_t client_addr_size = sizeof(client_addr);
+		ssize_t n = recvfrom(discovery->socket, buf, sizeof(buf) - 1, 0, &client_addr, &client_addr_size);
+		if(n < 0)
+		{
+			CHIAKI_LOGE(discovery->log, "Discovery thread failed to read from socket\n");
+			break;
+		}
+
+		if(n == 0)
+			continue;
+
+		if(n > sizeof(buf) - 1)
+			n = sizeof(buf) - 1;
+
+		buf[n] = '\00';
+
+		CHIAKI_LOGD(discovery->log, "Discovery received:\n%s\n", buf);
+	}
 
 	return NULL;
 }
\ No newline at end of file