ipClientConnector.c

#include "ipClientConnector.h"
#include <stdlib.h>
//socket:
//#include <sys/types.h>
#include <sys/socket.h>
//#include <errno.h>
#include <netinet/in.h>
#include <netdb.h>
#include <string.h>
#include <unistd.h>

#define CREATE_TCP 0
#define CREATE_UDP 1

//global variables
int _socket = -1;
unsigned char _ip[UNISASA_SIZE_IPV4];

union {
    unsigned int integer;
    unsigned char byte[256];
} converter;

void copyArray(unsigned char* src,unsigned char *dest,unsigned int len)
{
    int i=0;
    for(i=0;i<len;i++)
        dest[i]=src[i];
}

unsigned int discoverySockTCPImpl (discoveredDevice_t *devs)
{

    unsigned char message[256];
    
    message[0]= DISCOVERY;
    send(_socket,message,1,0);

    /*
     * 1 byte    sizeAddr   1 byte       
     * sizeAddr  |  addr  | sizeIOMsg | ...  
     *   (A)         (B)       (C)  
     *
     *    1 byte     sizeIDSen sizeIDSen   2 byte    1 byte     1 byte 
     * | sizeIDSen | num Sens | ID Sen | type Sen | size Out | type Out|
     *     (D)         (E)        (F)      (G)         (H)       (I)
     *
     *    1 byte     sizeIDAct sizeIDAct    2 byte    1 byte   1 byte
     * | sizeIDAct | num Acts | ID Act  | type Act | size In | type In |
     *    (J)         (K)         (L)        (M)        (N)       (O)  
     */

    
    recv(_socket,message,1,0); // (A) must be UNISASA_SIZE_IPV4, ipvUNISASA_SIZE_IPV4
    unsigned int sizeAddress = message[0];

    recv(_socket,message,sizeAddress,0); // (B)
    //copyArray(message,dev[0].address.byte,sizeAddress);
    //Use filedescriptor no IP
    devs[0].address.integer=_socket;
    
    recv(_socket,message,1,0); // (C)
    devs[0].sizeIODevice=message[0];

    recv(_socket,message,1,0); // (D)
    devs[0].sizeIDSensor=message[0];

    recv(_socket,message,devs[0].sizeIDSensor,0); // (E)
    converter.integer=0;
    copyArray(message,converter.byte,devs[0].sizeIDSensor);
    devs[0].numSensors=converter.integer;

    unsigned int s=0;
    for(s=0;s<devs[0].numSensors;s++)
    {
        recv(_socket,message,devs[0].sizeIDSensor,0); // (F)
        converter.integer=0;
        copyArray(message,converter.byte,devs[0].sizeIDSensor);
        devs[0].sensors[s].ID.integer=converter.integer;

        recv(_socket,message,SIZE_TYPE_SENSOR,0); // (G)
        converter.integer=0;
        copyArray(message,converter.byte,SIZE_TYPE_SENSOR);
        devs[0].sensors[s].typeSensor.integer=converter.integer;

        recv(_socket,message,1,0); // (H)
        devs[0].sensors[s].sizeOutput=message[0];

        recv(_socket,message,1,0); //(I)
        devs[0].sensors[s].typeOutput=message[0];
    }

    recv(_socket,message,1,0); // (J)
    devs[0].sizeIDActuator=message[0];

    recv(_socket,message,devs[0].sizeIDActuator,0); // (K)
    converter.integer=0;
    copyArray(message,converter.byte,devs[0].sizeIDActuator);
    devs[0].numActuators=converter.integer;

    unsigned int a=0;
    for(a=0;a<devs[0].numActuators;a++)
    {
        recv(_socket,message,devs[0].sizeIDSensor,0); // (L)
        converter.integer=0;
        copyArray(message,converter.byte,devs[0].sizeIDSensor);
        devs[0].sensors[a].ID.integer=converter.integer;

        recv(_socket,message,SIZE_TYPE_SENSOR,0); // (M)
        converter.integer=0;
        copyArray(message,converter.byte,SIZE_TYPE_SENSOR);
        devs[0].sensors[a].typeSensor.integer=converter.integer;

        recv(_socket,message,1,0); // (N)
        devs[0].sensors[a].sizeOutput=message[0];

        recv(_socket,message,1,0); //(O)
        devs[0].sensors[a].typeOutput=message[0];
    }
    
    return 1;

}

int checkDeviceSockTCPImpl ( unsigned char* addr)
{
    unsigned int ad = (addr[0] << 8) + addr[1];
    int check=0;
    if(ad == 35 || ad == 5 || ad == 500)
        check=1;
    return check;
}

void msgToDeviceSockTCPImpl (unsigned char* addr, unsigned char sizeData, unsigned char* data)
{
    unsigned char msg[256];
    
    converter.integer=0;
    copyArray(addr,converter.byte,UNISASA_SIZE_IPV4);
    unsigned int sockInt = converter.integer;
    msg[0] = MSG_TO_DEVICE;
    send(sockInt,msg,SIZE_OPERATION,0);
    send(sockInt,data,sizeData,0);
}

void msgAndAnswerToDeviceSockTCPImpl (unsigned char* addr, unsigned char sizeReqAns, unsigned char* request, unsigned char* answer)
{
    unsigned char msg[256];
    
    converter.integer=0;
    copyArray(addr,converter.byte,UNISASA_SIZE_IPV4);
    unsigned int sockInt = converter.integer;
    msg[0] = MSG_AND_ANSWER_TO_DEVICE;
    send(sockInt,msg,SIZE_OPERATION,0);
    send(sockInt,request,sizeReqAns,0);
    
    recv(sockInt,answer,sizeReqAns,0);
}

void getSensorValueSockTCPImpl (unsigned char* addr, unsigned char sizeIDSen, unsigned char* IDSen, unsigned char sizeValue, unsigned char* value)
{
    unsigned char msg[256];
    
    converter.integer=0;
    copyArray(addr,converter.byte,UNISASA_SIZE_IPV4);
    unsigned int sockInt = converter.integer;
    msg[0] = GET_SENSOR_VALUE;
    send(sockInt,msg,SIZE_OPERATION,0);
    send(sockInt,IDSen,sizeIDSen,0);
    
    recv(sockInt,value,sizeValue,0);
}

void setActuatorValueSockTCPImpl (unsigned char* addr, unsigned char sizeIDAct,unsigned char* IDAct, unsigned char sizeValue ,unsigned char* value)
{
    unsigned char msg[256];
    
    converter.integer=0;
    copyArray(addr,converter.byte,UNISASA_SIZE_IPV4);
    unsigned int sockInt = converter.integer;
    msg[0] = GET_SENSOR_VALUE;
    send(sockInt,msg,SIZE_OPERATION,0);
    send(sockInt,IDAct,sizeIDAct,0);
    send(sockInt,value,sizeValue,0);
}


connectorInterface_t createSocketClientConnector(const char *IP, unsigned int port, int typeSocket)
{

    struct sockaddr_in temp; 
    struct hostent *h;
  
    //Address Type
    temp.sin_family=AF_INET;
    temp.sin_port=htons(port);
    h=gethostbyname(IP);
    if (h==0) 
    {
      //printf("Gethostbyname failed\n");
      exit(1);
    }
    bcopy(h->h_addr,&temp.sin_addr,h->h_length);
    
    if(typeSocket == CREATE_TCP)
        _socket=socket(AF_INET,SOCK_STREAM,0);
    else // CREATE_UDP
        _socket=socket(AF_INET,SOCK_DGRAM,0);
    

    connect(_socket, (struct sockaddr*) &temp, sizeof(temp));

    
    connectorInterface_t conn;

    conn.name = "SocketTCPConnector";
    conn.sizeAddress = sizeof(int);
    conn.discovery = discoverySockTCPImpl;
    conn.checkDevice = checkDeviceSockTCPImpl;
    conn.msgToDevice = msgToDeviceSockTCPImpl;
    conn.msgAndAnswerToDevice = msgAndAnswerToDeviceSockTCPImpl;
    conn.getSensorValue = getSensorValueSockTCPImpl;
    conn.setActuatorValue = setActuatorValueSockTCPImpl;

    return conn;
}

connectorInterface_t createSocketClientTCPConnector(const char *IP, unsigned int port)
{
    return createSocketClientConnector(IP,port,CREATE_TCP);
}

connectorInterface_t createSocketClientUDPConnector(const char *IP, unsigned int port)
{
    return createSocketClientConnector(IP,port,CREATE_UDP);
}