Revision 1814
| branches/16299_s10/latex/math.tex (revision 1814) | ||
|---|---|---|
| 1 |
\documentclass[11pt]{article}
|
|
| 2 |
\usepackage{fullpage}
|
|
| 3 |
\usepackage{latexsym}
|
|
| 4 |
\usepackage{amsmath}
|
|
| 5 |
\begin{document}
|
|
| 6 |
|
|
| 7 |
|
|
| 8 |
notation: |
|
| 9 |
\begin{itemize}
|
|
| 10 |
\item $x$ - true x position |
|
| 11 |
\item $\tilde{x}$ - sensed x
|
|
| 12 |
\item $\hat{x}$ - desired
|
|
| 13 |
\end{itemize}
|
|
| 14 |
|
|
| 15 |
|
|
| 16 |
\textbf{motion model}
|
|
| 17 |
|
|
| 18 |
\[ |
|
| 19 |
\bigl [ \omega_l[k] \;,\; \omega_r[k] \bigr] = |
|
| 20 |
\max \left \{ \min \left \{
|
|
| 21 |
\left[\begin{array}{cc} \frac{R}{2} & \frac{R}{2}\\ -\frac{R}{L} & \frac{R}{L} \end{array}\right]
|
|
| 22 |
^ {-1}
|
|
| 23 |
\left[\begin{array}{c} v[k] \\ \omega[k] \end{array}\right]
|
|
| 24 |
\;, \quad \tt{minSpeed} \right \} \;, \quad \tt{maxSpeed} \right \}
|
|
| 25 |
+ \mathcal{N}
|
|
| 26 |
\] |
|
| 27 |
|
|
| 28 |
Where $\mathcal{N}$ is the Gaussian noise model
|
|
| 29 |
|
|
| 30 |
\[ |
|
| 31 |
x[k] = k[k-1] + \cos ( \theta[k-1] ) v[k] dt |
|
| 32 |
\] |
|
| 33 |
|
|
| 34 |
\[ |
|
| 35 |
y[k] = y[k-1] + \sin ( \theta[k-1] ) v[k] dt |
|
| 36 |
\] |
|
| 37 |
|
|
| 38 |
\[ |
|
| 39 |
\theta[k] = \theta[k-1] + \omega[k]dt |
|
| 40 |
\] |
|
| 41 |
|
|
| 42 |
|
|
| 43 |
\textbf{sensor model}
|
|
| 44 |
|
|
| 45 |
$d$ is the sensor delay, in timesteps |
|
| 46 |
|
|
| 47 |
\begin{align*}
|
|
| 48 |
\tilde{\phi}[k] &= \left \lfloor (\phi[k-d] + \mathcal{N}) \frac{8}{\pi} \right \rfloor \frac{\pi}{8} \\
|
|
| 49 |
\tilde{x}[k] &= x[k-d] \\
|
|
| 50 |
\tilde{y}[k] &= y[k-d]
|
|
| 51 |
\end{align*}
|
|
| 52 |
|
|
| 53 |
|
|
| 54 |
\end{document}
|
|
Also available in: Unified diff