El proceso de derivación detallado del filtro Kalman-Bucy generalizado (general) (exclusivo para toda la red)


Este artículo tiene un total de 16.000 palabras y todo el texto y las fórmulas de rebajas están codificados manualmente. Compartir y codificar palabras no es fácil, espero recibir un Me gusta y seguir tu colección. ¡Tu apoyo es la mayor motivación para actualizar!

1. Filtro Kalman-Bucy y antecedentes del sistema

El filtro de Kalman-Bucy es esencialmente un filtro para sistemas lineales, que puede filtrar la señal intrínseca del sistema cuando hay ruido blanco gaussiano en el sistema, para obtener una señal de medición relativamente pura que esté relativamente cerca de la señal intrínseca.

Sea la señal de salida del filtro (es decir, la señal de medición ) Y ( t ) \mathbf{Y}(t)Y ( t ) ,la señal de entrada(es decir,la señal intrínseca, o laseñal útil) esX ( t ) \mathbf{X}(t)X ( t ) . La función del filtro es convertir la cantidad de estado X ( t ) \mathbf{X}(t)en el sistemaX ( t ) bajo la influencia del ruido, con la ayuda del valor medidoY ( t ) \mathbf{Y}(t)Y ( t ) estima correctamente la señal intrínseca (útil) en el sistema.

La señal útil en el sistema se puede expresar como
X ˙ ( t ) = A ( t ) X ( t ) + G ( t ) N 1 ( t ) , A ∈ R n × n , G ∈ R n × p (1 ) \ mathbf{\dot X} (t) = \mathbf{A}(t) \mathbf{X}(t) + \mathbf{G}(t)\mathbf{N}_1(t), \quad \ mathbf{ A} \in \mathbb{R}^{ n \times n}, \mathbf{G} \in \mathbb{R}^{n \times p} \tag{1}X˙ (t)=A ( t ) X ( t )+G ( t ) norte1( t ) ,ARnorte × norte ,GRAMORnorte × p( 1 ) Entre ellas, la condición inicial esX ( t 0 ) = X 0 \mathbf{X}(t_0) = \mathbf{X}^0X ( t0)=X0norte 1 ( t ) \mathbf{N}_1(t)norte1( t ) esruido blanco gaussiano, que es el ruido del sistema durante el funcionamiento, y tiene el siguiente valor esperado y varianza:
M { N 1 ( t ) } = 0; RN 1 N 1 ( t , τ ) = M { N 1 ( t ) N 1 T ( t ) } = S 1 ( t ) δ ( t − τ ) M\left\{ \mathbf{N}_1(t) \right\} = 0; \quad \mathbf{ R}_ {\mathbf{N}_1 \mathbf{N}_1} (t, \tau) = M\left\{ \mathbf{N}_1(t) \mathbf{N}_1^{\rm T} (t) \right\} = \mathbf{S}_1 (t) \delta (t - \tau)METRO{ norte1(t)}=0;RN1N1(t,τ)=M{ N1(t)N1T(t)}=S1(t)δ(tτ)其中 S 1 ( t ) \mathbf{S}_1(t) S1(t)为表征噪声信号强度的对称正定矩阵,这意味着 S 1 T ( t ) = S 1 ( t ) \mathbf{S}_1^{\rm T}(t) = \mathbf{S}_1(t) S1T(t)=S1(t)

另外,假设有用信号初值的期望已知:
X ˉ 0 = M { X 0 } = 0 \bar{ \mathbf{X} }^0 = M\left\{ \mathbf{X}^0 \right\} = 0 Xˉ0=M{ X0}=0 restricciones:
D 00 = M { ( X 0 − X ˉ 0 ) ( X 0 − X ˉ 0 ) T } = 0 \mathbf{D}_{00} = M\left\{ \left( \mathbf {X }^0 - \bar{\mathbf{X}}^0 \right) \left( \mathbf{X}^0 - \bar{\mathbf{X}}^0 \right)^{\rm T } \ derecha\} =D00=METRO{ ( X0Xˉ0 )( X0Xˉ0 )t }=0

Luego configure la señal de salida del sistema Y ( t ) \mathbf{Y}(t)Sea Y ( t ) lo mismo que
Y ( t ) = C ( t ) X ( t ) + N 2 ( t ), C ∈ R l × n (2) \mathbf{Y}(t) = \mathbf{ C} (t) \mathbf{X}(t) + \mathbf{N}_2(t), \quad \mathbf{C} \in \mathbb{R}^{ l \times n} \tag{2}Y ( t )=C ( t ) X ( t )+norte2( t ) ,CRl × n( 2 ) dondeN 2 ( t ) \mathbf{N}_2(t)norte2( t ) también esruido blanco gaussiano, que es el ruido de medición durante la medición:
M { N 2 ( t ) } = 0; RN 2 N 2 ( t , τ ) = M { N 2 ( t ) N 2 T ( t ) } = S 2 ( t ) δ ( t − τ ) M\left\{ \mathbf{N}_2(t) \right\} = 0; \quad \mathbf{R}_{\mathbf{N}_2 \ mathbf{N}_2} (t, \tau) = M\left\{ \mathbf{N}_2(t) \mathbf{N}_2^{\rm T}(t) \right\} = \mathbf { S}_2 (t) \delta (t - \tau)METRO{ norte2( t ) }=0 ;Rnorte2norte2( t ,t )=METRO{ norte2( t ) norte2T(t)}=S2(t)δ(tτ)设滤波器的滤波误差为
X σ ( t ) = X ( t ) − X ^ ( t ) \mathbf{X}_\sigma (t) = \mathbf{X}(t) - \hat{\mathbf{X} } (t) Xσ(t)=X(t)X^(t)滤波器的设计应当满足如下条件,使得滤波器得到的状态估计量为无偏的,且估计误差的均方差 M { ∥ X σ ( t ) ∥ 2 } M\left\{ \Vert \mathbf{X}_\sigma (t) \Vert ^2 \right\} M{ Xσ(t)2}最小

2. 系统中相关关系整理

(1) 假设有用信号初值 X 0 \mathbf{X}^0 X0 y ruido del sistemaN 1 ( t ) \mathbf{N}_1(t)norte1( t ) , ruido de mediciónN 2 ( t ) \mathbf{N}_2(t)norte2( t ) Especifique:
M { X 0 N 1 } = 0 , M { X 0 N 2 } = 0 M\left\{ \mathbf{X}^0 \mathbf{N}_1 \right\} = , \quad M\left\{ \mathbf{X}^0 \mathbf{N}_2 \right\} =METRO{ X0 norte1}=0 ,METRO{ X0 norte2}=0 (2) y supongamos el ruido del sistemaN 1 ( t ) \mathbf{N}_1(t)norte1( t ) y ruido de mediciónN 2 ( t ) \mathbf{N}_2(t)norte2(t)之间具有如下相关关系(注意!通常认为二者不具有相关关系,但此处二者是具有相关关系的!
M { N 1 ( t ) N 2 T ( τ ) } = S 3 ( t ) δ ( t − τ ) M\left\{ \mathbf{N}_1(t) \mathbf{N}_2^{\rm T}(\tau) \right\} = \mathbf{S}_3 (t) \delta (t - \tau) M{ N1(t)N2T(τ)}=S3(t)δ(tτ)其中 S 3 ( t ) \mathbf{S}_3 (t) S3(t)为对称正定矩阵,因此 S 3 T ( t ) = S 3 ( t ) \mathbf{S}_3^{\rm T}(t) = \mathbf{S}_3(t) S3T(t)=S3(t)

(3) La ecuación (1) da la expresión de la ecuación diferencial del sistema. Por supuesto, con la ayuda de la idea de matriz de transición de estado, el estado del sistema X ( t ) \mathbf{X}(t) se puede obtener integrando ambos lados de la ecuación (1 )X ( t ) en cualquier momento∀ t ≥ t 0 \forall t \geq t_0∀t _t0valor:
X ( t ) = Φ ( t , t 0 ) X ( t 0 ) + ∫ t 0 t Φ ( t , s ) G ( s ) N 1 ( s ) ds \mathbf{X}(t) = \ mathbf{\Phi}(t, t_0) \mathbf{X}(t_0) + \int_{t_0}^t \mathbf{\Phi}(t, {\rm s}) \mathbf{G}({\ rm s}) \mathbf{N}_1({\rm s}) d{\rm s}X ( t )=Φ ( t ,t0) X ( t0)+t0tΦ ( t ,s )GRAMO( s ) norte1( s ) d s dondeΦ ( t , t 0 ) \mathbf{\Phi}(t, t_0)Φ ( t ,t0) es la matriz de transición de estado, y el valor de estado en cualquier momento se puede obtener usándolo junto con el valor inicial. Entonces, la cantidad de estadoX ( t ) \mathbf{X}(t)X ( t ) y ruido de mediciónN 2 ( t ) \mathbf{N}_2(t)norte2( t ) Correlación entre:
METRO { X ( t ) norte 2 T ( τ ) } = M { Φ ( t , t 0 ) X ( t 0 ) norte 2 T ( τ ) + ∫ t 0 t Φ ( t , s ) GRAMO ( s ) norte 1 ( s ) ds N 2 T ( τ ) } = Φ ( t , t 0 ) M { X ( t 0 ) N 2 T ( τ ) } + ∫ t 0 t Φ ( t , s ) G ( s ) M { norte 1 ( s ) norte 2 T ( τ ) } ds = 0 + ∫ t 0 t Φ ( t , s ) G ( s ) ⋅ S 3 ( t ) δ ( t − τ ) ds = Φ ( t , τ ) G ( τ ) S 3 ( τ ) , ( t 0 ≤ τ ≤ t ) \begin{aligned} M\left\{ \mathbf{X}(t) \mathbf{N}_2^{\rm T} ( \tau) \right\} &= M\left\{ \mathbf{\Phi}(t, t_0) \mathbf{X}(t_0) \mathbf{N}_2^{\rm T} (\tau) + \int_{t_0}^t \mathbf{\Phi}(t, {\rm s}) \mathbf{G}({\rm s}) \mathbf{N}_1({\rm s}) d{\ rm s} \mathbf{N}_2^{\rm T}(\tau) \right\} \\ &= \mathbf{\Phi}(t, t_0) M\left\{ \mathbf{X}(t_0 ) \mathbf{N}_2^{\rm T} (\tau) \right\} + \int_{t_0}^t \mathbf{\Phi}(t,{\rm s}) \mathbf{G}({\rm s}) M \left\{ \mathbf{N}_1({\rms}) \mathbf{N}_2^{\rm T}(\ tau ) \right\}d{\rms}\\&= 0 + \int_{t_0}^t\mathbf{\Phi}(t, {\rms})\mathbf{G}({\rms }) \cdot \mathbf{S}_3(t)\delta(t - \tau)d{\rms}\\ &= \mathbf{\Phi}(t,\tau)\mathbf{G}(\ tau) \mathbf{ S}_3(\tau), \quad\left( t_0 \leq \tau \leq t \right) \end{alineado}METRO{ X ( t ) norte2t( t ) }=METRO{ Φ ( t ,t0) X ( t0) norte2t( t )+t0tΦ ( t ,s )GRAMO( s ) norte1( s ) d s norte2t( t ) }=Φ ( t ,t0) M{ X ( t0) norte2t( t ) }+t0tΦ ( t ,s )G( s )M{ norte1( s ) norte2t( t ) }d s=0+t0tΦ ( t ,s )G( s )S3( t ) δ ( tt ) d s=Φ ( t ,τ ) GRAMO ( τ ) S3( t ) ,( t0tt )
La tarea del filtro se basa en el valor medido Y ( t ) \mathbf{Y}(t)Y ( t ) obtiene la cantidad de estadoX ( t ) \mathbf{X}(t)Estimación X ( t ) , y la estimación es insesgada y el error mínimo es el error cuadrático medio.

3. Derivación de fórmulas

(1) Condición de estimación insesgada

Sea el valor estimado del filtro lineal X ^ ( t ) \hat {\mathbf{X} }(t)X^ (t)con la definición de
X ^ ̇ ( t ) = F ( t ) X ^ ( t ) + K ϕ ( t ) Y ( t ) (3) \dot{ \hat{ \mathbf{X} } } ( t) = \mathbf{F}(t) \hat {\mathbf{X}}(t) + \mathbf{K}_\phi(t) \mathbf{Y}(t) \tag{3}X^˙ (t)=F ( t )X^ (t)+kϕ( t ) Y ( t )( 3 ) Para satisfacer la condición de estimación insesgada,
M { X ^ ( t ) } = M { X ( t ) } = X ˉ ( t ) (4) M\left\{ \hat {\mathbf{X } }(t) \right\} = M\left\{ \mathbf{X}(t) \right\} = \bar {\mathbf{X} }(t) \tag{4}METRO{ X^ (t)}=METRO{ X ( t ) }=Xˉ (t)( 4 ) Definamos (3) la ecuación
M { X ^ ̇ ( t ) } = F ( t ) M { X ^ ( t ) } + K ϕ ( t ) M { Y ( t ) } (5) M\ izquierda\{ \dot{ \hat{ \mathbf{X} } } (t) \right\} = \mathbf{F}(t) M\left\{ \hat{\mathbf{X}}(t). ) \right\} + \mathbf{K}_\phi(t) M\left\{ \mathbf{Y}(t) \right\} \tag{5}METRO{ X^˙ (t)}=F ( t ) M{ X^ (t)}+kϕ( t ) M{ Y ( t ) }( 5 ) Sea ( 2 )Y ( t ) = C ( t ) X ( t ) + N 2 ( t ) \mathbf{Y}(t) = \mathbf{C}(t) \mathbf{X }( t) + \mathbf{N}_2(t)Y ( t )=C ( t ) X ( t )+norte2( t ) , en el caso (2) de la ecuación única
M { Y ( t ) } = M { C ( t ) X ( t ) + N 2 ( t ) } = M { C ( t ) X ( t ) } + M { N 2 ( t ) } = C ( t ) X ˉ ( t ) + 0 = C ( t ) X ˉ ( t ) \begin{aligned} M\left\{ \mathbf{Y}(t) \ right\} &= M\left\{ \mathbf{C}(t) \mathbf{X}(t) + \mathbf{N}_2(t) \right\} \\ &= M\left\{ \ mathbf{C}(t) \mathbf{X}(t)\right\} + M\left\{\mathbf{N}_2(t)\right\}\\ &= \mathbf{C}(t ) \bar {\mathbf{X}}(t) + 0 \\ &= \mathbf{C}(t) \bar {\mathbf{X}}(t)\end{aligned}METRO{ Y ( t ) }=METRO{ C ( t ) X ( t )+norte2( t ) }=METRO{ C ( t ) X ( t ) }+METRO{ norte2( t ) }=C ( t )Xˉ (t)+0=C ( t )Xˉ (t)Sustituyendo en la fórmula (5) y según la fórmula (4), tenemos
M { X ^ ˙ ( t ) } = F ( t ) M { X ^ ( t ) } + K ϕ ( t ) M { Y ( t ) } = F ( t ) M { X ^ ( t ) } + K ϕ ( t ) ⋅ C ( t ) X ˉ ( t ) = F ( t ) M { X ^ ( t ) } + K ϕ ( t ) ⋅ C ( t ) M { X ^ ( t ) } = [ F ( t ) + K ϕ ( t ) C ( t ) ] ⋅ M { X ^ ( t ) } (6) \begin{aligned} M\left\{ \dot{ \hat{ \mathbf{X} } } (t ) \right\} &= \mathbf{F}(t) M\left\{ \hat {\mathbf{X} }(t) \right\} + \mathbf{K}_\phi(t) M\ izquierda\{ \mathbf{Y}(t) \right\} \\ &= \mathbf{F}(t) M\left\{ \hat {\mathbf{X} }(t) \right\} + \ mathbf{K}_\phi(t) \cdot \mathbf{C}(t) \bar {\mathbf{X} }(t) \\ &= \mathbf{F}(t) M\left\{ \ sombrero {\mathbf{X} }(t) \right\} + \mathbf{K}_\phi(t) \cdot \mathbf{C}(t) M\left\{ \hat {\mathbf{X} }(t) \right\} \\ &= \left[ \mathbf{F}(t) + \mathbf{K}_\phi(t) \mathbf{C}(t) \right] \cdot M\ izquierda\{ \hat {\mathbf{X} }(t) \right\} \end{aligned} \tag{6}METRO{ X^˙ (t)}=F ( t ) M{ X^ (t)}+kϕ( t ) M{ Y ( t ) }=F ( t ) M{ X^ (t)}+kϕ( t )C ( t )Xˉ (t)=F ( t ) M{ X^ (t)}+kϕ( t )C ( t ) M{ X^ (t)}=[ F ( t )+kϕ( t ) C ( t ) ]METRO{ X^ (t)}( 6 ) Por otro lado, tomando la expectativa matemática en ambos lados de la fórmula (1) (considerando que la expectativa de ruido es 0)
X ˉ ˙ ( t ) = A ( t ) X ˉ ( t ) (7) \dot { \bar { \mathbf{X} } }(t) = \mathbf{A}(t) \bar{ \mathbf{X} }(t) \tag{7}Xˉ˙ (t)=Un ( t )Xˉ (t)( 7 ) Según la fórmula (4), se puede ver que los lados derechos del signo igual en la fórmula (6) y la fórmula (7) deben ser iguales, entonces
F ( t ) + K ϕ ( t ) C ( t ) = A ( t ) \mathbf {F}(t) + \mathbf{K}_\phi(t) \mathbf{C}(t) = \mathbf{A}(t)F ( t )+kϕ( t ) C ( t )=A ( t ) o F( t ) = A ( t ) − K ϕ ( t ) C ( t ) (8) \mathbf{F}(t) = \mathbf{A}(t) - \mathbf{K} _ \phi(t) \mathbf{C}(t) \tag{8}F ( t )=Un ( t )kϕ( t ) C ( t )( 8 ) Fórmula inversa (3) para obtener la estructura del filtro
X ^ ˙ ( t ) = [ A ( t ) − K ϕ ( t ) C ( t ) ] X ^ ( t ) + K ϕ ( t ) Y ( t ) (9) \dot{ \hat{ \mathbf{X} } } (t) = \left[ \mathbf{A}(t) - \mathbf{K}_\phi(t) \mathbf{ C}( t) \right] \hat {\mathbf{X} }(t) + \mathbf{K}_\phi(t) \mathbf{Y}(t) \tag{9}X^˙ (t)=[ A ( t )kϕ( t ) C ( t ) ]X^ (t)+kϕ( t ) Y ( t )( 9 ) Cabe señalar queel valor estimadoX ^ \hat{ \mathbf{X} }XEl valor inicial de ^ debe ser lo más cercano posible al valor verdadero, es decir,X ^ ( t 0 ) = X ˉ 0 \hat{ \mathbf{X} }(t_0) = \bar{ \mathbf{X} }^0X^ (t0)=Xˉ0 , el filtro es válido en este momento.

(2) Condición de error cuadrático medio de error mínimo

La condición de error cuadrático medio de error mínimo se expresa como
M { ∥ X σ ( t ) ∥ 2 } → min ⁡ K ϕ ( t ) M\left\{ \Vert \mathbf{X}_\sigma (t) \Vert ^ 2 \right \} \rightarrow \min_{\mathbf{K}_\phi (t) }METRO{ ∥X _pag( t ) 2 }kϕ( t )min其中X σ ( t ) = X ( t ) − X ^ ( t ) \mathbf{X}_\sigma (t) = \mathbf{X}(t) - \hat{ \mathbf{X} }(t)Xpag( t )=X ( t )X^ (t)
不难看出:
M { ∥ X σ ( t ) ∥ 2 } = tr [ D σ σ ( t ) ] (10) M\left\{ \Vert \mathbf{X}_\sigma (t ) \Vert ^2 \right\} = {\rm tr} \left[ \mathbf{D}_{\sigma \sigma}(t) \right] \tag{10}METRO{ ∥X _pag( t ) 2 }=tr[ Dss( t ) ]( 10 ) dondeDXX ( t ) \mathbf{D}_{XX} (t)DXX( t ) significaX ( t ) \mathbf{X}(t)X ( t )方差,即DXX ( t ) = M { ( X − X ˉ ) ( X − X ˉ ) T } \mathbf{D}_{XX} (t) = M \left\{ \left( \ mathbf{X} - \bar{ \mathbf{X} } \right) \left( \mathbf{X} - \bar{ \mathbf{X} } \right)^{\rm T} \right\}DXX( t )=METRO{ ( XXˉ )( XXˉ )T }.
Derivación del error tiene (fórmula usada (2) (9))
X ˙ σ ( t ) = X ˙ ( t ) − X ^ ˙ ( t ) = [ A ( t ) X ( t ) + G ( t ) N 1 ( t ) ] − { [ A ( t ) − K ϕ ( t ) C ( t ) ] X ^ ( t ) + K ϕ ( t ) Y ( t ) } = A ( t ) X ( t ) + G ( t ) N 1 ( t ) − A ( t ) X ^ ( t ) + K ϕ ( t ) C ( t ) X ^ ( t ) − K ϕ ( t ) Y ( t ) = A ( t ) [ X ( t ) − X ^ ( t ) ] + G ( t ) N 1 ( t ) + K ϕ ( t ) C ( t ) X ^ ( t ) − K ϕ ( t ) [ C ( t ) X ( t ) + N 2 ( t ) ] = A ( t ) X σ ( t ) + GRAMO ( t ) norte 1 ( t ) − K ϕ ( t ) norte 2 ( t ) − K ϕ ( t ) C ( t ) X σ ( t ) = [ A ( t ) − K ϕ ( t ) C ( t ) ] X σ ( t ) + GRAMO ( t ) N 1 ( t ) − K ϕ ( t ) N 2 ( t ) = [ A ( t ) − K ϕ ( t ) C ( t ) ] X σ ( t ) + u = A ~ ( t ) X σ ( t ) + u (11) \begin{aligned} \dot{ \mathbf{X} }_\sigma (t) &= \dot{ \mathbf{X } }(t) - \dot{ \hat{ \mathbf{X} } }(t) \\ &= \left[ \mathbf{A}(t) \mathbf{X}(t) + \mathbf{G }(t) \mathbf{N}_1(t) \right] - \left\{ \left[\mathbf{A}(t) - \mathbf{K}_\phi(t) \mathbf{C}(t) \right] \hat {\mathbf{X} }(t) + \mathbf{K}_ \phi(t) \mathbf{Y}(t) \right\} \\ &= \mathbf{A}(t) \mathbf{X}(t) + \mathbf{G}(t) \mathbf{N }_1(t) - \mathbf{A}(t) bueno {\mathbf{X} }(t) + \mathbf{K}_\phi(t) \mathbf{C}(t) bueno {\ mathbf{ X} }(t) - \mathbf{K}_\phi(t) \mathbf{Y}(t) \\ &= \mathbf{A}(t) \left[ \mathbf{X}(t). ) - \hat {\mathbf{X} }(t) \right] + \mathbf{G}(t) \mathbf{N}_1(t) + \mathbf{K}_\phi(t) \mathbf{ C}(t) \hat {\mathbf{X}}(t) - \mathbf{K}_\phi(t) \left[ \mathbf{C}(t) \mathbf{X}(t) + \ mathbf{N}_2(t) \right] \\ &= \mathbf{A}(t) \mathbf{X}_\sigma(t) + \mathbf{G}(t) \mathbf{N}_1( t) - \mathbf{K}_\phi(t) \mathbf{N}_2(t) - \mathbf{K}_\phi(t) \mathbf{C}(t) \mathbf{X}_\ sigma(t) \\ &= \left[ \mathbf{A}(t) - \mathbf{K}_\phi(t) \mathbf{C}(t) \right] \mathbf{X}_\sigma (t) + \mathbf{G}(t)\mathbf{N}_1(t) - \mathbf{K}_\phi(t) \mathbf{N}_2(t) \\ &= \left[ \mathbf{A}(t) - \mathbf{K }_\phi(t) \mathbf{C}(t) \right] \mathbf{X}_\sigma(t) + \mathbf{u} \\ &= \tilde{ \mathbf{A} }(t ) \mathbf{X}_\sigma(t) + \mathbf{u} \end{aligned} \tag{11}X˙pag( t )=X˙ (t)X^˙ (t)=[ A ( t ) X ( t )+G ( t ) norte1( t ) ]{ [ A ( t )kϕ( t ) C ( t ) ]X^ (t)+kϕ( t ) Y ( t ) }=A ( t ) X ( t )+G ( t ) norte1( t )Un ( t )X^ (t)+kϕ( t ) C ( t )X^ (t)kϕ( t ) Y ( t )=Un ( t )[ X ( t )X^ (t)]+G ( t ) norte1( t )+kϕ( t ) C ( t )X^ (t)kϕ( t )[ C ( t ) X ( t )+norte2( t ) ]=A ( t ) Xpag( t )+G ( t ) norte1( t )kϕ( t ) norte2( t )kϕ( t ) C ( t ) Xpag( t )=[ A ( t )kϕ( t ) C ( t ) ]Xpag( t )+G ( t ) norte1( t )kϕ( t ) norte2( t )=[ A ( t )kϕ( t ) C ( t ) ]Xpag( t )+tu=A~ (t)Xpag( t )+tu( 11 )其中
u ( t ) = G ( t ) N 1 ( t ) − K ϕ ( t ) N 2 ( t ) , M { u ( t ) } = 0 \mathbf{u}(t) ​​= \mathbf {G}(t) \mathbf{N}_1(t) - \mathbf{K}_\phi(t) \mathbf{N}_2(t),\quad M\left\{ \mathbf{u}( t) \derecha\} = 0tu ( t )=G ( t ) norte1( t )kϕ( t ) norte2( t ) ,METRO{ tu ( t ) }=0 y la condición inicialX σ ( t ) = X ( t 0 ) − X ˉ 0 \mathbf{X}_\sigma(t) = \mathbf{X}(t_0) - \bar{ \mathbf{X} } ^ 0Xpag( t )=X ( t0)Xˉ0 .

对于u ( t ) \mathbf{u}(t)u ( t ) , su varianza (omitida en la fórmula( t ) (t)( t ) para escribir)
METRO { tu ( t ) tu T ( τ ) } = M { [ GN 1 − K ϕ N 2 ] ⋅ [ GN 1 − K ϕ N 2 ] T } = M { [ GN 1 − K ϕ N 2 ] ⋅ N 1 TGT − N 2 TK ϕ T ] } = M { GN 1 N 1 TGT − GN 1 N 2 TK ϕ T − K ϕ N 2 N 1 TGT + K ϕ N 2 N 2 TK ϕ T } = M { GN 1 N 1 TGT } − M { GN 1 N 2 TK ϕ T } − M { K ϕ N 2 N 1 TGT } + M { K ϕ N 2 N 2 TK ϕ T } \begin{aligned} M\left\{ \ mathbf{u}(t) ​​​​\mathbf{u}^{\rm T}(\tau) \right\} &= M\left\{ \left[ \mathbf{G} \mathbf{N}_1 - \ mathbf{K}_\phi \mathbf{N}_2 \right] \cdot \left[ \mathbf{G} \mathbf{N}_1 - \mathbf{K}_\phi \mathbf{N}_2 \right ] ^{\rm T} \right\} \\ &= M\left\{ \left[ \mathbf{G} \mathbf{N}_1 - \mathbf{K}_\phi \mathbf{N}_2 \ derecha ] \cdot \left[ \mathbf{N}_1^{\rm T} \mathbf{G}^{\rm T} - \mathbf{N}_2^{\rm T} \mathbf{K}_\ fi ^{\rm T} \right] \right\} \\ &= M\left\{ \mathbf{G} \mathbf{N}_1 \mathbf{N}_1^{\rm T}\mathbf{G}^{\rm T} - \mathbf{G} \mathbf{N}_1 \mathbf{N}_2^{\rm T} \mathbf{K}_\phi^{\rm T} - \mathbf{K}_\phi \mathbf{N}_2 \mathbf{N}_1^{\rm T} \mathbf{G}^{\rm T} + \mathbf{K}_\phi \mathbf{N }_2 \mathbf{N}_2^{\rm T} \mathbf{K}_\phi^{\rm T} \right\} \\ &= M\left\{ \mathbf{G} \mathbf{N }_1 \mathbf{N}_1^{\rm T} \mathbf{G}^{\rm T} \right\} - M\left\{ \mathbf{G} \mathbf{N}_1 \mathbf{N }_2^{\rm T} \mathbf{K}_\phi^{\rm T} \right\} - M\left\{ \mathbf{K}_\phi \mathbf{N}_2 \mathbf{N }_1^{\rm T} \mathbf{G}^{\rm T} \right\} + M\left\{ \mathbf{K}_\phi \mathbf{N}_2 \mathbf{N}_2^ {\rm T} \mathbf{K}_\phi^{\rm T} \right\} end{alineado}&= M\left\{\mathbf{G}\mathbf{N}_1 \mathbf{N}_1^{\rm T}\mathbf{G}^{\rm T}\right\} - M\left\ { \mathbf{G} \mathbf{N}_1 \mathbf{N}_2^{\rm T} \mathbf{K}_\phi^{\rm T} \right\} - M\left\{ \mathbf {K}_\phi \mathbf{N}_2 \mathbf{N}_1^{\rm T} \mathbf{G}^{\rm T} \right\} + M\left\{ \mathbf{K} _\phi \mathbf{N}_2 \mathbf{N}_2^{\rm T} \mathbf{K}_\phi^{\rm T}\right\}\end{aligned}&= M\left\{\mathbf{G}\mathbf{N}_1 \mathbf{N}_1^{\rm T}\mathbf{G}^{\rm T}\right\} - M\left\ { \mathbf{G} \mathbf{N}_1 \mathbf{N}_2^{\rm T} \mathbf{K}_\phi^{\rm T} \right\} - M\left\{ \mathbf {K}_\phi \mathbf{N}_2 \mathbf{N}_1^{\rm T} \mathbf{G}^{\rm T} \right\} + M\left\{ \mathbf{K} _\phi \mathbf{N}_2 \mathbf{N}_2^{\rm T} \mathbf{K}_\phi^{\rm T}\right\}\end{aligned}METRO{ tu ( t ) tuT (τ)}=METRO{ [ GN _1kϕnorte2][ GN _1kϕnorte2]t }=METRO{ [ GN _1kϕnorte2][ norte1tGRAMOtnorte2tkϕt] }=METRO{ G N1norte1tGRAMOtG N1norte2tkϕtkϕnorte2norte1tGRAMOt+kϕnorte2norte2tkϕt}=METRO{ G N1norte1tGRAMOt }METRO{ G N1norte2tkϕt}METRO{ kϕnorte2norte1tGRAMOt }+METRO{ kϕnorte2norte2tkϕt}由于M { N 1 ( t ) N 1 T ( t ) } = S 1 ( t ) δ ( t - τ ) , M { N 2 ( t ) N 2 T ( t ) } = S 2 ( t ) δ ( t − τ ) , METRO { N 1 ( t ) N 2 T ( τ ) } = S 3 ( t ) δ ( t − τ ) M\left\{ \mathbf{N}_1(t) \mathbf{N} _1^{\rm T}(t) \right\} = \mathbf{S}_1 (t) \delta (t - \tau),\quad M\left\{ \mathbf{N}_2(t) \ mathbf{N}_2^{\rm T}(t) \right\} = \mathbf{S}_2 (t) \delta (t - \tau), \quad M\left\{ \mathbf{N}_1 (t) \mathbf{N}_2^{\rm T}(\tau) \right\} = \mathbf{S}_3 (t) \delta (t - \tau)METRO{ norte1( t ) norte1t( t ) }=S1( t ) δ ( tt ) ,METRO{ norte2( t ) norte2t( t ) }=S2( t ) δ ( tt ) ,METRO{ norte1( t ) norte2t( t ) }=S3( t ) δ ( tτ ) , por lo que la fórmula anterior se convierte en
METRO { tu ( t ) u T ( τ ) } = M { GN 1 N 1 TGT } - M { GN 1 N 2 TK ϕ T } - M { K ϕ N 2 N 1 TGT } + M { K ϕ N N 2 TK ϕ T } = [ GS 1 GT − G ( t ) S 3 K ϕ T − K ϕ S 3 GT + K ϕ S 2 K ϕ T ] δ ( t − τ ) (12) \begin{aligned} M \left\{\mathbf{u}(t)\mathbf{u}^{\rm T}(\tau)\right\} &= M\left\{\mathbf{G}\mathbf{N}_1 \ mathbf{N}_1^{\rm T} \mathbf{G}^{\rm T} \right\} - M\left\{ \mathbf{G} \mathbf{N}_1 \mathbf{N}_2 ^ {\rm T} \mathbf{K}_\phi^{\rm T} \right\} - M\left\{ \mathbf{K}_\phi \mathbf{N}_2 \mathbf{N}_1 ^ {\rm T} \mathbf{G}^{\rm T} \right\} + M\left\{ \mathbf{K}_\phi \mathbf{N}_2 \mathbf{N}_2^{\ rm T} \mathbf{K}_\phi^{\rm T}\right\}\\&= \left[\mathbf{G}\mathbf{S}_1 \mathbf{G}^{\rm T} - \mathbf{G}(t) \mathbf{S}_3 \mathbf{K}_\phi^{\rm T} - \mathbf{K}_\phi \mathbf{S}_3 \mathbf{G}^ { \rm T} + \mathbf{K}_\phi \mathbf{S}_2\mathbf{K}_\phi^{\rm T} \right] \delta(t - \tau) \tag{12} \end{aligned}METRO{ tu ( t ) tuT (τ)}=METRO{ G N1norte1tGRAMOt }METRO{ G N1norte2tkϕt}METRO{ kϕnorte2norte1tGRAMOt }+METRO{ kϕnorte2norte2tkϕt}=[ G S1GRAMOtG ( t ) S3kϕtkϕS3GRAMOt+kϕS2kϕt]re ( tt ).( 12 )

(3) La condición de variación del error.

La siguiente conclusión se da aquí sin prueba :
cuando X ˙ ( t ) = A ( t ) X ( t ) + G ( t ) N 1 ( t ) \dot{ \mathbf{X} }(t) = \mathbf { A}(t) \mathbf{X}(t) + \mathbf{G}(t) \mathbf{N}_1(t)X˙ (t)=A ( t ) X ( t )+G ( t ) norte1( t ) , su varianza satisface la siguiente ecuación diferencial
D ˙XX ( t ) = A ( t ) DXX ( t ) + DXX ( t ) AT ( t ) + G ( t ) S 1 ( t ) GT ( t ) ( 13) \dot{ \mathbf{D} }_{XX}(t) = \mathbf{A}(t) \mathbf{D}_{XX}(t) + \mathbf{D}_{XX}( t) \mathbf{A}^{\rm T}(t) + \mathbf{G}(t) \mathbf{S}_1(t) \mathbf{G}^{\rm T}(t) \tag {13}D˙XX( t )=A ( t ) DXX( t )+DXX( t ) AT (t)+G ( t ) S1( t ) GRAMOT (t)( 13 ) Entonces, cuandoX ˙ σ ( t ) \dot{ \mathbf{X} }_\sigma(t)X˙pagCuando ( t ) tiene la forma de fórmula (11), el error estimado X σ ( t ) \mathbf{X}_\sigma(t) sepuede obtener sustituyendo en la fórmula (13)Xpag( t ) varianzaD σ σ ( t ) \mathbf{D}_{\sigma \sigma}(t)Dss( t ) satisface la ecuación diferencial:
D ̇ σ σ ( t ) = A ~ ( t ) DXX ( t ) + DXX ( t ) A ~ T ( t ) + M { u ( t ) u T ( τ ) } / δ ( t − τ ) = A − K ϕ C ] D σ σ + D σ σ [ A − K ϕ C ] T + [ GS 1 GT − GS 3 K ϕ T − K ϕ S 3 GT + K ϕ S 2 K ϕ T ] = A ~ ( t ) D σ σ + D σ σ A ~ T ( t ) + GS 1 GT − GS 3 K ϕ T − K ϕ S 3 GT + K ϕ S 2 K ϕ T (14) \begin{aligned} \dot { \mathbf{D} }_{\sigma \sigma}(t) &= \tilde{ \mathbf{A} }(t) \mathbf{D}_{XX}(t) + \mathbf{D}_ { XX}(t) \tilde{ \mathbf{A}^{\rm T}(t) + M\left\{ \mathbf{u}(t) ​​​​\mathbf{u}^{\rm T}( \tau) \right\} / \delta(t - \tau) \\ &= \left[ \mathbf{A} - \mathbf{K}_\phi \mathbf{C} \right] \mathbf{D} _{\sigma \sigma} + \mathbf{D}_{\sigma \sigma} \left[ \mathbf{A} - \mathbf{K}_\phi \mathbf{C} \right]^{\rm T } + \left[ \mathbf{G} \mathbf{S}_1 \mathbf{G}^{\rm T} - \mathbf{G} \mathbf{S}_3 \mathbf{K}_\phi^{\ rm T} - \mathbf{K}_\phi\mathbf{S}_3 \mathbf{G}^{\rm T} + \mathbf{K}_\phi \mathbf{S}_2 \mathbf{K}_\phi^{\rm T} \right] \ \ &= \assign{ \mathbf{A} }(t) \mathbf{D}_{\sigma \sigma} + \mathbf{D}_{\sigma \sigma} \assign{ \mathbf{A} }^ {\rm T}(t) + \mathbf{G} \mathbf{S}_1 \mathbf{G}^{\rm T} - \mathbf{G} \mathbf{S}_3 \mathbf{K}_\ phi^{\rm T} - \mathbf{K}_\phi \mathbf{S}_3 \mathbf{G}^{\rm T} + \mathbf{K}_\phi \mathbf{S}_2 \mathbf {K}_\phi^{\rm T} \tag{14}\end{aligned}\end{alineado}\end{alineado}D˙ss( t )=A~ (t)DXX( t )+DXX( t )A~T (t)+METRO{ tu ( t ) tuT (τ)}/ d ( tt )=[ UnkϕC ]Dss+Dss[ UnkϕC ]t+[ G S1GRAMOtgs _3kϕtkϕS3GRAMOt+kϕS2kϕt]=A~ (t)Dss+DssA~T (t)+gs _1GRAMOtgs _3kϕtkϕS3GRAMOt+kϕS2kϕt( 14 )

(4) K ϕ ( t ) \mathbf{K}_\phi(t)kϕ( t ) derivación

现在滤波器的任务转化为求解 K ϕ ( t ) \mathbf{K}_\phi(t) Kϕ(t)使得 D σ σ ( t ) \mathbf{D}_{\sigma \sigma}(t) Dσσ(t)最小。可以想到,当方差 D σ σ ( t ) \mathbf{D}_{\sigma \sigma}(t) Dσσ(t)最小时,同样我们也期望方差稳定在该最小值附近不要变化,即其导数 D ˙ σ σ ( t ) \dot{ \mathbf{D} }_{\sigma \sigma}(t) D˙σσ(t)同样方差最小。表示为
min ⁡ K ϕ ( t ) { t r [ D σ σ ( t ) ] } → K ~ ϕ ∗ ( t ) max ⁡ K ϕ ( t ) { − t r [ D ˙ σ σ ( t ) ] } → K ~ ~ ϕ ∗ ( t ) \min_{ \mathbf{K}_\phi(t) } \left\{ {\rm tr} \left[ \mathbf{D}_{\sigma \sigma} (t) \right] \right\} \rightarrow \tilde{ \mathbf{K} }_\phi^* (t) \\ \max_{ \mathbf{K}_\phi(t) } \left\{ {\rm -tr} \left[ \dot{ \mathbf{D} }_{\sigma \sigma} (t) \right] \right\} \rightarrow \tilde{ \tilde{ \mathbf{K} } }_\phi^* (t) Kϕ(t)min{ tr[Dσσ(t)]}K~ϕ(t)Kϕ(t)max{ tr[D˙σσ(t)]}K~~ϕ( t ) Dado queK ϕ ( t ) \mathbf{K}_\phi(t)kϕ( t ) es único, 故
K ~ ϕ ∗ ( t ) = K ~ ~ ϕ ∗ ( t ) \tilde{ \mathbf{K} }_\phi^* (t) = \tilde{ \tilde{ \mathbf{ K } } }_\phi^* (t)k~ϕ( t )=k~~ϕ( t ) Con el conocimiento del método variacional y refiriéndose a la ecuación de Euler (no sé cómo obtenerla aquí),K ϕ ( t ) \mathbf{K}_\phi(t)kϕ( t )满足
∂ ∂ K ϕ ( t ) tr [ D ˙ σ σ ( t ) ] = 0 (15) \frac{\partial}{\partial \mathbf{K}_\phi(t)} {\rm tr} \left[ \dot{ \mathbf{D} }_{\sigma \sigma} (t) \right] = 0 \tag{15}∂K _ϕ( t )tr[D˙ss( t ) ]=0( 15 )

(5) Derivación de la traza de la matriz

Para una solución (15), es necesario resolver el problema de una solución simple:
∂ tr ( PQPT ) ∂ P = P ( Q + QT ) ∂ tr ( PQ ) ∂ Q = PT ∂ tr ( QP ) ∂ Q = PT ∂ tr ( PQT ) ∂ Q = P ∂ tr ( QTP ) ∂ Q = P \frac{\partial {\rm tr} \left( \mathbf{P} \mathbf{Q} \mathbf{P}^{ \ rm T} \right)}{\partial \mathbf{P}} = \mathbf{P}\left( \mathbf{Q} + \mathbf{Q}^{\rm T} \right) \\\frac { \partial {\rm tr} \left( \mathbf{P} \mathbf{Q}\right)}{\partial \mathbf{Q}} = \mathbf{P}^{\rm T}\\\frac { \partial {\rm tr} \left( \mathbf{Q} \mathbf{P} \right)}{\partial \mathbf{Q}} = \mathbf{P}^{\rm T}\\\frac { \partial {\rm tr} \left( \mathbf{P} \mathbf{Q}^{\rm T} \right)}{\partial \mathbf{Q}} = \mathbf{P}\\\frac { \partial {\rm tr} \left( \mathbf{Q}^{\rm T} \mathbf{P}\right)}{\partial \mathbf{Q}} = \mathbf{P}∂P _tr( porque P.T )=PAG( Q+qT )∂Q _tr( PQ )=PAGt∂Q _tr( QP )=PAGt∂Q _tr( P QT )=PAG∂Q _tr( QTP )_=P se refiere a los elementos del lado derecho de la fórmula (14) y primero obtiene la derivada de la traza de los siguientes elementos:
∂ tr ( A − K ϕ C ) ∂ K ϕ = ∂ tr ( A ) ∂ K ϕ − ∂ tr ( K ϕ C ) ∂ K ϕ = 0 − CT = − CT ∂ tr ( K ϕ S 2 K ϕ T ) ∂ K ϕ = K ϕ ( S 2 + S 2 T ) = 2 K ϕ S 2 ∂ tr ( G ( t ) S 3 K ϕ T ) ∂ K ϕ = G ( t ) S 3 ∂ tr ( K ϕ S 3 GT ) ∂ K ϕ = [ S 3 GT ] T = G ( t ) S 3 \frac{\partial {\rm tr} \left( \mathbf{A} - \mathbf{K}_\phi \mathbf{C } \right)}{\partial \mathbf{K}_\phi} = \frac{\partial {\rm tr} \left( \mathbf{A} \right)}{\partial \mathbf{K}_\ phi} - \frac{\partial {\rm tr} \left( \mathbf{K}_\phi \mathbf{C} \right)}{\partial \mathbf{K}_\phi} = 0 - \mathbf {C}^{\rm T} = - \mathbf{C}^{\rm T} \\ \frac{\partial {\rm tr} \left( \mathbf{K}_\phi \mathbf{S} _2 \mathbf{K}_\phi^{\rm T} \right)}{\partial \mathbf{K}_\phi} = \mathbf{K}_\phi \left( \mathbf{S}_2 + \mathbf{S}_2^{\rm T} \right) = 2 \mathbf{K}_\phi \mathbf{S}_2 \\ \frac{\partial {\rm tr} \left( \mathbf{G }(t)\mathbf{S}_3 \mathbf{K}_\phi^{\rm T} \right)}{\partial \mathbf{K}_\phi} = \mathbf{G}(t) \mathbf{S} _3 \\ \frac{\partial {\rm tr} \left( \mathbf{K}_\phi \mathbf{S}_3 \mathbf{G}^{\rm T} \right)}{\partial \mathbf {K}_\phi} = \left[ \mathbf{S}_3 \mathbf{G}^{\rm T} \right]^{\rm T} = \mathbf{G}(t) \mathbf{S }_3∂K _ϕtr( UnkϕC )=∂K _ϕtr( Un )∂K _ϕtr( kϕC )=0Ct=−C _t∂K _ϕtr( kϕS2kϕt)=kϕ( s2+S2t)=2K _ϕS2∂K _ϕtr( G ( t ) S3kϕt)=G ( t ) S3∂K _ϕtr( kϕS3GRAMOT )=[ S3GRAMOT ]t=G ( t ) S3Sustituyendo todas las fórmulas anteriores en la ecuación diferencial (15), se puede resolver para obtener
K ϕ ∗ ( t ) = [ D σ σ ( t ) CT ( t ) + G ( t ) S 3 ( t ) ] S 2 − 1 ( t ) (16 – 1) \mathbf{K}_\phi^* (t) = \left[ \mathbf{D}_{\sigma \sigma}(t) \mathbf{C}^{\ rm T}( t) + \mathbf{G}(t) \mathbf{S}_3(t) \right] \mathbf{S}_2^{-1}(t) \tag{16 -- 1}kϕ( t )=[ Dss( t ) CT (t)+G ( t ) S3( t ) ]S2 1( t )( 16 – 1 )

(6) Caso especial entre dos ruidos

Todas las derivaciones anteriores se basan en el punto (2) de la Sección 2: N 1 ( t ) \mathbf{N}_1(t)norte1( t )N 2 ( t ) \mathbf{N}_2(t)norte2( t )相关,即M { N 1 ( t ) N 2 T ( τ ) } = S 3 ( t ) δ ( t − τ ) M\left\{ \mathbf{N}_1(t) \mathbf{N }_2^{\rm T}(\tau) \right\} = \mathbf{S}_3 (t) \delta (t - \tau)METRO{ norte1( t ) norte2t( t ) }=S3( t ) δ ( tτ ) . Sin embargo, uno de estos dos ruidos es ruido del sistema y el otro es ruido de medición, que a menudo son irrelevantes en la práctica.

Cuando los dos no están correlacionados, M { N 1 ( t ) N 2 T ( τ ) } = 0 M\left\{ \mathbf{N}_1(t) \mathbf{N}_2^{\rm T}( \ tau) \derecha\} = 0METRO{ norte1( t ) norte2t( t ) }=0,即 S 3 ( t ) = 0 \mathbf{S}_3 (t) = 0 S3(t)=0。在这种特殊情况下,式(16 – 1)具有较为理想的特殊形式
K ϕ ∗ ( t ) = D σ σ ( t ) C T ( t ) S 2 − 1 ( t ) (16 – 2) \mathbf{K}_\phi^* (t) = \mathbf{D}_{\sigma \sigma}(t) \mathbf{C}^{\rm T}(t) \mathbf{S}_2^{-1}(t) \tag{16 -- 2} Kϕ(t)=Dσσ(t)CT(t)S21(t)(16 – 2)式(16 – 1)和(16 – 2)即为所求得的最优Kalman-Bucy滤波器表达式

最后,将式(16 – 1)反代回式(14),以求得不显含 K ϕ ∗ ( t ) \mathbf{K}_\phi^*(t) Kϕ( t ) Varianza del errorD σ σ ( t ) \mathbf{D}_{\sigma \sigma}(t)Dss( t ) satisface la ecuación diferencial:
D ̇ σ σ ( t ) = [ A − K ϕ ∗ C ] D σ σ + D σ σ [ A − K ϕ ∗ C ] T + [ GS 1 GT − GS 3 K ϕ ∗ T − K ϕ ∗ S GT + K ϕ ∗ S 2 K ϕ ∗ T ] = { A − [ D σ σ CT + GS 3 ] S 2 − 1 ⋅ C } D σ σ + D σ σ { A − [ D σ σ CT + GS ] S 2 − 1 ⋅ C } T + + GS 1 GT − GS 3 { [ D σ σ CT + GS 3 ] S 2 − 1 } T − [ D σ σ CT + GS 3 ] S 2 − 1 ⋅ S GT + [ D σ σ CT + GS 3 ] S 2 − 1 ⋅ S 2 ⋅ K ϕ ∗ T { [ D σ σ CT + GS 3 ] S 2 − 1 } T = ( A − GS 3 S 2 − 1 C ) D σ σ + D σ σ ( A − GS 3 S 2 − 1 C ) T − D σ σ CTS 2 − 1 CD σ σ + G ( S 1 − S 3 S 2 − 1 S 3 ) GT (17 – 1) \ comenzar{alineado} \dot{ \mathbf{D} }_{\sigma \sigma}(t) &= \left[ \mathbf{A} - \mathbf{K}_\phi^* \mathbf{ C} \ derecha] \mathbf{D}_{\sigma \sigma} + \mathbf{D}_{\sigma \sigma} \left[ \mathbf{A} - \mathbf{K}_\phi^*\ mathbf{C } \right]^{\rm T} + \left[ \mathbf{G} \mathbf{S}_1 \mathbf{G}^{\rm T} - \mathbf{G}\mathbf{S}_3 \mathbf{K}_\phi^{*\rm T} - \mathbf{K}_\phi^* \mathbf{S}_3 \mathbf{G}^{\rm T} + \mathbf{K}_\phi^* \mathbf{S}_2 \mathbf{K}_\phi^{*\rm T} \right] \\ &= \left\{ \mathbf{A} - \left [ \mathbf{D}_{\sigma\sigma} \mathbf{C}^{\rm T} + \mathbf{G} \mathbf{S}_3 \right] \mathbf{S}_2^{-1} \cdot \mathbf{C} \right\} \mathbf{D}_{\sigma \sigma} + \mathbf{D}_{\sigma \sigma} \left\{ \mathbf{A} - \left[\ mathbf{D}_{\sigma\sigma}\mathbf{C}^{\rm T} + \mathbf{G}\mathbf{S}_3 \right] \mathbf{S}_2^{-1}\cdot \mathbf{C} \right\}^{\rm T} + \\ &+ \mathbf{G} \mathbf{S}_1 \mathbf{G}^{\rm T} - \mathbf{G} \mathbf {S}_3 \left\{\left[\mathbf{D}_{\sigma\sigma}\mathbf{C}^{\rm T} + \mathbf{G}\mathbf{S}_3 \right]\ mathbf{S}_2^{-1} \right\}^{\rm T} - \left[ \mathbf{D}_{\sigma \sigma} \mathbf{C}^{\rm T} + \mathbf {G} \mathbf{S}_3\right] \mathbf{S}_2^{-1}\cdot\mathbf{S}_3 \mathbf{G}^{\rm T} \\ &+ \left[ \mathbf{D}_{\sigma \sigma} \mathbf{C}^{\rm T} + \mathbf {G} \mathbf{S}_3 \right] \mathbf{S}_2^{-1}\cdot \mathbf{S}_2 \cdot \mathbf{K}_\phi^{*\rm T}\left \{\left[\mathbf{D}_{\sigma\sigma}\mathbf{C}^{\rm T} + \mathbf{G}\mathbf{S}_3 \right] \mathbf{S}_2^ {-1} \right\}^{\rm T} \\ &= \left( \mathbf{A} - \mathbf{G} \mathbf{S}_3 \mathbf{S}_2^{-1}\ mathbf{C} \right) \mathbf{D}_{\sigma \sigma} + \mathbf{D}_{\sigma \sigma} \left( \mathbf{A} - \mathbf{G} \mathbf{S }_3 \mathbf{S}_2^{-1} \mathbf{C}\right)^{\rm T} - \mathbf{D}_{\sigma\sigma}\mathbf{C}^{\rm T } \mathbf{S}_2^{-1} \mathbf{C} \mathbf{D}_{\sigma \sigma} + \mathbf{G} \left( \mathbf{S}_1 - \mathbf{S} _3 \mathbf{S}_2^{-1} \mathbf{S}_3 \right) \mathbf{G}^{\rm T}\end{aligned} \tag{17 -- 1}\mathbf{D}_{\sigma\sigma} \mathbf{C}^{\rm T} + \mathbf{G} \mathbf{S}_3 \right] \mathbf{S}_2^{-1}\ cdot \mathbf{S}_2 \cdot \mathbf{K}_\phi^{*\rm T} \left\{ \left[ \mathbf{D}_{\sigma \sigma} \mathbf{C}^{ \rm T} + \mathbf{G} \mathbf{S}_3 \right] \mathbf{S}_2^{-1} \right\}^{\rm T}\\ &= \left( \mathbf{ A} - \mathbf{G} \mathbf{S}_3 \mathbf{S}_2^{-1} \mathbf{C} \right) \mathbf{D}_{\sigma \sigma} + \mathbf{D }_{\sigma\sigma}\left(\mathbf{A} - \mathbf{G}\mathbf{S}_3 \mathbf{S}_2^{-1}\mathbf{C}\right)^{\ rm T} - \mathbf{D}_{\sigma\sigma} \mathbf{C}^{\rm T} \mathbf{S}_2^{-1} \mathbf{C}\mathbf{D}_{ \sigma \sigma} + \mathbf{G} \left( \mathbf{S}_1 - \mathbf{S}_3 \mathbf{S}_2^{-1} \mathbf{S}_3 \right) \mathbf{ G}^{\rm T} \end{alineado} \tag{17 -- 1}\mathbf{D}_{\sigma\sigma} \mathbf{C}^{\rm T} + \mathbf{G} \mathbf{S}_3 \right] \mathbf{S}_2^{-1}\ cdot \mathbf{S}_2 \cdot \mathbf{K}_\phi^{*\rm T} \left\{ \left[ \mathbf{D}_{\sigma \sigma} \mathbf{C}^{ \rm T} + \mathbf{G} \mathbf{S}_3 \right] \mathbf{S}_2^{-1} \right\}^{\rm T}\\ &= \left( \mathbf{ A} - \mathbf{G} \mathbf{S}_3 \mathbf{S}_2^{-1} \mathbf{C} \right) \mathbf{D}_{\sigma \sigma} + \mathbf{D }_{\sigma\sigma}\left(\mathbf{A} - \mathbf{G}\mathbf{S}_3 \mathbf{S}_2^{-1}\mathbf{C}\right)^{\ rm T} - \mathbf{D}_{\sigma\sigma} \mathbf{C}^{\rm T} \mathbf{S}_2^{-1} \mathbf{C}\mathbf{D}_{ \sigma \sigma} + \mathbf{G} \left( \mathbf{S}_1 - \mathbf{S}_3 \mathbf{S}_2^{-1} \mathbf{S}_3 \right) \mathbf{ G}^{\rm T} \end{alineado} \tag{17 -- 1}\mathbf{S}_2 \cdot \mathbf{K}_\phi^{*\rm T} \left\{ \left[ \mathbf{D}_{\sigma \sigma} \mathbf{C}^{\ rm T} + \mathbf{G} \mathbf{S}_3 \right] \mathbf{S}_2^{-1}\right\}^{\rm T}\\ &= \left( \mathbf{A } - \mathbf{G} \mathbf{S}_3 \mathbf{S}_2^{-1} \mathbf{C}\right) \mathbf{D}_{\sigma\sigma} + \mathbf{D} _{\sigma \sigma} \left( \mathbf{A} - \mathbf{G} \mathbf{S}_3 \mathbf{S}_2^{-1} \mathbf{C}\right)^{\rm T} - \mathbf{D}_{\sigma \sigma} \mathbf{C}^{\rm T} \mathbf{S}_2^{-1} \mathbf{C}\mathbf{D}_{\ sigma \sigma} + \mathbf{G} \left( \mathbf{S}_1 - \mathbf{S}_3 \mathbf{S}_2^{-1} \mathbf{S}_3 \right) \mathbf{G }^{\rm T} \end{alineado} \tag{17 -- 1}\mathbf{S}_2 \cdot \mathbf{K}_\phi^{*\rm T} \left\{ \left[ \mathbf{D}_{\sigma \sigma} \mathbf{C}^{\ rm T} + \mathbf{G} \mathbf{S}_3 \right] \mathbf{S}_2^{-1}\right\}^{\rm T}\\ &= \left( \mathbf{A } - \mathbf{G} \mathbf{S}_3 \mathbf{S}_2^{-1} \mathbf{C}\right) \mathbf{D}_{\sigma\sigma} + \mathbf{D} _{\sigma \sigma} \left( \mathbf{A} - \mathbf{G} \mathbf{S}_3 \mathbf{S}_2^{-1} \mathbf{C}\right)^{\rm T} - \mathbf{D}_{\sigma \sigma} \mathbf{C}^{\rm T} \mathbf{S}_2^{-1} \mathbf{C}\mathbf{D}_{\ sigma \sigma} + \mathbf{G} \left( \mathbf{S}_1 - \mathbf{S}_3 \mathbf{S}_2^{-1} \mathbf{S}_3 \right) \mathbf{G }^{\rm T} \end{alineado} \tag{17 -- 1}\mathbf{S}_3 \mathbf{S}_2^{-1} \mathbf{C}\right) \mathbf{D}_{\sigma\sigma} + \mathbf{D}_{\sigma\sigma} \left( \mathbf{A} - \mathbf{G} \mathbf{S}_3 \mathbf{S}_2^{-1} \mathbf{C}\right)^{\rm T} - \mathbf{D }_{\sigma\sigma}\mathbf{C}^{\rm T}\mathbf{S}_2^{-1}\mathbf{C}\mathbf{D}_{\sigma\sigma} + \mathbf {G} \left( \mathbf{S}_1 - \mathbf{S}_3 \mathbf{S}_2^{-1} \mathbf{S}_3 \right) \mathbf{G}^{\rm T} \end{alineado} \tag{17 -- 1}\mathbf{S}_3 \mathbf{S}_2^{-1} \mathbf{C}\right) \mathbf{D}_{\sigma\sigma} + \mathbf{D}_{\sigma\sigma} \left( \mathbf{A} - \mathbf{G} \mathbf{S}_3 \mathbf{S}_2^{-1} \mathbf{C}\right)^{\rm T} - \mathbf{D }_{\sigma\sigma}\mathbf{C}^{\rm T}\mathbf{S}_2^{-1}\mathbf{C}\mathbf{D}_{\sigma\sigma} + \mathbf {G} \left( \mathbf{S}_1 - \mathbf{S}_3 \mathbf{S}_2^{-1} \mathbf{S}_3 \right) \mathbf{G}^{\rm T} \end{alineado} \tag{17 -- 1}D˙ss( t )=[ UnkϕC ]Dss+Dss[ UnkϕC ]t+[ G S1GRAMOtgs _3kϕ TkϕS3GRAMOt+kϕS2kϕ T]={ Un[ DssCt+gs _3]S2 1C }Dss+Dss{ Un[ DssCt+gs _3]S2 1C }t++gs _1GRAMOtgs _3{ [ DssCt+gs _3]S2 1}t[ DssCt+gs _3]S2 1S3GRAMOt+[ DssCt+gs _3]S2 1S2kϕ T{ [ DssCt+gs _3]S2 1}t=( Ungs _3S2 1c )Dss+Dss( Ungs _3S2 1c )tDssCts _2 1CD _ss+GRAMO( s1S3S2 1S3)GRAMOt( 17 – 1 )N 1 ( t ) \mathbf{N}_1(t)norte1( t )N 2 ( t ) \mathbf{N}_2(t)norte2( t ) S 3 ( t ) = 0 \mathbf{S}_3(t)=0cuando no hay correlaciónS3( t )=0 ,excepto
D ̇ σ σ ( t ) = AD σ σ + D σ σ AT − D σ σ CTS 2 − 1 CD σ σ + GS 1 GT (17 – 2) \dot{ \mathbf{D} }_{ \sigma\sigma}(t) = \mathbf{A}\mathbf{D}_{\sigma\sigma} + \mathbf{D}_{\sigma\sigma}\mathbf{A}^{\ rm T} - \mathbf{D}_{\sigma\sigma} \mathbf{C}^{\rm T} \mathbf{S}_2^{-1} \mathbf{C}\mathbf{D}_{ \sigma \ sigma} + \mathbf{G} \mathbf{S}_1\mathbf{G}^{\rm T} \tag{17 -- 2}D˙ss( t )=un ress+DssAtDssCts _2 1CD _ss+gs _1GT(17 – 2)至此,式(17 – 1)和(17 – 2)给出了不含 K ϕ ( t ) \mathbf{K}_\phi(t) Kϕ(t)的估计误差方差 D σ σ ( t ) \mathbf{D}_{\sigma \sigma}(t) Dσσ(t)表达式。

(7) 滤波器的结论

式(16)给出了最优Kalman-Bucy滤波器的表达式 K ϕ ∗ ( t ) \mathbf{K}_\phi^* (t) Kϕ(t)

a) Kalman-Bucy滤波器具有式(9)的形式,它利用测量值 Y ( t ) \mathbf{Y}(t) Y(t)可以求出状态量 X ( t ) \mathbf{X}(t) X(t)的真值。
b) 由式(9)可以看出,在这个过程中需要用到状态矩阵 A ( t ) \mathbf{A}(t) A(t)和测量矩阵 C ( t ) \mathbf{C}(t) C(t),二者可以在参数估计或参数识别的前提下获得。
c) 利用式(17),可以直接基于状态矩阵 A ( t ) \mathbf{A}(t) A(t)、测量矩阵 C ( t ) \mathbf{C}(t) C(t)与两个噪声的方差分布矩阵 S i ( t ) \mathbf{S}_i(t) Si(t)计算出估计误差 D σ σ \mathbf{D}_{\sigma \sigma} Dσσ,而绕开 K ϕ ( t ) \mathbf{K}_\phi(t) Kϕ(t)的计算。
d) 在计算出 D σ σ \mathbf{D}_{\sigma \sigma} DσσDespués de eso, sustituyendo en la fórmula (16), se puede calcular K ϕ ( t ) \mathbf{K}_\phi(t)kϕ( t ) , y luego la estructura del filtro de Kalman-Bucy se obtiene como fórmula (9). e) El valor de estado estimado X ^ ( t ) \hat{ \mathbf{X} }(t)
calculado mediante la fórmula (9)X^ (t)puede satisfacer la estimación insesgada y minimizar el error cuadrático medio del error de estimación.
f) Condiciones que no se pueden ignorar: todo lo anterior se basa en dos fundamentos principales: uno es la matriz de estadosA ( t ) \mathbf{A}(t)A ( t ) y matriz de mediciónC ( t ) \mathbf{C}(t)La estimación de C ( t ) es lo suficientemente precisa, lo que plantea requisitos más altos para la identificación de parámetros; el segundo es el valor estimadoX ^ ( t ) \hat{ \mathbf{X} }(t)XEl valor inicial de ^ (t)debe estimarse con precisión, es decir, el resultado se ve muy afectado por el valor inicial.
g) Pasos para filtrar el estado usando el filtro de Kalman-Bucy: identificación de parámetros para obtener el modelo del sistemaA ( t ) , C ( t ) \mathbf{A}(t),\mathbf{C}(t)Un ( t ) ,C ( t ) —— Varianza del error D σ σ \mathbf{D}_{\sigma \sigma}calculada según la fórmula (17)Dss—— 将D σ σ \mathbf{D}_{\sigma\sigma}DssSustituyendo la fórmula (16) para calcular la matriz de coeficientes óptima K del filtro K ϕ ∗ ( t ) \mathbf{K}_\phi^*(t)kϕ( t ) , la matriz puede satisfacer el valor de estimación de estado insesgado y el error cuadrático medio del error mínimo. Utilice la fórmula (9) para construir el filtro de Kalman-Bucy y resuelva el valor de estimación de estado X ^ ( t ) \hat{\ matematica {X} }(t)X^ (t)

Supongo que te gusta

Origin blog.csdn.net/weixin_58399148/article/details/131860905
Recomendado
Clasificación