Crash Lab navigation and slam code - View it on GitHub