MIRA
Public Types | Public Member Functions | Static Public Member Functions | Public Attributes | Protected Types | Protected Member Functions | Protected Attributes | List of all members
EstarPlanner Class Referenceabstract

#include <pilot/EstarPlanner.h>

Inheritance diagram for EstarPlanner:
Inheritance graph
[legend]

Public Types

enum  Status {
  OUT_OF_GRID, VALID, INVALID, WAVEFRONT,
  OUTDATED, GOAL, OBSTACLE
}
 Planner status of a fixed position (planner map cell) More...
 
typedef std::vector< Point2f > Carrot
 
typedef std::function< float(int x, int y, float r)> CostFn
 Type declaration for a cost function to be used with setGoal(const Polygon2i, ...) or setGoal(const Polygon2f, ...). More...
 
enum  Flags
 
typedef std::multimap< std::string, std::string > ChannelNameMapping
 
typedef std::map< std::string, Status > ChannelStatusMap
 
typedef std::map< std::string, Status > StatusMap
 

Public Member Functions

 EstarPlanner (bool useDoubleBuffer=false, bool persistentDoubleBuffer=false)
 
virtual ~EstarPlanner ()
 
template<typename Reflector >
void reflect (Reflector &r)
 
virtual double infinity () const
 Implementation of AbstractMetricPlanner::infinity(). More...
 
virtual bool hasValidGoal () const
 Implementation of AbstractMetricPlanner::hasValidGoal() More...
 
virtual bool haveWork () const
 Implementation of AbstractMetricPlanner::haveWork() More...
 
virtual void planStep ()
 Implementation of AbstractMetricPlanner::planStep() More...
 
virtual double getCurrentValueMap (const Point2i &mapPos) const
 Implementation of MetricPlannerBase::getCurrentValueMap() More...
 
virtual Carrot getCurrentCarrot (const Point2f &pos, int maxCount, float maxDistance=1e10f) const
 Implementation of MetricPlannerBase::getCurrentCarrot() More...
 
virtual maps::CostMap getCurrentNavFunction () const
 Implementation of MetricPlannerBase::getCurrentNavFunction() More...
 
virtual void setOnewayMap (const maps::OccupancyGrid &onewayMap)
 Implementation of AbstractMetricPlanner::setOnewayMap(). More...
 
void setUseDoubleBuffer (bool useDoubleBuffer)
 Enable/disable double buffer. More...
 
void setPersistentDoubleBuffer (bool persistentDoubleBuffer)
 Enable/disable persistent double buffer (i.e. not reset when setting goal) More...
 
virtual Point2f getGradient (const Point2f &worldPos) const
 Implementation of AbstractMetricPlanner::getGradient(const Point2f&) More...
 
Point2f getGradientMap (const Point2i &mapPos) const
 Returns the gradient for a position in map coordinates. More...
 
virtual Point2f getCurrentGradientMap (const Point2i &mapPos) const
 Returns the gradient for a position in map coordinates from current costs. More...
 
virtual void update (const maps::CostMap &map, const maps::DirtyRegions &dirty)
 Implementation of AbstractMetricPlanner::update(const maps::CostMap&, const maps::DirtyRegions&) More...
 
void update (const maps::CostMap &map)
 Update the planning context with the current costmap (entire area). More...
 
double getValue (const Point2f &worldPos, bool ignoreDoubleBuffer=false) const
 Implementation of AbstractMetricPlanner::getValue(const Point2f&, bool) More...
 
double getValueMap (const Point2i &mapPos, bool ignoreDoubleBuffer=false) const
 Returns the cost value at position (in map coordinates) in the planner map. More...
 
virtual double getValueFiltered (const Point2f &worldPos, bool ignoreDoubleBuffer=false) const
 Implementation of AbstractMetricPlanner::getValueFiltered(const Point2f&, bool) More...
 
virtual Carrot getCarrot (const Point2f &pos, int maxCount, float maxDistance=1e10f) const
 Implementation of AbstractMetricPlanner::getCarrot(const Point2f&, int, float) More...
 
virtual Carrot getDoubleBufferCarrot (const Point2f &pos, int maxCount, float maxDistance=1e10f) const
 Return the optimal path to the goal, starting at pos, based on the double buffer. More...
 
virtual Pose2 getCurrentGoal (const Point2f &pos) const
 Implementation of AbstractMetricPlanner::getCurrentGoal(const Point2f&) More...
 
Point2i world2map (const Point2f &p) const
 Implementation of AbstractMetricPlanner::world2map(const Point2f&) More...
 
Point2f map2world (const Point2i &p) const
 Implementation of AbstractMetricPlanner::world2map(const Point2i&) More...
 
float getCellSize () const
 Implementation of AbstractMetricPlanner::getCellSize() More...
 
Rect2f getRegion () const
 Implementation of AbstractMetricPlanner::getRegion() More...
 
Rect2i getMapRegion () const
 Implementation of AbstractMetricPlanner::getMapRegion() More...
 
bool getUseDoubleBuffer () const
 Double buffer enabled? More...
 
bool getPersistentDoubleBuffer () const
 Persistent double buffer enabled (i.e. not reset on setting goal)? More...
 
Duration getAccumulatedPlanningTime () const
 Implementation of AbstractMetricPlanner::getAccumulatedPlanningTime() More...
 
void setGoal (const Point2f &goal, float radius, bool clearDoubleBuffer=true, bool prepareNew=true)
 Implementation of AbstractMetricPlanner::setGoal(const Point2f&, float, bool, bool) More...
 
void setGoal (const Polygon2i &polygon, int radius=1, bool clearDoubleBuffer=true, bool prepareNew=true)
 Implementation of AbstractMetricPlanner::setGoal(const Polygon2i&, int, bool, bool) More...
 
void setGoal (const Polygon2f &polygon, float radius=0.1f, bool clearDoubleBuffer=true, bool prepareNew=true)
 Implementation of AbstractMetricPlanner::setGoal(const Polygon2f&, float, bool, bool) More...
 
void setGoal (const Polygon2i &polygon, int radius, CostFn &costFn, bool clearDoubleBuffer=true, bool prepareNew=true)
 Implementation of AbstractMetricPlanner::setGoal(const Polygon2i&, int, CostFn, bool, bool) More...
 
void setGoal (const Polygon2f &polygon, float radius, CostFn &costFn, bool clearDoubleBuffer=true, bool prepareNew=true)
 Implementation of AbstractMetricPlanner::setGoal(const Polygon2f&, float, CostFn, bool, bool) More...
 
float defaultCostFn (int x, int y, float r)
 A default cost function which is always returning r (radius) More...
 
void plan (const Point2f &pos, Duration plantime)
 Implementation of AbstractMetricPlanner::plan(const Point2f&, Duration) More...
 
bool havePlan () const
 Implementation of AbstractMetricPlanner::havePlan() More...
 
bool havePlanSinceUpdate () const
 Implementation of AbstractMetricPlanner::havePlanSinceUpdate() More...
 
Time lastValidPlan () const
 Implementation of AbstractMetricPlanner::lastValidPlan() More...
 
void planTime (Duration plantime)
 Implementation of AbstractMetricPlanner::planTime(Duration) More...
 
void planSteps (int steps)
 Implementation of AbstractMetricPlanner::planSteps(int) More...
 
void resetPlanningTimeout ()
 Implementation of AbstractMetricPlanner::resetPlanningTimeout() More...
 
maps::CostMap getNavFunction (bool ignoreDoubleBuffer=false) const
 Implementation of AbstractMetricPlanner::getNavFunction(bool) More...
 
maps::GridMap< uint8, 3 > dumpNavStatus (bool useDoubleBuffer=false, bool costsInGoalRegion=true)
 Implementation of AbstractMetricPlanner::dumpNavStatus(bool, bool) More...
 
maps::GridMap< uint8, 3 > showNavFunctionNearGoal ()
 Implementation of AbstractMetricPlanner::showNavFunctionNearGoal() More...
 
Status getStatus (const Point2f &p) const
 Implementation of AbstractMetricPlanner::getStatus(const Point2f&) More...
 
Status::StatusMode getStatus () const
 
StatusMap getStatusMap () const
 
StatusManager::StatusMap getStatusMap () override
 
void initialize (Authority *parent)
 
virtual void setRobotPosition (const Point2f &robotPos)
 Set the current robot position in planner (world position) Base implementation is empty. More...
 
Class const & getClass () const
 
void enableSubscriberCallbacks (bool enable)
 
StatusManager & getStatusManager ()
 
void setHeartbeatInterval (const Duration &interval)
 
void setName (const std::string &name)
 
Duration getHeartbeatInterval () const
 
void heartbeat ()
 
bool hasHeartbeatTimeout () const
 
void bootup (const std::string &message, const std::string &trText="")
 
void bootupFinished ()
 
void recoverFinished ()
 
void recover (const std::string &message, const std::string &trText="")
 
void ok (const std::string &category="")
 
bool warning (const std::string &category, const std::string &message, const std::string &trText="")
 
bool error (const std::string &category, const std::string &message, const std::string &trText="")
 
bool setStatus (Status::StatusMode mode, const std::string &category, const std::string &message, const std::string &trText="")
 
void checkin (const ResourceName &fullname, AuthorityRuntimePtr runtime=AuthorityRuntimePtr())
 
void checkin (const ResourceName &ns, const std::string &name, AuthorityRuntimePtr runtime=AuthorityRuntimePtr())
 
void checkin (Authority &iParent, const ResourceName &ns, const std::string &name)
 
void checkin (Authority &iParent, const std::string &name)
 
void checkin (const ResourceName &fullname, AuthorityRuntimePtr runtime=AuthorityRuntimePtr())
 
void checkin (const ResourceName &ns, const std::string &name, AuthorityRuntimePtr runtime=AuthorityRuntimePtr())
 
void checkin (Authority &iParent, const ResourceName &ns, const std::string &name)
 
void checkin (Authority &iParent, const std::string &name)
 
void checkout ()
 
void checkout ()
 
void validate () const
 
void validate () const
 
void startWithParent (bool start)
 
void startWithParent (bool start)
 
AuthorityRuntimePtr getRuntime ()
 
AuthorityRuntimePtr getRuntime ()
 
std::set< Authority *> getChildren ()
 
std::set< Authority *> getChildren ()
 
void addImmediateHandler (DiagnosticRunnablePtr runnable)
 
void addImmediateHandler (DiagnosticRunnablePtr runnable)
 
void addImmediateHandlerFunction (F &&fn)
 
void addImmediateHandlerFunction (F &&fn)
 
void addFinalizeHandler (DiagnosticRunnablePtr runnable)
 
void addFinalizeHandler (DiagnosticRunnablePtr runnable)
 
void addFinalizeHandlerFunction (F &&fn)
 
void addFinalizeHandlerFunction (F &&fn)
 
TimerPtr createTimer (Duration period, TimerCallback callback, bool oneshot=false)
 
TimerPtr createTimer (Duration period, Duration tolerance, TimerCallback callback, bool oneshot=false)
 
TimerPtr createTimer (Duration period, void(Class::*f)(const Timer &), Class *obj, bool oneshot=false)
 
TimerPtr createTimer (Duration period, void(Class::*f)(const Timer &), bool oneshot=false)
 
TimerPtr createTimer (Duration period, Duration tolerance, void(Class::*f)(const Timer &), Class *obj, bool oneshot=false)
 
TimerPtr createTimer (Duration period, Duration tolerance, void(Class::*f)(const Timer &), bool oneshot=false)
 
TimerPtr createTimer (Time time, TimerCallback callback)
 
TimerPtr createTimer (Time time, void(Class::*f)(const Timer &), Class *obj)
 
TimerPtr createTimer (Time time, void(Class::*f)(const Timer &))
 
TimerPtr createTimer (Duration period, TimerCallback callback, bool oneshot=false)
 
TimerPtr createTimer (Duration period, Duration tolerance, TimerCallback callback, bool oneshot=false)
 
TimerPtr createTimer (Duration period, void(Class::*f)(const Timer &), Class *obj, bool oneshot=false)
 
TimerPtr createTimer (Duration period, void(Class::*f)(const Timer &), bool oneshot=false)
 
TimerPtr createTimer (Duration period, Duration tolerance, void(Class::*f)(const Timer &), Class *obj, bool oneshot=false)
 
TimerPtr createTimer (Duration period, Duration tolerance, void(Class::*f)(const Timer &), bool oneshot=false)
 
TimerPtr createTimer (Time time, TimerCallback callback)
 
TimerPtr createTimer (Time time, void(Class::*f)(const Timer &), Class *obj)
 
TimerPtr createTimer (Time time, void(Class::*f)(const Timer &))
 
void removeTimer (TimerPtr timer)
 
void removeTimer (TimerPtr timer)
 
void start () override
 
void start () override
 
void stop () override
 
void stop () override
 
bool spin (const Duration &maxWait=Duration::infinity())
 
bool spin (const Duration &maxWait=Duration::infinity())
 
bool hasWork (Time horizon=Time::now()) const
 
bool hasWork (Time horizon=Time::now()) const
 
bool hasUnrecoverableFailure () const override
 
bool hasUnrecoverableFailure () const override
 
bool isStarted () const override
 
bool isStarted () const override
 
bool isRunning () const override
 
bool isRunning () const override
 
std::string resolveName (const std::string &name) const
 
std::string resolveName (const std::string &name) const
 
std::string resolveServiceName (const std::string &name) const
 
std::string resolveServiceName (const std::string &name) const
 
Channel< T > publish (const std::string &channelID)
 
Channel< T > publish (const std::string &channelID, const Typename &type)
 
Channel< T > publish (const std::string &channelID)
 
Channel< T > publish (const std::string &channelID, const Typename &type)
 
void unpublish (const std::string &channelID)
 
void unpublish (const std::string &channelID)
 
Channel< T > subscribe (const std::string &channelID, const Duration &storageDuration=Duration::seconds(0))
 
Channel< T > subscribe (const std::string &channelID, boost::function< void(ChannelRead< T >)> fn, const Duration &storageDuration=Duration::seconds(0), bool independentThread=false)
 
Channel< T > subscribe (const std::string &channelID, boost::function< void(ChannelRead< T >)> fn, bool independentThread)
 
Channel< T > subscribe (const std::string &channelID, void(Class::*f)(ChannelRead< T >), Class *obj, const Duration &storageDuration=Duration::seconds(0), bool independentThread=false)
 
Channel< T > subscribe (const std::string &channelID, void(Class::*f)(ChannelRead< T >), Class *obj, bool independentThread)
 
Channel< T > subscribe (const std::string &channelID, void(Class::*f)(ChannelRead< T >), const Duration &storageDuration=Duration::seconds(0), bool independentThread=false)
 
Channel< T > subscribe (const std::string &channelID, void(Class::*f)(ChannelRead< T >), bool independentThread)
 
Channel< T > subscribe (const std::string &channelID, const Duration &storageDuration=Duration::seconds(0))
 
Channel< T > subscribe (const std::string &channelID, boost::function< void(ChannelRead< T >)> fn, const Duration &storageDuration=Duration::seconds(0), bool independentThread=false)
 
Channel< T > subscribe (const std::string &channelID, boost::function< void(ChannelRead< T >)> fn, bool independentThread)
 
Channel< T > subscribe (const std::string &channelID, void(Class::*f)(ChannelRead< T >), Class *obj, const Duration &storageDuration=Duration::seconds(0), bool independentThread=false)
 
Channel< T > subscribe (const std::string &channelID, void(Class::*f)(ChannelRead< T >), Class *obj, bool independentThread)
 
Channel< T > subscribe (const std::string &channelID, void(Class::*f)(ChannelRead< T >), const Duration &storageDuration=Duration::seconds(0), bool independentThread=false)
 
Channel< T > subscribe (const std::string &channelID, void(Class::*f)(ChannelRead< T >), bool independentThread)
 
Channel< T > publishAndSubscribe (const std::string &channelID, const Duration &storageDuration=Duration::seconds(0))
 
Channel< T > publishAndSubscribe (const std::string &channelID, boost::function< void(ChannelRead< T >)> fn, const Duration &storageDuration=Duration::seconds(0), bool independentThread=false)
 
Channel< T > publishAndSubscribe (const std::string &channelID, boost::function< void(ChannelRead< T >)> fn, bool independentThread)
 
Channel< T > publishAndSubscribe (const std::string &channelID, void(Class::*f)(ChannelRead< T >), Class *obj, const Duration &storageDuration=Duration::seconds(0), bool independentThread=false)
 
Channel< T > publishAndSubscribe (const std::string &channelID, void(Class::*f)(ChannelRead< T >), Class *obj, bool independentThread)
 
Channel< T > publishAndSubscribe (const std::string &channelID, void(Class::*f)(ChannelRead< T >), const Duration &storageDuration=Duration::seconds(0), bool independentThread=false)
 
Channel< T > publishAndSubscribe (const std::string &channelID, void(Class::*f)(ChannelRead< T >), bool independentThread)
 
Channel< T > publishAndSubscribe (const std::string &channelID, const Duration &storageDuration=Duration::seconds(0))
 
Channel< T > publishAndSubscribe (const std::string &channelID, boost::function< void(ChannelRead< T >)> fn, const Duration &storageDuration=Duration::seconds(0), bool independentThread=false)
 
Channel< T > publishAndSubscribe (const std::string &channelID, boost::function< void(ChannelRead< T >)> fn, bool independentThread)
 
Channel< T > publishAndSubscribe (const std::string &channelID, void(Class::*f)(ChannelRead< T >), Class *obj, const Duration &storageDuration=Duration::seconds(0), bool independentThread=false)
 
Channel< T > publishAndSubscribe (const std::string &channelID, void(Class::*f)(ChannelRead< T >), Class *obj, bool independentThread)
 
Channel< T > publishAndSubscribe (const std::string &channelID, void(Class::*f)(ChannelRead< T >), const Duration &storageDuration=Duration::seconds(0), bool independentThread=false)
 
Channel< T > publishAndSubscribe (const std::string &channelID, void(Class::*f)(ChannelRead< T >), bool independentThread)
 
Channel< T > subscribeInterval (const std::string &channelID, boost::function< void(ChannelReadInterval< T >)> fn, const Duration &storageDuration, bool independentThread=false, const Time &startAfter=Time::unixEpoch())
 
Channel< T > subscribeInterval (const std::string &channelID, void(Class::*f)(ChannelReadInterval< T >), Class *obj, const Duration &storageDuration, bool independentThread=false, const Time &startAfter=Time::unixEpoch())
 
Channel< T > subscribeInterval (const std::string &channelID, void(Class::*f)(ChannelReadInterval< T >), const Duration &storageDuration, bool independentThread=false, const Time &startAfter=Time::unixEpoch())
 
Channel< T > subscribeInterval (const std::string &channelID, boost::function< void(ChannelReadInterval< T >)> fn, const Duration &storageDuration, bool independentThread=false, const Time &startAfter=Time::unixEpoch())
 
Channel< T > subscribeInterval (const std::string &channelID, void(Class::*f)(ChannelReadInterval< T >), Class *obj, const Duration &storageDuration, bool independentThread=false, const Time &startAfter=Time::unixEpoch())
 
Channel< T > subscribeInterval (const std::string &channelID, void(Class::*f)(ChannelReadInterval< T >), const Duration &storageDuration, bool independentThread=false, const Time &startAfter=Time::unixEpoch())
 
Channel< T > subscribeIntervalByElements (const std::string &channelID, void(Class::*f)(ChannelRead< T >), Class *obj, const Duration &storageDuration=Duration::seconds(0), bool independentThread=false, const Time &startAfter=Time::unixEpoch())
 
Channel< T > subscribeIntervalByElements (const std::string &channelID, boost::function< void(ChannelRead< T >)>, const Duration &storageDuration=Duration::seconds(0), bool independentThread=false, const Time &startAfter=Time::unixEpoch())
 
Channel< T > subscribeIntervalByElements (const std::string &channelID, void(Class::*f)(ChannelRead< T >), const Duration &storageDuration=Duration::seconds(0), bool independentThread=false, const Time &startAfter=Time::unixEpoch())
 
Channel< T > subscribeIntervalByElements (const std::string &channelID, void(Class::*f)(ChannelRead< T >), Class *obj, const Duration &storageDuration=Duration::seconds(0), bool independentThread=false, const Time &startAfter=Time::unixEpoch())
 
Channel< T > subscribeIntervalByElements (const std::string &channelID, boost::function< void(ChannelRead< T >)>, const Duration &storageDuration=Duration::seconds(0), bool independentThread=false, const Time &startAfter=Time::unixEpoch())
 
Channel< T > subscribeIntervalByElements (const std::string &channelID, void(Class::*f)(ChannelRead< T >), const Duration &storageDuration=Duration::seconds(0), bool independentThread=false, const Time &startAfter=Time::unixEpoch())
 
ChannelRead< T > waitForData (Channel< T > channel, Duration timeout=Duration::infinity()) const
 
ChannelRead< T > waitForData (Channel< T > channel, Duration timeout=Duration::infinity()) const
 
void unsubscribe (const std::string &channelID)
 
void unsubscribe (const std::string &channelID)
 
void unsubscribe (const std::string &channelID)
 
void unsubscribe (const std::string &channelID)
 
Channel< T > getChannel (const std::string &channelID)
 
Channel< T > getChannel (const std::string &channelID)
 
bool isSubscribedOn (const std::string &channelID) const
 
bool isSubscribedOn (const std::string &channelID) const
 
 MIRA_DEPRECATED ("Please use isSubscribedOn() instead", bool hasSubscribedOn(const std::string &channelID) const)
 
 MIRA_DEPRECATED ("Please use isSubscribedOn() instead", bool hasSubscribedOn(const std::string &channelID) const)
 
bool hasPublished (const std::string &channelID) const
 
bool hasPublished (const std::string &channelID) const
 
bool doesChannelExist (const std::string &channelID) const
 
bool doesChannelExist (const std::string &channelID) const
 
bool waitForChannel (const std::string &channelID, const Duration &timeout=Duration::infinity()) const
 
bool waitForChannel (const std::string &channelID, const Duration &timeout=Duration::infinity()) const
 
bool isTransformAvailable (const std::string &targetID, const std::string &sourceID) const
 
bool isTransformAvailable (const std::string &targetID, const std::string &sourceID, const std::string &fixedID) const
 
bool isTransformAvailable (const std::string &targetID, const std::string &sourceID) const
 
bool isTransformAvailable (const std::string &targetID, const std::string &sourceID, const std::string &fixedID) const
 
bool waitForTransform (const std::string &targetID, const std::string &sourceID, Duration timeout=Duration::invalid()) const
 
bool waitForTransform (const std::string &targetID, const std::string &sourceID, const std::string &fixedID, Duration timeout=Duration::invalid()) const
 
bool waitForTransform (const std::string &targetID, const std::string &sourceID, Duration timeout=Duration::invalid()) const
 
bool waitForTransform (const std::string &targetID, const std::string &sourceID, const std::string &fixedID, Duration timeout=Duration::invalid()) const
 
void subscribeTransform (const std::string &targetID, const std::string &sourceID, boost::function< void(Transform, Time)> fn, Filter &&filter)
 
void subscribeTransform (const std::string &targetID, const std::string &sourceID, void(Class::*f)(Transform, Time), Class *obj, Filter &&filter)
 
void subscribeTransform (const std::string &targetID, const std::string &sourceID, void(Class::*f)(Transform, Time), Filter &&filter)
 
void subscribeTransform (const std::string &targetID, const std::string &sourceID, boost::function< void(Transform, Time)> fn)
 
void subscribeTransform (const std::string &targetID, const std::string &sourceID, void(Class::*f)(Transform, Time), Class *obj)
 
void subscribeTransform (const std::string &targetID, const std::string &sourceID, void(Class::*f)(Transform, Time))
 
void subscribeTransform (const std::string &targetID, const std::string &sourceID, boost::function< void(Transform, Time)> fn, Filter &&filter)
 
void subscribeTransform (const std::string &targetID, const std::string &sourceID, void(Class::*f)(Transform, Time), Class *obj, Filter &&filter)
 
void subscribeTransform (const std::string &targetID, const std::string &sourceID, void(Class::*f)(Transform, Time), Filter &&filter)
 
void subscribeTransform (const std::string &targetID, const std::string &sourceID, boost::function< void(Transform, Time)> fn)
 
void subscribeTransform (const std::string &targetID, const std::string &sourceID, void(Class::*f)(Transform, Time), Class *obj)
 
void subscribeTransform (const std::string &targetID, const std::string &sourceID, void(Class::*f)(Transform, Time))
 
Transform getTransform (const std::string &targetID, const std::string &sourceID, const Time &time, Filter &&filter) const
 
Transform getTransform (const std::string &targetID, const std::string &sourceID, const Time &time=Time()) const
 
Transform getTransform (const std::string &targetID, const Time &targetTime, const std::string &sourceID, const Time &sourceTime, const std::string &fixedID, Filter &&filter) const
 
Transform getTransform (const std::string &targetID, const Time &targetTime, const std::string &sourceID, const Time &sourceTime, const std::string &fixedID) const
 
Transform getTransform (const TransformDesc &desc, const Time &time, Filter &&filter) const
 
Transform getTransform (const TransformDesc &desc, const Time &time=Time()) const
 
Transform getTransform (const TransformDesc &desc, const Time &targetTime, const Time &sourceTime, Filter &&filter) const
 
Transform getTransform (const TransformDesc &desc, const Time &targetTime, const Time &sourceTime) const
 
Transform getTransform (const std::string &targetID, const std::string &sourceID, const Time &time, Filter &&filter) const
 
Transform getTransform (const std::string &targetID, const std::string &sourceID, const Time &time=Time()) const
 
Transform getTransform (const std::string &targetID, const Time &targetTime, const std::string &sourceID, const Time &sourceTime, const std::string &fixedID, Filter &&filter) const
 
Transform getTransform (const std::string &targetID, const Time &targetTime, const std::string &sourceID, const Time &sourceTime, const std::string &fixedID) const
 
Transform getTransform (const TransformDesc &desc, const Time &time, Filter &&filter) const
 
Transform getTransform (const TransformDesc &desc, const Time &time=Time()) const
 
Transform getTransform (const TransformDesc &desc, const Time &targetTime, const Time &sourceTime, Filter &&filter) const
 
Transform getTransform (const TransformDesc &desc, const Time &targetTime, const Time &sourceTime) const
 
FrameworkTransformerNode * getTransformNode (const std::string &frameID) const
 
FrameworkTransformerNode * getTransformNode (const std::string &frameID) const
 
TransformDesc prepareTransform (const std::string &targetID, const std::string &sourceID) const
 
TransformDesc prepareTransform (const std::string &targetID, const std::string &sourceID, const std::string &fixedID) const
 
TransformDesc prepareTransform (const std::string &targetID, const std::string &sourceID) const
 
TransformDesc prepareTransform (const std::string &targetID, const std::string &sourceID, const std::string &fixedID) const
 
void publishTransform (const std::string &frameID, const Transform &transform, const Time &time) const
 
void publishTransform (const std::string &frameID, const Transform &transform, const Time &time) const
 
void publishTransformIndirect (const std::string &frameID, const std::string &targetID, const std::string &sourceID, const Transform &transform, const Time &time, Filter &&filter=NearestNeighborInterpolator()) const
 
void publishTransformIndirect (const std::string &frameID, const std::string &targetID, const std::string &sourceID, const Transform &transform, const Time &time, Filter &&filter=NearestNeighborInterpolator()) const
 
void addTransformLink (const std::string &childID, const std::string &parentID) const
 
void addTransformLink (const std::string &childID, const std::string &parentID, FrameworkTransformerNode::Type type) const
 
void addTransformLink (const std::string &childID, const std::string &parentID) const
 
void addTransformLink (const std::string &childID, const std::string &parentID, FrameworkTransformerNode::Type type) const
 
void publishService (const std::string &name, Service &iService, RPCHandlerPtr handler=RPCHandlerPtr())
 
void publishService (Service &iService, RPCHandlerPtr handler=RPCHandlerPtr())
 
void publishService (const std::string &name, Service &iService, RPCHandlerPtr handler=RPCHandlerPtr())
 
void publishService (Service &iService, RPCHandlerPtr handler=RPCHandlerPtr())
 
void unpublishService ()
 
void unpublishService (const std::string &name)
 
void unpublishService ()
 
void unpublishService (const std::string &name)
 
RPCFuture< R > callService (const std::string &iService, const std::string &method, ARGS &&... args) const
 
RPCFuture< R > callService (const std::string &iService, const std::string &method, ARGS &&... args) const
 
RPCFuture< JSONRPCResponse > callServiceJSON (const json::Value &jsonRequest) const
 
RPCFuture< JSONRPCResponse > callServiceJSON (const std::string &jsonString) const
 
RPCFuture< JSONRPCResponse > callServiceJSON (const std::string &service, const std::string &method, const json::Value &params=json::Value()) const
 
RPCFuture< JSONRPCResponse > callServiceJSON (const std::string &service, const std::string &method, const std::string &params) const
 
RPCFuture< JSONRPCResponse > callServiceJSON (const RPCCallDefinition &rpc) const
 
RPCFuture< JSONRPCResponse > callServiceJSON (const json::Value &jsonRequest) const
 
RPCFuture< JSONRPCResponse > callServiceJSON (const std::string &jsonString) const
 
RPCFuture< JSONRPCResponse > callServiceJSON (const std::string &service, const std::string &method, const json::Value &params=json::Value()) const
 
RPCFuture< JSONRPCResponse > callServiceJSON (const std::string &service, const std::string &method, const std::string &params) const
 
RPCFuture< JSONRPCResponse > callServiceJSON (const RPCCallDefinition &rpc) const
 
ServiceCall< F > createServiceCall (const std::string &service, std::string method, bool waitTillExists=true, bool showBootupMsg=true)
 
ServiceCall< F > createServiceCall (const std::string &service, std::string method, bool waitTillExists=true, bool showBootupMsg=true)
 
bool existsService (const std::string &name) const
 
bool existsService (const std::string &name) const
 
bool implementsInterface (const std::string &name, const std::string &interface) const
 
bool implementsInterface (const std::string &name, const std::string &interface) const
 
bool waitForService (const std::string &name, Duration timeout=Duration::invalid()) const
 
bool waitForService (const std::string &name, Duration timeout=Duration::invalid()) const
 
std::string waitForServiceInterface (const std::string &interface, Duration timeout=Duration::invalid()) const
 
std::string waitForServiceInterface (const std::string &interface, Duration timeout=Duration::invalid()) const
 
std::list< std::string > queryServicesForInterface (const std::string &interface) const
 
std::list< std::string > queryServicesForInterface (const std::string &interface) const
 
void registerCallbackForInterface (const std::string &interface, ServiceInterfaceHandler::Callback cb)
 
void registerCallbackForInterface (const std::string &interface, void(Class::*f)(const std::string &, const std::string &), Class *obj)
 
void registerCallbackForInterface (const std::string &interface, ServiceInterfaceHandler::Callback cb)
 
void registerCallbackForInterface (const std::string &interface, void(Class::*f)(const std::string &, const std::string &), Class *obj)
 
boost::shared_ptr< PropertyNode > getProperties () override
 
boost::shared_ptr< PropertyNode > getProperties () override
 
std::set< std::string > getPublishedChannels () override
 
std::set< std::string > getPublishedChannels () override
 
std::set< std::string > getSubscribedChannels () override
 
std::set< std::string > getSubscribedChannels () override
 
std::set< std::string > getServiceInterfaces () override
 
std::set< std::string > getServiceInterfaces () override
 
ChannelNameMapping getPublishedChannelNames () override
 
ChannelNameMapping getPublishedChannelNames () override
 
ChannelNameMapping getSubscribedChannelNames () override
 
ChannelNameMapping getSubscribedChannelNames () override
 
ChannelStatusMap getSubscribedChannelStatus () override
 
ChannelStatusMap getSubscribedChannelStatus () override
 
std::string getNamespace () const
 
std::string getNamespace () const
 
std::string getGlobalName () const
 
std::string getGlobalName () const
 
std::string getGlobalID () const
 
std::string getGlobalID () const
 
std::string getID () const
 
std::string getID () const
 
std::string getName () const
 
std::string getName () const
 
const AuthorityDescription & getDescription () const
 
const AuthorityDescription & getDescription () const
 

Static Public Member Functions

static PseudoClass const & CLASS ()
 

Public Attributes

 NORMAL
 
 ANONYMOUS
 
 HIDDEN
 
 INVISIBLE_PUBLISHER_SUBSCRIBER
 
 INTERNAL
 
 INDEPENDENT_SUBSCRIBER_THREAD
 
 INDEPENDENT_RPC_THREAD
 
 NO_MAIN_THREAD
 

Protected Types

typedef std::map< std::string, RWAccessFlags > RWAccessMap
 
typedef std::list< AbstractChannelSubscriberPtr > SubscribePtrList
 

Protected Member Functions

virtual Status getStatusMap (const Point2i &p) const
 Implementation of MetricPlannerBase::getStatusMap(const Point2i&). More...
 
virtual Img8U1 getStatusField () const
 Implementation of MetricPlannerBase::getStatusField(). More...
 
virtual bool isValid () const
 Return whether planner is properly initialized and able to calculate a path (when a goal is set) More...
 
virtual void reset ()
 Re-initialize internal structures. More...
 
virtual void copyDoubleBuffer ()
 Copy entire field of internally calculated cost values to mDoubleBuffer. More...
 
virtual void removeGoals ()
 Remove all set goals. More...
 
virtual void addGoal (const Point2i &p, float cost)
 Add a goal cell with a certain cost (e.g. More...
 
virtual void freeCell (const Point2i &p)
 Mark a cell as free in the planner's internal cost function representation. More...
 
virtual void dirtyCell (const Point2i &p, double value)
 Update a cell's cost map value in the planner's internal cost function representation. More...
 
virtual void resetDoubleBuffer (bool createNew)
 Set the entire double buffer to infinity. More...
 
void prepareNewGoal (bool clearDoubleBuffer)
 Call removeGoals() and reset all status and timing data related to planning on the current goal. More...
 
AbstractMetricPlanner::Carrot getCarrotFromMap (const maps::CostMap &map, const Point2f &pos, int maxCount, float maxDistance) const
 Calculate a path through the given costmap, starting at pos and following the gradient computed by computeStableGradientFromMap. More...
 
int computeStableGradientFromMap (const maps::CostMap &map, int ix, int iy, double baseVal, double stepsize, double &dx, double &dy, double &gx, double &gy) const
 
double filteredCorner (double self, double xnb, double ynb, double diagnb) const
 Fix infinite (invalid) values by replacing with finite neighbour values, if available. More...
 
virtual void initialize ()
 Called in initialize(parent). More...
 
virtual Class const & internalGetClass () const=0
 
Channel< T > toProxy (ConcreteChannel< T > *channel)
 
void setChannelReadAccess (const std::string &channelID)
 
void setChannelWriteAccess (const std::string &channelID)
 
void removeChannelReadAccess (const std::string &channelID)
 
void removeChannelWriteAccess (const std::string &channelID)
 
void insertChannelNameMapping (AbstractAuthority::ChannelNameMapping &map, const std::string &local, const std::string &global)
 
void eraseChannelNameMapping (AbstractAuthority::ChannelNameMapping &map, const std::string &local, const std::string &global)
 
void remotePublishService (const std::string &service) const
 
PropertyTree getPropertiesRPC ()
 
void setProperty (const std::string &property, const std::string &value)
 
std::string getProperty (const std::string &property) const
 
void setPropertyJSON (const std::string &property, const json::Value &value)
 
json::Value getPropertyJSON (const std::string &property) const
 

Protected Attributes

boost::shared_ptr< estar::Facade > mFacade
 
boost::shared_ptr< estar::Grid > mGrid
 
boost::shared_ptr< estar::Algorithm > mAlgorithm
 
boost::shared_ptr< estar::Kernel > mKernel
 
Size2i mSize
 
maps::CostMap mCostMap
 
maps::CostMap mDoubleBuffer
 
Time mLastPlan
 
Time mLastValidPlan
 
Duration mAccumulatedPlanningTime
 
Duration mMaxPlanningTime
 
Duration mPathLostTimeout
 
bool mHadValidPlan
 
bool mHadValidPlanSinceUpdate
 
bool mPathLostReported
 
float mNavfscale
 
bool mHasPointGoal
 
Point2f mPointGoal
 
Point2i mPointGoalCell
 
Eigen::VectorXf mPointGoalPyrBorder
 
Eigen::VectorXf mPointGoalPyrSlope
 
bool mUseDoubleBuffer
 
bool mGetCarrotFromDoubleBuffer
 
bool mDoubleBufferValid
 
bool mPersistentDoubleBuffer
 
AuthorityDescription mDescription
 
boost::optional< Status > mBootUpStatus
 
boost::optional< Status > mRecoverStatus
 
Duration mHeartbeatInterval
 
boost::optional< Time > mLastHeartbeat
 
StatusMap mStatusMap
 
std::string mName
 

Member Typedef Documentation

◆ Carrot

typedef std::vector<Point2f> Carrot
inherited

◆ CostFn

typedef std::function<float(int x, int y, float r)> CostFn
inherited

Type declaration for a cost function to be used with setGoal(const Polygon2i, ...) or setGoal(const Polygon2f, ...).

CostFn is a function taking parameters int x, int y and float r (a cell's coordinates and distance to goal). The function must return a float value which is the initial cost for cell <x,y>. The distance r is given in cells, and the returned initial costs/distance must be returned in cells (not meter).

Member Enumeration Documentation

◆ Status

enum Status
inherited

Planner status of a fixed position (planner map cell)

Enumerator
OUT_OF_GRID 
VALID 
INVALID 
WAVEFRONT 
OUTDATED 
GOAL 
OBSTACLE 

Constructor & Destructor Documentation

◆ EstarPlanner()

EstarPlanner ( bool  useDoubleBuffer = false,
bool  persistentDoubleBuffer = false 
)

◆ ~EstarPlanner()

virtual ~EstarPlanner ( )
inlinevirtual

Member Function Documentation

◆ reflect()

void reflect ( Reflector &  r)
inline

◆ infinity()

virtual double infinity ( ) const
virtual

Implementation of AbstractMetricPlanner::infinity().

Default implementation returns plannerDefaultInfinity(), sub classes can provide their own.

Reimplemented from MetricPlannerBase.

◆ hasValidGoal()

virtual bool hasValidGoal ( ) const
virtual

Implementation of AbstractMetricPlanner::hasValidGoal()

Implements AbstractMetricPlanner.

◆ haveWork()

virtual bool haveWork ( ) const
virtual

Implementation of AbstractMetricPlanner::haveWork()

Implements AbstractMetricPlanner.

◆ planStep()

virtual void planStep ( )
virtual

Implementation of AbstractMetricPlanner::planStep()

Implements AbstractMetricPlanner.

◆ getCurrentValueMap()

virtual double getCurrentValueMap ( const Point2i &  mapPos) const
virtual

Implementation of MetricPlannerBase::getCurrentValueMap()

Implements MetricPlannerBase.

◆ getCurrentCarrot()

virtual Carrot getCurrentCarrot ( const Point2f &  pos,
int  maxCount,
float  maxDistance = 1e10f 
) const
virtual

Implementation of MetricPlannerBase::getCurrentCarrot()

Implements MetricPlannerBase.

◆ getCurrentNavFunction()

virtual maps::CostMap getCurrentNavFunction ( ) const
virtual

Implementation of MetricPlannerBase::getCurrentNavFunction()

Implements MetricPlannerBase.

◆ getStatusMap()

virtual Status getStatusMap ( const Point2i &  p) const
protectedvirtual

Implementation of MetricPlannerBase::getStatusMap(const Point2i&).

Returns the actual EStar planner's status for this cell.

Reimplemented from MetricPlannerBase.

◆ getStatusField()

virtual Img8U1 getStatusField ( ) const
protectedvirtual

Implementation of MetricPlannerBase::getStatusField().

Returns the actual EStar planner's status for all cells.

Reimplemented from MetricPlannerBase.

◆ isValid()

virtual bool isValid ( ) const
protectedvirtual

Return whether planner is properly initialized and able to calculate a path (when a goal is set)

Reimplemented from MetricPlannerBase.

◆ reset()

virtual void reset ( )
protectedvirtual

Re-initialize internal structures.

Reimplemented from MetricPlannerBase.

◆ copyDoubleBuffer()

virtual void copyDoubleBuffer ( )
protectedvirtual

Copy entire field of internally calculated cost values to mDoubleBuffer.

Implements MetricPlannerBase.

◆ removeGoals()

virtual void removeGoals ( )
protectedvirtual

Remove all set goals.

Implements MetricPlannerBase.

◆ addGoal()

virtual void addGoal ( const Point2i &  p,
float  cost 
)
protectedvirtual

Add a goal cell with a certain cost (e.g.

for goal regions, costs may be set to increase from inside to edge of the region).

Implements MetricPlannerBase.

◆ freeCell()

virtual void freeCell ( const Point2i &  p)
protectedvirtual

Mark a cell as free in the planner's internal cost function representation.

Implements MetricPlannerBase.

◆ dirtyCell()

virtual void dirtyCell ( const Point2i &  p,
double  value 
)
protectedvirtual

Update a cell's cost map value in the planner's internal cost function representation.

Implements MetricPlannerBase.

◆ setOnewayMap()

virtual void setOnewayMap ( const maps::OccupancyGrid &  onewayMap)
inlinevirtualinherited

Implementation of AbstractMetricPlanner::setOnewayMap().

Override in subclasses if you want to support planning with oneway road restrictions.

Implements AbstractMetricPlanner.

◆ setUseDoubleBuffer()

void setUseDoubleBuffer ( bool  useDoubleBuffer)
inlineinherited

Enable/disable double buffer.

◆ setPersistentDoubleBuffer()

void setPersistentDoubleBuffer ( bool  persistentDoubleBuffer)
inlineinherited

Enable/disable persistent double buffer (i.e. not reset when setting goal)

◆ getGradient()

virtual Point2f getGradient ( const Point2f &  worldPos) const
virtualinherited

Implementation of AbstractMetricPlanner::getGradient(const Point2f&)

Implements AbstractMetricPlanner.

◆ getGradientMap()

Point2f getGradientMap ( const Point2i &  mapPos) const
inherited

Returns the gradient for a position in map coordinates.

◆ getCurrentGradientMap()

virtual Point2f getCurrentGradientMap ( const Point2i &  mapPos) const
virtualinherited

Returns the gradient for a position in map coordinates from current costs.

◆ update() [1/2]

virtual void update ( const maps::CostMap &  map,
const maps::DirtyRegions &  dirty 
)
virtualinherited

Implementation of AbstractMetricPlanner::update(const maps::CostMap&, const maps::DirtyRegions&)

Implements AbstractMetricPlanner.

◆ update() [2/2]

void update ( const maps::CostMap &  map)
inherited

Update the planning context with the current costmap (entire area).

Calls update(map, {mapArea}) for the actual work.

◆ getValue()

double getValue ( const Point2f &  worldPos,
bool  ignoreDoubleBuffer = false 
) const
virtualinherited

Implementation of AbstractMetricPlanner::getValue(const Point2f&, bool)

Implements AbstractMetricPlanner.

◆ getValueMap()

double getValueMap ( const Point2i &  mapPos,
bool  ignoreDoubleBuffer = false 
) const
inherited

Returns the cost value at position (in map coordinates) in the planner map.

By default the value is taken from the double buffer (if enabled), to ensure the returned value is valid, even while planning is in progress. This can be suppressed by ignoreDoubleBuffer=true.

◆ getValueFiltered()

virtual double getValueFiltered ( const Point2f &  worldPos,
bool  ignoreDoubleBuffer = false 
) const
virtualinherited

Implementation of AbstractMetricPlanner::getValueFiltered(const Point2f&, bool)

Implements AbstractMetricPlanner.

◆ getCarrot()

virtual Carrot getCarrot ( const Point2f &  pos,
int  maxCount,
float  maxDistance = 1e10f 
) const
virtualinherited

Implementation of AbstractMetricPlanner::getCarrot(const Point2f&, int, float)

Implements AbstractMetricPlanner.

◆ getDoubleBufferCarrot()

virtual Carrot getDoubleBufferCarrot ( const Point2f &  pos,
int  maxCount,
float  maxDistance = 1e10f 
) const
virtualinherited

Return the optimal path to the goal, starting at pos, based on the double buffer.

See AbstractMetricPlanner::getCarrot(worldPos, ignoreDoubleBuffer)

◆ getCurrentGoal()

virtual Pose2 getCurrentGoal ( const Point2f &  pos) const
virtualinherited

Implementation of AbstractMetricPlanner::getCurrentGoal(const Point2f&)

Implements AbstractMetricPlanner.

◆ world2map()

Point2i world2map ( const Point2f &  p) const
inlinevirtualinherited

Implementation of AbstractMetricPlanner::world2map(const Point2f&)

Note
The point is not checked against exceeding the map boundaries.
Exceptions
XLogical,ifno costmap was created yet.

Implements AbstractMetricPlanner.

◆ map2world()

Point2f map2world ( const Point2i &  p) const
inlinevirtualinherited

Implementation of AbstractMetricPlanner::world2map(const Point2i&)

Exceptions
XLogical,ifno costmap was created yet.

Implements AbstractMetricPlanner.

◆ getCellSize()

float getCellSize ( ) const
inlinevirtualinherited

Implementation of AbstractMetricPlanner::getCellSize()

Exceptions
XLogical,ifno costmap was created yet.

Implements AbstractMetricPlanner.

◆ getRegion()

Rect2f getRegion ( ) const
inlinevirtualinherited

Implementation of AbstractMetricPlanner::getRegion()

Exceptions
XLogical,ifno costmap was created yet.

Implements AbstractMetricPlanner.

◆ getMapRegion()

Rect2i getMapRegion ( ) const
inlinevirtualinherited

Implementation of AbstractMetricPlanner::getMapRegion()

Exceptions
XLogical,ifno costmap was created yet.

Implements AbstractMetricPlanner.

◆ getUseDoubleBuffer()

bool getUseDoubleBuffer ( ) const
inlineinherited

Double buffer enabled?

◆ getPersistentDoubleBuffer()

bool getPersistentDoubleBuffer ( ) const
inlineinherited

Persistent double buffer enabled (i.e. not reset on setting goal)?

◆ getAccumulatedPlanningTime()

Duration getAccumulatedPlanningTime ( ) const
inlinevirtualinherited

Implementation of AbstractMetricPlanner::getAccumulatedPlanningTime()

Implements AbstractMetricPlanner.

◆ setGoal() [1/5]

void setGoal ( const Point2f &  goal,
float  radius,
bool  clearDoubleBuffer = true,
bool  prepareNew = true 
)
virtualinherited

Implementation of AbstractMetricPlanner::setGoal(const Point2f&, float, bool, bool)

Implements AbstractMetricPlanner.

◆ setGoal() [2/5]

void setGoal ( const Polygon2i &  polygon,
int  radius = 1,
bool  clearDoubleBuffer = true,
bool  prepareNew = true 
)
virtualinherited

Implementation of AbstractMetricPlanner::setGoal(const Polygon2i&, int, bool, bool)

Implements AbstractMetricPlanner.

◆ setGoal() [3/5]

void setGoal ( const Polygon2f &  polygon,
float  radius = 0.1f,
bool  clearDoubleBuffer = true,
bool  prepareNew = true 
)
virtualinherited

Implementation of AbstractMetricPlanner::setGoal(const Polygon2f&, float, bool, bool)

Implements AbstractMetricPlanner.

◆ setGoal() [4/5]

void setGoal ( const Polygon2i &  polygon,
int  radius,
CostFn &  costFn,
bool  clearDoubleBuffer = true,
bool  prepareNew = true 
)
virtualinherited

Implementation of AbstractMetricPlanner::setGoal(const Polygon2i&, int, CostFn, bool, bool)

Implements AbstractMetricPlanner.

◆ setGoal() [5/5]

void setGoal ( const Polygon2f &  polygon,
float  radius,
CostFn &  costFn,
bool  clearDoubleBuffer = true,
bool  prepareNew = true 
)
virtualinherited

Implementation of AbstractMetricPlanner::setGoal(const Polygon2f&, float, CostFn, bool, bool)

Implements AbstractMetricPlanner.

◆ defaultCostFn()

float defaultCostFn ( int  x,
int  y,
float  r 
)
inherited

A default cost function which is always returning r (radius)

◆ resetDoubleBuffer()

virtual void resetDoubleBuffer ( bool  createNew)
protectedvirtualinherited

Set the entire double buffer to infinity.

If createNew = true, create a new double buffer array first (with size matching the costmap).

◆ prepareNewGoal()

void prepareNewGoal ( bool  clearDoubleBuffer)
protectedinherited

Call removeGoals() and reset all status and timing data related to planning on the current goal.

If clearDoubleBuffer = true (and double buffer is active and not persistent), reset and invalidate current double buffer.

◆ getCarrotFromMap()

AbstractMetricPlanner::Carrot getCarrotFromMap ( const maps::CostMap &  map,
const Point2f &  pos,
int  maxCount,
float  maxDistance 
) const
protectedinherited

Calculate a path through the given costmap, starting at pos and following the gradient computed by computeStableGradientFromMap.

Stops when path exceeds maxCount steps or a distance of maxDistance from pos, or when it reaches the goal.

◆ computeStableGradientFromMap()

int computeStableGradientFromMap ( const maps::CostMap &  map,
int  ix,
int  iy,
double  baseVal,
double  stepsize,
double &  dx,
double &  dy,
double &  gx,
double &  gy 
) const
protectedinherited

◆ plan()

void plan ( const Point2f &  pos,
Duration  plantime 
)
virtualinherited

Implementation of AbstractMetricPlanner::plan(const Point2f&, Duration)

Implements AbstractMetricPlanner.

◆ havePlan()

bool havePlan ( ) const
inlinevirtualinherited

Implementation of AbstractMetricPlanner::havePlan()

Implements AbstractMetricPlanner.

◆ havePlanSinceUpdate()

bool havePlanSinceUpdate ( ) const
inlinevirtualinherited

Implementation of AbstractMetricPlanner::havePlanSinceUpdate()

Implements AbstractMetricPlanner.

◆ lastValidPlan()

Time lastValidPlan ( ) const
inlinevirtualinherited

Implementation of AbstractMetricPlanner::lastValidPlan()

Implements AbstractMetricPlanner.

◆ planTime()

void planTime ( Duration  plantime)
virtualinherited

Implementation of AbstractMetricPlanner::planTime(Duration)

Implements AbstractMetricPlanner.

◆ planSteps()

void planSteps ( int  steps)
virtualinherited

Implementation of AbstractMetricPlanner::planSteps(int)

Implements AbstractMetricPlanner.

◆ resetPlanningTimeout()

void resetPlanningTimeout ( )
virtualinherited

Implementation of AbstractMetricPlanner::resetPlanningTimeout()

Implements AbstractMetricPlanner.

◆ getNavFunction()

maps::CostMap getNavFunction ( bool  ignoreDoubleBuffer = false) const
virtualinherited

Implementation of AbstractMetricPlanner::getNavFunction(bool)

Implements AbstractMetricPlanner.

◆ dumpNavStatus()

maps::GridMap<uint8,3> dumpNavStatus ( bool  useDoubleBuffer = false,
bool  costsInGoalRegion = true 
)
virtualinherited

Implementation of AbstractMetricPlanner::dumpNavStatus(bool, bool)

Implements AbstractMetricPlanner.

◆ showNavFunctionNearGoal()

maps::GridMap<uint8,3> showNavFunctionNearGoal ( )
virtualinherited

Implementation of AbstractMetricPlanner::showNavFunctionNearGoal()

Implements AbstractMetricPlanner.

◆ getStatus()

Status getStatus ( const Point2f &  p) const
virtualinherited

Implementation of AbstractMetricPlanner::getStatus(const Point2f&)

Implements AbstractMetricPlanner.

◆ filteredCorner()

double filteredCorner ( double  self,
double  xnb,
double  ynb,
double  diagnb 
) const
protectedinherited

Fix infinite (invalid) values by replacing with finite neighbour values, if available.

This is applied to each of the values in a 2x2 patch before interpolating from them the value at an arbitrary exact position inbetween.

◆ initialize() [1/2]

void initialize ( Authority *  parent)
inherited

◆ initialize() [2/2]

virtual void initialize ( )
inlineprotectedvirtualinherited

Called in initialize(parent).

Default implementation is empty, can be overwritten in subclasses.

◆ setRobotPosition()

virtual void setRobotPosition ( const Point2f &  robotPos)
inlinevirtualinherited

Set the current robot position in planner (world position) Base implementation is empty.

Member Data Documentation

◆ mFacade

boost::shared_ptr<estar::Facade> mFacade
protected

◆ mGrid

boost::shared_ptr<estar::Grid> mGrid
protected

◆ mAlgorithm

boost::shared_ptr<estar::Algorithm> mAlgorithm
protected

◆ mKernel

boost::shared_ptr<estar::Kernel> mKernel
protected

◆ mSize

Size2i mSize
protectedinherited

◆ mCostMap

maps::CostMap mCostMap
protectedinherited

◆ mDoubleBuffer

maps::CostMap mDoubleBuffer
protectedinherited

◆ mLastPlan

Time mLastPlan
protectedinherited

◆ mLastValidPlan

Time mLastValidPlan
protectedinherited

◆ mAccumulatedPlanningTime

Duration mAccumulatedPlanningTime
protectedinherited

◆ mMaxPlanningTime

Duration mMaxPlanningTime
protectedinherited

◆ mPathLostTimeout

Duration mPathLostTimeout
protectedinherited

◆ mHadValidPlan

bool mHadValidPlan
protectedinherited

◆ mHadValidPlanSinceUpdate

bool mHadValidPlanSinceUpdate
protectedinherited

◆ mPathLostReported

bool mPathLostReported
protectedinherited

◆ mNavfscale

float mNavfscale
protectedinherited

◆ mHasPointGoal

bool mHasPointGoal
protectedinherited

◆ mPointGoal

Point2f mPointGoal
protectedinherited

◆ mPointGoalCell

Point2i mPointGoalCell
protectedinherited

◆ mPointGoalPyrBorder

Eigen::VectorXf mPointGoalPyrBorder
protectedinherited

◆ mPointGoalPyrSlope

Eigen::VectorXf mPointGoalPyrSlope
protectedinherited

◆ mUseDoubleBuffer

bool mUseDoubleBuffer
protectedinherited

◆ mGetCarrotFromDoubleBuffer

bool mGetCarrotFromDoubleBuffer
protectedinherited

◆ mDoubleBufferValid

bool mDoubleBufferValid
protectedinherited

◆ mPersistentDoubleBuffer

bool mPersistentDoubleBuffer
protectedinherited
The documentation for this class was generated from the following file:
GIT-r093dc3fa2d349de0a55949aec7505ad0006dd69e , Generated on Sun Dec 14 2025 03:38:08 for MIRA by   doxygen 1.8.14