Adding an initial code for controlling the direction of the motors depending on the sweep scan done by the ultrasonic sensor mounted on a servomotor