nmea_rmb.c

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

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

#include "NMEA_Lib.h"


#if (NMEA_INCLUDE_RMB == 1)

#include "NMEA_RMB.h"


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

    if('R' == sentence[0] && 'M' == sentence[1] && 'B' == sentence[2])
    {
        sentenceToCHAR(sentence, &NMEAObject->RMBObject.StatusNavigationReceiverWarning, &sentence_index, NMEA_RMB_STATUSNAVIGATIONRECEIVERWARNING, flags);
        sentenceToPOINT(sentence, &NMEAObject->RMBObject.CrossTrackError, &sentence_index, NMEA_RMB_CROSSTRACKERROR, flags);
        sentenceToCHAR(sentence, &NMEAObject->RMBObject.DirectionToSteer, &sentence_index, NMEA_RMB_DIRECTIONTOSTEER, flags);
        sentenceToWPID(sentence, &NMEAObject->RMBObject.TOWaypointID, &sentence_index, NMEA_RMB_TOWAYPOINTID, flags);
        sentenceToWPID(sentence, &NMEAObject->RMBObject.FROMWaypointID, &sentence_index, NMEA_RMB_FROMWAYPOINTID, flags);
        sentenceToPOINT(sentence, &NMEAObject->RMBObject.DestinationWaypointLatitude, &sentence_index, NMEA_RMB_DESTINATIONWAYPOINTLATITUDE, flags);
        sentenceToCHAR(sentence, &NMEAObject->RMBObject.NorhtOrSouth, &sentence_index, NMEA_RMB_NORHTORSOUTH, flags);
        sentenceToPOINT(sentence, &NMEAObject->RMBObject.DestinationWaypointLongitude, &sentence_index, NMEA_RMB_DESTINATIONWAYPOINTLONGITUDE, flags);
        sentenceToCHAR(sentence, &NMEAObject->RMBObject.EastOrwest, &sentence_index, NMEA_RMB_EASTORWEST, flags);
        sentenceToPOINT(sentence, &NMEAObject->RMBObject.RangeToDestination, &sentence_index, NMEA_RMB_RANGETODESTINATION, flags);
        sentenceToPOINT(sentence, &NMEAObject->RMBObject.BearingToDestination, &sentence_index, NMEA_RMB_BEARINGTODESTINATION, flags);
        sentenceToPOINT(sentence, &NMEAObject->RMBObject.DestinationClosingVelocity, &sentence_index, NMEA_RMB_DESTINATIONCLOSINGVELOCITY, flags);
        sentenceToCHAR(sentence, &NMEAObject->RMBObject.ArrivalStatusArrivalCircleEntered, &sentence_index, NMEA_RMB_ARRIVALSTATUSARRIVALCIRCLEENTERED, flags);
    }
    return ret_val;
}


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

    sentence[0] = 'R';
    sentence[1] = 'M';
    sentence[2] = 'B';

    sentenceFromCHAR(sentence, &NMEAObject->RMBObject.StatusNavigationReceiverWarning, &sentence_index, NMEA_RMB_STATUSNAVIGATIONRECEIVERWARNING, flags);
    sentenceFromPOINT(sentence, &NMEAObject->RMBObject.CrossTrackError, &sentence_index, NMEA_RMB_CROSSTRACKERROR, flags);
    sentenceFromCHAR(sentence, &NMEAObject->RMBObject.DirectionToSteer, &sentence_index, NMEA_RMB_DIRECTIONTOSTEER, flags);
    sentenceFromWPID(sentence, &NMEAObject->RMBObject.TOWaypointID, &sentence_index, NMEA_RMB_TOWAYPOINTID, flags);
    sentenceFromWPID(sentence, &NMEAObject->RMBObject.FROMWaypointID, &sentence_index, NMEA_RMB_FROMWAYPOINTID, flags);
    sentenceFromPOINT(sentence, &NMEAObject->RMBObject.DestinationWaypointLatitude, &sentence_index, NMEA_RMB_DESTINATIONWAYPOINTLATITUDE, flags);
    sentenceFromCHAR(sentence, &NMEAObject->RMBObject.NorhtOrSouth, &sentence_index, NMEA_RMB_NORHTORSOUTH, flags);
    sentenceFromPOINT(sentence, &NMEAObject->RMBObject.DestinationWaypointLongitude, &sentence_index, NMEA_RMB_DESTINATIONWAYPOINTLONGITUDE, flags);
    sentenceFromCHAR(sentence, &NMEAObject->RMBObject.EastOrwest, &sentence_index, NMEA_RMB_EASTORWEST, flags);
    sentenceFromPOINT(sentence, &NMEAObject->RMBObject.RangeToDestination, &sentence_index, NMEA_RMB_RANGETODESTINATION, flags);
    sentenceFromPOINT(sentence, &NMEAObject->RMBObject.BearingToDestination, &sentence_index, NMEA_RMB_BEARINGTODESTINATION, flags);
    sentenceFromPOINT(sentence, &NMEAObject->RMBObject.DestinationClosingVelocity, &sentence_index, NMEA_RMB_DESTINATIONCLOSINGVELOCITY, flags);
    sentenceFromCHAR(sentence, &NMEAObject->RMBObject.ArrivalStatusArrivalCircleEntered, &sentence_index, NMEA_RMB_ARRIVALSTATUSARRIVALCIRCLEENTERED, flags);
    return ret_val;
}

#endif