Autonomous Systems Final Project