CigiSensorRespV1.cpp

Go to the documentation of this file.

#define _EXPORT_CCL_

#include "CigiSensorRespV1.h"
#include "CigiSwapping.h"
#include "CigiExceptions.h"

#include <memory.h>


#ifdef CIGI_LITTLE_ENDIAN
   #define CIGI_SCOPY2 CigiSwap2
   #define CIGI_SCOPY4 CigiSwap4
   #define CIGI_SCOPY8 CigiSwap8
#else
   #define CIGI_SCOPY2 CigiCopy2
   #define CIGI_SCOPY4 CigiCopy4
   #define CIGI_SCOPY8 CigiCopy8
#endif




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


// ================================================
// CigiSensorRespV1
// vvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvv
CigiSensorRespV1::CigiSensorRespV1()
{

   PacketID = CIGI_SENSOR_RESP_PACKET_ID_V1;
   PacketSize = CIGI_SENSOR_RESP_PACKET_SIZE_V1;
   Version = 1;
   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;

}

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

}

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

// ================================================
// Pack
// vvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvv
int CigiSensorRespV1::Pack(CigiBasePacket * Base, Cigi_uint8 * Buff, void *Spec) const
{
   double DBuf[6];

   Cigi_uint8 *tBuf = (Cigi_uint8 *)DBuf;

   Cigi_int16  tsCnvt;
   Cigi_int32   tlCnvt;
   double tdCnvt;

   union Conversion_short
   {
      Cigi_uint16 u;
      Cigi_int16 s;
   } tuCnvt;

   PackPointer CDta;

   CigiBaseSensorResp * Data = ( CigiBaseSensorResp *)Base;

   CDta.d = DBuf;

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

   Cigi_uint8 HDta = (Cigi_uint8)((Data->ViewID << 3) & 0x00f8);
   HDta |= (Cigi_uint8)((Data->SensorStat << 1) & 0x06);
   *CDta.c++ = HDta;

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

   tdCnvt = (double)Data->GateXoff;
   if(tdCnvt < 0.0)
      tdCnvt += 360.0;
   tlCnvt = CIGI_FLOAT_TO_BA(tdCnvt);
   if((tlCnvt > 65535)||(tlCnvt < 0))
      tsCnvt = 0;
   else
   {
      tuCnvt.u = (Cigi_uint16)tlCnvt;
      tsCnvt = tuCnvt.s;
   }
   CIGI_SCOPY2(CDta.s++, &tsCnvt);

   tdCnvt = (double)Data->GateYoff;
   if(tdCnvt < 0.0)
      tdCnvt += 360.0;
   tlCnvt = CIGI_FLOAT_TO_BA(tdCnvt);
   if((tlCnvt > 65535)||(tlCnvt < 0))
      tsCnvt = 0;
   else
   {
      tuCnvt.u = (Cigi_uint16)tlCnvt;
      tsCnvt = tuCnvt.s;
   }
   CIGI_SCOPY2(CDta.s++, &tsCnvt);

   CIGI_SCOPY2(CDta.s++, &Data->GateSzX);
   CIGI_SCOPY2(CDta.s++, &Data->GateSzY);

   memcpy(Buff,tBuf,CIGI_SENSOR_RESP_PACKET_SIZE_V1);

   return(PacketSize);

}

// ================================================
// Unpack
// vvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvv
int CigiSensorRespV1::Unpack(Cigi_uint8 * Buff, bool Swap, void *Spec)
{
   double DBuf[6];

   Cigi_uint8 *tBuf = (Cigi_uint8 *)DBuf;

   Cigi_int16  tsCnvt;

   PackPointer CDta;

   memcpy(tBuf,Buff,CIGI_SENSOR_RESP_PACKET_SIZE_V1);

   CDta.d = DBuf;

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

   Cigi_uint8 HDta = *CDta.c++;
   ViewID = (Cigi_uint16)((HDta >> 3) & 0x1f);
   SensorStat = (SensorStatGrp)((HDta >> 1) & 0x03);
   SensorID = *CDta.c++;

   CIGI_SCOPY2(&tsCnvt, CDta.s++);
   GateXoff = (float)CIGI_BA_TO_FLOAT(tsCnvt);
   if(GateXoff > 180.0)
      GateXoff -= 360.0;

   CIGI_SCOPY2(&tsCnvt, CDta.s++);
   GateYoff = (float)CIGI_BA_TO_FLOAT(tsCnvt);
   if(GateYoff > 180.0)
      GateYoff -= 360.0;

   CIGI_SCOPY2(&GateSzX, CDta.s++);
   CIGI_SCOPY2(&GateSzY, CDta.s++);

   return(PacketSize);

}



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


// ================================================
// ViewID
// vvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvv
int CigiSensorRespV1::SetViewID(const Cigi_uint16 ViewIDIn, bool bndchk)
{

#ifndef CIGI_NO_BND_CHK
   if(bndchk && ((ViewIDIn < 0)||(ViewIDIn > 32)))
   {
#ifndef CIGI_NO_EXCEPT
      throw CigiValueOutOfRangeException("ViewID",(Cigi_uint16)ViewIDIn,0,32);
#endif
      return(CIGI_ERROR_VALUE_OUT_OF_RANGE);
   }
#endif

   ViewID = ViewIDIn;
   return(CIGI_SUCCESS);

}

---