IT'S DONE

:D (maybe)
changed some timers, and did distance testing. set the ultrasonic
reading in autonomous