GroundLevelEstimator.h

Go to the documentation of this file.

#ifndef AGL_DETECTOR_H
#define AGL_DETECTOR_H
#include <cstdint>
 
#define DEFAULT_GLE_ALPHA 0.1F
 
/*
TWO RULES - 2 input functions, 1 output:
 
input
Update function: current ASL in meters as a DataPoint type
Launch Dectcted: Call this when launch has happened (MUST BE SURE)
 
output
GetEGL (estimated ground level), returns a float that represents how many meters above sealevel the rocket was before launch
*/
 
class GroundLevelEstimator{
    public:
        GroundLevelEstimator(float alpha = DEFAULT_GLE_ALPHA);

        float update(float currentASL_m);

        void launchDetected();

        float getEGL() const;
 
    private:
 
        bool launched = false; // Turned true if launch is detected
        float estimatedGroundLevel_m = 0.0F; // EGL in meters
        uint32_t sampleCount = 0; // Number of samples used for ground level estimate
        float alpha; // Determines how much weight the most recent number added has on the current EGL
 
};
 
#endif