jaus++/2.0/src/jaus/core/discovery/vehicle.cpp

Go to the documentation of this file.

#include "jaus/core/discovery/vehicle.h"

using namespace JAUS;

Vehicle::Vehicle() { mAuthority = -1; mpInfo = NULL; }

Vehicle::Vehicle(const Vehicle& vehicle) : Subsystem() 
{ 
    mpInfo = NULL; *this = vehicle; 
}


Vehicle::~Vehicle() 
{ 
    if(mpInfo) { delete mpInfo; } 
}

void Vehicle::Update(const Wgs& position,
                     const Attitude& attitude,
                     const Time& time)
{
    mPosition = position;
    mAttitude = attitude;
    mUpdateTime = time;
}


void Vehicle::Update(const Point3D& linearVelocity,
                     const Time& time)
{
    mLinearVelocity = linearVelocity;
    mUpdateTime = time;
}


Subsystem* Vehicle::Clone() const { return new Vehicle(*this); }


void Vehicle::SetAdditionalInfo(const Vehicle::Info* info)
{
    if(mpInfo == NULL)
    {
        mpInfo = info->Clone();
    }
    else
    {
        mpInfo->Copy(info);
    }
}


void Vehicle::DeleteAdditionalInfo()
{
    if(mpInfo)
    {
        delete mpInfo;
    }
    mpInfo = NULL;
}

Vehicle::Info* Vehicle::GetAdditionalInfo() { return mpInfo; }


const Vehicle::Info* Vehicle::GetAdditionalInfo() const { return mpInfo; }


Vehicle& Vehicle::operator=(const Vehicle& vehicle)
{
    if(this != &vehicle)
    {
        *((Subsystem *)this) = *((Subsystem *)&vehicle);
        mPosition = vehicle.mPosition;
        mAttitude = vehicle.mAttitude;
        mAuthority = vehicle.mAuthority;
        mLinearVelocity = vehicle.mLinearVelocity;
        if(vehicle.mpInfo)
        {
            if(mpInfo && mpInfo->Copy(vehicle.mpInfo) == false)
            {
                DeleteAdditionalInfo();
                SetAdditionalInfo(vehicle.mpInfo);
            }
            else
            {
                SetAdditionalInfo(vehicle.mpInfo);
            }
        }
        else if(mpInfo && !vehicle.mpInfo)
        {
            DeleteAdditionalInfo();
        }
    }
    return *this;
}


void Vehicle::DeleteVehicleMap(Vehicle::Map& list)
{
    Map::iterator s;
    for(s = list.begin();
        s != list.end();
        s++)
    {
        delete s->second;
    }
    list.clear();
}


void Vehicle::CopyVehicleMap(const Vehicle::Map& src, Vehicle::Map& dest)
{
    Map::const_iterator s;
    DeleteVehicleMap(dest);
    for(s = src.begin();
        s != src.end();
        s++)
    {
        dest[s->first] = (Vehicle *)s->second->Clone();
    }
}


/*  End of File */