(57)【要約】【課題】  人工衛星の姿勢について適応制御を行う際、未知のパラメータの随時更新によって、推定及び更新項がフィードバック制御系ゲインに加えられることになり、見かけ上ゲインが変更されたことになり、制御系安定性に影響を与えるため、制御系設計上の制約が大きくなるという問題があった。【解決手段】  未知パラメータの推定及び更新を、姿勢変更開始から終了までの間で非随時とすることで、姿勢変更時に発生する姿勢角度誤差を、当該更新以降で抑制することによって、制御系の安定性を損なうことなく外乱を抑制することができる。【選択図】      図１
2010211282.tif 000002
【特許請求の範囲】
【請求項１】
角度を検出する角度検出センサと、
角速度を検出する角速度検出センサと、
上記角度検出センサの出力と目標角度との角度誤差と、上記角速度検出センサの出力と目標角速度との角速度誤差に基づいて、姿勢制御対象の慣性テンソルを含む未知パラメータを推定し、推定結果に基づいて未知パラメータを更新し、更新した未知パラメータに基づいてフィードフォワードトルクを求めるパラメータ推定及び更新部と、
上記角度誤差及び角速度誤差と、ゲインと、上記フィードフォワードトルクに基づいて指令値が入力され、上記姿勢制御対象の姿勢を変更するアクチュエータと、
を備え、
上記パラメータ推定及び更新部は、上記姿勢制御対象の姿勢変更開始から姿勢変更終了までの間に、一度もしくは複数回断続的に未知パラメータの更新を行うことを特徴とした適応制御装置。
【発明の詳細な説明】
【技術分野】
【０００１】
この発明は、人工衛星や宇宙機等の姿勢変更時に、未知のパラメータによる外乱を抑制する、適応制御装置に関するものである。
【背景技術】
【０００２】
外乱発生時に、未知のパラメータを推定、更新して姿勢制御を行う、人工衛星姿勢制御系の適応制御則が一般的に知られている。未知のパラメータの推定、及び更新則を制御系に組み込むことで、見かけ上フィードバック制御系ゲインを変更することができる。従来の適応制御則では、更新則による影響を加味した上で制御系が安定となるように設計する必要がある。
【先行技術文献】
【特許文献】
【０００３】
【特許文献１】特開昭６０−４４９７号公報
【非特許文献１】山田克彦 他「データ中継衛星DRTSの適応形姿勢制御系の機能確認試験」、日本機械学会論文集(C編)70巻689号(2004-1)、論文No.03-0309、p.97-104
【発明の概要】
【発明が解決しようとする課題】
【０００４】
従来の適応制御則では、人工衛星や宇宙機等の姿勢変更時に、例えば慣性モーメントやトルク等の未知のパラメータを推定、更新することで外乱を抑制できる。この際、未知のパラメータの随時更新によって、推定及び更新項がフィードバック制御系ゲインに加えられることになり、見かけ上ゲインが変更されたことになる。しかし、最悪の場合、見かけ上のゲインが強まることによって、制御系安定性に影響を与えるため、例えば制御余有を十分に確保するなど、制御系設計上の制約が大きくなるという問題があった。
【０００５】
この発明は、上記課題を解決するためになされたものであり、フィードバック制御系ゲインに見かけ上の影響を与えず、かつ、未知のパラメータを推定、更新し、外乱を抑制する適応制御装置を得ることを目的とする。
【課題を解決するための手段】
【０００６】
この発明による適応制御装置は、角度を検出する角度検出センサと、角速度を検出する角速度検出センサと、上記角度検出センサの出力と目標角度との角度誤差と、上記角速度検出センサの出力と目標角速度との角速度誤差に基づいて、姿勢制御対象の慣性テンソルを含む未知パラメータを推定し、推定結果に基づいて未知パラメータを更新し、更新した未知パラメータに基づいてフィードフォワードトルクを求めるパラメータ推定及び更新部と、上記角度誤差及び角速度誤差と、ゲインと、上記フィードフォワードトルクに基づいて指令値が入力され、上記姿勢制御対象の姿勢を変更するアクチュエータと、を備え、上記パラメータ推定及び更新部は、上記姿勢制御対象の姿勢変更開始から姿勢変更終了までの間に、一度もしくは複数回断続的に未知パラメータの更新を行うことを特徴としたものである。
【発明の効果】
【０００７】
この発明によれば、制御系が安定して姿勢誤差が小さくなるとともに、所定の外乱抑制効果を得ることができる。
【図面の簡単な説明】
【０００８】
【図１】この発明に係る実施の形態１による適応制御装置の構成を説明するための図である。
【図２】この発明に係る実施の形態１による未知パラメータ推定、更新方法の効果を説明するための図である。
【発明を実施するための形態】
【０００９】
実施の形態１．
以下、図を用いてこの発明に係る実施の形態１について説明する。
図１は、実施の形態１による人工衛星や宇宙機等の宇宙装置本体の姿勢制御を行う適応制御装置の構成を示す図であり、適応制御装置の簡略化した制御系ブロック図を示している。図において、適応制御装置は、未知パラメータ推定及び更新則部１と、ゲイン４１、４２と、加算器５，６，７，８と、センサ１０，１１と、調整部１２とを備えて構成される。また、符号１３は、人工衛星や宇宙機等の宇宙装置本体のダイナミクスを示している。
【００１０】
センサ１０は、例えば人工衛星の姿勢角を検出する姿勢角検出器である。姿勢角検出器としては、スターセンサ、地球センサ、地磁気センサ、ジャイロスコープなどが用いられる。センサ１１は、例えば人工衛星の角速度を検出する角速度検出器である。角速度検出器としては、レートジャイロ、加速度センサなどが用いられる。加算器５は、センサ１０からフィードバックされる角度推定値θ＾と、外部入力される角度目標値θｒｅｆとの差分θｅｒｒを角度誤差として求め、その角度誤差θｅｒｒをゲイン４１に入力する。ゲイン４１は、角度誤差θｅｒｒに比例ゲインＫｐを乗算し、加算器７に出力する。加算器６は、センサ１１からフィードバックされる角速度推定値ω＾と、外部入力される角速度目標値ωｒｅｆとの差分ωｅｒｒを角速度誤差として求め、その角速度誤差ωｅｒｒをゲイン４２に入力する。ゲイン４２は、角速度誤差ωｅｒｒに微分ゲインＫｄを乗算し、加算器７に出力する。加算器７は、ゲイン４１の出力Ｋｐθｅｒｒとゲイン４２の出力Ｋｄωｅｒｒを加算し、その加算結果であるＫｐθｅｒｒ＋Ｋｄωｅｒｒを、加算器８に出力する。加算器８は、Ｋｐθｅｒｒ＋Ｋｄωｅｒｒと、フィードフォワードトルクＴ〜ｆｆとを加算し、その加算結果を調整部１２に入力する。未知パラメータ推定及び更新則部１は、角度誤差θｅｒｒと角速度誤差ωｅｒｒに基づいて、フィードフォワードトルクＴ〜ｆｆを求める。フィードフォワードトルクＴ〜ｆｆは、式１で与えられる。
【００１１】
【数１】
2010211282.tif 000003
【００１２】
調整部１２は、制御系フィルターと、モーメンタムホイールやスラスタなどのアクチュエータを有しており、加算器８から入力されたＫｐθｅｒｒ＋Ｋｄωｅｒｒ＋Ｔ〜ｆｆにフィルター処理を施した後、そのフィルタ処理結果を指令値としてアクチュエータに入力し、指令値に基づいてアクチュエータを駆動することによって、宇宙装置本体の姿勢制御を行う。宇宙装置本体は、アクチュエータの駆動出力及びダイナミクス１３に基づいて姿勢が変化し、センサ１０，１１によってその姿勢角及び角速度が検出される。
【００１３】
実施の形態１の適応制御装置は、未知パラメータ推定及び更新則部１に特徴を有する。未知パラメータ推定及び更新則部１は、角度誤差θｅｒｒ及び角速度誤差ωｅｒｒを基に、誤差を含む慣性テンソル推定値の推定、更新を行う。この場合、未知パラメータとは慣性テンソル真値を指すことになる。ただし、以下で説明する方式では、制御対象である宇宙装置本体の慣性テンソルのほか、アクチュエータ慣性テンソル推定誤差、アクチュエータトルク変換式誤差等、トルクに影響を与える全ての未知パラメータの影響を含め、角度誤差、角速度誤差が最小となるように慣性テンソル値が推定、更新される。
【００１４】
慣性テンソル推定値と慣性テンソル真値の間に誤差がある場合、見かけ上、式２に示す外乱トルクΔＴが入力される。ただし、記号の定義は図１に示したとおりである。
【００１５】
【数２】
2010211282.tif 000004
【００１６】
式２に示す外乱トルクΔＴのため、宇宙装置本体には、角度誤差、角速度誤差が発生する。また、定常状態の場合、式３に示す角度誤差、角速度誤差に収束する。
【００１７】
【数３】
2010211282.tif 000005
【００１８】
式３の角度誤差から外乱トルクΔＴを求めることができるため、式２と合わせることで外乱トルクΔＴをゼロとするように、慣性テンソル推定値を推定、更新することができる。
【００１９】
なお、外乱トルクをゼロとするよう推定、更新すると、制御対象である宇宙装置本体の慣性テンソルのほか、アクチュエータ慣性テンソル推定誤差、アクチュエータトルク変換式誤差等、トルクに影響を与える全ての未知パラメータの影響を含め、角度誤差、角速度誤差が最小となるよう慣性テンソル値が推定、更新できる。
【００２０】
2010211282.tif 000006
【００２１】
【数４】
2010211282.tif 000007
【００２２】
従来の適応制御則では、角度誤差、角速度誤差等の誤差をゼロに収束させるフィルタとして更新則を定式化するため、常に未知パラメータを推定、更新することとなる。そのため、更新則により見かけ上フィードバック制御系ゲイン（Ｋｐ、Ｋｄ）が変更される。また、常に角度誤差を小さく抑えようと推定、更新則が動作するため、結果として式３に表すような角度誤差は現れず、式３等に示す誤差から決定論的に外乱トルクをゼロとする推定、更新はできない。
【００２３】
一方、人工衛星において機動性の高い姿勢変更を実施する場合、姿勢変更途中に角度誤差が発生することは最終的な姿勢安定の観点からは問題とならず、姿勢変更終了近傍の角度誤差を小さく抑えることが課題となることが多い。この場合、式３等に示す誤差が姿勢変更中に発生することは問題とならない。
【００２４】
このことを利用し、実施の形態１の適応制御装置は、未知パラメータを非随時更新とすることで式３等に示す誤差を姿勢変更中に発生させ、そこから決定論的に外乱トルクの推定、更新を行うことで、外乱トルクをゼロとすることができる。
【００２５】
図２は、実施の形態１による適応制御装置の未知パラメータ推定、更新手法と、その手法による効果を説明するためのシミュレーション結果を示す図である。図２において、（ｂ）適応制御なし、（ｃ）従来の適応制御、（ｄ）実施の形態１による適応制御、のそれぞれの場合について、（ａ）に示す姿勢角目標値を与えた際の、姿勢変更開始から姿勢変更終了までの間の宇宙装置本体の角度誤差変化を示している。
【００２６】
実施の形態１による適応制御装置は、未知パラメータの推定及び更新を、次の１）〜４）の更新則に基づいて行う。
１）宇宙装置本体の姿勢変更（マヌーバ）時以外は、未知パラメータを更新しない。
２）宇宙装置本体の姿勢変更（マヌーバ）開始から、中間点付近までのデータを用いて、未知パラメータの推定を行う。
３）宇宙装置本体の姿勢変更（マヌーバ）の中間点付近で、所定の回数（一回のみもしくは断続的に数回）だけ、未知パラメータの更新を行う。
４）宇宙装置本体の姿勢変更（マヌーバ）の後半は、未知パラメータにて姿勢制御を行う。
【００２７】
すなわち、未知パラメータは非随時更新とし、姿勢変更途中まで更新をしない。そのため、数式３等に示す誤差が発生する。その後、姿勢変更途中の任意のタイミングで（任意の回数）、数式３等に示す誤差による外乱トルクΔＴをゼロとするよう、未知パラメータの推定、更新を行う。
【００２８】
例えば、図２（ｄ）に示すように、実施の形態１の適応制御装置は、姿勢変更開始から姿勢変更終了までの中間点で、一度だけ未知パラメータの推定及び更新を行う。これにより、図２（ｂ）の適用制御適用なしの場合に比べて、図２（ｄ）では姿勢変更終了時点での角度誤差が収束していることがわかる。しかも、図２（ｃ）の従来の適応制御装置と比べて、その角度誤差は同程度に収束している。また、図２（ｄ）に示すように、実施の形態１の適応制御装置では、姿勢変更開始から中間地点までの間では角度誤差が生じているが、この角度誤差の発生は最終的な姿勢安定の観点からは問題とならないことがわかる。
【００２９】
このように、未知パラメータの更新後は、外乱トルクがゼロに近くなるため、姿勢変更終了近傍における角度誤差等はゼロに近くなるので、制御系が安定するとともに姿勢誤差が小さくなり、随時推定・更新する従来の適応制御則と同様の外乱抑制効果を得ることができる。
【００３０】
また、この方式では、宇宙装置の姿勢変更途中に決定論的に推定、更新を行うため、フィードバック制御系ゲインが見かけ上変更されることはない。したがって、制御系設計上の制約とはならず、従来の適用制御則の欠点のみを解決することができる。
【００３１】
さらに、この方式では、各姿勢変更の状態に合わせて推定、更新を行うため、各姿勢変更の特性（変更方向）に応じ、誤差を最小とする推定値を得ることができる。また、この技術を応用することで、各姿勢変更特性毎の未知パラメータを得ることもできる。例えば、マヌーバ軸の違いによるパラメータ推定誤差の変動分も補正できる。これにより、各マヌーバの後半では姿勢誤差変動が小さくなり、整定時間が短くなるので、宇宙装置の姿勢制御について高機動性を実現することが可能となる。
【符号の説明】
【００３２】
１ 未知パラメータ推定及び更新則部、１０，１１  センサ、１２  調整部、１３  ダイナミクス、４１，４２ フィードバック制御系ゲイン 。
【図１】
2010211282.tif 000008
【図２】
2010211282.tif 000009