sbgEComBinaryLogDebug.c

Go to the documentation of this file.

#include "sbgEComBinaryLogDebug.h"

//----------------------------------------------------------------------//
//- Operations                                                         -//
//----------------------------------------------------------------------//

SbgErrorCode sbgEComBinaryLogParseDebug0Data(SbgStreamBuffer *pInputStream, SbgLogDebug0Data *pOutputData)
{
        uint32                  i;

        //
        // Check input arguments
        //
        SBG_ASSERT(pInputStream);
        SBG_ASSERT(pOutputData);
        
        //
        // Read the frame payload and return
        //
        pOutputData->timeStamp = sbgStreamBufferReadUint32LE(pInputStream);

        //
        // Read each value in the array
        //
        for (i = 0; i < 64; i++)
        {
                pOutputData->data[i] = sbgStreamBufferReadUint32LE(pInputStream);
        }

        //
        // Return if any error has occurred while parsing the frame
        //
        return sbgStreamBufferGetLastError(pInputStream);
}

SbgErrorCode sbgEComBinaryLogWriteDebug0Data(SbgStreamBuffer *pOutputStream, const SbgLogDebug0Data *pInputData)
{
        uint32  i;

        //
        // Check input arguments
        //
        SBG_ASSERT(pOutputStream);
        SBG_ASSERT(pInputData);

        //
        // Write the frame payload
        //
        sbgStreamBufferWriteUint32LE(pOutputStream, pInputData->timeStamp);

        //
        // Write each value in the array
        //
        for (i = 0; i < 64; i++)
        {
                sbgStreamBufferWriteUint32LE(pOutputStream, pInputData->data[i]);
        }

        //
        // Return if any error has occurred while writing the frame
        //
        return sbgStreamBufferGetLastError(pOutputStream);
}