[发明专利]移动机器人在陌生室内场景下的核辐射探测路径自主规划方法

说明书

移动机器人在陌生室内场景下的核辐射探测路径自主规划方法，应用于移动机器人，移动机器人上搭载了里程计、加速度传感器、激光测距雷达、摄像头、辐射探测器及计算机；里程计、加速度传感器、激光测距雷达、摄像头及辐射探测器分别与计算机电连接或通信连接；核辐射探测路径自主规划方法如下：S01，获取环境地图：S02，生成全局路径规划：S03，通过局部路径规划修正全局路径规划。

技术领域

本发明涉及核辐射探测领域，特别涉及一种移动机器人在陌生室内场景下的核辐射探测路径自主规划方法。

背景技术

辐射探测技术在核应急、核安全、核设施退役处置等领域中占有重要的地位。针对需要快速响应的核应急场景及频繁更换辐射作业环境的核设施退役处置场所，采用搭载辐射探测器的移动机器人进行辐射探测是一个可行的方案，其最大的优势在于可近距离、长时间的对放射源进行探测，避免了人工探测辐射带来的健康损害。

采用移动机器人进行辐射探测，环境地图是先验信息。在缺乏环境地图信息的室内环境中采用移动机器人进行辐射探测，构建环境地图的需求是必要的。首先，需要地图来支持路径规划或提供可视化操作等任务。其次，地图可以限制机器人状态估计的误差，如果没有地图，航位推算算法就会随时间变化快速漂移。再次，如果给定一个地图，机器人可以再次访问之前走过的区域重置位置误差，即回环闭合。

但目前在移动机器人核辐射探测领域中缺乏一种可靠的室内场景定位(包含机器人状态估计和环境地图构建)的方法。

发明内容

本发明的目的是克服上述不足之处，而提供一种移动机器人在陌生室内场景下的核辐射探测路径自主规划方法，该方法基于搭载核辐射探测器的移动机器人，提供了一种在缺乏环境先验信息且需要进行核辐射探测的室内场景下的移动机器人自主规划核辐射探测路径的方法，可实现探测区域全覆盖及自主避障。

本发明的技术方案是：移动机器人在陌生室内场景下的核辐射探测路径自主规划方法，应用于移动机器人，移动机器人上搭载了里程计、加速度传感器、激光测距雷达、摄像头、辐射探测器及计算机；里程计、加速度传感器、激光测距雷达、摄像头及辐射探测器分别与计算机电连接或通信连接；

核辐射探测路径自主规划方法如下：

S01，获取环境地图：

移动机器人进入室内待测区域后，绕室内的边界行驶，通过里程计、加速度传感器、激光测距雷达及摄像头综合获取环境信息，由计算机通过扩展卡尔曼滤波算法进行多传感器数据融合，从而获得环境地图，通过多传感数据融合的结果计算出移动机器人当前的位置坐标、姿态角及行进速度；

本步骤中，环境地图为二维平面坐标系地图，其包含了待测区域的边界和待测区域内部的障碍物边界；

S02，生成全局路径规划：

移动机器人可在待测区域的任意位置作为探测路径的起始点，计算机通过环境地图生成全局代价地图，再通过全局代价地图生成全局路径规划路线；全局路径规划路线从待测区域的一侧边界抵达另一侧边界，在遇到障碍物时贴障碍物边界移动，抵达地图边界时，转向90°，前进H距离，H为辐射探测器的最远探测距离，再转向90°，抵达另一侧地图边界；如此往复，规划出蛇形盘管状的路线，将待测区域全部覆盖，实现移动机器人在室内场景下的核辐射探测路径自主规划；移动机器人在移动过程中根据地图数据配合激光雷达扫描特征，获取最佳定位；

本步骤中，全局代价地图根据环境地图生成，将环境地图中的障碍物或移动机器人无法到达区域的轮廓进行自动标识，自动设置机器人与该轮廓的安全距离，防止碰撞。

本发明进一步的技术方案是：其还包括在S02步骤后的S03步骤，

S03，通过局部路径规划修正全局路径规划：