基于二分试探的平面冗余机械臂碰撞检测与避障

摘要

针对协作机械臂与未知环境安全交互问题,提出基于二分试探的平面冗余机械臂碰撞位置检测与虚拟碰撞空间估计方法,基本思想为碰撞臂杆绕选定二分点旋转微小角位移,期间根据关节电流信息判断是否发生进一步碰撞,从而确定碰撞位置所处二分区间,以此迭代试探缩小碰撞位置估计误差至可接受范围。建立冗余机械臂碰撞臂杆以选定二分点为不动点的逆运动学模型,解决机械臂二分试探运动控制问题;通过简化改进二阶前馈外力观测器,建立基于关节电流的快速碰撞检测算法;根据碰撞位置与碰撞臂杆位姿信息,建立基于包络法的虚拟碰撞空间模型,以近似表征障碍物空间信息。仿真与实验结果表明,所提出的基于二分试探的碰撞位置检测与虚拟碰撞空间估计方法,可为主从任务转化闭环控制避障算法提供有效的障碍物信息,实现平面冗余机械臂安全避障,提高协作机械臂与环境交互安全性。