Fixed angles in servoGoto to match inverse kinematic