CigiIGMsgV2.cpp

Go to the documentation of this file.

#define _EXPORT_CCL_

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


// ================================================
// CigiIGMsgV2
// vvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvv
CigiIGMsgV2::CigiIGMsgV2()
{

   PacketID = CIGI_IG_MSG_PACKET_ID_V2;
   PacketSize = 8;
   Version = 2;
   MinorVersion = 0;

   MsgID = 0;
   memset(Msg,0,4);
   VariableDataSize = MsgLen = 4;

}

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

}

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

// ================================================
// Pack
// vvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvv
int CigiIGMsgV2::Pack(CigiBasePacket * Base, Cigi_uint8 * Buff, void *Spec) const
{

   Cigi_int16 tbuf;

   CigiBaseIGMsg * Data = ( CigiBaseIGMsg *)Base;

   Cigi_uint8 *CDta = Buff;

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

   CIGI_SCOPY2(&tbuf, &Data->MsgID);
   memcpy(CDta,&tbuf,2);
   CDta += 2;


   memcpy(CDta,Data->Msg,Data->MsgLen);

   return(Data->PacketSize);

}

// ================================================
// Unpack
// vvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvv
int CigiIGMsgV2::Unpack(Cigi_uint8 * Buff, bool Swap, void *Spec)
{

   Cigi_int16 tbuf;
   int tPktSz;

   Cigi_uint8 *CDta = Buff;

   CDta++;  // Step over packet id

   tPktSz = *CDta++;  // Get packet size

   memcpy(&tbuf,CDta,2);
   CIGI_SCOPY2(&MsgID, &tbuf);

   CDta += 2;

   if(tPktSz > 104)
   {
      PacketSize = 104;
      memcpy(&Msg,CDta,99);
      Msg[99] = 0;
   }
   else if(tPktSz <= 5)
   {
      PacketSize = tPktSz;
      Msg[0] = 0;
   }
   else
   {
      PacketSize = tPktSz;
      memcpy(&Msg,CDta,(tPktSz - 4));
      Msg[(tPktSz - 5)] = 0;
   }

   MsgLen = PacketSize - 4;

   return(tPktSz);

}


// ================================================
// GetTruePacketSize
// vvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvv
int CigiIGMsgV2::GetTruePacketSize(CigiBaseVariableSizePckt &refPacket)
{
   return(refPacket.GetVariableDataSize() + 4);
}



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


// ================================================
// SetMsg
// vvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvvv
int CigiIGMsgV2::SetMsg(const Cigi_Ascii *MsgIn, bool bndchk)
{

   MsgLen = strlen(MsgIn);

   if(MsgLen == 0)
   {
      MsgLen = 4;
      memset(Msg,0,4);
   }
   else if(MsgLen >= 95)
   {
      MsgLen = 100;
      memcpy(Msg,MsgIn,95);
      memset(&Msg[MsgLen],0,5);
      Msg[99] = 0;
   }
   else
   {
      memcpy(Msg,MsgIn,MsgLen);

      int tadj = (MsgLen + 1) % 4;

      tadj = (tadj == 0) ? 1 : (5 - tadj);

      memset(&Msg[MsgLen],0,(tadj+4));

      MsgLen += tadj;
   }

   VariableDataSize = MsgLen;
   PacketSize = VariableDataSize + 4;

   return(CIGI_SUCCESS);
}

---