#include <footstep_graph.h>
Public Types | |
typedef boost::function< double(StatePtr, StatePtr, double) > | PathCostFunction |
typedef boost::shared_ptr< FootstepGraph > | Ptr |
typedef boost::function< bool(StatePtr target_state, std::vector< StatePtr > &) > | SuccessorFunction |
Public Types inherited from jsk_footstep_planner::Graph< FootstepState > | |
typedef boost::shared_ptr< Graph > | Ptr |
typedef boost::shared_ptr< StateT > | StatePtr |
typedef FootstepState | StateT |
Public Member Functions | |
virtual void | clearPerceptionDuration () |
bool | finalizeSteps (const StatePtr &last_1_Step, const StatePtr &lastStep, std::vector< StatePtr > &finalizeSteps) |
FootstepGraph (const Eigen::Vector3f &resolution, const bool use_pointcloud_model=false, const bool lazy_projection=true, const bool local_movement=false, const bool use_obstacle_model=false) | |
virtual TransitionLimit::Ptr | getGlobalTransitionLimit () |
virtual FootstepState::Ptr | getGoal (int leg) |
virtual ros::WallDuration | getPerceptionDuration () |
virtual pcl::PointIndices::Ptr | getPointIndicesCollidingSphere (const Eigen::Affine3f &c) |
virtual Eigen::Affine3f | getRobotCoords (StatePtr current_state, StatePtr previous_state) const |
Compute robot coords from current footstep and previous footstep. R_robot = midcoords(F_current, F_previous) * R_offset;. More... | |
virtual TransitionLimit::Ptr | getTransitionLimit () |
virtual std::string | infoString () const |
return string about graph information. More... | |
virtual bool | isColliding (StatePtr current_state, StatePtr previous_state) |
return True if current_state collides with obstacle. More... | |
virtual bool | isCollidingBox (const Eigen::Affine3f &c, pcl::PointIndices::Ptr candidates) const |
virtual bool | isGoal (StatePtr state) |
virtual bool | isSuccessable (StatePtr current_state, StatePtr previous_state) |
virtual bool | lazyProjection () const |
virtual std::vector< FootstepState::Ptr > | localMoveFootstepState (FootstepState::Ptr in) |
virtual bool | localMovement () const |
virtual double | maxSuccessorDistance () |
virtual double | maxSuccessorRotation () |
double | path_cost_original (StatePtr from, StatePtr to, double prev_cost) |
virtual double | pathCost (StatePtr from, StatePtr to, double prev_cost) |
virtual FootstepState::Ptr | projectFootstep (FootstepState::Ptr in) |
virtual FootstepState::Ptr | projectFootstep (FootstepState::Ptr in, unsigned int &state) |
virtual bool | projectGoal () |
virtual bool | projectStart () |
virtual void | setBasicSuccessors (std::vector< Eigen::Affine3f > left_to_right_successors) |
virtual void | setCollisionBBoxOffset (const Eigen::Affine3f &offset) |
virtual void | setCollisionBBoxSize (const Eigen::Vector3f &size) |
virtual void | setGlobalTransitionLimit (TransitionLimit::Ptr limit) |
virtual void | setGoalState (FootstepState::Ptr left, FootstepState::Ptr right) |
void | setHeuristicPathLine (jsk_recognition_utils::PolyLine &path_line) |
virtual void | setLeftGoalState (FootstepState::Ptr goal) |
virtual void | setObstacleModel (pcl::PointCloud< pcl::PointXYZ >::Ptr model) |
virtual void | setParameters (FootstepParameters &p) |
virtual void | setPathCostFunction (PathCostFunction p) |
virtual void | setPointCloudModel (pcl::PointCloud< pcl::PointNormal >::Ptr model) |
virtual void | setProgressPublisher (ros::NodeHandle &nh, std::string topic) |
virtual void | setRightGoalState (FootstepState::Ptr goal) |
virtual void | setSuccessorFunction (SuccessorFunction s) |
virtual void | setTransitionLimit (TransitionLimit::Ptr limit) |
virtual std::vector< StatePtr > | successors (StatePtr target_state) |
bool | successors_original (StatePtr target_state, std::vector< FootstepGraph::StatePtr > &ret) |
virtual bool | useObstacleModel () const |
virtual bool | usePointCloudModel () const |
Public Member Functions inherited from jsk_footstep_planner::Graph< FootstepState > | |
virtual void | addNode (StatePtr state) |
virtual StatePtr | getGoalState () |
virtual StatePtr | getStartState () |
Graph () | |
virtual bool | isGoal (StatePtr state)=0 |
virtual size_t | numNodes () |
virtual void | setGoalState (StatePtr goal) |
virtual void | setStartState (StatePtr start) |
Private Attributes | |
PathCostFunction | path_cost_func_ |
SuccessorFunction | successor_func_ |
Friends | |
double | footstepHeuristicFollowPathLine (SolverNode< FootstepState, FootstepGraph >::Ptr node, FootstepGraph::Ptr graph) |
Definition at line 54 of file footstep_graph.h.
typedef boost::function< double(StatePtr, StatePtr, double) > jsk_footstep_planner::FootstepGraph::PathCostFunction |
Definition at line 59 of file footstep_graph.h.
Definition at line 57 of file footstep_graph.h.
typedef boost::function< bool(StatePtr target_state, std::vector<StatePtr> &) > jsk_footstep_planner::FootstepGraph::SuccessorFunction |
Definition at line 58 of file footstep_graph.h.
|
inline |
Definition at line 63 of file footstep_graph.h.
|
inlinevirtual |
Definition at line 211 of file footstep_graph.h.
bool jsk_footstep_planner::FootstepGraph::finalizeSteps | ( | const StatePtr & | last_1_Step, |
const StatePtr & | lastStep, | ||
std::vector< StatePtr > & | finalizeSteps | ||
) |
Definition at line 154 of file footstep_graph.cpp.
|
inlinevirtual |
Definition at line 207 of file footstep_graph.h.
|
inlinevirtual |
Definition at line 143 of file footstep_graph.h.
|
inlinevirtual |
Definition at line 210 of file footstep_graph.h.
|
virtual |
Definition at line 107 of file footstep_graph.cpp.
|
virtual |
Compute robot coords from current footstep and previous footstep. R_robot = midcoords(F_current, F_previous) * R_offset;.
Definition at line 101 of file footstep_graph.cpp.
|
inlinevirtual |
Definition at line 205 of file footstep_graph.h.
|
virtual |
return string about graph information.
Definition at line 168 of file footstep_graph.cpp.
|
virtual |
return True if current_state collides with obstacle.
Definition at line 137 of file footstep_graph.cpp.
|
virtual |
Definition at line 118 of file footstep_graph.cpp.
|
virtual |
Definition at line 71 of file footstep_graph.cpp.
|
virtual |
Definition at line 214 of file footstep_graph.cpp.
|
inlinevirtual |
Definition at line 200 of file footstep_graph.h.
|
virtual |
Definition at line 233 of file footstep_graph.cpp.
|
inlinevirtual |
Definition at line 201 of file footstep_graph.h.
|
inlinevirtual |
Definition at line 156 of file footstep_graph.h.
|
inlinevirtual |
Definition at line 160 of file footstep_graph.h.
|
inline |
Definition at line 223 of file footstep_graph.h.
|
inlinevirtual |
Reimplemented from jsk_footstep_planner::Graph< FootstepState >.
Definition at line 96 of file footstep_graph.h.
|
virtual |
Definition at line 324 of file footstep_graph.cpp.
|
virtual |
Definition at line 330 of file footstep_graph.cpp.
|
virtual |
Definition at line 350 of file footstep_graph.cpp.
|
virtual |
Definition at line 372 of file footstep_graph.cpp.
|
virtual |
Definition at line 41 of file footstep_graph.cpp.
|
inlinevirtual |
Definition at line 213 of file footstep_graph.h.
|
inlinevirtual |
Definition at line 214 of file footstep_graph.h.
|
inlinevirtual |
Definition at line 206 of file footstep_graph.h.
|
inlinevirtual |
Definition at line 117 of file footstep_graph.h.
|
inline |
Definition at line 227 of file footstep_graph.h.
|
inlinevirtual |
Definition at line 124 of file footstep_graph.h.
|
inlinevirtual |
Definition at line 189 of file footstep_graph.h.
|
inlinevirtual |
Definition at line 203 of file footstep_graph.h.
|
inlinevirtual |
Definition at line 219 of file footstep_graph.h.
|
inlinevirtual |
Definition at line 171 of file footstep_graph.h.
|
inlinevirtual |
Definition at line 165 of file footstep_graph.h.
|
inlinevirtual |
Definition at line 129 of file footstep_graph.h.
|
inlinevirtual |
Definition at line 216 of file footstep_graph.h.
|
inlinevirtual |
Definition at line 204 of file footstep_graph.h.
|
inlinevirtual |
Implements jsk_footstep_planner::Graph< FootstepState >.
Definition at line 88 of file footstep_graph.h.
bool jsk_footstep_planner::FootstepGraph::successors_original | ( | StatePtr | target_state, |
std::vector< FootstepGraph::StatePtr > & | ret | ||
) |
Definition at line 274 of file footstep_graph.cpp.
|
inlinevirtual |
Definition at line 198 of file footstep_graph.h.
|
inlinevirtual |
Definition at line 199 of file footstep_graph.h.
|
friend |
|
protected |
Definition at line 249 of file footstep_graph.h.
|
protected |
Definition at line 250 of file footstep_graph.h.
|
protected |
Definition at line 263 of file footstep_graph.h.
|
protected |
Definition at line 239 of file footstep_graph.h.
|
protected |
Definition at line 269 of file footstep_graph.h.
|
protected |
Definition at line 257 of file footstep_graph.h.
|
protected |
Definition at line 242 of file footstep_graph.h.
|
protected |
Definition at line 258 of file footstep_graph.h.
|
protected |
Definition at line 251 of file footstep_graph.h.
|
protected |
Definition at line 252 of file footstep_graph.h.
|
protected |
Definition at line 233 of file footstep_graph.h.
|
protected |
Definition at line 236 of file footstep_graph.h.
|
protected |
Definition at line 264 of file footstep_graph.h.
|
private |
Definition at line 272 of file footstep_graph.h.
|
protected |
Definition at line 266 of file footstep_graph.h.
|
protected |
Definition at line 232 of file footstep_graph.h.
|
protected |
Definition at line 234 of file footstep_graph.h.
|
protected |
Definition at line 254 of file footstep_graph.h.
|
protected |
Definition at line 253 of file footstep_graph.h.
|
protected |
Definition at line 260 of file footstep_graph.h.
|
protected |
Definition at line 243 of file footstep_graph.h.
|
private |
Definition at line 271 of file footstep_graph.h.
|
protected |
Definition at line 240 of file footstep_graph.h.
|
protected |
Definition at line 241 of file footstep_graph.h.
|
protected |
Definition at line 262 of file footstep_graph.h.
|
protected |
Definition at line 235 of file footstep_graph.h.
|
protected |
Definition at line 238 of file footstep_graph.h.
|
protected |
Definition at line 259 of file footstep_graph.h.
|
protected |
Definition at line 256 of file footstep_graph.h.
|
protected |
zero_state is used only for global transition limit
Definition at line 248 of file footstep_graph.h.