Calculate joint angles from end-effector position.
Formula
q2 = acos((x2+y2-L12-L22)/(2xL1xL2))
Joint 1 Angle
—
Joint 2 Angle
Reachable (1=yes)
