Eerything works yo dont touch (tanner)
Added working ultra sonic and driver display. needs averaging still
Refactored and bug Fixes final copy Do Not Touch (Tannor)
Autonomous mode complete, hopefully ready for competition.