Robot Control

All destinations for the robotic hand are given in cylindrical coordinates, , with being at the point on the table intersected by the vertical rotational axis of the robot base.

• Translating to
• Finding the Shoulder and Elbow Angles