Correction of ikJacobian3DOF method. Used numpy pseudoinverse matrix