inverse action, much nicer

release/4.3a0
Frank Dellaert 2010-03-11 21:39:44 +00:00
parent 67fb7fa9ff
commit 84c25b2346
2 changed files with 48 additions and 15 deletions

View File

@ -54,7 +54,7 @@ Geometry Derivatives and Other Hairy Math
Frank Dellaert Frank Dellaert
\end_layout \end_layout
\begin_layout Plain Layout \begin_layout Standard
\begin_inset Box Frameless \begin_inset Box Frameless
position "t" position "t"
hor_pos "c" hor_pos "c"
@ -326,7 +326,7 @@ Derivatives of Lie Group Mappings
\end_layout \end_layout
\begin_layout Subsection \begin_layout Subsection
New Homomorphisms
\end_layout \end_layout
\begin_layout Standard \begin_layout Standard
@ -410,6 +410,10 @@ e^{-\xhat}=\left(e^{-\xhat}\right)^{-1}\]
\end_layout \end_layout
\begin_layout Standard \begin_layout Standard
\begin_inset Note Note
status open
\begin_layout Plain Layout
Let us define two mappings Let us define two mappings
\begin_inset Formula \[ \begin_inset Formula \[
\Phi_{1}(A)=AB\mbox{ and }\Phi_{2}(B)=AB\] \Phi_{1}(A)=AB\mbox{ and }\Phi_{2}(B)=AB\]
@ -423,10 +427,15 @@ Then
\end_inset \end_inset
\end_layout
\end_inset
\end_layout \end_layout
\begin_layout Subsection \begin_layout Subsection
Old Derivatives
\end_layout \end_layout
\begin_layout Standard \begin_layout Standard
@ -903,28 +912,22 @@ we would now like to know what an incremental action
\begin_inset Formula \begin{eqnarray*} \begin_inset Formula \begin{eqnarray*}
q(x) & = & \left(Te^{\xhat}\right)^{-1}p\\ q(x) & = & \left(Te^{\xhat}\right)^{-1}p\\
& = & e^{-\xhat}T^{-1}p\\ & = & e^{-\xhat}T^{-1}p\\
& = & T^{-1}Te^{-\xhat}T^{-1}p\\ & = & e^{-\xhat}q\\
& = & -T^{-1}\exp\left(T\xhat T^{-1}\right)p\end{eqnarray*} & \approx & q-\xhat q\end{eqnarray*}
\end_inset \end_inset
Hence Hence
\begin_inset Formula \begin{equation} \begin_inset Formula \begin{equation}
\deriv{q(x)}x=-T^{-1}\deriv{\left(T\xhat T^{-1}\mbox{ }p\right)}x\label{eq:inverseAction}\end{equation} \deriv{q(x)}x=\deriv{\left(q-\xhat q\right)}x=-\deriv{\left(\xhat q\right)}x=-H_{q}\label{eq:inverseAction}\end{equation}
\end_inset \end_inset
The derivative in where
\begin_inset Formula $p$ \begin_inset Formula $H_{q}$
\end_inset \end_inset
is again easy for matrix Lie groups: will be as above.
\begin_inset Formula \[
\deriv{\left(T^{-1}p\right)}p=T^{-1}\]
\end_inset
\end_layout \end_layout
\begin_layout Section \begin_layout Section
@ -1679,6 +1682,36 @@ in homogenous coordinates.
\end_inset \end_inset
The derivative of the inverse action
\begin_inset Formula $T^{-1}p$
\end_inset
is given by formula
\begin_inset CommandInset ref
LatexCommand ref
reference "eq:inverseAction"
\end_inset
:
\end_layout
\begin_layout Standard
\family roman
\series medium
\shape up
\size normal
\emph off
\bar no
\noun off
\color none
\begin_inset Formula \[
\deriv{\hat{q}(\xi)}{\xi}=-H_{q}=\left[\begin{array}{cc}
\Skew q & -I_{3}\end{array}\right]\]
\end_inset
\end_layout \end_layout

Binary file not shown.