ApproachingObjectState.h

Go to the documentation of this file.

 
#ifndef APPROACHING_OBJECT_STATE_H
#define APPROACHING_OBJECT_STATE_H
 
#include "../interfaces/State.hpp"
#include "../util/GeospatialOperations.hpp"
#include "../util/states/StuckDetection.hpp"
#include "../util/vision/ObjectDetectionUtility.hpp"
#include "../vision/objects/ObjectDetector.h"
 
#include <chrono>
 
 
namespace statemachine
{
 
    class ApproachingObjectState : public State
    {
        private:
            // Core Components
            std::vector<std::shared_ptr<ObjectDetector>> m_vObjectDetectors;
            statemachine::TimeIntervalBasedStuckDetector m_StuckDetector;
 
            // State tracking
            States m_eTriggeringState;
            bool m_bInitialized;
            geoops::Waypoint m_stGoalWaypoint;
 
            // Persistent tracking variables for Run()
            double m_dHeadingSetPoint;
            bool m_bDriveBackwards;
 
            // Geolocation fallback
            geoops::Waypoint m_stLastGeolocatedPosition;
            bool m_bHasLastGeolocatedPosition;
            bool m_bHasSeenTarget;
 
            // Timing and logging flags
            std::chrono::system_clock::time_point m_tmLastSeenTime;
            std::chrono::system_clock::time_point m_tmLastLogTime;
            bool m_bAlreadyPrintedLost;
            bool m_bAlreadyPrintedVisualLostFallback;
 
        protected:
            void Start() override;
            void Exit() override;
 
        public:
            ApproachingObjectState();
            void Run() override;
            States TriggerEvent(Event eEvent) override;
    };
}    // namespace statemachine
 
#endif    // APPROACHING_OBJECT_STATE_H