一种有界半正定自适应过程噪声协方差更新方法
本发明涉及自适应卡尔曼滤波与隐参数辨识,特别涉及一种有界半正定保持自适应过程噪声协方差更新方法。
背景技术:
0、技术背景
1、扩展卡尔曼滤波通过状态预测、量测更新和协方差递推实现非线性系统状态及隐参数估计。过程噪声协方差用于表征状态模型预测的不确定性,量测噪声协方差用于表征量测数据的不确定性,二者共同影响卡尔曼增益、后验协方差及状态估计结果。
2、sage-husa自适应滤波方法能够基于滤波创新信息估计噪声统计特性。在隐参数辨识的滤波场景中,过程噪声协方差需要参与扩展卡尔曼滤波递推,其物理属性要求为半正定矩阵。为保持过程噪声协方差的半正定性,采用基于创新序列协方差、卡尔曼增益和后验协方差的简化过程噪声协方差更新方式。
3、直接采用经典sage-husa公式时,估计得到的过程噪声协方差会逐渐失去半正定性,导致协方差演化在数值上失效,进而影响滤波递推。采用半正定保持简化更新方式能够在短时域退化监测中维持数值有效的扩展卡尔曼滤波递推,但该简化更新引入的正向偏差会随迭代积累。当监测间隔细化且序列长度增长时,过程噪声协方差的迹持续增大,降低长时域隐参数跟踪质量。
技术实现思路
1、本发明提供一种有界半正定保持自适应过程噪声协方差更新方法,通过对无界半正定保持过程噪声协方差更新结果进行通道级方差上界约束和相关结构保持重构,解决长时域过程中过程噪声协方差持续膨胀的问题。
2、所述方法首先利用创新序列的滑动窗口计算创新序列协方差,并根据卡尔曼增益、创新序列协方差和后验协方差计算过程噪声协方差增量。随后,利用遗忘系数将过程噪声协方差增量与前一时刻过程噪声协方差进行加权,得到无界过程噪声协方差。
3、对于第个状态通道,采用稳态标量近似关系作为过程噪声协方差上界设计的量级参考,其中,为后验方差,为卡尔曼增益,为量测噪声方差。设置设计参数作为第个状态通道的稳态标量卡尔曼增益上限,并由卡尔曼增益上限得到过程噪声方差与量测噪声方差的比值上限。
4、针对维纳型退化增量的离散时间协方差随离散时间步长线性缩放的特性,利用离散时间步长、参考时间步长、设计参数和量测噪声方差,确定过程噪声方差上界。
5、进一步地,从无界过程噪声协方差中提取相关结构矩阵,并将其对角矩阵的各对角元裁剪至对应的过程噪声方差上界。利用裁剪后的对角矩阵和相关结构矩阵重构过程噪声协方差,从而在限制过程噪声协方差幅值的同时保留状态通道之间的相关结构。
6、在约八百个循环周期的长轨迹试验中,采用且各状态通道时,有界半正定保持更新抑制了过程噪声协方差的长期增长并维持半正定性。相对于无界半正定保持更新,三个隐参数、和的均方根误差分别由、和降至、和。在为至的范围内,跟踪结果对的取值不敏感。
1.一种有界半正定保持自适应过程噪声协方差更新方法,其特征在于,包括:获取第时刻的创新序列、卡尔曼增益、后验协方差、量测噪声协方差、前一时刻过程噪声协方差、遗忘系数和离散时间步长;根据所述创新序列、所述卡尔曼增益和所述后验协方差计算过程噪声协方差增量,并根据所述过程噪声协方差增量、所述前一时刻过程噪声协方差和所述遗忘系数得到无界过程噪声协方差;针对各状态通道设置处于开区间的设计参数作为稳态标量卡尔曼增益上限,并根据所述设计参数、所述量测噪声协方差、所述离散时间步长和参考时间步长确定各状态通道的过程噪声方差上界;提取所述无界过程噪声协方差的相关结构,将所述无界过程噪声协方差的对角元裁剪至对应的过程噪声方差上界,并利用裁剪后的对角矩阵和所述相关结构重构第时刻过程噪声协方差。
2.根据权利要求1所述的有界半正定保持自适应过程噪声协方差更新方法,其特征在于,所述根据所述创新序列、所述卡尔曼增益和所述后验协方差计算过程噪声协方差增量,包括:采用长度为的滑动窗口计算创新序列协方差;按照计算所述过程噪声协方差增量。
3.根据权利要求2所述的有界半正定保持自适应过程噪声协方差更新方法,其特征在于,所述无界过程噪声协方差按照计算,其中,为所述无界过程噪声协方差,为所述遗忘系数,为所述前一时刻过程噪声协方差。
4.根据权利要求1所述的有界半正定保持自适应过程噪声协方差更新方法,其特征在于,针对第个状态通道,采用稳态标量近似关系,并按照设置所述稳态标量卡尔曼增益上限,其中,为后验方差,为卡尔曼增益,为量测噪声方差,为第个状态通道的设计参数。
5.根据权利要求4所述的有界半正定保持自适应过程噪声协方差更新方法,其特征在于,第个状态通道的过程噪声方差上界按照确定,其中,为所述过程噪声方差上界,为所述离散时间步长,为所述参考时间步长。
6.根据权利要求1所述的有界半正定保持自适应过程噪声协方差更新方法,其特征在于,所述提取所述无界过程噪声协方差的相关结构,包括:构建对角矩阵;按照计算相关结构矩阵;将的各对角元裁剪至开区间以得到裁剪后的对角矩阵;按照重构第时刻过程噪声协方差。
7.根据权利要求6所述的有界半正定保持自适应过程噪声协方差更新方法,其特征在于,在计算所述相关结构矩阵时,对所述对角矩阵中的正对角元采用正保护常数进行保护,以避免数值奇异性。
版权声明:本站专利文献数据主要来源于国家知识产权局等公开渠道,由 技术新讯 进行整理汇编。页面设计及数据汇编的著作权归本站所有。全部内容仅供个人学习、科研评估与技术交流参考,严禁用于任何商业用途(包括但不限于直接生产制造、技术转让、倒卖数据等)。
免责条款:专利技术具有时效性,本站不对资料的绝对准确性、完整性和可实施性提供任何明示或暗示的担保。因参考本站内容造成的直接或间接损失,本站不承担相关法律责任。若您认为本站内容有侵权问题,请及时提供权属证明与我们联系,本站将在核实后依法处理。反馈意见:yyfuon@163.com