CN104570742B - Feedforward PID (proportion, integration and differentiation) control based rapid high-precision relative pointing control method of noncoplanar rendezvous orbit - Google Patents
Feedforward PID (proportion, integration and differentiation) control based rapid high-precision relative pointing control method of noncoplanar rendezvous orbit Download PDFInfo
- Publication number
- CN104570742B CN104570742B CN201510046799.2A CN201510046799A CN104570742B CN 104570742 B CN104570742 B CN 104570742B CN 201510046799 A CN201510046799 A CN 201510046799A CN 104570742 B CN104570742 B CN 104570742B
- Authority
- CN
- China
- Prior art keywords
- axis
- coordinate system
- attitude
- control
- 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 abstract description 29
- 230000010354 integration Effects 0.000 title claims abstract description 6
- 230000004069 differentiation Effects 0.000 title abstract 2
- 238000005096 rolling process Methods 0.000 claims abstract description 12
- 238000004422 calculation algorithm Methods 0.000 claims abstract description 11
- 238000001914 filtration Methods 0.000 claims abstract description 7
- 239000013598 vector Substances 0.000 claims description 37
- 239000011159 matrix material Substances 0.000 claims description 20
- 230000008859 change Effects 0.000 claims description 11
- 230000009466 transformation Effects 0.000 claims description 10
- 230000008569 process Effects 0.000 claims description 9
- 238000013461 design Methods 0.000 claims description 8
- 238000005259 measurement Methods 0.000 claims description 8
- 230000007246 mechanism Effects 0.000 claims description 6
- 230000003321 amplification Effects 0.000 claims description 5
- 238000003199 nucleic acid amplification method Methods 0.000 claims description 5
- 230000001133 acceleration Effects 0.000 claims description 4
- 230000000694 effects Effects 0.000 claims description 3
- 238000012546 transfer Methods 0.000 description 7
- 238000001514 detection method Methods 0.000 description 4
- 239000000446 fuel Substances 0.000 description 4
- 238000011160 research Methods 0.000 description 4
- 230000009471 action Effects 0.000 description 3
- 230000005484 gravity Effects 0.000 description 3
- 238000004088 simulation Methods 0.000 description 3
- 230000001629 suppression Effects 0.000 description 3
- 206010034719 Personality change Diseases 0.000 description 2
- 238000004458 analytical method Methods 0.000 description 2
- 238000010586 diagram Methods 0.000 description 2
- 238000005516 engineering process Methods 0.000 description 2
- 238000012544 monitoring process Methods 0.000 description 2
- 238000005457 optimization Methods 0.000 description 2
- 230000004044 response Effects 0.000 description 2
- 238000012706 support-vector machine Methods 0.000 description 2
- 241000282414 Homo sapiens Species 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000004364 calculation method Methods 0.000 description 1
- 230000008878 coupling Effects 0.000 description 1
- 238000010168 coupling process Methods 0.000 description 1
- 238000005859 coupling reaction Methods 0.000 description 1
- 238000013016 damping Methods 0.000 description 1
- 230000001419 dependent effect Effects 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 230000005764 inhibitory process Effects 0.000 description 1
- 238000009434 installation Methods 0.000 description 1
- 238000000926 separation method Methods 0.000 description 1
- 230000001360 synchronised effect Effects 0.000 description 1
Landscapes
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
The invention relates to a rapid high-precision relative pointing control method of a noncoplanar rendezvous orbit, in particular to a feedforward PID (proportion, integration and differentiation) control based rapid high-precision relative pointing control method of the noncoplanar rendezvous orbit, and aims to solve the problem that rapid high-precision tracking-pointing control methods related to satellite attitudes under the noncoplanar rendezvous orbit do not exist in the prior art. The feedforward PID control based rapid high-precision relative pointing control method including adopting an Euler angle for attitude description of a spacecraft, creating dynamical and kinematical equations of the spacecraft, and acquiring an precise expected angle theta according to a noise-containing expected angle z by a Kalman filtering algorithm of a spaceborne computer; designing an attitude control law of each axis according to a formula of ; selecting two parallelly-placed single-frame control moment gyroscopes to control a yaw axis, and selecting two flywheels to control a rolling axis and a pitch axis respectively; calculating gyroscopic moment T and flywheel actual output moment uw to complete rapid high-precision relative pointing control of the noncoplanar rendezvous orbit. The feedforward PID control based rapid high-precision relative pointing control method is applicable to rapid high-precision relative pointing control of the noncoplanar rendezvous orbit.
Description
Technical Field
The invention relates to a rapid high-precision relative pointing control method for a different-surface crossed quick-change track.
Background
With the development of aerospace technology, space technology has been applied in various fields on a large scale, and space is said to exist as a resource on which human beings live and develop. In order to enable the satellite payload to point to a specific target with a certain precision, firstly, an expected attitude of the satellite payload when an apparent axis points to the target needs to be calculated according to the position of the target, and then, the deviation and the relative rotation speed of the satellite from the command attitude are kept within an allowable range under the action of orbital motion and disturbance moment by tracking the expected attitude.
The flexible spacecraft robust backstepping self-adaptive attitude maneuver and active vibration suppression researches the problems of the flexible spacecraft attitude maneuver and active vibration suppression, designs a double-loop robust control method, has strong robustness to parameter uncertainty, increases the damping of a flexible structure, and can realize the high-precision attitude control and vibration suppression of the flexible spacecraft. However, the algorithm is slow to enter steady state, affecting the rapidity of the system.
The application of variable structure control in the attitude rapid maneuver control of the flexible spacecraft emphatically researches the variable structure control law of the flexible spacecraft. The method for setting the variable structure parameters under the fastest maneuver is analyzed, the algorithm has strong robustness and is simple, the algorithm does not depend on model parameters, the dynamic performance is better than PID control, and the rapidity and the precision of the satellite attitude maneuver are improved. However, the algorithm is too dependent on the modeling precision of the satellite attitude dynamics, and the application of the algorithm in practical engineering is limited.
The research on the attitude control method of the satellite with the solar sailboard researches the problems of complex dynamic characteristics of the attitude of the flexible satellite, modeling uncertainty and limited moment output of an actual satellite actuator, and designs an inverse model control law of a non-precise model based on a support vector machine. The control law has good steady-state effect and dynamic quality, effectively reduces the influence of flexible mode vibration on attitude control, and has certain inhibition capability on interference. However, the stability analysis and calculation processes of the algorithm are complex, the application is still relatively few, and documents for combining the support vector machine with the flexible satellite attitude do not appear yet.
At present, the problem of fast and high-precision tracking and pointing of the attitude of a satellite under an out-of-plane cross orbit is hardly researched.
Disclosure of Invention
The invention aims to solve the problem that the existing control method does not have a control method for quickly and accurately tracking and pointing the attitude of a satellite under an out-of-plane crossed orbit.
The method for controlling the rapid high-precision relative pointing of the different-surface crossed fast-changing track based on feedforward PID control comprises the following steps:
step 1: determining a desired pose:
the tracking star and the target star are positioned on the non-coplanar cross orbit, and the tracking star needs to autonomously detect the position of the target; in order to enable a laser transmitter or observation equipment for tracking the star to always point to a target star, an expected attitude needs to be determined firstly, so that the problem of pointing to the target becomes the problem of attitude tracking; because the detection range is limited, laser attack or observation and monitoring can be carried out only when the distance between the tracking satellite and the target satellite is close, when the track included angle of the two satellites is large, only a small section near the track intersection point meets the detection distance requirement, and the expected attitude is changed very fast (embodied by fast change), so that the pointing tracking of the target is required to have higher response speed; the pointing task of the target star is often required to have certain precision, so that higher requirement is provided for the pointing precision;
assuming that a tracking star view axis is coincident with an x axis of a body, enabling the x axis of a desired attitude coordinate system to point to a target star, enabling a y axis to be perpendicular to a plane formed by the x axis and a tracking star geocentric vector and to be opposite to the track angular velocity, and enabling a z axis, the x axis and the y axis to form a right-hand coordinate system as shown in figure 1; the expected attitude coordinate system designed in the way is almost obtained by rotating the centroid orbit coordinate system for a certain angle around the z axis, and the centroid orbit coordinate system is taken as an attitude reference coordinate system, so that the change of the expected attitude is approximately rotated around the z axis;
in the geocentric inertial coordinate system, unit vectors of all coordinate axes of the expected attitude coordinate system are expressed as follows:
wherein r istAnd rcRespectively are position vectors of the tracking star and the target star in the geocentric inertial coordinate system; i. j and k are unit vectors of each coordinate axis of the expected attitude coordinate system;
let x1、y1、z1Is a unit vector, x, of each coordinate axis of the earth's center inertial coordinate system2、y2、z2Is a unit vector of each coordinate axis of a centroid orbit coordinate system, and consists of a unit vector i, j, k of each coordinate axis of an expected attitude coordinate system and a unit vector x of each coordinate axis of a geocentric inertia coordinate system1,y1,z1Obtaining a cosine transformation matrix R of the expected attitude coordinate system relative to the geocentric inertial coordinate systemdiUnit vector x of each coordinate axis of the centroid orbital coordinate system2,y2,z2And unit vector x of each coordinate axis of the earth center inertial coordinate system1,y1,z1Solving the cosine transform matrix R of the mass center orbit coordinate system relative to the geocentric inertia coordinate systemoi,
The transformation matrix of the desired pose coordinate system with respect to the centroid orbital coordinate system is
Step 2: the Kalman filtering estimation uses a second derivative of an expected attitude angle in a control law and cannot be directly measured; the measured expected attitude angle hasNoise influence, namely, if the noise is amplified by direct quadratic difference, designing a standard continuous Kalman filter to determine an expected attitude angle and a derivative thereof; the expected attitude angle is an attitude angle obtained by taking the coordinate axis where the i, j and k unit vectors are located as an expected attitude coordinate system, and is theta,to be the first derivative of the desired attitude angle theta,a second derivative of the desired attitude angle θ; take the state vector as
The desired angle z containing noise information is obtained by measurement:
z=Hzx+v (3)
in the formula Hz=[1,0,0]V is the high frequency noise that is not estimated;
inputting a desired angle z containing noise into a Kalman filter; in the case of the kalman filter, the filter,
setting estimators of three axes to be in the same form; the equation of state for each axis is:
wherein,w is virtual white noise with variance not zero to reflect the change characteristic of the actual angular acceleration information;
the estimator is
K=PHz TR-1(6)
PAT+AP-PHz TR-1HzP+BQBT=0 (7)
Is a state estimate for the state variable x;a first derivative of a state estimate for a state variable x; q is a semi-positive definite system noise variance matrix; r is a positive definite measurement noise array; p is a stateA variance matrix of (a);
obtaining an accurate expected angle theta through a Kalman filtering algorithm of an on-board computer according to the expected angle z containing noise;
and step 3: designing an attitude control law of each axis, wherein the attitude control law is specifically represented as a control moment u; has the following form:
where u is the control moment, I is the principal inertia of the shaft, KpIs a proportional amplification factor, KiFor integral control coefficient, KdIs a differential control coefficient; a isdIs an attitude angle under the body mass center coordinate system,is adThe second derivative of (a); e is the Euler attitude angle error;
and 4, step 4: selecting an actuating mechanism, and controlling a yaw axis, namely a z axis, by using two single-frame control moment gyroscopes which are arranged in parallel; two flywheels are used to control the roll axis and the pitch axis, i.e., the x-axis and the y-axis, respectively.
The invention has the following beneficial effects:
1. in practical engineering, the thruster has an upper amplitude limit and is not continuous, and compared with the existing track transfer schemes under some continuous control, the method considers the amplitude limit of the thruster and is more suitable for practical engineering application.
2. Compared with some schemes only considering time optimization or only considering fuel consumption, the invention simultaneously considers the transfer time and the fuel consumption, and can find the time-fuel optimization control scheme under the specific gravity by adjusting the specific gravities of the transfer time and the fuel consumption.
3. Unlike some studies on orbital transfer in an inertial system, the invention studies on orbital transfer in a relative orbital coordinate system, and the starting point and the ending point of orbital transfer in the relative orbital coordinate system are not fixed points in the inertial system, so that the invention has greater practical application value in the problem of relative orbital transfer between spacecrafts.
Drawings
FIG. 1 is a schematic view of a desired pose coordinate system;
FIG. 2 is a schematic diagram of the body and the orbital coordinate system;
FIG. 3 is a schematic view of a control moment gyro mounting configuration;
FIG. 4 is a schematic diagram of a PD controller for the flywheel in a torque mode;
FIG. 5 is a graph of expected attitude versus body attitude change;
FIG. 6 is a graph of a change in attitude angle error;
FIG. 7 is a graph of the variation of angular velocity of a satellite;
FIG. 8 is a graph of CMG versus flywheel output torque;
FIG. 9 is a graph of total control torque variation.
Detailed Description
The first embodiment is as follows:
the method for controlling the rapid high-precision relative pointing of the different-surface crossed fast-changing track based on feedforward PID control comprises the following steps:
step 1: determining a desired pose:
the tracking star and the target star are positioned on the non-coplanar cross orbit, and the tracking star needs to autonomously detect the position of the target; in order to enable a laser transmitter or observation equipment for tracking the star to always point to a target star, an expected attitude needs to be determined firstly, so that the problem of pointing to the target becomes the problem of attitude tracking; because the detection range is limited, laser attack or observation and monitoring can be carried out only when the distance between the tracking satellite and the target satellite is close, when the track included angle of the two satellites is large, only a small section near the track intersection point meets the detection distance requirement, and the expected attitude is changed very fast (embodied by fast change), so that the pointing tracking of the target is required to have higher response speed; the pointing task of the target star is often required to have certain precision, so that higher requirement is provided for the pointing precision;
assuming that a tracking star view axis is coincident with an x axis of a body, enabling the x axis of a desired attitude coordinate system to point to a target star, enabling a y axis to be perpendicular to a plane formed by the x axis and a tracking star geocentric vector and to be opposite to the track angular velocity, and enabling a z axis, the x axis and the y axis to form a right-hand coordinate system as shown in figure 1; the expected attitude coordinate system designed in the way is almost obtained by rotating the centroid orbit coordinate system for a certain angle around the z axis, and the centroid orbit coordinate system is taken as an attitude reference coordinate system, so that the change of the expected attitude is approximately rotated around the z axis;
in the geocentric inertial coordinate system, unit vectors of all coordinate axes of the expected attitude coordinate system are expressed as follows:
wherein r istAnd rcRespectively are position vectors of the tracking star and the target star in the geocentric inertial coordinate system; i. j and k are unit vectors of each coordinate axis of the expected attitude coordinate system;
let x1、y1、z1Is a unit vector, x, of each coordinate axis of the earth's center inertial coordinate system2、y2、z2Is a unit vector of each coordinate axis of a centroid orbit coordinate system, and consists of a unit vector i, j, k of each coordinate axis of an expected attitude coordinate system and a unit vector x of each coordinate axis of a geocentric inertia coordinate system1,y1,z1Obtaining a cosine transformation matrix R of the expected attitude coordinate system relative to the geocentric inertial coordinate systemdiUnit vector x of each coordinate axis of the centroid orbital coordinate system2,y2,z2And unit vector x of each coordinate axis of the earth center inertial coordinate system1,y1,z1Solving the cosine transform matrix R of the mass center orbit coordinate system relative to the geocentric inertia coordinate systemoi,
The transformation matrix of the desired pose coordinate system with respect to the centroid orbital coordinate system is
Step 2: the Kalman filtering estimation uses a second derivative of an expected attitude angle in a control law and cannot be directly measured; the measured expected attitude angle has noise influence, and if the noise is amplified by direct second-order difference, a standard continuous Kalman filter is designed to determine the expected attitude angle and the derivative thereof; the desired attitude angle is at the seat where the unit vectors of i, j, k lieThe axis is an attitude angle obtained under an expected attitude coordinate system, the expected attitude angle is set as theta,to be the first derivative of the desired attitude angle theta,a second derivative of the desired attitude angle θ; take the state vector as
The desired angle z containing noise information is obtained by measurement:
z=Hzx+v (3)
in the formula Hz=[1,0,0]V is the high frequency noise that is not estimated;
inputting a desired angle z containing noise into a Kalman filter; in the case of the kalman filter, the filter,
setting estimators of three axes to be in the same form; the equation of state for each axis is:
wherein,w is virtual white noise with variance not zero to reflect the change characteristic of the actual angular acceleration information;
the estimator is
K=PHz TR-1(6)
PAT+AP-PHz TR-1HzP+BQBT=0 (7)
Is a state estimate for the state variable x;a first derivative of a state estimate for a state variable x; q is a semi-positive definite system noise variance matrix; r is a positive definite measurement noise array; p is a stateA variance matrix of (a);
obtaining an accurate expected angle theta through a Kalman filtering algorithm of an on-board computer according to the expected angle z containing noise;
and step 3: designing an attitude control law of each axis, wherein the attitude control law is specifically represented as a control moment u; has the following form:
where u is the control moment, I is the principal inertia of the shaft, KpIs a proportional amplification factor, KiFor integral control coefficient, KdIs a differential control coefficient; a isdIs an attitude angle under the body mass center coordinate system,is adThe second derivative of (a); e is the Euler attitude angle error;
and 4, step 4: selecting an actuating mechanism, and controlling a yaw axis, namely a z axis, by using two single-frame control moment gyroscopes which are arranged in parallel; two flywheels are used to control the roll axis and the pitch axis, i.e., the x-axis and the y-axis, respectively.
The second embodiment is as follows: the implementation process of step 3 in this embodiment is as follows:
the angular velocity omega of the tracking star in the inertial space is equal to the angular velocity omega of the tracking star body coordinate system relative to the attitude reference coordinate systembrAngular velocity ω associated with the attitude reference frame relative to the centroid inertial frameriTo sum, i.e.
ω=ωbr+ωri(8)
In the inertial directional flight mode
The reference coordinate system is the mass center inertial coordinate system, omegariIs equal to 0 and has
Cx(·)、Cy(·)、Cz(. The) is the rotation matrix in the transformation process of the coordinate system respectively;
psi is the yaw angle;is a pitch angle;is a roll angle; omegax、ωy、ωzRespectively tracking the components of the angular velocity omega of the star on the x-axis, the y-axis and the z-axis under a centroid inertial coordinate system;
see FIG. 2, Euler angles ψ,The geometrical meaning of (A) is as follows:
psi is yaw angle-Tracking star rolling axis ObXb(direction of tracking star velocity) projection on local horizontal plane and orbit coordinate system OoXoThe included angle of the axes;
for pitch-tracking star rolling axis ObXbThe included angle with the projection of the device on the local horizontal plane;
for roll angle-tracking star pitch axis ObYbThe included angle with the projection of the device on the local horizontal plane;
three corners as known in the art
And (3) obtaining an Euler angle attitude kinematic equation:
because the attitude control task is similar to single-axis rotation, a three-axis decoupling design attitude tracking control law is carried out; when the tracking star rotates approximately around the z-axis, the attitude angles of the x-axis and the y-axis are approximately 0, and the orbit angular velocity is also small compared to the tracking star angular velocity, and it can be seen from the equation (10)The angular velocity obtained by the gyro measurement can be directly used for feedback control, and the 3-1-2 rotation sequence Euler angular form is selected to describe and track the star attitude;
the desired attitude angle theta is based on the transformation matrix ad=θRdoAttitude angle a converted to body centroid coordinate systemd;Body attitude angle is denoted as abThe Euler attitude angle error e ═ ad-ab(ii) a When the expected attitude changes rapidly around the z axis, the traditional PID control law cannot meet the requirement of tracking accuracy, so that a feedforward term of an expected Euler angle second derivative (obtained by filtering estimation in step 2) is added to predict the change of angular acceleration and improve the pointing tracking capability;
the attitude control law for each axis has the form:
where u is the control moment, I is the principal inertia of the shaft, KpIs a proportional amplification factor, KiFor integral control coefficient, KdIs a differential control coefficient;
in order to prevent integral saturation, the idea of "integral separation" is adopted, i.e. the integral action is introduced only when the error is small, the integral is started when | e | is smaller than a certain threshold value, and no integral action is taken when | e | is larger than the value; a certain threshold is determined according to the actual euler attitude angle error requirement.
Other steps and parameters are the same as in the first embodiment.
The third concrete implementation mode: the implementation process of step 4 in this embodiment is as follows:
because the expected attitude near the intersection point of the two star non-coplanar orbits is greatly changed, the requirement on the control moment is higher; although the thruster can provide larger torque, the output torque is not continuous and cannot accurately track the command torque, so that the performance of a control system is damaged; in the feedforward PID attitude pointing tracking control, the requirement on the accuracy of the controlled quantity is higher, buffeting is more easily caused by using a thruster as an executing mechanism, and an ideal control effect cannot be achieved;
the invention only has larger torque demand of the yaw axis and has smaller torque demand of other two axes, and the flywheel and the CMG can be combined for use, namely two single-frame control torque gyros which are arranged in parallel are used for controlling the yaw axis, namely the z axis; the two flywheels are used for respectively controlling a rolling shaft and a pitching shaft, namely an x shaft and a y shaft;
a Control moment gyro (CMG for short); the mounting configuration of control moment gyro groups (CMGs) in a tracking star body coordinate system is shown in figure 3, h1And h2Two gyro rotor angular momentums; establishing a relative coordinate system for installing the control moment gyroscope in an installation configuration, wherein three axes point to Fx, Fy and Fz respectively; the configuration can only output the moments in the Fx and the Fz directions, and each two-dimensional vector represents the Fx and the Fz directions;
in order to reduce the influence of the coupling moment, the angular momentum of the whole tracking star is made to be zero as much as possible, namely h is made to be zero when the angular velocity of the tracking star body is zero1And h2The directions are opposite, and the frame angle of the direction shown in the drawing is defined to be zero;
the yaw axis is controlled by two single-frame control moment gyros arranged in parallel, and the angular momentum h of two gyro rotors is set1And h2All have the size of h, and the frame angles of the CMG are respectively1And2according to the control moment u designed by the yaw axis control law, the frame angle of the gyroscope is obtained1And2then according to1And2determining gyro moment T
The total angular momentum of the gyro group in the tracking star system is
The resultant gyro moment T generated by the rotation of each gyro frame can be expressed as
Is the first derivative of H;
except the yaw axis, the rolling axis and the pitching axis adopt flywheels as actuating mechanisms;
the rolling shaft and the pitching shaft are respectively controlled by a flywheel, and the flywheel is used as a simple first-order inertia link to analyze and design the flywheel and the controller as (14) in the working mode of the control moment u designed by the rolling shaft and the pitching shaft control law
In the formula, tsIs the time constant of the first order inertial system;
the PD controller is adopted for design, and the form is shown in FIG. 4;
actual output torque u of flywheelw
tsIs the time constant, k, of a first-order inertial systempAs integration time constant, kdIs a differential time constant;
the resultant gyro moment T generated by the rotation of the gyro frame and the actual output moment u of the flywheelwAnd finishing the rapid high-precision relative pointing control of the different-surface crossed rapid-change track.
Other steps and parameters are the same as in the first or second embodiment.
Examples
Setting the target satellite to be in a 600km sun synchronous orbit, wherein the number of initial orbits is as follows: semi-major axis a of target star orbit16978140m, meshEccentricity e of the orbit of the satellite10, target star orbit inclination i197.7597 °, target star orbit intersection longitude Ω10, target star isocenter angular distance omega10, true angle f of target star1-6.2 °; the tracking star is positioned on the homomorphic different-surface orbit and has a certain phase difference with the target, and the number of the initial orbits is as follows: track the star orbit semi-major axis a26978140m, tracking satellite orbit eccentricity e2Track star orbit inclination i ═ 02=i1+5 °, tracking star orbit elevation point longitude Ω20, tracking the angular distance omega of the star near center point20, tracking true star near angle f2=f1-0.0821°。
Tracking star inertia matrix
The space disturbance moment added in the simulation is as follows: sunlight pressure moment, gravity gradient moment, geomagnetic moment and pneumatic moment.
Controller design parameters
PID parameter Kp=1.8I,Ki=1,Kd1.8I, I is the main inertia of the corresponding axis, the integral threshold value is 0.01 degrees, the filter parameters R is (10/3600/57.3) ^2, Q is (500/5000/100) ^2, the angular momentum h of a single gyro rotor is 30Nms, the upper limit of the angular speed of the gyro frame is 30 degrees/s, and the manipulation law weight coefficient α is e-10D。
Simulation analysis
The simulation images obtained by the feedforward PID attitude pointing tracking control algorithm are shown in the figures 5-9:
it can be seen from fig. 5 that the yaw angle of the expected attitude is rapidly changed from-80 ° to 80 °, the rolling angle and the pitch angle are almost zero, the assumption of approximate uniaxial rotation is met, and the attitude of the body can well track the change of the expected attitude. It can be seen from fig. 6 that the tracking accuracy is good except for the initial large-deviation adjustment process, and the error near the track intersection increases. From fig. 8 and fig. 8, it can be seen that the control moment is provided by the control moment gyro CMG and the flywheel during the maneuvering process, and the yaw axis moment requirement near the track crossing point is larger and is provided by the control moment gyro CMG.
Claims (3)
1. The method for controlling the rapid high-precision relative pointing of the different-surface cross fast-changing track based on feedforward PID control is characterized by comprising the following steps: the method comprises the following steps:
step 1: determining a desired pose:
assuming that a tracking star view axis is coincident with an x axis of a body, enabling the x axis of a desired attitude coordinate system to point to a target star, enabling a y axis to be perpendicular to a plane formed by the x axis and a tracking star geocentric vector and to be opposite to the track angular velocity, enabling a z axis, the x axis and the y axis to form a right-hand coordinate system, and enabling a centroid track coordinate system to serve as an attitude reference coordinate system, so that the change of the desired attitude is approximately rotated around the z axis;
in the geocentric inertial coordinate system, unit vectors of all coordinate axes of the expected attitude coordinate system are expressed as follows:
wherein r istAnd rcRespectively are position vectors of the tracking star and the target star in the geocentric inertial coordinate system; i. j and k are unit vectors of each coordinate axis of the expected attitude coordinate system;
let x1、y1、z1Is a unit vector, x, of each coordinate axis of the earth's center inertial coordinate system2、y2、z2Is a unit vector of each coordinate axis of a centroid orbit coordinate system, and consists of a unit vector i, j, k of each coordinate axis of an expected attitude coordinate system and a unit vector x of each coordinate axis of a geocentric inertia coordinate system1,y1,z1Obtaining a cosine transformation matrix R of the expected attitude coordinate system relative to the geocentric inertial coordinate systemdiUnit vector x of each coordinate axis of the centroid orbital coordinate system2,y2,z2And unit vector x of each coordinate axis of the earth center inertial coordinate system1,y1,z1Solving the cosine transform matrix R of the mass center orbit coordinate system relative to the geocentric inertia coordinate systemoi,
The transformation matrix of the desired pose coordinate system with respect to the centroid orbital coordinate system is
Step 2: designing a standard continuous Kalman filter to determine an expected attitude angle and a derivative thereof; the expected attitude angle is an attitude angle obtained by taking the coordinate axis where the i, j and k unit vectors are located as an expected attitude coordinate system, and is theta,to be the first derivative of the desired attitude angle theta,a second derivative of the desired attitude angle θ; take the state vector as
The desired angle z containing noise information is obtained by measurement:
z=Hzx+v (3)
in the formula Hz=[1,0,0]V is the high frequency noise that is not estimated;
inputting a desired angle z containing noise into a Kalman filter; in the case of the kalman filter, the filter,
setting estimators of three axes to be in the same form; the equation of state for each axis is:
wherein,w is virtual white noise with variance not zero to reflect the change characteristic of the actual angular acceleration information;
the estimator is
K=PHz TR-1(6)
PAT+AP-PHz TR-1HzP+BQBT=0 (7)
Is a state estimate for the state variable x;a first derivative of a state estimate for a state variable x; q is a semi-positive definite system noise variance matrix; r is a positive definite measurement noise array; p is a stateA variance matrix of (a);
obtaining an accurate expected angle theta through a Kalman filtering algorithm of an on-board computer according to the expected angle z containing noise;
and step 3: designing an attitude control law of each axis, wherein the attitude control law is specifically represented as a control moment u; has the following form:
where u is the control moment, I is the principal inertia of the shaft, KpIs a proportional amplification factor, KiFor integral control coefficient, KdIs a differential control coefficient; a isdIs an attitude angle under the body mass center coordinate system,is adThe second derivative of (a); e is the Euler attitude angle error;
and 4, step 4: selecting an actuating mechanism, and controlling a yaw axis, namely a z axis, by using two single-frame control moment gyroscopes which are arranged in parallel; two flywheels are used to control the roll axis and the pitch axis, i.e., the x-axis and the y-axis, respectively.
2. The method for controlling the fast high-precision relative orientation of the different-surface crossed fast-changing orbit based on the feedforward PID control as claimed in claim 1, wherein the implementation process of the step 3 is as follows:
the angular velocity omega of the tracking star in the inertial space is equal to the angular velocity omega of the tracking star body coordinate system relative to the attitude reference coordinate systembrAngular velocity ω associated with the attitude reference frame relative to the centroid inertial frameriTo sum, i.e.
ω=ωbr+ωri(8)
In the inertial directional flight mode
The reference coordinate system is the mass center inertial coordinate system, omegariIs equal to 0 and has
Cx(·)、Cy(·)、Cz(. The) is the rotation matrix in the transformation process of the coordinate system respectively;
psi is the yaw angle;is a pitch angle;is a roll angle; omegax、ωy、ωzRespectively tracking the components of the angular velocity omega of the star on the x-axis, the y-axis and the z-axis under a centroid inertial coordinate system;
and (3) obtaining an Euler angle attitude kinematic equation:
because the attitude control task is similar to single-axis rotation, a three-axis decoupling design attitude tracking control law is carried out; when the tracking star rotates approximately around the z-axis, the attitude angles of the x-axis and the y-axis are approximately 0, and the orbit angular velocity is also small compared to the tracking star angular velocity, and it can be seen from the equation (10)The angular velocity obtained by the gyro measurement can be directly used for feedback control, and the 3-1-2 rotation sequence Euler angular form is selected to describe and track the star attitude;
the desired attitude angle theta is based on the transformation matrix ad=θRdoAttitude angle a converted to body centroid coordinate systemd;Body attitude angle is denoted as abThe Euler attitude angle error e ═ ad-ab;
The attitude control law for each axis has the form:
where u is the control moment, I is the principal inertia of the shaft, KpIs a proportional amplification factor, KiFor integral control coefficient, KdIs a differential control coefficient;
integration starts when | e | is less than a certain threshold and there is no integration effect when | e | is greater than this value.
3. The method for controlling the fast high-precision relative orientation of the different-surface crossed fast-changing orbit based on the feedforward PID control as claimed in claim 1 or 2, wherein the implementation process of the step 4 is as follows:
controlling a yaw axis, namely a z axis, by using two single-frame control moment gyroscopes which are arranged in parallel; the two flywheels are used for respectively controlling a rolling shaft and a pitching shaft, namely an x shaft and a y shaft;
a control moment gyro, abbreviated as CMG;
the yaw axis is controlled by two single-frame control moment gyros arranged in parallel, and the angular momentum h of two gyro rotors is set1And h2All have the size of h, and the frame angles of the CMG are respectively1And2according to the control moment u designed by the yaw axis control law, the frame angle of the gyroscope is obtained1And2then according to1And2determining gyro moment T
The total angular momentum of the gyro group in the tracking star system is
The resultant gyro moment T generated by the rotation of each gyro frame can be expressed as
Is the first derivative of H;
except the yaw axis, the rolling axis and the pitching axis adopt flywheels as actuating mechanisms;
the rolling shaft and the pitching shaft are respectively controlled by a flywheel, and the flywheel is used as a simple first-order inertia link to analyze and design the flywheel and the controller as (14) in the working mode of the control moment u designed by the rolling shaft and the pitching shaft control law
In the formula, tsIs the time constant of the first order inertial system;
designing by adopting a PD controller;
actual output torque u of flywheelw
tsIs the time constant, k, of a first-order inertial systempAs integration time constant, kdIs a differential time constant;
the resultant gyro moment T generated by the rotation of the gyro frame and the actual output moment u of the flywheelwAnd finishing the rapid high-precision relative pointing control of the different-surface crossed rapid-change track.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201510046799.2A CN104570742B (en) | 2015-01-29 | 2015-01-29 | Feedforward PID (proportion, integration and differentiation) control based rapid high-precision relative pointing control method of noncoplanar rendezvous orbit |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201510046799.2A CN104570742B (en) | 2015-01-29 | 2015-01-29 | Feedforward PID (proportion, integration and differentiation) control based rapid high-precision relative pointing control method of noncoplanar rendezvous orbit |
Publications (2)
Publication Number | Publication Date |
---|---|
CN104570742A CN104570742A (en) | 2015-04-29 |
CN104570742B true CN104570742B (en) | 2017-02-22 |
Family
ID=53087112
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201510046799.2A Active CN104570742B (en) | 2015-01-29 | 2015-01-29 | Feedforward PID (proportion, integration and differentiation) control based rapid high-precision relative pointing control method of noncoplanar rendezvous orbit |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN104570742B (en) |
Families Citing this family (12)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106020224B (en) * | 2016-07-22 | 2019-01-08 | 北京航空航天大学 | A kind of probabilistic Upper Stage vectored thrust control method of consideration centroid position |
CN106379558B (en) * | 2016-09-09 | 2018-09-11 | 上海航天控制技术研究所 | A kind of sliding moding structure composite control method based on angular acceleration feedforward |
CN106919055B (en) * | 2017-04-18 | 2019-10-01 | 上海航天控制技术研究所 | A kind of in-orbit prediction scheme design method of SGCMG failure based on robust pseudoinverse manipulation rate |
CN107132850B (en) * | 2017-05-25 | 2019-08-02 | 上海航天控制技术研究所 | Change rail posture based on angular speed tracking keeps control method |
CN109507875B (en) * | 2019-01-08 | 2022-03-04 | 哈尔滨工业大学 | Euler rotary satellite attitude maneuver hierarchical saturation PID control method |
CN109993224B (en) * | 2019-03-27 | 2021-02-02 | 中国人民解放军战略支援部队航天工程大学 | GEO satellite shape and attitude identification method based on deep learning and multi-core learning |
CN110502026B (en) * | 2019-08-26 | 2022-04-15 | 上海宇航***工程研究所 | Satellite rolling attitude planning method considering thermal control measurement and control constraint based on sight pointing |
CN111591472B (en) * | 2020-05-15 | 2021-12-10 | 北京世冠金洋科技发展有限公司 | Method and related device for adjusting satellite attitude |
CN112115574B (en) * | 2020-07-28 | 2022-08-02 | 北京航空航天大学 | High-precision pointing tracking control method for different-plane orbit satellite |
CN111649624B (en) * | 2020-07-30 | 2022-04-15 | 哈尔滨工业大学 | Space miniature precise guided weapon control method |
CN112379680B (en) * | 2020-10-10 | 2022-12-13 | 中国运载火箭技术研究院 | Aircraft attitude angle control method, control device and storage medium |
CN112607065B (en) * | 2020-12-23 | 2023-04-18 | 长春工业大学 | High-precision phase control method based on electric propulsion system |
Family Cites Families (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101708780B (en) * | 2009-11-26 | 2012-12-05 | 哈尔滨工业大学 | Method for controlling rigid spacecraft for target attitude tracking |
JP5405417B2 (en) * | 2010-08-24 | 2014-02-05 | 株式会社小野測器 | Attitude angle stabilization device and method |
TW201221959A (en) * | 2010-11-30 | 2012-06-01 | Ind Tech Res Inst | Method and apparatus for estimating 3D attitude |
CN103121514B (en) * | 2011-11-18 | 2015-09-02 | 上海宇航***工程研究所 | A kind of attitude control method being applicable to the traversing space vehicle of barycenter |
-
2015
- 2015-01-29 CN CN201510046799.2A patent/CN104570742B/en active Active
Also Published As
Publication number | Publication date |
---|---|
CN104570742A (en) | 2015-04-29 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN104570742B (en) | Feedforward PID (proportion, integration and differentiation) control based rapid high-precision relative pointing control method of noncoplanar rendezvous orbit | |
CN104527994B (en) | Multi-polar cross-over becomes the track set time soon and holds position sensing tracking and controlling method | |
Sawai et al. | Control of hovering spacecraft using altimetry | |
Searcy et al. | Magnetometer-only attitude determination using novel two-step Kalman filter approach | |
CN105629732B (en) | A kind of spacecraft attitude output Tracking Feedback Control method for considering Control constraints | |
Chen et al. | Spacecraft angular rates and angular acceleration estimation using single-gimbal magnetically suspended control moment gyros | |
Takada et al. | Control moment gyro singularity-avoidance steering control based on singular-surface cost function | |
CN108181916B (en) | Control method and device for relative attitude of small satellite | |
CN107402516B (en) | Rank saturation the fuzzy PD attitude control method is passed based on joint executing agency | |
CN102944241B (en) | Spacecraft relative attitude determining method based on multicell liner differential inclusion | |
CN112572835B (en) | Satellite in-orbit angular momentum management and control method with attitude switching function | |
CN109683628A (en) | A kind of spacecraft relative position control method based on finite time distribution speed observer | |
Wu et al. | Sliding-mode control for staring-mode spacecraft using a disturbance observer | |
Srivastava et al. | Attitude determination and control system for a leo debris chaser small satellite | |
Cortiella et al. | 3CAT-2: Attitude determination and control system for a GNSS-R earth observation 6U cubesat mission | |
CN110567462A (en) | identification method for three-axis rotational inertia ratio of approximate spinning non-cooperative spacecraft | |
Guo et al. | Integrated vibration isolation and attitude control for spacecraft with uncertain or unknown payload inertia parameters | |
CN108871312B (en) | Combined attitude determination method for gravity gradiometer and star sensor | |
Anderson et al. | Attitude determination and control system simulation and analysis for low-cost micro-satellites | |
CN112393835B (en) | Small satellite on-orbit thrust calibration method based on extended Kalman filtering | |
Reijneveld et al. | Attitude control system of the Delfi-n3Xt satellite | |
Tan et al. | A new approach for small satellite gyroscope and star tracker fusion | |
Xie et al. | Autonomous guidance, navigation, and control of spacecraft | |
Li et al. | Attitude control of staring-imaging satellite using Permanent Magnet momentum Exchange Sphere | |
Zhang et al. | An improved Kalman filter for attitude determination of multi-rotor UAVs based on low-cost MEMS sensors |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
C14 | Grant of patent or utility model | ||
GR01 | Patent grant |