论文部分内容阅读
智能车辆(Intelligent Vehicle,IV)是智能交通系统的重要组成部分。为了能够彻底将人类从繁重的驾驶过程中解放出来,有效避免交通事故的发生,智能车辆需要完全实现无人驾驶。同时定位与建图(simultaneous localization and mapping,SLAM)技术作为智能车辆实现自主导航的关键技术,能够为车辆在定位系统失效的未知环境中实现无人驾驶提供必要的条件。为此,论文分别从基于概率的SLAM方法、SLAM中的数据关联方法和基于扫描匹配的地图构建与定位方法三个方面出发,对智能车同时定位与建图的关键技术进行了深入的研究,主要内容如下:(1)针对智能车辆SLAM系统,定义了其研究中所需要的坐标系,建立了车辆运动学模型、传感器观测模型、环境地图模型以及数据关联模型,并基于上述模型给出了智能车SLAM问题的概率模型,为智能车同时定位与建图关键技术的研究搭建了统一平台。(2)针对几何特征地图中自然实体路标的提取问题,研究了一种基于激光雷达数据的圆型特征提取方法。该方法可根据雷达数据点的距离信息和角度信息提取环境中实体路标的中心和直径。通过Victoria Park数据集验证了圆型特征提取方法的有效性,从而为后续SLAM算法中的几何地图构建提供特征提取方法。针对基于扩展卡尔曼滤波的SLAM(EKF-SLAM)算法易受非线性模型的不确定性和误差统计的不确定性影响,基于强跟踪滤波思想,提出了一种自适应渐消EKF-SLAM算法。该算法为后续章节核心算法的研究奠定了理论基础。(3)为了解决基于粒子滤波器的快速同时定位与建图算法(Fast simultaneous localization and mapping,FastSLAM)一致性差、估计精度随粒子的退化和贫化逐渐降低的问题,提出了一种基于改进粒子建议分布函数和部分重采样策略的FastSLAM算法。在该算法中,设计了强跟踪平方根中心差分卡尔曼滤波(strong tracking square root central difference Kalman filter,STSRCDKF);在车辆位姿估计阶段利用STSRCDKF获取可自适应调节的建议分布函数,使其更贴近粒子后验概率分布,进而提高粒子采样精度;在地图估计阶段,采用STSRCDKF实现对环境路标位置的估计,提高建图精度;在重采样阶段,采用部分重采样策略降低粒子集的退化和贫化现象,提高算法的一致性。实验结果证明了提出算法在鲁棒性、一致性和估计精度方面的优势。(4)在SLAM中,数据关联作为状态估计的前提和基础,是保证定位与建图过程收敛的核心和关键。针对目前SLAM中所应用的数据关联算法无法同时保证计算复杂度低和关联正确率高的问题,提出了两种不同的联合数据关联算法。首先,在联合兼容分枝定界(Joint Compatibility Branch and Bound,JCBB)算法的基础上,提出了一种基于聚类分组策略和中心差分联合兼容准则的数据关联算法,该算法有效解决了JCBB算法易受线性化误差影响和复杂度高的问题,能够在获得准确关联结果的同时,降低SLAM算法的复杂度。其次,根据联合最大似然准则将SLAM数据关联问题转化为一种组合优化问题,采用一种基于跳跃行为和自适应步长改进的人工鱼群算法搜索最优数据关联解。实验结果表明提出的两种关联算法能够为提高智能车SLAM的实时性和准确性提供可靠的保障。(5)为了实现车辆准确自定位且构建描述环境细节的稠密特征地图,提出了一种基于扫描匹配和粒子滤波器的点云地图创建与定位方法。采用强跟踪平方根中心差分粒子滤波融合基于迭代最近点(Iterative Closest Points,ICP)匹配的定位结果和基于里程计的定位结果,有效避免了扫描匹配定位过程中的累积误差对车辆位姿估计和地图更新的影响。在点云地图构建阶段,通过寻找当前扫描数据点与参考数据点之间的对应关系,将存在对应关系的点根据各自的权重值进行融合;最后基于车辆的全局位姿完成点云地图的拼接。实验结果表明提出的方法不仅能够实现车辆的准确定位,而且构建的点云地图可以为智能车自主驾驶提供细致的环境信息。