jaus++/2.0/src/jaus/mobility/drivers/reporttravelspeed.cpp

Go to the documentation of this file.

#include "jaus/mobility/drivers/reporttravelspeed.h"
#include "jaus/core/scaledinteger.h"
#include <cxutils/math/cxmath.h>

const double JAUS::ReportTravelSpeed::Limits::MinSpeed = 0.0;
const double JAUS::ReportTravelSpeed::Limits::MaxSpeed = 327.67;

using namespace JAUS;


ReportTravelSpeed::ReportTravelSpeed(const Address& dest, const Address& src) : Message(REPORT_TRAVEL_SPEED, dest, src)
{
    mSpeed = 0;
}


ReportTravelSpeed::ReportTravelSpeed(const ReportTravelSpeed& message) : Message(REPORT_TRAVEL_SPEED)
{
    *this = message;
}


ReportTravelSpeed::~ReportTravelSpeed()
{
}


bool ReportTravelSpeed::SetSpeed(const double value)
{
    if(value >= Limits::MinSpeed && value <= Limits::MaxSpeed)
    {
        mSpeed = value;
        return true;
    }
    return false;
}


int ReportTravelSpeed::WriteMessageBody(Packet& packet) const
{
    int expected = USHORT_SIZE;
    int written = 0;

    written += ScaledInteger::Write(packet, mSpeed, Limits::MaxSpeed, Limits::MinSpeed, ScaledInteger::UShort);

    return expected == written ? written : -1;
}


int ReportTravelSpeed::ReadMessageBody(const Packet& packet)
{
    int expected = USHORT_SIZE;
    int read = 0;

    read += ScaledInteger::Read(packet, mSpeed, Limits::MaxSpeed, Limits::MinSpeed, ScaledInteger::UShort);

    return expected == read ? read : -1;
}


void ReportTravelSpeed::ClearMessageBody()
{
    mSpeed = 0;
}


void ReportTravelSpeed::PrintMessageBody() const
{
    std::cout << "Meter/Sec: [" << mSpeed << "]" << std::endl;
}


int ReportTravelSpeed::RunTestCase() const
{
    int result = 0;

    Packet packet;
    ReportTravelSpeed msg1, msg2;
    msg1.SetSpeed(30);

    if(msg1.WriteMessageBody(packet))
    {
        msg2.ClearMessage();
        if(msg2.ReadMessageBody(packet))
        {
            if(msg1.GetSpeed()- msg2.GetSpeed() <= 0.001)
            {
                result = 1;
            }
        }
    }

    return result;
}


ReportTravelSpeed& ReportTravelSpeed::operator=(const ReportTravelSpeed& message)
{
    if(this != &message)
    {
        CopyHeaderData(&message);
        mSpeed = message.mSpeed;
    }
    return *this;
}


/*  End of File */