ApogeeDetector.h

Go to the documentation of this file.

#ifndef APOGEE_DETECTOR_H
#define APOGEE_DETECTOR_H
 
#include <cstdint>
 
#include "data_handling/DataPoint.h"
#include "state_estimation/VerticalVelocityEstimator.h"

struct ApogeeDetectorInitialState {
    float initialAltitude;       
    uint32_t initialTimestamp;   
};

class ApogeeDetector {
public:
    explicit ApogeeDetector(float apogeeThreshold_m);

    ApogeeDetector() : ApogeeDetector(1.0F) {}

    void init(ApogeeDetectorInitialState initialState);

    void update(VerticalVelocityEstimator* verticalVelocityEstimator);

    bool isApogeeDetected() const;

    DataPoint getApogee() const;

    float getEstimatedAltitude() const;

    float getEstimatedVelocity() const;

    float getInertialVerticalAcceleration() const;

    int8_t getVerticalAxis() const;

    int8_t getVerticalDirection() const;
 
private:
    bool apogeeDetected_ = false;              
    float apogeeThreshold_m_ = 1.0F;        
 
    float maxAltitude_ = 0.0F;              
    uint32_t maxAltitudeTimestamp_ = 0;     
};
 
#endif // APOGEE_DETECTOR_H