Added ultrasonic sensor function. that is all