got encoder code and auto working

auto works based of a sanity checked bang-bang system