added basic crappy drive system based on if statements and sonar