本发明属于传感器数据融合,尤其涉及一种新的用于在非线性非高斯环境下多传感器融合的方法。
1、近年来,随着现代化的发展,单个传感器已然不能够满足高标准下的准确定位,多传感器数据融合方法成为目标定位的研究热点。多个同类传感器来采集更多的数据,而如何有效地利用这些冗余数据是目前需要解决的难题,尤其是在考虑非线性非高斯的复杂情况下,多传感器融合算法还存在很大的困难和挑战。冗余数据需要进行滤波再融合,而考虑非高斯噪声的情况下,滤波算法的实时性受到了挑战,因此研究一种实时性较高的非线性非高斯滤波方法是提高融合方法的重要基础保障。
2、在复杂环境下多传感器融合领域,对非线性非高斯模型的融合方法已经引起了大量研究人员的关注,并得到了广泛的应用。多传感器融合方法根据对多传感器观测信息的处理方法不同,可以将信息融合系统的体系结构分成分为集中式融合、分布式融合和混合式融合。刘华等人在非线性的多传感器融合方法上,提出了基于平方根容积滤波的多传感器非线性序贯式融合算法(刘华,吴文,王世元.基于平方根ckf的多传感器序贯式融合跟踪算法[j].系统工程与电子术,2015,37(7):1494-1498),但缺乏考虑复杂环境下非高斯噪声的对系统的影响。吴骁航等人将student’s t分布作为系统的噪声,通过无迹四元数局部滤波算法来对非高斯噪声鲁棒,同时设计最优权重计算方法及线型加权信息融合算法(吴骁航,马克茂.students’st滤波框架下的信息融合算法[j].浙江大学学报:工学版,2020,54(3):581-588),但是此方法没有对含有噪声数据进行处理,很难得到消除脉冲噪声影响的估计值,并且整体计算量增大,系统的实时性不高。
1、针对现有技术的不足,本发明提供了一种新的用于在非线性非高斯环境下多传感器融合的方法,解决了上述问题。
2、为实现以上目的,本发明通过以下技术方案予以实现:一种新的用于在非线性非高斯环境下多传感器融合的方法,包括以下步骤:
3、s1、基于梯度下降技术的高斯近似非高斯算法,在已知非高斯噪声分布的情况下使用高斯分布拟合非高斯分布;
4、s2、将近似的高斯分布用到容积粒子滤波中,再加入最大熵准则来抑制噪声;
5、s3、基于s2引入序贯式融合算法,得到一种针对非高斯噪声的多传感器融合方法。
8、若已知非高斯噪声yi,假设高斯分布的噪声初始化μ,σ后,使用梯度下降算法作为优化算法来最小化伪huber损失函数,得到一个概率密度函数近似非高斯分布的高斯分布,使用此高斯分布近似作为滤波算法中的非高斯噪声分布;
9、其中,伪huber损失函数是huber损失的改进,他对异常值鲁棒,也存在解析解,主要用于控制函数从二次到线性切换的位置,此外该参数还用于剪裁梯度值,从而可以限制异常值的影响,公式如下:
11、其中,δ为可调的阈值参数,为误差,对于较小的值,该损失函数近似值为而对于较大的值,该损失函数可近似为一条斜率为δ的直线,因此,其对异常值不敏感,具有很好的鲁棒性,当函数收敛后则意味着高斯噪声已经逼近非高斯噪声yi了,此时优化得到的即为高斯噪声的期望和标准差。
12、使用梯度下降算法作为优化算法来最小化伪huber损失函数,公式如下:
14、其中,parm为需要训练的参数,f()是包含参数的损失函数,具体分别是[μ,σ]和伪huber损失函数,当函数收敛后则意味着高斯噪声的概率密度已经逼近非高斯噪声的概率密度,此时优化得到的和即为高斯噪声的期望和标准差,利用此高斯分布特性来近似作为滤波中的过程噪声方差q和量测噪声方差r。
16、利用最大相关熵准则对噪声进行预处理,通过调节卡尔曼滤波增益改变先验信息权重,得到消除脉冲噪声影响的估计值,即首先利用容积变换获得伪量测矩阵,并根据统计误差线性传递模型对量测方程进行近似处理,然后基于最大相关熵准则构造代价函数,并通过固定点迭代更新目标估计状态,获得状态估计性能;
17、已知k-1时刻的状态估计值及估计协方差高斯核带宽σ,收敛门限ε,采样m个粒子,具体流程如下:
45、由于所以残差向量各分量不相关。根据最大相关熵准则,可构造代价函数:
47、其中,gσ(·)为高斯核函数,σ为带宽,表示向量的维度。表示向量的第l个元素,表示的第l行。故可知,在最大相关熵准则下,的最优估计可以转化为求解以下优化问题:
74、如果系统状态发生异常时,需要通过调节状态噪声协方差来控制动态模型噪声异常对状态参数估值的影响。基于自适应滤波思想,利用自适应因子实时调整状态参数协方差,从而控制动态模型异常对参数的影响。自适应因子公式如下:
76、其中,c0∈(1.0~1.5),c1∈(3.0~8.0),它是决定自适应因子的取值,能够反映出系统实际观测值与状态预估值之间的偏差。
90、预测:利用ckf算法构造重要性密度函数,假设k-1时刻的状态后验概率密度函数服从高斯分布且可表示为采样m个粒子,则第i个粒子的后验密度可表示为通过ckf算法的时间更新完成对状态和协方差的预测,得到k时刻的预测状态和预测协方差:
必一运动
93、更新:通过基于最大熵准的容积卡尔曼滤波的测量更新得到k时刻的状态和协方差的估计,同时在多传感器的情况下通过序贯式融合得到最终的状态估计(传感器个数为n,下标n代表传感器序号)
120、本发明提供了一种新的用于在非线性非高斯环境下多传感器融合的方法,与现有技术相比具备以下有益效果:
121、1、提出了一种高斯近似非高斯的方法,用近似的高斯分布作为系统的噪声分布,同时在容积粒子滤波中加入了最大熵准则,使得系统对非高斯噪声具有鲁棒性,最后将整个滤波算法加入序贯式融合中心,能够提高整个融合算法的实时性,而本发明将非高斯噪声考虑到了系统中,为准确的滤波加入了最大熵准则,使得系统能够对非高斯噪声鲁棒,同时为了减小计算量,使用高斯近似非高斯的方法,提高了系统的实时性。
必一运动