一种三关节点焊机器人轨迹跟踪控制方法技术

本发明专利技术公开了一种三关节点焊机器人轨迹跟踪控制方法，包括以下步骤：1) 建立三关节点焊机器人系统的数学模型，在实际工程中要得到精确数学模型十分困难，在建立点焊机器人的数学模型时，需要对点焊机器人做合理的近似处理，忽略一些不确定性因素，利用拉格朗日方法对水平三关节点焊机器人进行动力学建模；2) 扩张状态观测器设计，本发明专利技术采用扩张状态观测器可将不确定动态作为总和扰动的一部分进行估计。其可以有效地对多关节点焊机器人进行解耦控制，此方法对多关节机械人的不确定性和系统内外扰动以及模型不确定性均具有很强的抑制能力。

【技术实现步骤摘要】
一种三关节点焊机器人轨迹跟踪控制方法
本专利技术应用于机器人控制领域，涉及到工业机器人在实际应用中的轨迹跟踪问题，尤其是汽车制造所用到的点焊机器人的路径规划和轨迹跟踪，实现一种有效的实时控制方法。
技术介绍
随着计算机和自动化技术的发展，特别是第一台计算机的诞生以来，计算机取得了巨大进步，并逐渐向着巨型化、微型化、智能化、网络化方向发展。同时，随着工业规模不断扩大，大批量生产的迫切需求推动了自动化技术的不断进步，也为工业机器人的研发奠定了基础。由于工业机器人的动作灵活、运动惯性小、通用性强等优点，目前已被广泛应用到机械制造、电子、冶金、军事和危险任务等领域。工业机器人大致有三大部分组成，包括执行机构、驱动结构和控制系统。其执行机构部分是用来抓持工具，也就是工业机器人的末端执行器，根据不同的抓持工具和作业对象又分为多种结构方式，在此不再赘述；其驱动系统部分包括动力和传动装置，使得执行机构产生相应的动作，如常用到的伺服驱动、气动装置等；其控制系统部分则是整个系统的核心部分，控制整个机器人系统有条不紊精确执行相应的动作，其工作原理是将信号指令发送到驱动系统，其执行机构按照指令完成特定动作，并接收传感器反馈回来的检测信息，它通常是以MCU、ARM或DSP等微控制器为主控制芯片，并辅助外围电路设备，通过控制算法的研究和编程而实现对机械手的精确控制。工业机器人通常是多关节的，多关节机器人是一个非线性和不确定性系统，同时又是一个与运动学和动力学原理密切相关、强耦合的多变量复杂控制系统，因此，不管是工业机器人的数学建模，还是工业机器人的控制方法都带来巨大挑战。为解决点焊机器人的轨迹跟踪以及内外部扰动对点焊机器人的性能影响问题，常用的处理方法有传统的PID控制、自适应控制、神经网络控制、模糊控制以及迭代学习控制等。通常所用的PID控制方法是利用误差来消除误差的过程控制原理，它不依赖于系统的模型，而且简单实用得到广泛的应用。但是该方法存在因系统自身的惯性，导致系统输出不能及时对跳变量跟踪而产生超调的不合理情况，即快速性和超调之间有着不可调和的矛盾，同时由于积分环节具有滞后作用，这就使得误差积分的反馈会使闭环系统反应迟钝以及容易产生震荡等问题。迭代学习法是通过算法本身的学习，在机器重复过程中能够达到有效的控制。这对于像重复作业的机器人来说是非常有效的，然而迭代学习控制大多仅适用于那些可重复作业的系统，对收敛速度等控制品质来说做的还是不够。
技术实现思路
针对现有技术的不足，本专利技术的目的是提供一种不仅能对三关节的点焊机器人各关节进行很好有效地控制，也能解决各关节之间的耦合问题的轨迹跟踪控制方法。本专利技术解决其技术问题所采用的技术方案如下：一种采用带有解耦控制抗干扰技术的三关节点焊机器人的轨迹跟踪控制方法，所述方法包括以下步骤：步骤1)建立三关节点焊机器人系统的数学模型。一个五自由度的点焊机器人，其结构由一系列旋转连杆和滑动关节顺次串联而成，由于末端执行器可以由前三个关节来控制，在不影响对系统动力学结构和控制算法研究的情况下，在此把点焊机器人系统近似看成一个三关节刚性串联的点焊机器人。由于在实际建模过程中要得到精确数学模型是十分困难，所以在建立点焊机器人的数学模型时，可以考虑对点焊机器人结构做一定的近似处理，比如忽略一些不确定性因素。建模方法包括牛顿欧拉法和拉格朗日方法，本专利技术采用拉格朗日方法对水平三关节点焊机器人进行动力学建模，得到点焊机器人系统的动力学方程为：式中M(q)为点焊机器人的3×3质量矩阵，是3×1的离心力和哥氏力矢量，G为3×1的重力项，τ为输入力矩。其中其中d＝[d1d2d3]T，d1为旋转关节变量，d2、d3为两个移动关节变量，τ＝[τ1τ2τ3]T，τ1、τ、2τ3分别为三个关节的输入力矩，l1、l、2l3分别为三个连杆的长度，m1、m2、m3分别为三连杆的质量，Iz1、Iy2、Iz3分别为各关节惯性矩转动惯量。质量矩阵是对称正定矩阵，为便于理解后续带有解耦控制的抗扰动控制器的设计过程，将式(1)写成如下形式：步骤2)三关节点焊机器人的解耦抗干扰控制算法的设计。带有解耦控制的抗扰动控控制算法大致有三部分组成，包括跟踪微分器、非线性反馈控制律和扩张状态观测器。其具体设计过程如下所示：2.1)安排过渡过程，设计跟踪微分器。此过程是将三关节的参考运动轨迹v，经过跟踪微分器获得参考轨迹v的近似微分信号v2，同时还可以获得参考轨迹v的过渡信号v1，此过程可将跳变的轨迹信号平滑化，防止产生超调，式(7)给出跟踪微分器的具体形式。其中，r为快速跟踪因子，h为积分步长，h0为滤波因子，fhan(e(k),v2(k),r,h0)为最速控制综合函数，fhan(x1,x2,r,h)具体表达式如下：2.2)扩张状态观测器的设计。用于估计系统每个关节中三个状态变量的扩张状态观测器具有如下形式：其中，e(k)为三关节点焊机器人参考轨迹值与实际运动轨迹预估计值之差，即关节运动轨迹的误差量，其式中z1(k)是对运动轨迹x1(k)的估计，z2(k)是对运动轨迹速度量x2(k)的估计，z3(k)是对新扩张状态量x3(k)的估计，h是积分步长。fal(e(k),0.25,δ)为非线性函数，具体如式(10)所示。δ、、β01、β02β03为一组待整定的参数，为保证一定的估计精度，根据高增益状态观测器设计原则，β01、、β02β03可取得大一些，一般要大于噪声或扰动的上界。其中，a为幂指数，δ为线性段的区间长度，sign()为符号函数，具体表达式如式(11)所示。2.3)非线性反馈控制律设计。此过程得到两个误差量，即e1(k)＝v1(k)-z1(k)和e2(k)＝v2(k)-z2(k)。经过非线性组合可计算出对象控制量u0(k)，计算过程如式(12)所示。为了补偿系统中加速度项和内外扰动，在得到的控制量u0(k)中减去新扩张的量z3(k)得到新的控制量，即补偿过程可抵消系统中所有总和扰动项，从而使系统转化成了纯积分的线性系统，同时也消除了内外扰动对系统性能的影响。步骤3)三关节点焊机器人系统的解耦过程。式(6)计算得出的点焊机器人模型是经过近似处理得到的没有关节间耦合的数学模型，实际上多关节机器人是一个强耦合的多变量复杂控制系统，所以在实际应用中必须考虑关节间的耦合问题。对于多输入多输出系统的解耦控制方法无论是控制理论界还是控制工程界都是追求解决的重要问题，现有的方法是采用系统模型，但是计算量很大，本专利技术采用带有解耦抗扰动控制技术来解决关节之间的耦合问题，具有很好的鲁棒性。为了分析在有耦合情况下的解耦控制，同时为了验证设计控制器的抗干扰能力，人为地加入扰动项w(t)，现将式(6)写成如下形式：其中，为含有内外总和扰动加速度项，w(t)为噪声信号。控制量的放大系数bij是状态变量的函数，即bij(d1,d2,d3)。在这里，将系统控制量之外的模型部分称为“动态耦合”部分，将bij(d1,d2,d3)部分称为“静态耦合部分”。三关节点焊机器人系统具有耦合性，在解耦控制过程中，由于扩张的状态观测器对内外扰实时估计，并对含有总和扰动的加速度项进行动态线性化补偿，这就使得解耦过程不必考虑“动态耦合”部分，只需考虑“静态耦合”部分即可。在式(13)中，取本文档来自技高网...

【技术保护点】
一种三关节点焊机器人轨迹跟踪控制方法，其特征在于,所述方法包括以下步骤：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＝[d1 d2 d3]T，d1为旋转关节变量，d2、d3为两个移动关节变量，τ＝[τ1 τ2 τ3]T，τ1、τ2、τ3分别为三个关节的输入力矩，l1、l2、l3分别为三个连杆的长度，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&Cent...

【技术特征摘要】
1.一种三关节点焊机器人轨迹跟踪控制方法，其特征在于,所述方法包括以下步骤：1)建立三关节点焊机器人系统的数学模型所述点焊机器人具有五个自由度，其结构由一系列旋转连杆和滑动关节顺次串联而成，将点焊机器人系统近似看成一个三关节刚性串联的点焊机器人；建模方法包括牛顿欧拉法和拉格朗日方法，采用拉格朗日方法对水平三关节点焊机器人进行动力学建模，得到点焊机器人系统的动力学方程为：式中M(q)为点焊机器人的3×3质量矩阵，是3×1的离心力和哥氏力矢量，G为3×1的重力项，τ为输入力矩，其中并且d＝[d1d2d3]T，d1为旋转关节变量，d2、d3为两个移动关节变量，τ＝[τ1τ2τ3]T，τ1、τ2、τ3分别为三个关节的输入力矩，l1、l2、l3分别为三个连杆的长度，m1、m2、m3分别为三连杆的质量，Ixl、Iy2、Iz3分别为各关节惯性矩转动惯量，质量矩阵是对称正定矩阵，为便于说明后续的带解耦抗干扰控制器的设计过程，将式(1)写成如下形式：步骤2)三关节点焊机器人的控制算法的设计带有解耦控制的抗扰动控制算法包括三部分，包括跟踪微分器、非线性反馈控制律和扩张状态观测器，其具体设计过程如下所示：2.1)安排过渡过程：此过程是将三关节的参考运动轨迹v，经过跟踪微分器获得参考轨迹v的近似微分信号v2，同时获得参考轨迹v的过渡信号v1，将跳变的轨迹信号平滑化，防止产生超调，式(7)给出跟踪微分器的具体形式：其中，r为快速跟踪因子，h为积分步长，h0为滤波因子，fhan(e(k),v2(k),r,h0)为最速控制综合函数，fhan(x...

【专利技术属性】
技术研发人员：李跃，
申请(专利权)人：苏州继企机电科技有限公司，
类型：发明
国别省市：江苏;32