基于地标点匹配的高精度室内定位算法

针对基于惯导的行人室内定位算法定位误差大的问题,提出了一种基于地标点匹配的行人高精度三维室内定位算法。该算法仅使用惯性测量单元(IMU)这一单一传感器,包含速度约束、航向角约束、水平位置约束和高度约束四个模块。水平位置约束模块可根据航向角变化实时检测并建立地标点,并设计了一种地标点匹配度函数,提高了地标匹配的准确度。多楼层行走实验表明所提算法能够提升行人室内定位精度,其终点误差为0.3421 m,相较于ZUPT算法和ZUPT+HDE算法分别减小了82.6%和68.3%,具有一定的工程应用价值.

基于EM算法的组合导航系统容错方法

针对SINS/GPS组合导航系统中,GPS提供的量测信号存在容易受到干扰而导致滤波精度下降的问题,提出一种基于EM算法的组合导航系统容错方法。该方法对各个分量的量测噪声建立二维高斯混合模型,并引入一个指示变量表示量测值从异常分布中采样的概率。根据系统状态方程、上一时刻状态估计值以及当前时刻测量值,利用EM算法求解当前时刻量测真值的极大似然估计,并结合序贯滤波算法对每一个分量的量测值进行精细检测与修正。车载实验表明,该方法能够有效提高SINS/GPS组合导航系统在GPS信号异常情况下的融合精度与可靠性。