机器人折弯放料位姿的校正方法及其装置制造方法及图纸

本发明专利技术公开了机器人折弯放料位姿的校正方法，包括：a、接收机器人处于标准折弯放料点时的待折弯板材位置数据；b、确定机器人处在标准折弯放料点时校正坐标系B相对于机器人工作坐标系A的坐标变换矩阵；c、接收机器人处于实际折弯放料点时的待折弯板材位置数据；d、确定机器人处于实际折弯放料点的校正坐标系B’相对于校正坐标系B的坐标变换矩阵；e、获取机器人处于实际折弯放料点时的位姿矩阵；f、对位姿矩阵进行校正；g、重复上述步骤c至f，直至接收的机器人处于实际折弯放料点时的待折弯板材位置数据与标准折弯放料点时的待折弯板材位置数据一致。本发明专利技术还公开了机器人折弯放料位姿的校正装置。本发明专利技术可提高机器人折弯质量。

【技术实现步骤摘要】
机器人折弯放料位姿的校正方法及其装置
本专利技术涉及机器人的折弯放料位姿的校正方法及其装置。
技术介绍
随着劳动力成本的不断上升，工业机器人应用于折弯领域越来越普及。在大板件 折弯应用中，机器人的精准度使得其表现出很大的优势。目前，机器人折弯的难点主要在 于，在折弯开始前，由于机器人的实际折弯放料点与标准折弯放料点之间存在偏差，导致待 折弯板材的挡料边没有紧靠折弯机上的第一挡块和第二挡块，折弯边没有平行于刀槽口， 此时直接折弯会导致折弯的折痕有偏差，影响折弯板件质量。
技术实现思路
本专利技术所要解决的技术问题在于提供一种机器人折弯放料位姿的校正方法，其能 对机器人的实际折弯放料点的位姿进行校正，使其与机器人的标准折弯放料点一致，从而 提高机器人折弯的质量。 本专利技术所要解决的进一步的技术问题在于提供一种机器人折弯放料位姿的校正 装直。 本专利技术所采用的技术方案是：一种机器人折弯放料位姿的校正方法，包括以下步 骤： 步骤a、接收位置检测装置检测到的机器人处于标准折弯放料点时的待折弯板材 位置数据；其中，机器人处于标准折弯放料点时，待折弯板材与折弯机上的第一挡块及第二 挡块相对的一面紧靠该第一挡块和第二挡块； 步骤b、确定机器人处在标准折弯放料点时校正坐标系B相对于机器人工作坐标 系a的坐标变换矩阵|所述的校正坐标系B以折弯机刀槽口部的纵向中心线的延伸方向 作为Y轴方向，以折弯刀的移动方向作为Z轴方向，X轴方向与Y轴方向和Z轴方向满足右 手法则，校正坐标系B的原点为所述待折弯板材与折弯机上的第一挡块及第二挡块相对的 一面上的任意一点； 步骤c、接收位置检测装置检测到的机器人处于实际折弯放料点时的待折弯板材 位置数据； 步骤d、根据接收的机器人处于标准折弯放料点和实际折弯放料点时的位置数据， 确定机器人处于实际折弯放料点时的校正坐标系B'相对于机器人处于标准折弯放料点时 的校正坐标系b的坐标变换矩阵;r;机器人处于实际折弯放料点的校正坐标系B'是通过 将校正坐标系B沿X轴方向移动和Z轴方向旋转得到； 步骤e、获取机器人处于实际折弯放料点时的位姿矩阵,!r: 步骤f、对该位姿矩阵，进行校正，校正后的位姿矩阵为ir， Arp-Annf ,4rj^ = ) pi m * 步骤g、重复上述的步骤c至步骤f，直至接收的位置检测装置检测到的机器人处 于实际折弯放料点时的待折弯板材位置数据与机器人处于标准折弯放料点时的待折弯板 材位置数据一致。 本专利技术还公开了一种机器人折弯放料位姿的校正装置，包括： 接收单元，用于接收位置检测装置检测到的机器人处于标准折弯放料点和实际放 料点时的待折弯板材位置数据；其中，机器人处于标准折弯放料点时，待折弯板材与折弯机 上的第一挡块及第二挡块相对的一面紧靠该第一挡块和第二挡块；； 校正坐标系与工作坐标系变换关系确定单元，用于确定机器人处在标准折弯放料 点时校正坐标系B相对于机器人工作坐标系A的坐标变换矩阵ir;所述的校正坐标系B以 折弯机刀槽口部的纵向中心线的延伸方向作为Y轴方向，以折弯刀的移动方向作为Z轴方 向，X轴方向与Y轴方向和Z轴方向满足右手法则，校正坐标系B的原点为所述待折弯板材 与折弯机上的第一挡块及第二挡块相对的一面上的任意一点； 校正坐标系变换关系确定单元，用于根据所述接收单元接收的机器人处于标准折 弯放料点和实际折弯放料点时的位置数据，确定机器人处于实际折弯放料点时的校正坐标 系B'相对于机器人处于标准折弯放料点时的校正坐标系B的坐标变换矩阵机器人处 于实际折弯放料点的校正坐标系B'是通过将校正坐标系B沿Y轴方向移动和Z轴方向旋 转得到； 位姿矩阵获取单元，用于获取机器人处于实际折弯放料点时的位姿矩阵 校正单元，用于对位姿矩阵获取单元获取的位姿矩阵pat进行校正，校正后的位 姿矩阵戈本文档来自技高网...

【技术保护点】
一种机器人折弯放料位姿的校正方法，其特征在于，包括以下步骤：步骤a、接收位置检测装置检测到的机器人处于标准折弯放料点时的待折弯板材位置数据；其中，机器人处于标准折弯放料点时，所述待折弯板材与折弯机上的第一挡块及第二挡块相对的一面紧靠该第一挡块和第二挡块；步骤b、确定机器人处在标准折弯放料点时校正坐标系B相对于机器人工作坐标系A的坐标变换矩阵所述的校正坐标系B以折弯机刀槽口部的纵向中心线的延伸方向作为Y轴方向，以折弯刀的移动方向作为Z轴方向，X轴方向与Y轴方向和Z轴方向满足右手法则，校正坐标系B的原点为所述待折弯板材与折弯机上的第一挡块及第二挡块相对的一面上的任意一点；步骤c、接收位置检测装置检测到的机器人处于实际折弯放料点时的待折弯板材位置数据；步骤d、根据接收的机器人处于标准折弯放料点和实际折弯放料点时的位置数据，确定机器人处于实际折弯放料点时的校正坐标系B’相对于机器人处于标准折弯放料点时的校正坐标系B的坐标变换矩阵机器人处于实际折弯放料点的校正坐标系B’是通过将校正坐标系B沿X轴方向移动和Z轴方向旋转得到；步骤e、获取机器人处于实际折弯放料点时的位姿矩阵步骤f、对该位姿矩阵进行校正，校正后的位姿矩阵为TPnA=TBA(TBATB′B)-1TPA;]]>步骤g、重复上述的步骤c至步骤f，直至接收的位置检测装置检测到的机器人处于实际折弯放料点时的待折弯板材位置数据与机器人处于标准折弯放料点时的待折弯板材位置数据一致。...

【技术特征摘要】
1. 一种机器人折弯放料位姿的校正方法，其特征在于，包括以下步骤： 步骤a、接收位置检测装置检测到的机器人处于标准折弯放料点时的待折弯板材位置 数据；其中，机器人处于标准折弯放料点时，所述待折弯板材与折弯机上的第一挡块及第二 挡块相对的一面紧靠该第一挡块和第二挡块； 步骤b、确定机器人处在标准折弯放料点时校正坐标系B相对于机器人工作坐标系A 的坐标变换矩阵?Γ;所述的校正坐标系B以折弯机刀槽口部的纵向中心线的延伸方向作为 Y轴方向，以折弯刀的移动方向作为Z轴方向，X轴方向与Y轴方向和Z轴方向满足右手法 贝1J，校正坐标系B的原点为所述待折弯板材与折弯机上的第一挡块及第二挡块相对的一面 上的任意一点； 步骤c、接收位置检测装置检测到的机器人处于实际折弯放料点时的待折弯板材位置 数据； 步骤d、根据接收的机器人处于标准折弯放料点和实际折弯放料点时的位置数据，确定 机器人处于实际折弯放料点时的校正坐标系B'相对于机器人处于标准折弯放料点时的校 正坐标系B的坐标变换矩阵；机器人处于实际折弯放料点的校正坐标系B'是通过将校 正坐标系B沿X轴方向移动和Z轴方向旋转得到； 步骤e、获取机器人处于实际折弯放料点时的位姿矩阵?Γ: 步骤f、对该位姿矩阵纟Tt进行校正,校正后的位姿矩阵为Lr, 步骤g、重复上述的步骤c至步骤f，直至接收的位置检测装置检测到的机器人处于实 际折弯放料点时的待折弯板材位置数据与机器人处于标准折弯放料点时的待折弯板材位 置数据一致。2. 如权利要求1所述的机器人折弯放料位姿的校正方法，其特征在于，所述的位置检 测装置包括用于对待折弯板材进行实时测距的第一距离测量装置和第二距离测量装置。3. 如权利要求2所述的机器人折弯放料位姿的校正方法，其特征在于，所述的第一距 离测量装置和第二距离测量分别为安装在第一挡块上的第一电子尺和安装在第二挡块上 的第二电子尺。4. 如权利要求2或3所述的机器人折弯放料位姿的校正方法，其特征在于，所述的机器 人工作坐标系A为折弯坐标系，该折弯坐标系以折弯机刀槽口部的纵向中心线的延伸方向 作为Y轴方向，以折弯刀的移动方向作为Z轴方向，X轴方向由Y轴方向和Z轴方向根据右 手法则确定；该折弯坐标系的原点为所述的折弯机刀槽口部的纵向中心线与第一距离测量 装置中心线和第二距离测量装置中心线之间的连线的垂直平分面的交点。5. 如权利要求4所述的机器人折弯放料位姿的校正方法，其特征在于， 该校正坐标系B的原点为所述待折弯板材与折弯机上的第一挡块及第二挡块相对的 一面的底边与第一距离测量装置中心线和第二距离测量装置中心线之间的连线的垂直平 分面的交点。6. -种机器人折弯放料位姿的校正装置，其特征在于，包括： 接收单元，用于接收位置检测装置检测到的机器人处于标准折弯放料点和实际放料点 时的待折...

【专利技术属性】
技术研发人员：周朔鹏，熊圆圆，邓洪洁，乔正，卢晓荣，
申请(专利权)人：上海新时达电气股份有限公司，上海新时达机器人有限公司，
类型：发明
国别省市：上海;31