Implementation of algorithms for SLAM: EKF, EIF and SEIF. Group Project with Dmitry ZHUKOV and Joseph LAM.
Mainly based on this article: http://robots.stanford.edu/papers/thrun.tr-seif02.pdf
For now, data association is supposed know as well as a previous noisy knowledge of the map.