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;

}