1.一种未知环境放射源自主搜索方法,其特征在于,所述方法包括:控制机器人进入未知辐射环境后,进行初始化;
基于SLAM技术进行机器人的实时定位与环境地图构建,获取机器人的当前位置以及周围障碍物情况;
获取辐射探测器测得的当前位置的辐射剂量率,并根据所述当前位置以及周围障碍物情况得到针对放射源的估计结果,所述估计结果包括放射源位置及活度;
基于多次估计结果对比,判断当前估计结果是否作为最终的放射源定位结果,并确定机器人的下次移动目标位置;
以机器人的当前位置为起始点,以移动目标位置为目标点,综合考虑移动代价和累计辐射剂量代价规划机器人的运动路径。
2.根据权利要求1所述的未知环境放射源自主搜索方法,其特征在于,所述根据所述当前位置以及周围障碍物情况得到针对放射源的估计结果的步骤,具体包括:基于粒子滤波算法,结合机器人的实时定位与环境地图,根据放射源剂量率理论计算模型,估计放射源的位置和活度。
3.根据权利要求2所述的未知环境放射源自主搜索方法,其特征在于,所述基于多次估计结果对比,判断当前估计结果是否作为最终的放射源定位结果,并确定机器人的下次移动目标位置的步骤,具体包括:将在当前位置进行的最优估计结果与两次估计结果进行比较,如果差异值在预设的阈值区间内,则将当前的估计结果作为最终估计结果,将估计结果中的放射源位置作为下一次移动目标;如果差异值在预设的阈值区间外,则在安全辐射剂量率区域内选择一空间位置作为下一次移动目标。
4.根据权利要求3所述的未知环境放射源自主搜索方法,其特征在于,规划机器人的运动路径的方法为:基于所构建的环境地图得到移动代价地图;
搜索机器人从当前位置移动到周围八个方向地图栅格的代价;
选择所需代价最小的栅格作为新的当前位置,记录到路径中,并开始下一次搜索,直至搜索到目标位置;
回溯从起始点到目标点的所有节点,提取从当前位置到目标位置的最优路径作为机器人的规划路径并输出。
5.一种未知环境放射源自主搜索装置,其特征在于,所述装置包括:初始化单元,用于控制机器人进入未知辐射环境后,进行初始化;
环境构建单元,用于基于SLAM技术进行机器人的实时定位与环境地图构建,获取机器人的当前位置以及周围障碍物情况;
位置估计单元,用于获取辐射探测器测得的当前位置的辐射剂量率,并根据所述当前位置以及周围障碍物情况得到针对放射源的估计结果,所述估计结果包括放射源位置及活度;
目标确定单元,用于基于多次估计结果对比,判断当前估计结果是否作为最终的放射源定位结果,并确定机器人的下次移动目标位置;
路径规划单元,用于以机器人的当前位置为起始点,以移动目标位置为目标点,综合考虑移动代价和累计辐射剂量代价规划机器人的运动路径。
6.根据权利要求5所述的未知环境放射源自主搜索方法,其特征在于,所述位置估计单元,具体用于:基于粒子滤波算法,结合机器人的实时定位与环境地图,根据放射源剂量率理论计算模型,估计放射源的位置和活度。
7.根据权利要求6所述的未知环境放射源自主搜索方法,其特征在于,所述目标确定单元,具体用于:将在当前位置进行的最优估计结果与两次估计结果进行比较,如果差异值在预设的阈值区间内,则将当前的估计结果作为最终估计结果,将估计结果中的放射源位置作为下一次移动目标;如果差异值在预设的阈值区间外,则在安全辐射剂量率区域内选择一空间位置作为下一次移动目标。
8.根据权利要求7所述的未知环境放射源自主搜索方法,其特征在于,所述路径规划单元,具体用于:基于所构建的环境地图得到移动代价地图;
搜索机器人从当前位置移动到周围八个方向地图栅格的代价;
选择所需代价最小的栅格作为新的当前位置,记录到路径中,并开始下一次搜索,直至搜索到目标位置;
回溯从起始点到目标点的所有节点,提取从当前位置到目标位置的最优路径作为机器人的规划路径并输出。
9.一种未知环境放射源自主搜索系统,其特征在于,包括机器人主体,探测系统,通信系统以及智能处理系统,其中:所述机器人主体包括电源系统、驱动控制系统和设备搭载平台;所述电源系统用于为驱动控制系统及探测系统、通信系统、智能处理系统进行供电;所述驱动控制系统用于与通信系统、智能处理系统进行数据交流,实现控制指令接收,控制机器人在空间中的移动;所述设备搭载平台与通信系统、智能处理系统、探测系统通过机械连接,实现各部分的安装固定;
所述智能处理系统用于执行如权利要求1‑4任意一项所述的未知环境放射源自主搜索方法;
所述探测系统用于实现对外部环境的探测;
所述通信系统用于实现探测系统、智能处理系统以及驱动控制系统之间的信息通信。
10.根据权利要求9所述的未知环境放射源自主搜索系统,其特征在于,所述探测系统包括里程计、加速度传感器、惯性传感器、雷达传感器、视觉传感器、辐射探测器、所有传感器均与所述智能处理系统电连接。