一种巡检无人机路径规划系统

1.本发明涉及无人机技术领域，具体为一种巡检无人机路径规划系统。


背景技术：

2.无人驾驶飞机简称“无人机”，是利用无线电遥控设备和自备的程序控制装置操纵的不载人飞机。无人机实际上是无人驾驶飞行器的统称，从技术角度定义可以分为：无人直升机、无人固定翼机、无人多旋翼飞行器、无人飞艇、无人伞翼机这几大类。
3.无人多旋翼飞行器日常应用较为广泛，被频繁用于视频拍摄或巡检，典型代表为四旋翼无人机，现有四旋翼无人机多为人工操作或第三方卫星地图载入进行路线规划，其中，人工操作对操作人员操作能力要求格外严格，偏航概率大，第三方卫星地图载入，虽然可以减少偏航概率，但面对狭窄环境工况时，无法有效地规划出可行路线，很难难满足复杂地形的巡检，且巡检范围小，续航能力差。


技术实现要素：

4.本发明的目的在于提供一种巡检无人机路径规划系统，以解决上述背景技术中提出的问题。
5.为实现上述目的，本发明提供如下技术方案：
6.一种巡检无人机路径规划系统，包括无人机控制单元、路线规划单元、续航单元、巡检单元、预警单元和通讯单元，所述无人机控制单元采用内环加外环双单元控制，所述路线规划单元采用节点巡检模块加路径巡检模块，所述续航单元采用基站式续电，所述巡检单元采用影像采集模块和ai人工智能自检模块，所述预警单元包括自检预警模块和无人机故障预警模块，所述通讯单元包括基站通讯模块和无人机机载通讯模块。
7.优选的，所述内环控制单元为姿态控制单元，用于控制无人机的姿态、偏航率以及垂直速度，所述外环控制单元为位置控制单元，用于控制无人机水平速度、偏向角以及高度，所述无人机控制单元利用内、外环控制单元静态混合或送进系统的转置模型中转换为浆翼电动机电压。
8.优选的，所述节点巡检模块为基于快速搜索随机树rrt算法的路径规划的改进算法，在承传统rrt算法上添加扩展高度约束，使得算法扩展过程在高度上逐层递进，路径更加优化，并且能够在狭窄空间中找到可行的路径，使改进rrt算法继承传统rrt算法的二维空间搜索效率，并提高三维空间搜索效率；
9.所述改进rrt算法的完整搜索过程：
[0010][0011]
所述extend函数的完整过程：
[0012][0013][0014]
所述hight_state函数的完整过程：
[0015][0016]
优选的，所述路径巡检模块为基于卫星定位算法对巡检路线进行避障巡检飞行。
[0017]
优选的，所述基站式续电为在规划线路上各节点处均设置太阳能充电蜂巢，所述蜂巢采用隐藏式升降平台设计，且平台上集成有无线快充模块和信息收发模块。
[0018]
优选的，所述巡检单元利用影像采集模块对巡检节点或路线进行高清影像采集，可与ai人工智能自检模块内标准影像进行自动校对，还可自动进行数据保存、上传，进行人工复检。
[0019]
优选的，所述自检预警模块为将ai人工智能自检模块自检异常进行预警提示，所述无人机故障预警模块为利用无人机自身搭载传感器进行无人机自身故障检测，并进行故障报警。
[0020]
优选的，所述基站通讯模块和无人机机载通讯模块均采用卫星通讯技术进行通讯。
[0021]
与现有技术相比，本发明的有益效果是：
[0022]
本发明中，通过内环加外环双单元控制设计，可以高精度地控制无人机姿态和位置，实现对无人机姿态、偏航率以、垂直速度、水平速度、偏向角以及高度的精准控制，配合节点巡检加路径巡检，实现在狭窄复杂环境设置巡检节点，利用改进rrt算法自动规划出可行巡检路线，利用第三方卫星导航自动规划出开阔简单环境的巡检路线，达到巡检全线路自动规划；且配合巡检单元实现巡检路线自巡检，同时配合基站式续航单元设计，可实现无人机定点续航、定点数据反馈，可大大提高续航能力和数据安全行。
附图说明
[0023]
图1为本发明一种巡检无人机路径规划系统的线路规划原理框图；
[0024]
图2为本发明一种巡检无人机路径规划系统的全线路巡检原理框图；
[0025]
图3为本发明一种巡检无人机路径规划系统的四旋翼无人机内、外环控制原理框图；
[0026]
图4为本发明一种巡检无人机路径规划系统的四旋翼无人机控制架构图。
具体实施方式
[0027]
下面将结合本发明实施例中的附图，对本发明实施例中的技术方案进行清楚、完整地描述，显然，所描述的实施例仅仅是本发明一部分实施例，而不是全部的实施例，基于本发明中的实施例，本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例，都属于本发明保护的范围。
[0028]
为了便于理解本发明，下面将参照相关附图对本发明进行更全面的描述。附图中给出了本发明的若干实施例。但是，本发明可以以许多不同的形式来实现，并不限于本文所描述的实施例。相反地，提供这些实施例的目的是使对本发明的公开内容更加透彻全面。
[0029]
需要说明的是，当元件被称为“固设于”另一个元件，它可以直接在另一个元件上或者也可以存在居中的元件。当一个元件被认为是“连接”另一个元件，它可以是直接连接到另一个元件或者可能同时存在居中元件。本文所使用的术语“垂直的”、“水平的”、“左”、“右”以及类似的表述只是为了说明的目的。
[0030]
除非另有定义，本文所使用的所有的技术和科学术语与属于本发明的技术领域的技术人员通常理解的含义相同。本文中在本发明的说明书中所使用的术语只是为了描述具体的实施例的目的，不是旨在于限制本发明。本文所使用的术语“及/或”包括一个或多个相关的所列项目的任意的和所有的组合。
[0031]
请参阅图1-4，本发明提供一种技术方案：
[0032]
一种巡检无人机路径规划系统，包括无人机控制单元、路线规划单元、续航单元、巡检单元、预警单元和通讯单元，利用无人机控制单元实现无人机高精度飞行控制，并配合路线规划单元、巡检单元实现智能化全线路路径规划和巡检，同时配合续航单元进行无人机续航，配合通讯单元实现巡检数据上传，配合预警单元进行检测异常点和无人机自身异常预警提示；所述无人机控制单元采用内环加外环双单元控制，实现对无人机姿态和位置高精度控制；所述路线规划单元采用节点巡检模块加路径巡检模块，实现巡检全线路智能规划；所述续航单元采用基站式续电，保证无人机续航能力，实现长距离巡检；所述巡检单元采用影像采集模块和ai人工智能自检模块，实现智能巡检和人工复检，保证检测高效性；所述预警单元包括自检预警模块和无人机故障预警模块，实现巡检异常点预警和无人机自身故障预警；所述通讯单元包括基站通讯模块和无人机机载通讯模块，实现无人机巡检数据转存至基站，基站数据上传至终端控制平台，见图2。
[0033]
本实施例中，所述内环控制单元为姿态控制单元，用于控制无人机的姿态、偏航率以及垂直速度，所述外环控制单元为位置控制单元，用于控制无人机水平速度、偏向角以及高度，所述无人机控制单元利用内、外环控制单元静态混合或送进系统的转置模型中转换为浆翼电动机电压，其四旋翼无人机控制框图，见图3、图4。
[0034]
本实施例中，所述节点巡检模块为基于快速搜索随机树rrt算法的路径规划的改进算法，在承传统rrt算法上添加扩展高度约束，使得算法扩展过程在高度上逐层递进，路径更加优化，并且能够在狭窄空间中找到可行的路径，使改进rrt算法继承传统rrt算法的二维空间搜索效率，并提高三维空间搜索效率；
[0035]
路径搜索开始时，以起点为搜索树的根巡点，并在起始局部空间中随机生成采样
点，通过新巡点生成函数生成新巡点后，判断新巡点是否与障碍物发生碰撞，若可行则添加到搜索树中，否则丢弃；上述随机搜索过程迭代时，通过评估函数判断是否对局部空间进行递增，进行搜索高度空间的调整；在搜索空间的过程中，判断添加到搜索树的新巡点的某一邻域内存在目标点时，则可以确实搜索到了可行路径，并把目标点添加到搜索树中；此时，在搜索树中，从目标点到根巡点便能找到一条由巡点相接构成的路径；
[0036]
所述改进rrt算法的完整搜索过程：
[0037][0038]
在改进rrt算法的完整搜索过程中，扩展函数extend的运行过程是算法的重要部分、extend函数主要的作用是对搜索树进行扩展，包括生产新巡点、判断新巡点是否可行；由于rrt算法对新生产的巡点没有任何约束，这样的巡点生产的路径是无法让无人机跟踪的，改进rrt算法引入了巡点的航向角约束以及碰撞检测，确保路径的可跟踪性；extend函数根据算法在空间中随机采样得到的q
rand
同时在搜索树中找到距离q
rand
最近的树巡点q
nearest
，然后沿着q
rand
和q
nearest
的方向上扩展新巡点q
new
，最后对新巡点进行碰撞检测，如果新巡点可行则添加到搜索树中；
[0039]
所述extend函数的完整过程：
[0040]
[0041][0042]
改进rrt算法搜索过程中，局部空间高度调整的接口hight_state函数是改进算法中的关键部分；在上述的extend函数中，通过对局部空间进行搜索树巡点，在搜索到新巡点时都会进行搜索高度调整；当算法在某一高度的局部空间搜索时，会对新生成的巡点进行处理，得到两个阈值变量newnodet，newnodef；其中newnodet表示添加到搜索树中的新巡点是可行的，当其值累加到设定额阈值时，则进行局部空间高度递增；另外，newnodef生产的新巡点不可行，不能添加到搜索树中，并且其值到达设定阈值的倍时，也可以进行局部空间高度递增，即进入到下一局部空间中进行搜索路径。newnodef
[0043]
所述hight_state函数的完整过程：
[0044]
[0045][0046]
所述路径巡检模块为基于卫星定位算法对巡检路线进行避障巡检飞行，卫星定位算法采用第三方卫星地图载入，见图1。
[0047]
本实施例中，所述基站式续电为在规划线路上各节点处均设置太阳能充电蜂巢，所述蜂巢采用隐藏式升降平台设计，实现封闭式设计，提高防护等级；且平台上集成有无线快充模块和信息收发模块，实现无线充电和相邻站点间数据收发、存储，并上传至终端监控平台。
[0048]
本实施例中，所述巡检单元利用影像采集模块对巡检节点或路线进行高清影像采集，可与ai人工智能自检模块内标准影像进行自动校对，还可自动进行数据保存、上传，进行人工复检。
[0049]
本实施例中，所述自检预警模块为将ai人工智能自检模块自检异常进行预警提示，所述无人机故障预警模块为利用无人机自身搭载传感器进行无人机自身故障检测，并进行故障报警。
[0050]
本实施例中，所述基站通讯模块和无人机机载通讯模块均采用卫星通讯技术进行通讯，实现全工况数据通讯信号覆盖，满足全工况通讯需求。
[0051]
实施例1
[0052]
光伏线路巡检：首先在各个电力塔上设置续航基站，并将各电力塔设置成巡检节点，然后将待巡线路和各电力塔数据参数输入终端控制平台，然后利用改进rrt算法和第三方卫星地图智能规划出全线路巡检路线和节点电塔巡检路线，然后通过无人机控制单元控制无人机从巡检起点起飞，按规划规划巡检路线配合巡检单元进行智能影像采集、校对智能巡检，当巡检至节点电力塔时，按节点巡检路线对电力塔各待检位置进行智能巡检；当一节点电力塔巡检完成后，无人机自动寻航至对应电力塔上基站平台，进行无线充电和巡检数据转存，然后基站在将数据上传至终端平台，续航完成后，无人机按规划路线前往下一个节点电力塔，然后重复上述过程，进而完成全线路智能巡检。
[0053]
实施例2
[0054]
园区内巡检：参照实施例1将内部电力塔数据更换成园区内狭窄复杂环境区域即可，然后其巡检基本原理参照实施例1光伏线路巡检进行巡检即可。
[0055]
尽管已经示出和描述了本发明的实施例，对于本领域的普通技术人员而言，可以理解在不脱离本发明的原理和精神的情况下可以对这些实施例进行多种变化、修改、替换和变型，本发明的范围由所附权利要求及其等同物限定。