CN107783548A - 基于多传感器信息融合技术的数据处理方法 - Google Patents
基于多传感器信息融合技术的数据处理方法 Download PDFInfo
- Publication number
- CN107783548A CN107783548A CN201610728667.2A CN201610728667A CN107783548A CN 107783548 A CN107783548 A CN 107783548A CN 201610728667 A CN201610728667 A CN 201610728667A CN 107783548 A CN107783548 A CN 107783548A
- Authority
- CN
- China
- Prior art keywords
- data
- unmanned aerial
- aerial vehicle
- obstacle
- sensor
- 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.)
- Granted
Links
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
- 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
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01D—MEASURING NOT SPECIALLY ADAPTED FOR A SPECIFIC VARIABLE; ARRANGEMENTS FOR MEASURING TWO OR MORE VARIABLES NOT COVERED IN A SINGLE OTHER SUBCLASS; TARIFF METERING APPARATUS; MEASURING OR TESTING NOT OTHERWISE PROVIDED FOR
- G01D21/00—Measuring or testing not otherwise provided for
- G01D21/02—Measuring two or more variables by means not covered by a single other subclass
Abstract
基于多传感器信息融合技术的数据处理方法，包括：数据采集层使用各个传感器对无人机飞行环境中的障碍物数据进行采集：毫米波防撞雷达传感器输出数据为无人机与障碍物的相对距离R1、相对速度V1、障碍物与雷达法线之间的角度θ1；超声波传感器采集无人机与障碍物的相对距离R2；毫米波雷达高度表输出无人机与地面的相对高度值H1；GPS/北斗定位传感器输出无人机对地的海拔高度值H2；消除传感器间可能存在的冗余和矛盾的数据，加以互补，降低其不确定性，以形成对系统环境的相对完整一致的感知描述，从而提高智能系统的决策、规划、反映的快速性和正确性，降低决策风险。
Description
技术领域
本发明属于无人机避障技术领域，尤其涉及一种基于多传感器信息融合技术的数据处理方法。
背景技术
农业植保无人机在美国、俄罗斯、日本等国运用的非常普遍，技术也十分先进，然而中国作为农业大国，18亿亩基本农田，农业植保无人机却尚未得到普及。但是，我国的农业植保无人机市场正值上升阶段，正因为尚未普及所以市场大有作为。中国每年需要大量的人员从事农业植保作业，而我国每年农药中毒人数有10万之众，同时，农村青壮年劳动力逐渐稀缺，人力成本日益增加。植保无人机则可远距离遥控操作，避免了喷洒作业人员暴露于农药的危险，保障了喷洒作业的安全。
植保无人机，是用于农林植物保护作业的无人驾驶飞机，该型无人飞机由飞行平台、GPS飞控、喷洒机构三部分组成，通过地面遥控或GPS飞控，来实现喷洒作业，可以喷洒药剂、种子、粉剂等。植保无人机采用高效无刷电机作为动力，机身振动小，可以搭载精密仪器，喷洒农药等更加精准；同时，植被地形要求低，作业不受海拔限制；植保无人机起飞调校短、效率高、出勤率高；植保无人机具有环保，无废气，符合国家节能环保和绿色有机农业发展要求。
植保无人机不断普及，开始走进普通老百姓的生活。但是植保无人机由于没有采用相关的防碰撞防护，导致植保无人机在作业过程中，增加了很多的限制，如作业田块周界10米范围内要求无人员居住的房舍，作业田块周界10米范围内无防护林、高压线塔、电杆等障碍物，作业田块中间无影响飞行安全的障碍物或影响飞行视线的障碍物，作物高度应低于操作人员的视线，操作人员能够观察到飞机飞行姿态等要求，这些限制将会使得植保无人机的使用受到一定的地域限制，不利于植保无人机的全面普及。
发明内容
本发明提供了一种基于多传感器信息融合技术的数据处理方法，通过数据融合，最优化的利用各个传感器的特性进行相应数据的融合，同时采用数据融合技术，可以更好地提高数据的准确性。
本申请的技术方案是：一种基于多传感器信息融合技术的数据处理方法，包括：数据采集层使用各个传感器对无人机飞行环境中的障碍物数据进行采集：
1)毫米波防撞雷达传感器输出数据为无人机与障碍物的相对距离R1、相对速度V1、障碍物与雷达法线之间的角度θ1；
2)超声波传感器采集无人机与障碍物的相对距离R2；
3)毫米波雷达高度表输出无人机与地面的相对高度值H1；
4)GPS/北斗定位传感器输出无人机对地的海拔高度值H2；
5)AHRS模块输出三维加速度A_x,A_y,A_z、三维角速度w_x,w_y,w_z和三维地磁场强度m_x,m_y,m_z，通过上述数据解算出无人机当前的姿态数据。
进一步的，所述姿态数据，包括飞行方位角θ2、俯仰角ψ1和翻滚角
进一步的，所述数据预处理层，包括：异常数据处理和数据缺失补偿两个步骤；
异常数据处理的步骤为：首先在采集到的各个传感器数据中找出异常值，采用求平均移动线的方法，进行异常数据处理；设含有异常数据序列为{xi,i＝1,2,Λ}，当i＝n时出现异常值，则用移动平均线xn替代，即利用i＝n之前的N个数据取其均值计算出xn；计算公式如下：
进一步的，数据缺失补偿的步骤为：设含有数据缺失序列为{xi,i＝1,2,Λ}，数据长度N，缺失数据点的前N个点的检测值的序列为xn,n＝1,2,Λ,N，需要平滑处理的步数m；
首先进行一次指数平滑计算，计算公式为：S′n＝αxn+(1-α)S′n-1，其中S′n为第一次平滑后的第n个数据均值，S′n-1为第一次平滑后的第n-1个数据均值，S′n-1的计算公式为：α为平滑常数，xn为数据缺失序列中的第n个数据值；
然后进行二次指数平滑计算，计算公式为：S″n＝αS′n+(1-α)S″n-1，其中S″n为第二次平滑后的第n个数据均值，S″n-1为第二次平滑后的第n-1个数据均值，S″n-1的计算公式为：α为平滑常数，S′n为第一次平滑后的第n个数据均值；
最后是进行三次指数平滑计算，计算公式为：S″′n＝αS″n+(1-α)S″′n-1，其中S″′n为第三次平滑后的第n个数据均值，S″′n-1为第三次平滑后的第n-1个数据均值，S″′n-1的计算公式为：α为平滑常数，S″n为第二次平滑后的第n个数据均值；
xn+m＝an+bnm+cnm2/2，其中，xn+m为第n+m个数据的预测值，m为由n开始向后平滑处理的步数，α取0.5，an，bn，cn的计算公式如下所示：
进一步的，数据融合层进行无人机与障碍物相对距离的数据融合：
A、距离在0m到1m范围内，对超声波雷达传感器采集的数据进行kalman数据融合；
B、距离在1m到10m范围内,采用超声波雷达传感器和毫米波防撞雷达传感器进行检测，然后加权平均，即引入α的加权值对超声波雷达传感器和毫米波防撞雷达传感器进行加权平均，将加权融合后的数据进行kalman数据融合；
C、距离在10m到50m范围内,直接对毫米波防撞雷达传感器采集的数据进行kalman数据融合。
更进一步的，根据不同的实际距离，各个传感器采集计算的距离如下：
更进一步的，数据融合层进行无人机与地面相对高度的数据融合，毫米雷达高度表和GPS/北斗定位传感器所获取的无人机高度值进行数据融合，高度值的数据融合根据距离分为两种；
对于高度小于50m的范围内，采用毫米雷达高度表和GPS/北斗定位传感器对无人机高度进行检测，检测后的结果采用加权平均，即引入α值对这两种传感器的高度值进行加权平均处理，处理后采用kalman对高度值进行数据融合；根据AHRS航姿数据对高度值进行修正：
对于高度大于50m以上，采用GPS/北斗定位传感器，将获取的高度数据直接进行kalman数据融合，然后，采用AHRS航姿数据进行高度修正；
其中H1是毫米雷达高度表采集的高度，H2是GPS/北斗定位传感器采集的高度。
作为更进一步的，决策层通过如下步骤完成避障的：
P1,首先判断无人机与障碍物的相对距离，将相对距离进行三个部分的划分:小于N1m，N1m到N2m，N2m到N3m三个距离范围；
P2,距离划分完成后，根据无人机与障碍物的相对速度进行危险等级的划分:
P3,然后判断无人机与地面的高度值，将该高度值H进行两个等级的划分；
P4：对于危险等级，需要进行步骤P3的操作；对于警示等级，需要紧急减速后进行步骤P3的操作；对于提示等级和不相关等级，不用进行第三步骤的判断，返回重新进行检测。
作为更进一步的，步骤P2具体为：当距离小于N1m，速度大于M1m/s,且预警时间小于Qs，则属于危险等级，速度小于M1m/s时，属于警示等级；
当距离N1m≤R<N2m，速度大于M2m/s时,处于危险等级；当速度M1m/s≤V<M2m/s时，处于警示等级，当速度小于M1m/s时，处于提示等级；
当距离N2m≤R<N3m时，当速度大于M3m/s时,处于危险等级；当速度M2m/s≤V<M3m/s时，处于警示等级，当速度M1m/s≤V<M2m/s时，处于提示等级，当速度小于M1m/s时，处于不相关等级；
作为更进一步的，步骤P3具体为：当高度0m≤H<50m，根据毫米波防撞雷达传感器进行无人机与障碍物方位角的判断，如果障碍物处于无人机的左边，则控制无人机进行右偏飞行，躲避障碍物；如果障碍物处于无人机的右边，控制无人机进行左偏飞行，躲避障碍物；如果障碍物处于无人机的正前方，则无人机爬升进行避障；
当高度H≥50m，根据毫米波防撞雷达进行无人机与障碍物方位角的判断，如果障碍物处于无人机的左边，则控制无人机进行右偏飞行，躲避障碍物，如果障碍物处于无人机的右边，控制无人机进行左偏飞行，躲避障碍物；如果障碍物处于无人机飞行的正前方，采用紧急悬停后进行折返避障。
本发明由于采用以上技术方案，能够取得如下的技术效果：
本申请能够更好地实现单旋翼植保无人机对植保环境的感知，获得更加准确的障碍物数据信息，做出更准确的避障决策以及做出避障控制。对于无人机与障碍物的相对速度以及无人机与地面高度值都是利用各个传感器的优缺点，互相弥补，进行数据融合，以提高数据精度，改善系统可靠性。
单旋翼植保无人机系统通过合理支配和充分使用多个传感器的数据资源，使得多传感器在时间和空间上的冗余或互补信息进行组合处理，以获得环境以及障碍物目标特征获取的一致性的描述。
附图说明
为了更清楚的说明本发明的实施例或现有技术的技术方案，下面将对实施例或现有技术描述中所需要使用的附图做一简单地介绍，显而易见地，下面描述中的附图仅仅是本发明的一些实施例，对于本领域普通技术人员来讲，在不付出创造性劳动的前提下，还可以根据这些附图获得其他的附图。
图1为实施例1中检测装置结构框图；
图2基于多传感器信息融合技术的数据处理方法结构框图；
图3为实施例中数据融合层进行无人机与障碍物相对距离的数据融合流程图；
图4为实施例中数据融合层进行无人机与地面相对高度的数据融合流程图；
图5为决策层控制无人机的示意图；
图6为实施例中决策层完成避障的流程图。
具体实施方式
为使本发明的实施例的目的、技术方案和优点更加清楚，下面结合本发明实施例中的附图，对本发明实施例中的技术方案进行清楚完整的描述：
本申请是针对单旋翼的植保无人机，单旋翼植保无人机旋翼大，飞行稳定，抗风条件好，风场稳定，雾化效果好，下旋风力大，穿透力强，农药可以打到农作物的根茎部位；核心部件为进口电机，构件为航空铝材，碳纤材料，结实耐用，性能稳定；飞行植保作业历时2年多，连续植保10万亩/次以上，无重大故障，飞行驾驶简便易学，稳定智能的飞控系统，傻瓜式的操作模式经过简单培训就可上手。
实施例1
本实施例提供了一种基于多传感器信息融合技术的数据处理方法，包括：数据采集层、数据预处理层、数据融合层、决策层和检测装置；
所述检测装置，包括：
毫米波雷达高度表，对无人机与地面的相对高度进行测量；
GPS/北斗定位传感器，采集定位信息、无人机海拔高度、无人机飞行速度等；
AHRS模块，采集无人机飞行姿态数据；
毫米波防撞雷达传感器，采集无人机与障碍物的相对速度、相对距离以及方位角等；
超声波雷达传感器，用于对障碍物的相对距离进行采集；
主控制器，通过对各个传感器获得的数据进行分析，控制无人机完成避障动作；
所述主控制器分别与毫米波雷达高度表、GPS/北斗定位传感器、AHRS模块、毫米波防撞雷达传感器、超声波雷达传感器相连。
可选地，所述毫米波防撞雷达传感器、超声波雷达传感器安装在无人机前方，超声波雷达传感器进行0～10米范围的测距，毫米波防撞雷达传感器进行1～50m范围内的测距。
可选地，AHRS模块，包括MEMS的三轴陀螺仪、加速度计和磁强计，输出数据为三维加速度、三维角速度和三维地磁场强度。
实施例2
作为对实施例1的补充，数据采集层使用各个传感器对无人机飞行环境中的障碍物数据进行采集：
1)毫米波防撞雷达传感器输出数据为无人机与障碍物的相对距离R1、相对速度V1、障碍物与雷达法线之间的角度θ1，即(R1,V1,θ1)；
2)超声波传感器采集无人机与障碍物的相对距离R2；
3)毫米波雷达高度表输出无人机与地面的相对高度值H1；
4)GPS/北斗定位传感器输出无人机对地的海拔高度值H2；GPS数据遵循NMEA0183协议，所输出的信息都是标准的具有固定格式的。其中与无人机导航密切相关的有GPGGA和GPVTG语句。它们的数据格式规定如下：
(1)$GPGGA，UTC时间，纬度，纬度半球，经度，经度半球，GPS模式，星数，HDOP水平精度因子，海拔高度，M，地球椭球面相对大地水平面的高度，M，差分时间，差分站ID*hh<CR><LF>。
(2)$GPVTG，以真北为基准的地面航向，T，以磁北为基准的地面航向，M，地面速率(节)，N，地面速率(公里/小时)，K，模式指示*hh<CR><LF>。通过提取GPGGA语句中，特定位置的海拔高度数据，可以得到无人机的海拔高度H2。
5)AHRS模块输出三维加速度A_x,A_y,A_z、三维角速度w_x,w_y,w_z和三维地磁场强度m_x,m_y,m_z，通过上述数据解算出无人机当前的姿态数据，即飞行方位角θ2、俯仰角ψ1和翻滚角
实施例3
由于数据在采集过程中可能会存在数据缺失等情况，以及后续数据进行融合处理时，需要提前进行数据集成等工作，因此需要进行数据预处理等工作；所述数据预处理层，包括：异常数据处理和数据缺失补偿两个步骤；
异常数据的存在会大大影响预测的准确性；因此提供一种异常数据处理的步骤为：首先在采集到的各个传感器数据中找出异常值，采用求平均移动线的方法，进行异常数据处理；设含有异常数据序列为{xi,i＝1,2,Λ}，当i＝n时出现异常值，则用移动平均线xn替代，即利用i＝n之前的N个数据取其均值计算出xn；计算公式如下：
数据的丢失会严重影响后续的数据处理的准确性和连续性。在采集到的各个传感器的数据中可能在若干长度的连续数据或某个数据点出现数据缺失的问题，而且对于各个传感器采集到的数据可能构成具有2次、3次或高次的数据模型，所以需要用高次平滑形式。因此对于所有缺失的若干长度的连续数据或某个数据点，采用布朗3次指数平滑法进行处理。布朗3次指数平滑法由从线性平滑再进行1次平滑过渡到2次多项式平滑，即是3次平滑。本发明采用布朗3次指数平滑法对缺失的数据进行平滑处理。
数据缺失补偿的步骤为：设含有数据缺失序列为{xi,i＝1,2,Λ}，数据长度N，缺失数据点的前N个点的检测值的序列为xn,n＝1,2,Λ,N，需要平滑处理的步数m；
首先进行一次指数平滑计算，计算公式为：S′n＝αxn+(1-α)S′n-1，其中S′n为第一次平滑后的第n个数据均值，S′n-1为第一次平滑后的第n-1个数据均值，S′n-1的计算公式为：α为平滑常数，xn为数据缺失序列中的第n个数据值；
然后进行二次指数平滑计算，计算公式为：S″n＝αS′n+(1-α)S″n-1，其中S″n为第二次平滑后的第n个数据均值，S″n-1为第二次平滑后的第n-1个数据均值，S″n-1的计算公式为：α为平滑常数，S′n为第一次平滑后的第n个数据均值；
最后是进行三次指数平滑计算，计算公式为：S″′n＝αS″n+(1-α)S″′n-1，其中S″′n为第三次平滑后的第n个数据均值，S″′n-1为第三次平滑后的第n-1个数据均值，S″′n-1的计算公式为：α为平滑常数，S″n为第二次平滑后的第n个数据均值；
xn+m＝an+bnm+cnm2/2，其中，xn+m为第n+m个数据的预测值，m为由n开始向后平滑处理的步数，α取0.5，an，bn，cn的计算公式如下所示：
实施例4
本实施例针对数据融合层进行详细讲述，数据融合层进行无人机与障碍物相对距离的数据融合：
A、距离在0m到1m范围内，超声波传感器采集到的相对距离值精度更高，毫米波防撞雷达传感器对于1m范围内会存在一定的盲区，所以在这区间范围的数据使用超声波雷达传感器采集的数据进行kalman数据融合；
B、距离在1m到10m范围内,采用超声波雷达传感器和毫米波防撞雷达传感器进行检测，所以在该距离范围内，然后加权平均，即引入α的加权值对超声波雷达传感器和毫米波防撞雷达传感器进行加权平均，将加权融合后的数据进行kalman数据融合；
C、距离在10m到50m范围内,已经超出超声波雷达的测距范围，但是毫米波防撞雷达传感器还可以进行检测，所以在该距离范围内，直接对毫米波防撞雷达传感器采集的数据进行ka lman数据融合；
即如下所示
数据融合层进行无人机与地面相对高度的数据融合，毫米雷达高度表和GPS/北斗定位传感器所获取的无人机高度值进行数据融合，高度值的数据融合根据距离分为两种；
对于高度小于50m的范围内，采用毫米雷达高度表和GPS/北斗定位传感器对无人机高度进行检测，检测后的结果采用加权平均，即引入α值对这两种传感器的高度值进行加权平均处理，处理后采用ka lman对高度值进行数据融合；根据AHRS航姿数据对高度值进行修正：
对于高度大于50m以上，采用GPS/北斗定位传感器，将获取的高度数据直接进行kalman数据融合，然后，采用AHRS航姿数据进行高度修正；
其中H1是毫米雷达高度表采集的高度，H2是GPS/北斗定位传感器采集的高度。
可选地，AHRS航姿数据进行高度修正具体为：
ψ1为俯仰角和为翻滚角。H为测量高度，H′为修正后的高度值。
实施例5
本实施例对决策层进行详细说明，决策层通过如下步骤完成避障的：
P1,首先判断无人机与障碍物的相对距离，将相对距离进行三个部分的划分:小于N1m，N1m到N2m，N2m到N3m三个距离范围；
P2,距离划分完成后，根据无人机与障碍物的相对速度进行危险等级的划分:
当距离小于N1m，速度大于M1m/s,且预警时间小于Qs，则属于危险等级，速度小于M1m/s时，属于警示等级；
当距离N1m≤R<N2m，速度大于M2m/s时,处于危险等级；当速度M1m/s≤V<M2m/s时，处于警示等级，当速度小于M1m/s时，处于提示等级；
当距离N2m≤R<N3m时，当速度大于M3m/s时,处于危险等级；当速度M2m/s≤V<M3m/s时，处于警示等级，当速度M1m/s≤V<M2m/s时，处于提示等级，当速度小于M1m/s时，处于不相关等级；
P3,然后判断无人机与地面的高度值，将该高度值H进行两个等级的划分；
当高度0m≤H<50m，根据毫米波防撞雷达传感器进行无人机与障碍物方位角的判断，主要进行障碍物在无人机飞行过程中得左边，右边，还是正前方。如果障碍物处于无人机的左边，则控制无人机进行右偏飞行，躲避障碍物；同理如果障碍物处于无人机的右边，控制无人机进行左偏飞行，躲避障碍物；如果障碍物处于无人机的正前方，则无人机爬升进行避障；
当高度H≥50m，根据毫米波防撞雷达进行无人机与障碍物方位角的判断，主要进行障碍物在无人机飞行过程中得左边，右边，还是正前方。如果障碍物处于无人机的左边，则控制无人机进行右偏飞行，躲避障碍物，同理如果障碍物处于无人机的右边，控制无人机进行左偏飞行，躲避障碍物；如果障碍物处于无人机飞行的正前方，由于此时无人机高度已经相对很高，对于这种情况采用紧急悬停后进行折返避障。
P4：对于危险等级，需要进行步骤P3的操作；对于警示等级，需要紧急减速后进行步骤P3的操作；对于提示等级和不相关等级，不用进行第三步骤的判断，返回重新进行检测。
产生控制指令后，向无人机主控制器发送控制命令，然后控制无人机舵机控制系统，控制无人机进行悬停折返、爬升、向右或向左偏飞行等避障动作，完成障碍。本申请给出了基于多传感器数据融合技术的单旋翼植保无人机避障系统实现原理以及给出多传感器融合技术方法；采用多传感器信息融合技术，能够更好地实现单旋翼植保无人机对植保环境的感知，获得更加准确的障碍物数据信息，做出更准确的避障决策以及做出避障控制还给出了数据预处理的流程以及给出相应的解决方案，为后续数据处理提供了更精准的数据信息。
以上所述，仅为本发明较佳的具体实施方式，但本发明的保护范围并不局限于此，任何熟悉本技术领域的技术人员在本发明披露的技术范围内，根据本发明的技术方案及其发明构思加以等同替换或改变，都应涵盖在本发明的保护范围之内。
Claims (10)
1.基于多传感器信息融合技术的数据处理方法，其特征在于，包括：数据采集层使用各个传感器对无人机飞行环境中的障碍物数据进行采集：
1)毫米波防撞雷达传感器输出数据为无人机与障碍物的相对距离R1、相对速度V1、障碍物与雷达法线之间的角度θ1；
2)超声波传感器采集无人机与障碍物的相对距离R2；
3)毫米波雷达高度表输出无人机与地面的相对高度值H1；
4)GPS/北斗定位传感器输出无人机对地的海拔高度值H2；
5)AHRS模块输出三维加速度A_x,A_y,A_z、三维角速度w_x,w_y,w_z和三维地磁场强度m_x,m_y,m_z，通过上述数据解算出无人机当前的姿态数据。
2.根据权利要求1所述基于多传感器信息融合技术的数据处理方法，其特征在于，所述姿态数据，包括飞行方位角θ2、俯仰角ψ1和翻滚角
3.根据权利要求1所述基于多传感器信息融合技术的数据处理方法，其特征在于，数据预处理层，包括：异常数据处理和数据缺失补偿两个步骤；
异常数据处理的步骤为：首先在采集到的各个传感器数据中找出异常值，采用求平均移动线的方法，进行异常数据处理；设含有异常数据序列为{xi,i＝1,2,Λ}，当i＝n时出现异常值，则用移动平均线xn替代，即利用i＝n之前的N个数据取其均值计算出xn；计算公式如下：
<mrow>
<msub>
<mi>x</mi>
<mi>n</mi>
</msub>
<mo>=</mo>
<mfrac>
<mrow>
<munderover>
<mo>&Sigma;</mo>
<mrow>
<mi>i</mi>
<mo>=</mo>
<mi>n</mi>
<mo>-</mo>
<mi>N</mi>
</mrow>
<mrow>
<mi>n</mi>
<mo>-</mo>
<mn>1</mn>
</mrow>
</munderover>
<msub>
<mi>x</mi>
<mi>i</mi>
</msub>
</mrow>
<mi>N</mi>
</mfrac>
<mo>.</mo>
</mrow>
4.根据权利要求3所述基于多传感器信息融合技术的数据处理方法，其特征在于，数据缺失补偿的步骤为：设含有数据缺失序列为{xi,i＝1,2,Λ}，数据长度N，缺失数据点的前N个点的检测值的序列为xn,n＝1,2,Λ,N，需要平滑处理的步数m；
首先进行一次指数平滑计算，计算公式为：S′n＝αxn+(1-α)S′n-1，其中S′n为第一次平滑后的第n个数据均值，S′n-1为第一次平滑后的第n-1个数据均值，S′n-1的计算公式为：α为平滑常数，xn为数据缺失序列中的第n个数据值；
然后进行二次指数平滑计算，计算公式为：S″n＝αS′n+(1-α)S″n-1，其中S″n为第二次平滑后的第n个数据均值，S″n-1为第二次平滑后的第n-1个数据均值，S″n-1的计算公式为：α为平滑常数，S′n为第一次平滑后的第n个数据均值；
最后是进行三次指数平滑计算，计算公式为：S″′n＝αS″n+(1-α)S″′n-1，其中S″′n为第三次平滑后的第n个数据均值，S″′n-1为第三次平滑后的第n-1个数据均值，S″′n-1的计算公式为：α为平滑常数，S″n为第二次平滑后的第n个数据均值；
xn+m＝an+bnm+cnm2/2，其中，xn+m为第n+m个数据的预测值，m为由n开始向后平滑处理的步数，α取0.5，an，bn，cn的计算公式如下所示：
<mrow>
<mfenced open = "{" close = "">
<mtable>
<mtr>
<mtd>
<mrow>
<msub>
<mi>a</mi>
<mi>n</mi>
</msub>
<mo>=</mo>
<mn>3</mn>
<msubsup>
<mi>S</mi>
<mi>n</mi>
<mo>&prime;</mo>
</msubsup>
<mo>-</mo>
<mn>3</mn>
<msubsup>
<mi>S</mi>
<mi>n</mi>
<mrow>
<mo>&prime;</mo>
<mo>&prime;</mo>
</mrow>
</msubsup>
<mo>+</mo>
<msup>
<mi>S</mi>
<mrow>
<mo>&prime;</mo>
<mo>&prime;</mo>
<mo>&prime;</mo>
</mrow>
</msup>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mi>b</mi>
<mi>n</mi>
</msub>
<mo>=</mo>
<mfrac>
<mi>&alpha;</mi>
<mrow>
<mn>2</mn>
<msup>
<mrow>
<mo>(</mo>
<mrow>
<mn>1</mn>
<mo>-</mo>
<mi>&alpha;</mi>
</mrow>
<mo>)</mo>
</mrow>
<mn>2</mn>
</msup>
</mrow>
</mfrac>
<mrow>
<mo>&lsqb;</mo>
<mrow>
<mrow>
<mo>(</mo>
<mrow>
<mn>6</mn>
<mo>-</mo>
<mn>5</mn>
<mi>&alpha;</mi>
</mrow>
<mo>)</mo>
</mrow>
<msubsup>
<mi>S</mi>
<mi>n</mi>
<mo>&prime;</mo>
</msubsup>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mrow>
<mn>10</mn>
<mo>-</mo>
<mn>8</mn>
<mi>&alpha;</mi>
</mrow>
<mo>)</mo>
</mrow>
<msubsup>
<mi>S</mi>
<mi>n</mi>
<mrow>
<mo>&prime;</mo>
<mo>&prime;</mo>
</mrow>
</msubsup>
<mo>+</mo>
<mrow>
<mo>(</mo>
<mrow>
<mn>4</mn>
<mo>-</mo>
<mn>3</mn>
<mi>&alpha;</mi>
</mrow>
<mo>)</mo>
</mrow>
<msup>
<mi>S</mi>
<mrow>
<mo>&prime;</mo>
<mo>&prime;</mo>
<mo>&prime;</mo>
</mrow>
</msup>
</mrow>
<mo>&rsqb;</mo>
</mrow>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mi>c</mi>
<mi>n</mi>
</msub>
<mo>=</mo>
<mfrac>
<msup>
<mi>&alpha;</mi>
<mn>2</mn>
</msup>
<msup>
<mrow>
<mo>(</mo>
<mrow>
<mn>1</mn>
<mo>-</mo>
<mi>&alpha;</mi>
</mrow>
<mo>)</mo>
</mrow>
<mn>2</mn>
</msup>
</mfrac>
<mrow>
<mo>&lsqb;</mo>
<mrow>
<msubsup>
<mi>S</mi>
<mi>n</mi>
<mo>&prime;</mo>
</msubsup>
<mo>-</mo>
<mn>2</mn>
<msubsup>
<mi>S</mi>
<mi>n</mi>
<mrow>
<mo>&prime;</mo>
<mo>&prime;</mo>
</mrow>
</msubsup>
<mo>+</mo>
<msup>
<mi>S</mi>
<mrow>
<mo>&prime;</mo>
<mo>&prime;</mo>
<mo>&prime;</mo>
</mrow>
</msup>
</mrow>
<mo>&rsqb;</mo>
</mrow>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>.</mo>
</mrow>
5.根据权利要求1所述基于多传感器信息融合技术的数据处理方法，其特征在于，数据融合层进行无人机与障碍物相对距离的数据融合：
A、距离在0m到1m范围内，对超声波雷达传感器采集的数据进行kalman数据融合；
B、距离在1m到10m范围内,采用超声波雷达传感器和毫米波防撞雷达传感器进行检测，然后加权平均，即引入α的加权值对超声波雷达传感器和毫米波防撞雷达传感器进行加权平均，将加权融合后的数据进行kalman数据融合；
C、距离在10m到50m范围内,直接对毫米波防撞雷达传感器采集的数据进行kalman数据融合。
6.根据权利要求5所述基于多传感器信息融合技术的数据处理方法，其特征在于，根据不同的实际距离，各个传感器采集计算的距离如下：
<mrow>
<mfenced open = "{" close = "">
<mtable>
<mtr>
<mtd>
<mrow>
<mi>R</mi>
<mo>=</mo>
<mi>R</mi>
<mn>2</mn>
</mrow>
</mtd>
<mtd>
<mrow>
<mn>0</mn>
<mo><</mo>
<mi>R</mi>
<mo>&le;</mo>
<mn>1</mn>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mi>R</mi>
<mo>=</mo>
<mi>&alpha;</mi>
<mo>&times;</mo>
<mi>R</mi>
<mn>2</mn>
<mo>+</mo>
<mrow>
<mo>(</mo>
<mn>1</mn>
<mo>-</mo>
<mi>&alpha;</mi>
<mo>)</mo>
</mrow>
<mo>&times;</mo>
<mi>R</mi>
<mn>1</mn>
</mrow>
</mtd>
<mtd>
<mrow>
<mn>1</mn>
<mo><</mo>
<mi>R</mi>
<mo>&le;</mo>
<mn>10</mn>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mi>R</mi>
<mo>=</mo>
<mi>R</mi>
<mn>1</mn>
</mrow>
</mtd>
<mtd>
<mrow>
<mn>10</mn>
<mo><</mo>
<mi>R</mi>
<mo>&le;</mo>
<mn>50</mn>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>.</mo>
</mrow>
7.根据权利要求1所述基于多传感器信息融合技术的数据处理方法，其特征在于，数据融合层进行无人机与地面相对高度的数据融合，毫米雷达高度表和GPS/北斗定位传感器所获取的无人机高度值进行数据融合，高度值的数据融合根据距离分为两种；
对于高度小于50m的范围内，采用毫米雷达高度表和GPS/北斗定位传感器对无人机高度进行检测，检测后的结果采用加权平均，即引入α值对这两种传感器的高度值进行加权平均处理，处理后采用kalman对高度值进行数据融合；根据AHRS航姿数据对高度值进行修正：
对于高度大于50m以上，采用GPS/北斗定位传感器，将获取的高度数据直接进行kalman数据融合，然后，采用AHRS航姿数据进行高度修正；
<mfenced open = "{" close = "">
<mtable>
<mtr>
<mtd>
<mrow>
<mi>H</mi>
<mo>=</mo>
<mi>&alpha;</mi>
<mo>&times;</mo>
<mi>H</mi>
<mn>1</mn>
<mo>+</mo>
<mrow>
<mo>(</mo>
<mn>1</mn>
<mo>-</mo>
<mi>&alpha;</mi>
<mo>)</mo>
</mrow>
<mo>&times;</mo>
<mi>H</mi>
<mn>2</mn>
</mrow>
</mtd>
<mtd>
<mrow>
<mn>1</mn>
<mo><</mo>
<mi>H</mi>
<mo>&le;</mo>
<mn>50</mn>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mi>H</mi>
<mo>=</mo>
<mi>H</mi>
<mn>2</mn>
</mrow>
</mtd>
<mtd>
<mrow>
<mi>H</mi>
<mo>></mo>
<mn>50</mn>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
其中H1是毫米雷达高度表采集的高度，H2是GPS/北斗定位传感器采集的高度。
8.根据权利要求1所述基于多传感器信息融合技术的数据处理方法，其特征在于，决策层通过如下步骤完成避障的：
P1,首先判断无人机与障碍物的相对距离，将相对距离进行三个部分的划分:小于N1m，N1m到N2m，N2m到N3m三个距离范围；
P2,距离划分完成后，根据无人机与障碍物的相对速度进行危险等级的划分:
P3,然后判断无人机与地面的高度值，将该高度值H进行两个等级的划分；
P4：对于危险等级，需要进行步骤P3的操作；对于警示等级，需要紧急减速后进行步骤P3的操作；对于提示等级和不相关等级，不用进行第三步骤的判断，返回重新进行检测。
9.根据权利要求8所述基于多传感器信息融合技术的数据处理方法，其特征在于，步骤P2具体为：当距离小于N1m，速度大于M1m/s,且预警时间小于Qs，则属于危险等级，速度小于M1m/s时，属于警示等级；
当距离N1m≤R<N2m，速度大于M2m/s时,处于危险等级；当速度M1m/s≤V<M2m/s时，处于警示等级，当速度小于M1m/s时，处于提示等级；
当距离N2m≤R<N3m时，当速度大于M3m/s时,处于危险等级；当速度M2m/s≤V<M3m/s时，处于警示等级，当速度M1m/s≤V<M2m/s时，处于提示等级，当速度小于M1m/s时，处于不相关等级。
10.根据权利要求8所述基于多传感器信息融合技术的数据处理方法，其特征在于，步骤P3具体为：当高度0m≤H<50m，根据毫米波防撞雷达传感器进行无人机与障碍物方位角的判断，如果障碍物处于无人机的左边，则控制无人机进行右偏飞行，躲避障碍物；如果障碍物处于无人机的右边，控制无人机进行左偏飞行，躲避障碍物；如果障碍物处于无人机的正前方，则无人机爬升进行避障；
当高度H≥50m，根据毫米波防撞雷达进行无人机与障碍物方位角的判断，如果障碍物处于无人机的左边，则控制无人机进行右偏飞行，躲避障碍物，如果障碍物处于无人机的右边，控制无人机进行左偏飞行，躲避障碍物；如果障碍物处于无人机飞行的正前方，采用紧急悬停后进行折返避障。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201610728667.2A CN107783548B (zh) | 2016-08-25 | 2016-08-25 | 基于多传感器信息融合技术的数据处理方法 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201610728667.2A CN107783548B (zh) | 2016-08-25 | 2016-08-25 | 基于多传感器信息融合技术的数据处理方法 |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| CN107783548A true CN107783548A (zh) | 2018-03-09 |
| CN107783548B CN107783548B (zh) | 2021-02-26 |
Family
ID=61439073
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN201610728667.2A Active CN107783548B (zh) | 2016-08-25 | 2016-08-25 | 基于多传感器信息融合技术的数据处理方法 |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN107783548B (zh) |
Cited By (9)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN109270524A (zh) * | 2018-10-19 | 2019-01-25 | 禾多科技（北京）有限公司 | 基于无人驾驶的多数据融合障碍物检测装置及其检测方法 |
| CN109884616A (zh) * | 2019-03-13 | 2019-06-14 | 浙江吉利汽车研究院有限公司 | 一种雷达测量距离融合方法、装置及终端 |
| CN110658831A (zh) * | 2019-10-22 | 2020-01-07 | 深圳市道通智能航空技术有限公司 | 对地高度校正方法及装置、无人飞行器 |
| CN111046761A (zh) * | 2019-11-29 | 2020-04-21 | 天地（常州）自动化股份有限公司 | 基于多传感信息融合的皮带载荷分布检测系统及检测方法 |
| CN111879286A (zh) * | 2020-08-11 | 2020-11-03 | 中国商用飞机有限责任公司 | 一种用于获得飞行器的飞行高度的方法 |
| WO2021087751A1 (zh) * | 2019-11-05 | 2021-05-14 | 深圳市大疆创新科技有限公司 | 距离检测方法、距离检测设备、自主移动平台和存储介质 |
| CN113778121A (zh) * | 2021-11-15 | 2021-12-10 | 西安羚控电子科技有限公司 | 一种无人机多余度传感器管理方法、系统及无人机 |
| CN113853561A (zh) * | 2020-07-30 | 2021-12-28 | 深圳市大疆创新科技有限公司 | 无人飞行器的控制方法、装置、无人飞行器及存储介质 |
| CN113985925A (zh) * | 2021-12-28 | 2022-01-28 | 普宙科技(深圳)有限公司 | 无人机高度控制方法、系统、存储介质及电子设备 |
Citations (11)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US20070093945A1 (en) * | 2005-10-20 | 2007-04-26 | Grzywna Jason W | System and method for onboard vision processing |
| CN201918032U (zh) * | 2010-12-31 | 2011-08-03 | 同济大学 | 一种飞行器低空飞行防撞的装置 |
| CN102679951A (zh) * | 2011-03-11 | 2012-09-19 | 尤洛考普特公司 | 一种测量高度和探测障碍物的方法、无线电高度表以及飞行器 |
| US20120271491A1 (en) * | 2011-04-20 | 2012-10-25 | Accenture Global Services Limited | Capturing environmental information |
| CN103224026A (zh) * | 2012-12-05 | 2013-07-31 | 福建省电力有限公司 | 一种适用于山区电网巡检的专用无人直升机避障系统及其工作流程 |
| CN103699668A (zh) * | 2013-12-30 | 2014-04-02 | 贵州电力试验研究院 | 基于数据断面一致性的配电网电气设备组合状态评估方法 |
| CN103778323A (zh) * | 2014-01-03 | 2014-05-07 | 株洲南车时代电气股份有限公司 | 基于指数平滑的预测交通流数据的方法和系统 |
| CN103776451A (zh) * | 2014-03-04 | 2014-05-07 | 哈尔滨工业大学 | 一种基于mems的高精度三维姿态惯性测量系统以及测量方法 |
| CN104597910A (zh) * | 2014-11-27 | 2015-05-06 | 中国人民解放军国防科学技术大学 | 一种基于瞬时碰撞点的无人机非协作式实时避障方法 |
| CN105700550A (zh) * | 2016-01-26 | 2016-06-22 | 深圳市大疆创新科技有限公司 | 无人机及其飞行控制方法与系统 |
| CN105892489A (zh) * | 2016-05-24 | 2016-08-24 | 国网山东省电力公司电力科学研究院 | 一种基于多传感器融合的自主避障无人机系统及控制方法 |
-
2016
- 2016-08-25 CN CN201610728667.2A patent/CN107783548B/zh active Active
Patent Citations (11)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US20070093945A1 (en) * | 2005-10-20 | 2007-04-26 | Grzywna Jason W | System and method for onboard vision processing |
| CN201918032U (zh) * | 2010-12-31 | 2011-08-03 | 同济大学 | 一种飞行器低空飞行防撞的装置 |
| CN102679951A (zh) * | 2011-03-11 | 2012-09-19 | 尤洛考普特公司 | 一种测量高度和探测障碍物的方法、无线电高度表以及飞行器 |
| US20120271491A1 (en) * | 2011-04-20 | 2012-10-25 | Accenture Global Services Limited | Capturing environmental information |
| CN103224026A (zh) * | 2012-12-05 | 2013-07-31 | 福建省电力有限公司 | 一种适用于山区电网巡检的专用无人直升机避障系统及其工作流程 |
| CN103699668A (zh) * | 2013-12-30 | 2014-04-02 | 贵州电力试验研究院 | 基于数据断面一致性的配电网电气设备组合状态评估方法 |
| CN103778323A (zh) * | 2014-01-03 | 2014-05-07 | 株洲南车时代电气股份有限公司 | 基于指数平滑的预测交通流数据的方法和系统 |
| CN103776451A (zh) * | 2014-03-04 | 2014-05-07 | 哈尔滨工业大学 | 一种基于mems的高精度三维姿态惯性测量系统以及测量方法 |
| CN104597910A (zh) * | 2014-11-27 | 2015-05-06 | 中国人民解放军国防科学技术大学 | 一种基于瞬时碰撞点的无人机非协作式实时避障方法 |
| CN105700550A (zh) * | 2016-01-26 | 2016-06-22 | 深圳市大疆创新科技有限公司 | 无人机及其飞行控制方法与系统 |
| CN105892489A (zh) * | 2016-05-24 | 2016-08-24 | 国网山东省电力公司电力科学研究院 | 一种基于多传感器融合的自主避障无人机系统及控制方法 |
Cited By (14)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN109270524A (zh) * | 2018-10-19 | 2019-01-25 | 禾多科技（北京）有限公司 | 基于无人驾驶的多数据融合障碍物检测装置及其检测方法 |
| CN109884616B (zh) * | 2019-03-13 | 2021-09-14 | 浙江吉利汽车研究院有限公司 | 一种雷达测量距离融合方法、装置及终端 |
| CN109884616A (zh) * | 2019-03-13 | 2019-06-14 | 浙江吉利汽车研究院有限公司 | 一种雷达测量距离融合方法、装置及终端 |
| CN110658831A (zh) * | 2019-10-22 | 2020-01-07 | 深圳市道通智能航空技术有限公司 | 对地高度校正方法及装置、无人飞行器 |
| CN110658831B (zh) * | 2019-10-22 | 2022-04-15 | 深圳市道通智能航空技术股份有限公司 | 对地高度校正方法及装置、无人飞行器 |
| WO2021087751A1 (zh) * | 2019-11-05 | 2021-05-14 | 深圳市大疆创新科技有限公司 | 距离检测方法、距离检测设备、自主移动平台和存储介质 |
| CN111046761A (zh) * | 2019-11-29 | 2020-04-21 | 天地（常州）自动化股份有限公司 | 基于多传感信息融合的皮带载荷分布检测系统及检测方法 |
| CN111046761B (zh) * | 2019-11-29 | 2023-06-02 | 天地（常州）自动化股份有限公司 | 基于多传感信息融合的皮带载荷分布检测系统及检测方法 |
| CN113853561A (zh) * | 2020-07-30 | 2021-12-28 | 深圳市大疆创新科技有限公司 | 无人飞行器的控制方法、装置、无人飞行器及存储介质 |
| WO2022021214A1 (zh) * | 2020-07-30 | 2022-02-03 | 深圳市大疆创新科技有限公司 | 无人飞行器的控制方法、装置、无人飞行器及存储介质 |
| CN111879286B (zh) * | 2020-08-11 | 2021-09-21 | 中国商用飞机有限责任公司 | 一种用于获得飞行器的飞行高度的方法 |
| CN111879286A (zh) * | 2020-08-11 | 2020-11-03 | 中国商用飞机有限责任公司 | 一种用于获得飞行器的飞行高度的方法 |
| CN113778121A (zh) * | 2021-11-15 | 2021-12-10 | 西安羚控电子科技有限公司 | 一种无人机多余度传感器管理方法、系统及无人机 |
| CN113985925A (zh) * | 2021-12-28 | 2022-01-28 | 普宙科技(深圳)有限公司 | 无人机高度控制方法、系统、存储介质及电子设备 |
Also Published As
| Publication number | Publication date |
|---|---|
| CN107783548B (zh) | 2021-02-26 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN107783548B (zh) | 基于多传感器信息融合技术的数据处理方法 | |
| CN107783544B (zh) | 一种控制单旋翼植保无人机避障飞行的方法 | |
| CN107783549B (zh) | 基于多传感器信息融合技术的单旋翼植保无人机避障系统 | |
| CN107783106B (zh) | 无人机与障碍物之间的数据融合方法 | |
| CN110631593B (zh) | 一种用于自动驾驶场景的多传感器融合定位方法 | |
| CN107783545B (zh) | 基于ooda环多传感器信息融合的灾后救援旋翼无人机避障系统 | |
| US11935420B1 (en) | Flight assistant | |
| CN108594850B (zh) | 基于无人机的航线规划及控制无人机作业的方法、装置 | |
| US9310222B1 (en) | Flight assistant with automatic configuration and landing site selection method and apparatus | |
| US7640797B2 (en) | Method and system for increasing safety in chemical application from an aircraft | |
| CN103869822B (zh) | 多旋翼无人机感知与规避系统及其规避方法 | |
| CN103744429B (zh) | 一种小型无人直升机飞行控制系统 | |
| CN206057974U (zh) | 一种应用在旋翼无人机上的避障系统 | |
| US10866593B2 (en) | Aerial vehicle landing method, ground control system, and flight control system | |
| CN107783119A (zh) | 应用在避障系统中的决策融合方法 | |
| WO2020018148A4 (en) | Methods and systems for determining flight plans for vertical take-off and landing (vtol) aerial vehicles | |
| CN104820434A (zh) | 一种无人机对地面运动目标的测速方法 | |
| CN103744430A (zh) | 一种小型无人直升机飞行控制方法 | |
| CN109683629A (zh) | 基于组合导航和计算机视觉的无人机电力架线系统 | |
| CN102508493A (zh) | 一种小型无人飞行器飞行控制方法 | |
| US11313663B2 (en) | Location estimation apparatus, moving object, location estimation method, and computer-readable storage medium | |
| Moore et al. | UAV Inspection of Electrical Transmission Infrastructure with Path Conformance Autonomy and Lidar-based Geofences NASA Report on UTM Reference Mission Flights at Southern Company Flights November 2016 | |
| Priandana et al. | Development of autonomous UAV quadcopters using pixhawk controller and its flight data acquisition | |
| CN105242248A (zh) | 一种基于测控设备的雷达挂飞试验位置参数自动装订方法 | |
| US11657721B1 (en) | Aircraft with flight assistant |
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 |