jaus++/2.0/src/jaus/mobility/sensors/reportgeomagneticproperty.cpp

Go to the documentation of this file.

#include "jaus/mobility/sensors/reportgeomagneticproperty.h"
#include "jaus/core/scaledinteger.h"
#include <cxutils/math/cxmath.h>

const double JAUS::ReportGeomagneticProperty::Limits::MinMagneticVariation = -CxUtils::PI;
const double JAUS::ReportGeomagneticProperty::Limits::MaxMagneticVariation = CxUtils::PI;

using namespace JAUS;


ReportGeomagneticProperty::ReportGeomagneticProperty(const Address& dest, const Address& src) : Message(REPORT_GEOMAGNETIC_PROPERTY, dest, src)
{
    mMagneticVariation = 0;
}


ReportGeomagneticProperty::ReportGeomagneticProperty(const ReportGeomagneticProperty& message) : Message(REPORT_GEOMAGNETIC_PROPERTY)
{
    *this = message;
}


ReportGeomagneticProperty::~ReportGeomagneticProperty()
{
}


bool ReportGeomagneticProperty::SetMagneticVariation(const double radians)
{
    if(radians >= Limits::MinMagneticVariation && radians <= Limits::MaxMagneticVariation)
    {
        mMagneticVariation = radians;
        return true;
    }
    return false;
}


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

    written += ScaledInteger::Write(packet, mMagneticVariation, Limits::MaxMagneticVariation, Limits::MinMagneticVariation, ScaledInteger::UShort);

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


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

    read += ScaledInteger::Read(packet, mMagneticVariation, Limits::MaxMagneticVariation, Limits::MinMagneticVariation, ScaledInteger::UShort);

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


void ReportGeomagneticProperty::ClearMessageBody()
{
    mMagneticVariation = 0;
}


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

    Packet packet;
    ReportGeomagneticProperty msg1, msg2;
    msg1.SetMagneticVariation(1.2333);

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

    return result;
}


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


/*  End of File */