EPSIAE » eneraptor

/*

 * hci_comm_listener.c

 *

 * 2011, Aleksander Besir (alex.besir@gmail.com)

 *

 */

#include "hci_comm.h"

#include <sys/types.h>

#include <sys/socket.h>

#include <netinet/in.h>

#include <arpa/inet.h>

#include <stdio.h>

#include <stdlib.h>

#include <string.h>

#include <unistd.h>

int listenTo(unsigned short int portNum) {

	// Buffer

	char *requestBuffer = malloc(HCI_COMM_REQUEST_BUFFER_SIZE * sizeof(char));

	if(requestBuffer == NULL) {

		fprintf(stderr,"HCI comm error: Cannot allocate buffer.\n");

		return HCI_COMM_ERR_BUF_ALOC_FAIL;

	}

	// Socket holder

	int socketHolder = socket(PF_INET, SOCK_STREAM, IPPROTO_TCP);

	if(socketHolder < 0) {

		fprintf(stderr,"HCI comm error: Cannot create a new socket.\n");

		return HCI_COMM_ERR_NEW_SOCKET_FAIL;

	}

	// Socket address holder

	struct sockaddr_in socketAddressHolder;

	memset(&socketAddressHolder, 0, sizeof(socketAddressHolder));

	socketAddressHolder.sin_family      = AF_INET;

    	socketAddressHolder.sin_port        = htons(portNum);

    	socketAddressHolder.sin_addr.s_addr = INADDR_ANY;

	// Bind socket to port

	int bindingResult = bind(socketHolder,(struct sockaddr *)&socketAddressHolder, sizeof(socketAddressHolder));

	if(bindingResult == -1) {

		fprintf(stderr,"HCI comm error: Cannot bind socket to port %d.\n",portNum);

		close(socketHolder);

		return HCI_COMM_ERR_BIND_FAIL;

	}

	// Listen to port

	int listenResult = listen(socketHolder, 10);

	if(listenResult == -1) {

		fprintf(stderr,"HCI comm error: Cannot listen to port %d.\n",portNum);

		close(socketHolder);

		return HCI_COMM_ERR_LISTEN_FAIL;

	}

	// Infinite listening

	while(1) {

		// Accept request

		int connectionHolder = accept(socketHolder,NULL,NULL);

		if(connectionHolder < 0) {

			fprintf(stderr,"HCI comm error: Error accepting request.\n");

			close(socketHolder);

			return HCI_COMM_ERR_ACCEPT_FAIL;

		}

		// Read request

		int readResult = read(connectionHolder,requestBuffer,HCI_COMM_REQUEST_BUFFER_SIZE);

		if(readResult < 0) {

			fprintf(stderr,"HCI comm error: Error reading request.\n");

			close(socketHolder);

			return HCI_COMM_ERR_READ_FAIL;

		}

		// Create a response

		char *hciResponse = "Works!"; // TODO

		int responseLength = 6; // TODO

		// Check if logic wants to terminate the infinite loop

		if(responseLength == HCI_COMM_TERMINATE) {

			break;

		}

		// Send response

		int writeResult = write(connectionHolder,hciResponse,responseLength);

		if(writeResult < 0) {

			fprintf(stderr,"HCI comm error: Error writting response.\n");

			close(socketHolder);

			return HCI_COMM_ERR_WRITE_FAIL;

		}

	}

	// Terminate

	close(socketHolder);

	free(requestBuffer);

	requestBuffer = NULL;

	return HCI_COMM_TERMINATED_BY_LOGIC;

}