实现声呐传感器的各种测试，包括测高，自校准等一些列功能-Sonar sensors to achieve a variety of tests, including altimeter, self-calibration function for some columns