nmea_vtg.c

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

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

#include "NMEA_Lib.h"


#if (NMEA_INCLUDE_VTG == 1)

#include "NMEA_VTG.h"


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

    if('V' == sentence[0] && 'T' == sentence[1] && 'G' == sentence[2])
    {
        sentenceToPOINT(sentence, &NMEAObject->VTGObject.TrackDegrees, &sentence_index, NMEA_VTG_TRACKDEGREES, flags);
        sentenceToCHAR(sentence, &NMEAObject->VTGObject.True, &sentence_index, NMEA_VTG_TRUE, flags);
        sentenceToPOINT(sentence, &NMEAObject->VTGObject.TrackDegreesMagnetic, &sentence_index, NMEA_VTG_TRACKDEGREESMAGNETIC, flags);
        sentenceToCHAR(sentence, &NMEAObject->VTGObject.Magnetic, &sentence_index, NMEA_VTG_MAGNETIC, flags);
        sentenceToPOINT(sentence, &NMEAObject->VTGObject.SpeedKnots, &sentence_index, NMEA_VTG_SPEEDKNOTS, flags);
        sentenceToCHAR(sentence, &NMEAObject->VTGObject.Knots, &sentence_index, NMEA_VTG_KNOTS, flags);
        sentenceToPOINT(sentence, &NMEAObject->VTGObject.SpeedKilometersPerHour, &sentence_index, NMEA_VTG_SPEEDKILOMETERSPERHOUR, flags);
        sentenceToCHAR(sentence, &NMEAObject->VTGObject.KilometersPerHour, &sentence_index, NMEA_VTG_KILOMETERSPERHOUR, flags);
    }
    return ret_val;
}


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

    sentence[0] = 'V';
    sentence[1] = 'T';
    sentence[2] = 'G';

    sentenceFromPOINT(sentence, &NMEAObject->VTGObject.TrackDegrees, &sentence_index, NMEA_VTG_TRACKDEGREES, flags);
    sentenceFromCHAR(sentence, &NMEAObject->VTGObject.True, &sentence_index, NMEA_VTG_TRUE, flags);
    sentenceFromPOINT(sentence, &NMEAObject->VTGObject.TrackDegreesMagnetic, &sentence_index, NMEA_VTG_TRACKDEGREESMAGNETIC, flags);
    sentenceFromCHAR(sentence, &NMEAObject->VTGObject.Magnetic, &sentence_index, NMEA_VTG_MAGNETIC, flags);
    sentenceFromPOINT(sentence, &NMEAObject->VTGObject.SpeedKnots, &sentence_index, NMEA_VTG_SPEEDKNOTS, flags);
    sentenceFromCHAR(sentence, &NMEAObject->VTGObject.Knots, &sentence_index, NMEA_VTG_KNOTS, flags);
    sentenceFromPOINT(sentence, &NMEAObject->VTGObject.SpeedKilometersPerHour, &sentence_index, NMEA_VTG_SPEEDKILOMETERSPERHOUR, flags);
    sentenceFromCHAR(sentence, &NMEAObject->VTGObject.KilometersPerHour, &sentence_index, NMEA_VTG_KILOMETERSPERHOUR, flags);
    return ret_val;
}

#endif