Efficient Solutions to Autonomous Mapping and Navigation Problems