Forward Kinematics of PUMA 560