Calculate end-effector position from joint angles.
Formula
x = L1 x cos(q1) + L2 x cos(q1+q2)
End-Effector X
—
End-Effector Y
Total Reach
