基于自适应VFH算法的移动机器人避障规划.pdf
《基于自适应VFH算法的移动机器人避障规划.pdf》由会员分享,可在线阅读,更多相关《基于自适应VFH算法的移动机器人避障规划.pdf(9页珍藏版)》请在咨信网上搜索。
1、 doi:10.3772/j.issn.1002-0470.2023.06.009基于自适应 VFH 算法的移动机器人避障规划徐天余 孙晓冬 谢建良 孟祥冬 何启江 (电子科技大学电子科学与工程学院 成都 611731)(中国电子科技集团公司第五十八研究所 无锡 214063)(东南大学微电子学院 南京 210096)摘 要 向量场直方图(VFH)方法具有对传感器误差不敏感以及响应速率快等特点而广泛应用于移动机器人的运动避障问题。该方法将各方向的障碍物信息量化为强度值,并以设定的阈值判断可行性。而不同的阈值会造成机器人避障效果的差异,对不同任务环境的适应性较差。本文针对传统 VFH 方法的阈值
2、敏感性问题进行改进,提出一种自适应阈值调整策略,通过构建阈值评价函数,结合环境信息对候选方向范围内每组阈值进行代价分析,实时地选取适于当前运动的阈值,使机器人能够自主完成避障。为验证算法的有效性和可靠性,设计模拟障碍物的场景并进行对比实验。结果表明,采用改进自适应阈值策略的 VFH 算法,能够改善传统算法对阈值敏感的问题,能保证机器人可以在狭窄通道中以较短的无碰撞路径到达目标位置。关键词 路径规划;自主避障;向量场直方图(VFH);自适应阈值0 引 言人工智能和控制技术等领域的飞速发展,使得具备自主规划能力的移动机器人广泛应用于众多领域。移动机器人的自主导航主要包括定位、路径规划和避障等任务。
3、机器人路径规划可以根据对环境信息的掌握程度划分为环境信息完全已知的全局路径规划和环境信息部分未知(或完全未知)的局部路径规划1。全局路径规划可以求得全局最优路径,但存在计算量较大和实时性能不佳等问题,且环境中的未知信息会对全局路径产生极大影响,甚至会导致机器人与障碍物发生碰撞或无法到达目标点等情况;局部路径规划通过传感器实时感知障碍物信息,可以实现机器人动态避障,但由于缺少全局信息,易于陷入局部极值点,最终偏离目标方向2。为提高机器人自主避障能力,国内外研究者做了大量研究,提出了一些经典的机器人避障方法,如栅格法3、可视图法、虚拟势场法(virtual force field,VFF)3等。其
4、中向量场直方图法(vector field histo-gram,VFH)是一种广泛应用的局部避障规划算法。VFH 算法由文献4于 1991 年提出,算法针对虚拟势场法的力场急剧变化引起稳定性不佳和数据震荡等问题进行改进。VFH 算法不仅保留了 VFF算法计算速率快的优点,并且应用两级数据减少技术在平衡计算量的同时保留了许多细节信息,使得机器人能够在狭窄空间内平滑转弯且不发生震荡。然而该算法最初并未考虑移动机器人自身的尺寸和运动学特性,机器人会出现无法执行已规划路径的情况。针对这个问题,1998 年文献5提出了 VFH+算法,该算法通过隐性的构造空间将机器人的尺寸和运动学特性纳入考虑,将直方图
5、二值化并应用代价函数更细致地评估候选方向。为进一步突破346 高技术通讯 2023 年 第33 卷 第6 期:643-651 中国博士后科学基金面上项目(2022M712976),国家自然科学青年基金(62103388)和江苏省双创博士项目(JSSCBS20211448)资助。男,1997 年生,硕士生;研究方向:嵌入式系统设计;E-mail:。通信作者,E-mail:。(收稿日期:2022-06-08)VFH 算法自身局限,文献6于 2000 年结合启发式搜索 A算法提出了 VFH算法,该算法能够预测机器人选择某个方向后可能产生的后果,使机器人在运动过程中更趋于目标方向。目前 VFH 算法系
6、列仍有以下几点局限:(1)VFH 算法对阈值等参数敏感性较大;(2)VFH 算法作为局部避障规划算法,容易陷入局部极值点;(3)VFH 算法较为依赖距离传感器,易受环境因素的制约7。针对上述问题,国内外许多研究者对 VFH 系列算法的阈值敏感性、直方图构建、转弯策略等问题进一步提出了改进算法。国外方面,文献8提出了一种共享控制方法,将来自 VFH+避障导航模块的命令与操作员通过操纵台提供的遥操作命令相结合,易于集成自治系统和加强应对动态环境的能力。文献9提出了结合 TDT(time dependent tree)方法的改进 VFH算法,通过创建前瞻树的方法提高动态环境下的避障能力。国内方面,文
7、献10提出了结合离线规划双向 A算法和在线避障 VFH 算法的规划方法,不影响全局路径最优性的同时能有效避开突发威胁。文献11 充分考量了机器人运动学模型和转弯策略,保证移动状态点的可执行性。在 VFH 原算法中,阈值设定和谷底宽度等参数并没有量化定义。因此,本文针对 VFH 算法的阈值等参数敏感性问题,提出一种改进型避障算法,采用自适应阈值策略12和新的谷底计算方式,运用阈值代价函数,对候选方向进一步评估,选取最适用于机器人当前环境的阈值并获得目标航向。之后对改进算法在仿真障碍物环境中进行验证并分析对比规划结果。实验表明,采用该方法能够有效改善阈值等参数对 VFH 算法避障效果的差异化影响,
8、使机器人能以较短的平滑路径避开障碍物并到达目标,同时兼顾实时性,提高对动态环境的适应性。1 避障算法设计1.1 VFH 算法原理VFH 算法的基本原理是建立以移动机器人为中心的极坐标系,将所有栅格的障碍物对机器人运动方向的影响通过直方图量化为各个角度上的极线障碍物强度值(polar obstacle density,POD),在障碍物强度值低于某个确定阈值的角度范围内确定机器人移动的候选方向13,VFH 算法流程如图 1 所示。图 1 VFH 算法流程图算法的核心机理是 2 个阶段的数据缩减作用14,具体实现步骤如下。(1)以机器人的中心位置为坐标原点,将地图转换为各单元格,保留激光雷达前方一
9、定角度范围扫描区域(记为 Block)的数据,按每 1 一个区间(可根据雷达分辨率调整)将区域划分为扇区,按逆时针方向进行编号,第 k 个扇区用 Zk表示。(2)计算各扇区中单元格(i,j)的障碍物强度值 mi,j及其总和 Hk,并以此构建向量场直方图,障碍物强度值的计算公式为mi,j=c2i,j(a-bdi,j)(1)Hk=i,jmi,j(2)式中,ci,j称为单元格(i,j)的信度值(certainty val-ue,CV),表示该单元格内存在障碍物的概率;di,j表示该单元格(i,j)到机器人中心点的距离;a、b为常数,且满足如下关系 a-bdmax=0;dmax表示单元格距离机器人中心
10、点的最远距离,该关系式令机器人的运动空间内各顶点的 m 值为 0,即机器人在即将离开运动空间时不受该区域障碍物的影响15。446高技术通讯 2023 年 6 月 第 33 卷 第 6 期在实际环境中运用时,工作空间的范围需比实际边界更远,以免机器人与实际边界发生碰撞。(3)设定阈值对应的障碍物强度值为 Mth,将每个扇区的 Hk与阈值进行对比,合并满足 Hk 2+3。1.2 VFH 算法的缺陷从 1.1 小节中可以看出,对于 VFH 算法,可通行扇区直方图是引导机器人选择最优规划方向的基准,其根据阈值 Mth的大小差异生成的直方图形状也大不相同,因此合适的阈值策略对 VFH 算法至关重要。以算
11、法某一时刻构建的扇区直方图为例,设置不同阈值 Mth对应直方图中的扇区宽度和数量会不一致。假设机器人的目标方向为第 90 号扇区对应角度,如图 4 所示。图 4 算法构建的向量场直方图当距离阈值 dth=3 时对应的 Mth为 3700;而当dth=1 时 Mth则为1800。将图5 对比可得,当 Mth=3700 时的可通行扇区数量和宽度明显多于 Mth=1800 时。当 Mth=3700 时,直方图中的宽谷扇区包括24 172 号扇区、239 261 号扇区和265 300 号扇区,90 号扇区周围均为可通行候选方向,机器人在下一时刻将选择 100 号扇区对应角度向前移动。而实际上 77
12、91 号扇区的障碍物强度值已开始增大,表示此方向上较远处存在障碍物,若此时机器人继续沿前一时刻方向运动,机器人会有与障碍物发546徐天余等:基于自适应 VFH 算法的移动机器人避障规划生碰撞的风险;反之当 Mth=1800 时,直方图中的宽谷扇区则比较狭窄且稀少,虽然 90 号扇区的障碍物强度值小于阈值,但存在稍远障碍物的 77 91 号扇区已经被确定为不可通行扇区,90 号扇区周围并没有形成宽谷,机器人在下一时刻将转变方向,选择42 号扇区作为避开障碍物的运动方向。以图 5 为例,VFH 算法设置不同大小的阈值会使生成的直方图中可通行扇区数量和分布情况存在较大差异,对机器人的避障规划功能产生
13、下面 2 种不同的影响。(a)Mth=3700 对应可通行扇区直方图(b)Mth=1800 对应可通行扇区直方图图 5 不同阈值对应可通行扇区直方图(1)设置较大阈值 Mth较大阈值会使可通行扇区增多,机器人前进有更多候选方向,虽然有利于机器人迅速找到更接近目标的方向,但会使其对障碍物不敏感,若运动速度较快则极有可能发生碰撞。以原算法仿真18为例,地图模型为 50 50 维的二值地图,起点为(1,1),终点为(50,50)。算法的各参数设置如下:阈值 Mth设为 200;障碍物强度值 Hk记录为 density;代价函数式(3)的各项权重设为 1=6,2=2,3=2。图6 为选取某一时刻机器人
14、的仿真避障结果路径图,中间带框路径为避障路径,分散栅格则为障碍物。图 6 原算法避障路径仿真图在路径仿真图中,选取某一时刻机器人的离散位置坐标为(35,36),最优目标方向角度约为 43。由于选取的阈值过大,生成的直方图中会有大段宽而连续的宽谷区间,机器人的前进方向会更偏向于维持不变,从而容易忽略前方较远处的障碍物。而在下一时刻位置坐标(36,37)处,机器人虽已发现前方障碍物(前进扇区内参数 density 急剧增大),但在较高速情况下难以及时做出避障动作,最终发生碰撞。(2)设置较小阈值 Mth较小阈值使可通行扇区更少,使机器人对障碍物更敏感,能提前发现前方的障碍物,及时调整运动轨迹。然而
15、,这种情况下狭窄且分散的可通行扇区会使机器人易将一些实际可行通道当作不可行通道排除,导致其丧失通过相对狭窄的通道的能力。综上所述,VFH 算法中阈值设定值的不同会对机器人的避障规划产生不同的影响。在实际应用中,阈值通常根据经验人为设置,对于障碍物少的较空旷环境可以设置一个较大的阈值,而在障碍物密集环境中则需要一个较小的阈值,但这种方式面对机器人所处环境或运动状态的变化则不再适用。1.3 候选谷宽度及可通行方向分析VFH 的原始算法没有将机器人尺寸参数和运动特性计入考虑,对谷区宽度也没有精确量化定义。因此本文针对这 2 点问题进行研究,对机器人物理参数、谷区宽度提出一种新的量化处理方式,以分析6
16、46高技术通讯 2023 年 6 月 第 33 卷 第 6 期其可通行性。由 1.1 节中图 3 可以得出可通行扇区内障碍物到机器人中心的最小距离和扇区跨越角度,公式如下:dmin=min(dz1,dz2)(4)=180(dz1-dz2)(5)式中,为角度分辨率(本文中取值为 1),dz1、dz2分别是障碍物与扇区 Z1,Z2 的 2 个交点到机器人中心点的最小距离。由式(4)、(5)可以得出机器人在扇区 Z1,Z2 中的可通行距离 d dmin,将这个距离与机器人底盘的宽度 Wb(需略大于实际值)比较即可判断机器人是否在该扇区内可通行。若 Wb d 2Wb,则机器人在 Z1,Z2 中的可通行
17、方向 t可通过式(6)求解。t=180(Z1+Z2)rad2(6)若 d 2Wb,则机器人在 Z1,Z2 中可以求得2 个可通行方向,计算公式为t1=180 Z1(rad)-arcsinWbdz1()(7)t2=180 Z2(rad)+arcsinWbdz2()(8)在通过上述方式求解可通行方向的步骤中,会面临一类极端情况,如图 7 所示。图 7 可通行方向局限情况从图中可看出,可通行距离 d Wb。在这种情况下,算法会认为前方窄道不可通行,无法找到可通行方向,可能会使机器人进入下方障碍物夹角的死区中。实际上机器人所在位置只需向上移动即可找到一条可以通过该窄谷的路径。1.4 阈值选取策略分析针
18、对 1.2 节提出的 VFH 算法阈值敏感性问题,本文考虑机器人的物理参数、运动特性和目标环境,提出了自适应阈值调整策略。为使机器人在运动过程中能合理选用阈值,需要确定阈值的调整范围,其受机器人的物理参数、运动特性影响。1.4.1 物理参数1.3 节说明了机器人底盘宽度对算法的影响,此外还要考虑传感器的性能。机器人搭载的激光雷达具有一定的扫描范围,可设为(Lmin,Lmax),则阈值必须在这个对应区间内调整。1.4.2 运动特性实际运动过程中,机器人从发现障碍物到减速避障需要一定制动距离。设机器人运动线速度为v,减速时最大加速度为 a,则其从减速到停止的制动距离 Sb为Sb=v22a(9)通常
19、 Sb Lmin,由此可以得到H(Sb+Rs)Mth Mthmax2.Mth=Mthmin3.end if4.if Mthmin Ht Mthmax5.Mth=Ht6.end if7.if Ht04.then kd appropriatedirection(directionnum)5.cost h(Mth,kd)6.(Mth,kd,cost)Set7.end if8.Mth=Mth+delta(Mth)9.until Mth Mthmax10.if Set.Step 111.iminimum cost number in Set12.kt Seti,kd13.end if14.return
20、kt15.send ktto controller(1)设置阈值的初始值:根据式(10)的对应关系确定符合条件的阈值最大值和最小值,分别设置为 Mthmax和 Mthmin。设移动机器人当前坐标为(xc,yc),目标点坐标为(xt,yt),此时则有:Ht=c2t(a-bdt)(11)式中,Ht表示当前点到目标点之间的总障碍物强度值,ct表示目标点栅格的信度值;dt表示目标点与机器人当前点间的距离。(2)对(Mthmin,Mth)区间内的阈值按一确定步长 Mth进行遍历,若某个阈值下存在可行的候选方向,则使用代价函数式(3)求解代价最小的方向,记为 kd,之后将此方向向量及对应的 Mth代入式(
21、12)计算代价值,新的代价函数如下:h(Mth,kd)=H(Mth-Mthmin)+(kd-kt)(12)式中,(Mth-Mthmin)为阈值代价项,为阈值权重系数。根据 1.2 节的分析,阈值过大的情况下机器人会对障碍物不敏感,容易与障碍物发生碰撞,所以在代价增大的情况下机器人会选择更小阈值得出更小代价的运动方向前进。取值与机器人当前的运动状态相关,运动速度越快则 的值越大,阈值代价项也会随之增大,此时机器人的运动方向选择相比于向目标点前进,会更侧重于避开障碍物的安全性。(kd-kt)为方向代价项,取决于机器人当前可行方向 kd与目标方向 kt的向量差,该代价项越小表示可行方向越接近目标方向
22、。(3)将各计算所得的代价值及对应的阈值 Mth和方向 kd参数统计并存入集合中,选取集合内代价值最小一组的运动方向为最优前进方向;若第(2)步中满足条件候选方向的阈值数为 0,则表示此时机器人周围不存在可通行方向,应当立即停止前进。综上所述,这个自适应阈值调整策略的核心原理即对阈值区间进行遍历,使用附加的代价函数对每个阈值对应的候选方向集合更加细致地评估其可行性,提高规划方向与路径的可靠性。2 实验结果及分析为了验证本文算法的有效性和可靠性,在模拟的障碍物环境中进行实验。移动机器人的物理参数与 VFH 算法的各项关键参数设置如表 1。表 1 物理参数和算法参数设置参数符号数值表征说明N360
- 配套讲稿:
如PPT文件的首页显示word图标,表示该PPT已包含配套word讲稿。双击word图标可打开word文档。
- 特殊限制:
部分文档作品中含有的国旗、国徽等图片,仅作为作品整体效果示例展示,禁止商用。设计者仅对作品中独创性部分享有著作权。
- 关 键 词:
- 基于 自适应 VFH 算法 移动 机器人 规划
1、咨信平台为文档C2C交易模式,即用户上传的文档直接被用户下载,收益归上传人(含作者)所有;本站仅是提供信息存储空间和展示预览,仅对用户上传内容的表现方式做保护处理,对上载内容不做任何修改或编辑。所展示的作品文档包括内容和图片全部来源于网络用户和作者上传投稿,我们不确定上传用户享有完全著作权,根据《信息网络传播权保护条例》,如果侵犯了您的版权、权益或隐私,请联系我们,核实后会尽快下架及时删除,并可随时和客服了解处理情况,尊重保护知识产权我们共同努力。
2、文档的总页数、文档格式和文档大小以系统显示为准(内容中显示的页数不一定正确),网站客服只以系统显示的页数、文件格式、文档大小作为仲裁依据,平台无法对文档的真实性、完整性、权威性、准确性、专业性及其观点立场做任何保证或承诺,下载前须认真查看,确认无误后再购买,务必慎重购买;若有违法违纪将进行移交司法处理,若涉侵权平台将进行基本处罚并下架。
3、本站所有内容均由用户上传,付费前请自行鉴别,如您付费,意味着您已接受本站规则且自行承担风险,本站不进行额外附加服务,虚拟产品一经售出概不退款(未进行购买下载可退充值款),文档一经付费(服务费)、不意味着购买了该文档的版权,仅供个人/单位学习、研究之用,不得用于商业用途,未经授权,严禁复制、发行、汇编、翻译或者网络传播等,侵权必究。
4、如你看到网页展示的文档有www.zixin.com.cn水印,是因预览和防盗链等技术需要对页面进行转换压缩成图而已,我们并不对上传的文档进行任何编辑或修改,文档下载后都不会有水印标识(原文档上传前个别存留的除外),下载后原文更清晰;试题试卷类文档,如果标题没有明确说明有答案则都视为没有答案,请知晓;PPT和DOC文档可被视为“模板”,允许上传人保留章节、目录结构的情况下删减部份的内容;PDF文档不管是原文档转换或图片扫描而得,本站不作要求视为允许,下载前自行私信或留言给上传者【自信****多点】。
5、本文档所展示的图片、画像、字体、音乐的版权可能需版权方额外授权,请谨慎使用;网站提供的党政主题相关内容(国旗、国徽、党徽--等)目的在于配合国家政策宣传,仅限个人学习分享使用,禁止用于任何广告和商用目的。
6、文档遇到问题,请及时私信或留言给本站上传会员【自信****多点】,需本站解决可联系【 微信客服】、【 QQ客服】,若有其他问题请点击或扫码反馈【 服务填表】;文档侵犯商业秘密、侵犯著作权、侵犯人身权等,请点击“【 版权申诉】”(推荐),意见反馈和侵权处理邮箱:1219186828@qq.com;也可以拔打客服电话:4008-655-100;投诉/维权电话:4009-655-100。