simulationConnector.c

#include "simulationConnector.h"
#include <stdlib.h>

unsigned int _simulationConnectorSenValue_ = 0;

unsigned int discoveryStaticImpl (discoveredDevice_t *devs)
{

    // Device - 1 -
    
    devs[0].actuators[0].ID.integer=5;
    devs[0].actuators[0].typeActuator.integer=3;
    devs[0].actuators[0].sizeInput=4;
    devs[0].actuators[0].typeInput=2;
    
    devs[0].address.integer=35;
    devs[0].sizeIODevice=2;
    devs[0].sizeIDSensor=0;
    devs[0].numSensors=0;
    //devs[0].sensors;
    devs[0].sizeIDActuator=1;
    devs[0].numActuators=1;
    //devs[0].actuators;

    // Device - 2 -

    devs[1].sensors[0].ID.integer=5;
    devs[1].sensors[0].typeSensor.integer=3;
    devs[1].sensors[0].sizeOutput=1;
    devs[1].sensors[0].typeOutput=1;

    devs[1].sensors[1].ID.integer=7;
    devs[1].sensors[1].typeSensor.integer=4;
    devs[1].sensors[1].sizeOutput=1;
    devs[1].sensors[1].typeOutput=1;

    devs[1].actuators[0].ID.integer=10;
    devs[1].actuators[0].typeActuator.integer=1;
    devs[1].actuators[0].sizeInput=2;
    devs[1].actuators[0].typeInput=3;
    
    devs[1].address.integer = 5;
    devs[1].sizeIODevice = 2;
    devs[1].sizeIDSensor = 1;
    devs[1].numSensors = 2;
    //devs[1].sensors;
    devs[1].sizeIDActuator = 1;
    devs[1].numActuators = 1;
    //devs[1].actuators;

    // Device - 3 -

    devs[2].sensors[0].ID.integer=3;
    devs[2].sensors[0].typeSensor.integer=5;
    devs[2].sensors[0].sizeOutput=1;
    devs[2].sensors[0].typeOutput=1;

    devs[2].sensors[1].ID.integer=300;
    devs[2].sensors[1].typeSensor.integer=6;
    devs[2].sensors[1].sizeOutput=1;
    devs[2].sensors[1].typeOutput=1;

    devs[2].address.integer=500;
    devs[2].sizeIODevice=2;
    devs[2].sizeIDSensor=2;
    devs[2].numSensors=2;
    //devs[2].sensors;
    devs[2].sizeIDActuator=0;
    devs[2].numActuators=0;
    //devs[2].actuators;

    
    return 3;


}

int checkDeviceStaticImpl ( 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 msgToDeviceStaticImpl (unsigned char* addr, unsigned char sizeData, unsigned char* data)
{
    //Nothing
}

void msgAndAnswerToDeviceStaticImpl (unsigned char* addr, unsigned char sizeReqAns, unsigned char* request, unsigned char* answer)
{
    answer[0]=request[0];
    answer[1]= request[1] + 1;
}

void getSensorValueStaticImpl (unsigned char* addr, unsigned char sizeIDSen, unsigned char* IDSen, unsigned char sizeValue, unsigned char* value)
{
    _simulationConnectorSenValue_++;
    value[0] = _simulationConnectorSenValue_;
}

void setActuatorValueStaticImpl (unsigned char* addr, unsigned char sizeIDAct,unsigned char* IDAct, unsigned char sizeValue ,unsigned char* value)
{
    //Nothing
}


connectorInterface_t createStaticConnector()
{
    connectorInterface_t conn;

    conn.name = "StaticConnector";
    conn.sizeAddress = 2;
    conn.discovery = discoveryStaticImpl;
    conn.checkDevice = checkDeviceStaticImpl;
    conn.msgToDevice = msgToDeviceStaticImpl;
    conn.msgAndAnswerToDevice = msgAndAnswerToDeviceStaticImpl;
    conn.getSensorValue = getSensorValueStaticImpl;
    conn.setActuatorValue = setActuatorValueStaticImpl;

    return conn;
}