1.一种未知环境下排爆机器人多阶自主导航探测系统，其特征在于：包括机器人，在机器人上设置有控制器、TNT气体浓度传感器、RGB-D相机和激光雷达；TNT气体浓度传感器，用于实时检测机器人所处位置的TNT气体的浓度信息并将检测信息传输至控制器内；控制器根据浓度信息得到机器人的前进方向；RGB-D相机用于采集机器人所处位置的环境图像并将采集图像传输至控制器内；控制器将将接收到的图像信息进行处理后构建地图和确认未爆物；激光雷达用于检测机器人所处环境信息并将检测信息传输给控制器，控制器处理后判断机器人所处环境是否存在障碍物，控制器将接收到的信息综合处理后机器人发送移动命令，机器人接收命令后进行避障导航移动直至找到未爆物。

2.一种未知环境下排爆机器人多阶自主导航探测方法，其特征在于，步骤如下：S1，粗略路径规划；

S1.1，RGB-D相机实时采集机器人所处位置的rgb图像和depth图像并传输至控制器内，控制器运用OpenCV库提取rgb图像的特征点；

S1.2，将当前时刻的rgb图像与下一时刻的rgb图像通过堆排序进行特征匹配得到匹配点对；

S1.3，将步骤S1.2得到的匹配点对通过tf坐标转换得到三维坐标匹配点对；

S1.4，采用OpenCV库中的RANSAC函数构建运动变换模型R,t，运动变换模型R,t为：S1.5，通过最小二乘法求解运动变换模型R,t，得到相机位姿序列和相应的相机运动序列，构建相机位姿图，并通过闭环检测rgb图像及其对应的depth图像，以获得相邻两帧rgb图像间运动距离过大或提取到的特征点过少为约束条件，对图像进行筛选以优化相机位姿图；求解公式为：式中pi，qi表示两帧图像一一对应的特征点，R表示旋转向量，t表示平移向量。

S1.6，采用基于g2o库的图优化方法全局优化位姿图，位姿图边为相机位姿间的相对运动估计，继而获得到相机运动轨迹，构建三维点云地图，并通过Octomap库将点云地图转化为三维栅格地图；

S1.7，获得障碍物的轮廓；

S1.8，根据步骤S1.7得到的障碍物的轮廓形状结合RGD-D相机采集的环境障碍物坐标信息，得到障碍物的位置信息，将障碍物的位置信息添加到步骤S1.6得到的三维栅格地图中，并将被占据的栅格和与被占据栅格相邻的栅格放入不可通过序列，未被占据栅格放入可通过序列，得到完善的三维格栅地图；

S1.9，在完善三维格栅地图的前提下，检测TNT分子的存在区域；

S1.10，找到TNT分子的存在区域后，控制器控制机器人朝TNT分子浓度增大的方向搜索未爆物的存在区域；

S2，精细路径规划；

S2.1，在完善三维格栅地图内的未爆物疑似存在区域，构建以机器人为根节点的单叉树；

S2.2，根据障碍物被检测到的顺序，将障碍物依次作为上一障碍物的叶子结点和下一障碍物的根节点，并增加到增加在单叉树上；

S2.3，遍历单叉树上的叶子节点，并探测节点是否为未爆物，若不是，则避开障碍物，并对不可通过栅格和可通过栅格的改变，并采用A*算法得到节点之间的最优路径到达下一叶子节点并继续探测，直至探测到未爆物。

3.根据权利要求2所述的未知环境下排爆机器人多阶自主导航探测方法，其特征在于，在步骤S1.1中，具体步骤为：S1.1.1，从rgb图像中提取粗略特征点；

根据rgb图像像素点亮度，从rgb图像中选择满足正态分布G(I)的像素点作为粗略特征点；正态分布G(I)的公式为：其中，I为像素点亮度，(μ，σ2)为像素点的像素坐标，μ表示位置参数，σ2表示尺度参数；

S1.1.2，在rgb图像中从粗略特征点中选取像素点P，并设定像素点的亮度为I，阈值为T；

S1.1.3，以像素点P为中心，构建正方形图像块，并从粗略特征点中选取正方形4个顶点的像素点；

S1.1.4，判断像素点P是否为精准特征点；若正方形4个顶点的像素点中有3个同时大于I+T或小于I-T，则像素点p为精确特征点并执行下一步，执行步骤S1.1.5，否则剔除像素点P点并重复步骤S1.1.2-S1.1.3；

S1.1.5，计算精确特征点p对应正方形图像块的质心C；

C＝(xc,yc)  (3)；

其中，p,q表示矩阶；N表示像素点个数；f(x,y)表示像素点的灰度值；

S1.1.6，连接图像块的中心点P和质心C，得到一个方向向量 得到精准特征点的方向；

θ＝arctan(m01/m10)  (5)；

S1.1.7，重复步骤S1.1.2-S1.1.6直至得到所有的精准特征点。

4.根据权利要求2所述的未知环境下排爆机器人多阶自主导航探测方法，其特征在于，在步骤S1.2中，具体步骤为：S1.2.1，设定当前时刻的rgb图像为图像It，提取的精准特征点为 下一时刻的rgb图像为图像It+1，提取的精准特征点为S1.2.2，对每一个精准特征点 和所有的精准特征点 分别测量描述子距离；

S1.2.3，以描述子距离为记录数构建小顶堆；

S1.2.4，以测得堆顶数据的精准特征点 为精准特征点 的匹配点；

S1.2.5，依次循环，匹配所有的精准特征点 和精准特征点

5.根据权利要求2所述的未知环境下排爆机器人多阶自主导航探测方法，其特征在于，在步骤S1.7中，具体步骤为：S1.7.1，在构建地图时，激光雷达采集机器人所处环境中障碍物的距离信息和角度信息并传输至控制器内，控制器进行处理并划分区域；

S1.7.2，筛选有效区域；

对步骤S1.7.1中得到的多个数据区域，将一些扫描点很少，或扫描点很密集的区域视为噪声区域剔除，剩余区域为合格数据区域；

S1.7.3，在合格数据区域内得到障碍物的轮廓形状。

6.根据权利要求5所述的未知环境下排爆机器人多阶自主导航探测方法，其特征在于，在步骤S1.7.1中，具体步骤为：S1.7.1.1，设定一个区域阈值T；

S1.7.1.2，计算相邻扫描点(xi,xi+1)间距D；

S1.7.1.3，比较间距D与区域阈值T；如果D≦T，则这两个扫描点源于同一障碍物；如果D>T，则这两个扫描点源于不同障碍物，并将xi作为当前区域的终点，xi+1作为下一区域的起点；

S1.7.1.4，重复步骤S1.7.1.2-S1.7.1.3，直至将所有扫描点循环完毕，完成区域的划分。

7.根据权利要求5所述的未知环境下排爆机器人多阶自主导航探测方法，其特征在于，在步骤S1.7.3中，具体步骤为：S1.7.3.1，设定阈值L；

S1.7.3.2，根据合格数据区域内扫描点的坐标(xi,yi)并结合合最小二乘法拟合直线；

y＝kx+b  (11)；

S1.7.3.3，计算合格数据区域内各扫描点距离拟合直线的距离d；

S1.7.3.4，将距离d与阈值L一一进行比较；若d大于L，则障碍物某一平面轮廓是折线，距离d对应的扫描点为障碍物的角点；反之，则障碍物某一平面轮廓是直线；

S1.7.3.5，连接该合格数据区域内的所有角点连接在一起，得到障碍物的轮廓形状；

S1.7.3.6，重复步骤S1.7.3.2-S1.7.3.5，直至所有合格数据区域都循环一遍。

8.根据权利要求2所述的未知环境下排爆机器人多阶自主导航探测方法，其特征在于，在步骤S1.9中，具体步骤为：S1.9.1，在完善三维格栅地图内，以机器人当前位置为原点A，水平方向为x轴，纵向为y轴，竖直方向为z轴的三维坐标系；

S1.9.2，控制器从完善三维格栅地图中获得原点A的坐标位置，从TNT气体浓度传感器处得到原点A处的TNT分子浓度C；

S1.9.3，控制器将TNT分子浓度C与0作比较，若C＝0，设定阈值M，则控制器控制机器人以范围每次增加M米的Ω形行进，直至找到TNT分子的存在区域。

9.根据权利要求2所述的未知环境下排爆机器人多阶自主导航探测方法，其特征在于，在步骤S1.10中，具体步骤为：S1.10.1，构建以机器人当前位置Bj点为圆心，a为半径的圆Mj，圆Mj为机器人取样路径，以π为间隔距离在圆Mj上进行采样，得到2n个采样点的坐标，坐标集合A为：A＝{Ai(xi,yi,z)},i＝1,2,3,...,2n，以及2n个采样点的TNT分子浓度，TNT分子浓度集合C为：C＝{Ci},i＝1,2,3,...2n；

S1.10.2，对2n个采样点进行仿真，判断是否满足高斯分布；若满足高斯图像则停止采样，进行建模；若不满足高斯分布，则从TNT分子浓度集合C中选择最大值，以TNT分子浓度最大值对应的采样点Ai(xi,yi,z)和当前位置Bj点所在直线为前进方向，机器人沿着前进方向前进大于当前半径的距离到达另一点Bj+1；

S1.10.3，以另一点Bj+1为机器人的当前位置，并令a＝a+g,g为常数；重复步骤S1.10.1-S1.10.3，直至采样点满足高斯分布，此时机器人当前位置为Bm；

S1.10.4，对满足高斯分布的采样点进行整理并建立TNT分子的扩散高斯模型；

其中，C(xi,yi,z)为采样点A(xi,yi,z)处的TNT分子浓度，Q为未爆物泄露TNT分子速率，μ表示平均风速，σy为TNT分子水平方向的扩散参数，σz为TNT分子竖直方向的扩散参数；

S1.10.5，计算TNT分子浓度递增梯度，并采用预测浓度的方法逆推未爆物存在区域；

式中 表示采样点Ai和采样点Ai+1两点间的浓度比值，S表示采样点Ai和采样点Ai+1两点间的距离；假设未爆物在距离机器人S处，则未爆物在以机器人所在位置Bm为圆心，S为半径的圆D上；

S1.10.6，构建以机器人当前位置Bm为圆心，S为半径的圆D；

S1.10.7，从Bm点出发，在圆D上搜索满足TNT分子浓度递增梯度的采样点Ai，若不存在，则以圆D上浓度最大的点为Ai点，机器人以Bm，Ai点所在直线为前进方向并前进S米达到Bm+1点；

S1.10.8，更新机器人当前位置，并重复步骤S1.10.6-S1.10.7，直至有多个圆D相交于一点，交点视为未爆物疑似存在区域。