Anti-interference formation control method for UAVs based on generalized proportional-integral observer
By using generalized proportional integral observers in the drone formation to design interference observers and composite dynamic inverse active anti-interference controllers, the problem of insufficient anti-interference capability of the drone formation in the existing technology is solved, and higher control is achieved Accuracy and anti-interference performance.
Patent Information
- Application Number
- CN202410892403.5
- Authority / Receiving Office
- CN · China
- Patent Type
- Patents(China)
- Current Assignee / Owner
- Filing Date
- 2024-07-04
- Publication Date
- 2024-12-06
- Estimated Expiration
- 2044-07-04
AI Technical Summary
When the existing UAV fleet flight control method faces external interference and unmeasurable parameters, its anti-interference ability is limited, making it difficult to effectively maintain the stability of the formation and mission execution efficiency.
Using the anti-interference formation control method based on generalized proportional integral observer, by establishing the disturbed dynamic model of the wingman under the ground coordinate system, the interference observer is designed to estimate and compensate for the aggregate interference, and a composite dynamic inverse active anti-interference formation controller is constructed. , generate controls to resist external wind disturbances and trajectory tracking errors.
It improves the control effect and active anti-interference ability of the drone formation, has higher interference estimation accuracy, broadens the scope of application of the types of interference processing, and significantly improves the anti-interference performance of the formation.
Smart Images

Figure CN118625835B_ABST
Abstract
Description
Technical Field
[0001] The present application relates to the technical field of unmanned aerial vehicles (UAVs), and in particular to an anti-interference formation control method for UAVs based on a generalized proportional-integral observer. Background Art
[0002] At present, cluster collaborative mission execution has gradually become an important development trend in the application of UAV systems, and has been widely studied and applied in many fields such as military, civil aviation, logistics and environmental monitoring. Compared with a single UAV, a UAV formation cluster improves the flight efficiency and mission execution capability of the entire formation by sharing information and working together among multiple UAVs. It can adapt to the needs of different fields, has better fault tolerance and robustness, and can complete tasks that are difficult for a single UAV to complete. When UAVs fly in formation, each UAV needs to coordinate with each other and make joint decisions to ensure the stability of the formation. In addition, the actual flight process is easily affected by external wind disturbances and unmeasurable parameters within the formation system, making the flight control of UAV formation very challenging.
[0003] In recent years, domestic and foreign researchers have applied a variety of control strategies and algorithms to the problem of anti-interference formation flight control of UAVs, such as linear PID control, robust control, adaptive control, etc. However, these control methods mainly rely on the robustness of the algorithm itself to passively suppress the impact of interference, and their anti-interference capabilities are relatively limited. Summary of the invention
[0004] In response to the above problems and technical requirements, this application proposes a UAV anti-interference formation control method based on a generalized proportional integral observer. The technical solution of this application is as follows:
[0005] A UAV anti-interference formation control method based on a generalized proportional integral observer, the UAV anti-interference formation control method comprising: for any i-th wingman in the UAV formation:
[0006] Based on the expected formation of the UAV formation and the motion state information of the leader in the UAV formation, the expected trajectory of the wingman in the ground coordinate system is determined;
[0007] The disturbed dynamics model of the wingman based on the control quantity in the ground coordinate system is established, and the disturbed dynamics model of the wingman's trajectory tracking error is obtained by combining the desired trajectory of the wingman. in, It represents the trajectory tracking error of the wingman on the x-axis in the ground coordinate system. It represents the trajectory tracking error of the wingman on the y-axis in the ground coordinate system; Indicates the x-axis virtual control amount related to the wingman's control amount, Indicates the y-axis virtual control amount related to the control amount of the wingman; represents the x-axis lumped disturbance that is independent of the wingman's control quantity, represents the y-axis aggregate disturbance that is independent of the wingman's control quantity;
[0008] Based on the generalized proportional integral observer, the disturbance observers of the x-axis and y-axis are designed respectively, and the disturbance observer of the x-axis is used to estimate the lumped disturbance of the x-axis. Estimated value of And the trajectory tracking error An estimate of the rate of change Estimation of y-axis aggregate interference using y-axis interference observer Estimated value of And the trajectory tracking error An estimate of the rate of change
[0009] According to the disturbed dynamics model of trajectory tracking error, a composite dynamic inverse active disturbance rejection formation controller based on the estimated value of lumped disturbance and the estimated value of trajectory tracking error change rate is constructed. The estimated value obtained by using the disturbance observer is substituted into the composite dynamic inverse active disturbance rejection formation controller to obtain the control variable of the wingman to control the wingman's motion.
[0010] The beneficial technical effects of this application are:
[0011] The present application discloses a method for controlling a UAV formation with anti-interference, based on a generalized proportional integral observer. The method regards the unmeasurable parts of the external wind interference and the wingman tracking error system as lumped interference, and uses the generalized proportional integral observer to design an interference observer for the lumped interference to estimate and compensate for the lumped interference, thereby improving the control effect and active anti-interference capability of the UAV formation control system. The method has a higher-precision interference estimation effect and control performance, and broadens the types of interference that can be handled and the scope of application of the proposed method. BRIEF DESCRIPTION OF THE DRAWINGS
[0012] Figure 1 This is a control structure block diagram of a UAV anti-interference formation control method according to an embodiment of the present application.
[0013] Figure 2 It is a schematic diagram of the relationship between the ground coordinate system and the lead aircraft coordinate system.
[0014] Figure 3 It is the response diagram of the disturbed UAV formation flight trajectory when no interference observer is added in the simulation example.
[0015] Figure 4 It is the response diagram of the disturbed UAV formation flight trajectory when using the ESO-based interference observer in the simulation example.
[0016] Figure 5It is a flight trajectory response diagram of a disturbed UAV formation when the UAV anti-interference formation control method based on a generalized proportional-integral observer of the present application is used in a simulation example.
[0017] Figure 6 It is a curve comparison diagram of the longitudinal distance and longitudinal distance error between the leader 1 and the wingman 2 in the leader's coordinate system during the formation flight of the disturbed UAVs in the simulation example without the interference observer, using the ESO-based interference observer, and using the method of the present application.
[0018] Figure 7 It is a curve comparison diagram of the offset distance and the offset distance error between the leader 1 and the wingman 2 in the leader's coordinate system during the formation flight of the disturbed UAVs in the simulation example without the interference observer, using the ESO-based interference observer, and using the method of the present application.
[0019] Figure 8 It is a curve comparison diagram of the distance between the leader 1 and the wingman 2 in the ground coordinate system and the distance between the leader 1 and the wingman 2 during the formation flight of the disturbed UAVs in the simulation example without the interference observer, using the ESO-based interference observer, and using the method of the present application.
[0020] Fig. 9 It is a curve comparison diagram of the longitudinal distance and longitudinal distance error between the leader 1 and the wingman 3 in the leader's coordinate system during the formation flight of the disturbed UAVs in the simulation example without the interference observer, using the ESO-based interference observer, and using the method of the present application.
[0021] Fig.10 It is a curve comparison diagram of the offset distance and the offset distance error between the leader 1 and the wingman 3 in the leader's coordinate system during the formation flight of the disturbed UAVs in the simulation example without the interference observer, using the ESO-based interference observer, and using the method of the present application.
[0022] Fig.11 It is a curve comparison diagram of the distance between the leader 1 and the wingman 3 in the ground coordinate system and the distance between the leader 1 and the wingman 3 during the formation flight of the disturbed UAVs when no interference observer is added in the simulation example, when an ESO-based interference observer is used, and when the method of the present application is used.
[0023] Fig.12 It is a curve comparison diagram of the distance between wingman 2 and wingman 3 in the ground coordinate system and the distance between wingman 3 during the formation flight of the disturbed UAVs when no interference observer is added in the simulation example, when an ESO-based interference observer is used, and when the method of the present application is used.
[0024] Fig.13 It is a control quantity curve diagram of wingman 2 during the formation flight of disturbed UAVs in a simulation example when no interference observer is added, an ESO-based interference observer is used, and the method of the present application is used.
[0025] Fig.14 It is a control quantity curve diagram of the wingman 3 during the formation flight of the disturbed UAVs in the simulation example when no interference observer is added, an ESO-based interference observer is used, and the method of the present application is used.
[0026] Fig.15 It is a curve comparison diagram of the interference estimation effect and interference estimation error of the wingman 2 on the x-axis of the ground coordinate system during the formation flight of the disturbed UAVs in the simulation example when no interference observer is added, when an ESO-based interference observer is used, and when the method of the present application is used.
[0027] Fig.16 It is a curve comparison diagram of the interference estimation effect and interference estimation error of the wingman 2 on the y-axis of the ground coordinate system during the formation flight of the disturbed UAVs in the simulation example when no interference observer is added, when an ESO-based interference observer is used, and when the method of the present application is used.
[0028] Fig.17 It is a curve comparison diagram of the interference estimation effect and interference estimation error of the wingman 3 on the x-axis of the ground coordinate system during the formation flight of the disturbed UAVs in the simulation example when no interference observer is added, when an ESO-based interference observer is used, and when the method of the present application is used.
[0029] Fig.18 It is a curve comparison diagram of the interference estimation effect and interference estimation error of the wingman 3 on the y-axis of the ground coordinate system during the formation flight of the disturbed UAVs in the simulation example when no interference observer is added, an ESO-based interference observer is used, and the method of the present application is used. DETAILED DESCRIPTION
[0030] The specific implementation of the present application is further described below in conjunction with the accompanying drawings.
[0031] This application discloses a UAV anti-interference formation control method based on a generalized proportional integral observer. Please refer to Figure 1 The control block diagram shown in FIG. 1 is used in a UAV formation scenario, where the UAV formation includes a leader and multiple wingmen following the leader, such as Figure 1 Take, for example, a desired formation including a leader 1 and two wingmen 2 and 3 that maintains an equilateral triangle.
[0032] The leader controller is used to determine the control amount of the leader based on the preset flight route and output it to the leader 1 to control the motion state of the leader 1. The control amount of the leader includes the acceleration and heading angular rate of the leader. This part can be completed according to the conventional method under the current UAV formation control. This application does not go into details. The anti-interference formation control method of this application is mainly aimed at the following control of the wingman. The control method for any i-th wingman in the UAV formation includes the following content, i is a positive integer parameter, and the i-th wingman is any wingman in the UAV formation:
[0033] Step S1, based on the expected formation of the UAV formation and combined with the motion state information of the leader aircraft in the UAV formation, determine the expected trajectory of the wingman in the ground coordinate system.
[0034] During the UAV formation flight, the motion status information of the leader and the wingman can be read. The motion status information of the leader includes the motion speed v L , the heading angle of the lead aircraft The x-axis coordinate x of the lead aircraft in the ground coordinate system L , the y-axis coordinate of the lead aircraft in the ground coordinate system L The wingman's motion status information includes the wingman's motion speed. Wingman's heading angle The x-axis coordinate of the wingman in the ground coordinate system Y-axis coordinate of the lead aircraft in the ground coordinate system The ground coordinate system in this application generally takes an arbitrary position as the coordinate origin, the positive direction of the x-axis pointing due east, and the positive direction of the y-axis pointing due north.
[0035] The kinematic equation of the lead aircraft in the ground coordinate system is:
[0036]
[0037] The expected formation of the UAV formation will indicate the expected longitudinal distance of the i-th wingman relative to the leader in the leader's coordinate system O-XY. and expected deviation Long machine coordinate system O-XY such as Figure 2 As shown, the lead machine coordinate system O-XY takes the position of the lead machine as the coordinate origin, the direction of the movement speed of the lead machine as the positive direction of the X axis, and the direction perpendicular to the X axis and pointing to the left side of the axis where the movement speed of the lead machine is located as the positive direction of the Y axis. Represents x L The first derivative of other parameters is also expressed in this way.
[0038] The expected longitudinal distance of the i-th wingman It is the difference between the X-axis coordinate of the leader in the leader's coordinate system O-XY and the X-axis coordinate of the wingman in the leader's coordinate system O-XY. Figure 1 In the example, both wingmen are flying behind the lead aircraft, so the expected longitudinal distance between the two wingmen is Both are greater than 0.
[0039] The expected deviation distance of the i-th wingman It is the difference between the Y-axis coordinate of the leader in the leader's coordinate system O-XY and the Y-axis coordinate of the wingman in the leader's coordinate system O-XY. When the i-th wingman is located on the left side of the axis where the leader's motion speed direction is located, the expected deviation distance is When the i-th wingman is located on the right side of the axis of the leader's speed direction, the expected deviation distance like Figure 2 The coordinate diagram shows the expected longitudinal distance of the wingman 2. and expected deviation And in Figure 1 The expected deviation distance of Wingman 2 under the expected formation Expected deviation distance of Wingman 3
[0040] According to the coordinate conversion relationship between the lead aircraft coordinate system O-XY and the ground coordinate system, the expected x-axis coordinate of the i-th wingman in the ground coordinate system at each moment can be determined while maintaining the expected formation action. and the expected y-axis coordinate for:
[0041]
[0042] The expected coordinates of the i-th wingman at each moment are the expected trajectory of the wingman in the ground coordinate system.
[0043] Step S2, establishing a disturbed dynamics model of the wingman based on the control quantity in the ground coordinate system.
[0044] The disturbed dynamic model of the wingman in the ground coordinate system is:
[0045]
[0046] in, is the x-axis coordinate of the wingman in the ground coordinate system, is the y-axis coordinate of the wingman in the ground coordinate system, is the wingman's movement speed, is the heading angle of the wingman. These are all measurable information of the wingman's motion status. is the wingman's acceleration, is the heading angular rate of the wingman, and these two are the control quantities of the wingman. and Both represent the external wind interference items that the wingman is subject to.
[0047] Step S3, combining the disturbed dynamics model of the wingman and the desired trajectory of the wingman to obtain the disturbed dynamics model of the trajectory tracking error of the wingman.
[0048] First, define the x-axis trajectory tracking error of the wingman in the ground coordinate system: And the tracking error of the y-axis Combining formula (2) and formula (3), the trajectory tracking error can be obtained as follows:
[0049]
[0050] Then, the disturbed dynamic model of the wingman's trajectory tracking error can be obtained. The disturbed dynamic model of the trajectory tracking error characterizes the relationship between the wingman's trajectory tracking error and the wingman's control quantity and motion state information. Combining the kinematic equation (1) of the leader in the ground coordinate system and the disturbed dynamic model (3) of the wingman in the ground coordinate system, we substitute them into the above equation (4) to obtain:
[0051]
[0052] Considering that the acceleration of the lead aircraft is unknown during the UAV formation flight, the velocity v of the lead aircraft will be included. L and heading angle The term of the rate of change is used as an interference term. and Represents the interference term in the rate of change of trajectory tracking error. represents the x-axis lumped disturbance that is independent of the wingman's control quantity, represents the y-axis lumped disturbance that is independent of the wingman's control quantity. And:
[0053]
[0054] It can be seen from the above formula that the x-axis lumped interference and the y-axis lumped interference They respectively include external wind interference and unmeasurable interference in the wingman tracking error system.
[0055] In order to facilitate the design, the x-axis virtual control amount related to the control amount of the wingman is introduced and the y-axis virtual control amount Based on equations (6) and (7), the virtual control quantity can be designed as:
[0056]
[0057] Then equation (6) can be rewritten to obtain the disturbed dynamic model of the wingman's trajectory tracking error:
[0058]
[0059] Step S4, designing the disturbance observers of the x-axis and the y-axis respectively based on the generalized proportional integral observer (GPIO).
[0060] The designed x-axis disturbance observers are:
[0061]
[0062] The designed disturbance observers for the y-axis are:
[0063]
[0064] in, as well as Both are observer intermediate variables of the generalized proportional-integral observer. as well as are the observer parameters of the generalized proportional-integral observer. The values of the observer parameters satisfy as well as is Hurwitz, s represents an imaginary parameter. In one embodiment,
[0065] Then the x-axis interference observer (10) can be used to estimate the x-axis aggregate interference Estimated value of And the trajectory tracking error An estimate of the rate of change And the y-axis interference observer (11) is used to estimate the y-axis aggregate interference Estimated value of And the trajectory tracking error An estimate of the rate of change
[0066] Step S5, according to the trajectory tracking error disturbed dynamics model, construct a composite dynamic inverse active disturbance rejection formation controller based on the estimated value of the lumped disturbance and the estimated value of the trajectory tracking error change rate, substitute the estimated value obtained by using the disturbance observer into the composite dynamic inverse active disturbance rejection formation controller, and obtain the control amount of the wingman to control the movement of the wingman.
[0067] According to the trajectory tracking error disturbed dynamics model (9), combined with the estimated values of the x-axis disturbance observer (10) and the y-axis disturbance observer (11), a composite dynamic inverse active anti-disturbance formation controller is designed based on the x-axis virtual control quantity. and the y-axis virtual control amount The expression is:
[0068]
[0069] in, and are controller parameters and are positive numbers. as well as
[0070] According to the expression (8) of the virtual control quantity, combined with (12), the expression of the control quantity of the composite dynamic inverse active disturbance rejection formation controller based on the wingman can be obtained as follows:
[0071]
[0072] Therefore, the wingman controller can obtain the control quantity of the wingman based on the composite dynamic inverse active anti-disturbance formation controller (13) and use it to control the motion state of the wingman.
[0073] In order to verify the anti-interference performance of the UAV anti-interference formation control method proposed in this application, simulation verification is carried out based on MATLAB / Simulink, and the Simulink toolbox in the simulation software MATLAB R2022b is used to build a simulation model considering external wind disturbance. Figure 1 The control system of the three UAVs in the regular triangle formation is shown, and simulation and verification are carried out. Considering the effect of external wind disturbance, the wingman controller is designed based on the extended state observer (ESO) and the generalized proportional integral observer (GPIO) proposed in this application without an observer, and then compared and verified.
[0074] The initial motion state information of the lead aircraft 1 in the inertial coordinate system is set as The initial motion state information of wingman 2 in the inertial coordinate system is set as The initial motion state information of wingman 3 in the inertial coordinate system is set as
[0075] During the flight, the preset acceleration and heading rate commands of the lead aircraft are set as follows:
[0076]
[0077] The external wind interference is set as the amount of change in the y-axis direction of the ground coordinate system as the wingman position coordinate changes:
[0078]
[0079] The specific simulation results and analysis are as follows:
[0080] The motion trajectory of the UAV formation in the form of a regular triangle formation when there is no observer is as follows: Figure 3 As shown in the figure, the motion trajectory of the regular triangle formation when the UAV formation is disturbed based on the ESO anti-interference formation control method is as follows Figure 4 As shown, the motion trajectory of the regular triangle formation when the UAV formation is disturbed when the anti-interference formation control method based on GPIO in this application is as follows Figure 5 As shown. Figure 3-Figure 5 It can be seen that the GPIO-based UAV anti-interference formation control method proposed in this application has the best effect, the formation is kept most intact, and the influence of external wind interference and the unmeasurable parts in the wingman trajectory tracking error system on the formation control accuracy is significantly reduced.
[0081] The longitudinal distance between the leader aircraft 1 and the wingman 2 on the left in the leader aircraft coordinate system during formation flight in three different situations. The response curve comparison is shown in the figure Figure 6 As shown in (a) in the figure, the longitudinal distance in the long-machine coordinate system is Longitudinal distance error from expected longitudinal distance The response curve comparison is shown in the figure Figure 6 The lateral offset distance between the leader aircraft 1 and the wingman 2 on the left in the leader aircraft coordinate system during formation flight The response curve comparison is shown in the figure Figure 7 As shown in (a), the side deviation error between the side deviation in the long-machine coordinate system and the expected side deviation The response curve comparison is shown in the figure Figure 7 The distance between the lead aircraft 1 and the wingman 2 on the left in the ground coordinate system during formation flight in three different situations The response curve comparison is shown in the figure Figure 8 As shown in (a), the distance between the lead aircraft 1 and the wingman 2 in the ground coordinate system and the expected distance between the aircraft The response curve comparison is shown in the figure Figure 8 As shown in (b) in .
[0082] The longitudinal distance between the leader aircraft 1 and the wingman 3 on the right in the leader aircraft coordinate system during formation flight in three different situations. The response curve comparison is shown in the figure Fig. 9 As shown in (a), the longitudinal distance error between the longitudinal distance in the long-haul aircraft coordinate system and the expected longitudinal distance The response curve comparison is shown in the figure Fig. 9 The lateral offset distance between the leader aircraft 1 and the wingman aircraft 3 on the right in the leader aircraft coordinate system during formation flight The response curve comparison is shown in the figure Fig.10As shown in (a), the side deviation error between the side deviation in the long-machine coordinate system and the expected side deviation The response curve comparison is shown in the figure Fig.10 The distance between the lead aircraft 1 and the wingman 3 on the right in the ground coordinate system during formation flight in three different situations The response curve comparison is shown in the figure Fig.11 As shown in (a), the distance between the lead aircraft 1 and the wingman 3 in the ground coordinate system and the expected distance between the aircraft The response curve comparison is shown in the figure Fig.11 As shown in (b) in .
[0083] The distance between wingman 2 and wingman 3 in the ground coordinate system during formation flying in three different situations The response curve comparison is shown in the figure Fig.12 As shown in (a), the distance between wingman 2 and wingman 3 in the ground coordinate system The error between the machine spacing and the expected machine spacing The response curve comparison is shown in the figure Fig.12 As shown in (b) in .
[0084] By the above Figure 6-Figure 12 It can be seen from the comparison chart that the GPIO-based UAV anti-interference formation control method of the present application has the best effect and the smallest error. It can better maintain the preset formation under wind disturbance and during formation turning, the formation error converges to zero faster, and the anti-interference performance is significantly improved.
[0085] In three different cases, the control amount curves of wingman 2 during formation flight are as follows: Fig.13 As shown, Fig.13 (a) is the acceleration curve of wingman 2 in three different situations. Fig.13 (b) is the heading angular rate curve of wingman 2 under three different conditions. The control amount curve of wingman 3 during formation flight is shown in Fig.14 As shown, Fig.14 (a) is the acceleration curve of wingman 3 under three different conditions. Fig.14 (b) in FIG. 1 is a graph showing the heading angular rate of the wingman 3 in three different situations. Fig.13 and Fig.14 It can be seen that the response curves of the control quantities of the three different methods are at the same level, which shows the fairness of the comparison.
[0086] When the anti-interference formation control method is performed based on ESO, the comparison curve between the interference estimation value of wingman 2 in the x-axis direction of the ground coordinate system and the true value of the aggregate interference is as follows: Fig.15When the anti-interference formation control method based on GPIO is used in the present application, the comparison curve between the interference estimation value of wingman 2 in the x-axis direction of the ground coordinate system and the real value of the aggregate interference is as follows: Fig.15 The comparison curves of the interference estimation error of wingman 2 in the x-axis direction of the ground coordinate system under three different control methods are shown in (b). Fig.15 When the anti-interference formation control method is performed based on ESO, the comparison curve between the interference estimation value of wingman 2 in the y-axis direction of the ground coordinate system and the real value of the aggregate interference is shown in Fig.16 When the anti-interference formation control method based on GPIO is used in the present application, the comparison curve between the interference estimation value of wingman 2 in the y-axis direction of the ground coordinate system and the real value of the aggregate interference is as follows: Fig.16 The comparison curves of the interference estimation error of wingman 2 in the y-axis direction of the ground coordinate system under three different control methods are shown in (b). Fig.16 As shown in (c) in .
[0087] When the anti-interference formation control method is performed based on ESO, the comparison curve between the interference estimation value of wingman 3 in the x-axis direction of the ground coordinate system and the real value of the aggregate interference is as follows: Fig.17 When the anti-interference formation control method based on GPIO is used in the present application, the comparison curve between the interference estimation value of the wingman 3 in the x-axis direction of the ground coordinate system and the real value of the aggregate interference is as follows: Fig.17 The comparison curves of the interference estimation errors of the wingman 3 in the x-axis direction of the ground coordinate system under three different control methods are shown in (b). Fig.17 When the anti-interference formation control method is performed based on ESO, the comparison curve between the interference estimation value of wingman 3 in the y-axis direction of the ground coordinate system and the real value of the aggregate interference is shown in Fig.18 When the anti-interference formation control method based on GPIO is used in the present application, the comparison curve between the interference estimation value of the wingman 3 in the y-axis direction of the ground coordinate system and the real value of the aggregate interference is as follows: Fig.18 The comparison curves of the interference estimation errors of the wingman 3 in the y-axis direction of the ground coordinate system under three different control methods are shown in (b). Fig.18 As shown in (c) in .
[0088] Depend on Figure 15-18 It can be seen that the interference estimation error is minimized when the anti-interference formation control method based on GPIO of the present application is used, and a higher estimation accuracy can be obtained, thereby achieving a better anti-interference formation control effect.
[0089] The above is only a preferred embodiment of the present application, and the present application is not limited to the above embodiments. It is understood that other improvements and changes directly derived or associated by those skilled in the art without departing from the spirit and concept of the present application should be considered to be included in the protection scope of the present application.
Claims
1. A UAV anti-interference formation control method based on generalized proportional integral observer, characterized in that: The anti-interference formation control method for unmanned aerial vehicles includes: for any i-th wingman in the unmanned aerial vehicle formation: Based on the expected formation of the UAV formation and combined with the motion state information of the leader aircraft in the UAV formation, determine the expected trajectory of the wingman in the ground coordinate system; A disturbed dynamics model of the wingman based on the control quantity in the ground coordinate system is established, and a disturbed dynamics model of the trajectory tracking error of the wingman is obtained in combination with the desired trajectory of the wingman. in, represents the trajectory tracking error of the wingman on the x-axis in the ground coordinate system, represents the trajectory tracking error of the wingman on the y-axis in the ground coordinate system; represents the x-axis virtual control amount related to the control amount of the wingman, A y-axis virtual control amount related to the control amount of the wingman is represented; represents the x-axis lumped disturbance that is independent of the wingman's control quantity, represents the y-axis aggregate disturbance that is independent of the wingman's control quantity; Based on the generalized proportional integral observer, the disturbance observers of the x-axis and y-axis are designed respectively, and the disturbance observer of the x-axis is used to estimate the lumped disturbance of the x-axis. Estimated value of And the trajectory tracking error An estimate of the rate of change Estimation of y-axis aggregate interference using y-axis interference observer Estimated value of And the trajectory tracking error An estimate of the rate of change According to the trajectory tracking error disturbed dynamics model, a composite dynamic inverse active disturbance rejection formation controller based on the estimated value of the lumped disturbance and the estimated value of the trajectory tracking error change rate is constructed, and the estimated value obtained by using the disturbance observer is substituted into the composite dynamic inverse active disturbance rejection formation controller to obtain the control amount of the wingman to control the movement of the wingman; the constructed composite dynamic inverse active disturbance rejection formation controller is based on the x-axis virtual control amount and the y-axis virtual control amount The expression is: in, and They are all controller parameters and their values are positive numbers; The control amount of the wingman includes the acceleration of the wingman and the heading angular rate The x-axis virtual control amount and the y-axis virtual control amount of the wingman are respectively: The constructed composite dynamic inverse active disturbance rejection formation controller based on the control quantity of the wingman is expressed as follows: in, is the movement speed of the wingman, is the heading angle of the wingman.
2. The anti-interference formation control method for UAVs according to claim 1, characterized in that: The designed x-axis disturbance observers are: The designed disturbance observers for the y-axis are: in, as well as are all observer intermediate variables of the generalized proportional-integral observer, as well as are all observer parameters of the generalized proportional-integral observer, and their values satisfy as well as is the Hurwitz function, and s represents the imaginary parameter.
3. The anti-interference formation control method for UAVs according to claim 1, characterized in that: The disturbed dynamics model of the wingman in the ground coordinate system is: in, is the x-axis coordinate of the wingman in the ground coordinate system, is the y-axis coordinate of the wingman in the ground coordinate system, and All represent the external wind interference items to which the wingman is subjected; Trajectory tracking error based on the x-axis And the tracking error of the y-axis The relationship between is used to obtain the disturbed dynamic model of the trajectory tracking error of the wingman; wherein, is the expected x-axis coordinate of the wingman in the ground coordinate system, is the expected y-axis coordinate of the wingman in the ground coordinate system.
4. The anti-interference formation control method for UAVs according to claim 3 is characterized in that: The motion state information of the lead aircraft includes the motion speed v of the lead aircraft L , heading angle The x-axis coordinate x in the ground coordinate system L , the y-axis coordinate y in the ground coordinate system L ; Determining the desired trajectory of the wingman in the ground coordinate system includes: The kinematic equation of the lead aircraft in the ground coordinate system is determined as: The expected longitudinal distance between the wingman and the leader in the leader coordinate system O-XY based on the expected formation formation indicated by the UAV formation and expected deviation Determine the expected x-axis coordinate of the wingman at each moment in the ground coordinate system and the expected y-axis coordinate for: The expected longitudinal distance is the difference between the X-axis coordinate of the lead aircraft in the lead aircraft coordinate system O-XY and the X-axis coordinate of the wingman in the lead aircraft coordinate system O-XY. It is the difference between the Y-axis coordinate of the lead aircraft in the lead aircraft coordinate system O-XY and the Y-axis coordinate of the wingman in the lead aircraft coordinate system O-XY; the lead aircraft coordinate system O-XY takes the position of the lead aircraft as the coordinate origin, the direction of the leader's movement speed as the positive direction of the X-axis, and the direction perpendicular to the X-axis and pointing to the left side of the axis where the leader's movement speed direction is located as the positive direction of the Y-axis.
5. The anti-interference formation control method for UAVs according to claim 4 is characterized in that: The trajectory tracking error disturbed dynamics model of the wingman is obtained, including: Define the trajectory tracking error of the wingman in the ground coordinate system: Combining the kinematic equation of the lead aircraft in the ground coordinate system and the disturbed dynamics model of the wingman in the ground coordinate system, we can get: The velocity v of the long machine will be included L and heading angle The term of the rate of change is used as an interference term, and represents the interference term in the rate of change of trajectory tracking error, and: The x-axis virtual control amount and the y-axis virtual control amount are introduced to obtain the trajectory tracking error disturbed dynamic model of the wingman
Citation Information
Patent Citations
Unmanned aerial vehicle formation keeping control method based on self-adaptive control
CN107807663A
Quadrotor unmanned aerial vehicle cluster anti-interference formation control method based on disturbance observer
CN111766899A
Wing plane formation control system and method based on lead plane behavior prediction
CN112596546A
Multi-unmanned aerial vehicle system nonlinear robust tracking control method based on azimuth measurement information
CN115407661A
Unmanned aerial vehicle formation keeping control method based on active disturbance rejection controller
CN115542943A
