基于警戒机制的RRT无碰撞双路径规划算法

针对双臂机器人或双机械臂的路径规划问题,提出一种双路径快速扩展随机树(DP-RRT)算法。基于传统的快速扩展随机树(RRT)算法,设计了一种警戒机制,使同时生长的两个随机树能够时刻相互感知,且互为动态障碍来规避彼此;采用交替生长策略改进生长过程,来避免相互间可能出现的无序碰撞、路径交叉和生长抑制等问题,并引入非均匀B样条曲线来平滑路径,以减小机械臂运动产生的冲击。仿真结果表明,与两次应用RRT算法相比,各种环境的规划成功率都有所提升,尤其在10 mm大步长条件下,4种环境的搜索成功率分别提升了10%、31%、65%、84%,平均总路径减少10.8%。总之,DP-RRT算法在搜索成功率,计算时间和路径质量上都比与传统两次应用RRT算法的方案表现得更好。