搭载端侧模型的无人机巡检区域航线规划系统的制作方法
本发明涉及航线规划,具体涉及一种搭载端侧模型的无人机巡检区域航线规划系统。
背景技术:
1、在城镇与乡村的10kv配电网自主巡检作业中,广泛采用搭载端侧计算平台的无人机进行飞行拍摄。受制于硬件成本与续航要求,巡检无人机通常仅配置单目相机,并未搭载激光雷达等深度测距传感器,且端侧算力无法支撑复杂的三维空间重建算法。
2、在实际的配电网现场环境中,线路周边常分布有茂密的树木。在风力作用下,树枝会发生无规律的晃动,经常会在航线正前方遮挡绝缘子等关键拍摄目标。现有的单目无人机在遭遇正前方视线遮挡时,通常采用盲目绕飞策略,即向左或向右执行固定距离的横向平移,随后直接沿直线飞向下一个电线杆。这种情况下单目相机缺乏深度感知能力,实际飞行场景复杂,无法判断侧前方树枝的距离,且两基电线杆之间的导线会呈现自然下垂的悬链线走势,均会导致无人机绕飞时发生碰撞,航线规划的避障可靠性较差。
技术实现思路
1、为了解决航线规划的避障可靠性较差的技术问题,本发明提供一种搭载端侧模型的无人机巡检区域航线规划系统,所采用的技术方案具体如下:
2、本发明提出了一种搭载端侧模型的无人机巡检区域航线规划系统,系统包括:
3、感知模块,用于控制无人机在当前电线杆处悬停,对采集的图像帧进行运动补偿,基于补偿后的图像帧确定障碍物干扰风险度,并结合视场角约束生成环绕空间状态数组;
4、基准模块,用于根据当前电线杆坐标、下一电线杆坐标及导线比载常数,确定反映导线下垂走势的悬链线参考轨迹点集;
5、决策模块,用于针对所述环绕空间状态数组中的未遮挡角度,确定其侧向安全余量系数以及其接续飞行直线相对于所述悬链线参考轨迹点集的轨迹形态偏差,并对所述侧向安全余量系数与所述轨迹形态偏差进行融合,得到该角度的路线综合代价;
6、执行模块,用于根据所述路线综合代价确定绕飞中继坐标,控制无人机执行带偏航补偿的环绕飞行后接续飞向下一电线杆。
7、进一步地,所述对采集的图像帧进行运动补偿,包括:
8、提取相邻两帧原始图像帧中的远景静止特征点,基于所述远景静止特征点的坐标变化计算全局仿射变换矩阵;
9、利用所述全局仿射变换矩阵对相邻原始图像帧执行反向扭曲与对齐,生成去抖动且补偿后的图像帧。
10、进一步地,所述障碍物干扰风险度的确定方法,包括:
11、将补偿后的图像帧输入端侧目标检测模型得到障碍物边界框,提取所述边界框内目标特征点的二维位移向量并计算位移模长平均值;
12、将所述位移模长平均值相对于图像总像素宽度进行归一化,得到所述障碍物干扰风险度。
13、进一步地,所述结合视场角约束生成环绕空间状态数组,包括:
14、根据机头零度偏航角基准与相机水平视场角计算有效角度区间,将所述有效角度区间之外的角度索引标记为盲区遮挡,将对应角度索引的数值属性赋值为正无穷大;
15、根据障碍物的偏航中心角与阻断角度跨度生成二维遮挡角度区间,对落入所述二维遮挡角度区间的角度索引标记遮挡状态,存入对应的障碍物干扰风险度。
16、进一步地,所述悬链线参考轨迹点集的确定方法,包括:
17、以当前电线杆坐标为悬挂起点、下一电线杆坐标为悬挂终点构建三维直角参考坐标系并计算水平跨距;
18、将悬挂起点坐标、悬挂终点坐标、水平跨距及预设的导线比载常数代入悬链线参数方程,沿水平连线方向按固定距离步长等距采样并解算各采样位置的高程,得到三维空间离散坐标点序列,作为悬链线参考轨迹点集。
19、进一步地,所述侧向安全余量系数的确定方法,包括:
20、判断所述有效角度区间内所有角度索引是否均处于未遮挡状态,若是则将各未遮挡角度的侧向安全余量系数统一赋值为最小值常数0;否则以当前角度索引为起点分别按索引递减方向和递增方向查找首个处于遮挡状态的角度索引,提取两侧处于遮挡状态的角度索引对应的障碍物干扰风险度并取最大值,将所述最大值与常数1相加得到所述侧向安全余量系数。
21、进一步地,所述轨迹形态偏差的确定方法,包括:
22、根据未遮挡角度与预设的平飞安全半径结合当前电线杆坐标推算候选停机绝对坐标,以所述候选停机绝对坐标为起点、下一电线杆坐标为终点生成候选飞行直线并等距采样得到候选飞行直线点集;
23、将所述候选飞行直线点集与所述悬链线参考轨迹点集输入离散fréchet距离算法模型,输出三维空间走势上的最大包络误差作为所述轨迹形态偏差。
24、进一步地,路线综合代价的确定方法,包括:
25、引入预设的量纲配平权重,将所述轨迹形态偏差与所述量纲配平权重相乘得到相对路线偏离惩罚度,将所述相对路线偏离惩罚度与所述侧向安全余量系数相乘,得到所述路线综合代价。
26、进一步地,绕飞中继坐标的确定方法,包括:
27、剔除所述环绕空间状态数组中数值为正无穷大的元素后判断剩余有效数值集合是否为空,若为空则生成原地悬停告警指令并终止规划;
28、若不为空则查找路线综合代价极小值对应的角度索引,将其乘以固定角度分辨率得到目标偏航角,将目标偏航角的候选停机绝对坐标作为绕飞中继坐标。
29、进一步地,根据所述路线综合代价确定绕飞中继坐标,控制无人机执行带偏航补偿的环绕飞行后接续飞向下一电线杆,包括:
30、以当前电线杆坐标为圆心、所述平飞安全半径为旋转半径,在无人机当前位置与所述绕飞中继坐标之间生成等距圆弧飞行航线,在沿所述等距圆弧飞行航线飞行过程中根据无人机实时空间坐标动态调整机身偏航角,使机头光轴时刻指向当前电线杆坐标;无人机抵达所述绕飞中继坐标后触发相机快门采集图像,随后以所述绕飞中继坐标为起点、下一电线杆坐标为终点生成三维空间直线飞行指令并执行接续飞行,并在执行接续飞行后清空所述环绕空间状态数组及代价值运算缓存数据。
31、本发明具有如下有益效果:
32、针对现有单目无人机盲目绕飞易引发侧向碰撞与走廊偏离的问题,本发明对图像帧进行运动补偿以确定障碍物干扰风险度,结合视场角约束生成环绕空间状态数组,在无深度感知条件下量化树枝动态威胁并封锁盲区;利用电线杆坐标与导线比载常数确定悬链线参考轨迹点集;针对未遮挡角度确定侧向安全余量系数与轨迹形态偏差并融合为路线综合代价,将侧向防撞与走廊贴合需求耦合以自动筛选最优绕飞方向;最后确定绕飞中继坐标,控制无人机执行带偏航补偿的环绕飞行并接续飞向下一电线杆,从而在端侧有限算力下兼顾飞行安全,有效避免无人机撞击侧方树枝或切入导线弧腹,显著提升了复杂空域内自主巡检的避障可靠性。
1.一种搭载端侧模型的无人机巡检区域航线规划系统,其特征在于,所述系统包括:
2.根据权利要求1所述的一种搭载端侧模型的无人机巡检区域航线规划系统,其特征在于,所述对采集的图像帧进行运动补偿,包括:
3.根据权利要求1所述的一种搭载端侧模型的无人机巡检区域航线规划系统,其特征在于,所述障碍物干扰风险度的确定方法,包括:
4.根据权利要求1所述的一种搭载端侧模型的无人机巡检区域航线规划系统,其特征在于,所述结合视场角约束生成环绕空间状态数组,包括:
5.根据权利要求1所述的一种搭载端侧模型的无人机巡检区域航线规划系统,其特征在于,所述悬链线参考轨迹点集的确定方法,包括:
6.根据权利要求4所述的一种搭载端侧模型的无人机巡检区域航线规划系统,其特征在于,所述侧向安全余量系数的确定方法,包括:
7.根据权利要求4所述的一种搭载端侧模型的无人机巡检区域航线规划系统,其特征在于,所述轨迹形态偏差的确定方法,包括:
8.根据权利要求1所述的一种搭载端侧模型的无人机巡检区域航线规划系统,其特征在于,路线综合代价的确定方法,包括:
9.根据权利要求7所述的一种搭载端侧模型的无人机巡检区域航线规划系统,其特征在于,绕飞中继坐标的确定方法,包括:
10.根据权利要求9所述的一种搭载端侧模型的无人机巡检区域航线规划系统,其特征在于,根据所述路线综合代价确定绕飞中继坐标,控制无人机执行带偏航补偿的环绕飞行后接续飞向下一电线杆,包括:
版权声明:本站专利文献数据主要来源于国家知识产权局等公开渠道,由 技术新讯 进行整理汇编。页面设计及数据汇编的著作权归本站所有。全部内容仅供个人学习、科研评估与技术交流参考,严禁用于任何商业用途(包括但不限于直接生产制造、技术转让、倒卖数据等)。
免责条款:专利技术具有时效性,本站不对资料的绝对准确性、完整性和可实施性提供任何明示或暗示的担保。因参考本站内容造成的直接或间接损失,本站不承担相关法律责任。若您认为本站内容有侵权问题,请及时提供权属证明与我们联系,本站将在核实后依法处理。反馈意见:yyfuon@163.com