RobotStatePtrVecPtr & posesToExplorePtr
TFSIMD_FORCE_INLINE tfScalar distance(const Vector3 &v) const
SortHelper(RobotStatePtrVecPtr &posesToExplorePtr, bool needreorderPosesByTSP)
void setNeedreorderPosesByTSP(bool needreorderPosesByTSP)
bool needreorderPosesByTSP
boost::shared_ptr< SortHelper > SortHelperPtr
PoseHelperPtr poseHelperPtr
void nearest_neighbour_and_update_distance(double &distance)
void two_opt_and_update_distance(double &distance)