nmea_rsd.c

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

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

#include "NMEA_Lib.h"


#if (NMEA_INCLUDE_RSD == 1)

#include "NMEA_RSD.h"


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

    if('R' == sentence[0] && 'S' == sentence[1] && 'D' == sentence[2])
    {
        sentenceToPOINT(sentence, &NMEAObject->RSDObject.Dummy1, &sentence_index, NMEA_RSD_DUMMY1, flags);
        sentenceToPOINT(sentence, &NMEAObject->RSDObject.Dummy2, &sentence_index, NMEA_RSD_DUMMY2, flags);
        sentenceToPOINT(sentence, &NMEAObject->RSDObject.Dummy3, &sentence_index, NMEA_RSD_DUMMY3, flags);
        sentenceToPOINT(sentence, &NMEAObject->RSDObject.Dummy4, &sentence_index, NMEA_RSD_DUMMY4, flags);
        sentenceToPOINT(sentence, &NMEAObject->RSDObject.Dummy5, &sentence_index, NMEA_RSD_DUMMY5, flags);
        sentenceToPOINT(sentence, &NMEAObject->RSDObject.Dummy6, &sentence_index, NMEA_RSD_DUMMY6, flags);
        sentenceToPOINT(sentence, &NMEAObject->RSDObject.Dummy7, &sentence_index, NMEA_RSD_DUMMY7, flags);
        sentenceToPOINT(sentence, &NMEAObject->RSDObject.Dummy8, &sentence_index, NMEA_RSD_DUMMY8, flags);
        sentenceToPOINT(sentence, &NMEAObject->RSDObject.Dummy9, &sentence_index, NMEA_RSD_DUMMY9, flags);
        sentenceToPOINT(sentence, &NMEAObject->RSDObject.CursorRangeFromOwnShip, &sentence_index, NMEA_RSD_CURSORRANGEFROMOWNSHIP, flags);
        sentenceToPOINT(sentence, &NMEAObject->RSDObject.CursorBearingDegreesClockwiseFromZero, &sentence_index, NMEA_RSD_CURSORBEARINGDEGREESCLOCKWISEFROMZERO, flags);
        sentenceToCHAR(sentence, &NMEAObject->RSDObject.RangeScale, &sentence_index, NMEA_RSD_RANGESCALE, flags);
        sentenceToCHAR(sentence, &NMEAObject->RSDObject.RangeUnits, &sentence_index, NMEA_RSD_RANGEUNITS, flags);
    }
    return ret_val;
}


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

    sentence[0] = 'R';
    sentence[1] = 'S';
    sentence[2] = 'D';

    sentenceFromPOINT(sentence, &NMEAObject->RSDObject.Dummy1, &sentence_index, NMEA_RSD_DUMMY1, flags);
    sentenceFromPOINT(sentence, &NMEAObject->RSDObject.Dummy2, &sentence_index, NMEA_RSD_DUMMY2, flags);
    sentenceFromPOINT(sentence, &NMEAObject->RSDObject.Dummy3, &sentence_index, NMEA_RSD_DUMMY3, flags);
    sentenceFromPOINT(sentence, &NMEAObject->RSDObject.Dummy4, &sentence_index, NMEA_RSD_DUMMY4, flags);
    sentenceFromPOINT(sentence, &NMEAObject->RSDObject.Dummy5, &sentence_index, NMEA_RSD_DUMMY5, flags);
    sentenceFromPOINT(sentence, &NMEAObject->RSDObject.Dummy6, &sentence_index, NMEA_RSD_DUMMY6, flags);
    sentenceFromPOINT(sentence, &NMEAObject->RSDObject.Dummy7, &sentence_index, NMEA_RSD_DUMMY7, flags);
    sentenceFromPOINT(sentence, &NMEAObject->RSDObject.Dummy8, &sentence_index, NMEA_RSD_DUMMY8, flags);
    sentenceFromPOINT(sentence, &NMEAObject->RSDObject.Dummy9, &sentence_index, NMEA_RSD_DUMMY9, flags);
    sentenceFromPOINT(sentence, &NMEAObject->RSDObject.CursorRangeFromOwnShip, &sentence_index, NMEA_RSD_CURSORRANGEFROMOWNSHIP, flags);
    sentenceFromPOINT(sentence, &NMEAObject->RSDObject.CursorBearingDegreesClockwiseFromZero, &sentence_index, NMEA_RSD_CURSORBEARINGDEGREESCLOCKWISEFROMZERO, flags);
    sentenceFromCHAR(sentence, &NMEAObject->RSDObject.RangeScale, &sentence_index, NMEA_RSD_RANGESCALE, flags);
    sentenceFromCHAR(sentence, &NMEAObject->RSDObject.RangeUnits, &sentence_index, NMEA_RSD_RANGEUNITS, flags);
    return ret_val;
}

#endif