金器更加适应当前的物理系统。进一步地,可以根据每个滤波器的输出获得系统当前最好的状态估计。这就是多模型滤波算法的基本思想或出发点,其工作原理如图1所示。6/28系统状态方程X.p滤波器1量测方程加权平均滤波器n模型概率计算Figurel:多模型滤波原理示意图多模型方法已经获得了非常广泛的应用,包括(1)目标跟踪[1, 2];(2)组合导航;BackClose
6/28 JJ II J I Back Close 器更加适应当前的物理系统。进一步地,可以根据每个滤波器的输出 获得系统当前最好的状态估计。这就是多模型滤波算法的基本思想或 出发点,其工作原理如图1所示。 Figure 1: 多模型滤波原理示意图 多模型方法已经获得了非常广泛的应用,包括 (1) 目标跟踪 [1, 2]; (2) 组合导航;
(3)故障诊断与识别;(4)飞行器制导与控制[3];(5)过程控制等等。7/28BackClose
7/28 JJ II J I Back Close (3) 故障诊断与识别; (4) 飞行器制导与控制 [3]; (5) 过程控制等等
多模型组合滤波公式8/28假设共有r个滤波器(mi}-1,记k时刻第i个滤波器的输出为ak.m,和Pk.m,那么系统当前时刻的组合估计为(1)th=Zpk(ma)ik,mi-1对应的估计误差协方差为Ph = E(- k)(k - k)Tpk(mi)[Pk,m: + (k - k,m)(*)](2)i=1BackClose
8/28 JJ II J I Back Close 多模型组合滤波公式 假设共有 r 个滤波器 {mi} r i=1,记 k 时刻第 i 个滤波器的输出为 xˆk,mi 和 Pk,mi,那么系统当前时刻的组合估计为 xˆk = ∑ r i=1 pk(mi)ˆxk,mi (1) 对应的估计误差协方差为 Pk = E(ˆxk − xk)(ˆxk − xk) T = ∑ r i=1 pk(mi)[Pk,mi + (ˆxk − xˆk,mi )(∗) T ] (2)
以上两式中,Pk(mi)表示k时刻模型(滤波器)mi的概率,即金(3)pk(mi) = Pr(m = mily1, y2, .., yk)9/28BackClose
9/28 JJ II J I Back Close 以上两式中,pk(mi) 表示 k 时刻模型(滤波器)mi 的概率,即 pk(mi) = Pr(m = mi |y1, y2, · · · , yk) (3)
金静态多模型滤波10/28假设对象的真实模型是r个模型【mi}-中的一个,不随时间变化,但事先并不知道具体是哪个。由此建立的多模型方法称为静态多模型滤波方法,这里的“静态”是指对象真实的模型是固定的,当然对象的状态仍然随时间变化,是动态的。模型概率递推计算公式设k时刻的量测为y,那么模型㎡i的似然函数为1e-[y-Hk,m,,m,]Cx,m,[](4)A(yk|mi) :=/2元|Ck,miBackClose
10/28 JJ II J I Back Close 静态多模型滤波 假设对象的真实模型是 r 个模型 {mi} r i=1 中的一个,不随时间变 化,但事先并不知道具体是哪个。由此建立的多模型方法称为静态多 模型滤波方法,这里的“静态”是指对象真实的模型是固定的,当然 对象的状态仍然随时间变化,是动态的。 模型概率递推计算公式 设 k 时刻的量测为 yk,那么模型 mi 的似然函数为 Λ(yk|mi) = 1 √ 2π|Ck,mi | e − 1 2 [yk−Hk,mi xˆ − k,mi ]C −1 k,mi [∗] T (4)