EKF SLAM simulation (no GUI)