Design of a small quadrotor UAV forward flight experimental system and model identification method

By reconstructing and verifying the measurement data of the quadrotor UAV, an augmented state space model was established, which solved the accuracy and reliability problems under the front flight mode and improved the accuracy of flight control and efficiency.

CN115309178BActive Publication Date: 2024-11-29BEIJING INST OF TECH +1
View PDF 5 Cites 0 Cited by

Patent Information

Application Number
CN202110492406.6
Authority / Receiving Office
CN · China
Patent Type
Patents(China)
Current Assignee / Owner
Filing Date
2021-05-06
Publication Date
2024-11-29
Estimated Expiration
2041-05-06

AI Technical Summary

Technical Problem

The flight control system of the four-rotor drone in the front flight mode has accuracy and reliability problems. The dynamic model varies greatly and is susceptible to disturbances, making it difficult to achieve high-precision flight control.

Method used

A small four-rotor drone forward flight experimental system was designed, and the flight path reconstruction of the measurement data was obtained, the input and output frequency response data was obtained, and the transfer function model and state space model were established based on equivalent time delay, and the transfer function model and state space model were used. The dipole square wave signal is time-domain validated to augment the motor dynamics variables in the state space model to improve model accuracy.

Benefits of technology

Improve the correction accuracy of the measurement data and the accuracy of subsequent spatial state models, enhance the verification efficiency of transfer functions and state space models, realize a more accurate flight control model, improve the flight safety of the four-rotor drone and reliability.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN115309178B_ABST
    Figure CN115309178B_ABST
Patent Text Reader

Abstract

The present invention discloses a small quad-rotor unmanned aerial vehicle forward flight experimental system design and model identification method. The method provided by the present invention comprises: reconstructing the flight path of the measurement data of the quad-rotor unmanned aerial vehicle in the forward flight state to obtain input and output frequency response data; obtaining a transfer function model and a state space model based on equivalent time delay according to the input and output frequency response data; and verifying the transfer function model and the state space model in the time domain using a dipole square wave signal. The present invention reconstructs the flight path of the measurement data, can accurately determine the correction of the measurement data, and can also improve the accuracy of the subsequent spatial state model.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present invention relates to the technical field of aircraft flight control and modeling, and in particular to a small-sized quad-rotor unmanned aerial vehicle forward flight experimental system design and a model identification method. Background Art

[0002] In recent years, the application technology of UAVs has gradually matured, and various types of UAVs have gradually become popular in various fields and industries, among which multi-rotor UAVs are widely used. Today, quad-rotor UAVs have become the mainstream of small aircraft, and are also gradually developing towards intelligence and miniaturization. Considering safety and reliability, the flight control system plays a vital role in the complex application scenarios of quad-rotor UAVs. Its various performances, including take-off and landing, operational flight, flight safety and reliability, system automation and maintainability, largely depend on the design of its flight control system. A high-quality flight control system is an important guarantee for modern high-performance quad-rotor UAVs to achieve safe flight and complete complex flight missions. Therefore, it is of great practical significance to establish a control model for the forward flight mode of quad-rotor UAVs. However, quad-rotor UAVs have the disadvantages of low accuracy and poor reliability of onboard sensors, large differences in dynamic models under different flight conditions, and susceptibility to disturbances.

[0003] Therefore, in view of the problems existing in the prior art, it is urgent to design a quadrotor drone forward flight model with high accuracy, reliability and stability. Summary of the invention

[0004] In order to solve the problems existing in the prior art, the present invention provides a small quad-rotor UAV forward flight experiment system design and a model identification method.

[0005] In order to achieve the above-mentioned object, in a first aspect, the present invention provides a method for identifying a small quad-rotor unmanned aerial vehicle forward flight experimental model, which comprises:

[0006] The flight path of the measured data of the quadrotor drone in forward flight is reconstructed to obtain input and output frequency response data;

[0007] Obtaining a transfer function model and a state space model based on equivalent time delay according to input and output frequency response data;

[0008] The transfer function model and state space model are verified in the time domain using a dipole square wave signal.

[0009] In a second aspect, the present invention provides a small quad-rotor UAV forward flight experimental system, which comprises:

[0010] A data processing module is used to reconstruct the flight path of the measured data of the quadrotor drone in forward flight state to obtain input and output frequency response data;

[0011] A state space module, which is used to obtain a transfer function model and a state space model based on an equivalent time delay according to input and output frequency response data;

[0012] The time domain verification module is used to perform time domain verification on the transfer function model and the state space model using a dipole square wave signal.

[0013] The beneficial effects of the small quad-rotor unmanned aerial vehicle forward flight experimental model identification method and system of the present invention include:

[0014] (1) In the present invention, the flight path reconstruction of the measurement data can accurately determine the correction status of the measurement data and improve the accuracy of the subsequent space state model;

[0015] (2) In the present invention, a new state space model is adopted to augment the state variables describing the motor dynamics of the quadrotor drone into the vector of the state space model, thereby improving the accuracy of the state space model;

[0016] (3) In the present invention, the transfer function model and the state space model are verified in the time domain, and the verification result is more accurate and the verification efficiency can be improved. BRIEF DESCRIPTION OF THE DRAWINGS

[0017] Figure 1 It is a flow chart of a method for identifying a forward flight experimental model of a small quad-rotor unmanned aerial vehicle provided in the first embodiment of the present invention;

[0018] Figure 2 This is a schematic diagram of a process flow of a small quad-rotor UAV forward flight experiment system provided by Embodiment 2 of the present invention;

[0019] Figure 3 is a curve diagram of sensor zero bias results in forward flight mode of Experimental Example 1 of the present invention;

[0020] Figure 4a ) is the V in the forward flight mode of Experimental Example 1 of the present invention N 、V E 、V D Variable estimation fitting curve graph;

[0021] Figure 4b ) is a fitting curve diagram of the estimated variables of height, θ, φ, and ψ in the forward flight mode of Experimental Example 1 of the present invention;

[0022] Figure 5a ) is a time domain verification fitting curve diagram of the modal longitudinal channel identification model of the quad-rotor UAV in forward flight at 15 m / s in Experimental Example 1 of the present invention;

[0023] Figure 5b ) is a time domain verification fitting curve diagram of the modal lateral channel identification model of the quad-rotor unmanned aerial vehicle flying forward at 15m / s in Experimental Example 1 of the present invention;

[0024] Figure 6a ) is a comparison diagram of the transfer function model data of the pitch channel obtained by the actual test flight and identification model of the quad-rotor drone in Experimental Example 2 of the present invention;

[0025] Figure 6b ) is a comparison diagram of the transfer function model data of the altitude channel obtained by the actual test flight and identification model of the quad-rotor unmanned aerial vehicle in Experimental Example 2 of the present invention;

[0026] Figure 6c ) is a comparison diagram of the transfer function model data of the roll channel obtained by the actual test flight and identification model of the quad-rotor UAV in Experimental Example 2 of the present invention;

[0027] Figure 6d ) is a comparison diagram of the transfer function model data of the yaw channel obtained by the actual test flight and identification model of the quad-rotor UAV in Experimental Example 2 of the present invention. DETAILED DESCRIPTION

[0028] The preferred embodiments of the present invention are described in detail below in conjunction with the accompanying drawings so that the advantages and features of the present invention can be more easily understood by those skilled in the art, thereby making a clearer and more definite definition of the protection scope of the present invention.

[0029] It should be noted that, in this article, the terms "include", "comprises" or any other variations thereof are intended to cover non-exclusive inclusion, so that a process, method, article or device including a series of elements includes not only those elements, but also includes other elements not explicitly listed, or also includes elements inherent to such process, method, article or device. In the absence of further restrictions, the elements defined by the sentence "includes..." do not exclude the existence of other identical elements in the process, method, article or device including the elements.

[0030] Figure 1 A flowchart of a small quadcopter forward flight experimental model identification method provided in Example 1 of the present invention. The method can be applied to a terminal or server capable of data processing, such as a cloud or local exploration server, and is mainly used to determine the collection of input and output data during the quadcopter test flight.

[0031] Specifically, the method of the first embodiment mainly includes:

[0032] Step S101: reconstructing the flight path of the measured data of the quadrotor drone in forward flight to obtain input and output frequency response data.

[0033] In a preferred embodiment of the present invention, a logarithmic swept frequency signal is used as an input signal during a forward flight test, wherein the sampling frequency of the logarithmic swept frequency signal is 90 to 110 Hz. More preferably, the sampling frequency of the logarithmic swept frequency signal is 100 Hz. When the logarithmic swept frequency signal is selected as the excitation signal input in the flight test, the measurement time of each logarithmic swept frequency signal is 30 to 60 s, and more preferably, the measurement time is 40 to 50 s. In the present invention, the sampling frequency of the GPS signal in the flight test is 5 Hz, and the sampling frequency of the other sensors is 100 Hz.

[0034] In the present invention, the logarithmic frequency sweep signal has no prior knowledge about the dynamic system to be identified, excites the system in a wide frequency range, and has nearly constant power in all frequencies.

[0035] After the rotor drone receives the logarithmic swept frequency signal, the flight controller sends out control instructions for four channels (pitch, roll, yaw and altitude axis). After passing through the mixer, the control instructions are transmitted to the quadcopter motor in the form of a constant matrix. The speed is then distributed to the blades of the quadcopter. Finally, the output response of the quadcopter is measured and collected by the sensor.

[0036] In the present invention, the server can obtain the measurement data in any way and further process the data. The sensors involved include the accelerometer and gyroscope of the quadcopter, the barometric altimeter, the attitude reference system (AHRS) and the GPS. The data required in the quadcopter flight test include: the altitude and ground speed measured by GPS, the acceleration and angular velocity measured by IMU, the attitude quaternion measured by AHRS, the barometric altitude and the start and end flags of the excitation signal. For example, the user can directly import the required data, and the server can receive it; for example, other electronic devices other than the server can send the required data to the server, and the server can receive it.

[0037] In the motion equation of a quadrotor drone, acceleration and angular rate need to be input. The measurement noise of the accelerometer and angular rate gyroscope is the process noise of the motion equation of a quadrotor drone. At the same time, the IMU system of a quadrotor drone is seriously affected by random noise.

[0038] In the prior art, since the first column time vector of each sensor's output data file may be different and the sampling interval of the time vector is also different, the present invention needs to unify the time axis of the output data. Preferably, the sampling linear interpolation method unifies the output data.

[0039] In a preferred embodiment of the present invention, the flight path is reconstructed using an extended Kalman filter (EKF) algorithm, and the relationship between the output data and the motion state of the quadrotor drone is established through the extended Kalman filter algorithm.

[0040] Preferably, the sensor constant error of the quad-rotor drone in the forward flight state is fixed, that is, the sensor constant error is a constant.

[0041] In the present invention, the EFK algorithm includes the nonlinear motion equations of the six degrees of freedom of the quadcopter and the sensor constant error. Specifically, the EFK algorithm is expressed as:

[0042]

[0043]

[0044]

[0045]

[0046]

[0047]

[0048]

[0049]

[0050]

[0051]

[0052]

[0053]

[0054]

[0055] Among them, r m Represents the roll angular rate measured by the IMU sensor of the quadrotor drone; q m Represents the pitch rate measured by the IMU sensor of the quadrotor drone; p m represents the yaw rate measured by the IMU sensor of the quadrotor drone; b q represents the constant error of the pitch angle rate; b r represents the constant error of the roll angular rate; b p represents the constant error of the yaw rate; They represent the three-axis acceleration of the quadrotor drone measured by the IMU sensor; They represent the constant errors of the three-axis acceleration of the aircraft body.

[0056] The experimental measurement data (ground speed [V N V E V D ]、Barometric altitude measurement h m The relationship between the aircraft attitude information [θ φ ψ]) given by the AHRS system in the flight control firmware and the motion state. That is, formula 1 is obtained:

[0057] V N =u cosψcosθ+v(cosψsinθsinφ-sinψcosφ)+w(cosψsinθcosφ+sinψsinφ)

[0058] V E =u sinψcosθ+v(sinψsinθsinφ+cosψcosφ)+w(sinψsinθcosφ-cosψsinφ)

[0059] V D =vcosθsinφ-u sinθ+wcosθcosφ

[0060] h m =h

[0061] φ m =φ

[0062] θ m =θ

[0063] ψ m =ψ Formula 1

[0064] Among them, V N 、V E 、V D They represent the ground speed in the ground coordinate system; u represents the linear speed of the quadrotor drone in the x-axis direction; w represents the linear speed of the quadrotor drone in the y-axis direction; v represents the linear speed of the quadrotor drone in the z-axis direction; θ represents the pitch angle; φ represents the roll angle; ψ represents the yaw angle; h represents the pitch angle; m Indicates the altitude measured by the barometric altimeter; h indicates the altitude state of the system; φ m represents the roll angle measured by the attitude reference system (AHRS); θ m represents the pitch angle measured by the attitude heading reference system (AHRS); ψ m Represents the yaw angle measured by the Attitude Heading Reference System (AHRS).

[0065] Therefore, the present invention calculates the motion amount (VN V E V D hθφψ]) and the estimated sensor constant error ([b ax b ay b az b p b q b r ]) can accurately determine the correction of the motion data, and the processing efficiency is higher.

[0066] Step S102: acquiring a transfer function model and a state space model based on equivalent delay time according to input-output frequency response data.

[0067] Specifically, step S102 may include the following steps:

[0068] (1) Input the input and output frequency response data into the transfer function model for identification to obtain the parameter values ​​of the transfer function model.

[0069] In the present invention, the test data of the quad-rotor drone is used to identify the transfer function model. The transfer function model can accurately describe the frequency response from the input to the output of the quad-rotor drone in the frequency band of interest.

[0070] In a preferred embodiment of the present invention, the transfer function model of the pitch channel is obtained by the following formula:

[0071]

[0072] Among them, δ lon represents the pitch input, τ lon represents the equivalent time delay of the pitch channel, M lon The pitch moment of the quadrotor UAV is used to determine the lon Find the partial derivative to obtain, M q represents the pitch damping, ω lag is a constant obtained by the quadrotor UAV motor, and s represents a fixed variable.

[0073] In a preferred embodiment of the present invention, the transfer function model of the height channel is obtained by the following formula:

[0074]

[0075] Among them, δ col Indicates the height input, Z col Indicates the force on the z-axis of the quadrotor drone relative to the height input δ col Find the partial derivative, τ col represents the equivalent time delay of the height channel, Z wFind the derivative of the force on the z-axis of the quadrotor drone with respect to w.

[0076] In a preferred embodiment of the present invention, the transfer function model of the roll channel is obtained by the following formula:

[0077]

[0078] Among them, δ lat represents the roll input, τ lat represents the equivalent time delay of the roll channel, L lat Through the rolling moment lat Find the partial derivative to obtain, L P Indicates roll damping.

[0079] In a preferred embodiment of the present invention, the transfer function model of the yaw channel is obtained by the following formula:

[0080]

[0081] Among them, δ dir Indicates yaw input, N dir Denotes the yaw moment to yaw input δ dir Find the partial derivative, ω lead is a constant, indicating the pole constant of the motor leading link, τ dir represents the equivalent time delay of the yaw channel, N r Represents yaw damping.

[0082] In the present invention, the indicators for evaluating the accuracy of the transfer function model are the cost function J and the error response function.

[0083] For example, when the cost function J≤100, it indicates that the identified transfer function model is within an acceptable accuracy range. Or when J≤50, it is considered that the frequency response data generated by the transfer function model is basically the same as the response data directly obtained from the quadcopter test data.

[0084] Exemplarily, the error response function is obtained by fitting the envelope with the frequency as the horizontal axis according to the maximum unnoticed dynamic increment (MUAD) provided by the MIL-STD-1797 standard. If the second indicator, i.e., the flight data fitting error response curve, falls within the curve range, it is determined that the response of the transfer function model is not significantly different from the actual flight response.

[0085] Among them, the transfer function model can provide a clearer understanding of the model and its dynamic characteristics. However, if it involves the design of a control system, the transfer function is not enough, and the state space model of the system is also required.

[0086] (2) The parameter values ​​in the transfer function model are used as input values ​​of the state-space model to identify the parameter values ​​of the state-space model.

[0087] Among them, the state space model of the quadrotor drone in the forward flight mode is a multi-input multi-output system, which can be divided into a longitudinal channel and a lateral channel. The pitch axis and the altitude axis in the longitudinal channel are coupled, and the roll axis and the yaw axis in the lateral channel are coupled.

[0088] Therefore, in a preferred embodiment of the present invention, the state space model of the longitudinal channel is obtained by formula 2:

[0089]

[0090] Among them, u0 represents the initial value of the linear velocity of the x-axis of the quadrotor drone; w0 represents the initial value of the linear velocity of the z-axis of the quadrotor drone; q represents the pitch angle rate; represents the pitch input δ lon lagged information; Indicates the height input δ col The delayed information of lon represents the pitch input; δ col Indicates height input; X lon Indicates the force F in the x-axis direction of the quadrotor drone x δ lon Find the partial derivative to obtain; Z u Indicates the z-axis force F of the quadrotor drone z Take the partial derivative of u to get; Z col Indicates the z-axis force F of the quadrotor drone z δ col Find the partial derivative to obtain; M u It is obtained by taking the partial derivative of the pitch moment of the quadrotor drone with respect to u; M w It is obtained by taking the partial derivative of the pitch moment of the quadrotor drone with respect to w; M lon The pitch moment of the quadrotor UAV is used to determine the lon Find the partial derivative to obtain; ω lag is a constant, obtained through the motor of the quadrotor drone; τ lon represents the equivalent time delay of the pitch channel; τ col Represents the equivalent time delay of the height channel.

[0091] Among them, it can be seen from the state space model to be identified that the pitch input δ describing the motor dynamics lon The lag information is augmented into the state space vector. This augmented model structure is used to model the motor dynamics of the quadrotor UAV. The augmented motor dynamics can be used to describe the attenuation of the frequency response in the high-frequency band.

[0092] In a preferred embodiment of the present invention, the state space model of the lateral channel is obtained by formula 3:

[0093]

[0094] Where p represents the roll angular rate; r represents the yaw angular rate; θ0 represents the initial value of the pitch angle; represents the roll input δ lat lagged information; represents the yaw input δ dir The delayed information of lat represents the roll input; δ dir Indicates yaw input; L lat Through the rolling moment lat Find the partial derivative to obtain; N dir Denotes the yaw moment to yaw input δ dir Find the partial derivative, ω lead is the zero-point constant of the motor leading link; τ dir represents the equivalent time delay of the yaw channel; τ lat Represents the equivalent time delay of the roll channel.

[0095] It can be seen that in the state space model, this transfer function model describes the delayed input With the command input δ lon The relationship between them, the transfer function expression is In this way, the original nine rigid body state variables of the quadcopter UAV dynamics model under forward flight conditions are augmented with four additional states describing the motor dynamics. lead The motor advance link is introduced to describe the flat phase angle curve in the mid-frequency band. This model form that includes motor dynamics is more accurate and has a wider range of applications. The efficiency of designing flight controllers using this model is also higher.

[0096] In the present invention, the index for evaluating the accuracy of the state space model is Boundary Relative Value and insensitivity For example, when And the average cost function J ave When ≤100, it indicates that the state space model identification result is highly reliable and the prediction accuracy is good; for example, when It can be considered that the identified state space model has good predictive ability.

[0097] Step S103: using a dipole square wave signal to perform time domain verification on the transfer function model and the state space model.

[0098] Specifically, step S103 includes:

[0099] The quadrotor drone is controlled to perform a test flight according to the dipole square wave signal. The transfer function model and the state space model are verified in the time domain using the dipole square wave signal to determine whether the matching error between the test flight output value and the state space model output value meets the evaluation index.

[0100] If it is satisfied, the transfer function model and the state space model are reliable.

[0101] Otherwise, the parameters of the transfer function model and / or the state space model are adjusted until the matching error satisfies the evaluation index.

[0102] Among them, the form of the doublet square wave signal is relatively simple and easy to implement in flight tests. This signal can maximize data information and collect the required information in a shorter test time. This signal is composed of steps, which is completely different from the logarithmic sweep signal and is suitable for testing the predictive ability of the identification model.

[0103] Preferably, the sampling frequency of the dipole square wave signal is 1 Hz; and the measurement time of the dipole square wave signal is 8 s.

[0104] It is worth noting that frequency domain verification can easily meet the matching requirements of test data and model data. However, important evaluations such as the accuracy and robustness of the identification model and the limitations of the linear model also need to be reflected through time domain verification. The process is to input the input signal into the actual flight and the model respectively to see how close the outputs of the two are. Among them, the evaluation index can be the matching error J rms , that is, the disturbance model response time history y and the disturbance flight data y data Minimize the fitting error. For example, if the matching error J rms If the matching error J is within 1-2, it indicates that the prediction accuracy of the model is within an acceptable range and the model is reliable. rms If it is greater than 2, continue to adjust the model parameters to make it true. At this point, the entire identification process is completed.

[0105] exist Figure 1 In the embodiment 1 shown,

[0106] (1) In the present invention, the flight path reconstruction of the measurement data can accurately determine the correction status of the measurement data and improve the accuracy of the subsequent space state model;

[0107] (2) In the present invention, a new state space model is adopted to augment the state variables describing the motor dynamics of the quadrotor drone into the vector of the state space model, thereby improving the accuracy of the state space model;

[0108] (3) In the present invention, the transfer function model and the state space model are verified in the time domain, and the verification result is more accurate and the verification efficiency can be improved.

[0109] Figure 2 This is a schematic diagram of a small quadcopter forward flight test system provided in Embodiment 2 of the present invention. The system can be applied to a terminal or server capable of data processing, such as a cloud or local exploration server, and is mainly used to determine the collection of input and output data during the quadcopter test flight. The system mainly includes:

[0110] The data processing module 201 is used to reconstruct the flight path of the measured data of the quad-rotor drone in the forward flight state to obtain input and output frequency response data;

[0111] A state space module 202, which is used to obtain a transfer function model and a state space model based on an equivalent time delay according to input and output frequency response data;

[0112] The time domain verification module 203 is used to perform time domain verification on the transfer function model and the state space model using a dipole square wave signal.

[0113] The small quad-rotor UAV forward flight experiment system provided in the present application can be used to execute the small quad-rotor UAV forward flight experiment model identification method described in any of the above embodiments. Its implementation principle and technical effects are similar and will not be repeated here.

[0114] Preferably, the data processing module 201, the state space module 202 and the time domain verification module 203 in the small quad-rotor drone forward flight experimental system of the present application can be directly in the hardware, in the software module executed by the processor, or in a combination of the two.

[0115] The software modules may reside in RAM memory, flash memory, ROM memory, EPROM memory, EEPROM memory, registers, hard disk, removable disk, CD-ROM or any other form of storage medium known in the art. An exemplary storage medium is coupled to the processor so that the processor can read information from and write information to the storage medium.

[0116] The processor may be a central processing unit (CPU), or other general-purpose processors, digital signal processors (DSP), application-specific integrated circuits (ASIC), field programmable gate arrays (FPGA), or other programmable logic devices, discrete gates or transistor logic, discrete hardware components, or any combination thereof. A general-purpose processor may be a microprocessor, but in an alternative, the processor may be any conventional processor, controller, microcontroller, or state machine. The processor may also be implemented as a combination of computing devices, such as a combination of a DSP and a microprocessor, a plurality of microprocessors, one or more microprocessors combined with a DSP core, or any other such configuration. In an alternative, the storage medium may be integrated with the processor. The processor and the storage medium may reside in an ASIC. The ASIC may reside in a user terminal. In an alternative, the processor and the storage medium may reside in a user terminal as discrete components.

[0117] In a third embodiment of the present application, a computer-readable storage medium stores computer instructions, and the computer instructions are operated to execute the small quad-rotor drone forward flight experimental model identification method described in any embodiment.

[0118] In embodiment 4 of the present application, a program product includes a computer program, the computer program is stored in a readable storage medium, at least one processor can read the computer program from the readable storage medium, and at least one processor executes the computer program to execute the small quadrotor drone forward flight experimental model identification method described in any embodiment.

[0119] In the several embodiments provided in the present application, it should be understood that the disclosed devices and methods can be implemented in other ways. For example, the device embodiments described above are only schematic. For example, the division of the units is only a logical function division. There may be other division methods in actual implementation, such as multiple units or components can be combined or integrated into another system, or some features can be ignored or not executed. Another point is that the mutual coupling or direct coupling or communication connection shown or discussed can be through some interfaces, indirect coupling or communication connection of devices or units, which can be electrical, mechanical or other forms.

[0120] The units described as separate components may or may not be physically separated, and the components shown as units may or may not be physical units, that is, they may be located in one place or distributed on multiple network units. Some or all of the units may be selected according to actual needs to achieve the purpose of the solution of this embodiment.

[0121] Finally, it should be noted that the above embodiments are only used to illustrate the technical solutions of the present invention, rather than to limit it. Although the present invention has been described in detail with reference to the aforementioned embodiments, those skilled in the art should understand that they can still modify the technical solutions described in the aforementioned embodiments, or replace some or all of the technical features therein with equivalents. However, these modifications or replacements do not cause the essence of the corresponding technical solutions to deviate from the scope of the technical solutions of the embodiments of the present invention.

[0122] Experimental Example 1

[0123] To calculate the dynamic model of a 6.5kg quad-rotor drone, provide an input signal to the quad-rotor drone so that it flies forward at a speed of 15m / s, and calculate the output data of the quad-rotor drone in real time. The quad-rotor drone state x = [uvwpqr φ θ ψ] and the four control inputs u = [δ lat δ lon δ dir δ col ];

[0124] Reconstruct the flight path of the measured data, that is, substitute it into Eq.

[0125] V N =u cosψcosθ+v(cosψsinθsinφ-sinψcosφ)+w(cosψsinθcosφ+sinψsinφ)

[0126] V E =u sinψcosθ+v(sinψsinθsinφ+cosψcosφ)+w(sinψsinθcosφ-cosψsinφ)

[0127] V D =v cosθsinφ-u sinθ+w cosθcosφ

[0128] h m =h

[0129] φ m =φ

[0130] θ m =θ

[0131] ψ m =ψ Formula 1

[0132] Among them, V N 、V E 、V D They represent the ground speed in the ground coordinate system; u represents the linear speed of the quadrotor drone in the x-axis direction; w represents the linear speed of the quadrotor drone in the y-axis direction; v represents the linear speed of the quadrotor drone in the z-axis direction; θ represents the pitch angle; φ represents the roll angle; ψ represents the yaw angle; h represents the pitch angle; m Indicates the altitude measured by the barometric altimeter; h indicates the altitude state of the system; φ m represents the roll angle measured by the attitude reference system (AHRS); θ m represents the pitch angle measured by the attitude heading reference system (AHRS); ψ m Represents the yaw angle measured by the Attitude Heading Reference System (AHRS).

[0133] The results are as follows Figure 3 , 4. From Figure 3 4. It can be seen that the attitude angle obtained after numerical integration of the angular rate obtained by flight path reconstruction is basically consistent with the attitude angle measured by the UAV flight control AHRS system, ensuring the kinematic consistency of the reconstructed angular rate and the AHRS attitude angle, while the angular rate obtained by the original IMU diverges during numerical integration because it contains constant errors. This shows that the flight path reconstruction technology has high reliability.

[0134] Using input and output frequency response data,

[0135] (1) y=[uwqa x a z ](a x 、a z Representing the acceleration of the x-axis and z-axis respectively) are input into the transfer function model of the pitch channel and the height channel;

[0136]

[0137] The transfer function model parameters of the pitch channel and the height channel are obtained respectively: M lon =101.2,ω lag =24, τ lon =0.04554, Z col =-19.96, Z w =0.2157, τ col =-0.03494.

[0138] And the cost function of the transfer function model:

[0139]

[0140] Substitute the identified parameters into the state space model of the longitudinal channel, that is, in Equation 2,

[0141]

[0142] Get the parameters Value and insensitivity

[0143]

[0144]

[0145] (2) y=[vpra y ](a y represents the y-axis acceleration) is input into the transfer function model of the roll channel and the yaw channel:

[0146] The transfer function model parameters of the roll channel and yaw channel are obtained respectively: L lat =151.1,ω lag =24, L P =-1.923, τ lat =0.03967, N dir =55.52, N r =-0.5824, τ dir =0.0425.

[0147] And the cost function of the transfer function model:

[0148]

[0149] Substitute the identified parameters into the state space model of the lateral channel, that is,

[0150]

[0151] Get the parameters Value and insensitivity ::

[0152]

[0153] Therefore, the cost functions of the transfer function models of the four channels are within the preset thresholds, and the parameters of the state space models of the longitudinal channel and the lateral channel are also within the preset thresholds, indicating that the model is reliable.

[0154] Doublets signals are used to perform time domain verification on the quadrotor drone. The verification results are shown in Figure 5. Figure 5a ) is the time domain verification and fitting of the longitudinal channel identification model of the forward flight mode at 15m / s; Figure 5b ) is the time domain verification and fitting of the lateral channel identification model of the forward flight 15m / s mode. It can be seen from Figure 5 that the state space model identified using data is reliable and has higher accuracy.

[0155] Experimental Example 2

[0156] A new set of input signals is input to the quadrotor drone to obtain the flight data detected by the corresponding sensors on the quadrotor drone. The flight path of the measured data is reconstructed, and the reconstructed data is input into the transfer function model and state space model obtained according to Experimental Example 1 to obtain the corresponding model data. The flight data and the model data are compared as shown in Figure 6.

[0157] The flight data and model data overlap well, which further proves that the model prediction is accurate. Therefore, the transfer function model and state space model obtained in Experimental Example 1 can truly reflect the flight response of the quadrotor drone under forward flight conditions.

[0158] The present invention has been described in detail above in conjunction with specific implementation methods and exemplary examples, but these descriptions cannot be understood as limiting the present invention. Those skilled in the art will appreciate that, without departing from the spirit and scope of the present invention, various equivalent substitutions, modifications or improvements may be made to the technical solution of the present invention and its implementation methods, all of which fall within the scope of the present invention.

Claims

1. A method for identifying a small quad-rotor UAV forward flight experimental model, characterized in that: include: Reconstructing the flight path of the measured data of the quadrotor drone in the forward flight state to obtain input and output frequency response data; Acquire a transfer function model and a state space model based on equivalent time delay according to the input-output frequency response data; The transfer function model and the state space model are verified in the time domain using a dipole square wave signal. Before reconstructing the flight path of the measurement data, the time axis of the measurement data is unified. The flight path is reconstructed using an extended Kalman filter algorithm, and the relationship between the measurement data and the motion state of the quadrotor drone is established through the extended Kalman filter algorithm. The sensor constant error of the quad-rotor drone in the forward flight state is fixed. The relationship between the measured data and the motion state of the quadrotor drone is expressed by Formula 1: V N =ucosψcosθ+v(cosψsinθsinφ-sinψcosφ)+w(cosψsinθcosφ+sinψsinφ) V E =usinψcosθ+v(sinψsinθsinφ+cosψcosφ)+w(sinψsinθcosφ-cosψsinφ) V D =vcosθsinφ-usinθ+wcosθcosφ h m =h f m =φ i m =θ ψ m =ψ Formula 1 Among them, V N 、V E 、V D They represent the ground speed in the ground coordinate system; u represents the linear speed of the quadrotor drone in the x-axis direction; w represents the linear speed of the quadrotor drone in the y-axis direction; v represents the linear speed of the quadrotor drone in the z-axis direction; θ represents the pitch angle; φ represents the roll angle; ψ represents the yaw angle; h represents the pitch angle; m Indicates the altitude measured by the barometric altimeter; h indicates the altitude state of the system; φ m Represents the roll angle measured by the attitude reference system; θ m represents the pitch angle measured by the attitude reference system; ψ m represents the yaw angle measured by the attitude reference system, The state space model of the longitudinal channel is obtained by equation 2: Among them, u0 represents the initial value of the linear velocity of the x-axis of the quadrotor drone; w0 represents the initial value of the linear velocity of the z-axis of the quadrotor drone; q represents the pitch angle rate; represents the pitch input δ lon lagged information; Indicates the height input δ col The delayed information of lon represents the pitch input; δ col Indicates height input; X lon Indicates the force F in the x-axis direction of the quadrotor drone x δ lon Find the partial derivative to obtain; Z u Indicates the z-axis force F of the quadrotor drone z Take the partial derivative of u to get; Z col Indicates the z-axis force F of the quadrotor drone z δ col Find the partial derivative to obtain; M u It is obtained by taking the partial derivative of the pitch moment of the quadrotor drone with respect to u; M w It is obtained by taking the partial derivative of the pitch moment of the quadrotor drone with respect to w; M lon The pitch moment of the quadrotor UAV is used to determine the lon Find the partial derivative to obtain; ω lag is a constant, obtained through the motor of the quadrotor drone; τ lon represents the equivalent time delay of the pitch channel; τ col represents the equivalent time delay of the height channel, The state space model of the lateral channel is obtained by equation 3: Where p represents the roll angular rate; r represents the yaw angular rate; θ0 represents the initial value of the pitch angle; represents the roll input δ lat lagged information; represents the yaw input δ dir The delayed information of lat represents the roll input; δ dir Indicates yaw input; L lat Through the rolling moment lat Find the partial derivative to obtain; N dir Denotes the yaw moment to yaw input δ dir Find the partial derivative, ω lead is the zero point constant of the motor leading link; τ dir represents the equivalent time delay of the yaw channel; τ lat Represents the equivalent time delay of the roll channel.

2. The small quad-rotor unmanned aerial vehicle forward flight experimental model identification method according to claim 1 is characterized in that: A logarithmic swept frequency signal is used as an input signal in the forward flight state, wherein the sampling frequency of the logarithmic swept frequency signal is 90 to 110 Hz; and / or the measurement time of each logarithmic swept frequency signal is 30 to 60 seconds.

3. The small quad-rotor unmanned aerial vehicle forward flight experimental model identification method according to claim 1 is characterized in that: The sampling frequency of the dipole square wave signal is 1 Hz; and / or the measurement time of each dipole square wave signal is 8 s.

4. A small quad-rotor UAV forward flight experiment system, using the method according to claim 1, characterized in that: include: A data processing module, which is used to reconstruct the flight path of the measurement data of the quadrotor drone in the forward flight state to obtain input and output frequency response data; A state space module, which is used to obtain a transfer function model and a state space model based on an equivalent time delay according to the input and output frequency response data; A time domain verification module is used to perform time domain verification on the transfer function model and the state space model using a dipole square wave signal.

Citation Information

Patent Citations

  • GPS (Global Position System) based prediction method for speed state of micro quad-rotor unmanned aerial vehicle

    CN103246203A

  • Tilting rotor wing unmanned aerial vehicle nonlinear shallow grey model identification and correction method

    CN111538237A

  • Tilt rotor unmanned aerial vehicle transition mode model identification method

    CN112068582A

  • Time domain identification method for aerodynamic parameters of small four-rotor aircraft

    CN112257186A

  • Stable flight control method for multi-rotor unmanned aerial vehicle based on finite-time neurodynamics

    WO2019024303A1