Fixed Logmap
parent
8f36e33566
commit
47ad4c13f7
|
@ -136,7 +136,7 @@ namespace gtsam {
|
||||||
/* ************************************************************************* */
|
/* ************************************************************************* */
|
||||||
Vector3 Rot3::Logmap(const Rot3& R, OptionalJacobian<3, 3> H) {
|
Vector3 Rot3::Logmap(const Rot3& R, OptionalJacobian<3, 3> H) {
|
||||||
// if(H) *H = Rot3::LogmapDerivative(thetaR);
|
// if(H) *H = Rot3::LogmapDerivative(thetaR);
|
||||||
// return QuaternionChart::Logmap(R.quaternion_);
|
return traits<Quaternion>::Logmap(R.quaternion_, H);
|
||||||
return Vector3(0,0,0);
|
return Vector3(0,0,0);
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
Loading…
Reference in New Issue