一种自适应惯导和视觉组合导航方法

摘要

本发明公开了一种自适应惯导和视觉组合导航方法在现有惯导和视觉组合导航方法的基础上，设计一种自适应无迹卡尔曼滤波对惯导和视觉进行组合；该方法考虑了车辆行驶时路面颠簸导致相机振动引起的噪声，设计了反映相机振动噪声水平的自适应因子，并根据不同的噪声水平自适应的调整组合导航算法中的卡尔曼滤波增益和误差协方差矩阵，确保组合导航系统定位结果的可靠性，是一种鲁棒的定位方法；由于本发明的方法无需事先对振动噪声引起的误差建模补偿或者轨迹闭环校正，因此对环境的适应性较强；本发明在惯导15维误差量的基础上，设计了添加相机位姿的滤波器状态量，实现了惯导和视觉的紧组合，是一种精度较高的定位方法。