Ultrasonic test Code

Code for hagisonic ultrasonics
fix
Revert "fix"

This reverts commit aa9983002a88ea73318e898ce2a43dfa6c3a326d.