我写的一个2D-EKF-SLAM的实现，pdf里面有程序地址，麻雀虽小，五脏俱全，可以作为EKF-SLAM的入门。