A dynamic filtering obstacle detection method based on ultrasonic array

In research on the navigation and control of an Autonomous Land Vehicle (ALV), the ultrasonic obstacle detection system plays an important role extending the environment cognition capability of the ALV. With a goal of improving the accuracy of ultrasonic obstacle detection, a dynamic data filtering method based on ultrasonic array is presented. The sonar return data is first processed through static filtering according to the geometric relationship of the ultrasonic array. Then, dynamic filtering is executed using the orientation and trajectory information of the vehicle. The dynamic filtering method is compared to the traditional ultrasonic obstacle detection method, which is the static filtering method in a typical field environment. The experiment result demonstrates the validity of the method for solving the fake data problem, and the accuracy of obstacle detection is improved.