JP6707206B2 - Spacecraft control device, spacecraft control method, and program - Google Patents
Spacecraft control device, spacecraft control method, and program Download PDFInfo
- Publication number
- JP6707206B2 JP6707206B2 JP2019539474A JP2019539474A JP6707206B2 JP 6707206 B2 JP6707206 B2 JP 6707206B2 JP 2019539474 A JP2019539474 A JP 2019539474A JP 2019539474 A JP2019539474 A JP 2019539474A JP 6707206 B2 JP6707206 B2 JP 6707206B2
- Authority
- JP
- Japan
- Prior art keywords
- command value
- thruster
- spacecraft
- angular momentum
- angle
- 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
Links
- 238000000034 method Methods 0.000 title claims description 11
- 238000002347 injection Methods 0.000 claims description 100
- 239000007924 injection Substances 0.000 claims description 100
- 230000007246 mechanism Effects 0.000 claims description 51
- 230000008859 change Effects 0.000 claims description 46
- 239000000243 solution Substances 0.000 claims description 42
- 238000010304 firing Methods 0.000 claims 1
- 230000006870 function Effects 0.000 description 94
- 238000012545 processing Methods 0.000 description 34
- 230000014509 gene expression Effects 0.000 description 18
- 239000003380 propellant Substances 0.000 description 10
- 238000010586 diagram Methods 0.000 description 8
- 230000005855 radiation Effects 0.000 description 7
- 230000001174 ascending effect Effects 0.000 description 4
- 238000012423 maintenance Methods 0.000 description 4
- 230000008569 process Effects 0.000 description 4
- 238000005457 optimization Methods 0.000 description 3
- 230000000737 periodic effect Effects 0.000 description 3
- PEDCQBHIVMGVHV-UHFFFAOYSA-N Glycerine Chemical compound OCC(O)CO PEDCQBHIVMGVHV-UHFFFAOYSA-N 0.000 description 2
- 230000001154 acute effect Effects 0.000 description 2
- 230000014759 maintenance of location Effects 0.000 description 2
- 238000012986 modification Methods 0.000 description 2
- 230000004048 modification Effects 0.000 description 2
- 230000003287 optical effect Effects 0.000 description 2
- 230000001133 acceleration Effects 0.000 description 1
- 230000004913 activation Effects 0.000 description 1
- 238000004891 communication Methods 0.000 description 1
- 239000002131 composite material Substances 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 230000005484 gravity Effects 0.000 description 1
- 229920006395 saturated elastomer Polymers 0.000 description 1
- 238000009738 saturating Methods 0.000 description 1
- 239000004065 semiconductor Substances 0.000 description 1
- 230000002123 temporal effect Effects 0.000 description 1
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B64—AIRCRAFT; AVIATION; COSMONAUTICS
- B64G—COSMONAUTICS; VEHICLES OR EQUIPMENT THEREFOR
- B64G1/00—Cosmonautic vehicles
- B64G1/22—Parts of, or equipment specially adapted for fitting in or to, cosmonautic vehicles
- B64G1/24—Guiding or controlling apparatus, e.g. for attitude control
- B64G1/26—Guiding or controlling apparatus, e.g. for attitude control using jets
- B64G1/262—Guiding or controlling apparatus, e.g. for attitude control using jets having adjustable angles, e.g. gimbaled thrusters
Landscapes
- Engineering & Computer Science (AREA)
- Remote Sensing (AREA)
- Chemical & Material Sciences (AREA)
- Combustion & Propulsion (AREA)
- Radar, Positioning & Navigation (AREA)
- Aviation & Aerospace Engineering (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Description
本発明は、天体の回りの軌道を周回する宇宙機の軌道保持制御および角運動量のアンローディングを行う宇宙機制御装置、宇宙機制御方法、およびプログラムに関する。 The present invention relates to a spacecraft control device, a spacecraft control method, and a program that perform orbital maintenance control and unloading of angular momentum of a spacecraft that orbits around an celestial body.
宇宙機には、宇宙機の姿勢を制御する姿勢制御アクチュエータ、および宇宙機の経度および緯度を所望の範囲に維持するスラスタが搭載される。宇宙機は、例えば、静止衛星、地球観測衛星、宇宙船等である。姿勢制御アクチュエータの一例として、リアクションホイール、CMG(Control Moment Gyro)等が宇宙機に搭載される。宇宙機には、太陽輻射トルク、磁気トルク等の種々の外乱トルクが働く。そこで、リアクションホイールを回転させて、外乱トルクを吸収して、宇宙機の姿勢を所望の向きに維持する必要がある。リアクションホイールの回転数には限度があるため、リアクションホイールの回転数の増加を抑え、リアクションホイールの回転数を正常範囲内に維持することが行われる。これを姿勢制御アクチュエータに蓄積された角運動量のアンローディングという。詳細には、スラスタを用いてアンローディングトルクを発生させることで、アンローディングが行われる。 The spacecraft is equipped with an attitude control actuator that controls the attitude of the spacecraft and a thruster that maintains the longitude and latitude of the spacecraft within a desired range. The spacecraft is, for example, a geostationary satellite, an earth observation satellite, a spacecraft, or the like. As an example of the attitude control actuator, a reaction wheel, a CMG (Control Moment Gyro), or the like is mounted on the spacecraft. Various disturbance torques such as solar radiation torque and magnetic torque act on the spacecraft. Therefore, it is necessary to rotate the reaction wheel to absorb the disturbance torque and maintain the attitude of the spacecraft in a desired direction. Since the rotation speed of the reaction wheel is limited, it is possible to suppress an increase in the rotation speed of the reaction wheel and maintain the rotation speed of the reaction wheel within a normal range. This is called unloading of the angular momentum accumulated in the attitude control actuator. Specifically, unloading is performed by generating unloading torque using a thruster.
宇宙機の経度および緯度を所望の範囲に維持する軌道保持制御と、角運動量のアンローディングとを行う技術が特許文献1,2に開示されている。特許文献1に開示される衛星に搭載されたスラスタは、軌道の下降ノードの近傍、および上昇ノードの近傍で噴射される。特許文献2に開示される制御システムは、超過運動量をアンロードするように、宇宙船の姿勢およびスラスタへの入力に対する制約を条件とした後退ホライズンにわたるコスト関数の最適化を用いて、宇宙船のスラスタおよび宇宙船の運動量交換デバイスを同時に制御する制御入力コマンドを生成する。 Patent Documents 1 and 2 disclose techniques for performing orbit hold control for maintaining the longitude and latitude of a spacecraft within a desired range and unloading angular momentum. The thruster mounted on the satellite disclosed in Patent Document 1 is ejected in the vicinity of the descending node of the orbit and in the vicinity of the ascending node. The control system disclosed in U.S. Pat. No. 6,096,839 uses spacecraft optimization using a cost function optimization over a receding horizon subject to constraints on the spacecraft attitude and inputs to the thrusters to unload excess momentum. Generate control input commands to simultaneously control the thruster and spacecraft momentum exchange devices.
上述の軌道保持制御と角運動量のアンローディングとを行うためには、推薬が必要である。推薬が枯渇すると、宇宙機は軌道保持制御および角運動量のアンローディングを行うことができない。そのため、軌道保持制御と角運動量のアンローディングとにおける推薬の使用量の低減が求められている。 A propellant is required to perform the above-described trajectory maintenance control and angular momentum unloading. When the propellant is exhausted, the spacecraft cannot perform orbit hold control and angular momentum unloading. Therefore, it is required to reduce the amount of propellant used in the trajectory maintenance control and the unloading of the angular momentum.
一方で、宇宙機の通信能力を増大させるために宇宙機の発生電力の大電力化が求められ、宇宙機の太陽電池パドルが大型化する傾向にある。太陽電池パドルが大型化すると、宇宙機に働く太陽輻射圧の影響が増大する。その結果、太陽輻射圧の影響によって増大する衛星の軌道の離心率を補償するために、衛星の経度を所望の範囲内に維持する東西制御の制御量が増大する。また宇宙機に働く太陽輻射圧トルクも増大するため、宇宙機に搭載された姿勢制御アクチュエータの角運動量が飽和しやすくなる。この場合、例えば、昇交点近傍および降交点近傍の二箇所、または、特許文献1に開示されるように、軌道の下降ノードの近傍および上昇ノードの近傍において、軌道保持制御と角運動量のアンローディングとを行うことは、推薬の使用量の削減の観点から、最適ではないことがある。 On the other hand, in order to increase the communication capability of the spacecraft, it is required to increase the power generated by the spacecraft, and the solar battery paddle of the spacecraft tends to be large. As the size of the solar array paddle increases, the effect of solar radiation pressure on the spacecraft increases. As a result, in order to compensate for the eccentricity of the satellite's orbit, which is increased by the influence of solar radiation pressure, the control amount of the east-west control for keeping the longitude of the satellite within the desired range is increased. Further, since the solar radiation pressure torque acting on the spacecraft also increases, the angular momentum of the attitude control actuator mounted on the spacecraft tends to be saturated. In this case, for example, in two locations near the ascending node and the descending node, or in the vicinity of the descending node and the ascending node of the orbit, as described in Patent Document 1, orbital holding control and angular momentum unloading. Doing and may not be optimal from the perspective of reducing propellant usage.
特許文献2に開示される制御システムは、後退ホライズンにわたるモデル予測制御(Model Predictive Control:MPC)を用いて、宇宙船の動作の最適化を行う。この制御システムは、宇宙船の現在の状態、宇宙船の現在のモデル、および宇宙船への現在の制御入力に基づいて、宇宙船の次の状態を求める。そのため、MPCの最適化変数の次元が数十から数百と膨大な数となって、処理が複雑化するため、宇宙機に搭載される計算機での処理に適さないという課題がある。 The control system disclosed in Patent Document 2 optimizes the operation of a spacecraft by using model predictive control (MPC) over a backward horizon. The control system determines the next state of the spacecraft based on the current state of the spacecraft, the current model of the spacecraft, and the current control inputs to the spacecraft. Therefore, the dimension of the optimization variable of MPC becomes a huge number of several tens to several hundreds, and the processing becomes complicated.
本発明は上述の事情に鑑みてなされたものであり、推薬の使用量が少なく、軌道保持制御と角運動量のアンローディングとを行うための処理が、宇宙機に搭載される計算機で処理が可能となるように簡易化された宇宙機制御装置、宇宙機制御方法、およびプログラムを提供することを目的とする。 The present invention has been made in view of the above circumstances, the amount of propellant used is small, and the processing for performing orbital holding control and angular momentum unloading is performed by a computer mounted on a spacecraft. An object of the present invention is to provide a spacecraft control device, a spacecraft control method, and a program that are simplified so as to be possible.
上記目的を達成するため、本発明に係る宇宙機制御装置は、角運動量算出部、指令値算出部、スラスタ制御部、およびジンバル制御部を備える。角運動量算出部は、天体の周りの軌道を周回する宇宙機が有する角運動量を算出する。指令値算出部は、それぞれが宇宙機の構体に、ジンバル機構を介して取り付けられた複数のスラスタの内、少なくともいずれかのスラスタの噴射を指示するスラスタ指令値、およびスラスタの噴射時におけるジンバル機構の角度を指示する角指令値を算出する。スラスタ制御部は、スラスタ指令値に基づき、スラスタを制御する。ジンバル制御部は、角指令値に基づき、ジンバル機構を制御する。指令値算出部は、第1の制約条件の下で、複数の噴射区間におけるスラスタの噴射量の合計が目的関数である非線形計画問題の解を求めることで、複数の噴射区間のそれぞれのスラスタ指令値および角指令値を算出する。非線形計画問題の第1の制約条件は、第1の関数および第2の関数に基づく。第1の関数は、軌道における複数の噴射区間でのスラスタ指令値および角指令値を引数として、該スラスタ指令値に基づいてスラスタが制御され、該角指令値に基づいてジンバル機構が制御された場合に、宇宙機が軌道を一周する間の、宇宙機の軌道を表す軌道要素の変化量と角運動量の変化量とを出力する。第2の関数は、軌道要素、軌道要素の時間変化率、および角運動量を引数として、宇宙機が軌道を一周する間の、軌道要素の制御量と角運動量の制御量とを出力する。第1の制約条件は、軌道要素の変化量と軌道要素の制御量とが一致し、かつ、角運動量の変化量と角運動量の制御量とが一致することである。 In order to achieve the above object, a spacecraft control device according to the present invention includes an angular momentum calculation unit, a command value calculation unit, a thruster control unit, and a gimbal control unit. The angular momentum calculation unit calculates the angular momentum of the spacecraft that orbits the celestial body. The command value calculation unit includes a thruster command value for instructing the ejection of at least one thruster of the plurality of thrusters attached to the structure of the spacecraft via the gimbal mechanism, and the gimbal mechanism at the time of thruster ejection. An angle command value that indicates the angle of is calculated. The thruster control unit controls the thruster based on the thruster command value. The gimbal control unit controls the gimbal mechanism based on the angle command value. The command value calculation unit obtains the solution of the nonlinear programming problem in which the total of the injection amounts of the thrusters in the plurality of injection sections is the objective function under the first constraint condition, and thus the thruster commands of the plurality of injection sections are obtained. Value and angle command value are calculated. The first constraint of the nonlinear programming problem is based on the first function and the second function. The first function has the thruster command value and the angle command value in a plurality of injection sections in the trajectory as arguments, the thruster is controlled based on the thruster command value, and the gimbal mechanism is controlled based on the angle command value. In this case, the amount of change in the orbital element representing the orbit of the spacecraft and the amount of change in angular momentum are output while the spacecraft goes around the orbit. The second function outputs the control amount of the orbital element and the control amount of the angular momentum while the spacecraft goes around the orbit with the orbital element, the time change rate of the orbital element, and the angular momentum as arguments. The first constraint condition is that the change amount of the trajectory element and the control amount of the trajectory element match, and the change amount of the angular momentum and the control amount of the angular momentum match.
本発明によれば、軌道要素の変化量と軌道要素の制御量とが一致し、かつ、角運動量の変化量と角運動量の制御量とが一致する第1の制約条件の下で、複数の噴射区間におけるスラスタの噴射量の合計が目的関数である非線形計画問題の解が求められる。非線形計画問題の解を求めて、スラスタ指令値および角指令値を算出するため、推薬の使用量が少なく、軌道保持制御および角運動量のアンローディングを行うための処理が簡易化される。 According to the present invention, under the first constraint condition in which the change amount of the trajectory element and the control amount of the trajectory element match, and the change amount of the angular momentum and the control amount of the angular momentum match, The solution of the nonlinear programming problem in which the total injection amount of thrusters in the injection section is the objective function is obtained. Since the solution of the non-linear programming problem is obtained and the thruster command value and the angular command value are calculated, the amount of propellant used is small, and the processing for orbit hold control and angular momentum unloading is simplified.
以下、本発明の実施の形態に係る宇宙機制御装置について図面を参照して詳細に説明する。なお図中、同一または同等の部分には同一の符号を付す。 Hereinafter, a spacecraft control device according to an embodiment of the present invention will be described in detail with reference to the drawings. In the drawings, the same or equivalent parts are designated by the same reference numerals.
(実施の形態1)
実施の形態1に係る宇宙機制御装置を、宇宙機の一例である地球の周りを周回する静止衛星に搭載される宇宙機制御装置を例に説明する。この宇宙機制御装置は、静止衛星を目標とする軌道上に維持する軌道保持制御と、静止衛星の姿勢を制御する姿勢制御アクチュエータに蓄積された角運動量のアンローディングとを行う。(Embodiment 1)
The spacecraft control device according to the first embodiment will be described by taking a spacecraft control device mounted on a geostationary satellite that orbits the earth, which is an example of a spacecraft, as an example. This spacecraft control device performs orbit hold control for maintaining the geostationary satellite in a target orbit and unloading of the angular momentum accumulated in the attitude control actuator for controlling the attitude of the geostationary satellite.
上述したように実施の形態1に係る宇宙機制御装置の制御対象である静止衛星を図1に示す。図1に示す静止衛星10は、構体5と、構体5に取り付けられるジンバル機構31,32,33,34と、ジンバル機構31,32,33,34のそれぞれに取り付けられるスラスタ21,22,23,24と、を備える。ジンバル機構31,32,33,34は、いずれも同じ構造であり、構体5の外面の内、地球に向いている面50の反対側に位置する面51に取り付けられる。スラスタ21,22,23,24は、噴射方向が互いに異なる向きで面51に取り付けられる。スラスタ21,22,23,24をそれぞれ、NWスラスタ21、NEスラスタ22、SWスラスタ23、およびSEスラスタ24とも呼ぶこととする。スラスタ21,22,23,24およびジンバル機構31,32,33,34は、後述する宇宙機制御装置によって制御される。詳細には、宇宙機制御装置は、図1に示すジンバル機構31,32,33,34の角度を制御し、ジンバル機構31,32,33,34を介して構体5に取り付けられるスラスタ21,22,23,24を噴射させることで、静止衛星10の軌道保持制御と角運動量のアンローディングとを行う。
As described above, FIG. 1 shows a geostationary satellite which is a control target of the spacecraft control device according to the first embodiment. The
図2に示すように、理解を容易にするため、xH軸、yH軸、zH軸を基底とし、静止衛星10の質量中心C.M.(Center of Mass)を原点とする軌道座標系を設定し、適宜参照する。xH軸は、軌道の中心に位置する天体である地球4の中心と静止衛星10の質量中心C.M.とを通る。zH軸は、静止衛星10の軌道面の法線方向である。yH軸は、xH軸およびzH軸と右手系の座標を構成する。ジンバル機構31,32,33,34のそれぞれから質量中心C.M.までの距離を示す取付距離rは互いに同じである。xHyH平面に投影された質量中心C.M.からスラスタ21,22,23,24のそれぞれを指すベクトルと、xH軸とがなす鋭角である角度ψは互いに同じである。xHzH平面に投影された質量中心C.M.からスラスタ21,22,23,24のそれぞれを指すベクトルと、zH軸とがなす鋭角である角度γは互いに同じである。As shown in FIG. 2, for ease of understanding, x H axis, y H axis, and a base of z H axis, the centroid C.
ジンバル機構31,32,33,34の構造はいずれも同じであるから、ジンバル機構31について図3を用いて説明する。ジンバル機構31の回転軸を、互いに直交するxT軸およびyT軸とする。xT軸およびyT軸に直交する軸をzT軸とする。zT軸は、ジンバル機構31に取り付けられるスラスタ21の推力軸に平行に位置する。xT軸周りのジンバル角をαとし、yT軸周りのジンバル角をβとする。ジンバル角α,βが0である場合、zT軸は静止衛星10の質量中心C.M.を貫き、スラスタ21を噴射しても静止衛星10にトルクが働かない。ジンバル角α,βの少なくとも1つが0でない場合は、スラスタ21の噴射時に静止衛星10にトルクが働く。Since the
上述のスラスタ21,22,23,24およびジンバル機構31,32,33,34は、図4に示す宇宙機制御装置1によって制御される。宇宙機制御装置1は、ジンバル機構31,32,33,34の角度を制御し、スラスタ21,22,23,24の内、少なくとも1つを噴射させることで、静止衛星10の軌道保持制御と角運動量のアンローディングとを行う。
宇宙機制御装置1は、静止衛星10の軌道要素を算出する軌道決定部11と、静止衛星10の角運動量を算出する角運動量算出部12と、スラスタ21,22,23,24に対するスラスタ指令値およびジンバル機構31,32,33,34に対する角指令値を算出する指令値算出部13と、スラスタ指令値に基づきスラスタ21,22,23,24を制御するスラスタ制御部14と、角指令値に基づきジンバル機構31,32,33,34を制御するジンバル制御部15とを備える。The
The spacecraft control device 1 includes an
軌道決定部11は、例えば、静止衛星10に搭載されたGPS(Global Positioning System:全地球測位システム)受信機から取得したGPS情報、地上局から受信したレンジ、レンジレート、静止衛星10の方位角および仰角の情報等から、静止衛星10の軌道要素を算出する。なおレンジは、地上局から静止衛星10までの距離を示す。レンジレートは、地上局から静止衛星10までの距離の変化の割合を示す。地上局は、地上の光学カメラを用いた観測から静止衛星10の方位角および仰角を得ることができる。軌道決定部11は、静止衛星10の軌道要素の瞬時値から周期的な変動成分を取り除いて平均軌道要素を算出する。軌道要素は、例えば、離心率、傾斜角等を含む。以下の説明において、静止衛星10の軌道要素として平均軌道要素を用いる。周期的な変動成分とは、地球重力の摂動、例えば太陽、月等の摂動天体の潮汐力等によって発生し、周期が閾値以下の周期的な変動成分である。軌道決定部11は、算出した平均軌道要素を指令値算出部13に送る。軌道決定部11はさらに、平均軌道要素の時間変化率を算出し、平均軌道要素の時間変化率を指令値算出部13に送る。平均軌道要素の時間変化率は、十分に短い時間における平均軌道要素の変化量を示す。
The
角運動量算出部12は、静止衛星10に搭載された恒星センサ、ジャイロセンサ、磁気センサ、地球センサ、太陽センサ等のセンサから得られる静止衛星10の姿勢情報を用いて、静止衛星10の姿勢および姿勢角速度を求め、静止衛星10の角運動量を算出する。角運動量算出部12は、算出した角運動量を指令値算出部13に送る。
The angular
指令値算出部13は、詳細については後述するが、非線形計画問題の解を求めることで、静止衛星10を目標とする軌道から定められた範囲内に保持するための、スラスタ指令値および角指令値を算出する。なおスラスタ指令値は、スラスタ21,22,23,24の内、少なくともいずれかのスラスタに対する指令値である。詳細にはスラスタ指令値は、例えば、噴射タイミング、噴射位相、スラスタ21,22,23,24の噴射量の合計、噴射量の合計に対する噴射量の割合等を含む。角指令値は、スラスタ21,22,23,24のそれぞれの噴射時におけるジンバル機構31,32,33,34の少なくともいずれかのジンバル角α,βを示す。
Although detailed description will be given later, the command
スラスタ制御部14は、指令値算出部13が算出したスラスタ指令値に基づき、スラスタ21,22,23,24を制御する。ジンバル制御部15は、指令値算出部13が算出した角指令値に基づきジンバル機構31,32,33,34を制御する。
The
指令値算出部13は、図5に示すように、後述する第1の関数を求める第1関数算出部131と、後述する第2の関数を求める第2関数算出部132と、第1の関数の出力と第2の関数の出力とが一致する第1の制約条件を決める第1制約条件設定部133と、ジンバル機構31,32,33,34の角度が定められた範囲内にある第2の制約条件を決める第2制約条件設定部134と、第1の制約条件と第2の制約条件の下で、複数の噴射区間におけるスラスタ21,22,23,24の噴射量の合計が目的関数である非線形計画問題の解を求めることで、スラスタ指令値および角指令値を算出する求解部135と、を備える。なお指令値算出部13は、静止衛星10の緯度および経度の許容範囲、角運動量の許容範囲、ならびにジンバル角α,βの許容範囲を予め保持している。
As shown in FIG. 5, the command
第1関数算出部131は、複数の噴射区間でのスラスタ指令値および角指令値を引数として、後述する下記(13)−(16)式を含む第1の関数を求める。第1の関数は、引数であるスラスタ指令値に基づいてスラスタ21,22,23,24が制御され、引数である角指令値に基づいてジンバル機構31,32,33,34が制御された場合に、静止衛星10が軌道を一周する間の、軌道要素の変化量および角運動量の変化量を出力する。
The first
第2関数算出部132は、軌道決定部11から平均軌道要素および平均軌道要素の時間変化率を取得し、角運動量算出部12から角運動量を取得する。そして、第2関数算出部132は、平均軌道要素、平均軌道要素の時間変化率、および静止衛星10が有する角運動量を引数として、後述する下記(17),(20),(22),(24)式を含む第2の関数を求める。第2の関数は、静止衛星10の平均軌道要素の制御量および静止衛星10が有する角運動量の制御量を出力する。
The second
第1制約条件設定部133は、第1の関数を第1関数算出部131から取得し、第2の関数を第2関数算出部132から取得する。そして、第1制約条件設定部133は、軌道要素の変化量と平均軌道要素の制御量とが一致し、かつ、角運動量の変化量と角運動量の制御量とが一致することを示す条件式である第1の制約条件を求める。
The first constraint
第2制約条件設定部134は、ジンバル機構31,32,33,34の角度が定められた範囲内にあることを示す条件式である第2の制約条件を求める。
The second constraint
求解部135は、第1の制約条件と第2の制約条件の下で、複数の噴射区間におけるスラスタ21,22,23,24の噴射量の合計が目的関数である非線形計画問題について、目的関数を最小化する解を求める。その結果、複数の噴射区間のそれぞれのスラスタ指令値および角指令値が算出される。
Under the first constraint condition and the second constraint condition, the
指令値算出部13が予め保持している許容範囲の詳細について説明する。指令値算出部13は、静止衛星10の目標位置からのずれの許容範囲を予め保持している。詳細には、静止衛星10の緯度の目標値φrefおよび保持精度Δφmax、ならびに、静止衛星10の経度の目標値λrefおよび保持精度Δλmaxを予め保持している。緯度の目標値φrefおよび経度の目標値λrefは、上述の目標とする軌道を示す。緯度の保持精度Δφmaxおよび経度の保持精度Δλmaxは、静止衛星10が保持される、目標とする軌道を含む定められた範囲を示す。
静止衛星10の緯度φの範囲は下記(1)式で表される。静止衛星10の経度λの範囲は、下記(2)式で表される。
φref−Δφmax≦φ≦φref+Δφmax (1)
λref−Δλmax≦λ≦λref+Δλmax (2)Details of the allowable range that the command
The range of latitude φ of the
φ ref −Δφ max ≦φ≦φ ref +Δφ max (1)
λ ref −Δλ max ≦λ≦λ ref +Δλ max (2)
静止衛星10の場合、φrefは0であり、静止衛星10の観測対象が日本であれば、λrefは例えば140°である。緯度の保持精度Δφmaxおよび経度の保持精度Δλmaxを、例えば0.1°とする。この場合、静止衛星10の緯度の範囲は−0.1°以上、かつ、0.1°以下であり、静止衛星10の経度の範囲は、139.9°以上、かつ、140.1°以下である。In the case of the
さらに、指令値算出部13は、静止衛星10の角運動量の目標値からのずれの許容範囲を予め保持している。詳細には、指令値算出部13は、慣性系における静止衛星10の角運動量の目標値hxref,hyref,hzref、および角運動量の保持精度Δhxmax,Δhymax,Δhzmaxを予め保持している。Furthermore, the command
静止衛星10の角運動量の範囲は、下記(3)−(5)式で表される。
hxref−Δhxmax≦hx≦hxref+Δhxmax (3)
hyref−Δhymax≦hy≦hyref+Δhymax (4)
hzref−Δhzmax≦hz≦hzref+Δhzmax (5)
例えば、ゼロモーメンタム衛星の場合は、hxref、hyref、および、hzrefはいずれも0である。バイアスモーメンタム衛星の場合は、hxref、hyref、hzrefはいずれも0でない。Δhxmax、Δhymax、および、Δhzmaxは、リアクションホイール、CMG(Control Moment Gyro)等の静止衛星10に搭載された姿勢制御アクチュエータで補償可能な角運動量の大きさに応じて定められる。Δhxmax、Δhymax、および、Δhzmaxを、例えば30Nmsとする。The range of angular momentum of the
h xref −Δh xmax ≦h x ≦h xref +Δh xmax (3)
h yref -Δh ymax ≦ h y ≦ h yref + Δh ymax (4)
h zref −Δh zmax ≦h z ≦h zref +Δh zmax (5)
For example, in the case of a zero momentum satellite, h xref , h yref , and h zref are all 0. In the case of the bias momentum satellite, none of h xref , h yref and h zref is zero. Δh xmax , Δh ymax , and Δh zmax are determined according to the magnitude of angular momentum that can be compensated by the attitude control actuator mounted on the
さらに、指令値算出部13は、ジンバル機構の駆動角度の許容範囲を予め保持している。詳細には、指令値算出部13は、ジンバル機構31,32,33,34の駆動角度の上限αmax,βmaxおよび下限−αmax,−βmaxを予め保持している。Further, the command
ジンバル機構31,32,33,34の駆動角度の上限αmax、βmaxおよび下限−αmax,−βmaxは、静止衛星10の姿勢情報を取得するための上述のセンサ、姿勢制御アクチュエータ、姿勢制御アクチュエータを制御する制御装置等を含む姿勢制御系が補償可能な外乱トルクの大きさに応じて定められる。ジンバル機構31,32,33,34を回転させて、スラスタ21,22,23,24を噴射することで、静止衛星10にトルクが働く。トルクの大きさTは、下記(6)式で表されるように、ジンバル角の二乗ノルム、スラスタ21,22,23,24の推力の大きさF、および取付距離rに比例する。The upper limits α max , β max and the lower limits −α max , −β max of the drive angles of the
静止衛星10の打ち上げ後は、取付距離rを変更することはできない。スラスタ21,22,23,24の推力の大きさFは、軌道上で一定とみなされる。そのため、トルクの大きさTの調節は、ジンバル角α,βによって行われる。ジンバル角α,βを大きくすることで、より大きなトルクを静止衛星10に与えることが可能である。ジンバル角α,βを大きくすることで、静止衛星10に蓄積された角運動量をアンローディングする能力は向上する。しかしながら、スラスタ21,22,23,24の噴射によって静止衛星10に作用するトルクは、静止衛星10の姿勢制御系にとっては、外乱トルクである。そのため、トルクの大きさTが大きすぎると、姿勢制御系が不安定になり、静止衛星10の姿勢を保持できなくなる。そのため、ジンバル角α,βは、姿勢制御系で補償可能な外乱トルクの上限値Tmaxに応じて定められる。ジンバル角αの最大値αmaxは、下記(7)式で表される。ジンバル角βの最大値βmaxは、下記(8)式で表される。下記(7),(8)式におけるκは、1未満の正数である。After the
ジンバル角α,βの範囲は、下記(9),(10)式で表される。
−αmax≦α≦αmax (9)
−βmax≦β≦βmax (10)The ranges of gimbal angles α and β are expressed by the following equations (9) and (10).
−α max ≦α≦α max (9)
−β max ≦β≦β max (10)
指令値算出部13は、上述の静止衛星10の緯度および経度の範囲、角運動量の範囲、ならびにジンバル角α,βの範囲を予め保持している。指令値算出部13は、これらの許容範囲に基づいて、非線形計画問題の解を求めることで、スラスタ指令値および角指令値を算出する。詳細には、指令値算出部13は、後述する第1の制約条件の下で、目的関数を最小化する解を求める。図6を用いて、指令値算出部13の全体の流れを説明した後、個々のステップについて順に詳細に説明する。第1関数算出部131は、複数の噴射区間でのスラスタ指令値および角指令値を引数として、第1の関数を求める(ステップS11)。第2関数算出部132は、軌道決定部11から平均軌道要素を取得し、角運動量算出部12から角運動量を取得する(ステップS12)。第2関数算出部132は、平均軌道要素、平均軌道要素の時間変化率、および静止衛星10が有する角運動量を引数として、第2の関数を求める(ステップS13)。第1制約条件設定部133は、軌道要素の変化量と平均軌道要素の制御量とが一致し、かつ、角運動量の変化量と角運動量の制御量とが一致することを示す条件式である第1の制約条件を求める(ステップS14)。第2制約条件設定部134は、ジンバル機構31,32,33,34の角度が定められた範囲内にあることを示す条件式である第2の制約条件を求める(ステップS15)。求解部135は、目的関数を求める(ステップS16)。求解部135は、第1の制約条件、第2の制約条件、および複数の噴射区間におけるスラスタ21,22,23,24の噴射量の合計である目的関数に基づく非線形計画問題について、目的関数を最小化する解を求めることで、スラスタ指令値および角指令値を算出する(ステップS17)。指令値算出部13は、スラスタ指令値および角指令値をそれぞれ、スラスタ制御部14およびジンバル制御部15に出力する(ステップS18)。
The command
図6の各ステップの詳細について順に説明する。上記ステップS11の処理の詳細について説明する。第1関数算出部131は、複数の噴射区間でのスラスタ指令値および角指令値を引数として、第1の関数を求める。軌道の一周あたりN個の噴射区間が設けられる場合を例にして説明する。スラスタ指令値が、N個の噴射区間のそれぞれにおいて、スラスタ21,22,23,24の内、2本に対する噴射の指示である場合を例にして説明する。2本の組み合わせは、NWスラスタ21とNEスラスタ22の組、SWスラスタ23とSEスラスタ24の組、SWスラスタ23とNWスラスタ21の組、および、NEスラスタ22とSEスラスタ24の組のいずれかである。1つの噴射区間でスラスタ21,22,23,24の内、2本のみ噴射することで、推薬の使用量を少なくすることが可能である。
Details of each step in FIG. 6 will be described in order. Details of the processing in step S11 will be described. The first
j(1≦j≦N)番目の噴射区間において噴射するスラスタ21,22,23,24の内の2本を、aj,bjとする。ajとbjは、NWスラスタ21とNEスラスタ22の組、SWスラスタ23とSEスラスタ24の組、SWスラスタ23とNWスラスタ21の組、および、NEスラスタ22とSEスラスタ24の組のいずれかである。j番目の噴射区間において噴射するスラスタaj,bjの噴射量の合計をFjとすると、aj,bjのそれぞれの噴射量を決定する配分係数ξjを用いて、スラスタaj,bjのそれぞれの噴射量faj,fbjは、下記(11),(12)式で表される。配分係数ξjは、−1≦ξj≦1の条件を満たす係数である。ξj=1の場合には、スラスタajのみが噴射し、ξj=−1の場合は、スラスタbjのみが噴射し、ξj=0の場合は、スラスタaj,bjが等しく噴射する。Two of the
第1の関数のパラメータは、j番目の噴射区間における噴射量の合計Fj,j番目の噴射区間における配分係数ξj,j番目の噴射区間における平均経度λavgj、およびj番目の噴射区間における角度αaj,βaj,αbj,βbjである。角度αaj,βajは、スラスタajを構体5に取り付けるジンバル機構31,32,33,34のj番目の噴射区間における角度である。角度αbj,βbjは、スラスタbjを構体5に取り付けるジンバル機構31,32,33,34のj番目の噴射区間における角度である。The parameters of the first function are the total injection amount F j in the j-th injection section, the distribution coefficient ξ j in the j-th injection section, the average longitude λ avgj in the j-th injection section, and the j-th injection section. The angles are α aj , β aj , α bj , β bj . The angles α aj and β aj are angles in the j-th injection section of the
第1の関数の出力である軌道要素の変化量は、線形化されたガウスの惑星方程式に基づいて、噴射量の合計Fj、配分係数ξj、平均経度λavgj、および角度αaj,βaj,αbj,βbjで表される。軌道要素の変化量は、平均離心率ベクトル、平均傾斜角ベクトル、および平均直下点経度のそれぞれの変化量を含む。さらに第1の関数の出力である角運動量の変化量は、線形化されたオイラーの方程式に基づいて、噴射量の合計Fj、配分係数ξj、平均経度λavgj、および角度αaj,βaj,αbj,βbjで表される。The change amount of the orbital element, which is the output of the first function, is based on the linearized Gaussian planet equation, the total injection amount F j , the distribution coefficient ξ j , the average longitude λ avgj , and the angles α aj and β. It is represented by aj , α bj , and β bj . The amount of change in the orbital element includes the amount of change in each of the average eccentricity vector, the average inclination angle vector, and the average longitude of the point directly below. Further, the amount of change in the angular momentum, which is the output of the first function, is based on the linearized Euler's equation, the total injection amount F j , the distribution coefficient ξ j , the average longitude λ avgj , and the angles α aj , β. It is represented by aj , α bj , and β bj .
N個の噴射区間におけるスラスタ21,22,23,24の噴射によって生じる軌道要素の変化量の合計および角運動量の変化量の合計は、下記(13)−(16)式で表される。下記(13)式において、Ge(Fj,ξj,λavgj,αaj,βaj,αbj,βbj)は、離心率ベクトルについてのガウスの惑星方程式である。下記(14)式において、Gi(Fj,ξj,λavgj,αaj,βaj,αbj,βbj)は、傾斜角ベクトルについてのガウスの惑星方程式である。下記(15)式において、Gλ(Fj,ξj,λavgj,αaj,βaj,αbj,βbj)は、平均直下点経度についてのガウスの惑星方程式である。下記(16)式において、Eh(Fj,ξj,λavgj,αaj,βaj,αbj,βbj)は、静止衛星10が有する角運動量に関するオイラーの方程式である。第1関数算出部131は、上記パラメータを確定して、下記(13)−(16)式を含む第1の関数を求め、第1制約条件設定部133に送る。The total change amount of the orbital elements and the total change amount of the angular momentum caused by the injection of the
図6のステップS11の処理の説明は以上であるから、図6のステップS11と並行して行われるステップS12,S13の処理について以下に説明する。ステップS12において、第2関数算出部132は、軌道決定部11から平均軌道要素および平均軌道要素の時間変化率を取得し、角運動量算出部12から角運動量を取得する。そして、ステップS13において、第2関数算出部132は、平均軌道要素、平均軌道要素の時間変化率、および静止衛星10が有する角運動量を引数として、パラメータを確定し、静止衛星10の平均軌道要素の制御量および静止衛星10が有する角運動量の制御量を出力する第2の関数を求める。平均軌道要素の制御量とは、スラスタ21,22,23,24を噴射することで達成すべき平均軌道要素の制御量である。制御対象となる平均軌道要素は、平均離心率ベクトル、平均傾斜角ベクトル、および平均直下点経度を含む。
Since the processing of step S11 of FIG. 6 has been described above, the processing of steps S12 and S13 performed in parallel with step S11 of FIG. 6 will be described below. In step S<b>12, the second
第2関数算出部132が第2の関数を算出するステップS13の処理の概要について図7を用いて説明した後に、各ステップの詳細について説明する。第2関数算出部132は、平均離心率ベクトルの目標値etargetを定める軌道座標系の原点を中心とする円の半径eRを決定する(ステップS21)。第2関数算出部132は、軌道座標系の原点を中心とする半径eRの円と、地球4と太陽とを結ぶ線分の交点に設定される平均離心率ベクトルの目標値etargetに平均離心率ベクトルを近づけるための制御量Δecを算出する(ステップS22)。第2関数算出部132は、緯度の保持精度Δφmaxの大きさに応じて、年平均傾斜角ベクトル、月平均傾斜角ベクトル、および日平均傾斜角ベクトルのいずれかを、制御対象である平均傾斜角ベクトルとして決定する(ステップS23)。第2関数算出部132は、ステップS23で決定した平均傾斜角ベクトルに対する制御量Δicを算出する(ステップS24)。第2関数算出部132は、平均直下点経度の制御量Δλcを算出する(ステップS25)。第2関数算出部132は、角運動量の制御量Δhcを算出する(ステップS26)。図7に示すように、第2関数算出部132は、ステップS21,S23,S25,S26の処理を並行に行うことができる。The outline of the process of step S13 in which the second
上記ステップS21,S22の処理について説明する。第2関数算出部132は、軌道座標系の原点を中心とする半径eRの円と、地球4と太陽とを結ぶ線分の交点に平均離心率ベクトルの目標値etargetを設定し、下記(17)式で表される平均離心率ベクトルの制御量Δecを算出する。下記(17)式において、eODは、軌道決定部11が算出した平均離心率ベクトルである。Keは正の係数である。下記(17)式の第2項−Ke(eOD−etarget)は、フィードバック制御量に相当する。下記(17)式における第1項−δeFFは、フィードフォワード制御量に相当する。フィードフォワード制御量は、静止衛星10に働く摂動力、例えば、太陽輻射圧、月の潮汐力、太陽の潮汐力等による、平均離心率ベクトルの変動を補償する。下記(17)式におえるδeFFは、下記(18)式で表される。下記(18)式におけるe’ODは、eODの時間変化率であり、Tcは、静止衛星10が軌道を周回する周期である。
Δec=−δeFF−Ke(eOD−etarget) (17)
δeFF=e’ODTc (18)The processing of steps S21 and S22 will be described. The second
Δe c = -δe FF -K e ( e OD -e target) (17)
δe FF =e' OD T c (18)
上記(17)式における平均離心率ベクトルの目標値etargetは、軌道座標系の原点を中心とする半径eRの円と、地球4と太陽とを結ぶ線分の交点に設定される。eRは、下記(19)式で表される。ΔλMは、軌道決定部11が算出する平均軌道要素の誤差、スラスタ21,22,23,24の噴射誤差等によって生じる経度の誤差である。ΔλMは、0<ΔλM<Δλmaxを満たす値であり、例えば、0.02°である。The target value e target of the average eccentricity vector in the above equation (17) is set at the intersection of the line segment connecting the earth 4 and the sun with the circle of radius e R centered on the origin of the orbit coordinate system. e R is represented by the following formula (19). Δλ M is a longitude error generated by an error of the average trajectory element calculated by the
図7のステップS21,S22の処理については以上であるから、図7においてステップS21,S22と並行して行われるステップS23,S24の処理について説明する。第2関数算出部132は、平均傾斜角ベクトル、例えば、年平均傾斜角ベクトル、月平均傾斜角ベクトル、および日平均傾斜角ベクトル等を制御する。第2関数算出部132は、緯度の保持精度Δφmaxの大きさに適した平均傾斜角ベクトルを制御する。例えば、0.040°×(1+κφ)≦Δφmaxの場合、第2関数算出部132は、年平均傾斜角ベクトルを制御対象として決定する。0.0040°×(1+κφ)<Δφmax<0.040°×(1+κφ)の場合、第2関数算出部132は、月平均傾斜角ベクトルを制御対象として決定する。Δφmax<0.004°×(1+κφ)の場合、第2関数算出部132は、日平均傾斜角ベクトルを制御対象として決定する。κφは、正の係数であり、例えば、1.1に設定される。Since the processing in steps S21 and S22 in FIG. 7 has been described above, the processing in steps S23 and S24 performed in parallel with steps S21 and S22 in FIG. 7 will be described. The
平均傾斜角ベクトルの制御量Δicは、下記(20)式で表される。下記(20)式において、iODは、軌道決定部11が算出した平均傾斜角ベクトルである。itargetは、定められた平均傾斜角ベクトルの目標値である。Kiは、正の定数である。下記(20)式における第2項−Ki(iOD−itarget)は、フィードバック制御量に相当する。下記(20)式における第1項−δiFFは、フィードフォワード制御量に相当する。フィードフォワード制御量は、静止衛星10に働く摂動力による、平均傾斜角ベクトルの変動を補償する。δiFFは、下記(21)式で表される。下記(21)式において、diFF/dtは、平均傾斜角ベクトルの時間変化率である。
Δic=−δiFF−Ki(iOD−itarget) (20)The control amount Δi c of the average tilt angle vector is expressed by the following equation (20). In the following equation (20), i OD is the average tilt angle vector calculated by the
Δi c =−δi FF −K i (i OD −i target ) (20)
図7のステップS23,S24の説明は以上であるから、図7においてステップS23,S24と並行して行われるステップS25の処理について説明する。第2関数算出部132は、下記(22)式で表される平均直下点経度の制御量Δλcを算出する。下記(22)式において、λODは、軌道決定部11で算出された平均直下点経度である。下記(22)式において、λtargetは、平均直下点経度の目標値である。Kλは正の係数である。下記(22)式における第2項−Kλ(λOD−λtarget)は、フィードバック制御量に相当する。下記(22)式における第1項−δλEFは、フィードフォワード制御量に相当する。フィードフォワード制御量は、静止衛星10に働く摂動力による、平均直下点経度の変動を補償する。δλEFは、下記(23)式で表される。下記(23)式において、λ’ODは、平均直下点経度の角速度である。下記(23)式においてλ”ODは、平均直下点経度の角加速度である。
Δλc=−δλFF−Kλ(λOD−λtarget) (22)Since the description of steps S23 and S24 in FIG. 7 is as above, the processing of step S25 performed in parallel with steps S23 and S24 in FIG. 7 will be described. The
Δλ c =−δλ FF −K λ (λ OD −λ target ) (22)
図7のステップS25の説明は以上であるから、図7においてステップS25と並行して行われるステップS26の処理について説明する。第2関数算出部132は、下記(24)式で表される角運動量の制御量Δhcを算出する。下記(24)式において、hADは、角運動量算出部12で算出された慣性系における静止衛星10の角運動量である。下記(24)式の第2項−Kh(hAD−href)は、フィードバック制御量に相当する。Khは、正の係数である。下記(24)式の第1項−δhFFは、フィードフォワード制御量に相当する。フィードフォワード制御量は、摂動トルクによって生じる慣性系での角運動量の変動量を補償する。摂動トルクの内、最も支配的なトルクは、太陽輻射圧によるトルクである。静止衛星10に働く太陽輻射圧トルクをτSRPとし、δhFFを下記(25)式で近似する。hrefは、慣性系における角運動量の目標値であり、下記(26)式で表される。角運動量の目標値hrefの各成分は、予め指令値算出部13が保持している。
Δhc=−δhFF−Kh(hAD−href) (24)
δhFF=TcτSRP (25)
href=[hxref,hyref,hzref]T (26)Since the description of step S25 in FIG. 7 has been given above, the processing of step S26 performed in parallel with step S25 in FIG. 7 will be described. The
Δh c =−δh FF −K h (h AD −h ref ) (24)
δh FF =T c τ SRP (25)
h ref =[h xref , h yref , h zref ] T (26)
第2関数算出部132は、上記(17),(20),(22),(24)式を含む第2の関数を第1制約条件設定部133に送る。
The second
図6のステップS12,13の処理の説明は以上であるから、後続のステップS14の処理について説明する。第1制約条件設定部133は、軌道要素の変化量と平均軌道要素の制御量とが一致し、かつ、角運動量の変化量と角運動量の制御量とが一致することを示す条件式である第1の制約条件を求める。第1制約条件設定部133は、下記(27)−(30)式を含む第1の制約条件を求解部135に送る。
Δec=δe (27)
Δic=δi (28)
Δλc=δλ (29)
Δhc=δh (30)Since the processing of steps S12 and S13 in FIG. 6 has been described above, the processing of the subsequent step S14 will be described. The first constraint
Δe c =δ e (27)
Δi c =δ i (28)
Δλ c =δ λ (29)
Δh c =δ h (30)
図6のステップS14の処理の説明は以上であるから、後続のステップS15の処理について説明する。第2制約条件設定部134は、ジンバル機構31,32,33,34の角度が定められた範囲内にあることを示す条件式である第2の制約条件を求める。第2制約条件設定部134は、下記(31)−(34)式を含む第2の制約条件を求解部135に送る。
−αmax≦αaj≦αmax (31)
−βmax≦βaj≦βmax (32)
−αmax≦αbj≦αmax (33)
−βmax≦βbj≦βmax (34)Since the processing of step S14 of FIG. 6 has been described above, the processing of subsequent step S15 will be described. The second constraint
-Α max ≤α aj ≤α max (31)
-Β max ≤ β aj ≤ β max (32)
-Α max ≤α bj ≤α max (33)
−β max ≦β bj ≦β max (34)
スラスタ21,22,23,24の噴射量は0より大きいことは明らかであるから、下記(35)式が成り立つ。また上述のように、噴射区間jにおける配分係数については、下記(36)式が成り立つ。
0≦Fj (35)
−1≦ξj≦1 (36)Since it is clear that the injection amount of the
0≦F j (35)
-1 ≤ ξ j ≤ 1 (36)
図6のステップS15の説明は以上であるから、後続のステップS16,S17の処理について説明する。求解部135は、第1の制約条件、第2の制約条件、および複数の噴射区間におけるスラスタ21,22,23,24の噴射量の合計である目的関数に基づく非線形計画問題について、目的関数を最小化する解を求めることで、複数の噴射区間のそれぞれのスラスタ指令値および角指令値を算出する。目的関数は、下記(37)式で表される。
Since the description of step S15 in FIG. 6 has been given above, the processing of subsequent steps S16 and S17 will be described. The
求解部135は、噴射区間のそれぞれにおける、噴射量の合計Fj、配分係数ξj、平均経度λavgj、および角度αaj,βaj,αbj,βbjの解を求める。非線形計画問題を解くにあたっては、逐次二次計画法、内点法等の手法が用いられる。求解部135は、非線形計画問題を解くことで得られるλavgjの解から、スラスタ21,22,23,24の噴射区間の開始位置および終了位置を含む噴射タイミングを得る。また求解部135は、非線形計画問題を解くことで得られるFj,ξjの解から、噴射区間におけるスラスタ21,22,23,24の噴射量を得る。さらに求解部135は、非線形計画問題を解くことで得られるαaj,βaj,αbj,βbjの解から、スラスタ21,22,23,24を噴射する際のジンバル角を得る。The
図6のステップS16,S17の説明は以上であるから、後続のステップS18の処理について説明する。求解部135は、スラスタ21,22,23,24の噴射タイミングおよび噴射量を示すスラスタ指令値を、スラスタ制御部14に送り、ジンバル角を示す角指令値を、ジンバル制御部15に送る。
Since the description of steps S16 and S17 in FIG. 6 has been given above, the processing of the subsequent step S18 will be described. The
スラスタ制御部14は、スラスタ指令値に基づいてスラスタ21,22,23,24を制御して噴射させる。ジンバル制御部15は、角指令値に基づいてジンバル機構31,32,33,34のジンバル角を制御する。上述のように非線形計画問題を解いて、スラスタ指令値および角指令値を算出することで、推薬の使用量を少なくしながら、軌道保持制御および角運動量のアンローディングを行うための処理を簡易化することが可能である。
The
以上説明したとおり、本実施の形態1に係る宇宙機制御装置1によれば、非線形計画問題について、スラスタの噴射量の合計である目的関数を最小化する解を求め、スラスタ指令値および角指令値を算出することで、推薬の使用量を抑制しながら、軌道保持制御および角運動量のアンローディングを行うための処理を簡易化することが可能である。 As described above, according to the spacecraft control device 1 according to the first embodiment, the solution that minimizes the objective function, which is the total thruster injection amount, is obtained for the nonlinear programming problem, and the thruster command value and the angle command are calculated. By calculating the value, it is possible to simplify the processing for performing the trajectory maintenance control and the angular momentum unloading while suppressing the amount of propellant used.
実施の形態1に係る宇宙機制御装置1によれば、昇交点および降交点から離隔した位置でスラスタ21,22,23,24を噴射する必要がある場合、また軌道を一周する間にスラスタ21,22,23,24を複数回噴射する必要がある場合でも、推薬の使用量を抑制しながら、軌道保持制御および角運動量のアンローディングを行うための処理を行うことができる。
According to the spacecraft control device 1 according to the first embodiment, when it is necessary to inject the
(実施の形態2)
実施の形態1における非線形計画問題の制約条件は、第1の制約条件と第2の制約条件であったが、非線形計画問題は、さらに他の制約条件を含んでもよい。実施の形態2に係る宇宙機制御装置1の構成は、図4に示す実施の形態1に係る宇宙機制御装置1の構成と同様である。図8は、本発明の実施の形態2に係る指令値算出部の構成例を示す図である。実施の形態2に係る指令値算出部16は、図5に示す実施の形態1に係る指令値算出部13の構成に加えて、第3制約条件設定部136をさらに備える。第3制約条件設定部136は、複数の噴射区間のそれぞれの噴射直前および噴射直後の少なくともいずれかにおいて、角運動量が定められた範囲内にあることを示す条件式である第3の制約条件を求め、求解部135に送る。(Embodiment 2)
Although the constraint conditions of the nonlinear programming problem in the first embodiment are the first constraint condition and the second constraint condition, the nonlinear programming problem may further include other constraint conditions. The configuration of the spacecraft control device 1 according to the second embodiment is the same as the configuration of the spacecraft control device 1 according to the first embodiment shown in FIG. FIG. 8 is a diagram showing a configuration example of a command value calculation unit according to the second embodiment of the present invention. The command
指令値算出部16がスラスタ指令値および角指令値を算出する処理の概略について図9を用いて説明する。ステップS11−S16,S18の処理は、図6に示す処理と同様である。実施の形態2に係る指令値算出部16においては、第3制約条件設定部136が、複数の噴射区間のそれぞれの噴射直前および噴射直後の少なくともいずれかにおいて、角運動量が定められた範囲内にあることを示す条件式である第3の制約条件を求める(ステップS19)。求解部135は、目的関数を求める(ステップS16)。求解部135は、第1の制約条件、第2の制約条件、第3の制約条件、および複数の噴射区間におけるスラスタ21,22,23,24の噴射量の合計である目的関数に基づく非線形計画問題について、目的関数を最小化する解を求めることで、スラスタ指令値および角指令値を算出する(ステップS20)。後続の処理は、図6に示す処理と同様である。
The outline of the process in which the command
上記(31)−(34)式における、αmax,βmaxを小さくすると、スラスタ21,22,23,24の噴射中に静止衛星10に作用するトルクは小さくなる。すなわち、スラスタ21,22,23,24の噴射によって生じる角運動量の変動が抑制される。αmax,βmaxを小さくすることで、角運動量の変動が抑制されても、噴射区間の噴射直前または噴射直後において、角運動量が、上記(3)−(5)式で規定される範囲内にないことがある。そこで、第3制約条件設定部136は、複数の噴射区間のそれぞれの噴射直前および噴射直後の少なくともいずれかにおいて、角運動量が定められた範囲内にあることを示す条件式である第3の制約条件を求める。すなわち、第3制約条件設定部136は、下記(38),(39)式の少なくともいずれかが成立することを示す条件式である第3の制約条件を求める。下記(38)式におけるhj (−)は、j番目の噴射区間の噴射直前における角運動量である。j番目の噴射区間の噴射直前における角運動量とは、j番目の噴射区間におけるスラスタ21,22,23,24の噴射開始直前の静止衛星10の角運動量である。下記(39)式におけるhj (+)は、j番目の噴射区間の噴射直後における角運動量である。j番目の噴射区間の噴射直後における角運動量とは、j番目の噴射区間におけるスラスタ21,22,23,24の噴射終了直後の静止衛星10の角運動量である。hj (−)およびhj (+)は、変数Fj,ξj,λavgj,αaj,βaj,αbj,βbjの関数である。
href−Δhmax≦hj (−)≦href+hmax (38)
href−Δhmax≦hj (+)≦href+hmax (39)When α max and β max in the equations (31) to (34) are reduced, the torque acting on the
h ref −Δh max ≦h j (−) ≦h ref +h max (38)
h ref −Δh max ≦h j (+) ≦h ref +h max (39)
hj (−)の各成分について、上記(3)−(5)式と同様に、下記(40)−(42)が成り立つ。またhj (+)の各成分について、上記(3)−(5)式と同様に、下記(43)−(45)が成り立つ。
hxref−Δhxmax≦hxj (−)≦hxref+Δhxmax (40)
hyref−Δhymax≦hyj (−)≦hyref+Δhymax (41)
hzref−Δhzmax≦hzj (−)≦hzref+Δhzmax (42)
hxref−Δhxmax≦hxj (+)≦hxref+Δhxmax (43)
hyref−Δhymax≦hyj (+)≦hyref+Δhymax (44)
hzref−Δhzmax≦hzj (+)≦hzref+Δhzmax (45)For each component of h j (−), the following (40)-(42) is established, as in the above expressions (3)-(5). Further, with respect to each component of h j (+), the following (43)-(45) is established as in the above expressions (3)-(5).
h xref −Δh xmax ≦h xj (−) ≦h xref +Δh xmax (40)
h yref -Δh ymax ≦ h yj ( -) ≦ h yref + Δh ymax (41)
h zref −Δh zmax ≦h zj (−) ≦h zref +Δh zmax (42)
h xref −Δh xmax ≦h xj (+) ≦h xref +Δh xmax (43)
h yref -Δh ymax ≦ h yj ( +) ≦ h yref + Δh ymax (44)
h zref −Δh zmax ≦h zj (+) ≦h zref +Δh zmax (45)
以上説明したとおり、本実施の形態2に係る宇宙機制御装置1によれば、複数の噴射区間のそれぞれの噴射直前および噴射直後の少なくともいずれかにおいて、角運動量が定められた範囲内にあることを、非線形計画問題の第3の制約条件とすることで、静止衛星10の角運動量を保持範囲内に維持することができる。そのため、姿勢制御アクチュエータの角運動量を飽和させることなく、軌道保持制御および角運動量のアンローディングを行うことが可能である。
As described above, according to the spacecraft control device 1 according to the second embodiment, the angular momentum is within the defined range at least immediately before or immediately after the injection in each of the plurality of injection sections. Is set as the third constraint condition of the nonlinear programming problem, the angular momentum of the
次に、本実施の形態のハードウェア構成について説明する。図10は、ハードウェア構成の例を示す図である。図10は、宇宙機制御装置1が処理回路101によって実現される例を示している。図10のように、静止衛星10は、衛星の位置、速度、姿勢角、角速度を観測するセンサ110、宇宙機制御装置1、スラスタ21,22,23,24、およびジンバル機構31,32,33,34を有する。
Next, the hardware configuration of this embodiment will be described. FIG. 10 is a diagram illustrating an example of the hardware configuration. FIG. 10 shows an example in which the spacecraft control device 1 is realized by the
処理回路101が、専用のハードウェアである場合、処理回路101は、例えば、単一回路、複合回路、プログラム化したプロセッサ、並列プログラム化したプロセッサ、ASIC(Application Specific Integrated Circuit)、FPGA(Field Programmable Gate Array)、またはこれらを組み合わせたものが該当する。軌道決定部11、角運動量算出部12、指令値算出部13、スラスタ制御部14、およびジンバル制御部15の各部の機能それぞれを処理回路101で実現してもよいし、各部の機能をまとめて処理回路101で実現してもよい。
When the
図11は、本実施の形態のハードウェア構成の別の例を示す図である。図11は、宇宙機制御装置1がプロセッサ(CPU:Central Processing Unit)102とメモリ103によって実現される例を示している。図11のプロセッサ102とメモリ103は、図10の処理回路101に相当する。
FIG. 11 is a diagram showing another example of the hardware configuration of the present embodiment. FIG. 11 shows an example in which the spacecraft control device 1 is realized by a processor (CPU: Central Processing Unit) 102 and a
宇宙機制御装置1がプロセッサ102とメモリ103によって実現される場合、軌道決定部11、角運動量算出部12、指令値算出部13、スラスタ制御部14、およびジンバル制御部15の機能は、ソフトウェア、ファームウェア、またはソフトウェアとファームウェアとの組み合わせにより実現される。ソフトウェアやファームウェアはプログラムとして記述され、メモリ103に格納される。プロセッサ102は、メモリ103に記憶されたプログラムを読み出して実行することにより、各部の機能を実現する。すなわち、メモリ103には、軌道決定部11、角運動量算出部12、指令値算出部13、スラスタ制御部14、およびジンバル制御部15の処理を実行するためのプログラムが格納される。メモリ103は、例えば、RAM(Random Access Memory)、ROM(Read-Only Memory)、フラッシュメモリー、EPROM(Erasable Programmable Read Only Memory)、EEPROM(Electrically Erasable and Programmable Read-Only Memory)等の、不揮発性または揮発性の半導体メモリ、磁気ディスク、フレキシブルディスク、光ディスク、コンパクトディスク、ミニディスク、DVD(Digital Versatile Disc)等を含む。
When the spacecraft control device 1 is realized by the
メモリ103は、上述のプログラムの他、軌道決定部11で決定される軌道決定値、角運動量算出部12で設定される衛星角運動量値、指令値算出部13で算出されるスラスタ指令値およびジンバル角指令値を記憶する。上述のメモリ103に記憶された情報は適宜読みだされて、軌道決定部11、角運動量算出部12、指令値算出部13、スラスタ制御部14、およびジンバル制御部15の処理に用いられ、修正される。
In addition to the above program, the
なお、軌道決定部11、角運動量算出部12、指令値算出部13、スラスタ制御部14、およびジンバル制御部15の各機能について、一部を専用のハードウェアで実現し、一部をソフトウェアまたはファームウェアで実現するようにしてもよい。例えば、軌道決定部11については専用のハードウェアとしての処理回路101でその機能を実現し、指令値算出部13については、プロセッサ102がメモリ103に格納されたプログラムを読み出して実行することによってその機能を実現することが可能である。
It should be noted that some of the functions of the
本発明の実施の形態は上述の実施の形態に限られない。宇宙機は、静止衛星10に限られず、天体の周りの軌道を周回する任意の飛行体である。飛行体の一例は、地球観測衛星、宇宙船等である。スラスタ21,22,23,24の本数は任意であり、それぞれの噴射区間において噴射するスラスタ21,22,23,24の本数および組み合わせも任意である。またジンバル機構31,32,33,34の自由度は1でもよい。ジンバル機構31,32,33,34の自由度が1である場合、上記数式のβ=0となるため、第1の関数は、変数Fj,ξj,λavgj,αaj,αbjの関数である。β=0の場合、第1の関数と同様に、hj (−)およびhj (+)は、変数Fj,ξj,λavgj,αaj,αbjの関数である。図1の例では、宇宙機の構体5に、スラスタ21,22,23,24が取り付けられているが、宇宙機の構体5に取り付けられるスラスタ21,22,23,24の数は任意である。スラスタ21,22,23,24のそれぞれの角度ψおよび角度γは互いに同じでもよいし、異なってもよい。The embodiment of the present invention is not limited to the above embodiment. The spacecraft is not limited to the
緯度および経度の範囲、ならびに、緯度および経度の保持精度は、上述の例に限られず、任意に定めることができる。上述のように、軌道決定部11が平均軌道要素の時間変化率を算出する代わりに、第2関数算出部132が平均軌道要素の時間変化率を算出してもよい。軌道決定部11は、軌道要素を算出する代わりに、外部装置から起動要素を取得してもよい。軌道決定部11は、軌道要素の瞬時値を指令値算出部13に送ってもよい。第2関数算出部132は、図7に示す、平均離心率ベクトルの制御量Δecの算出、平均傾斜角ベクトルΔicの算出、平均直下点経度の制御量Δλcの算出、および、角運動量の制御量Δhcの算出を順次行ってもよい。The latitude and longitude ranges and the latitude and longitude holding accuracy are not limited to the above examples, and can be arbitrarily determined. As described above, the second
求解部135は、第1の制約条件の下で、非線形計画問題の解を求めることで、スラスタ指令値およびジンバル指令値を算出してもよい。あるいは、求解部135は、第1の制約条件と第3の制約条件の下で、非線形計画問題の解を求めてもよい。また、求解部135は、第1の制約条件の下で、目的関数を小さくする準最適解を求めることで、スラスト指令値およびジンバル指令値を算出してもよい。
The
本発明は、本発明の広義の精神と範囲を逸脱することなく、様々な実施の形態及び変形が可能とされるものである。また、上述した実施の形態は、この発明を説明するためのものであり、本発明の範囲を限定するものではない。すなわち、本発明の範囲は、実施の形態ではなく、特許請求の範囲によって示される。そして、特許請求の範囲内及びそれと同等の発明の意義の範囲内で施される様々な変形が、この発明の範囲内とみなされる。 The present invention allows various embodiments and modifications without departing from the broad spirit and scope of the present invention. Further, the above-described embodiments are for explaining the present invention and do not limit the scope of the present invention. That is, the scope of the present invention is shown not by the embodiments but by the scope of the claims. Various modifications made within the scope of the claims and within the scope of the meaning of the invention equivalent thereto are regarded as within the scope of the present invention.
本出願は、2017年9月1日に出願された、日本国特許出願特願2017−168649号に基づく。本明細書中に日本国特許出願特願2017−168649号の明細書、特許請求の範囲、図面全体を参照として取り込むものとする。 This application is based on Japanese Patent Application No. 2017-168649 filed on Sep. 1, 2017. The specification, claims, and the entire drawing of Japanese Patent Application No. 2017-168649 are incorporated herein by reference.
1 宇宙機制御装置、4 地球、5 構体、10 静止衛星、11 軌道決定部、12 角運動量算出部、13,16 指令値算出部、14 スラスタ制御部、15 ジンバル制御部、21,22,23,24 スラスタ、31,32,33,34 ジンバル機構、50,51 面、101 処理回路、102 プロセッサ、103 メモリ、110 センサ、131 第1関数算出部、132 第2関数算出部、133 第1制約条件設定部、134 第2制約条件設定部、135 求解部、136 第3制約条件設定部。
1 spacecraft control device, 4 earth, 5 structure, 10 geostationary satellite, 11 orbit determination unit, 12 angular momentum calculation unit, 13, 16 command value calculation unit, 14 thruster control unit, 15
Claims (14)
それぞれが前記宇宙機の構体に、ジンバル機構を介して取り付けられた複数のスラスタの内、少なくともいずれかのスラスタの噴射を指示するスラスタ指令値、および前記スラスタの噴射時における前記ジンバル機構の角度を指示する角指令値を算出する指令値算出部と、
前記スラスタ指令値に基づき、前記スラスタを制御するスラスタ制御部と、
前記角指令値に基づき、前記ジンバル機構を制御するジンバル制御部と、
を備え、
前記指令値算出部は、前記軌道における複数の噴射区間での前記スラスタ指令値および前記角指令値を引数として、該スラスタ指令値に基づいて前記スラスタが制御され、該角指令値に基づいて前記ジンバル機構が制御された場合に、前記宇宙機が前記軌道を一周する間の、前記宇宙機の軌道を表す軌道要素の変化量と前記角運動量の変化量とを出力する第1の関数、ならびに、前記軌道要素、前記軌道要素の時間変化率、および前記角運動量を引数として、前記宇宙機が前記軌道を一周する間の、前記軌道要素の制御量および前記角運動量の制御量を出力する第2の関数に基づき、前記軌道要素の変化量と前記軌道要素の制御量とが一致し、かつ、前記角運動量の変化量と前記角運動量の制御量とが一致する第1の制約条件の下で、前記複数の噴射区間における前記スラスタの噴射量の合計が目的関数である非線形計画問題の解を求めることで、前記複数の噴射区間のそれぞれの前記スラスタ指令値および前記角指令値を算出する、
宇宙機制御装置。An angular momentum calculation unit that calculates the angular momentum of the spacecraft that orbits around the celestial body,
A thruster command value for instructing the ejection of at least one thruster among a plurality of thrusters attached to the structure of the spacecraft via a gimbal mechanism, and an angle of the gimbal mechanism at the time of ejecting the thruster. A command value calculation unit that calculates the commanded angle command value,
A thruster control unit that controls the thruster based on the thruster command value;
A gimbal control unit that controls the gimbal mechanism based on the angle command value,
Equipped with
The command value calculation unit uses the thruster command value and the angle command value in a plurality of injection sections in the trajectory as arguments, the thruster is controlled based on the thruster command value, and the thruster command value is calculated based on the angle command value. A first function that outputs a change amount of an orbital element representing the orbit of the spacecraft and a change amount of the angular momentum while the spacecraft goes around the orbit when the gimbal mechanism is controlled, and Outputting the control amount of the orbital element and the control amount of the angular momentum while the spacecraft goes around the orbit with the orbital element, the time change rate of the orbital element, and the angular momentum as arguments. Under the first constraint condition in which the change amount of the trajectory element and the control amount of the trajectory element match, and the change amount of the angular momentum and the control amount of the angular momentum match based on the function of 2. Then, the solution of the nonlinear programming problem in which the sum of the injection amounts of the thrusters in the plurality of injection sections is an objective function is calculated, and the thruster command value and the angle command value of each of the plurality of injection sections are calculated. ,
Spacecraft control device.
請求項1に記載の宇宙機制御装置。The command value calculation unit calculates the thruster command value and the angle command value of each of the plurality of injection sections by obtaining a solution of the nonlinear programming problem that minimizes the objective function.
The spacecraft control device according to claim 1.
請求項1または2に記載の宇宙機制御装置。The command value calculation unit obtains a solution of the nonlinear programming problem under a second constraint condition in which an angle of the gimbal mechanism is within a predetermined range, and thereby the thruster of each of the plurality of injection sections is obtained. Calculate a command value and the angle command value,
The spacecraft control device according to claim 1.
請求項1または2に記載の宇宙機制御装置。The command value calculation unit is configured such that the angular momentum is at least one of a second constraint condition in which an angle of the gimbal mechanism is within a predetermined range, and at least one of immediately before injection and immediately after injection of each of the plurality of injection sections. By calculating a solution of the nonlinear programming problem under a third constraint condition within a defined range, the thruster command value and the angle command value of each of the plurality of injection sections are calculated.
The spacecraft control device according to claim 1.
請求項1から4のいずれか1項に記載の宇宙機制御装置。The control amount of the orbital element calculated by the second function is a feedforward control amount that corrects the fluctuation of the orbital element caused by the perturbation acting on the spacecraft while the spacecraft makes one revolution in the orbit. And a feedback control amount based on the trajectory element and a target value of the trajectory element,
The spacecraft control device according to any one of claims 1 to 4.
請求項1から5のいずれか1項に記載の宇宙機制御装置。The control amount of the angular momentum calculated by the second function is a feedforward control amount that corrects the fluctuation of the angular momentum caused by the perturbation torque that acts on the spacecraft while the spacecraft makes a turn around the orbit. And a feedback control amount based on the angular momentum and a target value of the angular momentum,
The spacecraft control device according to any one of claims 1 to 5.
請求項1から6のいずれか1項に記載の宇宙機制御装置。The orbital element includes an eccentricity vector, a tilt angle vector, and a direct point longitude,
The spacecraft control device according to any one of claims 1 to 6.
請求項7に記載の宇宙機制御装置。The second function is a control amount for any one of the annual average tilt angle vector, the monthly average tilt angle vector, and the daily average tilt angle vector according to the latitude holding accuracy obtained in the orbit holding control of the spacecraft. Outputting the controlled variable of the orbital element including
The spacecraft control device according to claim 7.
前記複数のスラスタは、噴射方向が互いに異なる向きで、前記構体の外面の内、常に前記天体に向いている面と反対側に位置する面に取り付けられる、
請求項1から8のいずれか1項に記載の宇宙機制御装置。One of the outer surfaces of the structure is always facing the celestial body,
The plurality of thrusters are attached to a surface of the outer surface of the structure that is located on the opposite side of the surface that is always facing the celestial body, with the ejection directions different from each other.
The spacecraft control device according to any one of claims 1 to 8.
前記複数のスラスタの個数は4つであり、
前記スラスタは、前記宇宙機の質量中心から離れる方向に伸び、
前記噴射区間において4つの前記スラスタの内、2つの前記スラスタが噴射される、
請求項1から9のいずれか1項に記載の宇宙機制御装置。The gimbal mechanism has two degrees of freedom,
The number of the plurality of thrusters is four,
The thruster extends in a direction away from the center of mass of the spacecraft,
Of the four thrusters, two of the thrusters are fired in the firing section.
The spacecraft control device according to any one of claims 1 to 9.
請求項1から10のいずれか1項に記載の宇宙機制御装置。The angle of the gimbal mechanism is a value within a range in which the torque acting on the spacecraft by the thruster injection is equal to or less than the upper limit value of the disturbance torque that can be compensated by the attitude control system of the spacecraft.
The spacecraft control device according to any one of claims 1 to 10.
請求項1から11のいずれか1項に記載の宇宙機制御装置。The thruster command value is the ejection phase of the thruster, the sum of the ejection amounts of the plurality of thrusters, and the ratio of the ejection amount of the thruster instructed to be ejected by the thruster command value in the total.
The spacecraft control device according to any one of claims 1 to 11.
宇宙機制御方法。When the thruster command value and the angle command value in a plurality of injection sections in the orbit are used as arguments, the thruster is controlled based on the thruster command value, and the gimbal mechanism is controlled based on the angle command value. A first function that outputs a change amount and a change amount of the angular momentum, and a control amount of the orbital element and a control amount of the angular momentum with the orbital element, the time change rate of the orbital element, and the angular momentum as arguments. Based on a second function for outputting a solution of the objective function for a nonlinear programming problem in which the sum of the injection amounts of the thrusters in the plurality of injection sections is the objective function while satisfying a predetermined constraint condition. Then, the thruster command value and the angle command value of each of the plurality of injection sections are calculated,
Spacecraft control method.
天体の周りの軌道を周回する宇宙機が有する角運動量を算出する角運動量算出部、
それぞれが前記宇宙機の構体に、ジンバル機構を介して取り付けられた複数のスラスタの内、少なくともいずれかのスラスタの噴射を指示するスラスタ指令値、および前記スラスタの噴射時における前記ジンバル機構の角度を指示する角指令値を算出する指令値算出部、
前記スラスタ指令値に基づき、前記スラスタを制御するスラスタ制御部、および、
前記角指令値に基づき、前記ジンバル機構を制御するジンバル制御部、
として機能させるためのプログラムであって、
前記指令値算出部は、前記軌道における複数の噴射区間での前記スラスタ指令値および前記角指令値を引数として、該スラスタ指令値に基づいて前記スラスタが制御され、該角指令値に基づいて前記ジンバル機構が制御された場合に、前記宇宙機が前記軌道を一周する間の、前記宇宙機の軌道を表す軌道要素の変化量と前記角運動量の変化量とを出力する第1の関数、ならびに、前記軌道要素、前記軌道要素の時間変化率、および前記角運動量を引数として、前記宇宙機が前記軌道を一周する間の、前記軌道要素の制御量および前記角運動量の制御量を出力する第2の関数に基づき、前記軌道要素の変化量と前記軌道要素の制御量とが一致し、かつ、前記角運動量の変化量と前記角運動量の制御量とが一致する第1の制約条件の下で、前記複数の噴射区間における前記スラスタの噴射量の合計が目的関数である非線形計画問題の解を求めることで、前記複数の噴射区間のそれぞれの前記スラスタ指令値および前記角指令値を算出する、
プログラム。Computer,
An angular momentum calculator that calculates the angular momentum of a spacecraft that orbits the celestial body,
A thruster command value for instructing the ejection of at least one thruster among a plurality of thrusters attached to the structure of the spacecraft via a gimbal mechanism, and an angle of the gimbal mechanism at the time of ejecting the thruster. A command value calculation unit that calculates the commanded angle command value,
A thruster controller that controls the thruster based on the thruster command value; and
A gimbal control unit that controls the gimbal mechanism based on the angle command value,
It is a program to function as
The command value calculation unit uses the thruster command value and the angle command value in a plurality of injection sections in the trajectory as arguments, the thruster is controlled based on the thruster command value, and the thruster command value is calculated based on the angle command value. A first function that outputs a change amount of an orbital element representing the orbit of the spacecraft and a change amount of the angular momentum while the spacecraft goes around the orbit when the gimbal mechanism is controlled, and Outputting the control amount of the orbital element and the control amount of the angular momentum while the spacecraft goes around the orbit with the orbital element, the time change rate of the orbital element, and the angular momentum as arguments. Under the first constraint condition in which the change amount of the trajectory element and the control amount of the trajectory element match, and the change amount of the angular momentum and the control amount of the angular momentum match based on the function of 2. Then, the solution of the nonlinear programming problem in which the sum of the injection amounts of the thrusters in the plurality of injection sections is an objective function is calculated, and the thruster command value and the angle command value of each of the plurality of injection sections are calculated. ,
program.
Applications Claiming Priority (3)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2017168649 | 2017-09-01 | ||
JP2017168649 | 2017-09-01 | ||
PCT/JP2018/031486 WO2019044735A1 (en) | 2017-09-01 | 2018-08-27 | Spacecraft control device, spacecraft control method, and program |
Publications (2)
Publication Number | Publication Date |
---|---|
JPWO2019044735A1 JPWO2019044735A1 (en) | 2020-04-23 |
JP6707206B2 true JP6707206B2 (en) | 2020-06-10 |
Family
ID=65527282
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2019539474A Active JP6707206B2 (en) | 2017-09-01 | 2018-08-27 | Spacecraft control device, spacecraft control method, and program |
Country Status (2)
Country | Link |
---|---|
JP (1) | JP6707206B2 (en) |
WO (1) | WO2019044735A1 (en) |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US11292618B2 (en) * | 2019-07-03 | 2022-04-05 | Mitsubishi Electric Research Laboratories, Inc. | Nonlinear model predictive control of coupled celestial system |
Family Cites Families (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP3174174B2 (en) * | 1992-11-04 | 2001-06-11 | 三菱電機株式会社 | Satellite attitude control system |
US5984236A (en) * | 1995-12-22 | 1999-11-16 | Keitel; Keith F. | Momentum unloading using gimbaled thrusters |
JP4511390B2 (en) * | 2005-03-01 | 2010-07-28 | 三菱電機株式会社 | Satellite attitude control device |
JP5484262B2 (en) * | 2010-08-31 | 2014-05-07 | 三菱電機株式会社 | Spacecraft attitude control device |
US9764858B2 (en) * | 2015-01-07 | 2017-09-19 | Mitsubishi Electric Research Laboratories, Inc. | Model predictive control of spacecraft |
JP6271043B2 (en) * | 2015-01-09 | 2018-01-31 | 三菱電機株式会社 | Orbit control device and satellite |
US9522746B1 (en) * | 2015-08-27 | 2016-12-20 | The Boeing Company | Attitude slew methodology for space vehicles using gimbaled low-thrust propulsion subsystem |
-
2018
- 2018-08-27 JP JP2019539474A patent/JP6707206B2/en active Active
- 2018-08-27 WO PCT/JP2018/031486 patent/WO2019044735A1/en active Application Filing
Also Published As
Publication number | Publication date |
---|---|
JPWO2019044735A1 (en) | 2020-04-23 |
WO2019044735A1 (en) | 2019-03-07 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP6656380B2 (en) | Method and system for controlling operation of spacecraft, spacecraft | |
US9874879B2 (en) | Model Predictive control of spacecraft | |
US5098041A (en) | Attitude control system for momentum-biased spacecraft | |
US8113468B2 (en) | Precision attitude control system for gimbaled thruster | |
Bedrossian et al. | Zero-propellant maneuver guidance | |
JP2020515455A (en) | Spacecraft and control system and method for controlling operation of spacecraft | |
US20220097872A1 (en) | Attitude control system and method | |
JP2020515459A (en) | Spacecraft and control system for controlling operation of spacecraft | |
CN107850900A (en) | Quick rotation and installing system for grapefruit satellite | |
EP3765369B1 (en) | Spacecraft and vehicle | |
US20200055617A1 (en) | System and Method of Tracking a Spacecraft Trajectory for Orbital Transfer | |
CN111638643B (en) | Displacement mode drag-free control dynamics coordination condition determination method | |
JP2021011257A (en) | Nonlinear model predictive control of coupled celestial system | |
CN105043417A (en) | Multi-target continuous imaging drift angle compensation method | |
Sah et al. | Design development of debris chaser small satellite with robotic manipulators for debris removal | |
JP6707206B2 (en) | Spacecraft control device, spacecraft control method, and program | |
US7464898B1 (en) | Precision thrust/sun tracking attitude control system for gimbaled thruster | |
JP7204987B2 (en) | Orbital attitude control device, artificial satellite, orbital attitude control method and program | |
Wong et al. | An attitude control design for the Cassini spacecraft | |
US20240182185A1 (en) | Phased control of multiple spacecraft during a low-thrust orbit transfer maneuver | |
Koh et al. | In-orbit performance of attitude control system in DubaiSat-2 | |
Kitamura et al. | Minimum Time Orbit Raising of Geostationary Spacecraft by Optimizing Feedback Gain of Steering Law | |
Moorthy et al. | Extended Orbital Flight of a CubeSat in the Lower Thermosphere with Active Attitude Control | |
Mengali et al. | Optimal solar sail interplanetary trajectories with constant cone angle | |
CN116080932A (en) | Method and system for planning and controlling pose of daily observation swing-scanning maneuver imaging |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20191011 |
|
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: 20200421 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20200519 |
|
R150 | Certificate of patent or registration of utility model |
Ref document number: 6707206 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R150 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |