无人机建图算法与无人车导航算法的融合应用系统及方法与流程

本专利申请属于机器人技术领域，更具体地说，是涉及一种无人机建图算法与无人车导航算法的融合应用系统及方法。

背景技术：

现有的无人机与无人车各自执行探索、导航等工作时，明显暴露各自缺点，如无人机在恶劣环境下易受气流，gps信号的因素变化的影响，增加电池消耗，导致无人机续航能力不足；甚至无人机失联，以至于无法完成既定探索任务。无人车在未知环境下运动时建图效率低下，导致无人车执行任务周期长，甚至在移动过程中受损，不能如期完成任务。

技术实现要素：

本发明需要解决的技术问题是提供一种无人机建图算法与无人车导航算法的融合应用系统及方法，意在提取无人机与无人车各自的优点，并围绕两者的优点为核心建立一种新的应用模式。

为了解决上述问题，本发明所采用的技术方案是：

一种无人机建图算法与无人车导航算法的融合应用方法，包括如下步骤：

步骤a、无人机和无人车均进入探索环境，地面站登陆无人机和无人车，分别启动无人机和无人车的系统节点；

步骤b、无人机起飞后，利用无人机携带的激光雷达传感器和建图算法开发板进行激光slam，采集一片区域获得地理环境信息后在建图算法开发板上建立地图，而后通过建图算法开发板将无人机建立的地图通过局域网传输至无人车上的路径规划板；

步骤c、路径规划板获取地图后，地面站确定无人车运动终点，路径规划板通过路径规划算法，规划无人车行走路径从而进行导航。

本发明技术方案的进一步改进在于：步骤b中，建图算法开发板对激光雷达传感器采集到的环境激光数据进行转换的建图算法的实施过程为：

步骤b1、初步建图：将激光点pm变换到一个被占据的栅格中，当设定时刻所有的激光点pm都能够变换到被占据的栅格中，意味着初步建图成功；

步骤b2、回环检测：采用双线性插值的方法，刻画激光点pm映射到栅格地图中是否对应被占据栅格中以及对应的程度，求出占据概率m(pm)，m(pm)的取值范围是0～1；

步骤b3、最终建图：回环检测无误后，通过使用函数文件probability_values.h定义一系列与概率相关的函数，即多个用于计算概率的mapping命名空间下的全局函数，实现了对雷达数据转换成栅格数据后的并附带有概率权值的地图建立。

本发明技术方案的进一步改进在于：步骤b1中，被占据的栅格显示为灰色。

本发明技术方案的进一步改进在于：步骤b3中，先通过采集一帧帧的雷达数据，再将雷达数据构成一幅子地图，最后将多幅子地图构建成完整的地图，同时实现对无人机的定位。

本发明技术方案的进一步改进在于：步骤c中，路径规划板的路径规划算法为迪杰斯特拉算法，具体过程为：

步骤c1、依据一种贪心策略，声明一个数组dis来保存源点到各个顶点的最短距离和一个保存已经找到了最短路径的顶点的集合t；初始时，源点s的路径权重被赋为0，即dis[s]＝0；

步骤c2、若对于顶点s存在能直接到达的点mi的距离的集合[mi]，则把dis[mi]设为待选择路径距离集合，同时把所有顶点s不能直接到达的其他顶点的路径长度设为无穷大；

步骤c3、初始时，集合t只有顶点s，接着从数组dis选择最小值，则该值就是源点s到该值对应的顶点的最短路径，并且把该点加入到t中，此时完成一个顶点；

步骤c4、然后需要确认新加入的顶点是否可以到达其他顶点并且确认通过该顶点到达其他顶点的路径长度是否比源点直接到达短，如果是则替换这些顶点在dis中的值；

步骤c5、最后又从数组dis中找出最小值，重复步骤c2～c4，直到集合t中包含了地图的所有顶点，最终实现无人车的路径规划。

一种无人机建图算法与无人车导航算法的融合应用系统，用于实现上述方法，包括彼此之间相互连接的无人机、地面站和无人车，其中：

无人机包括机体、与地面站连接的飞行控制模块、与飞行控制模块连接的激光雷达传感器和建图算法开发板；飞行控制模块、激光雷达传感器和建图算法开发板均设置在机体上；

地面站为计算机；

无人车包括车体、设置在车体上与地面站连接的运动控制模块、设置在车体上与运动控制模块连接的路径规划板，路径规划板还通过地面站连接无人机的建图算法开发板。

本发明技术方案的进一步改进在于：激光雷达传感器和建图算法开发板分别设置在无人机的机体的顶部和底部；路径规划板设置在无人车的车体上部。

本发明技术方案的进一步改进在于：激光雷达传感器为rplidara2激光雷达，建图算法开发板为内置建图算法开发板jetsontx2，路径规划板为raspberrypi3b开发板。

本发明技术方案的进一步改进在于：无人车为四轮无人车，无人机为六轴无人机。

由于采用了上述技术方案，本发明取得的有益效果是：

本发明的无人机建图算法与无人车导航算法的融合应用系统及方法意在提取无人机与无人车各自的优点，并围绕两者的优点为核心建立一种新的应用模式。本发明充分发挥无人机建图的高效性、准确性和无人车的易于自主导航的特点，让无人机在宏观上位置更好的建立实时地图，为无人车提供有效的地理信息，再由无人车自行规划最优的行走路线，将无人机的建图算法与无人车的导航算法融合应用，提高无人机与无人车的智能化交流方式，二者的结合便于更快速的完成任务，提高了在抢险救灾等危险活动中救灾人员使用机器人的效率。

附图说明

图1为本发明无人车轴测图；

图2为本发明无人机轴测图；

图3为本发明融合应用系统实际运行效果图；

其中：1、无人车，11、路径规划板，2、无人机，21、激光雷达传感器，22、建图算法开发板。

具体实施方式

下面结合实施例对本发明做进一步详细说明。

本发明公开了一种无人机建图算法与无人车导航算法的融合应用方法，包括如下步骤：

步骤a、无人机2和无人车1均进入探索环境，地面站登陆无人机2和无人车1，分别启动无人机2和无人车1的系统节点；

步骤b、无人机2起飞后，利用无人机2携带的激光雷达传感器21和建图算法开发板22进行激光slam，采集一片区域获得地理环境信息后在建图算法开发板22上建立地图，而后通过建图算法开发板22将无人机2建立的地图通过局域网传输至无人车1上的路径规划板11；建图算法开发板22jetsontx2对rplidara2激光雷达传感器21的数据在ros系统上进行处理，通过内置建图算法cartographer算法构建无人机与无人车所处环境的地图。

步骤c、路径规划板11获取地图后，地面站确定无人车1运动终点，路径规划板11通过路径规划算法，规划无人车1行走路径从而进行导航。上述过程须由地面站通过局域网登陆无人车1与无人机2终端启动节点，并联结无人机2与无人车1，此后地面站可作为监控和发布命令的指挥中心

本方法中使用到的激光雷达传感器21为rplidara2激光雷达，建图算法开发板22为内置建图算法开发板jetsontx2，路径规划板11为raspberrypi3b开发板。

步骤b中，建图算法开发板22对激光雷达传感器21采集到的环境激光数据进行转换的建图算法的实施过程为：

步骤b1、初步建图：将激光点pm变换到一个被占据的栅格中，当设定时刻所有的激光点pm都能够变换到被占据的栅格中，意味着初步建图成功；

步骤b2、回环检测：采用双线性插值的方法，刻画激光点pm映射到栅格地图中是否对应被占据栅格中以及对应的程度，求出占据概率m(pm)，m(pm)的取值范围是0～1；

步骤b3、最终建图：回环检测无误后，通过使用函数文件probability_values.h定义一系列与概率相关的函数，即多个用于计算概率的mapping命名空间下的全局函数，实现了对雷达数据转换成栅格数据后的并附带有概率权值的地图建立。

步骤b1中，被占据的栅格显示为灰色。

步骤b3中，先通过采集一帧帧的雷达数据，再将雷达数据构成一幅子地图，最后将多幅子地图构建成完整的地图，同时实现对无人机2的定位。

步骤c中，路径规划板11的路径规划算法为迪杰斯特拉算法，具体过程为：

步骤c1、依据一种贪心策略，通过使用贪心算法原理，每一次都计算求出最近的路径点，从而实现无人车的路径规划。具体过程为：声明一个数组dis来保存源点到各个顶点的最短距离和一个保存已经找到了最短路径的顶点的集合t；初始时，源点s的路径权重被赋为0，即dis[s]＝0；

步骤c2、若对于顶点s存在能直接到达的点mi的距离的集合[mi](s点可直接到达的点距离的集合)，则把dis[mi]设为待选择路径距离集合，同时把所有顶点s不能直接到达的其他顶点的路径长度设为无穷大；

步骤c3、初始时，集合t只有顶点s，接着从数组dis选择最小值，则该值就是源点s到该值对应的顶点的最短路径，并且把该点加入到t中，此时完成一个顶点；

步骤c4、然后需要确认新加入的顶点是否可以到达其他顶点并且确认通过该顶点到达其他顶点的路径长度是否比源点直接到达短，如果是则替换这些顶点在dis中的值；

步骤c5、最后又从数组dis中找出最小值，重复步骤c2～c4，直到集合t中包含了地图的所有顶点，最终实现无人车的路径规划。

一种无人机建图算法与无人车导航算法的融合应用系统，用于实现上述方法，包括彼此之间相互连接的无人机2、地面站和无人车1，其中：

无人机2包括机体、与地面站连接的飞行控制模块、与飞行控制模块连接的激光雷达传感器21和建图算法开发板22；飞行控制模块、激光雷达传感器21和建图算法开发板22均设置在机体上；

地面站为计算机；

无人车1包括车体、设置在车体上与地面站连接的运动控制模块、设置在车体上与运动控制模块连接的路径规划板11，路径规划板11还通过地面站连接无人机2的建图算法开发板22。

激光雷达传感器21和建图算法开发板22分别设置在无人机2的机体的顶部和底部；路径规划板11设置在无人车1的车体上部。

激光雷达传感器21为rplidara2激光雷达，建图算法开发板22为内置建图算法开发板jetsontx2，路径规划板11为raspberrypi3b开发板。

无人车1为四轮无人车1，无人机2为六轴无人机2。

本发明充分发挥无人机建图的高效性、准确性和无人车的易于自主导航的特点，让无人机在宏观上位置更好的建立实时地图，为无人车提供有效的地理信息，再由无人车自行规划最优的行走路线，将无人机的建图算法与无人车的导航算法融合应用，提高无人机与无人车的智能化交流方式，二者的结合便于更快速的完成任务，提高了在抢险救灾等危险活动中救灾人员使用机器人的效率。