Attitude and orbit coupling control method for spacecraft to linearly approach space target in consideration of thruster constraint
By considering the thrust layout and size of the spacecraft, the problem of unconstrained thrust layout and thrust size constraints in the prior art is solved, and the accuracy of the spacecraft in the linear approach mission is achieved. Attitude and track control.
Patent Information
- Application Number
- CN202411174569.X
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Priority Date
- 2024-03-15
- Filing Date
- 2024-08-26
- Publication Date
- 2024-11-29
- Estimated Expiration
- 2044-08-26
AI Technical Summary
The existing attitude orbit control method for spacecraft to approach space targets in a straight line cannot effectively consider the constraints of the thrust layout and thrust magnitude, resulting in the inability to accurately and reliably obtain the control instructions of attitude and orbit control thrust, especially in the thrust posture. Under the influence of rail coupling.
A spacecraft linear approaching orbit coupling control method considering the constraints of thrusts is proposed. By distributing the thrust to the attitude and orbit control channels, planning the maneuver path, designing the attitude maneuver control law and orbit control law, and using pulse width modulation to the The control command is converted into a power-off command that responds to the thrust, giving priority to attitude control and combining with track control.
It realizes the accurate and reliable calculation of the control instructions of various posture control and orbital control thrusts in the straight line approach task, meets the layout and size constraints of the thrust, and improves control accuracy and reliability.
Smart Images

Figure CN119045330A_ABST
Abstract
Description
Technical Field
[0001] The present invention belongs to the technical field of spacecraft dynamics control, and in particular relates to an attitude-orbit coupling control method for a spacecraft to approach a space target in a straight line. Background Art
[0002] In recent years, with the rapid development of the aerospace industry, the missions of various countries' spacecraft have gradually developed in a more complex direction. The concepts of on-orbit services and space attack and defense have become hot issues in the space field, including repairing failed spacecraft, cleaning up space debris, and conducting reconnaissance or destruction of enemy target spacecraft. In completing the above tasks, spacecraft are required to observe the target at close range. In order to ensure the stability of the line of sight of the sensor, the spacecraft is required to approach the target in a straight line, which can not only ensure that the line of sight angle changes within a very small range, but also ensure the safety of the motion trajectory.
[0003] In addition, in engineering practice, the layout of thrusters and the thrust size of thrusters are determined by the overall design, and the design of attitude and orbit control schemes regards thruster parameters as given inputs. When the jet of a single thruster is working, it simultaneously generates forces and torques applied to the spacecraft body. This characteristic presents an inherent attitude and orbit coupling feature. In engineering, due to conditions such as the installation position of the fuel tank, pipeline laying, or jet flow regulation, the thruster layout is usually installed asymmetrically. This coupling characteristic is more obvious, which brings difficulties to controller design and task completion. Traditional spacecraft close-range approach control adopts a state feedback scheme, but does not take the thruster layout and thrust size constraints into consideration in the design process, nor does it carry out detailed design of the mission requirements for strict linear approximation, especially under the influence of thruster attitude and orbit coupling, which is not conducive to direct use in engineering.
[0004] In summary, the existing attitude and orbit control methods for spacecraft approaching space targets in a straight line do not take the thruster layout and thrust size constraints into consideration during the design process. In addition, due to the influence of the thruster attitude-orbit coupling, the existing methods cannot accurately and reliably obtain the attitude control thruster and orbit control thruster control instructions when the spacecraft approaches the space target in a straight line. Summary of the invention
[0005] The purpose of the present invention is to solve the problem that the existing methods cannot accurately and reliably obtain the control instructions of the attitude control thrusters and orbit control thrusters when the spacecraft approaches the space target in a straight line, and to propose an attitude and orbit coupling control method for the spacecraft approaching the space target in a straight line taking into account the thruster constraints.
[0006] The technical solution adopted by the present invention to solve the above technical problems is:
[0007] A method for attitude-orbit coupling control of a spacecraft approaching a space target in a straight line considering thruster constraints, the method specifically comprising the following steps:
[0008] Step 1: Allocate the thrusters to the attitude and orbit control channels according to the layout and thrust size of the plurality of thrusters;
[0009] Step 2: planning a maneuvering path for adjusting the spacecraft from an initial zero attitude to a desired straight approach attitude, and designing an attitude maneuvering control law for adjusting the spacecraft from an initial zero attitude to a desired straight approach attitude;
[0010] Step 3: Design an attitude stabilization feedforward compensation control law based on the orbit control disturbance torque during the process of the spacecraft approaching the target in a straight line;
[0011] Step 4: Obtain the orbit control thrust output limiting coefficient according to the maximum attitude control capability, and then design a three-axis orbit control law based on feedback linearization according to the orbit control thrust output limiting coefficient;
[0012] Step 5: Use the pulse width modulation method to convert the control instructions from step 2 to step 4 into the on / off instructions of the thruster response.
[0013] Furthermore, in step 1, the thrusters are allocated to the attitude and orbit control channels, and the specific allocation principle is:
[0014] 1) For any channel of attitude control, when the channel outputs control torque, the control force output by the channel is zero; when a certain axis of the channel outputs control torque, the control torques of the other two axes of the channel are zero;
[0015] 2) For any channel of track control, when the channel outputs control force, the control torque output by the channel is zero; when a certain axis of the channel outputs control force, the control forces of the other two axes of the channel are both zero;
[0016] 3) Prioritize attitude control, then orbit control.
[0017] Furthermore, the desired straight-line approach posture is: the axis of maximum orbital control thrust is along the orbit radial direction.
[0018] Furthermore, the design adjusts the spacecraft from the initial zero attitude to the desired straight approach attitude attitude maneuver control law; the specific process is:
[0019] The dynamic equation of spacecraft attitude error is:
[0020]
[0021] Where J is the moment of inertia of the spacecraft, ω is the angular velocity of the spacecraft, and ω × is the cross product matrix of ω, ω d is the desired reference angular velocity of the spacecraft, Yes dis the first-order derivative of, τ is the output torque of the thruster acting on the spacecraft, [q v q0] is the spacecraft attitude quaternion, q v × Yes v The cross product matrix, [q vd q 0d ] is the reference attitude quaternion expected by the spacecraft, the superscript T represents the transpose of the matrix, [q ve q 0e ] is the attitude error quaternion, for q ve The first derivative of for q 0e The first derivative of e is the coordinate transformation matrix of the error quaternion, ω e is the error angular velocity of the spacecraft, Yes e The first derivative of ;
[0022] Design attitude maneuver control law:
[0023]
[0024] In the formula, τ a is the attitude maneuver control law, q e =[q ve q 0e ] T , ω e The cross product matrix, K p and K d To control the gain.
[0025] Furthermore, the calculation method of the reference attitude quaternion expected by the spacecraft is:
[0026] After calculating the Euler axis angle θ between the straight approach posture and the initial zero posture, perform Bang-Bang path planning on the Euler axis angle θ to obtain the new Euler axis angle θ d , and then the new Euler axis angle θ d Transformed into the desired reference attitude quaternion q vd and q 0d .
[0027] Furthermore, the specific process of step 3 is as follows:
[0029] τ' ax =τ dx ,τ' ay =τ dy ,τ' az =τ dz (3)
[0030] Among them, τ dx It is the X generated by orbital control b Disturbance torque of the shaft, τ dy Y is generated by orbit control b Disturbance torque of the shaft, τ dz is the Z generated by orbital control b Disturbance torque of the shaft, τ' ax Yes X b Compensation torque of the shaft, τ' ay Yes b Compensation torque of the shaft, τ' az It's Z b Compensation torque of the shaft;
[0031] After attitude stabilization feedforward compensation, X b The attitude stabilization control command of the axis is τ ax +τ' ax , Y b The attitude stabilization control command of the axis is τ ay +τ' ay , Z b The attitude stabilization control command of the axis is τ az +τ' az , τ ax is the attitude maneuver control law τ a Medium X b Axis control command, τ ay is the attitude maneuver control law τ a Middle Y b Axis control command, τ az is the attitude maneuver control law τ a Middle Z b Axis control instructions.
[0032] Furthermore, the orbit control thrust output limiting coefficient is obtained according to the maximum attitude control capability, which is specifically:
[0033] For X b Axis, if X b The disturbance torque generated by the orbit control thruster of the axis when the duty cycle is 1 does not exceed the maximum compensation capability of the attitude control or X b If there is no orbital control interference torque on the axis, then X b The axis's orbit control thrust output limit coefficient is 1; otherwise, if X b When the duty cycle of the orbit control thruster of the axis is 1, the disturbance torque generated exceeds the maximum compensation capability of the attitude control. Then, the X b The axis's orbital control thrust output limiting coefficient;
[0034] Y b Axis and Z b The method of obtaining the orbit control thrust output limit coefficient of the axis is the same as that of the Xb The axes are the same.
[0035] Furthermore, the three-axis orbit control law based on feedback linearization is designed according to the orbit control thrust output limiting coefficient, which is specifically:
[0036] The dynamic model of the relative motion between the spacecraft and the space target is as follows:
[0037]
[0038] Where [x, y, z] is the LVLH coordinate system O l X l Y l Z l The position of the spacecraft relative to the space target, x is the orbital radial O l X l The coordinate of the axis, y is the tangent direction of the orbit O l Y l The coordinates of the axis, z is the orbital normal O l Z l axis coordinates; n is the magnitude of the orbital angular velocity, u x 、u y and u z O l X l Axis, O l Y l Axis and O l Z l Axis track control quantity, is the first-order derivative of x, is the second-order derivative of x, is the first-order derivative of y, is the second-order derivative of y, is the second-order derivative of z;
[0039] The three-axis orbit control law based on feedback linearization is designed as:
[0040]
[0041] In the formula, [k px ,k dx ,k py ,k dy ,k pz ,k dz ] is the control gain, y d is the reference tangential motion trajectory after Bang-Bang path planning, for y d The first derivative of for y d The second-order derivative of is the second-order derivative of z. The maximum tangential velocity and maximum acceleration in the parameters of Bang-Bang path planning satisfy the inequality constraints of formula (9):
[0042]
[0043] In the formula, u x,max =F x / m is the maximum unit mass thrust provided in radial direction, u y,max =F y / mThe maximum unit mass thrust provided in the tangential direction, m is the mass of the spacecraft, F x is the radial thrust, F y The thrust provided in the tangential direction, n y Y b The axis's orbital control thrust output limiting coefficient, represent The upper limit of represent represents the upper limit of , and |·| represents the absolute value.
[0044] Furthermore, the attitude maneuver control command is converted into a thruster response command; specifically:
[0045] The duty cycle command of the three-axis attitude control thruster is:
[0046]
[0047] Where, T x , T y and T z When the duty cycle is 100%, X b Axis, Y b Axis and Z b Maximum moment of the shaft; τ ax , τ ay and τ az X b Axis, Y b Axis and Z b Axis attitude maneuver control command; D ax , D ay and D az X b Axis, Y b Axis and Z b Duty cycle of the axis attitude control thruster, sign(·) represents the sign function, and min(·) represents the minimum value;
[0048] D ax , D ay and D az Assign thrusters to each attitude control channel and obtain the duty cycle and start-up time of each attitude control thruster;
[0049] Similarly, the attitude stability feedforward compensation control command is converted into a thruster response command.
[0050] Furthermore, the three-axis orbit control law is converted into thruster response instructions; specifically:
[0051] The duty cycle command of the three-axis orbit control thruster is:
[0052]
[0053] In the formula, u z,max =F z / m is the maximum unit mass thrust provided in the normal direction, F z The thrust provided in the normal direction, n x 、n y and n z X b Axis, Y b Axis and Z b Thrust output limiting factor of the shaft, D ox , D oy and D oz X b Axis, Y b Axis and Z b Duty cycle of axis orbit control thrusters;
[0054] D ox , D oy and D oz The thrusters assigned to each orbit control channel obtain the duty cycle and start-up time of each orbit control thruster.
[0055] The beneficial effects of the present invention are:
[0056] Aiming at the spacecraft's straight-line approach observation mission, the present invention combines the actual needs of straight-line approach to space targets, considers thruster layout and thrust size constraints as inputs for control scheme design, and proposes an attitude and orbit control scheme design method, which can accurately and reliably calculate the control instructions of each attitude control thruster and orbit control thruster. BRIEF DESCRIPTION OF THE DRAWINGS
[0057] Figure 1 This is a flow chart of an attitude-orbit coupling control method for a spacecraft approaching a space target in a straight line considering thruster constraints of the present invention;
[0058] Figure 2 A schematic diagram of the thrust direction and installation layout of a spacecraft provided in an embodiment of the present invention;
[0059] Figure 3 A schematic diagram of Euler axis-angle Bang-Bang path planning provided by an embodiment of the present invention;
[0060] Figure 4 A schematic diagram of the Bang-Bang path planning for orbital radial motion provided by an embodiment of the present invention;
[0061] Figure 5 Design a flow chart for the attitude and orbit coupling control scheme of the present invention;
[0062] Figure 6 A structural diagram of a posture and trajectory control system for approaching a target in a straight line provided by an embodiment of the present invention;
[0063] Figure 7 A straight-line approach trajectory diagram of a spacecraft in the LVLH coordinate system provided by an embodiment of the present invention;
[0064] Figure 8 A curve showing the change of the spacecraft position over time during the approach process provided by an embodiment of the present invention;
[0065] Fig. 9 A curve showing the change of the spacecraft speed over time during the approach process provided by an embodiment of the present invention;
[0066] Fig.10 A curve showing the change of the Euler angle of a spacecraft over time during the approach process provided by an embodiment of the present invention;
[0067] Fig.11 A curve showing the change of the Euler angular velocity of a spacecraft over time during the approach process provided by an embodiment of the present invention;
[0068] Fig.12 A spacecraft thruster operating duty cycle curve during the approach process provided by an embodiment of the present invention. DETAILED DESCRIPTION
[0069] Specific implementation method 1. Combination Figure 1 This embodiment describes an attitude-orbit coupling control method for a spacecraft approaching a space target in a straight line considering thruster constraints, and the method specifically includes the following steps:
[0070] Step 1: Allocate the thrusters to the attitude and orbit control channels according to the layout and thrust size of the plurality of thrusters;
[0071] Step 2: planning a maneuvering path for adjusting the spacecraft from an initial zero attitude to a desired straight approach attitude, and designing an attitude maneuvering control law for adjusting the spacecraft from an initial zero attitude to a desired straight approach attitude;
[0072] Step 3: Design an attitude stabilization feedforward compensation control law based on the orbit control disturbance torque during the process of the spacecraft approaching the target in a straight line;
[0073] Step 4: Obtain the orbit control thrust output limiting coefficient according to the maximum attitude control capability, and then design a three-axis orbit control law based on feedback linearization according to the orbit control thrust output limiting coefficient;
[0074] Step 5: Use the pulse width modulation method to convert the control instructions from step 2 to step 4 into the on / off instructions of the thruster response.
[0075] Under the constraints of thruster layout and thrust size, the attitude control design and orbit control design show strong coupling characteristics in the entire controller design process. The control quantity output by the algorithm is strictly smaller than the capacity of the thruster, which is conducive to engineering implementation.
[0076] Specific implementation method 2: This implementation method is different from the specific implementation method 1 in that, in step 1, the thrusters are allocated to the control channels of attitude and orbit. The specific allocation principle is:
[0077] 1) For any channel of attitude control, when the channel outputs control torque, the control force output by the channel is zero; when a certain axis of the channel outputs control torque, the control torques of the other two axes of the channel are zero;
[0078] When each channel of the attitude control satisfies condition 1), attitude control is satisfied;
[0079] 2) For any channel of track control, when the channel outputs control force, the control torque output by the channel is zero; when a certain axis of the channel outputs control force, the control forces of the other two axes of the channel are both zero;
[0080] When each channel of the track control meets condition 2), the track control is satisfied;
[0081] 3) Prioritize attitude control, then orbit control.
[0082] It should be noted that giving priority to attitude control and then orbit control means: if it is difficult to meet both conditions 1) and 2) at the same time due to the limitation of the number, layout or size of thrusters, attitude control shall be given priority, that is, condition 1) shall be met first.
[0083] The other steps and parameters are the same as those in the first embodiment.
[0084] Specific implementation method three: This implementation method is different from specific implementation methods one or two in that the desired straight-line approach posture is: the axis with the maximum track control thrust is along the track radial direction.
[0085] The other steps and parameters are the same as those in the first or second embodiment.
[0086] Specific implementation method 4: This implementation method is different from one of the specific implementation methods 1 to 3 in that the design adjusts the attitude maneuver control law of the spacecraft from the initial zero attitude to the desired straight approach attitude; the specific process is:
[0087] The dynamic equation of spacecraft attitude error is:
[0088]
[0089] Where J is the moment of inertia of the spacecraft, ω is the angular velocity of the spacecraft, and ω × is the cross product matrix of ω, ω d is the desired reference angular velocity of the spacecraft, Yes d is the first-order derivative of, τ is the output torque of the thruster acting on the spacecraft, [q v q0] is the spacecraft attitude quaternion, q v × Yes v The cross product matrix, [q vd q 0d ] is the reference attitude quaternion expected by the spacecraft, the superscript T represents the transpose of the matrix, [q ve q 0e ] is the attitude error quaternion, for q ve The first derivative of for q 0e The first derivative of e is the coordinate transformation matrix of the error quaternion, ω e is the error angular velocity of the spacecraft, Yes e The first derivative of ;
[0090] Design attitude maneuver control law:
[0091]
[0092] In the formula, τ a is the attitude maneuver control law, q e =[q ve q 0e ] T , ω e The cross product matrix, K p and K d To control the gain.
[0093] The other steps and parameters are the same as those in Specific Embodiments 1 to 3.
[0094] Specific implementation method 5: This implementation method is different from specific implementation methods 1 to 4 in that the calculation method of the reference attitude quaternion expected by the spacecraft is:
[0095] After calculating the Euler axis angle θ between the straight approach posture and the initial zero posture, perform Bang-Bang path planning on the Euler axis angle θ to obtain the new Euler axis angle θ d , and then the new Euler axis angle θ d Transformed into the desired reference attitude quaternion q vd and q 0d .
[0096] The other steps and parameters are the same as those in Specific Embodiments 1 to 4.
[0097] Specific implementation method 6: This implementation method is different from specific implementation methods 1 to 5 in that the specific process of step 3 is as follows:
[0098] The structure diagram of the attitude control system with orbit control torque disturbance compensation is as follows: Figure 6 As shown in the upper part; after the attitude maneuver is completed, the straight approach officially begins and the orbit control thruster works. The attitude control enters the attitude stabilization control stage. Based on equation (2), it is necessary to apply the interference torque to compensate for the orbit control;
[0100] τ' ax =τ dx ,τ' ay =τ dy ,τ' az =τ dz (3)
[0101] Among them, τ dx It is the X generated by orbital control b Disturbance torque of the shaft, τ dy Y is generated by orbit control b Disturbance torque of the shaft, τ dz is the Z generated by orbital control b Disturbance torque of the shaft, τ' ax Yes X b Compensation torque of the shaft, τ' ay Yes b Compensation torque of the shaft, τ' az It's Z b Compensation torque of the shaft;
[0102] After attitude stabilization feedforward compensation, X b The attitude stabilization control command of the axis is τ ax +τ' ax , Y b The attitude stabilization control command of the axis is τ ay +τ' ay , Z bThe attitude stabilization control command of the axis is τ az +τ' az , τ ax is the attitude maneuver control law τ a Medium X b Axis control command, τ ay is the attitude maneuver control law τ a Middle Y b Axis control command, τ az is the attitude maneuver control law τ a Middle Z b Axis control instructions.
[0103] If there is no track control interference torque on the three axes, no compensation is required;
[0104] The other steps and parameters are the same as those in Specific Implementation Methods 1 to 5.
[0105] Specific implementation method 7: This implementation method is different from any one of specific implementation methods 1 to 6 in that the trajectory control thrust output limiting coefficient is obtained according to the maximum attitude control capability, which is specifically:
[0106] For X b Axis, if X b The disturbance torque generated by the orbit control thruster of the axis when the duty cycle is 1 does not exceed the maximum compensation capability of the attitude control or X b If there is no orbital control interference torque on the axis, then X b The axis's orbit control thrust output limit coefficient is 1; otherwise, if X b When the duty cycle of the orbit control thruster of the axis is 1, the disturbance torque generated exceeds the maximum compensation capability of the attitude control. Then, the X b The axis's orbit control thrust output limiting coefficient (i.e., the product of the axis's limiting coefficient and the disturbance torque generated by the axis' orbit control thruster when the duty cycle is 1 is less than the maximum compensation capability of the attitude control on the axis);
[0107] Y b Axis and Z b The method of obtaining the orbit control thrust output limit coefficient of the axis is the same as that of the X b The axes are the same.
[0108] The other steps and parameters are the same as those in Specific Embodiments 1 to 6.
[0109] Specific implementation eight: This implementation is different from any one of specific implementations one to seven in that the three-axis orbit control law based on feedback linearization is designed according to the orbit control thrust output limiting coefficient, which is specifically:
[0110] The dynamic model of the relative motion between the spacecraft and the space target is as follows:
[0111]
[0112] Where [x, y, z] is the LVLH coordinate system O l X l Y l Z l The position of the spacecraft relative to the space target, x is the orbital radial O l X l The coordinate of the axis, which is always zero under the requirement of straight line approximation; y is the tangent of the track O l Y l The coordinate of the axis, which is also the direction of the spacecraft's approach motion; z is the orbital normal O l Z l axis coordinates, decoupled from the other two axes; n is the orbital angular velocity, u x 、u y and u z O l X l Axis, O l Y l Axis and O l Z l Axis track control quantity, is the first-order derivative of x, is the second-order derivative of x, is the first-order derivative of y, is the second-order derivative of y, is the second-order derivative of z;
[0113] The three-axis orbit control law based on feedback linearization is designed as:
[0114]
[0115] In the formula, [k px ,k dx ,k py ,k dy ,k pz ,k dz ] is the control gain, y d is the reference tangential motion trajectory after Bang-Bang path planning, for y d The first derivative of for y d The second-order derivative of is the second-order derivative of z. The maximum tangential velocity and maximum acceleration in the parameters of Bang-Bang path planning satisfy the inequality constraints of formula (9):
[0116]
[0117] In the formula, u x,max =Fx / m is the maximum unit mass thrust provided in radial direction, u y,max =F y / mThe maximum unit mass thrust provided in the tangential direction, m is the mass of the spacecraft, F x is the radial thrust, F y The thrust provided in the tangential direction, n y Y b The axis's orbital control thrust output limiting coefficient, represent The upper limit of represent represents the upper limit of , and |·| represents the absolute value.
[0118] The other steps and parameters are the same as those in Specific Embodiments 1 to 7.
[0119] Specific implementation method 9: This implementation method is different from any one of specific implementation methods 1 to 8 in that the attitude maneuvering control instruction is converted into an instruction for thruster response; specifically:
[0120] The duty cycle command of the three-axis attitude control thruster is:
[0121]
[0122] Where, T x , T y and T z When the duty cycle is 100%, X b Axis, Y b Axis and Z b Maximum moment of the shaft; τ ax , τ ay and τ az X b Axis, Y b Axis and Z b Axis attitude maneuver control command; D ax , D ay and D az X b Axis, Y b Axis and Z b Duty cycle of the axis attitude control thruster, sign(·) represents the sign function, and min(·) represents the minimum value;
[0123] D ax , D ay and D az Assign thrusters to each attitude control channel and obtain the duty cycle and start-up time of each attitude control thruster;
[0124] Similarly, the attitude stability feedforward compensation control command is converted into a thruster response command.
[0125] The specific process of converting the attitude stability feedforward compensation control command into the thruster response command is as follows:
[0126]
[0127] The other steps and parameters are the same as those in Specific Embodiments 1 to 8.
[0128] Specific embodiment 10: This embodiment differs from specific embodiments 1 to 9 in that the three-axis orbit control law is converted into thruster response instructions; specifically:
[0129] The duty cycle command of the three-axis orbit control thruster is:
[0130]
[0131] In the formula, u z,max =F z / m is the maximum unit mass thrust provided in the normal direction, F z The thrust provided in the normal direction, n x 、n y and n z X b Axis, Y b Axis and Z b Thrust output limiting factor of the shaft, D ox , D oy and D oz X b Axis, Y b Axis and Z b Duty cycle of axis orbit control thrusters;
[0132] D ox , D oy and D oz The thrusters assigned to each orbit control channel obtain the duty cycle and start-up time of each orbit control thruster.
[0133] The other steps and parameters are the same as those in Specific Embodiments 1 to 9.
[0134] Example
[0135] The present invention provides a maneuvering control method for spacecraft approach observation taking into account thruster constraints. First, input a plurality of thruster layouts and thrust sizes, and allocate the thrusters to a total of 12 control channels for attitude and orbit according to certain principles. Then, plan and establish a Bang-Bang maneuvering path for the desired approach attitude, and design an attitude maneuvering control law when the orbit control is not turned on. Secondly, in order to suppress the interference torque generated by the orbit control thrusters, a feedforward compensation control law for attitude stability when the orbit control is turned on is designed, and the compensation amount is determined by the orbit control amount. Next, according to the mission constraints of approaching the target in a straight line, a three-axis orbit control law with limiting is designed based on feedback linearization. The orbital linear motion adopts the Bang-Bang motion path planning method, and the thrust output limiting coefficient is determined by the maximum attitude control capability. Under the constraints of thruster layout and thrust size, during the entire controller design process, the attitude and orbit coupling control scheme is such as Figure 5 As shown in the figure, the attitude control design and orbit control design show strong coupling characteristics, and the control quantity output by the algorithm is strictly smaller than the capacity of the thruster, which is conducive to engineering implementation. Finally, the pulse width modulation (PWM) method is used to convert the continuous control law into the on / off time that the thruster can respond to.
[0136] The following is a detailed description of some of the contents of this embodiment:
[0137] 1) Attitude and orbital thruster combination allocation
[0138] For a spacecraft, there are 24 jet thrusters for attitude and orbit control. Their thrust direction and installation layout are in the spacecraft system. b X b Y b Z b The following situation Figure 2 As shown, the spacecraft system O b X b Y b Z b It is a coordinate system with the center of mass of the spacecraft as the origin, the roll axis as the x-axis, the pitch axis as the y-axis, and the yaw axis as the z-axis.
[0139] The basic principles of thruster channel allocation are as follows: ① Decouple attitude and orbit as much as possible: when outputting control force, the control torque is zero. When outputting control torque, the control force is zero. ② Decouple three axes as much as possible: when outputting control force of one axis, the control forces of the other two axes are zero. When outputting control torque of one axis, the control torque of the other two axes are zero. ③ Satisfy attitude control requirements first, then satisfy orbit control requirements.
[0140] According to the above principles, the jet thrusters are allocated to 6 control channels of 3 axes of attitude and 6 control channels of 3 axes of orbit. The output force and output torque of each combination are shown in Table 1 under the spacecraft system. In Table 1, the thrust of a single thruster is F, then Tx =FL a , T y =FL b , T z =FL a , F x =2F,F y =2F,F z =2F,T dy =F(L c / 2-L d ), T dz =FL c .
[0141] Table 1 Distribution results of thruster combined attitude and orbit control channels in the spacecraft system
[0142]
[0143]
[0144] As shown in Table 1, in the three-axis positive and negative channels of attitude control, the thrusters form a couple in pairs, which means that attitude control has no effect on orbit control and satisfies attitude and orbit decoupling. b The channel can output the control force with the output torque being zero. b and Z b When the axis outputs control force, a large interference torque will be generated, and there will be a huge attitude-orbit coupling during orbit control.
[0145] 2) Bang-Bang path planning for large-angle attitude maneuvering control algorithm
[0146] The control algorithm in this stage is used to adjust the attitude before approaching the target in a straight line, and adjusts the initial zero attitude to the approach observation attitude.
[0147] The spacecraft attitude error dynamics are:
[0148]
[0149] Where J is the moment of inertia of the spacecraft, ω is the angular velocity of the spacecraft, and ω d is the desired reference angular velocity of the spacecraft, [q v q0] is the spacecraft attitude quaternion, [q vd q 0d ] is the reference attitude quaternion expected by the spacecraft, τ is the output torque of the thruster acting on the spacecraft, [q vd q 0e ] is the attitude error quaternion, R e is the coordinate transformation matrix of the error quaternion.
[0150] Design the following attitude maneuver control law:
[0151]
[0152] In the formula, K p With K d is the control gain. Take the Lyapunov function as:
[0153]
[0154] Substituting its derivative into the control law and error dynamics:
[0155]
[0156] Therefore, under the action of the above attitude maneuver control law, the spacecraft attitude quaternion can asymptotically track the expected reference attitude quaternion.
[0157] The Bang-Bang path planning method is used to calculate the expected attitude quaternion during the maneuver: first calculate the Euler axis angle θ between the approach attitude and the initial attitude, then perform Bang-Bang path planning on the Euler axis angle, and finally calculate the planned Euler axis angle θ d Convert to the desired reference quaternion q vd and q 0d .like Figure 3 As shown in the figure, the whole attitude maneuver process is divided into three stages: acceleration stage (t0~t1) maintains the maximum angular acceleration a max Or control torque, there is no control torque in the uniform speed section (t1~t2), and the deceleration section (t2~t3) maintains the negative maximum angular acceleration -a max Or control torque. The angular velocity curve shows obvious trapezoidal characteristics, and the upper base of the trapezoid is affected by the maximum angular velocity ω max Constrained, the angle curve presents a monotonous smooth curve and finally maneuvers to the desired posture.
[0158] 3) Pulse Width Modulation (PWM) Algorithm
[0159] The pulse width modulation algorithm is used to convert the continuous command into a command that the thruster can respond to. The duty cycle of the three-axis thruster is
[0160]
[0161] In the formula, sign represents the sign function, min represents the minimum value function, T x , T y , T z is the maximum torque of the three axes when the duty cycle is 100%. Therefore, the fixed thrust can be approximated as a continuous control quantity. Then it is allocated to each channel according to Table 1 to obtain the duty cycle of each thruster. And boot time Where Δt is a single control cycle.
[0162] 4) Attitude stabilization control algorithm with orbit control disturbance torque compensation
[0163] After the attitude maneuver is completed, the straight-line approach officially begins and the orbit control thruster works. The attitude control enters the attitude stabilization control stage. Based on equation (9), the interference torque for compensating orbit control needs to be applied:
[0164] τ' ax =τ dx ,τ' ay =τ dy ,τ' az =τ dz (13)
[0165] In the formula, τ' a =[τ' ax ,τ' ay ,τ' az ] is the compensation torque, τ d =[τ dx ,τ dy ,τ dz ] is the disturbance torque generated by orbit control, taking Table 1 as an example;
[0166] τ dx =0,τ dy =D oz T dz ,τ dz =-D oy T dy (14)
[0167] Where D oz ,D oy Y b and Z b Axis track control thruster start-up duty cycle, T dz T dy Y b and Z b The interference torque generated when the duty cycle of the axis orbit control thruster is 1.
[0168] If T z <T dy or T y <T dz , the orbit control interference torque exceeds the maximum compensation capacity of the attitude control. Therefore, the orbit control force must be forced to be limited, and the compensation capacity of the attitude control determines the size of the orbit control limit in disguise. Limit coefficient n y With n z Requirements to meet n y T dz <T yand n z T dy <T z The structure diagram of the attitude control system for orbit control torque disturbance compensation is as follows: Figure 6 Shown in the upper part.
[0169] 5) Bang-Bang control path planning for three-axis control algorithm of straight approach track
[0170] The CW equation is a dynamic model that describes the relative motion of spacecraft as follows:
[0171]
[0172] Where [xyz] is the LVLH coordinate system O l X l Y l Z l The position of the spacecraft relative to the target, n is the orbital angular velocity, u is the three-axis orbit control quantity. x is the orbital radial X l The coordinates of the track are always zero under the requirement of straight line approximation; y is the tangent Y l The coordinate of the spacecraft, which is also the direction of the spacecraft's approach; z is the orbital normal Z l The coordinates of the axis are decoupled from the other two axes.
[0173] The three-axis orbit control law based on feedback linearization is designed as:
[0174]
[0175] In the formula, [k px k dx k py k dy k pz k dz ] is the control gain, y d is the reference tangential motion trajectory after Bang-Bang path planning. Its path planning method is similar to that of attitude maneuver path planning, such as Figure 4 As shown. The maximum tangential velocity and maximum acceleration in the planning parameters satisfy the following inequality constraints:
[0176]
[0177] In the formula, u x,max =F x / m is the maximum unit mass thrust provided in radial direction, u y,max =F y / m is the maximum unit mass thrust provided in the tangential direction, where m is the mass of the spacecraft.
[0178] The duty cycle command of the three-axis orbit control thruster is:
[0179]
[0180] In the formula, u z,max =F z / mThe maximum unit mass thrust provided in the normal direction. Then, as in the attitude control scheme, it is distributed to each channel according to Table 1 to obtain the duty cycle instruction of each orbit control thruster And boot time
[0181] The following is an analysis of the closed-loop system stability of the three-axis orbit control law. Substituting the control law into the CW equation, we get:
[0182]
[0183] The three axes in the above equation are typical second-order linear steady-state systems. By configuring the poles, a reasonable control gain is obtained to make the system asymptotically stable. Therefore, the radial direction of the orbit is zero x→0. The track moves tangentially according to the path planning y→y d , The orbital normal is zero z→0, Finally, the track surface was approached to a straight line.
[0184] The following analysis is whether the three-axis orbit control amount exceeds the maximum capacity of the thruster.
[0185] ① Divide the orbit radial control quantity into the following three parts:
[0186]
[0187] At the beginning of the approach, the initial state is the stable point behind the target, that is, x(0)≈0. Keep stable during the approach x→0, The second and third terms will always remain at a very small magnitude. The first term is the feedback linearization term, which contains This is much greater than zero during the approach process. x plays a major role, namely
[0188]
[0189] because is a reasonably planned value, so u x The maximum thruster capacity will not be exceeded.
[0190] ② Divide the orbit radial control quantity into the following three parts:
[0191]
[0192] From the above formula, we can see that the first term is the radial motion term, which is very small when the straight line approaches. The second term is the PD feedback state term, which is also very small when stable tracking. The third term is the path planning feedforward term The approach process is always large, in u y plays a major role, namely
[0193]
[0194] because is a reasonably planned value, so u y The maximum thruster capacity will not be exceeded.
[0195] ③ Divide the track normal control quantity into the following two parts:
[0196]
[0197] From the above formula, we can see that z→0 remains stable during the approach process. u z will always be smaller.
[0198] |u z |≈0(24)
[0199] So u z The maximum thruster capacity will not be exceeded.
[0200] The following is an explanation of the relationship between the desired approach attitude and orbit control from the perspective of attitude-orbit coupling. b The axis is not limited and the available thrust is maximum. In order to ensure close-range linear approach, the feedback linearization of the track radial direction must be compensated at all times, which requires that the track radial X l Therefore, considering the thruster constraints and attitude-orbit coupling, the desired approach attitude should make the X b Axis along X l Axis, such as pitch -90° as the approach attitude.
[0201] The structure diagram of the three-axis control system of the track approaching the target in a straight line is as follows Figure 6 Shown in the lower part.
[0202] The effect of the present invention is illustrated below using a numerical simulation case. The mission is divided into two stages: ① The spacecraft first maneuvers to an approach attitude; ② After 200s, the orbit control thruster is turned on to begin approaching the target in a straight line. The six numbers of the target initial orbit are set to be a semi-major axis of 6728m, an eccentricity of 0.00001, an orbit inclination of 51.5°, a perigee angle of 193°, an ascending node right ascension of 315°, and a true anomaly of 192°. Set the spacecraft thruster thrust to 3N, the spacecraft mass to 1000kg, and the moment of inertia matrix to diag(600,5000,6000)kgm 2 . The initial relative position is [-0.5; -2599; 1] m, and the initial relative speed is [0.01; 0.02; -0.03] m / s. The initial attitude Euler angle is [0.3; 0.1; 0.2]°, and the initial angular velocity is [0.01; -0.02; 0.03]° / s. Set the expected approach attitude Euler angle to [0; -90; 0]°, and the control period is 100ms.
[0203] The simulation results are as follows Figure 7 to Figure 12 shown. Figure 7 To follow the trajectory of motion within the orbital plane during the approach, the spacecraft approaches the target in a straight line from behind and hovers. Figure 8-Figure 9 The three-axis curves of the spacecraft position and velocity are shown in Figure 2. The radial motion is controlled within 0.5 m. After the Bang-Bang path planning, the tangential motion is very smooth, and the tangential velocity shows the characteristics of first accelerating and then decelerating. Figure 10-11 This is the attitude change curve during the attitude maneuver before approach and attitude stabilization during approach. After Bang-Bang path planning, the pitch axis changes smoothly and the large-angle maneuver is completed within 100 seconds. Fig.12 The duty cycle of the 24 thrusters is less than 100%, indicating that the control method of the present invention can effectively meet the thrust size constraints of the thrusters. After the above analysis, it can be seen that the control algorithm meets all the set conditions and can complete the attitude and orbit motion control tasks of the spacecraft in the process of approaching the target in a straight line.
[0204] The above calculation examples of the present invention are only used to explain the calculation model and calculation process of the present invention in detail, and are not intended to limit the implementation methods of the present invention. For ordinary technicians in the relevant field, other different forms of changes or modifications can be made based on the above description. It is impossible to list all the implementation methods here. All obvious changes or modifications derived from the technical solution of the present invention are still within the scope of protection of the present invention.
Claims
1. A method for attitude-orbit coupling control of a spacecraft approaching a space target in a straight line considering thruster constraints, characterized in that: The method specifically comprises the following steps: Step 1: Allocate the thrusters to the attitude and orbit control channels based on the layout and thrust size of the thrusters. Step 2: Plan the maneuver path of the spacecraft from the initial zero attitude to the desired straight-line approach attitude, and design the attitude maneuver control law for adjusting the spacecraft from the initial zero attitude to the desired straight-line approach attitude; Step 3: Design an attitude stabilization feedforward compensation control law based on the orbit control disturbance torque during the spacecraft's linear approach to the target. Step 4: Obtain the orbit control thrust output limiting coefficient based on the maximum attitude control capability, and then design a three-axis orbit control law based on feedback linearization based on the orbit control thrust output limiting coefficient; Step 5: Use the pulse width modulation method to convert the control instructions from step 2 to step 4 into the on / off instructions of the thruster response.
2. The attitude-orbit coupling control method for a spacecraft approaching a space target in a straight line considering thruster constraints according to claim 1, characterized in that: In step 1, the thrusters are allocated to the attitude and orbit control channels. The specific allocation principle is: 1) For any channel of attitude control, when the channel outputs control torque, the control force output by the channel is zero; when one axis of the channel outputs control torque, the control torques of the other two axes of the channel are zero; 2) For any channel of track control, when the channel outputs control force, the control torque output by the channel is zero; when one axis of the channel outputs control force, the control forces of the other two axes of the channel are both zero; 3) Prioritize attitude control over orbit control.
3. The attitude-orbit coupling control method for a spacecraft approaching a space target in a straight line considering thruster constraints according to claim 2, characterized in that: The desired straight-line approach posture is: the axis with the maximum orbital control thrust is along the orbital radial direction.
4. The attitude-orbit coupling control method for a spacecraft approaching a space target in a straight line considering thruster constraints according to claim 3, characterized in that: The design is to adjust the spacecraft from the initial zero attitude to the desired straight approach attitude attitude maneuver control law; the specific process is: The dynamic equation of spacecraft attitude error is: Where J is the moment of inertia of the spacecraft, ω is the angular velocity of the spacecraft, and ω × is the cross product matrix of ω, ω d is the desired reference angular velocity of the spacecraft, Yes d The first-order derivative of τ is the output torque of the thruster acting on the spacecraft, [q v q0] is the spacecraft attitude quaternion, q v × It's q v The cross product matrix, [q vd q 0d ] is the reference attitude quaternion expected by the spacecraft, the superscript T represents the transpose of the matrix, [q ve q 0e ] is the attitude error quaternion, q ve The first derivative of q 0e The first derivative of R e is the coordinate transformation matrix of the error quaternion, ω e is the spacecraft’s error angular velocity, Yes e The first derivative of ; Design attitude maneuver control law: Where, τ a is the attitude maneuver control law, q e =[q ve q 0e ] T , ω e The cross product matrix, K p and K d To control the gain.
5. The attitude-orbit coupling control method for a spacecraft approaching a space target in a straight line considering thruster constraints according to claim 4, characterized in that: The calculation method of the reference attitude quaternion expected by the spacecraft is: After calculating the Euler axis angle θ between the straight approach posture and the initial zero posture, perform Bang-Bang path planning on the Euler axis angle θ to obtain the new Euler axis angle θ d , and then the new Euler axis angle θ d Converted into the desired reference attitude quaternion q vd and q 0d .
6. The attitude-orbit coupling control method for a spacecraft approaching a space target in a straight line considering thruster constraints according to claim 5, characterized in that: The specific process of step 3 is: the ax =t dx ,t' ay =t dy ,t' az =t dz (3) Among them, τ dx It is X generated by orbit control b Disturbance torque of the shaft, τ dy Y is generated by orbit control b Disturbance torque of the shaft, τ dz is the Z generated by orbital control b Interference torque of the shaft, τ' ax It's X b Compensation torque of the shaft, τ' ay It's Y b Compensation torque of the shaft, τ' az It's Z b Compensation torque of the shaft; After attitude stabilization feedforward compensation, X b The attitude stabilization control command of the axis is τ ax +τ' ax , Y b The attitude stabilization control command of the axis is τ ay +τ' ay , Z b The attitude stabilization control command of the axis is τ az +τ' az , τ ax is the attitude maneuver control law τ a Medium X b Axis control instructions, τ ay is the attitude maneuver control law τ a Middle Y b Axis control instructions, τ az is the attitude maneuver control law τ a Middle Z b Axis control instructions.
7. The attitude-orbit coupling control method for a spacecraft approaching a space target in a straight line considering thruster constraints according to claim 6, characterized in that: The orbit control thrust output limiting coefficient is obtained according to the maximum attitude control capability, which is specifically: For X b Axis, if X b The disturbance torque generated by the orbit control thruster of the axis when the duty cycle is 1 does not exceed the maximum compensation capability of the attitude control or the X b If there is no orbital interference torque on the axis, then X b The axis's orbital control thrust output limiting coefficient is 1; Otherwise, if X b When the duty cycle of the axis orbit control thruster is 1, the interference torque generated exceeds the maximum compensation capability of the attitude control. The X b The axis's orbital control thrust output limiting coefficient; Y b Axis and Z b The method of obtaining the axis's orbital control thrust output limit coefficient is the same as that of the X b The axes are the same.
8. The attitude-orbit coupling control method for a spacecraft approaching a space target in a straight line considering thruster constraints according to claim 7, characterized in that: The three-axis orbit control law based on feedback linearization is designed according to the orbit control thrust output limiting coefficient, which is specifically: The dynamic model of the relative motion between the spacecraft and the space target is as follows: Where [x, y, z] is the LVLH coordinate system O l X l Y l Z l The position of the spacecraft relative to the space target, x is the orbital radial O l X l The coordinate of the axis, y is the tangent direction of the orbit O l Y l The coordinate of the axis, z is the orbital normal O l Z l The coordinates of the axis; n is the angular velocity of the orbit, u x 、u y and u z O l X l Axis, O l Y l Axis and O l Z l Axis track control quantity, is the first-order derivative of x, is the second-order derivative of x, is the first-order derivative of y, is the second-order derivative of y, is the second-order derivative of z; The three-axis orbit control law based on feedback linearization is designed as: In the formula, [k px ,k dx ,k py ,k dy ,k pz ,k dz ] is the control gain, y d is the reference tangential motion trajectory after Bang-Bang path planning, y d The first derivative of y d The second derivative of is the second-order derivative of z. The maximum tangential velocity and maximum acceleration in the Bang-Bang path planning parameters satisfy the inequality constraints of formula (9): Where u x,max =F x / m is the maximum unit mass thrust provided in radial direction, u y,max =F y / mThe maximum unit mass thrust provided in the tangential direction, m is the mass of the spacecraft, F x The thrust provided in radial direction, F y Thrust provided in the tangential direction, n y Y b The axis's orbital control thrust output limiting coefficient, represent The upper limit, represent represents the upper limit of , and |·| represents the absolute value.
9. The attitude-orbit coupling control method for a spacecraft approaching a space target in a straight line considering thruster constraints according to claim 8, characterized in that: The specific process of converting the attitude maneuver control command into the thruster response command is as follows: The duty cycle command of the three-axis attitude control thruster is: Where, T x , T y and T z When the duty cycle is 100%, X b Axis, Y b Axis and Z b Maximum moment of the shaft; τ ax , τ ay and τ az X b Axis, Y b Axis and Z b Axis attitude maneuver control command; D ax 、D ay and D az X b Axis, Y b Axis and Z b Duty cycle of the axial attitude control thruster, sign(·) represents the sign function, and min(·) represents the minimum value; D ax 、D ay and D az Assign thrusters to each attitude control channel and obtain the duty cycle and power-on time of each attitude control thruster; Similarly, the attitude stabilization feedforward compensation control command is converted into a thruster response command.
10. The attitude-orbit coupling control method for a spacecraft approaching a space target in a straight line considering thruster constraints according to claim 9, characterized in that: The three-axis orbit control law is converted into thruster response instructions; specifically: The duty cycle command of the three-axis orbit control thruster is: Where u z,max =F z / m is the maximum unit mass thrust provided in the normal direction, F z The thrust provided in the normal direction, n x 、n y and n z X b Axis, Y b Axis and Z b Shaft thrust output limiting coefficient, D ox 、D oy and D oz X b Axis, Y b Axis and Z b Duty cycle of axis orbit control thrusters; D ox 、D oy and D oz The thrusters assigned to each orbit control channel are used to obtain the duty cycle and power-on time of each orbit control thruster.
Citation Information
Patent Citations
Attitude control method applied to centroid transverse moving spacecraft
CN103121514A
Method for designing PD+ attitude control law based on back-stepping design and nonlinear feedback
CN103455035A
Flexible satellite attitude orbit coupling control method based on isolation allowance method and pulse width fusion strategy
CN104590588A
Spacecraft control method and system considering residual vibration
CN116729647A
Concurrent Station Keeping, Attitude Control, and Momentum Management of Spacecraft
US20170269610A1
