nmea_fsi.c

来自「the example file that can decode the NME」· C语言 代码 · 共 47 行

#include <stdlib.h>
#include <string.h>

#include "NMEA_Lib.h"


#if (NMEA_INCLUDE_FSI == 1)

#include "NMEA_FSI.h"


BOOL NMEA_ParseFSISentence(CHAR * sentence, struct NMEAObject_t * NMEAObject, UINT32 * flags)
{
    UINT32 sentence_index = 3;
    BOOL ret_val = NMEA_FAILURE;

    if('F' == sentence[0] && 'S' == sentence[1] && 'I' == sentence[2])
    {
        sentenceToUINT32(sentence, &NMEAObject->FSIObject.TransmittingFrequency, &sentence_index, NMEA_FSI_TRANSMITTINGFREQUENCY, flags);
        sentenceToUINT32(sentence, &NMEAObject->FSIObject.ReceivingFrequency, &sentence_index, NMEA_FSI_RECEIVINGFREQUENCY, flags);
        sentenceToCHAR(sentence, &NMEAObject->FSIObject.CommunicationsMode, &sentence_index, NMEA_FSI_COMMUNICATIONSMODE, flags);
        sentenceToCHAR(sentence, &NMEAObject->FSIObject.PowerLevel, &sentence_index, NMEA_FSI_POWERLEVEL, flags);
    }
    return ret_val;
}


BOOL NMEA_CreateFSISentence(CHAR * sentence, struct NMEAObject_t * NMEAObject, UINT32 * flags)
{
    UINT32 sentence_index = 3;
    BOOL ret_val = NMEA_FAILURE;

    sentence[0] = 'F';
    sentence[1] = 'S';
    sentence[2] = 'I';

    sentenceFromUINT32(sentence, &NMEAObject->FSIObject.TransmittingFrequency, &sentence_index, NMEA_FSI_TRANSMITTINGFREQUENCY, flags);
    sentenceFromUINT32(sentence, &NMEAObject->FSIObject.ReceivingFrequency, &sentence_index, NMEA_FSI_RECEIVINGFREQUENCY, flags);
    sentenceFromCHAR(sentence, &NMEAObject->FSIObject.CommunicationsMode, &sentence_index, NMEA_FSI_COMMUNICATIONSMODE, flags);
    sentenceFromCHAR(sentence, &NMEAObject->FSIObject.PowerLevel, &sentence_index, NMEA_FSI_POWERLEVEL, flags);
    return ret_val;
}

#endif