Dynamic obstacle tracking method based on sparse laser radar data

Abstract

The invention discloses a dynamic obstacle tracking method and system based on sparse laser radar data, and belongs to the technical field of dynamic obstacle tracking, and the method comprises the following steps: S1, eliminating a static background; S2, performing dynamic point cloud clustering; S3, performing convex hull extraction; S4, performing feature extraction; S5, performing data association; S6: predicting a trajectory. According to the method, static obstacle laser radar point clouds are filtered by using a grid map, and extremely sparse point clouds are filtered by a small amountof residual static point clouds through a dbscan algorithm, so the final filtering effect is enhanced; point clouds are classified into ellipses, rectangles and straight lines in a fuzzy mode by extracting angle information of point cloud convex hulls, then correct point cloud position points are obtained by assisting the point clouds in fitting the sizes of graphs, and the accuracy of data association is guaranteed. In addition, the characteristics of the nearest neighborhood and the multi-target hypothesis algorithm are integrated, the multi-target association algorithm is improved, and dataassociation work can be efficiently completed on the premise of ensuring accuracy.

Description

technical field [0001] The invention relates to the technical field of dynamic obstacle tracking, in particular to a dynamic obstacle tracking method and system based on sparse laser radar data. Background technique [0002] Object detection and tracking technologies based on visual sensors are relatively mature, but visual sensors usually cannot provide distance information and must be used under good lighting conditions, which limits their use in robot navigation. Lidar is not affected by light and can provide distance data, which can complete tasks such as robot navigation and tracking. In recent years, using lidar to detect dynamic obstacles and predict their trajectory is a key topic in the field of mobile robotics. [0003] With the development of unmanned driving technology, there are already a large number of dynamic obstacle detection and tracking methods. For vehicle detection and tracking, Konrad M et al. use raster maps to detect and track vehicles. Chen Tongt...

AI Technical Summary

Problems solved by technology

However, the two-dimensional laser radar collects a point cloud on a horizontal plane, and the amount of data is small, which leads to sparse point cloud, and the accuracy of the processing results obtained by using these sparse data will become worse. Therefore, a sparse laser radar based Data dynamic obstacle tracking method and system

Images