一种工业机器人折弯跟随方法技术

本发明专利技术公开了一种工业机器人折弯跟随方法，涉及工业机器人折弯跟随方法领域。包括以下步骤：根据折弯刀建立用户坐标系；基于用户坐标系获取工业机器人在折弯开始点的位置以及姿态；根据外部传感器反馈的折弯刀位置信息，计算出在一定采样周期内的数据变化量从而得出折弯刀的变化量及速度；通过结合折弯刀参数、折弯机速度以及板材参数计算出机器人在用户坐标系下的实时位置与姿态，在通过用户坐标系这个桥梁，找到折弯刀实时位置与姿态在直角坐标系下的位置与姿态。本发明专利技术解决了人工折弯同步性差、工件质量不稳定、生产效率差以及安全性低等问题。

A Bending Following Method for Industrial Robots

The invention discloses a bending following method for industrial robots, which relates to the field of bending following method for industrial robots. It includes the following steps: establishing user coordinate system according to the bending tool; obtaining the position and posture of industrial robot at the beginning of bending based on user coordinate system; calculating the change of data in a certain sampling period according to the position information of the bending tool feedback from external sensors, so as to get the change and speed of the bending tool; combining the parameters of the bending tool, the speed of the bending machine and the plate. Material parameters are used to calculate the real-time position and attitude of the robot in the user coordinate system. Through the bridge in the user coordinate system, the real-time position and attitude of the bending tool in the rectangular coordinate system are found. The invention solves the problems of poor synchronization of manual bending, unstable quality of workpiece, poor production efficiency and low safety.

【技术实现步骤摘要】
一种工业机器人折弯跟随方法
本专利技术涉及机器人折弯跟随方法领域，特别涉及一种工业机器人折弯跟随方法。
技术介绍
随着折弯件在工程机械产品上的广泛应用，为满足其产品质量和生产需要，其质量标准也逐渐提高。数控折弯机在冷态下可利用所配备的通用模具(或专用模具)将金属板材折弯或者各种所需要的几何截面形状的工件，折弯工艺的合理性直接影响到产品最终成型尺寸和外观。而目前大部分为人工配合折弯机进行工件加工，但是现在人工配合折弯机折弯板材存在几个问题：1、板材较大，人托举板材跟随折弯机折弯板材，速度不能保证，同步性信不好。2、人托举板材接触面较小，板材折弯过程中处于变形状态，折弯质量一致性不好，不能保证。3、折弯属于重复性劳动，生产过程中容易让人产生疲劳。从而带来安全隐患。4、生产效率不高。
技术实现思路
本专利技术的目的在于：提供了一种工业机器人折弯跟随方法，解决了人工折弯同步性差、工件质量不稳定、生产效率差以及安全性低等问题。本专利技术采用的技术方案如下：本专利技术一种工业机器人折弯跟随方法，包括以下步骤：步骤A：建立用户坐标系：A1：以折弯刀刀尖边缘所在轴线上一点为用户坐标原点ORG；A2：以折弯刀刀尖边缘所在轴线方向为用户坐标YY方向；A3：以折弯刀移动方向为用户坐标XX方向；A4：基于右手法则确定Z轴方向；A5：建立用户坐标原点时折弯刀刀尖边缘与折弯槽底部距离为D；A6：基于用户坐标系获得机器人折弯开始点在用户坐标系下的位置P0(X0，Y0，Z0)和姿态Q0(N0，O0，M0)；步骤B:在折弯刀上设置光栅，采集周期△t内的反馈数据△P，得出折弯刀在周期△t内的速度V，其中步骤C：根据机器人在折弯开始点相对折弯板的姿态，通过折弯刀上光栅采集的数据，得出机器人每个时刻t的位置Pt(Xt，Yt，Zt)和姿态Qt(Nt，Ot，Mt)；步骤D：采集折弯刀的宽度D；步骤E：采集折弯刀初始状态下V槽的最大间距B；步骤F：采集折弯刀初始状态下V槽的锐角角度β；步骤G：计算折弯刀与折弯板V槽接触位置倒角圆圆心到折弯槽端面距离M，其中步骤H：记录折弯刀的初始位置，采集折弯刀折弯后底面与折弯刀初始位置的底面相交点到折弯板V槽倒角圆圆心所在水平线的垂直距离H；步骤I：采集折弯刀折弯后底面与折弯刀初始位置的底面的两个相交点的距离W；步骤J：采集机器人的位移量S；步骤K：采集折弯刀的倒角半径R；步骤L：计算折弯刀位移后与初始位置的角度：步骤M：采集标尺光栅与折弯刀接触面的中点所在的竖直线与折弯板V槽倒角圆圆心的水平距离L1；步骤N：采集光栅读数头的中点到折弯刀初始位置的垂直距离I；步骤O：计算周期t内Pt位置和姿态，其中：Xt＝Z0-L1+L1cosα+Isinα，Yt＝Y0，Zt＝X0-{sinα·(L1-W/2cosα)-Icosα}＝X0-L1sinα+Wtan/2+Icosα，Nt＝N0，Ot＝O0+α，Mt＝M0；从而得出机器人的位置Pt(Xt，Yt，Zt)和姿态Qt(Nt，Ot，Mt)；步骤P：根据以上方法得出机器人控制点在用户坐标系下的实时t时刻和位置，从而得出控制点在直角坐标系下的实时位置和姿态，通过以上算法得出机器人控制点位置和姿态下的各个轴的关节角度α；步骤Q：上位机通过计算控制驱动器配合运动各个轴，计算出机器人△t时间内位移量△S，从而计算出机器人末端速度△V。t+1时刻速度△Vt+1，K为增益比例；机器人速度Vr，其中从而利用公式Vr＝△V(1-K)+△Vt+1K计算出机器人速度。进一步地，所述k为衍射光谱的级次。进一步地，所述K为增益比例。进一步地，所述光栅包括标尺光栅和光栅读数头。综上所述，由于采用了上述技术方案，本专利技术的有益效果是：1.本专利技术一种工业机器人折弯跟随方法，使用机器人折弯，可以保证其速度稳定一致，提高折弯的同步性。2.本专利技术一种工业机器人折弯跟随方法，使用上述算法，使得控制机器人准确进行每一次相同的动作，提高折弯质量的一致性。3.本专利技术一种工业机器人折弯跟随方法，通过上述算法，控制机器人替代人工，减少了人工长期重复进行同一类生产的工作量，避免人工操作使得工作人员产生疲倦，提高了生产的安全性。4.本专利技术一种工业机器人折弯跟随方法，通过上述算法，控制机器人替代人工操作，提高了生产效率。附图说明本专利技术将通过例子并参照附图的方式说明，其中：图1是本专利技术的折弯刀位移图；图2是本专利技术的流程图。具体实施方式本说明书中公开的所有特征，或公开的所有方法或过程中的步骤，除了互相排斥的特征和/或步骤以外，均可以以任何方式组合。下面结合图1至图2对本专利技术作详细说明。实施例1包括以下步骤：步骤A：建立用户坐标系：A1：以折弯刀1刀尖边缘所在轴线上一点为用户坐标原点ORG；A2：以折弯刀1刀尖边缘所在轴线方向为用户坐标YY方向；A3：以折弯刀1移动方向为用户坐标XX方向；A4：基于右手法则确定Z轴方向；A5：建立用户坐标原点时折弯刀1刀尖边缘与折弯槽底部距离为D；A6：基于用户坐标系获得机器人折弯开始点在用户坐标系下的位置P0(X0，Y0，Z0)和姿态Q0(N0，O0，M0)；步骤B:在折弯刀1上设置光栅，采集周期△t内的反馈数据△P，得出折弯刀1在周期△t内的速度V，其中步骤C：根据机器人在折弯开始点相对折弯板的姿态，通过折弯刀1上光栅采集的数据，得出机器人每个时刻t的位置Pt(Xt，Yt，Zt)和姿态Qt(Nt，Ot，Mt)；步骤D：采集折弯刀1的宽度D；步骤E：采集折弯刀1初始状态下V槽的最大间距B；步骤F：采集折弯刀1初始状态下V槽的锐角角度β；步骤G：计算折弯刀1与折弯板V槽接触位置倒角圆圆心到折弯槽端面距离M，其中步骤H：记录折弯刀1的初始位置，采集折弯刀1折弯后底面与折弯刀1初始位置的底面相交点到折弯板V槽倒角圆圆心所在水平线的垂直距离H；步骤I：获取折弯刀1折弯后底面与折弯刀1初始位置的底面的两个相交点的距离W；步骤J：采集机器人的位移量S；步骤K：采集折弯刀1的倒角半径R；步骤L：计算折弯刀1位移后与初始位置的角度：步骤M：采集标尺光栅与折弯刀1接触面的中点所在的竖直线与折弯板V槽倒角圆圆心的水平距离L1；步骤N：采集光栅读数头的中点到折弯刀1初始位置的垂直距离I；步骤O：计算周期t内Pt位置和姿态，其中：Xt＝Z0-L1+L1cosα+Isinα，Yt＝Y0，Zt＝X0-{sinα·(L1-W/2cosα)-Icosα}＝X0-L1sinα+Wtan/2+Icosα，Nt＝N0，Ot＝O0+α，Mt＝M0；从而得出机器人的位置Pt(Xt，Yt，Zt)和姿态Qt(Nt，Ot，Mt)；步骤P：根据以上方法得出机器人控制点在用户坐标系下的实时t时刻和位置，从而得出控制点在直角坐标系下的实时位置和姿态，通过以上算法得出机器人控制点位置和姿态下的各个轴的关节角度α；步骤Q：上位机通过计算控制驱动器配合运动各个轴，计算出机器人△t时间内位移量△S，从而计算出机器人末端速度△V。t+1时刻速度△Vt+1，K为增益比例；机器人速度Vr，其中从而利用公式Vr＝△V(1-K)+△Vt+1K计算出机器人速度。以上所述，仅为本专利技术的优选实施方式，但本专利技术的保护范围并不局限于此，任何熟悉本领域的技术人员在本专利技术所揭露的技术范围内，本文档来自技高网...

【技术保护点】
1.一种工业机器人折弯跟随方法，包括折弯刀(1)，其特征在于：包括以下步骤：步骤A：建立用户坐标系：A1：以折弯刀(1)刀尖边缘所在轴线上一点为用户坐标原点ORG；A2：以折弯刀(1)刀尖边缘所在轴线方向为用户坐标YY方向；A3：以折弯刀(1)移动方向为用户坐标XX方向；A4：基于右手法则确定Z轴方向；A5：建立用户坐标原点时折弯刀(1)刀尖边缘与折弯槽底部距离为D；A6：基于用户坐标系获得机器人折弯开始点在用户坐标系下的位置P0(X0，Y0，Z0)和姿态Q0(N0，O0，M0)；步骤B:在折弯刀(1)上设置光栅，采集周期△t内的反馈数据△P，得出折弯刀(1)在周期△t内的速度V，其中

【技术特征摘要】
1.一种工业机器人折弯跟随方法，包括折弯刀(1)，其特征在于：包括以下步骤：步骤A：建立用户坐标系：A1：以折弯刀(1)刀尖边缘所在轴线上一点为用户坐标原点ORG；A2：以折弯刀(1)刀尖边缘所在轴线方向为用户坐标YY方向；A3：以折弯刀(1)移动方向为用户坐标XX方向；A4：基于右手法则确定Z轴方向；A5：建立用户坐标原点时折弯刀(1)刀尖边缘与折弯槽底部距离为D；A6：基于用户坐标系获得机器人折弯开始点在用户坐标系下的位置P0(X0，Y0，Z0)和姿态Q0(N0，O0，M0)；步骤B:在折弯刀(1)上设置光栅，采集周期△t内的反馈数据△P，得出折弯刀(1)在周期△t内的速度V，其中步骤C：根据机器人在折弯开始点相对折弯板的姿态，通过折弯刀(1)上光栅采集的数据，得出机器人每个时刻t的位置Pt(Xt，Yt，Zt)和姿态Qt(Nt，Ot，Mt)；步骤D：采集折弯刀(1)的宽度D；步骤E：采集折弯刀(1)初始状态下V槽的最大间距B；步骤F：采集折弯刀(1)初始状态下V槽的锐角角度β；步骤G：计算折弯刀(1)与折弯板V槽接触位置倒角圆圆心到折弯槽端面距离M，其中步骤H：记录折弯刀(1)的初始位置，采集折弯刀(1)折弯后底面与折弯刀(1)初始位置的底面相交点到折弯板V槽倒角圆圆心所在水平线的垂直距离H；步骤I：采集折弯刀(1)折弯后底面与折弯刀(1)初始位置的底面的两个相交点的距离W；步骤J：采集机器人的位移量S；步骤K：采集折...

【专利技术属性】
技术研发人员：夏久零，邓璨宇，
申请(专利权)人：成都卡诺普自动化控制技术有限公司，
类型：发明
国别省市：四川,51