formatting
parent
dfa32e5020
commit
40e6d8be9b
|
@ -82,7 +82,7 @@
|
||||||
\begin_body
|
\begin_body
|
||||||
|
|
||||||
\begin_layout Title
|
\begin_layout Title
|
||||||
The new IMU Factor
|
The New IMU Factor
|
||||||
\end_layout
|
\end_layout
|
||||||
|
|
||||||
\begin_layout Author
|
\begin_layout Author
|
||||||
|
|
|
@ -157,9 +157,9 @@ Vector9 PreintegrationBase::computeError(const NavState& state_i,
|
||||||
state_j.localCoordinates(predictedState_j, H2 ? &D_error_state_j : 0,
|
state_j.localCoordinates(predictedState_j, H2 ? &D_error_state_j : 0,
|
||||||
H1 || H3 ? &D_error_predict : 0);
|
H1 || H3 ? &D_error_predict : 0);
|
||||||
|
|
||||||
if (H1) *H1 << D_error_predict* D_predict_state_i;
|
if (H1) *H1 << D_error_predict * D_predict_state_i;
|
||||||
if (H2) *H2 << D_error_state_j;
|
if (H2) *H2 << D_error_state_j;
|
||||||
if (H3) *H3 << D_error_predict* D_predict_bias_i;
|
if (H3) *H3 << D_error_predict * D_predict_bias_i;
|
||||||
|
|
||||||
return error;
|
return error;
|
||||||
}
|
}
|
||||||
|
|
Loading…
Reference in New Issue