CigiCollDetSegDefV2.cpp

Go to the documentation of this file.

#define _EXPORT_CCL_

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


// ================================================
// CigiCollDetSegDefV2
// vvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvv
CigiCollDetSegDefV2::CigiCollDetSegDefV2()
{

   PacketID = CIGI_COLL_DET_SEG_DEF_PACKET_ID_V2;
   PacketSize = CIGI_COLL_DET_SEG_DEF_PACKET_SIZE_V2;
   Version = 2;
   MinorVersion = 0;

   EntityID = 0;
   SegmentID = 0;
   SegmentEn = false;
   X1 = 0.0;
   Y1 = 0.0;
   Z1 = 0.0;
   X2 = 0.0;
   Y2 = 0.0;
   Z2 = 0.0;
   Mask = 0;

}

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

}

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

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

   Cigi_uint8 *tBuf = (Cigi_uint8 *)DBuf;

   PackPointer CDta;

   CigiBaseCollDetSegDef * Data = ( CigiBaseCollDetSegDef *)Base;

   CDta.d = DBuf;

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

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

   Cigi_uint8 HDta = Data->SegmentID;
   if(HDta > 127)
      HDta = 127;

   HDta |= (Data->SegmentEn) ? 0x80 : 0x00;

   *CDta.c++ = HDta;

   *CDta.c++ = 0;
   *CDta.s++ = 0;

   CIGI_SCOPY4(CDta.l++, &Data->Mask);

   float tpt;
   Cigi_int16 stpt;
   
   tpt = Data->X1 / 0.015625f;
   if(tpt > 32767.0f)
      stpt = 32767;
   else if(tpt < -32768.0f)
      stpt = -32768;
   else
      stpt = (Cigi_int16)tpt;

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

   tpt = Data->Y1 / 0.015625f;
   if(tpt > 32767.0f)
      stpt = 32767;
   else if(tpt < -32768.0f)
      stpt = -32768;
   else
      stpt = (Cigi_int16)tpt;

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

   tpt = Data->Z1 / 0.015625f;
   if(tpt > 32767.0f)
      stpt = 32767;
   else if(tpt < -32768.0f)
      stpt = -32768;
   else
      stpt = (Cigi_int16)tpt;

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

   tpt = Data->X2 / 0.015625f;
   if(tpt > 32767.0f)
      stpt = 32767;
   else if(tpt < -32768.0f)
      stpt = -32768;
   else
      stpt = (Cigi_int16)tpt;

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

   tpt = Data->Y2 / 0.015625f;
   if(tpt > 32767.0f)
      stpt = 32767;
   else if(tpt < -32768.0f)
      stpt = -32768;
   else
      stpt = (Cigi_int16)tpt;

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

   tpt = Data->Z2 / 0.015625f;
   if(tpt > 32767.0f)
      stpt = 32767;
   else if(tpt < -32768.0f)
      stpt = -32768;
   else
      stpt = (Cigi_int16)tpt;

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


   memcpy(Buff,tBuf,CIGI_COLL_DET_SEG_DEF_PACKET_SIZE_V2);

   return(PacketSize);

}

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

   Cigi_uint8 *tBuf = (Cigi_uint8 *)DBuf;

   PackPointer CDta;

   memcpy(tBuf,Buff,CIGI_COLL_DET_SEG_DEF_PACKET_SIZE_V2);

   CDta.d = DBuf;

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

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

   Cigi_uint8 HDta = *CDta.c++;
   SegmentID = HDta & 0x7f;
   SegmentEn = ((HDta & 0x80) != 0);

   CDta.c += 3;

   CIGI_SCOPY4(&Mask, CDta.l++);

   Cigi_int16 stpt;
   float tpt;

   CIGI_SCOPY2(&stpt, CDta.s++);
   tpt = (float)stpt;
   X1 = tpt * 0.015625f;

   CIGI_SCOPY2(&stpt, CDta.s++);
   tpt = (float)stpt;
   Y1 = tpt * 0.015625f;

   CIGI_SCOPY2(&stpt, CDta.s++);
   tpt = (float)stpt;
   Z1 = tpt * 0.015625f;

   CIGI_SCOPY2(&stpt, CDta.s++);
   tpt = (float)stpt;
   X2 = tpt * 0.015625f;

   CIGI_SCOPY2(&stpt, CDta.s++);
   tpt = (float)stpt;
   Y2 = tpt * 0.015625f;

   CIGI_SCOPY2(&stpt, CDta.s++);
   tpt = (float)stpt;
   Z2 = tpt * 0.015625f;

   return(PacketSize);

}



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


// ================================================
// SegmentID
// vvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvv
int CigiCollDetSegDefV2::SetSegmentID(const Cigi_uint8 SegmentIDIn, bool bndchk)
{

#ifndef CIGI_NO_BND_CHK
   if(bndchk && ((SegmentIDIn < 0)||(SegmentIDIn > 127)))
   {
#ifndef CIGI_NO_EXCEPT
      throw CigiValueOutOfRangeException("SegmentID",(Cigi_uint8)SegmentIDIn,0,127);
#endif
      return(CIGI_ERROR_VALUE_OUT_OF_RANGE);
   }
#endif

   SegmentID = SegmentIDIn;
   return(CIGI_SUCCESS);

}

---