双机械臂碰撞检测算法研究

简介

为保障双机械臂在公共活动空间的安全性,提出了一种准确高效的碰撞检测算法。采用球体和胶囊体包围盒简化机械臂模型,根据包围盒之间的相交情况判断是否发生碰撞。通过二次投影法实现快速检测,将包围盒投影为线段,若投影线段未重叠则包围盒未相交;若投影线段有重叠,则将问题进一步转化为空间点到点、点到线段、线段到线段的最短距离求解。通过仿真软件和实体机械臂实验平台对算法进行了分析,结果说明,该算法检测效率高,可直接植入机械臂控制器程序中,满足安全性需要。