Skip to content

burgetf/nao_wholebody_planning

Repository files navigation

Steps to run Whole-Body Motion Planner:

//------ SETUP ------
1) roslaunch rrt_connect_planner planning_context_rfoot.launch 
  (starts all planner services and sets parameters on param server)
2) rosrun rviz rviz (optional)

//---- EXAMPLES -----
3.1) For a simulated NAO:
  roslaunch rrt_connect_planner_example nao_local.launch (for a simulated NAO / NAOqi needs to be started beforehand)
  rosrun rrt_connect_planner_example planning_example_simulation 3 (the number, here "3", sets the planning scenario in planning_example_simulation.cpp)

3.2) For a real NAO:
  roslaunch rrt_connect_planner_example nao_extern.launch (for a real NAO, set IP and PORT for your NAO in nao_extern.launch)
  rosrun rrt_connect_planner_example planning_example_execution 3 (the number, here "3", sets the planning scenario in planning_example_execution.cpp)

//--- EXECUTION -------
NAO starts execution immediatedly after successful planning 
(otherwise outputs an eror message if it failed to generated a plan for the given grasp pose or manipulation task)

About

Extended RRT-CONNECT Algorithm for Whole-body Motion Planning

Resources

Stars

Watchers

Forks

Releases

No releases published

Packages

No packages published

Languages