JP6837574B2 - 宇宙機並びに宇宙機の動作を制御する制御システム及び方法 - Google Patents

宇宙機並びに宇宙機の動作を制御する制御システム及び方法 Download PDF

Info

Publication number
JP6837574B2
JP6837574B2 JP2019553124A JP2019553124A JP6837574B2 JP 6837574 B2 JP6837574 B2 JP 6837574B2 JP 2019553124 A JP2019553124 A JP 2019553124A JP 2019553124 A JP2019553124 A JP 2019553124A JP 6837574 B2 JP6837574 B2 JP 6837574B2
Authority
JP
Japan
Prior art keywords
spacecraft
thruster
model
mpc
thrusters
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Active
Application number
JP2019553124A
Other languages
English (en)
Other versions
JP2020515455A (ja
Inventor
ワイス、アビシャイ
ズロトニク、デイビッド
ディ・カイラノ、ステファノ
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Mitsubishi Electric Corp
Original Assignee
Mitsubishi Electric Corp
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Mitsubishi Electric Corp filed Critical Mitsubishi Electric Corp
Publication of JP2020515455A publication Critical patent/JP2020515455A/ja
Application granted granted Critical
Publication of JP6837574B2 publication Critical patent/JP6837574B2/ja
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • BPERFORMING OPERATIONS; TRANSPORTING
    • B64AIRCRAFT; AVIATION; COSMONAUTICS
    • B64GCOSMONAUTICS; VEHICLES OR EQUIPMENT THEREFOR
    • B64G1/00Cosmonautic vehicles
    • B64G1/22Parts of, or equipment specially adapted for fitting in or to, cosmonautic vehicles
    • B64G1/24Guiding or controlling apparatus, e.g. for attitude control
    • B64G1/244Spacecraft control systems
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B64AIRCRAFT; AVIATION; COSMONAUTICS
    • B64GCOSMONAUTICS; VEHICLES OR EQUIPMENT THEREFOR
    • B64G1/00Cosmonautic vehicles
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B64AIRCRAFT; AVIATION; COSMONAUTICS
    • B64GCOSMONAUTICS; VEHICLES OR EQUIPMENT THEREFOR
    • B64G1/00Cosmonautic vehicles
    • B64G1/22Parts of, or equipment specially adapted for fitting in or to, cosmonautic vehicles
    • B64G1/24Guiding or controlling apparatus, e.g. for attitude control
    • B64G1/242Orbits and trajectories
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B64AIRCRAFT; AVIATION; COSMONAUTICS
    • B64GCOSMONAUTICS; VEHICLES OR EQUIPMENT THEREFOR
    • B64G1/00Cosmonautic vehicles
    • B64G1/22Parts of, or equipment specially adapted for fitting in or to, cosmonautic vehicles
    • B64G1/24Guiding or controlling apparatus, e.g. for attitude control
    • B64G1/242Orbits and trajectories
    • B64G1/2429Station keeping
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B64AIRCRAFT; AVIATION; COSMONAUTICS
    • B64GCOSMONAUTICS; VEHICLES OR EQUIPMENT THEREFOR
    • B64G1/00Cosmonautic vehicles
    • B64G1/22Parts of, or equipment specially adapted for fitting in or to, cosmonautic vehicles
    • B64G1/24Guiding or controlling apparatus, e.g. for attitude control
    • B64G1/26Guiding or controlling apparatus, e.g. for attitude control using jets
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B64AIRCRAFT; AVIATION; COSMONAUTICS
    • B64GCOSMONAUTICS; VEHICLES OR EQUIPMENT THEREFOR
    • B64G1/00Cosmonautic vehicles
    • B64G1/22Parts of, or equipment specially adapted for fitting in or to, cosmonautic vehicles
    • B64G1/24Guiding or controlling apparatus, e.g. for attitude control
    • B64G1/26Guiding or controlling apparatus, e.g. for attitude control using jets
    • B64G1/262Guiding or controlling apparatus, e.g. for attitude control using jets having adjustable angles, e.g. gimbaled thrusters
    • B64G1/264Guiding or controlling apparatus, e.g. for attitude control using jets having adjustable angles, e.g. gimbaled thrusters mounted on adjustable booms or the like
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B64AIRCRAFT; AVIATION; COSMONAUTICS
    • B64GCOSMONAUTICS; VEHICLES OR EQUIPMENT THEREFOR
    • B64G1/00Cosmonautic vehicles
    • B64G1/22Parts of, or equipment specially adapted for fitting in or to, cosmonautic vehicles
    • B64G1/24Guiding or controlling apparatus, e.g. for attitude control
    • B64G1/28Guiding or controlling apparatus, e.g. for attitude control using inertia or gyro effect
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B64AIRCRAFT; AVIATION; COSMONAUTICS
    • B64GCOSMONAUTICS; VEHICLES OR EQUIPMENT THEREFOR
    • B64G1/00Cosmonautic vehicles
    • B64G1/22Parts of, or equipment specially adapted for fitting in or to, cosmonautic vehicles
    • B64G1/24Guiding or controlling apparatus, e.g. for attitude control
    • B64G1/244Spacecraft control systems
    • B64G1/245Attitude control algorithms for spacecraft attitude control
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B64AIRCRAFT; AVIATION; COSMONAUTICS
    • B64GCOSMONAUTICS; VEHICLES OR EQUIPMENT THEREFOR
    • B64G1/00Cosmonautic vehicles
    • B64G1/22Parts of, or equipment specially adapted for fitting in or to, cosmonautic vehicles
    • B64G1/24Guiding or controlling apparatus, e.g. for attitude control
    • B64G1/28Guiding or controlling apparatus, e.g. for attitude control using inertia or gyro effect
    • B64G1/283Guiding or controlling apparatus, e.g. for attitude control using inertia or gyro effect using reaction wheels
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B64AIRCRAFT; AVIATION; COSMONAUTICS
    • B64GCOSMONAUTICS; VEHICLES OR EQUIPMENT THEREFOR
    • B64G1/00Cosmonautic vehicles
    • B64G1/22Parts of, or equipment specially adapted for fitting in or to, cosmonautic vehicles
    • B64G1/24Guiding or controlling apparatus, e.g. for attitude control
    • B64G1/28Guiding or controlling apparatus, e.g. for attitude control using inertia or gyro effect
    • B64G1/285Guiding or controlling apparatus, e.g. for attitude control using inertia or gyro effect using momentum wheels
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B64AIRCRAFT; AVIATION; COSMONAUTICS
    • B64GCOSMONAUTICS; VEHICLES OR EQUIPMENT THEREFOR
    • B64G1/00Cosmonautic vehicles
    • B64G1/22Parts of, or equipment specially adapted for fitting in or to, cosmonautic vehicles
    • B64G1/24Guiding or controlling apparatus, e.g. for attitude control
    • B64G1/28Guiding or controlling apparatus, e.g. for attitude control using inertia or gyro effect
    • B64G1/286Guiding or controlling apparatus, e.g. for attitude control using inertia or gyro effect using control momentum gyroscopes (CMGs)
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B64AIRCRAFT; AVIATION; COSMONAUTICS
    • B64GCOSMONAUTICS; VEHICLES OR EQUIPMENT THEREFOR
    • B64G1/00Cosmonautic vehicles
    • B64G1/22Parts of, or equipment specially adapted for fitting in or to, cosmonautic vehicles
    • B64G1/24Guiding or controlling apparatus, e.g. for attitude control
    • B64G1/36Guiding or controlling apparatus, e.g. for attitude control using sensors, e.g. sun-sensors, horizon sensors

Landscapes

  • Engineering & Computer Science (AREA)
  • Remote Sensing (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Chemical & Material Sciences (AREA)
  • Combustion & Propulsion (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Automation & Control Theory (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
  • Feedback Control In General (AREA)

Description

本開示は包括的には宇宙機の動作を制御することに関し、より詳細には、後退ホライズンにわたる、モデル予測制御(MPC:model predictive control)を使用する同時の軌道位置(station)保持、姿勢制御及び運動量管理に関する。
軌道上の宇宙機は、その軌道位置、すなわち、所望の軌道及び所望の軌道上の所望の位置、を維持するその能力に影響を及ぼす様々な外乱力を受ける。これらの力を打ち消すために、宇宙機は、一般に、軌道位置保持操縦(maneuvers:マニューバ)のためのスラスタを装備している。軌道摂動に加えて、宇宙機は、当該宇宙機が地球又は恒星に対して所望の方位を維持することを可能にするリアクションホイール又はコントロールモーメントジャイロスコープ等のオンボード運動量交換デバイスによって概ね吸収される外部トルクによって外乱を受ける可能性がある。運動量交換デバイスの飽和及びその後の所望の宇宙機の姿勢の喪失を防止するために、蓄積された角運動量は、オンボードスラスタを介して周期的にアンロードされる。軌道位置保持及び運動量アンロードを組み合わせたものにスラスタの同じセットを用いるという問題は、複数の目的をもたらし、そのような目的を同時に達成するためにそれらを調整する方法は困難である。これについては、例えば、スラスタのトルク及び力に利用可能な最大値を用いることによって制御を簡素化する特許文献1に記載された方法を参照されたい。
さらに、スラスタプルームの衝突の危険を伴うことなくアンテナ及び太陽電池パネルを展開することができるようにするには、多くの場合、宇宙機におけるスラスタの配置には制限がある。軌道位置保持及び運動量アンロードの双方に用いられるスラスタの配置が制限されることにより、スラスタが、衛星に対して正味の力も印加することなく純粋なトルクを提供することが妨げられる可能性がある。したがって、スラスタの噴射は、宇宙機の位置及び方位(姿勢)並びに蓄積された運動量に影響を及ぼす場合があり、これによって、同時の軌道位置保持、姿勢制御、及び運動量管理の問題が発生する。
宇宙機のモデル予測制御(MPC)は、オンボード制御システムにおいて実施することができ、結果として、より厳格で、かつ正確な軌道位置保持、姿勢制御及び運動量アンロードをもたらすことができる自律制御を提供することができる。しかしながら、オンボード制御システムは、計算能力及び記憶容量が限られる可能性がある。そのため、宇宙機上のスラスタの配置に関する種々の制限を考慮するMPCの計算効率の良い実施態様は困難である。
それゆえ、同時の軌道位置保持、姿勢制御及び運動量管理のために、宇宙機の動作を制御する改善された方法が当該技術分野において必要とされている。
米国特許第8,282,043号
本開示の実施形態は、後退ホライズンにわたるモデル予測制御(MPC)を使用する同時の軌道位置保持、姿勢制御及び運動量管理のために、宇宙機の動作を制御することに関する。
本開示のいくつかの実施形態は、宇宙機のスラスタの配置及び/又は回転範囲に関する種々の制限を考慮する、宇宙機のオンボード制御システムにおいて実施することができるモデル予測制御(MPC)を提供する。具体的には、MPCは、宇宙機の姿勢をもたらす宇宙機のダイナミクスのモデルと、宇宙機の方位をもたらす宇宙機の運動量交換デバイスのダイナミクスのモデルとを用いて、有限後退ホライズンにわたってコスト関数を最適化することによって、スラスタコントローラを介して宇宙機のスラスタを制御するための解を生成することができる。
例えば、本開示は、宇宙機の複数のスラスタによって生成されるスラスト角に関するハード制約及びソフト制約を条件としてMPCを最適化することができるという認識に基づく。具体的には、ハード制約が、或る解におけるスラスト角がハード制約によって規定される所定の範囲内に入るように要求するとき、ソフト制約は、その解に、宇宙機の質量中心を通り抜けるトルクフリースラストに対応する公称角からのスラスト角の偏差に関してペナルティを科すことができる。数多くの態様の中でも、MPCの少なくとも1つの態様は、MPCが、MPCの解に従って、単一の1組のスラスタを動作させるスラスタコントローラを用いて、宇宙機の軌道位置、方位及び累積されるオンボード運動量の同時制御を提供できることである。
しかしながら、この実現に際しては、スラスタプルームの衝突の危険を伴うことなくアンテナ及び太陽電池パネルを展開することができるようには、宇宙機上のスラスタの配置に関する制限に対処する方法を含む、数多くの課題に直面した。例えば、軌道位置保持及び運動量アンロードの双方に用いられるスラスタの配置が制限されることにより、スラスタが、衛星に対して正味の力も印加することなく純粋なトルクを提供することが妨げられる可能性があり、逆もまた同様である。換言すると、これは、スラスタの噴射が、宇宙機の位置及び方位(姿勢)並びに蓄積された運動量に影響を及ぼす場合があり、これによって、同時の軌道位置保持、姿勢制御、及び運動量管理の問題が発生することを意味する。
最初に、軌道内で宇宙機が自らの軌道位置を保持する能力に影響を及ぼす可能性がある種々の外乱力をより深く理解する必要があった。これらの種々の外乱力を打ち消すために、軌道位置保持操縦のために、宇宙機のスラスタを使用できることがわかった。また、軌道摂動に加えて、宇宙機は外部トルクによって妨害される可能性があり、外部トルクは一般に、宇宙機が地球又は恒星に対して所望の方位を保持することを可能にする、リアクションホイール又はコントロールモーメントジャイロスコープ等のオンボード運動量交換デバイスによって吸収される。その場合に、運動量交換デバイスの飽和を防ぐために、蓄積された角運動量を、オンボードスラスタを介して定期的にアンロードすることができる。しかしながら、直面した少なくとも1つの問題として、同じ1組のスラスタを使用する複合的な軌道位置保持及び運動量アンロードの問題が多くの目的を生み出す結果となり、それらを同時に達成するために、そのような目的を調整するための方法が生じることになった。
MPCを用いて、オンボード制御システムにおいて実施される自律制御を提供し、より厳格で、かつ正確な軌道位置保持、姿勢制御及び運動量アンロードであると思われるものを提供できる、提案される解法を発見した。しかしながら、提案される解法は、数多くの課題、すなわち、上記のような、スラスタプルームの衝突の危険を伴うことなくアンテナ及び太陽電池パネルを展開できるような宇宙機上のスラスタの配置に関する制限に直面することを後に発見した。本発明において提案される解法について理解したことは、スラスタの配置及び/又は回転範囲に関する制限は、MPCによって、スラスト角に関するハード制約と見なすことができ、MPCがそのようなハード制約に違反する解を生成するのを防ぐことができることである。しかしながら、ハード制約が望ましくない可能性があること、及び結果として宇宙機のダイナミクスを複雑にする可能性があることがわかった。
例えば、スラスト角に関するハード制約は、スラストのトルクフリー角の効率を下げる可能性があり、MPCの解に、宇宙機に及ぼす正味の力及びトルクの両方を与えるスラストを生成するように指示する可能性がある。これらのトルク誘発スラストの結果として、宇宙機の不要な回転が生じる可能性がある。オンボード運動量交換デバイスは、宇宙機の不要な回転を補償することができ、その補償は、MPCの解において考慮することができる。しかしながら、運動量交換デバイスのダイナミクスは、スラスタのダイナミクスより緩慢である可能性があり、スラスタの動作に及ぼす運動量交換デバイスの動作の影響は、MPCの予測ホライズンから外れる可能性がある。そのため、MPCは、上記で言及されたように、宇宙機の姿勢及び累積されるオンボード運動量の両方に関して適した解を与えることができない可能性がある。
習得したこの問題に対する1つの解法は、予測ホライズンを長くすることである。例えば、無限予測ホライズンを用いるMPCは、宇宙機の種々の構成要素のダイナミクスの応答に関するそのような変動を考慮することができる。しかしながら、無限予測ホライズンを用いるMPCは、オンボードコントローラの計算要件に負担をかけ、宇宙機から期待される、長期にわたる自律制御にとって望ましくない。そのため、本開示のいくつかの実施形態は、有限予測ホライズンを用いるMPCを用いて宇宙機を制御する。例えば、1つの実施態様では、有限予測ホライズンは24時間とすることができ、それは宇宙機の予測制御にとって標準であると考えられる。
この問題に対する別の解法は、宇宙機の方位を制御する必要がないときに、MPCに強制的にトルクフリースラストのみを生成させることである。しかしながら、宇宙機のいくつかの構成では、そのようなトルクフリースラストは準最適である可能性がある。例えば、いくつかの実施態様において、宇宙機バスに取り付けられたジンバル上に搭載されるスラスタ。スラスタの運動範囲は、南北搭載太陽電池パネル上のプルームの衝突の可能性に起因して制限される。また、南北軌道位置保持において、平面外の径方向におけるスラストは、Δv消費において支配的な成分である。しかしながら、衛星の非天底面(anti-nadir face)に配置されるスラスタの場合、スラストのトルクフリー角、すなわち、スラスタを強制的に衛星の質量中心を通って噴射させる角度は、結果として、径方向において非常に無駄な労力が生じる。したがって、Δv効率に関して、ジンバルは多くの場合にその限界において動作し、衛星上に望ましくないトルクを生成し、運動量交換デバイスに無用に負荷をかける。それにより、全角運動量蓄積に関する限界に起因して、運動量交換デバイス、例えば、リアクションホイールによって、結果として運動量管理において更なるΔvが費やされる。
さらに、本開示のいくつかの実施形態は、トルク誘発スラストを許容できるが、トルクが不要であるときに阻止できるという理解に基づく。そのため、本開示のいくつかの実施形態は、スラスト角に関するハード制約を課すことに加えて、スラスト角に関するソフト制約を課し、宇宙機の質量中心を通り抜けるトルクフリースラストに対応する公称角からの角度の偏差にペナルティを科す。
本開示において、ペナルティを科すという用語は、最適化及び制御コミュニティによって採用される通常の意味において使用される。例えば、本開示のいくつかの実施形態において、ソフト制約は、ハード制約を受けたMPCによって最適化されたコスト関数の構成要素として定式化される。
MPCがコスト関数を最小化する場合には、その構成要素の値が、MPCによって生成されるスラスト角と公称角との間の差に比例して、例えば、線形に、又は非線形に増加する。MPCによって最小化されるそのようなコスト関数の例が、宇宙機の燃料効率を考慮する関数を含む。対照的に、MPCがコスト関数を最大化する場合には、その構成要素の値は、公称角からの偏差に比例して減少する。MPCによって最大化されるそのようなコスト関数の例が、宇宙機の目標姿勢に達するのに要する時間を考慮する関数を含む。
またさらに、本開示のいくつかの実施形態は、宇宙機のスラスタを制御するための解を生成するモデル予測コントローラ(MPC)と、MPCの解に従ってスラスタを動作させるスラスタコントローラとを含む宇宙機の動作を制御する制御システムを開示する。MPCは、宇宙機の姿勢をもたらす宇宙機のダイナミクスのモデルと、宇宙機の方位をもたらす宇宙機の運動量交換デバイスのダイナミクスのモデルとを用いて、有限後退ホライズンにわたってコスト関数を最適化することによって解を生成する。その最適化は、宇宙機のスラスタによって生成されたスラスト角に関するハード制約及びソフト制約を受ける。ハード制約は、解内のスラスト角がハード制約によって規定される所定の範囲内に入るように要求する。ソフト制約は、MPCの解に、宇宙機の質量中心を通り抜けるトルクフリースラストに対応する公称角からのスラスト角の偏差に関してペナルティを科す。
そのようにして、MPCは、予測ホライズンの長さの延長を必要とすることなく、その解を調整する。さらに、MPCはここでは、宇宙機の姿勢をもたらす宇宙機のダイナミクスと、宇宙機の方位をもたらす宇宙機の運動量交換デバイスのダイナミクスとの両方を考慮する多目的MPCである。例えば、いくつかの実施態様において、コスト関数は、目標姿勢からの宇宙機の変位にペナルティを科す宇宙機の姿勢に関する構成要素と、蓄積された運動量の大きさの値が大きいほどペナルティを科す、運動量交換デバイスによって蓄積される運動量に関する構成要素とを含む。それに加えて、又は代替的に、コスト関数の構成要素として、MPCにソフト制約を含むこともできる。
本開示のいくつかの実施形態は、ソフト制約が有限後退ホライズンの限界を補償することができるだけでなく、MPCの最適化の近似を容易にするために使用することもできるという理解に基づく。例えば、いくつかの実施形態において、コスト関数の最適化は、二次計画法(QP:quadratic program)として定式化される。二次計画法は、オンボード計算能力が制限された宇宙機等のリソース制約のあるハードウェアにおいてより高速かつ効率的に解くことができる。二次計画法を利用するために、本開示のいくつかの実施形態は、本明細書においてLQ−MPCと呼ばれる、MPCの線形二次定式化を使用する。LQ−MPCは、宇宙機の公称動作条件に関する線形化軌道及び線形化姿勢ダイナミクス方程式(dynamic equation)に基づく、宇宙機の予測モデルを利用する。そのような線形化は更に、MPC解の精度ももたらす。しかしながら、ソフト制約が、MPC解の精度と、MPCによるコスト関数の最適化の簡単さとの間のバランスを保持するのを助ける。
さらに、本開示のいくつかの実施形態は、宇宙機の姿勢をもたらす宇宙機のダイナミクスと、宇宙機の方位をもたらす宇宙機の運動量交換デバイスのダイナミクスとの両方を考慮するMPCが、軌道位置保持ダイナミクスと方位ダイナミクスとの差を考慮する必要があるという認識に基づくことができる。これは特に、宇宙機のスラスタの配置及び/又は回転範囲に関する制限を有する宇宙機、例えば、宇宙機の単一の面上に位置するスラスタを有し、宇宙機に作用する力及びトルクが大きく結合される宇宙機にとって懸念である。
さらに、本開示のいくつかの実施形態は、MPCが宇宙機の位置及び方位の両方に及ぼす影響を考慮することができる。とりわけ、スラスト角に関するソフト制約によって、それらの影響を切り離すことができるようになる。例えば、本開示のいくつかの実施形態は、軌道位置保持(位置制御)及び方位ダイナミクス(姿勢制御)の時間スケールの相違を考慮する。例えば、いくつかの軌道について、軌道位置保持の時間スケールは、姿勢制御の時間スケールよりもかなり遅く、頻繁な状態サンプリング及び制御入力計算が方位ダイナミクスによって必要とされる一方で、長い予測ホライズンが軌道位置保持によって必要とされることの双方において問題を解く単一のMPCは、計算的に極めて大きな負担になる。
またさらに、本開示のいくつかの実施形態は、2レベル制御方式を用いることができる。例えば、本開示のいくつかの実施形態は、宇宙機の方位の内部ループ制御を用いて宇宙機の方位を制御し、外部ループ制御、例えばMPC、を用いて、宇宙機の姿勢及び宇宙機の運動量交換デバイスによって蓄積された運動量を制御する。内部制御及び外部制御は、宇宙機制御の特質に起因して異なる時間スケールを有するので、内部ループ制御は外部ループ制御から切り離され、外部ループ制御は、内部ループ制御のダイナミクスを含むモデルを用いて、内部ループ制御の効果を考慮する。また、本開示のいくつかの実施形態は、スラスト角に関する制限の悪影響を、そのような制限を緩和するか、又は最小化する宇宙機の機械的設計によって対処できるという別の認識に基づくことができる。
例えば、1つの実施形態は、衛星の非天底面に取り付けられるジンバル搭載ブームアセンブリ(gimbaled boom assemblies)上にスラスタを搭載することができる。ブーム−スラスタセンブリは、プルームの衝突の危険を伴うことなく、スラスタの回転範囲を増加させる。そのようにして、公称トルクフリー角を径方向に拡張することができる。また、ブーム上のスラスタを宇宙機本体から離れるように変位させることにより、ジンバリングは、南北軸と位置合わせできるようになり、それは、より大きいトルクと、効率的な軌道位置保持との両方を可能にする。
しかしながら、そのようなジンバル搭載ブームアセンブリの実際の実施態様では、各アセンブリが同じジンバル上に少なくとも一対のスラスタを搭載し、各対のスラスタの回転を互いに依存させる。すなわち、各スラスタの回転がジンバルの回転によって制御され、それゆえ、1つのスラスタが回転すると、ジンバル上に搭載される全てのスラスタが必然的に回転し、すなわち、同じジンバル搭載ブームアセンブリ上に搭載される全てのスラスタが同じジンバル角を共有する。理論的には、スラスタの角度を結び付ける制約を用いて宇宙機の姿勢をもたらす宇宙機のダイナミクスのモデル内で、MPCはスラスタのそのような構成を取り扱うことができる。しかしながら、そのようなダイナミクスのモデルの結果として、非線形最適化問題が生じる。非線形MPCは、計算能力及び記憶容量が限られるいくつかのオンボード制御システムにとって望ましくない可能性がある。
本開示のいくつかの実施形態は、同じジンバル上に搭載されるスラスタの同時の、及び/又は依存する回転を要求する制約を取り除くと、MPCの複雑度が緩和され、結果として、MPCが線形最適化問題を解くことができるという認識に基づくことができる。しかしながら、そのように簡略化する結果として、同じジンバル角を共有する2つのスラスタが同時にスラストする必要があるが、スラスト角が異なるときに、実現不可能な解が生じる可能性がある。しかしながら、本開示のいくつかの実施形態は、同じジンバル角を共有するスラスタを切り離し、スラスタが異なる時点でスラストできるようにするポストMPC変調プロセスによって、そのような実現不可能な解を取り扱うことができるという理解に基づく。例えば、いくつかの先進的な電気推進システムが連続スラストをスロットルすることができるとき、スラスタの大部分が実際にはオン−オフのままである。さらに、電力制限が、同時にオンになることができるスラスタの数を制限する場合がある。そのため、本開示のいくつかの実施形態は、オン−オフ変調が、そのオン−オフ性能を犠牲にすることなく、同じジンバル角を共有するスラスタを強制的に異なる時点でスラストすることができるという理解に基づく。
具体的には、MPC解が、制御ステップの或る期間にわたって同じジンバル角を共有するスラスタによって生成されることになる、一定のスラストの大きさを生成することができる。例えば、いくつかの実施態様において、その期間は1時間である。本開示のいくつかの実施形態は、これらのスラストの大きさを、制御ステップのその期間内に各スラスタのオン状態及びオフ状態を指定するパルス信号に変調又は符号化する。スラスタは、スラストの状態がオンであるとき、所定の大きさのスラストを生成し、スラスタの状態がオフであるとき、いかなるスラストも生成しない。各被変調信号のスラストの平均の大きさは、MPC解によって要求されるスラストの対応する大きさに等しい。本開示のいくつかの実施形態は、同じジンバル角を共有するスラスタのオン状態が時間的に交わらないように、スラストの大きさを変調する。
そのような相互排他的な時間変調によって、ジンバルは、搭載されたスラスタを、オン状態を有するように現時点でスケジューリングされたスラスタ角まで回転させることができるようになる。例えば、1つの実施形態は、要求されたスラスト値を所定の周波数において完全にオン又は完全にオフになるように量子化する閉ループパルス幅変調(PWM:pulse-width modulation)方式を用いてMPCを強化する。パルスの幅又はデューティサイクルは、MPCポリシーからの連続スラスト要求及び所定の周波数によって指定される。
本開示の別の実施形態によれば、宇宙機の動作を制御する制御システム。その制御システムは、宇宙機の姿勢をもたらす宇宙機のダイナミクスのモデルと、宇宙機の方位をもたらす宇宙機の運動量交換デバイスのダイナミクスのモデルとを用いて、有限後退ホライズンにわたってコスト関数を最適化することによって、宇宙機のスラスタを制御するための解を生成するモデル予測コントローラ(MPC)を含む。最適化は、宇宙機のスラスタによって生成されるスラスト角に関するハード制約及びソフト制約を受ける。ハード制約は、解内のスラスト角がハード制約によって規定される所定の範囲内に入るように要求する。ソフト制約は、その解に、宇宙機の質量中心を通り抜けるトルクフリースラストに対応する公称角からのスラスト角の偏差に関してペナルティを科す。最後に、スラスタコントローラを用いて、MPCの解に従ってスラスタを動作させる。
本開示の別の実施形態によれば、宇宙機バスと、宇宙機の姿勢を変更するための1組のスラスタとを有する宇宙機。スラスタは宇宙機バスの単一の面に位置し、少なくとも2つのスラスタが、スラスタを宇宙機バスに接続するジンバル搭載ブームアセンブリ上に搭載される。宇宙機は、宇宙機に作用する外乱トルクを吸収するための1組の運動量交換デバイスを含む。1組のスラスタを動作させるスラスタコントローラ。宇宙機の動作を制御するための制御システム、制御システムはモデル予測コントローラ(MPC)を含む。MPCは、宇宙機の姿勢をもたらす宇宙機のダイナミクスのモデルと、宇宙機の方位をもたらす宇宙機の運動量交換デバイスのダイナミクスのモデルとを用いて、有限後退ホライズンにわたってコスト関数を最適化することによって、宇宙機のスラスタを制御するための解を生成することができる。最適化は、宇宙機のスラスタによって生成されるスラスト角に関するハード制約及びソフト制約を受け、ハード制約は、解内のスラスト角がハード制約によって規定される所定の範囲内に入るように要求する。ソフト制約は、その解に、宇宙機の質量中心を通り抜けるトルクフリースラストに対応する公称角からのスラスト角の偏差に関してペナルティを科す。MPCの解に従ってスラスタを動作させるために、MPCの解がスラスタコントローラに出力される。
本開示の別の実施形態によれば、宇宙機のモデルに従って宇宙機の動作を制御する方法。その方法は、宇宙機の姿勢に関する制約及びスラスタへの入力に関する制約を受けた、有限後退ホライズンにわたるコスト関数の最適化を用いて、宇宙機のスラスタ及び宇宙機の運動量交換デバイスを同時に制御する制御入力を決定することを含む。コスト関数は、宇宙機の姿勢を制御するための構成要素と、宇宙機の方位をもたらす運動量交換デバイスによって蓄積される運動量を制御するための構成要素とを含む。最適化は、宇宙機のスラスタによって生成されるスラスト角に関するハード制約及びソフト制約を受ける。ハード制約は、解内のスラスト角がハード制約によって規定される所定の範囲内に入るように要求する。ソフト制約は、その解に、宇宙機の質量中心を通り抜けるトルクフリースラストに対応する公称角からのスラスト角の偏差に関してペナルティを科す。制御入力の少なくとも一部に従ってスラスタ及び運動量交換デバイスを同時に制御する司令を生成する。その方法のステップは、宇宙機のプロセッサによって実行される。
本開示の別の実施形態によれば、方法を実行するためのプロセッサによって実行可能なプログラムを具現する非一時的コンピュータ可読記憶媒体。その方法は、宇宙機の姿勢に関する制約及びスラスタへの入力に関する制約を受けた、有限後退ホライズンにわたるコスト関数の最適化を用いて、宇宙機のスラスタ及び宇宙機の運動量交換デバイスを同時に制御する制御入力を決定することを含む。コスト関数は、宇宙機の姿勢を制御するための構成要素と、宇宙機の方位をもたらす運動量交換デバイスによって蓄積される運動量を制御するための構成要素とを含む。最適化は、宇宙機のスラスタによって生成されるスラスト角に関するハード制約及びソフト制約を受ける。ハード制約は、解内のスラスト角がハード制約によって規定される所定の範囲内に入るように要求し、スラスト角に関するハード制約は、スラスタのスラストが角錐形の内部に存在するように強制するスラスタの回転範囲を規定する。ソフト制約は、その解に、宇宙機の質量中心を通り抜けるトルクフリースラストに対応する公称角からのスラスト角の偏差に関してペナルティを科す。制御入力の少なくとも一部に従ってスラスタ及び運動量交換デバイスを同時に制御する司令を生成する。その方法のステップは、宇宙機のプロセッサによって実行される。
ここに開示されている実施形態は、添付図面を参照して更に説明される。示されている図面は、必ずしも一律の縮尺というわけではなく、その代わり、一般的に、ここに開示されている実施形態の原理を示すことに強調が置かれている。
本開示の実施形態による、宇宙機のモデルに従って宇宙機の動作を制御する方法を示すブロック図である。 本開示の実施形態による、図1Aのコントローラの構造を示すブロック図である。 本開示の実施形態による、大気圏外空間の宇宙機とともに図1Aのコントローラを示す概略図である。 本開示の実施形態による、図1Cの大気圏外空間の宇宙機とともにコントローラを示す概略図であり、宇宙機は所望の位置165の周りの指定された寸法を有するウィンドウ内に留まることになる。 本開示の実施形態による、宇宙機固定基準座標系と所望の基準座標系との間のオイラー角を示す概略図である。 本開示の実施形態による、運動量アンロードプロセス中に限度内に留まるオイラー角を示すグラフである。 本開示の実施形態による、宇宙機の動作を制御する内部外部ループコントローラを示すブロック図である。 本開示の実施形態による、外部ループ制御システムの一部とすることができるいくつかのモジュールを示すブロック図である。 本開示の実施形態による、外乱予測問題を示す概略図である。 本開示の実施形態による、予測ホライズン中の運動量交換デバイスの予測値を示す概略図である。 本開示の実施形態による、コスト関数がスラスタによって生成されるトルクにペナルティを科すための構成要素で強化された場合の解を示すブロック図である。 本開示の実施形態による、代替のコンピュータ又はプロセッサを用いて実施することができる、図1Aの方法を示すブロック図である。 本開示の実施形態による、外乱予測問題の概略図である。
上記で明らかにされた図面は、ここに開示されている実施形態を記載しているが、この論述において言及されるように、他の実施形態も意図されている。この開示は、限定ではなく代表例として例示の実施形態を提示している。ここに開示されている実施形態の原理の範囲及び趣旨に含まれる非常に多くの他の変更及び実施形態を当業者は考案することができる。
以下の説明は、例示的な実施形態のみを提供し、本開示の範囲も、適用範囲も、構成も限定することを意図していない。そうではなく、例示的な実施形態の以下の説明は1つ以上の例示的な実施形態を実施することを可能にする説明を当業者に提供する。添付の特許請求の範囲に明記されているような開示された主題の趣旨及び範囲から逸脱することなく要素の機能及び配置に行うことができる様々な変更が意図されている。
以下の説明では、実施形態の十分な理解を提供するために、具体的な詳細が与えられる。しかしながら、当業者は、これらの具体的な詳細がなくても実施形態を実施することができることを理解することができる。例えば、開示された主題におけるシステム、プロセス、及び他の要素は、実施形態を不必要な詳細で不明瞭にしないように、ブロック図形式の構成要素として示される場合がある。それ以外の場合において、よく知られたプロセス、構造、及び技法は、実施形態を不明瞭にしないように不必要な詳細なしで示される場合がある。さらに、様々な図面における同様の参照符号及び名称は、同様の要素を示す。
また、個々の実施形態は、フローチャート、フロー図、データフロー図、構造図、又はブロック図として描かれるプロセスとして説明される場合がある。フローチャートは、動作を逐次的なプロセスとして説明することができるが、これらの動作の多くは、並列又は同時に実行することができる。加えて、これらの動作の順序は、再配列することができる。プロセスは、その動作が完了したときに終了することができるが、論述されない又は図に含まれない追加のステップを有する場合がある。さらに、特に説明される任意のプロセスにおける全ての動作が全ての実施形態において行われ得るとは限らない。プロセスは、方法、関数、手順、サブルーチン、サブプログラム等に対応することができる。プロセスが関数に対応するとき、その関数の終了は、呼び出し側関数又はメイン関数へのその機能の復帰に対応することができる。
さらに、開示された主題の実施形態は、少なくとも一部は手動又は自動のいずれかで実施することができる。手動実施又は自動実施は、マシン、ハードウェア、ソフトウェア、ファームウェア、ミドルウェア、マイクロコード、ハードウェア記述言語、又はそれらの任意の組み合わせを用いて実行することもできるし、少なくとも援助することができる。ソフトウェア、ファームウェア、ミドルウェア又はマイクロコードで実施されるとき、必要なタスクを実行するプログラムコード又はプログラムコードセグメントは、マシン可読媒体に記憶することができる。プロセッサ(複数の場合もある)が、それらの必要なタスクを実行することができる。
概説
本開示の実施形態は、後退ホライズンにわたるモデル予測制御(MPC)を使用する同時の軌道位置保持、姿勢制御及び運動量管理のために、宇宙機の動作を制御することに関する。
本開示のいくつかの実施形態は、宇宙機のスラスタの配置及び/又は回転範囲に関する種々の制限を考慮する、宇宙機のオンボード制御システムにおいて実施することができるモデル予測制御(MPC)を提供する。具体的には、MPCは、宇宙機の姿勢をもたらす宇宙機のダイナミクスのモデルと、宇宙機の方位をもたらす宇宙機の運動量交換デバイスのダイナミクスのモデルとを用いて、有限後退ホライズンにわたってコスト関数を最適化することによって、スラスタコントローラを介して宇宙機のスラスタを制御するための解を生成することができる。
例えば、本開示は、宇宙機の複数のスラスタによって生成されるスラスト角に関するハード制約及びソフト制約を条件としてMPCを最適化することができるという認識に基づく。具体的には、ハード制約が、或る解におけるスラスト角がハード制約によって規定される所定の範囲内に入るように要求するとき、ソフト制約は、その解に、宇宙機の質量中心を通り抜けるトルクフリースラストに対応する公称角からのスラスト角の偏差に関してペナルティを科すことができる。数多くの態様の中でも、MPCの少なくとも1つの態様は、MPCが、MPCの解に従って、単一の1組のスラスタを動作させるスラスタコントローラを用いて、宇宙機の軌道位置、方位及び累積されるオンボード運動量の同時制御を提供できることである。
最初に、MPCを用いて、オンボード制御システムにおいて実施される自律制御を提供し、より厳格で、かつ正確な軌道位置保持、姿勢制御及び運動量アンロードであると思われるものを提供できる、提案される解法を発見した。しかしながら、提案される解法は、数多くの課題、すなわち、上記のような、スラスタプルームの衝突の危険を伴うことなくアンテナ及び太陽電池パネルを展開することができるような宇宙機上のスラスタの配置に関する制限に直面することを後に発見した。本発明において提案される解法について理解したことは、スラスタの配置及び/又は回転範囲に関する制限は、MPCによって、スラスト角に関するハード制約と見なすことができ、MPCがそのようなハード制約に違反する解を生成するのを防ぐことができることである。しかしながら、ハード制約が望ましくない可能性があること、及び結果として宇宙機のダイナミクスを複雑にする可能性があることを発見した。
例えば、スラスト角に関するハード制約は、スラストのトルクフリー角の効率を下げる可能性があり、MPCの解に、宇宙機に及ぼす正味の力及びトルクの両方を与えるスラストを生成するように指示する可能性がある。これらのトルク誘発スラストの結果として、宇宙機の不要な回転が生じる可能性がある。オンボード運動量交換デバイスは、宇宙機の不要な回転を補償することができ、その補償は、MPCの解において考慮することができる。しかしながら、運動量交換デバイスのダイナミクスは、スラスタのダイナミクスより緩慢である可能性があり、スラスタの動作に及ぼす運動量交換デバイスの動作の影響は、MPCの予測ホライズンから外れる可能性がある。そのため、MPCは、上記で言及されたように、宇宙機の姿勢及び累積されるオンボード運動量の両方に関して適した解を与えることができない可能性がある。
習得したこの問題に対する1つの解法は、予測ホライズンを長くすることである。例えば、無限予測ホライズンを用いるMPCは、宇宙機の種々の構成要素のダイナミクスの応答に関するそのような変動を考慮することができる。しかしながら、無限予測ホライズンを用いるMPCは、オンボードコントローラの計算要件に負担をかけ、宇宙機から期待される、長期にわたる自律制御にとって望ましくない。そのため、本開示のいくつかの実施形態は、有限予測ホライズンを用いるMPCを用いて宇宙機を制御する。例えば、1つの実施態様では、有限予測ホライズンは24時間とすることができ、それは宇宙機の予測制御にとって標準であると考えられる。
この問題に対する別の解法は、宇宙機の方位を制御する必要がないときに、MPCに強制的にトルクフリースラストのみを生成させることである。しかしながら、宇宙機のいくつかの構成では、そのようなトルクフリースラストは準最適である可能性がある。例えば、いくつかの実施態様において、宇宙機バスに取り付けられたジンバル上に搭載されるスラスタ。スラスタの運動範囲は、南北搭載太陽電池パネル上のプルームの衝突の可能性に起因して制限される。また、南北軌道位置保持において、平面外の径方向におけるスラストは、Δv消費において支配的な成分である。しかしながら、衛星の非天底面に配置されるスラスタの場合、スラストのトルクフリー角、すなわち、スラスタを強制的に衛星の質量中心を通って噴射させる角度は、結果として、径方向において非常に無駄な労力が生じる。したがって、Δv効率に関して、ジンバルは多くの場合にその限界において動作し、衛星上に望ましくないトルクを生成し、運動量交換デバイスに無用に負荷をかける。それにより、全角運動量蓄積に関する限界に起因して、運動量交換デバイス、例えば、リアクションホイールによって、結果として運動量管理において更なるΔvが費やされる。
例えば、本開示のいくつかの実施形態は、トルク誘発スラストを許容できるが、トルクが不要であるときに阻止できるという理解に基づく。そのため、本開示のいくつかの実施形態は、スラスト角に関するハード制約を課すことに加えて、スラスト角に関するソフト制約を課し、宇宙機の質量中心を通り抜けるトルクフリースラストに対応する公称角からの角度の偏差にペナルティを科す。
本開示において、ペナルティを科すという用語は、最適化及び制御コミュニティによって採用される通常の意味において使用される。例えば、本開示のいくつかの実施形態において、ソフト制約は、ハード制約を受けたMPCによって最適化されたコスト関数の構成要素として定式化される。MPCがコスト関数を最小化する場合には、その構成要素の値が、MPCによって生成されるスラスト角と公称角との間の差に比例して、例えば、線形に、又は非線形に増加する。MPCによって最小化されるそのようなコスト関数の例が、宇宙機の燃料効率を考慮する関数を含む。対照的に、MPCがコスト関数を最大化する場合には、その構成要素の値は、公称角からの偏差に比例して減少する。MPCによって最大化されるそのようなコスト関数の例が、宇宙機の目標姿勢に達するのに要する時間を考慮する関数を含む。
さらに、本開示のいくつかの実施形態は、宇宙機のスラスタを制御するための解を生成するモデル予測コントローラ(MPC)と、MPCの解に従ってスラスタを動作させるスラスタコントローラとを含む宇宙機の動作を制御する制御システムを開示する。MPCは、宇宙機の姿勢をもたらす宇宙機のダイナミクスのモデルと、宇宙機の方位をもたらす宇宙機の運動量交換デバイスのダイナミクスのモデルとを用いて、有限後退ホライズンにわたってコスト関数を最適化することによって解を生成する。その最適化は、宇宙機のスラスタによって生成されたスラスト角に関するハード制約及びソフト制約を受ける。ハード制約は、解内のスラスト角がハード制約によって規定される所定の範囲内に入るように要求する。ソフト制約は、MPCの解に、宇宙機の質量中心を通り抜けるトルクフリースラストに対応する公称角からのスラスト角の偏差に関してペナルティを科す。
そのようにして、MPCは、予測ホライズンの長さの延長を必要とすることなく、その解を調整する。さらに、MPCはここでは、宇宙機の姿勢をもたらす宇宙機のダイナミクスと、宇宙機の方位をもたらす宇宙機の運動量交換デバイスのダイナミクスとの両方を考慮する多目的MPCである。例えば、いくつかの実施態様において、コスト関数は、目標姿勢からの宇宙機の変位にペナルティを科す宇宙機の姿勢に関する構成要素と、蓄積された運動量の大きさの値が大きいほどペナルティを科す、運動量交換デバイスによって蓄積される運動量に関する構成要素とを含む。それに加えて、又は代替的に、コスト関数の構成要素として、MPCにソフト制約を含むこともできる。
本開示のいくつかの実施形態は、ソフト制約が有限後退ホライズンの限界を補償することができるだけでなく、MPCの最適化の近似を容易にするために使用することもできるという理解に基づく。例えば、いくつかの実施形態において、コスト関数の最適化は、二次計画法(QP)として定式化される。二次計画法は、オンボード計算能力が限られた宇宙機等のリソース制約のあるハードウェアにおいてより高速かつ効率的に解くことができる。二次計画法を利用するために、本開示のいくつかの実施形態は、本明細書においてLQ−MPCと呼ばれる、MPCの線形二次定式化を使用する。LQ−MPCは、宇宙機の公称動作条件に関する線形化軌道及び線形化姿勢ダイナミクス方程式に基づく、宇宙機の予測モデルを利用する。そのような線形化は更に、MPC解の精度ももたらす。しかしながら、ソフト制約が、MPC解の精度と、MPCによるコスト関数の最適化の簡単さとの間のバランスを保持するのを助ける。
さらに、本開示のいくつかの実施形態は、宇宙機の姿勢をもたらす宇宙機のダイナミクスと、宇宙機の方位をもたらす宇宙機の運動量交換デバイスのダイナミクスとの両方を考慮するMPCが、軌道位置保持ダイナミクスと方位ダイナミクスとの差を考慮する必要があるという認識に基づくことができる。これは特に、宇宙機のスラスタの配置及び/又は回転範囲に関する制限を有する宇宙機、例えば、宇宙機の単一の面上に位置するスラスタを有し、宇宙機に作用する力及びトルクが大きく結合される宇宙機にとって懸念である。
さらに、本開示のいくつかの実施形態は、MPCが宇宙機の位置及び方位の両方に及ぼす影響を考慮することができる。とりわけ、スラスト角に関するソフト制約によって、それらの影響を切り離すことができるようになる。例えば、本開示のいくつかの実施形態は、軌道位置保持(位置制御)及び方位ダイナミクス(姿勢制御)の時間スケールの相違を考慮する。例えば、いくつかの軌道について、軌道位置保持の時間スケールは、姿勢制御の時間スケールよりもかなり遅く、頻繁な状態サンプリング及び制御入力計算が方位ダイナミクスによって必要とされる一方で、長い予測ホライズンが軌道位置保持によって必要とされることの双方において問題を解く単一のMPCは、計算的に極めて大きな負担になる。
またさらに、本開示のいくつかの実施形態は、2レベル制御方式を用いることができる。例えば、本開示のいくつかの実施形態は、宇宙機の方位の内部ループ制御を用いて宇宙機の方位を制御し、外部ループ制御、例えばMPC、を用いて、宇宙機の姿勢及び宇宙機の運動量交換デバイスによって蓄積された運動量を制御する。内部制御及び外部制御は、宇宙機制御の特質に起因して異なる時間スケールを有するので、内部ループ制御は外部ループ制御から切り離され、外部ループ制御は、内部ループ制御のダイナミクスを含むモデルを用いて、内部ループ制御の効果を考慮する。また、本開示のいくつかの実施形態は、スラスト角に関する制限の悪影響を、そのような制限を緩和するか、又は最小化する宇宙機の機械的設計によって対処できるという別の認識に基づくことができる。
例えば、少なくとも1つの実施形態は、衛星の非天底面に取り付けられるジンバル搭載ブームアセンブリ上にスラスタを搭載することができる。ブーム−スラスタセンブリは、プルームの衝突の危険を伴うことなく、スラスタの回転範囲を増加させる。そのようにして、公称トルクフリー角を径方向に拡張することができる。また、ブーム上のスラスタを宇宙機本体から離れるように変位させることにより、ジンバリングは、南北軸と位置合わせできるようになり、それは、より大きいトルクと、効率的な軌道位置保持との両方を可能にする。しかしながら、そのようなジンバル搭載ブームアセンブリの実際の実施態様では、各アセンブリが同じジンバル上に少なくとも一対のスラスタを搭載し、各対のスラスタの回転を互いに依存させる。すなわち、各スラスタの回転がジンバルの回転によって制御され、それゆえ、1つのスラスタが回転すると、ジンバル上に搭載される全てのスラスタが必然的に回転し、すなわち、同じジンバル搭載ブームアセンブリ上に搭載される全てのスラスタが同じジンバル角を共有する。理論的には、スラスタの角度を結び付ける制約を用いて宇宙機の姿勢をもたらす宇宙機のダイナミクスのモデル内で、MPCはスラスタのそのような構成を取り扱うことができる。しかしながら、そのようなダイナミクスのモデルの結果として、非線形最適化問題が生じる。非線形MPCは、計算能力及び記憶容量が限られるいくつかのオンボード制御システムにとって望ましくない可能性がある。
本開示のいくつかの実施形態は、同じジンバル上に搭載されるスラスタの同時の、及び/又は依存する回転を要求する制約を取り除くと、MPCの複雑度が緩和され、結果として、MPCが線形最適化問題を解くことができるという認識に基づくことができる。しかしながら、そのように簡略化する結果として、同じジンバル角を共有する2つのスラスタが同時にスラストする必要があるが、スラスト角が異なるときに、実現不可能な解が生じる可能性がある。しかしながら、本開示のいくつかの実施形態は、同じジンバル角を共有するスラスタを切り離し、スラスタが異なる時点でスラストできるようにするポストMPC変調プロセスによって、そのような実現不可能な解を取り扱うことができるという理解に基づく。例えば、いくつかの先進的な電気推進システムが連続スラストをスロットルすることができるとき、スラスタの大部分が実際にはオン−オフのままである。さらに、電力制限が、同時にオンになることができるスラスタの数を制限する場合がある。そのため、本開示のいくつかの実施形態は、オン−オフ変調が、そのオン−オフ性能を犠牲にすることなく、同じジンバル角を共有するスラスタを強制的に異なる時点でスラストすることができるという理解に基づく。
具体的には、MPC解が、制御ステップの或る期間にわたって同じジンバル角を共有するスラスタによって生成されることになる、一定のスラストの大きさを生成することができる。例えば、いくつかの実施態様において、その期間は1時間である。本開示のいくつかの実施形態は、これらのスラストの大きさを、制御ステップのその期間内に各スラスタのオン状態及びオフ状態を指定するパルス信号に変調又は符号化する。スラスタは、スラストの状態がオンであるとき、所定の大きさのスラストを生成し、スラスタの状態がオフであるとき、いかなるスラストも生成しない。各被変調信号のスラストの平均の大きさは、MPC解によって要求されるスラストの対応する大きさに等しい。本開示のいくつかの実施形態は、同じジンバル角を共有するスラスタのオン状態が時間的に交わらないように、スラストの大きさを変調する。
そのような相互排他的な時間変調によって、ジンバルは、搭載されたスラスタを、オン状態を有するように現時点でスケジューリングされたスラスタ角まで回転させることができるようになる。例えば、少なくとも1つの実施形態は、要求されたスラスト値を所定の周波数において完全にオン又は完全にオフになるように量子化する閉ループパルス幅変調(PWM)方式を用いてMPCを強化する。パルスの幅、又はデューティサイクルは、MPCポリシーからの連続スラスト要求及び所定の周波数によって指定される。
図1A及び図1Bを参照すると、図1Aは、本開示の実施形態による、宇宙機の動作を制御する方法100Aを示すブロック図である。図1Bは、本開示の実施形態による、図1Aの方法100Aのいくつかの構成要素を示すブロック図である。方法100Aは、コスト関数の最適化に基づく宇宙機のモデルを用いて決定された制御入力を用いて、宇宙機の動作を繰り返し制御する。
図1Aの方法100Aは最初に、宇宙機の現在の状態を判断するステップ110から開始し、宇宙機の現在の状態は、センサ(図1Bの107)を用いて、又はハードウェア若しくはソフトウェア等の他の態様を用いて判断することができる。さらに、宇宙機の現在の状態は、地球上に位置する地上指令センターとの通信から、又は大気圏外空間に位置する別の宇宙機、例えば、GPS、相対範囲測定、スタートラッカー、ホライズンセンサ等との通信から取得することができる。また、宇宙機の以前のモデルを用いて以前のコスト関数で最適化された、以前の反復の間に決定された以前の制御入力に基づいて、現在の宇宙機状態を判断することもできる。
図1Aの次のステップ120は、宇宙機モデルを更新することとすることができる。宇宙機モデル更新ステップ120は、現時点についての、及び、将来の予測ホライズンにわたる、目標軌道上の所望の目標ロケーションにおける宇宙機モデルの線形化を含むことができる。宇宙機モデル更新ステップ120はまた、目標ロケーションにおける同じホライズンにわたる予測外乱力を計算することもでき、この予測外乱力をダイナミクス予測モデルと組み合わせて、全体予測を形成する。最後に、本開示のいくつかの実施形態において、宇宙機モデル更新ステップ120は、コスト関数の安定性構成要素を、現時点についての、及び、将来の予測ホライズンにわたる、正しい値に更新することもできる。
次に、方法ステップ130は、現在のモデル及び現在のコスト関数を用いて、現在の反復において宇宙機を制御するための現在の制御入力を決定する。例えば、その方法は、ステップ132において、更新された現在のコスト関数及び現在の宇宙機モデルを用いて、現時点から、新たな宇宙機状態測定値を少なくとも取得する限り、将来の決まった時間にわたって、スラスタ力の将来の入力シーケンスを決定する。予測される将来の宇宙機状態及び入力が、宇宙機の動作に関する制約、及び制御入力に関する制約を満たすようにする。次のステップ134は、宇宙機の状態の新たな測定値を取得するために必要とされる時間に等しい持続時間にわたる、入力シーケンスの第1の部分を含む。それが選択され、宇宙機への現在の制御入力として、次のステップ136に適用される。宇宙機の決定された現在の状態(ステップ110)、宇宙機の現在の更新されたモデル(ステップ120)及び宇宙機に対して決定された現在の制御入力(ステップ130)に基づいて、宇宙機の次の状態が判断され、ステップ140において、コントローラは、新たな状態測定値が受信されるまで待つ。
図1Bは、本開示の実施形態による、図1Aの方法を実施するためのコントローラのいくつかの構成要素を示すブロック図である。方法100Aは、コントローラのモジュールを実行するための少なくとも1つのプロセッサ113を有する制御システム又はコントローラ101を含むことができる。コントローラ101は、プロセッサ113及びメモリ119と通信することができる。メモリは、コスト関数121、宇宙機モデル123、内部ループ125、外部ループ127及び制約129を含む、少なくとも1つを記憶することができる。コントローラのモジュールは、内部ループ125及び外部ループ127のいずれかの一部とすることができる。制約は、宇宙機102の物理的限界、宇宙機102の動作に関する安全限界、宇宙機102の軌道に関する性能限界を表すことができる。
さらに、方法100Aは、制約を受けた宇宙機のモデル123を用いて、プロセッサ113を介して制御入力107を決定することができる。決定された制御入力107は宇宙機102に送信することができる。さらに、宇宙機102は、数ある構成要素の中でも、スラスタ103、運動量交換デバイス105及びセンサ107を有することができる。宇宙機102の現在の状態106は、センサ107から取得し、プロセッサ113に通信することができる。コントローラ101が、プロセッサ113を介して、宇宙機102のための所望の入力133を受信することができる。
少なくとも1つの実施形態において、プロセッサ113は、制御中に、コスト関数121、宇宙機モデル123、制約129のうちの少なくとも1つを決定し、及び/又は更新することができる。例えば、制御システム101は、コスト関数の最適化に基づいて、宇宙機のモデル123を用いて決定された図1Aのステップ130の制御入力を用いて、宇宙機102の動作を繰り返し制御する方法100Aを実行することができる。方法100Aはまた、宇宙機102の以前の反復動作に基づいて、すなわち、宇宙機の以前のモデルを用いて以前のコスト関数によって最適化される以前の反復において決定された以前の制御入力を有する以前の反復制御動作から、コントローラ101によって実行できることが可能である。
図1C及び図1Dを参照すると、図1Cは、本開示の実施形態による、大気圏外空間の宇宙機とともに、図1Aのコントローラを示す概略図である。図1Dは、本開示の実施形態による、図1Cの大気圏外空間の宇宙機とともにコントローラを示す概略図であり、宇宙機は所望の位置165の周りの指定された寸法を有するウィンドウ内に留まることになる。
例えば、図1C及び図1Dは、スラスタ103及び運動量交換デバイス105等の複数のアクチュエータを装備した宇宙機102を示している。このタイプの運動量交換デバイス105の例は、リアクションホイール(RW)及びジャイロスコープを含むことができる。宇宙機102は、その動作が、アクチュエータ103に送信された司令に応答して宇宙機の位置、その速度、及びその姿勢又は方位等の物理量を変化させる、大気圏外空間を飛行するように設計された乗り物、船、又は機械とすることができる。アクチュエータ103は、司令されると、宇宙機102の速度を増加又は減少させる力を宇宙機102に与える。したがって、宇宙機102にその位置を並進させ、また、アクチュエータ103は、司令されると、宇宙機102にトルクを与える。与えられたトルクは、宇宙機102を回転させ、それによって、その姿勢又は方位を変化させることができる。本明細書で用いられるように、宇宙機102の動作は、そのような物理量を変化させる宇宙機102の運動を決定するアクチュエータ103の動作によって決まる可能性がある。
図1C及び図1Dを更に参照すると、宇宙機102は、開軌道経路又は閉軌道経路160であって、地球161、月、及び/又は他の惑星、恒星、小惑星、彗星等の1つ以上の重力体を周回する経路160、それらの間の経路160、又はそれらの近くの経路160に沿って大気圏外空間を飛行する。通常、軌道経路に沿った所望の位置又は目標位置165が与えられる。基準座標系170が所望の位置165に結び付けられ、座標系の原点、すなわち、基準座標系170内の全ての0座標が常に所望の位置165の座標であり、
Figure 0006837574
は、基準座標系の軸を表す標準単位ベクトルである。
宇宙機102は、様々な外乱力114を受ける可能性がある。これらの外乱力114は、宇宙機102の軌道経路160を求めるときに考慮されていなかった力を含む可能性がある。これらの外乱力114は、宇宙機102に作用して、軌道経路160上の所望の位置から宇宙機102を離遠させる。これらの外乱力114は、重力、放射圧、大気抵抗、非球形の中心体、及び推進燃料の漏れを含むことができるが、これらに限定されるものではない。このため、宇宙機102は、目標位置165から距離167だけ離れる可能性がある。
図1C及び図1Dを更に参照すると、外乱力114のために、宇宙機102をその軌道160に沿って所望の位置165に保持することが常に可能であるとは限らない。したがって、その代わりに、宇宙機102を所望の位置165の周囲において指定された寸法104を有するウィンドウ166内に留めることが所望される。そのために、宇宙機102は、ウィンドウ166内に制約される任意の経路に沿って移動するように制御される。この例では、ウィンドウ166は方形の形状を有するが、ウィンドウ166の形状は実施形態が異なれば変化する可能性がある。
宇宙機102は、多くの場合、所望の方位を維持することも必要とされる。例えば、宇宙機固定基準座標系174は、遠方の恒星172に対して固定された慣性基準座標系171、又は地球161を指し示すように常に方位付けられた基準座標系173等の所望の基準座標系と位置合わせされることが必要とされる。しかしながら、宇宙機102の形状に応じて、種々の外乱力114が、宇宙機102に非均一に作用する可能性があり、それによって、宇宙機102をその所望の方位から離遠して回転させる外乱トルクが発生する。これらの外乱トルクを補償するために、リアクションホイール等の運動量交換デバイス105が、外乱トルクを吸収するために用いられ、したがって、宇宙機102をその所望の方位に維持することが可能になる。運動量交換デバイス105が飽和しないように、それによって、外乱トルクを補償する能力を喪失しないように、例えば、リアクションホイールのスピン速度を低減することによって、それらのデバイスが蓄積した運動量をアンロードしなければならない。運動量交換デバイス105をアンロードすることによって、所望されないトルクが宇宙機102に与えられる。そのような所望されないトルクも、スラスタ103によって補償することができる。
図1Eは、本開示の実施形態による、宇宙機固定基準座標系174と所望の基準座標系171との間のオイラー角175を示す概略図である。図1Fは、本開示の実施形態による、運動量アンロードプロセス中に限度176内に留まるオイラー角175を示すグラフである。例えば、本開示のいくつかの実施形態は、運動量アンロードプロセス中にオイラー角175が限度176(図1F)内に留まるように、宇宙機102を制御する。スラスタ103は、宇宙機座標系との公称アライメントから決まった量だけ回転できるようにするために、ジンバルによって支持することができる。
図2は、本開示の実施形態による宇宙機の動作を制御する二重ループコントローラのブロック図を示している。宇宙機102の運動は、外乱力及びトルク114による影響を受ける。例えば、二重ループコントローラは、宇宙機102の動作の一部、例えば、所望の座標系171に対する宇宙機固定座標系の方位174(図1E)、を制御する内部ループフィードバック制御125を備える。その方法のステップは、プロセッサ、例えば、コントローラ101と通信する(図1Bの)プロセッサ113、宇宙機の別のプロセッサ及び/又はリモートプロセッサを用いて実施することができる。
内部ループ制御システム125は、宇宙機運動についての全情報106のサブセットである宇宙機102についての情報204を、宇宙機102に直接又はリモートに接続された図1Bのセンサ107、ハードウェア、又はソフトウェアから受信することができる。この情報106は、宇宙機運動の状態を含む。サブセット204は、内部ループフィードバック制御125に関係しており、司令209を生成するのに用いられる。これらの司令は、方位(姿勢)制御の場合には、図1Bの運動量交換デバイス105への司令である。また、宇宙機102の動作を制御する外部ループ制御システム127も示されている。外部ループ制御システム127は、目標動作、例えば、所望の軌道又は物理量のうちのいくつかの目標点等の宇宙機102の所望の運動133、を受信し、制御入力107を介して宇宙機を制御する。これらの制御入力107は、宇宙機102の動作のパラメータを変更する司令を含むこともできるし、宇宙機に影響を及ぼす電圧、圧力、トルク、力等のパラメータの実際の値を含むこともできる。
図2を更に参照すると、制御入力107は、司令209とともに、宇宙機102への入力211を形成し、宇宙機の物理量205の生成をもたらす運動を誘発する。例えば、入力211は、任意選択で、マッパ274によって形成することができる。例えば、マッパ274は、未変更信号107及び209を組み合わせて、入力211を形成することができる。さらに、マッパ274は、スラスタ103(図1B及び図1C)が全体で所望の力及びトルク107を宇宙機102に与えるように、宇宙機102に対して司令された全体の力及びトルクから個々のスラスタ103への司令を求めることができる。マッパ274は、これらの司令を、変更することなく、現在の制御入力204として、個々のスラスタ司令とともにオンボード運動量交換デバイス105(図1B及び図1C)に渡すことができる。
外部ループ制御システム127は、宇宙機運動についての情報106も受信する。外部ループ制御システム127は、制御入力107の選択に状態を用いる。情報106は、運動物理量205のうちのいくつか又は全てを含むことができ、宇宙機102についての追加の情報も含むことができる。物理量205、制御入力107又はそれらの組み合わせは、宇宙機102の動作に対する制約129に従ったいくつかの既定の範囲に留まるように要求することができる。
図2を更に参照すると、本開示のいくつかの実施形態は、宇宙機102が、ボックス166(図1C及び図1D)内に留まることと、そのオイラー角175(図1E)を限度176(図1F)内に留めることと、蓄積された過剰な運動量をアンロードすることとを同時に行うように、スラスタ103(図1B及び図1C)への司令107と、運動量交換デバイス105への制御入力209とを求める。これは、内部ループフィードバック制御システム125とともに宇宙機のモデル123を用いる自動外部ループ制御システム127を実施することによって行われる。例えば、本開示のいくつかの実施形態は、宇宙機の姿勢に対する制約129を条件とする後退ホライズンにわたるコスト関数の最適化を用いて宇宙機のスラスタを制御する制御入力と、スラスタ103(図1B及び図1C)への入力とを求め、適切な制御入力司令107を生成する。宇宙機の姿勢は、宇宙機の絶対位置及び絶対方位又は相対位置及び相対方位のうちの一方又は組み合わせを含む。本開示のいくつかの実施形態では、コスト関数は、宇宙機の姿勢を制御する構成要素と、運動量交換デバイスによって蓄積された運動量をアンロードする構成要素とを含む。
本開示のいくつかの実施形態では、内部ループフィードバック制御システム125は、センサ測定値204を用いて、宇宙機の現在の方位を求め、宇宙機の現在の方位と宇宙機の目標方位との間の誤差を低減するために、運動量交換デバイス105等のアクチュエータ103に司令209を送信する。本開示のいくつかの実施形態では、内部ループコントローラ125は、アクチュエータ103へのフィードバック司令209としての宇宙機の現在の方位と宇宙機の目標方位との間の誤差に対して比例積分微分(PID)利得を適用する。他の実施形態では、宇宙機の現在の方位と宇宙機の目標方位との間の誤差は、不確定の宇宙機パラメータ、例えば、慣性モーメント及び慣性相乗モーメント、を推定する内部状態に基づいてフィードバック司令209を生成する適応姿勢コントローラを用いて低減することができる。
図2を更に参照すると、いくつかの他の実施形態では、内部ループフィードバック制御システム125は、現在の宇宙機の方位と宇宙機の目標方位との間の誤差を回転行列として符号化するSO(3)ベースの姿勢コントローラの形態を取る。SO(3)ベース姿勢コントローラは、姿勢追従問題のほぼ大域的な漸近的安定性を提供することができ、容易に実現可能なフィードバックコントローラとすることができ、外乱周波数において無限のフィードバック利得を提供することによって外乱除去を提供することができる。宇宙機の目標方位は、慣性固定方位とすることができ、又は特別に変化することができる方位、例えば、地球を常に指し示すように進展する方位、とすることができる。
本開示のいくつかの実施形態では、外部ループ制御システム127は、後退ホライズンにわたってモデル予測制御(MPC)を用いて制御を実現する。MPCは、内部ループフィードバック制御をモデル化する構成要素と、宇宙機の運動の目的のセットと、宇宙機推進システム及び運動に対する制約とを含む宇宙機のモデルに基づく反復的な有限ホライズン最適化に基づいており、今後の事象を予想し、その結果として適切な制御動作を行う能力を有する。これは、制約を受ける宇宙機のモデルに従って取得される予測を有する今後の有限時間ホライズンにわたって、目的のセットに従って宇宙機の動作を最適化し、現在のタイムスロットに対してのみ制御を実施することによって達成される。
図2を更に参照すると、例えば、制約129は、宇宙機102の物理的限界、宇宙機の動作に対する安全性限界、及び宇宙機の軌道に対する性能限界を表すことができる。宇宙機の制御ストラテジーは、そのような制御ストラテジーについて宇宙機によって生成される運動が全ての制約を満たすときに容認可能である。例えば、時刻tにおいて、宇宙機の現在の状態がサンプリングされ、容認可能なコスト最小化制御ストラテジーが、今後の比較的短い時間ホライズンについて求められる。具体的には、オンライン又はリアルタイムの計算が、コスト最小化制御ストラテジーを時刻t+Tまで求める。制御の最初のステップが実施された後、状態が再度測定又は推定され、この時点における現在の状態から開始して計算が繰り返され、新たな制御及び新たな予測状態軌道が得られる。予測ホライズンは前方にシフトし、この理由から、MPCは後退ホライズン制御とも呼ばれる。
図3は、本開示の実施形態による、外部ループ制御システムの一部とすることができるいくつかのモジュールを示すブロック図である。例えば、図3は、宇宙機のモデル123が、宇宙機の並進運動を統御する宇宙機軌道ダイナミクス、並びに宇宙機の姿勢運動を統御する宇宙機姿勢ダイナミクス及び宇宙機姿勢運動学等のモデル123のパラメータ間の関係を規定する公称モデル302を含むことを示す。モデル123は、内部ループフィードバック制御モデル325も含むことを示す。この内部ループフィードバック制御モデルは、内部ループ325が取る動作を外部ループが予測することができることを可能にするものであり、外部ループ制御システム127が、運動量交換デバイス105(図1B及び図1C)にそれらの運動量をアンロードするように内部ループ制御システム125に司令させる(109)(図2)形で、スラスタ103(図1B及び図1C)に動作するように司令する(107)(図2)ことができるという認識に基づいている。
モデル123は、宇宙機102に作用する外乱力114(図2)を規定する外乱モデル303も含む。本開示のいくつかの実施形態では、外乱力114は、制御の種々の時間ステップの間、宇宙機102が所定の位置、例えば所望の位置165(図1C及び図1D)、に位置しているかのように求められる。すなわち、宇宙機の実際の位置にかかわらず求められる。それらの実施形態は、そのような近似が、精度を大幅に低下させることなく外乱の計算複雑度を簡素化するという認識に基づいている。外乱モジュール303は、宇宙機の運動目的を満たしながら燃料消費を削減することができるように、MPCが、ナチュラルダイナミクスを活用して外乱力を補償することを可能にする。
図3を更に参照すると、宇宙機の物理量のうちのいくつかは、宇宙機の動作に対する制約305によって規定された所望の範囲内に留まっている必要がある。例えば、そのような物理量は、宇宙機をウィンドウ166(図1C及び図1D)内に維持する要件から導出される位置制約と、オイラー角175(図1E)を限度176内に維持する要件から導出される方位制約とを含む宇宙機の姿勢を含むことができる。
本開示のいくつかの実施形態は、スラスト規模制限等の宇宙機アクチュエータの動作制限を満たすには、制御入力に対する制約306が必要とされるという追加の認識に基づいている。本開示のいくつかの実施形態では、制約306は、宇宙機を制御する少なくともいくつかの制約305と組み合わせて用いられる。
図3を更に参照すると、本開示のいくつかの実施形態では、制御入力107は、宇宙機の動作に対する制約305及び制御入力に対する制約306を条件としたコスト関数309の最適化に基づいて求められる。本開示のいくつかの実施形態では、コスト関数は、宇宙機の位置の構成要素391と、宇宙機の姿勢の構成要素392と、蓄積された運動量の構成要素393と、宇宙機の動作の目的の構成要素394と、宇宙機の動作の安定性を確保する構成要素395と、トルクペナルティを含む構成要素396とを含む複数の構成要素の組み合わせを含む。コスト関数306の構成要素の異なる組み合わせを選択することによって、本開示のいくつかの実施形態は、制御の種々の目的のために調整された現在のコスト関数309を求める。
例えば、宇宙機の位置の構成要素391は、ウィンドウ166(図1C及び図1D)内に留まるという目的の達成を助けるために、所望の位置165(図1C)からの宇宙機のより大きな変位167(図1C)にペナルティを科し、それによって、コスト関数309の最適化が、宇宙機に印加されると変位167を低減する制御入力をもたらすようにしている。
図3を更に参照すると、宇宙機の姿勢の構成要素392は、宇宙機の所望の方位を維持するという目的の達成を助けるために、宇宙機固定基準座標系174(図1E)と所望の基準座標系、例えば171(図1E)との間の宇宙機のオイラー角175(図1E及び図1F)のより大きな大きさにペナルティを科し、それによって、コスト関数309の最適化が、宇宙機に印加されるとオイラー角175を低減する制御入力をもたらすようにしている。これらの結果の制御入力は、オイラー角175をそれらの目的値に向けて直接低減する方法でスラスタの噴射を誘発する司令とすることもできるし、オイラー角の目的値の達成を助ける運動量交換デバイスへの司令を生成するように内部ループ制御システムに影響を与える方法でスラスタ103(図1B及び図1C)の噴射を誘発する司令とすることもできる。
蓄積された運動量の構成要素393は、蓄積された運動量のより大きな大きさにペナルティを科し、それによって、コスト関数309の最適化が、宇宙機に印加されると蓄積された運動量をアンロードする制御入力をもたらすようにしている。例えば、リアクションホイールのスピン速度の高い値にはペナルティが科され、その結果、リアクションホイール105(図1B及び図1C)のスピン速度を低減する制御入力を生成する最適化がもたらされる。外部ループ制御システムは、運動量交換デバイスに直接司令せず、蓄積された運動量を直接アンロードすることができないので、この制御入力は、蓄積された運動量をアンロードするように内部ループ制御システムに影響を与える方法でスラスタを噴射させる。
図3を更に参照すると、宇宙機の動作の目的の構成要素394は、例えば、コスト関数309の最適化がより少ない燃料を用いる制御入力をもたらすように、スラスタが用いる燃料の量に対するペナルティを含むこともできるし、コスト関数の最適化が宇宙機により高速に動作させる、すなわち、より短い期間で目的を達成する、制御入力をもたらすように、宇宙機が動作する速度のより小さな大きさに対するペナルティを含むこともできる。
安定性の構成要素395は、コスト関数309の最適化が、宇宙機の動作の安定性を確保する制御入力をもたらすように求められる。1つの実施形態では、所望の軌道160(図1C及び図1D)が円形である場合、コスト関数の安定性構成要素は、離散代数リッカチ方程式(DARE)の解を用いることによって、MPCホライズンの端部にある宇宙機の位置にペナルティを科す。他の実施形態では、所望の軌道は円形ではない。例えば、所望の軌道は楕円形であるか、又はそれ以外の非円形で周期的なものである。その場合、安定性構成要素は、周期的差分リッカチ方程式(PDRE)の解を用いることによって、MPCホライズンの端部にある宇宙機の位置にペナルティを科す。PDRE解は一定ではなく、このため、現在のコスト関数209のペナルティは、MPCホライズンの端部にいる時刻に対応する時点におけるPDRE解に対応するように選択されることに留意されたい。
図3を更に参照すると、本開示のいくつかの実施形態では、コスト関数309の構成要素391〜394のそれぞれは、当該コスト関数の最適化が、それらの相対重みに対応する優先順位で様々な個々の構成要素の目標を達成する制御入力を生成するように重み付けされる。
例えば、1つの実施形態では、重みは、スラスタが用いる燃料にペナルティを科す構成要素394に最大重みが与えられるように選択される。その結果、この実施形態は、より大きな平均変位167(図1C)を犠牲にして可能な限り最小量の燃料を用いることを優先する宇宙機の動作を生成する。異なる実施形態では、所望の位置165(図1C及び図1D)からの変位167(図1C)にペナルティを科す構成要素391に最大重みが与えられる。その結果、この実施形態は、より多くの燃料を用いることを犠牲にして小さな平均変位167を維持することを優先する宇宙機の動作を生成する。本開示のいくつかの実施形態では、安定性の構成要素395は、安定化制御入力を生成する重みに従って規定されたその重みを有する。
図3を更に参照すると、制御システム101(図1B)のプロセッサ113(図1B)は、現在のコスト関数309を最適化することによって現在の反復中に宇宙機スラスタへの力の司令107を求める制御入力モジュール308を含む制御システムの様々なモジュールを実行する。制御入力モジュールは、宇宙機の動作に対する制約305と現在の制御入力に対する制約306とを条件として、宇宙機の現在のモデル301を用いて現在のコスト関数を最適化する。
1つの実施形態では、制御入力モジュール308におけるコスト関数309の最適化は、二次計画法(QP)として定式化される。二次計画法は、オンボード計算能力が制限された宇宙機等のリソース制約のあるハードウェアにおいてより高速かつより効率的に解くことができる。二次計画法を利用するために、線形二次MPC(LQ−MPC)定式化が適用される。
図3を更に参照すると、例えば、制御システムは、目標軌道上の所望の目標ロケーション165(図1B及び図1C)における公称モデル302の線形化と、内部ループフィードバック制御モデル302の線形化と、所望の目標ロケーション165における外乱力を求めることとを行うための現在のモデルモジュール301も備える。本開示のいくつかの実施形態では、線形化は、LQ−MPCが線形予測モデルを利用することに起因している。モジュール301は、現時点のMPCホライズン全体にわたる宇宙機の現在のモデルを求める。モジュール301は、宇宙機(図1B)の現在の状態106を受信して、線形化に対する宇宙機の状態を求めることもできる。
制御システムは、現在のコスト関数309を求めるコスト関数モジュール307も備える。例えば、コスト関数モジュール307は、宇宙機の目標動作の変化、例えば、所望の運動133の変化、に基づいて以前のコスト関数を更新する。なぜならば、異なる運動は、宇宙機の物理量205にそれらの所望の目的値を満たさせるために異なるコスト関数を必要とする可能性があるからである。また、コスト関数モジュールは、所望の軌道が、その軌道に基づいて更新された重みを必要とする場合に、コスト関数の安定性構成要素395を更新することができる。制御のステップは反復して実行されるので、現在のモデル及び現在のコスト関数は、その後の反復については以前のモデル及び以前のコスト関数になる。例えば、以前のモデル、以前のコスト関数及び以前の制御入力は、以前の反復においては、現在のモデル、現在のコスト関数及び現在の制御入力として求められる。
また、本開示の少なくとも1つの方法を実施する少なくとも1組のプロセスステップを考案した。例えば、軌道位置保持ボックス内に留まると同時に、余分な蓄積運動量をアンロードするように宇宙機を制御するために、以下の反復方法ステップに従って宇宙機を制御することができる制御システムを開発する。
初期ステップ1は、GPS、相対範囲測定等の任意のタイプの軌道特定手順を用いて、目標軌道上の目標位置に対する現在の宇宙機位置を特定するステップを含むことができる。ステップ2は、スタートラッカー、ホライズンセンサ等の任意のタイプの姿勢特定手順を用いて、所望の方位に対する現在の宇宙機方位を特定することを含むことができる。ステップ3は、現時点についての、及び、将来の予測ホライズンにわたる、目標軌道上の目標ロケーションにおける宇宙機軌道及び姿勢ダイナミクスの線形化を計算することを含むことができる。ステップ4は、目標ロケーションにおいて同じホライズンにわたって予測される非ケプラー外乱力を計算することを含むことができ、これらの外乱力をダイナミクス予測モデルと組み合わせて、全体予測を形成することができる。ステップ5は、軌道のタイプに依存するコスト関数を場合によって更新することを含むことができる。ステップ6は、全体予測モデル、軌道位置保持及び方位要件、スラスタ力−トルク関係、及び利用可能なスラスタに関する制約によって規定され、制約されるようなコスト関数を用いて有限ホライズン最適制御問題を解き、オンボード運動量交換デバイスへの力、トルク及び司令を取得することを含むことができる。コスト関数は、任意選択で、ジンバルブームアセンブリのジンバル角に関するソフト制約を含むことができる。ステップ7は、力及びトルクから、宇宙機に司令されることになるスラストプロファイルを計算することを含むことができる。ステップ8は、宇宙機にスラストプロファイルを適用することを含むことができる。ステップ9は、オンボード運動量交換デバイスに司令を適用することを含むことができる。ステップ10は、指定された時間だけ待機することを含むことができ、そのプロセスを繰り返すことができる。当然、これらのステップは繰り返すことができ、及び/又は場合によっては異なる順序に編成することができる。
図4は、質量中心401と、ジンバル搭載ブームアセンブリ403上に搭載されるスラスタ103とを伴う宇宙機102を示す。スラスタプルームの衝突の危険を伴うことなく、アンテナ及び太陽電池パネル405を搭載できるように、スラスタ103は多くの場合に宇宙機102の1つの面に制限される。さらに、スラスタは、太陽電池パネル405を避けるために、領域404内で噴射するように要求される場合がある。領域404は、許容可能スラスタ入力司令に関する、MPC内のハード制約306(図3)として実現することができる。
軌道位置保持及び運動量アンロードの両方のために使用されるスラスタの配置及び許容可能噴射領域を制限することにより、スラスタが、宇宙機上に正味の力を加えることもなく、純粋なトルクを与えるのを妨げる可能性がある。例えば、図4において、スラスタ103は方向402において噴射し、その方向は、宇宙機102の質量中心401を通り抜けない。そのようなスラスタ噴射は、蓄積された運動量だけでなく、宇宙機の位置及び方位(姿勢)にも影響を及ぼすことになり、同時の軌道位置保持、姿勢制御及び運動量管理の問題を引き起こす。
図4を更に参照すると、理論的には、所望の軌道、又は複数の量のうちのいくつかに関する目標点等の、宇宙機に関する所望の目標動作、例えば、所望の運動133を満たすために、MPCは制御入力107を介して宇宙機を制御する最適なスラスタ司令を見つけることになる。例えば、MPCは、トルク誘発スラストによって宇宙機の不要な回転が生じる可能性があり、オンボード運動量交換デバイス105を用いて宇宙機の不要な回転を補償できることを認識することができる。しかしながら、運動量交換デバイス105のダイナミクスが、スラスタ103のダイナミクスより緩慢である可能性があり、運動量交換デバイスの動作の影響が、MPCの予測ホライズンから外れる可能性がある。
図5Aは、予測ホライズン502中の運動量交換デバイス105の予測値501を示す。運動量交換デバイス105のダイナミクスがスラスタのダイナミクスに比べて緩慢な場合があるので、その将来値503は、MPCから制御入力107を生成する際に利用されない場合がある。計算上の理由から、MPC予測ホライズンを拡張するのが実現不可能な場合があり、そのため、MPCは、宇宙機の姿勢及び蓄積されたオンボード運動量の両方に適した解を与えることができない可能性があるのが現実である。
図5Bは、コスト関数309(図3)が、スラスタ103(図1B及び図1C)によって生成されたトルクにペナルティを科すための構成要素596で強化される解を示す。このトルクペナルティ596は、トルク誘発スラストを許容できるが、トルクが不要であるときに阻止できるソフト制約としても知られる。そのため、本開示のいくつかの実施形態は、スラスト角に関するハード制約を課すほかに、スラスト角に関するソフト制約を課す構成要素596をコスト関数309に追加し、宇宙機の質量中心401(図4)を通り抜けるトルクフリースラストに対応する公称角からの角度の偏差にペナルティを科す。構成要素596を伴うコスト関数309の最適化の結果として、宇宙機に適用されるときに、質量中心401付近の角度において噴射して、不要な回転を回避するという目的を果たすのを助ける可能性がより高い制御入力が生成される。
特徴
制御システムの一態様は、目標姿勢からの宇宙機の変位にペナルティを科す宇宙機の姿勢に関する構成要素と、蓄積された運動量の大きさの値が大きいほどペナルティを科す、運動量交換デバイスによって蓄積される運動量に関する構成要素とを有するコスト関数を含むことができる。ソフト制約はコスト関数の一構成要素を形成する。さらに、一態様は、運動量交換デバイスの内部ループ制御のダイナミクスを含む、宇宙機の運動量交換デバイスのダイナミクスのモデルを含むことができ、宇宙機のダイナミクスのモデルは内部ループ制御のダイナミクスを含み、MPCの解は、内部ループ制御に従う運動量交換デバイスの作動の影響を考慮に入れる。またさらに、一態様は、宇宙機の方位と宇宙機の目標方位との間の誤差を削減する内部ループ制御を含むことができ、MPCの解は、運動量交換デバイスを減速するためのスラスタのスラスト角及びその大きさを指定する。さらに、宇宙機のダイナミクスのモデルは、モデルのパラメータ間の関係を規定する線形公称モデルと、後退ホライズンの全期間にわたって目標位置に位置する宇宙機に作用する外乱力を規定する外乱モデルとを含むことができる。
宇宙機の一態様は、宇宙機バスと、宇宙機の姿勢を変更するための1組のスラスタとを含む宇宙機を含むことができ、スラスタは宇宙機バスの単一の面上に位置する。宇宙機に作用する外乱トルクを吸収するための1組の運動量交換デバイス。制御システムに従ってスラスタを動作させるスラスタコントローラ。
宇宙機の態様は、スラスタのスラストが角錐形の内部に存在するように強制する、スラスタの回転範囲を規定する、スラスト角に関するハード制約を含むことができる。2つのスラスタが同じジンバル角を共有するように、少なくとも2つの結合されたスラスタが、スラスタを宇宙機バスに接続するジンバル搭載ブームアセンブリ上に搭載される。さらに、宇宙機は、宇宙機のダイナミクスのモデルが、ジンバル搭載ブームアセンブリの機構に違反して、結合されたスラスタが互いに独立して回転できるようにする一態様を含むことができる。制御システムは、MPCによって決定される結合されたスラスタのスラストの大きさを結合されたスラスタのそれぞれのオン状態及びオフ状態を指定するパルス信号として変調する変調器を更に備えることができ、同じジンバル角を共有する結合されたスラスタのオン状態は時間的に交わらず、スラスタコントローラはパルス信号に従って結合されたスラスタを動作させる。変調器は、パルス信号を生成するために所定の周波数においてスラストの大きさを量子化する閉ループパルス幅変調器(PWM)とすることができることが可能であり、パルス信号の幅又はデューティサイクルが、MPCからの連続スラスト要求及び所定の周波数によって指定される。
方法の態様は、目標姿勢からの宇宙機の変位にペナルティを科す宇宙機の姿勢に関する構成要素と、蓄積される運動量の大きさの値が大きいほどペナルティを科す、運動量交換デバイスによって蓄積される運動量に関する構成要素とを有するコスト関数を含むことができる。ソフト制約はコスト関数の一構成要素を形成する。一態様は、運動量交換デバイスの内部ループ制御のダイナミクスを含む、宇宙機の運動量交換デバイスのダイナミクスのモデルを含む宇宙機のモデルに基づく最適化を含むことができることが可能であり、宇宙機のダイナミクスのモデルは、内部ループ制御のダイナミクスを含み、司令は、内部ループ制御に従う運動量交換デバイスの作動の影響を考慮に入れる。内部ループ制御は宇宙機の方位と宇宙機の目標方位との間の誤差を削減し、司令は、運動量交換デバイスを減速するためのスラスタのスラスト角及びその大きさを指定する。またさらに、宇宙機のダイナミクスのモデルは、モデルのパラメータ間の関係を規定する線形公称モデルと、後退ホライズンの全期間にわたって目標位置に位置する宇宙機に作用する外乱力を規定する外乱モデルとを含むことができる。
図6は、本開示の実施形態による、代替のコンピュータ又はプロセッサを用いて実施することができる図1Aの方法を示すブロック図である。コンピュータ611は、バス656を通して接続されるプロセッサ640、コンピュータ可読メモリ612及び記憶装置658を含む。
メモリ612は、プロセッサによって実行可能である命令、履歴データ、並びに本開示の方法及びシステムによって利用することができる任意のデータを記憶できると考えられる。プロセッサ640は、シングルコアプロセッサ、マルチコアプロセッサ、コンピューティングクラスタ、又は任意の数の他の構成とすることができる。プロセッサ640は、バス656を通して1つ以上の入力デバイス及び出力デバイスに接続することができる。メモリ612は、ランダムアクセスメモリ(RAM),リードオンリーメモリ(ROM)、フラッシュメモリ、又は任意の他の適切なメモリシステムを含むことができる。
図6を更に参照すると、記憶デバイス658は、プロセッサによって使用される補足データ及び/又はソフトウェアモジュールを記憶するように構成することができる。例えば、記憶デバイス658は、履歴デバイスデータ、及びデバイスのためのマニュアル等の他の関連デバイスデータを記憶することができ、それらのデバイスは、本開示に関して上記で言及されたような測定データを取得することができる検知デバイスである。それに加えて、又は代替的に、記憶デバイス658はセンサデータに類似の履歴データを記憶することができる。記憶デバイス658は、ハードドライブ、光ドライブ、サムドライブ、ドライブのアレイ、又はその任意の組み合わせを含むことができる。
コンピュータ611は、適用例に応じて、電源654を含むことができ、電源654は、任意選択で、コンピュータ611の外部に位置することができる。ネットワークインターフェースコントローラ(NIC)634が、バス656を通してネットワーク636に接続するように構成され、数ある中でも、センサデータ又は他のデータ。
図6を更に参照すると、数ある中でも、センサデータ又は他のデータを、ネットワーク636の通信チャネルを介して送信することができ、及び/又は記憶及び/又は更なる処理のために記憶システム658内に記憶することができる。さらに、センサデータ又は他のデータは受信機646(若しくは外部受信機638)からワイヤレスで若しくは有線で受信することができるか、又は送信機647(若しくは外部送信機639)を介してワイヤレスで若しくは有線で送信することができ、受信機646及び送信機647はいずれもバス656を通して接続される。コンピュータ611は入力インターフェース608を介して外部検知デバイス644及び/又は外部入力/出力デバイス641に接続することができる。コンピュータ611は、他の外部コンピュータ642に接続することができる。出力インターフェース609を用いて、プロセッサ640からの処理済みのデータを出力することができる。
スラスタへの司令を計算する方程式
本開示の一実施形態によれば、宇宙機モデル123(図2)は、ジンバルによって支持された4つの電気スラスタ103と、直交したマスバランス構成でリジッドバス(rigid bus:剛体バス)に取り付けられた3つの軸対称リアクションホイール105とを装備した静止地球軌道(GEO)上の直下視宇宙機について求められる。宇宙機のバス固定座標系174(図1E)が規定され、宇宙機の姿勢を求める慣性座標系171(図1E)が指定される。宇宙機の運動方程式は、以下の式によって与えられる。
Figure 0006837574
ここで、
Figure 0006837574
は、衛星の位置であり、
Figure 0006837574
は、慣性座標系に対するバス座標系の回転行列を用いて
Figure 0006837574
を姿勢パラメータ化したものであり、
Figure 0006837574
は、各リアクションホイールの回転角度を含む列行列である。ベクトル
Figure 0006837574
は、バス座標系において解かれた慣性座標系に対するバス座標系の角速度である。行列J Bcは、バス座標系において解かれた、衛星
Figure 0006837574
のその質量中心に対する慣性モーメントである。リアクションホイールアレイは、慣性モーメント
Figure 0006837574
を有し、ホイールは、加速度
Figure 0006837574
を用いて制御される。項
Figure 0006837574
は、地球の非球形重力場、太陽及び月の重力、太陽放射圧(SRP)に起因した衛星に対する外部摂動を表し、以下の式(4)において定義される。項
Figure 0006837574
は、太陽放射圧に起因した摂動トルクを表す。この摂動トルクは、全吸収を前提とし、以下の式によって与えられる。
Figure 0006837574
ここで、cは、地球の近くの有効SRPであり、
Figure 0006837574
は、宇宙機の質量中心から太陽を指し示す単位ベクトルであり、pは、衛星の6つの側部のうちの1つの圧力中心であり、
Figure 0006837574
は、衛星の質量中心に対する第iパネルの圧力中心の位置であり、
Figure 0006837574
は、バス座標系において解かれた第iパネルの法線ベクトルである。値Nは、太陽の方向に向いているパネルの数である。太陽の方向に向いているパネルのみがトルクに寄与する。ジンバルによって支持された電気スラスタ150は、以下の式によって与えられる宇宙機に対する正味の力を提供する力を生成する。
Figure 0006837574
電気スラスタは、以下の式によって与えられる宇宙機に対する正味のトルクも生成する。
Figure 0006837574
1つの実施形態では、内部ループ制御システム108は、SO(3)ベースの姿勢コントローラであり、式(1)におけるリアクションホイールアレイを制御するフィードバック則は、以下の式によって与えられる。
Figure 0006837574
ここで、
Figure 0006837574
であり、
Figure 0006837574
である。
このSO(3)内部ループ姿勢コントローラは、以下の物理量を使用する。
Figure 0006837574
ここで、
Figure 0006837574
は、歪対称射影演算子であり、
Figure 0006837574
は、歪対称行列を3次元ベクトルにアンマッピングするアンクロス(uncross)演算子であり、K、K、及びKは利得である。
他の実施形態では、式(1)は、他の軌道における宇宙機及びリアクションホイール以外の他の運動量交換デバイスを用いる宇宙機を統御する式の代わりに用いられる。
1つの実施形態では、モデル(1)は線形化され、現在の予測モデル301(図3)が形成される。姿勢誤差回転行列
Figure 0006837574
は、3−2−1オイラー角セット(ψ,θ,φ)を用いて
Figure 0006837574
としてパラメータ化される。ここで、Rは、所望の姿勢軌道であり、C、C、及びCは、それぞれx軸、y軸、及びz軸の回りのψ、θ、及びφの初等回転である。軌道の平均運動nに対応する角速度を有する平衡スピンについての姿勢ダイナミクス及び姿勢運動学の線形化は、公称円形軌道の回りの小さな操縦のための宇宙機の運動の線形化とともに、以下の式によって与えられる。
Figure 0006837574
ここで、δx、δy及びδzは、公称ロケーション165である
Figure 0006837574
に対する宇宙機の相対位置ベクトル
Figure 0006837574
の成分であり、
Figure 0006837574
は、公称軌道の平均運動であり、
Figure 0006837574
は、宇宙機の相対角速度成分であり、
Figure 0006837574
は、宇宙機の相対オイラー角である。すなわち、それらは、宇宙機の所望の角速度成分及び所望のオイラー角からの誤差を表す物理量である。
内部ループ姿勢制御を利用する実施形態の場合、内部ループ制御法則(11)とともに式(1)の線形化が、モデル123に基づく予測の一部として内部ループフィードバック制御モデル325(図3)として用いられる。これは、変更された相対角速度方程式
Figure 0006837574
と、以下の式によって与えられる式(12)に基づく追加の線形化方程式とを与える。
Figure 0006837574
宇宙機がGEOに存在する実施形態の場合、主な摂動加速度は、太陽及び月の重力と、太陽放射圧と、異方性ジオポテンシャル、すなわち地球の非球形重力場とに起因している。単位質量当たりのこれらの摂動力、すなわち外乱加速度、の解析的表現は、それぞれ以下の式によって与えられる。
Figure 0006837574
ここで、
Figure 0006837574
は座標のない(未定の)ベクトルを示し、μsun及びμmoonは太陽及び月の重力定数であり、Csrpは太陽放射圧定数であり、Sは太陽の方向に向いている表面積であり、creflは表面反射率であり、ρは地球の赤道半径であり、
Figure 0006837574
は地球を中心とする慣性座標系のz軸単位ベクトルであり、Jは検討対象のジオポテンシャル摂動モデルにおける支配的な係数である。ここで、追加の高次項は無視される。式(4)における個々の外乱加速度の和は、式(1)において検討される総外乱加速度を与える。
本開示のいくつかの実施形態では、状態空間モデルが、以下の式によって与えられる。
Figure 0006837574
ここで、
Figure 0006837574
である。
式(5)は、MPCポリシーにおいて予測モデルとして用いられるために、ΔT秒のサンプリング周期を用いて離散化され、これによって、以下の式が与えられる。
Figure 0006837574
ここで、xは、時間ステップk∈Zにおける状態であり、uは、時間ステップk∈Zにおける制御ベクトルであり、
Figure 0006837574
は、式(5)における連続時間システム実現値(A,B)に基づいて取得される離散化された行列である。
宇宙機に作用する外乱の推定
本開示のいくつかの実施形態では、モデル(8)は、外乱加速度(4)の予測モデルを用いて強化され、以下の式が取得される。
Figure 0006837574
ここで、ap,kは、所望の位置165(図1B及び図1C)の伝播に基づいて時間ステップkにおいて予測された総外乱加速度であり、OH/Eは、慣性座標系171(図1E)からのap,kの成分を、所望の基準座標系170(図1C)における同じ加速度の成分に変換する回転行列である。
外乱加速度予測の所望の位置165(図1B及び図1C)は、式(4)における解析的表現の非線形性に起因して式(9)において用いられる。
図7は、時間ステップk=0におけるその所望の位置165から変位した宇宙機102を示している。時間ステップk=1,k=2,...,k=Nにおける公称軌道160上の所望の位置701、702、及び703は事前に知られているので、ap,kは、外乱力704、705、及び706から、時間ステップk=1,k=2,...,k=Nにおける解析的表現(4)に基づいて予測することができる。宇宙機の位置は、タイトなウィンドウ166内に制約されるので、所望の位置701、702、及び703における外乱加速度と真の衛星位置707における外乱加速度との差は、事前に知られていないが、無視することができる。したがって、本開示のいくつかの実施形態は、宇宙機が後退ホライズンの全期間の間目標位置に位置しているかのように外乱力を求める。
スラスタへの入力に対する制約
本開示のいくつかの実施形態では、宇宙機の動作に対する制約129(図2)は、以下の関係を用いて、軌道位置保持ウィンドウ166に対応するδy及びδzによって少なくとも部分的に課される。
Figure 0006837574
ここで、λ1,maxは最大許容可能経度誤差であり、λ2,maxは最大許容可能緯度誤差である。
本開示のいくつかの実施形態では、スラスタ103が宇宙機座標系174とのそれらの公称アライメントから固定量回転することを可能にするために、それらのスラスタをジンバルによって支持することができる。しかしながら、個々のスラスタは、限られたジンバル範囲の運動を有し、したがって、角錐183を形成する4つの平面の内部に位置するように制約される。この制約は、以下の式によって与えられる。
Figure 0006837574
ここで、
Figure 0006837574
の4つの行のそれぞれは、平面を記述する法線ベクトルを含む。
本開示のいくつかの実施形態では、蓄積された過剰な運動量をアンロードしている間であっても宇宙機の方位を維持するために、相対オイラー角(δφ,δθ,δψ)は、以下の小さな許容誤差内に制約される。
Figure 0006837574
コスト関数の目的
本開示のいくつかの実施形態では、現在のコスト関数309(図3)は、様々な目的、例えば、公称軌道位置からの変位を定量化する目的Jと、オイラー角の誤差を定量化し、宇宙機の角速度成分にペナルティを科す目的Jと、スラスタを用いて力及びトルクを生成することにペナルティを科す目的Jと、リアクションホイール運動量にペナルティを科す目的Jとに関連付けられたコストから構成される。本開示のいくつかの実施形態では、これらのコストJ〜Jは、以下の式によって与えられる。
Figure 0006837574
各目的J〜Jは、重みwを乗算され、以下の総コスト関数Jtotに組み合わされる。
Figure 0006837574
各目的に割り当てられる重みwは、その相対的な重要度を定める。所与の目的に割り当てられる重みが大きいほど、その目的は、コスト関数が最適化されるときに優先度が高くなる。
式(6)及び式(7)に基づいて、Jtotは、状態空間を定式化するために以下のように記述することができる。
Figure 0006837574
ここで、Q及びRは、各目的に割り当てられた重みwを符号化する対称正定値重み行列であり、成分定式化(18)から明らかでない交差重み(cross-weights)等の追加の重みを更に変更又は追加することができる。
コスト関数の安定性目的
本開示のいくつかの実施形態では、所望の軌道が円形でない場合、例えば、楕円形であるか、又はそれ以外の非円形で周期的なものである場合、その軌道を回る宇宙機運動のモデル123(図3)は、線形でありかつ時間変化するものとすることができる。そのような実施形態では、安定性のためのコスト関数309(図3)の構成要素395(図3)は、以下の周期的差分リッカチ方程式(PDRE)の解に基づいて求められる。
Figure 0006837574
ここで、A、Bは、時間ステップkにおけるモデル123の行列であり、P、Q及びRは、対称正定値重み行列である。行列Q及びRは、式(19)における重み行列と同じとなるように選ばれる。
公称円形軌道、例えばGEOを回る運動等の、線形化が時間不変である実施形態の場合、安定性の構成要素395(図3)は、以下の離散代数リッカチ方程式(DARE)の解に基づいて求められる。
Figure 0006837574
ここで、A、Bは、式(8)におけるモデルの行列であり、P、Q、及びRは、対称正定値重み行列である。上記のように、行列Q及びRは、式(19)における重み行列と同じになるように選ばれる。
制御入力計算
本開示のいくつかの実施形態では、制御入力モジュール308(図3)は、現在のコスト関数309(図3)と、式(9)を用いてホライズンにわたる状態の進展を予測する現在の線形化された宇宙機モデル123と、式(10)、式(13)、及び式(14)を用いる宇宙機制約306(図3)とから形成される以下の有限ホライズン数値最適化問題の形態を取る。
Figure 0006837574
ここで、P、Q、Rは、式(15)において与えられる行列であり、Dは、式(13)において与えられる行列であり、x(t)は、現在の時間ステップにおける状態である。問題(17)は、問題制約を条件として現在のコスト関数を最小にする入力シーケンスU=[u...uを見つける数値ソルバーを用いて解かれる。
入力シーケンスにおける第1の入力uは、入力計算208の出力107とみなされる。入力uは、スラスタ及び運動量交換デバイスへの司令104を作成する内部ループフィードバック制御109の出力と組み合わされる。次の時間ステップt+1において、モデル及びコスト関数は更新され、状態は更新され、数値最適化問題が再度解かれる。
軌道が、宇宙機モデル123(図3)が時間不変であるような軌道である場合、A=A=...=Aであり、B=B=...=Bであり、式(17)におけるP、Q、及びRは、式(16)における行列P、Q、及びRによって与えられる。P又はPが式(17)のコスト関数に含まれることによって、制約が作用していない原点近くと同様に、目標位置の局所安定性が確保され、外乱予測がない場合、式(17)の解は、周期的LQRコントローラ又はLQRコントローラのいずれかの解と同等になる。
本開示の上記で説明した実施形態は、数多くの方法のうちの任意のもので実施することができる。例えば、これらの実施形態は、ハードウェア、ソフトウェア、又はそれらの組み合わせを用いて実施することができる。請求項の要素を修飾する、特許請求の範囲における「第1」、「第2」等の序数の使用は、それ自体で、1つの請求項の要素の別の請求項の要素に対する優先順位も、優位性も、順序も暗示するものでもなければ、方法の動作が実行される時間的な順序も暗示するものでもなく、請求項の要素を区別するために、単に、或る特定の名称を有する1つの請求項の要素を、同じ(序数の用語の使用を除く)名称を有する別の要素と区別するラベルとして用いられているにすぎない。

Claims (20)

  1. 宇宙機の動作を制御する制御システムであって、
    前記宇宙機の姿勢をもたらす前記宇宙機のダイナミクスのモデルと、前記宇宙機の方位をもたらす前記宇宙機の運動量交換デバイスのダイナミクスのモデルとを用いて、有限後退ホライズンにわたってコスト関数を最適化することによって、前記宇宙機のスラスタを制御するための解を生成するモデル予測コントローラ(MPC)であって、前記最適化は、前記宇宙機のスラスタによって生成されるスラスト角に関するハード制約及びソフト制約を受け、前記ハード制約は、前記解内の前記スラスト角が前記ハード制約によって規定される所定の範囲内に入るように要求し、前記ソフト制約は、前記解に、前記宇宙機の質量中心を通り抜けるトルクフリースラストに対応する公称角からの前記スラスト角の偏差に関してペナルティを科すように、前記ハード制約を受けた前記モデル予測コントローラ(MPC)によって最適化されるべき前記コスト関数の構成要素として定式化される、モデル予測コントローラ(MPC)と、
    前記MPCの前記解に従って前記スラスタを動作させるスラスタコントローラと、
    を備える、制御システム。
  2. 前記コスト関数は、目標姿勢からの前記宇宙機の変位にペナルティを科す前記宇宙機の前記姿勢に関する構成要素と、蓄積された運動量の大きさの値が大きいほどペナルティを科す、前記運動量交換デバイスによって蓄積される運動量に関する構成要素とを含む、請求項1に記載の制御システム。
  3. 前記ソフト制約は前記コスト関数の一構成要素を形成する、請求項2に記載の制御システム。
  4. 前記宇宙機の運動量交換デバイスの前記ダイナミクスのモデルは、前記運動量交換デバイスの内部ループ制御のダイナミクスを含み、前記宇宙機の前記ダイナミクスのモデルは前記内部ループ制御の前記ダイナミクスを含み、前記MPCの前記解は、前記内部ループ制御に従う前記運動量交換デバイスの作動の影響を考慮に入れる、請求項1に記載の制御システム。
  5. 前記内部ループ制御は前記宇宙機の前記方位と前記宇宙機の目標方位との間の誤差を削減し、前記MPCの前記解は、前記運動量交換デバイスを減速するための前記スラスタのスラスト角及びその大きさを指定する、請求項4に記載の制御システム。
  6. 前記宇宙機の前記ダイナミクスのモデルは、前記モデルのパラメータ間の関係を規定する線形公称モデルと、前記有限後退ホライズンの全期間にわたって目標位置に位置する前記宇宙機に作用する外乱力を規定する外乱モデルとを含む、請求項1に記載の制御システム。
  7. 宇宙機であって、
    宇宙機バスと、
    前記宇宙機の姿勢を変更するための1組のスラスタであって、前記スラスタは前記宇宙機バスの単一の面上に位置する、1組のスラスタと、
    前記宇宙機に作用する外乱トルクを吸収するための1組の運動量交換デバイスと、
    請求項1に記載の制御システムに従って前記スラスタを動作させるスラスタコントローラと、
    を備える、宇宙機。
  8. 宇宙機であって、
    宇宙機バスと、
    前記宇宙機の姿勢を変更するための1組のスラスタであって、前記スラスタは前記宇宙機バスの単一の面上に位置し、少なくとも2つのスラスタが、前記スラスタを前記宇宙機バスに接続するジンバル搭載ブームアセンブリ上に搭載される、1組のスラスタと、
    前記宇宙機に作用する外乱トルクを吸収するための1組の運動量交換デバイスと、
    前記1組のスラスタを動作させるスラスタコントローラと、
    宇宙機の動作を制御するための制御システムであって、前記制御システムは、前記宇宙機の姿勢をもたらす前記宇宙機のダイナミクスのモデルと、前記宇宙機の方位をもたらす前記宇宙機の運動量交換デバイスのダイナミクスのモデルとを用いて、有限後退ホライズンにわたってコスト関数を最適化することによって、前記宇宙機のスラスタを制御するための解を生成するモデル予測コントローラ(MPC)を含み、前記最適化は、前記宇宙機のスラスタによって生成されるスラスト角に関するハード制約及びソフト制約を受け、前記ハード制約は、前記解内の前記スラスト角が前記ハード制約によって規定される所定の範囲内に入るように要求し、前記ソフト制約は、前記解に、前記宇宙機の質量中心を通り抜けるトルクフリースラストに対応する公称角からの前記スラスト角の偏差に関してペナルティを科すように、前記モデル予測コントローラ(MPC)によって最適化されるべき前記コスト関数の構成要素として定式化され、前記MPCの前記解は、前記MPCの前記解に従って前記スラスタを動作させるために前記スラスタコントローラに出力される、制御システムと、
    を備える、宇宙機。
  9. 前記スラスト角に関する前記ハード制約は、前記スラスタのスラストが角錐形の内部に存在するように強制する、前記スラスタの回転範囲を規定する、請求項8に記載の宇宙機。
  10. 少なくとも2つのスラスタが同じジンバル角を共有するように、前記2つのスラスタが結合される、請求項8に記載の宇宙機。
  11. 前記制御システムは更に、
    同じジンバル角を共有する結合されたスラスタのオン状態が時間的に交わらないように、前記MPCによって決定される前記結合されたスラスタのスラストの大きさを前記結合されたスラスタのそれぞれのオン状態及びオフ状態を指定するパルス信号として変調し、互いに排他的な時間変調を実行する変調器を備え、
    前記スラスタコントローラは、前記ジンバル搭載ブームアセンブリ上に搭載されたスラスタが前記同じジンバル角を共有するように、前記パルス信号に従って前記結合されたスラスタを動作させる、請求項10に記載の宇宙機。
  12. 前記変調器は、パルス信号を生成するために所定の周波数において前記スラストの前記大きさを量子化する閉ループパルス幅変調器(PWM)であり、前記パルス信号の幅又はデューティサイクルが、前記MPCからの連続スラスト要求及び前記所定の周波数によって指定される、請求項11に記載の宇宙機。
  13. 宇宙機のモデルに従って前記宇宙機の動作を制御する方法であって、
    前記宇宙機の姿勢に関する制約及びスラスタへの入力に関する制約を受ける、有限後退ホライズンにわたるコスト関数の最適化を用いて、前記宇宙機の前記スラスタ及び前記宇宙機の運動量交換デバイスを同時に制御するための制御入力を決定することであって、
    前記コスト関数は、前記宇宙機の前記姿勢を制御するための構成要素と、前記宇宙機の方位をもたらす前記運動量交換デバイスによって蓄積される運動量を制御するための構成要素とを含み、前記最適化は、前記宇宙機のスラスタによって生成されるスラスト角に関するハード制約及びソフト制約を受け、前記ハード制約は、前記宇宙機のスラスタを制御するための解内の前記スラスト角が前記ハード制約によって規定される所定の範囲内に入るように要求し、前記ソフト制約は、前記解に、前記宇宙機の質量中心を通り抜けるトルクフリースラストに対応する公称角からの前記スラスト角の偏差に関してペナルティを科すように、モデル予測コントローラ(MPC)によって最適化されるべき前記コスト関数の構成要素として定式化される、決定することと、
    前記制御入力の少なくとも一部に従って前記スラスタ及び前記運動量交換デバイスを同時に制御する司令を生成することと、
    を含み、前記方法の前記決定すること及び前記生成することは前記宇宙機のプロセッサによって実行される、方法。
  14. 前記コスト関数は、目標姿勢からの前記宇宙機の変位にペナルティを科す前記宇宙機の前記姿勢に関する構成要素と、蓄積される運動量の大きさの値が大きいほどペナルティを科す、前記運動量交換デバイスによって蓄積される運動量に関する構成要素とを含む、請求項13に記載の方法。
  15. 前記ソフト制約は前記コスト関数の一構成要素を形成する、請求項13に記載の方法。
  16. 前記最適化は、運動量交換デバイスの内部ループ制御のダイナミクスを含む、前記宇宙機の前記運動量交換デバイスのダイナミクスのモデルを含む前記宇宙機の前記モデルに基づき、前記宇宙機の前記ダイナミクスのモデルは、前記内部ループ制御の前記ダイナミクスを含み、前記司令は、前記内部ループ制御に従う前記運動量交換デバイスの作動の影響を考慮に入れる、請求項13に記載の方法。
  17. 前記内部ループ制御は前記宇宙機の前記方位と前記宇宙機の目標方位との間の誤差を削減し、前記司令は、前記運動量交換デバイスを減速するための前記スラスタのスラスト角及びその大きさを指定する、請求項16に記載の方法。
  18. 前記宇宙機の前記ダイナミクスのモデルは、前記モデルのパラメータ間の関係を規定する線形公称モデルと、前記有限後退ホライズンの全期間にわたって目標位置に位置する前記宇宙機に作用する外乱力を規定する外乱モデルとを含む、請求項16に記載の方法。
  19. 方法を実行するためのプロセッサによって実行可能なプログラムを具現する非一時的コンピュータ可読記憶媒体であって、前記方法は、
    宇宙機の姿勢に関する制約及びスラスタへの入力に関する制約を受ける、有限後退ホライズンにわたるコスト関数の最適化を用いて、前記宇宙機の前記スラスタ及び前記宇宙機の運動量交換デバイスを同時に制御するための制御入力を決定することであって、
    前記コスト関数は、前記宇宙機の前記姿勢を制御するための構成要素と、前記宇宙機の方位をもたらす前記運動量交換デバイスによって蓄積される運動量を制御するための構成要素とを含み、
    前記最適化は、前記宇宙機のスラスタによって生成されるスラスト角に関するハード制約及びソフト制約を受け、前記ハード制約は、前記宇宙機のスラスタを制御するための解内の前記スラスト角が前記ハード制約によって規定される所定の範囲内に入るように要求し、前記スラスト角に関する前記ハード制約は、前記スラスタのスラストが角錐形の内部に存在するように強制する前記スラスタの回転範囲を規定し、前記ソフト制約は、前記解に、前記宇宙機の質量中心を通り抜けるトルクフリースラストに対応する公称角からの前記スラスト角の偏差に関してペナルティを科ように、モデル予測コントローラ(MPC)によって最適化されるべき前記コスト関数の構成要素として定式化される、決定することと、
    前記制御入力の少なくとも一部に従って前記スラスタ及び前記運動量交換デバイスを同時に制御する司令を生成することと、
    を含み、前記方法の前記決定すること及び前記生成することは前記宇宙機のプロセッサによって実行される、非一時的コンピュータ可読記憶媒体。
  20. 前記最適化は、運動量交換デバイスの内部ループ制御のダイナミクスを含む、前記宇宙機の前記運動量交換デバイスのダイナミクスのモデルを含む前記宇宙機の前記モデルに基づき、前記宇宙機の前記ダイナミクスのモデルは、前記内部ループ制御の前記ダイナミクスを含み、前記司令は、前記内部ループ制御に従う前記運動量交換デバイスの作動の影響を考慮に入れる、請求項19に記載の記憶媒体。
JP2019553124A 2017-08-10 2018-02-05 宇宙機並びに宇宙機の動作を制御する制御システム及び方法 Active JP6837574B2 (ja)

Applications Claiming Priority (3)

Application Number Priority Date Filing Date Title
US15/674,479 US10875669B2 (en) 2017-08-10 2017-08-10 Model predictive control of spacecraft
US15/674,479 2017-08-10
PCT/JP2018/005144 WO2019030950A1 (en) 2017-08-10 2018-02-05 SPACE VEHICLE AND CONTROL SYSTEM AND METHOD FOR CONTROLLING THE OPERATION OF A SPATIAL VEHICLE

Publications (2)

Publication Number Publication Date
JP2020515455A JP2020515455A (ja) 2020-05-28
JP6837574B2 true JP6837574B2 (ja) 2021-03-03

Family

ID=61692033

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2019553124A Active JP6837574B2 (ja) 2017-08-10 2018-02-05 宇宙機並びに宇宙機の動作を制御する制御システム及び方法

Country Status (4)

Country Link
US (1) US10875669B2 (ja)
EP (1) EP3665085B1 (ja)
JP (1) JP6837574B2 (ja)
WO (1) WO2019030950A1 (ja)

Families Citing this family (20)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP6490314B2 (ja) 2016-09-29 2019-03-27 三菱電機株式会社 ポインティング機構
US11420775B2 (en) * 2018-10-04 2022-08-23 The Aerospace Corporation Systems and methods for deploying a deorbiting device
WO2020160314A1 (en) * 2019-01-31 2020-08-06 Urugus S.A. Attitude control system and method
CN110304279B (zh) * 2019-05-31 2021-03-26 北京控制工程研究所 一种电推进卫星的质心在轨标定补偿方法
US11292618B2 (en) * 2019-07-03 2022-04-05 Mitsubishi Electric Research Laboratories, Inc. Nonlinear model predictive control of coupled celestial system
CN110266237B (zh) * 2019-07-08 2021-03-02 长安大学 一种七个基本电压集合模型预测pmsm直接转矩控制简化方法
CN110844122B (zh) * 2019-11-20 2022-08-16 中山大学 一种约束姿态跟踪误差的卫星姿态控制方法
CN111605733B (zh) * 2020-04-28 2022-03-04 北京控制工程研究所 航天器自治协同粗精分层主被一体三超控制参数确定方法
RU2764935C1 (ru) * 2020-09-02 2022-01-24 Публичное акционерное общество "Ракетно-космическая корпорация "Энергия" имени С.П. Королёва" Способ определения ориентации космического аппарата по сигналам навигационных спутников
CN112193438B (zh) * 2020-09-14 2021-12-07 中国空间技术研究院 一种卫星入轨初期放气扰动的评估系统与评估方法
CN112506051B (zh) * 2020-11-24 2022-05-06 西北工业大学深圳研究院 一种基于模型预测控制的混合帆平动点轨道保持方法
CN112572834B (zh) * 2020-12-08 2021-08-31 哈尔滨工业大学 考虑矩形视场的目标区域规避相对位姿一体化控制
CN114035595B (zh) * 2021-10-14 2024-08-09 北京空间飞行器总体设计部 一种深空探测指向机构多自由度大范围运动线束控制方法
CN114137839B (zh) * 2021-11-26 2023-03-24 南京航空航天大学 适用于分布式电推进飞机多推进器的协同控制方法
CN114019997B (zh) * 2021-11-26 2023-12-01 南京航空航天大学 固定翼无人机位置跟踪偏差约束下有限时间控制方法
CN114063653B (zh) * 2021-12-03 2023-12-29 中国人民解放军63892部队 空间与时间一致性约束小型无人机高精度航迹控制方法
US20230286674A1 (en) * 2022-03-08 2023-09-14 Utah State University Space Dynamics Laboratory Model predictive control for spacecraft formation
CN114970180B (zh) * 2022-06-06 2023-02-28 哈尔滨工业大学 一种航天器掠飞观测的在轨优化方法
CN115356927B (zh) * 2022-08-17 2024-05-07 浙大宁波理工学院 机器人的三闭环鲁棒预测函数控制方法
CN116880521B (zh) * 2023-06-26 2024-07-12 北京空间飞行器总体设计部 一种航天器自主诊断重构的正常和故障一体化设计方法

Family Cites Families (23)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US5349532A (en) 1992-04-28 1994-09-20 Space Systems/Loral Spacecraft attitude control and momentum unloading using gimballed and throttled thrusters
US5850993A (en) * 1995-08-25 1998-12-22 Martin Marietta Corp. Spacecraft thruster operation for improved orbital maneuver accuracy
US6047221A (en) * 1997-10-03 2000-04-04 Pavilion Technologies, Inc. Method for steady-state identification based upon identified dynamics
US5810295A (en) 1996-07-10 1998-09-22 Hughes Electronics Corporation Method and apparatus for a satellite station keeping
US6068217A (en) * 1996-10-16 2000-05-30 Space Systems/Loral, Inc. Method to reorient a spacecraft using only initial single axis attitude knowledge
US6042058A (en) * 1997-04-29 2000-03-28 Hughes Electronics Corporation Stationkeeping and momentum-dumping thruster systems and methods
US6125310A (en) * 1997-07-18 2000-09-26 Space Systems/Loral, Inc. Thruster on time signaling with flexure compensation avoidance
US6296207B1 (en) * 1999-01-27 2001-10-02 Space Systems/Loral, Inc. Combined stationkeeping and momentum management
US6565043B1 (en) * 2001-12-21 2003-05-20 The Boeing Company Redundant system for satellite inclination control with electric thrusters
JP4339016B2 (ja) 2002-05-20 2009-10-07 川崎重工業株式会社 推力配分方法及び推力配分装置
US20090039202A1 (en) * 2007-02-07 2009-02-12 Keita Ogo Attitude Change Control Method, Attitude Change Control System, Attitude Change Control Program and Program Recording Medium
US20080315039A1 (en) * 2007-06-21 2008-12-25 Lael Rudd System and methods for space vehicle torque balancing
US7918420B2 (en) * 2007-07-17 2011-04-05 The Boeing Company System and methods for simultaneous momentum dumping and orbit control
US8412391B2 (en) * 2007-08-17 2013-04-02 Princeton Satelitte Systems Proximity spacecraft maneuvering
US9115662B1 (en) * 2009-07-10 2015-08-25 The Boeing Company Health-adaptive reaction control system
US9180984B2 (en) * 2012-05-11 2015-11-10 The Boeing Company Methods and apparatus for performing propulsion operations using electric propulsion systems
US9038958B1 (en) 2012-05-29 2015-05-26 United States Of America As Represented By The Secretary Of The Navy Method and apparatus for contingency guidance of a CMG-actuated spacecraft
US9296494B1 (en) * 2012-08-10 2016-03-29 Lockheed Martin Corporation Thruster orbit control method and configuration
US8880246B1 (en) * 2012-08-22 2014-11-04 United States Of America As Represented By The Secretary Of The Navy Method and apparatus for determining spacecraft maneuvers
US10183765B2 (en) * 2014-03-12 2019-01-22 Lockheed Martin Corporation Thruster arrangement for geosynchronous orbit spacecraft
US9764858B2 (en) * 2015-01-07 2017-09-19 Mitsubishi Electric Research Laboratories, Inc. Model predictive control of spacecraft
CN105843239B (zh) 2016-04-06 2019-03-29 北京理工大学 一种用于组合航天器姿态控制推力器布局优化方法
US10967991B2 (en) * 2017-08-10 2021-04-06 Mitsubishi Electric Research Laboratories, Inc. Model predictive control of spacecraft

Also Published As

Publication number Publication date
US10875669B2 (en) 2020-12-29
EP3665085A1 (en) 2020-06-17
WO2019030950A1 (en) 2019-02-14
JP2020515455A (ja) 2020-05-28
US20190049999A1 (en) 2019-02-14
EP3665085B1 (en) 2021-12-22

Similar Documents

Publication Publication Date Title
JP6837574B2 (ja) 宇宙機並びに宇宙機の動作を制御する制御システム及び方法
JP6837575B2 (ja) 宇宙機、及び宇宙機の動作を制御する制御システム
JP6656380B2 (ja) 宇宙機の動作を制御する方法及びシステム、宇宙機
US9874879B2 (en) Model Predictive control of spacecraft
JP6945952B2 (ja) 宇宙機及び輸送機関
Dell et al. Optimal propellantless rendez-vous using differential drag
US20220097872A1 (en) Attitude control system and method
Wen et al. Tension control of space tether via online quasi-linearization iterations
US11292618B2 (en) Nonlinear model predictive control of coupled celestial system
WO2023234420A1 (en) Eigenmotion control for near rectilinear halo orbits
De Florio et al. Precise autonomous orbit control in low earth orbit
US20230391477A1 (en) Eigenmotion Control for Near Rectilinear Halo Orbits
Dearing Efficient Trajectory Optimization for Constrained Spacecraft Attitude Maneuvers using Momentum Exchange Devices
Swei Spacecraft attitude control design with adaptive bounded controllers
Mehra et al. Nonlinear predictive control for spacecraft trajectory guidance, navigation and control

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20190926

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20200630

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20200805

TRDD Decision of grant or rejection written
A01 Written decision to grant a patent or to grant a registration (utility model)

Free format text: JAPANESE INTERMEDIATE CODE: A01

Effective date: 20210112

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20210209

R150 Certificate of patent or registration of utility model

Ref document number: 6837574

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250