ParameterConfiguration.cpp

Go to the documentation of this file.

#include "ParameterConfiguration.h"

ParameterConfiguration::ParameterConfiguration()
{
    read();

    switch(m_itsGnLocalAddrConfMethod)
    {
    case itsGnLocalAddrConfMethod_managed:
    {
        QString randomHex;
        for(int i = 0; i < 12; i++)
        {
            int n = qrand() % 16;
            randomHex.append(QString::number(n,16));

            if(i%2)
                randomHex.append(":");
        }
        int last = -1;
        sscanf(randomHex.toStdString().c_str(), "%hhx:%hhx:%hhx:%hhx:%hhx:%hhx%n",
               m_mid + 0, m_mid + 1, m_mid + 2, m_mid + 3, m_mid + 4, m_mid + 5, &last);

        m_mid[0] &= 0xFC;
        m_mid[0] |= 0x02;

        break;
    }
    case itsGnLocalAddrConfMethod_anonymous:
    case itsGnLocalAddrConfMethod_auto:
    default:
        getMacAddr();
        break;
    }
    //readDebug();
}

ParameterConfiguration::~ParameterConfiguration()
{/*
    if(m_energyStorageType.buf != 0)
        free(m_energyStorageType.buf);
    if(m_positionOfPillars.list.array != 0)
    {
        for(int i = 0; i< m_positionOfPillars.list.count; i++)
            free(m_positionOfPillars.list.array[i]);
        free(m_positionOfPillars.list.array);
    }*/
}

void ParameterConfiguration::getMacAddr()
{
    m_itsGnLocalAddrConfMethod = itsGnLocalAddrConfMethod_auto;
    foreach(QNetworkInterface netInterface, QNetworkInterface::allInterfaces())
    {
        // Return only the first non-loopback MAC Address
        if (!(netInterface.flags() & QNetworkInterface::IsLoopBack))
        {
            int last = -1;
            int rc = sscanf(netInterface.hardwareAddress().toStdString().c_str(), "%hhx:%hhx:%hhx:%hhx:%hhx:%hhx%n",
                            m_mid + 0, m_mid + 1, m_mid + 2, m_mid + 3, m_mid + 4, m_mid + 5, &last);
            if(rc != 6 || netInterface.hardwareAddress().toStdString().size() > (unsigned int)last)
                fprintf(stderr, "invalid mac address format %s", netInterface.hardwareAddress().toStdString().c_str());
            printf("hardwareaddress : %s\n",netInterface.hardwareAddress().toStdString().c_str());
        }
    }
}

void ParameterConfiguration::updateMID(uchar* mid)
{
    for(int i = 0; i < 6; i++)
        m_mid[i] = mid[i];
}

void ParameterConfiguration::read()
{
    cfg_opt_t vehicleLength_opts[] =
    {
        CFG_INT("vehicleLengthConfidence", VehicleLengthConfidenceIndication_unavailable, CFGF_NONE),
        CFG_INT("vehicleLengthValue", VehicleLengthValue_unavailable, CFGF_NONE),
        CFG_END()
    };
    cfg_opt_t trafficClass_opts[] =
    {
        CFG_INT("storeCarryForward", 0, CFGF_NONE),
        CFG_INT("channelOffload", 0, CFGF_NONE),
        CFG_INT("trafficClassID", TrafficClass::trafficClassID_otherDataTraffic, CFGF_NONE),
        CFG_END()
    };

    cfg_opt_t opts[] =
    {
        CFG_STR("interface", "eth0", CFGF_NONE),
        CFG_INT("countryCode", 208, CFGF_NONE),
        CFG_BOOL("itsGnGeoAreaLineForwarding", cfg_true, CFGF_NONE),
        CFG_INT("itsGnGeoBroadcastForwardingAlgorithm", itsGnGeoBroadcastForwardingAlgorithm_advanced, CFGF_NONE),
        CFG_INT("itsGnGeoUnicastForwardingAlgorithm", itsGnGeoUnicastForwardingAlgorithm_greedy, CFGF_NONE),
        CFG_INT("itsGnLocalAddrConfMethod", itsGnLocalAddrConfMethod_default, CFGF_NONE),
        CFG_BOOL("itsGnSecurity", cfg_false, CFGF_NONE),

        CFG_BOOL_LIST("energyStorageType", "{false, false, false, false, false, false, false}", CFGF_NONE),
        CFG_INT("heightLonCarrLeft", HeightLonCarr_unavailable, CFGF_NONE),
        CFG_INT("heightLonCarrRight", HeightLonCarr_unavailable, CFGF_NONE),
        CFG_INT("posCentMass", PosCentMass_unavailable, CFGF_NONE),
        CFG_INT("posFrontAx", PosFrontAx_unavailable, CFGF_NONE),

        CFG_INT_LIST("positionOfPillars", "{30}", CFGF_NONE),

        CFG_INT("posLonCarrLeft", PosLonCarr_unavailable, CFGF_NONE),
        CFG_INT("posLonCarrRight", PosLonCarr_unavailable, CFGF_NONE),
        CFG_SEC("trafficClass",trafficClass_opts, CFGF_NO_TITLE_DUPES),
        CFG_INT("turningRadius", TurningRadius_unavailable, CFGF_NONE),
        CFG_SEC("vehicleLength", vehicleLength_opts, CFGF_NO_TITLE_DUPES),
        CFG_INT("vehicleMass", VehicleMass_unavailable, CFGF_NONE),
        CFG_INT("vehicleWidth", VehicleWidth_unavailable, CFGF_NONE),
        CFG_INT("wheelBaseVehicle", WheelBaseVehicle_unavailable, CFGF_NONE),

        CFG_INT("maxRepetitionAdvancedContention", 3, CFGF_NONE),

        CFG_END()
    };

    m_posPillar = (PosPillar_t**)calloc(3, sizeof *m_posPillar);
    for(int i = 0 ; i < 3 ; i++)
        m_posPillar[i] = (PosPillar_t*)calloc(1, sizeof *m_posPillar[i]);
    cfg_t *cfg;
    cfg_t *cfg_vehicleLength;
    cfg_t *cfg_trafficClass;

    cfg = cfg_init(opts, CFGF_NONE);

    cfg_vehicleLength = cfg_getsec(cfg, "vehicleLength");
    cfg_trafficClass = cfg_getsec(cfg, "trafficClass");

    cfg_set_validate_func(cfg, "countryCode", validate_unsigned_int);
    cfg_set_validate_func(cfg, "itsGnGeoBroadcastForwardingAlgorithm", validate_unsigned_int);
    cfg_set_validate_func(cfg, "itsGnGeoUnicastForwardingAlgorithm", validate_unsigned_int);
    cfg_set_validate_func(cfg, "itsGnLocalAddrConfMethod", validate_unsigned_int);
    cfg_set_validate_func(cfg, "heightLonCarrLeft", validate_unsigned_int);
    cfg_set_validate_func(cfg, "heightLonCarrRight", validate_unsigned_int);
    cfg_set_validate_func(cfg, "posCentMass", validate_unsigned_int);
    cfg_set_validate_func(cfg, "posFrontAx", validate_unsigned_int);
    cfg_set_validate_func(cfg, "positionOfPillars", validate_unsigned_int);
    cfg_set_validate_func(cfg, "posLonCarrLeft", validate_unsigned_int);
    cfg_set_validate_func(cfg, "posLonCarrRight", validate_unsigned_int);
        cfg_set_validate_func(cfg_trafficClass, "storeCarryForward", validate_unsigned_int);
        cfg_set_validate_func(cfg_trafficClass, "channelOffload", validate_unsigned_int);
        cfg_set_validate_func(cfg_trafficClass, "trafficClassID", validate_unsigned_int);
    cfg_set_validate_func(cfg, "turningRadius", validate_unsigned_int);
        cfg_set_validate_func(cfg_vehicleLength, "vehicleLengthConfidence", validate_unsigned_int);
        cfg_set_validate_func(cfg_vehicleLength, "vehicleLengthValue", validate_unsigned_int);
    cfg_set_validate_func(cfg, "vehicleMass", validate_unsigned_int);
    cfg_set_validate_func(cfg, "vehicleWidth", validate_unsigned_int);
    cfg_set_validate_func(cfg, "wheelBaseVehicle", validate_unsigned_int);

    cfg_set_validate_func(cfg, "maxRepetitionAdvancedContention", validate_unsigned_int);

    cfg_add_searchpath(cfg, "/etc/its/config");
    if(cfg_parse(cfg, "system.conf") == CFG_PARSE_ERROR)
        printf("PARSE_ERROR\n");

    m_interface = cfg_getstr(cfg, "interface");
    m_countryCode = cfg_getint(cfg, "countryCode");
    m_itsGnGeoAreaLineForwarding = cfg_getbool(cfg, "itsGnGeoAreaLineForwarding");
    m_itsGnGeoBroadcastForwardingAlgorithm = cfg_getint(cfg, "itsGnGeoBroadcastForwardingAlgorithm");
    m_itsGnGeoUnicastForwardingAlgorithm = cfg_getint(cfg, "itsGnGeoUnicastForwardingAlgorithm");
    m_itsGnLocalAddrConfMethod = cfg_getint(cfg, "itsGnLocalAddrConfMethod");
    m_itsGnSecurity = cfg_getbool(cfg, "itsGnSecurity");

    m_energyStorageType = makeBitString(cfg_size(cfg, "energyStorageType") ,cfg, "energyStorageType");
    m_heightLonCarrLeft = cfg_getint(cfg, "heightLonCarrLeft");
    m_heightLonCarrRight = cfg_getint(cfg, "heightLonCarrRight");
    m_posCentMass = cfg_getint(cfg, "posCentMass");
    m_posFrontAx = cfg_getint(cfg, "posFrontAx");

    memset(&m_positionOfPillars, 0, sizeof m_positionOfPillars);
    for(uint i=0; i < cfg_size(cfg, "positionOfPillars"); i++)
    {
        *m_posPillar[i] = cfg_getnint(cfg, "positionOfPillars", i);
    }
    m_positionOfPillars.list.array = (PosPillar_t**) calloc (1, sizeof * m_positionOfPillars.list.array);
    m_positionOfPillars.list.count = 0;
    m_positionOfPillars.list.size = 0;
    m_positionOfPillars.list.free = 0;
    for(uint i=0; i<cfg_size(cfg, "positionOfPillars"); i++)
    {
        m_positionOfPillars.list.array[i] = (PosPillar_t*)calloc(1,sizeof * m_positionOfPillars.list.array[i]);
        ASN_SEQUENCE_ADD(&m_positionOfPillars, m_posPillar[i]);
        //m_positionOfPillars.list.array[i] = m_posPillar[i];
    }
    asn_fprint(NULL, &asn_DEF_PositionOfPillars, &m_positionOfPillars);

    m_posLonCarrLeft = cfg_getint(cfg, "posLonCarrLeft");
    m_posLonCarrRight = cfg_getint(cfg, "posLonCarrRight");
        quint8 SCF_tmp = cfg_getint(cfg_trafficClass, "storeCarryForward");
        quint8 channelOffload_tmp = cfg_getint(cfg_trafficClass, "channelOffload");
        quint8 TCID_tmp = cfg_getint(cfg_trafficClass, "trafficClassID");
    m_trafficClass = TrafficClass(SCF_tmp, channelOffload_tmp, TCID_tmp);
    m_turningRadius = cfg_getint(cfg, "turningRadius");
    m_vehicleLength.vehicleLengthConfidenceIndication = cfg_getint(cfg_vehicleLength, "vehicleLengthConfidence");
    m_vehicleLength.vehicleLengthValue = cfg_getint(cfg_vehicleLength, "vehicleLengthValue");
    m_vehicleMass = cfg_getint(cfg, "vehicleMass");
    m_vehicleWidth = cfg_getint(cfg, "vehicleWidth");
    m_wheelBaseVehicle = cfg_getint(cfg, "wheelBaseVehicle");

    m_maxRepetitionAdvancedContention = cfg_getint(cfg, "maxRepetitionAdvancedContention");

    cfg_free(cfg);

    //readDebug();
}

void ParameterConfiguration::readDebug()
{
    printf("-----------------------------------------------------------------\n\t\tReadConf\n\n");
    printf("mac addr : ");
    int h;
    for(h=0; h<5; h++)
        printf("%02x:",m_mid[h]);
    printf("%02x",m_mid[h]);
    printf("\n\n");
    printf("interface = %s\n\n", m_interface.toStdString().c_str());
    printf("countryCode = %ld\n\n", m_countryCode);
    printf("itsGnGeoAreaLineForwarding = %d\n\n", m_itsGnGeoAreaLineForwarding);
    printf("itsGnGeoBroadcastForwardingAlgorithm = %d\n\n", m_itsGnGeoBroadcastForwardingAlgorithm);
    printf("itsGnGeoUnicastForwardingAlgorithm = %d\n\n", m_itsGnGeoUnicastForwardingAlgorithm);
    printf("itsGnLocalAddrConfMethod = %d\n\n", m_itsGnLocalAddrConfMethod);
    printf("itsGnSecurity = %d\n\n", m_itsGnSecurity);

    printf("energyStorageType = %s\n\n", printBitString(m_energyStorageType).toStdString().c_str());
    printf("heightLonCarrLeft = %ld\n\n", m_heightLonCarrLeft);
    printf("heightLonCarrRight = %ld\n\n", m_heightLonCarrRight);
    printf("posCentMass = %ld\n\n", m_posCentMass);
    printf("posFrontAx = %ld\n\n", m_posFrontAx);

    printf("positionOfPillars : {");
    int i;
    for(i = 0; i < m_positionOfPillars.list.count-1; i++)
        printf("%ld, ", *m_positionOfPillars.list.array[i]);
    printf("%ld}\n\n", *m_positionOfPillars.list.array[i]);

    printf("posLonCarrLeft = %ld\n\n", m_posLonCarrLeft);
    printf("posLonCarrRight = %ld\n\n", m_posLonCarrRight);
    printf("trafficClass\n{\n\tstoreCarryForward = %d\n\n\tchannelOffload = %d\n\n\ttrafficClassID = %d\n}\n\n", m_trafficClass.SCF() ,m_trafficClass.channelOffload(), m_trafficClass.TCID());
    printf("turningRadius = %ld\n\n", m_turningRadius);
    printf("vehicleLength\n{\n\tvehicleLengthConfidence = %ld\n\n\tvehicleLengthValue = %ld\n}\n\n", m_vehicleLength.vehicleLengthConfidenceIndication, m_vehicleLength.vehicleLengthValue);
    printf("vehicleMass = %ld\n\n", m_vehicleMass);
    printf("vehicleWidth = %ld\n\n", m_vehicleWidth);
    printf("wheelBaseVehicle = %ld\n\n", m_wheelBaseVehicle);

    printf("maxRepetitionAdvancedContention = %d\n\n", m_maxRepetitionAdvancedContention);
}

PosPillar_t ParameterConfiguration::positionOfPillars(int i) const
{
    if(i<m_positionOfPillars.list.count)
        return  *m_positionOfPillars.list.array[i];
    else
        return PosPillar_unavailable;
}

ParameterConfiguration& ParameterConfiguration::operator=(const ParameterConfiguration& other)
{
    memcpy(this->m_mid, other.m_mid, 6);
    this->m_interface = other.m_interface;
    this->m_countryCode = other.m_countryCode;
    this->m_itsGnGeoAreaLineForwarding = other.itsGnGeoAreaLineForwarding();
    this->m_itsGnGeoBroadcastForwardingAlgorithm = other.m_itsGnGeoBroadcastForwardingAlgorithm;
    this->m_itsGnGeoUnicastForwardingAlgorithm = other.m_itsGnGeoUnicastForwardingAlgorithm;
    this->m_itsGnLocalAddrConfMethod = other.m_itsGnLocalAddrConfMethod;
    this->m_itsGnSecurity = other.m_itsGnSecurity;

    this->m_energyStorageType = other.m_energyStorageType;
    this->m_heightLonCarrLeft = other.m_heightLonCarrLeft;
    this->m_heightLonCarrRight = other.m_heightLonCarrRight;
    this->m_posCentMass = other.m_posCentMass;
    this->m_posFrontAx = other.m_posFrontAx;
    memcpy(this->m_posPillar, other.m_posPillar, 3);
    this->m_positionOfPillars = other.m_positionOfPillars;
    this->m_posLonCarrLeft = other.m_posLonCarrLeft;
    this->m_posLonCarrRight = other.m_posLonCarrRight;
    this->m_trafficClass = other.m_trafficClass;
    this->m_turningRadius = other.m_turningRadius;
    this->m_vehicleLength = other.m_vehicleLength;
    this->m_vehicleMass = other.m_vehicleMass;
    this->m_vehicleWidth = other.m_vehicleWidth;
    this->m_wheelBaseVehicle = other.m_wheelBaseVehicle;
    return *this;
}