CN114296455A - 一种基于行人预测的移动机器人避障方法 - Google Patents
一种基于行人预测的移动机器人避障方法 Download PDFInfo
- Publication number
- CN114296455A CN114296455A CN202111609239.5A CN202111609239A CN114296455A CN 114296455 A CN114296455 A CN 114296455A CN 202111609239 A CN202111609239 A CN 202111609239A CN 114296455 A CN114296455 A CN 114296455A
- Authority
- CN
- China
- Prior art keywords
- pedestrian
- robot
- obstacle avoidance
- mobile robot
- prediction
- 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.)
- Granted
Links
- 238000000034 method Methods 0.000 title claims abstract description 46
- 238000011156 evaluation Methods 0.000 claims abstract description 19
- 230000001133 acceleration Effects 0.000 claims description 6
- 238000004364 calculation method Methods 0.000 claims 1
- 238000012216 screening Methods 0.000 claims 1
- 238000010586 diagram Methods 0.000 description 5
- 230000000694 effects Effects 0.000 description 5
- 238000013459 approach Methods 0.000 description 3
- 238000010276 construction Methods 0.000 description 2
- 238000005034 decoration Methods 0.000 description 2
- 238000005516 engineering process Methods 0.000 description 2
- 239000000463 material Substances 0.000 description 2
- 238000012986 modification Methods 0.000 description 2
- 230000004048 modification Effects 0.000 description 2
- 238000013473 artificial intelligence Methods 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 229940079593 drug Drugs 0.000 description 1
- 239000003814 drug Substances 0.000 description 1
- 238000007726 management method Methods 0.000 description 1
- 239000012567 medical material Substances 0.000 description 1
- 230000005541 medical transmission Effects 0.000 description 1
- 238000002483 medication Methods 0.000 description 1
- 238000005457 optimization Methods 0.000 description 1
- 230000035484 reaction time Effects 0.000 description 1
- 238000011160 research Methods 0.000 description 1
Images
Landscapes
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明公开一种基于行人预测的移动机器人避障方法,方法参考了人在面对运动障碍物时会分析它们的运动趋势,然后提前进行躲避的思想。根据移动机器人运行中的不同场景分为狭长廊道地段和宽阔大厅地段:当机器人前方遇到行人后使用社会力模型来预测其接下来一段时间的行走轨迹,在狭长廊道地段采用不主动躲避的方式,根据预测到的行人位置来调整自身的速度;位于大厅地段时采用主动避让的策略,对动态窗口法(DWA)进行改进,在原有的评价函数中新增预测行人走向的评价项,使得改进后的算法能够提前躲避行人接下来要行走到的位置。本发明提出的移动机器人避障方法将行人的行走意图添加到机器人的避障决策中,提高了移动机器人动态避障的效率。
Description
技术领域
本发明属于自动化技术领域,具体涉及一种基于行人预测的移动机器人避障方法。
背景技术
近年来,随着科学技术的不断进步,如今物流的物流建设已经从人工管理步入了信息化建设的时代。在数字化、人工智能日益发展的大背景下,采用移动机器人来代替人工运输物资是大势所趋。例如,在疫情当下国家不提倡人与人之间近距离接触,采用医护人员手工配送药物的方式会增大疾病传播的风险。目前国外已经开始批量使用了医疗配送机器人,我国的医疗物资无人配送技术也在不断地发展中。
在现有移动机器人的研究中,躲避障碍物是其中的一个重要问题。在移动机器人避障问题上,国内外目前的解决方案包括人工势场法(APF)、动态窗口法(DWA)等。这些算法在障碍物静止时还有不错的效果,然而在障碍物运动时经常会陷入局部最优,从而拖慢了整体的避障时间。产生上述问题的根本原因在于以上的算法在某一时刻只考虑移动机器人和障碍物当前的位置关系,因此在避障时做出的决策只是当前最优解,在全局的角度上还有可以提升效率的余地。综上所述,本发明提出的避障方法旨在提高移动机器人在面对行人时物资运输的效率。
发明内容
为解决上述问题,本发明公开了一种基于行人预测的移动机器人避障方法,能够将预测到的行人行走意图添加到机器人的避障决策中,使得机器人提前躲避行人接下来的行走位置,智能程度高,动态避障效果好。
为达到上述目的,本发明的技术方案如下:
一种基于行人预测的移动机器人避障方法,包括如下步骤:
(1)根据移动机器人当前处于的不同位置分为狭长廊道地段和宽阔大厅地段;
(2)当机器人行走路线前方遇到行人后,使用社会力模型预测行人接下来的走向;
(3)若机器人位于狭长廊道地段,则根据预测到的行人位置调整自身速度;若处于宽阔大厅地段,则使用动态窗口法进行避障,将预测的行人走向添加到动态窗口法的评估函数中。
进一步的,所述步骤(2)中利用社会力模型预测行人的走向,模型假定行人在行走过程中时刻受到环境以及其他行人的力学作用,合力改变行人的运动状态,通过步步迭代到达理想目标点从而完成整个过程。这些力并不是真实存在的,而是为了描述行人在指定情况下的运动特性。在原始的社会力模型中,每一个行人都受到行人自驱动力(即目标点牵引力)、行人间排斥力、边界或障碍物阻力的作用。行人在受到这三种力的作用下,其运动学方程如为:
上式中为第i个行人所受的自驱动力,它描述了该行人朝向目的地运动的主观期望。行人在运动过程中若无其他干扰,会出现以一定速度、以直线最短路径到达的意愿。若行人受到了其他行人或者周围环境的干扰,其行走方向会发生变化,这时在驱动力的作用下行人将逐渐回到原来的行走方向。
其中的中mi为第i个行人的质量,vexp为行人i的理想速度矢量,vi(t)为行人i在t时刻实际的速度,τ为行人对加速度变化的反应时间,即当行人i将当前速度调整为期望速度的松弛时间。为了确定行人理想行走的方向,使用各种车载传感器对移动机器人前方的行人进行观测,再由这段观测时间ΔT内行人行走起点和终点的连线作为此方向。
在上述三个力的基础上,本次发明在原始社会力模型的基础上新增了一个心里驱动力,用来描述行人在遇到配送机器人时主动进行避让的行为,
进一步的,所述步骤(3)中如果移动机器人位于狭长廊道时前方遇到行人,则首先按照上述方法预测出行人一段时间后的行走位置,然后确定一个危险范围r,接着可以得到机器人可以行走到的最远位置。若机器人当前速度为v0,由当前位置到可行走到的最远位置的距离为D,假设移动机器人做匀变速直线运动,则由运动学公式可以得出机器人的加速度为此后可使用该公式不断迭代,调整机器人自身速度即可完成整个过程。
当移动机器人位于宽阔大厅时遇到行人,同样使用社会力模型预测出行人的行走位置,然后将预测的结果添加到动态窗口法的评估函数中,评估函数公式为
G(v,w)=σ·(α·heading(v,w)+β·dist(v,w)+γ·velocity(v,w)+ε·predict(v,w)),
其中的heading(v,w)为朝向角评价,dist(v,w)为障碍物距离评价,velocity(v,w)为机器人速度评价,predict(v,w))为本发明新增的行人预测评价项,公式设计为
当条件成立时,说明移动机器人与行人有同向运动的趋势,因此在所有预测的轨迹中选择较大的可以让机器人朝远离行人行走的方向移动;当条件成立时说明机器人与行人有反向运动的趋势,在所有预测的轨迹中选择较小的可以让机器人朝远离行人行走的方向移动。
本发明的有益效果为:
本发明采用了社会力模型对行人的走向进行了预测,并将结果添加到后续的避障决策中,使得移动机器人能够提前躲避行人将要行走到的位置,提高了动态避障的效果,避免了传统避障算法陷入局部最优的缺陷。
附图说明
图1为本发明所述的避障方法流程图;
图2为社会力模型行人受力示意图;
图3为本发明中确定行人理想前进方向方法示意图;
图4为移动机器人位于狭长廊道时避障示意图;
图5为本发明中在动态窗口法评估函数中新增评价函数项的示意图;
图6为移动机器人在狭窄廊道运行时使用本发明避障方法与原始方法的对比图;
图7为移动机器人在宽阔大厅中运行时使用本发明避障方法与原始方法的对比图。
具体实施方式
下面结合附图和具体实施方式,进一步阐明本发明,应理解下述具体实施方式仅用于说明本发明而不用于限制本发明的范围。
如图1所示,本发明所述的一种基于行人预测的移动机器人避障方法,根据机器人当前处于的位置判断其为狭窄廊道地段或者是宽阔大厅地段。当机器人遇到行人时,首先使用社会力模型预测行人的走向。
进一步的,若机器人位于狭长廊道中(图4所示),使用社会力模型预测出行人的走向后,接着确定一个危险范围r,然后可以得到机器人行走到的最远位置。若机器人当前速度为v0,由当前位置到可行走到的最远位置的距离为D,则由运动学公式可以得出机器人的加速度为此后可使用该公式不断迭代,调整机器人自身速度即可完成整个过程。
进一步的,若机器人位于宽阔大厅中则对原始的动态窗口算法进行改进,改进后的评估函数为G(v,w)=σ·(α·heading(v,w)+β·dist(v,w)+γ·velocity(v,w)+ε·predict(v,w))。其中的predict(v,w))为本发明中新增的行人预测函数评估项,表达式设计为
当条件成立时,说明移动机器人与行人有同向运动的趋势,因此在所有预测的轨迹中选择较大的可以让机器人朝远离行人行走的方向移动,如图5(a)所示;当条件成立时说明机器人与行人有反向运动的趋势,因此在所有预测的轨迹中选择较小的可以让机器人朝远离行人行走的方向移动,如图5(b)所示。
实施例1:
实施例1用来验证本发明提出的避障方法在狭长廊道中的效果,如图6所示。实施例中在狭长廊道设置了一个行人,且与机器人同向行走。机器人的初始速度为0.7m/s,行人速度为0.8m/s,机器人与行人初始距离为1.9m,危险半径为1.5m。黑色曲线使用原始DWA算法避障,由于没有预判行人的行走意图,因此原有算法在避障时比较保守,机器人行走过程中与保持较远的距离,稳定后约为3m;而优化后的算法由于判断到了行人接下来还会向前继续行走,因此可以进一步缩短与行人之间的距离,稳定后约为1.2m。
实施例2:
实施例2用来验证本发明提出的避障算法在宽阔大厅中的避障效果,如图7所示。在大厅中设置了五个行人,其运动方向在图中用黑色箭头标明,其中1、4号行人遇到机器人时减速,即产生了避让行为,其余行人不会主动避让,正常行走。由图7(b)可以看出,优化前的原始DWA算法经过了避让的行人1和4之后在P1处接近了行人2,由于没有预判到该行人的行走意图,机器人的前进方向并没有受到影响,因此在图7(c)中P2处与行人3产生了冲突,减速停车后在从上方绕过行人3。整个避障过程中评估函数执行次数为311,运行总时长为15.5s。而优化后的DWA算法在图7(a)中P1处由于预测到了行人2还会继续向下行走,因此提前向下方进行了避让,这样在图7(b)中P3处面对行人3时就有充分的时间进行躲避,不至于停车,最后在图7(d)中P5处遇到行人5,再向上躲避最终到达终点。优化后的算法整个避障过程中评估函数执行次数为225,运行总时长为11.2s。
需要说明的是,以上内容仅仅说明了本发明的技术思想,不能以此限定本发明的保护范围,对于本技术领域的普通技术人员来说,在不脱离本发明原理的前提下,还可以做出若干改进和润饰,这些改进和润饰均落入本发明权利要求书的保护范围之内。
Claims (5)
1.一种基于行人预测的移动机器人避障方法,其特征在于,包括如下步骤:
(1)根据移动机器人所处于的不同场景分为狭长廊道地段和宽阔大厅地段;
(2)当机器人行走路线前方遇到行人后,使用社会力模型预测行人接下来的走向,没遇到行人则继续正常行驶;
(3)若机器人位于狭长廊道地段,则根据预测到的行人位置调整自身速度;若处于宽阔大厅地段,则使用动态窗口法进行避障,将预测的行人走向添加到动态窗口法的评估函数中。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111609239.5A CN114296455B (zh) | 2021-12-27 | 2021-12-27 | 一种基于行人预测的移动机器人避障方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111609239.5A CN114296455B (zh) | 2021-12-27 | 2021-12-27 | 一种基于行人预测的移动机器人避障方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN114296455A true CN114296455A (zh) | 2022-04-08 |
CN114296455B CN114296455B (zh) | 2023-11-10 |
Family
ID=80968754
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202111609239.5A Active CN114296455B (zh) | 2021-12-27 | 2021-12-27 | 一种基于行人预测的移动机器人避障方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN114296455B (zh) |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103558856A (zh) * | 2013-11-21 | 2014-02-05 | 东南大学 | 动态环境下服务动机器人导航方法 |
CN110414365A (zh) * | 2019-07-03 | 2019-11-05 | 上海交通大学 | 基于社会力模型的过街行人轨迹预测方法、***及介质 |
US20200310444A1 (en) * | 2019-03-25 | 2020-10-01 | Honda Motor Co.,Ltd. | Route determining device, robot, and route determining method |
JP2020184135A (ja) * | 2019-05-07 | 2020-11-12 | マツダ株式会社 | 歩行者位置予測方法及び歩行者位置予測装置 |
CN112631294A (zh) * | 2020-12-16 | 2021-04-09 | 上海应用技术大学 | 一种移动机器人智能路径规划方法 |
CN112965081A (zh) * | 2021-02-05 | 2021-06-15 | 浙江大学 | 基于融合行人信息的特征地图的模仿学习社交导航方法 |
-
2021
- 2021-12-27 CN CN202111609239.5A patent/CN114296455B/zh active Active
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103558856A (zh) * | 2013-11-21 | 2014-02-05 | 东南大学 | 动态环境下服务动机器人导航方法 |
US20200310444A1 (en) * | 2019-03-25 | 2020-10-01 | Honda Motor Co.,Ltd. | Route determining device, robot, and route determining method |
JP2020184135A (ja) * | 2019-05-07 | 2020-11-12 | マツダ株式会社 | 歩行者位置予測方法及び歩行者位置予測装置 |
CN110414365A (zh) * | 2019-07-03 | 2019-11-05 | 上海交通大学 | 基于社会力模型的过街行人轨迹预测方法、***及介质 |
CN112631294A (zh) * | 2020-12-16 | 2021-04-09 | 上海应用技术大学 | 一种移动机器人智能路径规划方法 |
CN112965081A (zh) * | 2021-02-05 | 2021-06-15 | 浙江大学 | 基于融合行人信息的特征地图的模仿学习社交导航方法 |
Also Published As
Publication number | Publication date |
---|---|
CN114296455B (zh) | 2023-11-10 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
Cai | ROBOTICS: From Manipulator to Mobilebot | |
CN112631294B (zh) | 一种移动机器人智能路径规划方法 | |
CN107168305B (zh) | 路口场景下基于Bezier和VFH的无人车轨迹规划方法 | |
CN109375632B (zh) | 自动驾驶车辆实时轨迹规划方法 | |
Stahl et al. | Multilayer graph-based trajectory planning for race vehicles in dynamic scenarios | |
CN112666939B (zh) | 一种基于深度强化学习的机器人路径规划算法 | |
Wei et al. | Autonomous vehicle social behavior for highway entrance ramp management | |
CN111781948A (zh) | 一种无人机编队队形变换与在线动态避障方法 | |
CN115373399B (zh) | 一种基于空地协同的地面机器人路径规划方法 | |
CN109318890A (zh) | 一种基于动态窗口及障碍物势能场的无人车动态避障方法 | |
CN112506199B (zh) | 一种基于动态窗口法且适用于阿克曼模型机器人的局部路径规划方法 | |
JP7469850B2 (ja) | 経路決定装置、ロボット及び経路決定方法 | |
CN111397622A (zh) | 基于改进A*算法与Morphin算法的智能汽车局部路径规划方法 | |
CN115933648A (zh) | 一种机器人动态避障方法及*** | |
CN116360457A (zh) | 一种基于自适应栅格和改进a*-dwa融合算法的路径规划方法 | |
CN116643572A (zh) | 针对室内复杂环境的局部路径规划方法、电子设备及介质 | |
Sun et al. | Interactive left-turning of autonomous vehicles at uncontrolled intersections | |
CN114296455A (zh) | 一种基于行人预测的移动机器人避障方法 | |
Raiesdana | A hybrid method for industrial robot navigation | |
CN116465427A (zh) | 一种基于时空风险量化的智能车辆换道避障路径规划方法 | |
Ou et al. | Modular hierarchical reinforcement learning for multi-destination navigation in hybrid crowds | |
CN115840465A (zh) | 一种基于粒子群算法的无人机集群航迹规划方法 | |
Koike et al. | Proscriptive bayesian programming application for collision avoidance | |
Fan et al. | An Improved Path Planning Algorithm With Adaptive Parameters and Predictions | |
Ribickis et al. | Neuro-Immune Algorithm for Embedded Real-Time Control System in Transport Safety Tasks |
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 | ||
GR01 | Patent grant | ||
GR01 | Patent grant |