kalman

状態の推定用のカルマン フィルターの設計

構文

[kalmf,L,P] = kalman(sys,Q,R,N)

[kalmf,L,P] = kalman(sys,Q,R,N,sensors,known)

[kalmf,L,P,Mx,Z,My] = kalman(___)

[kalmf,L,P,Mx,Z,My] = kalman(___,type)

説明

[kalmf,L,P] = kalman(sys,Q,R,N) は、プラント モデルを sys およびノイズ共分散データを Q、R、N としてカルマン フィルターを作成します。この関数では、次のブロック線図に示す設定のカルマン推定器で使用するカルマン フィルターを計算します。

既知入力を u およびプロセス ノイズ入力を w としてモデル sys を作成し、w が sys への最後の N_w 入力で構成されるようにします。"真" のプラント出力 y_t は、sys のすべての出力で構成されています。ノイズの共分散データ Q、R および N も指定します。返されるカルマン フィルター kalmf は、既知入力 u とノイズを含む測定値 y を取り、真のプラント出力の推定 $$\widehat{y}$$ とプラント状態の推定 $$\widehat{x}$$ を生成する状態空間モデルです。kalman は、カルマン ゲイン L と定常偏差の共分散行列 P も返します。

[kalmf,L,P] = kalman(sys,Q,R,N,sensors,known) は、次のいずれかまたは両方の条件が満たされる場合にカルマン フィルターを計算します。

• sys のすべての出力が観測されない。

• 外乱入力 w が sys の最後の入力ではない。

インデックス ベクトルの sensors は、sys のどの出力が観測されるか指定します。これらの出力で y が構成されます。インデックス ベクトル known は、どの入力を既知 (確定的) にするかを指定します。既知入力で u が構成されます。kalman コマンドは、確率的入力 w になる sys の残りの入力を取ります。

[kalmf,L,P,Mx,Z,My] = kalman(___) は、離散時間 sys の場合、イノベーション ゲイン Mx と My および定常偏差の共分散 P と Z も返します。この構文は、前記のすべての入力引数の組み合わせで使用できます。

[kalmf,L,P,Mx,Z,My] = kalman(___,type) は、離散時間 sys に対する推定器のタイプを指定します。

• type = 'current' — $$y[n]$$ までの使用可能なすべての測定値を使用して、出力推定 $$\widehat{y}[n|n]$$ および状態推定 $$\widehat{x}[n|n]$$ を計算します。

• type = 'delayed' — $$y\left[n-1\right]$$ までの測定値のみを使用して、出力推定 $$\widehat{y}[n|n-1]$$ および状態推定 $$\widehat{x}[n|n-1]$$ を計算します。遅延推定器は制御ループ内で実装する方が簡単です。

type 入力引数は、前記のすべての入力引数の組み合わせで使用できます。

例

SISO プラント用のカルマン フィルターの設計

以下のブロック線図に示されているように、入力に加法性ホワイト ノイズ "w" および出力に "v" をもつプラントに対するカルマン フィルターを設計します。

プラントは、次の状態空間行列をもち、サンプル時間が指定されていない (Ts = -1) 離散時間プラントであると仮定します。

A = [1.1269   -0.4940    0.1129 
     1.0000         0         0 
          0    1.0000         0];

B = [-0.3832
      0.5919
      0.5191];

C = [1 0 0];

D = 0;

Plant = ss(A,B,C,D,-1);
Plant.InputName = 'un';
Plant.OutputName = 'yt';

kalman を使用するには、ノイズ w の入力をもつモデル sys を指定しなければなりません。したがって、Plant は入力 un = u + w を取るため、sys は Plant とは同じにはなりません。ノイズ入力の加算結合を作成して、sys を作成できます。

Sum = sumblk('un = u + w');
sys = connect(Plant,Sum,{'u','w'},'yt');

同様に、sys = Plant*[1 1] を使用できます。

ノイズ共分散を指定します。プラントには 1 つのノイズ入力と 1 つの出力があるため、これらの値はスカラーになります。実際には、これらの値はシステムのノイズ源のプロパティであり、システムの測定値またはその他の情報により判別します。この例では、両方のノイズ源に単位共分散があり、相関していない (N = 0) ものと仮定します。

Q = 1;
R = 1;
N = 0;

フィルターを設計します。

[kalmf,L,P] = kalman(sys,Q,R,N);
size(kalmf)

State-space model with 4 outputs, 2 inputs, and 3 states.

カルマン フィルター kalmf は、2 つの入力と 4 つの出力をもつ状態空間モデルです。kalmf は、入力としてプラント入力信号 "u" とノイズを含むプラント出力 $$y=y_t+v$$ を取ります。最初の出力は、推定された真のプラント出力 $$\underset{}{\overset{ˆ}{y}}$$ です。残りの 3 つの出力は、状態推定値 $$\underset{}{\overset{ˆ}{x}}$$ です。kalmf の入力名と出力名を調べて、kalman でそれらに適宜ラベル付けされていることを確認します。

kalmf.InputName

ans = 2x1 cell
    {'u' }
    {'yt'}

kalmf.OutputName

ans = 4x1 cell
    {'yt_e'}
    {'x1_e'}
    {'x2_e'}
    {'x3_e'}

カルマン ゲイン L を調べます。3 つの状態をもつ SISO プラントの場合、L は 3 要素の列ベクトルになります。

L

L = 3×1

    0.3586
    0.3798
    0.0817

kalmf を使用してノイズによる測定誤差を削減する方法を示す例については、カルマン フィルター処理を参照してください。

MIMO プラント用のカルマン フィルターの設計

3 つの入力をもち、その中の 1 つがプロセス ノイズ "w"、2 つが測定出力を表すプラントについて考えます。プラントには次の 4 つの状態があります。

次の状態空間行列と仮定して、sys を作成します。

A = [-0.71  0.06 -0.19 -0.17;
      0.06 -0.52 -0.03  0.30;
     -0.19 -0.03 -0.24 -0.02;
     -0.17  0.30 -0.02 -0.41];

B = [ 1.44  2.91   0;
     -1.97  0.83 -0.27;
     -0.20  1.39  1.10;
     -1.2   0    -0.28];

C = [ 0    -0.36 -1.58 0.28;
     -2.05  0     0.51 0.03];

D = zeros(2,3);

sys = ss(A,B,C,D);
sys.InputName = {'u1','u2','w'};
sys.OutputName = {'y1','y2'};

プラントに 1 つのプロセス ノイズ入力のみがあるため、共分散 "Q" はスカラーになります。この例では、プロセス ノイズに単位共分散があるものと仮定します。

Q = 1;

kalman は、Q の次元を使用して、既知入力はどれで、ノイズ入力はどれかを判別します。スカラー Q の場合、他に指定しない限り、kalman は 1 つがノイズ入力と仮定し、最後の入力を使用します (非測定出力をもつプラントを参照)。

2 つの出力の測定ノイズについては、2 行 2 列のノイズ共分散行列を指定します。この例では、最初の出力に単位分散を使用し、2 番目の出力に 1.3 の分散を使用します。非対角要素値を 0 に設定して、2 つのノイズ チャネルが無相関であることを示します。

R = [1 0;
     0 1.3];

カルマン フィルターを設計します。

[kalmf,L,P] = kalman(sys,Q,R);

入力と出力を調べます。kalman は、kalmf の入力と出力が表す内容を追跡するのに役立つ、kalmf の InputName プロパティ、OutputName プロパティ、InputGroup プロパティ、および OutputGroup プロパティを使用します。

kalmf.InputGroup

ans = struct with fields:
     KnownInput: [1 2]
    Measurement: [3 4]

kalmf.InputName

ans = 4x1 cell
    {'u1'}
    {'u2'}
    {'y1'}
    {'y2'}

kalmf.OutputGroup

ans = struct with fields:
    OutputEstimate: [1 2]
     StateEstimate: [3 4 5 6]

kalmf.OutputName

ans = 6x1 cell
    {'y1_e'}
    {'y2_e'}
    {'x1_e'}
    {'x2_e'}
    {'x3_e'}
    {'x4_e'}

したがって、2 つの既知入力 u1 および u2 は kalmf の最初の 2 つの入力で、2 つの測定出力 y1 および y2 は kalmf への最後の 2 つの入力です。kalmf の出力では、最初の 2 つが推定出力で、残りの 4 つが状態推定です。カルマン フィルターを使用するには、カルマン フィルター処理で SISO プラントについて説明されている方法と類似の方法で、これらの入力をプラントとノイズ信号に接続します。

非測定出力をもつプラント

4 つの入力と 2 つの出力をもつプラントについて考えます。最初の入力と 3 番目の入力は既知ですが、2 番目と 4 番目の入力はプロセス ノイズを表します。プラントには 2 つの出力もありますが、2 番目の出力のみ測定されます。

次の状態空間行列を使用して、sys を作成します。

A = [-0.37  0.14 -0.01  0.04;
     0.14 -1.89  0.98 -0.11;
    -0.01  0.98 -0.96 -0.14;
     0.04 -0.11 -0.14 -0.95];

B = [-0.07 -2.32  0.68  0.10;
     -2.49  0.08  0     0.83;
      0    -0.95  0     0.54;
     -2.19  0.41  0.45  0.90];

C = [ 0     0    -0.50 -0.38;
     -0.15 -2.12 -1.27  0.65];

D = zeros(2,4);

sys = ss(A,B,C,D,-1);    % Discrete with unspecified sample time

sys.InputName = {'u1','w1','u2','w2'};
sys.OutputName = {'yun','ym'};

kalman を使用してこのシステムのフィルターを設計するには、入力引数 known および sensors を使用して、既知となるプラントへの入力と、測定される出力を指定します。

known = [1 3];
sensors = [2];

ノイズ共分散を指定して、フィルターを設計します。

Q = eye(2);
R = 1;
N = 0;

[kalmf,L,P] = kalman(sys,Q,R,N,sensors,known); 

kalmf の入力ラベルと出力ラベルを調べると、フィルターが必要とする入力と、フィルターで返される出力がわかります。

kalmf.InputGroup

ans = struct with fields:
     KnownInput: [1 2]
    Measurement: 3

kalmf.InputName

ans = 3x1 cell
    {'u1'}
    {'u2'}
    {'ym'}

kalmf は、入力として sys の 2 つの既知入力および sys のノイズを含む測定出力を取ります。

kalmf.OutputGroup

ans = struct with fields:
    OutputEstimate: 1
     StateEstimate: [2 3 4 5]

kalmf の最初の出力は、測定されたプラント出力の真の値の推定値です。残りの出力は、状態推定値です。

入力引数

sys — プロセス ノイズを含むプラント モデル

ss モデル

プロセス ノイズを含むプラント モデル。状態空間 (ss) モデルとして指定します。プラントは、既知入力 u とホワイト プロセス ノイズ入力 w をもちます。プラント出力 yt には、測定ノイズは含まれません。

次のようなプラント モデルの状態空間行列を作成できます。

$$A,[BG],C,[DH]$$

kalman では、出力にガウス ノイズ v を仮定します。したがって、連続時間の場合、kalman が機能する状態空間方程式は次のようになります。

$$\begin{array}{l}\dot{x}=Ax+Bu+Gw\\ y=Cx+Du+Hw+v\end{array}$$

離散時間の場合、状態空間方程式は次のようになります。

$$\begin{array}{l}x[n+1]=Ax[n]+Bu[n]+Gw[n]\\ y[n]=Cx[n]+Du[n]+Hw[n]+v[n]\end{array}$$

known 入力引数を使用しない場合、kalman は Q のサイズを使用して、ノイズ入力である sys の入力を判別します。この例では、kalman は最後の N_w = size(Q,1) 入力をノイズ入力として扱います。ノイズ入力 w が sys の最後の入力でない場合、known 入力引数を使用して既知のプラント入力を指定できます。kalman では、残りの入力を確率的として扱います。

プラント行列のプロパティに対する追加の制約については、制限を参照してください。

Q — プロセス ノイズ共分散

スカラー | 行列

プロセス ノイズ共分散。スカラーまたは N_w 行 N_w 列の行列として指定します。ここで N_w はプラントのノイズ入力の数です。kalman は Q のサイズを使用して、ノイズ入力である sys の入力を判別し、known 入力引数で他に指定しない限り、ノイズである最後の N_w = size(Q,1) 入力を取ります。

kalman は、プロセス ノイズ w が共分散 Q = E(ww^T) をもつガウス ノイズであると仮定します。プラントに 1 つのプロセス ノイズ入力のみがある場合、Q は w の分散と等しいスカラーになります。プラントに複数の無相関のノイズ入力がある場合、Q は対角行列になります。実際には、測定を行うか、システムのノイズ プロパティについての、経験や知識に基づく推測によって、Q の適切な値を特定します。

R — 測定ノイズ共分散

スカラー | 行列

測定ノイズ共分散。スカラーまたは N_y 行 N_y 列の行列として指定します。ここで N_y はプラント出力の数です。kalman は、測定ノイズ v が共分散 R = E(vv^T) をもつホワイト ノイズであると仮定します。プラントに 1 つの出力チャネルのみがある場合、R は v の分散と等しいスカラーになります。プラントに、無相関の測定ノイズをもつ複数の出力チャネルがある場合、R は対角行列になります。実際には、測定を行うか、システムのノイズ プロパティについての、経験や知識に基づく推測によって、R の適切な値を特定します。

測定ノイズ共分散に対する追加の制約については、制限を参照してください。

N — ノイズ相互共分散

0 (既定値) | スカラー | 行列

ノイズ相互共分散。スカラーまたは N_w 行 N_y 列の行列として指定します。kalman は、プロセス ノイズ w と測定ノイズ v が N = E(wv^T) を満たすことを前提としています。2 つのノイズ源が相関しない場合は、N を省略できます。これは N = 0 と設定するのと同じです。実際には、測定を行うか、システムのノイズ プロパティについての、経験や知識に基づく推測によって、N の適切な値を特定します。

sensors — sys の測定された出力

ベクトル

sys の測定された出力。測定される sys の出力を特定するインデックスのベクトルとして指定します。たとえば、システムに 3 つの出力があっても、測定されるのは、sys の最初と 3 番目の出力にあたる 2 つの出力であるとします。この場合は、sensors = [1 3] と設定します。

known — sys の既知入力

ベクトル

sys の既知入力。既知 (確定的) の入力を特定するインデックスのベクトルとして指定します。たとえば、システムに 3 つの入力があっても、既知となるのは最初と 2 番目の入力のみです。この場合は、known = [1 2] と設定します。kalman は、sys の残りのすべての入力を確率的と解釈します。

type — 離散時間推定器のタイプ

'current' (既定値) | 'delayed'

離散時間推定器のタイプ。'current' または 'delayed' として指定します。この入力は離散時間 sys にのみ関連します。

• 'current' — $$y[n]$$ までの使用可能なすべての測定値を使用して、出力推定 $$\widehat{y}[n|n]$$ および状態推定 $$\widehat{x}[n|n]$$ を計算します。

• 'delayed' — $$y\left[n-1\right]$$ までの測定値のみを使用して、出力推定 $$\widehat{y}[n|n-1]$$ および状態推定 $$\widehat{x}[n|n-1]$$ を計算します。遅延推定器は制御ループ内で実装する方が簡単です。

kalman での現在の推定値と遅延推定値の計算方法の詳細については、離散時間の推定を参照してください。

出力引数

kalmf — カルマン推定器

ss モデル

カルマン推定器 (カルマン フィルター)。状態空間 (ss) モデルとして返されます。結果として得られる推定器には、入力 $$[u;y]$$ および出力 $$\left[\widehat{y};\widehat{x}\right]$$ があります。言い換えれば、kalmf は入力としてプラント入力 u およびノイズを含むプラント出力 y を取り、出力として、推定されたノイズのないプラント出力 $$\widehat{y}$$ および推定状態値 $$\widehat{x}$$ を生成します。

kalman では、kalmf の InputName、OutputName、InputGroup、および OutputGroup プロパティが自動的に設定されるため、どの信号にどの入力と出力が対応するのか追跡できます。

kalmf の状態方程式と出力方程式については、連続時間の推定および離散時間の推定を参照してください。

L — フィルター ゲイン

配列

フィルター ゲイン。N_x 行 N_y 列のサイズの配列として返されます。ここで N_x はプラント内の状態の数、N_y はプラント出力の数です。連続時間の場合、カルマン フィルターの状態方程式は次のようになります。

$$\dot{\widehat{x}}=A\widehat{x}+Bu+L(y-C\widehat{x}-Du).$$

離散時間の場合、状態方程式は次のようになります。

$$\widehat{x}[n+1|n]=A\widehat{x}[n|n-1]+Bu[n]+L(y[n]-C\widehat{x}[n|n-1]-Du[n]).$$

これらの方程式と L の計算方法の詳細については、連続時間の推定および離散時間の推定を参照してください。

P, Z — 定常偏差の共分散

配列

定常偏差の共分散。N_x 行 N_x 列として返されます。ここで N_x はプラント内の状態の数です。カルマン フィルターは、P を最小化する状態推定値を計算します。連続時間の場合、定常偏差の共分散は、次で求められます。

$$P=\underset{t\to \infty }{\lim }E\left(\left\{x-\widehat{x}\right\}{\left\{x-\widehat{x}\right\}}^T\right).$$

離散時間の場合、定常偏差の共分散は、次で求められます。

$$\begin{array}{l}P=\underset{n\to \infty }{\lim }E\left(\left\{x\left[n\right]-\widehat{x}\left[n|n-1\right]\right\}{\left\{x\left[n\right]-\widehat{x}\left[n|n-1\right]\right\}}^T\right),\\ Z=\underset{n\to \infty }{\lim }E\left(\left\{x\left[n\right]-\widehat{x}\left[n|n\right]\right\}{\left\{x\left[n\right]-\widehat{x}\left[n|n\right]\right\}}^T\right).\end{array}$$

これらの数量と kalman でのそれらの使用方法の詳細については、連続時間の推定および離散時間の推定を参照してください。

Mx, My — 状態推定器のイノベーション ゲイン

配列

離散時間システムの状態推定器のイノベーション ゲイン。配列として返されます。

Mx および My は、type = 'current' の場合にのみ関連します。これは離散時間システムの既定の推定器です。連続時間 sys または type = 'delayed' の場合、Mx = My = [] となります。

'current' タイプの推定器の場合、Mx および My は、更新の式におけるイノベーション ゲインです。

$$\widehat{x}\left[n|n\right]=\widehat{x}\left[n|n-1\right]+M_x\left(y\left[n\right]-C\widehat{x}\left[n|n-1\right]-Du\left[n\right]\right)$$

$$\widehat{y}\left[n|n\right]=C\widehat{x}\left[n|n-1\right]+Du\left[n\right]+M_y\left(y\left[n\right]-C\widehat{x}\left[n|n-1\right]-Du\left[n\right]\right)$$

ノイズ入力 w からプラント出力 y への直達がない場合 (つまり、H = 0 の場合、離散時間の推定を参照)、$$M_y=C{M}_x$$ となり、出力の推定値は $$\widehat{y}\left[n|n\right]=C\widehat{x}\left[n|n\right]+Du\left[n\right]$$ に単純化されます。

配列 Mx および My の次元は、次のように sys の次元によって異なります。

• Mx — N_x 行 N_y 列です。ここで N_x はプラント内の状態の数、N_y は出力の数です。

• My — N_y 行 N_y 列です。

kalman による Mx および My の取得の詳細については、離散時間の推定を参照してください。

制限

プラントとノイズ データは以下の条件を満たさなければなりません。

• (C,A) は検出可能です。ここで

• $$\overline{R}>0$$ および $$\left[\begin{array}{cc}\overline{Q}& \overline{N};\begin{array}{cc}{\overline{N}}^{\prime }& \overline{R}\end{array}\end{array}\right]\ge 0$$ となり、ここで

  $$\left[\begin{array}{cc}\overline{Q}& \overline{N}\\ {\overline{N}}^{\prime }& \overline{R}\end{array}\right]=\left[\begin{array}{cc}G& 0\\ H& I\end{array}\right]\left[\begin{array}{cc}Q& N\\ N^{\prime }& R\end{array}\right]{\left[\begin{array}{cc}G& 0\\ H& I\end{array}\right]}^{\prime }.$$

• $$(A-\overline{N}{\overline{R}}^{-1}C,\overline{Q}-\overline{N}{\overline{R}}^{-1}{\overline{N}}^T)$$ は、連続時間の場合は虚軸または離散時間の場合は単位円に非可制御モードがありません。

アルゴリズム

連続時間の推定

既知入力 u、プロセス ノイズ w、および測定ノイズ v をもつ連続時間プラントについて考えます。

$$\begin{array}{l}\dot{x}=Ax+Bu+Gw\\ y=Cx+Du+Hw+v\end{array}$$

ノイズ信号 w および v は次を満たします。

$$E(w)=E(v)=0,E(w{w}^T)=Q,E(v{v}^T)=R,E(w{v}^T)=N$$

カルマン フィルター、つまりカルマン推定器は、定常偏差の共分散を最小化する状態推定値 $$\widehat{x}(t)$$ を計算します。

$$P=\underset{t\to \infty }{\lim }E\left(\left\{x-\widehat{x}\right\}{\left\{x-\widehat{x}\right\}}^T\right).$$

カルマン フィルターは、次の状態方程式と出力方程式をもっています。

$$\begin{array}{l}\frac{d\widehat{x}}{dt}=A\widehat{x}+Bu+L(y-C\widehat{x}-Du)\\ \left[\begin{array}{c}\widehat{y}\\ \widehat{x}\end{array}\right]=\left[\begin{array}{c}C\\ I\end{array}\right]\widehat{x}+\left[\begin{array}{c}D\\ 0\end{array}\right]u\end{array}$$

フィルター ゲイン L を取得するために、kalman は代数リカッチ方程式を解きます。

$$L=(P{C}^T+\overline{N}){\overline{R}}^{-1}$$

ここで、

$$\begin{array}{l}\overline{R}=R+HN+N^T{H}^T+HQ{H}^T\\ \overline{N}=G(Q{H}^T+N)\end{array}$$

P は対応する代数リカッチ方程式を解きます。

推定器は既知の入力 u と測定値 y を使用して、出力と状態の推定 $$\widehat{y}$$ および $$\widehat{x}$$ を生成します。

離散時間の推定

離散プラントは、次のように求められます。

$$\begin{array}{l}x[n+1]=Ax[n]+Bu[n]+Gw[n]\\ y[n]=Cx[n]+Du[n]+Hw[n]+v[n]\end{array}$$

離散時間の場合、ノイズ信号 w および v は次を満たします。

$$E(w[n]w{[n]}^T)=Q,E(v[n]v{[n]}^T)=R,E(w[n]v{[n]}^T)=N$$

離散時間推定器は、次の状態方程式をもっています。

$$\widehat{x}[n+1|n]=A\widehat{x}[n|n-1]+Bu[n]+L(y[n]-C\widehat{x}[n|n-1]-Du[n]).$$

kalman は離散リカッチ方程式を解いて、ゲイン行列 L を取得します。

$$L=(AP{C}^T+\overline{N}){(CP{C}^T+\overline{R})}^{-1}$$

ここで、

$$\begin{array}{l}\overline{R}=R+HN+N^T{H}^T+HQ{H}^T\\ \overline{N}=G(Q{H}^T+N)\end{array}$$

kalman は離散時間のカルマン推定器の 2 つのバリアント、現在の推定器 (type = 'current') と遅延推定器 (type = 'delayed') を計算できます。

• 現在の推定器 — $$y[n]$$ までの使用可能なすべての測定値を使用して、出力推定 $$\widehat{y}[n|n]$$ および状態推定 $$\widehat{x}[n|n]$$ を生成します。この推定器は、次の出力方程式をもっています。

  $$\left[\begin{array}{c}\widehat{y}\left[n|n\right]\\ \widehat{x}\left[n|n\right]\end{array}\right]=\left[\begin{array}{c}\left(I-M_y\right)C\\ I-M_{x}C\end{array}\right]\widehat{x}\left[n|n-1\right]+\left[\begin{array}{cc}\left(I-M_y\right)D& M_y\\ -M_{x}D& M_x\end{array}\right]\left[\begin{array}{c}u\left[n\right]\\ y\left[n\right]\end{array}\right].$$

  ここで、イノベーション ゲイン M_x および M_y は次のように定義されます。

  $$\begin{array}{c}{M}_x=P{C}^T{\left(CP{C}^T+\overline{R}\right)}^{-1},\\ M_y=\left(CP{C}^T+HQ{H}^T+HN\right){\left(CP{C}^T+\overline{R}\right)}^{-1}.\end{array}$$

  したがって、M_x は、新しい測定値 $$y[n]$$ を使用して状態推定 $$\widehat{x}[n|n-1]$$ を更新します。

  $$\widehat{x}\left[n|n\right]=\widehat{x}\left[n|n-1\right]+M_x\left(y\left[n\right]-C\widehat{x}\left[n|n-1\right]-Du\left[n\right]\right)$$

  同様に、M_y は更新された出力推定を計算します。

  $$\widehat{y}\left[n|n\right]=C\widehat{x}\left[n|n-1\right]+Du\left[n\right]+M_y\left(y\left[n\right]-C\widehat{x}\left[n|n-1\right]-Du\left[n\right]\right)$$

  H = 0 の場合、$$M_y=C{M}_x$$ となり、出力推定は $$\widehat{y}\left[n|n\right]=C\widehat{x}\left[n|n\right]+Du\left[n\right]$$ に単純化されます。

• 遅延推定器 — y_v[n–1] までの測定値のみを使用して、出力推定 $$\widehat{y}[n|n-1]$$ と状態推定 $$\widehat{x}[n|n-1]$$ を生成します。この推定器は次の出力方程式をもっています。

  $$\left[\begin{array}{c}\widehat{y}[n|n-1]\\ \widehat{x}[n|n-1]\end{array}\right]=\left[\begin{array}{c}C\\ I\end{array}\right]\widehat{x}[n|n-1]+\left[\begin{array}{cc}D& 0\\ 0& 0\end{array}\right]\left[\begin{array}{c}u[n]\\ y[n]\end{array}\right]$$

  遅延推定器は制御ループ内で展開する方が簡単です。

バージョン履歴

R2006a より前に導入

参考

ブロック

• Kalman Filter

トピック

• カルマン フィルター処理
• X 軸に対する LQG 設計