nmea_trf.c

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

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

#include "NMEA_Lib.h"


#if (NMEA_INCLUDE_TRF == 1)

#include "NMEA_TRF.h"


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

    if('T' == sentence[0] && 'R' == sentence[1] && 'F' == sentence[2])
    {
        sentenceToUTC(sentence, &NMEAObject->TRFObject.UTCTime, &sentence_index, NMEA_TRF_UTCTIME, flags);
        sentenceToUINT32(sentence, &NMEAObject->TRFObject.Date, &sentence_index, NMEA_TRF_DATE, flags);
        sentenceToPOINT(sentence, &NMEAObject->TRFObject.Latitude, &sentence_index, NMEA_TRF_LATITUDE, flags);
        sentenceToCHAR(sentence, &NMEAObject->TRFObject.NorthOrSouth, &sentence_index, NMEA_TRF_NORTHORSOUTH, flags);
        sentenceToPOINT(sentence, &NMEAObject->TRFObject.Longitude, &sentence_index, NMEA_TRF_LONGITUDE, flags);
        sentenceToCHAR(sentence, &NMEAObject->TRFObject.EastOrWest, &sentence_index, NMEA_TRF_EASTORWEST, flags);
        sentenceToPOINT(sentence, &NMEAObject->TRFObject.ElevationAngle, &sentence_index, NMEA_TRF_ELEVATIONANGLE, flags);
        sentenceToPOINT(sentence, &NMEAObject->TRFObject.NumberOfIterations, &sentence_index, NMEA_TRF_NUMBEROFITERATIONS, flags);
        sentenceToPOINT(sentence, &NMEAObject->TRFObject.NumberOfDopplerIntervals, &sentence_index, NMEA_TRF_NUMBEROFDOPPLERINTERVALS, flags);
        sentenceToPOINT(sentence, &NMEAObject->TRFObject.UpdateDistance, &sentence_index, NMEA_TRF_UPDATEDISTANCE, flags);
        sentenceToUINT16(sentence, &NMEAObject->TRFObject.SatelliteID, &sentence_index, NMEA_TRF_SATELLITEID, flags);
        sentenceToCHAR(sentence, &NMEAObject->TRFObject.DataValidity, &sentence_index, NMEA_TRF_DATAVALIDITY, flags);
    }
    return ret_val;
}


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

    sentence[0] = 'T';
    sentence[1] = 'R';
    sentence[2] = 'F';

    sentenceFromUTC(sentence, &NMEAObject->TRFObject.UTCTime, &sentence_index, NMEA_TRF_UTCTIME, flags);
    sentenceFromUINT32(sentence, &NMEAObject->TRFObject.Date, &sentence_index, NMEA_TRF_DATE, flags);
    sentenceFromPOINT(sentence, &NMEAObject->TRFObject.Latitude, &sentence_index, NMEA_TRF_LATITUDE, flags);
    sentenceFromCHAR(sentence, &NMEAObject->TRFObject.NorthOrSouth, &sentence_index, NMEA_TRF_NORTHORSOUTH, flags);
    sentenceFromPOINT(sentence, &NMEAObject->TRFObject.Longitude, &sentence_index, NMEA_TRF_LONGITUDE, flags);
    sentenceFromCHAR(sentence, &NMEAObject->TRFObject.EastOrWest, &sentence_index, NMEA_TRF_EASTORWEST, flags);
    sentenceFromPOINT(sentence, &NMEAObject->TRFObject.ElevationAngle, &sentence_index, NMEA_TRF_ELEVATIONANGLE, flags);
    sentenceFromPOINT(sentence, &NMEAObject->TRFObject.NumberOfIterations, &sentence_index, NMEA_TRF_NUMBEROFITERATIONS, flags);
    sentenceFromPOINT(sentence, &NMEAObject->TRFObject.NumberOfDopplerIntervals, &sentence_index, NMEA_TRF_NUMBEROFDOPPLERINTERVALS, flags);
    sentenceFromPOINT(sentence, &NMEAObject->TRFObject.UpdateDistance, &sentence_index, NMEA_TRF_UPDATEDISTANCE, flags);
    sentenceFromUINT16(sentence, &NMEAObject->TRFObject.SatelliteID, &sentence_index, NMEA_TRF_SATELLITEID, flags);
    sentenceFromCHAR(sentence, &NMEAObject->TRFObject.DataValidity, &sentence_index, NMEA_TRF_DATAVALIDITY, flags);
    return ret_val;
}

#endif