Unmanned aerial vehicle airspeed sensing device and flight control method
By combining thermistor airspeed sensor and inertial measurement unit, data fusion is used to fusion with extended Kalman filtering and neural network, the local positioning problem of micro-UAVs in closed space or lack of satellite positioning areas is solved, and the accuracy of flight control is improved Sex and stability.
Patent Information
- Application Number
- CN202411003411.6
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2024-07-25
- Publication Date
- 2024-11-08
- Estimated Expiration
- 2044-07-25
AI Technical Summary
It is difficult to locally position micro fixed-wing drones in closed spaces or lack satellite positioning areas, traditional large-size airspeed sensors are difficult to deploy, and the real-time performance of state estimation and flight control data is insufficient.
Using thermistor-based airspeed sensor and inertial measurement unit, the data fusion method of extended Kalman filtering can realize the online speed and position perception of the drone, and simplify the airspeed data processing through neural networks to provide real-time flight control support.
Accurate airspeed and position measurement without destroying the shape of the drone and increasing weight, improving the accuracy and stability of flight control, and is suitable for flight missions in complex environments of micro fixed-wing drones .
Smart Images

Figure CN118914591A_ABST
Abstract
Description
Technical Field
[0001] The present invention relates to the field of drone sensing and control technology, and more particularly to a drone airspeed sensing device and a flight control method, and more particularly to an airspeed inertial odometer for measuring drone airspeed and position, and a related flight state estimation and control method. Background Art
[0002] With the rapid development of drone technology, micro fixed-wing drones are increasingly used in various special environments, such as closed space exploration and areas lacking satellite positioning. In these scenarios, it is crucial to determine the precise location of the drone to support its safe flight, mission execution, and spatial positioning needs. However, due to the limited payload capacity of micro drones, traditional large-size, high-power, and high-computing positioning sensors are difficult to carry, which poses a challenge to achieving accurate local positioning. To solve this problem, researchers began to explore ways to infer the location of the drone by measuring the airflow velocity passing through it. This method is called airflow velocity odometer.
[0003] The air velocity odometer measures the position change of the UAV relative to the surrounding airflow and calculates the position information of the UAV by combining dead reckoning or data fusion technology. Previous research has mainly focused on the quadcopter UAV platform, by arranging sensors at a long distance to reduce the impact of propeller flow on airspeed measurement. However, even with this approach, traditional airspeed sensors are limited when deployed on micro-UAVs due to their large size and weight.
[0004] Therefore, in recent years, researchers have begun to explore the development of smaller and lighter airspeed sensors to meet the needs of micro-UAVs. These new sensors are based on different principles, such as calorimetric, ultrasonic, etc., and are designed to provide accurate airspeed measurements to support local positioning of micro-UAVs. Progress in this field provides new possibilities for the application of micro-UAVs in complex environments, but also brings new challenges and opportunities for the development of UAV positioning technology.
[0005] In addition, how to effectively use the data collected by sensors for flight control is another key research area. UAVs need to understand their current flight status in real time to perform complex flight missions and maintain stability. This involves a key technical link - state estimation. State estimation not only provides speed and attitude information, which is essential for adjusting control inputs, maintaining or changing flight direction and altitude, but also is the basis for ensuring the safe and efficient operation of UAVs. Therefore, studying and optimizing state estimation algorithms to better interpret sensor data and convert it into reliable flight control information is an important challenge and opportunity in the current development of UAV technology. Summary of the invention
[0006] In view of the above problems, the present invention provides an airspeed sensing device and a flight control method for a UAV. The UAV airspeed sensing device is implemented by an airspeed sensor based on a hot wire, and is combined with the measurement of an inertial measurement unit (IMU). Data fusion is performed through the state estimation method of the extended Kalman filter to achieve online UAV speed and position perception, further solve the local positioning problem of UAVs in special environments such as closed space exploration and areas lacking satellite positioning, and improve the effect of flight control.
[0007] The present invention provides an airspeed sensing device for a drone, comprising: an airspeed sensor unit 1 9, an airspeed sensor unit 2 10, an inertial measurement unit 11 and a data fusion estimation module;
[0008] The airspeed sensor unit 1 9 and the airspeed sensor unit 2 10 are connected to the data fusion estimation module via wires;
[0009] The inertial measurement unit 11 is connected to the data fusion estimation module; the inertial measurement unit is used to collect dynamic motion information of the drone and obtain acceleration and angular velocity information related to the drone's attitude.
[0010] The airspeed sensor unit 1 9 and the airspeed sensor unit 2 10 are respectively arranged on two wings of the UAV, and are respectively used to generate temperature differences of multiple thermistors, and the three-dimensional airspeed of the UAV is obtained through the temperature differences of the multiple thermistors;
[0011] Preferably, the UAV is a micro fixed-wing UAV;
[0012] Preferably, the airspeed sensor unit 9 comprises: a thermistor unit 2, a protective layer 1 and a flexible substrate 1;
[0013] The protective layer 1 is connected to the flexible substrate 1 and is arranged on the outer side of the wing of the UAV;
[0014] The thermistor unit 1 2 encapsulates a plurality of thermistor pairs 7;
[0015] The airspeed sensor unit 9 further includes a heater 8; the thermistor unit 2 and the heater 8 are arranged on the protective layer 1;
[0016] The heater 1 8 is arranged at the center of the thermistor unit 1 2;
[0017] Each thermistor pair includes two thermistors; the two thermistors of each thermistor pair are symmetrically arranged with the heater 8 as the center;
[0018] Further, with the heater 1 8 as the center, multiple groups of thermistor pairs 7 are arranged from the inside to the outside on the periphery of the heater 1 8; the two thermistors in the thermistor pairs 7 are symmetrically arranged on the periphery of the heater 1 8 with the heater 1 8 as the center;
[0019] Exemplarily, the multiple thermistors are arranged in a cross shape with heater 8 as the center, and are symmetrically arranged in pairs on the periphery of the heater in an orthogonal distribution; the multiple groups of thermistor pairs are arranged on the outside of the wing of the UAV through a protective layer 1 and a flexible substrate 1 to measure the airspeed in two orthogonal directions to obtain the three-dimensional airspeed of the UAV.
[0020] The airspeed sensor unit 2 10 comprises: a thermistor unit 2, a heater 2, a protective layer 2 and a flexible substrate 2; the configuration of the airspeed sensor unit 2 is consistent with that of the airspeed sensor unit 1.
[0021] It is understandable that the flexible substrate 1 is a flexible printed circuit (FPC) circuit;
[0022] The thermistor is manufactured by a micron-scale process and packaged on a flexible printed circuit (FPC) line.
[0023] In the technical solution of the present invention, multiple thermistors are arranged in a cross shape on the outside of the wings of the UAV, and two orthogonal directions are measured simultaneously to accurately measure the three-dimensional wind speed. While maintaining the integrity of the UAV's appearance, it provides the ability to accurately measure the direction and size of the airspeed.
[0024] The present invention uses multiple ultra-thin thermistors as the core components of each wind speed sensor unit, which continuously generate heat in the wind field and produce a temperature difference between the upstream and downstream of the wind flow. The temperature difference reflects thermal convection, offsets the influence of environmental heat, and further infers the directionality of air flow, reflecting the change of airspeed.
[0025] Preferably, the data fusion estimation module comprises: an analog and / or digital conversion unit, a processor and a data storage module;
[0026] The processor is connected to the analog and / or digital conversion unit and the data storage module respectively;
[0027] The multiple thermistors generate a temperature difference, the temperature difference is converted into voltage data by an analog and / or digital conversion unit, and the voltage data is transmitted to a processor;
[0028] Preferably, the inertial measurement unit 11 includes a three-axis gyroscope, a three-axis accelerometer and a three-axis magnetometer; the inertial measurement unit 11 is a sensing element, which is used to output measurement information;
[0029] The three-axis gyroscope, the three-axis accelerometer and the three-axis magnetometer are connected in parallel; the three-axis accelerometer is connected to the processor;
[0030] The three-axis gyroscope, three-axis accelerometer and three-axis magnetometer output the acceleration and angular velocity of the drone and transmit them to the processor; as shown in the attached Figure 3 As shown, the voltage data and the acceleration and angular velocity of the drone are combined through a data fusion algorithm to obtain the position of the drone.
[0031] Preferably, the UAV airspeed sensing device further comprises: a sampling module;
[0032] The sampling module includes a thermistor interface 1 12-1, a thermistor interface 2 12-2 and a data transmission interface 13;
[0033] The thermistor interface 1 12-2 is connected to the airspeed sensor unit 1 and the analog and / or digital conversion unit respectively; the thermistor interface 2 12-2 is connected to the airspeed sensor unit 2 and the analog and / or digital conversion unit respectively;
[0034] The data transmission interface 13 is connected to the three-axis gyroscope, the three-axis accelerometer and the three-axis magnetometer;
[0035] Further, the thermistor interface 1 12 - 1 and the thermistor interface 2 12 - 2 are used to transmit the voltage data of the airspeed sensor unit 1 and the airspeed sensor unit 2 to the data fusion estimation module;
[0036] The data transmission interface 13 is used to transmit the inertial measurement information such as the acceleration and angular velocity of the UAV to the data fusion estimation module.
[0037] Furthermore, the processor is a filter data fusion model;
[0038] Furthermore, the filter data fusion model includes: filter one, neural network, extended filter one, filter two, and extended filter two;
[0039] The voltage data is transmitted to the neural network through filter 1 to obtain the three-dimensional airspeed of the drone;
[0040] The inertial measurement unit outputs the acceleration and angular velocity of the drone; then transmits it to the extended filter 1 through the filter 2 to obtain the attitude data;
[0041] The acceleration and angular velocity of the drone are transmitted to the extended filter 1 through the filter 2 to obtain attitude data;
[0042] The three-dimensional airspeed and attitude data of the UAV are input into the second expansion filter to obtain the position data and speed data of the UAV;
[0043] Furthermore, the filter data fusion model is an extended Kalman filter data fusion model;
[0044] Furthermore, the extended filter 1 and the extended filter 2 are both extended Kalman filters.
[0045] Furthermore, the data fusion estimation module also includes a sampling module;
[0046] The airspeed sensor units of the present invention are distributed on the leading edge and outer section of the wing, thereby minimizing fuselage shielding and interference and improving measurement accuracy.
[0047] The airspeed sensor unit of the present invention uses an integrated circuit chip (single-chip microcomputer) to connect the acquisition circuit in the integrated circuit chip and the flight controller 14 through a serial interface to establish real-time communication for transmitting data of the airspeed sensor unit; a storage log chip is also provided for separately analyzing the data from the sampling circuit after the flight mission is completed; a neural network is used to establish an airspeed calculation agent model through the voltage data transmitted by the airspeed sensor unit and the actual vector airspeed data measured in the motion capture, and the model is simplified and deployed in the processor to realize online airspeed data measurement, and further realize position and speed calculation and flight control.
[0048] Another object of the present invention is to provide a flight control method for an airspeed sensing device of a drone, comprising:
[0049] Based on the airspeed sensor unit 1 9 and the airspeed sensor unit 2 10, voltage data at the current moment is obtained;
[0050] Input the voltage data at the current moment into the filter 1 and the neural network of the data fusion estimation module to obtain the corresponding airspeed data;
[0051] The acceleration and angular velocity of the drone at the current moment are obtained based on the inertial measurement unit 11;
[0052] The acceleration and angular velocity of the drone at the current moment are input into the extended filter 1 through the filter 2 of the data fusion estimation module for fusion to obtain the attitude data at the current moment;
[0053] The airspeed data at the current moment and the attitude data at the current moment are input into the extended filter 2 of the data fusion estimation module for fusion to obtain the position data at the current moment.
[0054] The present invention adopts a parallel processing method to help the airspeed inertial odometer better understand the motion state of the object, and provide more reliable data support for the attitude control and positioning of the UAV.
[0055] Furthermore, the posture data is expressed as
[0056]
[0057] in, is the attitude data of the UAV at the kth moment, is the predicted attitude data of the UAV at the kth moment, K k is the Kalman gain at the kth moment, h is the measurement equation, describing the association between the airspeed sensor measurement and the drone state, z k It is the measurement data of the airspeed sensor unit at the kth moment, that is, the voltage data.
[0058] Furthermore, the Kalman gain expression at the kth moment is:
[0059]
[0060] in, is the prediction covariance at the kth moment, H is the Jacobian matrix of the observation matrix, and R is the measurement noise covariance matrix.
[0061] Furthermore, the predicted attitude data of the UAV at the kth moment is expressed as
[0062]
[0063] Where f(·) is the state transfer equation, is the predicted attitude data of the UAV at the k-1th moment, is the control input of the UAV at the k-1th moment.
[0064] Furthermore, the predicted covariance of the UAV at the kth moment is expressed as
[0065] P k - =AP k-1 A T +Q
[0066] Where A is the Jacobian matrix of the state transfer matrix, which is related to the airspeed sensor measurement results, Q is the process noise covariance matrix, P k-1 is the covariance of the UAV at the k-1th moment.
[0067] Furthermore, the covariance of the UAV at the k-1th moment is expressed as
[0068]
[0069] Where I is the identity matrix.
[0070] In the present invention, the Kalman filter continuously iterates and updates the state estimation of the system by alternating prediction and update steps until it converges to the optimal solution or reaches a certain number of iterations. It estimates and predicts the state of the system through the interaction between the dynamic system model and the sensor measurement data. By extending the Kalman filter data fusion model, the odometer will output accurate position and speed information, which will be transmitted to the flight control system for more accurate flight control.
[0071] The present invention uses parallel processing to help the airspeed inertial odometer better understand the motion state of the object, providing more reliable data support for the attitude control and positioning of the UAV. By extending the Kalman filter data fusion model, the odometer will output accurate position and speed information.
[0072] The UAV airspeed sensing device of the present invention is realized by an airspeed sensor based on a hot wire, and is combined with the measurement of an inertial measurement unit (IMU). Data fusion is performed through a state estimation method of an extended Kalman filter to achieve online UAV speed and position perception, further solving the local positioning problem of UAVs in special environments such as closed space exploration and areas lacking satellite positioning, and improving the effect of flight control.
[0073] It will be appreciated that the local positioning problem includes that when performing specific missions such as search and rescue, agricultural monitoring or infrastructure inspection, the drone may need to perform delicate operations within a well-defined small area.
[0074] Compared with the prior art, the present invention has at least the following beneficial effects:
[0075] (1) The present invention designs the airspeed sensor unit according to the shape of the UAV, and provides the UAV with the ability to measure airspeed and position without destroying the shape or adding too much extra weight;
[0076] (2) The present invention designs a posture estimation unit to obtain accurate drone position and speed data, which is suitable for micro fixed-wing drones;
[0077] (3) The present invention realizes real-time communication with the flight control system and deploys the airspeed inertial odometer online to achieve the effect of real-time measurement. BRIEF DESCRIPTION OF THE DRAWINGS
[0078] The drawings are only for the purpose of illustrating particular embodiments and are not to be construed as limiting the invention.
[0079] Figure 1 This is a schematic diagram of the application of the UAV airspeed sensing device on the UAV in an embodiment of the present invention;
[0080] Figure 2Schematic diagram of the hardware framework of the UAV airspeed sensing device in an embodiment of the present invention;
[0081] Figure 3 It is a schematic diagram of the calculation method framework of the UAV airspeed sensing device in an embodiment of the present invention;
[0082] Figure 4 A schematic diagram of a micro UAV equipped with an airspeed sensor unit and an inertial measurement unit (IMU) in an embodiment of the present invention;
[0083] Figure 5 It is a schematic diagram of arranging thermistors of an airspeed sensor around a heater in an embodiment of the present invention;
[0084] Figure 6 Schematic diagram of a sampling module in an embodiment of the present invention.
[0085] Reference numerals:
[0086] 1. Flexible substrate, 2. Thermistor unit, 3. Conductive channel, 4. Flexible wire, 5. Packaging interface, 6. Data transmission interface, 7. Thermistor pair, 8. Heater, 9. Airspeed sensor unit 1, 10. Airspeed sensor unit 2, 11. Inertial measurement unit, 12-1. Thermistor interface 1, 12-2 Thermistor interface 2, 13. Data transmission interface, 14. Flight controller DETAILED DESCRIPTION
[0087] In order to more clearly understand the above-mentioned purpose, features and advantages of the present invention, the present invention is further described in detail below in conjunction with the accompanying drawings and specific embodiments. It should be noted that, in the absence of conflict, the embodiments of the present invention and the features in the embodiments can be combined with each other. In addition, the present invention can also be implemented in other ways different from those described herein, and therefore, the protection scope of the present invention is not limited by the specific embodiments disclosed below.
[0088] A specific embodiment of the present invention, as Figure 1-6 , discloses an airspeed sensing device and a flight control method for a UAV. In order to illustrate the effectiveness of the method proposed by the present invention, the above technical solution of the present invention is described in detail through a specific embodiment below. The specific implementation steps are as follows:
[0089] The present invention provides an airspeed sensing device for a drone, comprising: an airspeed sensor unit 1 9, an airspeed sensor unit 2 10, an inertial measurement unit 11 and a data fusion estimation module;
[0090] The airspeed sensor unit 1 9 and the airspeed sensor unit 2 10 are connected to the data fusion estimation module via wires;
[0091] The inertial measurement unit 11 is connected to the data fusion estimation module; the inertial measurement unit is used to collect dynamic motion information of the drone and obtain acceleration and angular velocity information related to the drone's attitude.
[0092] The airspeed sensor unit 1 9 and the airspeed sensor unit 2 10 are respectively arranged on two wings of the UAV, and are respectively used to generate temperature differences of multiple thermistors, and the three-dimensional airspeed of the UAV is obtained through the temperature differences of the multiple thermistors;
[0093] Preferably, the UAV is a micro fixed-wing UAV;
[0094] Preferably, the airspeed sensor unit 9 comprises: a thermistor unit 2, a protective layer 1 and a flexible substrate 1;
[0095] The protective layer 1 is connected to the flexible substrate 1 and is arranged on the outer side of the wing of the UAV;
[0096] The thermistor unit 1 2 encapsulates a plurality of thermistor pairs;
[0097] The airspeed sensor unit 9 further includes a heater 8; the thermistor unit 2 and the heater 8 are arranged on the protective layer 1;
[0098] The heater 1 8 is arranged at the center of the thermistor unit 1 2;
[0099] Each thermistor pair includes two thermistors; the two thermistors of each thermistor pair are symmetrically arranged with the heater 8 as the center;
[0100] Further, with the heater 1 8 as the center, multiple groups of thermistor pairs 7 are arranged from the inside to the outside on the periphery of the heater 1 8; the two thermistors in the thermistor pairs 7 are symmetrically arranged on the periphery of the heater 1 8 with the heater 1 8 as the center;
[0101] Exemplarily, the multiple thermistors are arranged in a cross shape with heater 8 as the center, and are symmetrically arranged in pairs on the periphery of the heater in an orthogonal distribution; the multiple groups of thermistor pairs are arranged on the outside of the wing of the UAV through a protective layer 1 and a flexible substrate 1 to measure the airspeed in two orthogonal directions to obtain the three-dimensional airspeed of the UAV.
[0102] The airspeed sensor unit 2 10 comprises: a thermistor unit 2, a heater 2, a protective layer 2 and a flexible substrate 2; the configuration of the airspeed sensor unit 2 is consistent with that of the airspeed sensor unit 1.
[0103] It is understandable that the flexible substrate 1 is a flexible printed circuit (FPC) circuit;
[0104] The thermistor is manufactured by a micron-scale process and packaged on a flexible printed circuit (FPC) line.
[0105] In the technical solution of the present invention, multiple thermistors are arranged in a cross shape on the outside of the wings of the UAV, and two orthogonal directions are measured simultaneously to accurately measure the three-dimensional wind speed. While maintaining the integrity of the UAV's appearance, it provides the ability to accurately measure the direction and size of the airspeed.
[0106] The present invention uses multiple ultra-thin thermistors as the core components of each wind speed sensor unit, which continuously generate heat in the wind field and produce a temperature difference between the upstream and downstream of the wind flow. The temperature difference reflects thermal convection, offsets the influence of environmental heat, and further infers the directionality of air flow, reflecting the change of airspeed.
[0107] Preferably, the data fusion estimation module comprises: an analog and / or digital conversion unit, a processor and a data storage module;
[0108] The processor is connected to the analog and / or digital conversion unit and the data storage module respectively;
[0109] The multiple thermistors generate a temperature difference, the temperature difference is converted into voltage data by an analog and / or digital conversion unit, and the voltage data is transmitted to a processor;
[0110] Preferably, the inertial measurement unit 11 includes a three-axis gyroscope, a three-axis accelerometer and a three-axis magnetometer; the inertial measurement unit 11 is a sensing element, which is used to output measurement information;
[0111] The three-axis gyroscope, the three-axis accelerometer and the three-axis magnetometer are connected in parallel; the three-axis accelerometer is connected to the processor;
[0112] The three-axis gyroscope, three-axis accelerometer and three-axis magnetometer output the acceleration and angular velocity of the drone and transmit them to the processor; as shown in the attached Figure 3 As shown, the voltage data and the acceleration and angular velocity of the drone are combined through a data fusion algorithm to obtain the position of the drone.
[0113] Preferably, the UAV airspeed sensing device further comprises: a sampling module;
[0114] The sampling module includes a thermistor interface 1 12-1, a thermistor interface 2 12-2 and a data transmission interface 13;
[0115] The thermistor interface 1 12-2 is connected to the airspeed sensor unit 1 and the analog and / or digital conversion unit respectively; the thermistor interface 2 12-2 is connected to the airspeed sensor unit 2 and the analog and / or digital conversion unit respectively;
[0116] The data transmission interface 13 is connected to the three-axis gyroscope, the three-axis accelerometer and the three-axis magnetometer;
[0117] Further, the thermistor interface 1 12 - 1 and the thermistor interface 2 12 - 2 are used to transmit the voltage data of the airspeed sensor unit 1 and the airspeed sensor unit 2 to the data fusion estimation module;
[0118] The data transmission interface 13 is used to transmit the inertial measurement information such as the acceleration and angular velocity of the UAV to the data fusion estimation module.
[0119] Furthermore, the processor is a filter data fusion model;
[0120] Furthermore, the filter data fusion model includes: filter one, neural network, extended filter one, filter two, and extended filter two;
[0121] The voltage data is transmitted to the neural network through filter 1 to obtain the three-dimensional airspeed of the drone;
[0122] The inertial measurement unit outputs the acceleration and angular velocity of the drone; then transmits it to the extended filter 1 through the filter 2 to obtain the attitude data;
[0123] The acceleration and angular velocity of the drone are transmitted to the extended filter 1 through the filter 2 to obtain attitude data;
[0124] The three-dimensional airspeed and attitude data of the UAV are input into the second expansion filter to obtain the position data and speed data of the UAV;
[0125] Furthermore, the filter data fusion model is an extended Kalman filter data fusion model;
[0126] Furthermore, the extended filter 1 and the extended filter 2 are both extended Kalman filters.
[0127] Furthermore, the data fusion estimation module also includes a sampling module;
[0128] The airspeed sensor units of the present invention are distributed on the leading edge and outer section of the wing, thereby minimizing fuselage shielding and interference and improving measurement accuracy.
[0129] The airspeed sensor unit of the present invention uses an integrated circuit chip (single-chip microcomputer) to connect the acquisition circuit in the integrated circuit chip and the flight controller 14 through a serial interface to establish real-time communication for transmitting data of the airspeed sensor unit; a storage log chip is also provided for separately analyzing the data from the sampling circuit after the flight mission is completed; a neural network is used to establish an airspeed calculation agent model through the voltage data transmitted by the airspeed sensor unit and the actual vector airspeed data measured in the motion capture, and the model is simplified and deployed in the processor to realize online airspeed data measurement, and further realize position and speed calculation and flight control.
[0130] Another object of the present invention is to provide a flight control method for an airspeed sensing device of a drone, comprising:
[0131] Based on the airspeed sensor unit 1 9 and the airspeed sensor unit 2 10, voltage data at the current moment is obtained;
[0132] Input the voltage data at the current moment into the filter 1 and the neural network of the data fusion estimation module to obtain the corresponding airspeed data;
[0133] The acceleration and angular velocity of the drone at the current moment are obtained based on the inertial measurement unit 11;
[0134] The acceleration and angular velocity of the drone at the current moment are input into the extended filter 1 through the filter 2 of the data fusion estimation module for fusion to obtain the attitude data at the current moment;
[0135] The airspeed data at the current moment and the attitude data at the current moment are input into the extended filter 2 of the data fusion estimation module for fusion to obtain the position data at the current moment.
[0136] The present invention adopts a parallel processing method to help the airspeed inertial odometer better understand the motion state of the object, and provide more reliable data support for the attitude control and positioning of the UAV.
[0137] Furthermore, the posture data is expressed as
[0138]
[0139] in, is the attitude data of the UAV at the kth moment, is the predicted attitude data of the UAV at the kth moment, K k is the Kalman gain at the kth moment, h is the measurement equation, describing the association between the airspeed sensor measurement and the drone state, z k It is the measurement data of the airspeed sensor unit at the kth moment, that is, the voltage data.
[0140] Furthermore, the Kalman gain expression at the kth moment is:
[0141]
[0142] in, is the prediction covariance at the kth moment, H is the Jacobian matrix of the observation matrix, and R is the measurement noise covariance matrix.
[0143] Furthermore, the predicted attitude data of the UAV at the kth moment is expressed as
[0144]
[0145] Where f(·) is the state transfer equation, is the predicted attitude data of the UAV at the k-1th moment,
[0146] is the control input of the UAV at the k-1th moment.
[0147] Furthermore, the predicted covariance of the UAV at the kth moment is expressed as
[0148] P k - =AP k-1 A T +Q
[0149] Where A is the Jacobian matrix of the state transfer matrix, which is related to the airspeed sensor measurement results, Q is the process noise covariance matrix, P k-1 is the covariance of the UAV at the k-1th moment.
[0150] Furthermore, the covariance of the UAV at the k-1th moment is expressed as
[0151]
[0152] Where I is the identity matrix.
[0153] In the present invention, the Kalman filter continuously iterates and updates the state estimation of the system by alternating prediction and update steps until it converges to the optimal solution or reaches a certain number of iterations. It estimates and predicts the state of the system through the interaction between the dynamic system model and the sensor measurement data. By extending the Kalman filter data fusion model, the odometer will output accurate position and speed information, which will be transmitted to the flight control system for more accurate flight control.
[0154] The present invention uses parallel processing to help the airspeed inertial odometer better understand the motion state of the object, providing more reliable data support for the attitude control and positioning of the UAV. By extending the Kalman filter data fusion model, the odometer will output accurate position and speed information.
[0155] The UAV airspeed sensing device of the present invention is realized by an airspeed sensor based on a hot wire, and is combined with the measurement of an inertial measurement unit (IMU). Data fusion is performed through a state estimation method of an extended Kalman filter to achieve online UAV speed and position perception, further solving the local positioning problem of UAVs in special environments such as closed space exploration and areas lacking satellite positioning, and improving the effect of flight control.
[0156] It will be appreciated that the local positioning problem includes that when performing specific missions such as search and rescue, agricultural monitoring or infrastructure inspection, the drone may need to perform delicate operations within a well-defined small area.
[0157] The above description is only a preferred specific implementation manner of the present invention, but the protection scope of the present invention is not limited thereto. Any changes or substitutions that can be easily conceived by any technician familiar with the technical field within the technical scope disclosed by the present invention should be covered within the protection scope of the present invention.
Claims
1. A UAV airspeed sensing device, It is characterized in that include: An airspeed sensor unit 1 (9), an airspeed sensor unit 2 (10), an inertial measurement unit (11) and a data fusion estimation module; the airspeed sensor unit 1 (9) comprises a thermistor unit 1 (2); the airspeed sensor unit 1 (9), the airspeed sensor unit 2 (10) and the inertial measurement unit (11) are all connected to the data fusion estimation module; The inertial measurement unit (11) is used to collect dynamic motion information of the drone and obtain acceleration and angular velocity information related to the attitude of the drone; The airspeed sensor unit 1 (9) and the airspeed sensor unit 2 (10) are respectively arranged on the two wings of the drone, and are respectively used to generate a temperature difference of the thermistor, and the three-dimensional airspeed of the drone is obtained through the temperature difference of the thermistor.
2. The drone airspeed sensing device according to claim 1, It is characterized in that The airspeed sensor unit 1 (9) comprises a protective layer 1 and a flexible substrate 1 (1); The protective layer 1 is connected to the flexible substrate 1 (1) and is arranged on the outside of the wing of the drone; the thermistor unit 1 (2) is arranged on the protective layer 1; The thermistor unit 1 (2) encapsulates a plurality of thermistor pairs (7).
3. The drone airspeed sensing device according to claim 2, It is characterized in that The airspeed sensor unit 1 (9) further comprises a heater 1 (8); The heater 1 (8) is arranged on the protective layer 1; The heater one (8) is arranged at the center position of the thermistor unit one (2).
4. The drone airspeed sensing device according to claim 1, It is characterized in that The data fusion estimation module includes: an analog and / or digital conversion unit, a processor and a data storage module; the processor is connected to the analog and / or digital conversion unit and the data storage module respectively; the multiple thermistors generate a temperature difference, the temperature difference is obtained through the analog and / or digital conversion unit to obtain voltage data, and the voltage data is transmitted to the processor.
5. The drone airspeed sensing device according to claim 4, It is characterized in that The inertial measurement unit (11) comprises a three-axis gyroscope, a three-axis accelerometer and a three-axis magnetometer; The three-axis gyroscope, the three-axis accelerometer and the three-axis magnetometer are respectively connected to the data fusion estimation module; The three-axis gyroscope, three-axis accelerometer and three-axis magnetometer output the acceleration and angular velocity of the drone and transmit them to the processor.
6. The drone airspeed sensing device according to claim 4, It is characterized in that The processor is a filter data fusion model; the filter data fusion model includes: filter one, neural network, extended filter one, filter two and extended filter two; The voltage data is transmitted to the neural network through filter 1 to obtain the three-dimensional airspeed of the drone; The inertial measurement unit outputs the acceleration and angular velocity of the drone; then transmits it to the extended filter 1 through the filter 2 to obtain the attitude data; The three-dimensional airspeed and attitude data of the UAV are input into the second expansion filter to obtain the position data and speed data of the UAV.
7. The drone airspeed sensing device according to claim 6, It is characterized in that The extended filter 1 and the extended filter 2 are both extended Kalman filters.
8. The drone airspeed sensing device according to claim 5, It is characterized in that The UAV airspeed sensing device also includes a sampling module; The sampling module comprises a thermistor interface 1 (12-1), a thermistor interface 2 (12-2) and a data transmission interface (13); The thermistor interface 1 (12-2) is connected to the airspeed sensor unit 1 (9) and the analog and / or digital conversion unit respectively; the thermistor interface 2 (12-2) is connected to the airspeed sensor unit 2 (10) and the analog and / or digital conversion unit respectively; The data transmission interface (13) is connected to the three-axis gyroscope, the three-axis accelerometer and the three-axis magnetometer.
9. The flight control method of the UAV airspeed sensing device according to any one of claims 1 to 8, It is characterized in that include: Acquiring voltage data based on airspeed sensor unit one (9) and airspeed sensor unit two (10); The voltage data is input into the filter 1 and the neural network of the data fusion estimation module to obtain the corresponding airspeed data; Obtaining the acceleration and angular velocity of the drone based on an inertial measurement unit (11); The acceleration and angular velocity of the drone are input into the extended filter 1 through the filter 2 of the data fusion estimation module to obtain the attitude data; The airspeed data and attitude data are input into the extended filter 2 of the data fusion estimation module for fusion to obtain the position data.
10. The flight control method of the drone airspeed sensing device according to claim 9, It is characterized in that The expression of the posture data is: in, is the attitude data of the UAV at the kth moment, is the predicted attitude data of the UAV at the kth moment, K k is the Kalman gain at the kth moment, h is the measurement equation; z k is the measurement data of the airspeed sensor unit at the kth moment.
Citation Information
Patent Citations
Low-altitude autonomous navigation system for rotary-wing unmanned plane
CN105094138A
Multi-information-fused real-time wind speed estimation method for multi-rotor aircraft
CN106885918A
Wind velocity and direction sensor based on octagonal thermistor structure and preparation method of wind velocity and direction sensor
CN108226568A
Combined airspeed and inertial data for rotorcraft longitudinal control
CN108628339A
Attitude and position determination method for multi-rotor unmanned aerial vehicle
CN110081878A
