Pre-Test Simple Autonomous

Basic Autonomous Function is implemented and is a pre test state.