Autonomous code written for URC 2018 in literally one night by Stanford Robotics - View it on GitHub