CN106843249B - two-dimensional guiding attitude control method - Google Patents
two-dimensional guiding attitude control method Download PDFInfo
- Publication number
- CN106843249B CN106843249B CN201710060168.5A CN201710060168A CN106843249B CN 106843249 B CN106843249 B CN 106843249B CN 201710060168 A CN201710060168 A CN 201710060168A CN 106843249 B CN106843249 B CN 106843249B
- Authority
- CN
- China
- Prior art keywords
- angular velocity
- yaw
- corrected
- angle
- guidance
- 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 abstract description 18
- 238000005096 rolling process Methods 0.000 claims abstract description 15
- 230000008878 coupling Effects 0.000 claims abstract description 6
- 238000010168 coupling process Methods 0.000 claims abstract description 6
- 238000005859 coupling reaction Methods 0.000 claims abstract description 6
- 230000008569 process Effects 0.000 claims abstract description 4
- 238000004364 calculation method Methods 0.000 claims description 4
- 238000012937 correction Methods 0.000 abstract description 5
- 230000004044 response Effects 0.000 abstract description 2
- 238000003384 imaging method Methods 0.000 description 4
- 230000004075 alteration Effects 0.000 description 1
- 230000008859 change Effects 0.000 description 1
- 230000006872 improvement Effects 0.000 description 1
- 230000005012 migration Effects 0.000 description 1
- 238000013508 migration Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000012545 processing Methods 0.000 description 1
- 230000006641 stabilisation Effects 0.000 description 1
- 238000011105 stabilization Methods 0.000 description 1
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/244—Spacecraft control systems
Landscapes
- Engineering & Computer Science (AREA)
- Remote Sensing (AREA)
- Automation & Control Theory (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)
Abstract
The invention discloses a high-precision high-stability two-dimensional guidance attitude control method, which comprises the following processes: the angular velocity instruction of two-dimensional guidance is added in a correction loop in the original general non-guidance attitude control method, which is equivalent to angular velocity feedforward of a system, so that the response capability of the system can be improved, and rapid guidance control is realized; and decoupling control is carried out on the yaw in the rolling direction, so that the coupling influence on the rolling direction after the yaw direction is guided is eliminated. By the measures, the rapid two-dimensional guidance access control of any position of the satellite can be realized, and the control precision of the system can be improved. The invention has the advantages of simple and easy on-board implementation and ground operation.
Description
Technical Field
the invention belongs to the technical field of satellite attitude control, and particularly relates to a high-precision high-stability two-dimensional guidance attitude control method.
Background
In the application of the satellite-borne synthetic aperture radar, the Doppler characteristic has direct influence on the azimuth resolution, the calculation of the pulse repetition frequency, the ambiguity problem of the azimuth direction and the imaging precision. The mismatch of the doppler center frequency of the SAR echo can even result in an inability to image when it is severe. The change of the Doppler center frequency caused by the influence of the earth rotation generates the range migration, which brings difficulty to the imaging processing.
In order to eliminate the influence of Doppler central frequency drift on radar imaging, a radar satellite originally designs a simple one-dimensional yaw guidance scheme, which can only start to switch on or stop guidance near a guidance angle of 90 degrees or 270 degrees, wherein the guidance angle is zero, and the deviation of guidance has a coupling influence of about 0.02 degrees in the rolling direction.
With the improvement of imaging precision requirements, a two-dimensional guidance scheme is gradually designed, namely guidance control is respectively carried out along the pitching direction and the yawing direction, the attitude control precision and the stability are equivalent to those of guidance not carried out, and the two-dimensional guidance can be quickly accessed in any direction, but the guidance can not be started only near the guidance angle of 90 degrees or 270 degrees at the latitude argument.
disclosure of Invention
The invention aims to provide a two-dimensional guiding attitude control method, which is characterized in that a satellite is stably controlled through a three-axis to ensure that a satellite coordinate system of the satellite is superposed relative to an orbit coordinate system, and the satellite tracks the motion of the orbit coordinate system to realize the stable earth orientation of the satellite; and through two-dimensional guidance control, the Doppler center frequency drift phenomenon is eliminated, and the purposes of quick access to two-dimensional guidance and two-dimensional guidance access control can be achieved under the condition that the precision and the stability of the system are not influenced and the satellite is in any position.
In order to achieve the above purpose, the invention is realized by the following technical scheme:
A two-dimensional guiding attitude control method comprises the following processes:
Introducing a yaw guide angle and a yaw guide angular speed in the yaw direction of the satellite operation, and calculating to obtain a corrected yaw angular speed;
Decoupling control is carried out in the rolling direction of satellite operation and the yaw direction, and the decoupling control is used for eliminating the coupling influence on the rolling direction after the yaw direction is guided, so that the corrected rolling angular speed is obtained;
Introducing a pitching guide angle and a pitching guide angle speed in the pitching direction of the satellite operation, and calculating to obtain a corrected pitching angle speed;
Adding the corrected yaw angular velocity, the corrected pitch angular velocity and the corrected rolling angular velocity respectively and correspondingly with the combined output angular velocity of the fiber-optic gyroscope to obtain an angular velocity instruction;
and substituting the angular speed instruction into a control algorithm to obtain the control moment of the satellite flywheel.
preferably, the corrected yaw rate ω iskxand the corrected roll angular velocity ωkzComprises the following steps:
Wherein the parameter K, Kintin order to be the gain factor,Psi is the roll and yaw attitude angle, omega, respectively0For track angular velocity, #c、Respectively yaw guide angle and yaw guide angular velocity.
Preferably, said corrected pitch angle velocity ωkycomprises the following steps:
In the formula, parameter KIcy、KcyIs a gain coefficient, theta is a pitch attitude angle, thetac、respectively, a pitch direction guide angle and a guide angular velocity.
Preferably, the angular velocity command signal ω of the control torque for controlling the satellite flywheelcx、ωcy、ωczthe calculation is as follows:
ωcx=ωkx+ωgx
ωcy=ωky+ωgy
ωcz=ωkz+ωgz
In the formula, ωgx、ωgy、ωgzAnd outputting an angular velocity signal for the gyro combination.
compared with the prior art, the invention has the following advantages:
1) The high-precision high-stability two-dimensional guidance control is realized, in the control process, guidance angle and guidance angle speed instructions are added in the yaw direction and the pitch direction, the rapid access of any position of the two-dimensional guidance is realized, the track coupling influence in the yaw direction is compensated in the rolling direction, and the control precision and the stability are improved.
2) The invention is easy to realize on-satellite and ground operation, can realize the fast two-dimensional guidance access control of the satellite at any position, and can improve the control precision of the system.
Drawings
Fig. 1 is a flowchart of a two-dimensional guiding attitude control method according to the present invention.
Detailed Description
The present invention will now be further described by way of the following detailed description of a preferred embodiment thereof, taken in conjunction with the accompanying drawings.
As shown in fig. 1, the two-dimensional guiding attitude control method of the present invention includes the following steps:
Adding a yaw guide angle and a yaw guide angular speed instruction into the yaw direction correction loop; namely, a two-dimensional guiding angular velocity instruction is added into a correction loop in the original general non-guiding attitude control method, and the two-dimensional guiding angular velocity instruction is equivalent to angular velocity feedforward of a satellite attitude control system, so that the response capability of the satellite attitude control system can be improved, and rapid guiding control can be realized. The correction loop is used for generating the command angular velocity and the two-dimensional guidance command angular velocity of the satellite body coordinate system tracking orbit coordinate system. By searching for the satellite attitude motion law, Doppler center frequency offset is compensated, and a simplified representation mode of a yaw guide angle and a pitch guide angle can be obtained:
yaw lead angle psic:
Yaw vectoring angular velocityis composed of
in the formulai is the track inclination angle and u is the latitude argument;ω0Is the satellite on-orbit real-time angular velocity, omegaeis the rotational angular velocity of the earth.
Pitch guide angle thetac:
Angular velocity of pitch guidance
In the formula: e is track eccentricity, f is true paraxial point angle, TsIs a control cycle.
and the yaw direction realizes the control of two-dimensional guidance by adding a guidance angle and a guidance angular speed instruction. And decoupling control with yaw is carried out in the rolling direction of satellite operation, and coupling influence on the rolling direction after the yaw direction is guided is eliminated.
I.e. yaw rate omegakxAnd roll angular velocity omegakzthe correction loop algorithm is as follows:
Wherein the parameter K, KintIn order to be the gain factor,Psi is the calculated roll and yaw attitude angle, ω0For track angular velocity, #c、Respectively yaw guide angle and yaw guide angular velocity.
And the control of two-dimensional guidance is realized by adding a guidance angle and a guidance angular speed instruction in the pitching direction.
Corrected pitch angular velocity ωkyThe following were used:
in the formula, parameter KIcy、KcyIs a gain coefficient, theta is a calculated pitch attitude angle, omega0Is the angular velocity of the track, thetac、pitch guide angle and pitch guide angular velocity, respectively.
After the corrected angular velocities of the three channels in the pitching direction, the yawing direction and the rolling direction are obtained, the corrected angular velocities are added into a stable loop, so that the satellite can move according to the rule of the corrected angular velocities, the satellite orbit coordinate system is tracked to move, and the aim of three-axis ground orientation is fulfilled.
And the angular velocity of the input stabilization loop isLet signal omegacx、ωcy、ωczFor correcting angular velocity omegakx、ωky、ωkzoutput angular velocity signal omega combined with gyroscopegx、ωgy、ωgzSum, so that the angular velocity command signal ω is calculatedcx、ωcy、ωcz,
The calculation is as follows:
ωcx=ωkx+ωgx (8)
ωcy=ωky+ωgy (9)
ωcz=ωkz+ωgz (10)
ωgx、ωgy、ωgzAnd outputting an angular velocity signal for the gyro combination.
The above angular velocity command signal ωcx、ωcy、ωczSubstituting the control algorithm to obtain the control moment instruction of the satellite flywheel.
by the above measures, the fast two-dimensional guidance access control at any position can be realized, and the control precision of the system can be improved.
While the present invention has been described in detail with reference to the preferred embodiments, it should be understood that the above description should not be taken as limiting the invention. Various modifications and alterations to this invention will become apparent to those skilled in the art upon reading the foregoing description. Accordingly, the scope of the invention should be determined from the following claims.
Claims (4)
1. A two-dimensional guiding attitude control method is characterized by comprising the following processes:
Introducing a yaw guide angle and a yaw guide angular speed in the yaw direction of the satellite operation, and calculating to obtain a corrected yaw angular speed;
Decoupling control is carried out in the rolling direction of satellite operation and the yaw direction, and the decoupling control is used for eliminating the coupling influence on the rolling direction after the yaw direction is guided, so that the corrected rolling angular speed is obtained;
Introducing a pitching guide angle and a pitching guide angle speed in the pitching direction of the satellite operation, and calculating to obtain a corrected pitching angle speed;
adding the corrected yaw angular velocity, the corrected pitch angular velocity and the corrected rolling angular velocity respectively and correspondingly with the combined output angular velocity of the fiber-optic gyroscope to obtain an angular velocity instruction;
and substituting the angular speed instruction into a control algorithm to obtain the control moment of the satellite flywheel.
2. A two-dimensional guidance attitude control method according to claim 1, characterized in that: the corrected yaw rate ωkxAnd the corrected roll angular velocity ωkzComprises the following steps:
Wherein the parameter K, Kintin order to be the gain factor,Psi is the roll and yaw attitude angle, omega, respectively0For track angular velocity, #c、Respectively yaw guide angle and yaw guide angular velocity.
3. A two-dimensional guidance attitude control method according to claim 2, characterized in that: the corrected pitch angular velocity ωkyComprises the following steps:
in the formula, parameter KIcy、Kcyis a gain coefficient, theta is a pitch attitude angle, thetac、Pitch guide angle and pitch guide angular velocity, respectively.
4. A two-dimensional steering attitude control method according to claim 3, wherein said angular velocity command signal ω for controlling the control torque of the satellite flywheelcx、ωcy、ωczThe calculation is as follows:
ωcx=ωkx+ωgx
ωcy=ωky+ωgy
ωcz=ωkz+ωgz
In the formula, ωgx、ωgy、ωgzAnd outputting an angular velocity signal for the gyro combination.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710060168.5A CN106843249B (en) | 2017-01-24 | 2017-01-24 | two-dimensional guiding attitude control method |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710060168.5A CN106843249B (en) | 2017-01-24 | 2017-01-24 | two-dimensional guiding attitude control method |
Publications (2)
Publication Number | Publication Date |
---|---|
CN106843249A CN106843249A (en) | 2017-06-13 |
CN106843249B true CN106843249B (en) | 2019-12-17 |
Family
ID=59121402
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201710060168.5A Active CN106843249B (en) | 2017-01-24 | 2017-01-24 | two-dimensional guiding attitude control method |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN106843249B (en) |
Families Citing this family (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108710379B (en) * | 2018-06-14 | 2021-02-02 | 上海卫星工程研究所 | Method for calculating yaw guide angle in imaging of stationary satellite |
CN115993122A (en) * | 2023-03-17 | 2023-04-21 | 齐鲁空天信息研究院 | Zero Doppler attitude guidance method, device, equipment and storage medium |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103674033A (en) * | 2013-12-13 | 2014-03-26 | 中国科学院电子学研究所 | Method and device for guiding attitude of spaceborne synthetic aperture radar satellite |
CN104155985A (en) * | 2014-08-08 | 2014-11-19 | 北京航天自动控制研究所 | Crosslinking impact assessment method for inertia coupling property between aircraft attitude movement channels |
CN104730506A (en) * | 2015-03-05 | 2015-06-24 | 北京控制工程研究所 | All-zero Doppler attitude guiding method for synthetic aperture radar satellite |
CN105819004A (en) * | 2016-04-21 | 2016-08-03 | 上海微小卫星工程中心 | Solar array control method and system of satellite and satellite |
CN106200660A (en) * | 2016-07-29 | 2016-12-07 | 北京控制工程研究所 | A kind of attitude maneuver track calculating method for geo-stationary orbit SAR satellite |
-
2017
- 2017-01-24 CN CN201710060168.5A patent/CN106843249B/en active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103674033A (en) * | 2013-12-13 | 2014-03-26 | 中国科学院电子学研究所 | Method and device for guiding attitude of spaceborne synthetic aperture radar satellite |
CN104155985A (en) * | 2014-08-08 | 2014-11-19 | 北京航天自动控制研究所 | Crosslinking impact assessment method for inertia coupling property between aircraft attitude movement channels |
CN104730506A (en) * | 2015-03-05 | 2015-06-24 | 北京控制工程研究所 | All-zero Doppler attitude guiding method for synthetic aperture radar satellite |
CN105819004A (en) * | 2016-04-21 | 2016-08-03 | 上海微小卫星工程中心 | Solar array control method and system of satellite and satellite |
CN106200660A (en) * | 2016-07-29 | 2016-12-07 | 北京控制工程研究所 | A kind of attitude maneuver track calculating method for geo-stationary orbit SAR satellite |
Non-Patent Citations (7)
Title |
---|
Analytic Yaw–Pitch Steering for Side-Looking SAR With Numerical Roll Algorithm for Incidence Angle;Daniel P. Scharf.etc;《IEEE TRANSACTIONS ON GEOSCIENCE AND REMOTE SENSING》;20120930;第3587-3594页 * |
BTT导弹的变结构解耦控制***设计;童春霞等;《宇航学报》;20060131;第27-30页 * |
Doppler properties of radars in circular orbits;R. K. Raney;《International Journal of Remote Sensing 》;19861231;第1153-1162页 * |
InSAR编队卫星全零多普勒姿态导引研究;槐超等;《上海航天》;20141225;第18-21页 * |
Total Zero Doppler steering - A new method for minimizing the Doppler centroid.;H. Fiedler.etc;《IEEE Geoscience and Remote Sensing Letters》;20051231;第141-145页 * |
星载SAR椭圆轨道全零多普勒导引方法研究;姚玉林等;《航天器工程》;20110731;第50-53页 * |
椭圆轨道全零多普勒导引律研究;张永俊等;《电子与信息学报》;20100430;第937-940页 * |
Also Published As
Publication number | Publication date |
---|---|
CN106843249A (en) | 2017-06-13 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106915477B (en) | A kind of attitude control method | |
US5809457A (en) | Inertial pointing and positioning system | |
CN104656666B (en) | Relative orbit design and high-precision posture pointing control method aiming at space non-cooperative target | |
CN105157705B (en) | A kind of half strapdown radar seeker line of sight rate extracting method | |
CN103217987B (en) | Agile satellite dynamic imaging posture adjustment method | |
CN110632935B (en) | Autonomous control method for formation satellite flying around | |
CN111897357A (en) | Attitude tracking control method for satellite earth scanning | |
CN108710379A (en) | Fixed statellite is imaged Yaw steering angle computational methods | |
CN110658854B (en) | Photoelectric turret video tracking feedforward compensation method based on combined inertial navigation information application | |
CN109269504B (en) | Attitude maneuver path planning method with terminal constraint | |
CN105180936A (en) | Servo loop decoupling method of four-axle inertial stabilization platform system | |
CN108663052B (en) | Autonomous space non-cooperative target Relative Navigation camera is directed toward control method on a kind of star | |
CN107478110A (en) | A kind of rotating missile attitude angle computational methods based on state observer | |
CN109599674B (en) | Phased array antenna stable angle tracking method based on decoupling | |
CN106843249B (en) | two-dimensional guiding attitude control method | |
CN113602532A (en) | Solid carrier rocket in-orbit correction method | |
CN113847913A (en) | Missile-borne integrated navigation method based on ballistic model constraint | |
CN110895418B (en) | Low-speed rotating aircraft control method and system for compensating dynamic lag of steering engine | |
CN105115505A (en) | Two-rank dynamic disturbance torque compensation method of four-axis inertial stabilization platform system | |
CN103941740B (en) | A kind of motor-driven imaging satellite yaw attitude control method of multiaxis considering compression of the earth | |
CN110466803B (en) | Spinning stabilized satellite attitude prediction method based on equal-inclination-angle attitude control | |
Bai et al. | The study of guidance performance of a phased array seeker with platform | |
CN114383603B (en) | Guided projectile aerial attitude identification method based on rotation modulation method | |
CN115950452A (en) | High-precision alignment method for airborne inertial navigation | |
CN115371707A (en) | Coarse alignment method for Doppler radar assisted strapdown inertial navigation motion base under large azimuth misalignment angle |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |