SLAM with gaussian movement