A side-slip and tilt compound turning control method for unmanned aerial vehicle
Through the UAV side-sliding and tilt composite turn control method based on interference estimation and dual-channel dynamic coupling adjustment technology, the problem of difficult to eliminate dual-channel coupling and poor turning speed is solved, and better turn control effect and stability are achieved sex.
Patent Information
- Application Number
- CN202210936737.9
- 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
There are problems such as difficult to eliminate the dual-channel coupling and poor turning speed in the existing drones in the side-slip and tilt composite turn control. This is mainly due to the difficulty in precise modeling of the yaw channel and the tilt channel, which leads to traditional linearity. The state feedback design method is difficult to obtain satisfactory reliability and stability margins.
Using the drone side slip and tilt composite turn control method based on interference estimation and dual-channel dynamic coupling adjustment technology, the yaw angle and tilt angle command signals are generated through sensor measurement data such as accelerometers and attitude gyroscopes, and adaptive interference is designed. Estimation law realizes dynamic coupling adjustment and reasonable distribution of turning energy.
The dynamic coupling adjustment of the dual-channel and the reasonable allocation of turning energy are realized, which improves the speed and stability of turning, and has high engineering practical value.
Smart Images

Figure CN115167494B_ABST
Abstract
Description
Technical Field
[0001] The invention relates to the field of unmanned aerial vehicle stabilization and control, and in particular to a method for controlling a side-slip and tilt compound turning of an unmanned aerial vehicle. Background Art
[0002] In the lateral turning control of large UAVs, the main methods are currently sideslip turning and bank turning. Among them, sideslip turning has better stability, and bank turning has better speed. The technology of using sidelip and bank compound turning is relatively rare in UAV lateral control. The reason is that it is difficult to accurately model the yaw channel and the bank channel. At the same time, there is a serious coupling relationship between the two channels, as well as some nonlinear hinge relationships, which makes it difficult for the traditional linear state feedback design method to obtain satisfactory reliability and stability margin in two-channel composite control. Based on the above background reasons, the present invention provides a UAV sideslip and bank compound turning control technology based on interference estimation and dual-channel dynamic coupling adjustment technology. Experiments show that this method has good stability and reliability, and thus 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 side slip and tilt compound turning control technology for an unmanned aerial vehicle, thereby overcoming the problems of difficulty in eliminating dual-channel coupling and poor turning speed caused by limitations and defects of related technologies.
[0005] According to one aspect of the present invention, a side slip and tilt compound turning control technology for an unmanned aerial vehicle is provided, comprising the following steps:
[0006] Step S10, installing an accelerometer to measure the lateral acceleration of the drone; obtaining the lateral velocity by integration, and obtaining the lateral displacement signal by integration again; then setting the lateral displacement expected signal according to the flight mission, and comparing it with the lateral displacement signal to obtain the lateral displacement error signal, using the lateral velocity signal to compare with the first-order derivative of the lateral displacement expected signal to obtain the lateral velocity error signal, using the lateral acceleration signal to compare with the second-order derivative of the lateral displacement expected signal to obtain the lateral acceleration error signal; then integrating the lateral displacement error signal to obtain the lateral displacement error integral signal, and combining to generate the yaw angle command signal; then generating the yaw velocity error interference estimation law, the yaw acceleration error interference estimation law and the yaw position error interference estimation law respectively through the yaw angle command signal; obtaining the yaw velocity error interference estimation parameters, the yaw acceleration error interference estimation parameters and the yaw position error interference estimation parameters respectively after integration; finally combining the lateral displacement error signal, the lateral velocity error signal and the lateral acceleration error signal to obtain the lateral combined error signal.
[0007] Step S20, installing an accelerometer to measure the vertical acceleration of the UAV and generating an outer loop angular velocity related interference estimation law and an outer loop acceleration related interference estimation law according to the pitch angle error signal and the pitch angle error lag signal, and obtaining an outer loop angular velocity related interference estimation signal and an outer loop acceleration related interference estimation signal by integration, combining the two to form an outer loop interference estimation total signal, and superimposing the pitch angle error signal, the pitch angle error dynamic filtering differential signal and the dynamic filtering parameters to form an expected signal of the UAV pitch angle rate.
[0008] Step S30, compare the pitch angle rate expected signal of the UAV with the pitch angle rate signal to obtain a pitch angle rate error signal; then set the vertical acceleration threshold parameter, and according to the comparison result of the vertical acceleration signal and the vertical acceleration threshold parameter, divide the pitch angle rate error change into three cases of fast, medium and slow, combine and integrate the pitch angle rate error signal and the vertical acceleration signal in turn to obtain a dynamic rate filter parameter, and then design a first-order dynamic filter to solve the pitch angle rate error lag signals of the three cases respectively; finally, solve the pitch angle rate error dynamic filter differential signal by the pitch angle rate error signal, the pitch angle rate error lag signal and the corresponding dynamic rate filter parameter.
[0009] Step S40, generating inner loop angular velocity related interference estimation law and inner loop acceleration related interference estimation law according to the pitch angular rate error signal, the pitch angular rate error hysteresis signal, the vertical acceleration signal and the pitch angular rate signal, obtaining inner loop angular velocity related interference estimation signal and inner loop acceleration related interference estimation signal through integration, combining and generating inner loop interference estimation total signal, finally superimposing dynamic rate filtering parameter, pitch angular rate error dynamic filtering differential signal, pitch angle error dynamic filtering differential signal and pitch angular rate error signal to form pitch channel control comprehensive signal, obtaining pitch channel saturation limiting control signal through saturation limiting processing, transmitting it to the pitch rudder system of the pitch channel of the UAV, realizing the task of tracking the pitch angle expected signal of the pitch channel attitude angle of the UAV through negative feedback control.
[0010] In an exemplary embodiment of the present invention, an accelerometer is installed to measure the lateral acceleration of the drone; the lateral velocity is obtained by integration, and the lateral displacement signal is obtained by integration again; then the lateral displacement expected signal is set according to the flight mission, and compared with the lateral displacement signal to obtain a lateral displacement error signal, the lateral velocity signal is compared with the first-order derivative of the lateral displacement expected signal to obtain a lateral velocity error signal, and the lateral acceleration signal is compared with the second-order derivative of the lateral displacement expected signal to obtain a lateral acceleration error signal; then the lateral displacement error signal is integrated to obtain a lateral displacement error integral signal, and a yaw angle command signal is generated by combination; then the yaw angle command signal is used to generate a yaw velocity error interference estimation law, a yaw acceleration error interference estimation law and a yaw position error interference estimation law; after integration, yaw velocity error interference estimation parameters, yaw acceleration error interference estimation parameters and yaw position error interference estimation parameters are obtained respectively; finally, the lateral displacement error signal, the lateral velocity error signal and the lateral acceleration error signal are combined to obtain a lateral combined error signal, which includes:
[0011] v z =∫a z dt;
[0012] z=∫v z dt;
[0013] e1=zz d ;
[0014]
[0015] s1=∫e1dt;
[0016] φ d =k1e1+k2s1+k3d1+k4d2;
[0017] d w1 =k w1 φd d1;d w2 =k w2 φ d d2;d w3 =k w3 φ d e1;
[0018] w1=∫d w1 dt; w2 = ∫d w2 dt;w3=∫d w3 dt;
[0019]
[0020] where a z v is the lateral acceleration of the drone measured by the installed accelerometer; z is the lateral velocity signal, z is the lateral displacement signal; d is the lateral displacement expected signal, e1 is the lateral displacement error signal, is the first-order derivative of the lateral displacement expected signal, is the second-order derivative of the lateral displacement desired signal, d1 is the lateral velocity error signal, d2 is the lateral acceleration error signal, s1 is the lateral position error integral signal; φ d is the yaw angle command signal; k1, k2, k3, k4 are constant control parameters; d w1 is the yaw velocity error disturbance estimation law, d w2 is the yaw acceleration error disturbance estimation law, d w3 is the yaw position error disturbance estimation law; k w1 , k w2 With k w3 is a constant parameter; w1 is the yaw velocity error interference estimation parameter, w2 is the yaw acceleration error interference estimation parameter, and w3 is the yaw position error interference estimation parameter; is the lateral combined error signal.
[0021] In an exemplary embodiment of the present invention, an attitude gyroscope is installed to measure and obtain a yaw angle signal of a UAV, a tilt control integrated integral signal is solved according to a tilt channel control integrated signal, and an initial value of a yaw weight is set to generate a yaw weight signal, which is then multiplied by a yaw angle command signal and superimposed with a lateral combined error signal to obtain an ideal yaw angle signal, which is then compared with the UAV yaw angle signal to obtain a yaw angle error signal, and finally integrated to obtain a yaw angle error integral signal, including:
[0022] s g =∫|u g |dt;
[0023]
[0024] e2=φ-φ da ;
[0025] s2=∫e2dt;
[0026] Where φ is the UAV yaw angle signal measured by the attitude gyroscope, u g is the comprehensive signal for tilt channel control, and its initial value is selected as 0; s g is the comprehensive integral signal of tilt control; w 10 is the initial value of the yaw weight, which is a constant parameter; ε 11 , ε 12 is a constant parameter; w a1 is the yaw weight signal; φ da is the ideal yaw angle signal, e2 is the yaw angle error signal; s2 is the yaw angle error integrated signal.
[0027] In an exemplary embodiment of the present invention, a tilt angle command signal is generated according to a combination of a lateral displacement error signal, a lateral displacement error integral signal, a lateral velocity error signal, and a lateral acceleration error signal; then a tilt velocity error interference estimation law, a tilt acceleration error interference estimation law, and a tilt position error interference estimation law are respectively generated according to the tilt angle command signal; after integration, a tilt velocity error interference estimation parameter, a tilt acceleration error interference estimation parameter, and a tilt position error interference estimation parameter are respectively obtained; finally, the lateral displacement error signal, the lateral velocity error signal, and the lateral acceleration error signal are combined to obtain a tilt combined error signal, which includes:
[0028] γ d =l1e1+l2s1+l3d1+l4d2;
[0029] d m1 =k m1 γ d d1;d m2 =k m2 γ d d2;dm w3 =k m3 γ d e1
[0030] m1=∫d m1 dt;m2=∫d m2 dt;m3=∫d m3 dt;
[0031]
[0032] where γ d is the tilt angle command signal; l1, l2, l3, l4 are constant control parameters; d m1is the tilt velocity error disturbance estimation law, d m2 is the tilt acceleration error disturbance estimation law, d m3 is the tilt position error disturbance estimation law; k m1 , k m2 With k m3 is a constant parameter; m1 is a tilt velocity error interference estimation parameter, m2 is a tilt acceleration error interference estimation parameter, and m3 is a tilt position error interference estimation parameter; is the tilt combined error signal.
[0033] In an exemplary embodiment of the present invention, an attitude gyroscope is installed to measure and obtain a tilt angle signal of a UAV, a yaw control integrated integral signal is solved according to a yaw channel control integrated signal, and an initial value of a tilt weight is set to generate a tilt weight signal, which is then multiplied by a tilt angle command signal and superimposed with a tilt combined error signal to obtain a tilt angle ideal signal, which is compared with the tilt angle signal of the UAV to obtain a tilt angle error signal, and finally integrated to obtain a tilt angle error integral signal, including:
[0034] s f =∫|u p |dt;
[0035]
[0036] e3=γ-γ da ;
[0037] s3=∫e3dt;
[0038] Where γ is the tilt angle signal of the UAV measured by the attitude gyroscope, u p is the comprehensive signal for yaw channel control, and its initial value is selected as 0; s f is the comprehensive integral signal of yaw control; w 20 is the initial value of the tilt weight, which is a constant parameter; ε 21 , ε 22 is a constant parameter; w a2 is the tilt weight signal; γ da is the ideal tilt angle signal, e3 is the tilt angle error signal; s3 is the tilt angle error integral signal.
[0039] In an exemplary embodiment of the present invention, according to the tilt angle command signal and the yaw angle command signal, the yaw channel constant interference estimation law signal, the yaw channel yaw angle error interference estimation law signal, the yaw channel yaw angle rate interference estimation law signal, the yaw channel tilt angle error interference estimation law signal, and the yaw channel acceleration interference estimation law signal are respectively solved; the yaw channel constant interference estimation signal, the yaw channel yaw angle error interference estimation law signal, the yaw channel tilt angle rate interference estimation law signal, the tilt channel yaw angle error interference estimation law signal, and the tilt channel acceleration interference estimation law signal are respectively obtained after integration; the yaw channel constant interference estimation signal, the yaw channel yaw angle error interference estimation signal, the yaw channel yaw angle rate interference estimation signal, the yaw channel tilt angle error interference estimation signal, and the yaw channel acceleration interference estimation signal are respectively obtained; and then the yaw channel interference estimation total signal and the tilt channel interference estimation total signal are generated;
[0040] d c11 =k c11 φ d ;d c21 =k c21 γ d ;
[0041] d c12 =k c12 φ d e2;d c22 =k c22 γ d e3;
[0042] d c13 =k c13 φ d ω y ;d c23 =k c23 γ d ω x ;
[0043] d c14 =k c14 φ d e3;d c24 =k c24 γ d e2;
[0044] d c15 =k c15 φ d a z ;d c25 =k c25 γd a z ;
[0045]
[0046] where k c11 , k c12 , k c13 , k c14 , k c15 , k c21 , k c22 , k c23 , k c24 , k c25 is a constant control parameter; d c11 is the constant interference estimation law signal of the yaw channel, d c12 is the yaw angle error interference estimation law signal of the yaw channel, d c13 is the yaw channel yaw angle rate interference estimation law signal, d c14 is the interference estimation law signal of the yaw channel tilt angle error, d c15 is the acceleration disturbance estimation law signal of the yaw channel, d c21 is the constant interference estimation law signal of the inclined channel, d c22 is the tilt channel tilt angle error interference estimation law signal, d c23 is the tilt angle rate interference estimation law signal of the tilt channel, d c24 is the interference estimation law signal of the tilt channel yaw angle error, d c25 is the acceleration disturbance estimation law signal of the tilt channel; is the constant interference estimation signal of the yaw channel, is the yaw angle error interference estimation signal of the yaw channel, is the yaw channel yaw angle rate interference estimation signal, is the yaw channel tilt angle error interference estimation signal, is the acceleration disturbance estimation signal of the yaw channel, is the constant interference estimation signal of the tilt channel, is the tilt angle error interference estimation signal of the tilt channel, is the tilt angle rate interference estimation signal of the tilt channel, is the yaw angle error interference estimation signal of the tilt channel, It is the acceleration disturbance estimation signal of the tilt channel; is the total signal estimated for the yaw channel interference, Estimate the total signal for slanted channel interference.
[0047] In an exemplary embodiment of the present invention, a rate gyroscope is installed to measure the yaw rate signal and the tilt rate signal of the drone, and then the tilt error integral signal, the yaw error integral signal, the tilt error signal, the yaw error signal, the lateral acceleration signal, the yaw channel interference estimation total signal and the tilt channel interference estimation total signal are superimposed to generate the final yaw channel control integrated signal and the tilt channel control integrated signal as follows:
[0048]
[0049] where u p It is the comprehensive signal for yaw channel control, u g is the integrated signal for tilt channel control, k 11 , k 12 , k 13 , k 14 , k 15 , k 16 , k 21 , k 22 , k 23 , k 24 , k 25 , k 26 are constant control parameters, which are respectively transmitted to the yaw servo and tilt servo of the UAV to realize the sideslip and tilt compound turning control of the UAV.
[0050] Beneficial Effects
[0051] The invention discloses a side-slip and tilt compound turning control technology for an unmanned aerial vehicle, and its main innovations are as follows: first, the weights of the attitude angle expectation values of the yaw channel and the roll channel are coupled and adjusted through the integrated control signals of the roll channel and the yaw channel, thereby realizing the dynamic coupling adjustment of the two channels and the reasonable distribution of the turning energy, that is, when the roll turning energy is large, the corresponding yaw turning is relatively smooth, and when the tilt turning energy is small, the corresponding yaw turning is relatively violent. Second, an adaptive interference estimation law is designed through the tilt angle command signal and the yaw angle command signal to realize the interference estimation of the two channels, which is different from the effect of the adaptive adjustment based on the error in the past, and the adaptive estimation is carried out from the error, acceleration, the coupling of the attitude angular rate and other aspects, so that the mutual matching of the entire side-slip and the tilt turning achieves an excellent effect, and has better turning rapidity.
[0052] 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
[0053] 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.
[0054] Figure 1 This is a flow chart of a method for controlling a side-slip and tilt compound turning of an unmanned aerial vehicle provided by the present invention;
[0055] Figure 2 is a lateral displacement signal curve of the UAV according to the method provided in the embodiment of the present invention (unit: meter);
[0056] Figure 3 is a lateral acceleration signal curve of the UAV according to the method provided in the embodiment of the present invention (unit: meters per second);
[0057] Figure 4 is a lateral velocity signal curve of the UAV according to the method provided in the embodiment of the present invention (unit: meter per square second);
[0058] Figure 5 is the lateral velocity error signal of the UAV according to the method provided in the embodiment of the present invention (unit: meters per second);
[0059] Figure 6 is a yaw angle signal curve of the UAV according to the method provided in the embodiment of the present invention (unit: degree);
[0060] Figure 7 is a roll angle signal curve of the UAV according to the method provided in the embodiment of the present invention (unit: degree);
[0061] Figure 8 is a comprehensive signal curve of the yaw channel control of the UAV according to the method provided in the embodiment of the present invention (unit: degree);
[0062] Fig. 9 It is a slope channel control comprehensive signal curve (unit: degree) of the method provided in the embodiment of the present invention. DETAILED DESCRIPTION
[0063] 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.
[0064] The present invention provides a method for realizing lateral center of mass turning control of a UAV by combining two turning modes, namely sideslip and tilt. The magnitude of the tilt attitude expected angle signal is adjusted by the yaw channel control amount, and the yaw channel attitude angle expected signal is adjusted by the tilt channel control amount, thereby avoiding the simultaneous drastic turning of the two channels and realizing the dynamic and reasonable distribution of the turning energy. At the same time, the uncertainty of the yaw and tilt channels is respectively estimated by dual-channel coupling dynamic estimation between acceleration, yaw angular rate, and tilt angular rate through lateral position error, velocity error, and acceleration error, thereby realizing dynamic coupling compensation of uncertainty of the dual channels, so that the method has good rapidity and anti-interference ability.
[0065] Next, the side slip and tilt compound turning control technology of a UAV of the present invention will be further explained and illustrated in conjunction with the accompanying drawings. Figure 1 As shown, the side slip and tilt compound turning control technology of the UAV may include the following steps:
[0066] Step S10, installing an accelerometer to measure the lateral acceleration of the drone; obtaining the lateral velocity by integration, and obtaining the lateral displacement signal by integration again; then setting the lateral displacement expected signal according to the flight mission, and comparing it with the lateral displacement signal to obtain the lateral displacement error signal, using the lateral velocity signal to compare with the first-order derivative of the lateral displacement expected signal to obtain the lateral velocity error signal, using the lateral acceleration signal to compare with the second-order derivative of the lateral displacement expected signal to obtain the lateral acceleration error signal; then integrating the lateral displacement error signal to obtain the lateral displacement error integral signal, and combining to generate the yaw angle command signal; then generating the yaw velocity error interference estimation law, the yaw acceleration error interference estimation law and the yaw position error interference estimation law respectively through the yaw angle command signal; obtaining the yaw velocity error interference estimation parameters, the yaw acceleration error interference estimation parameters and the yaw position error interference estimation parameters respectively after integration; finally combining the lateral displacement error signal, the lateral velocity error signal and the lateral acceleration error signal to obtain the lateral combined error signal.
[0067] Specifically, it is divided into the following nine steps. The first step is to install an accelerometer to measure the lateral acceleration of the drone, denoted as a z ; After integration, the lateral displacement signal is as follows:
[0068] v z =∫a z dt;
[0069] where v z is the lateral velocity signal, and then the lateral displacement signal is obtained by integrating the lateral velocity signal as follows:
[0070] z=∫v z dt;
[0071] Where z is the lateral displacement signal.
[0072] In the second step, the lateral displacement expected signal is set according to the flight mission, and compared with the lateral displacement signal to obtain the lateral displacement error signal as follows:
[0073] e1=zz d ;
[0074] where z d is the lateral displacement desired signal, and e1 is the lateral displacement error signal.
[0075] In the third step, the lateral velocity signal is compared with the first-order derivative of the lateral displacement expected signal to obtain the lateral velocity error signal as follows:
[0076]
[0077] in is the first-order derivative of the lateral displacement desired signal, and d1 is the lateral velocity error signal.
[0078] In the fourth step, the lateral acceleration signal is compared with the second-order derivative of the lateral displacement expected signal to obtain the lateral acceleration error signal as follows:
[0079]
[0080] in is the second-order derivative of the lateral displacement desired signal, and d2 is the lateral acceleration error signal.
[0081] The fifth step is to integrate the lateral displacement error signal to obtain the lateral displacement error integral signal as follows:
[0082] s1=∫e1dt;
[0083] Where s1 is the lateral position error integral signal.
[0084] In the sixth step, the lateral displacement error signal, the lateral displacement error integral signal, the lateral velocity error signal and the lateral acceleration error signal are combined to generate a yaw angle command signal as follows:
[0085] φ d =k1e1+k2s1+k3d1+k4d2;
[0086] where φd d is the yaw angle command signal; k1, k2, k3, k4 are constant control parameters.
[0087] In the seventh step, the yaw velocity error disturbance estimation law, the yaw acceleration error disturbance estimation law and the yaw position error disturbance estimation law are generated by the yaw angle command signal as follows:
[0088] d w1 =k w1 φ d d1;
[0089] d w2 =k w2 φ d d2;
[0090] d w3 =k w3 φ d e1;
[0091] where d w1 is the yaw velocity error disturbance estimation law, d w2 is the yaw acceleration error disturbance estimation law, d w3 is the yaw position error disturbance estimation law; k w1 , k w2 With kw3 Is a constant parameter.
[0092] In the eighth step, the yaw velocity error interference estimation law, the yaw acceleration error interference estimation law and the yaw position error interference estimation law are integrated to obtain the yaw velocity error interference estimation parameters, the yaw acceleration error interference estimation parameters and the yaw position error interference estimation parameters as follows:
[0093] w1=∫d w1 dt;
[0094] w2=∫d w2 dt;
[0095] w3=∫d w3 dt;
[0096] Wherein w1 is the yaw velocity error interference estimation parameter, w2 is the yaw acceleration error interference estimation parameter, and w3 is the yaw position error interference estimation parameter;
[0097] In the ninth step, the lateral displacement error signal, the lateral velocity error signal and the lateral acceleration error signal are combined to obtain a lateral combined error signal as follows:
[0098]
[0099] in is the lateral combined error signal.
[0100] Step S20, install the attitude gyroscope to measure the UAV yaw angle signal, solve the tilt control integrated integral signal according to the tilt channel control integrated signal, set the initial value of the yaw weight, generate the yaw weight signal, then multiply it by the yaw angle command signal and superimpose the lateral combined error signal to obtain the yaw angle ideal signal, compare it with the UAV yaw angle signal to obtain the yaw angle error signal, and finally integrate it to obtain the yaw angle error integral signal.
[0101] Specifically, firstly, the tilt control integrated integral signal is solved according to the tilt channel control integrated signal. The initial value of the tilt channel control integrated signal is selected as 0, and the initial value of the tilt control integrated integral signal is also selected as 0. The integration method is as follows:
[0102] s g =∫|u g |dt;
[0103] where u g is the integrated signal for tilt channel control, s g The integrated signal is synthesized for tilt control.
[0104] Secondly, the initial value of the yaw weight is set, and the yaw weight signal is generated according to the tilt channel control integrated signal and the tilt control integrated integral signal as follows:
[0105]
[0106] where w 10 is the initial value of the yaw weight, which is a constant parameter; ε 11 , ε 12 is a constant parameter; w a1 is the yaw weight signal.
[0107] Thirdly, the ideal yaw angle signal is obtained by multiplying the yaw weight signal by the yaw angle command signal and superimposing the lateral combined error signal as follows:
[0108]
[0109] where φ da It is the ideal signal of yaw angle.
[0110] Finally, the attitude gyroscope is installed to measure the yaw angle signal of the drone, recorded as φ; and the yaw angle error signal is obtained by comparing it with the yaw angle signal of the drone as follows
[0111] e2=φ-φ da ;
[0112] And integrate to get the yaw angle error integral signal
[0113] s2=∫e2dt;
[0114] Wherein, e2 is the yaw angle error signal; s2 is the yaw angle error integral signal.
[0115] Step S30, generating a tilt angle command signal according to the combination of the lateral displacement error signal, the lateral displacement error integral signal, the lateral velocity error signal, and the lateral acceleration error signal; then generating a tilt velocity error interference estimation law, a tilt acceleration error interference estimation law, and a tilt position error interference estimation law respectively through the tilt angle command signal; obtaining a tilt velocity error interference estimation parameter, a tilt acceleration error interference estimation parameter, and a tilt position error interference estimation parameter respectively after integration; finally, combining the lateral displacement error signal, the lateral velocity error signal, and the lateral acceleration error signal to obtain a tilt combined error signal.
[0116] Specifically, firstly, the tilt angle command signal is generated according to the combination of the lateral displacement error signal, the lateral displacement error integral signal, the lateral velocity error signal, and the lateral acceleration error signal as follows:
[0117] γ d =l1e1+l2s1+l3d1+l4d2;
[0118] where γ d is the tilt angle command signal; l1, l2, l3, l4 are constant control parameters.
[0119] Secondly, the tilt velocity error disturbance estimation law, the tilt acceleration error disturbance estimation law and the tilt position error disturbance estimation law are generated by the tilt angle command signal as follows:
[0120] d m1 =k m1 γ d d1;d m2 =k m2 γ d d2;dm w3 =k m3 γ d e1;
[0121] where d m1 is the tilt velocity error disturbance estimation law, d m2 is the tilt acceleration error disturbance estimation law, d m3 is the tilt position error disturbance estimation law; k m1 , k m2 With k m3 Is a constant parameter.
[0122] Then, after integrating the above-mentioned tilt velocity error interference estimation law and tilt acceleration error interference estimation law, the tilt velocity error interference estimation parameter, the tilt acceleration error interference estimation parameter and the tilt position error interference estimation parameter are obtained as follows:
[0123] m1=∫d m1 dt;m2=∫d m2 dt;m3=∫d m3 dt;
[0124] Wherein, m1 is the tilt velocity error interference estimation parameter, m2 is the tilt acceleration error interference estimation parameter, and m3 is the tilt position error interference estimation parameter.
[0125] Finally, the lateral displacement error signal, the lateral velocity error signal and the lateral acceleration error signal are combined to obtain the tilt combined error signal as follows:
[0126]
[0127] in is the tilt combined error signal.
[0128] Step S40, install the attitude gyroscope to measure the tilt angle signal of the UAV, solve the yaw control integrated integral signal according to the yaw channel control integrated signal, set the initial value of the tilt weight, generate a tilt weight signal, then multiply the tilt angle command signal and superimpose the tilt combination error signal to obtain the ideal tilt angle signal, compare it with the UAV tilt angle signal to obtain the tilt angle error signal, and finally integrate it to obtain the tilt angle error integral signal.
[0129] Specifically, firstly, the yaw control integrated integral signal is solved according to the yaw channel control integrated signal as follows:
[0130] s f =∫|u p |dt;
[0131] The initial value of the yaw channel control integrated signal is selected as 0, and the initial value of the yaw control integrated integral signal is also selected as 0. p is the comprehensive signal for yaw channel control, s f It is the comprehensive integral signal for yaw control.
[0132] Secondly, the initial value of the tilt weight is set, and the yaw weight signal is generated according to the yaw channel control integrated signal and the tilt control integrated integral signal as follows:
[0133]
[0134] where w 20 is the initial value of the tilt weight, which is a constant parameter; ε 21 , ε 22 is a constant parameter; w a2 is the tilt weight signal.
[0135] Again, the ideal tilt angle signal is obtained by multiplying the tilt weight signal by the tilt angle command signal and superimposing the tilt combined error signal as follows:
[0136]
[0137] where γ da is the ideal signal of the tilt angle.
[0138] Finally, the attitude gyroscope is installed to measure the tilt angle signal of the drone, which is recorded as γ. The ideal tilt angle signal is compared with the tilt angle signal of the drone to obtain the tilt angle error signal as follows:
[0139] e3=γ-γ da ;
[0140] Where e3 is the tilt angle error signal, and the tilt angle error integral signal is obtained by integration as follows:
[0141] s3=∫e3dt;
[0142] Where s3 is the tilt angle error integral signal.
[0143] Step S50, according to the tilt angle command signal and the yaw angle command signal, respectively solve the yaw channel constant interference estimation law signal, the yaw channel yaw angle error interference estimation law signal, the yaw channel yaw angle rate interference estimation law signal, the yaw channel tilt angle error interference estimation law signal, and the yaw channel acceleration interference estimation law signal, the tilt channel constant interference estimation law signal, the tilt channel tilt angle error interference estimation law signal, the tilt channel tilt angle rate interference estimation law signal, the tilt channel yaw angle error interference estimation law signal, and the tilt channel acceleration interference estimation law signal; after integration, respectively obtain the yaw channel constant interference estimation signal, the yaw channel yaw angle error interference estimation signal, the yaw channel yaw angle rate interference estimation signal, the yaw channel tilt angle error interference estimation signal, and the yaw channel acceleration interference estimation signal, the tilt channel constant interference estimation signal, the tilt channel tilt angle error interference estimation signal, the tilt channel tilt angle rate interference estimation signal, the tilt channel yaw angle error interference estimation signal, and the tilt channel acceleration interference estimation signal; then compose and generate the yaw channel interference estimation total signal and the tilt channel interference estimation total signal.
[0144] Specifically, first, according to the tilt angle command signal and the yaw angle command signal, the yaw channel constant interference estimation law signal, the yaw channel yaw angle error interference estimation law signal, the yaw channel yaw angle rate interference estimation law signal, the yaw channel tilt angle error interference estimation law signal, and the yaw channel acceleration interference estimation law signal are solved respectively. The tilt channel constant interference estimation law signal, the tilt channel tilt angle error interference estimation law signal, the tilt channel tilt angle rate interference estimation law signal, the tilt channel yaw angle error interference estimation law signal, and the tilt channel acceleration interference estimation law signal are as follows:
[0145] d c11 =k c11 φ d ;d c21 =k c21 γ d ;
[0146] d c12 =k c12 φ d e2;d c22 =k c22 γ d e3;
[0147] d c13 =k c13 φ d ω y ;d c23 ×kc23 γ d ω x ;
[0148] d c14 =k c14 φ d e3;d c24 =k c24 γ d e2;
[0149] d c15 ×k c15 φ d a z ;d c25 =k c25 γ d a z ;
[0150] where k c11 , k c12 , k c13 , k c14 , k c15 , k c21 , k c22 , k c23 , k c24 , k c25 is a constant control parameter; d c11 is the constant interference estimation law signal of the yaw channel, d c12 is the yaw angle error interference estimation law signal of the yaw channel, d c13 is the yaw channel yaw angle rate interference estimation law signal, d c14 is the interference estimation law signal of the yaw channel tilt angle error, d c15 is the acceleration disturbance estimation law signal of the yaw channel, d c21 is the constant interference estimation law signal of the inclined channel, d c22 is the tilt channel tilt angle error interference estimation law signal, d c23 is the tilt angle rate interference estimation law signal of the tilt channel, d c24 is the interference estimation law signal of the tilt channel yaw angle error, d c25 It is the acceleration disturbance estimation law signal of the tilt channel.
[0151] Secondly, the above estimation law signals are integrated to obtain the yaw channel constant interference estimation signal, the yaw channel yaw angle error interference estimation signal, the yaw channel yaw angle rate interference estimation signal, the yaw channel tilt angle error interference estimation signal, and the yaw channel acceleration interference estimation signal. The tilt channel constant interference estimation signal, the tilt channel tilt angle error interference estimation signal, the tilt channel tilt angle rate interference estimation signal, the tilt channel yaw angle error interference estimation signal, and the tilt channel acceleration interference estimation signal are as follows:
[0152]
[0153]
[0154] in is the constant interference estimation signal of the yaw channel, is the yaw angle error interference estimation signal of the yaw channel, is the yaw channel yaw angle rate interference estimation signal, is the yaw channel tilt angle error interference estimation signal, is the acceleration disturbance estimation signal of the yaw channel, is the constant interference estimation signal of the tilt channel, is the tilt angle error interference estimation signal of the tilt channel, is the tilt angle rate interference estimation signal of the tilt channel, is the yaw angle error interference estimation signal of the tilt channel, Estimated signal for the acceleration disturbance in the tilt channel.
[0155] Finally, the total yaw channel interference estimation signal and the tilt channel interference estimation signal are generated by superimposing the above estimation law signal and the estimation signal as follows:
[0156]
[0157] in is the total signal estimated for the yaw channel interference, Estimate the total signal for slanted channel interference.
[0158] Step S60: Install a rate gyro to measure the yaw rate signal and tilt rate signal of the drone, and then superimpose the tilt error integral signal, the yaw error integral signal, the tilt error signal, the yaw error signal, the lateral acceleration signal, the yaw channel interference estimation total signal and the tilt channel interference estimation total signal to generate the final yaw channel control integrated signal and tilt channel control integrated signal, which are respectively transmitted to the drone yaw servo and tilt servo to achieve the drone sideslip and tilt compound turning control as follows:
[0159]
[0160] where u p It is the comprehensive signal for yaw channel control, u g is the integrated signal for tilt channel control, k 11 , k 12 , k 13 , k 14 , k 15 , k 16 , k21 , k 22 , k 23 , k 24 , k 25 , k 26 is a constant control parameter.
[0161] Case implementation and computer simulation results analysis
[0162] In step S10, the desired lateral position z is selected d For 400 meters, select parameters k1 = 0.01, k2 = 0.015, k3 = 0.05, k4 = 0.1. w1 =0.1, k w2 = 0.1 and k w3 =0.1.
[0163] In step S20, the parameter ε is selected 11 =0.03,ε 12 =0.8.
[0164] In step S30, the parameter k is selected m1 =0.1, k m2 =0.03 and k m3 =0.02.
[0165] In step S40, the parameter ε is selected 21 =0.05,ε 22 =1.2. In step S50, select parameter k c11 =0.003, k c12 =0.005, k c13 =0.002, k c14 =0.006, k c15 =0.004, k c21 =0.002, k c22 =0.004, k c23 =0.001, k c24 =0.006, k c25 =0.003.
[0166] In step S60, the parameter k is selected 11 =2.5, k 12 =0.3, k 13 =0.2, k 14 =0.02, k 15 =0.12, k 16 =0.05, k 21 =1.8, k 22 =0.5, k 23 =0.35, k 24 =0.03, k25 =0.11, k 26 =0.06.
[0167] Finally, the lateral displacement signal of the UAV is obtained as Figure 2 As shown; the lateral acceleration signal of the UAV is as follows Figure 3 As shown; the lateral speed signal of the UAV is as follows Figure 4 As shown; the lateral velocity error signal of the UAV is as follows Figure 5 As shown; the UAV yaw angle signal is as follows Figure 6 As shown, the UAV roll angle signal is as follows Figure 7 As shown, the comprehensive signal of the UAV yaw channel control is as follows Figure 8 As shown; the tilt channel control integrated signal is as follows Fig. 9 As shown. It can be seen from the above curve that the final lateral displacement of the UAV can quickly compare to the expected position of 400 meters, and the yaw channel control integrated signal and the tilt channel control integrated signal of the entire turning process do not exceed 10 degrees, while the maximum value of the yaw angle and the roll angle reaches about 15 degrees. The main reason is that the composite technology of sideslip and tilt turning reduces the control amount of each channel, and the superimposed turning energy makes the turning faster. Therefore, it can be seen from the experimental results that the present invention has good theoretical value and engineering application value.
Claims
1. A method for controlling a side-slip and tilt compound turn of an unmanned aerial vehicle. It is characterized by the following steps: Step S10: installing an accelerometer to measure the lateral acceleration of the drone; obtaining the lateral velocity by integration, and obtaining the lateral displacement signal by integration again; then setting the lateral displacement expected signal according to the flight mission, and comparing it with the lateral displacement signal to obtain the lateral displacement error signal, using the lateral velocity signal to compare with the first-order derivative of the lateral displacement expected signal to obtain the lateral velocity error signal, using the lateral acceleration signal to compare with the second-order derivative of the lateral displacement expected signal to obtain the lateral acceleration error signal; then integrating the lateral displacement error signal to obtain the lateral displacement error integral signal, and combining to generate the yaw angle command signal; then generating the yaw velocity error interference estimation law, the yaw acceleration error interference estimation law and the yaw position error interference estimation law respectively through the yaw angle command signal; obtaining the yaw velocity error interference estimation parameters, the yaw acceleration error interference estimation parameters and the yaw position error interference estimation parameters respectively after integration; finally combining the lateral displacement error signal, the lateral velocity error signal and the lateral acceleration error signal to obtain the lateral combined error signal includes: v z =∫a z dt; z=∫v z dt; e1=zz d ; s1=∫e1dt; φ d =k1e1+k2s1+k3d1+k4d2; d w1 =k w1 φ d d1;d w2 =k w2 φ d d2;d w3 =k w3 φ d e1; w1=∫d w1 dt;w2=∫d w2 dt;w3=∫d w3 dt; where a z v is the lateral acceleration of the drone measured by the installed accelerometer; z is the lateral velocity signal, z is the lateral displacement signal; d is the lateral displacement expected signal, e1 is the lateral displacement error signal, is the first-order derivative of the lateral displacement expected signal, is the second-order derivative of the lateral displacement desired signal, d1 is the lateral velocity error signal, d2 is the lateral acceleration error signal, s1 is the lateral position error integral signal; φ d is the yaw angle command signal; k1, k2, k3, k4 are constant control parameters; d w1 is the yaw velocity error disturbance estimation law, d w2 is the yaw acceleration error disturbance estimation law, d w3 is the yaw position error disturbance estimation law; k w1 , k w2 With k w3 is a constant parameter; w1 is the yaw velocity error interference estimation parameter, w2 is the yaw acceleration error interference estimation parameter, and w3 is the yaw position error interference estimation parameter; is the lateral combined error signal; Step S20: Install the attitude gyroscope to measure the yaw angle signal of the UAV, solve the tilt control integrated integral signal according to the tilt channel control integrated signal, set the initial value of the yaw weight, generate the yaw weight signal, then multiply the yaw angle command signal and superimpose the lateral combined error signal to obtain the yaw angle ideal signal, and compare it with the UAV yaw angle signal to obtain the yaw angle error signal, and finally integrate to obtain the yaw angle error integral signal, including: s g =∫|u g |dt; e2=φ-φ da ; s2=∫e2dt; Where φ is the UAV yaw angle signal measured by the attitude gyroscope, u g is the comprehensive signal for tilt channel control, and its initial value is selected as 0; s g is the comprehensive integral signal of tilt control; w 10 is the initial value of the yaw weight, which is a constant parameter; ε 11 , ε 12 is a constant parameter; w a1 is the yaw weight signal; φ da is the ideal yaw angle signal, e2 is the yaw angle error signal; s2 is the yaw angle error integral signal; Step S30: Generate a tilt angle command signal according to the combination of the lateral displacement error signal, the lateral displacement error integral signal, the lateral velocity error signal, and the lateral acceleration error signal; then generate a tilt velocity error interference estimation law, a tilt acceleration error interference estimation law, and a tilt position error interference estimation law respectively through the tilt angle command signal; obtain a tilt velocity error interference estimation parameter, a tilt acceleration error interference estimation parameter, and a tilt position error interference estimation parameter respectively after integration; finally, combine the lateral displacement error signal, the lateral velocity error signal, and the lateral acceleration error signal to obtain a tilt combined error signal as follows: γ d l1e1+l2s1+l3d1+l4d2; d m1 =k m1 c d d1;d m2 =k m2 c d d2;dm w3 =k m3 c d e1 m1=∫d m1 dt;m2=∫d m2 dt;m3=∫d m3 dt; where γ d is the tilt angle command signal; l1, l2, l3, l4 are constant control parameters; d m1 is the tilt velocity error disturbance estimation law, d m2 is the tilt acceleration error disturbance estimation law, d m3 is the tilt position error disturbance estimation law; k m1 , k m2 With k m3 is a constant parameter; m1 is a tilt velocity error interference estimation parameter, m2 is a tilt acceleration error interference estimation parameter, and m3 is a tilt position error interference estimation parameter; is the tilt combined error signal; Step S40: Install the attitude gyroscope to measure and obtain the tilt angle signal of the UAV, solve the yaw control integrated integral signal according to the yaw channel control integrated signal, set the initial value of the tilt weight, generate the tilt weight signal, then multiply the tilt angle command signal and superimpose the tilt combination error signal to obtain the tilt angle ideal signal, compare it with the UAV tilt angle signal to obtain the tilt angle error signal, and finally integrate to obtain the tilt angle error integral signal; s f =∫|u p |dt; e3=γ-γ da ; s3=∫e3dt; Where γ is the tilt angle signal of the UAV measured by the attitude gyroscope, u p is the comprehensive signal for yaw channel control, and its initial value is selected as 0; s f is the comprehensive integral signal of yaw control; w 20 is the initial value of the tilt weight, which is a constant parameter; ε 21 , ε 22 is a constant parameter; w a2 is the tilt weight signal; γ da is the ideal tilt angle signal, e3 is the tilt angle error signal; s3 is the tilt angle error integral signal; Step S50: according to the tilt angle command signal and the yaw angle command signal, respectively solve the yaw channel constant interference estimation law signal, the yaw channel yaw angle error interference estimation law signal, the yaw channel yaw angle rate interference estimation law signal, the yaw channel tilt angle error interference estimation law signal, the yaw channel acceleration interference estimation law signal, the tilt channel constant interference estimation law signal, the tilt channel tilt angle error interference estimation law signal, the tilt channel tilt angle rate interference estimation law signal, the tilt channel yaw angle error interference estimation law signal, the tilt channel acceleration interference estimation law signal; after integration, respectively obtain the yaw channel constant interference estimation signal, the yaw channel yaw angle error interference estimation signal, the yaw channel yaw angle rate interference estimation signal, the yaw channel tilt angle error interference estimation signal, the yaw channel acceleration interference estimation signal, the tilt channel constant interference estimation signal, the tilt channel tilt angle error interference estimation signal, the tilt channel tilt angle rate interference estimation signal, the tilt channel yaw angle error interference estimation signal, the tilt channel acceleration interference estimation signal; then compose and generate the yaw channel interference estimation total signal and the tilt channel interference estimation total signal; d c11 =k c11 f d ;d c21 =k c21 c d ; d c12 =k c12 f d e2;d c22 =k c22 c d e3; d c13 =k c13 f d oh y ;d c23 =k c23 c d oh x ; d c14 =k c14 f d e3;d c24 =k c24 c d e2; d c15 =k c15 f d a z ;d c25 =k c25 c d a z ; where k c11 , k c12 , k c13 , k c14 , k c15 , k c21 , k c22 , k c23 , k c24 , k c25 is a constant control parameter; d c11 is the constant interference estimation law signal of the yaw channel, d c12 is the yaw angle error interference estimation law signal of the yaw channel, d c13 is the yaw channel yaw angle rate interference estimation law signal, d c14 is the interference estimation law signal of the yaw channel tilt angle error, d c15 is the acceleration disturbance estimation law signal of the yaw channel, d c21 is the constant interference estimation law signal of the inclined channel, d c22 is the tilt channel tilt angle error interference estimation law signal, d c23 is the tilt angle rate interference estimation law signal of the tilt channel, d c24 is the interference estimation law signal of the tilt channel yaw angle error, d c25 is the acceleration disturbance estimation law signal of the tilt channel; is the constant interference estimation signal of the yaw channel, is the yaw angle error interference estimation signal of the yaw channel, is the yaw channel yaw angle rate interference estimation signal, is the yaw channel tilt angle error interference estimation signal, is the acceleration disturbance estimation signal of the yaw channel, is the constant interference estimation signal of the tilt channel, is the tilt angle error interference estimation signal of the tilt channel, is the tilt angle rate interference estimation signal of the tilt channel, is the yaw angle error interference estimation signal of the tilt channel, It is the acceleration disturbance estimation signal of the tilt channel; is the total signal estimated for the yaw channel interference, Estimating the total signal for slanted channel interference; Step S60: Install a rate gyro to measure the yaw rate signal and tilt rate signal of the drone, and then superimpose the tilt error integral signal, the yaw error integral signal, the tilt error signal, the yaw error signal, the lateral acceleration signal, the yaw channel interference estimation total signal and the tilt channel interference estimation total signal to generate the final yaw channel control integrated signal and tilt channel control integrated signal, which are respectively transmitted to the drone yaw servo and tilt servo to achieve the drone sideslip and tilt compound turning control as follows: where u p It is the comprehensive signal for yaw channel control, u g is the integrated signal for tilt channel control, k 11 , k 12 , k 13 , k 14 , k 15 , k 16 , k 21 , k 22 , k 23 , k 24 , k 25 , k 26 is a constant control parameter.
Citation Information
Patent Citations
Hypersonic speed aircraft control method capable of suppressing constant deviation influence of sideslip angle signal
CN103587681A
Control method of crosswind landing for unmanned planes
CN107745822A
Fixed-wing unmanned aerial vehicle landing control method based on self-adaptive dynamic inverse
CN111123967A
Unmanned aerial vehicle stunt flight control system and method
CN111580537A
Aircraft turning control method for providing damping by measuring acceleration
CN112061379A
