论文部分内容阅读
同时定位与构图(SLAM)是指在没有任何先验信息的前提下,移动平台利用自身传感器观测信息实现定位的同时完成环境地图的构建,被认为是实现真正完全自主导航的重要手段,已成为智能机器人和无人机等领域的研究热点之一。由于没有外界辅助信息,相对于经典导航系统,SLAM在理论与工程实现中面临更多问题和挑战。SLAM的概率形式从理论上揭示了其技术内涵和实现方式,并导出了SLAM两种不同的求解形式:滤波和优化。虽然多种方法相继被应用于SLAM问题的求解,然而计算复杂性、估计不一致性、鲁棒性和非欧几里德参数化仍是SLAM应用中较为突出的问题,对其实时性、可靠性和准确性有着直接影响。本文针对上述问题对SLAM相关关键技术展开深入研究。建立了SLAM问题求解的滤波模型和图论优化模型。根据马尔科夫假设,推导了SLAM问题的贝叶斯滤波形式。将一般性SLAM问题分解为非线性的运动更新和测量更新,建立了SLAM问题求解的扩展卡尔曼滤波(EKF)模型。针对不同应用环境,分别建立地面车辆和无人机应用系统模型,仿真验证SLAM在2D和3D环境中可行性。利用图论描述SLAM问题,将状态估计转化为图结构优化,建立了图论SLAM问题数学模型。基于Gauss-Newton方法,给出问题求解具体形式。研究了面向SLAM的压缩无迹卡尔曼滤波(UKF)方法。基于全采样和部分采样UKF一致性的证明,建立了基于部分采样的UKF-SLAM问题求解模型,并推导了UKF的等效雅克比矩阵计算形式。结合压缩滤波思想,提出了基于压缩UKF的SLAM问题求解方法,进一步提高了UKF在SLAM问题求解中的计算效率。通过仿真实验和地面跑车实验数据处理分析,结果证明了非线性滤波方法UKF在SLAM问题中实时应用的可行性。研究了鲁棒线性SLAM优化方法。阐述了基于广义最小二乘法的L-SLAM一般性数学描述形式,利用逆函数理论避免非线性坐标变换中雅克比矩阵求逆问题。提出了延迟最优化策略,解决子图联合过程中信息不足时野值探测问题。引入期望最大值方法实现野值探测。分析了野值延迟剔除对子图联合结果间的影响,进而提出Schur补方法实现野值信息的完全剔除。仿真结果证明了鲁棒线性SLAM优化方法对不同类型野值的鲁棒性,利用包含野值的真实实验数据验证算法实际环境适用性。研究了基于单位对偶四元数的图论SLAM优化方法。依据对偶四元数乘法特性,建立了基于单位对偶四元数的测量误差函数模型,实现测量误差函数对相关节点的双线性形式和雅克比矩阵计算的简化;推导了基于单位对偶四元数的误差函数Gauss-Newton求解模型;探索了在不同噪声水平下,基于四元数和轴-角的扰动过参数化方法对优化结果影响;实验结果验证了算法计算效率,并表明大噪声情况下轴-角过参数化方法具有更好的数值稳定性。