DebounceSensor.h

#pragma once
 
#include <functional>
#include <string>
 
#include <frc/TimedRobot.h>
#include <valkyrie/sensors/BaseSensor.h>
 
namespace valor {
namespace sensors {

class DebounceSensor : public BaseSensor<bool> {
   public:
    DebounceSensor();

    inline void SetEdgeCallback(std::function<void()> lambda) { edge = lambda; }

    inline void SetRisingEdgeCallback(std::function<void()> lambda) { risingEdge = lambda; }

    inline void SetFallingEdgeCallback(std::function<void()> lambda) { fallingEdge = lambda; }
 
    void LoggablePeriodic() override;
 
   protected:
    void Calculate() override;
 
   private:
    std::function<void()> edge;         
    std::function<void()> fallingEdge;  
    std::function<void()> risingEdge;   
};
 
}  // namespace sensors
}  // namespace valor