一种料框与夹具快速碰撞检测的方法技术

本发明专利技术提供一种料框与夹具快速碰撞检测的方法，包括以下步骤：S1：建立夹具与料框的模型；S2：根据模型建立坐标系，并进行坐标系统一；S3：进行底面碰撞检测；若未发生碰撞，则执行步骤S4；若发生碰撞，则执行步骤S7；S4：将三维碰撞检测问题转化为二维碰撞检测问题；S5：将二维碰撞检测问题转化为一维碰撞检测问题；S6：检测料框侧面与夹具的碰撞情况；S7：完成料框与夹具快速碰撞检测。本发明专利技术提供一种料框与夹具快速碰撞检测的方法，通过统一坐标系，并将三维碰撞问题简化为一维碰撞问题，提高了碰撞检测效率，达到了准实时的效果，解决了现有的碰撞检测方法的实时性不够高的问题。

【技术实现步骤摘要】
一种料框与夹具快速碰撞检测的方法
本专利技术涉及碰撞检测
，更具体的，涉及一种料框与夹具快速碰撞检测的方法。
技术介绍
在立体抓取中，机械臂的抓取姿态不唯一，且不同工件的抓取位置和姿态都不一样，首先需要对抓取姿态的机械臂末端与料框的碰撞问题进行检测；由于视觉单次识别工件的数量较多，每个工件的抓取姿态也有多种，需要对每个工件的每个抓取姿态都进行一次碰撞检测，但是在工业现场存在生产节拍的时间限制，所以对碰撞检测方法的实时性要求很高，需达到准实时。现有技术中，进行碰撞检测的方法的实时性都不够高，无法达到准实时，如冲压线搬运机器人防碰撞控制方法，公开号为CN104850699B，采用AABB包络模型进行分析，并在此基础上进行碰撞检测，但碰撞检测的实时性不够高，无法达到准实时。
技术实现思路
本专利技术为克服现有的碰撞检测方法的实时性不够高的技术缺陷，提供一种料框与夹具快速碰撞检测的方法。为解决上述技术问题，本专利技术的技术方案如下：一种料框与夹具快速碰撞检测的方法，包括以下步骤：S1：建立夹具与料框的模型；S2：根据模型建立坐标系，并进行坐标系统一；S3：进行底面碰撞检测；若未发生碰撞，则执行步骤S4；若发生碰撞，则执行步骤S7；S4：将三维碰撞检测问题转化为二维碰撞检测问题；S5：将二维碰撞检测问题转化为一维碰撞检测问题；S6：检测料框侧面与夹具的碰撞情况；S7：完成料框与夹具快速碰撞检测。r>上述方案中，通过统一坐标系解决实际生产过程中料框的位置变化和旋转的问题，保证检测精度；同时，将三维碰撞问题简化为一维碰撞问题，提高了碰撞检测效率，达到了准实时的效果。优选的，在步骤S1中，采用长方体包络面的方式对夹具进行建模，将夹具建模为一个长方体包络面；按料框每个面的实际大小对料框进行建模，将料框建模为由四个长方体面和一个底面围成的区域。上述方案中，由于工业现场的夹具种类较多且形状各异，采用长方体包络面的方式对夹具进行建模，既可以简化碰撞检测算法又可以为碰撞检测留有一定的安全距离；按料框的实际大小对料框进行建模，包括料框的长度、宽度、高度和厚度，其中根据料框底面的长度和宽度对料框底面进行建模，根据料框侧面的长度、高度和厚度对料框侧面进行建模，从而将料框建模为由四个长方体面和一个底面围成的区域。优选的，在步骤S2中，建立的坐标系包括机器人基坐标系O0，夹具坐标系O1和料框坐标系O2；其中，料框坐标系的原点建立在料框模型底面的一个顶点上，且其坐标轴沿着料框模型的棱。上述方案中，机器人基坐标系由机器人本身决定；夹具坐标系以夹具模型底面的几何中心为原点，以夹具模型底面向外为Z轴，以夹具开合方向为X轴，以右手定则决定Y轴。优选的，在步骤S2中，进行坐标系统一具体包括以下步骤：S2.1：获取夹具坐标系到机器人基坐标系的转化矩阵0T1；S2.2：获取料框坐标系到机器人基坐标系的转化矩阵0T2；S2.3：通过0T1和0T2计算得到夹具坐标系到料框坐标系的转化矩阵；S2.4：通过转化矩阵2T1将夹具模型的八个顶点坐标统一到料框坐标系下。上述方案中，夹具相对于机器人基坐标系的位姿可以由机器人控制器实时获得，从而得到转化矩阵0T1；通过转化矩阵2T1可以将任意位姿的夹具模型的坐标投影到料框坐标系下，解决实际生产过程中料框的位置变化和旋转的问题，保证检测精度。优选的，在步骤S2.2中，具体包括以下步骤：S2.2.1：设初始时料框模型沿料框坐标系的X轴方向的顶点坐标为P（x，y，z），料框模型沿料框坐标系的X轴方向的长度为Length；通过测量实时获取顶点坐标P（x1，y1，z1）和料框坐标系的原点相对于机械人基坐标系的平移量（x0，y0，z0）；S2.2.2：通过计算得到料框模型沿料框坐标系的Z轴的旋转角度，计算公式为：S2.2.3：根据平移量和旋转角度得到0T2。上述方案中，通过顶点坐标P的x坐标变化值计算出旋转角度，然后将平移量和旋转角度带入标准的转化矩阵从而得到料框坐标系到机械人坐标系的转化矩阵。优选的，在步骤S3中，通过判断夹具模型的八个顶点在料框坐标系下的最小z坐标是否大于0，若大于0则认为夹具未与料框底面发生碰撞；否则认为夹具与料框底面发生碰撞。上述方案中，先通过z坐标判断夹具与料框底面是否发生碰撞，如果未发生碰撞，则进一步判断夹具与料框侧面是否发生碰撞，从而判断出夹具与料框是否发生碰撞。优选的，在步骤S4中，通过投影的方式，将三维碰撞检测问题转化为二维平面的矩形投影面与棱投影线段的碰撞检测问题，具体包括以下步骤：S4.1：分别沿料框坐标系的XO2Z平面和YO2Z平面对料框模型的四个侧面进行投影，从而在XO2Z平面和YO2Z平面分别得到四个矩形投影面；S4.2：分别沿料框坐标系的XO2Z平面和YO2Z平面对夹具模型的底面和侧面的棱进行投影，从而在XO2Z平面和YO2Z平面分别得到八条棱投影线段。上述方案中，由于料框模型的四个侧面具有厚度，所以能够在XO2Z平面和YO2Z平面分别得到四个矩形投影面。若夹具模型与料框模型发生碰撞，则一定有夹具模型的棱与料框模型的侧面接触；所以分别判断矩形投影面与棱投影线段的碰撞情况，就可以对夹具与料框的碰撞进行检测，实现将三维碰撞检测问题转化为二维碰撞检测问题。优选的，在步骤S5中，将二维碰撞检测问题转化为一维碰撞检测问题具体包括以下步骤：S5.1：将矩形投影面投影到其所在平面的X轴或Y轴上，得到面投影线段；S5.2：根据矩形投影面对处于同一平面的棱投影线段进行处理后投影到该平面的X轴或Y轴上，得到线投影线段。上述方案中，通过比较面投影线段和线投影线段是否有重合部分，就可以确定矩形投影面与棱投影线段是否有交点，实现将二维碰撞检测问题转化为一维碰撞检测问题。优选的，对棱投影线段进行处理具体包括以下步骤：S5.2.1：设棱投影线段为BC，过BC作直线L；其中，B点的Z轴坐标大于C点的Z轴坐标；S5.2.2：针对在XO2Z平面的矩形投影面，离X轴较远的边作延长线与直线L交于A点；针对在YO2Z平面的矩形投影面，离Y轴较远的边作延长线与直线L交于A点；S5.2.3：针对在XO2Z平面的矩形投影面，离X轴较近的边作延长线与直线L交于D点；针对在YO2Z平面的矩形投影面，离Y轴较近的边作延长线与直线L交于D点；S5.2.4：在A点和B点中取Z轴坐标较小的点作为处理后的线段的一端端点，在C点和D点中取Z轴坐标较大的点作为处理后的线段的另一端端点，完成对棱投影线段进行处理。优选的，在步骤S6中，分别在XO2Z平面和YO2Z平面中，将面投影线段与线投影线段进行重合检测；若至少有一条夹具模型的棱的线投影线段与一个料框模型的侧面的面投影线段在XO2Z平面和YO2Z平面中均本文档来自技高网...

【技术保护点】
1.一种料框与夹具快速碰撞检测的方法，其特征在于，包括以下步骤：/nS1：建立夹具与料框的模型；/nS2：根据模型建立坐标系，并进行坐标系统一；/nS3：进行底面碰撞检测；/n若未发生碰撞，则执行步骤S4；/n若发生碰撞，则执行步骤S7；/nS4：将三维碰撞检测问题转化为二维碰撞检测问题；/nS5：将二维碰撞检测问题转化为一维碰撞检测问题；/nS6：检测料框侧面与夹具的碰撞情况；/nS7：完成料框与夹具快速碰撞检测。/n

【技术特征摘要】
1.一种料框与夹具快速碰撞检测的方法，其特征在于，包括以下步骤：
S1：建立夹具与料框的模型；
S2：根据模型建立坐标系，并进行坐标系统一；
S3：进行底面碰撞检测；
若未发生碰撞，则执行步骤S4；
若发生碰撞，则执行步骤S7；
S4：将三维碰撞检测问题转化为二维碰撞检测问题；
S5：将二维碰撞检测问题转化为一维碰撞检测问题；
S6：检测料框侧面与夹具的碰撞情况；
S7：完成料框与夹具快速碰撞检测。


2.根据权利要求1所述的一种料框与夹具快速碰撞检测的方法，其特征在于，在步骤S1中，采用长方体包络面的方式对夹具进行建模，将夹具建模为一个长方体包络面；按料框每个面的实际大小对料框进行建模，将料框建模为由四个长方体面和一个底面围成的区域。


3.根据权利要求2所述的一种料框与夹具快速碰撞检测的方法，其特征在于，在步骤S2中，建立的坐标系包括机器人基坐标系O0，夹具坐标系O1和料框坐标系O2；其中，料框坐标系的原点建立在料框模型底面的一个顶点上，且其坐标轴沿着料框模型的棱。


4.根据权利要求3所述的一种料框与夹具快速碰撞检测的方法，其特征在于，在步骤S2中，进行坐标系统一具体包括以下步骤：
S2.1：获取夹具坐标系到机器人基坐标系的转化矩阵0T1；
S2.2：获取料框坐标系到机器人基坐标系的转化矩阵0T2；
S2.3：通过0T1和0T2计算得到夹具坐标系到料框坐标系的转化矩阵；
S2.4：通过转化矩阵2T1将夹具模型的八个顶点坐标统一到料框坐标系下。


5.根据权利要求4所述的一种料框与夹具快速碰撞检测的方法，其特征在于，在步骤S2.2中，具体包括以下步骤：
S2.2.1：设初始时料框模型沿料框坐标系的X轴方向的顶点坐标为P（x，y，z），料框模型沿料框坐标系的X轴方向的长度为Length；通过测量实时获取顶点坐标P（x1，y1，z1）和料框坐标系的原点相对于机械人基坐标系的平移量（x0，y0，z0）；
S2.2.2：通过计算得到料框模型沿料框坐标系的Z轴的旋转角度，计算公式为：



S2.2.3：根据平移量和旋转角度得到0T2。


6.根据权利要求4所述的一种料框与夹具快速碰撞检测的方法，其特征在于，在步骤S3中，通过判断夹具模型的八个顶点在料...

【专利技术属性】
技术研发人员：候金良，盛国强，汪良红，王辉，王雪峰，
申请(专利权)人：佛山隆深机器人有限公司，
类型：发明
国别省市：广东;44