CN109031312A - 适用于烟囱内部作业的飞行平台定位装置和定位方法 - Google Patents
适用于烟囱内部作业的飞行平台定位装置和定位方法 Download PDFInfo
- Publication number
- CN109031312A CN109031312A CN201810382489.1A CN201810382489A CN109031312A CN 109031312 A CN109031312 A CN 109031312A CN 201810382489 A CN201810382489 A CN 201810382489A CN 109031312 A CN109031312 A CN 109031312A
- Authority
- CN
- China
- Prior art keywords
- positioning device
- information
- chimney
- sampling
- dimensional
- 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
- 238000000034 method Methods 0.000 title claims abstract description 34
- 238000012545 processing Methods 0.000 title claims abstract description 6
- 230000004807 localization Effects 0.000 title abstract 2
- 230000004927 fusion Effects 0.000 claims abstract description 7
- 238000005070 sampling Methods 0.000 claims description 91
- 230000005540 biological transmission Effects 0.000 claims description 40
- 230000007246 mechanism Effects 0.000 claims description 12
- 238000012544 monitoring process Methods 0.000 claims description 11
- 238000004891 communication Methods 0.000 claims description 9
- 238000001914 filtration Methods 0.000 claims description 9
- 238000005259 measurement Methods 0.000 claims description 9
- 238000012887 quadratic function Methods 0.000 claims description 8
- 239000000523 sample Substances 0.000 claims description 7
- 230000008859 change Effects 0.000 claims description 6
- 230000002093 peripheral effect Effects 0.000 claims description 6
- 238000012216 screening Methods 0.000 claims description 6
- 238000009434 installation Methods 0.000 claims description 4
- 230000008569 process Effects 0.000 claims description 4
- 238000006243 chemical reaction Methods 0.000 claims description 3
- 238000007726 management method Methods 0.000 description 8
- 238000001514 detection method Methods 0.000 description 6
- 238000004364 calculation method Methods 0.000 description 2
- 230000007797 corrosion Effects 0.000 description 2
- 238000005260 corrosion Methods 0.000 description 2
- 238000010586 diagram Methods 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
Classifications
-
- 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
-
- 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/86—Combinations of sonar systems with lidar systems; Combinations of sonar systems with systems not using wave reflection
-
- 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
- G01S17/00—Systems using the reflection or reradiation of electromagnetic waves other than radio waves, e.g. lidar systems
- G01S17/02—Systems using the reflection of electromagnetic waves other than radio waves
- G01S17/06—Systems determining position data of a target
-
- 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
- G01S17/00—Systems using the reflection or reradiation of electromagnetic waves other than radio waves, e.g. lidar systems
- G01S17/86—Combinations of lidar systems with systems other than lidar, radar or sonar, e.g. with direction finders
Abstract
本发明公开了一种适用于烟囱内部作业的飞行平台定位装置和定位方法。飞行平台定位装置由空中从烟囱顶端竖直进入烟囱内部,通过二维环形激光雷达和四路超声波传感器获取二维空间信息;通过机载电子罗盘获取绝对角度信息,融合解算得到二维平面坐标点;通过一体式云台相机的摄像头结合烟囱已知总高度获取第一高度信息,通过气压计获取第二高度信息,通过辅助定位处理器对两个高度信息进行融合获得绝对高度,进而获得空间位置。本发明中的方法简便易行,使飞行平台定位装置满足烟囱内部作业时的定位问题,具有较高的实用价值。
Description
技术领域
本发明涉及无人机定位领域,特别是涉及到一种适用于烟囱内部作业的飞行平台定位装置和定位方法。
背景技术
多旋翼无人飞行器又称多轴飞行器,是一种结构简单、能够垂直起降的、多旋翼式无人飞行器,凭借其可靠的稳定性,多旋翼无人机经常被用于航拍,桥梁检测,定点巡航等场景。以多旋翼无人飞行器为平台搭载用于烟囱内壁腐蚀图像采集设备可以有效的代替传统的人工检测方法,有利于提高检测效率,降低人员风险,减少检测成本。
定位系统在机器人,无人飞行器等移动平台中起着重要的作用。路径规划,环境检测,实时控制等操作和动作都依赖于定位系统可靠高效的定位结果。准确和稳定的定位系统和定位方法是机器人和无人飞行器等实现其功能的基础和根本。
目前无人飞行器的定位方式主要采用GPS卫星定位。火力发电厂烟囱内部本封闭空间的特性影响GPS定位系统和气压计的稳定性和准确性。无人机飞行器的控制系统的运算能力难以支持视觉为主的定位方式。
发明内容
为了解决背景技术中存在的问题,本发明的目的在于提供一种适用于烟囱内部作业的飞行平台定位装置和定位方法,可以基于先验的应用环境,通过算法准确有效的解算出无人飞行平台定位装置在烟囱内部作业时的位置。
本发明的技术方案包括:
一、一种适用于烟囱内部作业的飞行平台定位装置:
包括半封闭空间内部作业无人机、辅助定位装置、基于旋翼无人机的中继器和地面监控站;半封闭空间内部作业无人机上安装有辅助定位装置,半封闭空间内部作业无人机经中继器与地面监控站连接。
所述半封闭空间内部作业无人机包括多轴飞行器支架和安装多轴飞行器支架上的飞行控制器、飞行执行机构、电源系统、下承载板、一体式云台相机、加速度计、陀螺仪、电子罗盘、气压计、数传模块和图传模块;一体式云台相机上装载摄像头,飞行执行机构布置在多轴飞行器支架周围各角处,多轴飞行器支架上安装有加速度计、陀螺仪、电子罗盘、气压计和飞行控制器,飞行执行机构、加速度计、陀螺仪、电子罗盘和气压计均连接到飞行控制器;多轴飞行器支架中设有下承载板,下承载板底面安装有一体式云台相机,下承载板上安装有数传模块、图传模块和电源系统,数传模块、图传模块、一体式云台相机和电源系统均与飞行控制器连接。
所述的中继器包括数传中继器和图传中继器,数传模块、图传模块分别经数传中继器和图传中继器与地面监控站无线通信连接。
所述辅助定位装置包括辅助定位装置支架以及安装在辅助定位装置支架上的辅助定位处理器、存储模块、电源管理模块、二维环形激光雷达和四路超声波传感器;辅助定位装置支架固定安装在多轴飞行器支架上,四路超声波传感器布置在辅助定位装置支架周围侧面;二维环形激光雷达布置在辅助定位装置支架顶面,辅助定位装置支架中安装有辅助定位处理器、存储模块和电源管理模块,辅助定位处理器和飞行控制器通讯连接,辅助定位处理器分别与存储模块、电源管理模块、二维环形激光雷达和四路超声波传感器连接。
二维环形激光雷达和四路超声波传感器均用于采集获得角度信息及其对应的距离信息。
所述的辅助定位装置中的辅助定位处理器和飞行控制器之间通过can总线以PnP方式通讯连接。
所述的四路超声波传感器分别布置在辅助定位装置支架周围侧面的四边边缘处并且传感器探头水平向外布置。
所述的飞行执行机构主要由电机和螺旋桨构成。
二、一种适用于烟囱内部作业的飞行定位方法:
1)所述飞行平台定位装置由空中从烟囱顶端竖直进入烟囱内部,通过二维环形激光雷达和四路超声波传感器获取飞行平台定位装置在水平面所处位置的二维空间信息;
2)通过机载电子罗盘获取飞行平台定位装置机头正前方向的绝对角度信息,通过辅助定位处理器对所获取的二维空间信息和绝对角度信息进行融合解算得到飞行平台定位装置在烟囱为坐标系下的二维平面坐标点(x',y');
3)通过一体式云台相机的摄像头结合烟囱已知总高度获取飞行平台定位装置在烟囱内部距离烟囱底部的第一高度信息,通过气压计获取飞行平台定位装置相对地面的第二高度信息,通过辅助定位处理器对两个高度信息进行融合,获得飞行平台定位装置在烟囱内部作业时距离地面的绝对高度h;
4)组合步骤2)获得的二维平面坐标点和步骤3)获得的绝对高度获得飞行平台定位装置以烟囱为坐标系下的空间位置(x',y',h)。
所述步骤1)中,通过二维环形激光雷达所获取飞行平台定位装置在水平面所处位置的二维空间信息,具体为:
1.1)通过二维环形激光雷达得到各个采样点的采样信息,采样信息包括角度信息θi和距离信息di,i为二维环形激光雷达采样一周时的采样点序数;
1.2)二维环形激光雷达采样一周得到的采样信息构成一个采样点集,对采样点集去除误差:
1.2.1)通过二维环形激光雷达采样一周得到的采样点的角度信息θi和距离信息di,采用以下公式获取相邻采样点之间的采样差信息(Δθn,Δdn):
Δθn=θi-θi-1,Δdn=di-di-1,n=(1,2,3...m)
其中,Δθn为相邻采样点角度变化信息,Δdn为相邻角度变化信息Δθn所对应的距离变化信息,m表示采样差总数,n表示采样差的序数;
1.2.2)将采样点集以平均分布的每五个点为一组的采样差信息建立拟合点集,从而将采样点集的采样差信息分为多个拟合点集,第k个拟合点集Φk表示为:
Φk={(Δθk,Δdk)}(k=n,n+s,n+2s,n+3s,n+4s),(n=1,2,3,...s),(s=1/5m)
将每个拟合点集Φk二次函数多项式f(x)=ax2+bx+c拟合并通过最小二乘法解算每个拟合点集Φk的的参数解(ak,bk,ck),(ak,bk,ck)表示第k个拟合点集Φk通过二次函数多项式拟合后的第一、第二、第三参数解,将各个拟合点集的参数解构成多项式参数解集:
U={(ak,bk,ck)|k=1,2,3...s}
1.2.3)针对每个参数解(ak,bk,ck)采用以下公式的筛选条件进行判断:
其中,δ1、δ2、δ3分别表示第一、第二、第三参数解的偏差阈值;
若参数解(ak,bk,ck)中的任一参数解不满足上述参数解(ak,bk,ck)筛选条件,则将该参数解(ak,bk,ck)的拟合点集Φk对应的采样点从采样点集中剔除,得到去除误差的采样点集;
1.3)通过扩展卡尔曼滤波算法对去除误差的采样点集处理去除噪声干扰,得到的二维环形激光雷达采样一周得到的雷达初始采样信息集Ψ1={(θ'i,d'i)}。
所述步骤1)中,通过四路超声波传感器所获取飞行平台定位装置在水平面所处位置的二维空间信息,具体为:
以飞行平台定位装置的无人机机头正前方向为0°,作为参考方向,通过测量得到四路超声波传感器的四个超声波传感器分别在飞行平台定位装置上相对于参考方向的安装角度α,超声波传感器通过卡尔曼滤波后获取距离初始距离信息l,四路超声波传感器分别得到超声波初始采样信息集Ψ2={(αu,lu)|u=1,2,3,4}。
所述步骤3)具体为:
3.1)固定机载摄像头朝向为水平,飞行平台定位装置根据摄像头在从烟囱顶端下降飞行过程中采集到的图像序列解算出飞行平台定位装置在烟囱内部由烟囱顶端向烟囱底端飞行的距离c,结合烟囱已知总高度H获取飞行平台定位装置在烟囱内部距离烟囱底部的第一高度信息h1=H-c;
3.2)通过气压计经过卡尔曼滤波滤波后获得第二高度信息h2;
3.3)通过以下公式的加权数据融合算法计算获取飞行平台定位装置在烟囱内部作业时距离地面的绝对高度h:
h=ph1+(1-p)h2
其中,p表示高度权值。
所述步骤2)具体为:
2.1)将雷达初始采样信息集Ψ1和超声波初始采样信息集Ψ2合并,组成以飞行平台定位装置中心为原点、以飞行平台定位装置机头正前方为0°的水平面坐标系下的二维测量信息集Ψ=Ψ1∪Ψ2={(ωt,zt)},其中ωt为第t个二维角度信息,zt为第t个二维距离信息;
2.2)根据二维测量信息集电子罗盘获取的机头正前方向与正东方向之间的逆时针绝对夹角采用以下公式通过极坐标直角坐标系转换修正方向偏差得到二维空间直角坐标信息(xt,yt):
其中,表示通过电子罗盘获得的逆时针绝对夹角;
2.3)将二维空间直角坐标信息(xt,yt)拟合成二维圆形曲线方程 (x-w)2+(y-e)2=R2,获得二维圆形曲线方程的参数w、e和R,其中(w,e)为拟合圆心坐标并作为烟囱圆形结构中心点位置坐标,R为拟合圆半径;
2.4)通过坐标转换将烟囱圆形结构中心点位置坐标(m,n)转换到(0,0),获取飞行平台定位装置的二维空间直角坐标信息(xt,yt)在烟囱为坐标系下的二维平面坐标点(x',y')。
本发明对于现有的技术具有以下有益效果:
本发明将将二维激光雷达结合四路超声波传感器搭载在无人飞行器平台上,获取飞行平台定位装置在二维平面中距离墙壁的极坐标信息,并通过先验的结构信息,提高定位算法的准确性和速度。通过相机标定法和飞行平台定位装置距离信息获得从顶部向下运行的距离,结合气压计信息获取飞行器在烟囱内部的高度信息,扩展了无人机飞行平台定位装置的应用领域,在无人飞行器定位领域和火力发电厂烟囱内壁腐蚀检测的行业应用领域均具有实际的应用价值。
附图说明
图1为本发明飞行平台定位装置俯视结构图。
图2为本发明飞行平台定位装置一侧视结构图。
图3为本发明飞行平台定位装置另一侧视局部结构图。
图4为本发明内各个部分模块电气连接结构图。
图5为本发明的定位系统流程图。
图6是发明实施例在烟囱个内部二维平面定位示意图。
图中:1、二维环形激光雷达,2、四路超声波传感器,3、辅助定位处理器, 4、辅助定位装置支架,5、加速度计,6、陀螺仪,7、电子罗盘,8、数传模块, 9、图传模块,10、电源系统,11、下承载板,12、一体式云台相机,13、多轴飞行器支架,14气压计,15、数传中继器,16、图传中继器、17、飞行执行机构,18、飞行控制器。S1、半封闭空间内部作业无人机,S2、辅助定位装置, S3、中继器,S4、地面监控站。
具体实施方式
下面结合附图和实施例对本发明作进一步说明。
如图1所示,本发明包括半封闭空间内部作业无人机S1、辅助定位装置S2、基于旋翼无人机的中继器S3和地面监控站S4;半封闭空间内部作业无人机S1 上安装有辅助定位装置S2,半封闭空间内部作业无人机S1经中继器S3与地面监控站S4连接。地面监控站S4可以采用计算机。
如图1-图3所示,半封闭空间内部作业无人机S1包括多轴飞行器支架13 和安装多轴飞行器支架13上的飞行控制器18、飞行执行机构17、电源系统10、下承载板11、一体式云台相机12、加速度计5、陀螺仪6、电子罗盘7、气压计 14、数传模块8和图传模块9;一体式云台相机12上装载摄像头,飞行执行机构17布置在多轴飞行器支架13周围各角处,飞行执行机构17主要由电机和螺旋桨构成,多轴飞行器支架13上安装有加速度计5、陀螺仪6、电子罗盘7、气压计14和飞行控制器18,飞行执行机构17、加速度计5、陀螺仪6、电子罗盘 7和气压计14均连接到飞行控制器18;多轴飞行器支架13中设有下承载板11,下承载板11底面安装有一体式云台相机12,下承载板11上安装有数传模块8、图传模块9和电源系统10,数传模块8、图传模块9、一体式云台相机12和电源系统10均与飞行控制器18连接;电源系统10用于对飞行控制器18及无人机中与飞行控制器18连接的各个器件进行供电。
如图4所示,中继器S3包括数传中继器15和图传中继器16,数传模块8、图传模块9分别经数传中继器15和图传中继器16与地面监控站S4无线通信连接;辅助定位装置S2包括辅助定位装置支架4以及安装在辅助定位装置支架4 上的辅助定位处理器3、存储模块19、电源管理模块20、二维环形激光雷达1 和四路超声波传感器2;辅助定位装置支架4固定安装在多轴飞行器支架13上,位于下承载板11上方,四路超声波传感器2布置在辅助定位装置支架4周围侧面,沿辅助定位装置支架4周向间隔均布,四路超声波传感器2的传感器探头朝向分别朝向相对于多轴飞行器支架13的东南西北四个方向,其中一个超声波传感器2的传感器探头朝向无人机S1机头正方向;二维环形激光雷达1布置在辅助定位装置支架4顶面,辅助定位装置支架4中安装有辅助定位处理器3、存储模块19和电源管理模块20,辅助定位处理器3和飞行控制器18通讯连接,辅助定位处理器3分别与存储模块19、电源管理模块20、二维环形激光雷达1 和四路超声波传感器2连接,电源管理模块20用于对辅助定位处理器3、存储模块19、二维环形激光雷达1和四路超声波传感器2进行供电。
辅助定位装置S2中的辅助定位处理器3和飞行控制器18通讯连接,将从二维环形激光雷达1和四路超声波传感器2采集到的数据与无人机S1的飞行控制器18本身采集到的飞行数据融合处理,获得无人机在半封闭空间内部的空间位置信息。
辅助定位装置S2中的辅助定位处理器3和飞行控制器18之间通过can总线以PnP方式通讯连接。
四路超声波传感器2分别布置在辅助定位装置支架4周围侧面的四边边缘处并且传感器探头水平向外布置。
如图5所示,本发明的具体实施例及其实施工作过程如下:
1)飞行平台定位装置由空中从烟囱顶端竖直进入烟囱内部,如图6所示,通过二维环形激光雷达1和四路超声波传感器3获取飞行平台定位装置在水平面所处位置的二维空间信息;
A)通过二维环形激光雷达1所获取飞行平台定位装置在水平面所处位置的二维空间信息,具体为:
1.1)通过二维环形激光雷达1得到各个采样点的采样信息,采样信息包括角度信息θi和距离信息di,i为二维环形激光雷达1采样一周时的采样点序数,角度信息θi是指二维环形激光雷达1探头采样时的圆周角度值,距离信息di是指二维环形激光雷达1探头采样时的所探测到距离烟囱内壁的间距值;
1.2)烟囱内部同一水平面的内壁形状视为圆形结构,二维环形激光雷达1采样一周得到的采样信息构成一个采样点集(θi,di),对采样点集通过设定采样阈值δl(l=1,2,3)去除误差:
1.2.1)通过二维环形激光雷达1采样一周得到的采样点的角度信息θi和距离信息di,采用以下公式获取相邻采样点之间的采样差信息(Δθn,Δdn):
Δθn=θi-θi-1,Δdn=di-di-1,n=(1,2,3...m)
其中,Δθn为相邻采样点角度变化信息,Δdn为相邻角度变化信息Δθn所对应的距离变化信息,m表示采样差总数,n表示采样差的序数;
采样差信息(Δθn,Δdn)满足二次函数多项式:
Δdn=aΔθn 2+bΔθn+c
其中,(ak,bk,ck)表示第k个拟合点集Φk通过二次函数多项式拟合后的第一、第二、第三参数解。
1.2.2)将采样点集以平均分布的每五个点为一组的采样差信息建立拟合点集,从而将采样点集的采样差信息分为多个拟合点集,第k个拟合点集Φk表示为:
Φk={(Δθk,Δdk)}(k=n,n+s,n+2s,n+3s,n+4s),(n=1,2,3,...s),(s=1/5m)
将每个拟合点集Φk二次函数多项式f(x)=ax2+bx+c拟合并通过最小二乘法解算每个拟合点集Φk的的参数解(ak,bk,ck),(ak,bk,ck)表示第k个拟合点集Φk通过二次函数多项式拟合后的第一、第二、第三参数解,将各个拟合点集的参数解构成多项式参数解集:
U={(ak,bk,ck)|k=1,2,3...s}
1.2.3)针对每个参数解(ak,bk,ck)采用以下公式的筛选条件进行判断:
其中,δ1、δ2、δ3分别表示第一、第二、第三参数解的偏差阈值,具体实施中取为δ1=0.7,δ2=0.5,δ3=0.3;
若参数解(ak,bk,ck)中的任一参数解不满足上述参数解(ak,bk,ck)筛选条件,则将该参数解(ak,bk,ck)的拟合点集Φk对应的采样点从采样点集(θi,di)中剔除,得到去除误差的采样点集;
1.3)通过扩展卡尔曼滤波算法对去除误差的采样点集处理去除噪声干扰,得到的二维环形激光雷达1采样一周得到的雷达初始采样信息集Ψ1={(θ'i,d'i)},作为二维空间信息。
B)通过四路超声波传感器3所获取飞行平台定位装置在水平面所处位置的二维空间信息,具体为:
以飞行平台定位装置的无人机机头正前方向为0°,作为参考方向,通过测量得到四路超声波传感器3的四个超声波传感器分别在飞行平台定位装置上相对于参考方向的安装角度α,超声波传感器通过卡尔曼滤波后获取距离初始距离信息l,四路超声波传感器3分别得到超声波初始采样信息集Ψ2={(au,lu)|u=1,2,3,4},作为二维空间信息,u表示超声波传感器在飞行平台定位装置上安装位置的序数。
2)通过机载电子罗盘7获取飞行平台定位装置机头正前方向的绝对角度信息,通过辅助定位处理器2对所获取的二维空间信息和绝对角度信息进行融合解算得到飞行平台定位装置在烟囱为坐标系下的二维平面坐标点(x',y');
2.1)将雷达初始采样信息集Ψ1和超声波初始采样信息集Ψ2合并,组成以飞行平台定位装置中心为原点、以飞行平台定位装置机头正前方为00的水平面坐标系下能够反映二维空间环境角度和距离的二维测量信息集Ψ=Ψ1∪Ψ2={(ωt,zt)},t=i+u,t=1,...,m+4,其中ωt为第t个二维角度信息,zt为第t个二维距离信息;
2.2)根据二维测量信息集电子罗盘14获取的机头正前方向与正东方向之间的逆时针绝对夹角采用以下公式通过极坐标直角坐标系转换修正方向偏差得到二维空间直角坐标信息(xt,yt):
其中,表示通过电子罗盘7获得的逆时针绝对夹角;
2.3)通过随机抽样一致性算法和最小二乘法将二维空间直角坐标信息(xt,yt) 拟合成二维圆形曲线方程(x-w)2+(y-e)2=R2,获得二维圆形曲线方程的参数w、 e和R,具体是先用随机抽样一致性算法得到局内点,再用最小二乘法对局内点拟合求解,其中(w,e)为拟合圆心坐标并作为烟囱圆形结构中心点位置坐标,R 为拟合圆半径;
2.4)通过坐标转换将烟囱圆形结构中心点位置坐标(m,n)转换到0,0,获取飞行平台定位装置的二维空间直角坐标信息(xt,yt)在烟囱为坐标系下的二维平面坐标点(x',y')。
3)通过一体式云台相机12的摄像头结合烟囱已知总高度获取飞行平台定位装置在烟囱内部距离烟囱底部的第一高度信息,通过气压计14获取飞行平台定位装置相对地面的第二高度信息,通过辅助定位处理器2对两个高度信息进行融合,获得飞行平台定位装置在烟囱内部作业时距离地面的绝对高度h;
3.1)固定机载摄像头朝向为水平,飞行平台定位装置根据摄像头在从烟囱顶端下降飞行过程中采集到的图像序列解算出飞行平台定位装置在烟囱内部由烟囱顶端向烟囱底端飞行的距离c,结合烟囱已知总高度H获取飞行平台定位装置在烟囱内部距离烟囱底部的第一高度信息h1=H-c;
3.2)通过气压计14经过卡尔曼滤波滤波后获得第二高度信息h2;
3.3)通过以下公式的加权数据融合算法计算获取飞行平台定位装置在烟囱内部作业时距离地面的绝对高度h:
h=ph1+(1-p)h2
其中,p表示高度权值。
具体实施通过辅助定位处理器根据装置运行情况和图像高度信息与气压计高度信息的实时稳定情况,自动调整权值。
通过一体式云台相机12的摄像头结合烟囱已知总高度获取飞行平台定位装置与烟囱顶端入口之间的距离信息c,具体为;
首先,以摄像头的位置作为飞行平台定位装置的位置,根据飞行平台定位装置在烟囱内部的定位算法获取摄像头与其采集当下时刻图像时所朝向的烟囱内壁之间的距离Z,由距离Z结合摄像头标定获取所能采集到的图像的宽度系数 B计算得到采集图像的宽度Y=B*Z,宽度为图像的纵方向,对应于沿竖直方向的距离;
接着,控制飞行平台定位装置从烟囱顶部进入烟囱内部采集图像信息,采集飞行平台定位装置带动摄像头旋转一周为一次作业的。一次作业完成后竖直下降一段距离进行第二次作业,保证每次竖直向下的一段距离使得上一次作业和下一次作业同一侧图像的特征点重复率在30%-50%之间,依次作业至底部。飞行平台定位装置上以摄像头正东方向的图像为高度解算图像。
通过特征点匹配的算法拼接正东方向的图像,根据正东方向每两张连续图特征点之间的图像距离,解算出依次下降的距离Y1,Y2,Y3…,最后根据依次下降的距离累加计算出飞行平台定位装置在烟囱内部由烟囱顶部向烟囱底部飞行的距离c=Y1+Y2+Y3+…。
4)组合步骤2)获得的二维平面坐标点和步骤3)获得的绝对高度获得飞行平台定位装置以烟囱为坐标系下的空间位置(x',y',h)。
由此,本发明将二维激光雷达结合四路超声波传感器搭载在无人飞行器平台上,能准确获取飞行平台在二位平面中距离墙壁的位置,获得从顶部向下运行的距离,结合气压计信息获取飞行器在烟囱内部的高度信息,具有其突出显著的技术效果。
Claims (10)
1.一种适用于烟囱内部作业的飞行平台定位装置,其特征在于:包括半封闭空间内部作业无人机(S1)、辅助定位装置(S2)、基于旋翼无人机的中继器(S3)和地面监控站(S4);半封闭空间内部作业无人机(S1)上安装有辅助定位装置(S2),半封闭空间内部作业无人机(S1)经中继器(S3)与地面监控站(S4)连接。
2.根据权利要求1所述的一种适用于烟囱内部作业的飞行平台定位装置,其特征在于:所述半封闭空间内部作业无人机(S1)包括多轴飞行器支架(13)和安装多轴飞行器支架(13)上的飞行控制器(18)、飞行执行机构(17)、电源系统(10)、下承载板(11)、一体式云台相机(12)、加速度计(5)、陀螺仪(6)、电子罗盘(7)、气压计(14)、数传模块(8)和图传模块(9);一体式云台相机(12)上装载摄像头,飞行执行机构(17)布置在多轴飞行器支架(13)周围各角处,多轴飞行器支架(13)上安装有加速度计(5)、陀螺仪(6)、电子罗盘(7)、气压计(14)和飞行控制器(18),飞行执行机构(17)、加速度计(5)、陀螺仪(6)、电子罗盘(7)和气压计(14)均连接到飞行控制器(18);多轴飞行器支架(13)中设有下承载板(11),下承载板(11)底面安装有一体式云台相机(12),下承载板(11)上安装有数传模块(8)、图传模块(9)和电源系统(10),数传模块(8)、图传模块(9)、一体式云台相机(12)和电源系统(10)均与飞行控制器(18)连接;
所述的中继器(S3)包括数传中继器(15)和图传中继器(16),数传模块(8)、图传模块(9)分别经数传中继器(15)和图传中继器(16)与地面监控站(S4)无线通信连接;
所述辅助定位装置(S2)包括辅助定位装置支架(4)以及安装在辅助定位装置支架(4)上的辅助定位处理器(3)、存储模块(19)、电源管理模块(20)、二维环形激光雷达(1)和四路超声波传感器(2);辅助定位装置支架(4)固定安装在多轴飞行器支架(13)上,四路超声波传感器(2)布置在辅助定位装置支架(4)周围侧面;二维环形激光雷达(1)布置在辅助定位装置支架(4)顶面,辅助定位装置支架(4)中安装有辅助定位处理器(3)、存储模块(19)和电源管理模块(20),辅助定位处理器(3)和飞行控制器(18)通讯连接,辅助定位处理器(3)分别与存储模块(19)、电源管理模块(20)、二维环形激光雷达(1)和四路超声波传感器(2)连接。
3.根据权利要求1所述的一种适用于烟囱内部作业的飞行平台定位装置,其特征在于:所述的辅助定位装置(S2)中的辅助定位处理器(3)和飞行控制器(18)之间通过can总线以PnP方式通讯连接。
4.根据权利要求1所述的一种适用于烟囱内部作业的飞行平台定位装置,其特征在于:所述的四路超声波传感器(2)分别布置在辅助定位装置支架(4)周围侧面的四边边缘处并且传感器探头水平向外布置。
5.根据权利要求1所述的一种适用于烟囱内部作业的飞行平台定位装置,其特征在于:所述的飞行执行机构(17)主要由电机和螺旋桨构成。
6.应用于权利要求2-5任一所述飞行平台定位装置的一种适用于烟囱内部作业的飞行定位方法,其特征在于所述方法包括:
1)所述飞行平台定位装置由空中从烟囱顶端竖直进入烟囱内部,通过二维环形激光雷达(1)和四路超声波传感器(3)获取飞行平台定位装置在水平面所处位置的二维空间信息;
2)通过机载电子罗盘(7)获取飞行平台定位装置机头正前方向的绝对角度信息,通过辅助定位处理器(2)对所获取的二维空间信息和绝对角度信息进行融合解算得到飞行平台定位装置在烟囱为坐标系下的二维平面坐标点(x',y');
3)通过一体式云台相机(12)的摄像头结合烟囱已知总高度获取飞行平台定位装置在烟囱内部距离烟囱底部的第一高度信息,通过气压计(14)获取飞行平台定位装置相对地面的第二高度信息,通过辅助定位处理器(2)对两个高度信息进行融合,获得飞行平台定位装置在烟囱内部作业时距离地面的绝对高度h;
4)组合步骤2)获得的二维平面坐标点和步骤3)获得的绝对高度获得飞行平台定位装置以烟囱为坐标系下的空间位置(x',y',h)。
7.根据权利要求6所述的一种适用于烟囱内部作业的飞行定位方法,其特征在于:所述步骤1)中,通过二维环形激光雷达(1)所获取飞行平台定位装置在水平面所处位置的二维空间信息,具体为:
1.1)通过二维环形激光雷达(1)得到各个采样点的采样信息,采样信息包括角度信息θi和距离信息di,i为二维环形激光雷达(1)采样一周时的采样点序数;
1.2)二维环形激光雷达(1)采样一周得到的采样信息构成一个采样点集,对采样点集去除误差:
1.2.1)通过二维环形激光雷达(1)采样一周得到的采样点的角度信息θi和距离信息di,采用以下公式获取相邻采样点之间的采样差信息(△θn,△dn):
△θn=θi-θi-1,△dn=di-di-1,n=(1,2,3...m)
其中,△θn为相邻采样点角度变化信息,△dn为相邻角度变化信息△θn所对应的距离变化信息,m表示采样差总数,n表示采样差的序数;
1.2.2)将采样点集以平均分布的每五个点为一组的采样差信息建立拟合点集,从而将采样点集的采样差信息分为多个拟合点集,第k个拟合点集Φk表示为:
Φk={(△θk,△dk)}(k=n,n+s,n+2s,n+3s,n+4s),(n=1,2,3,...s),(s=1/5m)
将每个拟合点集Φk二次函数多项式f(x)=ax2+bx+c拟合并通过最小二乘法解算每个拟合点集Φk的的参数解(ak,bk,ck),(ak,bk,ck)表示第k个拟合点集Φk通过二次函数多项式拟合后的第一、第二、第三参数解,将各个拟合点集的参数解构成多项式参数解集:
U={(ak,bk,ck)|k=1,2,3...s}
1.2.3)针对每个参数解(ak,bk,ck)采用以下公式的筛选条件进行判断:
其中,δ1、δ2、δ3分别表示第一、第二、第三参数解的偏差阈值;
若参数解(ak,bk,ck)中的任一参数解不满足上述参数解(ak,bk,ck)筛选条件,则将该参数解(ak,bk,ck)的拟合点集Φk对应的采样点从采样点集中剔除,得到去除误差的采样点集;
1.3)通过扩展卡尔曼滤波算法对去除误差的采样点集处理去除噪声干扰,得到的二维环形激光雷达(1)采样一周得到的雷达初始采样信息集Ψ1={(θi',di')}。
8.根据权利要求6所述的一种适用于烟囱内部作业的飞行定位方法,其特征在于:所述步骤1)中,通过四路超声波传感器(3)所获取飞行平台定位装置在水平面所处位置的二维空间信息,具体为:
以飞行平台定位装置的无人机机头正前方向为00,作为参考方向,通过测量得到四路超声波传感器(3)的四个超声波传感器分别在飞行平台定位装置上相对于参考方向的安装角度α,超声波传感器通过卡尔曼滤波后获取距离初始距离信息l,四路超声波传感器(3)分别得到超声波初始采样信息集Ψ2={(αu,lu)|u=1,2,3,4}。
9.根据权利要求6所述的一种适用于烟囱内部作业的飞行定位方法,其特征在于:所述步骤2)具体为:
2.1)将雷达初始采样信息集Ψ1和超声波初始采样信息集Ψ2合并,组成以飞行平台定位装置中心为原点、以飞行平台定位装置机头正前方为00的水平面坐标系下的二维测量信息集Ψ=Ψ1∪Ψ2={(ωt,zt)},其中ωt为第t个二维角度信息,zt为第t个二维距离信息;
2.2)根据二维测量信息集电子罗盘(14)获取的机头正前方向与正东方向之间的逆时针绝对夹角采用以下公式通过极坐标直角坐标系转换修正方向偏差得到二维空间直角坐标信息(xt,yt):
其中,表示通过电子罗盘(7)获得的逆时针绝对夹角;
2.3)将二维空间直角坐标信息(xt,yt)拟合成二维圆形曲线方程(x-w)2+(y-e)2=R2,获得二维圆形曲线方程的参数w、e和R,其中(w,e)为拟合圆心坐标并作为烟囱圆形结构中心点位置坐标,R为拟合圆半径;
2.4)通过坐标转换将烟囱圆形结构中心点位置坐标(w,e)转换到(0,0),获取飞行平台定位装置的二维空间直角坐标信息(xt,yt)在烟囱为坐标系下的二维平面坐标点(x',y')。
10.根据权利要求6所述的一种适用于烟囱内部作业的飞行定位方法,其特征在于:所述步骤3)具体为:
3.1)固定机载摄像头朝向为水平,飞行平台定位装置根据摄像头在从烟囱顶端下降飞行过程中采集到的图像序列解算出飞行平台定位装置在烟囱内部由烟囱顶端向烟囱底端飞行的距离c,结合烟囱已知总高度H获取飞行平台定位装置在烟囱内部距离烟囱底部的第一高度信息h1=H-c;
3.2)通过气压计(14)经过卡尔曼滤波滤波后获得第二高度信息h2;
3.3)通过以下公式的加权数据融合算法计算获取飞行平台定位装置在烟囱内部作业时距离地面的绝对高度h:
h=ph1+(1-p)h2
其中,p表示高度权值。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810382489.1A CN109031312B (zh) | 2018-04-26 | 2018-04-26 | 适用于烟囱内部作业的飞行平台定位装置和定位方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810382489.1A CN109031312B (zh) | 2018-04-26 | 2018-04-26 | 适用于烟囱内部作业的飞行平台定位装置和定位方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN109031312A true CN109031312A (zh) | 2018-12-18 |
CN109031312B CN109031312B (zh) | 2023-08-22 |
Family
ID=64629552
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201810382489.1A Active CN109031312B (zh) | 2018-04-26 | 2018-04-26 | 适用于烟囱内部作业的飞行平台定位装置和定位方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN109031312B (zh) |
Cited By (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110040244A (zh) * | 2019-04-19 | 2019-07-23 | 中国计量大学 | 基于无人机悬挂平台的烟囱内壁图像采集装置与方法 |
CN110736993A (zh) * | 2019-10-31 | 2020-01-31 | 重庆交通大学 | 一种用于室内多目标定位的超声波定位系统及方法 |
CN111238477A (zh) * | 2019-03-25 | 2020-06-05 | 武汉珈鹰智能科技有限公司 | 一种烟囱内无人机的定位方法及装置 |
CN111352439A (zh) * | 2020-03-18 | 2020-06-30 | 广州万为石化科技有限公司 | 一种无人飞行器辅助的烟囱检测设备及检测方法 |
WO2021087643A1 (zh) * | 2019-11-04 | 2021-05-14 | 深圳市大疆创新科技有限公司 | 地杂波抑制与地形估计方法、无人机、旋转雷达及存储介质 |
CN113541763A (zh) * | 2021-06-04 | 2021-10-22 | 常州希米智能科技有限公司 | 一种烟囱内无人机视频拍摄传输控制方法和装置 |
WO2022153392A1 (ja) * | 2021-01-13 | 2022-07-21 | 株式会社Acsl | 無人航空機の自己位置推定システム及び方法、無人航空機、プログラム、並びに記憶媒体 |
WO2022153390A1 (ja) * | 2021-01-13 | 2022-07-21 | 株式会社Acsl | 無人航空機の自己位置を推定する自己位置推定システム、飛行制御システム、無人航空機、プログラム、及び、記録媒体 |
WO2022153391A1 (ja) * | 2021-01-13 | 2022-07-21 | 株式会社Acsl | 無人航空機の自己位置及び/又は姿勢を推定する推定システム、飛行制御システム、無人航空機、プログラム、及び、記録媒体 |
Citations (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20120089274A1 (en) * | 2010-10-06 | 2012-04-12 | Hon Hai Precision Industry Co., Ltd. | Electronic device and method for controlling unmanned aerial vehicle |
CN103868521A (zh) * | 2014-02-20 | 2014-06-18 | 天津大学 | 基于激光雷达的四旋翼无人机自主定位及控制方法 |
CN104683759A (zh) * | 2015-01-23 | 2015-06-03 | 中国计量学院 | 基于飞行器的烟囱内壁腐蚀情况无线视频监控设备与方法 |
CN105818998A (zh) * | 2016-05-24 | 2016-08-03 | 北京小米移动软件有限公司 | 飞行器及其室内辅助定位装置 |
US20170139410A1 (en) * | 2014-07-02 | 2017-05-18 | Mitsubishi Heavy Industries, Ltd. | Indoor monitoring system and method for structure |
CN106932411A (zh) * | 2017-04-06 | 2017-07-07 | 侯思明 | 一种应用于火电厂的设备检测方法及装置 |
JP2017154577A (ja) * | 2016-03-01 | 2017-09-07 | 株式会社タクマ | 無人航空機を用いた施設内点検システム |
CN107450583A (zh) * | 2017-08-23 | 2017-12-08 | 浙江工业大学 | 基于高通骁龙处理器的无人机运动跟踪系统 |
CN208506246U (zh) * | 2018-04-26 | 2019-02-15 | 中国计量大学 | 一种适用于烟囱内部作业飞行平台定位的装置 |
-
2018
- 2018-04-26 CN CN201810382489.1A patent/CN109031312B/zh active Active
Patent Citations (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20120089274A1 (en) * | 2010-10-06 | 2012-04-12 | Hon Hai Precision Industry Co., Ltd. | Electronic device and method for controlling unmanned aerial vehicle |
CN103868521A (zh) * | 2014-02-20 | 2014-06-18 | 天津大学 | 基于激光雷达的四旋翼无人机自主定位及控制方法 |
US20170139410A1 (en) * | 2014-07-02 | 2017-05-18 | Mitsubishi Heavy Industries, Ltd. | Indoor monitoring system and method for structure |
CN104683759A (zh) * | 2015-01-23 | 2015-06-03 | 中国计量学院 | 基于飞行器的烟囱内壁腐蚀情况无线视频监控设备与方法 |
JP2017154577A (ja) * | 2016-03-01 | 2017-09-07 | 株式会社タクマ | 無人航空機を用いた施設内点検システム |
CN105818998A (zh) * | 2016-05-24 | 2016-08-03 | 北京小米移动软件有限公司 | 飞行器及其室内辅助定位装置 |
CN106932411A (zh) * | 2017-04-06 | 2017-07-07 | 侯思明 | 一种应用于火电厂的设备检测方法及装置 |
CN107450583A (zh) * | 2017-08-23 | 2017-12-08 | 浙江工业大学 | 基于高通骁龙处理器的无人机运动跟踪系统 |
CN208506246U (zh) * | 2018-04-26 | 2019-02-15 | 中国计量大学 | 一种适用于烟囱内部作业飞行平台定位的装置 |
Non-Patent Citations (2)
Title |
---|
NORMAN HALLERMANN: "Unmanned aerial vehicles(UAV) for the assessment of existing strutures", IABSE SYMPOSIUM REPORT, pages 10 - 13 * |
杨中波,陈梦,李兵: "无人机在烟囱防腐工程中应用可行性研究", 《中国优秀硕士论文(工程科技Ⅱ辑)》, pages 110 - 111 * |
Cited By (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111238477A (zh) * | 2019-03-25 | 2020-06-05 | 武汉珈鹰智能科技有限公司 | 一种烟囱内无人机的定位方法及装置 |
CN110040244A (zh) * | 2019-04-19 | 2019-07-23 | 中国计量大学 | 基于无人机悬挂平台的烟囱内壁图像采集装置与方法 |
CN110736993A (zh) * | 2019-10-31 | 2020-01-31 | 重庆交通大学 | 一种用于室内多目标定位的超声波定位系统及方法 |
WO2021087643A1 (zh) * | 2019-11-04 | 2021-05-14 | 深圳市大疆创新科技有限公司 | 地杂波抑制与地形估计方法、无人机、旋转雷达及存储介质 |
CN111352439A (zh) * | 2020-03-18 | 2020-06-30 | 广州万为石化科技有限公司 | 一种无人飞行器辅助的烟囱检测设备及检测方法 |
CN111352439B (zh) * | 2020-03-18 | 2023-10-31 | 广州万为石化科技有限公司 | 一种无人飞行器辅助的烟囱检测设备及检测方法 |
WO2022153392A1 (ja) * | 2021-01-13 | 2022-07-21 | 株式会社Acsl | 無人航空機の自己位置推定システム及び方法、無人航空機、プログラム、並びに記憶媒体 |
WO2022153390A1 (ja) * | 2021-01-13 | 2022-07-21 | 株式会社Acsl | 無人航空機の自己位置を推定する自己位置推定システム、飛行制御システム、無人航空機、プログラム、及び、記録媒体 |
WO2022153391A1 (ja) * | 2021-01-13 | 2022-07-21 | 株式会社Acsl | 無人航空機の自己位置及び/又は姿勢を推定する推定システム、飛行制御システム、無人航空機、プログラム、及び、記録媒体 |
CN113541763A (zh) * | 2021-06-04 | 2021-10-22 | 常州希米智能科技有限公司 | 一种烟囱内无人机视频拍摄传输控制方法和装置 |
Also Published As
Publication number | Publication date |
---|---|
CN109031312B (zh) | 2023-08-22 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109031312B (zh) | 适用于烟囱内部作业的飞行平台定位装置和定位方法 | |
US11149717B2 (en) | Unmanned aerial vehicle wind turbine inspection systems and methods | |
CN110308457B (zh) | 一种基于无人机的输电线路巡检系统 | |
CN108306217B (zh) | 一种架空高压线智能自主沿导线飞行巡检系统和方法 | |
JP7260269B2 (ja) | 航空非破壊検査用の測位システム | |
He et al. | Research of multi-rotor UAVs detailed autonomous inspection technology of transmission lines based on route planning | |
CN108733079B (zh) | 通过无人机对风机进行自动巡检飞行路径确定方法及系统 | |
CN109911188B (zh) | 非卫星导航定位环境的桥梁检测无人机系统 | |
DK2702382T3 (en) | METHOD AND SYSTEM FOR INSPECTION OF A SURFACE ERROR FOR MATERIAL ERROR | |
EP3158293B1 (en) | Sensor fusion using inertial and image sensors | |
JP6179502B2 (ja) | マルチコプタを用いた3次元形状計測方法および装置 | |
Schäfer et al. | Multicopter unmanned aerial vehicle for automated inspection of wind turbines | |
CN112904877A (zh) | 一种基于无人机的风机叶片自动巡检系统及方法 | |
CN107240063A (zh) | 一种面向移动平台的旋翼无人机自主起降方法 | |
CN104298248A (zh) | 旋翼无人机精确视觉定位定向方法 | |
EP3734394A1 (en) | Sensor fusion using inertial and image sensors | |
CN105335733A (zh) | 一种无人机自主着陆视觉定位方法及系统 | |
WO2020103049A1 (zh) | 旋转微波雷达的地形预测方法、装置、系统和无人机 | |
Leira et al. | A ligth-weight thermal camera payload with georeferencing capabilities for small fixed-wing UAVs | |
CN105045276A (zh) | 无人机飞行控制方法及装置 | |
CN113534844B (zh) | 一种未知环境下的旋翼飞行器输电线路巡检方法及装置 | |
Hirose et al. | Implementation of UAV localization methods for a mobile post-earthquake monitoring system | |
CN113885580A (zh) | 基于无人机实现自动化巡检风机的路径规划方法及系统 | |
CN208506246U (zh) | 一种适用于烟囱内部作业飞行平台定位的装置 | |
Pierce et al. | Quantitative inspection of wind turbine blades using UAV deployed photogrammetry |
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 |