Project

General

Profile

Statistics
| Revision:

root / branches / 16299_s10 / latex / math.tex @ 1814

History | View | Annotate | Download (1.04 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}