(57)【要約】【課題】回転テーブルの数値制御を行う場合、回転テーブル上に固定される搭載物によって、制御対象の慣性モーメントや重心が変化する。この変化に対応した数値制御装置を提供する。【解決手段】搭載物が固定された回転テーブルを対象プラント５０とし、これの実際の運動と、対象プラントの同定モデルにより算出された運動とを比較し、トルク指令値を修正する。同定モデルは、角加速度に係る項と、回転角に係る項とからなり、回転角に係る項を有することにより、重心の変化に対応したトルク指令の修正を行うことができる。【選択図】図１
2008171165.tif 000002
【特許請求の範囲】
【請求項１】
位置及び速度のフィードバックループと速度及び加減速トルクのフィードフォワードによりサーボトルクのトルク指令値を決定する構成を持ち、上位装置からの位置指令値に従って、数値制御機械の回転軸の回転角をサーボモータにより制御する位置制御装置であって、
前記回転軸の実際の運動に基づき、その角加速度および回転角に基づく信号ベクトルを生成する信号ベクトル生成部と、
前記回転軸の角加速度に関する項と回転角に関する項とからなる回転軸を含む対象プラントの運動方程式に基づく同定モデルに対し、前記信号ベクトルと回転軸換算のトルク指令値とから適用同定を行い、同定モデルの角加速度に関する項の係数に係る要素と、回転角に関する項の係数に係る要素とからなるパラメータベクトルの推定値を算出する適用ループ演算部と、
前記パラメータベクトルの推定値の、角加速度に関する項の係数に係る要素に基づき、慣性モーメント係数を算出する慣性モーメント係数演算部と、
前記パラメータベクトルの推定値の、回転角に関する項の係数に係る要素と、回転軸の回転角とに基づき、非線形要素トルク補償量を算出する非線形要素演算部と、
を有し、
前記慣性モーメント係数および前記非線形トルク補償量により前記トルク指令値を修正する、位置制御装置。
【請求項２】
請求項１に記載の位置制御装置であって、
さらに、前記適用ループ演算部の適用同定を行うか否かを制御するパラメータ同定制御部を有し、
前記パラメータ同定制御部は、速度フィードフォワード量の絶対値が所定値以下であり、かつ加速度フィードフォワード量が０でないとき、適用同定を行うよう制御する、
位置制御装置。
【請求項３】
請求項１に記載の位置制御装置であって、
さらに、前記パラメータベクトルの推定値の各要素と、あらかじめ定められた前記サーボモータの発生トルク制限値とに基づき、現在の条件下で、当該位置制御装置が達成可能な最大角速度を算出し、この達成可能な最大角速度を当該位置制御装置の上位装置に出力する制約情報演算部、
を有する位置制御装置。
【請求項４】
請求項１に記載の位置制御装置であって、
さらに、前記パラメータベクトルの推定値の回転角に関する項の係数に係る要素と、重力加速度と、回転軸の傾き角とに基づき、対象プラントの質量と、重心と回転中心軸の距離との積を算出し、これを制約情報として上位装置に出力する制約情報演算部、
を有する位置制御装置。
【発明の詳細な説明】
【技術分野】
【０００１】
本発明は、数値制御機械の回転軸に適用される位置制御装置に関するものである。
【背景技術】
【０００２】
図３は、制御対象プラントである回転軸の機構モデルの一例を示した図である。回転テーブル５０はサーボモータ（図示しない）により、Ｚu軸回りに回転角θの回転動作を行う。回転テーブル５０の重心Ｇの描く回転軌跡面とＺu軸との交点を原点Ｏuとして、回転軌跡面上で重力に対して垂直方向にＸu軸をとり、Ｚu軸，Ｘu軸と右手系を形成する様に、残りのＹu軸をとる。
【０００３】
重心Ｇは、原点Ｏuから距離Ｌで、θ＝０の時、角度ａの位置にあるものとする。回転テーブル５０は、都度、各種冶具・工具や加工対象物等が搭載固定されるため、負荷状態が変化し、重心Ｇも位置変動する。尚、ｇは重力加速度、角度ｂは重力に対する垂直平面とＹu軸との成す角である。
【０００４】
図４は、前述の様な回転軸の回転角θを、上位装置（図示しない）より関数発生された位置指令値θc通りに制御するための、従来位置制御装置２００の一例のブロック図である。
【０００５】
ここでは指令応答の高速化を図るため、フィードフォワード構成をとっている。具体的には、位置指令値θcは、微分器５４で時間微分されて、速度フィードフォワード量Ｖfとなり、更に、Ｖfは微分器５５で時間微分されて、加速度フィードフォワード量Ａfとなる。増幅器Ｃbにおける増幅率Ｃbは、加速度Ａfを回転軸に発生させるための、回転軸換算モータトルクに相当する加減速トルクフィードフォワード量τfを求める定数であり、通常、Ｃbは、回転軸換算されたモータを含む伝達系と、物体が搭載されていない回転テーブル５０単体の慣性モーメントに相当する。
【０００６】
従来位置制御装置のフィードバック構成は次の様になっている。まず、回転角検出器（図示しない）により検出された回転角θは、減算器５１により、位置指令値θcから減算され、その出力である位置偏差は位置偏差増幅器Ｇpで増幅される。その出力は、加算器５２で速度フィードフォワード量Ｖfと加算されて速度指令値Ｖcとなる。減算器５３は、速度指令値Ｖcから、回転角θを微分器５６で微分した回転角速度ωを減算し、その出力である速度偏差は、速度偏差増幅器Ｇvで、通常、比例積分増幅される。この出力と加減速トルクフィードフォワード量τfが、加算器５７で加算されて、回転軸換算トルク指令値τcとなり、電力増幅器ＣtでＣt倍される。Ｃtは、サーボモータ特性に応じて定める定数であり、この出力τがサーボモータの回転軸換算発生トルクとなって回転テーブル５０が駆動される。
【０００７】
【特許文献１】特開２００２−３６６２３０号公報
【特許文献２】特開２００３−３２３２１６号公報
【特許文献３】特許第３３５１９９０号明細書
【発明の開示】
【発明が解決しようとする課題】
【０００８】
以上のように、従来の位置制御装置では、制御系の内部安定性確保や重力に起因した非線形特性を補償するためのフィードバック制御に、指令応答の高速化を図るため、ノミナルな線形特性に対してフィードフォワード制御を付加した全体構成をとっている。しかしながら、回転テーブルには、前述の様に、都度、各種冶具・工具や加工対象物等が搭載固定されるため、慣性モーメントが増大し、重心が変動することになる。すると、加減速トルクフィードフォワード量τｆは不足し、フィードバック制御帯域は縮小し、且つ、重力に起因した非線形特性が増大するため、制御性が劣化して、位置決め性能の低下や位置決め時の位置決め角度による応答ばらつきが発生した。
【０００９】
また、これらの変動要素が把握できないために、上位装置側で、位置指令値θcを関数発生するための、加速度制約や遠心力による速度制約が判断できず、結果として、効率的な関数発生ができなかった。更に、減速機構を持たないダイレクトドライブ駆動適用時には、前述の変動要素が相対的に増大するため、これらの問題点が一層大きくなる傾向にあった。
【００１０】
本発明は上記従来技術の問題点を鑑み、慣性モーメントや重心の変動に応じて、好適に対応しうるフィードバック制御とフィードフォワード制御が構成された位置制御装置を提供することを目的とする。
【課題を解決するための手段】
【００１１】
本発明の位置制御装置においては、制御対象である数値制御機械の回転軸の実際の運動と、制御対象を数学モデルとして表した同定モデルにより算出された運動との誤差に基づき同定モデルの各パラメータを決定し、このパラメータに基づき制御対象への入力を修正する。
【００１２】
同定モデルは回転軸の運動を記述する運動方程式であり、角加速度に係る項と、回転角に係る項とからなる。この同定モデルに対し、制御対象の回転軸の実際の角加速度および回転角と、数値制御機械に対するトルク指令値に基づき同定モデルのパラメータの同定を行う。そして、同定されたパラメータを用いて、トルク指令値の修正を行い、現在の制御対象の条件に則した制御を行う。
【００１３】
特に、本発明の位置制御装置においては、同定モデルに回転角に係る項を含んでいる。これにより、回転角に依存して変動する負荷に対応してトルク指令値の修正を行うことができる。例えば、制御対象の重心が回転の軸線からずれており、その軸線が鉛直ではない場合には、重心に作用する重力により、負荷が回転角に依存して変動する。このような制御対象であっても、負荷変動に追従した制御を実行することができる。
【発明を実施するための最良の形態】
【００１４】
以下、図面に従って本発明の実施の形態を説明する。
【００１５】
図３の対象プラントに対して、その運動方程式を導出する。この場合、一般化座標系として、回転角θをとればよく、数式（１）の運動方程式が得られる。
【００１６】
τ＝（ＭＬ2＋Ｉz＋Ｉm）（ｄω/ｄｔ）＋Ｍ・ｇ・Ｌ・ＳＩＮｂ・ＣＯＳ(θ＋ａ)
・・・・・（１）
ここで、Ｍは搭載固定された各種冶具・工具や加工対象物を含む回転テーブル全体の質量，Ｉzは、重心Ｇを通るＺu軸の平行軸回りの回転テーブル全体の慣性モーメント，Ｉmは、モータを含む伝達系の回転軸換算慣性モーメントである。
【００１７】
今、数式（２），（３）で、３次元の信号ベクトルξとパラメータベクトルγを定義すると、（以降、ベクトルや行列の転置は右上にTを付して表す。）
ξ＝［ｄω/ｄｔ，ＣＯＳθ，−ＳＩＮθ］T  ・・・・・（２）
γ＝［ＭＬ2＋Ｉz＋Ｉm，ＭｇＬＳbＣa，ＭｇＬＳbＳa］T  ・・・・・（３）
（但し、Ｓb＝ＳＩＮｂ，Ｃa＝ＣＯＳａ，Ｓa＝ＳＩＮaと表記する。）
数式（１）の運動方程式は、数式（４）の実系モデルで表現できる。
τ＝Ｃt・τc＝ξTγ  ・・・・・（４）
【００１８】
図１は、本発明による位置制御装置１００の構成を示すブロック図である。尚、本ブロック図において、図４（従来例）と同一の部分においては、同一の名称及び番号をつけて説明を省略する。適応ループ演算部２は、トルク指令値τcと信号ベクトルξから、パラメータベクトルγの推定値である同定パラメータベクトルγIDを演算するブロックである。
【００１９】
図２は、適応ループ演算部２の構成を示すブロック図である。一般化適応則２１は、公知（「ロバスト適応制御入門  オーム社」ｐ６２など）の数式（５），（６）により、同定パラメータベクトルγIDを演算する。（以降、あるサンプリング時間毎の時系列信号においてkサイクル目の信号を(k)と表記する。）
γID(k)＝γID(k-1)−Ｐ(k-1)・ξ(k)・ξ(k)TΦ(k)  ・・・・・（５）
Ｐ(k)-1＝Ｃ1(k)・Ｐ(k-1)-1＋Ｃ2(k)・ξ(k)ξ(k)T  ・・・・・（６）
但し、０＜Ｃ1(k)≦１，０≦Ｃ2(k)＜２，Ｐ(０)＞０とする。
【００２０】
追従スカラ誤差ξ(k)TΦ(k)は、信号ベクトルξ(k)と同定パラメータベクトルγID(k)を乗算器２２で乗算して得たスカラ信号ξ(k)TγID(k)から、減算器２３でサーボモータの発生トルクτ(k)を差し引いた信号である。つまり、追従スカラ誤差ξ(k)TΦ(k)は、数式（５）も用いて、数式（７）で表現でき、これより、１サイクル前のγID(k-1)を利用して演算できる。
ξ(k)TΦ(k)＝ξ(k)TγID(k)−τ(k)
＝ξ(k)T[γID(k-1)−Ｐ(k-1)・ξ(k)・ξ(k)TΦ(k)]−τ(k) 
・・・・・（７）
【００２１】
ここで、信号ベクトルξ(k) Tを時系列に行方向に並べた、数式（８）の行列Ｋ(k)を考えた時、
Ｋ(k)＝［ξ(1)，ξ(2)，・・・，ξ(k)］T  ・・・・・（８）
行列Ｋ(k)が継続的に列フルランクであれば、k→∞で、γID(k)→γとなってパラメータ同定は成立し、更に、収束応答よりもパラメータベクトルγの変化が十分に遅ければ、変化に対して追従した同定パラメータベクトルγID(k)を得られることが知られている。
【００２２】
数式（６）で、任意のkにおいてＰ(k)＞０が保証されるため、Ｐ(k)の特異値σ（Ｐ(k)）は固有値λ（Ｐ(k)）に一致する。このため、あるタイミング以降で、数式（８）の行列Ｋ(k)が列フルランク性を失い続けると、Ｃ1(k)＜１の時、数式（６）は、λmax（Ｐ(k)）→∞となることを意味している。これは、Ｐ(k)のある要素｛ｐij｝→∞を意味するから、結局、Ｐ(k)を演算できなくなる事につながる。以上のことから、行列Ｋ(k)が列フルランク性を失い続けてもＰ(k)が有界に留まることと、Ｃ1(k)→１になることは等価であることがわかる。
【００２３】
本例では、公知の一般化適応則の中で、固定トレースアルゴリズムを利用する。これは、tr[Ｐ(k)]＞λmax（Ｐ(k)）である事から、任意のkで、tr[Ｐ(k)]＝tr[Ｐ(０)]：（一定値）と制御すればＰ(k)を有界に留めることができるからである。このために、数式（９）でＣ1(k)を決定する。
Ｃ1(k)＝１−[|Ｐ(k-1)ξ(k)|2/[Ｃ＋ξ(k)TＰ(k-1)ξ(k)]]・[1/tr[Ｐ(０)]]
・・・・・（９）
ここで、Ｃ＝Ｃ1(k)/Ｃ2(k) ：（一定値）＞0.5  である。
【００２４】
すると、前述のことから、行列Ｋ(k)が列フルランク性を失い続けてもＰ(k)が有界に留まるため、Ｃ1(k)→１になって、数式（９）よりＰ(k-1)ξ(k)→０、よって、数式（５）のパラメータ同定動作が停止することがわかる。逆に、行列Ｋ(k)が列フルランク性を回復すると、数式（６）より、λmax（Ｐ(k)）が小さくなり、tr[Ｐ(k)]が一定だから、他の固有値は大きくなる。すると数式（９）において、Ｃ1(k)は１より小さくなって、数式（５）のパラメータ同定動作が回復実行することになる。
【００２５】
図１に戻って、本実施例の動作について説明する。信号ベクトル生成部１は、回転角θに対して三角関数演算を行い、ＣＯＳθと−ＳＩＮθを演算し、回転角速度ωを微分してｄω/ｄｔを求める。つまり、信号ベクトル生成部１は、数式（２）における信号ベクトルξの元信号を生成するブロックになる。但し、この出力は、パラメータ同定制御部３の２値（１または０）出力ＩＤＣと乗算器４で乗算されて、適応ループ演算部２の入力である信号ベクトルξになる。
【００２６】
次に、パラメータ同定制御部３の動作について説明する。数式（１）の運動方程式は、対象プラントに加わる外乱や誤差を含めていない。このため、外乱や誤差が存在すると、同定結果に誤差が発生する。また、数式（８）の行列Ｋ(k)が列フルランク性を確保できないとパラメータ同定動作が機能しないことから、数式（２）の信号ベクトルξにおいて、ｄω/ｄｔ≠０であることがパラメータ同定の必要条件になる。更に、図１における電力増幅器Ｃtは、回転角速度ωが大きくなると制御性が低下して、正確にＣt倍の電力増幅が実現しにくくなる。
【００２７】
以上のことから、パラメータ同定制御部３では、速度フィードフォワード量Ｖf，加速度フィードフォワード量Ａf及び上位装置からのパラメータ同定制御２値信号ＯＩＤＣに対して、数式（１０）〜数式（１２）の論理式を設定し、２値信号ＩＤＣを出力し、パラメータ同定動作の実行/停止を制御する。数式（１２）を満たす場合、ＩＤＣとして１が出力される。
cond１＝（０＜Ｖf≦Ｖmax）∩（０＜Ａf）  ・・・・・（１０）
cond２＝（−Ｖmax≦Ｖf＜０）∩（Ａf＜０）  ・・・・・（１１）
ＩＤＣ＝（cond１∪cond２）∩ＯＩＤＣ  ・・・・・（１２）
【００２８】
ここで、Ｖmax（＞０）は、電力増幅器Ｃtが正確にＣt倍の電力増幅を行う速度制限値であり、cond１は正方向加速状態、cond２は負方向加速状態を抽出している。減速状態は位置決め時に制御パラメータ（後述するＧIDやτfn）が変化しない様、同定動作を停止させる。パラメータ同定制御２値信号ＯＩＤＣは、回転テーブル５０に外部環境からの接触や加工があり、外乱が加わると想定される場合に、上位装置から０を出力することで、パラメータ同定動作を停止させることができる。
【００２９】
適応ループ演算部２の同定パラメータベクトルγIDの第１要素は、数式（３）から、数式（１）の対象プラントにおける運動方程式の慣性モーメントの同定値（ＭＬ2＋Ｉz＋Ｉm）IDになる。慣性モーメント係数演算部５は、これを入力として、数式（１３）で慣性モーメント係数ＧIDを出力する。
ＧID＝（ＭＬ2＋Ｉz＋Ｉm）ID/（Ｃb・Ｃt）  ・・・・・（１３）
慣性モーメント係数ＧIDは、加算器５７出力と乗算器８で乗算される。このため、加減速トルクフィードフォワード量τfは、数式（１）の運動方程式における右辺第１項の線形部分に対応する好適な量になる。
【００３０】
また、モータを含む伝達系と回転テーブル５０単体の慣性モーメントに対応して初期設定された速度偏差増幅器Ｇvの伝達特性をＧv(s)とおくと、一定の速度制御ループ特性を与える伝達特性Ｇv'(s)は、数式（１４）を満たす必要がある。
Ｇv'(s)/（ＭＬ2＋Ｉz＋Ｉm）＝Ｇv(s)/（Ｃb・Ｃt）  ・・・・・（１４）
よって、数式（１３）の慣性モーメント係数ＧIDを乗ずることは、速度偏差増幅器Ｇvの伝達特性が、ＧID・Ｇv(ｓ)となって、数式（１４）のＧv'(s)に一致するため、速度制御ループ特性の一定化つまりは、位置ループを含めたフィードバック制御帯域の一定化が図れる。
【００３１】
適応ループ演算部２の同定パラメータベクトルγIDの第２，３要素は、数式（３）から、（ＭｇＬＳbＣa）ID，（ＭｇＬＳbＳa）IDになる。非線形要素演算部６は、位置指令値θcに対して三角関数演算を行い、ＣＯＳθcと−ＳＩＮθcを演算し、同定パラメータベクトルγIDの第２，３要素との間で、数式（１５）の演算により、非線形要素トルク補償量τfnを求める。
τfn＝（１/Ｃt）｛（ＭｇＬＳbＣa）ID・ＣＯＳθc
＋（ＭｇＬＳbＳa）ID・（−ＳＩＮθc）｝
・・・・・（１５）
ここで、Ｃt・τfnは、ＭｇＬＳb・ＣＯＳ（θc＋ａ）と見なせるから、数式（１）の対象プラントにおける運動方程式の非線形要素である右辺第２項の推定値になる。よって、τfnを加算器９で、乗算器８出力に加算することにより、非線形要素に対するフィードフォワード補償ができる。
【００３２】
制約情報演算部７では、適応ループ演算部２の同定パラメータベクトルγIDから、数式（１６）の演算を行う。
（ＭｇＬＳb）ID＝｛（ＭｇＬＳbＣa）ID2＋（ＭｇＬＳbＳa）ID2｝1/2 
・・・・・（１６）
（ＭｇＬＳb）IDは、非線形要素の最大振幅を意味するから、既知情報であるサーボモータの回転軸換算発生トルク制限値τLIMとの間で、数式（１７）の演算を行う。
ＡLIM＝｛τLIM−（ＭｇＬＳb）ID｝/（ＭＬ2＋Ｉz＋Ｉm）ID  ・・・・・（１７）
ＡLIMは、現在の負荷条件下で、位置制御装置が達成できる最大角加速度を示している。
【００３３】
次に、重力加速度ｇと角度ｂは既知であるから、数式（１６）の（ＭｇＬＳb）IDから、数式（１８）が演算できる。ＭＬIDは、現在の負荷条件下における（質量）×（重心と回転中心軸の距離）と見なせる。
ＭＬID＝（ＭｇＬＳb）ID/（ｇＳb）  ・・・・・（１８）
制約情報演算部７は、演算されたＡLIMとＭＬIDを、現在の負荷条件下における制約情報として、上位装置に出力する。これらの制御情報の範囲内で位置指令値θcの関数発生がなされる。
【００３４】
角速度ωと、本発明による位置制御装置より出力されるＭＬIDから求まるＭＬIDω2は、Ｚu軸つまりは、回転テーブル５０の回転中心軸に加わる遠心力と見なせる。このため、上位装置では、駆動部のラジアル荷重耐量から、許容できる最大角速度ＶLIMを求めることができ、前述の最大角加速度ＡLIMと合わせて、現在の負荷条件に応じた、位置指令値θcの最適な関数発生ができる。
【００３５】
本発明によれば、数値制御機械の回転軸における慣性モーメントや重心の変動に対して、フィードバック制御帯域の一定化が図れる。加えて、線形特性及び非線形特性に対しては、フィードフォワード制御の好適化が図れるため、制御性が劣化せず、位置決め性能の低下や位置決め時の位置決め角度による応答ばらつきを軽減できる。また、上位装置側で、負荷状態に応じた加速度制約や遠心力による速度制約が把握できるため、位置指令値θcの最適な関数発生が可能になる。更に、減速機構を持たないダイレクトドライブ駆動適用時には、これらによる制御効果が一層顕著になる。
【００３６】
［付記］
［１］
位置及び速度のフィードバックループと速度及び加減速トルクのフィードフォワードによりサーボトルクのトルク指令値（τ）を決定する構成を持ち、上位装置からの位置指令値（θｃ）に従って、数値制御機械の回転軸の回転角をサーボモータにより制御する位置制御装置であって、
前記回転軸の実際の運動に基づき、その角加速度（ｄω／ｄｔ）および回転角（θ）に基づく信号ベクトル（ξ）を生成する信号ベクトル生成部（１）と、
前記回転軸の角加速度に関する項と回転角に関する項とからなる回転軸を含む対象プラント（５０）の運動方程式（数式１）に基づく同定モデルに対し、前記信号ベクトルと回転軸換算のトルク指令値（τｃ）とから適用同定を行い、同定モデル（数式４）の角加速度に関する項の係数に係る要素（ＭＬ2＋Ｉｚ＋Ｉｍ）と、回転角に関する項の係数に係る要素（ＭｇＬＳｂＣａ，ＭｇＬＳｂＳａ）とからなるパラメータベクトルの推定値（γID）を算出する適用ループ演算部（２）と、
前記パラメータベクトルの推定値の、角加速度に関する項の係数に係る要素に基づき、慣性モーメント係数（ＧID）を算出する慣性モーメント係数演算部（５）と、
前記パラメータベクトルの推定値の、回転角に関する項の係数に係る要素と、回転軸の回転角とに基づき、非線形要素トルク補償量（τfn）を算出する非線形要素演算部（６）と、
を有し、
前記慣性モーメント係数および前記非線形トルク補償量により前記トルク指令値を修正する。
［２］
［１］に記載の位置制御装置であって、
さらに、前記適用ループ演算部の適用同定を行うか否かを制御するパラメータ同定制御部（３）を有し、
前記パラメータ同定制御部は、速度フィードフォワード量（Ｖｆ）の絶対値が所定値以下であり、かつ加速度フィードフォワード量（Ａｆ）が０でないとき、適用同定を行うよう制御する。
［３］
［１］に記載の位置制御装置であって、
さらに、前記パラメータベクトルの推定値の各要素と、あらかじめ定められた前記サーボモータの発生トルク制限値（τLIM）とに基づき、現在の条件下で、当該位置制御装置が達成可能な最大角速度（ＡLIM）を算出し、この達成可能な最大角速度を当該位置制御装置の上位装置に出力する制約情報演算部（７）、
を有する位置制御装置。
［４］
［１］に記載の位置制御装置であって、
さらに、前記パラメータベクトルの推定値の回転角に関する項に係る要素と、重力加速度（ｇ）と、回転軸の傾き角（ｂ）とに基づき、対象プラントの質量と、重心と回転中心軸の距離との積を算出し、これを制約情報として上位装置に出力する制約情報演算部、
を有する。
【図面の簡単な説明】
【００３７】
【図１】本実施形態の回転軸の位置制御装置の構成を示すブロック図である。
【図２】本実施形態の適応ループ演算部の構成を説明するブロック図である。
【図３】対象プラントである回転軸の概略機構モデルである。
【図４】従来の回転軸の位置制御装置の構成例を示すブロック図である。
【符号の説明】
【００３８】
１  信号ベクトル生成部、２  適応ループ演算部、３  パラメータ同定制御部、４，８,２２  乗算器、５  慣性モーメント係数演算部、６  非線形要素演算部、７  制約情報演算部、２１  一般化適応則、５０  対象プラント（回転テーブル）、θc  位置指令値、Ｇp  位置偏差増幅器、Ｖf  速度フィードフォワード量、Ｖc  速度指令値、Af  加速度フィードフォワード量、Ｃb  増幅器、Ｇv  速度偏差増幅器、τf  加減速トルクフィードフォワード量、θ  回転角、ω  回転角速度、τc  トルク指令値、Ｃt  電力増幅器、τ  モータ発生トルク、ＧID  慣性モーメント係数、τfn  非線形要素トルク補償量、ＡLIM  最大角加速度、ＭＬID  （質量）×（重心と回転中心軸の距離）、γID  同定パラメータベクトル、ξ  信号ベクトル、ＯＩＤＣ  パラメータ同定制御２値信号、ＩＤＣ  ２値信号、ξTΦ  追従スカラ誤差、１００，２００  位置制御装置、Ｘu，Ｙu，Ｚu  基準座標系、Ｏu  基準座標系原点、Ｇ  重心、ｇ  重力加速度、ａ  重心角度、ｂ  回転テーブル傾斜角、Ｌ  重心距離。
【図１】
2008171165.tif 000003
【図２】
2008171165.tif 000004
【図３】
2008171165.tif 000005
【図４】
2008171165.tif 000006