NavigatingState.h

Go to the documentation of this file.

 
#ifndef NAVIGATING_STATE_H
#define NAVIGATING_STATE_H
 
#include "../interfaces/State.hpp"
#include "../util/GeospatialOperations.hpp"
#include "../util/states/StuckDetection.hpp"
#include "../vision/aruco/TagDetector.h"
 
 
namespace statemachine
{
 
    class NavigatingState : public State
    {
        private:
            // Declare private member variables.
            bool m_bFetchNewWaypoint;
            geoops::Waypoint m_stGoalWaypoint;
            int m_nMaxDataPoints;
            std::vector<double> m_vRoverXPosition;
            std::vector<double> m_vRoverYPosition;
            std::array<double, 2> m_dStuckCheckLastPosition;
            bool m_bInitialized;
            std::vector<TagDetector*> m_vTagDetectors;
            statemachine::TimeIntervalBasedStuckDetector m_StuckDetector;
 
        protected:
            // Declare protected class methods.
            void Start() override;
            void Exit() override;
 
        public:
            // Declare public class methods.
            NavigatingState();
            void Run() override;
            States TriggerEvent(Event eEvent) override;
    };
}    // namespace statemachine
 
#endif    // NAVIGATINGSTATE_H