JP7348468B2 - むだ時間推定装置及びそれを備えた試験装置 - Google Patents

Description

本発明は、制御対象のむだ時間を推定するむだ時間推定装置及びそれを備えた試験装置に関する。

制御対象を制御する際に、サンプリング周期及び制御装置内での通信等によって、前記制御対象に実際に入力される指令が入力指令に対して遅れることが知られている。このような遅れは、一般的にむだ時間と呼ばれる。このむだ時間は、前記制御対象の制御に影響を与えることが知られている。

例えば、ＰＩＤ制御において、むだ時間の影響により応答性を向上できない場合がある。

制御の応答性を向上するために、例えば特許文献１に開示されている制御装置では、目標値とフィードバック値とに基づいて制御対象に対する操作量を演算する操作量演算手段の入力側に、むだ時間補償器の出力を与えるむだ時間補償制御を行う。すなわち、前記制御装置では、目標応答時には、いわゆるスミス補償法によるむだ時間補償制御を行う。

これにより、制御対象の応答値を目標値に高速に到達させることができるとともに、オーバーシュートの発生を抑制することができる。

特開２００３－１６７６０５号公報

ところで、上述のようなむだ時間補償制御を行う場合、制御対象のむだ時間の推定精度が重要である。すなわち、上述のむだ時間補償制御を行う場合には、制御対象のむだ時間に応じてフィードバック値を調整するため、前記むだ時間が誤差を有すると、むだ時間補償制御の制御性能に影響を与える。

むだ時間の推定精度は、上述のむだ時間補償制御だけでなく、むだ時間の影響を受ける他の制御系設計においても制御性能に影響を与えるため、重要である。

本発明の目的は、制御対象のむだ時間を精度良く推定可能なむだ時間推定装置を提供することにある。

本発明の一実施形態に係るむだ時間推定装置は、制御対象のむだ時間を推定するむだ時間推定装置である。このむだ時間推定装置は、前記制御対象の伝達関数からむだ時間要素を除いた要素の周波数特性をＧ＾／ｅ^{-L^}′^1sとし、前記制御対象においてむだ時間要素を含まない伝達関数をＧ＾′とした場合に、式（１）の評価関数Ｊの値が最小になるむだ時間Ｌ＾′１を求めるむだ時間演算部を備える（第１の構成）。

これにより、制御対象のむだ時間を精度良く推定することができる。すなわち、むだ時間及び該むだ時間を除いた伝達関数をそれぞれ変数として、前記制御対象の伝達関数からむだ時間要素を除いた要素の周波数特性と、前記制御対象のむだ時間要素を含まない伝達関数とを用いて表される（１）式の評価関数において、該評価関数の値が最小になるむだ時間を求めることにより、前記制御対象のむだ時間を精度良く推定することができる。

よって、むだ時間推定装置によって推定したむだ時間を用いて前記制御対象を制御することにより、前記むだ時間の推定誤差の影響を抑えて、前記制御対象を、設計した制御系で制御することができる。

前記第１の構成において、むだ時間推定装置は、前記制御対象のむだ時間初期値を求めるむだ時間初期値取得部と、前記むだ時間初期値を用いて前記むだ時間要素を求めて、前記制御対象の伝達関数から前記むだ時間要素を除いた要素の周波数特性をＧ＾／ｅ^{-L^}′^1sとして求める周波数特性取得部と、を備える（第２の構成）。

これにより、制御対象のむだ時間を短時間で精度良く推定することができる。すなわち、むだ時間初期値取得部は、むだ時間初期値として、前記制御対象のむだ時間の真値により近い値を求めることができるため、むだ時間演算部で演算に用いる上述の（１）式において考慮するむだ時間に、より精度の良いむだ時間初期値を用いることができる。これにより、むだ時間演算部によって前記制御対象のむだ時間を迅速に求めることができる。

前記第２の構成において、前記むだ時間演算部は、前記むだ時間初期値を基準とした所定の範囲内で、且つ、前記評価関数Ｊの値が最小になるような前記むだ時間Ｌ＾′１を求める（第３の構成）。

これにより、むだ時間初期値を精度良く求められない場合であっても、むだ時間演算部によって、制御対象のむだ時間を精度良く推定することができる。

前記第２または第３の構成において、むだ時間推定装置は、前記制御対象に信号を入力して、その応答結果から伝達関数を取得する伝達関数取得部をさらに備える。前記むだ時間初期値取得部は、前記伝達関数取得部によって取得された前記伝達関数の制御対象に所定の入力信号を入力した場合に得られる応答信号から、前記むだ時間初期値を求める（第４の構成）。

これにより、制御対象に入力信号を入力してむだ時間初期値を求めることができない場合でも、前記制御対象の伝達関数を求めた後、該伝達関数に所定の入力信号を入力した場合の応答信号から、前記むだ時間初期値を求めることができる。よって、前記制御対象の前記むだ時間初期値を精度良く求めることができる。

前記第４の構成において、前記むだ時間初期値取得部は、前記応答信号において、所定の閾値を超えるまでの時間を、前記むだ時間初期値として求める（第５の構成）。これにより、制御対象のむだ時間初期値を容易に求めることができる。

前記第４または第５の構成において、前記所定の入力信号は、ステップ信号である（第６の構成）。これにより、制御対象のむだ時間初期値を、伝達関数に対するステップ応答によって、容易に求めることができる。

本発明の一実施形態に係る試験装置は、供試体に対して駆動力を与える制御対象と、前記制御対象を制御する制御装置と、前記制御装置に対し、推定したむだ時間を出力する、第１から第６の構成のうちいずれか一つに記載のむだ時間推定装置と、を備える（第７の構成）。

これにより、供試体の試験装置において、前記供試体に駆動力を与える制御対象のむだ時間を、むだ時間推定装置で精度良く推定することができる。よって、制御対象を、設計した制御系で制御することができるため、試験装置を精度良く駆動することができる。

本発明の一実施形態に係るむだ時間推定装置は、制御対象の伝達関数からむだ時間要素を除いた要素の周波数特性をＧ＾／ｅ^{-L^}′^1sとし、前記制御対象のむだ時間要素を含まない伝達関数をＧ＾′とした場合に、式（１）の評価関数Ｊの値が最小になるむだ時間Ｌ＾′１を求める。これにより、制御対象のむだ時間を精度良く推定することができる。

図１は、実施形態１に係るむだ時間推定装置を備えた試験装置の概略構成を示す機能ブロック図である。 図２は、実施形態１に係る制御装置のブロック線図である。 図３は、むだ時間の推定精度による違いを説明するための制御系を用いた場合のボード線図である。 図４は、むだ時間推定装置の動作の一例を示すフローチャートである。 図５は、実施形態２に係るむだ時間推定装置を備えた試験装置の概略構成を示す機能ブロック図である。 図６は、制御対象にランダム信号を入力して測定した周波数特性と、評価関数を用いて求めた伝達関数との関係の一例を示す図である。 図７は、ステップ応答の一例を示す図である。 図８は、実測したステップ応答の一例と、モデルを用いて求めたステップ応答の一例とを比較して示す図である。 図９は、むだ時間推定装置の動作の一例を示すフローチャートである。 図１０は、その他の実施形態に係る制御装置のブロック線図である。

以下、図面を参照し、本発明の実施の形態を詳しく説明する。図中の同一または相当部分については同一の符号を付してその説明は繰り返さない。

＜実施形態１＞
（全体構成）
図１は、本発明の実施形態１に係るむだ時間推定装置６を備えた試験装置１の概略構成を機能ブロックで示す図である。この試験装置１は、自動車のモータなどの供試体Ｍの特性を試験するための試験装置である。なお、試験装置１で試験する供試体Ｍは、モータ以外の回転体であってもよい。

具体的には、試験装置１は、制御装置２と、モータ駆動回路３と、電動モータ４と、トルク検出器５と、むだ時間推定装置６とを備える。

制御装置２は、入力指令であるモータトルク指令ｒと後述のフィードバック値とを用いて、モータ駆動回路３に対する駆動指令を生成する。制御装置２は、トルク検出器５の出力値を用いてモータトルク指令ｒに対して負帰還するフィードバックループ１０を有する（図２参照）。なお、制御装置２が前記駆動指令を生成する構成は、従来と同様であるため、制御装置２の詳しい説明は省略する。フィードバックループ１０の構成については後述する。

モータ駆動回路３は、特に図示しないが、複数のスイッチング素子を有する。モータ駆動回路３は、前記駆動指令に基づいて前記複数のスイッチング素子が駆動することにより、電動モータ４の図示しないコイルに電力を供給する。

電動モータ４は、図示しない回転子及び固定子を有する。前記固定子のコイルにモータ駆動回路３から電力が供給されることにより、前記回転子が前記固定子に対して回転する。前記回転子は、図示しない中間軸を介して、供試体Ｍに対し、供試体Ｍと一体で回転可能に連結されている。これにより、前記回転子の回転によって、電動モータ４から供試体Ｍにトルクを出力することができる。なお、電動モータ４の構成は、一般的なモータの構成と同様であるため、電動モータ４の詳しい説明は省略する。

トルク検出器５は、電動モータ４と供試体Ｍとを接続する中間軸に設けられている。トルク検出器５は、電動モータ４から出力されたトルクを検出する。トルク検出器５で検出されたトルクの出力値は、制御装置２にフィードバックループ１０の入力値として入力される。すなわち、トルク検出器５の出力値は、フィードバック制御に用いられる。なお、トルク検出器５の構成は、従来の構成と同様であるため、トルク検出器５の詳しい説明は省略する。

本実施形態において、制御装置２は、図２に示すように、入力指令であるモータトルク指令ｒに対してトルク検出器５の出力値をフィードバックするフィードバックループ１０を有する。すなわち、本実施形態の試験装置１は、制御装置２、モータ駆動回路３、電動モータ４及びトルク検出器５を含み且つ供試体Ｍを含まない制御系によって、電動モータ４の駆動を制御する。

なお、図２において、ｒはモータトルク指令としての目標値であり、ｙはトルク検出器５の出力値であり、Ｋ_Dは微分係数であり、ｓは微分要素であり、Ｆｄはフィルタ５２の伝達関数である。

また、図２における符号Ｐは制御対象であり、本実施形態では、制御対象Ｐは、モータ駆動回路３、電動モータ４及びトルク検出器５を含む。なお、制御対象Ｐには、電動モータ４と供試体Ｍとを接続する中間軸のうち、電動モータ４からトルク検出器５までの範囲も含む。すなわち、制御対象Ｐは、供試体Ｍに駆動力を与える。

フィードバックループ１０は、微分要素ｓを含む微分フィードバック系である。フィードバックループ１０には、トルク検出器５の出力値が入力される。フィードバックループ１０は、減衰比調整部５１と、フィルタ５２とを有する。減衰比調整部５１は、微分要素ｓ及び微分係数Ｋ_Dによって、制御対象に対する減衰比を調整する。フィルタ５２は、トルク検出器５の出力値からむだ時間の影響を排除する。フィードバックループ１０では、トルク検出器５の出力値は、フィルタ５２及び減衰比調整部５１によって処理された後、フィードバック値としてモータトルク指令ｒに負帰還される。

ところで、試験装置１において制御対象Ｐを制御する際には、制御装置２のサンプリング周期及び通信等によって、モータトルク指令ｒに対して供試体Ｍに入力されるトルクが遅れを生じる。このような遅れは、いわゆるむだ時間と呼ばれ、制御対象Ｐの制御に影響を与える。

よって、むだ時間を考慮して制御系を設計する場合、制御対象Ｐのむだ時間を精度良く推定し、推定したむだ時間を用いて制御対象Ｐを制御する必要がある。例えば、むだ時間を考慮してフィードフォワード制御系を設計した場合、図３に示すように、推定したむだ時間に誤差がない場合（図３の実線）に対して、推定したむだ時間に誤差がある場合には、破線及び一点鎖線のように、設計した制御性能と異なる特性になる。

むだ時間推定装置６は、制御対象Ｐのむだ時間を推定する。本実施形態の場合、むだ時間推定装置６によって推定されたむだ時間は、制御装置２のフィルタ５２において、トルク検出器５の出力値からむだ時間の影響を考慮する際に用いられる。

なお、以下の説明では、文章表記の都合上、数式及び図において各文字の上に付される“＾”を、各文字の後ろに記載する。

図１に示すように、むだ時間推定装置６は、周波数特性取得部１１と、初期値設定部１２と、むだ時間演算部１３とを備える。

周波数特性取得部１１は、制御対象Ｐにランダム信号（信号）を入力して周波数特性Ｇ（応答結果）を取得する前記ランダム信号は、予測できない変動を有する信号である。本実施形態では、前記ランダム信号として、例えばホワイトノイズの信号を用いる。

初期値設定部１２は、むだ時間推定装置６で用いる、むだ時間初期値Ｌ＾１及びむだ時間要素を除いた伝達関数を取得する。前記むだ時間初期値及びむだ時間要素を除いた伝達関数は、図示しない記憶部に予め記憶されていてもよいし、むだ時間推定装置６に入力されたデータから得た値であってもよい。

むだ時間演算部１３は、初期値設定部１２で取得したむだ時間初期値Ｌ＾１及び制御対象Ｐの伝達関数からむだ時間要素を除いた要素の周波数特性Ｇ＾／ｅ^{－Ｌ＾´１ｓ}をそれぞれ変数として、制御対象Ｐにおいてむだ時間要素を含まない伝達関数Ｇ＾´と前記変数とで構成される式（１）の評価関数Ｊの値が最小になるＬ＾´１を求める。具体的には、むだ時間演算部１３は、式（１）を用いて、シンプレックス法などの手法によって、最適解を求める。

以上のように式（１）式を用いて制御対象Ｐにおけるむだ時間Ｌ＾´１を求めることにより、むだ時間Ｌ＾´１を精度良く求めることができる。

上述の構成を有するむだ時間推定装置６を、試験装置１が有することにより、供試体Ｍに駆動力を与える制御対象Ｐのむだ時間を、むだ時間推定装置６で精度良く推定することができる。よって、制御対象Ｐを、設計した制御系で制御することができるため、むだ時間の推定誤差の影響を抑えて、試験装置１を精度良く駆動することができる。

（むだ時間推定装置の動作）
次に、上述の構成を有するむだ時間推定装置６の動作を、図４に示すフローを用いて説明する。

図４に示すフローがスタートすると、ステップＳＡ１において、むだ時間推定装置６の周波数特性取得部１１は、制御対象Ｐにランダム信号を入力する。続くステップＳＡ２で、周波数特性取得部１１は、制御対象Ｐにランダム信号を入力した際の出力から周波数特性Ｇを測定する。

その後、ステップＳＡ３で、むだ時間演算部１３は、初期値設定部１２で取得したむだ時間初期値Ｌ＾１及び制御対象Ｐの伝達関数からむだ時間要素を除いた要素の周波数特性Ｇ＾／ｅ^{－Ｌ＾´１ｓ}をそれぞれ変数として、制御対象Ｐにおいてむだ時間要素を含まない伝達関数Ｇ＾´と前記変数とで構成される既述の式（１）の評価関数Ｊの値が最小になるＬ＾´１を求める。具体的には、むだ時間演算部１３は、既述の式（１）を用いて、シンプレックス法などの手法によって、最適解を求める。

これにより、制御対象Ｐのむだ時間Ｌ＾´１を精度良く求めることができる。

＜実施形態２＞
（全体構成）
図５に、実施形態２に係るむだ時間推定装置６０を備えた試験装置１０１の概略構成を機能ブロックで示す。この試験装置１０１は、むだ時間推定装置６０の構成以外は、実施形態１の試験装置１と同様の構成を有する。よって、以下では、実施形態１と同様の構成については同一の符号を付して説明を省略し、実施形態１と異なる部分についてのみ説明する。

なお、以下の説明でも、文章表記の都合上、数式及び図において各文字の上に付される“＾”を、各文字の後ろに記載する。

図５に示すように、むだ時間推定装置６０は、伝達関数取得部６１と、むだ時間初期値取得部６２と、周波数特性取得部６３と、むだ時間演算部６４とを備える。

伝達関数取得部６１は、制御対象Ｐにランダム信号（信号）を入力して得られた周波数特性Ｇ（応答結果）から、制御対象Ｐの伝達関数Ｇ＾を取得する。制御対象Ｐにランダム信号を入力して得られた周波数特性Ｇの一例を図６に実線で示す。伝達関数Ｇ＾は、後述のむだ時間初期値取得部６２でむだ時間初期値Ｌ＾１を取得するために用いられる伝達関数である。前記ランダム信号は、予測できない変動を有する信号である。本実施形態では、前記ランダム信号として、例えばホワイトノイズの信号を用いる。

伝達関数取得部６１は、式（２）の評価関数Ｊ０の値が最小になる伝達関数Ｇ＾を求める。具体的には、伝達関数取得部６１は、式（２）の評価関数Ｊ０の値が最小になるように、式（３）に示す伝達関数の一般式における、分母及び分子の次数、ａ₀～ａ_mの値及びｂ₀～ｂ_nの値を求める。図６に、評価関数Ｊ０の値が最小になる伝達関数Ｇ＾を求める際に繰り返し演算で得られる伝達関数の計算結果の一例（計算例）を、破線で示す。

むだ時間初期値取得部６２は、伝達関数取得部６１で取得した伝達関数Ｇ＾を用いて、制御対象Ｐのむだ時間初期値Ｌ＾１を取得する。具体的には、むだ時間初期値取得部６２は、伝達関数Ｇ＾を有する制御対象Ｐのモデルに対してステップ信号（所定の入力信号）を入力することにより得られるステップ応答から、むだ時間初期値Ｌ＾１を取得する。図７に、前記ステップ応答の一例を示す。本実施形態では、図７に示すように、むだ時間初期値取得部６２は、前記ステップ応答において、前記ステップ信号の入力時（図７における時間０）から出力値が閾値Ｘを超えるまでの時間を、むだ時間初期値Ｌ＾１として取得する。閾値Ｘは、例えば、ステップ応答の収束値に対して所定の割合（例えば１０％）の値に設定される。

なお、むだ時間初期値取得部６２は、前記ステップ応答において、前記ステップ信号の入力時から出力値の移動平均値が閾値を超えるまでの時間を、むだ時間初期値Ｌ＾１として取得してもよい。

ところで、トルク指令によって駆動されるモータにステップ信号を入力した場合、前記モータが加速し続けて該モータの速度上限に達する可能性がある。そのため、前記ステップ信号の調整が必要である。これに対し、上述のように、制御対象Ｐの伝達関数Ｇ＾を求めるとともに、その伝達関数Ｇ＾を有するモデルに対してステップ信号を入力してステップ応答を得ることにより、制御対象Ｐに対してステップ信号を直接入力しなくても、制御対象Ｐにおけるむだ時間初期値Ｌ＾１を取得できる。したがって、前記ステップ信号の調整が不要になり、制御対象Ｐにおけるむだ時間初期値Ｌ＾１を容易に取得できる。

また、上述のようにむだ時間初期値Ｌ＾１を求めることにより、制御対象Ｐの周波数特性Ｇを取得する過程及び伝達関数Ｇ＾を推定する過程の少なくとも一方の過程において、ノイズ処理を行うことにより、伝達関数Ｇ＾を有するモデルのステップ応答にノイズの影響が現れにくくすることができる。図８に、ステップ応答の実測結果と、上述のように伝達関数Ｇ＾を有するモデルを用いて求めたステップ応答とを比較して示す。図８に示すように、ノイズの少ない周波数特性を得ることができる。これにより、前記ステップ応答から、むだ時間初期値Ｌ＾１を容易に取得することができる。

なお、制御対象Ｐに対してステップ信号を入力することにより得られるステップ応答から、むだ時間初期値を取得してもよい。この場合にも、得られたステップ応答において、前記ステップ信号の入力時から出力値が閾値Ｘを超えるまでの時間を、前記むだ時間初期値として取得してもよいし、前記ステップ信号の入力時から出力値の移動平均値が閾値を超えるまでの時間を、前記むだ時間初期値として取得してもよい。

周波数特性取得部６３は、伝達関数取得部６１で取得した伝達関数Ｇ＾と、むだ時間初期値取得部６２で取得したむだ時間初期値Ｌ＾１を用いて求められるむだ時間要素ｅ^{-L^}´^1sとを用いて、伝達関数Ｇ＾からむだ時間初期値Ｌ＾１を用いて求められるむだ時間要素を除いたＧ＾／ｅ^{-L^}´^1sの周波数特性を求める。

ここで、Ｌ＾´１は、例えば、以下の関係を満たす値である。なお、Ｌ＾´１は、Ｌ＾１を基準とした他の範囲で規定された値であってもよい。
Ｌ＾１ｍｉｎ＝Ｌ＾１－Ｌ＾１／１０
Ｌ＾１ｍａｘ＝Ｌ＾１＋Ｌ＾１／１０
Ｌ＾１ｍｉｎ≦Ｌ＾´１≦Ｌ＾１ｍａｘ

むだ時間演算部６４は、式（１）の評価関数Ｊの値が最小になるＬ＾´１を求める。

なお、式（１）において、Ｇ＾／ｅ^{-L^}´^1sの導出には、伝達関数取得部６１で求めたＧ＾を用いてもよいし、制御対象Ｐにランダム信号を入力して得られた周波数特性Ｇを用いてもよい。

これにより、Ｌ＾１ｍｉｎ≦Ｌ＾´１≦Ｌ＾１ｍａｘを満たすＬ＾´１のうち、式（１）の評価関数Ｊの値が最小になる値を求めることができる。このように、むだ時間初期値Ｌ＾１を基準とした所定の範囲内で且つ式（１）の評価関数Ｊの値が最小になる値を求めることにより、むだ時間初期値Ｌ＾１を精度良く求めることができない場合でも、制御対象Ｐのむだ時間を精度良く推定することができる。

以上のように式（１）式を用いて制御対象Ｐにおけるむだ時間Ｌ＾´１を求めることにより、むだ時間Ｌ＾´１を精度良く求めることができる。

しかも、本実施形態のようにむだ時間初期値Ｌ＾１を求めることにより、制御対象Ｐのむだ時間により近いむだ時間初期値を求めることができる。よって、実施形態１の構成に比べて、制御対象Ｐのむだ時間を迅速に推定することができる。

（むだ時間推定装置の動作）
次に、上述の構成を有するむだ時間推定装置６０の動作を、図９に示すフローを用いて説明する。

図９に示すフローがスタートすると、ステップＳＢ１において、むだ時間推定装置６０の伝達関数取得部６１は、制御対象Ｐにランダム信号を入力する。続くステップＳＢ２で、伝達関数取得部６１は、制御対象Ｐにランダム信号を入力した際の出力から周波数特性Ｇを測定する。その後、ステップＳＢ３で、伝達関数取得部６１は、周波数特性Ｇを用いて、既述の式（２）の評価関数Ｊ０が最小になるように制御対象Ｐの伝達関数Ｇ＾を推定する。

次に、むだ時間初期値取得部６２は、伝達関数Ｇ＾を有する制御対象Ｐのモデルに対してステップ信号を入力して、ステップ応答を取得する（ステップＳＢ４）。その後、むだ時間初期値取得部６２は、前記ステップ応答から、むだ時間初期値Ｌ＾１を取得する（ステップＳＢ５）。この際、むだ時間初期値取得部６２は、前記ステップ応答において、ステップ信号の入力から出力値が閾値を超えるまでの時間を、むだ時間初期値Ｌ＾１として取得する。

続くステップＳＢ６では、周波数特性取得部６３は、ステップＳＢ３で取得した伝達関数Ｇ＾からむだ時間初期値Ｌ＾１を用いて求められるむだ時間要素を除いたＧ＾／ｅ^{-L^}´^1sの周波数特性を求める。ここで、Ｌ＾´１は、例えば、以下の関係を満たす値である。
Ｌ＾１ｍｉｎ＝Ｌ＾１－Ｌ＾１／１０
Ｌ＾１ｍａｘ＝Ｌ＾１＋Ｌ＾１／１０
Ｌ＾１ｍｉｎ≦Ｌ＾´１≦Ｌ＾１ｍａｘ

そして、ステップＳＢ６では、むだ時間演算部６４は、既述の式（１）の評価関数Ｊが最小になるように制御対象Ｐにおけるむだ時間Ｌ＾´１を求める。

これにより、制御対象Ｐのむだ時間Ｌ＾´１を精度良く求めることができる。

（その他の実施形態）
以上、本発明の実施の形態を説明したが、上述した実施の形態は本発明を実施するための例示に過ぎない。よって、上述した実施の形態に限定されることなく、その趣旨を逸脱しない範囲内で上述した実施の形態を適宜変形して実施することが可能である。

前記各実施形態では、制御装置２は、微分フィードバック系を有する。しかしながら、制御装置は、制御対象におけるむだ時間が影響する制御系であれば、他の制御系を有していてもよい。

例えば、制御装置１０２は、図１０に示す２自由度制御系を有していてもよい。制御装置１０２は、フィードフォワードループ１２０を有する。制御装置１０２では、フィードフォワードループ１２０で伝達関数の逆モデルを用いている。そのため、むだ時間を除いた伝達関数を求める必要がある。よって、制御装置１０２では、制御性能を向上するために、むだ時間を精度良く推定することが要求される。

なお、図１０において、符号１１２は、フィードバック系のコントローラである。また、符号１１１，１２１は、フィードフォワード系のコントローラである。

前記実施形態２では、むだ時間初期値取得部６２は、伝達関数Ｇ＾を有する制御対象Ｐのモデルに対してステップ信号を入力することにより得られるステップ応答から、むだ時間初期値Ｌ＾１を取得する。しかしながら、むだ時間初期値取得部は、前記モデルにおけるランプ応答から、むだ時間初期値を取得してもよい。すなわち、むだ時間初期取得部は、応答から、むだ時間初期値を取得できれば、前記モデルに対してどのような種類の信号を入力してもよい。なお、得られるむだ時間初期値の精度を考慮すると、前記モデルからステップ応答を得るのが最も好ましい。

前記各実施形態では、制御対象Ｐは、モータ駆動回路３、電動モータ４及びトルク検出器５を含む。しかしながら、制御対象は、供試体に駆動力を与えることができる構成を有していれば、他の構成を含んでもよいし、他の構成を有する軸系を含んでいてもよい。

前記各実施形態では、むだ時間推定装置６，６０は、試験装置１に設けられている。しかしながら、むだ時間推定装置は、むだ時間の推定を必要とする他の装置に設けられていてもよいし、単独で構成されていてもよい。

本発明は、制御対象のむだ時間を推定するむだ時間推定装置に利用可能である。

１、１０１ 試験装置
２、１０２ 制御装置
３ モータ駆動回路
４ 電動モータ
５ トルク検出器
６、６０ むだ時間推定装置
１０ フィードバックループ
１１、６３ 周波数特性取得部
１２、６４ 初期値設定部
１３ むだ時間演算部
５１ 減衰比調整部
５２ フィルタ
６１ 伝達関数取得部
６２ むだ時間初期値取得部
１１２ フィードバック系のコントローラ
１２０ フィードフォワードループ
１１１、１２１ フィードフォワード系のコントローラ
Ｐ 制御対象
Ｍ 供試体

Claims (7)

1. 制御対象のむだ時間を推定するむだ時間推定装置であって、
   前記制御対象の伝達関数からむだ時間要素を除いた要素の周波数特性をＧ＾／ｅ^{-L^}′^1sとし、前記制御対象においてむだ時間要素を含まない伝達関数をＧ＾′とした場合に、式（１）の評価関数Ｊの値が最小になるむだ時間Ｌ＾′１を求めるむだ時間演算部を備える、むだ時間推定装置。
   

   
2. 請求項１に記載のむだ時間推定装置において、
   前記制御対象のむだ時間初期値を求めるむだ時間初期値取得部と、
   前記むだ時間初期値を用いて前記むだ時間要素を求めて、前記制御対象の伝達関数から前記むだ時間要素を除いた要素の周波数特性をＧ＾／ｅ^{-L^}′^1sとして求める周波数特性取得部と、
   を備える、むだ時間推定装置。
3. 請求項２に記載のむだ時間推定装置において、
   前記むだ時間演算部は、前記むだ時間初期値を基準とした所定の範囲内で、且つ、前記評価関数Ｊの値が最小になるような前記むだ時間Ｌ＾′１を求める、むだ時間推定装置。
4. 請求項２または３に記載のむだ時間推定装置において、
   前記制御対象に信号を入力して、その応答結果から伝達関数を取得する伝達関数取得部をさらに備え、
   前記むだ時間初期値取得部は、前記伝達関数取得部によって取得された前記伝達関数の制御対象に所定の入力信号を入力した場合に得られる応答信号から、前記むだ時間初期値を求める、むだ時間推定装置。
5. 請求項４に記載のむだ時間推定装置において、
   前記むだ時間初期値取得部は、前記応答信号において、所定の閾値を超えるまでの時間を、前記むだ時間初期値として求める、むだ時間推定装置。
6. 請求項４または５に記載のむだ時間推定装置において、
   前記所定の入力信号は、ステップ信号である、むだ時間推定装置。
7. 供試体に対して駆動力を与える制御対象と、
   前記制御対象を制御する制御装置と、
   前記制御装置に対し、推定したむだ時間を出力する、請求項１から６のいずれか一つに記載のむだ時間推定装置と、
   を備える、試験装置。

Images