CN110209171A - 一种基于人工势场法的路径规划方法 - Google Patents
一种基于人工势场法的路径规划方法 Download PDFInfo
- Publication number
- CN110209171A CN110209171A CN201910550879.XA CN201910550879A CN110209171A CN 110209171 A CN110209171 A CN 110209171A CN 201910550879 A CN201910550879 A CN 201910550879A CN 110209171 A CN110209171 A CN 110209171A
- Authority
- CN
- China
- Prior art keywords
- barrier
- mechanically moving
- coordinate
- field
- potential field
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Pending
Links
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B13/00—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion
- G05B13/02—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric
- G05B13/04—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators
- G05B13/042—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators in which a parameter or coefficient is automatically adjusted to optimise the performance
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
- G05D1/02—Control of position or course in two dimensions
Abstract
本发明公开了一种基于人工势场法的路径规划方法,涉及移动机械技术领域。该基于人工势场法的路径规划方法,包括如下步骤:坐标定位:在移动机械和障碍物所在的有效平面上建立平面直角坐标系,并标记移动机械和障碍物的坐标。该基于人工势场法的路径规划方法,通过工势场法对障碍物进行分析和计算,从而使得移动机械可以在环境中找出最优的行走轨迹,避免移动机械行走时与障碍物碰撞,同时在动态环境中(即障碍物移动的的环境中)移动机械能够根据障碍的位置,动态地规划处最优移动轨迹,进行快速地避障的同时向目标点运动,减少人力支出的同时提高了工作效率。
Description
技术领域
本发明涉及移动机械技术领域,具体为一种基于人工势场法的路径规划方法。
背景技术
路径规划是运动规划的主要研究内容之一,运动规划由路径规划和轨迹规划组成,连接起点位置和终点位置的序列点或曲线称之为路径,构成路径的策略称之为路径规划,路径规划在很多领域都具有广泛的应用。在高新科技领域的应用有:移动机械的自主无碰行动;无人机的避障突防飞行;巡航导弹躲避雷达搜索、防反弹袭击、完成突防爆破任务等。在日常生活领域的应用有:GPS导航;基于GIS系统的道路规划;城市道路网规划导航等。在决策管理领域的应用有:物流管理中的车辆问题(VRP)及类似的资源管理资源配置问题。通信技术领域的路由问题等。
在现有技术中,移动机械的路径规划一般采用人为设定或一些简单的算法进行,若遇到移动环境复杂或人工难以获取当前环境数据时则难以及时的通过机械化算法给出最优路径,增加人力支出的同时降低了工作效率。
发明内容
(一)解决的技术问题
针对现有技术的不足,本发明提供了一种基于人工势场法的路径规划方法,解决了在现有技术中,移动机械的路径规划一般采用人为设定或一些简单的算法进行,若遇到移动环境复杂、障碍物处于移动状态或人工难以获取当前环境数据时则难以及时的通过机械化算法给出最优路径,增加人力支出的同时降低了工作效率的问题。
(二)技术方案
为实现以上目的,本发明通过以下技术方案予以实现:一种基于人工势场法的路径规划方法,包括如下步骤:
S1、坐标定位:在移动机械和障碍物所在的有效平面上建立平面直角坐标系,并标记移动机械和障碍物的坐标,其中:移动机械在地图中的位置坐标为(x,y),目标位置坐标为(xt,yt),总共有n个障碍物,障碍物1的坐标为(x1,y1),障碍物2的坐标为(x2,y2),以此类推,第n个障碍物的坐标为(xn,yn);
S2、进行阻力场计算:具体计算方式如下:
障碍物1对移动机械的阻力场为:
障碍物2对移动机械的阻力场为:
公式中k的为阻力场权重系数;依次类推,得出所有障碍物对移动机械的阻力场总和为:
S3、进行引力场计算:具体计算方式如下:
目标位置对移动机械的引力场为:
公式中的h为引力场权重系数;
S4、进行人工势场的计算:具体计算方式如下:
移动机械的初始位置点为(x0,y0),从初始点到目标点,可以找到一条最优路径,使得该路径上移动机械的人工势场的总和∑M最大,则该路径为基于人工势场的最优路径。
(三)有益效果
本发明提供了一种基于人工势场法的路径规划方法。具备以下有益效果:该基于人工势场法的路径规划方法,通过工势场法对障碍物进行分析和计算,从而使得移动机械可以在环境中找出最优的行走轨迹,避免移动机械行走时与障碍物碰撞,同时在动态环境中(即障碍物移动的的环境中)移动机械能够根据障碍的位置,动态地规划处最优移动轨迹,进行快速地避障的同时向目标点运动,减少人力支出的同时提高了工作效率。
附图说明
图1为基于人工势场法的路径规划方法示意图。
具体实施方式
下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅仅是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。
请参阅图1,本发明提供一种技术方案:一种基于人工势场法的路径规划方法,其特征在于:包括如下步骤:
S1、坐标定位:在移动机械和障碍物所在的有效平面上建立平面直角坐标系,并标记移动机械和障碍物的坐标,其中:移动机械在地图中的位置坐标为(x,y),目标位置坐标为(xt,yt),总共有n个障碍物,障碍物1的坐标为(x1,y1),障碍物2的坐标为(x2,y2),以此类推,第n个障碍物的坐标为(xn,yn);
S2、进行阻力场计算:具体计算方式如下:
障碍物1对移动机械的阻力场为:
障碍物2对移动机械的阻力场为:
公式中k的为阻力场权重系数;依次类推,得出所有障碍物对移动机械的阻力场总和为:
S3、进行引力场计算:具体计算方式如下:
目标位置对移动机械的引力场为:
公式中的h为引力场权重系数;
S4、进行人工势场的计算:具体计算方式如下:
移动机械的初始位置点为(x0,y0),从初始点到目标点,可以找到一条最优路径,使得该路径上移动机械的人工势场的总和∑M最大,则该路径为基于人工势场的最优路径。
综上所述,该基于人工势场法的路径规划方法,通过工势场法对障碍物进行分析和计算,从而使得移动机械可以在环境中找出最优的行走轨迹,避免移动机械行走时与障碍物碰撞,同时在动态环境中(即障碍物移动的的环境中)移动机械能够根据障碍的位置,动态地规划处最优移动轨迹,进行快速地避障的同时向目标点运动,减少人力支出的同时提高了工作效率。
需要说明的是,在本文中,诸如第一和第二等之类的关系术语仅仅用来将一个实体或者操作与另一个实体或操作区分开来,而不一定要求或者暗示这些实体或操作之间存在任何这种实际的关系或者顺序。而且,术语“包括”、“包含”或者其任何其他变体意在涵盖非排他性的包含,从而使得包括一系列要素的过程、方法、物品或者设备不仅包括那些要素,而且还包括没有明确列出的其他要素,或者是还包括为这种过程、方法、物品或者设备所固有的要素。
尽管已经示出和描述了本发明的实施例,对于本领域的普通技术人员而言,可以理解在不脱离本发明的原理和精神的情况下可以对这些实施例进行多种变化、修改、替换和变型,本发明的范围由所附权利要求及其等同物限定。
Claims (1)
1.一种基于人工势场法的路径规划方法,其特征在于:包括如下步骤:
S1、坐标定位:在移动机械和障碍物所在的有效平面上建立平面直角坐标系,并标记移动机械和障碍物的坐标,其中:移动机械在地图中的位置坐标为(x,y),目标位置坐标为(xt,yt),总共有n个障碍物,障碍物1的坐标为(x1,y1),障碍物2的坐标为(x2,y2),以此类推,第n个障碍物的坐标为(xn,yn);
S2、进行阻力场计算:具体计算方式如下:
障碍物1对移动机械的阻力场为:
障碍物2对移动机械的阻力场为:
公式中k的为阻力场权重系数;依次类推,得出所有障碍物对移动机械的阻力场总和为:
S3、进行引力场计算:具体计算方式如下:
目标位置对移动机械的引力场为:
公式中的h为引力场权重系数;
S4、进行人工势场的计算:具体计算方式如下:
移动机械的初始位置点为(x0,y0),从初始点到目标点,可以找到一条最优路径,使得该路径上移动机械的人工势场的总和∑M最大,则该路径为基于人工势场的最优路径。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910550879.XA CN110209171A (zh) | 2019-06-24 | 2019-06-24 | 一种基于人工势场法的路径规划方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910550879.XA CN110209171A (zh) | 2019-06-24 | 2019-06-24 | 一种基于人工势场法的路径规划方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN110209171A true CN110209171A (zh) | 2019-09-06 |
Family
ID=67794400
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201910550879.XA Pending CN110209171A (zh) | 2019-06-24 | 2019-06-24 | 一种基于人工势场法的路径规划方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN110209171A (zh) |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112621751A (zh) * | 2020-12-10 | 2021-04-09 | 珠海格力电器股份有限公司 | 机器人的碰撞检测方法及装置、机器人 |
CN112965496A (zh) * | 2021-02-23 | 2021-06-15 | 武汉理工大学 | 基于人工势场算法的路径规划方法、装置及存储介质 |
CN113848914A (zh) * | 2021-09-28 | 2021-12-28 | 福州大学 | 动态环境下碰撞系数人工势场法局部路径规划方法 |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104317291A (zh) * | 2014-09-16 | 2015-01-28 | 哈尔滨恒誉名翔科技有限公司 | 一种基于人工势场法的机器人避碰路径规划方法 |
US20150120138A1 (en) * | 2013-10-28 | 2015-04-30 | GM Global Technology Operations LLC | Path planning for evasive steering manuever employing a virtual potential field technique |
CN106020199A (zh) * | 2016-07-06 | 2016-10-12 | 江苏科技大学 | 基于优化人工势场法的血凝仪动态避障路径规划方法 |
US20170341235A1 (en) * | 2016-05-27 | 2017-11-30 | General Electric Company | Control System And Method For Robotic Motion Planning And Control |
CN107608346A (zh) * | 2017-08-30 | 2018-01-19 | 武汉理工大学 | 基于人工势场的船舶智能避障方法及系统 |
CN109521794A (zh) * | 2018-12-07 | 2019-03-26 | 南京航空航天大学 | 一种多无人机航路规划及动态避障方法 |
-
2019
- 2019-06-24 CN CN201910550879.XA patent/CN110209171A/zh active Pending
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20150120138A1 (en) * | 2013-10-28 | 2015-04-30 | GM Global Technology Operations LLC | Path planning for evasive steering manuever employing a virtual potential field technique |
DE102014114608A1 (de) * | 2013-10-28 | 2015-04-30 | Gm Global Technology Operations, Llc | Wegplanung für Ausweichlenkmanöver mithilfe einer virtuellen Potentialfeldtechnik |
CN104317291A (zh) * | 2014-09-16 | 2015-01-28 | 哈尔滨恒誉名翔科技有限公司 | 一种基于人工势场法的机器人避碰路径规划方法 |
US20170341235A1 (en) * | 2016-05-27 | 2017-11-30 | General Electric Company | Control System And Method For Robotic Motion Planning And Control |
CN106020199A (zh) * | 2016-07-06 | 2016-10-12 | 江苏科技大学 | 基于优化人工势场法的血凝仪动态避障路径规划方法 |
CN107608346A (zh) * | 2017-08-30 | 2018-01-19 | 武汉理工大学 | 基于人工势场的船舶智能避障方法及系统 |
CN109521794A (zh) * | 2018-12-07 | 2019-03-26 | 南京航空航天大学 | 一种多无人机航路规划及动态避障方法 |
Non-Patent Citations (2)
Title |
---|
丁学恭: "《机器人控制研究》", 30 September 2006, 浙江大学出版社 * |
程磊: "《移动机器人系统及其协调控制》", 31 March 2014, 华中科技大学出版社 * |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112621751A (zh) * | 2020-12-10 | 2021-04-09 | 珠海格力电器股份有限公司 | 机器人的碰撞检测方法及装置、机器人 |
CN112965496A (zh) * | 2021-02-23 | 2021-06-15 | 武汉理工大学 | 基于人工势场算法的路径规划方法、装置及存储介质 |
CN113848914A (zh) * | 2021-09-28 | 2021-12-28 | 福州大学 | 动态环境下碰撞系数人工势场法局部路径规划方法 |
CN113848914B (zh) * | 2021-09-28 | 2024-04-26 | 福州大学 | 动态环境下碰撞系数人工势场法局部路径规划方法 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110209171A (zh) | 一种基于人工势场法的路径规划方法 | |
CN111024092B (zh) | 一种多约束条件下智能飞行器航迹快速规划方法 | |
Ziegler et al. | Spatiotemporal state lattices for fast trajectory planning in dynamic on-road driving scenarios | |
CN102997928B (zh) | 一种城际路网索引和匹配方法 | |
CN103336526B (zh) | 基于协同进化粒子群滚动优化的机器人路径规划方法 | |
CN105865449A (zh) | 基于激光和视觉的移动机器人的混合定位方法 | |
CN111639811A (zh) | 基于改进蚁群算法的多农机协同作业远程管理调度方法 | |
CN106873599A (zh) | 基于蚁群算法和极坐标变换的无人自行车路径规划方法 | |
CN109100730A (zh) | 一种多车协同快速建图方法 | |
CN106525047A (zh) | 一种基于floyd算法的无人机路径规划方法 | |
CN110531770A (zh) | 一种基于改进的rrt路径规划方法和系统 | |
CN113359756B (zh) | 一种基于栅格法实现全向移动机器人避障路径实时规划的方法 | |
CN104406590B (zh) | 一种基于道路等级的最短路径规划方法 | |
CN104535960A (zh) | 一种基于rfid的室内快速定位方法 | |
CN102062608B (zh) | 备选路径规划方法及导航终端 | |
CN111895999A (zh) | 一种基于结构化数据的路径规划方法 | |
CN110412984B (zh) | 一种群集安全一致性控制器及其控制方法 | |
CN103337084B (zh) | 一种基于人工地物特征的地物图斑自动生成方法 | |
CN108995648A (zh) | 自动驾驶方法和智能车 | |
CN111427368A (zh) | 一种改进的多目标无人智能车避碰行驶方法 | |
CN113485378B (zh) | 基于交通规则的移动机器人路径规划方法、系统及存储介质 | |
CN105930917A (zh) | 一种在电子地图上生成公交线路的方法及系统 | |
Maji et al. | Comparison of single and multi objective highway alignment optimization algorithms. | |
Zekui et al. | Three-dimensional path planning for unmanned aerial vehicles based on the developed RRT algorithm | |
CN110267193B (zh) | 基于马尔科夫决策过程模型的车辆位置跟踪方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
RJ01 | Rejection of invention patent application after publication | ||
RJ01 | Rejection of invention patent application after publication |
Application publication date: 20190906 |