CigiLosVectReqV1.cpp

Go to the documentation of this file.

#define _EXPORT_CCL_

#include "CigiLosVectReqV1.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
// ====================================================================


// ================================================
// CigiLosVectReqV1
// vvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvv
CigiLosVectReqV1::CigiLosVectReqV1()
{

   PacketID = CIGI_LOS_VECT_REQ_PACKET_ID_V1;
   PacketSize = CIGI_LOS_VECT_REQ_PACKET_SIZE_V1;
   Version = 1;
   MinorVersion = 0;

   LosID = 0;
   ReqType = Extended;
   SrcCoordSys = Geodetic;
   ResponseCoordSys = Geodetic;
   AlphaThresh = 0;
   EntityID = 0;
   VectAz = 0.0;
   VectEl = 0.0;
   MinRange = 0.0;
   MaxRange = 0.0;
   SrcXLat = 0.0;
   SrcYLon = 0.0;
   SrcZAlt = 0.0;
   Mask = 0;
   UpdatePeriod = 0;
   ValidV1or2 = true;

}

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

}

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

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

   Cigi_uint8 *tBuf = (Cigi_uint8 *)DBuf;

   PackPointer CDta;

   CigiBaseLosVectReq * Data = ( CigiBaseLosVectReq *)Base;

   if(!Data->ValidV1or2)
      return(0);

   CDta.d = DBuf;

   *CDta.c++ = Data->PacketID;
   *CDta.c++ = Data->PacketSize;

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

   *CDta.l++ = 0;

   if(Data->VectAz < 0.0f)
      Data->VectAz += 360.0f;

   CIGI_SCOPY4(CDta.f++, &Data->VectAz);

   CIGI_SCOPY4(CDta.f++, &Data->VectEl);
   CIGI_SCOPY4(CDta.f++, &Data->MaxRange);

   float tflt = (float)Data->SrcZAlt;
   CIGI_SCOPY4(CDta.f++, &tflt);

   CIGI_SCOPY8(CDta.d++, &Data->SrcXLat);
   CIGI_SCOPY8(CDta.d++, &Data->SrcYLon);

   memcpy(Buff,tBuf,CIGI_LOS_VECT_REQ_PACKET_SIZE_V1);

   return(PacketSize);

}

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

   Cigi_uint8 *tBuf = (Cigi_uint8 *)DBuf;

   PackPointer CDta;

   memcpy(tBuf,Buff,CIGI_LOS_VECT_REQ_PACKET_SIZE_V1);

   CDta.d = DBuf;

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

   CIGI_SCOPY2(&LosID, CDta.s++);

   CDta.l++;

   CIGI_SCOPY4(&VectAz, CDta.f++);
   CIGI_SCOPY4(&VectEl, CDta.f++);
   CIGI_SCOPY4(&MaxRange, CDta.f++);

   float tflt;
   CIGI_SCOPY4(&tflt, CDta.f++);
   SrcZAlt = (double)tflt;

   CIGI_SCOPY8(&SrcXLat, CDta.d++);
   CIGI_SCOPY8(&SrcYLon, CDta.d++);

   UpdatePeriod = 0;

   ValidV1or2 = true;

   return(PacketSize);

}



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


// ================================================
// VectAz
// vvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvv
int CigiLosVectReqV1::SetVectAz(const float VectAzIn, bool bndchk)
{

#ifndef CIGI_NO_BND_CHK
   if(bndchk && ((VectAzIn < 0.0)||(VectAzIn > 360.0)))
   {
#ifndef CIGI_NO_EXCEPT
      throw CigiValueOutOfRangeException("VectAz",(float)VectAzIn,0.0,360.0);
#endif
      return(CIGI_ERROR_VALUE_OUT_OF_RANGE);
   }
#endif

   VectAz = VectAzIn;
   return(CIGI_SUCCESS);

}

---