基于一步状态估计和协方差估计的距离野值剔除方法

摘要

本发明提供的是一种基于一步状态估计和协方差估计的距离野值剔除方法。步骤一、得到当前时刻的状态估计和协方差估计；步骤二、获得估计量和估计方差；步骤三、计算得到与各声信标距离信息的估计值；步骤四、由估计方差得到估计区间；步骤五、判断距离信息量测值是否落在估计区间内，若在则继续更新计算，若不在则视为野值剔除。通过本发明提出的方法，实现了距离量测数据的预处理，减小由野值引起的误差和滤波发散。有利于接下来的滤波处理。