JP6068779B2

JP6068779B2 - 直進型及び回転型ロボットの制御装置

Info

Publication number: JP6068779B2
Application number: JP2011066785A
Authority: JP
Inventors: 菲菲章; 雅則伊藤
Original assignee: Daiichi Electric Co Ltd
Current assignee: Daiichi Electric Co Ltd
Priority date: 2011-03-24
Filing date: 2011-03-24
Publication date: 2017-01-25
Anticipated expiration: 2031-03-24
Also published as: JP2012203589A

Description

本発明は、高精度な位置決めが要求される工作機械等において、可動体の位置決め制御を行う直進型及び回転型ロボットの制御装置に関する。

例えば、試料を載置したステージテーブルを、２次元平面内で互いに直交するＸ方向およびＹ方向に沿って移動させる移動ステージ装置（Ｘ−Ｙステージ装置ともいう）は、各種工作機械等に利用されている。２次元平面内を移動させる移動ステージ装置では、Ｘ軸制御機構、Ｙ軸制御機構が必要であり、これら２軸を制御する際に互いの軸方向のクロストーク（一方の軸を変位させた時に他方の軸が僅かに変位する現象）を回避する必要がある。そのため、従来、Ｘ軸ステージとＹ軸ステージとを積み重ねた２段構造にすることがなされている。Ｘ軸ステージとＹ軸ステージとを積み重ねた２段構造の装置では、下側のステージは上側のステージの重量を支持することとなり、移動動作に大きな負荷が掛かることとなって、最高移動速度を低く抑えたり、駆動機構を大型にしたりする必要がある等の問題があり、時間当たりの処理量に大きな制約を生じたり、機械のコストが過大になるという問題を生じていた。

また、例えば、２軸フライス盤などのステージテーブル上の対象物を加工する装置では、刃の切り込み深さ、移動速度、加工対象物の材質などにより負荷が絶えず変化するという問題がある。

このように、ステージ装置で様々な仕事を正確、迅速に行う為には、ステージの移動距離を要求される速度で精密に制御しなければならない。しかし、作業目的に応じて、移動ピッチ、負荷の重量、機械の固体差など様々な要因が変化する。また機械の組み合わせ使用の場合、外乱トルクも発生する。これらに対して、従来の制御法では一律にひとつの制御則で全ての状況に対応することができない。そのために、上記の要因が変化するたび、制御パラメータの調節が必要不可欠である。また、作業環境による機械の振動モードの変化、外乱トルクなどの影響も制御精度の向上を妨げる。

こうした問題に対し、従来、機械的構造を改良して上記の問題を解消しようとする試みがなされてきた。例えば、特許文献１（特開２００２−２２８６８号公報）では、ベースと外枠フレーム（ステージ）との間に中間部材（中間フレーム）を配設し、さらに、ベースと中間部材との間にＸ方向に変位可能な弾性ヒンジを配置し、中間部材と外枠フレーム（ステージ）との間にＹ方向に変位可能な弾性ヒンジを配置し、コンパクトな構成で、高速かつ高精度の制御を可能としたＸ−Ｙステージの支持構造が開示されている（特許文献１参照）。これによれば、Ｘ方向及びＹ方向へ外枠フレーム（ステージ）を駆動するリニアモータなどの適宜の駆動手段を設けることにより、外枠フレーム（ステージ）をＸ−Ｙ平面内における任意の方向へ微小駆動することができる。

特許文献１に記載されたＸ−Ｙステージの支持構造は、弾性ヒンジを用いるとともに、ベースに対して、中間部材や弾性ヒンジが左右前後対称あるいは点対称となるように取り付けられており、その結果、Ｚ方向、Ｘ軸回転（θｘ）、Ｙ軸回転（θｙ）、Ｚ軸回転（θｚ）については、「剛体」として機能するようにして、クロストークが発生しないようにしてある。

一方、Ｘ方向及びＹ方向へ外枠フレームを駆動するリニアモータなどの適宜の駆動手段を設けることが記載されているが、これら駆動手段の外枠フレームへの取り付け位置についても、外枠フレームの重量バランスがＸ軸方向に左右対称、Ｙ軸方向に前後対称になるように配慮して取り付けることが、クロストークを生じないようにするためには必要となる。しかしながら、実際には、Ｘ方向に１つの駆動手段が左右いずれか一辺に取り付けられ、Ｙ方向に１つの駆動手段が前後いずれか一辺に取り付けられることにより重量バランスが非対称になる。駆動手段が非対称に取り付けられる結果、Ｘ方向またはＹ方向のリニアモータが駆動されると、Ｚ軸回転が生じてクロストークが発生することとなる。

特開２００２−２２８６８号公報

本発明は、高精度な位置決めが要求される工作機械等において、比較的単純な構造を保ちつつ、迅速かつ高精度な位置決めを実現する直進型ロボットの制御装置を提供することを目的とする。なお、本発明の動作原理は、角度制御においても同様に適用できる。従って、本発明は比較的単純な構造を保ちつつ、迅速かつ高精度な位置決めを実現する回転型ロボットの制御を提供することも目的とする。

本発明では、上記の課題を達成するために、H無限大制御理論に基づく制御系の新しい形態を提案する。
従来においても、H無限大制御理論に基づく制御は考えられていた。図５に示すのがそのような制御システムの構成である。ここで、制御器は数式的に以下の３つの部分に分かれる。
１）モータの速度が定常誤差なく追従できるように設計された速度制御器
２）速度制御ループを含めたモータに対して設計されたH∞角度制御器
３）ゲイン可変のフィードフォーワード制御器

まず、上述諸問題を解決するために、達成すべき制御性能を整理する。
(i)基本性能：目標位置信号に対する定常誤差を解消する。ステップ外乱トルクに対する定常誤差を解消する。
(ii)ロバスト性：負荷の重量、機械の固体差、振動モータ変化があっても一定の制御性能が維持できる。
(ii)追従性：応答プロセスの中に、オーバーシュートと応答遅れを最
小限に抑える。
(iv)H無限大制御器の設計方法：上述制御性能を達成するH無限大制御器の設計方式を確立する。

上述(i)は制御系の基本性能である。これに対して、制御系の構造上、位置制御ループが１型（一つの積分）であれば、目標位置信号に対する定常誤差零の要求を満たすことができる。一般にモータの運動特性より、モータトルクから位置までの伝達関数には構造的に積分要素が含まれるので、位置制御器（下で述べるH∞制御器）でシステムが安定であれば、要求を満たすことができる。外乱トルクに対しても定常誤差が零であるためには、位置制御ループを２型（２個の積分）にすることもあるが、応答特性に大きなオーバーシュートを引き起こす可能性が大きい。そのためここでは、速度制御ループを位置制御ループの内部に構成することで問題を解決する。その速度制御ループに、一つの積分を含むような速度制御（例えばPI制御）であればよい。

上述(ii)は、制御対象と環境の変動に対するロバスト的性質である。このために、H∞制御理論に基づき、ロバスト安定性とロバストパフォーマンスを持たせるH∞制御器を設計する。すなわち、速度制御ループ（閉ループ）を含んだモータを対象に、位置制御器として設計し、その出力は速度ループへの目標信号として与える。これによって、システム全体のロバスト安定性が保証され、ロバストパフォーマンスも実現できる。

上述(iii)は、主にロボット動作中の加速、減速時に起こりやすい応答遅れ、またはオーバーシュートに対する抑制性能である。これに対して、フィードフォーワード（FF）制御器を設置し、目標信号と測定したモータ速度に基づき、モータの速度制御ループへ目標信号の補正量として与える。フィードフォーワード制御器のゲインは制御対象の速度変化に応じて変化（速度が上がるとき大きく、下がるとき小さく）するように設計し、ある上限を超えない範囲で、補正された目標速度信号を与えることによって、制御対象の加速時の遅れと減速時のオーバーシュートを抑えることができる。

最後に、(iv)はH∞制御器の設計方法に関する技術である。制御対象の伝達関数に積分要素が含まれたとき、H無限大制御問題の標準形の条件を満たさなくなり、解が存在しない、即ち、H無限大制御器が設計できないことが知られている。本発明者らは、このような難点を回避するための方法を提案する。すなわち、本発明には以下の装置が含まれる。

[１] ベースに対して移動可能に支持された対象物を少なくとも１つの駆動手段により１軸以上の方向に移動させる直進型ロボットの制御装置において、前記制御装置が、前記駆動手段に駆動信号を出力する１つの積分要素を含む１型の速度制御器と、前記駆動手段の速度情報を前記速度制御器に帰還させる速度フィードバック手段と、目標位置指令と前記駆動手段の駆動位置情報とに基づいて前記速度制御器に速度指令を出力するＨ無限大制御器と、前記駆動手段の駆動位置情報を前記Ｈ無限大制御器に帰還させる位置フィードバック手段と、前記目標位置指令に基づき目標速度の補正量である所定の信号を出力し、前記Ｈ無限大制御器の速度指令に前記所定の信号を加えて前記速度制御器に入力して応答速度を向上するフィードフォワード制御器を備え、前記Ｈ無限大制御器が、前記駆動手段、前記速度制御器、前記速度フィードバック手段、前記Ｈ無限大制御器、前記位置フィードバック手段からなる閉ループシステムを安定させることを特徴とする直進型ロボットの制御装置。
[２] 前記フィードフォワード制御器は、前記駆動手段の速度情報に基づいて、前記所定の信号のゲインを変化させるように構成されている、請求項1に記載の直進型ロボットの制御装置。
[３] 前記フィードフォワード制御器は、前記駆動手段が目標位置近傍で前記所定速度から減速を開始した場合に、前記駆動手段の所定速度からの速度低下に応じて前記所定の信号のゲインを減少させるように構成されている請求項１又は２に記載の直進型ロボットの御制御装置。
[４] 前記駆動手段として互いに直交するＸ方向およびＹ方向に駆動するＸ方向アクチュエータとＹ方向アクチュエータとを備えた請求項１〜３のいずれかに記載の直進型ロボットの制御装置。
[５] ベースに対して移動可能に支持された対象物を少なくとも１つの駆動手段により１軸以上の周囲に回転させる回転型ロボットの制御装置において、前記制御装置が、前記駆動手段に駆動信号を出力する１つの積分要素を含む１型の角速度制御器と、前記駆動手段の角速度情報を前記角速度制御器に帰還させる角速度フィードバック手段と、目標角度指令と前記駆動手段の駆動角度情報とに基づいて前記角速度制御器に角速度指令を出力するＨ無限大制御器と、前記駆動手段の駆動角度情報を前記Ｈ無限大制御器に帰還させる角度フィードバック手段と、前記目標角度指令に基づき目標角速度の補正量である所定の信号を出力し、前記Ｈ無限大制御器の角速度指令に前記所定の信号を加えて前記角速度制御器に入力して応答速度を向上するフィードフォワード制御器を備え、前記Ｈ無限大制御器が、前記駆動手段、前記角速度制御器、前記角速度フィードバック手段、前記Ｈ無限大制御器、前記角度フィードバック手段からなる閉ループシステムを安定させることを特徴とする回転型ロボットの制御装置。

本発明の装置によれば、パラメータの切り替えが必要なくなり、かつステップ状外乱に対する定常誤差も無くし、機械の振動を抑制する効果も得られる。また、簡便な構造で迅速かつ高精度な制御が可能になるので、生産性の向上及び製造コストの低減を実現できる。

図１は、本発明が提案する直進型ロボット制御装置の一般形を示すブロック図である。図２は、本発明の直進型ロボット制御装置の一実施態様を示すブロック図である。図３は、H無限大制御器を設計するに当たって、上述重み関数W1とW２を含めた一般化システムを示すブロック図である。図４は、各制御系における入出力を示す模式図である。図５は本発明の第２の実施形態示すブロック図である。図６は、フィードフォワード制御器における可変ゲインの一例を示すグラフである。図７は本発明の位置制御装置における、目標位置信号ｒをステップ状変化するときの出力信号ｙの時間応答曲線である。図8は、従来型の位置制御装置における、目標位置信号ｒをステップ状変化するときの出力信号ｙの時間応答曲線である。図９は、時間[μｓｅｃ]をとり、目標位置指令ｒに対する応答（上図：検出位置情報ｙ）及び（下図：偏差ｅy[ｒａｄ]）を示すグラフである。図１０は、図９の円Ａで示す範囲を拡大したグラフである。図１１は、図9に示す制御器に対応する実施例において、ノミナルプラントP0（ｓ）（図5参照）が変動した場合の応答を示すグラフである。図１２はフィードフォワード制御器の出力信号ｆを速度制御器２０（図5参照）の出力信号に加えた比較例（背景技術において説明した特許文献２に対応する比較例）において、ノミナルプラントP0（ｓ）（図5参照）が変動した場合の応答を示すグラフである。

以下、本発明について説明する。なお、本発明において直進型ロボットは、ｎ軸リニア搬送ロボットやｎ次元プロッタ、ｎ軸フライスなどを含む。ここで、ｎは１以上の整数であり、好ましくは２及び３である。また、回転型ロボットは、多関節ロボットを含む。これらの位置・角度を同時に制御することもできる。なお、以下の説明において、直進型ロボットの制御装置を単に「位置制御装置」、回転型ロボットの制御装置を単に「回転制御装置」ともいう。

図１は、本発明が提案する位置制御装置１００の一般形である。
位置制御装置１００は、外部から入力された目標信号（目標位置信号又は目標角度信号）rと、エンコーダなど制御対象の位置（又は角度）信号に基づき、制御対象への駆動信号を出力するように構成される。また、位置制御装置１００はサーボモータ２００を駆動する。
サーボモータ２００は、例えば、ステージ装置の１つの軸上でステージや搬送物を移動させるためのものであり、外部から入力された目標信号は、例えば、ステージ装置における目標位置であり、制御対象の位置（又は角度）は、例えば、計測器やセンサなどによる直接または間接の測定値である。

図２は、本発明の制御装置の第１の実施態様である（第１の実施態様は位置制御装置であり、第２の実施態様は回転制御装置である。以下の説明では、基本的に第１の実施態様について説明するが、第２の実施態様は、位置を角度、速度を角速度で読み替えればよい（必要であればこれらに従い他の文言も読み替える））。

位置制御装置１００は一つの積分を含む（１型）速度制御器２０と、H無限大制御器１０とFF制御器３０との３つの制御器を有する。

速度制御器２０はモータの速度ｖが目標速度Vrに追従するように設計する。設計に当たっては、モータの駆動トルクTから速度ｖまでの伝達関数Po(s)を用いて、ステップ目標信号に対して定常誤差なく追従するように設計する。Po(s)は入力信号Tと出力信号ｖの同定実験データより得られた数値モデルである場合も、物理原理によるモデルである場合も同じである。サーボモータの物理モデルは一般にPo (s)=1/(Js+D_L)として、モータと負荷を併せたノミナル（変動しない）特性を表す。ここで、Jはサーボモータ２００の慣性モーメントおよびサーボモータ２００に駆動される機構の慣性モーメントの換算値の和である。Dは摩擦係数である。このような速度制御器は例えばPI補償器のように一つの積分要素を含めたものでよい。この場合、速度制御器の伝達関数は(As+B)／sとなる。なお、ここで１／ｓは積分要素である。

続いてH無限大制御器１０を位置（角度）制御器として設計する。この場合の制御対象は、速度制御器を含めた速度閉ループと速度情報ｖを位置（角度）情報に変換する積分要素１／ｓと直列結合した拡大プラントP(s)である。

H無限大制御理論においては、拡大したプラントのノミナルな性質だけでなく、不確かさ（負荷変動やモータ個体差によるモデル誤差）と外乱に強いロバスト安定性を持つ制御器K(s)の設計ができる。このために、フィードバックシステムの安定性を満たすと共に、外乱の影響を受けにくいことを評価する感度関数
を小さく抑えることと、モデル変動に対するロバスト安定性に関わる相補感度関数
を小さく抑えることが必要である。

しかし、S+T=１より、上述SとTの両方を自由に小さくすることができないため、異なる周波数領域にSとTをそれぞれ小さくすることで両立を図る。感度を小さくしたい周波数領域（低周波領域）において、その周波数領域に大きな値をとる関数W1(s)を決め、また相補感度関数Tを小さくしたい周波数領域（高周波領域）に大きな値をとる関数W2(s)を決め、
となるように制御器K(s)を求める。図３はH無限大制御器を設計するに当たって、上述重み関数W1とW２を含めた一般化システムを示す。

重みつき感度関数
は図3-1の信号wからZ1までの伝達関数、重みつき相補感度関数
は信号wからZ2までの伝達関数となる。図3-1を図3-2のように書き換えると、一般化プラント表現が得る。この一般化プラントに対して、信号wから出力z1及びz2への伝達関数
の無限大ノルム
が所定の値γより小さく、かつK(s)、P(s)を繋がる閉ループシステムが安定であるように制御器K(s)を求めることによって、ロバスト性を持つ位置制御器が設計される。

上述制御器K(s)の設計に当たって、H無限大制御理論による標準問題の解を適用するが、図２に示した拡大プラントPの伝達関数に積分要素1／sを含めているので、図３−２で示す一般化プラントの状態空間表現におけるH無限大標準問題に必要な前提条件
を満たさない。このような場合、通常に解が存在しないという判断が出される。本発明はこの問題を回避するため、拡大プラントの伝達関数を
と表し、
について、積分器を内蔵するH無限大制御器
をまず求める。

このために、重み関数
を
のように積分を一つ含むような伝達関数として与える。即ち位置制御ループが安定でかつ
伝達関数
の無限大ノルム
が所定の値γより小さいという条件を満たすように
を求める。この時、求めた
は必ず積分が内蔵する。続いて
を
のように分離し、積分要素
を除いた
を得る。

ここで、
であることから、
はもとのシステム図２のH無限大制御器となる。
最後に、フィードフォーワード（FF）制御器について説明する。FF制御器の実施形態は２種類可能である。図２は第１の実施形態である。FF制御器３０は、目標位置指令により、速度制御器へ、目標速度の補正量fを出力する。この場合、FF制御器３０の機能は伝達関数
で表す。これによって、応答速度の向上を図る。

従来型のFF制御信号は直接制御対象（モータ）へ入力することであるが、その場合は、モータの特性変動の影響を受けやすく、FF制御の効果が低減するという問題点がある。本発明では、FF信号をH無限大制御器の出力信号に加えることによって、モデル誤差の影響を受けずに、FF制御の効果を高めることができる。

図５は本発明の第２の実施形態である。FF制御器４３０はFF制御器３０の基に、制御対象の速度信号もフィードバックする。ここでは
の係数
は一定の上限を設けて、速度信号ｖによって変化する。すなわち、
となる。

図６は可変ゲイン
のイメージである。これによって、モータ加速時の応答遅れと減速時のオーバーシュートを低減する効果が高められる。

具体的な計算・指示はコンピュータなどの計算・指示手段により行い、FF制御その他の制御部の構成要素は、当業者に知られている任意の構成を用いることができる。装置全体の機械的・電気的構成は、例えば、ｎ軸リニア搬送装置であれば、上記制御部を除いて従来のｎ軸リニア搬送装置と同様の構成を用いることができる。

実施例
以下、本発明によるリニア搬送装置について、位置制御装置の効果について説明する。

図７は位置制御装置１００に基づいた設計した位置制御結果であり、目標位置信号ｒをステップ状変化するときの出力信号ｙの時間応答曲線である。図8−１、図８−２に示す従来型制御の結果と明らかな有意差を示している。すなわち、負荷条件を変えたステップ応答性能に関して、従来型では、本発明と同等の応答性を持たせると大きなオーバーシュートを示し、その割合は、負荷が小さいほど大きくなる（図８−１）。また、オーバーシュートを押さえると応答性が悪くなり、その程度は、高負荷ほど大きくなる（図８−２）。

次に、図９および図１０は、フィードフォーワード効果を確認するために行った実験である。ここで、図９の上側のグラフは、縦軸にサーボモータの出力軸の回転角度[ｒａｄ]、横軸に時間[μｓｅｃ]をとり、目標位置指令ｒに対する応答（検出位置情報ｙ）を示している。また、図９の下側のグラフは、縦軸に目標位置指令ｒに対する偏差ｅy[ｒａｄ]、横軸に時間[μｓｅｃ]をとり、上側のグラフに対応する各時刻における偏差ｅyの発生量を示している。図１０のグラフは、縦軸と横軸の拡大率が等しくないため、縦に引き伸ばされたグラフとなっている。この実施例は、位置制御装置400（即ちフィードフォワード制御は第２実行態４３０）を用いた構成である。図９に示すように、サーボモータ200の出力軸の目標位置を回転角度９４．２５[ｒａｄ]とし、０〜２００[μｓｅｃ]の加速領域と、２００〜６００[μｓｅｃ]の一定角速度領域と、６００〜８００[μｓｅｃ]の減速（位置決め）領域を含むように目標位置指令ｒを入力した例を示している。

図9に示すように、目標位置指令rに対する応答は、２００〜６００[μｓｅｃ]の一定角速度領域において位置偏差が０となっている。上記のように１型の制御系では、ランプ入力に相当する一定角速度領域において定常偏差が発生する（図4の(d)参照）ので、位置偏差が略0となるという本実施例の結果は、FF制御器４３０によるゲイン補償によって偏差を減少させていることを示している。また、目標位置（９４．２５ [ｒａｄ]）近傍（図９の破線で囲まれた領域A）における位置決め挙動を見ると、オーバーシュートも発生していない。詳細には、目標位置（９４．２５ [ｒａｄ]）近傍の７００〜９００[μｓｅｃ]の範囲（図９の破線で囲まれた領域A）を拡大した図１０に示すように、サーボモータ２００の出力軸の回転角度（実線）が位置指令（破線）に対して、遥かに下回る過減衰の応答を示しながら、約８００[μｓｅｃ]付近で目標位置（９４．２５ [ｒａｄ]）に偏差０で収束していることが分かる。このような僅かな過減衰を示す特性は、特にオーバーシュートの発生が問題となる産業用ロボットの駆動制御に用いられる位置制御装置の特性としては、望ましい目標追従特性である。以上から、フィードフォワード第２実施形態による位置制御装置４００を用いた制御系が位置決め制御において良好な制御特性を示していると言える。

更に、図１１および図１２を参照して、図９および図１０に示した実験結果に基づき、ノミナルプラントP0（ｓ）が変動した場合の効果について説明する。
図１１は、図9に示した制御器４００に対応する実施例において、ノミナルプラントP0（ｓ）（図5参照）が変動した場合の応答を示している。図１２はフィードフォワード制御器の出力信号ｆを速度制御器２０（図5参照）の出力信号に加えた比較例（背景技術において説明した特許文献２に対応する比較例）において、ノミナルプラントP0（ｓ）（図5参照）が変動した場合の応答を示している。ここで、図１１および図１２の上側のグラフは、縦軸にサーボモータの出力軸の回転角度[ｒａｄ]、横軸に時間[μｓｅｃ]をとり、目標位置指令ｒに対する応答（検出位置情報ｙ）を示している。また、図１１および図１２の下側のグラフは、縦軸に目標位置指令ｒに対する偏差ｅy[ｒａｄ]、横軸に時間[μｓｅｃ]をとり、上側のグラフに対応する各時刻における偏差ｅyの発生量を示している。

図１１に示すように、前述の第２実施形態に対応する実施例では、ノミナルプラントP0（ｓ）が変動した場合においても、２００〜６００[μｓｅｃ]の一定角速度領域において位置指令と検出位置との間の位置偏差が０となっている。ここで、図１２に示す比較例度領域において定常偏差が発生する（図4の(d)参照）ので、位置偏差が略0となるという本実施例の結果は、FF制御器４３０によるゲイン補償によって偏差を減少させていることを示している。また、目標位置（９４．２５ [ｒａｄ]）近傍（図９の破線で囲まれた領域A）における位置決め挙動を見ると、オーバーシュートも発生していない。詳細には、目標位置（９４．２５ [ｒａｄ]）近傍の７００〜９００[μｓｅｃ]の範囲（図９の破線で囲まれた領域A）を拡大した図１０に示すように、サーボモータ２００の出力軸の回転角度（実線）が位置指令（破線）に対して、遥かに下回る過減衰の応答を示しながら、約８００[μｓｅｃ]付近で目標位置（９４．２５ [ｒａｄ]）に偏差０で収束していることが分かる。このような僅かな過減衰を示す特性は、特にオーバーシュートの発生が問題となる産業用ロボットの駆動制御に用いられる位置制御装置の特性としては、望ましい目標追従特性である。以上から、位置制御装置４００を用いた制御系が位置決め制御において良好な制御特性を示していると言える。
なお、ここでは位置制御について説明したが、角度制御についても同様である。

本発明の直進型及び回転型ロボットの制御装置は、例えば単軸ロボット、多軸ロボット、多関節ロボットに用いることができる。

Claims

ベースに対して移動可能に支持された対象物を少なくとも１つの駆動手段により１軸以上の方向に移動させる直進型ロボットの制御装置において、前記制御装置が、前記駆動手段に駆動信号を出力する１つの積分要素を含む１型の速度制御器と、前記駆動手段の速度情報を前記速度制御器に帰還させる速度フィードバック手段と、目標位置指令と前記駆動手段の駆動位置情報とに基づいて前記速度制御器に速度指令を出力するＨ無限大制御器と、前記駆動手段の駆動位置情報を前記Ｈ無限大制御器に帰還させる位置フィードバック手段と、前記目標位置指令に基づき目標速度の補正量である所定の信号を出力し、前記Ｈ無限大制御器の速度指令に前記所定の信号を加えて前記速度制御器に入力して応答速度を向上するフィードフォワード制御器を備え、前記Ｈ無限大制御器が、前記駆動手段、前記速度制御器、前記速度フィードバック手段、前記Ｈ無限大制御器、前記位置フィードバック手段からなる閉ループシステムを安定させることを特徴とする直進型ロボットの制御装置。
前記フィードフォワード制御器は、前記駆動手段の速度情報に基づいて、前記所定の信号のゲインを変化させるように構成されている、請求項1に記載の直進型ロボットの制御装置。
前記フィードフォワード制御器は、前記駆動手段が目標位置近傍で前記所定速度から減速を開始した場合に、前記駆動手段の所定速度からの速度低下に応じて前記所定の信号のゲインを減少させるように構成されている請求項１又は２に記載の直進型ロボットの御制御装置。
前記駆動手段として互いに直交するＸ方向およびＹ方向に駆動するＸ方向アクチュエータとＹ方向アクチュエータとを備えた請求項１〜３のいずれかに記載の直進型ロボットの制御装置。
ベースに対して移動可能に支持された対象物を少なくとも１つの駆動手段により１軸以上の周囲に回転させる回転型ロボットの制御装置において、前記制御装置が、前記駆動手段に駆動信号を出力する１つの積分要素を含む１型の角速度制御器と、前記駆動手段の角速度情報を前記角速度制御器に帰還させる角速度フィードバック手段と、目標角度指令と前記駆動手段の駆動角度情報とに基づいて前記角速度制御器に角速度指令を出力するＨ無限大制御器と、前記駆動手段の駆動角度情報を前記Ｈ無限大制御器に帰還させる角度フィードバック手段と、前記目標角度指令に基づき目標角速度の補正量である所定の信号を出力し、前記Ｈ無限大制御器の角速度指令に前記所定の信号を加えて前記角速度制御器に入力して応答速度を向上するフィードフォワード制御器を備え、前記Ｈ無限大制御器が、前記駆動手段、前記角速度制御器、前記角速度フィードバック手段、前記Ｈ無限大制御器、前記角度フィードバック手段からなる閉ループシステムを安定させることを特徴とする回転型ロボットの制御装置。