Implemented FastSLAM with three landmarks. The position of the robot is updated by a particle filter, in which each particle has an extend Kalman filter for estimating landmarks' position.
- CMake
- OpenCV (for visualization)
- Eigen
mkdir build
cd build
cmake ..
make
./runSLAM