Skip to content

Commit

Permalink
update Lyx document based on Luca's review
Browse files Browse the repository at this point in the history
  • Loading branch information
varunagrawal committed Jul 3, 2022
1 parent cb75d92 commit bbd1e3f
Show file tree
Hide file tree
Showing 2 changed files with 69 additions and 4 deletions.
73 changes: 69 additions & 4 deletions doc/ImuFactor.lyx
Original file line number Diff line number Diff line change
Expand Up @@ -281,8 +281,8 @@ The noise model associated with this factor is assumed to be zero-mean Gaussian
\end_inset

.
This covariance matrix is computed in the preintegrated measurement class,
of which there are two variants as discussed above.
This (discrete-time) covariance matrix is computed in the preintegrated
measurement class, of which there are two variants as discussed above.
\end_layout

\begin_layout Subsubsection*
Expand All @@ -309,6 +309,20 @@ CombinedImuFactor2 is a 4-way factor between the previous NavState and IMU
bias and the current NavState and IMU bias.
\end_layout

\begin_layout Standard
Since the Combined IMU Factor has a larger state variable due to the inclusion
of IMU biases, the noise model associated with this factor is assumed to
be a zero mean Gaussian with a
\begin_inset Formula $15\times15$
\end_inset

covariance matrix
\begin_inset Formula $\Sigma$
\end_inset

, similarly defined on the tangent space of the NavState manifold.
\end_layout

\begin_layout Subsubsection*
Covariance Matrices
\end_layout
Expand Down Expand Up @@ -564,7 +578,15 @@ acceleration
\end_inset

in the body frame.
We know (from Murray84book) that the derivative of
We know (from
\begin_inset CommandInset citation
LatexCommand cite
key "Murray94book"
literal "false"

\end_inset

) that the derivative of
\begin_inset Formula $R$
\end_inset

Expand Down Expand Up @@ -1618,6 +1640,42 @@ where
\begin_inset Formula $\omega^{b}$
\end_inset

.
Note that
\begin_inset Formula $\Sigma_{k},$
\end_inset


\begin_inset Formula $\Sigma_{\eta}^{ad}$
\end_inset

, and
\begin_inset Formula $\Sigma_{\eta}^{gd}$
\end_inset

are discrete time covariances with
\begin_inset Formula $\Sigma_{\eta}^{ad}$
\end_inset

, and
\begin_inset Formula $\Sigma_{\eta}^{gd}$
\end_inset

divided by
\begin_inset Formula $\Delta_{t}$
\end_inset

.
Please see the section on Covariance Discretization
\begin_inset CommandInset ref
LatexCommand vpageref
reference "subsec:Covariance-Discretization"
plural "false"
caps "false"
noprefix "false"

\end_inset

.
\end_layout

Expand Down Expand Up @@ -1645,7 +1703,7 @@ It can be shown that for small
we have
\begin_inset Formula
\[
\deriv{H(\theta_{k})^{-1}\omega_{k}^{b}}{\theta_{k}}\approx-\frac{1}{2}\Skew{\omega_{k}^{b}}\mbox{ and hence }\deriv{\theta_{k+1}}{\theta_{k}}=I_{3\times3}-\frac{\Delta t}{2}\Skew{\omega_{k}^{b}}
\deriv{H(\theta_{k})^{-1}\omega_{k}^{b}}{\theta_{k}}\approx-\frac{1}{2}\Skew{\omega_{k}^{b}}\mbox{ and hence }\deriv{\theta_{k+1}}{\theta_{k}}=I_{3\times3}-\frac{\Delta_{t}}{2}\Skew{\omega_{k}^{b}}
\]

\end_inset
Expand Down Expand Up @@ -2033,6 +2091,13 @@ which we can break into 3 matrices for clarity, representing the main diagonal

\begin_layout Subsubsection*
Covariance Discretization
\begin_inset CommandInset label
LatexCommand label
name "subsec:Covariance-Discretization"

\end_inset


\end_layout

\begin_layout Standard
Expand Down
Binary file modified doc/ImuFactor.pdf
Binary file not shown.

0 comments on commit bbd1e3f

Please sign in to comment.