made and finished the autonomous drive

mad it eas yo control robot while in auto with functions. anf i think i
fixed the belt toggle button!