denMessageTableForwarding.cpp

Go to the documentation of this file.

#include "include/denMessageTableForwarding.h"

denMessageTableForwarding::denMessageTableForwarding(FakeGPSProvider *gps)
{
    memset(&m_denm, 0, sizeof m_denm);
    m_T_F_Validity = -1;
    m_T_Forwarding = -1;
    m_gps = gps;
    qsrand(time(NULL));
    m_thread = new QThread;
    QObject::connect(m_thread, SIGNAL(started()), this, SLOT(execute()));
}

denMessageTableForwarding::denMessageTableForwarding(const denMessageTableForwarding &messageTable) : QObject()
{
    this->m_denm = messageTable.denm();
    this->m_T_F_Validity = messageTable.m_T_F_Validity;
    this->m_T_Forwarding = messageTable.m_T_Forwarding;
    this->m_actionID = messageTable.actionID();
    this->m_encodedDENM = messageTable.encodedDENM();
    this->m_gps = messageTable.m_gps;
    this->m_thread = messageTable.m_thread;
}

denMessageTableForwarding& denMessageTableForwarding::operator =(const denMessageTableForwarding& other)
{
    this->m_denm = other.m_denm;
    this->m_T_F_Validity = other.m_T_F_Validity;
    this->m_T_Forwarding = other.m_T_Forwarding;
    this->m_actionID = other.actionID();
    this->m_encodedDENM = other.encodedDENM();
    this->m_gps = other.m_gps;
    this->m_thread = other.m_thread;

    return *this;
}

void denMessageTableForwarding::execute()
{
    m_validity = new denMessageTableForwardingThread(m_T_F_Validity);
    m_forwarding = new denMessageTableForwardingThread(m_T_Forwarding);

    QObject::connect(m_validity, SIGNAL(T_F_ValiditySignal()), this, SLOT(endOfT_F_Validity()));
    QObject::connect(m_forwarding, SIGNAL(T_ForwardingSignal()), this, SLOT(endOfT_Forwarding()));
    QObject::connect(this, SIGNAL(DENMForwarded()), m_forwarding, SLOT(endOfT_Forwarding()));

    if(m_validity->timer() > -1)
    {
        m_validity->m_T_F_Validity_timer.start();
        QTimer::singleShot(m_validity->timer(), m_validity, SLOT(endOfT_F_Validity()));
    }

    if(m_forwarding->timer() > -1)
    {
        m_forwarding->m_T_Forwarding_timer.start();
        QTimer::singleShot(m_forwarding->timer(), m_forwarding, SLOT(endOfT_Forwarding()));
    }
}

denMessageTableForwarding::~denMessageTableForwarding()
{
    setT_F_Validity(-1);
    setT_Forwarding(-1);
}

void denMessageTableForwarding::endOfT_F_Validity()
{
    /* 1) Stop T_Forwarding timer. */
    m_forwarding->setTimer(-1);

    /* 2) Delete DENM entry from the forwarding message table. */
    emit T_F_ValiditySignal(m_actionID);
}

void denMessageTableForwarding::endOfT_Forwarding()
{
    printf("endOfT_Forwarding\n");
    /* 1) Check if the forwarding ITS-S is located in the relevance area or the destination area. */
    if(!inRelevanceArea(m_denm.denm.management.eventPosition, m_denm.denm.management.relevanceDistance))
    {
        /* 1) a. If not, omit the execution of further steps. */
        qDebug() << "Not in area";
        return;
    }
    /* 1) b. Otherwise, continue operation. */

    /* 2) Pass reconstructed DENM to ITS networking & transport layer. */
    qDebug() << "Emit T_ForwardingSignal";
    emit T_ForwardingSignal(m_actionID);

    /* 3) Restart timer T_Forwarding. */
    if(m_T_Forwarding > -1)
    {
        m_forwarding->m_T_Forwarding_timer.start();
        QTimer::singleShot(m_forwarding->timer(), m_forwarding, SLOT(endOfT_Forwarding()));
        emit DENMForwarded();
    }
}

bool denMessageTableForwarding::inRelevanceArea(ReferencePosition_t destination, RelevanceDistance_t *relevanceDistance)
{
    ReferencePosition_t myPosition = m_gps->data().referencePosition();

    qDebug() << "\n\n\n\ndest.lat =" << destination.latitude << "\nmypo.lat =" << myPosition.latitude;
    qDebug() << "dest.lon =" << destination.longitude << "\nmypo.lon =" << myPosition.longitude;
    if(relevanceDistance)
    {
        switch (*relevanceDistance)
        {
        case RelevanceDistance_lessThan50m:
            if(destination.positionConfidenceEllipse.semiMinorConfidence < (50 * 100)||
               destination.positionConfidenceEllipse.semiMinorConfidence < (50 * 100))
            {
                destination.positionConfidenceEllipse.semiMajorConfidence = 50;
                destination.positionConfidenceEllipse.semiMinorConfidence = 50;
            }
            break;
        case RelevanceDistance_lessThan100m:
            if(destination.positionConfidenceEllipse.semiMinorConfidence < (100 * 100) ||
               destination.positionConfidenceEllipse.semiMinorConfidence < (100 * 100))
            {
                destination.positionConfidenceEllipse.semiMajorConfidence = 100;
                destination.positionConfidenceEllipse.semiMinorConfidence = 100;
            }
            break;
        case RelevanceDistance_lessThan200m:
            if(destination.positionConfidenceEllipse.semiMinorConfidence < (200 * 100) ||
               destination.positionConfidenceEllipse.semiMinorConfidence < (200 * 100))
            {
                destination.positionConfidenceEllipse.semiMajorConfidence = 200;
                destination.positionConfidenceEllipse.semiMinorConfidence = 200;
            }
            break;
        case RelevanceDistance_lessThan500m:
            if(destination.positionConfidenceEllipse.semiMinorConfidence < (500 * 100) ||
               destination.positionConfidenceEllipse.semiMinorConfidence < (500 * 100))
            {
                destination.positionConfidenceEllipse.semiMajorConfidence = 500;
                destination.positionConfidenceEllipse.semiMinorConfidence = 500;
            }
            break;
        case RelevanceDistance_lessThan1000m:
            if(destination.positionConfidenceEllipse.semiMinorConfidence < (1000 * 100) ||
               destination.positionConfidenceEllipse.semiMinorConfidence < (1000 * 100))
            {
                destination.positionConfidenceEllipse.semiMajorConfidence = 1000;
                destination.positionConfidenceEllipse.semiMinorConfidence = 1000;
            }
            break;
        case RelevanceDistance_lessThan5km:
            if(destination.positionConfidenceEllipse.semiMinorConfidence < (5000 * 100) ||
               destination.positionConfidenceEllipse.semiMinorConfidence < (5000 * 100))
            {
                destination.positionConfidenceEllipse.semiMajorConfidence = 5000;
                destination.positionConfidenceEllipse.semiMinorConfidence = 5000;
            }
            break;
        case RelevanceDistance_lessThan10km:
            if(destination.positionConfidenceEllipse.semiMinorConfidence < (10000 * 100) ||
               destination.positionConfidenceEllipse.semiMinorConfidence < (10000 * 100))
            {
                destination.positionConfidenceEllipse.semiMajorConfidence = 10000;
                destination.positionConfidenceEllipse.semiMinorConfidence = 10000;
            }
            break;
        case RelevanceDistance_over10km:
            return true;
            break;
        default:
            break;
        }
        qDebug() << "RelevanceDistance =" << *relevanceDistance;
    }

    double x, y;
    x = diameter(myPosition.longitude, destination.longitude, circAtLat((myPosition.latitude + destination.latitude)/2));
    qDebug() << "x =" << x;
    y = LAT2METER*((myPosition.latitude - destination.latitude)/10000000.);
    qDebug() << "y =" << y;
    y *= y<0?-1:1;
    qDebug() << "y =" << y;
    qDebug() << "distanceA =" << destination.positionConfidenceEllipse.semiMajorConfidence;
    qDebug() << "distanceB =" << destination.positionConfidenceEllipse.semiMinorConfidence;
    double inArea;
    if(!destination.positionConfidenceEllipse.semiMinorConfidence ||
       (destination.positionConfidenceEllipse.semiMajorConfidence == destination.positionConfidenceEllipse.semiMinorConfidence))
        inArea = f(x, y, destination.positionConfidenceEllipse.semiMajorConfidence,
                   0, shape_circle);
    else
        inArea = f(x*cos(destination.positionConfidenceEllipse.semiMajorOrientation)-y*sin(destination.positionConfidenceEllipse.semiMajorOrientation),
                   x*sin(destination.positionConfidenceEllipse.semiMajorOrientation)+y*cos(destination.positionConfidenceEllipse.semiMajorOrientation),
                   destination.positionConfidenceEllipse.semiMajorConfidence,
                   destination.positionConfidenceEllipse.semiMinorConfidence, shape_ellipse);

    qDebug() << "inArea =" << inArea;
    return inArea >= 0;
}