Merged in pose_rotation_prior_logmap_fix (pull request #20)
Fixed PoseRotationPrior error calculation.release/4.3a0
commit
2000dbb868
|
@ -77,7 +77,7 @@ public:
|
||||||
(*H).middleCols(rotInterval.first, rDim).setIdentity(rDim, rDim);
|
(*H).middleCols(rotInterval.first, rDim).setIdentity(rDim, rDim);
|
||||||
}
|
}
|
||||||
|
|
||||||
return Rotation::Logmap(newR) - Rotation::Logmap(measured_);
|
return measured_.localCoordinates(newR);
|
||||||
}
|
}
|
||||||
|
|
||||||
private:
|
private:
|
||||||
|
|
Loading…
Reference in New Issue