WO1999047419A1 - Robust singularity avoidance in satellite attitude control - Google Patents
Robust singularity avoidance in satellite attitude control Download PDFInfo
- Publication number
- WO1999047419A1 WO1999047419A1 PCT/US1999/005599 US9905599W WO9947419A1 WO 1999047419 A1 WO1999047419 A1 WO 1999047419A1 US 9905599 W US9905599 W US 9905599W WO 9947419 A1 WO9947419 A1 WO 9947419A1
- Authority
- WO
- WIPO (PCT)
- Prior art keywords
- signal
- control
- pseudo inverse
- satellite
- producing
- 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.)
- Ceased
Links
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Program-controlled manipulators
- B25J9/16—Program controls
- B25J9/1602—Program controls characterised by the control system, structure, architecture
- B25J9/1607—Calculation of inertia, jacobian matrixes and inverses
-
- 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/28—Guiding or controlling apparatus, e.g. for attitude control using inertia or gyro effect
- B64G1/286—Guiding or controlling apparatus, e.g. for attitude control using inertia or gyro effect using control momentum gyroscopes (CMGs)
-
- 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/36—Guiding or controlling apparatus, e.g. for attitude control using sensors, e.g. sun-sensors, horizon sensors
Definitions
- This invention relates to satellites and robotic systems, for example controlling the orientation of a satellite using a plurality of control moment gyros (CMG).
- CMG control moment gyros
- attitude of an agile spacecraft or satellite is often maintained and adjusted with a control moment gyro array because those devices provide high torque and torque amplification.
- a typical CMG is a rotating mass suspended on a gimbal with an actuator to rotate it on the gimbal axis, producing torque and accumulating angular momentum.
- Angular momentum is the integral of torque over time.
- An array of «>3 CMGs is often used, allowing attitude control with some redundancy.
- Each CMG has an angular momentum (b) constrained essentially to a plane, the angular momentum vector of the gyro is nearly orthogonal to the gimbal axis.
- the error in orthogonality is small enough that it does not affect the operation of the CMG, the array of CMGs, or the attitude control of the satellite.
- the wheel speed of the CMG is essentially constant in most applications, but does not have to be for this invention to work.
- Q is the result of the cross product Q — ⁇ x t , where ⁇ is the gimbal rate and h is the angular momentum of the rotor, if varying wheel speed is incorporated then
- An object of the present invention is to significantly increase the speed in reorienting a satellite between two objects by utilizing more of the available angular momentum from the CMGs.
- the gimbal angle rates are calculated using a new pseudo inverse.
- the new pseudo inverse prevents the control from becoming unstable when the matrix generated by the Jacobean of the angular momentum with respect to the gimbal angles rank drops to two. Also if a singularity, the rank of the Jacobean drop from three to two, is encountered the solution trajectory passes through the singularity instead of getting caught in the singularity.
- Fig 2 is a block diagram showing a satellite with CMGs that are rotated to change the satellite's attitude in response to individually produce angular rate signals.
- Fig. 3 illustrates two possible paths for reorienting between two objects.
- Fig. 1 shows function blocks that may be implemented through hardware or software, preferably the latter in a computer based satellite control containing one or more signal processors programmed to produce output signals to control CMGs on the satellite as explained hereafter. Fundamentally the process is shown for a single signal path between two points, but it should be understood that single lines represent vector data which is 3 dimensional for the satellite attitude, attitude rate and torque, and n dimensional for the signals related to the n CMGs.
- the control scheme shown in Fig. 1 is used to pan or rotate the satellite on its axis from the line of sight view of an object A to a line of sight view of object B Fig 3.
- a typical closed loop control follows an eigen axis rotation path "old" by controlling the CMGs based on the actual (determined from the attitude determination system ADS in Fig. 3) and desired path attitude.
- the invention is not constrained to follow an eigen axis path as will be explained.
- the desired satellite attitude at input 10 presented as Euler angles, quaternions, Gibbs parameters, or some other convenient way of describing the attitude of a satellite, compared at 14 with actual attitude at input 12 generated by the Inertial Measurement Unit (IMU) 56 or some other method for determining satellite attitude.
- the attitude error 16 is used by the attitude control 18 to generate a desired body acceleration, CO at
- the modified pseudo inverse 36 is used to calculate the close loop gimbal rates, A 42, according to the following:
- ⁇ c A T ( P A A T + k I ) " ' P h c 36.
- the added term kl is to keep the equation from becoming indeterminate as the solution trajectory passes through internal singularities, that would be inescapable if this control was not used.
- the weighting matrix P is used to escape any singularity that is encountered. In order to do this P
- the CMG array 48 responds to the gimbal rate command 42.
- the CMG array 48 movement produces torque h 50 on the satellite 52.
- the satellite motion ⁇ 54 is detected by the attitude sensors 56.
Landscapes
- Engineering & Computer Science (AREA)
- Remote Sensing (AREA)
- Chemical & Material Sciences (AREA)
- Combustion & Propulsion (AREA)
- Radar, Positioning & Navigation (AREA)
- Aviation & Aerospace Engineering (AREA)
- Physics & Mathematics (AREA)
- Mathematical Physics (AREA)
- Automation & Control Theory (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Priority Applications (3)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| EP99916131A EP1064198B1 (en) | 1998-03-16 | 1999-03-16 | Robust singularity avoidance in satellite attitude control |
| JP2000536622A JP4276381B2 (ja) | 1998-03-16 | 1999-03-16 | 衛星姿勢制御における特異点回避 |
| DE69921790T DE69921790T2 (de) | 1998-03-16 | 1999-03-16 | Robuste singularitätsvermeidung in einer satellitenlageregelung |
Applications Claiming Priority (2)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| US09/039,959 US6039290A (en) | 1998-03-16 | 1998-03-16 | Robust singularity avoidance in satellite attitude control |
| US09/039,959 | 1998-03-16 |
Publications (1)
| Publication Number | Publication Date |
|---|---|
| WO1999047419A1 true WO1999047419A1 (en) | 1999-09-23 |
Family
ID=21908307
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| PCT/US1999/005599 Ceased WO1999047419A1 (en) | 1998-03-16 | 1999-03-16 | Robust singularity avoidance in satellite attitude control |
Country Status (5)
| Country | Link |
|---|---|
| US (1) | US6039290A (https=) |
| EP (1) | EP1064198B1 (https=) |
| JP (1) | JP4276381B2 (https=) |
| DE (1) | DE69921790T2 (https=) |
| WO (1) | WO1999047419A1 (https=) |
Cited By (6)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| WO2003085358A1 (en) * | 2002-04-03 | 2003-10-16 | Honeywell International Inc. | Inertial control and measurement system |
| EP1749743A1 (en) * | 2005-08-03 | 2007-02-07 | Honeywell International Inc. | A method and system for determining a singularity free momentum path |
| EP1793297A2 (en) | 2005-11-30 | 2007-06-06 | Honeywell Inc. | A method and system for controlling sets of collinear control moment gyroscopes |
| US7413754B2 (en) | 2001-09-19 | 2008-08-19 | Bionorica Ag | Use of extracts of the genus Cimicifugaas organoselective medicines for treating diseases of the genitourinary system caused by sex hormones |
| CN110466806A (zh) * | 2019-07-24 | 2019-11-19 | 北京控制工程研究所 | 一种使用cmg控制卫星姿态的方法 |
| CN116834976A (zh) * | 2023-06-07 | 2023-10-03 | 北京理工大学 | 空天飞行器再入段初期rcs力矩输出的容错控制分配方法 |
Families Citing this family (32)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| FR2786283B1 (fr) * | 1998-11-19 | 2001-01-26 | Matra Marconi Space France | Procede et dispositif de pilotage de l'attitude d'un satellite |
| US6456901B1 (en) | 2001-04-20 | 2002-09-24 | Univ Michigan | Hybrid robot motion task level control system |
| US6732977B1 (en) | 2002-02-11 | 2004-05-11 | Lockheed Martin Corporation | System for on-orbit correction of spacecraft payload pointing errors |
| US6695263B1 (en) | 2002-02-12 | 2004-02-24 | Lockheed Martin Corporation | System for geosynchronous spacecraft rapid earth reacquisition |
| US7051980B2 (en) * | 2002-02-26 | 2006-05-30 | Lockheed Martin Corporation | Efficient orbit sparing system for space vehicle constellations |
| US6891498B2 (en) | 2002-03-28 | 2005-05-10 | Honeywell International Inc. | Inertial reference system for a spacecraft |
| US6702234B1 (en) * | 2002-03-29 | 2004-03-09 | Lockheed Martin Corporation | Fault tolerant attitude control system for zero momentum spacecraft |
| US6682019B2 (en) | 2002-04-04 | 2004-01-27 | Honeywell International Inc. | Minimum energy wheel configurations for energy storage and attitude control |
| US6648274B1 (en) | 2002-04-12 | 2003-11-18 | David A. Bailey | Virtual reaction wheel array |
| WO2004032392A2 (en) | 2002-08-28 | 2004-04-15 | Arizona Board Of Regents | Steering logic for control moment gyro system |
| US7561947B2 (en) * | 2003-10-06 | 2009-07-14 | Honeywell International Inc. | Dynamic CMG array and method |
| US7185855B2 (en) * | 2004-04-30 | 2007-03-06 | Honeywell International, Inc. | Method and system for steering a momentum control system |
| US7246776B2 (en) * | 2004-07-23 | 2007-07-24 | Honeywell International, Inc. | Method and system for CMG array singularity avoidance |
| US7014150B2 (en) * | 2004-07-30 | 2006-03-21 | Honeywell International Inc. | Method and system for optimizing torque in a CMG array |
| US7364120B2 (en) * | 2004-08-26 | 2008-04-29 | Honeywell International, Inc. | Quantized control-moment gyroscope array |
| US7370833B2 (en) * | 2005-10-20 | 2008-05-13 | Honeywell International Inc. | Method and system for determining a singularity free momentum path |
| US7835826B1 (en) | 2005-12-13 | 2010-11-16 | Lockheed Martin Corporation | Attitude determination system for yaw-steering spacecraft |
| US7805226B2 (en) * | 2006-09-29 | 2010-09-28 | Honeywell International Inc. | Hierarchical strategy for singularity avoidance in arrays of control moment gyroscopes |
| US7627404B2 (en) * | 2007-04-13 | 2009-12-01 | The Boeing Company | Singularity escape and avoidance using a virtual array rotation |
| JP5228641B2 (ja) * | 2008-06-16 | 2013-07-03 | 三菱電機株式会社 | 姿勢制御装置および位置制御装置 |
| JP5126107B2 (ja) * | 2009-02-19 | 2013-01-23 | 三菱電機株式会社 | 人工衛星の姿勢制御装置 |
| WO2010135421A2 (en) * | 2009-05-19 | 2010-11-25 | University Of Florida Research Foundation, Inc. | Attitude control system for small satellites |
| JP5556782B2 (ja) * | 2011-10-04 | 2014-07-23 | 三菱電機株式会社 | 人工衛星の姿勢制御装置 |
| US10252151B2 (en) | 2012-03-15 | 2019-04-09 | Motorika Limited | Gyroscopic apparatuses and methods of using same |
| 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 |
| US9061775B2 (en) | 2012-06-22 | 2015-06-23 | Isaac M. Ross | Method and apparatus for spacecraft attitude control using polynomial interpolation |
| 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 |
| US9567112B1 (en) | 2013-06-27 | 2017-02-14 | The United States Of America, As Represented By The Secretary Of The Navy | Method and apparatus for singularity avoidance for control moment gyroscope (CMG) systems without using null motion |
| CN104238563B (zh) * | 2014-09-04 | 2017-01-18 | 北京航空航天大学 | 可变面倾角的控制力矩陀螺群设计方法 |
| US10737770B2 (en) * | 2015-02-23 | 2020-08-11 | Arif Mir Jalal ogly PASHAYEV | Method and device for increasing the stability and maneuverability of unmanned aerial vehicles (UAV) using a gyroscopic effect |
| CN106767673B (zh) * | 2016-11-29 | 2019-06-21 | 上海卫星工程研究所 | 一种卫星高精度光学敏感载荷的指向测量方法 |
| CN111897355B (zh) * | 2020-08-06 | 2022-09-13 | 中国科学院微小卫星创新研究院 | 一种卫星姿态机动轨迹规划方法 |
Citations (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US5159249A (en) * | 1989-05-16 | 1992-10-27 | Dalila Megherbi | Method and apparatus for controlling robot motion at and near singularities and for robot mechanical design |
Family Cites Families (12)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US3741500A (en) * | 1971-04-21 | 1973-06-26 | Sperry Rand Corp | A cmg fine attitude control system |
| FR2566935B1 (fr) * | 1984-06-27 | 1986-12-12 | Commissariat Energie Atomique | Systeme de commande optimisee des mouvements d'un mobile sensible et actif par rapport a un environnement local passif a l'aide de capteurs proximetriques locaux |
| US4860215A (en) * | 1987-04-06 | 1989-08-22 | California Institute Of Technology | Method and apparatus for adaptive force and position control of manipulators |
| US4967126A (en) * | 1990-01-30 | 1990-10-30 | Ford Aerospace Corporation | Method of controlling a seven degree of freedom manipulator arm |
| US5276390A (en) * | 1991-10-04 | 1994-01-04 | Hewlett-Packard Company | System for hybrid position and force control |
| US5777580A (en) * | 1992-11-18 | 1998-07-07 | Trimble Navigation Limited | Vehicle location system |
| US5441222A (en) * | 1993-04-26 | 1995-08-15 | Hughes Aircraft Company | Attitude control of spinning spacecraft |
| US5628267A (en) * | 1993-11-01 | 1997-05-13 | Mitsubishi Jukogyo Kabushiki Kaisha | Oscillation suppression device and ship provided with the same |
| US5681012A (en) * | 1995-01-05 | 1997-10-28 | Hughes Electronics | Spacecraft control with skewed control moment gyros |
| US5692707A (en) * | 1995-05-15 | 1997-12-02 | Hughes Aircraft Company | Universal spacecraft attitude steering control system |
| US5794892A (en) * | 1995-10-25 | 1998-08-18 | Hughes Electronics | Critical nutation dampling on spinning bodies via momentum wheels or similar devices |
| US5765780A (en) * | 1995-12-22 | 1998-06-16 | Hughes Electronics Corporation | Systematic vectored thrust calibration method for satellite momentum control |
-
1998
- 1998-03-16 US US09/039,959 patent/US6039290A/en not_active Expired - Fee Related
-
1999
- 1999-03-16 JP JP2000536622A patent/JP4276381B2/ja not_active Expired - Fee Related
- 1999-03-16 EP EP99916131A patent/EP1064198B1/en not_active Expired - Lifetime
- 1999-03-16 DE DE69921790T patent/DE69921790T2/de not_active Expired - Lifetime
- 1999-03-16 WO PCT/US1999/005599 patent/WO1999047419A1/en not_active Ceased
Patent Citations (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US5159249A (en) * | 1989-05-16 | 1992-10-27 | Dalila Megherbi | Method and apparatus for controlling robot motion at and near singularities and for robot mechanical design |
Non-Patent Citations (4)
| Title |
|---|
| KRISHNAN SHRIRAM, VADALI SRINIVAS R: "Inverse-free technique for attitude control of spacecraft using CMGs", ACTA ASTRONAUTICA, vol. 39, no. 6, September 1996 (1996-09-01), Elsevier Science Ltd., Oxford, UK, pages 431 - 438, XP002107130 * |
| LENARCIC J: "ALTERNATIVE COMPUTATIONAL SCHEME OF MANIPULATOR INVERSE KINEMATICS", PROCEEDINGS OF THE 1998 IEEE INTERNATIONAL CONFERENCE ON ROBOTICS A AUTOMATION. ICRA '98, LEUVEN, BE, MAY 16 - 20, 1998, vol. 4, no. CONF. 15, 16 May 1998 (1998-05-16), INSTITUTE OF ELECTRICAL AND ELECTRONICS ENGINEERS, pages 3235 - 3240, XP000784572 * |
| NAKAMURA Y, HANAFUSA H: "Inverse Kinematic Solutions with Singularity Robustness for Robot Manipulator Control", JOURNAL OF DYNAMIC SYSTEMS, MEASUREMENT, AND CONTROL, vol. 108, September 1986 (1986-09-01), pages 163 - 171, XP002107129 * |
| VADALI S R ET AL: "SUBOPTIMAL COMMAND GENERATION FOR CONTROL MOMENT GYROSCOPES AND FEEDBACK CONTROL OF SPACECRAFT", JOURNAL OF GUIDANCE AND CONTROL AND DYNAMICS, vol. 18, no. 6, 1 November 1995 (1995-11-01), pages 1350 - 1354, XP000558647 * |
Cited By (11)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US7413754B2 (en) | 2001-09-19 | 2008-08-19 | Bionorica Ag | Use of extracts of the genus Cimicifugaas organoselective medicines for treating diseases of the genitourinary system caused by sex hormones |
| WO2003085358A1 (en) * | 2002-04-03 | 2003-10-16 | Honeywell International Inc. | Inertial control and measurement system |
| US6681649B2 (en) | 2002-04-03 | 2004-01-27 | Honeywell International Inc. | Inertial control and measurement system |
| EP1749743A1 (en) * | 2005-08-03 | 2007-02-07 | Honeywell International Inc. | A method and system for determining a singularity free momentum path |
| US7464899B2 (en) | 2005-08-03 | 2008-12-16 | Honeywell International Inc. | Method and system for determining a singularity free momentum path |
| EP1793297A2 (en) | 2005-11-30 | 2007-06-06 | Honeywell Inc. | A method and system for controlling sets of collinear control moment gyroscopes |
| EP1793297A3 (en) * | 2005-11-30 | 2008-09-10 | Honeywell Inc. | A method and system for controlling sets of collinear control moment gyroscopes |
| US7693619B2 (en) | 2005-11-30 | 2010-04-06 | Honeywell International Inc. | Method and system for controlling sets of collinear control moment gyroscopes with offset determination without attitude trajectory of spacecraft |
| CN110466806A (zh) * | 2019-07-24 | 2019-11-19 | 北京控制工程研究所 | 一种使用cmg控制卫星姿态的方法 |
| CN110466806B (zh) * | 2019-07-24 | 2020-09-18 | 北京控制工程研究所 | 一种使用cmg控制卫星姿态的方法 |
| CN116834976A (zh) * | 2023-06-07 | 2023-10-03 | 北京理工大学 | 空天飞行器再入段初期rcs力矩输出的容错控制分配方法 |
Also Published As
| Publication number | Publication date |
|---|---|
| EP1064198B1 (en) | 2004-11-10 |
| DE69921790T2 (de) | 2005-11-03 |
| JP4276381B2 (ja) | 2009-06-10 |
| DE69921790D1 (de) | 2004-12-16 |
| EP1064198A1 (en) | 2001-01-03 |
| US6039290A (en) | 2000-03-21 |
| JP2002506773A (ja) | 2002-03-05 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| EP1064198B1 (en) | Robust singularity avoidance in satellite attitude control | |
| US6131056A (en) | Continuous attitude control that avoids CMG array singularities | |
| US6047927A (en) | Escaping singularities in a satellite attitude control | |
| Schaub et al. | Feedback control law for variable speed control moment gyros | |
| US11199858B2 (en) | Thrust vectored multicopters | |
| EP1064197B1 (en) | Cmg control based on angular momentum to control satellite attitude | |
| CA2041857C (en) | Attitude control system for momentum-biased spacecraft | |
| JP4307247B2 (ja) | ジャイロダインのクラスターによって人工衛星の姿勢を制御しかつ操舵するための方法及び装置 | |
| Bodie et al. | Towards efficient full pose omnidirectionality with overactuated mavs | |
| US6917862B2 (en) | Singularity escape/avoidance steering logic for control moment gyro systems | |
| US6154691A (en) | Orienting a satellite with controlled momentum gyros | |
| JP2004535324A5 (https=) | ||
| Caccavale et al. | Quaternion-based kinematic control of redundant spacecraft/manipulator systems | |
| JP2003521424A (ja) | 宇宙船の姿勢を制御するシステムおよび方法 | |
| US6354163B1 (en) | Mitigating gimbal induced disturbances in CMG arrays | |
| WO2005037646A2 (en) | Precision attitude control system for gimbaled thruster | |
| JP4630332B2 (ja) | Cmgアレイ特異性回避のための方法及びシステム | |
| EP3643621B1 (en) | Satellite attitude control system using eigen vector, non-linear dynamic inversion, and feedforward control | |
| EP0772108B1 (en) | Spacecraft attitude or orientation system and method | |
| KR19990063535A (ko) | 이동 물체의 상태 제어 장치 및 방법 | |
| JP4489654B2 (ja) | 衛星追尾用のアンテナ制御装置 | |
| Lappas et al. | Combined Singularity Avoidance for Redundant Control Moment Gyro (CMG) Clusters | |
| Kojima et al. | Adaptive skewing pyramid-type CMGs for fast attitude maneuver | |
| Orsag et al. | Sensors and Control | |
| Song et al. | Robust Control of the Missile Attitude Based on Quaternion Feedback |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| AK | Designated states |
Kind code of ref document: A1 Designated state(s): CN IL IN JP RU |
|
| AL | Designated countries for regional patents |
Kind code of ref document: A1 Designated state(s): AT BE CH CY DE DK ES FI FR GB GR IE IT LU MC NL PT SE |
|
| 121 | Ep: the epo has been informed by wipo that ep was designated in this application | ||
| DFPE | Request for preliminary examination filed prior to expiration of 19th month from priority date (pct application filed before 20040101) | ||
| ENP | Entry into the national phase |
Ref country code: JP Ref document number: 2000 536622 Kind code of ref document: A Format of ref document f/p: F |
|
| WWE | Wipo information: entry into national phase |
Ref document number: 1999916131 Country of ref document: EP |
|
| WWP | Wipo information: published in national office |
Ref document number: 1999916131 Country of ref document: EP |
|
| WWG | Wipo information: grant in national office |
Ref document number: 1999916131 Country of ref document: EP |