一种基于图像识别与UWB定位融合的输电线路巡检无人机精确定位系统及方法与流程

一种基于图像识别与uwb定位融合的输电线路巡检无人机精确定位系统及方法
技术领域
1.本发明涉及一种输电线路巡检无人机的精确空间定位方法，属检测设备定位和机器视觉应用领域。
技术背景
2.无人机是电力系统中输电线路巡检的常用设备。
3.当前，无人机的巡检工作主要依靠gps导航、惯导定位等定位技术以及人工遥控和飞行经验实现，而输电线路巡检工作进行时gps 导航信号弱和输电线路非直线的弧垂因素，极易影响操作人员的视线与决策，最终导致无人机无信号失联、原定飞行轨迹不可观测到输电线路等问题，甚至引发事故造成安全问题。因此，实现无人机定位的智能化、精准遥控显得尤为重要，而要实现无人机的精确定位首先就要完成对无人机空间位置的实时监测。基于uwb定位系统的输电线路巡检无人机的精确定位技术，其技术实质就是利用多个空间位置信息确定的uwb定位基站实时收发无人机位置信号，并结合视觉传感器采集的图像特征点来检测无人机机身位姿，实现该技术方案，有人工成本低、操作简单、定位精度高等优点。


技术实现要素：

4.本发明针对

背景技术：
的不足和工作状况，提出一种新的巡线无人机空间位姿检测方法，对无人机的空间位姿进行检测，使工人能实时观测到无人机在输电线路高空的位置状态，从而提高巡线效率和安全性。
5.技术方案
6.一种巡线无人机的精确定位方法，能够实时检测到无人机的空间位置参数，包括uwb
‑
tdoa方法测算的坐标(x
i
,y
i
,z
i
)，及空间前方交会方法测算的(x'
i
,y'
i
,z'
i
)，并根据误差融合两坐标，得到更精确的位置信息。
7.其中包括：一架装设uwb定位标签的无人机、一台数字摄像机、一台处理超宽带信号的计算机、以及数个uwb定位基站。
8.在实施方式中，uwb定位标签配合无人机的电源模块、控制模块、储存器模块等，固定安装于无人机外壳内部。
9.在实施方式中，无人机飞行前，启动uwb定位标签，无人机飞行时，uwb定位标签不断发出超宽带信号。
10.在实施方式中，网络摄像机安装时需保证位于无人机起落架中间，并调整其视野保证拍摄照片的完整性。
11.在实施方式中，工控计算机与无人机无线连接，实时解算定位标签接收到的定位基站信号，得到无人机空间位置坐标。
12.在实施方式中，工控计算机还提取并处理网络摄像机采集的图像，从而矫正无人
机位姿。
13.在实施方式中，uwb定位基站，通过绝缘可缠绕的外壳固定在输电线路及杆塔上，其数个基站距离分布合理有序。
14.与已有技术相比，本发明的有益效果是：
15.用机器视觉技术和uwb定位技术的无人机空间位姿检测相结合，减小工人的工作量，克服了人眼观测的局限性；本发明采用uwb信号收发装置，有效提升了定位精度，功率损耗小，节约了成本，安装方便，抗干扰性好。
附图说明
16.附图1为本发明无人机uwb
‑
tdoa解算模型；
17.附图2为本发明无人机拍摄像对空间前方交会结算模型；
18.附图3为本发明uwb无线定位坐标和图像识别空间坐标融合模型。
具体实施方式
19.下面结合附图和具体实施方式对本发明进行详细阐述。
20.设备安装及模型建立：
21.本发明的uwb定位基站安装的相对位置如附图1所示，一台无人机1，uwb定位基站2、3、4、5。
[0022][0023]
所述的无人机1上装设着uwb定位标签a，与所述的控制模块连接，固定安装于无人机外壳内部；无人机1上装设着的数字摄像机，通过三轴防抖云台，固定安装于无人机外壳下方、无人机支撑架中央，可旋转一定角度；所述的uwb定位基站2、3、4、5，通过绝缘可缠绕的外壳固定在输电线路及杆塔上，任意三个基站不在同一直线上，其外壳为球体，便于计算机更准确地识别无人机拍摄的图像中定位基站的特征。
[0024]
本发明要建立物方坐标系d
‑
xyz，为gps世界坐标系。无人机在输电线路坐标系中的空间模型和uwb定位基站的空间模型可简化为点。
[0025]
解算过程如下，无人机在飞行时，采用uwb
‑
tdoa(到达时间差)定位原理，无人机上装置的定位标签1每隔固定时间不断地发出超宽带信号，由四个uwb定位基站接收信号并发送回一个包含基站编号(1、2、3、4)的响应信号，计算出电磁波信号在定位标签1和定位基站之间的飞行时间t，计算出定位标签a与基站的距离：
[0026]
r＝c*t
ꢀꢀ
(1)
[0027]
其中c为超宽带信号传播速率即电磁波速率。
[0028]
根据定位标签a与基站的距离，首先得出定位标签相对于四组 uwb定位基站的距离差：
[0029][0030]
其中，定位标签a与基站的距离可通过物方坐标系d
‑
xyz中的位置坐标表示：
[0031][0032]
联结上式方程，用最小二乘法即可解算出定位标签a的三维坐标(x
i
,y
i
,z
i
)。
[0033]
为了补偿和校正无人机空间位置坐标，本发明结合无人机拍摄影像，采用空间前方交会方法确定无人机物方坐标系下的辅助坐标 (x
i
,y
i
,z
i
)。
[0034]
解算方法如下：随机选取两个uwb定位基站分别命名为s1、s2，参考附图2，本发明还需要以s1、s2为原点建立两个像空间辅助坐标系：s1‑
u1v1w1、s2‑
u2v2w2，使其与物方坐标系d
‑
xyz坐标轴方向相对应的平行，即互为平移关系，可以更方便的进行坐标变换。z轴与 xoy平面垂直方向向上，u1轴、u2轴与x轴平行,v1轴、v2轴与y轴平行,w1轴、w2轴与z轴平行。
[0035][0036]
设定位标签a在s1‑
u1v1w1中的坐标为(u1,v1,w1)，在s2‑
u2v2w2中的坐标为(u2,v2,w2),
[0037]
在定位标签a所在的位置上，无人机载数字摄像机分别拍摄 uwb定位基站s1、s2的相片，分别对应两个像点s'1、s'2,s'1、s'2的像空间坐标为(x1,y1,
‑
f)、(x2,y2,
‑
f)，对应的像空间辅助坐标为(u1,v1,w1)、 (u2,v2,w2)，其中，f为数字摄影机焦距。
[0038]
假设像空间坐标系与像辅助空间坐标系的相对转角已知，由左、右影像的外方位角元素和计算相应的正交矩阵r1、r2，则：
[0039][0040]
其中，r1、r2为已求左右相片的旋转矩阵。
[0041]
基线b的三个分量，即右uwb定位标签s2在左s1‑
u1v1w1中的坐标：
[0042][0043]
uwb定位标签s1、s2,像点s'1、s'2，无人机定位标签a，三点共线：
[0044][0045]
式中，定位标签a在s1‑
u1v1w1中的坐标为(u1,v1,w1)，在s2‑
u2v2w2中的坐标为(u2,v2,w2)，有：
[0046][0047]
上式可写为：
[0048][0049]
联立上面一、三两式，得投影系数:
[0050][0051]
取a在两个uwb定位标签辅助坐标系的平均值,求得定位标签a 的物方坐标(x'
i
,y'
i
,z'
i
)：
[0052][0053]
本发明中，根据测量的误差范围(uwb定位方法的精度可达到三维15cm，空间前方交会方法测量误差可在6～15cm范围内选取，本发明选取10cm)，以定位标签a的物方坐标为球心，建立球形模型。
[0054]
以uwb
‑
tdoa(到达时间差)定位原理得到的a的空间坐标 (x
i
,y
i
,z
i
)为球心，测量误差r1为半径，建立坐标合集球一；以空间前方交会原理得到的a的空间坐标(x'
i
,y
i
',z
i
')为球心，测量误差r2为半径，建立坐标合集球二。
[0055][0056]
求得的两球体相交的重合部分，即为本发明补偿和矫正后的无人机空间位置。可表示为：
[0057][0058]
本发明中未提及的部分采用现有技术加以实现。