sbgEComBinaryLogDiag.c

Go to the documentation of this file.

// sbgCommonLib headers
#include <sbgCommon.h>
#include <streamBuffer/sbgStreamBuffer.h>
 
// Local headers
#include "sbgEComBinaryLogDiag.h"
 
//----------------------------------------------------------------------//
//- Public functions                                                   -//
//----------------------------------------------------------------------//
 
SbgErrorCode sbgEComBinaryLogParseDiagData(SbgStreamBuffer *pInputStream, SbgLogDiagData *pOutputData)
{
        assert(pInputStream);
        assert(pOutputData);
 
        pOutputData->timestamp          = sbgStreamBufferReadUint32LE(pInputStream);
        pOutputData->type                       = (SbgDebugLogType)sbgStreamBufferReadUint8(pInputStream);
        pOutputData->errorCode          = (SbgErrorCode)sbgStreamBufferReadUint8(pInputStream);
 
        sbgStreamBufferReadBuffer(pInputStream, pOutputData->string, sbgStreamBufferGetSpace(pInputStream));
        pOutputData->string[sizeof(pOutputData->string) - 1] = '\0';
 
        return sbgStreamBufferGetLastError(pInputStream);
}
 
SbgErrorCode sbgEComBinaryLogWriteDiagData(SbgStreamBuffer *pOutputStream, const SbgLogDiagData *pInputData)
{
        size_t                                                           length;
 
        assert(pOutputStream);
        assert(pInputData);
 
        sbgStreamBufferWriteUint32LE(pOutputStream, pInputData->timestamp);
        sbgStreamBufferWriteUint8(pOutputStream, pInputData->type);
        sbgStreamBufferWriteUint8(pOutputStream, pInputData->errorCode);
 
        length = strlen(pInputData->string);
 
        if (length >= sizeof(pInputData->string))
        {
                length = sizeof(pInputData->string) - 1;
        }
 
        sbgStreamBufferWriteBuffer(pOutputStream, pInputData->string, length);
        sbgStreamBufferWriteUint8(pOutputStream, 0);
 
        return sbgStreamBufferGetLastError(pOutputStream);
}