基于包围盒算法的高精度机械臂碰撞检测方法

摘要

本发明公开了一种基于包围盒算法的高精度机械臂碰撞检测方法，首先对机械臂自身进行碰撞测试，在无互相接触时，对所述机械臂和工件进行建模以及模型简化，并根据得到的机械臂和工件的包围盒进行相交测试，当包围盒相交时，获取所述机械臂和工件的包围盒相交的两个交点和所述交点形成的矩形重叠区域，并在所述矩形重叠区域内连接所述交点，计算得到线段解，并当所述线段解无效时，根据获取的参考边进行工件识别并确定旋转射线，基于不同的工件的几何形状，判断所述旋转射线与所述线段解是否发生接触，进而进行所述旋转射线的合并和迭代，得到多超平面解，完成所述机械臂和所述工件的相交包围盒的分离，提高检测精度，降低检测误差。