CigiSensorXRespV3.cpp

Go to the documentation of this file.

#define _EXPORT_CCL_

#include "CigiSensorXRespV3.h"
#include "CigiSwapping.h"
#include "CigiExceptions.h"


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


// ================================================
// CigiSensorXRespV3
// vvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvv
CigiSensorXRespV3::CigiSensorXRespV3()
{

   PacketID = CIGI_SENSOR_XRESP_PACKET_ID_V3;
   PacketSize = CIGI_SENSOR_XRESP_PACKET_SIZE_V3;
   Version = 3;
   MinorVersion = 0;

   ViewID = 0;
   SensorID = 0;
   SensorStat = Searching;
   EntityTgt = false;
   EntityID = 0;
   GateSzX = 0;
   GateSzY = 0;
   GateXoff = 0.0;
   GateYoff = 0.0;
   FrameCntr = 0;
   TrackPntLat = 0.0;
   TrackPntLon = 0.0;
   TrackPntAlt = 0.0;

}

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

}

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

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

   CigiBaseSensorResp * Data = ( CigiBaseSensorResp *)Base;

   CDta.c = Buff;

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

   *CDta.s++ = Data->ViewID;
   *CDta.c++ = Data->SensorID;

   Cigi_uint8 HDta = (Data->EntityTgt) ? 0x04 : 0x00;
   HDta |= (Cigi_uint8)(Data->SensorStat & 0x03);
   *CDta.c++ = HDta;

   *CDta.s++ = Data->EntityID;
   *CDta.s++ = Data->GateSzX;
   *CDta.s++ = Data->GateSzY;
   *CDta.f++ = Data->GateXoff;
   *CDta.f++ = Data->GateYoff;
   *CDta.l++ = Data->FrameCntr;
   *CDta.d++ = Data->TrackPntLat;
   *CDta.d++ = Data->TrackPntLon;
   *CDta.d++ = Data->TrackPntAlt;

   return(PacketSize);

}

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

   CDta.c = Buff;

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

   if(!Swap)
   {
      ViewID = *CDta.s++;
      SensorID = *CDta.c++;

      Cigi_uint8 HDta = *CDta.c++;
      SensorStat = (SensorStatGrp)(HDta & 0x03);
      EntityTgt = ((HDta & 0x04) != 0);

      EntityID = *CDta.s++;
      GateSzX = *CDta.s++;
      GateSzY = *CDta.s++;
      GateXoff = *CDta.f++;
      GateYoff = *CDta.f++;
      FrameCntr = *CDta.l++;
      TrackPntLat = *CDta.d++;
      TrackPntLon = *CDta.d++;
      TrackPntAlt = *CDta.d++;
   }
   else
   {
      CigiSwap2(&ViewID, CDta.s++);
      SensorID = *CDta.c++;

      Cigi_uint8 HDta = *CDta.c++;
      SensorStat = (SensorStatGrp)(HDta & 0x03);
      EntityTgt = ((HDta & 0x04) != 0);

      CigiSwap2(&EntityID, CDta.s++);
      CigiSwap2(&GateSzX, CDta.s++);
      CigiSwap2(&GateSzY, CDta.s++);
      CigiSwap4(&GateXoff, CDta.f++);
      CigiSwap4(&GateYoff, CDta.f++);
      CigiSwap4(&FrameCntr, CDta.l++);
      CigiSwap8(&TrackPntLat, CDta.d++);
      CigiSwap8(&TrackPntLon, CDta.d++);
      CigiSwap8(&TrackPntAlt, CDta.d++);
   }

   return(PacketSize);

}


// ====================================================================
// Conversion Control
// ====================================================================


// ================================================
// GetCnvt
// vvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvv
int CigiSensorXRespV3::GetCnvt(CigiVersionID &CnvtVersion,
                                CigiCnvtInfoType::Type &CnvtInfo)
{
   CnvtInfo.ProcID = CigiProcessType::ProcStd;

   // Note: CIGI_SENSOR_RESP_PACKET_ID_V1 &
   // CIGI_SENSOR_RESP_PACKET_ID_V2 are the same
   if(CnvtVersion.CigiMajorVersion < 3)
      CnvtInfo.CnvtPacketID = CIGI_SENSOR_RESP_PACKET_ID_V2;
   else
      CnvtInfo.CnvtPacketID = CIGI_SENSOR_XRESP_PACKET_ID_V3;

   return(CIGI_SUCCESS);
}





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


// ================================================
// TrackPntLat
// vvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvv
int CigiSensorXRespV3::SetTrackPntLat(const double TrackPntLatIn, bool bndchk)
{

#ifndef CIGI_NO_BND_CHK
   if(bndchk && ((TrackPntLatIn < -90.0)||(TrackPntLatIn > 90.0)))
   {
#ifndef CIGI_NO_EXCEPT
      throw CigiValueOutOfRangeException("TrackPntLat",(double)TrackPntLatIn,-90.0,90.0);
#endif
      return(CIGI_ERROR_VALUE_OUT_OF_RANGE);
   }
#endif

   TrackPntLat = TrackPntLatIn;
   return(CIGI_SUCCESS);

}


// ================================================
// TrackPntLon
// vvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvv
int CigiSensorXRespV3::SetTrackPntLon(const double TrackPntLonIn, bool bndchk)
{

#ifndef CIGI_NO_BND_CHK
   if(bndchk && ((TrackPntLonIn < -180.0)||(TrackPntLonIn > 180.0)))
   {
#ifndef CIGI_NO_EXCEPT
      throw CigiValueOutOfRangeException("TrackPntLon",(double)TrackPntLonIn,-180.0,180.0);
#endif
      return(CIGI_ERROR_VALUE_OUT_OF_RANGE);
   }
#endif

   TrackPntLon = TrackPntLonIn;
   return(CIGI_SUCCESS);

}

---