数据处理的方法及装置与流程

文档序号:16853653发布日期:2019-02-12 22:59阅读:325来源:国知局
数据处理的方法及装置与流程

本发明涉及无人飞行器技术领域,特别是涉及一种数据处理的方法、一种数据处理的装置、一种飞行器以及一种计算机可读存储介质。



背景技术:

无人驾驶飞机简称无人机(unmannedaerialvehicle,简称uav),是一种不载人飞机。无人机的用途广泛,经常被应用于植保、城市管理、地质、气象、电力、抢险救灾、视频拍摄等行业。

无人机要实现低空尤其是近地面的自主飞行,除了要知道无人机当前的海拔高度外,还需知道无人机相对于地面的高度。其中,无人机的海拔高度信息一般通过气压计、gps等测量得到,而无人机相对于地面高度可以使用声纳测距、激光测距、微波雷达测距以及机器视觉测量方法等。

然而,由于激光测距方案容易受到光线的影响且价格成本较高,机器视觉测量方法较为复杂且也容易受到光线的影响,雷达测距和声纳测距不受光线影响,可全天候使用,且价格成本相对低廉,系统复杂性低。因此,雷达测距和声纳测距是比较常用的测距方式。

现有的雷达传感器以及声纳传感器多安装在移动的机器人上,或者安装在固定的空间内等,在此类环境下雷达传感器或声纳测传感器测得的数据本身就较为准确,不需要进行复杂的滤波操作。然而,在无人机的应用环境中,由于存在无人机螺旋桨高速转动引起的机身高频振动、螺旋桨转动引起的气流扰动、无人机在飞行过程中的姿态快速反复倾斜变化、螺旋桨在高速转动过程中引起的电源不稳定等较为复杂的因素,导致无人机机载的声纳测距或雷达测距引入较为严重噪声,甚至会使得测距失败,因此现有的简单滤波方案应用在无人机上效果较差。



技术实现要素:

鉴于上述问题,提出了本发明实施例以便提供一种克服上述问题或者至少部分地解决上述问题的一种数据处理的方法和相应的一种数据处理的装置、一种飞行器以及一种计算机可读存储介质。

为了解决上述问题,本发明实施例公开了一种数据处理的方法,应用于无人机中,所述方法包括:

当达到测量时机时,获取无人机中的指定传感器测量的初始测量数据;

获取所述无人机实时的飞行参数;

基于所述飞行参数,对所述初始测量数据进行滤波处理,得到目标测量数据。

优选地,所述基于所述飞行参数,对所述初始测量数据进行滤波处理,得到目标测量数据的步骤包括:

基于所述飞行参数,确定所述初始测量数据对应的滤波系数;

采用所述滤波系数,对所述初始测量数据进行滤波处理,得到目标测量数据。

优选地,所述基于所述飞行参数,确定所述初始测量数据对应的滤波系数的步骤包括:

基于所述飞行参数,确定所述初始测量数据对应的第一衰减参数;

对所述第一衰减参数进行归一化变换,得到第二衰减参数;

基于所述第二衰减参数确定滤波系数,其中,所述滤波系数随着所述第二衰减参数的减小而增大。

优选地,所述第一衰减参数对应设置有跳变计数器,所述基于所述飞行参数,确定所述初始测量数据对应的第一衰减参数的步骤包括:

获取所述无人机当前时刻的初始测量数据与上一时刻的目标测量数据的测量差值;

基于所述飞行参数,确定所述初始测量数据对应的跳变量;

在上一时刻对应的衰减参数小于所述跳变量时,若所述跳变量小于或等于预设跳变量阈值,则将所述衰减参数设置为所述跳变量,作为第一衰减参数;若所述跳变量大于预设跳变量阈值,则将所述第一衰减参数设置为根据变化趋势调节后的跳变量;

当上一时刻对应的衰减参数大于或等于所述跳变量时,若所述跳变量大于预设跳变量阈值,则清零所述跳变计数器,若所述跳变量小于或等于预设跳变量阈值,则将所述跳变计数器自增第一预设步长;若所述跳变计数器中的计数大于预设的延时系数阈值,则对上一时刻对应的衰减参数按照预设的衰减因子进行衰减计算,得到第一衰减参数;

若所述第一衰减参数大于所述测量差值,则将所述第一衰减参数设置为所述测量差值。

优选地,所述飞行参数包括无人机所处的海拔高度,所述基于所述飞行参数,确定所述初始测量数据对应的跳变量的步骤包括:

获取所述无人机当前时刻的海拔高度与上一时刻的海拔高度之间的海拔变化量;

确定当前时刻的初始测量数据与上一时刻的在先初始测量数据之间的测量变化值;

将所述测量变化值补偿所述海拔变化量,得到所述初始测量数据对应的跳变量。

优选地,所述基于所述第二衰减参数确定滤波系数的步骤包括:

对所述第二衰减参数进行非线性多项式运算,得到所述滤波系数。

优选地,在所述采用所述滤波系数,对所述初始测量数据进行滤波处理,得到目标测量数据的步骤之前,还包括:

对所述滤波系数进行限位处理。

优选地,在所述基于所述飞行参数,对所述初始测量数据进行滤波处理,得到目标测量数据的步骤之前,还包括:

判断所述初始测量数据是否有效,若所述初始测量数据有效,则执行所述基于所述飞行参数,对所述初始测量数据进行滤波处理,得到目标测量数据的步骤。

本发明实施例还提供了一种数据处理的装置,应用于无人机中,所述装置包括:

初始测量数据获取模块,用于当达到测量时机时,获取无人机中的指定传感器测量的初始测量数据;

飞行参数获取模块,用于获取所述无人机实时的飞行参数;

滤波处理模块,用于基于所述飞行参数,对所述初始测量数据进行滤波处理,得到目标测量数据。

优选地,所述滤波处理模块包括:

滤波系数确定子模块,用于基于所述飞行参数,确定所述初始测量数据对应的滤波系数;

目标测量数据确定子模块,用于采用所述滤波系数,对所述初始测量数据进行滤波处理,得到目标测量数据。

优选地,所述滤波系数确定子模块包括:

衰减参数确定单元,用于基于所述飞行参数,确定所述初始测量数据对应的第一衰减参数;

归一化变换单元,用于对所述第一衰减参数进行归一化变换,得到第二衰减参数;

滤波系数确定单元,用于基于所述第二衰减参数确定滤波系数,其中,所述滤波系数随着所述第二衰减参数的减小而增大。

优选地,所述第一衰减参数对应设置有跳变计数器,所述衰减参数确定单元包括:

测量差值确定子单元,用于获取所述无人机当前时刻的初始测量数据与上一时刻的目标测量数据的测量差值;

跳变量确定子单元,用于基于所述飞行参数,确定所述初始测量数据对应的跳变量;

第一参数确定子单元,用于在上一时刻对应的衰减参数小于所述跳变量时,若所述跳变量小于或等于预设跳变量阈值,则将所述衰减参数设置为所述跳变量,作为第一衰减参数;若所述跳变量大于预设跳变量阈值,则将所述第一衰减参数设置为根据变化趋势调节后的跳变量;

第二参数确定子单元,用于当上一时刻对应的衰减参数大于或等于所述跳变量时,若所述跳变量大于预设跳变量阈值,则清零所述跳变计数器,若所述跳变量小于或等于预设跳变量阈值,则将所述跳变计数器自增第一预设步长;若所述跳变计数器中的计数大于预设的延时系数阈值,则对上一时刻对应的衰减参数按照预设的衰减因子进行衰减计算,得到第一衰减参数;

第三参数确定子单元,用于若所述第一衰减参数大于所述测量差值,则将所述第一衰减参数设置为所述测量差值。

优选地,所述飞行参数包括无人机所处的海拔高度,所述跳变量确定子单元还用于:

获取所述无人机当前时刻的海拔高度与上一时刻的海拔高度之间的海拔变化量;

确定当前时刻的初始测量数据与上一时刻的在先初始测量数据之间的测量变化值;

将所述测量变化值补偿所述海拔变化量,得到所述初始测量数据对应的跳变量。

优选地,所述滤波系数确定单元还用于:

对所述第二衰减参数进行非线性多项式运算,得到所述滤波系数。

优选地,所述装置还包括:

限位处理模块,用于对所述滤波系数进行限位处理。

优选地,所述装置还包括:

有效性判断模块,用于判断所述初始测量数据是否有效,若所述初始测量数据有效,则调用所述滤波处理模块。

本发明实施例还提供了一种飞行器,包括存储器、处理器及存储在存储器上并可在处理器上运行的计算机程序,所述处理器执行所述程序时实现上述方法的步骤。

本发明实施例还提供了一种计算机可读存储介质,其上存储有计算机程序,该程序被处理器执行时实现上述方法的步骤。

本发明实施例包括以下优点:

在本发明实施例中,当达到测量时机时,无人机的飞行控制器可以获取无人机中的指定传感器测量的,当前时刻的初始测量数据,结合获取的无人机实时的飞行参数,可以对该初始测量数据进行滤波处理,得到目标测量数据,使得测量结果更加精确,提高了数据测量的精确度。

附图说明

图1是本发明的一种数据处理的方法实施例一的步骤流程图;

图2是本发明的一种数据处理的方法实施例二的步骤流程图;

图3是本发明的一种数据有效性判断的步骤流程图;

图4是本发明的数据融合步骤流程图;

图5是本发明的本发明的一种数据处理的装置实施例的结构框图。

具体实施方式

为使本发明的上述目的、特征和优点能够更加明显易懂,下面结合附图和具体实施方式对本发明作进一步详细的说明。

在无人机植保作业过程中,可以通过飞行控制系统(简称飞控)控制无人机完成起飞、空中飞行、执行作业任务和返航等整个飞行过程,飞控对于无人机相当于驾驶员对于有人机的作用,是无人机最核心的技术之一。

该飞行控制系统可以包括地面站,地面站可以通过通信模块与无人机进行通信,在实现中,该地面站可以为手持地面站,其中可以内置高精度gps,支持不规则地块边界的快速测绘,使用该地面站时,无需连接电脑,即可直接调节无人机飞行参数。该地面站具有智能航线规划功能,支持喷洒点开关预设,可有效避免作业过程中出现重喷或漏喷现象。在喷洒过程中,用户还可以通过地面站实时监测飞行及喷洒状态,让喷洒更精准、高效。

无人机中可以安装有用于进行距离测量的传感器,使得无人机能够实时获取自身所在的高度。在本发明实施例可以结合无人机自身的飞行特性,对传感器测量的数据来进行滤波处理,能够提高数据测量的精度。

参照图1,示出了本发明的一种数据处理的方法实施例一的步骤流程图,当该方法应用于无人机时,可以包括如下步骤:

步骤101,当达到测量时机时,获取无人机中的指定传感器测量的初始测量数据;

步骤102,获取所述无人机实时的飞行参数;

步骤103,基于所述飞行参数,对所述初始测量数据进行滤波处理,得到目标测量数据。

在本发明实施例中,当达到测量时机时,无人机的飞行控制器可以获取无人机中的指定传感器测量的,当前时刻的初始测量数据,结合获取的无人机实时的飞行参数,可以对该初始测量数据进行滤波处理,得到目标测量数据,使得测量结果更加精确,提高了数据测量的精确度。

参照图2,示出了本发明的一种数据处理的方法实施例二的步骤流程图,当该方法应用于无人机时,可以包括如下步骤:

步骤201,当达到测量时机时,获取无人机中的指定传感器测量的初始测量数据;

在本发明实施例中,该指定传感器可以包括声纳传感器、雷达传感器等的至少一种。

声纳传感器发出一个声波信号,当遇到物体后会反射回来,依据反射时间及波型可以计算无人机距离物体的距离及位置。

雷达传感器能通过发射与接收微波来感应物体的存在、运动速度、静止距离、物体所处角度等。

该初始测量数据可以为传感器测量得到的无人机的对地距离值。

当指定传感器有两个或以上时,则对应的初始测量数据可以包括第一传感器测量的第一测量数据,以及,第二传感器测量的第二测量数据。

例如,当第一传感器为声纳传感器时,第一测量数据可以为声纳传感器测量得到的无人机的对地距离值hs。当第二传感器为雷达传感器时,第二测量数据可以为雷达传感器测量得到的无人机的对地距离值hr,下述可以用hs表示第一测量数据,hr表示第二测量数据。

在具体实现中,可以通过飞行控制器预先设定测量间隔以及测量生命周期,例如,设定每秒测量20次,则可以根据时间间隔确定测量时机,如测量时机可以分别为1/20s、1/10s、3/20s、…、1s。

步骤202,获取所述无人机实时的飞行参数;

在具体实现中,飞行控制器还可以获取无人机实时的飞行参数,作为一种示例,该飞行参数可以包括但不限于:无人机实时的海拔高度、水平飞行速度、飞行航向角等。

在本发明实施例中,得到初始测量数据以后,本发明实施例还可以包括如下步骤:

判断所述初始测量数据是否有效。

具体的,参考图3的有效性判断步骤流程图所示,上述判断所述初始测量数据是否有效的过程具体可以包括如下步骤:

步骤301,判断所述初始测量数据是否满足预设的基础条件;若否,则执行步骤302;若是,则执行步骤303;

步骤302,判定所述初始测量数据无效;

本发明实施例可以预先设定基础条件,作为有效性判断的第一道判断程序。

在本发明实施例的一种优选实施例中,步骤301进一步可以包括如下子步骤:

子步骤s11,判断所述初始测量数据是否大于所述指定传感器的预设设计量程;若是,则执行子步骤s12,若否,则执行子步骤s13;

子步骤s12,判定所述初始测量数据不满足所述基础条件;

例如,指定传感器的预设设计量程为4米,初始测量数据的回波是5米,则该初始测量数据超过设计量程,此时,可以判定该初始测量数据不满足所述基础条件,进而可以判定该初始测量数据无效。

子步骤s13,获取所述指定传感器前n个时刻测量的m个在先初始测量数据,若所述初始测量数据与所述m个在先初始测量数据均相同,则判定所述初始测量数据不满足所述基础条件;若所述初始测量数据以及所述m个在先初始测量数据均不相同,则判定所述初始测量数据满足所述基础条件,其中,n大于1,m大于1。

如果初始测量数据没有超出指定传感器的设计量程,则继续执行子步骤s13。

在具体实现中,由于无人机在飞行过程中的对地距离是会发生变化的,或者是有波动的,如果在一段时间内测量的m个数据都相等,则表示该传感器测量的初始测量数据不满足基础条件,进而可以判定该初始测量数据无效。

在实际中,n、m可以根据传感器的测量精度、测量频率以及无人机载体的移动速度选取的一个适当的值,在实际中,n与m可以取值相同,例如,可以将n、m取值为5。

若当前时刻测量的初始测量数据以及前m个在先初始测量数据均不相同,则可以判定当前时刻的初始测量数据满足基础条件(即,该初始测量数据既不超过预设设计量程,又与前m个在先初始测量数据均不相同),此时,可以继续执行步骤303。

步骤303,基于所述飞行参数,获取所述初始测量数据的跳变量,并基于所述跳变量,判断所述初始测量数据是否有效。

在本发明实施例的一种优选实施例中,上述基于所述飞行参数,获取所述初始测量数据的跳变量的步骤可以包括如下子步骤:

子步骤s21,确定所述无人机当前时刻的海拔高度与上一时刻的海拔高度之间的海拔变化量;

子步骤s22,确定当前时刻的初始测量数据与上一时刻的在先初始测量数据之间的测量变化值;

子步骤s23,将所述测量变化值补偿所述海拔变化量,得到所述初始测量数据的跳变量。

在本发明实施例中,该跳变量可以包括第一测量数据对应的第一跳变量,以及,第二测量数据对应的第二跳变量。

例如,针对hr,其对应的测量变化值dr=|hr-hr_o|,其中,hr为当前时刻的测量数据,hr_o为上一时刻的在先测量数据。

hr对应的第二跳变量dr1=|hr-hr_o+hg_o-hg|,其中,hg_o-hg为根据无人机当前时刻的海拔高度与上一时刻的海拔高度计算的海拔变化量。

针对hs,其对应的测量变化值ds=|hs-hs_o|,其中,hs为当前时刻的测量数据,hs_o为上一时刻的在先测量数据。

hs对应的第一跳变量ds1=|hs-hs_o+hg_o-hg|。

需要说明的是,当海拔精度较差或者没有海拔数据时,可以用dr、ds代替dr1、ds1,即不进行载体海拔变化量补偿。

在具体实现中,n1和t1可以根据传感器的测量频率和无人机的移动速度选取一个适当的值,例如,n1可以取值为10,t1可以取值为0.3m。

在本发明实施例的一种优选实施例中,该指定传感器具有对应的有效计数器,步骤303进一步可以包括如下子步骤:

子步骤s31,若所述跳变量小于或等于第一预设阈值,则在判定当前时刻的初始测量数据与上一时刻的在先初始测量数据不相同时,将所述有效计数器自增预设步长;

子步骤s32,当所述有效计数器中的计数大于预设计数阈值时,则判定所述初始测量数据有效。

例如,若ds1<=t2,当hs!=hs_o时,对应的有效计数器tc_s++,当tc_s>预设计数阈值时,判定该hs有效,此时,可以将当前时刻的hs的状态设置为有效状态,即true_s=1。

在具体实现中,第一预设阈值t2可以根据传感器的具体特性进行设置,例如,设定第一预设阈值t2为1m。

第四预设阈值可以根据传感器的测量频率和实际传感器的特性取值,例如,可以将第四预设阈值取值为3。

在本发明实施例的一种优选实施例中,当指定传感器至少包括第一传感器以及第二传感器时,步骤303进一步可以包括如下子步骤:

子步骤s41,针对第一测量数据,在所述第一跳变量大于第一预设阈值时,若所述第二测量数据不满足所述基础条件,则判定所述第一测量数据无效;

例如,若当前进行有效性判断的传感器为声纳传感器,当ds1>t2时,若雷达传感器测量的数据hr因超出雷达传感器的设计量程或者连续m个数据相等的情况无效时(即hr不满足基础条件),则可以判定当前时刻的hs也无效。

子步骤s42,若所述第二测量数据满足所述基础条件,则基于所述第一测量数据以及所述第二测量数据,判定所述第一测量数据是否有效。

例如,如果hr满足基础条件时,可以根据hr以及hs,判断hs是否有效。

在本发明实施例的一种优选实施例中,子步骤s42进一步可以包括如下子步骤:

子步骤s421,计算所述第一测量数据与所述第二测量数据的第一差值,以及所述第一差值对应的变化趋势;

子步骤s422,若所述第一差值小于第二预设阈值且所述变化趋势小于第三预设阈值,则判定所述第一测量数据有效;

子步骤s423,若所述第一差值大于或等于第二预设阈值,和/或,所述变化趋势大于或等于第三预设阈值,则判定所述第一测量数据无效。

具体的,当ds1>t2时,若雷达传感器测量的数据hr并没有因超出雷达传感器的设计量程或者连续m个数据相等的情况导致无效,则可以计算当前时刻的hr与hs的第一差值,以及该第一差值对应的变化趋势。

在一种实施方式中,第一差值drs=|hr-hs|,表示两个传感器的测量距离差。

第一差值对应的变化趋势ddrs=|hr-hs|-|hr_o-hs_o|,即当前距离差减去上一时刻的距离差。

如果drs小于第二预设阈值且ddrs小于第三预设阈值,则可以判定当前时刻的第一测量数据有效;否则,如果drs大于或等于第二预设阈值和/或ddrs大于或等于第三预设阈值,则可以判定当前时刻的第一测量数据无效。

在具体实现中,第二预设阈值可以设定为t3,其可以根据传感器的具体特性进行设置,通常阈值t2>2*阈值t3,例如,设定第二预设阈值t3为0.4m。

第三阈值可以设定为数值0。

在本发明实施例的一种优选实施例中,还可以包括如下步骤:

若上一时刻的在先初始测量数据有效,但当前时刻的初始测量数据无效,则将所述有效计数器清零。

例如,若上一时刻的初始测量数据有效,即true_s=1,当前时刻的初始测量数据无效,即true_s=0,则对应的有效计数器tc_s清零,即tc_s=0。

在本发明实施例中,无人机中一个传感器的数据有效性判断还会影响另一传感器的数据的有效性判断结果,则本发明实施例还可以包括如下步骤:

在所述第一测量数据因所述第一跳变量大于第一预设阈值的情况被判定为有效时,若上一时刻的在先第二测量数据因第二跳变量大于第一预设阈值的情况被判定无效,则将所述在先第二测量数据改判为有效。

例如,如果true_s=1,若上一时刻的hr_o状态无效,且是因为上一时刻或者之前对应的第二跳变量大于第一预设阈值而判定为无效状态,即由于dr1>t2时drs大于或等于第二预设阈值和/或ddrs大于或等于第三预设阈值,导致无效的,将hr_o的结果改判为有效。

在本发明实施例中,可以基于无人机的飞行参数,来对指定传感器测量的初始测量数据进行有效性判断,从而可以避免无效的数据对测量精度的影响,提高测量的精确度,从而提高无人机的作业质量。

在本发明实施例的一种优选实施例中,对初始测量数据进行有效性判断后,还可以基于有效的初始测量数据,确定初始对地距离。

在具体实现中,针对最新的n1个时刻获得的初始测量数据,可以确定其中的有效的初始测量数据的数量,以及,有效的初始测量数据的跳变量。如果这n1个时刻的初始测量数据没有同时发生无效,且有效的初始测量数据的数量不少于n1个,以及有效的初始测量数据的跳变量均小于阈值t1,则可以剔除无效的初始测量数据,对剩余的有效的初始测量数据进行加和取均值得到初始对地距离。随后,进入滤波处理流程,如图2所示,在滤波处理流程中,包括步骤203以及步骤204:

步骤203,基于所述飞行参数,确定所述初始测量数据对应的滤波系数;

在本发明实施例中,可以基于飞行参数来确定滤波系数。

在本发明实施例的一种优选实施例中,步骤203进一步可以包括如下子步骤:

步骤203-1,基于所述飞行参数,确定所述初始测量数据对应的第一衰减参数;

在本发明实施例的一种优选实施例中,步骤203-1可以包括如下子步骤:

步骤203-1-1,获取所述无人机当前时刻的初始测量数据与上一时刻的目标测量数据的测量差值;

具体的,指定传感器为一个,则测量差值为当前时刻的初始测量数据与上一时刻的目标测量数据的测量差值。

例如,hs对应的测量差值ds2=|hs-hsf|,hr对应的测量差值dr2=|hr-hrf|,其中,hsf、hrf分别为上一时刻的初始测量数据经过滤波处理后得到的目标测量数据。

在实际中,若指定传感器为两个以上,则测量差值可以为当前时刻的初始测量数据与上一时刻的进行融合处理后的数据的测量差值。

例如,hs对应的测量差值ds4=|hs-hout|,hr对应的测量差值dr4=|hr-hout|,其中,hout为上一时刻的初始测量数据经过滤波及融合处理后得到的数据。

步骤203-1-2,基于所述飞行参数,确定所述初始测量数据对应的跳变量;

跳变量的计算方式可以参考上述的初始距离确定流程,在此不再赘述了。

步骤203-1-3,在上一时刻对应的衰减参数小于所述跳变量时,若所述跳变量小于或等于预设跳变量阈值,则将所述衰减参数设置为所述跳变量,作为第一衰减参数;若所述跳变量大于预设跳变量阈值,则将所述第一衰减参数设置为根据变化趋势调节后的跳变量;

若初始测量数据为hs,其对应的第一衰减参数可以表示为epfs,如果上一时刻的epfs小于跳变量ds1,则判断另一传感器测量的初始测量数据hr是否有效以及ds1是否较大(如大于预设跳变量阈值fds1),如果此时hr有效且ds1>fds1,则计算epfs=ds1+ddrs,如果hr无效或者跳变量dr1<=fds1则计算epfs=ds1。

在具体实现中,fds1可以根据传感器的测量频率以及测量精度等实际情况设置,例如,fds1可以设置为0.5m。

得到epfs以后,可以对epfs进行限位处理,在一种实施方式中,其中一种限位处理方式如下:若epfs>阈值ep1,则epfs=ep1;若epfs<数值0,则epfs=数值0。

在具体实现中,ep1可以根据传感器的测量频率以及测量精度等特性的实际情况设置,例如,ep1可以设置为1m。

在实际中,指定传感器还具有对应的跳变计数器cpfs,在对epfs进行限位处理以后,还可以清零该跳变计数器,即cpfs=0。

步骤203-1-4,当上一时刻对应的衰减参数大于或等于所述跳变量时,若所述跳变量大于预设跳变量阈值,则清零所述跳变计数器,若所述跳变量小于或等于预设跳变量阈值,则将所述跳变计数器自增第一预设步长;若所述跳变计数器中的计数大于预设的延时系数阈值,则对上一时刻对应的衰减参数按照预设的衰减因子进行衰减计算,得到第一衰减参数;

具体的,如果上一时刻的epfs大于或等于跳变量ds1,若ds1>fds1,则清零跳变计数器,即cpfs=0,若ds1<=fds1,则将跳变计数器自增第一预设步长,即cpfs++。

若cpfs>预设的延时系数阈值j_r,则对上一时刻对应的衰减参数按照预设的衰减因子进行衰减计算,得到第一衰减参数。例如,epfs=epfs*sjr,其中,sjr为衰减因子。

在具体实现中,sjr越大衰减速度越慢,epfs越大则相应的滤波越强,sjr可以根据实际滤波带宽设置,其设置的取值范围可以为:0<sjr<1,例如,可以设置sjr=0.8。

j_r可以根据传感器的测量频率以及测量精度等实际情况设置,例如,设置j_r取值为5。

若cpfs<j_r,则保持epfs不变,即epfs=epfs。

步骤203-1-5,若所述第一衰减参数大于所述测量差值,则将所述第一衰减参数设置为所述测量差值。

每次确定第一衰减参数以后,可以将第一衰减参数epfs与上述测量差值ds2或ds4进行比较,如果epfs大于ds2或ds4,说明当前的测量结果准确率很高,此时,为了加快收敛条件,可以使得epfs=ds2或ds4。

步骤203-2,对所述第一衰减参数进行归一化变换,得到第二衰减参数;

最终确定第一衰减参数以后,可以对该第一衰减参数进行归一化变换,得到归一化后的第二衰减参数kpfs,其中,归一化的过程是将数据epfs由0到ep1变换到0到1区域。

在一种实施方式中,一种归一化变换的过程如下:

如果epfs<阈值ep2,kpfs=0;否则,

如果epfs>=ep2,则kpfs=1/(ep1-ep2)*epfs–ep2/(ep1-ep2)。

在具体实现中,ep2可以根据传感器的测量频率以及测量精度等特性的实际情况设置,例如,ep2可以设置为0.1m。

步骤203-3,基于所述第二衰减参数确定滤波系数,其中,所述滤波系数随着所述第二衰减参数的减小而增大。

例如,针对声纳传感器获得的初始测量数据hs,确定第二衰减参数kpfs以后,可以根据kpfs计算滤波系数ks,可以设定为kpfs越大则ks越小。

在一种实施方式中,可以采用非线性变换方法计算ks,例如,

ks=1.0-kpfs*kpfs。

在本发明实施例中,确定滤波系数以后,还可以对滤波系数进行限位处理,例如,针对ks,其中一种限位处理的方法如下:

如果ks>阈值k1,则ks=k1;

如果ks<阈值k2,则ks=k2。

其中,阈值k1、阈值k2可以根据实际低通滤波带宽要求进行设置,例如,可以设置为k1=0.5,k2=0.05。

步骤204,采用所述滤波系数,对所述初始测量数据进行滤波处理,得到目标测量数据。

在一种实施方式中,该滤波处理可以包括低通滤波处理,例如,针对hs,根据滤波系数进行低通滤波计算得到目标测量数据的公式如下:

hsf=hsf+ks*(hs-hsf)。

需要说明的是,除了低通滤波方式,还可以采用其他滤波方式进行滤波处理,例如,中值滤波、卡尔曼滤波等,本发明实施例对此不作限制。

在本发明实施例中,若指定传感器至少包括第一传感器以及第二传感器,根据上述的滤波流程,第一测量数据hs对应第一目标测量数据hsf,第二测量数据hr对应第二目标测量数据hrf。

则本发明实施例还可以包括如下步骤:对第一目标测量数据和/或第二目标测量数据进行修正。

例如,如果hsf同时大于hr和hs,则令hsf等于hr和hs两个数据中较大的那个;如果hsf同时小于hr和hs,则令hsf等于hr和hs两个数据中较小的那个。

同理,如果hrf(针对hr的目标测量数据)同时大于hr和hs,则令hrf等于hr和hs两个数据中较大的那个;如果hrf同时小于hr和hs,则令hrf等于hr和hs两个数据中较小的那个。

在本发明实施例的一种优选实施例中,当第一测量数据以及第二测量数据都有效时,则本发明实施例还可以包括数据融合流程,参考图4所示的数据融合步骤流程图,可以包括如下步骤:

步骤401,基于所述飞行参数,确定所述第一测量数据对应的第一权重值,以及,所述第二测量数据对应的第二权重值;

在本发明实施例的一种优选实施例中,步骤401进一步可以包括如下子步骤:

步骤401-1,计算所述第一目标测量数据以及所述第二目标测量数据之间的差值,记为目标数据差值;

例如,目标数据差值drfsf=|hrf-hsf|。

步骤401-2,若所述目标数据差值小于预设的滤波差值阈值,则计算第一滤波系数与第二滤波系数的第一加和,并将所述第一权重值设置为所述第一滤波系数占所述第一加和的比例,将所述第二权重值设置为所述第二滤波系数占所述第一加和的比例;

在具体实现中,如果drfsf<预设的滤波差值阈值drsf,说明两个传感器的滤波结果相差很近,此时,可以基于ks(第一滤波系数,即第一个指定传感器的滤波系数)以及kr(第二滤波系数,即第二个指定传感器的滤波系数),采用非线性多项式计算第一权重值ksh以及第二权重值krh。

在一种实施方式中,ksh=ks*ks/(ks*ks+kr*kr);krh=kr*kr/(ks*ks+kr*kr)。

在具体实现中,drsf可以根据传感器的测量精度和实际使用环境设置,例如,可以设置为drsf=0.3m。

步骤401-3,若所述目标数据差值大于或等于预设的滤波差值阈值,则计算上一时刻的融合测量数据与当前时刻的第一目标测量数据的第二差值,以及,计算上一时刻的融合测量数据与当前时刻的第二个目标测量数据的第三差值,并计算所述第二差值与所述第三差值的第二加和,将所述第一权重值设置为所述第二差值占所述第二加和的比例,将所述第二权重值设置为所述第三差值占所述第二加和的比例。

在具体实现中,如果drfsf>=预设的滤波差值阈值drsf,说明两个传感器的滤波结果相差比较大,此时,可以计算上一时刻的融合测量数据与当前时刻的第一个指定传感器的目标测量数据的第二差值ds3,以及,计算上一时刻的融合测量数据与当前时刻的第二个指定传感器的目标测量数据的第三差值dr3。

即,ds3=|hout-hsf|,dr3=|hout-hrf|。

随后,基于ds3以及dr3,采用非线性多项式计算第一权重值ksh以及第二权重值krh。

在一种实施方式中,ksh=ds3*ds3/(dr3*dr3+ds3*ds3);krh=dr3*dr3/(dr3*dr3+ds3*ds3)。

步骤402,采用所述第一权重值以及所述第二权重值,对所述第一测量数据以及所述第二测量数据进行融合处理,得到融合测量数据。

在本发明实施例的一种优选实施例中,步骤402可以包括如下子步骤:

步骤402-1,确定与当前时刻的飞行速度对应的修正因子;

在具体实现中,移动速度越大,修正因子越小。

例如,当移动速度大于或等于0.5m/s时,修正因子k_o=0.5;否则,当移动速度小于0.5m/s时,修正因子k_o=0.8。

步骤402-2,基于所述第一权重值以及所述第二权重值,对第一目标测量数据以及第二目标测量数据进行加权运算,得到校准测量数据;

具体的,校准测量数据=krh*hrf+ksh*hsf。

步骤402-3,基于所述修正因子,对所述校准测量数据以及上一时刻的融合测量数据进行融合计算,得到当前时刻的融合测量数据。

在一种实施方式中,融合测量数据hout=k_o*hout+(1.0f-k_o)*(krh*hrf+ksh*hsf)。

需要说明的是,上述融合公式还可以采用方差权重融合的方式,本发明实施例对此不作限定。

在本发明实施例的另一种实施例中,当hr有效,hs无效时,可以令krh=1.0f,ksh=0.0f,并采用如下公式进行融合计算:

hout=k_o*hout+(1.0f-k_o)*(krh*hrf+ksh*hsf)。

在这种情况下,还可以对声纳滤波进行修正,令ks等于一个较小的固定值(例如,设定ks=0.1),对声纳滤波器进行修正计算的公式如下:hsf=hsf+ks*(hout-hsf)。

在本发明实施例的另一种实施例中,当hr无效,hs有效时,可以令ksh=1.0f,krh=0.0f,并采用如下公式进行融合计算:

hout=k_o*hout+(1.0f-k_o)*(krh*hrf+ksh*hsf)。

在这种情况下,还可以对雷达滤波进行修正,令kr等于一个较小的固定值(例如,设定kr=0.1),对雷达滤波器进行修正计算的公式如下:hrf=hrf+kr*(hout-hrf)。

当hr无效,hs也无效时,则可以保持上一时刻的数据,并给出当前时刻的数据无效的判定结果,如果长时间两个传感器的数据同时无效则重新进行初始化流程。

在本发明实施例中,结合无人机在移动过程中高度及升降速度连续变化的特点,对无人机中两个或以上的指定传感器的测量数据进行有效性判断、滤波及融合,得到融合测量数据,可以有效滤除无人机环境下两个或以上指定传感器的测量数据的噪声和测量错误,滤波融合效果好,且相位延时小,响应灵敏,提高了无人机离地高度数据测量的准确性和稳定性。

需要说明的是,对于方法实施例,为了简单描述,故将其都表述为一系列的动作组合,但是本领域技术人员应该知悉,本发明实施例并不受所描述的动作顺序的限制,因为依据本发明实施例,某些步骤可以采用其他顺序或者同时进行。其次,本领域技术人员也应该知悉,说明书中所描述的实施例均属于优选实施例,所涉及的动作并不一定是本发明实施例所必须的。

参照图5,示出了本发明的一种数据处理的装置实施例的结构框图,可以包括如下模块:

初始测量数据获取模块501,用于当达到测量时机时,获取无人机中的指定传感器测量的初始测量数据;

飞行参数获取模块502,用于获取所述无人机实时的飞行参数;

滤波处理模块503,用于基于所述飞行参数,对所述初始测量数据进行滤波处理,得到目标测量数据。

在本发明实施例的一种优选实施例中,所述滤波处理模块503可以包括如下子模块:

滤波系数确定子模块,用于基于所述飞行参数,确定所述初始测量数据对应的滤波系数;

目标测量数据确定子模块,用于采用所述滤波系数,对所述初始测量数据进行滤波处理,得到目标测量数据。

在本发明实施例的一种优选实施例中,所述滤波系数确定子模块包括:

衰减参数确定单元,用于基于所述飞行参数,确定所述初始测量数据对应的第一衰减参数;

归一化变换单元,用于对所述第一衰减参数进行归一化变换,得到第二衰减参数;

滤波系数确定单元,用于基于所述第二衰减参数确定滤波系数,其中,所述滤波系数随着所述第二衰减参数的减小而增大。

在本发明实施例的一种优选实施例中,所述第一衰减参数对应设置有跳变计数器,所述衰减参数确定单元还包括:

测量差值确定子单元,用于获取所述无人机当前时刻的初始测量数据与上一时刻的目标测量数据的测量差值;

跳变量确定子单元,用于基于所述飞行参数,确定所述初始测量数据对应的跳变量;

第一参数确定子单元,用于在上一时刻对应的衰减参数小于所述跳变量时,若所述跳变量小于或等于预设跳变量阈值,则将所述衰减参数设置为所述跳变量,作为第一衰减参数;若所述跳变量大于预设跳变量阈值,则将所述第一衰减参数设置为根据变化趋势调节后的跳变量;

第二参数确定子单元,用于当上一时刻对应的衰减参数大于或等于所述跳变量时,若所述跳变量大于预设跳变量阈值,则清零所述跳变计数器,若所述跳变量小于或等于预设跳变量阈值,则将所述跳变计数器自增第一预设步长;若所述跳变计数器中的计数大于预设的延时系数阈值,则对上一时刻对应的衰减参数按照预设的衰减因子进行衰减计算,得到第一衰减参数;

第三参数确定子单元,用于若所述第一衰减参数大于所述测量差值,则将所述第一衰减参数设置为所述测量差值。

在本发明实施例的一种优选实施例中,所述飞行参数包括无人机所处的海拔高度,所述跳变量确定子单元还用于:

获取所述无人机当前时刻的海拔高度与上一时刻的海拔高度之间的海拔变化量;

确定当前时刻的初始测量数据与上一时刻的在先初始测量数据之间的测量变化值;

将所述测量变化值补偿所述海拔变化量,得到所述初始测量数据对应的跳变量。

在本发明实施例的一种优选实施例中,所述滤波系数确定单元还用于:

对所述第二衰减参数进行非线性多项式运算,得到所述滤波系数。

在本发明实施例的一种优选实施例中,还包括:

限位处理模块,用于对所述滤波系数进行限位处理。

在本发明实施例的一种优选实施例中,还包括:

有效性判断模块,用于判断所述初始测量数据是否有效,若所述初始测量数据有效,则调用所述滤波处理模块。

对于图5的装置实施例而言,由于其与上述的方法实施例基本相似,所以描述的比较简单,相关之处参见方法实施例的部分说明即可。

另外,本发明实施例还公开了一种飞行器,包括存储器、处理器及存储在存储器上并可在处理器上运行的计算机程序,所述处理器执行所述程序时实现上述实施例所述方法的步骤。

另外,本发明实施例还公开了一种计算机可读存储介质,其上存储有计算机程序,该程序被处理器执行时实现上述实施例所述方法的步骤。

本说明书中的各个实施例均采用递进的方式描述,每个实施例重点说明的都是与其他实施例的不同之处,各个实施例之间相同相似的部分互相参见即可。

本领域内的技术人员应明白,本发明实施例的实施例可提供为方法、装置、或计算机程序产品。因此,本发明实施例可采用完全硬件实施例、完全软件实施例、或结合软件和硬件方面的实施例的形式。而且,本发明实施例可采用在一个或多个其中包含有计算机可用程序代码的计算机可用存储介质(包括但不限于磁盘存储器、cd-rom、光学存储器等)上实施的计算机程序产品的形式。

本发明实施例是参照根据本发明实施例的方法、终端设备(系统)、和计算机程序产品的流程图和/或方框图来描述的。应理解可由计算机程序指令实现流程图和/或方框图中的每一流程和/或方框、以及流程图和/或方框图中的流程和/或方框的结合。可提供这些计算机程序指令到通用计算机、专用计算机、嵌入式处理机或其他可编程数据处理终端设备的处理器以产生一个机器,使得通过计算机或其他可编程数据处理终端设备的处理器执行的指令产生用于实现在流程图一个流程或多个流程和/或方框图一个方框或多个方框中指定的功能的装置。

这些计算机程序指令也可存储在能引导计算机或其他可编程数据处理终端设备以特定方式工作的计算机可读存储器中,使得存储在该计算机可读存储器中的指令产生包括指令装置的制造品,该指令装置实现在流程图一个流程或多个流程和/或方框图一个方框或多个方框中指定的功能。

这些计算机程序指令也可装载到计算机或其他可编程数据处理终端设备上,使得在计算机或其他可编程终端设备上执行一系列操作步骤以产生计算机实现的处理,从而在计算机或其他可编程终端设备上执行的指令提供用于实现在流程图一个流程或多个流程和/或方框图一个方框或多个方框中指定的功能的步骤。

尽管已描述了本发明实施例的优选实施例,但本领域内的技术人员一旦得知了基本创造性概念,则可对这些实施例做出另外的变更和修改。所以,所附权利要求意欲解释为包括优选实施例以及落入本发明实施例范围的所有变更和修改。

最后,还需要说明的是,在本文中,诸如第一和第二等之类的关系术语仅仅用来将一个实体或者操作与另一个实体或操作区分开来,而不一定要求或者暗示这些实体或操作之间存在任何这种实际的关系或者顺序。而且,术语“包括”、“包含”或者其任何其他变体意在涵盖非排他性的包含,从而使得包括一系列要素的过程、方法、物品或者终端设备不仅包括那些要素,而且还包括没有明确列出的其他要素,或者是还包括为这种过程、方法、物品或者终端设备所固有的要素。在没有更多限制的情况下,由语句“包括一个……”限定的要素,并不排除在包括所述要素的过程、方法、物品或者终端设备中还存在另外的相同要素。

以上对本发明所提供的一种数据处理的方法及装置进行了详细介绍,本文中应用了具体个例对本发明的原理及实施方式进行了阐述,以上实施例的说明只是用于帮助理解本发明的方法及其核心思想;同时,对于本领域的一般技术人员,依据本发明的思想,在具体实施方式及应用范围上均会有改变之处,综上所述,本说明书内容不应理解为对本发明的限制。

当前第1页1 2 
网友询问留言 已有0条留言
  • 还没有人留言评论。精彩留言会获得点赞!
1