33 #ifndef DART_PLANNING_PATHSHORTENER_HPP_
34 #define DART_PLANNING_PATHSHORTENER_HPP_
52 const std::vector<std::size_t>&
dofs,
55 virtual void shortenPath(std::list<Eigen::VectorXd>& rawPath);
57 std::list<Eigen::VectorXd>& waypoints,
58 const Eigen::VectorXd& config1,
59 const Eigen::VectorXd& config2);
64 std::vector<std::size_t>
dofs;
67 std::list<Eigen::VectorXd>& waypoints,
68 std::list<Eigen::VectorXd>::const_iterator it1,
69 std::list<Eigen::VectorXd>::const_iterator it2);
Definition: PathShortener.hpp:46
virtual void shortenPath(std::list< Eigen::VectorXd > &rawPath)
Definition: PathShortener.cpp:73
virtual bool localPlanner(std::list< Eigen::VectorXd > &waypoints, std::list< Eigen::VectorXd >::const_iterator it1, std::list< Eigen::VectorXd >::const_iterator it2)
Definition: PathShortener.cpp:118
simulation::WorldPtr world
Definition: PathShortener.hpp:62
std::vector< std::size_t > dofs
Definition: PathShortener.hpp:64
double stepSize
Definition: PathShortener.hpp:65
bool segmentCollisionFree(std::list< Eigen::VectorXd > &waypoints, const Eigen::VectorXd &config1, const Eigen::VectorXd &config2)
Definition: PathShortener.cpp:129
PathShortener()
Definition: PathShortener.cpp:56
PathShortener(simulation::WorldPtr world, dynamics::SkeletonPtr robot, const std::vector< std::size_t > &dofs, double stepSize=0.1)
dynamics::SkeletonPtr robot
Definition: PathShortener.hpp:63
~PathShortener()
Definition: PathShortener.cpp:69
std::shared_ptr< Skeleton > SkeletonPtr
Definition: SmartPointer.hpp:60
std::shared_ptr< World > WorldPtr
Definition: SmartPointer.hpp:41
Definition: BulletCollisionDetector.cpp:65