CigiPositionRespV3.cpp

Go to the documentation of this file.

#define _EXPORT_CCL_

#include "CigiPositionRespV3.h"
#include "CigiSwapping.h"
#include "CigiExceptions.h"


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


// ================================================
// CigiPositionRespV3
// vvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvv
CigiPositionRespV3::CigiPositionRespV3()
{

   PacketID = CIGI_POSITION_RESP_PACKET_ID_V3;
   PacketSize = CIGI_POSITION_RESP_PACKET_SIZE_V3;
   Version = 3;
   MinorVersion = 0;

   ObjectID = 0;
   ArtPartID = 0;
   ObjectClass = Entity;
   CoordSys = Geodetic;
   LatOrXoff = 0.0;
   LonOrYoff = 0.0;
   AltOrZoff = 0.0;
   Roll = 0.0;
   Pitch = 0.0;
   Yaw = 0.0;

}

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

}

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

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

   CigiBasePositionResp * Data = ( CigiBasePositionResp *)Base;

   CDta.c = Buff;

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

   *CDta.s++ = Data->ObjectID;
   *CDta.c++ = Data->ArtPartID;

   Cigi_uint8 HDta = Data->ObjectClass & 0x07;
   HDta |= (Data->CoordSys << 3) & 0x18;
   *CDta.c++ = HDta;

   *CDta.s++ = 0;

   *CDta.d++ = Data->LatOrXoff;
   *CDta.d++ = Data->LonOrYoff;
   *CDta.d++ = Data->AltOrZoff;
   *CDta.f++ = Data->Roll;
   *CDta.f++ = Data->Pitch;
   *CDta.f++ = Data->Yaw;

   *CDta.l++ = 0;

   return(PacketSize);

}

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

   CDta.c = Buff;

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

   if(!Swap)
   {
      ObjectID = *CDta.s++;
      ArtPartID = *CDta.c++;

      Cigi_uint8 HDta = *CDta.c++;
      ObjectClass = (ObjectClassGrp)(HDta & 0x07);
      CoordSys = (CoordSysGrp)((HDta >> 3) & 0x03);

      CDta.s++;

      LatOrXoff = *CDta.d++;
      LonOrYoff = *CDta.d++;
      AltOrZoff = *CDta.d++;
      Roll = *CDta.f++;
      Pitch = *CDta.f++;
      Yaw = *CDta.f++;
   }
   else
   {
      CigiSwap2(&ObjectID, CDta.s++);
      ArtPartID = *CDta.c++;

      Cigi_uint8 HDta = *CDta.c++;
      ObjectClass = (ObjectClassGrp)(HDta & 0x07);
      CoordSys = (CoordSysGrp)((HDta >> 3) & 0x03);

      CDta.s++;

      CigiSwap8(&LatOrXoff, CDta.d++);
      CigiSwap8(&LonOrYoff, CDta.d++);
      CigiSwap8(&AltOrZoff, CDta.d++);
      CigiSwap4(&Roll, CDta.f++);
      CigiSwap4(&Pitch, CDta.f++);
      CigiSwap4(&Yaw, CDta.f++);
   }

   return(PacketSize);

}



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

---