CigiViewCtrlV2.cpp

Go to the documentation of this file.

#define _EXPORT_CCL_

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


// ================================================
// CigiViewCtrlV2
// vvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvv
CigiViewCtrlV2::CigiViewCtrlV2()
{

   PacketID = CIGI_VIEW_CTRL_PACKET_ID_V2;
   PacketSize = CIGI_VIEW_CTRL_PACKET_SIZE_V2;
   Version = 2;
   MinorVersion = 0;

   EntityID = 0;
   ViewID = 0;
   GroupID = 0;
   XOffEn = false;
   YOffEn = false;
   ZOffEn = false;
   RollEn = false;
   PitchEn = false;
   YawEn = false;
   XOff = 0.0;
   YOff = 0.0;
   ZOff = 0.0;
   Roll = 0.0;
   Pitch = 0.0;
   Yaw = 0.0;

}

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

}

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

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

   Cigi_uint8 *tBuf = (Cigi_uint8 *)DBuf;

   PackPointer CDta;

   CigiBaseViewCtrl * Data = ( CigiBaseViewCtrl *)Base;

   CDta.d = DBuf;

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

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

   Cigi_uint8 HDta = 0;

   if(Data->ViewID < 32)
      HDta = (Cigi_uint8)((Data->ViewID << 3) & 0xf8);
   else
      HDta = (Cigi_uint8)0xf8;

   if(Data->GroupID < 8)
      HDta |= (Cigi_uint8)(Data->GroupID & 0x07);
   else
      HDta |= (Cigi_uint8)0x07;

   *CDta.c++ = HDta;

   HDta = 0;

   if(Data->XOffEn)
      HDta |= 0x80;

   if(Data->YOffEn)
      HDta |= 0x40;

   if(Data->ZOffEn)
      HDta |= 0x20;

   if(Data->RollEn)
      HDta |= 0x10;

   if(Data->PitchEn)
      HDta |= 0x08;

   if(Data->YawEn)
      HDta |= 0x04;

   *CDta.c++ = HDta;

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

   CIGI_SCOPY4(CDta.f++, &Data->XOff);
   CIGI_SCOPY4(CDta.f++, &Data->YOff);
   CIGI_SCOPY4(CDta.f++, &Data->ZOff);
   CIGI_SCOPY4(CDta.f++, &Data->Roll);
   CIGI_SCOPY4(CDta.f++, &Data->Pitch);
   CIGI_SCOPY4(CDta.f++, &Data->Yaw);

   memcpy(Buff,tBuf,CIGI_VIEW_CTRL_PACKET_SIZE_V2);

   return(PacketSize);

}

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

   Cigi_uint8 *tBuf = (Cigi_uint8 *)DBuf;

   PackPointer CDta;

   memcpy(tBuf,Buff,CIGI_VIEW_CTRL_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++;

   ViewID = (Cigi_uint16)((HDta >> 3) & 0x1f);
   GroupID = (Cigi_uint8)(HDta & 0x07);

   HDta = *CDta.c++;

   XOffEn  = ((HDta & 0x80) != 0);
   YOffEn  = ((HDta & 0x40) != 0);
   ZOffEn  = ((HDta & 0x20) != 0);
   RollEn  = ((HDta & 0x10) != 0);
   PitchEn = ((HDta & 0x08) != 0);
   YawEn   = ((HDta & 0x04) != 0);

   CDta.c += 2;
   
   CIGI_SCOPY4(&XOff, CDta.f++);
   CIGI_SCOPY4(&YOff, CDta.f++);
   CIGI_SCOPY4(&ZOff, CDta.f++);
   CIGI_SCOPY4(&Roll, CDta.f++);
   CIGI_SCOPY4(&Pitch, CDta.f++);
   CIGI_SCOPY4(&Yaw, CDta.f++);

   return(PacketSize);

}



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


// ================================================
// ViewID
// vvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvv
int CigiViewCtrlV2::SetViewID(const Cigi_uint8 ViewIDIn, bool bndchk)
{

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

   ViewID = (Cigi_uint16)ViewIDIn;
   return(CIGI_SUCCESS);

}


// ================================================
// GroupID
// vvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvv
int CigiViewCtrlV2::SetGroupID(const Cigi_uint8 GroupIDIn, bool bndchk)
{

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

   GroupID = GroupIDIn;
   return(CIGI_SUCCESS);

}

---