Autonomous beginging code

Here is some starting code for Autonomous