Fixing bug in the computation of the SE3's residual and its derivaties