A highly adaptive control method for unmanned aerial vehicles

By estimating the interference of UAV pitch angle, angular rate, and vertical acceleration and using sliding mode control, a desired pitch angle signal is generated, which solves the problem of insufficient anti-interference capability of UAV altitude control and realizes adaptive tracking and robustness enhancement of altitude control.

CN115167117BActive Publication Date: 2024-11-01YANTAI UNIV
View PDF 0 Cites 0 Cited by

Patent Information

Application Number
CN202210936770.1
Authority / Receiving Office
CN · China
Patent Type
Patents(China)
Current Assignee / Owner
Filing Date
2022-08-05
Publication Date
2024-11-01
Estimated Expiration
2042-08-05

AI Technical Summary

Technical Problem

Existing drone altitude control methods lack sufficient anti-interference capability and robustness when facing different forms of interference.

Method used

An altitude adaptive control method based on disturbance estimation is adopted. By measuring signals such as pitch angle, angular rate, and vertical acceleration of the UAV, an error nonlinear sliding mode signal is formed. The desired pitch angle signal is generated by superimposing the error integrated sliding mode signal with the pitch control signal, thereby achieving adaptive tracking of the desired altitude.

Benefits of technology

It improves the anti-interference capability and robustness of UAV altitude control, ensuring altitude control accuracy and stability in complex environments.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN115167117B_ABST
    Figure CN115167117B_ABST
Patent Text Reader

Abstract

The present invention relates to a highly adaptive control technology for unmanned aerial vehicles. The technology forms an error sliding mode of a trinity of position error, velocity error and acceleration error by measuring the pitch angle, pitch angle rate, acceleration and vertical height of the unmanned aerial vehicle. At the same time, adaptive interference estimation and compensation are performed from three levels of pitch angle, pitch angle rate and vertical acceleration to form a pitch angle desired signal. An error comprehensive sliding mode surface is formed through pitch angle error, pitch angle rate error and error nonlinear transformation. Adaptive interference estimation and compensation from acceleration and angular velocity are superimposed. Finally, a method for highly adaptive control of unmanned aerial vehicles is realized, and the method has good highly anti-interference adaptive capability.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present invention relates to the field of unmanned aerial vehicle altitude control, and in particular to an unmanned aerial vehicle altitude adaptive control method using interference estimation. Background Art

[0002] At present, the altitude control of large unmanned aerial vehicles generally adopts the altitude proportional differential control to generate the desired pitch angle signal, and then forms the proportional integral differential control strategy of the inner loop by measuring and feedback the pitch angle and pitch angle rate. The robustness of the above control strategy comes from the robustness of PID control, but it cannot accurately compensate for specific different forms of interference. Based on the above background reasons, the present invention proposes a highly adaptive control method for interference compensation based on three aspects of pitch angle, angular rate and vertical acceleration, and the ingenious construction from interference to adaptive sliding surface and desired pitch angle makes the whole scheme have good altitude adaptability, robustness and anti-interference ability. Experiments also show that the present invention not only has good theoretical value, but also has high engineering practical value.

[0003] It should be noted that the information disclosed in the above background technology section is only used to enhance the understanding of the background of the present invention, and therefore may include information that does not constitute prior art known to ordinary technicians in the field. Summary of the invention

[0004] The purpose of the present invention is to provide a highly adaptive control technology for an unmanned aerial vehicle, thereby overcoming the problem of weak anti-interference ability of altitude control caused by limitations and defects of related technologies.

[0005] According to one aspect of the present invention, a highly adaptive control technology for a drone is provided, comprising the following steps:

[0006] Step S10, installing a radio altimeter to measure the altitude signal of the UAV, installing an inertial navigation device to measure the vertical acceleration signal and vertical velocity signal of the UAV, and setting an expected altitude signal according to the flight mission of the UAV, respectively comparing the altitude signal with the expected altitude signal to obtain an altitude error signal; comparing the vertical velocity signal with the first-order derivative of the expected altitude signal to obtain a velocity error signal; comparing the vertical acceleration signal with the second-order derivative of the expected altitude signal to obtain an acceleration error signal; then performing nonlinear transformation on the altitude error signal, the velocity error signal and the acceleration error signal and combining them to obtain an error nonlinear sliding mode signal.

[0007] Step S20, install an attitude gyroscope to measure the pitch angle signal of the UAV, install a rate gyroscope to measure the pitch angle rate signal of the UAV, solve the attitude angular rate related interference estimation law signal, the attitude acceleration related interference estimation law signal and the attitude angle related interference estimation law signal according to the error nonlinear sliding mode signal, and integrate them to obtain the corresponding attitude angular rate related interference estimation signal, attitude acceleration related interference estimation signal and attitude angle related interference estimation signal, and obtain the attitude related total interference estimation signal through synthesis.

[0008] Step S30, using the attitude-related total interference estimation signal to superimpose the nonlinear sliding mode signal, the altitude error signal, the velocity error signal, and the acceleration error signal to obtain a combined error sliding mode signal; and superimposing the sliding mode weight factor formed by the pitch control signal to form a pitch angle desired signal; and comparing the pitch angle signal with the pitch angle desired signal to obtain a pitch angle error signal.

[0009] Step S40, designing a first-order transfer function for the pitch angle error signal to solve the first-order lag signal of the pitch angle desired signal; designing a second-order transfer function to solve the second-order lag signal of the pitch angle desired signal; synthesizing the first-order lag signal of the pitch angle desired signal and the second-order lag signal of the pitch angle desired signal with the pitch angle desired signal, and dividing by a corresponding time constant to obtain a pitch angle desired approximate differential signal, and comparing it with the pitch angle rate signal to obtain a pitch angle rate error signal; then performing nonlinear transformation on the pitch angle error signal and the pitch angle rate error signal respectively to obtain a pitch angle error nonlinear signal and a pitch angle rate error nonlinear signal; then integrating the pitch angle error signal to obtain a pitch angle error integrated signal, and superimposing the height error signal, the velocity error signal, the acceleration error signal, the pitch angle error signal, the pitch angle rate error signal, the pitch angle error nonlinear signal and the pitch angle rate error nonlinear signal respectively to form an error synthesis sliding mode signal.

[0010] Step S50, solving the pitch angle rate related internal interference estimation law signal and the acceleration related internal interference estimation law signal according to the error integrated sliding mode signal, and obtaining the pitch angle rate related internal interference estimation signal and the acceleration related internal interference estimation signal by integration, and superimposing the error integrated sliding mode signal to form a final pitch control signal, which is transmitted to the pitch servo system to realize the highly adaptive control of the UAV and adaptively track the expected height signal.

[0011] In an exemplary embodiment of the present invention, a radio altimeter is installed to measure the altitude signal of the UAV, an inertial navigation device is installed to measure the vertical acceleration signal and the vertical velocity signal of the UAV, and an expected altitude signal is set according to the flight mission of the UAV, and the altitude signal is compared with the expected altitude signal to obtain an altitude error signal; the vertical velocity signal is compared with the first-order derivative of the expected altitude signal to obtain a velocity error signal; the vertical acceleration signal is compared with the second-order derivative of the expected altitude signal to obtain an acceleration error signal; and then the altitude error signal, the velocity error signal and the acceleration error signal are nonlinearly transformed and combined to obtain an error nonlinear sliding mode signal, which includes:

[0012] e1=hh d ;

[0013]

[0014]

[0015]

[0016] Where h is the altitude signal of the UAV measured by installing a radio altimeter, v is the vertical velocity signal of the UAV measured by installing an inertial navigation device, and a is the vertical acceleration signal measured by installing an inertial navigation device; h d To set the desired altitude signal according to the UAV flight mission, is the first-order derivative of the desired height signal, is the second-order derivative of the desired height signal; e1 is the height error signal, e2 is the velocity error signal; e3 is the acceleration error signal; s a is the error nonlinear sliding mode signal; d1, d2, d3, ε1, ε4, ε5, ε6 are constant parameters.

[0017] In an exemplary embodiment of the present invention, an attitude gyroscope is installed to measure the pitch angle signal of the drone, and a rate gyroscope is installed to measure the pitch angle rate signal of the drone. According to the error nonlinear sliding mode signal, the attitude angular rate-related interference estimation law signal, the attitude acceleration-related interference estimation law signal and the attitude angle-related interference estimation law signal are solved, and the corresponding attitude angular rate-related interference estimation signal, the attitude acceleration-related interference estimation signal and the attitude angle-related interference estimation signal are respectively integrated to obtain the corresponding attitude angular rate-related interference estimation signal, the attitude acceleration-related interference estimation signal and the attitude angle-related interference estimation signal. The attitude-related total interference estimation signal obtained by synthesis includes:

[0018]

[0019]

[0020]

[0021] where ω z is the pitch rate signal of the drone measured by the installed rate gyroscope; p4 ​​is the interference estimation law signal related to the attitude angular rate, p5 is the interference estimation law signal related to the attitude acceleration, and p6 is the interference estimation law signal related to the attitude angle. is the attitude angular rate related disturbance estimation signal, is the attitude acceleration related disturbance estimation signal, k is the attitude angle related interference estimation signal; d1 , k d2 , k d3 is a constant parameter used to adjust the estimation rate of the interference estimation signal; s b is the attitude related total interference estimation signal.

[0022] In an exemplary embodiment of the present invention, the attitude-related total interference estimation signal is superimposed on a nonlinear sliding mode signal, a height error signal, a velocity error signal, and an acceleration error signal to obtain a combined error sliding mode signal; and a sliding mode weight factor formed by a pitch control signal is superimposed to form a pitch angle desired signal; and the pitch angle signal is compared with the pitch angle desired signal to obtain a pitch angle error signal, which includes:

[0023] s w =c1e1+c2e2+c3e3+s a +s b ;

[0024]

[0025]

[0026]

[0027] where s w is the combined error sliding mode signal; c1, c2, c3 are constant parameters related to sliding mode; u f is the pitch control signal, and its initial value is selected as 0, k f is the sliding mode weight factor formed by the pitch control signal; Pitch angle desired signal; It is the pitch angle signal of the UAV measured by the attitude gyroscope; e4 is the pitch angle error signal.

[0028] In an exemplary embodiment of the present invention, a first-order transfer function is designed for a pitch angle error signal to solve a first-order lag signal of a desired pitch angle signal; a second-order transfer function is designed to solve a second-order lag signal of the desired pitch angle signal; the first-order lag signal of the desired pitch angle signal and the second-order lag signal of the desired pitch angle signal are synthesized with the desired pitch angle signal and divided by a corresponding time constant to obtain a desired pitch angle approximate differential signal, and the signal is compared with a pitch angle rate signal to obtain a pitch angle rate error signal; then, the pitch angle error signal and the pitch angle rate error signal are nonlinearly transformed respectively to obtain a pitch angle error nonlinear signal and a pitch angle rate error nonlinear signal; then, the pitch angle error signal is integrated to obtain a pitch angle error integrated signal, and a height error signal, a velocity error signal, an acceleration error signal, a pitch angle error signal, a pitch angle rate error signal, a pitch angle error nonlinear signal and a pitch angle rate error nonlinear signal are superimposed respectively to form an error synthesis sliding mode signal, including:

[0029]

[0030]

[0031]

[0032]

[0033]

[0034]

[0035] s2=∫e4dt;

[0036] s3=j1e1+j2e2+j3e3+j4e4+j5e5+j6s2+w a +w b ;

[0037] Where s is the differential operator of the first-order transfer function and the second-order transfer function; T1, T2, and T3 are the time factors of the transfer function, which are constants; is the first-order lag signal of the desired pitch angle signal; is the second-order lag signal of the desired pitch angle signal; is the expected approximate differential signal of the pitch angle; e5 is the pitch angle rate error signal; w a is the nonlinear signal of the pitch angle error, w b is the nonlinear signal of the pitch angle rate error; d4, d5, ε2, ε3 are constant parameters; s2 is the pitch angle error integral signal, s3 is the error integrated sliding mode signal, j1, j2, j3, j4, j5, j6 are constant parameters.

[0038] In an exemplary embodiment of the present invention, the pitch angle rate-related internal interference estimation law signal and the acceleration-related internal interference estimation law signal are solved according to the error integrated sliding mode signal, and the pitch angle rate-related internal interference estimation signal and the acceleration-related internal interference estimation signal are obtained by integration, and the error integrated sliding mode signal is superimposed to form a final pitch control signal including;

[0039]

[0040]

[0041] Where p7 is the pitch angle rate related internal interference estimation law signal, p8 is the acceleration related internal interference estimation law signal, k d7 With k d8 is a constant interference signal, used to adjust the speed of interference estimation; is the pitch angle rate related internal interference estimation signal, is the acceleration related internal interference estimation signal, k f1 , k f2 is a constant control parameter, u f The final pitch control signal is transmitted to the pitch servo system to achieve adaptive height control of the UAV and adaptively track the desired height signal.

[0042] Beneficial Effects

[0043] The invention discloses a highly adaptive control technology for unmanned aerial vehicles, and its main innovations are as follows: first, an error variable is formed by measuring the three-dimensional integration of acceleration, velocity and position, and a method of adaptive interference estimation of pitch angle, vertical acceleration and pitch angle rate is adopted to form an error nonlinear sliding mode, and a pitch angle desired signal that is dynamically adjusted with the final pitch control amount is formed through an error comprehensive sliding mode, so that adaptive interference estimation compensation is realized in the generation of the angle desired signal. Second, a proportional differential signal of the error comprehensive sliding mode is formed through the pitch angle error, the pitch angle rate error and nonlinear transformation, and an interference estimation signal related to acceleration and angular velocity is superimposed, so that highly adaptive control is realized, thereby providing a strong high anti-interference capability from the inside.

[0044] It is to be understood that the foregoing general description and the following detailed description are exemplary and explanatory only and are not restrictive of the invention. BRIEF DESCRIPTION OF THE DRAWINGS

[0045] The accompanying drawings herein are incorporated into and constitute a part of the specification, illustrate embodiments consistent with the present invention, and together with the specification are used to explain the principles of the present invention. Obviously, the accompanying drawings described below are only some embodiments of the present invention, and for those of ordinary skill in the art, other accompanying drawings can be obtained based on these accompanying drawings without creative work.

[0046] Figure 1 The present invention provides a method flow chart of highly adaptive control technology for unmanned aerial vehicles.

[0047] Figure 2 is a height signal curve of the UAV of the method provided in the embodiment of the present invention (unit: meter);

[0048] Figure 3 is a vertical speed signal curve of the UAV according to the method provided in the embodiment of the present invention (unit: meters per second);

[0049] Figure 4 is a vertical acceleration signal curve of the UAV of the method provided in the embodiment of the present invention (unit: meter per square second);

[0050] Figure 5 is a pitch angle signal curve of the UAV of the method provided in the embodiment of the present invention (unit: degree);

[0051] Figure 6 is a pitch rate curve of the UAV of the method provided in the embodiment of the present invention (unit: degrees per second);

[0052] Figure 7 is a pitch control signal curve of the UAV of the method provided in the embodiment of the present invention (unit: degree). DETAILED DESCRIPTION

[0053] Example embodiments will now be described more fully with reference to the accompanying drawings. However, example embodiments can be implemented in a variety of forms and should not be construed as being limited to the examples set forth herein; on the contrary, these embodiments are provided so that the present invention will be more comprehensive and complete, and the concept of the example embodiments will be fully conveyed to those skilled in the art. The described features, structures, or characteristics may be combined in one or more embodiments in any suitable manner. In the following description, many specific details are provided to provide a full understanding of the embodiments of the present invention. However, those skilled in the art will appreciate that the technical solutions of the present invention may be practiced while omitting one or more of the specific details, or other methods, components, devices, steps, etc. may be adopted. In other cases, known technical solutions are not shown or described in detail to avoid blurring out various aspects of the present invention.

[0054] The present invention provides an error sliding mode which forms a trinity of position error, velocity error and acceleration error by measuring the pitch angle, pitch angle rate, acceleration and vertical height, and simultaneously performs interference adaptive estimation and compensation from three levels of pitch angle, pitch angle rate and vertical acceleration to form a pitch angle desired signal, and forms an error comprehensive sliding mode surface through pitch angle error, pitch angle rate error and error nonlinear transformation, and superimposes interference adaptive estimation and compensation performed from acceleration and angular velocity, finally realizing a method for highly adaptive control of unmanned aerial vehicles, which has good highly anti-interference adaptive capability.

[0055] Next, a highly adaptive control technology for a drone of the present invention will be further explained and illustrated in conjunction with the accompanying drawings. Figure 1 As shown, the highly adaptive control technology of the UAV may include the following steps:

[0056] Step S10, installing a radio altimeter to measure the altitude signal of the UAV, installing an inertial navigation device to measure the vertical acceleration signal and vertical velocity signal of the UAV, and setting an expected altitude signal according to the flight mission of the UAV, respectively comparing the altitude signal with the expected altitude signal to obtain an altitude error signal; comparing the vertical velocity signal with the first-order derivative of the expected altitude signal to obtain a velocity error signal; comparing the vertical acceleration signal with the second-order derivative of the expected altitude signal to obtain an acceleration error signal; then performing nonlinear transformation on the altitude error signal, the velocity error signal and the acceleration error signal and combining them to obtain an error nonlinear sliding mode signal.

[0057] Specifically, first install a radio altimeter to measure the altitude signal of the UAV, denoted as h; install an inertial navigation device to measure the vertical acceleration signal of the UAV, denoted as a, and use the inertial navigation device to measure the vertical velocity signal of the UAV, denoted as v.

[0058] Secondly, the expected height signal is set according to the UAV flight mission, denoted as h d , the height error signal is obtained by comparing the height signal with the expected height signal as follows:

[0059] e1=hh d ;

[0060] Where e1 is the height error signal.

[0061] Then, the vertical velocity signal is compared with the first-order derivative of the expected height signal to obtain the velocity error signal as follows:

[0062]

[0063] in is the first-order derivative of the desired height signal, and e2 is the velocity error signal.

[0064] Again, the acceleration error signal is obtained by comparing the second-order derivative of the vertical acceleration signal with the expected height signal as follows:

[0065]

[0066] in is the second-order derivative of the desired height signal; e3 is the acceleration error signal.

[0067] Finally, the height error signal, velocity error signal and acceleration error signal are transformed nonlinearly and combined to obtain the error nonlinear sliding mode signal as follows:

[0068]

[0069] where s a is the error nonlinear sliding mode signal; d1, d2, d3, ε1, ε4, ε5, ε6 are constant parameters.

[0070] Step S20, install an attitude gyroscope to measure the pitch angle signal of the UAV, install a rate gyroscope to measure the pitch angle rate signal of the UAV, solve the attitude angular rate related interference estimation law signal, the attitude acceleration related interference estimation law signal and the attitude angle related interference estimation law signal according to the error nonlinear sliding mode signal, and integrate them to obtain the corresponding attitude angular rate related interference estimation signal, attitude acceleration related interference estimation signal and attitude angle related interference estimation signal, and obtain the attitude related total interference estimation signal through synthesis.

[0071] Specifically, first install the attitude gyroscope to measure the pitch angle signal of the drone, denoted as Install a rate gyro to measure the pitch rate signal of the drone, denoted as ω z .

[0072] Secondly, according to the error nonlinear sliding mode signal, the attitude angular rate-related interference estimation law signal, the attitude acceleration-related interference estimation law signal and the attitude angle-related interference estimation law signal are solved as follows:

[0073]

[0074] Among them, p4 is the interference estimation law signal related to the attitude angular rate, p5 is the interference estimation law signal related to the attitude acceleration, and p6 is the interference estimation law signal related to the attitude angle. d1 , k d2 , k d3 is a constant parameter used to adjust the estimation rate of the interference estimation signal.

[0075] Again, the above estimation law signals are integrated to obtain the corresponding attitude angular rate-related interference estimation signal, attitude acceleration-related interference estimation signal and attitude angle-related interference estimation signal as follows:

[0076]

[0077] in is the attitude angular rate related disturbance estimation signal, is the attitude acceleration related disturbance estimation signal, is the attitude angle related disturbance estimation signal.

[0078] Finally, the attitude-related total interference estimation signal is obtained through signal synthesis as follows:

[0079]

[0080] where s b is the attitude related total interference estimation signal.

[0081] Step S30, using the attitude-related total interference estimation signal to superimpose the nonlinear sliding mode signal, the altitude error signal, the velocity error signal, and the acceleration error signal to obtain a combined error sliding mode signal; and superimposing the sliding mode weight factor formed by the pitch control signal to form a pitch angle desired signal; and comparing the pitch angle signal with the pitch angle desired signal to obtain a pitch angle error signal.

[0082] Specifically, the attitude-related total interference estimation signal is firstly superimposed with the nonlinear sliding mode signal, the height error signal, the velocity error signal, and the acceleration error signal to obtain the combined error sliding mode signal as follows:

[0083] s w =c1e1+c2e2+c3e3+s a +s b ;

[0084] where s w is the combined error sliding mode signal; c1, c2, c3 are constant parameters related to the sliding mode.

[0085] Secondly, the sliding mode weight factor formed by the pitch control signal is as follows:

[0086]

[0087] where u f is the pitch control signal, and its initial value is selected as 0, k f is the sliding mode weight factor formed by the pitch control signal, ε f is a constant control parameter.

[0088] Then, the combined error sliding mode signal is multiplied by the sliding mode weight factor to form the desired pitch angle signal as follows:

[0089]

[0090] in Pitch angle desired signal.

[0091] Finally, the pitch angle signal is compared with the pitch angle expected signal to obtain the pitch angle error signal as follows:

[0092]

[0093] e4 is the pitch angle error signal.

[0094] Step S40, designing a first-order transfer function for the pitch angle error signal to solve the first-order lag signal of the pitch angle desired signal; designing a second-order transfer function to solve the second-order lag signal of the pitch angle desired signal; synthesizing the first-order lag signal of the pitch angle desired signal and the second-order lag signal of the pitch angle desired signal with the pitch angle desired signal, and dividing by a corresponding time constant to obtain a pitch angle desired approximate differential signal, and comparing it with the pitch angle rate signal to obtain a pitch angle rate error signal; then performing nonlinear transformation on the pitch angle error signal and the pitch angle rate error signal respectively to obtain a pitch angle error nonlinear signal and a pitch angle rate error nonlinear signal; then integrating the pitch angle error signal to obtain a pitch angle error integrated signal, and superimposing the height error signal, the velocity error signal, the acceleration error signal, the pitch angle error signal, the pitch angle rate error signal, the pitch angle error nonlinear signal and the pitch angle rate error nonlinear signal respectively to form an error synthesis sliding mode signal.

[0095] Specifically, it is divided into the following seven steps. The first step is to design the first-order transfer function as follows:

[0096]

[0097] Where s is the first-order transfer function; T1 is the time factor of the transfer function, which is a constant. The first-order lag signal of the pitch angle desired signal is solved by the above first-order transfer function, which is recorded as

[0098] In the second step, the second-order transfer function is designed as follows:

[0099]

[0100] The second-order lag signal of the desired pitch angle signal is solved by the above second-order transfer function, which is recorded as T2 and T3 are the time factors of the transfer function and are constants.

[0101] In the third step, the first-order lag signal of the desired pitch angle signal and the second-order lag signal of the desired pitch angle signal are synthesized with the desired pitch angle signal and divided by the corresponding time constant to obtain the desired approximate differential signal of the pitch angle as follows:

[0102]

[0103] in is the expected approximate differential signal of the pitch angle.

[0104] The fourth step is to compare the pitch angle expected approximate differential signal with the pitch angle rate signal to obtain the pitch angle rate error signal as follows:

[0105]

[0106] Where e5 is the pitch angle rate error signal.

[0107] In the fifth step, nonlinear transformation is performed on the pitch angle error signal and the pitch angle rate error signal respectively to obtain the pitch angle error nonlinear signal and the pitch angle rate error nonlinear signal as follows:

[0108]

[0109]

[0110] where w a is the nonlinear signal of the pitch angle error, w b is the nonlinear signal of the pitch angular rate error; d4, d5, ε2, ε3 are constant parameters.

[0111] Step 6: Integrate the pitch angle error signal to obtain the pitch angle error integral signal as follows:

[0112] s2=∫e4dt;

[0113] Where s2 is the pitch angle error integral signal.

[0114] In the seventh step, the pitch angle error integral signal is used to superimpose the height error signal, the velocity error signal, the acceleration error signal, the pitch angle error signal, the pitch angle rate error signal, the pitch angle error nonlinear signal, and the pitch angle rate error nonlinear signal to form an error comprehensive sliding mode signal as follows:

[0115] s3=j1e1+j2e2+j3e3+j4e4+j5e5+j6s2+w a +w b ;

[0116] Among them, s3 is the error comprehensive sliding mode signal, j1, j2, j3, j4, j5, and j6 are constant parameters.

[0117] Step S50, solving the pitch angle rate related internal interference estimation law signal and the acceleration related internal interference estimation law signal according to the error integrated sliding mode signal, and obtaining the pitch angle rate related internal interference estimation signal and the acceleration related internal interference estimation signal by integration, and superimposing the error integrated sliding mode signal to form a final pitch control signal, which is transmitted to the pitch servo system to realize the highly adaptive control of the UAV and adaptively track the expected height signal.

[0118] Specifically, firstly, the pitch angle rate related internal interference estimation law signal and the acceleration related internal interference estimation law signal are solved according to the error comprehensive sliding mode signal as follows:

[0119]

[0120] Where p7 is the pitch angle rate related internal interference estimation law signal, p8 is the acceleration related internal interference estimation law signal, k d7 With k d8 is a constant interference signal, which is used to adjust the speed of interference estimation.

[0121] Secondly, the above estimation law signals are integrated respectively to obtain the pitch angle rate related internal interference estimation signal and the acceleration related internal interference estimation signal as follows:

[0122]

[0123] in is the pitch angle rate related internal interference estimation signal, is the acceleration related internal disturbance estimation signal.

[0124] Finally, the acceleration-related internal disturbance estimation signal and the pitch angular rate-related internal disturbance estimation signal are superimposed on the error-synthesized sliding mode signal and its nonlinear transformation to form the final pitch control signal.

[0125]

[0126] where k f1 , k f2 is a constant control parameter, u f The final pitch control signal is transmitted to the pitch servo system to realize the highly adaptive control of the UAV and adaptively track the expected height signal.

[0127] Case implementation and computer simulation results analysis

[0128] In step S10, the expected height signal h is set according to the UAV flight mission. d =200.

[0129] Select parameters d1 = 2, d2 = 0.5, d3 = 0.2, ε1, ε4 = 500, ε5 = 150, ε6 = 40

[0130] In step S20, the parameter k is selected d1 =0.03, k d2 =0.02, k d3 =0.01.

[0131] In step S30, select parameters c1=5, c2=2, c3=1, ε f =0.2.

[0132] In step S40, parameters T1=0.05, T2=0.03, T3=0.001, d4=0.3, d5=0.2, ε2=1, ε3=1.4 are selected; j1=0.01, j2=0.03, j3=0.1, j4=2, j5=0.4, j6=0.2.

[0133] In step S50, the parameter k is selected d7 =0.005, k d8 =0.008, k f1 =1.2, k f2 =0.1.

[0134] Finally, the altitude signal of the drone is obtained as follows Figure 2 As shown, the vertical speed signal of the UAV is as follows Figure 3 The vertical acceleration signal of the UAV is as shown in Figure 4 The pitch angle signal of the drone is as shown in Figure 5 The pitch rate of the drone is shown as Figure 6 The pitch control signal of the UAV is as shown in Figure 7 As shown in the experimental results, it can be seen that the UAV climbs to a height of 200 meters in about 10 seconds, and the pitch angle of the UAV does not exceed 10 degrees, the pitch comprehensive control signal is less than 15 degrees, and the pitch angle rate is less than 1.5. It can be seen that the method provided by the present invention has the characteristics of fast climbing speed, various angle indicators are within the limited range required by the engineering, good stability, and high height control accuracy, so that the present invention has a high engineering application value.

Claims

1. A highly adaptive control method for an unmanned aerial vehicle, characterized in that: A radio altimeter is installed to measure the altitude signal of the UAV, an inertial navigation device is installed to measure the vertical acceleration signal and vertical velocity signal of the UAV, and an expected altitude signal is set according to the flight mission of the UAV. The altitude signal is compared with the expected altitude signal to obtain an altitude error signal; the vertical velocity signal is compared with the first-order derivative of the expected altitude signal to obtain a velocity error signal; the vertical acceleration signal is compared with the second-order derivative of the expected altitude signal to obtain an acceleration error signal; and then the altitude error signal, the velocity error signal and the acceleration error signal are subjected to nonlinear transformation and then combined to obtain an error nonlinear sliding mode signal; An attitude gyroscope is installed to measure the pitch angle signal of the UAV, and a rate gyroscope is installed to measure the pitch angle rate signal of the UAV. According to the error nonlinear sliding mode signal, the attitude angular rate-related interference estimation law signal, the attitude acceleration-related interference estimation law signal and the attitude angle-related interference estimation law signal are solved, and the corresponding attitude angular rate-related interference estimation signal, the attitude acceleration-related interference estimation signal and the attitude angle-related interference estimation signal are respectively integrated to obtain the corresponding attitude angular rate-related interference estimation signal, the attitude acceleration-related interference estimation signal and the attitude angle-related interference estimation signal, and the attitude-related total interference estimation signal is obtained by synthesis; then the nonlinear sliding mode signal, the height error signal, the velocity error signal and the acceleration error signal are superimposed to obtain the combined error sliding mode signal; and the sliding mode weight factor formed by the pitch control signal is superimposed to form the pitch angle desired signal; the pitch angle signal is compared with the pitch angle desired signal to obtain the pitch angle error signal; then a first-order transfer function is designed to solve the first-order lag signal of the pitch angle desired signal; a second-order transfer function is designed to solve the second-order lag signal of the pitch angle desired signal; the first-order lag signal of the pitch angle desired signal and the second-order lag signal of the pitch angle desired signal are used to compare the pitch angle desired signal with the pitch angle desired signal. The desired elevation angle signal is synthesized and divided by the corresponding time constant to obtain the desired approximate differential signal of the pitch angle, and compared with the pitch angle rate signal to obtain the pitch angle rate error signal; then the pitch angle error signal and the pitch angle rate error signal are nonlinearly transformed respectively to obtain the pitch angle error nonlinear signal and the pitch angle rate error nonlinear signal; then the pitch angle error signal is integrated to obtain the pitch angle error integral signal, and the height error signal, the velocity error signal, the acceleration error signal, the pitch angle error signal, the pitch angle rate error signal, the pitch angle error nonlinear signal and the pitch angle rate error nonlinear signal are superimposed respectively to form an error comprehensive sliding mode signal; and the pitch angle rate related internal interference estimation law signal and the acceleration related internal interference estimation law signal are solved, and the pitch angle rate related internal interference estimation signal and the acceleration related internal interference estimation signal are obtained by integration, and the error comprehensive sliding mode signal is superimposed to form the final pitch control signal, which is transmitted to the pitch servo system to realize the highly adaptive control of the UAV, and the adaptive tracking of the desired height signal includes: e1=hh d ; s2=∫e4dt; <h2 style=";text-align:left;direction:ltr">s3 = j1e1 + j2e2 + j3e3 + j4e4 + j5e5 + j6s2 + w<h2 style=";text-align:left;direction:ltr"> a <h2 style=";text-align:left;direction:ltr"> +w<h2 style=";text-align:left;direction:ltr"> b <h2 style=";text-align:left;direction:ltr"> ; Where h is the altitude signal of the UAV measured by installing a radio altimeter, v is the vertical velocity signal of the UAV measured by installing an inertial navigation device, and a is the vertical acceleration signal measured by installing an inertial navigation device; h d To set the desired altitude signal according to the UAV flight mission, is the first-order derivative of the desired height signal, is the second-order derivative of the desired height signal; e1 is the height error signal, e2 is the velocity error signal; e3 is the acceleration error signal; s a is the error nonlinear sliding mode signal; d1, d2, d3, ε1, ε4, ε5, ε6 are constant parameters; where ω z is the pitch rate signal of the drone measured by the installed rate gyroscope; p4 ​​is the interference estimation law signal related to the attitude angular rate, p5 is the interference estimation law signal related to the attitude acceleration, and p6 is the interference estimation law signal related to the attitude angle. is the attitude angular rate related disturbance estimation signal, is the attitude acceleration related disturbance estimation signal, k is the attitude angle related interference estimation signal; d1 , k d2 , k d3 is a constant parameter used to adjust the estimation rate of the interference estimation signal; s b is the attitude related total interference estimation signal; s w is the combined error sliding mode signal; c1, c2, c3 are constant parameters related to sliding mode; u f is the pitch control signal, and its initial value is selected as 0, k f is the sliding mode weight factor formed by the pitch control signal; ε f is a constant control parameter, Pitch angle desired signal; is the pitch angle signal of the UAV measured by the attitude gyroscope; e4 is the pitch angle error signal; s is the differential operator of the first-order transfer function and the second-order transfer function; T1, T2, and T3 are the time factors of the transfer function, which are constants; is the first-order lag signal of the desired pitch angle signal; is the second-order lag signal of the desired pitch angle signal; is the expected approximate differential signal of the pitch angle; e5 is the pitch angle rate error signal; w a is the nonlinear signal of the pitch angle error, w b is the nonlinear signal of the pitch angle rate error; d4, d5, ε2, ε3 are constant parameters; s2 is the pitch angle error integral signal, s3 is the error comprehensive sliding mode signal, j1, j2, j3, j4, j5, j6 are constant parameters; p7 is the pitch angle rate related internal interference estimation law signal, p8 is the acceleration related internal interference estimation law signal, k d7 With k d8 is a constant interference signal, used to adjust the speed of interference estimation; is the pitch angle rate related internal interference estimation signal, is the acceleration related internal interference estimation signal, k f1 , k f2 is a constant control parameter, u f is the final pitch control signal.