JPS5867600A - 人工衛星の制御装置 - Google Patents

人工衛星の制御装置

Info

Publication number
JPS5867600A
JPS5867600A JP56167500A JP16750081A JPS5867600A JP S5867600 A JPS5867600 A JP S5867600A JP 56167500 A JP56167500 A JP 56167500A JP 16750081 A JP16750081 A JP 16750081A JP S5867600 A JPS5867600 A JP S5867600A
Authority
JP
Japan
Prior art keywords
manipulator
satellite
acceleration
artificial satellite
control
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.)
Granted
Application number
JP56167500A
Other languages
English (en)
Other versions
JPS6138076B2 (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
Priority to JP56167500A priority Critical patent/JPS5867600A/ja
Publication of JPS5867600A publication Critical patent/JPS5867600A/ja
Publication of JPS6138076B2 publication Critical patent/JPS6138076B2/ja
Granted legal-status Critical Current

Links

Landscapes

  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
  • Manipulator (AREA)
  • Variable-Direction Aerials And Aerial Arrays (AREA)

Abstract

(57)【要約】本公報は電子出願前の出願データであるた
め要約のデータは記録されません。

Description

【発明の詳細な説明】 この発明は、宇宙空間での組立作業や保守作業などに使
用されるマニプレータを有する人工衛星のマニプレータ
制御と三軸姿勢制御を行なう制御装置に関するものであ
る。
マニプレータを有する人工衛星は、現在実用化の段階に
いたっていない。第1図はマニプレータを有する人工衛
星の概要を示す説明図であり、図において(1)は人工
衛星本体、(2)は人工衛星の姿勢を検出するセンサ、
(3m)、 (3b)、 (3e)  は人工衛星の三
軸姿勢制御を行なうホイール、(4)は組立作業や保守
作業などを行うマニプレータである、座標軸X II 
y @zはそれぞれロール軸・ピッチ軸・ヨー軸と呼ば
れ、人工衛星本体(1)に固定された座標軸である。
第2図は従来の人工衛星の三軸姿勢制御手段の一例を示
すブロック図であり、図において(3)は三) 軸姿勢制御を行なうホイール、(5)は人工衛星の姿勢
目標、(6)はホイール用コントローラ、(7)t;を
人工衛星のグイナミクスを示す。
填3図は従来のマニプレータ制御手段の一例を示すブロ
ック図であり、図において(8)はマニプレータの運動
軌道、(9)Fiこの運動軌道(8)から補償トルクを
推定する補償トルク推定器、α4はマニプレータ用コン
トローラ、Qηはマニプレータのダイナきクスを示す。
次に動作について説明する。ここでは、人工衛星の三軸
姿勢制御は、ピッチ軸方向のホイールに大きな角運動量
をもたせるバイアスモーメンタム方式によるものとする
。通常、センサ(2)によって人工衛星のロール角及び
ピッチ角が検出される。
ロール方向とヨ一方向の運動が強く達成しているので、
ロール角信号だけでホイール用コントローラ(6)によ
りホイール(3b) = (3e)の駆動トルクを定め
、これらの方向の姿勢制御をすることかで負る。また、
ピッチ方向の姿勢は、ピッチ角信号を用いて、ホイール
(3a)により制御することができる。
マニプレータ制御にはいくつかの方式があるが、人工衛
星のマニプレータのようにマニプレータの動きによる外
乱トルクの影響を抑える必要がある場合には、精度よく
制御するため、補償トルクを推定して、この補償トルク
を与える第3図に示す運動軌道(8)より得られた各関
節角の目標値とマニプレータより得られた関節角の偏差
をマニプレータ用コントローラ叫に久方し、各関節に加
える制御トルクを得る、マニプレータ用コントローラ(
lには通常PIDコントローラが使用される。
さらに、速度や加速度を含めてきめこまかに制御するに
は上記の制御ループだけでは不十分で、運動軌道(8)
の実行にともなう重力や慣性方をマニプレータ用補償ト
ルク推定器(9)によって推定し、各関節に対する補償
トルクを求める必要がある。
この場合、慣性方には直進力だけでなく、遠心力やコリ
オリカを含めて補償する方がよい。
また、マニプレータの各リンクごとに運動方程式をたて
る繰返し二ニートン・オイラー法を用いれば、補償トル
ク計算の実時間実行が可能(10mase以内)である
ことが知られている。
従来の人工衛星の姿勢制御は、第2図に示すように姿勢
角誤差だけからホイール駆動トルクを決めて制御を行な
うため、マニプレータの運動の反作用で人工衛星自体も
動いてしまうような大きな外乱トルクの生ずる場合には
、姿勢角間の干渉が大きくなるため、必要以上の制御ト
ルクを必要とし、また、姿勢精度を保たせることが困難
であるなどの欠点がある。
一方、マニプレータ制御に関しても、高精度の軌道制御
KFi人工衛星本体の加速度値が必要であり、この加速
度値はマニプレータの動きに応じて変化するのす高い制
御精度が得られない欠点がある。
この発明は、上記のよう々欠点を除去するためになされ
た亀ので、マニプレータの運動による反作用を推定する
ことにより、人工衛星自体とマニプレータの双方にフィ
ード、フォワードに補償トルクを与え、マニプレータの
軌道制御と人工衛星の姿勢制御を同時に精度よく達成で
きる制御装置を提供することを目的としている。
以下、この発明の一実施例を図について説明する。第4
図はこの発明の一実施例を示すブロック図であり、図に
おいて(3) 、 (5) 、 (6) 、 (8) 
、 QI Fiそれぞれ第2図または第3図の同一符号
と同一または相当する部分を示し、(ロ)は人工衛星の
姿勢目標(5)と人工衛星本体に対するマニプレータの
運動軌道−(8)から人工衛星本体の加速度を推定する
加速度推定器、(13t′i加速度推定器幹によって推
定された人工衛星本体の加速度と人工衛星の姿勢目標(
5)、マニプレータの運動軌道(8)から人工衛星本体
ならびにマニプレータの各関節に働く反作用を推定する
反作用推定器、C14はホイール(3)に加えるべき補
償トルクを推定するホイール用補償トルク推定器、α9
#′i人工衛星本体とマニプレータを合せた系全体のダ
イナミクスを示す。
次に動作について説明する。人工衛星の姿勢目標(5)
とマニプレータの運動軌道(8)から、繰返しニュート
ン・オイラー法を利用して加速度推定器(2)Kより人
工衛星本体の加速度を推定する。人工衛星本体の加速度
が得られれば、再度ニュートン・オイラー法を用いて反
作用推定器(至)によ抄、マニプレータの各関節に働く
力・モーメントやマニプレータの運動によって人工衛星
自体に働く反作用を得ることができる。上記のようにし
て得られた各関節に働くモーメントからマニプレータに
加えるべき補償トルクが得られ、また、人工衛星本体に
働く反作用からホイール用補償トルク推定器Q4によっ
てホイール(3)に加えるべき補償トルクが得られる。
次に加速度推定器(2)、反作用推定器(至)について
述べる。人工衛星本体の加速度ベクトルをaとする。マ
ニプレータの運動により人工衛星本体に働く反作用力F
〜は、ニュートン・オイラー法を用いればaの関数とし
て F=−m、a+g         (11のようにあ
られされる。ただし式(1)でm、け/〜ンドリングす
る物体も含めたマニプレータの質量、gはaに関係しか
い既知の加速度に関する項をあられす。一方、人工衛星
本体のダイナミクスによれば反作用力Fは F = m、a        (2)となる。こζで
m2は人工衛星本体の質量をあられす、式(1)でa=
Oとして右辺を求めればgが得られ、式(1)と式(2
)とから a=g/(m  +m  )   ’   (3)l 
     2 としてaを得ることができる。これが加速度推定器(6
)の構成の基本となるものである。
また、上記のようにして得られた人工衛星の加速)Jl
’aを用いれば、式(1)によって反作用力Fが、また
、Fを求める過程で人工衛星に働く反作用モーメントや
マニプレータの各関節に働く力・モーメントも同時に得
られる。これを基本にして反作用推定器α3が構成され
る。
ホイール用補償トルク推定器a4は、人工衛星本体のグ
イナミクスから容易に構成することができるnまた、そ
れぞれの推定器αつ、(至)、α◆における計算は単純
なので、実時間実行が可能である。
なお、上記実施例では三軸姿勢制御にホイール(3)を
用いたものを示したが、スラスタや磁気トルカを用いた
三軸姿勢制御方式であってもよい。また、ニュートン・
オイラー法の計算は二度実行するが、1ステツプ前の人
工衛星本体の加速度を用いれば、−摩の実行でも実施可
能となる。さらに、上記実施例ではマニプレータの関節
は回転自由度をもつものとしたが、摺動自由度をもつも
のであってもよい。
以上のように、この発明によれば、補償トルクをフィー
ド、フォワードに加えて人工衛星の姿勢制御とy=ニブ
レータ軌道制御を同時に考慮するように構成したので、
必要以上の制御トルクを加える必要がなく、また、精度
の高い制御が得られるという効果がある。
【図面の簡単な説明】
第1図はマニプレータを有する人工衛星の概要を示す説
明図、第2図は従来の人工衛星の三軸姿勢制御手段の一
例を示すブロック図、第3図は従来のマニプレータ制御
手段の一例を示す・ブロック図、第4図はこの発明の一
実施例を示すブロック図である。 図において(1)は人工衛星本体、(2)はセンサ、(
31。 (3a)=(3b)、(3c)  ldホイール、(4
) Fi−rニブレータ、(5) #′i人工衛星の姿
勢目標、(6)はホイール用コントローラ、(8)はマ
ニプレータの運動軌道、α1はマニプレータ用コントロ
ーラ、QaFi加速度推定器、Q3は反作用推定器、α
4はホイール用補償トルク推定器、(至)は人工衛星本
体とマニプレータを合せた系全体のダイナミクスである
。 なお、各図中同一符号は同一または相当する部分を示す
ものとする。 代理人 葛 野 信 − 手続補正書(自発) 特許庁長官殿 1、事件の表示    特願昭56−167500号2
、発明の名称 人工術10制御装置 3、補正をする者 (連絡先03(213)3421特許IN)5、補正の
対象 明細書の発明の詳細な説明の欄 6、補正の内容 (1)明細書第5頁第14行目「フィード、フォワード
」とあるを「フィードフォワード」と訂正する。 (2)同薔第7頁第艶行目「右辺」とあるを「左辺」と
訂正する。 (3)同書第8頁第16行目乃至第17行目「磁気トル
カ」とあるを「磁気トルカ」と訂正する。 (4)同書第9′jl第4行目「フィード、フォワード
」とあるを「フィードフォワード」と訂正する。 以上

Claims (1)

    【特許請求の範囲】
  1. マニプレータを有する人工衛星の三軸姿勢を制御すると
    ともに上記マニプレータの運動軌道を制御する人工衛星
    の制御装置において、上記三軸姿勢の目標値と上記運動
    軌道の目標値とから上記人工衛星の加速度を推定する手
    段、この推定した加速度と上記三軸姿勢の目標値と上記
    運動軌道の目標値とから上記三軸姿勢及び上記運動軌道
    を制御する場合にそれぞれ加算すべき補償トルクを推定
    する手段、この推定したそれぞれの補償トルクをそれぞ
    れ加算して上記三軸姿勢及び上記運動軌道をそれぞれフ
    ィードバック制御する手段を備えたことを特徴とする人
    工衛星の制御装置。
JP56167500A 1981-10-20 1981-10-20 人工衛星の制御装置 Granted JPS5867600A (ja)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP56167500A JPS5867600A (ja) 1981-10-20 1981-10-20 人工衛星の制御装置

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP56167500A JPS5867600A (ja) 1981-10-20 1981-10-20 人工衛星の制御装置

Publications (2)

Publication Number Publication Date
JPS5867600A true JPS5867600A (ja) 1983-04-22
JPS6138076B2 JPS6138076B2 (ja) 1986-08-27

Family

ID=15850829

Family Applications (1)

Application Number Title Priority Date Filing Date
JP56167500A Granted JPS5867600A (ja) 1981-10-20 1981-10-20 人工衛星の制御装置

Country Status (1)

Country Link
JP (1) JPS5867600A (ja)

Cited By (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS6218398A (ja) * 1985-07-16 1987-01-27 三菱電機株式会社 人工衛星の制御装置
JPS6235792U (ja) * 1985-08-20 1987-03-03
JPS632800A (ja) * 1986-06-23 1988-01-07 三菱電機株式会社 人工衛星の姿勢及びアンテナ指向制御装置
JPH04217477A (ja) * 1991-01-24 1992-08-07 Mitsubishi Heavy Ind Ltd マニピュレータ

Cited By (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS6218398A (ja) * 1985-07-16 1987-01-27 三菱電機株式会社 人工衛星の制御装置
JPS6235792U (ja) * 1985-08-20 1987-03-03
JPS632800A (ja) * 1986-06-23 1988-01-07 三菱電機株式会社 人工衛星の姿勢及びアンテナ指向制御装置
JPH04217477A (ja) * 1991-01-24 1992-08-07 Mitsubishi Heavy Ind Ltd マニピュレータ

Also Published As

Publication number Publication date
JPS6138076B2 (ja) 1986-08-27

Similar Documents

Publication Publication Date Title
JP3417977B2 (ja) 姿勢制御システム、及び人工衛星の方向を制御する方法
US6039290A (en) Robust singularity avoidance in satellite attitude control
EP1064591B1 (en) Continuous spacecraft attitude control that avoids cmg array singularities
CN111045432B (zh) 一种欠驱动水面船非线性路径跟踪控制系统及方法
Geller et al. Linear covariance analysis for powered lunar descent and landing
Fjellstad et al. Singularity-free tracking of unmanned underwater vehicles in 6 DOF
Aboaf et al. Living with the singularity of robot wrists
JP2006312344A (ja) 小型無人ヘリコプタの自律飛行制御装置及び自律飛行制御方法
CN111098299B (zh) 一种空间机器人扰动补偿的方法
Wang et al. Adaptive Jacobian position/force tracking control of free-flying manipulators
JPS5867600A (ja) 人工衛星の制御装置
Krogstad et al. Coordinated attitude control of satellites in formation
Jiao et al. Disturbance observer-based backstepping control for quadrotor UAV manipulator attitude system
KR19990063535A (ko) 이동 물체의 상태 제어 장치 및 방법
Zhao et al. Robust image-based control for spacecraft uncooperative rendezvous and synchronization using a zooming camera
JPS6077210A (ja) 空間運動機構の制御方法
CN115229792A (zh) 一种飞行作业机器人动态抓取的终端滑模自适应控制方法
Bara et al. Dynamic modeling and stabilization of wheeled mobile robot
JP5126107B2 (ja) 人工衛星の姿勢制御装置
Udwadia et al. New solutions to the exact formation-keeping control of satellites with attitude constraints
Senda et al. Hardware experiments of a truss assembly by an autonomous space learning robot
Ahmed et al. Stabilization and control of autonomous hexacopter via visual-servoing and cascaded-proportional and derivative (PD) controllers
EP1134640B1 (en) Attitude control system for a spacecraft
JPH05238493A (ja) 人工衛星の制御装置
JPH06198585A (ja) 宇宙ロボットの姿勢制御方法及びその装置