Corrected and improved performance of ik3DOFJacobian