separate openrave independent part query_grasp

[fmessmer]

part of #125

@ipa-rmb @ipa-rmb-pz FYI

[fmessmer]

@ipa-rmb @ipa-rmb-pz
I added a show_grasps_rviz action_server that uses rviz for visualization of the grasps - in addition to show_grasps_or that used OpenRAVE...beside querying the grasps you can now also visualize the grasps without having OpenRAVE installed...this should significantly help debugging the grasptables which are passed to cob_pick_place_action and MoveIt!

It might not be perfect yet, but it already shows a few issues (see the TODOs in the server) that might be the problem why MoveIt! is unable to find a plan for picking up the object:

• it complains about invalid quaternion for all grasp_poses of the sdhx...
• there again is the issue with "side-encoded" joint names, i.e. gripper_1_joint vs. gripper_left_1_joint
• currently you cannot view the grasps for the sdh due to the mimic joint

Still, if you continue using this tools...it should be of significant help as you do not need to install OpenRAVE at all!

[fmessmer]

I fixed the handling of mimic joints and the quaternion normalization
couldn't leave it like this....I was too curious myself...:stuck_out_tongue_winking_eye:

now you clearly see that the problem with grasping with the sdhx is the grasp_poses...this can easily be fixed by modifying the csv-files!

sdh grasptables look fine:

By the way, you run the visualization like so:

• roslaunch cob_grasp_generation show_grasp_rviz.launch gripper:=sdh (or sdhx)
• rosrun cob_grasp_generation show_grasps_rviz_client.py (then enter object_name and gripper_type)

[ipa-rmb]

Awesome, thanks for looking into this. I am looking forward to see this in operation by my student.

[ipa-rmb]

Why did you remove this file? Was it obsolete?

[fmessmer]

nothing is lost...i created separate nodes for each action...

[ipa-rmb]

Aha, excellent. Thanks.

[fmessmer]

@ipa-rmb @ipa-rmb-pz did you do any further tests/enhancements with/ontopof this?
what's the current status?

@ipa-bfb @ipa-aep FYI

[ipa-rmb-pz]

Sorry for the delay. I have just seen the Email, because I only work at Thursday and Friday. Until now i haven't tried to run it. because there was a Demo last month, so i needed to prepare for it. since this month i will begin to try it. i have already learned something about 'Moveit!'. have a wonderful day! ^_^ Zhiqiang

…

________________________________ From: Felix Messmer [notifications@github.com] Sent: Monday, September 04, 2017 3:10 PM To: ipa320/cob_manipulation Cc: Pu, Zhiqiang; Mention Subject: Re: [ipa320/cob_manipulation] separate openrave independent part query_grasp (#126) @ipa-rmb<https://github.com/ipa-rmb> @ipa-rmb-pz<https://github.com/ipa-rmb-pz> did you do any further tests/enhancements with/ontopof this? what's the current status? @ipa-bfb<https://github.com/ipa-bfb> @ipa-aep<https://github.com/ipa-aep> FYI — You are receiving this because you were mentioned. Reply to this email directly, view it on GitHub<#126 (comment)>, or mute the thread<https://github.com/notifications/unsubscribe-auth/AclzydyQl1pzNyRPh4xqqpJA7abC4zoJks5se_begaJpZM4O0lix>.