关键词:
采摘机械臂
路径规划
改进RRT算法
改进人工势场法
算法融合与切换
摘要:
针对苹果采摘任务中因自然环境复杂造成的机械臂路径规划时间长、效率低、成功率低等问题,提出一种改进的融合切换路径动态规划算法。该算法以RRT算法为基础,引入动态阈值的目标偏置采样策略与人工势场法,通过引力场与斥力场改变新节点的生成位置,增加采样的目的性并提高收敛速度;在斥力势场系数中引入相对距离,通过与目标点之间的距离来克服目标不可达的问题;为增强算法的鲁棒性,设定阈值划分区域空间,根据当前节点所在位置动态切换至FGA-RRT(Failure-guided adaptive sampling region RRT algorithm)算法搜索,解决狭窄通道的问题,提高规划成功率;基于贪心算法对所得路径树进行优化处理,去除冗余节点,进一步缩短路径长度并优化路径平滑度,保证采摘机械臂运动的平稳性。分别对RRT算法、RRT*算法、GB-RRT算法、普通融合算法和改进的融合切换算法,在简单障碍、狭窄通道、复杂障碍以及简单三维空间等不同环境中进行仿真分析,结果表明:改进的融合切换算法在不同环境中都具有良好的适应性,规划效率高,迭代次数少,路径质量高。基于林间苹果园生长环境,搭建6自由度机械臂仿真实验室环境,进行避障采摘路径规划试验,改进的融合切换算法采摘效率比RRT算法提升74.74%,路径长度减少32.03%,采摘成功率提高8个百分点。试验结果表明本文算法在多变的苹果采摘场景中有更强的搜索能力。