dameon: net: implement sending data.

Also, dropped some adhockery and rebased some code.

Signed-off-by: Gediminas Jakutis <gediminas@varciai.lt>

1 files changed, 73 insertions, 22 deletions

diff --git a/src/daemon/net.c b/src/daemon/net.c
index 9180344..29f1fde 100644
--- a/src/daemon/net.c
+++ b/src/daemon/net.c
@@ -45,10 +45,11 @@ struct netstate {
 	size_t bufsize;
 	unsigned int available;
 	int status;
-	pthread_mutex_t datamutex;
+	pthread_mutex_t mutex;
+	struct sockaddr_in clientaddr;
 };
 
-static pthread_mutex_t initmutex = PTHREAD_MUTEX_INITIALIZER;
+static pthread_mutex_t mutex = PTHREAD_MUTEX_INITIALIZER;
 static struct netstate *state;
 static ssize_t count;
 static size_t available_count;
@@ -63,7 +64,7 @@ int net_init(const unsigned short int port)
 	ssize_t i;
 	int sizechanged = 0;
 
-	pthread_mutex_lock(&initmutex);
+	pthread_mutex_lock(&mutex);
 	if (available_count) {
 		for (i = 0; !state[i].available; ++i) {
 			if (i == count) {
@@ -98,7 +99,7 @@ int net_init(const unsigned short int port)
 	memset(state[i].data, 0, MTU);
 	state[i].bufsize = MTU;
 	state[i].status = NONEWDATA;
-	pthread_mutex_init(&state[i].datamutex, NULL);
+	pthread_mutex_init(&state[i].mutex, NULL);
 
 	if (pthread_create(&state[i].listner, NULL, dolisten, state + i)) {
 		ret = ERROR;
@@ -111,7 +112,7 @@ out:
 		state = realloc(state, sizeof(struct netstate) * --count);
 	}
 
-	pthread_mutex_unlock(&initmutex);
+	pthread_mutex_unlock(&mutex);
 	return ret;
 }
 
@@ -119,7 +120,7 @@ int net_close(int nd)
 {
 	int ret;
 
-	pthread_mutex_lock(&initmutex);
+	pthread_mutex_lock(&mutex);
 	if (nd > count || nd < 1 || state[nd - 1].available) {
 		ret = ERROR;
 	} else {
@@ -132,7 +133,7 @@ int net_close(int nd)
 		ret = A_OK;
 	}
 
-	pthread_mutex_unlock(&initmutex);
+	pthread_mutex_unlock(&mutex);
 	return ret;
 }
 
@@ -158,14 +159,69 @@ out:
 	return ret;
 }
 
-static void *dolisten(void * state)
+int net_send(int nd, const char * const buf, size_t buf_size)
 {
+	int ret = A_OK;
+	ssize_t sent;
+	struct timespec now;
+
+	if (nd > count || nd < 1 || state[--nd].available) {
+		ret = ERROR;
+	} else {
+		if (setting_verbose() >= INFO) {
+			clock_gettime(CLOCK_MONOTONIC_RAW, &now);
+			fprintf(stderr, "Sending DATA, timestap: %li \n", now.tv_sec);
+		}
 
-	static const char servermagic[] = "I love coffee!";
-	static const char clientmagic[] = "I love tea!";
+		sent = sendto(	state[nd].sock, buf, buf_size, MSG_DONTWAIT,
+				(struct sockaddr *) &state[nd].clientaddr,
+				sizeof(state[nd].clientaddr));
+
+		if (sent == -1) {
+			ret = DEAD;
+			if (setting_verbose() >= ERR) {
+				fprintf(stderr, "Sending packet to %s failed.\n", inet_ntoa(state[nd].clientaddr.sin_addr));
+			}
+		}
+	}
+
+	return ret;
+}
+
+int net_send_addr(int nd, const char * const buf, size_t buf_size, const struct sockaddr_in * const addr)
+{
+	int ret = A_OK;
+	ssize_t sent;
+	struct timespec now;
+
+
+	if (nd > count || nd < 1 || state[--nd].available) {
+		ret = ERROR;
+	} else {
+		if (setting_verbose() >= INFO) {
+			clock_gettime(CLOCK_MONOTONIC_RAW, &now);
+			fprintf(stderr, "Sending DATA, timestap: %li \n", now.tv_sec);
+		}
+
+		sent = sendto(	state[nd].sock, buf, buf_size, MSG_DONTWAIT,
+				(struct sockaddr *) addr,
+				sizeof(*addr));
+
+		if (sent == -1) {
+			ret = DEAD;
+			if (setting_verbose() >= ERR) {
+				fprintf(stderr, "Sending packet to %s failed.\n", inet_ntoa(addr->sin_addr));
+			}
+		}
+	}
+
+	return ret;
+}
+
+static void *dolisten(void * state)
+{
 	struct timespec now;
 	struct timespec wait = {0, 10 * 1000 * 1000}; /* 10 ms */
-	struct sockaddr_in clientaddr;
 	struct netstate *st;
 	ssize_t recvbufsize;
 	int cancelstate;
@@ -176,17 +232,12 @@ static void *dolisten(void * state)
 
 	do {
 		pthread_setcancelstate(PTHREAD_CANCEL_DISABLE, &cancelstate);
-		pthread_mutex_lock(&st->datamutex);
+		pthread_mutex_lock(&st->mutex);
 		clock_gettime(CLOCK_MONOTONIC_RAW, &now);
-		st->status = getpacket(st->data, st->bufsize, &recvbufsize, st->sock, &clientaddr);
+		st->status = getpacket(st->data, st->bufsize, &recvbufsize, st->sock, &st->clientaddr);
 
 		if (!st->status) {
 			st->lastreply = now;
-			if (st->data[0] == 'I' && !(strcmp(st->data, servermagic))) {
-				sendto(st->sock, clientmagic, sizeof(clientmagic),
-					MSG_DONTWAIT, (struct sockaddr *) &clientaddr, sizeof(clientaddr));
-				setting_verbose() ? fprintf(stderr, "Sending DATA, timestap: %li \n", st->lastreply.tv_sec) : 0;
-			}
 		}
 
 		/* no packets in five seconds */
@@ -201,13 +252,13 @@ static void *dolisten(void * state)
 			oldstatus = st->status;
 			if(st->status == DEAD) {
 				/* this timestamp is arbitraty */
-				setting_verbose() ? fprintf(stderr, "Connection with the client has been lost. Last reply since: %li \n", st->lastreply.tv_sec) : 0;
+				setting_verbose() >= INFO ? fprintf(stderr, "Connection with the client has been lost. Last reply since: %li \n", st->lastreply.tv_sec) : 0;
 			} else {
-				ipstring = inet_ntoa(clientaddr.sin_addr);
-				setting_verbose() ? fprintf(stderr, "Successful incoming connection from %s\n", ipstring) : 0;
+				ipstring = inet_ntoa(st->clientaddr.sin_addr);
+				setting_verbose() >= INFO ? fprintf(stderr, "Successful incoming connection from %s\n", ipstring) : 0;
 			}
 		}
-		pthread_mutex_unlock(&st->datamutex);
+		pthread_mutex_unlock(&st->mutex);
 		pthread_setcancelstate(PTHREAD_CANCEL_ENABLE, &cancelstate);
 		pthread_testcancel();