sbgEComBinaryLogUtc.c

Go to the documentation of this file.

#include "sbgEComBinaryLogUtc.h"

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

SbgErrorCode sbgEComBinaryLogParseUtcData(SbgStreamBuffer *pInputStream, SbgLogUtcData *pOutputData)
{
        //
        // Check input arguments
        //
        SBG_ASSERT(pInputStream);
        SBG_ASSERT(pOutputData);

        //
        // Read the frame payload
        //
        pOutputData->timeStamp          = sbgStreamBufferReadUint32LE(pInputStream);
        pOutputData->status                     = sbgStreamBufferReadUint16LE(pInputStream);
        pOutputData->year                       = sbgStreamBufferReadUint16LE(pInputStream);
        pOutputData->month                      = sbgStreamBufferReadInt8LE(pInputStream);
        pOutputData->day                        = sbgStreamBufferReadInt8LE(pInputStream);
        pOutputData->hour                       = sbgStreamBufferReadInt8LE(pInputStream);
        pOutputData->minute                     = sbgStreamBufferReadInt8LE(pInputStream);
        pOutputData->second                     = sbgStreamBufferReadInt8LE(pInputStream);
        pOutputData->nanoSecond         = sbgStreamBufferReadInt32LE(pInputStream);
        pOutputData->gpsTimeOfWeek      = sbgStreamBufferReadUint32LE(pInputStream);

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

SbgErrorCode sbgEComBinaryLogWriteUtcData(SbgStreamBuffer *pOutputStream, const SbgLogUtcData *pInputData)
{
        //
        // Check input arguments
        //
        SBG_ASSERT(pOutputStream);
        SBG_ASSERT(pInputData);

        //
        // Write the frame payload
        //
        sbgStreamBufferWriteUint32LE(pOutputStream, pInputData->timeStamp);
        sbgStreamBufferWriteUint16LE(pOutputStream, pInputData->status);
        sbgStreamBufferWriteUint16LE(pOutputStream, pInputData->year);
        sbgStreamBufferWriteInt8LE(pOutputStream, pInputData->month);
        sbgStreamBufferWriteInt8LE(pOutputStream, pInputData->day);
        sbgStreamBufferWriteInt8LE(pOutputStream, pInputData->hour);
        sbgStreamBufferWriteInt8LE(pOutputStream, pInputData->minute);
        sbgStreamBufferWriteInt8LE(pOutputStream, pInputData->second);
        sbgStreamBufferWriteInt32LE(pOutputStream, pInputData->nanoSecond);
        sbgStreamBufferWriteUint32LE(pOutputStream, pInputData->gpsTimeOfWeek);

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