LongPositionVector.cpp

Go to the documentation of this file.

#include "LongPositionVector.h"
#include <apiData.h>

LongPositionVector::LongPositionVector()
{
    m_gnAddr = GnAddr();
    m_timestamp = 0;
    m_latitude = 0;
    m_longitude = 0;
    m_pai_Speed = 0;
    m_heading = 0;
}

LongPositionVector::LongPositionVector(GnAddr gnA, quint32 tmstmp, qint32 lat, qint32 lon, quint16 paiSpeed,  quint16 head)
{
    m_gnAddr = gnA;
    m_timestamp = tmstmp;
    m_latitude = lat;
    m_longitude = lon;
    m_pai_Speed = paiSpeed;
    m_heading = head;
}

LongPositionVector::LongPositionVector(GnAddr gnA, quint32 tmstmp, qint32 lat, qint32 lon, quint8 pai, quint16 speed,  quint16 head)
{
    m_gnAddr = gnA;
    m_timestamp = tmstmp;
    m_latitude = lat;
    m_longitude = lon;
    m_pai_Speed = (pai & 1) << 15;
    m_pai_Speed = (speed & 0x7FF);
    m_heading = head;
}

LongPositionVector::LongPositionVector(ShortPositionVector spv)
{
    m_gnAddr = spv.gnAddr();
    m_latitude = spv.latitude();
    m_longitude = spv.longitude();
    m_timestamp = spv.timestamp();
}

LongPositionVector::LongPositionVector(char *data, int *offset)
{
    m_gnAddr = GnAddr(QByteArray(data, *offset));
    *offset += 8;
    m_latitude = extractInt(data, 4, offset);
    m_longitude = extractInt(data, 4, offset);
    m_timestamp = extractUInt(data, 8, offset);
}

LongPositionVector::LongPositionVector(const LongPositionVector& other)
{
    this->m_gnAddr = other.gnAddr();
    this->m_timestamp = other.timestamp();
    this->m_latitude = other.latitude();
    this->m_longitude = other.longitude();
    this->m_pai_Speed = other.pai_Speed();
    this->m_heading = other.heading();
}

LongPositionVector& LongPositionVector::operator=(const LongPositionVector& other)
{
    this->m_gnAddr = other.gnAddr();
    this->m_timestamp = other.timestamp();
    this->m_latitude = other.latitude();
    this->m_longitude = other.longitude();
    this->m_pai_Speed = other.pai_Speed();
    this->m_heading = other.heading();
    return *this;
}

quint64 LongPositionVector::extract(uchar* packet)
{
    quint64 offset = 0;

    offset += m_gnAddr.extract(packet + offset);
    offset += get_UINT32(packet + offset, &m_timestamp);
    offset += get_INT32(packet + offset, &m_latitude);
    offset += get_INT32(packet + offset, &m_longitude);
    offset += get_UINT16(packet + offset, &m_pai_Speed);
    offset += get_UINT16(packet + offset, &m_heading);

    return offset;
}

QByteArray LongPositionVector::toHex()
{
    QByteArray hex;
    QDataStream ds(&hex, QIODevice::WriteOnly);

    ds.writeRawData(m_gnAddr.toHex().data(), GnAddr::helper_size);
    ds << m_timestamp;
    ds << m_latitude;
    ds << m_longitude;
    ds << m_pai_Speed;
    ds << m_heading;

    return hex;
}