基于改进VSRB-RRT算法的机器人路径规划仿真实验_倪建云.pdf
《基于改进VSRB-RRT算法的机器人路径规划仿真实验_倪建云.pdf》由会员分享,可在线阅读,更多相关《基于改进VSRB-RRT算法的机器人路径规划仿真实验_倪建云.pdf(7页珍藏版)》请在咨信网上搜索。
1、 实 验 技 术 与 管 理 第 40 卷 第 9 期 2023 年 9 月 Experimental Technology and Management Vol.40 No.9 Sep.2023 收稿日期:2023-05-05 基金项目:教育部产学合作协同育人项目(201801286006);天津理工大学教学基金项目(ZD21-06,ZD22-07GJ)作者简介:倪建云(1977),男,云南大理,硕士,副教授,研究方向为嵌入式技术、智能机器人路径规划,。通信作者:谷海青(1982),男,天津,硕士,实验师,研究方向为机器人路径规划,。引文格式:倪建云,李浩,谷海青,等.基于改进 VSRB-R
2、RT 算法的机器人路径规划仿真实验J.实验技术与管理,2023,40(9):172-178.Cite this article:NI J Y,LI H,GU H Q,et al.Simulation experiment of robot path planning based on improved VSRB-RRT algorithmJ.Experimental Technology and Management,2023,40(9):172-178.(in Chinese)ISSN 1002-4956 CN11-2034/T DOI:10.16791/ki.sjg.2023.09.024
3、 基于改进 VSRB-RRT 算法的机器人 路径规划仿真实验 倪建云,李 浩,谷海青,杜合磊,吴 杰,薛晨阳(天津理工大学 电气工程与自动化学院,天津 300384)摘 要:针对 B-RRT 算法在路径规划时存在的采样效率低、路径冗长且不光滑,以及无法实时避障等问题,该文提出了基于改进的可变采样区域双向 RRT(VSRB-RRT)和 DWA 的避障路径规划融合算法。在全局规划过程中,VSRB-RRT 算法使用可变采样区域和目标偏置策略相结合的方法,加快了收敛速度并提高了采样效率,并使用贪婪优化、迭代优化和关键点优化生成代价低且光滑可执行的路径。在局部规划过程中,以改进 VSRB-RRT 算法规
4、划的路径为指引,选取路径上的关键点,并使用改进 DWA 算法在关键点分段路径上分段规划。仿真实验表明:改进 VSRB-RRT 算法具有较好的搜索效率,能够以最少的时间和最稳定的效率获得最优路径,同时也验证了融合算法在实时避障路径规划时的有效性。关键词:路径规划;可变采样区域;改进 VSRB-RRT 算法;改进 DWA 算法;融合算法 中图分类号:TP391.9 文献标识码:A 文章编号:1002-4956(2023)09-0172-07 Simulation experiment of robot path planning based on improved VSRB-RRT algorit
5、hm NI Jianyun,LI Hao,GU Haiqing,DU Helei,WU Jie,XUE Chenyang(School of Electronic Engineering and Automation,Tianjin University of Technology,Tianjin 300384,China)Abstract:To address the problems of low sampling efficiency,long and unsmooth paths,and the inability to avoid obstacles in real time in
6、the B-RRT algorithm for path planning,this paper proposes a fusion algorithm for obstacle avoidance path planning based on improved variable sampling region bidirectional RRT(VSRB-RRT)and DWA.In the global planning process,the improved VSRB-RRT algorithm uses a combination of variable sampling regio
7、n and target biasing strategy to speed up rate of convergence and improve sampling efficiency,and uses greedy optimization,iterative optimization and key point optimization to generate low-cost and smooth executable paths.In the local planning process,the path planned by the improved VSRB-RRT algori
8、thm is used as a guide to select the key points on the path,and the improved DWA algorithm is used for segmented planning on the key point segmented path.Simulation experiments have shown that the improved VSRB-RRT algorithm has good search efficiency,can obtain the optimal path with the least time
9、and the most stable efficiency,and also verifies the effectiveness of the fusion algorithm in real-time obstacle avoidance path planning.Key words:path planning;variable sampling region;improved VSRB-RRT algorithm;improved DWA algorithm;fusion algorithm 路径规划是人工智能与机器人专业的重要内容,指机器人在复杂环境中,根据自身传感器信息和环境地图
10、,在一定时间内规划出从起点到终点的无碰撞路径1。移动机器人路径规划可分为基于先验完全信息 倪建云,等:基于改进 VSRB-RRT 算法的机器人路径规划仿真实验 173 的全局路径规划和基于传感器信息的局部路径规划2。与其他路径规划算法相比,快速扩展随机树算法不仅具有较好地适应动态环境的能力,而且还具有很强的避障功能3。文献4提出的 IB-RRT*算法专门为复杂环境设计,在无障碍区域中的采样会增加搜索时间。文献5提出的 HDCS-RRT*算法会根据障碍物和新节点生成的位置重新调整新节点的坐标,并随着约束采样区域的动态变化,快速收敛到目标。文献6提出的改进的 RRT-Connect 算法以动态步长
11、生成新节点,设置转角约束,并考虑祖代点的重选父节点,优化了路径质量,但未考虑局部动态避障。文献7根据碰撞检测失败的次数自适应改变采样概率,调整目标偏置采样和自由采样的概率,加快了经过障碍物和到达目标点的时间。文献8在改进的 RRT*算法中引入拓扑节点进行采样,并利用自适应阈值去除冗余节点,设计了节点扩充策略和逐级优化,提高了算法效率。文献910将人工势场法引入了改进的 RRT*采样算法中,减小了迭代次数,但是会遇到陷入局部极小值的问题。文献11设计了安全 A*算法和动态窗口法的融合算法,根据融合子函数改进评价函数,解决了陷入局部最优的问题。文献12提出了基于改进 Informed-RRT*和动
12、态窗口法结合的自主导航算法,引入了贪婪算法,并将潜在最优父节点的搜索对象替换为具有路径的构造节点树,在路径优化过程中,减少了搜索最优父节点的时间。文献13设计了基于 ROS 虚实结合的移动机器人路径规划实验平台,以 Turtlebot2 为实验对象开展了算法的仿真和实验,为实践教学提供了支撑。针对以上研究内容,本文提出了改进 VSRB-RRT算法解决全局规划问题。该算法采用可变采样区域和目标偏置相结合的策略,以与障碍物发生碰撞的新节点为中心来约束采样区域。该算法只有在获得不可用节点时才会调整采样区域,从而加快收敛速度和采样效率,并更快地生成无碰撞的路径。同时,通过贪婪优化、迭代优化和关键点优化
13、生成代价低且光滑可执行的路径。为解决局部规划问题,选取全局算法过程中迭代优化得到的渐进最优路径的关键点,使用改进的 DWA 算法在关键点的分段路径上进行分段规划,实现移动机器人在多障碍物环境中的实时避障。1 改进 VSRB-RRT 算法 改进 VSRB-RRT 算法是一个全局规划算法。首先,在双向搜索过程中采用可变采样区域的目标偏置策略高效获得初始路径;然后,使用 3 个优化策略提升路径质量,其中贪婪优化可简化路径点,减少路径代价,迭代优化策略可通过合适的迭代次数使路径更接近障碍物,进一步优化路径;最后,使用关键点优化策略平滑前两步优化后的路径,得到一条无碰撞、高质量且符合运动要求的轨迹。1.
14、1 可变采样区域的目标偏置采样 在使用双向 RRT 算法规划路径时,分别以起点和终点作为初始点扩展出两棵树,这两棵树向各自的扩展方向生长,直到两棵树中的某两个节点的距离小于某个阈值,此时说明两棵树可以进行连接。如图 1 所示,红色节点为起点,绿色节点为终点,树 1 是从起点开始生长,树 2 是从终点开始生长,紫色箭头和紫色虚线表示树 1 下一步将要朝终点扩展的方向,蓝色箭头和紫色虚线表示树 2 下一步将要朝起点扩展的方向,树 1 中节点19q与树 2 中节点22q的距离小于设定阈值,绿色路径为两棵树连接的桥梁。树 1 与树 2 均以彼此的起点为目标进行生长,因此会出现无效节点较多和搜索时间较长
15、的问题。图 1 双向 RRT 算法扩展采样示意图 针对上述问题,本文提出了改进 VSRB-RRT 算法。首先,结合双向 RRT 算法和 RRT-Connect 算法改进了树的扩展方式。如图 2 所示,红色节点为起点,绿色节点为终点,由起点扩展的树 1 总是以终点为目标,而由终点扩展的树 2 则将树 1 最近添加的节点看作目标,紫色箭头和紫色虚线表示树 1 中节点朝终点扩展的方向,蓝色箭头和紫色虚线表示树 2 中节点朝树 1 最近添加节点扩展的方向,这样使扩展更具有方向性,既减少了多余节点的扩展又提高了搜索效率。树1中节点16q与树2中节点26q的距离小于设定阈值,绿色路径为两棵树连接的桥梁。然
16、后,在采样过程中,提出了可变采样区域的目标偏置策略,当获得的新节点由于障碍物阻塞而不可用时,改进算法将采样区域限制为以该新节点为中心的区域,而不是整个地图。传统 RRT 算法的采样方式通过狭窄通道的概率非常小,改进 VSRB-RRT 算法的采样显著增加了将新节点放置在采样区域内狭窄通道上的概率,从而减少采样过程的无效执行和计算时间。将调整采样区域的方法174 实 验 技 术 与 管 理 与目标偏置采样方法相结合,进一步减少了计算时间和路径长度。图 2 改进 VSRB-RRT 算法扩展采样示意图 1.2 贪婪优化 改进 VSRB-RRT 算法得到的初始路径存在锯齿形和路径冗长的问题,因此本文采用
17、贪婪优化策略简化路径上不必要的节点来平滑锯齿形部分,从而减小路径代价。图 3 为贪婪优化策略的示意图,红色节点为起点,绿色节点为终点,改进 VSRB-RRT 算法得到的初始无碰撞路径为紫色路径。贪婪优化策略将起点与最后一个节点(即目标点)连接,并判断该路径是否经过障碍物,如果未经过障碍物,直接连接起点与终点,获得初始路径。否则,从最后一个点开始依次逆向连接起点并逐个进行无碰撞检测,直至找到16q与起点的路径无碰撞为止,并连接这两点,同时将找到的节点作为新的起点,按照上述流程可得到优化后的路径(图 3 中的红色路径)。图 3 greedy-VSRB-RRT 示意图 1.3 迭代优化 经过贪婪优化
18、后轨迹会相对缩短。若是路径冗长,则会产生很多拐角,路径无法达到最优,此时需要进一步优化,故本文提出了迭代优化的方法。经过贪婪优化后的路径点集合为OPnQ,经过迭代优化后的路径点集合为FOPnQ,其中OPOPOPOP12,nnQqqq=和FOPmQ=FOPFOPFOP12,mqqq,根据路径的长度获取两个随机值1、2,确定其迭代插值的位置,即确定 i 和j的值,然后对1和2之间的路径进行碰撞检测,如无碰撞,则将随机产生的值迭代插入FOPiq和FOP1jq+之间的位置,新的路径点的集合则变为 FOPFOPFOPFOPFOP1121,mijmQqqqq+=(1)式中,m 为迭代优化后路径点个数;i
19、为插入随机点1前路径点的位置序号;j+1 为插入随机点2后路径点的位置序号。重复上面的过程,直到达到设定的最大迭代次数,此时可删除路径冗长的部分,将全局更短的点添加到路径中。考虑到路径代价,迭代次数越高,优化效果越好。1.4 关键点平滑优化 经过贪婪优化和迭代优化后的轨迹不符合机器人的运动规则,需要使用三次样条曲线优化轨迹。首先将区间进行分段,在每个小区间的曲线都是一个三次方程,由l个关键点分段的三阶多项式构成的样条就是三次样条14。在区间1,kkh h+上的三次多项式可表示为 23()()()()kkkkkkkkShab hhchhdhh=+-+-+-(2)1,0,1,1kkkzhhkl+=
20、-=-(3)式中,ka为常数项系数;kb为一次项系数;kc为二次项系数;kd为三次项系数;kz为1kh+与kh之间的距离大小;l为关键点个数。式(2)满足的约束条件为:在每个区间1(),()kkkh hS hSh+=;插值条件为,()(kkShak=0,1,1)l-;二 阶 连 续 可 微,1()()kkShSh+=且()kSh=1,(0,1(1),)kShkl+=-;00S=且10lS-=。根据上面满足的约束条件可求未知系数,得到l个关键点的三次样条曲线,在这个过程中生成的样条曲线可能会与障碍物发生碰撞。如果发生碰撞,在最接近碰撞点的关键点和上一个关键点之间插入新的关键点,避开障碍物。用关键
21、点平滑优化可优化路径的拐角,提高路径的可控性,并生成满足机器人运动约束的轨迹。2 改进 DWA 算法 动态窗口法是机器人在满足约束条件的前提下,计算一个有效的速度搜索空间的方法,根据该空间模拟一段时间的轨迹,确保能够在环境中持续移动,接着根据评估结果选择最优的速度指令,生成一个安全无碰撞的轨迹。2.1 动态窗口法的运动学模型 由于动态窗口法使用的是瞬时速度,两个相邻时刻的轨迹可以看作一条直线,因此相邻时间t的姿态状态可表示为 cossinttxv tyv t=(4)由此得到机器人的运动轨迹为 倪建云,等:基于改进 VSRB-RRT 算法的机器人路径规划仿真实验 175 111cossinttt
22、tttttxxv tyyv tt+=+=+=+|(5)式中,xt为机器人在 t 时刻的横坐标;yt为机器人在t 时刻的纵坐标;v为机器人的线速度;为机器人的角速度;t为机器人在t时间内的偏转角。2.2 速度采样 使用动态窗口法计算机器人运动的速度,但机器人的速度受到以下约束限制:(1)机器人自身最大和最小速度的限制。(2)电机性能的限制。(3)环境因素对速度产生的限制。速度采样空间sV可表示为 sMDAVVVV=(6)式中,MV为机器人在最大和最小速度限制下的速度空间;DV为在电机性能限制下的速度空间;AV为在环境因素限制下的速度空间15。2.3 改进评价函数 动态窗口法可获得多组避障速度,因
23、此需要相应的评价函数评估轨迹,并选择最优的轨迹引导机器人动态避开障碍物。轨迹的评价函数可表示为(,)head(,)dist(,)vel(,)G vvvv=+(7)式中,head(,)v为机器人以当前速度到达位置与目标姿态的角度差;dist(,)v为移动机器人目前位置与最近障碍物的距离;vel(,)v为当前机器人的线速度,确保机器人以合理的速度移动;、分别为 3个子函数的加权系数;为平滑函数;v为机器人的线速度;为机器人的角速度。根据障碍物半径R和移动机器人与障碍物的距离,调整评价函数各个量的比例,实现评价指标的动态调节。具体而言,当移动机器人从起点开始运动时,增大方向的比例,实现快速收敛到目标
- 配套讲稿:
如PPT文件的首页显示word图标,表示该PPT已包含配套word讲稿。双击word图标可打开word文档。
- 特殊限制:
部分文档作品中含有的国旗、国徽等图片,仅作为作品整体效果示例展示,禁止商用。设计者仅对作品中独创性部分享有著作权。
- 关 键 词:
- 基于 改进 VSRB RRT 算法 机器人 路径 规划 仿真 实验 倪建云
1、咨信平台为文档C2C交易模式,即用户上传的文档直接被用户下载,收益归上传人(含作者)所有;本站仅是提供信息存储空间和展示预览,仅对用户上传内容的表现方式做保护处理,对上载内容不做任何修改或编辑。所展示的作品文档包括内容和图片全部来源于网络用户和作者上传投稿,我们不确定上传用户享有完全著作权,根据《信息网络传播权保护条例》,如果侵犯了您的版权、权益或隐私,请联系我们,核实后会尽快下架及时删除,并可随时和客服了解处理情况,尊重保护知识产权我们共同努力。
2、文档的总页数、文档格式和文档大小以系统显示为准(内容中显示的页数不一定正确),网站客服只以系统显示的页数、文件格式、文档大小作为仲裁依据,个别因单元格分列造成显示页码不一将协商解决,平台无法对文档的真实性、完整性、权威性、准确性、专业性及其观点立场做任何保证或承诺,下载前须认真查看,确认无误后再购买,务必慎重购买;若有违法违纪将进行移交司法处理,若涉侵权平台将进行基本处罚并下架。
3、本站所有内容均由用户上传,付费前请自行鉴别,如您付费,意味着您已接受本站规则且自行承担风险,本站不进行额外附加服务,虚拟产品一经售出概不退款(未进行购买下载可退充值款),文档一经付费(服务费)、不意味着购买了该文档的版权,仅供个人/单位学习、研究之用,不得用于商业用途,未经授权,严禁复制、发行、汇编、翻译或者网络传播等,侵权必究。
4、如你看到网页展示的文档有www.zixin.com.cn水印,是因预览和防盗链等技术需要对页面进行转换压缩成图而已,我们并不对上传的文档进行任何编辑或修改,文档下载后都不会有水印标识(原文档上传前个别存留的除外),下载后原文更清晰;试题试卷类文档,如果标题没有明确说明有答案则都视为没有答案,请知晓;PPT和DOC文档可被视为“模板”,允许上传人保留章节、目录结构的情况下删减部份的内容;PDF文档不管是原文档转换或图片扫描而得,本站不作要求视为允许,下载前自行私信或留言给上传者【自信****多点】。
5、本文档所展示的图片、画像、字体、音乐的版权可能需版权方额外授权,请谨慎使用;网站提供的党政主题相关内容(国旗、国徽、党徽--等)目的在于配合国家政策宣传,仅限个人学习分享使用,禁止用于任何广告和商用目的。
6、文档遇到问题,请及时私信或留言给本站上传会员【自信****多点】,需本站解决可联系【 微信客服】、【 QQ客服】,若有其他问题请点击或扫码反馈【 服务填表】;文档侵犯商业秘密、侵犯著作权、侵犯人身权等,请点击“【 版权申诉】”(推荐),意见反馈和侵权处理邮箱:1219186828@qq.com;也可以拔打客服电话:4008-655-100;投诉/维权电话:4009-655-100。