本发明涉及机器人折弯跟随方法领域,特别涉及一种工业机器人折弯跟随方法。
背景技术:
随着折弯件在工程机械产品上的广泛应用,为满足其产品质量和生产需要,其质量标准也逐渐提高。数控折弯机在冷态下可利用所配备的通用模具(或专用模具)将金属板材折弯或者各种所需要的几何截面形状的工件,折弯工艺的合理性直接影响到产品最终成型尺寸和外观。而目前大部分为人工配合折弯机进行工件加工,但是现在人工配合折弯机折弯板材存在几个问题: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,其中
进一步地,所述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,其中
以上所述,仅为本发明的优选实施方式,但本发明的保护范围并不局限于此,任何熟悉本领域的技术人员在本发明所揭露的技术范围内,可不经过创造性劳动想到的变化或替换,都应涵盖在本发明的保护范围之内。因此,本发明的保护范围应该以权利要求书所限定的保护范围为准。