Added simple autonomous and added some distance methods to drive.