/*
 ============================================================================
 Name        : opcuaServer.c
 Author      :
 Version     :
 Copyright   : Your copyright notice
 Description :
 ============================================================================
 */

#include <stdio.h>
#include <stdlib.h>
#include <memory.h> // bzero

#include "opcua.h"
#include "opcua_transportLayer.h"

#ifdef LINUX

#include <sys/types.h>
#include <sys/socket.h>
#include <netinet/in.h>
#include <sys/socketvar.h>

void server_init();
void server_run();

#endif

#define PORT    16664
#define MAXMSG  512
#define BUFFER_SIZE 8192

int main(void) {

#ifdef LINUX
	server_init();
	server_run();
#endif

	return EXIT_SUCCESS;

}

#ifdef LINUX

void server_init() {
	printf("Starting open62541 demo server on port %d\n", PORT);
	//call listen

}

void server_run() {
	UA_connection connection;

	UA_ByteString slMessage = { -1, UA_NULL };

	int optval = 1;
	int sockfd, newsockfd, portno, clilen;
	char buffer[BUFFER_SIZE];
	struct sockaddr_in serv_addr, cli_addr;
	int n;

	TL_initConnectionObject(&connection);
	SL_initConnectionObject(&connection);

	/* First call to socket() function */
	// sockfd = socket(AF_INET, SOCK_STREAM, 0);
	sockfd = socket(PF_INET, SOCK_STREAM, 0);
	if (sockfd < 0) {
		perror("ERROR opening socket");
		exit(1);
	}

	/* Initialize socket structure */
	bzero((void *) &serv_addr, sizeof(serv_addr));
	portno = PORT;
	serv_addr.sin_family = AF_INET;
	serv_addr.sin_addr.s_addr = INADDR_ANY;
	serv_addr.sin_port = htons(portno);

	if (setsockopt(sockfd, SOL_SOCKET, SO_REUSEADDR, &optval, sizeof optval)
			== -1) {
		perror("setsockopt");
		exit(1);
	}
	/* Now bind the host address using bind() call.*/
	if (bind(sockfd, (struct sockaddr *) &serv_addr, sizeof(serv_addr)) < 0) {
		perror("ERROR on binding");
		exit(1);
	}

	/* Now start listening for the clients, here process will
	 * go in sleep mode and will wait for the incoming connection
	 */
	listen(sockfd, 5);
	clilen = sizeof(cli_addr);

	/* Accept actual connection from the client */
	while (1) {
		newsockfd = accept(sockfd, (struct sockaddr *) &cli_addr, &clilen);
		if (newsockfd < 0) {
			perror("ERROR on accept");
			exit(1);
		}

		printf("One connection accepted\n");
		while (connection.transportLayer.connectionState != connectionState_CLOSE) {
			/* If connection is established then start communicating */
			bzero(buffer, BUFFER_SIZE);

			n = read(newsockfd, buffer, BUFFER_SIZE);

			if (n > 0) {
				connection.readData.data = buffer;
				connection.readData.length = n;
				connection.newDataToRead = 1;
				UA_ByteString_printx("server_run - received=",
						&connection.readData);

				//TL_receive(&connection, &slMessage);
				SL_receive(&connection, &slMessage);
			} else if (n < 0) {
				perror("ERROR reading from socket1");
				exit(1);
			}

			if (connection.newDataToWrite) {
				UA_ByteString_printx("Send data:", &connection.writeData);
				n = write(newsockfd, connection.writeData.data,
						connection.writeData.length);
				printf("written %d bytes \n", n);
				connection.newDataToWrite = 0;
				UA_ByteString_deleteMembers(&connection.writeData);

				connection.writeData.data = NULL;
				connection.writeData.length = 0;
			}

			connection.readData.data = NULL;
			connection.readData.length = 0;
			connection.newDataToRead = 0;
		}
		close(newsockfd);
		connection.transportLayer.connectionState = connectionState_CLOSED;
	}
}

#endif