CigiTrajectoryDefV3.cpp

Go to the documentation of this file.

#include <math.h>

#define _EXPORT_CCL_

#include "CigiTrajectoryDefV3.h"
#include "CigiSwapping.h"
#include "CigiExceptions.h"


// ====================================================================
// Construction/Destruction
// ====================================================================


// ================================================
// CigiTrajectoryDefV3
// vvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvv
CigiTrajectoryDefV3::CigiTrajectoryDefV3()
{

   PacketID = CIGI_TRAJECTORY_DEF_PACKET_ID_V3;
   PacketSize = CIGI_TRAJECTORY_DEF_PACKET_SIZE_V3;
   Version = 3;
   MinorVersion = 0;

   EntityID = 0;
   Accel = 0.0;
   RetardationRate = 0.0;
   TermVel = 0.0;
   Xoff = 0.0;
   Yoff = 0.0;
   Zoff = 0.0;
   AccelX = 0.0f;
   AccelY = 0.0f;
   AccelZ = 0.0f;

}

// ================================================
// ~CigiTrajectoryDefV3
// vvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvv
CigiTrajectoryDefV3::~CigiTrajectoryDefV3()
{

}

// ====================================================================
// Pack and Unpack
// ====================================================================

// ================================================
// Pack
// vvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvv
int CigiTrajectoryDefV3::Pack(CigiBasePacket * Base, Cigi_uint8 * Buff, void *Spec) const
{
   PackPointer CDta;

   CigiBaseTrajectoryDef * Data = ( CigiBaseTrajectoryDef *)Base;

   CDta.c = Buff;

   *CDta.c++ = PacketID;
   *CDta.c++ = PacketSize;

   *CDta.s++ = Data->EntityID;
   *CDta.f++ = Data->AccelX;
   *CDta.f++ = Data->AccelY;
   *CDta.f++ = Data->AccelZ;
   *CDta.f++ = Data->RetardationRate;
   *CDta.f++ = Data->TermVel;

   return(PacketSize);

}

// ================================================
// Unpack
// vvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvv
int CigiTrajectoryDefV3::Unpack(Cigi_uint8 * Buff, bool Swap, void *Spec)
{
   PackPointer CDta;

   CDta.c = Buff;

   CDta.c += 2;  // Step over packet id and size

   if(!Swap)
   {
      EntityID = *CDta.s++;
      AccelX = *CDta.f++;
      AccelY = *CDta.f++;
      AccelZ = *CDta.f++;
      RetardationRate = *CDta.f++;
      TermVel = *CDta.f++;
   }
   else
   {
      CigiSwap2(&EntityID, CDta.s++);
      CigiSwap4(&AccelX, CDta.f++);
      CigiSwap4(&AccelY, CDta.f++);
      CigiSwap4(&AccelZ, CDta.f++);
      CigiSwap4(&RetardationRate, CDta.f++);
      CigiSwap4(&TermVel, CDta.f++);
   }

   Accel = (float)sqrt((double)((AccelX*AccelX) + (AccelY*AccelY) + (AccelZ*AccelZ)));

   Xoff = 0.0;
   Yoff = 0.0;
   Zoff = 0.0;

   return(PacketSize);

}



// ====================================================================
// Accessors
// ====================================================================


// ================================================
// AccelX
// vvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvv
int CigiTrajectoryDefV3::SetAccelX(const float AccelIn, bool bndchk)
{
   AccelX = AccelIn;
   Accel = (float)sqrt((double)((AccelX*AccelX) + (AccelY*AccelY) + (AccelZ*AccelZ)));

   return(CIGI_SUCCESS);
}


// ================================================
// AccelY
// vvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvv
int CigiTrajectoryDefV3::SetAccelY(const float AccelIn, bool bndchk)
{
   AccelY = AccelIn;
   Accel = (float)sqrt((double)((AccelX*AccelX) + (AccelY*AccelY) + (AccelZ*AccelZ)));

   return(CIGI_SUCCESS);
}


// ================================================
// AccelZ
// vvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvv
int CigiTrajectoryDefV3::SetAccelZ(const float AccelIn, bool bndchk)
{
   AccelZ = AccelIn;
   Accel = (float)sqrt((double)((AccelX*AccelX) + (AccelY*AccelY) + (AccelZ*AccelZ)));

   return(CIGI_SUCCESS);
}

---