Finished auto code

Finished all the code and it compiles without errors. Please take a look
at it to see what you guys think about the auto, specifically you
William please.