Autonomous changes

added slight wait if it saw the target

also, sout'ed the ultrasonic in teleop