SmoothThetaStar.h

Go to the documentation of this file.

#pragma once
 
#include <ompl/geometric/PathGeometric.h>
#include <algorithm>
 
#pragma warning "SmoothThetaStar is not supported at the moment."
 
#if 0
 
#include "../base/Environment.h"
#include "../../base/Trajectory.h"
 
#include "../AbstractPlanner.hpp"
 
namespace ob = ompl::base;
namespace og = ompl::geometric;
 
class SmoothThetaStar : public AbstractPlanner, public ob::Planner {
 public:
  SmoothThetaStar();
  ~SmoothThetaStar() override = default;
 
  std::string name() const override { return "Smooth Theta*"; }
 
  bool initialize();
 
  void setProblemDefinition(const ob::ProblemDefinitionPtr &pdef) override;
  ob::PlannerStatus solve(const ob::PlannerTerminationCondition &ptc) override;
 
  ob::PlannerStatus run() override;
 
  std::vector<GNode> solutionTrajectory() const override;
  std::vector<TrajectoryPoint> solutionPath() const override;
  og::PathGeometric geometricPath() const override;
 
  bool hasReachedGoalExactly() const override;
  double planningTime() const;
  unsigned int steps() const;
 
 private:
  Trajectory *curr_traj;
 
  bool COST_SEARCH;
  bool USE_ASTAR;
  bool USE_GRANDPARENT;
 
  double _planningTime;
  unsigned int _steps;
 
  std::vector<std::vector<GNode> > global_paths;
 
  bool search(std::vector<std::vector<GNode> > &paths, GNode start, GNode goal);
 
 protected:
  explicit SmoothThetaStar(bool astar, std::string name);
 
  inline ob::Planner *omplPlanner() override { return this; }
};
#endif