forums.naturalpoint.com

Code: Select all

// PacketClient.cpp
DWORD WINAPI CommandListenThread(void* dummy)
{
...
        // handle command
        switch (PacketIn.iMessage)
        {
        case NAT_MODELDEF:
            Unpack((char*)&PacketIn);
            break;
        case NAT_FRAMEOFDATA:
            Unpack((char*)&PacketIn);
            break;
        case NAT_PINGRESPONSE:
//          // This can be used in conjunction with precompiler directive:
//          // #pragma pack(push, 1)
//          for(int i=0; i<4; i++)
//          {
//              NatNetVersion[i] = (int)PacketIn.Data.Sender.NatNetVersion[i];
//              ServerVersion[i] = (int)PacketIn.Data.Sender.Version[i];
//          }

            // This is the alternative: Directly access the sPacket structure fields
            // The pointer needs to traverse the datagram manually.
            char *ptr = (char*)&PacketIn;
            // message ID
            ptr += 2;
            // payload size
            ptr += 2;
            // sending app's name
            ptr += MAX_NAMELENGTH;
            // sending app's version [major.minor.build.revision]
            // sending app's NatNet version [major.minor.build.revision]
            for(int i=0; i<4; i++){
                ServerVersion[i] = (int)*ptr;
                NatNetVersion[i] = (int)*(ptr+4); ptr++;
            }
            break;
....

Code: Select all

// PacketClient.cpp
void Unpack(char* pData) {
...
    // skeletons (version 2.1 and later)
        if( ((major == 2)&&(minor>0)) || (major>2)) {
            ...
                   // Mean marker error
                   float fError = 0.0f; memcpy(&fError, ptr, 4); ptr += 4;
                   printf("Mean marker error: %3.2f\n", fError);

                   // release resources
                   if(markerIDs)
                       free(markerIDs);
                   if(markerSizes)
                       free(markerSizes);
                   if(markerData)
                       free(markerData);

                   // Issue #5 Fix : Motive:body is appending 2 bytes of zero data
                   // to the end of each rigid body (belonging to a skeleton) data.
                   // The problem may be caused by structure padding on the
                   // Motive:body software.
                   // NOTE: Please contact NaturalPoint, Inc to solve the issue at the source.
                   ptr += 2;   // Issue #5 Fix.

                 } // next rigid body

             } // next skeleton

        }
        
	// labeled markers (version 2.3 and later)
	if( ((major == 2)&&(minor>=3)) || (major>2))
	{
....