Hi,
When planning towards a pose goal with move_group_interface, my program freezes. The goal was successfully planned, there is no error message:
[ INFO] [1468585702.343711063]: Planning request received for MoveGroup action. Forwarding to planning pipeline.
[ INFO] [1468585702.346383724]: No planner specified. Using default.
[ INFO] [1468585702.347143174]: RRTConnect: Starting planning with 1 states already in datastructure
[ INFO] [1468585702.386972714]: RRTConnect: Created 4 states (2 start + 2 goal)
[ INFO] [1468585702.387030791]: Solution found in 0.040406 seconds
[ INFO] [1468585702.394637573]: SimpleSetup: Path simplification took 0.001726 seconds and changed from 3 to 2 states
After the last message, the program freezes.
To plan the pose goal, I used the following code:
this->move_group_interface->setPoseTarget(this->move_group_interface->getCurrentPose(this->move_group_interface->getEndEffectorLink()), this->move_group_interface->getEndEffectorLink());
I cannot imagine, why the `moveit::planning_interface::MoveGroup::plan()` should block my program even after the plan was successfully created.
Thank you for your help!
↧