sbgEComCmdAdvanced.c

Go to the documentation of this file.

#include "sbgEComCmdAdvanced.h"
#include <streamBuffer/sbgStreamBuffer.h>

//----------------------------------------------------------------------//
//- Event commands                                                             -//
//----------------------------------------------------------------------//

SbgErrorCode sbgEComCmdAdvancedGetConf(SbgEComHandle *pHandle, SbgEComAdvancedConf *pConf)
{
        SbgErrorCode            errorCode = SBG_NO_ERROR;
        uint32                          trial;
        size_t                          receivedSize;
        uint8                           receivedBuffer[SBG_ECOM_MAX_BUFFER_SIZE];
        SbgStreamBuffer         inputStream;

        //
        // Test that the input pointers are valid
        //
        if ((pHandle) && (pConf))
        {
                //
                // Send the command three times
                //
                for (trial = 0; trial < pHandle->numTrials; trial++)
                {
                        //
                        // Send the command without payload since this is a no-payload command
                        //
                        errorCode = sbgEComProtocolSend(&pHandle->protocolHandle, SBG_ECOM_CLASS_LOG_CMD_0, SBG_ECOM_CMD_ADVANCED_CONF, NULL, 0);

                        //
                        // Make sure that the command has been sent
                        //
                        if (errorCode == SBG_NO_ERROR)
                        {
                                //
                                // Try to read the device answer for 500 ms
                                //
                                errorCode = sbgEComReceiveCmd(pHandle, SBG_ECOM_CLASS_LOG_CMD_0, SBG_ECOM_CMD_ADVANCED_CONF, receivedBuffer, &receivedSize, sizeof(receivedBuffer), pHandle->cmdDefaultTimeOut);

                                //
                                // Test if we have received a SBG_ECOM_CMD_ADVANCED_CONF command
                                //
                                if (errorCode == SBG_NO_ERROR)
                                {
                                        //
                                        // Initialize stream buffer to read parameters
                                        //
                                        sbgStreamBufferInitForRead(&inputStream, receivedBuffer, receivedSize);

                                        //
                                        // Read parameters
                                        //
                                        pConf->timeReference = (SbgEComTimeReferenceSrc)sbgStreamBufferReadUint8LE(&inputStream);

                                        //
                                        // The command has been executed successfully so return
                                        //
                                        break;
                                }
                        }
                        else
                        {
                                //
                                // We have a write error so exit the try loop
                                //
                                break;
                        }
                }
        }
        else
        {
                //
                // Null pointer
                //
                errorCode = SBG_NULL_POINTER;
        }

        return errorCode;
}

SbgErrorCode sbgEComCmdAdvancedSetConf(SbgEComHandle *pHandle, const SbgEComAdvancedConf *pConf)
{
        SbgErrorCode            errorCode = SBG_NO_ERROR;
        uint32                          trial;
        uint8                           outputBuffer[SBG_ECOM_MAX_BUFFER_SIZE];
        SbgStreamBuffer         outputStream;

        //
        // Test that the input pointer are valid
        //
        if ((pHandle) && (pConf))
        {
                //
                // Send the command three times
                //
                for (trial = 0; trial < pHandle->numTrials; trial++)
                {
                        //
                        // Init stream buffer for output
                        //
                        sbgStreamBufferInitForWrite(&outputStream, outputBuffer, sizeof(outputBuffer));

                        //
                        // Build payload
                        //
                        sbgStreamBufferWriteUint8LE(&outputStream, (uint8)pConf->timeReference);

                        //
                        // Send the payload over ECom
                        //
                        errorCode = sbgEComProtocolSend(&pHandle->protocolHandle, SBG_ECOM_CLASS_LOG_CMD_0, SBG_ECOM_CMD_ADVANCED_CONF, sbgStreamBufferGetLinkedBuffer(&outputStream), sbgStreamBufferGetLength(&outputStream));

                        //
                        // Make sure that the command has been sent
                        //
                        if (errorCode == SBG_NO_ERROR)
                        {
                                //
                                // Try to read the device answer for 500 ms
                                //
                                errorCode = sbgEComWaitForAck(pHandle, SBG_ECOM_CLASS_LOG_CMD_0, SBG_ECOM_CMD_ADVANCED_CONF, pHandle->cmdDefaultTimeOut);

                                //
                                // Test if we have received a valid ACK
                                //
                                if (errorCode == SBG_NO_ERROR)
                                {
                                        //
                                        // The command has been executed successfully so return
                                        //
                                        break;
                                }
                        }
                        else
                        {
                                //
                                // We have a write error so exit the try loop
                                //
                                break;
                        }
                }
        }
        else
        {
                //
                // Null pointer.
                //
                errorCode = SBG_NULL_POINTER;
        }

        return errorCode;
}