Code for RC Tank and ultrasonic sensor