A three-axis angular momentum unloading method for geosynchronous orbit satellite

By calculating and adjusting the thrust direction by a single robotic arm thrust, the triaxial angular momentum unloading of geosynchronous orbit satellites is solved, and the problems of high fuel consumption and thrust interference caused by frequent ignition in traditional methods are achieved, achieving more efficient orbit and Attitude control.

CN115626304BActive Publication Date: 2024-11-19SHANGHAI AEROSPACE CONTROL TECH INST
View PDF 0 Cites 0 Cited by

Patent Information

Application Number
CN202211268170.9
Authority / Receiving Office
CN · China
Patent Type
Patents(China)
Current Assignee / Owner
Filing Date
2022-10-17
Publication Date
2024-11-19
Estimated Expiration
2042-10-17

AI Technical Summary

Technical Problem

In the orbit and attitude maintenance control of geosynchronous orbit satellites, due to the accumulation of angular momentum caused by solar light pressure, traditional methods require frequent ignition, resulting in large fuel consumption and large interference from the thrust, making it difficult to realize triaxial angular momentum unloading.

Method used

A single robotic arm plus thrust is used to calculate the angular momentum to be unloaded under the inertia system, determine the direction and position of the thrust, and use the multi-degree of freedom movement of the robotic arm to realize triaxial angular momentum unloading, reducing the number of thrust control times and fuel consumption.

Benefits of technology

Effectively save fuel, reduce interference from thrust start on satellite attitude, suitable for traditional multi-orbit ignition and single ignition conditions, suitable for fixed and attitude maneuverable conditions, expanding the scope of application.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN115626304B_ABST
    Figure CN115626304B_ABST
Patent Text Reader

Abstract

The present invention relates to a three-axis angular momentum unloading method for a geosynchronous orbit satellite, comprising the following steps: S1, determining the angular momentum that needs to be unloaded by a thruster; S2, formulating an unloading plan according to the determined angular momentum to be unloaded; S3, executing the angular momentum unloading, and controlling a mechanical arm to adjust the thruster pointing direction at the end of the mechanical arm. When using a geosynchronous orbit satellite, thrusters need to be used regularly to perform orbit control and angular momentum unloading. Traditional satellites perform these operations separately, which consumes a lot of propellant. The present invention utilizes the thrust of regular orbit control, and uses a mechanical arm to actively deflect the thrust position and pointing direction, and can utilize the orbit control thrust to unload the satellite angular momentum. It can save fuel and reduce the number of thruster controls, thereby reducing the interference of thruster startup on the satellite attitude.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The invention relates to a three-axis angular momentum unloading method for a geosynchronous orbit satellite. Background Art

[0002] Geosynchronous orbit satellites are affected by interference forces and interference torques in orbit, and their orbits and attitudes will deviate from the nominal positions, requiring maintenance and control of the satellite orbit and attitude. Especially for geosynchronous orbit satellites with single-wing sails, under the action of solar pressure, the satellite angular momentum accumulates about 40 to 100 Nms every day. Generally, it is necessary to unload it every day to ensure that the satellite angular momentum actuator is not saturated and the satellite works normally.

[0003] For orbit maintenance control, the engine is ignited at the right time and in the right direction to generate a suitable speed increment to achieve orbit control; while maintaining the orbit, the engine thrust vector is actively deviated from the center of mass to generate the expected attitude control lever arm, and the expected attitude control torque is achieved under the action of thrust, thereby achieving attitude maintenance and control with almost no additional fuel consumption.

[0004] Installing the thruster at the end of the robotic arm can not only adjust the direction of the thruster, but also adjust the position of the thruster. In theory, it can achieve attitude and orbit control at the same time.

[0005] Advantages and necessity of the manipulator with a thruster installed at its end:

[0006] 1. Geosynchronous satellites are generally large platform satellites with large sailboards and payloads. Due to the influence of thruster plumes, it is not convenient to install thrusters on the satellite body. An effective way is to extend the thrusters out of the satellite body through a robotic arm.

[0007] 2. In terms of engineering, combined with the entire satellite layout, a set of robotic arms plus thrusters can achieve orbit and attitude control in all required directions, which can greatly save the number of thrusters required;

[0008] 3. Since the manipulator thruster can provide the optimal thrust direction and thrust position, it is equivalent to using a combination of multiple thrusters in different directions to generate a combined force, and the fuel utilization efficiency can be optimized.

[0009] 4. For some satellites that require attitude scanning or attitude non-steady value bias, the influence of attitude can be offset by controlling the robotic arm and attitude tracking, so that the thruster can be maintained in the best position and direction to achieve the expected orbit and attitude maintenance.

[0010] 5. The traditional method of attitude maintenance control requires the configuration of two sets of robotic arms, or requires ignition at two different positions on the track to complete a complete three-axis attitude maintenance control. Otherwise, only two-axis attitude control can be achieved, and three-axis attitude unloading cannot be completed. Summary of the invention

[0011] In view of the above problems, the present invention proposes a three-axis angular momentum unloading method for a geosynchronous orbit satellite, which uses a single robotic arm plus a thruster to achieve three-axis angular momentum unloading, and includes the following steps:

[0012] S1. Determine the angular momentum that the thruster needs to unload;

[0013] S2. Formulate an unloading plan based on the determined angular momentum to be unloaded and determine the thruster direction;

[0014] S3, execution of angular momentum unloading, controlling the manipulator to adjust the thruster direction at the end of the manipulator.

[0015] Furthermore, the S1 comprises the following steps:

[0016] S11, calculating the angular momentum of the three axes to be unloaded in the inertial system;

[0017] S12, calculating the attitude transfer matrix from the inertial system to the satellite system at the theoretical ignition time;

[0018] S13, converting the angular momentum to be unloaded in the inertial system into the angular momentum to be unloaded in the satellite system through the attitude transfer matrix;

[0019] S14, calculating the transfer matrix from the satellite system to the robotic arm coordinate system;

[0020] S15. The angular momentum to be unloaded in the satellite system is converted into the unloading angular momentum in the robotic arm coordinate system through the transfer matrix in S14.

[0021] Furthermore, the S2 comprises the following steps:

[0022] S21, determining an intermediate parameter of angular momentum unloading;

[0023] S22, determining the end position of the angular momentum unloading robot arm;

[0024] S23, determining the direction of the thruster at the end of the angular momentum unloading manipulator arm.

[0025] Furthermore, the S3 comprises the following steps:

[0026] S31, determining the number of reciprocating motions of the robot arm;

[0027] S32, determining the ignition interval and controlling the mechanical arm to adjust the thruster direction according to the ignition interval.

[0028] Furthermore, the angular momentum to be unloaded in the three axes in the inertial system calculated in S11 are:

[0029] delta_ATT_H_fire_x_i=-ATT_H_fire_x_i-Dx×T_day / 2;

[0030] delta_ATT_H_fire_y_i=-ATT_H_fire_y_i-Dy×T_day / 2;

[0031] delta_ATT_H_fire_z_i=-ATT_H_fire_z_i-Dz×T_day / 2;

[0032] Among them, ATT_H_fire_x_i, ATT_H_fire_y_i, ATT_H_fire_z_i are the three-axis angular momentum of the satellite in the inertial system at the next theoretical moment; Dx, Dy, Dz are the solar light pressure interference torque of the satellite in the inertial system; T_day is the number of seconds in a day, and T_day=86400s;

[0033] S12. Calculate the quaternion from the inertial system to the orbital system at the theoretical ignition time:

[0034] qio=quatmultiply([cos(0.5×u_fire)0 0sin(0.5×u_fire)],[0.5 -0.5 -0.5 0.5]);

[0035] Where u_fire is the orbital argument corresponding to the theoretical ignition time; quatmultiply(A,B) represents the multiplication operation of quaternion A and quaternion B;

[0036] Calculate the quaternion from the inertial system to the satellite system at the theoretical ignition time:

[0037] qib=quatmultiply(qio,qob);

[0038] Among them, qob is the quaternion from the satellite orbit system to the satellite system, and qob varies according to the different regions of the earth that the satellite points to;

[0039] Calculate the attitude transfer matrix from the inertial system to the satellite system at the theoretical ignition time:

[0040] Abi = quat2dcm(qib);

[0041] Among them, quat2dcm(:) means converting the quaternion in the brackets into the corresponding attitude transfer matrix;

[0042] S13, calculate the three-axis angular momentum to be unloaded ATT_H_fire_b in the satellite body coordinate system, and calculate the angular momentum to be unloaded in the satellite system:

[0043] ATT_H_fire_b=Abi×[delta_ATT_H_fire_x_i; delta_ATT_H_fire_y_i;

[0044] delta_ATT_H_fire_z_i];

[0045] S14, calculate the transfer matrix qbs from the satellite system to the robotic arm coordinate system, and the velocity increments in the three directions of the radial cutting method are Vr, Vt, and Vn respectively;

[0046] If the robotic arm is installed on the south side of the satellite (+Ys direction), the velocity increment is in the positive normal direction, that is, Vn>0;

[0047] qbs=quatmultiply(quatinv(qob),[cos(theta / 2)-Vr / sqrt(Vr 2 +Vt 2 )×sin(theta / 2)

[0048] 0-Vt / sqrt(Vr 2 +Vt 2 )×sin(theta / 2)]);

[0049] Among them, quatinv(A) is the quaternion inverse operation, and the calculation process is: A=(a0;a1;a2;a3), then quatinv(A)=(a0;-a1;-a2;-a3);

[0050] theta=arccos(|Vn / sqrt(Vr 2 +Vt 2 +Vn 2 )|);

[0051] S15. Calculate the satellite three-axis unloading angular momentum ATT_H_fire_s in the robotic arm coordinate system.

[0052] ATT_H_fire_s=inv(Abs)×ATT_H_fire_b;

[0053] Among them, inv(A) is the matrix inversion operation, Abs is the attitude transfer matrix from the robot arm coordinate system to the satellite system, Abs=quat2dcm(qsb), qsb=quatinv(qbs).

[0054] Furthermore, the Abs calculation process is:

[0055] If, qsb = quatinv (qbs) = (q0; q1; q2; q3), q0, q1, q2, q3 are the values ​​of the quaternion respectively;

[0056] Abs = [1-2(q0 2 +q3 2 ),2(q1q2+q0q3),2(q1q3-q0q2);2(q1q2-q0q3),1-2(q1 2 +q3 2 ),2(q2q3

[0057] +q0q1); 2(q1q3+q0q2), 2(q2q3-q0q1), 1-2(q1 2 +q2 2 )].

[0058] In summary, the present invention utilizes geosynchronous orbit satellites that need to periodically use thrusters to perform orbit control and angular momentum unloading, while traditional satellites perform these operations separately, which consumes more propellant.

[0059] The present invention utilizes the thrust of periodic orbit control and adopts a mechanical arm to actively deflect the thrust position and direction, and can utilize the orbit control thrust to unload the satellite angular momentum; it can save fuel and also reduce the number of thruster control times, thereby reducing the interference of thruster startup on the satellite attitude;

[0060] The present invention is not only applicable to the angular momentum unloading scheme of the traditional multiple orbital controlled ignition per track, but also applicable to the working condition of only one ignition per track, thus expanding the application scope of the present invention; the multi-degree-of-freedom motion characteristics of the mechanical arm are utilized;

[0061] The present invention is not only applicable to the satellite fixed pointing situation, but also to the attitude maneuvering situation. BRIEF DESCRIPTION OF THE DRAWINGS

[0062] Figure 1 This is a schematic diagram of the angular momentum unloading strategy using a single robotic arm plus thruster in the present invention. DETAILED DESCRIPTION

[0063] The following is a further detailed description of a three-axis angular momentum unloading method for a geosynchronous orbit satellite proposed by the present invention in conjunction with the accompanying drawings and specific implementation methods.

[0064] S1. Determine the angular momentum that needs to be unloaded during the operation of the thruster;

[0065] S2. formulating an unloading plan according to the determined angular momentum to be unloaded;

[0066] S3. Angular momentum unloading is performed by controlling the manipulator to adjust the thruster direction at the end of the manipulator.

[0067] S1 includes the following steps:

[0068] S11. Calculate the angular momentum of the three axes to be unloaded in the inertial system according to the following formula, in Nms:

[0069] delta_ATT_H_fire_x_i=-ATT_H_fire_x_i-Dx×T_day / 2;

[0070] delta_ATT_H_fire_y_i=-ATT_H_fire_y_i-Dy×T_day / 2;

[0071] delta_ATT_H_fire_z_i=-ATT_H_fire_z_i-Dz×T_day / 2;

[0072] Among them, ATT_H_fire_x_i, ATT_H_fire_y_i, ATT_H_fire_z_i are the three-axis angular momentum of the satellite inertial system at the next theoretical moment, respectively, in Nms; Dx, Dy, Dz are the solar light pressure interference torque of the satellite three axes in the inertial system (the solar light pressure interference torque is generally approximately a constant in the inertial system), in Nm; T_day is the number of seconds in a day, and T_day=86400s.

[0073] S12, calculating the attitude transfer matrix from the inertial system to the satellite system at the theoretical ignition time;

[0074] Calculate the quaternion from the inertial system to the orbital system at the theoretical ignition time:

[0075] qio=quatmultiply([cos(0.5×u_fire)0 0sin(0.5×u_fire)],[0.5 -0.5 -0.5 0.5])

[0076] Wherein, u_fire is the orbital argument corresponding to the theoretical ignition time, in rad; quatmultiply(A,B) represents the multiplication operation of quaternion A and quaternion B;

[0077] Calculate the quaternion from the inertial system to the satellite system at the theoretical ignition time:

[0078] qib=quatmultiply(qio,qob);

[0079] Among them, qob is the quaternion from the satellite orbit system to the satellite system. This value is related to the characteristics of the satellite mission and varies according to the different regions of the earth that the satellite is pointing to.

[0080] Calculate the attitude transfer matrix from the inertial system to the satellite system at the theoretical ignition time:

[0081] Abi = quat2dcm(qib);

[0082] Among them, quat2dcm(A) means converting the quaternion A into the corresponding attitude transfer matrix;

[0083] S13. Calculate the three-axis angular momentum to be unloaded ATT_H_fire_b in the satellite body coordinate system, in Nms:

[0084] Calculate the angular momentum of the satellite to be unloaded in this system, in Nms:

[0085] ATT_H_fire_b=Abi×[delta_ATT_H_fire_x_i; delta_ATT_H_fire_y_i;

[0086] delta_ATT_H_fire_z_i];

[0087] S14, calculating the transfer matrix qbs from the satellite system to the robotic arm coordinate system;

[0088] The velocity increments in the three directions of the radial cutting method are Vr, Vt, and Vn respectively.

[0089] If the robotic arm is installed on the south side of the satellite (+Ys direction), the velocity increment is in the positive normal direction, that is, Vn>0.

[0090] qbs=quatmultiply(quatinv(qob),[cos(theta / 2)-Vr / sqrt(Vr 2 +Vt 2 )×sin(theta / 2)

[0091] 0-Vt / sqrt(Vr 2 +Vt 2 )×sin(theta / 2)]);

[0092] Among them, quatinv(A) is the quaternion inverse operation, and the calculation process is: A=(a0;a1;a2;a3), then quatinv(A)=(a0;-a1;-a2;-a3);

[0093] theta=arccos(|Vn / sqrt(Vr 2 +Vt 2 +Vn 2 )|);

[0094] S15, calculate the satellite three-axis unloading angular momentum ATT_H_fire_s in the robotic arm coordinate system;

[0095] ATT_H_fire_s=inv(Abs)×ATT_H_fire_b;

[0096] Among them, inv(A) is the matrix inversion operation, Abs is the attitude transfer matrix from the robot arm coordinate system to the satellite system, and the attitude transfer matrix Abs is obtained by converting the quaternion qsb, and the quaternion qsb and the quaternion qbs are the inverse operations of the quaternions; qsb = quatinv(qbs) = (q0; q1; q2; q3), Abs = quat2dcm(qsb); Specifically,

[0097] Abs = [1-2(q0 2 +q3 2 ),2(q1q2+q0q3),2(q1q3-q0q2);2(q1q2-q0q3),1-2(q1 2 +q3 2 ),2(q2q3

[0098] +q0q1); 2(q1q3+q0q2), 2(q2q3-q0q1), 1-2(q1 2 +q2 2 )].

[0099] ATT_H_fire_s is a three-dimensional vector that can be expressed as (ATT_H_fire_s(1); ATT_H_fire_s(2); ATT_H_fire_s(3)); where:

[0100] ATT_H_fire_x_s=ATT_H_fire_s(1);

[0101] ATT_H_fire_y_s=ATT_H_fire_s(2);

[0102] ATT_H_fire_z_s=ATT_H_fire_s(3).

[0103] S21, determining an intermediate parameter of angular momentum unloading;

[0104] If sqrt(ATT_H_fire_x_s 2 +ATT_H_fire_y_s 2 +ATT_H_fire_z_s 2)<yuzhi_1, where yuzhi_1 represents the first judgment threshold for unloading. When this formula is satisfied, it means that triaxial angular momentum unloading does not need to be performed this time. Then: R = 0, delta_L = 0, Alpha = 0, Beta = 0; Variable definitions are as Figure 1 shown:

[0105] R is the equivalent arm of angular momentum unloading in the XsOZs plane, unit m; delta_L is the arm of angular momentum unloading in the Ys axis, unit m; Alpha is the angle of robotic arm deflection required to generate angular momentum unloading in the Ys direction, unit rad; Beta is the angle between the projection of the end position of the robotic arm in the XsOZs plane and Xs, unit rad.

[0106] Otherwise, if sqrt(ATT_H_fire_x_s 2 +ATT_H_fire_z_s 2 )<yuzhi_2, where yuzhi_2 is the second judgment threshold for unloading. When this formula is satisfied, it means that the angular momentum in the XsOZs plane does not need to be unloaded this time, but the angular momentum in the Ys axis needs to be unloaded;

[0107] R = 0, delta_L = 2 × R_limit, Beta = pi / 4, Alpha = arcsin(-ATT_H_fire_y_s / F / (0.5 × mod((ufire_t - ufire_0), 2 × pi) / we) / delta_L);

[0108] Among them, R_limit is the maximum radius allowed for the end position of the robotic arm for angular momentum unloading in the XsOZs plane, unit, m; pi represents the circumference ratio; F is the thrust magnitude, unit N; ufire_t is the orbital argument corresponding to the end point of ignition, unit rad; ufire_0 is the orbital argument corresponding to the start point of ignition, unit rad; we is the satellite orbital angular velocity (also the Earth's autonomous angular velocity when it is a geostationary orbit), unit rad.

[0109] If |Alpha| > alpha_yuzhi, then Alpha = sign(Alpha) × alpha_yuzhi;

[0110] Among them, alpha_yuzhi is the maximum value allowed for the angle by which the end of the robotic arm deviates from the original direction when unloading in the Ys direction, unit rad. This number is uploaded from the ground according to the accumulation of angular momentum in the Ys direction and does not exceed pi / 6 (30°).

[0111] Otherwise, if |ATT_H_fire_y_s| < yuzhi_1, it means that the angular momentum in the XsOZs plane needs to be unloaded this time, but the angular momentum in the Ys axis does not need to be unloaded;

[0112] R = sqrt(ATT_H_fire_x_s 2 +ATT_H_fire_z_s 2 ) / F / (mod((ufire_t-ufire_0),2×

[0113] pi) / we);

[0114] Among them, F is the thrust size, unit N; ufire_t is the orbital argument corresponding to the ignition end point, unit rad; ufire_0 is the orbital argument corresponding to the ignition start point, unit rad; we is the satellite orbital angular velocity (when it is a geosynchronous orbit, it is also the Earth's angular velocity), unit rad; sqrt means the quadratic root, and mod(x,y) means the remainder of x divided by y.

[0115] If R>R_limit, then R=R_limit, delta_L=0, Alpha=0, Beta=atan2(-ATT_H_fire_x_s,-ATT_H_fire_z_s);

[0116] Among them, the range of atan2(y,x) is -pi to pi, specifically:

[0117] When x>0, atan2(y,x)=arctan(y / x), and the range is (-pi / 2,pi / 2);

[0118] When x<0, atan2(y,x)=pi+arctan(y / x), the range is (pi / 2,1.5*pi);

[0119] When x=0, and y>0, atan2(y,x)=pi / 2;

[0120] When x=0 and y<0, atan2(y,x)=-pi / 2;

[0121] When x=0 and y=0, atan2(y,x)=0;

[0122] Otherwise, it means that the angular momentum of the three axes needs to be unloaded.

[0123] R = sqrt(ATT_H_fire_x_s 2 +ATT_H_fire_z_s 2 ) / F / (mod((ufire_t-ufire_0),2×

[0124] pi) / we)

[0125] If R>R_limit, then R=R_limit, delta_L=0.2,

[0126] Alpha=arcsin(-ATT_H_fire_y_s / F_lowthrust / (0.5×mod((ufire_t-ufire_0),2×pi) / we) / delta_L);

[0127] If |Alpha|>alpha_yuzhi, then Alpha=sign(Alpha)×alpha_yuzhi,

[0128] Beta = atan2(-Xs,-Zs);

[0129] It should be noted that in order to ensure that the above logic is valid, it must satisfy: yuzhi_1>yuzhi_2;

[0130] S22, determining the end position of the angular momentum unloading robot arm;

[0131] Projection of the robot outer ring unloading position 1 on the Xs axis Pos_thrust_x_1: unit m;

[0132] Pos_thrust_x_1=(R+0.5×delta_L)×cos(Beta);

[0133] Projection of the robot outer ring unloading position 1 on the Zs axis Pos_thrust_z_1: unit m;

[0134] Pos_thrust_z_1=-(R+0.5×delta_L)×sin(Beta);

[0135] Projection of the unloading position 2 of the inner ring of the robot arm on the Xs axis Pos_thrust_x_2: unit m;

[0136] Pos_thrust_x_2=(R-0.5×delta_L)×cos(Beta);

[0137] Projection of the unloading position 2 of the inner ring of the robot arm on the Zs axis Pos_thrust_z_2: unit m;

[0138] Pos_thrust_z_2=-(R-0.5×delta_L)×sin(Beta);

[0139] S23, determining the direction of the thruster at the end of the angular momentum unloading manipulator arm;

[0140] n_x=ATT_H_fire_z_s / sqrt(ATT_H_fire_x_s 2 +ATT_H_fire_z_s 2 )

[0141] n_y=0;

[0142] n_z=-ATT_H_fire_x_s / sqrt(ATT_H_fire_x_s 2 +ATT_H_fire_z_s 2 );

[0143] n1 = [n_x n_y n_z];

[0144] n2 = [-n_x - n_y - n_z];

[0145] The thruster pointing to vec1 corresponds to the unloading position 1 of the outer ring of the robot arm;

[0146] vec1=cos(Alpha)×[0 1 0]+(1-cos(Alpha))×(dot(n1,[0 1 0]))×n1+sin(Alpha)×(cross(n1,[0 1 0]));

[0147] The thruster pointing to vec2 corresponds to the unloading position 2 of the inner ring of the robot arm;

[0148] vec2=cos(Alpha)×[0 1 0]+(1-cos(Alpha))×(dot(n2,[0 1 0]))×n2+sin(Alpha)×(cross(n2,[0 1 0]));

[0149] Among them: dot(A,B) is the dot product of two 3×1 vectors A and B; cross(A,B) is the cross product of two 3×1 vectors A and B;

[0150] S31. Determine the number of reciprocating motions of the robot arm N_cycle, where N_cycle is an integer greater than or equal to 1. The smaller N_cycle is, the greater the interference to the other two axes when unloading the Ys axis, and the smaller the number of robot arm motions; vice versa. In actual engineering, generally within the allowable range, the smaller the N_cycle, the better. In actual engineering, N_cycle is between 1 and 6.

[0151] S32, in the ignition interval of 0 to 1 / (2×N_cycle), ..., 2×N_cycle-2 / (2×N_cycle) to 2×N_cycle-1 / (2×N_cycle), the end of the manipulator is at the unloading position 1 of the outer ring of the manipulator, and the manipulator is controlled to point the thruster to vec1;

[0152] In the ignition interval of 1 / (2×N_cycle)~2 / (2×N_cycle),…,2×N_cycle-1 / (2×N_cycle)~1, the end of the robotic arm is at the unloading position 2 of the inner circle of the robotic arm, and the robotic arm is controlled to make the thruster point to vec2.

[0153] The present invention has the following beneficial effects:

[0154] 1. Geosynchronous orbit satellites require regular use of thrusters for orbit control and angular momentum unloading. Traditional satellites perform these operations separately, which consumes a lot of propellant. The present invention uses the thrust of regular orbit control and uses a mechanical arm to actively deflect the thrust position and direction, and can use orbit control thrust to unload satellite angular momentum. This saves fuel and can also reduce the number of thruster controls, thereby reducing the interference of thruster activation on satellite attitude.

[0155] 2. The present invention is not only applicable to the angular momentum unloading scheme of the conventional multiple orbital ignitions per track, but also applicable to the working condition of only one ignition per track, thus expanding the application scope of the present invention;

[0156] 3. By utilizing the multi-degree-of-freedom motion characteristics of the robotic arm, the present invention is not only applicable to the satellite fixed pointing situation, but also to the attitude maneuvering situation (attitude maneuvering, i.e., qob is time-varying).

[0157] Although the content of the present invention has been described in detail through the above preferred embodiments, it should be appreciated that the above description should not be considered as a limitation of the present invention. After reading the above content, it will be apparent to those skilled in the art that various modifications and substitutions of the present invention will occur. Therefore, the protection scope of the present invention should be limited by the appended claims.

Claims

1. A three-axis angular momentum unloading method for a geosynchronous orbit satellite, characterized in that: The following steps are involved: S1. Determine the angular momentum that the thruster needs to unload; S2. Formulate an unloading plan based on the determined angular momentum to be unloaded and determine the thruster direction; S3, execution of angular momentum unloading, controlling the manipulator to adjust the thruster direction at the end of the manipulator; The S1 comprises the following steps: S11, calculating the angular momentum of the three axes to be unloaded in the inertial system; S12, calculating the attitude transfer matrix from the inertial system to the satellite system at the theoretical ignition time; S13, converting the angular momentum to be unloaded in the inertial system into the angular momentum to be unloaded in the satellite system through the attitude transfer matrix; S14, calculating the transfer matrix from the satellite system to the robotic arm coordinate system; S15, converting the angular momentum to be unloaded in the satellite system into the unloading angular momentum in the robotic arm coordinate system through the transfer matrix in S14; The angular momentums to be unloaded in the three axes in the inertial system calculated in S11 are: delta_ATT_H_fire_x_i=-ATT_H_fire_x_i-Dx×T_day / 2; delta_ATT_H_fire_y_i=-ATT_H_fire_y_i-Dy×T_day / 2; delta_ATT_H_fire_z_i=-ATT_H_fire_z_i-Dz×T_day / 2; Among them, ATT_H_fire_x_i, ATT_H_fire_y_i, ATT_H_fire_z_i are the three-axis angular momentum of the satellite in the inertial system at the next theoretical moment; Dx, Dy, Dz are the solar light pressure interference torques of the three axes of the satellite in the inertial system; T_day is the number of seconds in a day, and T_day=86400s.

2. The three-axis angular momentum unloading method for a geosynchronous orbit satellite according to claim 1, characterized in that: The S2 comprises the following steps: S21, determining an intermediate parameter of angular momentum unloading; S22, determining the end position of the angular momentum unloading robot arm; S23, determining the direction of the thruster at the end of the angular momentum unloading manipulator arm.

3. The three-axis angular momentum unloading method for a geosynchronous orbit satellite according to claim 1, characterized in that: The S3 comprises the following steps: S31, determining the number of reciprocating motions of the robot arm; S32, determining the ignition interval and controlling the mechanical arm to adjust the thruster direction according to the ignition interval.

4. The three-axis angular momentum unloading method for a geosynchronous orbit satellite according to claim 1, characterized in that: S12. Calculate the quaternion from the inertial system to the orbital system at the theoretical ignition time: qio=quatmultiply([cos(0.5×u_fire);0;0;sin(0.5×u_fire)],[0.5;-0.5;-0.5;0.5]); Where u_fire is the orbital argument corresponding to the theoretical ignition time; quatmultiply(A,B) represents the multiplication operation of quaternion A and quaternion B; Calculate the quaternion from the inertial system to the satellite system at the theoretical ignition time: qib=quatmultiply(qio,qob); Among them, qob is the quaternion from the satellite orbit system to the satellite system, and qob varies according to the different regions of the earth that the satellite points to; Calculate the attitude transfer matrix from the inertial system to the satellite system at the theoretical ignition time: Abi = quat2dcm(qib); Among them, quat2dcm(): means converting the quaternion in the brackets into the corresponding attitude transfer matrix.

5. The three-axis angular momentum unloading method for a geosynchronous orbit satellite as claimed in claim 4, characterized in that: S13, calculate the three-axis angular momentum to be unloaded ATT_H_fire_b in the satellite body coordinate system, and calculate the angular momentum to be unloaded in the satellite system: ATT_H_fire_b=Abi×[delta_ATT_H_fire_x_i;delta_ATT_H_fire_y_i; delta_ATT_H_fire_z_i].

6. The three-axis angular momentum unloading method for a geosynchronous orbit satellite as claimed in claim 5, characterized in that: S14, calculate the transfer matrix qbs from the satellite system to the robotic arm coordinate system, and the velocity increments in the three directions of the radial cutting method are Vr, Vt, and Vn respectively; If the robotic arm is installed on the south side of the satellite, the velocity increment is in the positive normal direction, that is, Vn>0; qbs=quatmultiply(quatinv(qob);[cos(theta / 2)-Vr / sqrt(Vr 2 +Vt 2 )×sin(theta / 2); 0;-Vt / sqrt(Vr 2 +Vt 2 )×sin(theta / 2)]); Among them, quatinv(A) is the quaternion inverse operation, and the calculation process is: A=(a0;a1;a2;a3) then quatinv(A)=(a0;-a1;-a2;-a3); theta=arccos(|Vn / sqrt(Vr 2 +Vt 2 +Vn 2 )|)。 7. The three-axis angular momentum unloading method for a geosynchronous orbit satellite as claimed in claim 6, characterized in that: S15. Calculate the satellite three-axis unloading angular momentum ATT_H_fire_s in the robotic arm coordinate system. ATT_H_fire_s=inv(Abs)×ATT_H_fire_b; Among them, inv(A) is the matrix inversion operation, Abs is the attitude transfer matrix from the robot arm coordinate system to the satellite system, Abs=quat2dcm(qsb), qsb=quatinv(qbs).

8. The three-axis angular momentum unloading method for a geosynchronous orbit satellite as claimed in claim 7, characterized in that: The Abs calculation process is: If, qsb = quatinv (qbs) = (q0; q1; q2; q3), q0, q1, q2, q3 are the values ​​of the quaternion qsb respectively; Abs=[1-2(q0 2 +q3 2 ),2(q1q2+q0q3),2(q1q3-q0q2);2(q1q2-q0q3),1-2(q1 2 +q3 2 ),2(q2q3+ <h2 style=";text-align:left;direction:ltr">q0q1);2(q1q3+q0q2),2(q2q3-q0q1),1-2(q1<h2 style=";text-align:left;direction:ltr"> 2 <h2 style=";text-align:left;direction:ltr"> +q2<h2 style=";text-align:left;direction:ltr"> 2 <h2 style=";text-align:left;direction:ltr"> )]。