一种三关节点焊机器人轨迹跟踪控制方法与流程

文档序号:13251364阅读:来源:国知局
技术特征:
1.一种三关节点焊机器人轨迹跟踪控制方法,其特征在于,所述方法包括以下步骤:1)建立三关节点焊机器人系统的数学模型所述点焊机器人具有五个自由度,其结构由一系列旋转连杆和滑动关节顺次串联而成,将点焊机器人系统近似看成一个三关节刚性串联的点焊机器人;建模方法包括牛顿欧拉法和拉格朗日方法,采用拉格朗日方法对水平三关节点焊机器人进行动力学建模,得到点焊机器人系统的动力学方程为:M(q)q··+V(q,q·)+G(q)=τ---(1)]]>式中M(d)为点焊机器人的3×3质量矩阵,是3×1的离心力和哥氏力矢量,G为3×1的重力项,τ为输入力矩,其中M(d)=H000m2+m3000m3---(2)]]>V(q,q·)=2(m2+m3)d2d·2θ·1-(m2+m3)d2θ·120---(3)]]>G=00-m3g---(4)]]>H=Ix1+Iy2+Iz3+m14l22+m2d22+m3d22---(5)]]>并且d=[d1d2d3]T,d1为旋转关节变量,d2、d3为两个移动关节变量,τ=[τ1τ2τ3]T,τ1、τ2、τ3分别为三个关节的输入力矩,l1、l2、l3\t分别为三个连杆的长度,m1、m2、m3分别为三连杆的质量,Iz1、Iy2、Iz3分别为各关节惯性矩转动惯量,质量矩阵是对称正定矩阵,为便于说明后续的带解耦抗干扰控制器的设计过程,将式(1)写成如下形式:q··=-M(q)-1V(q,q·)-M(q)-1G(q)+M(q)-1τ---(6)]]>步骤2)三关节点焊机器人的控制算法的设计带有解耦控制的抗扰动控制算法包括三部分,包括跟踪微分器、非线性反馈控制律和扩张状态观测器,其具体设计过程如下所示:2.1)安排过渡过程:此过程是将三关节的参考运动轨迹v,经过跟踪微分器获得参考轨迹v的近似微分信号v2,同时获得参考轨迹v的过渡信号v1,将跳变的轨迹信号平滑化,防止产生超调,式(7)给出跟踪微分器的具体形式:其中,r为快速跟踪因子,h为积分步长,h0为滤波因子,fhan(e(k),v2(k),r,h0)为最速控制综合函数,fhan(x1,x2,r,h)具体表达式如下:d=rhd0=hdy=x1+hx2a0=d2+8r|y|a=x2+(a0-d)2sign(y),|y|>d0x2+yh,|y|≤d0fhan=-rsign(a),|a|>drad,|a|≤d---(8)]]>2.2)扩张状态观测器的设计用于估计系统每个关节中三个状态变量的扩张状态观测器具有如下形式:e(k)=z1(k)-x1(k),fe=fal(e(k),0.5,δ),fel=fal(e(k),0.25,δ),z1(k+1)=z1(k)+h(z2(k)-β01e(k))z2(k+1)=z2(k)+h(z3(k)-β02fe+bu(k))z3(k+1)=z3(k)+h(-β03fel)---(9)]]>其中,e(k)为三关节点焊机器人参考轨迹值与实际运动轨迹估计值之差,即关节运动轨迹的误差量,z1(k)是对运动轨迹x1(k)的估计,z2(k)是对运动轨迹速度x2(k)的估计,z3(k)是对新扩张状态量x3(k)的估计,h是积分步长,fal(e(k),0.25,δ)为非线性函数,具体如式(10)所示,δ、β01、β02β03为一组待整定的参数,其中,a为幂指数,δ为线性段的区间长度,sign()为符号函数,具体表达式如式(11)所示sign(x)=1x>00x=0-1x<0---(11)]]>2.3)非线性反馈控制律设计此过程得到两个误差量,即e1(k)=v1(k)-z1(k)和e2(k)=v2(k)-z2(k),经过非线性组合模块可计算出控制量u0(k),计算过程如式(12)所示e1(k)=v1(k)-z1(k),e2(k)=v2(k)-z2(k)u0(k)=-fhan(e1(k),e2(k),r,h)u(k)=(u0(k)-z3(k))/b---(12)]]>为了补偿系统中加速度项和内外扰动,在得到的控制量u0(k)中减去z3(k)得到新的控制量,即步骤3)三关节点焊机器人系统的解耦过程在式(6)中加入扰动项w(t),将式(6)写成如下形式:q··1=f1(q·1,d·2,d·3,w(t))+b11τ1+b12τ2+b13τ3d··2=f2(q·1,q·2,d·3,w(t))+b21τ1+b22τ2+b23τ3d··3=f3(q·1,q·2,d·3,w(t))+b31τ1+b32τ2+b33τ3---(13)]]>其中,为含有内外总和扰动加速度项,w(t)为未知扰动,仿真时给定w(t)为随机噪声信号,控制量的放大系数bij是状态变量的函数,即bij(d1,d2,d3),在式(13)中,取B=b11b12b13b21b22b23b31b32b33---(14)]]>并引入“虚拟控制量”U=[Ud1Ud2Ud3]T,则有τ1τ2τ3=b11b12b13b21b22b23b31b32b33-1Ud1Ud2Ud3---(15)]]>简写成如下形式:τ=B-1U(16)2.根据权利要求1所述的三关节点焊机器人轨迹跟踪控制方法,其特征在于,步骤2.1)中β01、β02、β03大于噪声或扰动的上界。
当前第2页1 2 3 
网友询问留言 已有0条留言
  • 还没有人留言评论。精彩留言会获得点赞!
1