Telemetry.h

Go to the documentation of this file.

#ifndef TELEMETRY_H
#define TELEMETRY_H
 
#include "data_handling/DataPoint.h"
#include "data_handling/SensorDataHandler.h"
#include <cstdint>
#include <unordered_map>
#include <vector>
#include "ArduinoHAL.h"
 
#define START_BYTE 51
#define END_BYTE 52

struct SendableSensorData {
    SensorDataHandler* singleSDH;
    SensorDataHandler** multiSDH;
    int multiSDHLength;
    int multiSDHDataLabel;
    int sendFrequencyHz;
    uint32_t lastSentTimestamp;
 
    SendableSensorData(SensorDataHandler* _singleSDH, SensorDataHandler** _multiSDH, int _multiSDHLength, int _multiSDHDataLabel, uint8_t _sendFrequencyHz) {
        singleSDH = _singleSDH;
        multiSDH = _multiSDH;
        multiSDHLength = _multiSDHLength;
        multiSDHDataLabel = _multiSDHDataLabel;
        sendFrequencyHz = _sendFrequencyHz;
        lastSentTimestamp = 0;
    }
    
    bool shouldBeSent(uint32_t time) {
        uint32_t delta = time-lastSentTimestamp;
        return delta >= (1000.0/sendFrequencyHz);
    }

    void markWasSent(uint32_t time) {
        lastSentTimestamp = time;
    }
};

class Telemetry {
    public:
    
        Telemetry(SendableSensorData* ssdArray[], int ssdArrayLength, Stream &rfdSerialConnection);

        bool tick(uint32_t currentTime);
 
    private:
        void preparePacket(uint32_t timestamp);
        void addSingleSDHToPacket(SensorDataHandler* sdh);
        void addSSDToPacket(SendableSensorData* ssd);
        void setPacketToZero();
        void addEndMarker();
 
        SendableSensorData** ssdArray;
        int ssdArrayLength;
        Stream &rfdSerialConnection;
        int nextEmptyPacketIndex;
        uint8_t packet[120]; //rfd settings indicate that 120 is the max packet size
};
 
#endif