ParameterGPS.cpp

Go to the documentation of this file.

#include "ParameterGPS.h"

ParameterGPS::ParameterGPS()
{
    read();
    //readDebug();
}

ParameterGPS::ParameterGPS(const ParameterGPS &other)
{
    this->m_address = other.address();
    this->m_heading = cpy_Heading(other.heading());
    this->m_port = other.port();
    this->m_referencePosition = cpy_ReferencePosition(other.referencePosition());
    this->m_speed = cpy_Speed(other.speed());
    this->m_timestamp = other.timestamp();
}

ParameterGPS::~ParameterGPS()
{
}

void ParameterGPS::read()
{
        cfg_opt_t altitude_opts[] =
        {
            CFG_INT("altitudeConfidence", AltitudeConfidence_unavailable, CFGF_NONE),
            CFG_INT("altitudeValue", AltitudeValue_unavailable, CFGF_NONE),
            CFG_END()
        };
        cfg_opt_t positionConfidenceEllipse_opts[] =
        {
            CFG_INT("semiMajorConfidence", SemiAxisLength_unavailable, CFGF_NONE),
            CFG_INT("semiMajorOrientation", HeadingValue_unavailable, CFGF_NONE),
            CFG_INT("semiMinorConfidence", SemiAxisLength_unavailable, CFGF_NONE),
            CFG_END()
        };
    cfg_opt_t referencePosition_opts[] =
    {
        CFG_SEC("altitude", altitude_opts, CFGF_NO_TITLE_DUPES),
        CFG_INT("latitude", Latitude_unavailable, CFGF_NONE),
        CFG_INT("longitude", Longitude_unavailable, CFGF_NONE),
        CFG_SEC("positionConfidenceEllipse", positionConfidenceEllipse_opts, CFGF_NO_TITLE_DUPES),
        CFG_END()
    };

    cfg_opt_t heading_opts[] =
    {
        CFG_INT("headingConfidence", HeadingConfidence_unavailable, CFGF_NONE),
        CFG_INT("headingValue", HeadingValue_unavailable, CFGF_NONE),
        CFG_END()
    };

    cfg_opt_t speed_opts[] =
    {
        CFG_INT("speedConfidence", SpeedConfidence_unavailable, CFGF_NONE),
        CFG_INT("speedValue", SpeedValue_unavailable, CFGF_NONE),
        CFG_END()
    };

    struct cfg_opt_t opts[] =
    {
        CFG_STR("address", "localhost", CFGF_NONE),

        CFG_SEC("heading", heading_opts, CFGF_NO_TITLE_DUPES),

        CFG_STR("port", "2947", CFGF_NONE),

        CFG_SEC("referencePosition", referencePosition_opts, CFGF_NO_TITLE_DUPES),

        CFG_SEC("speed", speed_opts, CFGF_NO_TITLE_DUPES),

        CFG_INT("timestamp", 0, CFGF_NONE),

        CFG_END()
    };

    cfg_t *cfg;
    cfg_t *cfg_altitude;
    cfg_t *cfg_heading;
    cfg_t *cfg_referencePosition;
    cfg_t *cfg_positionConfidenceEllipse;
    cfg_t *cfg_speed;

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

    cfg_referencePosition = cfg_getsec(cfg, "referencePosition");
        cfg_altitude = cfg_getsec(cfg_referencePosition, "altitude");
        cfg_positionConfidenceEllipse = cfg_getsec(cfg_referencePosition, "positionConfidenceEllipse");

    cfg_speed = cfg_getsec(cfg, "speed");

    cfg_heading = cfg_getsec(cfg, "heading");


    cfg_set_validate_func(cfg_altitude, "altitudeConfidence", validate_unsigned_int);

    cfg_set_validate_func(cfg_positionConfidenceEllipse, "semiMajorConfidence", validate_unsigned_int);
    cfg_set_validate_func(cfg_positionConfidenceEllipse, "semiMinorConfidence", validate_unsigned_int);
    cfg_set_validate_func(cfg_positionConfidenceEllipse, "semiMajorOrientation", validate_unsigned_int);

    cfg_set_validate_func(cfg_speed, "speedValue", validate_unsigned_int);
    cfg_set_validate_func(cfg_speed, "speedConfidence", validate_unsigned_int);

    cfg_set_validate_func(cfg_heading, "headingValue", validate_unsigned_int);
    cfg_set_validate_func(cfg_heading, "headingConfidence", validate_unsigned_int);

    cfg_set_validate_func(cfg, "timestamp", validate_unsigned_int);

    m_address = cfg_getstr(cfg, "address");

    m_port = cfg_getstr(cfg, "port");

    m_referencePosition.altitude.altitudeValue = cfg_getint(cfg_altitude, "altitudeValue");
    m_referencePosition.altitude.altitudeConfidence = cfg_getint(cfg_altitude, "altitudeConfidence");

    m_referencePosition.latitude = cfg_getint(cfg_referencePosition, "latitude");
    m_referencePosition.longitude = cfg_getint(cfg_referencePosition, "longitude");

    m_referencePosition.positionConfidenceEllipse.semiMajorConfidence = cfg_getint(cfg_positionConfidenceEllipse, "semiMajorConfidence");
    m_referencePosition.positionConfidenceEllipse.semiMajorOrientation = cfg_getint(cfg_positionConfidenceEllipse, "semiMajorOrientation");
    m_referencePosition.positionConfidenceEllipse.semiMinorConfidence = cfg_getint(cfg_positionConfidenceEllipse, "semiMinorConfidence");

    m_speed.speedConfidence = cfg_getint(cfg_speed, "speedConfidence");
    m_speed.speedValue = cfg_getint(cfg_speed, "speedValue");

    m_heading.headingConfidence = cfg_getint(cfg_heading, "headingConfidence");
    m_heading.headingValue = cfg_getint(cfg_heading, "headingValue");


    m_timestamp = cfg_getint(cfg, "timestamp");

    cfg_free(cfg);
}

void ParameterGPS::readDebug()
{
    printf("---------------------------------------------------------------------\n\t\tReadGPS\n\n");
    printf("address = \"%s\"\n\n", m_address.toStdString().c_str());
    printf("header\n{\n\theadingValue = %ld\n\n\theadingConfidence = %ld\n}\n\n", m_heading.headingValue, m_heading.headingConfidence);
    printf("port = \"%s\"\n\n",m_port.toStdString().c_str());
    printf("referencePosition\n{\n\taltitude\n\t{\n\t\taltitudeConfidence = %ld\n\n\t\taltitudeValue = %ld\n\t}\n\n", m_referencePosition.altitude.altitudeConfidence, m_referencePosition.altitude.altitudeValue);
    printf("\tlatitude = %ld\n\n\tlongitude = %ld\n\n", m_referencePosition.latitude, m_referencePosition.longitude);
    printf("\tpositionConfidenceEllipse\n\t{\n\t\tsemiMajorConfidence = %ld\n\n\t\tsemiMajorOrientation = %ld\n\n\t\tsemiMinorConfidence = %ld\n\t}\n}\n\n",
           m_referencePosition.positionConfidenceEllipse.semiMajorConfidence,
           m_referencePosition.positionConfidenceEllipse.semiMajorOrientation,
           m_referencePosition.positionConfidenceEllipse.semiMinorConfidence);

    printf("speed\n{\n\tspeedConfidence = %ld\n\n\tspeedValue = %ld\n}\n\n", m_speed.speedConfidence, m_speed.speedValue);
    printf("timestamp = %lld\n\n", m_timestamp);
}

ParameterGPS& ParameterGPS::operator=(const ParameterGPS& other)
{
    this->m_address = other.m_address;
    this->m_heading = other.m_heading;
    this->m_port = other.m_port;
    this->m_referencePosition = other.m_referencePosition;
    this->m_speed = other.m_speed;
    this->m_timestamp = other.m_timestamp;
    return *this;
}