finished perfect control of ultrasonic controlled cleaning robot