JP6024819B2 - 目標指向装置、目標指向制御方法、目標指向制御プログラム - Google Patents

Description

本発明は、目標指向装置に関する。例えば、目標軌道を生成してこの目標軌道に従うように制御対象を制御する目標指向装置に関する。

特許文献１では、目標指向装置が開示されている。
この開示された目標指向装置から、慣性センサ、積分器、減算器を省略した目標指向装置がある。
図７は、この関連する技術の目標指向装置を表すブロック図を示す。
目標指向装置は、
装置全体を移動体に取り付けるための固定部（図示せず）と、
固定部に対して回転自在に設けられた制御対象１と、
角度検出器２と、
指令生成器５と、
軌道生成器６と、
制御器３と、
ドライバ４と、を有する。

角度検出器２は、制御対象の固定部に対する相対角度を時々刻々検出する。
角度検出器２は、検出した角度値を現在角度信号として軌道生成器６および制御器３にフィードバックする。
指令生成器５は、目標角度信号および目標角速度信号を軌道生成器６に向けて出力する。
例えば、衛星や航空機などの移動物体を追尾したいとする場合、目標角度信号および目標角速度信号とは、この追尾のために制御対象１がとるべき角度および角速度を意味する。

軌道生成器６は、目標角度信号および目標角速度信号と、現在角度信号と、に基づいて目標指令を生成し、目標指令を制御器３に向けて出力する。
ここで、軌道生成器６を介することなく、指令生成器５からの目標角度信号および目標角速度信号を直接に制御器３に入力した場合でも、もちろん、制御対象１は目標角度および目標角速度に従った動作を行うことは可能である。
しかしながら、指令生成器５は、目標角度信号および目標角速度信号を出力するにあたって、現在の制御対象１の状態（角度位置や角速度）を考慮しない。
したがって、目標角度および目標角速度が現在の制御対象１の状態から大きく外れている場合には、制御対象１の動作が急になったり、不連続になったりすることが有り得る。
または、制御対象１が目標角度および目標角速度に達する前に目標角度および目標角速度が変更される場合も有り得る。やはり、この場合も、制御対象１の動作が急になったり不連続になったりするであろう。
したがって、軌道生成器６は、現在の制御対象１の状態、例えば、現在の制御対象の角度位置を考慮しつつ、そこから目標角度信号および目標角速度に滑らかに達することができるように軌道を算出する。
そして、軌道生成器６は、この軌道に従って目標指令を出力する。
目標指令には、目標角度指令と、目標角速度指令と、が含まれる。

制御器３は、目標指令と、現在角度信号と、に基づき、位相補償等を施した上で制御信号をドライバ４に向けて出力する。
制御器３のなかには、位置のフィードバックループや速度（角速度）のフィードバックループなどが内蔵されており、目標指令に含まれる目標角度指令および目標角速度指令と、現在角度信号と、基づいて制御信号を生成する。
ドライバ４は、制御信号に従って制御電流（または制御電圧）を制御対象１に印加する。
これにより、制御対象１は、所望の動作、例えば、目標物を追尾する、といった動作を適切かつ安定的に行う。

実開平０５−０７９２９９号公報

さて、制御対象１は、それ自体移動する移動体に設けられているので、制御対象をより安定的に制御するためには、移動体の動きをキャンセルするための空間安定機能を目標指向装置に付加することが好ましい。
図８は、図７の目標指向装置に空間安定機能を付加したブロック図である。
図８においては、慣性センサ７と、積分器８と、減算器９と、が付加されている。
慣性センサ７は、移動体の動揺角速度を検出する。
積分器８は、動揺角速度を積分して、移動体動揺角度に変換した後、減算器に出力する。
減算器９は、軌道生成器６と制御器３との間に設けられている。
減算器９は、軌道生成器６の出力から移動体動揺角度を減算し、目標指令として制御器に向けて出力する。

なお、軌道生成器６からの出力には角度の指令と角速度の指令とが含まれているところ、減算器による減算処理の方法として２パターン考えられる。
減算器９は、角度信号同士の減算処理を行い、軌道生成器６からの角速度指令についてはそのまま制御器３に与えてもよい。
つまり、減算器９は、軌道生成器６からの角度の指令と積分器からの移動体動揺角度との間で減算処理を行って、これを目標角度指令として制御器に与える。軌道生成器６からの角速度指令についてはそのままのものを目標角速度指令として制御器３に与える。
あるいは、次のようにしてもよい。
減算器９のなかにさらに微分器が内蔵されており、移動体動揺角度を微分して移動体動揺角速度にする。
そして、減算器９は、角度信号同士の減算処理に加えて、軌道生成器６からの角速度指令と算出した移動体動揺角速度との間で減算処理を行って、これを目標角速度指令として制御器３に与えてもよい。

これら慣性センサ７、積分器８および減算器９により、空間安定ループが構成されている。
空間安定ループにより、移動体の動きをキャンセルするので空間安定化が果たされるとも考えられる。
しかし、実際には、上記のように単純に空間安定ループを付加しただけではうまく動作しないことに本発明者らは気付いた。

さて、図８の空間安定機能付きの目標指向装置の問題点を明らかにする前に、空間安定機能が理想的にワークする例を示しておきたい。
そこで、まず、図９のように、軌道生成器が無い場合の動作を説明する。
図９は、図８のブロック図から軌道生成器を削除した場合を示す図である。
図１０Ａから図１０Ｄは、図９のブロック図における主要点での信号波形である。
対応が取りやすいように、図９中にカッコ書きで図１０Ａ−Ｄの波形がでるポイントを示した。

図９において、指令生成器５は、目標角度θｔを常に０(図１０Ａ)に設定したとする。
また、移動体は動揺しており、その揺れ（移動体動揺角度θｇ）が図１０Ｂのように−ｓｉｎ波であったとする。
このとき、減算器９において、目標角度θｔから移動体動揺角度θｇを減算すると、図１０Ｄに示すように、制御器３への目標指令（減算器９の出力）は、移動体動揺角度θｇを反転した波形であるｓｉｎ波形になる。
このようにして制御対象１の動きがｓｉｎ波形となると（図１０Ｃ）、ちょうど移動体動揺角度θｇを打ち消して、空間安定化を図ることができる。

さて、それでは、図８のブロック図の動作について考えてみたい。
図８において、指令生成器５が、目標角度θｔを常に０(図１１Ａ)に設定したとする。
また、移動体は動揺しており、その揺れ（移動体動揺角度θｇ）が図１１Ｂのように−ｓｉｎ波形であったとする。
このとき、減算器９において目標角度θｔから移動体動揺角度θｇを減算すると、減算器９の出力（制御器３の目標指令）は、移動体動揺角度θｇを反転した波形であるｓｉｎ波形になる。
この波形を図１１Ｅ中の実線で表す。
このｓｉｎ波形である目標指令が制御器３に与えられれば、移動体動揺角度θｇをキャンセルして制御対象の空間安定が実現するのは前述の通りである。

ここで、所定時間経過後における軌道生成器６へのフィードバックを考えてみる。
図１１Ｃに示すように、制御対象１がサイン波形で揺動すれば、この制御対象の動きが角度検出器２を介して軌道生成器６にフィードバックされる。
すると、図１１Ｄに示すように、軌道生成器６からの出力（角度指令に関する出力）はｓｉｎ波形状になる。
減算器９は、この軌道生成器６の出力（図１１Ｄ）から移動体動揺角度分（図１１Ｂ）を減算することになる。
しかし、この減算処理の結果としては、図１１Ｅの点線に示すように、移動体の動揺をちょうどキャンセルするサイン波形でなく、必要以上に振幅の大きいサイン波になってしまう。
このように考えてみると、軌道生成器による滑らかな動作と空間安定機能とを両立させることは単純には上手くいかないことがわかる。

本発明は、このような問題を解決するためになされたものであり、軌道生成を行いつつ空間安定化を行うことのできる目標指向装置を提供することを目的とする。

本発明にかかる目標指向装置は、
移動体に回動自在に取り付けられた制御対象を目標に従って制御する目標指向装置であって、
目標角度と目標角速度とを設定する指令生成手段と、
前記制御対象および前記移動体の少なくとも一方の現在角度状態が軌道生成用現在角度としてフィードバックされており、前記現在角度状態、前記目標角度および前記目標角速度に基づいて前記制御対象の軌道を生成するとともに、前記軌道に従った出力角度信号および出力角速度信号を出力する軌道生成手段と、
前記制御対象の現在角度を検出する角度検出手段と、
前記移動体または前記制御対象に設置された慣性センサと、
前記出力角度信号から前記移動体の動揺角度成分を減算する第１減算手段と、
前記第１減算手段からの出力と前記角度検出手段からの前記現在角度とに基づいて制御信号を生成する制御器と、
前記制御器からの制御信号に基づいて前記制御対象を駆動制御するドライバと、を備え、
前記軌道生成手段にフィードバックされる前記軌道生成用現在角度は、前記移動体の動き成分と前記制御対象の動き成分との和である。

本発明により、軌道生成を行いつつ空間安定化を行える目標指向装置を提供することができる。

第１の実施形態にかかる目標指向装置を表すブロック図である。 第１の実施形態にかかる目標指向装置における代表点の波形図である。 第１の実施形態にかかる目標指向装置における代表点の波形図である。 第１の実施形態にかかる目標指向装置における代表点の波形図である。 第１の実施形態にかかる目標指向装置における代表点の波形図である。 第１の実施形態にかかる目標指向装置における代表点の波形図である。 第２の実施形態にかかる目標指向装置を表すブロック図である。 第２の実施形態にかかる目標指向装置における代表点の波形図である。 第２の実施形態にかかる目標指向装置における代表点の波形図である。 第２の実施形態にかかる目標指向装置における代表点の波形図である。 第２の実施形態にかかる目標指向装置における代表点の波形図である。 第２の実施形態にかかる目標指向装置における代表点の波形図である。 第２の実施形態にかかる目標指向装置における代表点の波形図である。 第２の実施形態にかかる目標指向装置における代表点の波形図である。 第３の実施形態にかかる目標指向装置を表すブロック図である。 関連する技術の目標指向装置を表すブロック図である。 関連する技術の目標指向装置に空間安定機能を付加したブロック図である。 関連する技術の目標指向装置を表すブロック図である。 関連する目標指向装置にて軌道生成器なしの場合の代表点の波形図である。 関連する目標指向装置にて軌道生成器なしの場合の代表点の波形図である。 関連する目標指向装置にて軌道生成器なしの場合の代表点の波形図である。 関連する目標指向装置にて軌道生成器なしの場合の代表点の波形図である。 関連する目標指向装置にて軌道生成器ありの場合の代表点の波形図である。 関連する目標指向装置にて軌道生成器ありの場合の代表点の波形図である。 関連する目標指向装置にて軌道生成器ありの場合の代表点の波形図である。 関連する目標指向装置にて軌道生成器ありの場合の代表点の波形図である。 関連する目標指向装置にて軌道生成器ありの場合の代表点の波形図である。

（第１の実施形態）
図１を用いて第１の実施形態にかかる目標指向装置について説明する。図１は、第１の実施形態にかかる目標指向装置の一例を表すブロック図を示す。

目標指向装置は、支持部（図示略）と、制御対象１と、角度検出器２、制御器３と、ドライバ４と、慣性センサ７と、積分器８と、減算器９と、加算器１０と、指令生成器５と、軌道生成器６と、を備える。

支持部は、装置全体を移動体に取り付けるために支持する。
また、支持部により制御対象１が回転自在に支持されている。なお、ここでは、回転軸の自由度は一軸とする。
角度検出器２は、制御対象１の回転角度を検出する。制御器３は、角度検出器２の出力する検出角度θｍと目標指令Ｋｉとに基づき、適宜位相補償を施して、制御対象１を制御する制御信号を生成する。ドライバ４は、制御信号に基づいて制御対象１を駆動させる。目標指向装置はフィードバック制御系である。

慣性センサ７は支持部に固定設置され、制御対象１の回転軸回りの移動体の移動体動揺角速度ωｇを検出する。
積分器８は、移動体動揺角速度ωｇを積分処理等して移動体動揺角度θｇに変換する。
減算器９は、軌道生成器６で生成した角度軌道から移動体動揺角度θｇを減算して目標指令信号を生成する。これらにより、制御器３への目標指令Ｋｉとする空間安定ループを付加している。空間安定ループにより制御対象１を移動体動揺角度θｇをキャンセルするように動かすことができ、空間安定化を行うことができる。

加算器１０は、角度検出器２の出力である検出角度θｍと積分器８の出力である移動体動揺角度とを加算し、この加算した結果についての信号を軌道生成用現在角度θｋとして軌道生成器６に出力する。
指令生成器５は、目標角度θｔ及び目標角速度ωｔを設定し、これらについての信号を目標指令Ｋｉとして軌道生成器６に出力する。

軌道生成器６は、目標角度θｔ、目標角速度ωｔ、及び、軌道生成用現在角度θｋに基づいて、目標角度軌道Ｋθ及び目標角速度軌道Ｋωを含む目標軌道を生成する。
軌道生成器６は、目標軌道に基づく信号Ｋｔ（角度の指令と角速度の指令とを含む）を制御器３に出力する。
ここで、目標角度軌道Ｋθは、検出角度θｍから目標角度θｔへ到達するまでに制御対象１の向くべき角度θの時間変化の過程である。
また、目標角速度軌道Ｋωは、制御対象１の角度を目標角度軌道Ｋθに追従させるための、制御対象１の出すべき角速度ωの時間変化の過程である。
軌道生成器６は、例えば、制御対象１を目標角度θｔへ向かって駆動させる途中で、目標角度θｔが新たな新目標角度θｔ１に変化しても、目標角度軌道Ｋθ及び目標角速度軌道Ｋωを修正し、新たな新目標角度軌道Ｋθ１及び新目標角速度軌道Ｋω１を生成することができる。
これにより、目標角度θｔが変化しても、制御対象１を確実に早く目標を追尾させることができる。

（動作）
次に図２Ａ〜Ｅを用いて、第１の実施形態にかかる目標指向装置の動作について説明する。
図２Ａ〜Ｅは、第１の実施形態にかかる目標指向装置における代表点の波形図を示す。

まず、指令生成器５は、目標角度θｔを０(図２Ａ参照)に設定する。
また、図２Ｂに示すように、積分器８の出力である移動体動揺角度θｇは−ｓｉｎ波形であるとする。

開始時ｔｓでは、移動体動揺角度θｇ（図２Ｂ参照）は０であり、角度検出器２の出力である検出角度θｍも０である。
すると、加算器１０の出力は、図２Ｅに示すように、開始時ｔｓでは０となる。
目標角度θｔは０であるので、軌道生成器６の出力（角度に関する出力）は、図２Ｄに示すように０となる。

減算器９は、軌道生成器６の出力（角度に関する出力）から積分器８の出力を減算する。
いま、開始時ｔｓでは、目標角度θｔも加算器の出力（図２Ｅ）も０であるから、減算器９からの出力（角度に関する出力）は移動体動揺角度θｇを正負反転したものとなる。
すると、制御器３への目標指令Ｋｉとしては移動体動揺角度θｇを正負反転したものが与えられることになる。
制御対象１は、この指令に従って、移動体動揺角度θｇを正負反転した動作を行うことになる。

さて、加算器１０の出力は、移動体動揺角度θｇ（図２Ｂ参照）と、検出角度θｍ（図２Ｃ参照）と、を加算したものである。
開始時において、制御対象１は移動体動揺角度θｇを正負反転した動作を行うことになるのであるから、加算器出力は０である。
加算器出力が０であれば、目標角度θｔは常に０に設定されているので、軌道生成器からの出力（角度に関する出力）はやはり０である。
このように軌道生成器への軌道生成用現在角度信号（加算器からの出力）が０を保つと、制御対象１の動作は移動体の揺動をキャンセルするものになるので、加算器出力は０になり、その結果、図２Ｄに示すように、軌道生成器６の出力（角度に関する出力）も０となる。
つまり、軌道生成器６の出力（角度に関する出力）は常に０（図２Ｄ参照）であり、よって、制御器３への目標指令（目標角度指令）は、積分器８の出力（図２Ｂ参照）を反転したｓｉｎ波形状になる。
これにより、制御対象１は、移動体動揺角度θｇを打ち消すように動作し、空間安定化を行うことができる。

以上より、第１の実施形態によれば、軌道生成器６と空間安定化機能とが両立できることがわかるであろう。

（第２の実施形態）
次に、図３を用いて第２の実施形態にかかる目標指向装置について説明する。
図３は第２の実施形態にかかる目標指向装置の一例を表すブロック図を示す。
第１の実施形態と本実施形態とで共通する説明は省略し、第１の実施形態に対する本実施形態の相違点のみについて説明する。

本実施形態では、慣性センサ７は、支持部ではなく制御対象１に設置され、制御対象１の回転軸回りに関する揺れ（加速度）を検出する。
第１減算器９は、第１の実施形態にかかる目標指向装置に含まれる減算器９（図１参照）と共通する機能を有し、呼び方を変更している。第２の実施形態にかかる目標指向装置は、第１の実施形態にかかる目標指向装置に、第２減算器１１、ゲイン１２を追加した構成である。

積分器８は、慣性センサ７の出力を積分して角度に変換し、軌道生成器６及び第２減算器１１に向けて出力する。
第２減算器１１は、積分器８の出力から、軌道生成器６からの角度信号を減算する。
第２減算器１１からの出力にはゲイン１２にてゲイン係数が乗算され第１減算器９に与えられる。
第１減算器９は、軌道生成器６からの角度信号からゲイン１２の出力を減算し、減算結果を制御器３に目標指令Ｋｉとして出力する。

（動作）
次に、図４Ａ〜Ｄ及び図５Ａ〜Ｃを用いて、第２の実施形態にかかる目標指向装置の動作について説明する。
図４Ａ〜Ｄ及び図５Ａ〜Ｃは第２の実施形態にかかる目標指向装置における代表点の波形図である。

指令生成器５は目標角度を０(図４Ａ参照)に設定する。
移動体が慣性空間で動揺している（図５Ａ参照）。
慣性センサ７の出力は、積分器８、第２減算器１１、ゲイン１２、第１減算器９を介して目標指令Ｋｉとして制御器３に出力される。
開始時点において、慣性センサ７が検出するのは、移動体の揺動そのものである。
したがって、第１減算器９からの出力（角度に関する出力）は、移動体の揺動を正負反転させたものになる。
制御器３は、目標指令Ｋｉに従う制御信号をドライバ４に出力する。
したがって、制御対象１は、移動体の揺動をキャンセルするように動作することになる。
この時点では、制御対象１は慣性空間に静止することができ、空間安定化が行われている。

さて、この状態において、制御対象１に設置された慣性センサ７は残留動揺角速度を検出する。
ここで、残留動揺角速度ωｒは、移動体の動揺に起因する角速度変動を空間安定により減じて残留した角速度である。図５Ａに示すように、この残留動揺角速度ωｒは０に近い値となる。残留動揺角速度ωｒは、慣性センサ７を支持部に固定設置した第１実施形態にかかる目標指向装置と比較して、小さな値を示す。

積分器８の出力である角度信号θｇは、図４Ｂに示すように、０に近い値となる。角度信号θｇは０に近い値であり、目標角度θｔは０であるので、軌道生成器６の出力は図４Ｄに示すように０となる。

一方、第２減算器１１は、角度信号θｇから、軌道生成器６からの角度信号を減算することで、角度信号θｇから制御対象１の角度分を除去する。
ゲイン１２は、第２減算器１１の出力にゲイン係数を乗算する（図５Ｂ）。
これにより、角度信号θｇから移動体の動揺角速度の角度換算値と同等の値を取り出す。
第１減算器９は、軌道生成器６からの角度信号からゲイン１２の出力を減算し、制御器３に目標指令Ｋｉとして出力する（図５Ｃ参照）。
これにより、制御対象１を目標指令Ｋｉに従って回転制御し、角度検出器２の出力は図４Ｃに示すように、ｓｉｎ波形状に変化する。

つまり、空間安定機能が効いてる状態であれば慣性センサ７による検出値は極めて小さい値になる。
そして、軌道生成器６の軌道生成用現在角度θkに慣性センサ７の出力を積分した結果を用いることで、軌道生成器６の出力が常に０又は０に近い値にできるとともにゲイン１２の出力により移動体動揺角度θｇ（図５Ｂ参照。）を検出できる。つまり、制御対象１を、移動体動揺角度θｇ（図５Ｂ参照。）と逆方向に動作（図４Ｃ参照。）するように駆動させ、移動体動揺角度θｇを打ち消し、制御対象１を慣性空間に静止させることができ、空間安定化を行うことができる。

（第３の実施形態）
次に、図６を用いて第３の実施形態にかかる目標指向装置について説明する。
図６は第３の実施形態にかかる目標指向装置の一例を表すブロック図を示す。
第２の実施形態と本実施形態とで共通する説明は省略し、第２の実施形態との相違点のみについて説明する。
第１積分器８は、第２の実施形態にかかる目標指向装置の積分器８と同じ機能を有し、名前のみを変更したものである。

第２減算器１１は、慣性センサ７の出力から軌道生成器６からの角速度信号を減算し、減算結果を第２積分器１３に出力する。
この減算した結果は、移動体動揺角速度に相当する。
第２積分器１３は、第２減算器１１の出力を積分し、演算結果をゲイン１２に入力する。
この積分した結果は、移動体動揺角度θｇに相当する。

第３の実施形態にかかる目標指向装置及び第２の実施形態にかかる目標指向装置は異なる構成を有するものの、ゲイン１２に入力される信号はともに角度軌道の影響を除去した移動体動揺角度θｇに相当するものである。第３の実施形態にかかる目標指向装置は、第２の実施形態にかかる目標指向装置と同様に、制御対象１を移動体動揺角度θｇと逆方向に回転するように駆動させて、移動体動揺角度θｇを打ち消し、制御対象１を慣性空間に静止させることができ、空間安定化を行うことができる。

なお、上記した実施例では１軸を前提にしている。しかし、本実施形態にかかる目標指向装置は１軸に限定されず、複数軸存在する場合でも各軸独立に本実施形態にかかる目標指向装置を用いることで適用できる。

また、上記した実施例では角度フィードバック制御系を前提にしている。しかし、本実施形態にかかる目標指向装置は角度フィードバック制御系に限定されず、角度が検出でき、目標指令として、角度や角速度を用いる制御系であればどのような制御系でも本実施形態にかかる目標指向装置を適用できる。

本発明は上記の実施例に限定されるものではなく、移動を伴う制御対象における目標となる軌道生成を行うことのできる目標指向装置に、さらに空間安定機能を持たせる場合に容易に適用することが可能である。

以上、実施の形態を参照して本願発明を説明したが、本願発明は上記によって限定されるものではない。本願発明の構成や詳細には、発明のスコープ内で当業者が理解し得る様々な変更をすることができる。

この出願は、２０１３年３月１５日に出願された日本出願特願２０１３−０５３８０８を基礎とする優先権を主張し、その開示の全てをここに取り込む。

１…制御対象、２…角度検出器、３…制御器、４…ドライバ、５…指令生成器、６…軌道生成器、７…慣性センサ、８…積分器、９…減算器、１０…加算器。

Claims (12)

1. 移動体に回動自在に取り付けられた制御対象を目標に従って制御する目標指向装置であって、
   目標角度と目標角速度とを設定する指令生成手段と、
   前記制御対象および前記移動体の少なくとも一方の現在角度状態が軌道生成用現在角度としてフィードバックされており、前記現在角度状態、前記目標角度および前記目標角速度に基づいて前記制御対象の軌道を生成するとともに、前記軌道に従った出力角度信号および出力角速度信号を出力する軌道生成手段と、
   前記制御対象の現在角度を検出する角度検出手段と、
   前記移動体に設置された慣性センサと、
   前記出力角度信号から前記移動体の動揺角度成分を減算する第１減算手段と、
   前記第１減算手段からの出力と前記角度検出手段からの前記現在角度とに基づいて制御信号を生成する制御器と、
   前記制御器からの制御信号に基づいて前記制御対象を駆動制御するドライバと、を備え、
   前記軌道生成手段にフィードバックされる前記軌道生成用現在角度は、前記移動体の動き成分と前記制御対象の動き成分との和である
   ことを特徴とする目標指向装置。
2. 請求項１に記載の目標指向装置において、
   前記慣性センサは前記移動体に設置されており、
   前記軌道生成用現在角度は前記移動体の動き成分と前記制御対象の動き成分との和であって、
   前記軌道生成手段にフィードバックされる前記軌道生成用現在角度は、前記移動体の動き成分と前記制御対象の動き成分とが合わさってキャンセルされることによりほぼゼロの値である
   ことを特徴とする目標指向装置。
3. 請求項１または請求項２に記載の目標指向装置において、
   前記慣性センサは前記移動体に設置され、
   前記慣性センサによる角速度検出値を積分して前記移動体の動揺角度成分を算出する積分手段と、
   前記積分手段による積分値と前記角度検出手段にて検出された前記現在角度とを加算する加算手段と、をさらに備え、
   前記積分手段にて算出された前記移動体の動揺角度成分を前記第１減算手段に入力し、
   前記加算手段による加算値を前記軌道生成用現在角度として前記軌道生成手段にフィードバックする
   ことを特徴とする目標指向装置。
4. 移動体に回動自在に取り付けられた制御対象を目標に従って制御する目標指向装置であって、
   目標角度と目標角速度とを設定する指令生成手段と、
   前記制御対象および前記移動体の少なくとも一方の現在角度状態が軌道生成用現在角度としてフィードバックされており、前記現在角度状態、前記目標角度および前記目標角速度に基づいて前記制御対象の軌道を生成するとともに、前記軌道に従った出力角度信号および出力角速度信号を出力する軌道生成手段と、
   前記制御対象の現在角度を検出する角度検出手段と、
   前記制御対象に設置された慣性センサと、
   前記出力角度信号から前記移動体の動揺角度成分を減算する第１減算手段と、
   前記第１減算手段からの出力と前記角度検出手段からの前記現在角度とに基づいて制御信号を生成する制御器と、
   前記制御器からの制御信号に基づいて前記制御対象を駆動制御するドライバと、を備え、
   前記軌道生成手段にフィードバックされる前記軌道生成用現在角度は、前記制御対象の動き成分である
   ことを特徴とする目標指向装置。
5. 請求項４に記載の目標指向装置において、
   前記慣性センサは、前記制御対象に設置され、
   前記軌道生成用現在角度は前記制御対象の動き成分であって、
   前記慣性センサによる角速度検出値を積分して角度成分とする積分手段と、
   前記軌道生成手段からの前記出力角度信号を前記角度成分から減算することにより前記移動体の動揺角度成分を取り出す第２減算手段と、をさらに備え、
   前記第２減算手段にて取り出された前記移動体の動揺角度成分を前記第１減算手段に入力し、
   前記積分手段にて算出された角度成分を前記軌道生成用現在角度として前記軌道生成手段にフィードバックする
   ことを特徴とする目標指向装置。
6. 請求項５に記載の目標指向装置において、
   前記第２減算手段からの出力に所定のゲインを乗算して前記移動体の動揺角度に相当する値とする
   ことを特徴とする目標指向装置。
7. 請求項４に記載の目標指向装置において、
   前記慣性センサは前記制御対象に設置され、
   前記軌道生成用現在角度は前記制御対象の動き成分であって、
   前記慣性センサによる角速度検出値を積分して角度成分とする積分手段と、
   前記軌道生成手段からの前記出力角速度信号を前記慣性センサによる角速度検出値から減算して前記移動体の動揺角速度成分を取り出す第３減算手段と、
   前記第３減算手段にて取り出された前記動揺角速度成分を積分して前記移動体の動揺角度成分を算出する第２積分手段と、をさらに備え、
   前記第２積分手段にて算出された前記移動体の動揺角度成分を前記第１減算手段に入力し、
   前記積分手段にて算出された角度成分を前記軌道生成用現在角度として前記軌道生成手段にフィードバックする
   ことを特徴とする目標指向装置。
8. 請求項７に記載の目標指向装置において、
   前記第２積分手段にて算出された角度成分の所定のゲインを乗算して前記移動体の動揺角度に相当する値とする
   ことを特徴とする目標指向装置。
9. 移動体に回動自在に取り付けられた制御対象を目標に従って制御する目標指向制御方法であって、
   目標角度と目標角速度とを設定し、
   前記制御対象および前記移動体の少なくとも一方の現在角度状態を軌道生成用現在角度としてフィードバックして、前記現在角度状態、前記目標角度および前記目標角速度に基づいて前記制御対象の軌道を生成し、前記軌道に従った出力角度信号および出力角速度信号を出力し、
   前記制御対象の現在角度を検出し、
   前記移動体に設置された慣性センサで動揺角速度を検出し、
   前記出力角度信号から前記移動体の動揺角度成分を減算し、この減算結果と前記現在角度とに基づいて制御信号を生成し、前記制御信号に基づいて前記制御対象を駆動制御し、
   前記軌道生成用現在角度を、前記移動体の動き成分と前記制御対象の動き成分と和とする
   ことを特徴とする目標指向制御方法。
10. 移動体に回動自在に取り付けられた制御対象を目標に従って制御する目標指向制御方法であって、
    目標角度と目標角速度とを設定し、
    前記制御対象および前記移動体の少なくとも一方の現在角度状態を軌道生成用現在角度としてフィードバックして、前記現在角度状態、前記目標角度および前記目標角速度に基づいて前記制御対象の軌道を生成し、前記軌道に従った出力角度信号および出力角速度信号を出力し、
    前記制御対象の現在角度を検出し、
    前記制御対象に設置された慣性センサで動揺角速度を検出し、
    前記出力角度信号から前記移動体の動揺角度成分を減算し、この減算結果と前記現在角度とに基づいて制御信号を生成し、前記制御信号に基づいて前記制御対象を駆動制御し、
    前記軌道生成用現在角度を、前記制御対象の動き成分とする
    ことを特徴とする目標指向制御方法。
11. 移動体に回動自在に取り付けられた制御対象と、前記制御対象の現在角度を検出する角度検出手段と、前記移動体に設置された慣性センサと、を有し、目標に従って前記制御対象を制御する目標指向装置にコンピュータを組み込んで、
    このコンピュータを、
    目標角度と目標角速度とを設定する指令生成手段と、
    前記制御対象および前記移動体の少なくとも一方の現在角度状態が軌道生成用現在角度としてフィードバックされており、前記現在角度状態、前記目標角度および前記目標角速度に基づいて前記制御対象の軌道を生成するとともに、前記軌道に従った出力角度信号および出力角速度信号を出力する軌道生成手段と、
    前記出力角度信号から前記移動体の動揺角度成分を減算する第１減算手段と、
    前記第１減算手段からの出力と前記角度検出手段からの前記現在角度とに基づいて制御信号を生成する制御器と、として機能させ、
    軌道生成手段にフィードバックされる前記軌道生成用現在角度は、前記移動体の動き成分と前記制御対象の動き成分との和である
    ことを特徴とする目標指向制御プログラム。
12. 移動体に回動自在に取り付けられた制御対象と、前記制御対象の現在角度を検出する角度検出手段と、前記制御対象に設置された慣性センサと、を有し、目標に従って前記制御対象を制御する目標指向装置にコンピュータを組み込んで、
    このコンピュータを、
    目標角度と目標角速度とを設定する指令生成手段と、
    前記制御対象および前記移動体の少なくとも一方の現在角度状態が軌道生成用現在角度としてフィードバックされており、前記現在角度状態、前記目標角度および前記目標角速度に基づいて前記制御対象の軌道を生成するとともに、前記軌道に従った出力角度信号および出力角速度信号を出力する軌道生成手段と、
    前記出力角度信号から前記移動体の動揺角度成分を減算する第１減算手段と、
    前記第１減算手段からの出力と前記角度検出手段からの前記現在角度とに基づいて制御信号を生成する制御器と、として機能させ、
    軌道生成手段にフィードバックされる前記軌道生成用現在角度は、前記制御対象の動き成分である
    ことを特徴とする目標指向制御プログラム。

Images