Using ultrasonic sensor to detect wall when robot is driving