add details about noise propagation for CombinedImuFactor in ImuFactor.pdf

doc/ImuFactor.lyx

@@ -1,7 +1,9 @@
-#LyX 2.0 created this file. For more info see http://www.lyx.org/
+#LyX 2.3 created this file. For more info see http://www.lyx.org/
-\lyxformat 413
+\lyxformat 544
 \begin_document
 \begin_header
+\save_transient_properties true
+\origin unavailable
 \textclass article
 \use_default_options true
 \maintain_unincluded_children false
@@ -9,16 +11,18 @@
 \language_package default
 \inputencoding auto
 \fontencoding global
-\font_roman default
+\font_roman "default" "default"
-\font_sans default
+\font_sans "default" "default"
-\font_typewriter default
+\font_typewriter "default" "default"
+\font_math "auto" "auto"
 \font_default_family default
 \use_non_tex_fonts false
 \font_sc false
 \font_osf false
-\font_sf_scale 100
+\font_sf_scale 100 100
-\font_tt_scale 100
+\font_tt_scale 100 100
-
+\use_microtype false
+\use_dash_ligatures true
 \graphics default
 \default_output_format default
 \output_sync 0
@@ -29,16 +33,26 @@
 \use_hyperref false
 \papersize default
 \use_geometry true
-\use_amsmath 1
+\use_package amsmath 1
-\use_esint 1
+\use_package amssymb 1
-\use_mhchem 1
+\use_package cancel 1
-\use_mathdots 1
+\use_package esint 1
+\use_package mathdots 1
+\use_package mathtools 1
+\use_package mhchem 1
+\use_package stackrel 1
+\use_package stmaryrd 1
+\use_package undertilde 1
 \cite_engine basic
+\cite_engine_type default
+\biblio_style plain
 \use_bibtopic false
 \use_indices false
 \paperorientation portrait
 \suppress_date false
+\justification true
 \use_refstyle 1
+\use_minted 0
 \index Index
 \shortcut idx
 \color #008000
@@ -51,7 +65,10 @@
 \tocdepth 3
 \paragraph_separation indent
 \paragraph_indentation default
-\quotes_language english
+\is_math_indent 0
+\math_numbering_side default
+\quotes_style english
+\dynamic_quotes 0
 \papercolumns 1
 \papersides 1
 \paperpagestyle default
@@ -69,7 +86,7 @@ The new IMU Factor
 \end_layout
 
 \begin_layout Author
-Frank Dellaert
+Frank Dellaert & Varun Agrawal
 \end_layout
 
 \begin_layout Standard
@@ -592,6 +609,7 @@ Lie Group Methods
 \begin_inset CommandInset citation
 LatexCommand cite
 key "Iserles00an"
+literal "true"
 
 \end_inset
 
@@ -1382,6 +1400,99 @@ H(\theta_{k})^{-1}\Delta_{t}\\
 \end_inset
 
 
+\end_layout
+
+\begin_layout Subsubsection*
+Combined IMU Factor
+\end_layout
+
+\begin_layout Standard
+We can similarly account for bias drift over time, as is commonly seen in
+ commercial grade IMUs.
+ This is accomplished via the 
+\emph on
+CombinedImuFactor
+\emph default
+ which is a 6-way factor between the previous 
+\emph on
+pose/velocity/bias
+\emph default
+ and the 
+\emph on
+pose/velocity/bias
+\emph default
+ at the next timestep.
+ 
+\end_layout
+
+\begin_layout Standard
+We expand the state vector as 
+\begin_inset Formula $\zeta_{k}=[\theta_{k},p_{k},v_{k},a_{k}^{b}, \omega_{k}^{b}]$
+\end_inset
+
+.
+ For the jacobian 
+\begin_inset Formula $F_{k}$
+\end_inset
+
+ of 
+\begin_inset Formula $f$
+\end_inset
+
+ wrpt this new 
+\begin_inset Formula $\zeta$
+\end_inset
+
+, we get a 
+\begin_inset Formula $15\times15$
+\end_inset
+
+ matrix.
+ The top-left 
+\begin_inset Formula $9\times9$
+\end_inset
+
+ is the same as 
+\begin_inset Formula $A_{k}$
+\end_inset
+
+, thus we only have the jacobians wrpt the biases left to account for.
+\end_layout
+
+\begin_layout Standard
+Conveniently, the jacobians of the pose and velocity wrpt the biases are
+ already computed in the 
+\emph on
+ImuFactor 
+\emph default
+derivation as matrices 
+\begin_inset Formula $B_{k}$
+\end_inset
+
+ and 
+\begin_inset Formula $C_{k}$
+\end_inset
+
+, while they are identity matrices wrpt the biases themselves.
+ Thus, we can easily plug-in the values from the previous section to give
+ us the final result
+\end_layout
+
+\begin_layout Standard
+\begin_inset Formula 
+\[
+F_{k}=\left[\begin{array}{ccccc}
+I_{3\times3}-\frac{\Delta_{t}}{2}\Skew{\omega_{k}^{b}} &  &  &  & H(\theta_{k})^{-1}\Delta_{t}\\
+R_{k}\Skew{-a_{k}^{b}}H(\theta_{k})\frac{\Delta_{t}}{2}^{2} & I_{3\times3} & I_{3\times3}\Delta_{t} & R_{k}\frac{\Delta_{t}}{2}^{2}\\
+R_{k}\Skew{-a_{k}^{b}}H(\theta_{k})\Delta_{t} &  & I_{3\times3} & R_{k}\Delta_{t}\\
+ &  &  & I_{3\times3}\\
+ &  &  &  & I_{3\times3}
+\end{array}\right]
+\]
+
+\end_inset
+
+
 \end_layout
 
 \begin_layout Standard