RTCMParser.h

Go to the documentation of this file.

#pragma once
 
#include <cstddef>
#include <cstdint>
 
static constexpr uint8_t RTCM3_PREAMBLE = 0xD3;
 
class RTCMParser
{
public:
    RTCMParser();
    void reset();
    bool addByte(uint8_t byte);
    uint8_t* message() { return _buffer; }
    uint16_t messageLength() const { return _messageLength; }
    uint16_t messageId() const;
    const uint8_t* crcBytes() const { return _crcBytes; }
    static constexpr int kCrcSize = 3;
 
    bool validateCrc() const;
    static uint32_t crc24q(const uint8_t* data, size_t len);
 
private:
    enum State {
        WaitingForPreamble,
        ReadingLength,
        ReadingMessage,
        ReadingCRC
    };
 
    static constexpr uint16_t kMaxPayloadLength = 1023;
    static constexpr int kHeaderSize = 3;
 
    State _state;
    uint8_t _buffer[kHeaderSize + kMaxPayloadLength];
    uint16_t _messageLength;
    uint16_t _bytesRead;
    uint16_t _lengthBytesRead;
    uint8_t _lengthBytes[2];
    uint16_t _crcBytesRead;
    uint8_t _crcBytes[3];
};