一种基于激光传感器的快速运动障碍物实时跟踪方法与流程

技术特征：

1.一种基于激光传感器的快速运动障碍物实时跟踪方法，其特征在于，包括如下步骤：

(1)将激光雷达安装在车身上，以激光雷达的中心建立坐标系，并对坐标系进行内参标定和外参标定；

(2)通过激光雷达扫描自车周围，利用空间数据聚类算法组成障碍物；

(3)对步骤(2)所述的障碍物进行状态分类，包括初观测组和非初观测组；

(4)初次观测组的障碍物设置初始状态规则；

(5)对非初次观测组和已设置初始状态的初次观测组的障碍物均进行动态跟踪；

(6)生成障碍物信息列表。

2.根据权利要求1所述的一种基于激光传感器的快速运动障碍物实时跟踪方法，其特征在于：步骤(1)所述的内参标定包括旋转校正角度、垂直校正角度、距离校正角度、垂直便宜因子以及水平便宜因子；外参标定包括：激光雷达坐标系相对于自车坐标系的旋转矩阵R和平移矩阵T。

3.根据权利要求1所述的一种基于激光传感器的快速运动障碍物实时跟踪方法，其特征在于：步骤(1)所述的激光雷达为单线激光雷达或多线激光雷达或全向激光雷达；所述的单线激光雷达安装在车身四周，多线激光雷达安装在车身两侧，所述的全向激光雷达安装在车身顶部。

4.根据权利要求1所述的一种基于激光传感器的快速运动障碍物实时跟踪方法，其特征在于：步骤(2)所述的空间数据聚类算法为K-means算法，包括通过激光点云聚类，组成符合障碍物规则的高斯分布，判断为障碍物。

5.根据权利要求1所述的一种基于激光传感器的快速运动障碍物实时跟踪方法，其特征在于：步骤(4)所述的初始状态规则包括结构化道路障碍物、非结构化道路两侧障碍物和非结构化道路中间障碍物。

6.根据权利要求1所述的一种基于激光传感器的快速运动障碍物实时跟踪方法，其特征在于：所述的车身上还安装有摄像头、惯导设备和GPS接收器。

7.根据权利要求1所述的一种基于激光传感器的快速运动障碍物实时跟踪方法，其特征在于：步骤(5)所述的动态跟踪，包括将摄像头所采集的周围环境信息和激光雷达所采集的障碍物信息通过PF粒子滤波模型进行融合关联，使用KF扩展卡尔曼滤波模型生成跟踪信息。