Attention: Answers.ros.org is deprecated as of August the 11th, 2023. Please visit robotics.stackexchange.com to ask a new question. This site will remain online in read-only mode during the transition and into the foreseeable future. Selected questions and answers have been migrated, and redirects have been put in place to direct users to the corresponding questions on Robotics Stack Exchange. Additional details are available here.

Revision history [back]

Below is a pseudocode of solution that works for me:

Get rotation of tool tip in the bin's frame (r1)
get target's rotation in bin's frame (r2)
calculate r12
Form a new rotation r3 from r12 with the rz = 0
required rotation = r13

There may be issues with pre and post multiplications in the notations, but I hope the idea is clear.

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.