CN105912019A - Powered parafoil system's air-drop wind field identification method - Google Patents
Powered parafoil system's air-drop wind field identification method Download PDFInfo
- Publication number
- CN105912019A CN105912019A CN201610281210.1A CN201610281210A CN105912019A CN 105912019 A CN105912019 A CN 105912019A CN 201610281210 A CN201610281210 A CN 201610281210A CN 105912019 A CN105912019 A CN 105912019A
- Authority
- CN
- China
- Prior art keywords
- wind field
- wind
- parafoil system
- identification
- speed
- 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.)
- Pending
Links
- IBSREHMXUMOFBB-JFUDTMANSA-N 5u8924t11h Chemical compound O1[C@@H](C)[C@H](O)[C@@H](OC)C[C@@H]1O[C@@H]1[C@@H](OC)C[C@H](O[C@@H]2C(=C/C[C@@H]3C[C@@H](C[C@@]4(O3)C=C[C@H](C)[C@@H](C(C)C)O4)OC(=O)[C@@H]3C=C(C)[C@@H](O)[C@H]4OC\C([C@@]34O)=C/C=C/[C@@H]2C)/C)O[C@H]1C.C1=C[C@H](C)[C@@H]([C@@H](C)CC)O[C@]11O[C@H](C\C=C(C)\[C@@H](O[C@@H]2O[C@@H](C)[C@H](O[C@@H]3O[C@@H](C)[C@H](O)[C@@H](OC)C3)[C@@H](OC)C2)[C@@H](C)\C=C\C=C/2[C@]3([C@H](C(=O)O4)C=C(C)[C@@H](O)[C@H]3OC\2)O)C[C@H]4C1 IBSREHMXUMOFBB-JFUDTMANSA-N 0.000 title claims abstract description 168
- 238000000034 method Methods 0.000 title claims abstract description 51
- 230000008569 process Effects 0.000 claims abstract description 14
- 238000005259 measurement Methods 0.000 claims description 9
- 238000005070 sampling Methods 0.000 claims description 7
- XAGFODPZIPBFFR-UHFFFAOYSA-N aluminium Chemical compound [Al] XAGFODPZIPBFFR-UHFFFAOYSA-N 0.000 claims 1
- 229910052782 aluminium Inorganic materials 0.000 claims 1
- 239000011888 foil Substances 0.000 claims 1
- 238000003672 processing method Methods 0.000 claims 1
- 238000004422 calculation algorithm Methods 0.000 abstract description 8
- 241000287127 Passeridae Species 0.000 abstract description 7
- 230000008859 change Effects 0.000 abstract description 6
- 238000004088 simulation Methods 0.000 description 11
- 230000009471 action Effects 0.000 description 7
- 238000001914 filtration Methods 0.000 description 6
- 230000000694 effects Effects 0.000 description 5
- 239000011159 matrix material Substances 0.000 description 4
- 238000005516 engineering process Methods 0.000 description 3
- 230000006641 stabilisation Effects 0.000 description 3
- 238000011105 stabilization Methods 0.000 description 3
- 230000008901 benefit Effects 0.000 description 2
- 238000004364 calculation method Methods 0.000 description 2
- 238000011161 development Methods 0.000 description 2
- 239000000463 material Substances 0.000 description 2
- 238000005457 optimization Methods 0.000 description 2
- 238000012545 processing Methods 0.000 description 2
- 238000011160 research Methods 0.000 description 2
- 230000007704 transition Effects 0.000 description 2
- 101000802640 Homo sapiens Lactosylceramide 4-alpha-galactosyltransferase Proteins 0.000 description 1
- 102100035838 Lactosylceramide 4-alpha-galactosyltransferase Human genes 0.000 description 1
- 238000004458 analytical method Methods 0.000 description 1
- 230000007423 decrease Effects 0.000 description 1
- 230000003247 decreasing effect Effects 0.000 description 1
- 238000009795 derivation Methods 0.000 description 1
- 230000001066 destructive effect Effects 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 238000012544 monitoring process Methods 0.000 description 1
- 230000010355 oscillation Effects 0.000 description 1
- 230000008092 positive effect Effects 0.000 description 1
- 238000007781 pre-processing Methods 0.000 description 1
- 238000011084 recovery Methods 0.000 description 1
- 230000035939 shock Effects 0.000 description 1
- 230000009466 transformation Effects 0.000 description 1
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/10—Simultaneous control of position or course in three dimensions
- G05D1/101—Simultaneous control of position or course in three dimensions specially adapted for aircraft
- G05D1/105—Simultaneous control of position or course in three dimensions specially adapted for aircraft specially adapted for unpowered flight, e.g. glider, parachuting, forced landing
Landscapes
- Engineering & Computer Science (AREA)
- Aviation & Aerospace Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Indicating Or Recording The Presence, Absence, Or Direction Of Movement (AREA)
Abstract
本发明提出了一种动力翼伞系统空投风场的辨识方法,能够在动力翼伞系统的飞行过程中动态辨识所处风场的风速和风向,为动力翼伞系统的轨迹控制和雀降操作提供必要的参考信息。风场辨识过程分为三步。第一步,通过GPS定位模块获得动力翼伞系统的位置信息,根据动力翼伞系统的位置变化计算动力翼伞系统飞行速度的大小和方向。第二步,利用卡尔曼滤波算法对动力翼伞系统的飞行速度进行滤波处理,获得准确的速度信息。第三步,引入递推最小二乘法在线更新风场辨识结果。
The present invention proposes an identification method for the air-dropped wind field of the powered parafoil system, which can dynamically identify the wind speed and wind direction of the wind field where the powered parafoil system is in the flight process, and provides trajectory control and sparrow landing operation for the powered parafoil system. Provide the necessary reference information. The wind field identification process is divided into three steps. The first step is to obtain the position information of the powered parafoil system through the GPS positioning module, and calculate the flight speed and direction of the powered parafoil system according to the position change of the powered parafoil system. In the second step, the Kalman filter algorithm is used to filter the flight speed of the parafoil system to obtain accurate speed information. The third step is to introduce the recursive least squares method to update the wind field identification results online.
Description
技术领域technical field
本发明属于无人航空器控制领域,涉及对动力翼伞系统飞行环境的风场信息的辨识方法。The invention belongs to the field of unmanned aircraft control, and relates to a method for identifying wind field information of the flight environment of a powered parafoil system.
背景技术Background technique
翼伞是一种从传统圆形降落伞演变而来的特种降落伞,从产生至今已有50多年的历史。翼伞的特点是具有可控性、滑翔性、安全性和大载荷比,能够通过操纵伞绳实现转弯动作,控制翼伞的飞行方向。随着科学技术的发展和军事战略思想的转变,精确空投和“定点无损”着陆在军事、航空航天等领域的应用越来越广泛。在现代化战争中,地面作战部队可以通过空投实现武器、弹药、给养的及时补充,方便高效;在发生重大自然灾害时,通过空投的方式可以第一时间将救灾物资和设备运输到灾害中心,完成紧急救援任务;在航天事业中,航天飞船、卫星、导弹等设备的安全回收可以节省资源,减少太空垃圾;此外,在民用领域中,翼伞也用于运动、巡航、观光等。翼伞弥补了传统空投技术准确性、安全性不足的缺点,能够通过操纵控制和雀降技术实现精确空投和平稳降落,保证负载以较小的速度着陆,减轻冲击和震荡。The parafoil is a special parachute evolved from the traditional round parachute. It has a history of more than 50 years since its creation. The parafoil is characterized by controllability, gliding, safety and large load ratio. It can realize the turning action by manipulating the parachute and control the flight direction of the parafoil. With the development of science and technology and the transformation of military strategic thinking, precise airdrop and "fixed-point non-destructive" landing are more and more widely used in military, aerospace and other fields. In modern warfare, ground combat troops can replenish weapons, ammunition, and supplies in a timely manner through airdrops, which is convenient and efficient; in the event of major natural disasters, the relief materials and equipment can be transported to the disaster center as soon as possible by airdrops, completing Emergency rescue missions; in the aerospace industry, the safe recovery of spacecraft, satellites, missiles and other equipment can save resources and reduce space junk; in addition, in the civilian field, parafoils are also used for sports, cruises, sightseeing, etc. The parafoil makes up for the lack of accuracy and safety of traditional airdrop technology. It can achieve precise airdrop and stable landing through manipulation control and sparrow drop technology, ensuring that the load lands at a lower speed and reduces shock and vibration.
动力翼伞系统在普通翼伞系统的负载上增加了推力设备,不仅继承了翼伞的所有特点,而且能够弥补空投高度不足带来的空投误差,扩大了翼伞的应用范围。例如在巡航应用中,动力翼伞系统与固定翼无人机、四旋翼等飞行器相比具有速度低、性价比高、安全性高、续航时间长和抗干扰能力强的优势,因此具有更广阔的应用前景。The powered parafoil system adds thrust equipment to the load of the ordinary parafoil system, which not only inherits all the characteristics of the parafoil, but also can make up for the airdrop error caused by the lack of airdrop height, expanding the application range of the parafoil. For example, in cruising applications, the powered parafoil system has the advantages of low speed, high cost performance, high safety, long battery life and strong anti-interference ability compared with fixed-wing UAVs and quadrotors, so it has a wider range of applications. Application prospect.
由于翼伞本身材料的轻便性,在充气后飞行的过程中翼伞会受到风场较强的干扰作用。动力翼伞系统在执行巡航等任务进行轨迹跟踪时,对已知风速风向进行一定的补偿策略可以提高系统的跟踪精度,增加系统的稳定性。在雀降技术中,实施雀降操作首先要将翼伞系统逆风对准目标点,并在短时间内下拉翼伞后缘襟翼到最大下偏量,以瞬间增大翼伞的升阻力系数,快速降低翼伞系统的速度,保护负载平稳着陆。基于以上原因,风场辨识的研究对翼伞空投系统和动力翼伞系统具有实际意义。Due to the portability of the material of the parafoil itself, the parafoil will be strongly disturbed by the wind field during the flight process after inflation. When the powered parafoil system is performing cruising and other tasks for trajectory tracking, a certain compensation strategy for the known wind speed and direction can improve the tracking accuracy of the system and increase the stability of the system. In the sparrow drop technique, the first thing to do is to align the parafoil system against the wind at the target point, and pull down the trailing edge flap of the parafoil to the maximum deflection in a short time, so as to instantly increase the lift-drag coefficient of the parafoil , quickly reduce the speed of the parafoil system, and protect the load for a smooth landing. Based on the above reasons, the research on wind field identification has practical significance for parafoil airdrop system and powered parafoil system.
目前对风场的风速风向获取方法主要分为设备测量和模型预测两种。后者主要用于天气预报和风力发电场等平均风速风向的研究,例如对风力发电场的历史气象数据进行建模和分析,可以预测一段时间内的总体风向和风力情况,为风力发电机的部署和朝向提供指导,但该方法得到的平均风速风向不能满足动力翼伞系统归航和轨迹跟踪控制对实时风场信息的要求。相比之下设备测量具有较好的实时性。空速管是飞机等高速飞行器常用的测速器件,可以实现风速测量,但是对于速度较低的动力翼伞系统不适用,而且不能获得风向信息。国外提出的一种利用GPS和陀螺仪来测定翼伞系统所处环境风速风向的方法,该方法利用翼伞系统的动态特性以及翼伞系统对地飞行速度和偏航角来辨识风场的风速和风向。但翼伞系统的负载和翼伞本身是一种柔性连接,具有相对运动,陀螺仪所测的偏航角度与翼伞系统飞行方向具有一定的偏差,因此测量结果有较大的偏差,测量精度较差。At present, the methods for obtaining wind speed and direction in wind farms are mainly divided into two types: equipment measurement and model prediction. The latter is mainly used for weather forecasting and research on the average wind speed and direction of wind farms. For example, modeling and analyzing the historical meteorological data of wind farms can predict the overall wind direction and wind conditions for a period of time. However, the average wind speed and direction obtained by this method cannot meet the requirements of real-time wind field information for homing and trajectory tracking control of powered parafoil systems. In contrast, equipment measurement has better real-time performance. Pitot tubes are commonly used speed measuring devices for high-speed aircraft such as airplanes. They can measure wind speed, but they are not suitable for powered parafoil systems with low speeds, and wind direction information cannot be obtained. A method proposed by foreign countries using GPS and gyroscope to measure the wind speed and direction of the environment where the parafoil system is located. This method uses the dynamic characteristics of the parafoil system and the ground flight speed and yaw angle of the parafoil system to identify the wind speed of the wind field and wind direction. However, the load of the parafoil system and the parafoil itself are a kind of flexible connection, with relative motion, the yaw angle measured by the gyroscope has a certain deviation from the flight direction of the parafoil system, so the measurement results have a large deviation, and the measurement accuracy poor.
发明内容Contents of the invention
本发明的目的是提供一种根据GPS定位数据和动力翼伞系统动态特性进行在线风场辨识的方法,实现动力翼伞系统飞行过程中对风场的风速与风向的动态辨识,以实现高精度轨迹跟踪和雀降着陆。The purpose of the present invention is to provide a method for online wind field identification based on GPS positioning data and the dynamic characteristics of the powered parafoil system, so as to realize the dynamic identification of the wind speed and direction of the wind field during the flight of the powered parafoil system, so as to achieve high precision Trajectory tracking and sparrow landing.
为实现上述目的,本发明采用如下技术方案:To achieve the above object, the present invention adopts the following technical solutions:
动力翼伞空投风场的辨识方法,该方法包括以下步骤:An identification method for a powered parafoil airdrop wind field, the method comprising the following steps:
第1步、根据GPS定位数据计算当前动力翼伞系统的飞行速度。Step 1. Calculate the flight speed of the current powered parafoil system according to the GPS positioning data.
动力翼伞系统的实时飞行速度通过GPS定位数据计算获得。在动力翼伞飞行过程中,对GPS定位模块采集的位置定位数据进行实时记录,设连续两次GPS定位数据的经纬度为P1和P2,则此时动力翼伞系统的水平飞行速度为The real-time flight speed of the powered parafoil system is calculated through GPS positioning data. During the flight of the powered parafoil, the position positioning data collected by the GPS positioning module are recorded in real time, and the longitude and latitude of the GPS positioning data for two consecutive times are P 1 and P 2 , then the horizontal flight speed of the powered parafoil system at this time is
V=(P2-P1)·f (1)V=(P 2 -P 1 )·f (1)
式中V表示动力翼伞系统的水平飞行速度,包括经向、纬向两个方向的速度分量。f表示GPS定位模块的采样频率。In the formula, V represents the horizontal flight speed of the powered parafoil system, including the speed components in the meridian and latitudinal directions. f represents the sampling frequency of the GPS positioning module.
第2步、对动力翼伞系统的水平飞行速度进行滤波处理。Step 2, filtering the horizontal flight speed of the powered parafoil system.
GPS定位模块在运行中会因噪声等原因造成一定的定位误差,所以第1步中计算获得的动力翼伞系统水平飞行速度也包含误差信息,是一组包含噪声的测量序列。为了滤除噪声信号,得到更加真实的平滑速度信号,需要对获得的动力翼伞系统的水平飞行速度进行滤波处理。在滤波过程中,将动力翼伞系统的水平飞行速度V分为经向速度Vx和纬向速度Vy分别使用卡尔曼滤波器进行滤波处理。The GPS positioning module will cause certain positioning errors due to noise and other reasons during operation, so the horizontal flight speed of the powered parafoil system calculated in the first step also contains error information, which is a set of measurement sequences containing noise. In order to filter out the noise signal and obtain a more realistic smooth speed signal, it is necessary to filter the obtained horizontal flight speed of the powered parafoil system. In the filtering process, the horizontal flight velocity V of the powered parafoil system is divided into the meridional velocity V x and the latitudinal velocity V y , respectively, and the Kalman filter is used for filtering.
第3步、风场辨识Step 3, wind field identification
根据动力翼伞系统与空气的相对速度、动力翼伞系统与地面的相对速度和风速之间的矢量关系,对风场进行辨识。辨识结果为风场的风向以及风速在经向和纬向的速度分量。为实现风场辨识的实时性和稳定性,将带遗忘因子的最小二乘法引入风场辨识过程;通过递推最小二乘法辨识对风场的辨识结果进行在线更新。具体步骤包括:The wind field is identified according to the relative speed between the powered parafoil system and the air, the relative speed between the powered parafoil system and the ground, and the vector relationship between the wind speed. The identification results are the wind direction of the wind field and the velocity components of the wind speed in the meridional and latitudinal directions. In order to realize the real-time and stability of wind field identification, the least squares method with forgetting factor is introduced into the wind field identification process; the identification results of wind field are updated online through recursive least squares identification. Specific steps include:
1)根据动力翼伞系统的水平速度在经向和纬向速度分量的滤波结果计算动力翼伞系统滤波后的水平速度大小;1) Calculate the filtered horizontal velocity of the powered parafoil system according to the filtering results of the horizontal velocity of the powered parafoil system in the meridional and latitudinal velocity components;
2)通过动力翼伞系统的水平速度及其在经向和纬向的速度分量对风速和风向进行辨识;2) Identify the wind speed and wind direction through the horizontal speed of the powered parafoil system and its speed components in the longitudinal and latitudinal directions;
3)对风场辨识结果进行更新。3) Update the wind field identification results.
基于GPS定位数据的动力翼伞系统空投风场辨识方法不需要在原有系统上增加额外设备,只需要以GPS定位数据为基础,结合动力翼伞系统在风场中的动态特性,采用递推最小二乘法辨识风速在水平坐标系下各坐标轴的分量,对风场进行实时在线辨识,具有较好的经济性和实用性。The airdrop wind field identification method of powered parafoil system based on GPS positioning data does not need to add additional equipment to the original system, but only needs to use GPS positioning data as the basis, combined with the dynamic characteristics of powered parafoil system in the wind field, adopts the recursive minimum The quadratic method identifies the components of the wind speed on each coordinate axis in the horizontal coordinate system, and conducts real-time online identification of the wind field, which has good economy and practicability.
本发明方法的理论推导过程:Theoretical derivation process of the inventive method:
1、动力翼伞系统风场辨识原理1. Principle of wind field identification for powered parafoil system
动力翼伞系统在风场作用下,其相对地面运动速度会有所变化,根据动力翼伞系统的运动特性,将动力翼伞相对地面的飞行速度分解为风速和动力翼伞系统相对于空气速度的矢量和。如图1所示,动力翼伞系统相对地面的飞行速度是风速和动力翼伞系统相对空气速度的矢量和。Under the action of the wind field, the motion speed of the powered parafoil system relative to the ground will change. According to the motion characteristics of the powered parafoil system, the flying speed of the powered parafoil relative to the ground is decomposed into wind speed and the relative air speed of the powered parafoil system The vector sum of . As shown in Figure 1, the flight speed of the powered parafoil system relative to the ground is the vector sum of the wind speed and the relative air speed of the powered parafoil system.
图中Ψ表示欧拉偏航角,β表示侧滑角,V0表示动力翼伞系统相对于空气的速度,即空速,VW表示风速,V表示动力翼伞系统相对于大地的速度,即地速。地速是可由GPS定位模块测得的实际速度。从图1中可以看出,V0、VW和V组成一个速度矢量三角形。χ0、ΨW和χ分别是V0、VW和V与正北方向的夹角。In the figure, Ψ represents the Euler yaw angle, β represents the sideslip angle, V 0 represents the speed of the powered parafoil system relative to the air, that is, the airspeed, V W represents the wind speed, and V represents the speed of the powered parafoil system relative to the ground, That is ground speed. Ground speed is the actual speed that can be measured by the GPS positioning module. It can be seen from Figure 1 that V 0 , V W and V form a velocity vector triangle. χ 0 , Ψ W and χ are the angles between V 0 , V W and V and the true north direction, respectively.
根据动力翼伞的运动特性,可以假定风速和翼伞系统的空速保持不变,由图中的矢量关系可得:According to the motion characteristics of the powered parafoil, it can be assumed that the wind speed and the airspeed of the parafoil system remain constant, and the vector relationship in the figure can be obtained:
式中x和y分别表示水平直角坐标系的两个坐标轴,分别指向正东和正北方向,Vx和Vy分别表示动力翼伞地速V在x轴和y轴两个方向的分量。VWx和VWy分别表示风速在x轴和y轴方向的分量。In the formula, x and y represent the two coordinate axes of the horizontal Cartesian coordinate system, pointing to the due east and the due north respectively, and V x and V y represent the components of the parafoil ground speed V in the x-axis and y-axis directions respectively. V Wx and V Wy represent the components of the wind speed in the x-axis and y-axis directions, respectively.
对式(2)中的两部分进行平方求和,得到等式:The two parts in formula (2) are squared and summed to obtain the equation:
在动力翼伞轨迹中选取3个点,计算获得的动力翼伞系统的对地速度分别为V1、V2和V3。根据式(3)获得一组等式:Three points are selected in the parafoil trajectory, and the calculated ground speeds of the parafoil system are V 1 , V 2 and V 3 . According to formula (3), a set of equations is obtained:
式(4)中Vxi和Vyi分别表示速度Vi在x轴和y轴的分量(i=1,2,3)。V xi and V yi in formula (4) represent the components of velocity V i on x-axis and y-axis respectively (i=1, 2, 3).
由前面假设可知,式中的V0和VW保持不变,速度V、Vx和Vy可以通过GPS数据计算获得,因此将式(4)中三个等式依次相减,可以得到:It can be seen from the previous assumptions that V 0 and V W in the formula remain unchanged, and the speeds V, V x and V y can be calculated from GPS data. Therefore, the three equations in formula (4) can be subtracted in turn to obtain:
至此,风场辨识问题变成普通的求解二元一次方程组的问题。方程组的解为:So far, the problem of wind field identification has become an ordinary problem of solving linear equations in two variables. The solution to the system of equations is:
需要指出的是,当翼伞沿直线航行时等式组(4)中两组等式相同,不能对风场进行辨识,因此数据点必须在翼伞转弯轨迹中选择,即需要保证式(4)中选择的动力翼伞系统的地速V1、V2和V3的方向和大小不同。It should be pointed out that when the parafoil sails along a straight line, the two sets of equations in the equation group (4) are the same, and the wind field cannot be identified, so the data points must be selected in the parafoil turning trajectory, that is, it is necessary to ensure that the equation (4 The directions and magnitudes of the ground speeds V 1 , V 2 and V 3 of the parafoil system selected in ) are different.
2、风场辨识结果的实时更新2. Real-time update of wind field identification results
单次计算结果受到GPS定位精度的限制,结果具有偶然性,存在一定的误差,为了提高风场辨识结果的精度和稳定性,本发明中引入递推最小二乘法对辨识结果进行在线迭代更新。The single calculation result is limited by the GPS positioning accuracy, the result is accidental, and there are certain errors. In order to improve the accuracy and stability of the wind field identification result, the present invention introduces the recursive least squares method to iteratively update the identification result online.
设Assume
y(k)=(V(k)2-V(k-1)2)/2 (7)y(k)=(V(k) 2 -V(k-1) 2 )/2 (7)
θ(k)=[VWx(k) VWy(k)]T (9)θ(k)=[V Wx (k) V Wy (k)] T (9)
式(7)-(9)中(k)表示变量在k时刻的值,(k-1)表示k时刻前一次采样时间的值。则等式组(5)中的等式均可以改写为:In formulas (7)-(9), (k) represents the value of the variable at time k, and (k-1) represents the value of the previous sampling time at time k. Then the equations in equation group (5) can be rewritten as:
带遗忘因子的风场预测递推公式如式(11)所示:The recursive formula of wind field prediction with forgetting factor is shown in formula (11):
式中λ表示遗忘因子,θ(k)表示k时刻的风场辨识结果,K(k)和P(k)表示最小二乘法在k时刻的中间变量。In the formula, λ represents the forgetting factor, θ(k) represents the wind field identification result at time k, and K(k) and P(k) represent the intermediate variables of the least squares method at time k.
3、动力翼伞系统飞行速度的滤波处理3. Filter processing of flight speed of powered parafoil system
由于GPS定位模块进行定位是一个复杂的过程,干扰因素复杂而且无法全部避免,由GPS定位数据计算获得的动力翼伞系统对地速度在用于风场辨识前需要进行滤波处理,以提高风场辨识的精度。Since positioning by the GPS positioning module is a complicated process, and the interference factors are complex and cannot be completely avoided, the ground speed of the powered parafoil system calculated from the GPS positioning data needs to be filtered before being used for wind field identification to improve wind field accuracy. recognition accuracy.
卡尔曼滤波算法是在导航领域应用最为广泛的滤波算法。因此本发明选择卡尔曼滤波算法作为动力翼伞系统飞行速度信息的预处理方法。在卡尔曼滤波算法中,系统状态方程和测量方程为:Kalman filtering algorithm is the most widely used filtering algorithm in the field of navigation. Therefore, the present invention selects the Kalman filter algorithm as the preprocessing method for the flight speed information of the powered parafoil system. In the Kalman filter algorithm, the system state equation and measurement equation are:
Xk=Φk|k-1Xk-1+Γk-1Wk-1 (12)X k =Φ k|k-1 X k-1 +Γ k-1 W k-1 (12)
Zk=HkXk+Vk (13)Z k =H k X k +V k (13)
式中Xk为动力翼伞系统的状态矩阵,Φk|k-1为k-1时刻到k时刻的状态转移矩阵,Γk-1为k-1时刻的噪声转移矩阵,Wk-1为系统噪声,Zk为系统测量向量,Hk为系统测量矩阵,Vk表示系统噪声。噪声特征描述为E(Wk)=q,E(Vk)=r,E(WkWi T)=Qδi,E(VkVi T)=Rδi,其中q和r分别为Wk-1和Vk的均值,R和Q分别为Wk-1和Vk的协方差,δi为Kronecker函数。where X k is the state matrix of the powered parafoil system, Φ k|k-1 is the state transition matrix from k-1 time to k time, Γ k-1 is the noise transition matrix at k-1 time, W k-1 is the system noise, Z k is the system measurement vector, H k is the system measurement matrix, and V k is the system noise. The noise characteristics are described as E(W k )=q, E(V k )=r, E(W k W i T )=Qδ i , E(V k V i T )=Rδ i , where q and r are respectively The means of W k-1 and V k , R and Q are the covariances of W k-1 and V k , respectively, and δ i is the Kronecker function.
卡尔曼滤波算法描述为:The Kalman filter algorithm is described as:
Xk|k-1=Φk|k-1Xk-1+Γk-1q (14)X k|k-1 =Φ k|k-1 X k-1 +Γ k-1 q (14)
εk=Zk-HkXk|k-1-r (15)ε k =Z k -H k X k|k-1 -r (15)
Xk=Xk|k-1+Kkεk (18)X k =X k|k-1 +K k ε k (18)
Pk=[I-KkHk]Pk|k-1[I-KkHk]T (19)P k =[IK k H k ]P k|k-1 [IK k H k ] T (19)
本发明的优点和积极效果:Advantage and positive effect of the present invention:
1、本发明方法不需要在原有系统上增加额外设备,只需要以动力翼伞系统的GPS定位数据为基础,结合动力翼伞系统在风中的运动特性,即可实现对空投风场的实时准确辨识,具有较好的经济性和实用性。1. The method of the present invention does not need to add additional equipment to the original system. It only needs to use the GPS positioning data of the powered parafoil system as the basis and combine the motion characteristics of the powered parafoil system in the wind to realize real-time monitoring of the airdropped wind field. Accurate identification, good economy and practicability.
2、本发明通过卡尔曼滤波算法对动力翼伞系统的飞行速度进行滤波处理,降低了GPS定位噪声对风场辨识结果的影响,提高了风场辨识精度。2. The present invention filters the flight speed of the powered parafoil system through the Kalman filter algorithm, which reduces the influence of GPS positioning noise on the wind field identification results and improves the wind field identification accuracy.
3、本发明通过带遗忘因子的递推最小二乘法对风场辨识结果进行实时在线更新,避免了每个时间点独立计算的辨识结果的偶然误差,增加了风场辨识结果的准确性和有效性。3. The present invention updates the wind field identification results online in real time through the recursive least squares method with a forgetting factor, which avoids accidental errors in the identification results independently calculated at each time point, and increases the accuracy and effectiveness of the wind field identification results. sex.
4、本发明对动力翼伞系统空投风场的辨识结果可用于动力翼伞系统的航迹优化、航迹跟踪控制和雀降控制,提高航迹优化效果,增加动力翼伞系统在风场中飞行的稳定性,确保雀降控制的逆风对准和平稳着陆,对动力翼伞系统的开发和应用具有重要的工程应用价值。4. The identification results of the present invention on the airdrop wind field of the powered parafoil system can be used for track optimization, track tracking control and sparrow landing control of the powered parafoil system, improve the track optimization effect, and increase the power of the powered parafoil system in the wind field. The stability of the flight, ensuring the headwind alignment and smooth landing of the sparrow landing control, has important engineering application value for the development and application of the powered parafoil system.
附图说明Description of drawings
图1动力翼伞系统风场辨识原理图。Fig. 1 Schematic diagram of wind field identification for powered parafoil system.
图2风场辨识流程图Figure 2 Flow chart of wind field identification
图3动力翼伞系统在稳定风场下的水平轨迹。Fig. 3 The horizontal trajectory of the powered parafoil system in a stable wind field.
图4动力翼伞系统在稳定风场下的对地速度。Figure 4. The ground speed of the powered parafoil system in a stable wind field.
图5动力翼伞系统在稳定风场下的风场辨识结果。Figure 5. The wind field identification results of the powered parafoil system in a stable wind field.
图6动力翼伞系统在突风环境下的水平运动轨迹。Fig. 6 The horizontal trajectory of the powered parafoil system in a gust environment.
图7动力翼伞系统在突风环境下的辨识结果。Figure 7 The identification results of the powered parafoil system in a gust of wind.
图8动力翼伞系统在变化风场中的水平运动轨迹。Figure 8 The horizontal trajectory of the parafoil system in a changing wind field.
图9动力翼伞系统对变化风场的辨识结果。Figure 9 The identification results of the powered parafoil system to the changing wind field.
图10动力翼伞系统跟踪圆形参考轨迹时的水平轨迹。Figure 10 Horizontal trajectory of the powered parafoil system when following a circular reference trajectory.
图11动力翼伞系统跟踪圆形参考轨迹时的风场辨识结果。Figure 11 The wind field identification results when the powered parafoil system tracks the circular reference trajectory.
图12动力翼伞系统着陆过程水平轨迹。Figure 12 The horizontal trajectory of the powered parafoil system during landing.
图13动力翼伞系统着陆风场的辨识结果。Figure 13 The identification results of the landing wind field of the powered parafoil system.
具体实施方式:detailed description:
仿真中模拟的GPS模块采样频率为4Hz,根据GPS信号获得的翼伞系统速度是地速在x轴和y轴上的分量,所以选择二阶的扩张状态观测滤波器对地速在x轴和y轴上的分量分别进行滤波处理。动力翼伞系统空投风场的辨识流程如图2所示。The sampling frequency of the GPS module simulated in the simulation is 4Hz. The speed of the parafoil system obtained according to the GPS signal is the component of the ground speed on the x-axis and the y-axis, so the second-order extended state observation filter is selected for the ground speed on the x-axis and the y-axis. The components on the y-axis are filtered separately. The identification process of the airdropped wind field of the powered parafoil system is shown in Figure 2.
实施例1:单下偏控制(仿真1)Embodiment 1: Single downward bias control (simulation 1)
(1)动力翼伞系统在稳定风场下的风场辨识(1) Wind field identification of powered parafoil system under stable wind field
动力翼伞系统的单下偏控制在无风状态下呈圆周运动,圆周的半径与下偏量大小有关。当加入风场影响时,动力翼伞轨迹在风场的作用下沿风场的方向偏移。The single downward deflection control of the powered parafoil system is in a circular motion in a windless state, and the radius of the circle is related to the downward deflection. When the influence of the wind field is added, the trajectory of the powered parafoil will shift along the direction of the wind field under the action of the wind field.
图3显示在VW=(12)m/s的风场时,动力翼伞系统在单下偏40%控制作用下的水平轨迹。动力翼伞系统的参数见表1。Fig. 3 shows the horizontal trajectory of the powered parafoil system under the control action of single downward deflection of 40% in the wind field of V W =(12)m/s. The parameters of the powered parafoil system are shown in Table 1.
表1动力翼伞系统参数Table 1 Power parafoil system parameters
从图3和图4中可以看出动力翼伞系统沿风向螺旋前进,其对地速度随着其飞行方向和风向夹角的不同而呈周期性变化。It can be seen from Fig. 3 and Fig. 4 that the powered parafoil system advances helically along the wind direction, and its ground speed varies periodically with the difference between its flight direction and the included angle of the wind direction.
1)计算动力翼伞系统飞行速度1) Calculate the flight speed of the powered parafoil system
为了更加贴近实际情况,仿真过程模拟GPS的采样频率和定位精度进行信息采集,GPS定位模块的采样频率为4Hz,定位均方根差为1.2m。设(x(k-1),y(k-1))和(x(k),y(k))分别表示动力翼伞系统飞行轨迹上点在水平面投影的坐标,由采样频率为4Hz,得到动力翼伞系统k时刻在x轴和y轴上的速度分量Vx(k)和Vy(k)为:In order to be closer to the actual situation, the simulation process simulates the sampling frequency and positioning accuracy of GPS for information collection. The sampling frequency of the GPS positioning module is 4Hz, and the root mean square error of positioning is 1.2m. Let (x(k-1), y(k-1)) and (x(k), y(k)) denote the coordinates of the projected points on the horizontal plane on the flight trajectory of the powered parafoil system respectively, and the sampling frequency is 4Hz, The velocity components V x (k) and V y (k) of the powered parafoil system on the x-axis and y-axis at time k are:
Vx(k)=4(x(k)-x(k-1)) (22)V x (k)=4(x(k)-x(k-1)) (22)
Vy(k)=4(y(k)-y(k-1)) (23)V y (k)=4(y(k)-y(k-1)) (23)
从而可以得到动力翼伞系统的飞行速度V(k)为:Thereby, the flight speed V(k) of the powered parafoil system can be obtained as:
图4为动力翼伞系统在单下偏状态下受风场影响时的运动速度。Fig. 4 shows the movement speed of the powered parafoil system under the influence of the wind field under the single downward deflection state.
2)动力翼伞系统水平速度的滤波处理2) Filter processing of the horizontal velocity of the powered parafoil system
据此GPS定位模块的精度设置卡尔曼滤波器的噪声统计信息,根据式(12)-(19)对动力翼伞系统的飞行速度进行滤波,得到滤波后的动力翼伞系统的飞行速度为对应x轴和y轴的速度分量为和 According to the accuracy of the GPS positioning module, the noise statistical information of the Kalman filter is set, and the flight speed of the powered parafoil system is filtered according to formulas (12)-(19), and the filtered flying speed of the powered parafoil system is obtained as The velocity components corresponding to the x-axis and y-axis are and
3)风场辨识3) Wind field identification
将经过滤波的动力翼伞系统飞行速度在x轴和y轴的速度分量和代入式(7)-(10),利用带遗忘因子的递推最小二乘法对风场辨识结果进行迭代更新。The velocity components of the filtered powered parafoil system flight velocity on the x-axis and y-axis and Substituting equations (7)-(10), using the recursive least squares method with forgetting factor to iteratively update the wind field identification results.
单侧下偏时在稳定风场时的动力翼伞系统的动态辨识结果在图5中给出。The dynamic identification results of the powered parafoil system in a stable wind field with one-sided downward deviation are shown in Fig. 5.
由图5可知,由于在辨识算法中最小二乘法的遗忘因子初始条件设置为0,所以在初始阶段的辨识结果处于震荡状态,属于无效数据。风向辨识在30s之前的结果与真实风向偏离较远,在30s之后辨识结果达到稳定状态,仅在噪声作用下围绕真实风向角上下波动。风向的辨识结果最大偏差值为3.5°,平均绝对误差达到0.93°。图5同样表明,风速的辨识结果在经过一定时候后达到稳定,与风向的辨识结果相比,风速辨识结果的稳定时间稍长,在40s以后才达到稳定,40s时风速辨识的误差为0.14m/s。在风速辨识结果稳定后,误差处于较小的范围,最大误差在182s时达到0.13m/s,风速的平均绝对误差为0.04m/s。It can be seen from Figure 5 that since the initial condition of the forgetting factor of the least squares method in the identification algorithm is set to 0, the identification results in the initial stage are in a state of oscillation, which is invalid data. The result of wind direction identification before 30s deviates far from the real wind direction. After 30s, the identification result reaches a stable state, and only fluctuates around the real wind direction angle under the action of noise. The maximum deviation of wind direction identification results is 3.5°, and the average absolute error reaches 0.93°. Figure 5 also shows that the wind speed identification results stabilize after a certain period of time. Compared with the wind direction identification results, the wind speed identification results have a slightly longer stabilization time and only reach stability after 40s. At 40s, the wind speed identification error is 0.14m /s. After the wind speed identification results are stable, the error is in a small range, the maximum error reaches 0.13m/s at 182s, and the average absolute error of wind speed is 0.04m/s.
图5中的结果表明该方法使动力翼伞系统在单下偏作用下,受到稳定风场时的辨识结果较为理想,在风速和风向上均有较高的辨识精度。The results in Fig. 5 show that this method makes the identification results of the powered parafoil system under the action of a single downward bias and a stable wind field more ideal, and has higher identification accuracy in both wind speed and wind direction.
(2)动力翼伞系统在突风中的风场辨识(2) Wind field identification of powered parafoil system in gust
实际环境中的风场除了稳定分量外,还包括紊流和突风,在对所提的风场辨识方法进行评估时,需要考虑突风对辨识结果的影响。仿真环境中风场的初始值设定为VW=(24)m/s在第75s时刻加入VW=(0 -2)m/s的突风,稳定风叠加突风时翼伞系统的运动轨迹在图6中给出。In addition to the stable component, the wind field in the actual environment also includes turbulence and gusts. When evaluating the proposed wind field identification method, the influence of gusts on the identification results needs to be considered. The initial value of the wind field in the simulation environment is set to V W = (24)m/s. Add a gust of V W = (0 -2) m/s at the 75th second, and the movement of the parafoil system when the stable wind is superimposed on the gust The trajectory is given in Fig. 6.
由于初始风场设定值的变化,翼伞系统的水平运动轨迹沿风向运动的速度增加,每一圈的运动轨迹的重合部分减少。此时风向和风速辨识结果在图7中给出。Due to the change of the initial wind field setting value, the speed of the horizontal motion track of the parafoil system moving along the wind direction increases, and the overlapping part of the motion track of each circle decreases. At this time, the wind direction and wind speed identification results are shown in Fig. 7.
从图7中可以看出,突风对风向的辨识结果影响较小。风向预测在加入突风后从准确辨识降低了5.1°,随后在第90s突风影响消失以后辨识风向结果增大,保持高于实际风向角3°的结果持续到第129s,之后重新得到对风向角的准确辨识结果。It can be seen from Figure 7 that the wind gust has little influence on the wind direction identification results. The wind direction prediction decreased by 5.1° from the accurate identification after the gust was added, and then the identified wind direction increased after the gust effect disappeared in the 90s, and remained 3° higher than the actual wind direction until the 129th second, and then the wind direction was obtained again Accurate identification of corners.
突风对风速的辨识结果影响较大,辨识结果的趋势与风向变化相同,在突风加入时刻开始辨识风速值下降,最多下降了0.16m/s,在突风消失后,辨识的风速值迅速上升,最大误差达到了0.32m/s,突风对风速辨识结果的影响持续到第125s。Gusts have a great influence on the identification results of wind speed, and the trend of the identification results is the same as that of the wind direction. When the gusts join, the identified wind speed values begin to drop, with a maximum drop of 0.16m/s. After the gusts disappear, the identified wind speed values rapidly Ascent, the maximum error reached 0.32m/s, and the impact of the gust on the wind speed identification results lasted until the 125th second.
(3)变化风场对辨识结果的影响(3) Influence of changing wind field on identification results
本发明所提的风场辨识方法中采用带遗忘因子的最小二乘法对风场进行实时辨识,当辨识过程中风场发生变化时,辨识结果仍能对变化后的风场产生较好的辨识效果。In the wind field identification method proposed in the present invention, the least square method with forgetting factor is used to identify the wind field in real time. When the wind field changes during the identification process, the identification result can still produce a better identification effect on the changed wind field .
仿真环境中风场的初始值设定为VW=(1 2)m/s,在第100s时刻将风场改为VW=(13)m/s。辨识方式为翼伞系统单侧下偏50%自由飞行。The initial value of the wind field in the simulation environment is set to V W =(1 2)m/s, and the wind field is changed to V W =(13)m/s at the 100s moment. The identification method is 50% free flight on one side of the parafoil system.
图8为翼伞系统在变化风场中的水平运动轨迹。Fig. 8 is the horizontal motion trajectory of the parafoil system in a changing wind field.
从图8中可以看出,翼伞系统在初始风场中沿风向的运动速度较小,在第三圈时风场发生改变,风速在y轴上的分量由2m/s变为3m/s,则翼伞系统随风场运动的速度增加,旋转第三圈时间内在y轴方向的漂移距离大于第二圈时的变化量。It can be seen from Figure 8 that the movement speed of the parafoil system along the wind direction in the initial wind field is small, and the wind field changes in the third circle, and the component of the wind speed on the y-axis changes from 2m/s to 3m/s , the speed of the parafoil system moving with the wind field increases, and the drift distance in the y-axis direction within the third rotation time is greater than the change amount during the second rotation time.
风速、风向的辨识结果见图8。The identification results of wind speed and wind direction are shown in Figure 8.
图8表明,翼伞系统在第40s之后实现了对未变化风场的风速和风向实现了高精度稳定辨识。在第100s风场变化后,风向的辨识结果在20s之内达到了稳定,而且未出现较大的波动。由于新的辨识结果是在原结果的基础上继续运算获得,所以风场改变过程中风向辨识结果误差变化较小,最大误差值出现在第107s,误差值为7.2°。Figure 8 shows that the parafoil system achieves high-precision and stable identification of the wind speed and wind direction of the unchanged wind field after 40s. After the wind field changed in the 100s, the identification result of the wind direction reached stability within 20s, and there was no large fluctuation. Since the new identification results are obtained by continuous calculation on the basis of the original results, the error of the wind direction identification results changes slightly during the wind field change process, and the maximum error value appears at 107s, with an error value of 7.2°.
对于风速的辨识结果,从图8中可以看出,翼伞系统辨识出变化后的风场所需时间比从初始状态辨识出风场用时较短,在风场改变后20s就取得了比较好的风速辨识结果,但与实际值之间约0.3m/s的辨识误差直到155s才得以消除。在155s后,翼伞系统的风速辨识结果围绕真实风速小范围波动,达到比较理想的状态。As for the wind speed identification results, it can be seen from Figure 8 that the time required for the parafoil system to identify the changed wind field is shorter than the time required to identify the wind field from the initial state, and a better result is achieved 20s after the wind field changes. However, the identification error of about 0.3m/s between the actual value and the actual value was not eliminated until 155s. After 155s, the wind speed identification result of the parafoil system fluctuated around the real wind speed in a small range, reaching an ideal state.
仿真分析表明,翼伞系统可在单下偏自由飞行实现对风场的风速和风向的准确辨识,而且辨识所需时间小于翼伞系统运动一周所需的时间。从仿真结果可以看出,翼伞系统对风向的辨识效果好于对风速的辨识效果,通过辨识得到稳定的风向所需时间短,在风向发生变化时能在小误差的情况下实现快速的跟踪。The simulation analysis shows that the parafoil system can accurately identify the wind speed and direction of the wind field in a single downward free flight, and the time required for identification is less than the time required for the parafoil system to move for one week. It can be seen from the simulation results that the wind direction identification effect of the parafoil system is better than that of the wind speed. It takes a short time to obtain a stable wind direction through identification, and it can achieve fast tracking with a small error when the wind direction changes. .
实施例2:轨迹跟踪控制时的风场辨识(仿真2)Embodiment 2: Wind field identification during trajectory tracking control (simulation 2)
翼伞系统在单下偏状态下风场辨识精度较为理想,但在一些情况下翼伞系统的运动区域受到限制,不允许其在单下偏状态下随风飞行,因此需要考虑翼伞系统在受控状态下的风场辨识。The wind field identification accuracy of the parafoil system is ideal in the single downward deflection state, but in some cases the movement area of the parafoil system is limited, and it is not allowed to fly with the wind in the single downward deflection state. Wind field identification in control state.
前面章节介绍了翼伞系统跟踪参考轨迹的控制方法,翼伞系统可以在线性自抗扰控制器的操纵下跟踪圆形轨迹,通过控制翼伞系统跟踪圆形轨迹的方法将翼伞系统的运动区域限制在一定的范围内。图10是翼伞系统VW=(1 2)m/s的风场中跟踪定高圆形轨迹采集风向辨识数据时的水平投影轨迹,参考轨迹的半径为150m。The previous chapters introduced the control method for the parafoil system to track the reference trajectory. The parafoil system can track the circular trajectory under the control of the linear active disturbance rejection controller. By controlling the parafoil system to track the circular trajectory, the movement of the parafoil system The area is limited within a certain range. Fig. 10 is the horizontal projected trajectory of the parafoil system V W =(1 2)m/s in the wind field when tracking the height-fixed circular trajectory to collect wind direction identification data, and the radius of the reference trajectory is 150m.
图10和图11为翼伞系统在风场中跟踪圆形轨迹时的辨识结果。Figures 10 and 11 show the identification results of the parafoil system tracking a circular trajectory in the wind field.
在图11显示的结果中,由于翼伞系统的运动状态受到高度控制中推力变化的影响,风场的辨识结果在稳定后产生的波动大于单下偏操纵的情况。风向辨识结果的最大值为5°,平均绝对误差为2.3°。In the results shown in Fig. 11, since the motion state of the parafoil system is affected by the thrust change in the altitude control, the fluctuation of the wind field identification result after stabilization is larger than that in the case of single downward bias control. The maximum value of the wind direction identification result is 5°, and the average absolute error is 2.3°.
图11中的风速辨识结果同样显示出了较大的误差,在80s之后的风速辨识结果一直低于真实风速值。稳定后的风速辨识结果的最大误差为0.15m/s,误差的平均绝对值比单下偏时增长较多,达到了0.08m/s。The wind speed identification results in Figure 11 also show a large error, and the wind speed identification results after 80s are always lower than the true wind speed value. The maximum error of the wind speed identification result after stabilization is 0.15m/s, and the average absolute value of the error increases more than that of single downward deviation, reaching 0.08m/s.
仿真结果表明,翼伞系统在跟踪圆形轨迹时可以实现对风场的高精度辨识。The simulation results show that the parafoil system can realize high-precision identification of the wind field when tracking the circular trajectory.
实施例3:动力翼伞系统着陆阶段的风场辨识(仿真3)Embodiment 3: Wind field identification (simulation 3) of powered parafoil system landing stage
动力翼伞系统通过单下偏或者跟踪圆形轨迹的方式可以准确辨识出所处风场的风速和风向,风场信息对动力翼伞的归航控制、轨迹跟踪和雀降操作都具有重要的作用。本实施例以动力翼伞系统的着陆控制为例,首先利用动力翼伞跟踪圆形轨迹的方式对风场进行辨识,随后进行逆风对准和实施着陆。The powered parafoil system can accurately identify the wind speed and direction of the wind field where it is located by means of single downward deflection or tracking the circular trajectory. The wind field information plays an important role in the homing control, trajectory tracking and sparrow landing operation of the powered parafoil. . In this embodiment, the landing control of the powered parafoil system is taken as an example. Firstly, the wind field is identified by using the powered parafoil to track a circular trajectory, and then the headwind alignment and landing are performed.
图12和图13表示着陆过程的水平轨迹、风场辨识结果。系统中所加的稳定风场矢量为Vw=(0 3)m/s。Figure 12 and Figure 13 show the horizontal trajectory and wind field identification results of the landing process. The stable wind field vector added to the system is V w =(0 3)m/s.
从图12可以看出,动力翼伞系统的参考轨迹半径为150m,在风场的作用下,动力翼伞系统的水平轨迹偏离圆形参考轨迹的最大距离为8.1m,在风向辨识过程中保持了较好的轨迹跟踪效果。It can be seen from Figure 12 that the reference trajectory radius of the powered parafoil system is 150m. Under the action of the wind field, the maximum distance between the horizontal trajectory of the powered parafoil system and the circular reference trajectory is 8.1m. It has a better trajectory tracking effect.
除去动力翼伞系统逆风对准和着陆时间,可用于风向辨识的有效时间为130s。从图13中可以看出,风速的辨识结果在第20s时接近真实值,风向辨识结果在第20s时刻的辨识误差为8.4°,达到比较理想的状态。动力翼伞系统从初始位置旋转一周耗时69s,由此可知在动力翼伞系统围绕目标旋转一周时间内可以实现对风向的准确辨识,第69s时刻的风向辨识误差为0.63°,风速辨识结果的误差为0.004m/s,辨识精度较高。如图12所示,动力翼伞系统在得到风向辨识结果后,继续跟踪参考轨迹到转折点实现转弯。由于动力翼伞系统不能实现直角转弯,所以适当将转折点位置提前,仿真中选择参考轨迹上距离y轴75m的位置作为轨迹切换点。轨迹切换到逆风对准后,动力翼伞系统逐渐控制降低高度,在目标点附近着陆,着陆点距离目标点7.1m。Excluding the headwind alignment and landing time of the powered parafoil system, the effective time for wind direction identification is 130s. It can be seen from Fig. 13 that the identification result of wind speed is close to the real value at the 20th second, and the identification error of the wind direction identification result at the 20th second is 8.4°, reaching an ideal state. It takes 69 seconds for the powered parafoil system to rotate one circle from the initial position. It can be seen that the accurate identification of the wind direction can be realized within the period of one circle of the powered parafoil system around the target. The error is 0.004m/s, and the identification accuracy is high. As shown in Figure 12, after obtaining the wind direction identification result, the powered parafoil system continues to track the reference trajectory to the turning point to realize the turn. Since the powered parafoil system cannot realize a right-angle turn, the position of the turning point is appropriately advanced. In the simulation, the position 75m away from the y-axis on the reference trajectory is selected as the trajectory switching point. After the trajectory was switched to align against the wind, the powered parafoil system gradually lowered the altitude and landed near the target point, which was 7.1m away from the target point.
Claims (4)
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610281210.1A CN105912019A (en) | 2016-04-29 | 2016-04-29 | Powered parafoil system's air-drop wind field identification method |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610281210.1A CN105912019A (en) | 2016-04-29 | 2016-04-29 | Powered parafoil system's air-drop wind field identification method |
Publications (1)
Publication Number | Publication Date |
---|---|
CN105912019A true CN105912019A (en) | 2016-08-31 |
Family
ID=56753496
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201610281210.1A Pending CN105912019A (en) | 2016-04-29 | 2016-04-29 | Powered parafoil system's air-drop wind field identification method |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN105912019A (en) |
Cited By (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107153424A (en) * | 2017-07-06 | 2017-09-12 | 上海复亚通信科技有限公司 | A kind of full-automatic unmanned machine of energy anti-strong wind patrols winged system |
CN108227696A (en) * | 2017-09-04 | 2018-06-29 | 河南森源电气股份有限公司 | The mathematical model discrimination method and system of a kind of AGV mobile robots |
CN110412311A (en) * | 2019-07-18 | 2019-11-05 | 南京航空航天大学 | A method for measuring the horizontal speed of a parafoil and the wind speed and direction in an airdrop landing area |
CN111712630A (en) * | 2017-12-22 | 2020-09-25 | 维斯塔斯风力系统有限公司 | Control of a wind energy plant comprising an airborne wind energy system |
CN113031475A (en) * | 2021-03-01 | 2021-06-25 | 南京航空航天大学 | Parafoil track tail end real-time prediction device |
CN114237051A (en) * | 2021-12-16 | 2022-03-25 | 江苏理工学院 | Power parafoil height control method based on fractional order sliding mode backstepping method |
CN114740762A (en) * | 2022-05-07 | 2022-07-12 | 南开大学 | Power parafoil semi-physical simulation system based on active-disturbance-rejection decoupling control strategy |
CN116306333A (en) * | 2022-12-09 | 2023-06-23 | 中国能源建设集团广东省电力设计研究院有限公司 | Aerodynamic evaluation method and system for high-altitude wind energy capture device |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US6343244B1 (en) * | 1998-11-24 | 2002-01-29 | Fuji Jukogyo Kabushiki Kaisha | Automatic guidance system for flight vehicle having parafoil and navigation guidance apparatus for the system |
CN101082496A (en) * | 2006-05-31 | 2007-12-05 | 陈周俊 | System capable of effectively decreasing vehicle GPS navigation error |
CN105116915A (en) * | 2015-09-16 | 2015-12-02 | 航宇救生装备有限公司 | Multi-mode satellite navigation-based parafoil flight path control system |
-
2016
- 2016-04-29 CN CN201610281210.1A patent/CN105912019A/en active Pending
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US6343244B1 (en) * | 1998-11-24 | 2002-01-29 | Fuji Jukogyo Kabushiki Kaisha | Automatic guidance system for flight vehicle having parafoil and navigation guidance apparatus for the system |
CN101082496A (en) * | 2006-05-31 | 2007-12-05 | 陈周俊 | System capable of effectively decreasing vehicle GPS navigation error |
CN105116915A (en) * | 2015-09-16 | 2015-12-02 | 航宇救生装备有限公司 | Multi-mode satellite navigation-based parafoil flight path control system |
Non-Patent Citations (4)
Title |
---|
李永泉: "小波和Kalman滤波用于GPS数据去噪方法分析", 《交通科技与经济》 * |
檀盼龙 等: "动力翼伞系统空投风场的辨识与应用", 《航空学报》 * |
胡申森: "机载多普勒激光测风雷达风场反演研究", 《气象科学》 * |
高海涛: "翼伞系统自主归航航迹规划与控制研究", 《中国博士学位论文全文数据库工程科技Ⅱ辑》 * |
Cited By (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107153424A (en) * | 2017-07-06 | 2017-09-12 | 上海复亚通信科技有限公司 | A kind of full-automatic unmanned machine of energy anti-strong wind patrols winged system |
CN108227696A (en) * | 2017-09-04 | 2018-06-29 | 河南森源电气股份有限公司 | The mathematical model discrimination method and system of a kind of AGV mobile robots |
CN111712630A (en) * | 2017-12-22 | 2020-09-25 | 维斯塔斯风力系统有限公司 | Control of a wind energy plant comprising an airborne wind energy system |
CN110412311A (en) * | 2019-07-18 | 2019-11-05 | 南京航空航天大学 | A method for measuring the horizontal speed of a parafoil and the wind speed and direction in an airdrop landing area |
CN110412311B (en) * | 2019-07-18 | 2020-07-07 | 南京航空航天大学 | A method for measuring the horizontal speed of a parafoil and the wind speed and direction in the airdrop landing area |
CN113031475A (en) * | 2021-03-01 | 2021-06-25 | 南京航空航天大学 | Parafoil track tail end real-time prediction device |
CN113031475B (en) * | 2021-03-01 | 2022-09-30 | 南京航空航天大学 | Parafoil track tail end real-time prediction device |
CN114237051A (en) * | 2021-12-16 | 2022-03-25 | 江苏理工学院 | Power parafoil height control method based on fractional order sliding mode backstepping method |
CN114740762A (en) * | 2022-05-07 | 2022-07-12 | 南开大学 | Power parafoil semi-physical simulation system based on active-disturbance-rejection decoupling control strategy |
CN116306333A (en) * | 2022-12-09 | 2023-06-23 | 中国能源建设集团广东省电力设计研究院有限公司 | Aerodynamic evaluation method and system for high-altitude wind energy capture device |
CN116306333B (en) * | 2022-12-09 | 2023-10-20 | 中国能源建设集团广东省电力设计研究院有限公司 | Aerodynamic evaluation method and system for high-altitude wind energy capture device |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN105912019A (en) | Powered parafoil system's air-drop wind field identification method | |
Iscold et al. | Development of a hand-launched small UAV for ground reconnaissance | |
CN109814593B (en) | Low-altitude solar unmanned aerial vehicle flight control method and system capable of automatically searching heat | |
Demitrit et al. | Model-based wind estimation for a hovering VTOL tailsitter UAV | |
CN109250153A (en) | Martian atmosphere approach section track optimal tracking method of guidance | |
Larrabee et al. | Wind field estimation in UAV formation flight | |
CN115903888A (en) | An Autonomous Path Planning Method for Rotary Wing UAV Based on Beetle Swarm Algorithm | |
Zhu et al. | Design of air-wake rejection control for longitudinal automatic carrier landing cyber-physical system | |
Brossard et al. | Tightly coupled navigation and wind estimation for mini UAVs | |
Tao et al. | Modeling and control of a powered parafoil in wind and rain environments | |
Alexis et al. | Constrained-control of a quadrotor helicopter for trajectory tracking under wind-gust disturbances | |
Parfiryev et al. | Algorithm for controlling the trajectory of an unmanned aerial vehicle with the possibility of flying around obstacles | |
Karpinski et al. | Energy-Minimization Path Planning and Control of Unmanned Aerial Systems for Advanced Air Mobility | |
Chao et al. | Wake vortex detection with UAV close formation flight | |
Tian et al. | Wake encounter simulation and flight validation with UAV close formation flight | |
Saderla et al. | Parameter estimation of UAV from flight data using neural network | |
Zhang et al. | Small fixed-wing unmanned aerial vehicle path following under low altitude wind shear disturbance | |
CN106444793A (en) | RLV auto-landing segment speed control method based on nominal speed compensation idea | |
Chandar | A review on longitudinal control law design for a small fixed-wing uav | |
Tian et al. | UAS-based wind estimation using sinusoidal gust model | |
Yin et al. | Research on attitude control system design and flight experiments of small-scale unmanned aerial vehicle | |
Wang et al. | Design of autonomous flight control system for small-scale UAV | |
CN117829016B (en) | A method and device for predicting landing trajectory of large-wingspan UAV | |
Shao et al. | Optimization and Trajectory Tracking of Deep Stall Landing for a Variable Forward-swept Wing UAV | |
CN111651860A (en) | A Predictive Correction Robust Guidance Method for Re-entry Segments of Reusable Vehicles |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
WD01 | Invention patent application deemed withdrawn after publication |
Application publication date: 20160831 |
|
WD01 | Invention patent application deemed withdrawn after publication |