一种基于迭代策略的改进人工势场的移动机器人路径规划方法与流程

1.本发明涉及机器人路径规划技术领域，具体是一种基于迭代修正势场策略的改进人工势场算法(improved artificial potential field algorithm based on iterative strategy，iapf-bis)的移动机器人路径规划方法。


背景技术：

2.路径规划技术是移动机器人研究领域的一个重要组成部分，主要目的是在有障碍物的环境中，根据一定的准则(如路径最短，位置拐点最少，用时最短等)，寻求一条从起始位置节点到目标位置节点之间的最优或次优安全无碰路径。
3.路径规划技术的发展在一定程度上标志着机器人智能水平的高低，而路径规划方法的优劣直接影响路径规划效果。
4.目前，国内外许多专家学者都在致力于路径规划算法的研究，常用的优化算法主要有apf算法、免疫算法、蚁群优化算法、神经网络、a-star算法等。
5.其中，apf算法是由khatib提出的一种虚拟力法。它的基本思想是将机器人在周围环境中的运动，设计成一种抽象的人造引力场中的运动，目标点对移动机器人产生“引力”，障碍物对移动机器人产生“斥力”，最后通过求合力来控制移动机器人的运动。应用势场法规划出来的路径一般是比较平滑并且安全，但是这种方法存在局部最优点问题，即机器人可能会陷入局部较低的势场。


技术实现要素：

6.本发明的目的在于提供一种基于迭代修正势场策略的改进人工势场算法(improved artificial potential field algorithm based on iterative strategy，iapf-bis)的机器人路径规划方法，该方法能够克服传统apf在生成路径时可能陷入局部较低势场，从而无法到达终点的缺陷。
7.首先，图1所示为一些会导致apf陷入局部较低势场的栅格地图，其中，左上角栅格为起点s，右下角栅格为终点e。观察机器人陷入局部较低势能的栅格节点的位置，可以发现都是障碍物的邻接节点，同时，由人工势场法的逻辑流程可知，该节点处周围的节点的势能较高。基于上述两点特征，本发明提供一种基于迭代修正势场策略的改进人工势场算法的机器人路径规划方法，大体的思路为，通过迭代修改可能使得apf陷入局部较低势场的节点的势能，逐步减少该类节点的数量，当且仅当该类节点数目为0时，退出迭代过程，用修正后的新势力场去完成路径规划的任务，即可实现克服传统apf在生成路径时可能陷入局部较低势场，从而解决无法到达终点的缺陷。
8.本发明解决其技术问题所采用的技术方案是：一种基于迭代修正势场策略的iapf-bis算法的机器人路径规划方法，包括以下步骤：
s1、初始化算法的相关参数，如包括：地图数据矩阵m、起点s、终点e、空列表list_del、list_append，势场变化系数k=1.1；s2、根据apf相关公式计算每个节点的势力场，即原势场；s3、将所有障碍物的邻接节点添加进一个空列表a；s4、进入修正势场的迭代循环过程；s5、令势场变化误差delta=0；s6、依次遍历列表a中的节点，记为节点a，执行s7；遍历结束后执行s13；s7、检测节点a的邻接节点的势能的最小值，记pf_1；s8、若pf_1＜节点a的势能pf_a，则执行s9；否则，执行s10；s9、将节点a添加进list_del，执行s12；s10、令pf_a等于k*pf_1，delta自加pf_a的前后变化的绝对值；s11、将节点a的邻接节点添加仅list_append;s12、将list_append中的节点添加进列表a；将list_append中的节点从列表a中删除；执行s6；s13、若delta为0，则退出势场修正的迭代过程，执行s14；否则执行s5；s14、基于s13得到的修正势场，从起点节点开始，按照势场最大下降策略，即可找到一条从起点至终点的联通路径。
9.s15、输出路径结果，算法结束。
10.本发明的有益效果是，iapf-bis算法会通过一种迭代策略消除势场中存在的局部较低势场，使得机器人不会陷入局部较低势场，从而提高算法的求解效率。大量的仿真结果表明，采取本发明新型策略的iapf-bis算法在解决机器人路径规划问题上的效果进步明显，整体性能优于apf算法以及其他仿生算法。
附图说明
11.下面结合附图和实施例对本发明进一步说明：图1 apf陷入局部较低势场的仿真案例，其中 (a)、(b)、(c)及(d)部分分别表示4种apf陷入局部较低势场的典型实例；图2 本发明iapf-bis算法流程图；图3 本发明iapf-bis算法运行结果，其中 (a)、(b)、(c)及(d)部分分别表示iapf-bis算法在图1的四种典型实例下的运行结果；图4 势场修正前后三维对比图，其中 (a)、(b)、(c)及(d)部分分别表示iapf-bis算法在图1的四种典型实例下得到的原势场(左)与修正后势场(右)的可视图；原势场为s2中提到的依据传统apf流程得到的势场，修正势场为s13结束时得到的新势场；图5 4种实例环境下仿真过程中势场修正迭代曲线图；图6 iapf-bis与文献iapf仿真结果对比图；图7 原势场(左)与修正后的势场(右)对比图；图8 迭代曲线图。
具体实施方式
12.一种基于迭代修正势场策略的改进人工势场算法的机器人路径规划方法，包括以下步骤（如图2所示）：s1、初始化算法的相关参数，如包括：地图数据m、起点s、终点e、空列表list_del、list_append，势场变化系数k=1.1；s2、根据apf相关公式计算每个节点的势力场，即原势场；s3、将所有障碍物的邻接节点添加进一个空列表a；s4、进入修正势场的迭代循环过程；s5、令势场变化误差delta=0；s6、依次遍历列表a中的节点，记为节点a，执行s7；遍历结束后执行s13；s7、检测节点a的邻接节点的势能的最小值，记pf_1；s8、若pf_1＜节点a的势能pf_a，则执行s9；否则，执行s10；s9、将节点a添加进list_del，执行s12；s10、令pf_a等于k*pf_1，delta自加pf_a的前后变化的绝对值；s11、将节点a的邻接节点添加仅list_append;s12、将list_append中的节点添加进列表a；将list_append中的节点从列表a中删除；执行s6；s13、若delta为0，则退出势场修正的迭代过程，执行s14；否则执行s5；s14、基于s13得到的修正势场，从起点节点开始，按照势场最大下降策略，即可找到一条从起点至终点的联通路径。
13.s15、输出路径结果，算法结束。
14.本发明的有益效果是，通过使用迭代修正势场策略，使得iapf-bis算法在生成路径时，不会陷入局部较低势场，从而提高算法的求解效率。本发明的效果可以通过以下仿真实验进一步说明：为验证本方法的正确性和合理性，运用python语言编程，在图1所示的四种环境下进行仿真。以左上角节点为起点s，右下角节点为终点e，仿真结果如图3所示，图4为势场修正前后对比图，图5为迭代曲线图。
15.为了进一步验证本发明提出的改进算法的有效性，将本发明与另外一种改进的iapf算法进行比较，另一种改进的iapf算法为期刊《电子测量技术》在2020年第17期中101-104页文章《基于改进人工势场法的搬运机器人路径规划》中记载的改进iapf算法，在该文章记载的案例3的环境条件下利用本发明方法与其改进算法进行对比，仿真结果如图6、图7、图8以及表2所示。
16.表2 仿真数据对比表算法路径长度/单位长度算法运行时间/siapf-bis182.32050.3141文献iapf算法264.57180.2832通过表2中数据可知，本发明iapf-bis算法所得最优路径结果为182.3205，优于文献iapf所得到的结果264.5718，路径长度缩短了约31.08%。尽管iapf-bis的用时略高于文献iapf，但综合的来看，本发明的效果表现更好。
17.通过上述对比仿真实验可以得出结论：使用本发明iapf-bis算法的路径规划效率明显优于传统apf算法。且使用本发明提出的iapf-bis算法比他人改进的iapf算法效果好，这说明了本发明提出的iapf-bis算法在路径优化方面的具备一定的可行性与实用性。
18.以上所述，仅是本发明的较佳实施例而已，并非对本发明作任何形式上的限制；任何熟悉本领域的技术人员，在不脱离本发明技术方案范围情况下，都可利用上述揭示的方法和技术内容对本发明技术方案做出许多可能的变动和修饰，或修改为等同变化的等效实施例。因此，凡是未脱离本发明技术方案的内容，依据本发明的技术实质对以上实施例所做的任何简单修改、等同替换、等效变化及修饰，均仍属于本发明技术方案保护的范围内。