本发明涉及基于果蝇优化算法的多机器人气味源定位方法的研究，属于机器人主动嗅觉领域。
背景技术：
由于危险气体的泄漏导致生命财产受损的事件时常发生，很多自然界的生物可以凭借本身灵敏的嗅觉，判定危险的存在、及时规避危险。受到生物有效利用嗅觉信息的启发，一些学者将配备气体传感器的机器人应用到定位危险化学源的研究中，并将此类研究定义为机器人主动嗅觉。在机器人主动嗅觉研究领域，将危险气体泄漏源定义为气味源。
hayes将一般性的气味源定位问题定义为在二维的封闭环境中，尽可能快的找到单个气味源的过程，并将该过程分解为3个子任务：烟羽发现、烟羽追踪和气味源确认。在该领域的研究前期，有关单机器人的气味源定位问题得到了广泛研究。使用单机器人进行气味源的定位，无论是基于浓度梯度的趋化性策略，还是基于逆风搜索的趋风性策略，在指导机器人进行气味源定位的过程中都存在效率低下的问题。
近年来，由于机器人技术迅猛发展，研究如何利用多机器人定位气味源得到了重视。相较于单机器人，将多机器人应用到气味源定位研究存在诸多优势，比如可以减少搜索时间、扩大搜索区域、提高搜索效率、具有更高的鲁棒性和抗干扰性，在较为复杂的搜索环境中，可以完成单机器人无法完成的任务。
考虑到多机器人系统的群体性，群体智能优化算法被广泛的应用到气味源定位研究中。果蝇优化算法作为一种新的演化式群体智能算法，具有简单、稳健、易实现、灵活等优点，为复杂的优化应用问题或者能够转化为优化求解的问题提供了一种新的解决途径。目前果蝇优化算法的适用范围大多在连续函数的参数优化领域，针对离散域的寻优问题尚未有直接的应用。
本发明针对单机器人在气味源定位任务中存在的不足，在继承原始果蝇优化算法协作式寻优模式的基础上，将其应用于离散域的寻优过程，对原始果蝇优化算法中的固定步长加以修正，使其能够依据浓度进行自适应变化，在保证高成功率的前提下，极大的提高气味源定位的效率。
技术实现要素：
单机器人在气味源定位任务中对环境已知信息要求高、抗干扰性差、易陷入局部最优状态，针对单机器人应用于机器人主动嗅觉的缺陷，本发明提出了一种基于果蝇优化算法的多机器人气味源定位方法，机器人能够在不依靠风向信息的情况下，充分利用迭代更新的位置信息和浓度信息，高效完成气味源定位的任务。
本发明解决其技术问题所采用的技术方案是。
烟羽发现：随机给定机器人群体初始位置pos，机器人个体以该初始位置pos为中心，在自适应步长step*2的方块区域内分散开来，依据得到的最大浓度值是否大于设定的浓度阈值α确定是否转入烟羽追踪阶段。
烟羽发现：随机给定机器人群体初始位置pos，机器人个体以该初始位置pos为中心，在自适应步长step*2的方块区域内分散开来，依据得到的最大浓度值是否大于设定的浓度阈值α确定是否转入烟羽追踪阶段。
烟羽追踪：选择气味浓度最大的机器人作为最优个体bestsmell，若该最优个体的浓度值大于群体浓度值，则将该最优个体更新为群体最优值smellbest，以群体最优值的位置为中心不断进行迭代寻优。在迭代寻优过程中，机器人个体以pos为中心向外分散时的步长值依据浓度值进行自适应变化。采用自适应变化的步长值，可以保证在气味源定位的整个过程中保持高效率的搜索。
其中，自适应步长值的公式为：
l0为给定的固定步长值，scale是步长值自适应变化的比例因子，cmax为预先设定的最大浓度值，α为取值大于1的整数。
气味源确认：以设定的浓度阈值clim作为迭代终止条件，在最大迭代次数内，连续3次找到最优解的浓度值大于clim，才认定完成气味源定位的任务，将群体最优smellbest最后所处的位置确定为气味源位置；若实际运行的迭代次数大于设定的最大迭代次数，算法终止，宣告气味源定位任务失败。
附图说明
下面结合附图和实施例对本发明作进一步说明。
图1是本发明方法的流程图。
具体实施方式
1.初始化。
1.1设定初始参数：在搜索空间内随机选择一个位置pos作为机器人群体的初始位置，设定种群的规模size、初始浓度阈值α和初始步长值l0。
1.2设定算法终止条件：搜索空间的浓度阈值clim和最大迭代次数gmax。
2.烟羽发现和烟羽追踪：果蝇群体依据自适应变化的步长值进行气味源位置的迭代更新。
2.1计算自适应步长值step：自适应步长值的大小由当前的群体最优浓度值smellbest与预先设定的环境中的最大浓度值cmax之间的大小关系自适应调节，由式(1)决定：
其中l0为给定的固定步长值，scale是步长值自适应变化的比例因子，cmax为预先设定的最大浓度值，α为取值大于1的整数。
机器人刚进入到搜索环境时，随机选择一个位置作为群体的初始位置。由于气味源的泄漏是一个时变过程，在进行气味源定位的初始阶段，搜索区内的部分区域的浓度值近似为0，自适应步长依据浓度变化，在初始阶段步长值相对较大，全局搜索能力很强，机器人会加强在整个搜索空间的搜索；气味源临近区域内的气味浓度值较大，当机器人群体收敛到气味源邻域时，自适应步长的大小相对较小，具有很强的局部搜索能力，能够快速准确的定位到气味源位置。
2.2种群位置的更新：果蝇个体从群体最优位置出发，在自适应步长值step*2限定的方形区域内随机扩散，每个果蝇个体的位置根据式(2)进行更新：
.
其中，bestsmell表示果蝇群体的当前位置，loci*表示第i个果蝇将要前往的位置，step表示自适应步长的大小，rand(1,1)产生[-1,1]范围内的随机数。
2.3保留每次迭代过程中味道浓度最大的果蝇个体，作为最优个体bestsmell。若最优个体的味道浓度大于群体最优值，将该个体设定为群体最优smellbest。每次迭代都选出味道浓度最大的作为最优个体，不断更新群体最优。
3.气味源确认：以设定的浓度阈值clim作为迭代终止条件，在最大迭代次数内，连续3次找到最优解的浓度值大于clim，才认定完成气味源定位的任务，将群体最优的最后位置确定为气味源的位置。若实际运行的迭代次数大于设定的最大迭代次数，算法终止，宣告气味源定位任务失败。