Colony

\documentclass[11pt]{article}

\usepackage{fullpage}

\usepackage{latexsym}

\usepackage{amsmath}

\begin{document}

notation:

\begin{itemize}

\item $x$ - true x position

\item $\tilde{x}$ - sensed x

\item $\hat{x}$ - desired

\item $r$ - true r

\item $\tilde{r}$ - sensed r

\item $\hat{r}$ - desired

\item $\phi$ - true phi position

\item $\tilde{\phi}$ - sensed phi

\item $\hat{\phi}$ - desired

\item $y$ - true y position

\item $\tilde{y}$ - sensed y

\item $\hat{y}$ - desired

\item $(\hat{r}, \hat{\phi}) ^ n$

\item $(\hat{x}, \hat{y}) ^ n$

\item $(\hat{v}, \hat{\omega}) ^ n$

\item $(\tilde{v}, \tilde{\omega}) ^ n$

\item $(\tilde{x}, \tilde{y}, \tilde{\Theta}, \tilde{\phi}) ^ n$

\item $(\hat{\omega_l}, \hat{\omega_r}) ^ n$

\item $({\omega_l}, {\omega_r}) ^ n$

\item $(\tilde{\omega_l}, \tilde{\omega_r}) ^ n$

\item $(\tilde{x}, \tilde{y}, \tilde{\Theta}) ^ n$

\item $(\tilde{x}, \tilde{y}, \tilde{\phi}) ^ n$

\item $\phi ^ n$

\item $\tilde{\phi} ^ n$

\end{itemize}

\textbf{motion model}

\[

\bigl [ \omega_l[k] \;,\; \omega_r[k] \bigr] = 

\max \left \{ \min \left \{ 

\left[\begin{array}{cc} \frac{R}{2} & \frac{R}{2}\\ -\frac{R}{L} & \frac{R}{L} \end{array}\right]

^ {-1} 

\left[\begin{array}{c} v[k] \\ \omega[k] \end{array}\right]

\;, \quad \tt{minSpeed} \right \} \;, \quad \tt{maxSpeed} \right \}

+ \mathcal{N}

\]

Where $\mathcal{N}$ is the Gaussian noise model

\[

x[k] = k[k-1] + \cos ( \theta[k-1] ) v[k] dt

\]

\[

y[k] = y[k-1] + \sin ( \theta[k-1] ) v[k] dt

\]

\[

\theta[k] = \theta[k-1] + \omega[k]dt

\]

\textbf{sensor model}

$d$ is the sensor delay, in timesteps

\begin{align*}

  \tilde{\phi}[k] &= \left \lfloor (\phi[k-d] + \mathcal{N})  \frac{8}{\pi} \right \rfloor \frac{\pi}{8} \\

  \tilde{x}[k] &= x[k-d] \\

  \tilde{y}[k] &= y[k-d]

\end{align*}

\end{document}