servo motor and ultrasonic sensor problem