一种化工灾害现场搜救机器人路径规划方法技术

本发明专利技术涉及一种化工灾害现场搜救机器人路径规划方法，所述路径规划方法包括以下步骤：s‑1对灾害现场使用栅格法进行环境建模；s‑2利用遗传蚁群算法最终得到一个初步最优路径；s‑3在每个单位时间里，检测初步最优路径是否进入不断扩散的有毒气体范围中；s‑4若有，则对进入有毒气体范围内的线段两点重新进行路径规划以避开有毒气体，若无，则沿用当前路径。本发明专利技术的搜救机器人路径规划方法将有毒气体设置为动态扩散模式，通过检测与更新与有毒气体区域重合的路径，克服了传统模型中有毒气体静止所造成的缺陷，使得规划路径更为安全可靠。

A path planning method for chemical disaster scene search and rescue robot

The invention relates to a chemical disaster rescue robot path planning method, the path planning method comprises the following steps: S 1 to the disaster site using the grid method for the environment modeling; s 2 using ant colony algorithm to finally get a preliminary optimal path; s 3 in each unit of time, toxic gas range the initial optimal path detecting whether to enter the spread of S; 4 if, on line into the toxic gases within the scope of the two new path planning to avoid the poisonous gas, if not, then follow the current path. Rescue robot path planning method of this invention will set dynamic toxic gas diffusion model, through the path detection and update and toxic gases overlap, overcome the defects in the traditional model of toxic gases caused by the static path planning, which is more safe and reliable.

【技术实现步骤摘要】
一种化工灾害现场搜救机器人路径规划方法
本专利技术涉及机器人智能算法领域，具体为一种化工灾害现场搜救机器人路径规划方法。
技术介绍
移动机器人目前是人工智能领域和机电一体化领域的典型代表，被大量运用在灾害的现场搜救上，不过当前都集中于矿难领域。另外随着我国化工产业的逐步壮大以及这几年来化工灾害事故频发，其安全生产受到了很大的考验，发展化工灾害搜救机器人迫在眉睫。当化工灾害发生时，有毒气体扩散，制造出一个人员无法通过的区域，其搜救技术主要难点在于如何快速地规划出一条安全的逃生路径。遗传算法依据达尔文进化论“适者生存”的理论，模仿大自然种群选择、交叉和变异，具有全局性，随机性和鲁棒性。在操作中将所有的信息都置于染色体当中，每一次迭代都会进行一次随机选择，通过适应度函数不断地规范搜索方向，经过不断地迭代即可得到最优解。遗传算法能够将问题从具体领域中抽象出来，提供一种通用的计算模型。蚁群算法是模仿自然界当中蚂蚁寻找食物的启发式搜索方法，具有并行性、正反馈性和自组织性，蚂蚁在走过的路径时会留下一定量的信息素，这些信息素的浓度与到达目标点的距离成反比，后面的蚂蚁在选择时会有更大概率选择浓度高的路径，形成正反馈，最终规划出一条最优路径。遗传算法初期具有较高趋于最优解速度的收敛速度，而蚁群算法正好相反，后期收敛速度快速的上升，得益于信息素的积累，因而两者的算法融合具有了原理上的依据，即利用遗传算法前期的信息素积累来缩短蚁群算法进入后期高速收敛阶段的时间，提高算法整体的速度。
技术实现思路
本专利技术的目的是专利技术一种化工灾害现场搜救机器人路径规划方法，以解决当前算法运行速度慢，而且容易在沿着路径行走时进入有毒气体扩散区域的技术问题。为了解决这一技术问题，本专利技术提供了一种化工灾害现场搜救机器人路径规划方法，包括如下步骤：s-1对灾害现场使用栅格法进行环境建模；s-2利用遗传蚁群算法最终得到一个初步最优路径；s-3在每个单位时间里，检测初步最优路径是否进入不断扩散的有毒气体范围中；s-4若有，则对进入有毒气体范围内的线段两点重新进行路径规划以避开有毒气体，若无，则沿用当前路径。进一步，所述步骤s-1中对灾害现场使用栅格法进行环境建模包括：步骤s-1-1：将现场划分为n×n的栅格，其中无障碍的格子为0，有实体障碍物的格子为1，取路径规划开始时的有毒气体分布作为有毒气体初始区域，并设为0.5；步骤s-1-2：对于有毒气体的格子，设定每单位时间内气体会扩散到相邻的8个格子。进一步，所述步骤s-2中利用遗传算法形成初始路径信息素分布包括：步骤s-2-1：设置遗传参数，生成初始种群；步骤s-2-2：设置适应度函数并评价初始种群；步骤s-2-3：对初始种群进行选择、交叉、变异等操作；步骤s-2-4：检测是否满足迭代结束条件，若不满足则跳到s-2-2继续这一过程，若满足则结束迭代，并将适应度值的前30％组解转换成蚁群算法的信息素初始值。s-2-5：初始化各类参数，包括迭代次数、每次派出的蚂蚁数、起点和终点、信息素矩阵等；s-2-6：求出当前蚂蚁所在点前往周围八个节点的概率，并利用轮盘算法求出下一步前往的点；s-2-7:进行局部信息素更新，并转到s-2-6继续迭代，直到所有蚂蚁都到达终点或陷入死胡同；s-2-8：进行全局信息素更新，其中没有到达的蚂蚁不计算在内，然后重复s-2-6和s-2-7，直到n代蚂蚁完成搜索。进一步，所述步骤s-3中在每个单位时间里，检测初步最优路径是否进入不断扩散的有毒气体范围中的方法包括：步骤s-3-1：取机器人与幸存人员逃生的速度为v，根据初步最优路径的长度可以计算出每一个单位时间所通过的路线；步骤s-3-2：在每一个单位时间里，更新有毒气体的扩散区域，与当前时间段里的路径进行比较，检查是否重合并记录下当前时间段以及对应路径的起点和终点。进一步，所述步骤s-4中则对进入有毒气体范围内的线段两点重新进行路径规划以避开有毒气体包括：步骤s-4-1：将当前时间段的有毒气体区域在栅格法中设为0.5；步骤s-4-2：以当前时间段对应的两点作为起点和终点，再进行一次步骤s-2，寻找替代的最优路径。本专利技术的有益效果是，充分利用了遗传算法在前期快速积累的有用信息素，避免了蚁群算法在初期搜索时的盲目性，直接进入到能高效利用信息素正反馈的后期，提高了算法的运行速度，为灾害现场救援路径规划争取了时间；另一方面充分考虑到化工灾害现场的特殊性，将有毒气体设置为动态扩散模式，检测机器人与幸存者在沿着路径行进过程当中是否会进入到有毒气体的扩散范围内，从而避免了传统路径规划算法里容易进入有毒气体区域的问题。附图说明图1为本专利技术的化工灾害现场搜救机器人路径规划的流程框图。图2为本专利技术的搜救机器人路径规划遗传算法流程图。图3为本专利技术的搜救机器人路径规划蚁群算法流程图。图4为本专利技术的规划路径进入有毒气体区域时自我修正的示意图。具体实施方式为使本专利技术的目的、技术方案及优点更加清楚、明确，以下参照附图并举实施例对本专利技术进一步详细说明。所举实例只用于解释本专利技术，并非用于限定本专利技术。本专利技术的化工灾害现场搜救机器人路径规划工作原理：利用了遗传算法在前期全局搜索的优势，将30％的最优解转化为蚁群算法的初始信息素，避开了蚁群算法效率低下的初期搜索，直接进入到能高效利用信息素正反馈的后期，在蚁群算法规划出初步路径之后，将每个单位时间内移动的路径与相对应时间段的有毒气体扩散范围相比较，若有重合则针对这一时间段的路径重新规划以避开有毒气体。在一个优选实施例中，一种化工灾害现场搜救机器人路径规划方法，如图1所示，包括如下步骤：s-1对灾害现场使用栅格法进行环境建模；s-2利用遗传蚁群算法最终得到一个初步最优路径；s-3在每个单位时间里，检测初步最优路径是否进入不断扩散的有毒气体范围中；s-4若有，则对进入有毒气体范围内的线段两点重新进行路径规划以避开有毒气体，若无，则沿用当前路径。作为栅格法环境建模的一种可选的实施方式，所述步骤s-1对灾害现场使用栅格法进行环境建模的方法包括：对全局地图采用栅格进行划分并对障碍物以及有毒气体区域进行特殊标记。具体的，所述栅格法环境建模，即将现场划分为20×20的栅格，其中无障碍的格子为0，有实体障碍物的格子为1，取路径规划开始时的有毒气体分布作为有毒气体初始区域，并设为0.5；对于有毒气体的格子，设定其每单位时间内气体会扩散到相邻的8个格子。作为生成初始最优路径的一种可选的实施方式，如图2、图3所示，所述步骤s-2利用遗传蚁群算法最终得到一个初步最优路径的方法包括：步骤s-2-1：设置遗传参数，生成初始种群；即设置种群规模n、交叉概率Pc、变异概率Pm以及最大迭代次数Nmax，将起点和目标点固定后，通过随机选择栅格里内的点形成一个个基因片段，将这些点连接起来则形成了一个染色体，即初始路径，不同的染色体则构成了初始种群。步骤s-2-2：设置适应度函数；按照下式设定适应度函数F＝B-λ1·f1-λ2·f2-λ3·f3其中f1是路径长度，f2是节点个数，f3是平滑度，λ1、λ2、λ3为各个变量的系数，B是初值；f1可以用下式来计算：其中mj为路径所经过的点；f2为路径所经过的节点个数；f3可由下式计算：θj路径段与路径段之间的偏转角度。步骤本文档来自技高网...

【技术保护点】
一种化工灾害现场搜救机器人路径规划方法，其特征在于：所述路径规划方法包括以下步骤：s‑1对灾害现场使用栅格法进行环境建模；s‑2利用遗传蚁群算法最终得到一个初步最优路径；s‑3在每个单位时间里，检测初步最优路径是否进入不断扩散的有毒气体范围中；s‑4若有，则对进入有毒气体范围内的线段两点重新进行路径规划以避开有毒气体，若无，则沿用当前路径。

【技术特征摘要】
1.一种化工灾害现场搜救机器人路径规划方法，其特征在于：所述路径规划方法包括以下步骤：s-1对灾害现场使用栅格法进行环境建模；s-2利用遗传蚁群算法最终得到一个初步最优路径；s-3在每个单位时间里，检测初步最优路径是否进入不断扩散的有毒气体范围中；s-4若有，则对进入有毒气体范围内的线段两点重新进行路径规划以避开有毒气体，若无，则沿用当前路径。2.根据权利要求1所述化工灾害现场搜救机器人路径规划方法，其特征在于，所述步骤s-1中对灾害现场用栅格法进行环境建模包括：s-1-1：根据实际环境的大小，将现场划分为n×n的栅格，并对无障碍、实体障碍物以及有毒气体的格子做不同的标记；s-1-2：对于有毒气体区域，设定每个有毒气体格子每单位时间内气体会扩散到相邻的8个格子。3.根据权利要求1所述化工灾害现场搜救机器人路径规划方法，其特征在于，所述步骤s-2中利用遗传蚁群算法最终得到一个初步最优路径包括以下步骤：s-2-1：执行遗传算法，并将适应度值...

【专利技术属性】
技术研发人员：樊启高，庄祥鹏，孙艳，孙壁文，
申请(专利权)人：江南大学，
类型：发明
国别省市：江苏,32