Changing state to goal_state and there checking for collisions
Hi!
I would like to check for collisions in the goal state before actually moving the real robot. In particular I want to check whether a specified point is in collision with the robot.
Therefore I have two questions:
- To achieve that I think I need to set the state of the robot to the goal state after I planned the path. So I'm looking for something like
robot_state::RobotState& current_state = planning_scene.getCurrentState();
but for the goalstate. Is there a function like `planningscene.getGoalState()` or similar? I can't find any... - Being in the goalstate, I would like to check if a point would collide with the robot (in the goalstate). I'm looking for a function where I can insert a point x,y,z and it tells me whether this point is "inside" an object or free in space.
Does anybody knows whether this approach is actually doable with moveit?
Asked by bluefish on 2015-05-26 06:13:14 UTC
Comments