[发明专利]一种机械臂的碰撞检测方法

权利要求书

1.一种机械臂的碰撞检测方法，其特征在于，包括以下步骤：

S101：建立组件的胶囊体模型；

S102：以胶囊体模型为基础，建立长方体；

S103：根据建立胶囊体模型的方法，建立完整的预测模型；

S104：获取预测模型与碰撞物的三视图；

S105：判断各视图中两种平面是否都相交；

S106、S108：根据各视图两平面是否都相交的判断来确定预判模型与碰撞体是否有交点；

判断成立，认为该组件与碰撞物有碰撞风险，进行步骤S107，机械臂停止；

判断不成立，认为该组件与碰撞物无碰撞风险，进行步骤S109，机械臂继续运行。

2.根据权利要求1所述的一种机械臂的碰撞检测方法，其特征在于，所述步骤S103中的预测模型包括以机械臂组件为基础建立的基础预测模型，和以组件角速度方向、角速度、预判时间为基础建立的预测范围。

3.根据权利要求2所述的一种机械臂的碰撞检测方法，其特征在于，所述步骤S104中获取预测模型与碰撞物的三视图，具体步骤为：

首先设置一个平行于预判模型的中的扇形面的平面为主视图投影平面，其次设置一个平行于处于初始位置的胶囊体的轴线并与主视图平面垂直的侧视图平面，最后设置一个满足与主视图平面和侧视图平面两两垂直的俯视图平面；

将预判模型与碰撞物投影至三个平面，且投影方式皆为平行投影，分别获取这三个视图面上的预判模型与碰撞物的投影。

4.根据权利要求3所述的一种机械臂的碰撞检测方法，其特征在于，所述S106、S108中根据各视图两平面是否都相交的判断来确定预判模型与碰撞体是否有交点，具体包括以下步骤：

S201：选择其中一个未进行相交测试的视图平面；

S202：将预测模型和碰撞体模型投影至此平面上；

S203：判断在目标平面上，碰撞体模型在此平面上的投影图像，并根据判断结果，投影面是圆或胶囊面选择进行S204；

S205：判断是否三视图上的投影都经过了相交检测；

若判断为真，则此流程图结束；若判断为假，则返回步骤S201，再次进入S201及以下流程。

5.根据权利要求4所述的一种机械臂的碰撞检测方法，其特征在于，所述步骤S105中涉及的判断各视图中两种平面是否都相交的具体步骤为：

S301：进行相交测试的预备判断；

S302：判断主视图下模型投影与圆是否相交；

S303：判断主视图下预测模型的投影面与胶囊面是否相交；

S304：判断侧、俯视图下预测模型的投影面与圆是否相交；

S305：判断侧、俯视图下预测模型的投影面与圆是否相交。

6.根据权利要求5所述的一种机械臂的碰撞检测方法，其特征在于，所述S301步骤中的预备判断顺序为：首先判断视图类型，分为主视图、侧视图、俯视图，其次，判断视图下碰撞体碰撞模型的图像类型，分为圆和胶囊面。