fix typename
parent
81820bde52
commit
b0c57d34db
|
@ -92,7 +92,7 @@ namespace gtsam {
|
||||||
T hx = traits<T>::Between(p1, p2, H1, H2); // h(x)
|
T hx = traits<T>::Between(p1, p2, H1, H2); // h(x)
|
||||||
// manifold equivalent of h(x)-z -> log(z,h(x))
|
// manifold equivalent of h(x)-z -> log(z,h(x))
|
||||||
#ifdef SLOW_BUT_CORRECT_BETWEENFACTOR
|
#ifdef SLOW_BUT_CORRECT_BETWEENFACTOR
|
||||||
typename traits<T>::ChartJacobian::Fixed Hlocal;
|
typename traits<T>::ChartJacobian::Jacobian Hlocal;
|
||||||
Vector rval = traits<T>::Local(measured_, hx, boost::none, (H1 || H2) ? &Hlocal : 0);
|
Vector rval = traits<T>::Local(measured_, hx, boost::none, (H1 || H2) ? &Hlocal : 0);
|
||||||
if (H1) *H1 = Hlocal * (*H1);
|
if (H1) *H1 = Hlocal * (*H1);
|
||||||
if (H1) *H2 = Hlocal * (*H2);
|
if (H1) *H2 = Hlocal * (*H2);
|
||||||
|
|
Loading…
Reference in New Issue