[发明专利]一种机器人自动寻找折弯位置的方法

摘要

本发明公开了、一种机器人自动寻找折弯位置的方法，涉及机器人折弯的技术领域,包含以下步骤:步骤1、建立抓手工具坐标系；步骤2、确定后档值用户坐标系；步骤3、机器人抓手平移运动，并检测传感器状态；步骤4、机器人抓手执行旋转运动，并检测传感器状态，从而获取标准折弯位置。本发明实现了机器人自动寻找折弯位置，降低了示教难度，提高了折弯质量，尤其是在电梯行业，电梯门板折弯尺寸相同，但成型尺寸不同，只需要示教一种产品的程序，就能满足不同规格的电梯门板加工，减少了维护成本，提高了生产效率。

主权项

1.一种机器人自动寻找折弯位置的方法，包括以下步骤：步骤1、建立机器人抓手工具坐标系(TX,TY,TZ)，TZ方向为机器人法兰末端的法向量，且正方向为法兰引出方向，TX方向与机器人X方向同向，按照右手法则，确定TY方向，坐标系原点O为法兰中心在TZ方向与抓取工件平面的交点，将机器人TCP由法兰中心平移到新建立的工具坐标系上；步骤2、确定两个后档指各自的用户坐标系(XA，YA,ZA；XB，YB,ZB):其中：X轴与折弯机下模具中心线M平行,Z轴与折弯机上模运动方向平行,且Z轴的正方向与上滑块下行运动方向同向，Y轴与X轴垂直，Y轴的正方向为后挡指指向折弯机下模具方向，后档指的中心线与下模具边缘交点为该后档指用户坐标系的原点O；步骤3、选择一个后档指用户坐标系，计算机器人在该用户坐标系下沿着X方向校正平移矩阵：其中，p_x是机器人在用户坐标系下的平移距离；按照所述校正平移矩阵，进行机器人抓手平移运动，在运动过程中实时获取后档指传感器信息，当检测到其中一个后档指传感器时停止机器人抓手平移运动，记录机器人当前位置姿态；步骤4、判断后档指传感器信息状态，计算机器人抓手在被检测到后挡指传感器信息的后档指的用户坐标系的旋转矩阵，按照校正旋转矩阵，机器人抓手绕被检测到信息的后档指的用户坐标系原点做旋转运动：若同时检测到两个后档指传感器的信息，则此时机器人抓手处于标准折弯位置；若只检测到一个后档指传感器的信息，而未检测到另一个后档指传感器的信息，计算机器人在被检测到后挡指传感器信息的后挡指的用户坐标系的校正旋转矩阵，按照校正旋转矩阵，进行机器人抓手旋转运动，以检测到后档指传感器信息的后档指的用户坐标系原点为中心旋转机器人抓手，直到检测到另外一个传感器时停止机器人抓手旋转运动；此时机器人抓手处于标准折弯位置。