Predetermined error trajectory control method of non-cooperative target rendezvous system
By adopting the full drive system and sliding mode control theory in the non-cooperative target entries system, the predetermined error trajectory controller is designed, and the problems of inaccurate control model and instability in the existing technology are solved, and high-precision trajectory tracking control is achieved. .
Patent Information
- Application Number
- CN202411580477.1
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2024-11-07
- Publication Date
- 2024-12-06
- Estimated Expiration
- 2044-11-07
AI Technical Summary
The existing control method for non-cooperative target ensemble system is inaccurate due to linearization processing, and cannot effectively consider actuator failure, external interference and modeling uncertainty, which affects the control accuracy and stability of the system.
Using the full drive system (FAS) method and sliding mode control theory, a predetermined error trajectory controller is designed. Through the second-order full drive system model and disturbance observer, combined with the sliding mode controller, intermediate control variables are designed to achieve non-compliance Effective tracking and control of the cooperative goal celebration system.
It improves control accuracy, meets the performance of trajectory tracking errors, and realizes effective tracking control of non-cooperative target celebration systems with external disturbances to ensure system stability.
Smart Images

Figure CN119087906A_ABST
Abstract
Description
Technical Field
[0001] The invention belongs to the field of aerospace control technology, relates to the control of a non-cooperative target rendezvous system, and specifically relates to a predetermined error trajectory control method for a non-cooperative target rendezvous system. Background Art
[0002] In-orbit space service missions, such as space debris removal, capturing tumbling spacecraft, and tracking enemy spacecraft, are all very typical non-cooperative targets. To complete these tasks, the spacecraft needs to autonomously rendezvous with the non-cooperative target and track it. Therefore, the study of the control of the non-cooperative target rendezvous system has very important theoretical significance and application value.
[0003] At present, many non-cooperative target rendezvous control problems are solved by state space methods. The mainstream method is to linearize the nonlinear terms of the system, but this will lead to inaccurate control models and affect the control accuracy of the system. At the same time, due to measurement errors and fuel consumption, the actual mass of the spacecraft cannot be accurately determined, so there may be modeling uncertainties in the non-cooperative target rendezvous system. In the control and analysis of the system, ignoring these problems will affect the performance of the system and even cause system instability. In addition to external interference and actuator failure, in the process of serving spacecraft to perform some space missions, the controller needs to ensure that the trajectory tracking error meets certain performance. For this reason, it is necessary to develop a new control method to improve the control accuracy and consider the performance of the trajectory tracking error. Summary of the invention
[0004] In view of the shortcomings of the prior art, the present invention proposes a predetermined error trajectory control method for a non-cooperative target rendezvous system. Based on the disturbance observer, the full drive system method and the sliding mode control theory, actuator failure, external interference and modeling uncertainty are taken into consideration, and a predetermined error estimation controller based on the full drive system (FAS) method and sliding mode control is designed to achieve effective tracking control of the non-cooperative target rendezvous system.
[0005] A method for controlling a predetermined error trajectory of a non-cooperative target rendezvous system specifically comprises the following steps:
[0006] Step 1: Establish a second-order all-wheel drive system model for a non-cooperative target rendezvous system
[0007] Establish an inertial coordinate system O with the center of the earth as the origin I -X I Y I Z I , establish the inertial coordinate system O with the center of mass of the chasing spacecraft as the origin i -X i Y i Z i, establish the line of sight coordinate system O with the center of mass of the chasing spacecraft as the origin and the direction pointing to the center of mass of the target spacecraft as the positive direction of the X-axis ls -X ls Y ls Z ls According to the principles of aerospace dynamics, the following relative orbit model of spacecraft with external disturbance facing non-cooperative targets is established:
[0008]
[0009] in, To calculate the relative distance between the chasing spacecraft and the target spacecraft, and They represent the inclination and azimuth of the line of sight coordinate system relative to the inertial coordinate system, is the gravitational constant, is the distance vector from the center of the Earth to the chasing spacecraft, represent the thrust of the chasing spacecraft at X ls Axis, Y ls Axis and Z ls The acceleration provided in the axis direction, For unknown interference, . , denote the first and second derivatives respectively, represents the 2-norm.
[0010] The above spacecraft relative orbit model is written as the following second-order full drive system:
[0011] in, .
[0012] Assuming that the actuator of the spacecraft has gain fault and bias fault during operation, and the actual mass of the spacecraft cannot be accurately determined due to measurement error and consumption, the disturbance quantity is introduced into the second-order full drive system. :
[0013]
[0014] in, , and are the nominal mass and actual mass of the spacecraft, Represents the identity matrix of dimension 3. , is the gain fault matrix, diag{} represents the set of diagonal elements, , is the deviation fault vector, are all constants.
[0015] Step 2: Sliding mode controller design based on full drive system approach
[0016] The following controller u is designed using the FAS method:
[0017] in is the intermediate control variable to be designed. Apply this controller to the disturbance introduced in step 1 In the second-order all-wheel drive system:
[0018] in , Represents the inverse matrix.
[0019] Step 3: Disturbance Observer Design
[0020] Calculate the tracking error e:
[0021] in, is the expected trajectory vector.
[0022] Select a specified performance function , which satisfies that for any t>0 is a positive or negative number and , t represents time; design a sliding mode function S=[s1s2s3] T , the i-th synovial variable s i Defined as:
[0023] in Tracking error No. elements, To specify performance functions No. elements. Let the sliding mode variable be differentiated with respect to time t:
[0024] in, They are No. elements.
[0025] Design the following disturbance observer:
[0026]
[0027]
[0028]
[0029]
[0030] in They are S, F, The estimated value of , Respectively , No. elements. and are adjustable positive constants and positive definite matrices, respectively. . Represents a symbolic function.
[0031] Step 4: Design of intermediate control variables
[0032] Under the condition of satisfying system stability, design the intermediate control variables :
[0033] in is a constant greater than 0, express No. elements.
[0034] The present invention has the following beneficial effects:
[0035] Aiming at the problem that the existing tracking control method of non-cooperative target rendezvous system does not consider the tracking error performance, a predetermined error trajectory control method based on the full drive system method and sliding mode control theory is proposed. The relative orbit model of the spacecraft facing the non-cooperative target is converted into a second-order full drive system form through the full drive system method, and on this basis, a sliding mode controller is designed using the full drive system method and the sliding mode control method, so that the state of the system can track the desired state trajectory and the tracking error meets the predetermined performance. Using the method of the present invention, effective tracking control of the non-cooperative target rendezvous system with external disturbance can be achieved. BRIEF DESCRIPTION OF THE DRAWINGS
[0036] Figure 1 This is a schematic diagram of the non-cooperative target rendezvous system;
[0037] Figure 2 This is the tracking error result in the embodiment. DETAILED DESCRIPTION
[0038] The present invention will be further explained below with reference to the accompanying drawings;
[0039] A method for controlling a predetermined error trajectory of a non-cooperative target rendezvous system specifically comprises the following steps:
[0040] Step 1: Establish a second-order all-wheel drive system model for a non-cooperative target rendezvous system
[0041] like Figure 1 As shown, an inertial coordinate system O is established with the center of the earth as the origin. I -X I Y I Z I , establish the inertial coordinate system O with the center of mass of the chasing spacecraft as the origin i -X i Y i Z i , establish the line of sight coordinate system O with the center of mass of the chasing spacecraft as the origin and the direction pointing to the center of mass of the target spacecraft as the positive direction of the X-axis ls -X ls Y ls Z ls , for the pursuit spacecraft and the target spacecraft in the non-cooperative target rendezvous system, the following relative orbit model of spacecraft facing the non-cooperative target with external disturbance is established:
[0042]
[0043] in, To calculate the relative distance between the chasing spacecraft and the target spacecraft, and They represent the inclination and azimuth of the line of sight coordinate system relative to the inertial coordinate system, is the gravitational constant, is the distance vector from the center of the Earth to the chasing spacecraft, represent the thrust of the chasing spacecraft at X ls Axis, Y ls Axis and Z ls The acceleration provided in the axis direction, For unknown interference, . , denote the first and second derivatives respectively, represents the 2-norm.
[0044] The above spacecraft relative orbit model is written as the following second-order full drive system:
[0045] in, .
[0046] Assuming that the actuator of the spacecraft has gain fault and bias fault during operation, and the actual mass of the spacecraft cannot be accurately determined due to measurement error and consumption, the disturbance quantity is introduced into the second-order full drive system. :
[0047]
[0048] in, , and are the nominal mass and actual mass of the spacecraft, Represents the identity matrix of dimension 3. , is the gain fault matrix, diag{} represents the set of diagonal elements, , is the deviation fault vector, are all constants.
[0049] Step 2: Sliding mode controller design based on full drive system approach
[0050] The following controller u is designed using the FAS method:
[0051] in is the intermediate control variable to be designed. Apply this controller to the disturbance introduced in step 1 In the second-order all-wheel drive system:
[0052] in , Represents the inverse matrix.
[0053] Step 3: Disturbance Observer Design
[0054] Calculate the tracking error e:
[0055] in, is the expected trajectory vector.
[0056] Select a specified performance function , which satisfies that for any t>0 is a positive or negative number and , t represents time; design a sliding mode function S=[s1s2s3] T , the i-th synovial variable s i Defined as:
[0057] in Tracking error No. elements, To specify performance functions No. elements. Let the sliding mode variable be differentiated with respect to time t:
[0058] in, They are No. elements.
[0059] Design the following disturbance observer:
[0060]
[0061]
[0062]
[0063]
[0064] in They are S, F, The estimated value of , Respectively , No. elements. and are adjustable positive constants and positive definite matrices respectively. Represents a symbolic function.
[0065] Step 4: Design of intermediate control variables
[0066] Under the premise of ensuring system stability, design intermediate control variables :
[0067] in is a constant greater than 0, express No. elements.
[0068] First, a simulation experiment is conducted to demonstrate the effectiveness of this method. The simulation parameters are selected as follows: , , , , , , , , , , , , ,
[0069] The change of tracking error is as follows Figure 2 As shown, it can be seen that as time goes by, the tracking error tends to 0 and reaches 0 after a certain period of time, indicating that the chasing spacecraft can successfully track the target spacecraft, and the tracking error coincides with the predetermined tracking error trajectory, indicating that the error trajectory of the spacecraft tracking control is consistent with the predetermined tracking error trajectory, and its performance can be controlled to meet certain conditions.
[0070] The stability of the closed-loop system is analyzed theoretically as follows:
[0071] Disturbance Observer Error Variable It can converge to 0 in a finite time. Therefore, the disturbance observer error can be derived is bounded and satisfies:
[0072] in is a normal number.
[0073] Select the following Lyapunov function:
[0074] Taking the derivative with respect to time t, we get:
[0075] If the control parameters satisfy:
[0076] It can be solved as:
[0077] If the initial state of the error trajectory satisfies:
[0078] Available right All of them are established, so we can infer right Therefore, the error trajectory Will follow the specified error trajectory Tends to 0.
Claims
1. A method for controlling the predetermined error trajectory of a non-cooperative target rendezvous system. Features: The specific steps include: Step 1: Introduce disturbances caused by actuator gain failure and bias failure and inaccurate spacecraft mass estimation , establish the second-order all-wheel drive system model of the non-cooperative target rendezvous system, the disturbance quantity for: ; in, , and are the nominal mass and actual mass of the spacecraft, represents the identity matrix of dimension 3; , is the gain fault matrix, is the deviation fault vector, d is the unknown disturbance, and u is the control input; Step 2: Design a sliding mode controller u based on the all-wheel drive system method and substitute it into the second-order all-wheel drive system model established in step 1; Step 3: Calculate the tracking error of the chasing spacecraft to the target spacecraft and design a disturbance observer; Step 4: Design intermediate control variables under the condition of system stability .
2. A method for controlling a predetermined error trajectory of a non-cooperative target rendezvous system as claimed in claim 1, Features: Gain Fault Matrix , the deviation fault vector , where diag{} represents the set of diagonal elements, , are constants, .
3. A method for controlling a predetermined error trajectory of a non-cooperative target rendezvous system as claimed in claim 1, Features: Establish an inertial coordinate system O with the center of the earth as the origin I -X I Y I Z I , establish the inertial coordinate system O with the center of mass of the chasing spacecraft as the origin i -X i Y i Z i , establish the line of sight coordinate system O with the center of mass of the chasing spacecraft as the origin and the direction pointing to the center of mass of the target spacecraft as the positive direction of the X-axis ls -X ls Y ls Z ls According to the principles of aerospace dynamics, the following relative orbit model of spacecraft with external disturbance facing non-cooperative targets is established: ; ; in, To calculate the relative distance between the chasing spacecraft and the target spacecraft, and They represent the inclination and azimuth of the line of sight coordinate system relative to the inertial coordinate system, is the gravitational constant, is the distance vector from the center of the Earth to the chasing spacecraft, represent the thrust of the chasing spacecraft at X ls Axis, Y ls Axis and Z ls The acceleration provided in the axis direction, For unknown interference, ; , denote the first and second derivatives respectively, represents the 2-norm; The above spacecraft relative orbit model is written as a second-order full drive system, and the disturbance is introduced , establish the second-order all-wheel drive system model of the non-cooperative target rendezvous system: ; in, , .
4. A method for controlling a predetermined error trajectory of a non-cooperative target rendezvous system as claimed in claim 3, Features: The sliding mode controller is: ; in is the intermediate control variable to be designed; the controller is applied to the disturbance introduced in step 1 In the second-order all-wheel drive system, we get: ; in , Represents the inverse matrix.
5. A method for controlling a predetermined error trajectory of a non-cooperative target rendezvous system as claimed in claim 3, Features: The tracking error , is the expected trajectory vector; ; Select a specified performance function , which satisfies that for any t>0 is a positive or negative number and , t represents time; then design a sliding mode function S=[s 1 s 2 s 3 ] T The i-th synovial variable s i Defined as: ; in Tracking error No. elements, To specify performance functions No. elements; let the sliding mode variable be differentiated with respect to time t: ; in, They are No. elements, .
6. A method for controlling a predetermined error trajectory of a non-cooperative target rendezvous system as claimed in claim 5, Features: Based on the tracking error and sliding mode function, the following disturbance observer is designed: ; ; ; ; ; in They are S, F, The estimated value of , Respectively , No. elements; and are adjustable positive constants and positive definite matrices, respectively. ; Represents a symbolic function.
7. A method for controlling a predetermined error trajectory of a non-cooperative target rendezvous system as claimed in claim 6, Features: Design of intermediate control variables ,in is a constant greater than 0, express No. elements.
8. A computer-readable storage medium having a computer program stored thereon, which, when executed in a computer, causes the computer to execute the method according to any one of claims 1 to 7.
Citation Information
Patent Citations
Space rolling non-cooperative target autonomous rendezvous guidance method based on high-order sliding mode control and disturbance observer
CN108287476A
Anti-interference iterative learning control method for space manipulator system for capturing non-cooperative targets
CN108508749A
Multisource disturbance actuator saturation integrated spacecraft relative attitude control method
CN108710303A
Spatial multi-satellite cooperative formation control method based on event triggering
CN115108053A
Predefined time sliding mode control method of mechanical arm trajectory tracking system
CN117245656A
