基于多目标人工蜂群算法的多机器人路径规划方法
【技术领域】
[0001] 本发明涉及路径规划技术领域，具体涉及一种基于多目标人工蜂群算法的多机器 人路径规划方法。
【背景技术】
[0002] 自机器人诞生以来，人类社会的生活、生产方式发生了巨大变化。随着对机器人需 求的发展，人们认识到完成一件复杂的任务时，相比于设计单个功能复杂的机器人，设计多 个功能简单的机器人在成本、效率、鲁棒性上有很多优势。多机器人系统相比于单机器人具 有效率更高、成本更低、灵活性高、鲁棒性强等优点。在多机器人系统中，移动多机器人系统 是一个研宄的重要方向。设计移动多机器人系统，自主导航是研宄的关键问题之一。路径 规划作为自主导航技术的核心，是实现多机器人自主导航技术的关键，也是多机器人系统 研宄的一个热点问题。路径规划不仅要考虑路径最短这一指标，还要考虑路径的安全性、平 滑性等性能指标。传统的路径规划方法只考虑单个的性能指标或者通过加权法将多个性能 指标转化为单个性能指标，然后用单目标函数优化方法求解多目标优化问题。然而实际的 路径规划问题其路径长度、路径安全性和平滑性等指标一般都是相互冲突的，难以达到同 时最优化。通过传统的路径规划方法一次只能求得一条路径，不能满足复杂环境中机器人 的路径规划需求。多目标优化方法可以良好的解决存在冲突情况下的优化问题，每次优化 可以根据需要得到一个解集，包含所优化问题的多个可行解，便于机器人进行选择。多目标 人工蜂群算法是一种智能优化算法，算法收敛速度快、不易陷入局部最优值，是一种求解多 目标优化问题的有效算法。
【发明内容】
[0003] 针对现有技术存在的缺陷，本发明的目的在于对标准人工蜂群算法进行多目标优 化改进，提供一种基于多目标人工蜂群算法的多机器人路径规划方法。
[0004] 本发明提供一种基于多目标人工蜂群算法的多机器人路径规划方法，其特征在 于，包含以下优化步骤：
[0005] 步骤一：环境建模
[0006] -，路径规划问题的环境建模
[0007] 路径规划的环境设置为二维平面，建立环境地图的全局坐标系O-XY ;Start为 机器人的出发点，Target为机器人的目标点；机器人的路径在环境地图中可以表示为 起点、目标点和中间经过的η个路径点组成的集合：Path = {Start, Step1, Step2,… ,Stepn, Target};其中，集合P= (Step1, Step2, "^StepJ即为路径规划的优化目标，Step 为机器人的路径点，每个Step路径点含有机器人运动的横纵坐标
[0008] 为简化环境地图、优化机器人路径点的表示方法，将机器人的步长值设置为定值 StepLen，其运动路径通过机器人起点坐标（Startx, Starty)和机器人每一个 当前位置相对于上一个位置的夹角Θ i来确定，具体如下式：
【主权项】
1. 一种基于多目标人工蜂群算法的多机器人路径规划方法，其特征在于，包含以下优 化步骤： 步骤一：环境建模 一，路径规划问题的环境建模 路径规划的环境设置为二维平面，建立环境地图的全局坐标系O-XY;Start为机器人 的出发点，Target为机器人的目标点；机器人的路径在环境地图中可以表示为起点、目标 点和中间经过的n个路径点组成的集合：Path= {Start,StepuStep2，…，Stepn,Target}; 其中，集合P= {SkPl，St^2，…，St印J即为路径规划的优化目标，St印为机器人的路径 点，每个Step路径点含有机器人运动的横纵坐标(S/t九，S/(:九）； 为简化环境地图、优化机器人路径点的表示方法，将机器人的步长值设置为定值StepLen，其运动路径(5"/〇7:>,:，57〇7:〇通过机器人起点坐标（Start51,Starty)和机器人每一个 当前位置相对于上一个位置的夹角0i来确定，具体如下式：
其中，k表示机器人行走的第k步，为路径点的x坐标值，Sk九为路径点的y坐标 值；Startx为起点的x坐标值，Starty为起点的y坐标值；StepLen为机器人的步长值，0i 为机器人路径点对应的夹角； 路径规划目标由集合P转化为集合9 = {^，92，…，9n，9n+1};其中，^为路径点Start和路径点StePi之间对应的夹角；0 n+1为路径点Step"和Target之间对应的夹角；夹 角9 初始化是通过随机数生成的，生成方式为如下式： 9i= rand(0, 1) X (max「minj+mini 其中，rand(0, 1)表示0到1之间的随机数，maxi为夹角0i可以取得的最大值，mini为夹角Qi可以取得的最小值； 二，路径规划问题的三个目标函数 路径规划中，性能指标有很多；本发明考虑最重要的三个目标函数：路径长度函数、路 径安全性函数和路径平滑性函数；其定义分别是如下： 路径长度函数f\(0): 对于路径Path= {Stari^StepnStepa…，Stepn，Target} = ^，卩丨，…，pn，pn+1}的优 化转化为对0 = {0i，02，…，0n，0n+1}的优化；本发明中机器人的步长值为定值，因此机 器人路径长度为机器人的行走步数和最后一步到目标点的距离，可以表示为如下式： fi( 0 ) =f1(p) =nXStepLen+1pnpn+1 其中，n表示机器人行走的步数，StepLen为机器人的步长值；|pnpn+11表示路径目标点Target和机器人第n步的位置Stepn之间的距离； 路径安全性函数4(9): 机器人在运动过程中不能与障碍物或者其他机器人相撞，路径安全性函数是避免碰撞 的关键函数，本发明设计的路径安全性函数为如下式：
其中，min为最小值求取函数，disObst为机器人的路径点到障碍物的距离，min(disObst)为机器人的路径点到各个障碍物的距离的最小值；Dist为设定的阈值，表示 机器人的安全度；const为常数，表示当机器人的路径点到障碍物的距离大于此值时，机器 人的路径是安全的，不需要进行优化； 路径平滑性函数&(0): 通过路径点之间对应的夹角计算路径的方式简化了路径平滑性函数的设计，本发明的 路径平滑性函数为如下式：
其中，max为最大值求取函数，机器人的路径点集合0中机器人路径点之间的夹 角，n表示夹角的数目； 步骤二：路径规划参数、多目标人工蜂群算法参数初始化 多目标人工蜂群算法需要初始化的参数：首先设置食物源数目Fs、最大迭代次数MaxCycle、食物源的取值范围[min，max];然后进行食物源的初始化，食物源即代表路径规 划中的优化目标一一路径点之间的夹角集合9 ;食物源的数目等于雇佣蜂和观察蜂总量的 二分之一，通常每个食物源会对应一只雇佣蜂，雇佣蜂会对食物源进行优化；需要初始化的 路径规划参数为机器人步长值StepLen; 步骤三：三种蜜蜂分别对路径进行优化 算法初始化之后，进入算法的主体迭代优化过程；多目标人工蜂群算法的优化是通过 蜂群的自组织能力实现的；蜂群的自组织能力体现在其具有正反馈、负反馈、波动和交互的 属性；在多目标人工蜂群算法中，食物源最初在解空间中的分布是无序的、随机的，经过一 次次优化，逐步走向有序，得到最优解； 三种蜜蜂分别对路径进行优化是算法的主体循环部分之一；首先，雇佣蜂采蜜，产生新 的路径，得到路径点对应的夹角的集合0/ ;其路径的更新方式为如下式：
其中，ub#P 分别是路径点对应的夹角的最大值和最小值；eu代表的是波动系数， 决定雇佣蜂觅食的范围；9i/为新产生的路径点之间的夹角；9u为集合9 /中的一个元 素，9w为集合9中随机选择的一个子集9k中的对应元素； 然后雇佣蜂会判断新得到的0'和当前的0之间的Pareto支配关系，如果沒，则 用0 '取代0作为当前的路径集合；如果则不进行更新操作；观察蜂会根据自己的 喜好进行采蜜，之后同样会进行路径更新；最后，侦察蜂会根据当前的排序状态选择放弃不 可行路径，并重新生成新的路径； 步骤四：基于Pareto支配和拥挤距离排序，保留优良路径 基于Pareto支配和拥挤距离的排序是等雇佣蜂、观察蜂和侦察蜂路径优化结束之后 才总体进行的；此方法运行效率明显优于每种蜜蜂路径优化结束之后就进行一次排序；排 序之后，根据排序的次序保留优良路径，舍弃不可行路径，维持种群大小的恒定；此步骤也 是算法的主体循环部分之一；此步结束之后，会判断是否已经达到最大迭代次数，如果达到 最大迭代次数则进入下一步；否则，算法的迭代次数加1，继续进行下一步优化过程； 步骤五：输出最优路径 当算法达到最大迭代次数时便会终止；此时得到机器人路径规划的路径点之间的夹角 的集合；此集合是一个Pareto最优解集；算法的最后一步是把路径点的夹角关系集合0 转化为路径点的集合Path;然后，将集合Path输出，路径规划结束；最后，机器人运动的路 径是从输出的Pareto最优解集中选取的一条适合当时机器人所在环境要求的路径。
2. 根据权利要求1所述的基于多目标人工蜂群算法的多机器人路径规划方法，其特征 在于，所述机器人步长值StepLen决定机器人行走的歩距，步长值越大，机器人路径平滑性 越差；步长值越小，机器人路径平滑性越好。
3. 根据权利要求1所述的基于多目标人工蜂群算法的多机器人路径规划方法，其特征 在于，所述食物源数目Fs取40~60 ;所述最大迭代次数MaxCycle取800~1500 ;所述食 物源的取值范围[min, max]中，范围为-Jr < min < max < 31。
4.根据权利要求1所述的基于多目标人工蜂群算法的多机器人路径规划方法，其特征 在于，所述波动系数eu的取值范围为[-0. 5, 0. 5]。
【专利摘要】本发明提出一种基于多目标人工蜂群算法的多机器人路径规划方法，属于路径规划技术领域，包括：路径规划问题的环境建模、多目标人工蜂群算法的参数初始化、三种蜜蜂迭代优化路径并确定非劣解集、排序保留优良路径和输出最优路径集合。本发明基于Pareto支配和拥挤距离的非支配排序的概念对标准人工蜂群算法进行改进，提出了适用于求解多目标优化问题的多目标人工蜂群算法。在路径规划过程中本算法可以考虑路径长度、平滑性和安全性等多个性能指标，并且一次路径规划可以获得一组Pareto最优路径。本发明提出的路径规划方法属于元启发式智能优化方法，不同于传统的单目标路径规划方法，能够更好的适应复杂环境中的路径规划任务。
【IPC分类】G05D1-02
【公开号】CN104808665
【申请号】CN201510179769
【发明人】李敏, 窦连航, 李洋
【申请人】上海大学
【公开日】2015年7月29日
【申请日】2015年4月16日