-Cleaning up code and fixed a minor issue with the calculating autonomous drive distance