root / branches / 16299_s10 / latex / math.tex @ 1814
History | View | Annotate | Download (1 KB)
| 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} |