EventTrigger.h

#pragma once
 
#include <frc2/command/button/Trigger.h>
#include <string>
#include <unordered_map>
#include "pathplanner/lib/events/EventScheduler.h"
 
namespace pathplanner {
class EventTrigger: public frc2::Trigger {
public:
    EventTrigger(std::string name) : frc2::Trigger(
            EventScheduler::getEventLoop(), pollCondition(name)) {
    }
 
    EventTrigger(frc::EventLoop *eventLoop, std::string name) : frc2::Trigger(
            eventLoop, pollCondition(name)) {
    }
 
    static inline void setCondition(std::string name, bool value) {
        getEventConditions()[name] = value;
    }
 
private:
 
    static inline std::unordered_map<std::string, bool>& getEventConditions() {
        static std::unordered_map<std::string, bool> *eventConditions =
                new std::unordered_map<std::string, bool>();
        return *eventConditions;
    }
 
    static inline std::function<bool()> pollCondition(std::string name) {
        // Ensure there is a condition in the map for this name
        if (!getEventConditions().contains(name)) {
            getEventConditions().emplace(name, false);
        }
 
        return [name]() {
            return getEventConditions()[name];
        };
    }
};
}