SLAM-based Autonomous Navigation in Rough Terrains