一种基于改进型人工势场法的机器人路径规划方法及系统技术方案

本发明专利技术公开了一种基于改进型人工势场法的机器人路径规划方法及系统，首先在激光雷达的可视范围内找到局部目标点；然后规划出机器人当前位置到达局部目标点的可达路径，最后控制驱动机器人行进，循环检测局部目标点，直至机器人达到最终目标点；该方法采用基于人工势场法来规划机器人路径规划，解决了传统势场法对机器人进行路径规划出现的局部极小点问题，对传统的人工势场法进行了改进，即改进引力势函数，同时将整个任务划分为许多局部目标点，从而达到最优的路径；提高了路径规划的实时性、环境适应性效率。

【技术实现步骤摘要】

本专利技术涉及机器人及智能车辆的局部导航领域，特别是一种基于改进型人工势场法的机器人路径规划方法。
技术介绍
移动机器人实时路径规划和导航是反映机器人自主能力的关键要素之一，也是较难解决的问题之一。机器人路径规划主要分为环境信息已知的规划和环境信息未知的规划。对于前者多采用离线规划，得到的路径较优，后者多采用在线规划，体现了路径规划的实时性。近年来许多移动机器人路径规划的方法被人们所研究。主要的路径规划的方法可以分为两类：人工智能的方法(AI)和人工势场法(APF)。前者主要运用的方法有遗传算法(GA)、模糊逻辑控制(FLC)和人工神经网络(ANN)，这些方法往往较为复杂运算速度也较为缓慢。而后者由于其简洁性和快速性在机器人路径规划中得到广泛应用，其基本思想是环境中的目标点对其的吸引力以及障碍物的对其的排斥力构成一种势场环境。然而人工势场法在避障应用的过程中，常常会遇到局部最小的问题。如何避免人工势场法在避障路径规划中出现局部最小的问题，是移动机器人路径规划的关键。通过查阅专利和论文，主要有沿墙跟踪方法、极限环法、虚拟水流法及引入内部主体状态法等算法。这些方法虽然在一定程度上缓解了局部最小问题，但都有其各自的缺陷。其中沿墙跟踪法和极限环法存在规划速度慢的问题。虚拟水流法在解决环境已经情况下的局部极小点问题有一定的效果，但算法效率不高。引入内部主体状态的方法成功的解决了复杂环境中的局部最小值问题，但是不能解决通常情况下的静态势场问题，通用性不强。由于上述算法存在实时性不好、效率不高、会引入如环境适应能力差等一些新的问题等缺点。因此，急需一种既具有高效率，又能保证实时性且通用性强的改进的人工势场法。
技术实现思路
本专利技术的目的就是提供一种基于改进型人工势场法的机器人路径规划方法及系统，适用于局部导航中，采用基于势场法的运动规划及规避障碍物。本专利技术的目的是通过这样的技术方案实现的：本专利技术提供了一种基于改进型人工势场法的机器人路径规划方法，包括以下步骤：S1：获取机器人的初始化状态参数、环境信息和最终目标点；S2：获取机器人当前坐标位置和局部目标点；S3：建立基于时间虚拟驱动力的人工势场法生成机器人当前坐标位置和局部目标点之间的可达路径；S4：控制机器人沿可达路径行进；S5：在激光雷达可视范围内检测机器人当前坐标位置是否达到局部目标点，如果没有达到，则返回步骤S4继续控制驱动机器人行进；S6：如果达到局部目标点，则检测机器人是否达到最终目标点，如果没有达到，则返回步骤S2；S7：如果达到最终目标点，则结束机器人的行进。进一步，所述局部目标点的确定，具体包括以下步骤：S21：检测最终目标点和当前坐标位置之间可通过的直线路径下有无障碍物，如果没有障碍物，则设置最终目标点作为局部目标点；S22：如果有障碍物，则判断障碍物的个数是否小于两个，如果否，则设置离此障碍物充分安全距离的任一点最为新坐标点作为局部目标点；S23：如果是，则建立离最终目标点最近的两个障碍物呈现的斥力势场，并构建试探点寻找斥力场合力零的坐标作为局部目标点。进一步，所述试探点寻找斥力场合力零的坐标具体按照以下步骤来实现：S231：按照以下斥力势函数建立障碍物对机器人造成的人工斥力势场模型；Urep(q)=12δ(1ρ(q)-1ρ0),ρ(q)≤ρ00,ρ(q)>ρ0;]]>式中：δ：相应的正比例位置增益系数；ρ0：正常数，表示障碍物区域可对机器人的运动产生影响的最大距离；ρ(q)：某一障碍物区域Cobs到位置q的最小距离，对于所有的q′∈Cobs，ρ(q)＝min||q-q′||；S232：根据斥力势函数按照以下公式确定机器人所受的排斥力：式中，用qc表示障碍物区域Cobs上距离q最近的位置点；ρ(q)＝||q-qc||；是由qc指向q的单位向量，S233：选取距离全局目标点距离最近的障碍物，并获取障碍物在平面上呈现的斥力势场，S234：根据斥力势场计算排斥力，选取排斥力合力为零的点作为局部目标点。进一步，所述机器人在达到局部目标点之前还包括以下步骤来实现：S31：建立机器人与障碍物之间的斥力势函数并计算斥力：S32：建立机器人与局部目标点之间的引力势函数；Uatt(q)=-12ϵρg2(q);]]>式中：ε：人工势场法引力势场增益参数；ρg(q)：机器人当前位置距离局部目标点的欧氏距离；S33：按照以下公式计算局部目标点对机器人的引力：F‾att(q)=-grad[Uatt(q)]=ϵ(q-qg);]]>S34：通过以下公式来计算机器人的引力和斥力的合力为零时确定局部极小点；F‾att(q)=-F‾rep(q);]]>S35：按照以下公式计算时间虚拟驱动力的大小：Ftime=γ*vi3((xi-xg)2+(yi-yg)2)3]]>式中：γ：调节Ftime的常数。本专利技术提供了一种基于改进型人工势场法的机器人路径规划系统，包括机器人参数信息采集单元、机器人位置采集单元、局部目标点生成单元、可达路径生成单元、进行控制单元、局部目标点判断单元和最终目标点判断单元；所述机器人参数信息采集单元，用于获取机器人的初始化状态参数、环境信息和最终目标点；所述机器人位置采集单元，用于获取机器人当前坐标位置；所述局部目标点生成单元，用于确定机器人行进中的局部目标点；所述可达路径生成单元，用于计算机器人当前位置和局部目标点之间的可达路径；所述进行控制单元，用于控制、驱动机器人沿可达路径行进；所述局部目标点判断单元，用于计算并判断机器人当前坐标位置是否达到局部目标点；所述最终目标点判断单元，用于计算并判断机器人是否达到最终目标点；所述机器人参数信息采集单元和机器人位置采集单元分别与局部目标点生成单元连接；所述机器人位置采集单元与可达路径生成单元连接；所述可达路径生成单元与进行控制单元连接；所述局部目标点判断单元和最终目标点判断单元分别与行进控制单元连接。进一步，所述局部目标点生成单元是按照以下步骤来进行的：S11：检测最终目标点和当前坐标位置之间可通过的直线路径下有无障碍物，如果没有障碍物，则设置最终目标点作为局部目标点；S12：如果有障碍物，则判断障碍物的个数是否小于两个，如果否，则设置离此障碍物充分安全距离的任一本文档来自技高网...

【技术保护点】
一种基于改进型人工势场法的机器人路径规划方法，其特征在于：包括以下步骤：S1：获取机器人的初始化状态参数、环境信息和最终目标点；S2：获取机器人当前坐标位置和局部目标点；S3：建立基于时间虚拟驱动力的人工势场法生成机器人当前坐标位置和局部目标点之间的可达路径；S4：控制机器人沿可达路径行进；S5：在激光雷达可视范围内检测机器人当前坐标位置是否达到局部目标点，如果没有达到，则返回步骤S4继续控制驱动机器人行进；S6：如果达到局部目标点，则检测机器人是否达到最终目标点，如果没有达到，则返回步骤S2；S7：如果达到最终目标点，则结束机器人的行进。

【技术特征摘要】
1.一种基于改进型人工势场法的机器人路径规划方法，其特征在于：包括以下步骤：
S1：获取机器人的初始化状态参数、环境信息和最终目标点；
S2：获取机器人当前坐标位置和局部目标点；
S3：建立基于时间虚拟驱动力的人工势场法生成机器人当前坐标位置和局部目标点之间
的可达路径；
S4：控制机器人沿可达路径行进；
S5：在激光雷达可视范围内检测机器人当前坐标位置是否达到局部目标点，如果没有达
到，则返回步骤S4继续控制驱动机器人行进；
S6：如果达到局部目标点，则检测机器人是否达到最终目标点，如果没有达到，则返回
步骤S2；
S7：如果达到最终目标点，则结束机器人的行进。
2.如权利要求1所述的基于改进型人工势场法的机器人路径规划方法，其特征在于：所
述局部目标点的确定，具体包括以下步骤：
S21：检测最终目标点和当前坐标位置之间可通过的直线路径下有无障碍物，如果没有障
碍物，则设置最终目标点作为局部目标点；
S22：如果有障碍物，则判断障碍物的个数是否小于两个，如果否，则设置离此障碍物充
分安全距离的任一点最为新坐标点作为局部目标点；
S23：如果是，则建立离最终目标点最近的两个障碍物呈现的斥力势场，并构建试探点寻
找斥力场合力零的坐标作为局部目标点。
3.如权利要求2所述的基于改进型人工势场法的机器人路径规划方法，其特征在于：所
述试探点寻找斥力场合力零的坐标具体按照以下步骤来实现：
S231：按照以下斥力势函数建立障碍物对机器人造成的人工斥力势场模型；
Urep(q)=12δ(1ρ(q)-1ρ0),ρ(q)≤ρ00,ρ(q)>ρ0;]]>式中：
δ：相应的正比例位置增益系数；
ρ0：正常数，表示障碍物区域可对机器人的运动产生影响的最大距离；
ρ(q)：某一障碍物区域Cobs到位置q的最小距离，对于所有的q′∈Cobs，ρ(q)＝min||q-q′||；
S232：根据斥力势函数按照以下公式确定机器人所受的排斥力：
式中，用qc表示障碍物区域Cobs上距离q最近的位置点；
ρ(q)＝||q-qc||；
是由qc指向q的单位向量，S233：选取距离全局目标点距离最近的障碍物，并获取障碍物在平面上呈现的斥力势场，
S234：根据斥力势场计算排斥力，选取排斥力合力为零的点作为局部目标点。
4.如权利要求1所述的基于改进型人工势场法的机器人路径规划方法，其特征在于：所
述机器人在达到局部目标点之前还包括以下步骤来实现：
S31：建立机器人与障碍物之间的斥力势函数并计算斥力：
S32：建立机器人与局部目标点之间的引力势函数；
Uatt(q)=-12ϵρg2(q);]]>式中：
ε：人工势场法引力势场增益参数；
ρg(q)：机器人当前位置距离局部目标点的欧氏距离；
S33：按照以下公式计算局部目标点对机器人的引力：
F‾att(q)=-grad[Uatt(q)]=ϵ(q-qg);]]>S34：通过以下公式来计算机器人的引力和斥力的合力为零时确定局部极小点；
F‾att(q)=-F‾rep(q);]]>S35：按照以下公式计算时间虚拟驱动力的大小：
Ftime=γ*vi3((xi-xg)2+(yi-yg)2)3]]>式中：
γ：调节Ftime的常数。
5.一种基于改进型人工势场法的机器人路径规划系统，其特征在于：包括机器人参数信
息采集单元、机器人位置采集单元、局部目标点生成单元、可达路径生成单元、进行控...

【专利技术属性】
技术研发人员：孙棣华，廖孝勇，赵敏，杜道轶，
申请(专利权)人：重庆大学，
类型：发明
国别省市：重庆;50