離散時間システムの指令値追従問題において,シングルレート系の枠組みで不安定零点の影響を考慮した制御手法として零位相/振幅誤差追従制御が提案されている。
不安定零点が存在する場合には完全追従の実現が困難であるため,これらは入出力の振幅誤差を許容して位相誤差を零とする,または位相誤差を許容して振幅誤差を零とすることを目標とした制御器である。
零位相/振幅誤差追従制御器の導出では,複素共役の性質を利用すると見通しが良い。設計目標は入出力伝達関数の整形であるため,振幅・位相特性を示す周波数伝達関数を確認することを目的とし,
z = e j ω t z=e^{j\omega t} z = e jω t として議論する。
z z z が単位円上に存在する場合,その複素共役は次のように表される。
z ‾ = e − j ω t = z − 1 \begin{align}
\overline{z} = e^{-j\omega t} = z^{-1}
\end{align} z = e − jω t = z − 1
2. 多項式の複素共役
z z z の実係数多項式について,その複素共役は次のように表される。
F ( z ) = ∑ k = 1 p a k z k ( a k ∈ R , a k ‾ = a k ) F ( z ) ‾ = ∑ k = 1 p a k z k ‾ = ∑ k = 1 p a k z k ‾ = F ( z ‾ ) = F ( z − 1 ) \begin{align}
F(z) &= \sum^{p}_{k=1} a_{k}z^{k} \quad (a_{k}\in\mathbb{R}, \quad \overline{a_{k}} = a_{k})\\
\overline{F(z)} &= \sum^{p}_{k=1} \overline{a_{k}z^{k}} = \sum^{p}_{k=1} a_{k}\overline{z^{k}} = F(\overline{z}) = F(z^{-1})
\end{align} F ( z ) F ( z ) = k = 1 ∑ p a k z k ( a k ∈ R , a k = a k ) = k = 1 ∑ p a k z k = k = 1 ∑ p a k z k = F ( z ) = F ( z − 1 )
3. 多項式とその複素共役の積
z z z の実係数多項式とその複素共役の積はその実係数多項式の絶対値の二乗となり,さらに次の等式が成立する。
∣ F ( z ) ∣ 2 = F ( z ) F ( z ) ‾ = F ( z ) F ( z − 1 ) \begin{align}
|F(z)|^2 = F(z)\overline{F(z)} = F(z)F(z^{-1})
\end{align} ∣ F ( z ) ∣ 2 = F ( z ) F ( z ) = F ( z ) F ( z − 1 )
4. 多項式とその複素共役のノルム
z z z の実係数多項式とその複素共役のノルムは一致し,さらに次の等式が成立する。
∣ F ( z ) ∣ = ∣ F ( z ) ‾ ∣ = ∣ F ( z − 1 ) ∣ \begin{align}
|F(z)| = |\overline{F(z)}| = |F(z^{-1})|
\end{align} ∣ F ( z ) ∣ = ∣ F ( z ) ∣ = ∣ F ( z − 1 ) ∣
離散時間システムの入出力関係が,既約な有理関数形式の伝達関数
G ( z ) G(z) G ( z ) を用いて以下のように表現される場合について考える。
y [ k ] = G ( z ) r [ k ] G ( z ) = B ( z ) A ( z ) z − p \begin{align}
y[{\rm k}] &= G(z)r[{\rm k}]\\
G(z) &=\frac{B(z)}{A(z)}z^{-{\rm p}}
\end{align} y [ k ] G ( z ) = G ( z ) r [ k ] = A ( z ) B ( z ) z − p
ただし,このシステムは安定であり,
r r r を入力値,
y y y を出力値とする。参照軌道
y d y_{\rm d} y d は事前に決定されており,未来値が使用可能であるとする。離散時間システム
G ( z ) G(z) G ( z ) が不安定零点を持たない場合,次の入力決定則により完全追従が実現する。
r [ k ] = A ( z ) B ( z ) y d [ k + p ] \begin{align}
r[{\rm k}] &= \frac{A(z)}{B(z)}y_{\rm d}[{\rm k}+{\rm p}]
\end{align} r [ k ] = B ( z ) A ( z ) y d [ k + p ]
しかしながら,システムが持つ真性零点やサンプラ・ホールダの影響により発生する
離散化零点 が離散時間システムに不安定零点を与える場合には,この入力決定則を利用することはできない。このようなシステムに対して,所望の振幅・位相特性を与える入力決定則を導出する。
離散時間システムの伝達関数
G ( z ) G(z) G ( z ) について,分子を安定零点を持つ多項式
B s ( z ) B_{\rm s}(z) B s ( z ) と不安値零点持つ多項式
B u ( z ) B_{\rm u}(z) B u ( z ) に分離して表現する。
G ( z ) = B s ( z ) B u ( z ) A ( z ) z − d \begin{align}
G(z) &=\frac{B_{\rm s}(z)B_{\rm u}(z)}{A(z)}z^{-d} \
\end{align} G ( z ) = A ( z ) B s ( z ) B u ( z ) z − d
このシステムに対し,不安定逆系の要因となる
B u ( z ) B_{\rm u}(z) B u ( z ) を無視して逆系を作れば,以下のような出力を得る
[1] 。
r [ k ] = A ( z ) B s ( z ) y d [ k + p ] y [ k ] = B u ( z ) y d [ k ] \begin{align}
r[{\rm k}] &= \frac{A(z)}{B_{\rm s}(z)}y_{\rm d}[{\rm k}+{\rm p}]\\
y[{\rm k}] &= B_{\rm u}(z)y_{\rm d}[{\rm k}]
\end{align} r [ k ] y [ k ] = B s ( z ) A ( z ) y d [ k + p ] = B u ( z ) y d [ k ]
上記の決定則では不安定零点の影響が出力に残ることとなり,望ましい出力を得られない場合がある。そこで,入力整形フィルタ
F ( z ) F(z) F ( z ) を導入して入出力伝達特性を整形する。
r [ k ] = A ( z ) B s ( z ) F ( z ) y d [ k + p ] y [ k ] = B u ( z ) F ( z ) y d [ k ] \begin{align}
r[{\rm k}] &= \frac{A(z)}{B_{\rm s}(z)}F(z)y_{\rm d}[{\rm k}+{\rm p}]\\
y[{\rm k}] &= B_{\rm u}(z)F(z)y_{\rm d}[{\rm k}]
\end{align} r [ k ] y [ k ] = B s ( z ) A ( z ) F ( z ) y d [ k + p ] = B u ( z ) F ( z ) y d [ k ]
追従制御系の設計目標は,参照軌道から出力までの伝達関数
G d ( z ) G_{\rm d}(z) G d ( z ) が所望の特性を持つように
F ( z ) F(z) F ( z ) を設計することとなる。
G d ( z ) = B u ( z ) F ( z ) \begin{align}
G_{\rm d}(z) &= B_{\rm u}(z)F(z)
\end{align} G d ( z ) = B u ( z ) F ( z )
零位相誤差追従制御(Zero phase error tracking control: ZPETC)は入力と出力の振幅差を許容するが位相差を零とする制御である
[2] 。位相誤差が零となるためには,周波数伝達関数
G d ( e j ω t ) G_{\rm d}(e^{j\omega t}) G d ( e jω t ) が実数値を取る必要がある。これは次の入力整形フィルタ
F ( z ) F(z) F ( z ) によって達成される。
F ( z ) = B u ( z ) ‾ K = B u ( z − 1 ) K → G d ( z ) = B u ( z ) B u ( z − 1 ) K = ∣ B u ( z ) ∣ 2 K \begin{align}
F(z) &= \overline{B_{\rm u}(z)}K = B_{\rm u}(z^{-1})K \\
\rightarrow G_{\rm d}(z) &= B_{\rm u}(z)B_{\rm u}(z^{-1})K = |B_{\rm u}(z)|^2K
\end{align} F ( z ) → G d ( z ) = B u ( z ) K = B u ( z − 1 ) K = B u ( z ) B u ( z − 1 ) K = ∣ B u ( z ) ∣ 2 K
ただし,
K K K は定数ゲインであり,DCゲイン
G d ( z ) ∣ z = 1 = 1 G_{\rm d}(z)|_{z=1}=1 G d ( z ) ∣ z = 1 = 1 とするためには次のように設計すれば良い。
K = 1 ∣ B u ( 1 ) ∣ 2 → F ( z ) = B u ( z − 1 ) ∣ B u ( 1 ) ∣ 2 \begin{align}
K &= \frac{1}{|B_{\rm u}(1)|^{2}}\\
\rightarrow F(z) &= \frac{B_{\rm u}(z^{-1})}{|B_{\rm u}(1)|^{2}}
\end{align} K → F ( z ) = ∣ B u ( 1 ) ∣ 2 1 = ∣ B u ( 1 ) ∣ 2 B u ( z − 1 )
以上より,零位相誤差追従制御では入力を次のように決定する。
r [ k ] = A ( z ) B u ( z − 1 ) B s ( z ) ∣ B u ( 1 ) ∣ 2 y d [ k + p ] \begin{align}
r[{\rm k}] &= \frac{A(z)B_{\rm u}(z^{-1})}{B_{\rm s}(z)|B_{\rm u}(1)|^{2}} y_{\rm d}[{\rm k}+{\rm p}]
\end{align} r [ k ] = B s ( z ) ∣ B u ( 1 ) ∣ 2 A ( z ) B u ( z − 1 ) y d [ k + p ]
また,このときの入出力関係は次のように記述される。
y [ k ] = ∣ B u ( z ) ∣ 2 ∣ B u ( 1 ) ∣ 2 y d [ k ] \begin{align}
y[{\rm k}] &= \frac{|B_{\rm u}(z)|^2}{|B_{\rm u}(1)|^{2}} y_{\rm d}[{\rm k}]
\end{align} y [ k ] = ∣ B u ( 1 ) ∣ 2 ∣ B u ( z ) ∣ 2 y d [ k ]
零振幅誤差追従制御(Zero magnitude error tracking control: ZMETC)は入力と出力の位相差を許容するが振幅差を零とする制御である
[3] 。振幅誤差が零となるためには,周波数伝達関数
G d ( e j ω t ) G_{\rm d}(e^{j\omega t}) G d ( e jω t ) の分母と分子のノルムが一致する必要がある。これは次の入力整形フィルタ
F ( z ) F(z) F ( z ) によって達成される。
F ( z ) = 1 B u ( z ) ‾ = 1 B u ( z − 1 ) → G d ( z ) = B u ( z ) B u ( z − 1 ) = e j 2 arg B u ( z ) \begin{align}
F(z) &= \frac{1}{\overline{B_{\rm u}(z)}} = \frac{1}{B_{\rm u}(z^{-1})} \\
\rightarrow G_{\rm d}(z) &= \frac{B_{\rm u}(z)}{B_{\rm u}(z^{-1})} = e^{j2\arg B_{u}(z)}
\end{align} F ( z ) → G d ( z ) = B u ( z ) 1 = B u ( z − 1 ) 1 = B u ( z − 1 ) B u ( z ) = e j 2 a r g B u ( z )
以上より,零位相誤差追従制御では入力を次のように決定する。
r [ k ] = A ( z ) B s ( z ) B u ( z − 1 ) y d [ k + p ] \begin{align}
r[{\rm k}] &= \frac{A(z)}{B_{\rm s}(z)B_{\rm u}(z^{-1})} y_{\rm d}[{\rm k}+{\rm p}]
\end{align} r [ k ] = B s ( z ) B u ( z − 1 ) A ( z ) y d [ k + p ]
また,このときの入出力関係は次のように記述される。
y [ k ] = e j 2 arg B u ( z ) y d [ k ] \begin{align}
y[{\rm k}] &= e^{j2\arg B_{u}(z)} y_{\rm d}[{\rm k}]
\end{align} y [ k ] = e j 2 a r g B u ( z ) y d [ k ]
[1] J. A. Butterworth, L. Y. Pao, and D. Y. Abramovitch, "Analysis and comparison of three discrete-time feedforward model-inverse control techniques for nonminimum-phase systems," in Mechatronics , vol. 22, no. 5, pp. 577–587, Aug. 2012.
[2] M. Tomizuka, "Zero phase error tracking algorithm for digital control," in Journal of Dynamic Systems, Measurement, and Control , vol. 109, pp. 65-68, Mar. 1987.
[3] J. Wen and B. Potsaid, "An experimental study of a high performance motion control system," in American Control Conference , vol. 6, pp. 5158–5163, 2004.