CN109541963B - Unmanned aerial vehicle wind measurement modeling method based on sideslip angle information - Google Patents
Unmanned aerial vehicle wind measurement modeling method based on sideslip angle information Download PDFInfo
- Publication number
- CN109541963B CN109541963B CN201811337127.7A CN201811337127A CN109541963B CN 109541963 B CN109541963 B CN 109541963B CN 201811337127 A CN201811337127 A CN 201811337127A CN 109541963 B CN109541963 B CN 109541963B
- Authority
- CN
- China
- Prior art keywords
- aerial vehicle
- unmanned aerial
- sideslip angle
- angle
- wind
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Active
Links
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B17/00—Systems involving the use of models or simulators of said systems
- G05B17/02—Systems involving the use of models or simulators of said systems electric
Abstract
The invention is suitable for the field of atmospheric science, and provides an unmanned aerial vehicle wind measurement modeling method based on sideslip angle information, which comprises the following steps: establishing a horizontal side open-loop control model of the unmanned aerial vehicle; establishing a horizontal and lateral closed-loop navigation model of the unmanned aerial vehicle; establishing a relation model between actual measurement and sideslip angle; and establishing a wind field estimation model by utilizing the vector triangular relation of wind speed, ground speed and airspeed. According to the method provided by the invention, a sideslip angle sensor is not required to be installed, the wind field estimation model is perfected by establishing the unmanned aerial vehicle sideslip angle estimation model, the wind field estimation accuracy is improved, and the method is low in cost, simple and feasible. In addition, the method has the advantages of large wind measuring range and high frequency, can be used for measuring real-time continuous wind field information in larger areas including areas where people are not easy to reach and in severe weather, and has higher engineering application value.
Description
Technical Field
The invention belongs to the field of atmospheric science, and relates to an unmanned aerial vehicle wind measurement modeling method based on sideslip angle information.
Background
The wind detection has important significance for knowing the atmospheric motion condition and improving the accuracy of weather forecast, and is an important means for researching global climate change. The current wind measuring and estimating methods include anemometry by an anemometer, anemometry by an balloon method, radar anemometry and unmanned aerial vehicle anemometry. The anemometry of the anemometer is usually used for measuring wind on the ground, so that only near-ground wind field information can be obtained; the balloon method is used for measuring wind energy to obtain wind field information of different height layers from the ground to the high altitude, the detection precision and the detection height are high, but the detection cost is high, the detection area is small, a large number of balloons are needed if large-range wind field information is obtained, and the economy is low; the radar wind measurement is suitable for researching wind field information of specific height of a specific area, has high detection precision, is easily influenced by weather and has high manufacturing cost. Along with the development of unmanned aerial vehicle technique, unmanned aerial vehicle has advantages such as the detection area is big, the time of endurance is long, the continuity is good, the cost is relatively lower, environmental suitability is high, the use is nimble convenient, unmanned aerial vehicle anemometry has obtained wide application increasingly.
The unmanned aerial vehicle wind measurement method can be divided into a horizontal airspeed return-to-zero method, an analytic wind measurement method, a dead reckoning method and a pitot-static pressure tube wind measurement method in terms of measurement principle. The documents of the invention, namely the research on unmanned aerial vehicle anemometry technology (sensor world, 2014) and the invention application (patent application No. 201711064897.4 and application date 2017.11.02) named as a method for calculating wind speed and wind direction based on flight parameters, analyze an airborne anemometry means and the prior related background technology for measuring wind speed and wind direction. Compared with the application and other related technologies, the unmanned aerial vehicle anemometry algorithm usually ignores the influence of the sideslip angle, but the sideslip angle always exists in the flight process of the airplane and is important information in airplane control and navigation, and the accuracy of control of each part is influenced by ignoring the sideslip angle information. At present, the measurement of the sideslip angle is mainly realized by a vane type sensor, a differential pressure tube type sensor and a zero differential pressure type sensor which are arranged on an airplane, and the sensors are influenced by local circulation related to icing and flight states and almost inevitably subjected to large zero point deviation. In addition, a sideslip angle sensor on the aircraft interferes with the airflow, so that the airflow field at different positions on the aircraft is different from an ideal flow field, and a local sideslip angle is generated. Therefore, even if a slip angle sensor is present, it is difficult to make an accurate measurement. In order to improve the wind measurement precision of the unmanned aerial vehicle, sideslip angle information is added into a wind measurement algorithm, and the establishment of a sideslip angle estimation model has very important practical significance in consideration of the characteristic that the sideslip angle is difficult to measure accurately. On the basis, a wind field estimation model based on sideslip angle information is established, and finally the purpose of improving a wind measurement algorithm is achieved.
Disclosure of Invention
In order to meet the urgent need of the unmanned aerial vehicle wind measurement on accurate sideslip angle information, the invention aims to provide an unmanned aerial vehicle wind measurement modeling method based on sideslip angle information, and aims to solve wind field information by establishing a sideslip angle estimation model and applying the sideslip angle estimation model to an unmanned aerial vehicle wind measurement estimation model and further adopting a vector triangle algorithm.
In order to achieve the purpose, the technical scheme adopted by the invention is as follows: an unmanned aerial vehicle anemometry modeling method based on sideslip angle information comprises the following steps:
step one, establishing a horizontal side open-loop control model of the unmanned aerial vehicle, specifically:
the state space equation for the transverse lateral open-loop control model can be expressed as the following form
In the formula (I), the compound is shown in the specification,in order to be a state quantity,in the form of a matrix of states,in order to input the matrix, the input matrix is,is an input quantity; beta is a sideslip angle, p is a roll angle rate, r is a yaw angle rate, and phi is a roll angle; y isb、Yp、Yr、Yph、Lb、Lp、Lx、Nb、Np、Nr、Yda、Ydr、Lda、Ldr、Nda、NdrThe parameters of the unmanned aerial vehicle in the transverse direction can be calculated according to the pneumatic parameters and the control parameters given by the unmanned aerial vehicle; deltaa、δrThe rudder deflection angle of the rudder and the ailerons;
the equation of the horizontal and lateral open-loop control model of the unmanned aerial vehicle is obtained by the formula (1)
Step two, establishing a horizontal and lateral closed-loop navigation model of the unmanned aerial vehicle, specifically:
given unmanned aerial vehicle heading psigThen, the flight control law can be given as
Where ψ is the heading angle, kp、kφ、kψ、kr、kφrCoefficients related to p, phi, psi, r, respectively;
substituting (3) into (2) to obtain
For the same reason have
The unmanned aerial vehicle transverse and lateral closed-loop navigation equation is obtained as
If the unmanned aerial vehicle is not provided with the sideslip angle sensor, the sideslip angle contained in the equation (9) can be indirectly obtained by measuring the roll angle information, and meanwhile, the measured sideslip angle information is filtered through a Kalman filter, so that the method can realize unbiased estimation of the sideslip angle and has higher theoretical precision;
step three, establishing a relation model between actual measurement and sideslip angle, specifically:
the airspeed component under the coordinate system of the body is
In the formula, VaIs airspeed, α is angle of attack, Vxb、Vyb、VzbIs airspeed component under the machine body system;
the airspeed component in the inertial frame is
In the formula, Vx、Vy、VzIs the airspeed component on the x, y and z axes under the inertial coordinate system,converting coordinates from a body coordinate system to an inertial coordinate system;
by expanding equation (12)
Step four, establishing a wind field estimation model by utilizing a vector triangle relation among wind speed, ground speed and airspeed, namely taking sideslip angle data as a variable in wind field estimation, and obtaining wind field information through a vector triangle together with the ground speed measured by a GPS, an attitude angle measured by a gyroscope and the airspeed measured by an airspeed tube;
the vector triangular relation between the wind speed and the airspeed and the ground speed of the aircraft obtains a wind speed expression as
In the formula (I), the compound is shown in the specification,in order to obtain the ground speed,in order to be the space velocity,is the wind speed;
the formula (14) can be specifically expressed as
In the formula, VDx、VDy、VDzIs the component of the wind speed on the x, y and z axes under the inertial coordinate system,calculated ground speed components for the GPS-based position measurements in the x, y, and z axes of the inertial frame.
The unmanned aerial vehicle anemometry modeling method based on sideslip angle information provided by the invention has the following beneficial effects:
(1) according to the method, a sideslip angle sensor is not required to be installed, the unmanned aerial vehicle sideslip angle estimation model is established, the wind field estimation model is perfected, the wind field estimation accuracy is improved, and the method is low in cost, simple and easy to implement;
(2) the method has the advantages of large wind measuring range and high frequency, can be used for measuring real-time continuous wind field information in larger areas including areas which are difficult to reach by human beings and severe weather, and has higher engineering application value.
Drawings
The invention is further described with reference to the following figures and detailed description.
FIG. 1 is a block diagram of a course-preserving model of an unmanned aerial vehicle;
FIG. 2 is a schematic diagram of a speed coordinate system and a body coordinate system;
FIG. 3 is a schematic diagram of an inertial coordinate system and a body coordinate system;
fig. 4 is a schematic view of a wind field vector triangle.
Detailed Description
In order to make the technical solution of the present invention more clearly understood, the present invention is further described in detail below with reference to the accompanying drawings and embodiments. It should be understood that the specific embodiments described herein are merely illustrative of the invention and are not intended to limit the invention.
The embodiments of the present invention will be described in further detail below with reference to the accompanying drawings.
Step one, establishing a horizontal side open-loop control model of the unmanned aerial vehicle. FIG. 1 is a block diagram of a fixed-wing drone heading maintenance model, in which the dotted line square frame ranges are a drone lateral open-loop control model. Can be expressed in the form of the following by the equation of state space
In the formula (I), the compound is shown in the specification,in order to be a state quantity,in the form of a matrix of states,in order to input the matrix, the input matrix is,is an input quantity; beta is a sideslip angle, p is a roll angle rate, r is a yaw angle rate, and phi is a roll angle; y isb、Yp、Yr、Yph、Lb、Lp、Lr、Nb、Np、Nr、Yda、Ydr、Lda、Ldr、Nda、NdrFor defining the lateral parameters of the unmanned planeThe number can be calculated according to the pneumatic parameters and the control parameters given by the unmanned aerial vehicle; deltaa、δrThe rudder deflection angle of the rudder and the ailerons;
the equation of the horizontal and lateral open-loop control model of the unmanned aerial vehicle is obtained by the formula (1)
Step two, establishing a horizontal and lateral closed-loop navigation model of the unmanned aerial vehicle, specifically:
given unmanned aerial vehicle heading angle psigThen, the flight control law can be given as
Where ψ is the heading angle, kp、kφ、kψ、kr、kφrCoefficients related to p, phi, psi, r, respectively;
substituting (3) into (2) to obtain
For the same reason have
The unmanned aerial vehicle transverse and lateral closed-loop navigation equation is obtained as
If the drone does not have a sideslip angle sensor, the sideslip angle contained in equation (9) can be indirectly obtained by measuring the roll angle information, while filtering the measured sideslip angle information through a Kalman filter. The method can realize unbiased estimation of the sideslip angle, and has higher theoretical precision;
and step three, establishing a relation model between actual measurement and sideslip angle. FIG. 2 is a schematic diagram of a speed coordinate system and a body coordinate system. According to FIG. 2, the airspeed component in the body coordinate system can be expressed as
In the formula, VaIs airspeed, α is angle of attack, Vxb、Vyb、VzbIs airspeed component under the machine body system;
FIG. 3 is a schematic diagram of an inertial coordinate system and a body coordinate system. According to FIG. 3, the airspeed component in the inertial frame may be expressed as
In the formula, Vx、Vy、VzIs the airspeed component on the x, y and z axes under the inertial coordinate system,converting coordinates from a body coordinate system to an inertial coordinate system;
in the formula (I), the compound is shown in the specification,theta is a pitch angle and theta is a pitch angle,is the track azimuth;
by expanding equation (12)
And step four, establishing a wind field estimation model by utilizing a vector triangle relation among wind speed, ground speed and airspeed, namely taking sideslip angle data as a variable in wind field estimation, and obtaining wind field information through a vector triangle together with the ground speed measured by a GPS, the attitude angle measured by a gyroscope and the airspeed measured by an airspeed head. FIG. 4 is a vector triangle diagram of wind speed, ground speed and airspeed. According to FIG. 4, the wind speed can be represented as
In the formula (I), the compound is shown in the specification,in order to obtain the ground speed,in order to be the space velocity,is the wind speed;
equation (14) can be expressed specifically as:
Claims (1)
1. An unmanned aerial vehicle anemometry modeling method based on sideslip angle information is characterized by comprising the following steps:
step one, establishing a horizontal side open-loop control model of the unmanned aerial vehicle, specifically:
the state space equation for the transverse lateral open-loop control model can be expressed as the following form
In the formula (I), the compound is shown in the specification,in order to be a state quantity,in the form of a matrix of states,in order to input the matrix, the input matrix is,is an input quantity; beta is a sideslip angle, p is a roll angle rate, r is a yaw angle rate, and phi is a roll angle; y isb、Yp、Yr、Yph、Lb、Lp、Lr、Nb、Np、Nr、Yda、Ydr、Lda、Ldr、Nda、NdrThe parameters of the unmanned aerial vehicle in the transverse direction can be calculated according to the pneumatic parameters and the control parameters given by the unmanned aerial vehicle; deltaa、δrThe rudder deflection angle of the rudder and the ailerons;
the equation of the horizontal and lateral open-loop control model of the unmanned aerial vehicle is obtained by the formula (1)
Step two, establishing a horizontal and lateral closed-loop navigation model of the unmanned aerial vehicle, specifically:
given unmanned aerial vehicle heading psigThen, the flight control law can be given as
Where ψ is the heading angle, kp、kφ、kψ、kr、kφrCoefficients related to p, phi, psi, r, respectively;
substituting (3) into (2) to obtain
For the same reason have
The unmanned aerial vehicle transverse and lateral closed-loop navigation equation is obtained as
If the unmanned aerial vehicle is not provided with the sideslip angle sensor, the sideslip angle contained in the equation (9) can be indirectly obtained by measuring the roll angle information, and meanwhile, the measured sideslip angle information is filtered through a Kalman filter, so that the method can realize unbiased estimation of the sideslip angle and has higher theoretical precision;
step three, establishing a relation model between actual measurement and sideslip angle, specifically:
the airspeed component under the coordinate system of the body is
In the formula, VaIs airspeed, α is angle of attack, Vxb、Vyb、VzbIs airspeed component under the coordinate system of the machine body;
the airspeed component in the inertial frame is
In the formula, Vx、Vy、VzIs the airspeed component on the x, y and z axes under the inertial coordinate system,converting coordinates from a body coordinate system to an inertial coordinate system;
by expanding equation (12)
Step four, establishing a wind field estimation model by utilizing a vector triangle relation among wind speed, ground speed and airspeed, namely taking sideslip angle data as a variable in wind field estimation, and obtaining wind field information through a vector triangle together with the ground speed measured by a GPS, an attitude angle measured by a gyroscope and the airspeed measured by an airspeed tube;
the vector triangular relation between the wind speed and the airspeed and the ground speed of the aircraft obtains a wind speed expression as
In the formula (I), the compound is shown in the specification,in order to obtain the ground speed,in order to be the space velocity,is the wind speed;
the formula (14) can be specifically expressed as
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201811337127.7A CN109541963B (en) | 2018-11-12 | 2018-11-12 | Unmanned aerial vehicle wind measurement modeling method based on sideslip angle information |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201811337127.7A CN109541963B (en) | 2018-11-12 | 2018-11-12 | Unmanned aerial vehicle wind measurement modeling method based on sideslip angle information |
Publications (2)
Publication Number | Publication Date |
---|---|
CN109541963A CN109541963A (en) | 2019-03-29 |
CN109541963B true CN109541963B (en) | 2021-06-25 |
Family
ID=65846954
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201811337127.7A Active CN109541963B (en) | 2018-11-12 | 2018-11-12 | Unmanned aerial vehicle wind measurement modeling method based on sideslip angle information |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN109541963B (en) |
Families Citing this family (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111693999B (en) * | 2020-05-27 | 2023-05-05 | 哈尔滨工程大学 | Multi-sensor fusion wind speed and direction estimation method based on radar wind measurement combination strategy |
CN112762960A (en) * | 2020-12-29 | 2021-05-07 | 中国航空工业集团公司西安飞机设计研究所 | Online calculation method for wind field of aircraft |
CN116776043B (en) * | 2023-08-17 | 2023-11-07 | 四川腾盾科技有限公司 | Method for predicting motion trail of parachute landing nacelle of large unmanned aerial vehicle |
Citations (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101273273A (en) * | 2005-09-27 | 2008-09-24 | 空中客车法国公司 | System for monitoring anemobaroclinometric parameters for aircraft |
CN101321667A (en) * | 2005-12-06 | 2008-12-10 | 空中客车德国有限公司 | Method for reconstructing gusts and structural loads at aircraft, in particular passenger aircraft |
CN102073755A (en) * | 2010-11-10 | 2011-05-25 | 南京航空航天大学 | Motion control simulation method for near-space hypersonic aircraft |
CN103353623A (en) * | 2013-06-18 | 2013-10-16 | 沈阳创达技术交易市场有限公司 | Meteorological UAV (unmanned aerial vehicle) wind measuring instrument |
CN106680896A (en) * | 2016-12-14 | 2017-05-17 | 梁淑明 | Unmanned aerial vehicle upper-air meteorological detection system |
CN206569263U (en) * | 2016-12-21 | 2017-10-20 | 南京信息工程大学 | One kind determines the wind direction wind speed dedicated unmanned machine |
CN107918128A (en) * | 2017-10-31 | 2018-04-17 | 中国科学院国家空间科学中心 | A kind of high-precision near space real-time in-situ surveys the devices and methods therefor of wind |
CN107942720A (en) * | 2017-09-30 | 2018-04-20 | 成都飞机工业(集团)有限责任公司 | A kind of online flight Simulation System of portable type ground |
CN108152529A (en) * | 2017-11-02 | 2018-06-12 | 成都飞机工业(集团)有限责任公司 | A kind of method based on flight parameter calculation of wind speed and wind direction |
CN207894441U (en) * | 2018-02-27 | 2018-09-21 | 成都凯天电子股份有限公司 | Air data system ground transaucer test equipment |
-
2018
- 2018-11-12 CN CN201811337127.7A patent/CN109541963B/en active Active
Patent Citations (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101273273A (en) * | 2005-09-27 | 2008-09-24 | 空中客车法国公司 | System for monitoring anemobaroclinometric parameters for aircraft |
CN101321667A (en) * | 2005-12-06 | 2008-12-10 | 空中客车德国有限公司 | Method for reconstructing gusts and structural loads at aircraft, in particular passenger aircraft |
CN102073755A (en) * | 2010-11-10 | 2011-05-25 | 南京航空航天大学 | Motion control simulation method for near-space hypersonic aircraft |
CN103353623A (en) * | 2013-06-18 | 2013-10-16 | 沈阳创达技术交易市场有限公司 | Meteorological UAV (unmanned aerial vehicle) wind measuring instrument |
CN106680896A (en) * | 2016-12-14 | 2017-05-17 | 梁淑明 | Unmanned aerial vehicle upper-air meteorological detection system |
CN206569263U (en) * | 2016-12-21 | 2017-10-20 | 南京信息工程大学 | One kind determines the wind direction wind speed dedicated unmanned machine |
CN107942720A (en) * | 2017-09-30 | 2018-04-20 | 成都飞机工业(集团)有限责任公司 | A kind of online flight Simulation System of portable type ground |
CN107918128A (en) * | 2017-10-31 | 2018-04-17 | 中国科学院国家空间科学中心 | A kind of high-precision near space real-time in-situ surveys the devices and methods therefor of wind |
CN108152529A (en) * | 2017-11-02 | 2018-06-12 | 成都飞机工业(集团)有限责任公司 | A kind of method based on flight parameter calculation of wind speed and wind direction |
CN207894441U (en) * | 2018-02-27 | 2018-09-21 | 成都凯天电子股份有限公司 | Air data system ground transaucer test equipment |
Non-Patent Citations (3)
Title |
---|
Enhancing Model-Free Wind Estimation for Fixed-Wing UAV;Georg Balmer等;《2018 International Conference on Unmanned Aircraft Systems》;20180903;第1242-1247页 * |
基于转动状态的气象无人机测风方法;王彦杰等;《气象科学》;20111031;第31卷(第5期);第576-581段 * |
飞机测风技术方法探讨;魏强等;《第26届中国气象学会年会第三届气象综合探测技术研讨会分会场论文集》;20091014;第1-8页 * |
Also Published As
Publication number | Publication date |
---|---|
CN109541963A (en) | 2019-03-29 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106643737B (en) | Four-rotor aircraft attitude calculation method in wind power interference environment | |
CN108152529A (en) | A kind of method based on flight parameter calculation of wind speed and wind direction | |
CN102809377B (en) | Aircraft inertia/pneumatic model Combinated navigation method | |
CN109541963B (en) | Unmanned aerial vehicle wind measurement modeling method based on sideslip angle information | |
CN106527491B (en) | A kind of fixed-wing unmanned aerial vehicle control system and horizontal crabbing method for controlling trajectory | |
CN104061899B (en) | A kind of vehicle side inclination angle based on Kalman filtering and angle of pitch method of estimation | |
CN102608596B (en) | Information fusion method for airborne inertia/Doppler radar integrated navigation system | |
CN102520726A (en) | Estimation method of atmosphere angle of attack and angle of sideslip in high-angle-of-attack flight status | |
CN105094138A (en) | Low-altitude autonomous navigation system for rotary-wing unmanned plane | |
CN103994748B (en) | A kind of method adopting flight and wind tunnel test data estimation unmanned plane trim angle of attack | |
CN113819914A (en) | Map construction method and device | |
Thomas et al. | Measurement of turbulent water vapor fluxes using a lightweight unmanned aerial vehicle system | |
CN106403940B (en) | A kind of unmanned plane during flying navigation system elevation information fusion method of anti-atmospheric parameter drift | |
CN106885918B (en) | A kind of real-time wind estimation method of multi-information fusion towards multi-rotor aerocraft | |
CN102607639A (en) | BP (Back Propagation) neural network-based method for measuring air data in flight state with high angle of attack | |
CN202939489U (en) | Multi-rotor autobalance flight controller | |
CN102175882B (en) | Natural-landmark-based unmanned helicopter visual speed measurement method | |
CN104459193A (en) | Crosswind information estimation method based on unmanned aerial vehicle crabbing method | |
CN103837151A (en) | Pneumatic model-assisted navigation method for four-rotor-wing air vehicle | |
CN108592911B (en) | Four-rotor aircraft dynamic model/airborne sensor combined navigation method | |
CN103453907B (en) | Based on the planet approach section Navigation method of stratified atmosphere model | |
Larrabee et al. | Wind field estimation in UAV formation flight | |
CN103033197B (en) | Method for correcting zero drift of MEMS gyroscope | |
CN104808673A (en) | Height estimation method for four-rotor aircraft based on Kalman filtering | |
CN107063248A (en) | Kinetic model based on rotor rotating speed aids in the air navigation aid of inertial navigation |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |