| ROS Resources: Documentation | Support | Discussion Forum | Index | Service Status | ros @ Robotics Stack Exchange |
I am creating a node that has to publish the pose (and if possible twist) of the end effector.
My robot publishes a tf which I think could be used in this fashion. But I would also like to benefit from MoveIt's high-level API which allows to give names to the end effectors.
Additional question: if you have anything for the end effector twist, that would be very helpful.
As stated in here by Simon Jansen:
Assuming you're using the high-level movegroup interface, could you not do something like this:
moveit::planning_interface::MoveGroup *group; group = new moveit::planning_interface::MoveGroup("arm"); group->setEndEffectorLink("hand_left"); geometry_msgs::PoseStamped current_pose = group->getCurrentPose();
but this is if you want to define a new group. If you want to use the group linked to your previous end-effector you should do:
moveit::planning_interface::MoveGroup group("your end-effector");
group.getCurrentPose();
Is your end effector a link with a frame id?
Then you already have everything. Just get the tf transform for this frame_id. This gives you a pose that contains position and orientation.
There is a precise notion of end effector in the MoveIt API (http://moveit.ros.org/wiki/PR2/Setup_Assistant/Quick_Start#STEP_6:_Label_End_Effectors) which I would need to use. Plus, in the MoveIt API, if you have a link you can get the FK. However I fail at seeing the big picture.
I agree with @dornhege. Just use TF, using MoveIt only for this is overkill.
While I agree with your point, TF doesn't semantically take advantage of the end effector naming from MoveIt. Say you have at least two end effectors that you defined (e.g fingers on a hand) and your node accept an "end_effector" property, it's easier to switch from a user point of view.
Asked: 2013-10-08 22:16:51 -0500
Seen: 10,025 times
Last updated: Oct 10 '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.
With twist do you mean how it is oriented or how it is moving (i.e. velocities)?
Yes, as in geometry_msgs::Twist
@Flavian has also posted this question here, see more answers in this thread: https://groups.google.com/d/msg/moveit-users/zFMzGqkVBuc/cO7Pzc34qVMJ