CN109282808B - 用于桥梁三维巡航检测的无人机与多传感器融合定位方法 - Google Patents
用于桥梁三维巡航检测的无人机与多传感器融合定位方法 Download PDFInfo
- Publication number
- CN109282808B CN109282808B CN201811410228.2A CN201811410228A CN109282808B CN 109282808 B CN109282808 B CN 109282808B CN 201811410228 A CN201811410228 A CN 201811410228A CN 109282808 B CN109282808 B CN 109282808B
- Authority
- CN
- China
- Prior art keywords
- aerial vehicle
- unmanned aerial
- positioning
- bridge
- 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.)
- Expired - Fee Related
Links
Images
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/10—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
- G01C21/12—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning
- G01C21/16—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation
- G01C21/165—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation combined with non-inertial navigation instruments
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S15/00—Systems using the reflection or reradiation of acoustic waves, e.g. sonar systems
- G01S15/02—Systems using the reflection or reradiation of acoustic waves, e.g. sonar systems using reflection of acoustic waves
- G01S15/06—Systems determining the position data of a target
- G01S15/08—Systems for measuring distance only
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S19/00—Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
- G01S19/38—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system
- G01S19/39—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system the satellite radio beacon positioning system transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
- G01S19/42—Determining position
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S19/00—Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
- G01S19/38—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system
- G01S19/39—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system the satellite radio beacon positioning system transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
- G01S19/42—Determining position
- G01S19/45—Determining position by combining measurements of signals from the satellite radio beacon positioning system with a supplementary measurement
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S19/00—Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
- G01S19/38—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system
- G01S19/39—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system the satellite radio beacon positioning system transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
- G01S19/42—Determining position
- G01S19/45—Determining position by combining measurements of signals from the satellite radio beacon positioning system with a supplementary measurement
- G01S19/47—Determining position by combining measurements of signals from the satellite radio beacon positioning system with a supplementary measurement the supplementary measurement being an inertial measurement, e.g. tightly coupled inertial
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Computer Networks & Wireless Communication (AREA)
- Automation & Control Theory (AREA)
- Acoustics & Sound (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
- Position Fixing By Use Of Radio Waves (AREA)
- Measurement Of Velocity Or Position Using Acoustic Or Ultrasonic Waves (AREA)
Abstract
本发明公开了一种用于桥梁三维巡航检测的无人机,所述无人机包括控制器与k种定位传感器,每种定位传感器均与控制器的信号输入端连接;所述控制器内配置有多传感器融合定位程序,所述多传感器融合定位程序用于根据m种传感器对同一点的三维坐标进行坐标数据融合,1<m≤k,从而输出无人机当前巡航的空间坐标。本发明还提供一种用于桥三维巡航检测的多传感器融合定位方法,采用本发明用于桥梁三维巡航检测的无人机在巡航过程中进行实时定位。本发明解决了现有技术中由于巡航检测过程中卫星信号不稳定造成的无人机依赖GPS定位的准确性较低的技术问题。
Description
技术领域
本发明涉及桥梁检测技术领域,尤其涉及一种利用无人机进行自动巡航检测时对无人机进行定位的方法。
背景技术
随着无人机技术的发展,无人机广泛用于各种工程技术领域,在桥梁检测中也逐渐采用了无人机技术,特别是飞爬两栖机器人,飞爬两栖机器人具有飞行、爬行和栖息三种状态,并能够实现三种状态下的切换,如“一种飞行和爬壁两栖机器人及其控制方法CN103192987B”、“一种能飞行的爬墙机器人CN107539054A”。目前主要采用人工远程遥控的方式对桥梁进行检测,存在操作难度高、效率低、容易漏检的缺点。另外,桥梁结构存在如梯形、弧形等异性区域,并非完全的平整区域。如果无人机完全按照二维平面上规划出的巡航路径,容易与桥梁表面发生碰撞、无法顺利驻停,甚至坠机等安全事故,导致桥梁检测无法正常进行。
鉴于此,发明人设计了一种用于桥梁检测的三维巡航方法,在空间三维坐标系中规划出三维巡航路径,然后根据三维巡航路径解算无人机的巡航姿态,巡航路径中包含若干路径点,每个路径点均有对应的巡航姿态,无人机上搭载GPS定位模块,在巡航过程中实时获取定位坐标,若定位坐标与路径点坐标一致则以该路径点对应的巡航姿态进行运动,从而能够到达下一相邻路径点,最终能够完成沿着整个巡航路径进行巡航检测。
但是,由于在对桥梁结构底面或箱梁内部(桥梁上有检修孔供无人机进入,箱梁的形状规则,多为矩形体)等位置进行检测时,会造成GPS定位模块接收的卫星信号不稳定或失效的现象(接收到的卫星信号的颗数小于8颗为信号不稳定,小于4颗为信号失效),当GPS定位模块接收信号不稳定时,则以最近时间接收到的稳定卫星信号进行定位解算,这就造成定位坐标与实际位置坐标不相符,定位的准确性低,定位偏差大。然而对于桥梁巡航检测来说,对无人机实时定位的准确要求较高,无人机实时定位的偏差会导致无人机偏离规划的巡航路径,需人工远程监控并遥控使无人机回到巡航路径上,无人机定位准确性的提高能够减少人工巡航检测过程的干涉,提高无人机自动巡航检测的智能化水平。
发明内容
针对上述现有技术的不足,本发明提供一种用于桥梁三维巡航检测的无人机,解决现有技术中由于巡航检测过程中卫星信号不稳定造成的无人机依赖GPS定位的准确性较低的技术问题。本发明还提供一种专门针对桥梁巡航检测的多传感器融合定位方法,能够提高定位精度。
为解决上述技术问题,本发明的技术方案如下:一种用于桥梁三维巡航检测的无人机,所述无人机包括控制器与k种定位传感器,每种定位传感器均与控制器的信号输入端连接;所述控制器内配置有多传感器融合定位程序,所述多传感器融合定位程序用于根据m种传感器对同一点的三维坐标进行坐标数据融合,1<m≤k,从而输出无人机当前巡航的空间坐标。
优选的,多传感器融合定位程序对同一点分别在X、Y、Z三轴方向的坐标均按如下步骤进行计算:
步骤101:计算m种传感器中每种传感器对同一点同一方向上的坐标标准差,按如下公式:
式中,n表示对同一点的采样次数;
si,j表示第i种传感器对同一点的第j次采样数据,j∈{1,.....,n};
步骤102:计算m种传感器中每种传感器的权重,其中,第i种传感器的权重gi按如下公式计算:
步骤103:计算m种传感器对同一点同一方向上的融合坐标s:
优选的,包括以下定位传感器:GPS定位模块、惯性传感定位模块、图像传感定位模块以及超声测距定位模块;所述惯性传感定位模块包括惯性传感器与用于根据惯性传感数据计算空间坐标的微控制器;所述图像传感定位模块包括图像传感器与用于根据图像数据计算空间坐标的微控制器;所述超声测距定位模块包括超声测距传感器与用于根据距离数据计算空间坐标的微控制器。
优选的,无人机的控制器中配置有用于根据GPS定位模块当前所接收到的卫星颗数N来选择定位模式的定位管理程序:当N≥8时,采用GPS定位模块的传感数据进行定位,以获取无人机当前空间三维坐标;当4≤N<8时,采用GPS定位模块与惯性传感器的传感数据进行融合定位;当N<4时,采用GPS定位模块、惯性传感定位模块以及图像传感定位模块与超声测距定位模块中的一种或两种进行融合定位。
本发明还提供一种用于桥梁三维巡航检测的多传感器融合定方法,采用如上述用于桥梁三维巡航检测的无人机;在无人机运动过程中,k种定位传感器实时采集各自的定位数据,即三维坐标,并发送给控制器,控制器定位管理程序根据GPS定位模块当前所接收到的卫星颗数N来选择定位模式,多传感器融合定位程序根据定位模式进行定位数据融合,从而输出无人机当前巡航的空间坐标。
优选的,GPS定位模块用于解算世界坐标系的空间坐标。
优选的,惯性传感定位模块实时检测无人机的角速度与线速度,对角速度与线速度进行积分以得到无人机相对于桥梁基准点的相对空间坐标;然后根据桥梁基准点在世界坐标系的空间坐标得到无人机的空间坐标。
优选的,图像传感器定位模块与超声测距定位模块均根据桥梁的结构特征进行定位。
优选的,图像传感器定位模块包括左右两个图像传感器,在无人机运动过程中,左右两个图像传感器联系观测桥梁结构,利用多视角集合和图像特征提取计算实现定位,并包括以下步骤:
步骤201:获取图像传感器定位模块在两个相邻采样时刻所采集的两个相邻空间位置的两组图像;每组图像均包含左右两个图像传感器针对同一物理空间位置采集的两幅图像;
步骤202:采用尺度不变特征转化算子SIFT分别对每组图像中的两幅图像进行兴趣点检测,以分别提取两幅图像中的关键点,所述关键点表征了同一物理空间位置;
步骤203:根据每组图像中两幅图像的关键点进行图像立体匹配,以形成视差信息,并根据视差信息计算无人机相对于该组图像关键点的相对位姿,相对位姿即相对观测角度;
步骤204:时域特征点跟踪:利用最小零均值归一化互相关的方法实现无人机在两个相邻采样时刻的关键点匹配,然后通过三角定位获取无人机相对于两个相邻采样时刻的关键点的三维坐标;
步骤205:运动估计:采用RANSAC方法在立体匹配和时域特征点跟踪的基础上,通过无人机在相邻采样间隔内的相对位姿变化,对其进行运动估计,得到无人机的线速度和角速度;
步骤206:采样卡尔曼滤波算法对无人机的线速度与角速度进行处理,从而得到无人机的相对于桥梁基准点的相对空间坐标;
步骤207:根据桥梁基准点在世界坐标系的空间坐标将相对空间坐标换算为无人机的空间坐标。
优选的,超声测距定位模块包括6个超声测距传感器,分别安装在无人机的顶面、底面、左侧面、右侧面、正面与背面;超声测距定位模块按如下步骤进行定位:
步骤301:根据箱梁内空间任意点到桥梁基准点的相对空间坐标建立相对坐标集合,并根据相对坐标集合中每一点在上下左右前后六个方向上到桥梁的距离建立距离集合;
步骤302:根据相对坐标集合与距离集合建立距离-坐标映射函数:
f(x,y,z)=(d1,d2,d3,d4,d5,d6);
其中,d1、d2、d3、d4、d5、d6分别表示空间点上、下、左、右、前、后六个方向到箱梁的距离;
步骤303:6个超声测距传感器分别检测无人机顶面、底面、左侧面、右侧面、正面与背面到箱梁各面的距离,形成距离数组;
步骤304:根据步骤303所得到的距离数组以及步骤302中的距离-坐标映射函数,找到距离数组所对应的相对坐标;
步骤305:根据桥梁基准点在世界坐标系的空间坐标将相对空间坐标换算为无人机的空间坐标。
与现有技术相比,本发明具有以下有益效果:
1、本发明的无人机能够通过多种定位传感器的定位数据以及多传感器融合定位程序进行融合定位,以提高定位精度;并能通过定位管理程序在GPS信号较强时,如无人机位于桥梁外侧,单独采用GPS卫星信号进行定位;在卫星信号失稳时,采用GPS定位模块与惯性传感器的传感数据进行融合定位;在卫星信号失效时,采用采用GPS定位模块、惯性传感定位模块以及图像传感定位模块与超声测距定位模块中的一种或两种进行融合定位。
2、由于惯性传感器定位模块随着时间累积,误差逐渐增大,因此采用图像传感定位模块和/或超声传感定位模块对惯性传感器的定位数据进行修正,图像传感器定位模块与超声测距定位模块均是根据桥梁的结构特征进行定位,不会受到时间累计的影响。
3、本发明的多传感器融合定位方法根据GPS信号强弱来选择不同的定位模式进行定位,不仅能够提高定位精度,而且能够大大减少运算量。
附图说明
图1为本具体实施方式中用于桥梁三维巡航检测的无人机的结构示意图。
具体实施方式
一种用于桥梁三维巡航检测的无人机,其特征在于:所述无人机包括控制器与k种定位传感器,每种定位传感器均与控制器的信号输入端连接;所述控制器内配置有多传感器融合定位程序,所述多传感器融合定位程序用于根据m种传感器对同一点的三维坐标进行坐标数据融合,1<m≤k,从而输出无人机当前巡航的空间坐标。
本具体实施方式中,多传感器融合定位程序对同一点分别在X、Y、Z三轴方向的坐标均按如下步骤进行计算:
步骤101:计算m种传感器中每种传感器对同一点同一方向上的坐标标准差,按如下公式:
式中,n表示对同一点的采样次数;
si,j表示第i种传感器对同一点的第j次采样数据,j∈{1,.....,n};
步骤102:计算m种传感器中每种传感器的权重,其中,第i种传感器的权重gi按如下公式计算:
步骤103:计算m种传感器对同一点同一方向上的融合坐标s:
本具体实施方式中,包括以下定位传感器:GPS定位模块、惯性传感定位模块、图像传感定位模块以及超声测距定位模块;所述惯性传感定位模块包括惯性传感器与用于根据惯性传感数据计算空间坐标的微控制器;所述图像传感定位模块包括图像传感器与用于根据图像数据计算空间坐标的微控制器;所述超声测距定位模块包括超声测距传感器与用于根据距离数据计算空间坐标的微控制器。
本具体实施方式中,无人机的控制器中配置有用于根据GPS定位模块当前所接收到的卫星颗数N来选择定位模式的定位管理程序:当N≥8时,采用GPS定位模块的传感数据进行定位,以获取无人机当前空间三维坐标;当4≤N<8时,采用GPS定位模块与惯性传感器的传感数据进行融合定位;当N<4时,采用GPS定位模块、惯性传感定位模块以及图像传感定位模块与超声测距定位模块中的一种或两种进行融合定位。
一种用于桥梁三维巡航检测的多传感器融合定方法,采用本具体实施方式中的用于桥梁三维巡航检测的无人机;在无人机运动过程中,k种定位传感器实时采集各自的定位数据,即三维坐标,并发送给控制器,控制器定位管理程序根据GPS定位模块当前所接收到的卫星颗数N来选择定位模式,多传感器融合定位程序根据定位模式进行定位数据融合,从而输出无人机当前巡航的空间坐标。
本具体实施方式中,GPS定位模块用于解算世界坐标系的空间坐标。
本具体实施方式中,惯性传感定位模块实时检测无人机的角速度与线速度,对角速度与线速度进行积分以得到无人机相对于桥梁基准点的相对空间坐标;然后根据桥梁基准点在世界坐标系的空间坐标得到无人机的空间坐标。
本具体实施方式中,图像传感器定位模块与超声测距定位模块均根据桥梁的结构特征进行定位。
本具体实施方式中,如图1所示,图像传感器定位模块包括左右两个图像传感器,分别安装在无人机正面的左侧位7、右侧位8,在无人机运动过程中,左右两个图像传感器联系观测桥梁结构,利用多视角集合和图像特征提取计算实现定位,并包括以下步骤:
步骤201:获取图像传感器定位模块在两个相邻采样时刻所采集的两个相邻空间位置的两组图像;每组图像均包含左右两个图像传感器针对同一物理空间位置采集的两幅图像;
步骤202:采用尺度不变特征转化算子SIFT分别对每组图像中的两幅图像进行兴趣点检测,以分别提取两幅图像中的关键点,所述关键点表征了同一物理空间位置;
步骤203:根据每组图像中两幅图像的关键点进行图像立体匹配,以形成视差信息,并根据视差信息计算无人机相对于该组图像关键点的相对位姿,相对位姿即相对观测角度;
步骤204:时域特征点跟踪:利用最小零均值归一化互相关的方法实现无人机在两个相邻采样时刻的关键点匹配,然后通过三角定位获取无人机相对于两个相邻采样时刻的关键点的三维坐标;
步骤205:运动估计:采用RANSAC方法在立体匹配和时域特征点跟踪的基础上,通过无人机在相邻采样间隔内的相对位姿变化,对其进行运动估计,得到无人机的线速度和角速度;
步骤206:采样卡尔曼滤波算法对无人机的线速度与角速度进行处理,从而得到无人机的相对于桥梁基准点的相对空间坐标;
步骤207:根据桥梁基准点在世界坐标系的空间坐标将相对空间坐标换算为无人机的空间坐标。
本具体实施方式中给出了一种优选的图像定位方式,也可以采用现有技术中的图像定位方法,如“基于惯性传感器和视觉里程计的机器人定位,仪器仪表学报,第34卷第1期,夏凌楠,张波,王营冠,魏建明”。
本具体实施方式中,如图1所示,超声测距定位模块包括6个超声测距传感器,分别安装在无人机的顶面1、底面2、左侧面3、右侧面4、正面6与背面5;超声测距定位模块按如下步骤进行定位:
步骤301:根据箱梁内空间任意点(采用空间直线进行表示)到桥梁基准点的相对空间坐标建立相对坐标集合,并根据相对坐标集合中每一点在上下左右前后六个方向上到桥梁的距离建立距离集合;
步骤302:根据相对坐标集合与距离集合建立距离-坐标映射函数:
f(x,y,z)=(d1,d2,d3,d4,d5,d6);
其中,d1、d2、d3、d4、d5、d6分别表示空间点上、下、左、右、前、后六个方向到箱梁的距离;
步骤303:6个超声测距传感器分别检测无人机顶面、底面、左侧面、右侧面、正面与背面到箱梁各面的距离,形成距离数组;
步骤304:根据步骤303所得到的距离数组以及步骤302中的距离-坐标映射函数,找到距离数组所对应的相对坐标;
步骤305:根据桥梁基准点在世界坐标系的空间坐标将相对空间坐标换算为无人机的空间坐标。
最后说明的是,以上实施例仅用以说明本发明的技术方案而非限制,尽管参照较佳实施例对本发明进行了详细说明,本领域的普通技术人员应当理解,可以对发明的技术方案进行修改或者等同替换,而不脱离本发明技术方案的宗旨和范围,其均应涵盖在本发明的权利要求范围当中。
Claims (8)
1.一种用于桥梁三维巡航检测的无人机,其特征在于:所述无人机包括控制器与k种定位传感器,每种定位传感器均与控制器的信号输入端连接;所述控制器内配置有多传感器融合定位程序,所述多传感器融合定位程序用于根据m种传感器对同一点的三维坐标进行坐标数据融合,1<m≤k,从而输出无人机当前巡航的空间坐标;
包括以下定位传感器:GPS定位模块、惯性传感定位模块、图像传感定位模块以及超声测距定位模块;所述惯性传感定位模块包括惯性传感器与用于根据惯性传感数据计算空间坐标的微控制器;所述图像传感定位模块包括图像传感器与用于根据图像数据计算空间坐标的微控制器;所述超声测距定位模块包括超声测距传感器与用于根据距离数据计算空间坐标的微控制器;
无人机的控制器中配置有用于根据GPS定位模块当前所接收到的卫星颗数N来选择定位模式的定位管理程序:当N≥8时,采用GPS定位模块的传感数据进行定位,以获取无人机当前空间三维坐标;当4≤N<8时,采用GPS定位模块与惯性传感器的传感数据进行融合定位;当N<4时,采用GPS定位模块、惯性传感定位模块以及图像传感定位模块与超声测距定位模块中的一种或两种进行融合定位。
2.根据权利要求1所述的用于桥梁三维巡航检测的无人机,其特征在于:多传感器融合定位程序对同一点分别在X、Y、Z三轴方向的坐标均按如下步骤进行计算:
步骤101:计算m种传感器中每种传感器对同一点同一方向上的坐标标准差,按如下公式:
式中,n表示对同一点的采样次数;
si,j表示第i种传感器对同一点的第j次采样数据,j∈{1,.....,n};
步骤102:计算m种传感器中每种传感器的权重,其中,第i种传感器的权重gi按如下公式计算:
步骤103:计算m种传感器对同一点同一方向上的融合坐标s:
3.一种用于桥梁三维巡航检测的多传感器融合定方法,其特征在于:采用如权利要求2所述的用于桥梁三维巡航检测的无人机;在无人机运动过程中,k种定位传感器实时采集各自的定位数据,即三维坐标,并发送给控制器,控制器定位管理程序根据GPS定位模块当前所接收到的卫星颗数N来选择定位模式,多传感器融合定位程序根据定位模式进行定位数据融合,从而输出无人机当前巡航的空间坐标。
4.根据权利要求3所述的用于桥梁三维巡航检测的多传感器融合定方法,其特征在于:GPS定位模块用于解算世界坐标系的空间坐标。
5.根据权利要求3所述的用于桥梁三维巡航检测的多传感器融合定方法,其特征在于:惯性传感定位模块实时检测无人机的角速度与线速度,对角速度与线速度进行积分以得到无人机相对于桥梁基准点的相对空间坐标;然后根据桥梁基准点在世界坐标系的空间坐标得到无人机的空间坐标。
6.根据权利要求3所述的用于桥梁三维巡航检测的多传感器融合定方法,其特征在于:图像传感器定位模块与超声测距定位模块均根据桥梁的结构特征进行定位。
7.根据权利要求5所述的用于桥梁三维巡航检测的多传感器融合定方法,其特征在于:图像传感器定位模块包括左右两个图像传感器,在无人机运动过程中,左右两个图像传感器观测桥梁结构,利用多视角集合和图像特征提取计算实现定位,并包括以下步骤:
步骤201:获取图像传感器定位模块在两个相邻采样时刻所采集的两个相邻空间位置的两组图像;每组图像均包含左右两个图像传感器针对同一物理空间位置采集的两幅图像;
步骤202:采用尺度不变特征转化算子SIFT分别对每组图像中的两幅图像进行兴趣点检测,以分别提取两幅图像中的关键点,所述关键点表征了同一物理空间位置;
步骤203:根据每组图像中两幅图像的关键点进行图像立体匹配,以形成视差信息,并根据视差信息计算无人机相对于该组图像关键点的相对位姿,相对位姿即相对观测角度;
步骤204:时域特征点跟踪:利用最小零均值归一化互相关的方法实现无人机在两个相邻采样时刻的关键点匹配,然后通过三角定位获取无人机相对于两个相邻采样时刻的关键点的三维坐标;
步骤205:运动估计:采用RANSAC方法在立体匹配和时域特征点跟踪的基础上,通过无人机在相邻采样间隔内的相对位姿变化,对其进行运动估计,得到无人机的线速度和角速度;
步骤206:采样卡尔曼滤波算法对无人机的线速度与角速度进行处理,从而得到无人机的相对于桥梁基准点的相对空间坐标;
步骤207:根据桥梁基准点在世界坐标系的空间坐标将相对空间坐标换算为无人机的空间坐标。
8.根据权利要求5所述的用于桥梁三维巡航检测的多传感器融合定方法,其特征在于:超声测距定位模块包括6个超声测距传感器,分别安装在无人机的顶面、底面、左侧面、右侧面、正面与背面;超声测距定位模块按如下步骤进行定位:
步骤301:根据箱梁内空间任意点到桥梁基准点的相对空间坐标建立相对坐标集合,并根据相对坐标集合中每一点在上下左右前后六个方向上到桥梁的距离建立距离集合;
步骤302:根据相对坐标集合与距离集合建立距离-坐标映射函数:
f(x,y,z)=(d1,d2,d3,d4,d5,d6);
其中,d1、d2、d3、d4、d5、d6分别表示空间点上、下、左、右、前、后六个方向到箱梁的距离;
步骤303:6个超声测距传感器分别检测无人机顶面、底面、左侧面、右侧面、正面与背面到箱梁各面的距离,形成距离数组;
步骤304:根据步骤303所得到的距离数组以及步骤302中的距离-坐标映射函数,找到距离数组所对应的相对坐标;
步骤305:根据桥梁基准点在世界坐标系的空间坐标将相对空间坐标换算为无人机的空间坐标。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201811410228.2A CN109282808B (zh) | 2018-11-23 | 2018-11-23 | 用于桥梁三维巡航检测的无人机与多传感器融合定位方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201811410228.2A CN109282808B (zh) | 2018-11-23 | 2018-11-23 | 用于桥梁三维巡航检测的无人机与多传感器融合定位方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN109282808A CN109282808A (zh) | 2019-01-29 |
CN109282808B true CN109282808B (zh) | 2021-05-04 |
Family
ID=65173000
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201811410228.2A Expired - Fee Related CN109282808B (zh) | 2018-11-23 | 2018-11-23 | 用于桥梁三维巡航检测的无人机与多传感器融合定位方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN109282808B (zh) |
Families Citing this family (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110018691B (zh) * | 2019-04-19 | 2022-04-15 | 天津大学 | 小型多旋翼无人机飞行状态估计***和方法 |
JP7320380B2 (ja) * | 2019-06-11 | 2023-08-03 | イームズロボティクス株式会社 | 無人飛行体、無人飛行方法及び無人飛行プログラム |
CN111024431B (zh) * | 2019-12-26 | 2022-03-11 | 江西交通职业技术学院 | 一种基于多传感器无人驾驶的桥梁快速检测车 |
CN112013839A (zh) * | 2020-08-18 | 2020-12-01 | 重庆交通大学 | 一种gps拒止环境下无人机集群实时定位方法 |
CN112098326B (zh) * | 2020-08-20 | 2022-09-30 | 东南大学 | 针对桥梁病害的自动检测方法和*** |
CN112629529B (zh) * | 2020-12-15 | 2022-12-06 | 西安工业大学 | 无人机室内自主导航方法 |
CN112530014B (zh) * | 2020-12-18 | 2023-07-25 | 北京理工大学重庆创新中心 | 一种多无人机室内场景三维重建方法及装置 |
CN116147698A (zh) * | 2023-01-04 | 2023-05-23 | 广东工业大学 | 一种水陆空多栖侦查的监测*** |
CN116295020B (zh) * | 2023-05-22 | 2023-08-08 | 山东高速工程检测有限公司 | 一种桥梁病害定位方法及定位装置 |
Citations (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101858748A (zh) * | 2010-05-28 | 2010-10-13 | 南京航空航天大学 | 高空长航无人机的多传感器容错自主导航方法 |
CN102424112A (zh) * | 2011-11-30 | 2012-04-25 | 东北大学 | 微小型四旋翼飞行器的三层机载飞控装置 |
CN104843176A (zh) * | 2015-04-28 | 2015-08-19 | 武汉大学 | 一种用于桥梁隧道自动巡检旋翼无人机***及导航方法 |
CN105517666A (zh) * | 2014-09-05 | 2016-04-20 | 深圳市大疆创新科技有限公司 | 基于情景的飞行模式选择 |
CN106093994A (zh) * | 2016-05-31 | 2016-11-09 | 山东大学 | 一种基于自适应加权混合卡尔曼滤波的多源联合定位方法 |
CN106645205A (zh) * | 2017-02-24 | 2017-05-10 | 武汉大学 | 一种无人机桥梁底面裂纹检测方法及*** |
CN106767805A (zh) * | 2017-01-08 | 2017-05-31 | 上海拓攻机器人有限公司 | 基于mems传感器阵列的高精度惯性量测量方法及测量*** |
CN107643762A (zh) * | 2017-08-07 | 2018-01-30 | 中国兵器工业计算机应用技术研究所 | 自主导航的无人机***及其导航方法 |
CN108132053A (zh) * | 2017-11-24 | 2018-06-08 | 北京工商大学 | 一种行人轨迹构建方法、***及惯性测量装置 |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP3152630A4 (en) * | 2014-06-09 | 2017-06-21 | Izak Van Cruyningen | Uav constraint in overhead line inspection |
-
2018
- 2018-11-23 CN CN201811410228.2A patent/CN109282808B/zh not_active Expired - Fee Related
Patent Citations (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101858748A (zh) * | 2010-05-28 | 2010-10-13 | 南京航空航天大学 | 高空长航无人机的多传感器容错自主导航方法 |
CN102424112A (zh) * | 2011-11-30 | 2012-04-25 | 东北大学 | 微小型四旋翼飞行器的三层机载飞控装置 |
CN105517666A (zh) * | 2014-09-05 | 2016-04-20 | 深圳市大疆创新科技有限公司 | 基于情景的飞行模式选择 |
CN104843176A (zh) * | 2015-04-28 | 2015-08-19 | 武汉大学 | 一种用于桥梁隧道自动巡检旋翼无人机***及导航方法 |
CN106093994A (zh) * | 2016-05-31 | 2016-11-09 | 山东大学 | 一种基于自适应加权混合卡尔曼滤波的多源联合定位方法 |
CN106767805A (zh) * | 2017-01-08 | 2017-05-31 | 上海拓攻机器人有限公司 | 基于mems传感器阵列的高精度惯性量测量方法及测量*** |
CN106645205A (zh) * | 2017-02-24 | 2017-05-10 | 武汉大学 | 一种无人机桥梁底面裂纹检测方法及*** |
CN107643762A (zh) * | 2017-08-07 | 2018-01-30 | 中国兵器工业计算机应用技术研究所 | 自主导航的无人机***及其导航方法 |
CN108132053A (zh) * | 2017-11-24 | 2018-06-08 | 北京工商大学 | 一种行人轨迹构建方法、***及惯性测量装置 |
Non-Patent Citations (3)
Title |
---|
基于惯性传感器和视觉里程计的机器人定位;夏凌楠等;《仪器仪表学报》;20130131;第34卷(第1期);第166-172页 * |
李洋.自主防撞无人机传感器的信息融合算法研究.《中国优秀硕士学位论文全文数据库》.2015,第C031-78页. * |
自主防撞无人机传感器的信息融合算法研究;李洋;《中国优秀硕士学位论文全文数据库》;20150415;第C031-78页 * |
Also Published As
Publication number | Publication date |
---|---|
CN109282808A (zh) | 2019-01-29 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109282808B (zh) | 用于桥梁三维巡航检测的无人机与多传感器融合定位方法 | |
CN109945856B (zh) | 基于惯性/雷达的无人机自主定位与建图方法 | |
CN109154506B (zh) | 用于确定第一地标的全局位置的方法和*** | |
CN106017463B (zh) | 一种基于定位传感装置的飞行器定位方法 | |
CN102042835B (zh) | 自主式水下机器人组合导航*** | |
CN110850403A (zh) | 一种多传感器决策级融合的智能船水面目标感知识别方法 | |
US11237005B2 (en) | Method and arrangement for sourcing of location information, generating and updating maps representing the location | |
CN111123911B (zh) | 一种腿足式智能星表探测机器人感知***及其工作方法 | |
CN107422730A (zh) | 基于视觉导引的agv运输***及其驾驶控制方法 | |
JP2022113746A (ja) | 判定装置 | |
CN113781582A (zh) | 基于激光雷达和惯导联合标定的同步定位与地图创建方法 | |
WO2017008454A1 (zh) | 一种机器人的定位方法 | |
Mercado et al. | Gps/ins/optic flow data fusion for position and velocity estimation | |
CN112346463B (zh) | 一种基于速度采样的无人车路径规划方法 | |
WO2018154579A1 (en) | Method of navigating an unmanned vehicle and system thereof | |
CN111260751B (zh) | 基于多传感器移动机器人的建图方法 | |
CN113405560B (zh) | 车辆定位和路径规划统一建模方法 | |
CN112967392A (zh) | 一种基于多传感器触合的大规模园区建图定位方法 | |
CN112862818B (zh) | 惯性传感器和多鱼眼相机联合的地下停车场车辆定位方法 | |
CN113093759A (zh) | 基于多传感器信息融合的机器人编队构造方法及*** | |
Wang et al. | Micro aerial vehicle navigation with visual-inertial integration aided by structured light | |
CN114485613B (zh) | 一种多信息融合水下机器人定位方法 | |
CN115290090A (zh) | 基于多传感器信息融合的slam地图构建方法 | |
Ma et al. | A review: The survey of attitude estimation in autonomous uav navigation | |
Norazman et al. | Landmark scanning by using infrared sensor for simultaneous localization and mapping application |
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 | ||
CF01 | Termination of patent right due to non-payment of annual fee | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20210504 Termination date: 20211123 |