基于碰撞检测的空间冗余机械臂避障路径规划

摘要

针对障碍环境中自由漂浮模式空间冗余机械臂的路径规划问题进行了研究。首先基于球形包围盒和空间叠加思想简化描述障碍物和机械臂的空间占位关系,采用直线段与球体之间相对位置关系判断是否碰撞的检测方法。然后从正向运动学出发,运用关节参数化方法,把路径规划问题变为带约束的参数优化问题,并考虑基座姿态扰动最小以及碰撞规避建立多项加权的目标函数,通过粒子群优化算法求解最优解,得到机械臂关节运动轨迹。最后以七自由度空间冗余机械臂为例进行仿真,结果表明该方法可以实现有效避障,同时基座姿态受扰很小,关节运动轨迹平滑,且机械臂末端也能够以较高精度达到期望位姿。