SLAM in an initially unknown environment