| ROS Resources: Documentation | Support | Discussion Forum | Index | Service Status | ros @ Robotics Stack Exchange |
How do I get full RobotState from MoveIt? I could use /joint_states topic but there are more publishers of that, I would have to aggregate it somehow. There must be a simpler way, or am I wrong?
You can use the get_planning_scene service to query information about the various parts of MoveIt's planning scene.
Here is the detailed description: http://docs.ros.org/api/moveit_msgs/html/srv/GetPlanningScene.html
PS: For some reason that service was first not available for me. I had to manually add this capability in the move_group.launch:
<param name="capabilities" value="move_group/MoveGroupCartesianPathService [...]
move_group/MoveGroupGetPlanningSceneService" />
Another option is to use the CurrentStateMonitor class: http://moveit.ros.org/doxygen/classplanning__scene__monitor_1_1CurrentStateMonitor.html
Which allows you to monitor the current state easily.
Another way is to use the MoveGroupInterface class: http://moveit.ros.org/doxygen/classmoveit_1_1planning__interface_1_1MoveGroup.html and calling getCurrentJointValues(). This function is a bit slow, as it will wait for a little while to receive messages so it can construct a full state. I recommend the first option if you need to get the state multiple times.
I just saw the in python bit. I am working on a way to get a RobotState message (should be in today or tomorrow). At the moment, in RobotCommander you can call get_joint and get_link, which will give you some information about the state (joint position, transforms)
Asked: 2013-09-04 23:43:06 -0600
Seen: 1,274 times
Last updated: Sep 05 '13
ROS Answers is licensed under Creative Commons Attribution 3.0 Content on this site is licensed under a Creative Commons Attribution Share Alike 3.0 license.