How to get rotaion matrix or quaternion?
Hello all, I am doing some arm planning about my robot. I have a point B(x2,y2,z2) in space where I want the end-effector A(x1,y1,z1) to go.
In my opinion, I had better get the quaternion of point B first, then get the IK using point B and quaternion, after that I can use arm_navigation_msgs::GetMotionPlan to do a plan.
but I am unsure how to produce the quaternions.
or any other good method to plan end-effector from A to B?
Thanks in advance.