Ultrasonic Code

Integrate into main code