cartesio_planning Package for whole body sampling based planning ompl_test upload URDF & SRDF to param server (braccetto) rosrun robot_state_publisher robot_state_publisher run executable ./ompl_test _is_model_floating_base:=false rviz