1
vote
Derivation of EKF slam landmark initialization
You simply expand the size of your state vector and covariance matrix.
Lets say our current state is simply a 2D robot pose.
$$s = \begin{bmatrix}
x \\
y \\
\theta
\end{bmatrix}$$
which will have a ...
- 1,581
Only top scored, non community-wiki answers of a minimum length are eligible