基于事件触发的单连杆机械臂系统实际跟踪的控制方法

文档序号:25869635发布日期:2021-07-13 16:31阅读:147来源:国知局
基于事件触发的单连杆机械臂系统实际跟踪的控制方法

本发明属于控制理论与控制工程领域,涉及基于事件触发的单连杆机械臂系统实际跟踪的控制方法,具体涉及一种基于事件触发的具有有界扰动的单连杆机械臂系统实际跟踪的控制方法。



背景技术:

随着科学技术不断向智能化方向发展,机器人应用领域不断拓展和深化,工业机器人已成为一种高新技术产业,为工业自动化水平发挥了巨大作用。机器人是先进制造技术和自动化装备的典型代表,是人造机器的“终极”代表,涉及到机械、电子、自动控制、计算机、人工智能、传感器、通讯与网络等多个学科和领域,是多种高新技术发展成果的综合集成,因此它的发展与众多学科发展密切相关。机械臂作为工业机器人的一种典型代表,能模仿人手和臂的某些动作功能,是一种以按固定程序抓取、搬运物件或操作工具的自动操作装置。它可代替人的繁重劳动,以实现生产的机械化和自动化,能在有害环境下操作以保护人身安全,因而广泛应用于机械制造、冶金、电子、轻工和原子能等部门。

自适应技术是研究非线性系统的有效方法之一。在日常生活中,所谓自适应是指生物能改变自己的习性以适应新的环境的一种特征。因此,直观地讲,自适应控制器应当是这样一种控制器,它能修正自己的特性以适应对象和扰动的动态特性的变化。自适应控制的研究对象是具有一定程度不确定性的系统,这里所谓的“不确定性”是指描述被控对象及其环境的数学模型不是完全确定的,其中包含一些未知因素和随机因素。总之,自适应技术是通过时变的动态增益来解决系统中的“不确定性”,体现了“以动制动”的思想。

所谓实际跟踪就是希望系统的输出按照预先设定的形式运行,但由于实际系统不可避免的存在各种干扰,因此系统的输出不可能复现预先设定的形式,但可以要求系统的输出与预先设计的形式的误差在一定可以接受的范围内。实际跟踪在实际生活中有很多的应用,例如智能车按照预定的轨线前行以及最常见的无人机按照预定的方式进行编队变换等,因此研究机械臂系统的实际跟踪是有必要的。

事件触发机制是一种新型的控制策略,只有当特定的事件发生时,其控制任务才会被执行,这不同于传统的周期控制,其控制任务是周期执行的。典型的事件触发机制的设计核心就是保持系统的稳定性和性能,也就是说只有当系统的稳定性和性能有要求的时候,传感器才会对系统的状态或者输出进行采样和传输并更新控制信号,因此事件触发控制能在保持系统的稳定性和性能的情况下相应地减少对计算机资源的浪费。因此在实际机械臂系统中为了减少马达的磨损,设计基于事件触发机制的控制器方案是有必要的。



技术实现要素:

针对现有技术的不足,本发明提出了基于事件触发的单连杆机械臂系统实际跟踪的控制方法,利用自适应技术提出一种基于事件触发机制的输出反馈实际跟踪的控制方法,通过构造事件触发条件和设计事件触发控制器,减少浪费机械臂运行时的有限资源以及降低马达磨损,实现机械臂的实际跟踪。

基于事件触发的单连杆机械臂系统实际跟踪的控制方法,该方法包括以下步骤:

步骤1、建立系统空间状态模型。

根据牛顿定理以及相关的物理学原理,对单连杆机械臂系统进行分析,建立系统的动态描述方程:

其中,q1、q2分别表示t时刻连杆位移、电机转子位移,···分别表示一次求导与两次求导,jl、jm分别表示连杆惯性、电机转子惯性,k0代表弹性常数,g代表重力常数,m代表连接质量,l0代表质心,fl、fm分别表示连杆、电子转子的粘性摩擦系数,控制u代表马达传递的扭矩,u*为未知有界干扰。

设置控制目标为:在只有连杆位移q1可测的情况下,使q1跟踪参照信号yr,且最大允许误差为λ,参照信号yr满足定义状态η1=q1,η2=q2,将系统的动态模型转换为空间状态表达:

其中,是一个已知的常数,y是系统的输出信号。

定义x5=u*i=2,3,4,将系统的空间状态表达转换为下三角结构的形式:

步骤2、设计高增益观测器。

在单连杆机械臂系统只有连杆位移q1是可测的,因此步骤1建立的系统空间状态模型中只有y是已知的。利用系统输入输出信息来设计观测器重构系统状态以及未知的扰动,同时构造合适的自适应增益l,用于补偿系统不确定信息以及扰动带来的影响,得到高增益观测器:

其中是公式(3)中状态x=[x1,x2,x3,x4,x5]t的估计值,a1、a2、a3、a4、a5均大于0,是赫尔维茨多项式p(s)=s5+a1s4+a2s3+a3s2+a4s+a5的系数,τ是任意的正常数。

步骤3、设计基于事件触发的输出反馈控制器。

基于经典控制方法,引入动态增益,并补偿系统中的扰动项,得到控制器:

其中k1、k2、k3、k4均大于0,是赫尔维茨多项式p(s)=s4+k1s3+k2s2+k3s+k4的系数。

设计事件触发决策机制:

其中tk代表上一控制转换时刻,tk+1代表即将要控制转换的时刻,γ>0是可设计的参数代表控制器触发阈值,当满足事件触发决策才传输控制信号,否则一直沿用tk时刻的控制信号。

得到基于事件触发的控制器:

本发明具有以下有益效果:

1、非线性机械臂系统的较为复杂,已知信息较少,而且存在传感器、执行机构或者其他因素产生的误差或者干扰,现有的研究结果无法给出合适的事件触发控制方案,本发明提出的控制器填充了这一领域的空白。

2、非线性系统的实际跟踪问题要求连杆位移跟踪预先给定的轨迹,更符合实际生活的要求。

3、实现非线性机械臂系统进行有效控制,使得其在运行时是稳定有界的,采用的事件触发控制是一种采样控制,可以减少不必要的信息传输,节省计算机的资源,进而减少机械臂系统马达的磨损。

附图说明

图1为单连杆机械臂系统结构图;

图2为基于状态观测器的输出反馈控制原理;

图3为基于事件触发的控制系统原理;

图4是系统输出y的轨迹图;

图5是状态η1和η2的状态轨迹图;

图6是状态η3和η4的状态轨迹图;

图7是估计状态的状态轨迹图;

图8是估计状态的状态轨迹图;

图9是动态增益l的状态轨迹图;

图10是控制信号u的状态轨迹图。

具体实施方式

以下结合附图对本发明作进一步的解释说明;

基于事件触发的单连杆机械臂系统实际跟踪的控制方法,该方法包括以下步骤:

步骤1、建立系统空间状态模型。

根据牛顿定理以及相关的物理学原理,对如图1所示的单连杆机械臂系统进行分析,在不考虑机械臂系统本身形变的影响下,建立系统的动态描述方程:

其中,q1、q2分别表示t时刻连杆位移、电机转子位移,···分别表示一次求导与两次求导,jl、jm分别表示连杆惯性、电机转子惯性,k0代表弹性常数,g代表重力常数,m代表连接质量,l0代表质心,fl、fm分别表示连杆、电子转子的粘性摩擦系数,控制u代表马达传递的扭矩,u*代表由于传感器或者其他因素所造成的未知有界干扰,u*≤c,c是一个未知的正常数。

设置控制目标为:在只有连杆位移q1可测的情况下,使q1跟踪参照信号yr,且最大允许误差为λ,参照信号yr满足定义状态η1=q1,η2=q2,将系统的动态模型转换为空间状态表达:

其中,是一个已知的常数,y是系统的输出信号。

为了消去输入u前面的系数,定义x5=u*i=2,3,4,将系统的空间状态表达转换为下三角结构的形式:

步骤2、设计高增益观测器。

由步骤1建立的系统空间状态模型可知,系统的状态大都不可测,因此无法用状态反馈控制方法来对系统进行控制,针对这种情况可以采用如图2所示的带有状态观测器的输出反馈控制方法,为了实现准确的控制,需要状态的确切信息,因此需要设计观测器对原系统状态进行估计,为了保证观测器能准确估计原系统的状态,首先要求观测器在形式上和原系统是一致的,又因为在单连杆机械臂系统只有连杆位移q1是可测的,因此模型中只有y是已知的。利用系统输入输出信息来设计观测器重构系统状态以及未知的扰动,同时构造合适的自适应增益l,用于补偿系统不确定信息以及扰动带来的影响,得到高增益观测器:

其中是公式(3)中状态x=[x1,x2,x3,x4,x5]t的估计值,a1、a2、a3、a4、a5均大于0,是赫尔维茨多项式p(s)=s5+a1s4+a2s3+a3s2+a4s+a5的系数,τ是任意的正常数。l是自适应增益表达式中第一项保证系统的输出最终保持在[-λ,λ]范围内,第二项保证此增益是有界的,第三项保证增益单调递增,初值使得增益始终大于1。

步骤3、设计基于事件触发的输出反馈控制器。

将步骤1建立的空间状态模型与步骤2建立的观测器视为一个新的系统,新系统的输出为观测器估计的状态,基于经典控制方法得到控制器:

其中u是控制信号,k是一系列设计参数,是观测器的输出状态。

公式(5)展示的控制器并不能处理非线性系统,因此引入动态增益,并补偿系统中的扰动项,得到新的控制器:

其中k1、k2、k3、k4均大于0,是赫尔维茨多项式p(s)=s4+k1s3+k2s2+k3s+k4的系数。

如图3所示,为了减少不必要的信息传输,引入一种机制来决定是否传输“控制信息”,且保证该传输的信息确实可以保证系统的稳定运行,从而减少传输信息的量,减少马达的磨损,设计事件触发决策机制:

其中tk代表上一控制转换时刻,tk+1代表即将要控制转换的时刻,γ>0是可设计的参数代表控制器触发阈值,当满足事件触发决策才传输控制信号,否则一直沿用tk时刻的控制信号。

得到基于事件触发的控制器:

步骤5、确定控制器参数。

选择两组合适的赫尔维茨多项式系数,a1=2,a2=10,a3=6,a4=10.2,a5=1以及k1=5,k2=5,k3=6,k4=5。设置最大允许跟踪误差λ=0.2、参照信号yr=sint、控制器触发阈值γ=5以及增益参数τ=0.2,得到的观测器如下:

基于事件触发的控制器如下:

将其用于如表1所示参数的单连杆机械臂系统中,进行仿真实验。

表1

利用表1中的参数值,可以得到原机械臂非线性系统的较确切的表达式,同时假设该系统的系统初始条件

图4代表系统输出的状态轨迹图,可以看到系统的输出最总保持在[-0.2,0.2]范围内实现了系统的实际跟踪,图5代表原系统状态η1和η2的状态轨迹图,图6是原系统状态η3和η4的状态轨迹图,图7是观测器估计状态的状态轨迹图,图8是观测器估计状态的状态轨迹图,从图上可以看出系统在设计的控制器下的状态轨迹是有界的,图9代表动态增益l的状态轨迹,图10代表控制器u的轨迹。

以下内容从理论角度,证明本方法得到的基于事件触发的控制器的有效性:

定义矩阵a,k,d1和d2如下:

因为a和k是赫尔维茨矩阵,所以存在正定矩阵q=qt和p=pt满足:

其中i代表适当维数的单位矩阵。

首先选择如下的动态变换:

可以将系统空间状态模型(3)和高增益观测器(4)转换为如下的形式:

其中:

采用李亚普诺夫函数证明控制器可以实现系统的稳定运行以及实际跟踪。首先为机械臂系统构造一个李亚普诺夫函数

v=vz+μvε=ztpz+μεtqε(14)

其中基于上述变换对该李亚普诺夫函数求导可以得到:

进而可以得到:

其中和△=2γ2||pc‖2以及θ是未知的常数。

证明(1)、证明l是有界的:

根据解的存在唯一性定理和延拓定理,可以知道对于任意的初始条件闭环系统存在唯一的解在最大存在区间[0,tm)上。采用反证法,首先假设l是无界的,即那么一定存在一个时间t1,使得当t∈[t1,tm),成立,从而有

其中γ1是满足γ1v≤‖ε‖2+||z||2≤γ2v的常数。这意味着存在一个时间t2∈[t1,tm),使得当t2≤t≤tm有

进而可以得到

定义λ=lv,求导可得

这就意味着λ是有界的,同时也意味着v是有界的且因此:

而公式(19)和矛盾,因此假设l无界不成立,即l是有界的。

证明(2)、证明状态z是有界的。

从证明(1)可知l是有界的,设置:

注意到lyapunov函数vz=ztpz,对其求导可得:

其中λmax(p)代表矩阵p的最大特征值。

注意到进而可以得到

由公式(24)可以知道状态z是有界的。

证明(3)、证明状态ε是有界的。

重新选择坐标变换得到:

其中通过系统状态模型(3)、观测器(4)以及(25)可以将系统重写为:

其中a在上述已经定义,而

构造一个正定的lyapunov函数vη=ηtqη,对其求导可得:

其中λmax(q)代表矩阵q的最大特征值。注意到

因此对t∈[0,tm)积分可以得到

由公式(29)可以知道状态η有界的,通过(12)和(25),可以知道状态ε也是有界的。

(4)证明tm=+∞、没有zeno现象发生。

所述zeno现象为在有限时间内控制无限次触发。

首先假设tm<+∞,可以得到:

由基于事件触发的控制器可知,存在一个正实数m使得下式成立

进一步可以得到:

进而可以得到:

因此这也就意味着假设tm<+∞是错误的,因此tm=+∞以及zeno现象不会发生。

(5)通过上述4个证明可以知道闭环系统的所有状态都是有界的,这也就意味着l(t)在[0,+∞)上是有界的以及进一步通过引理,可以得到:

从动态增益更新率中可以得知存在一个时间tλ,当t>tλ时

这也就意味着|y(t)|=|η1(t)-yr(t)|≤λ,

综上所述,设计的利用自适应技术基于事件触发的控制器方案最终可以实现机械臂系统的跟踪运行。

当前第1页1 2 
网友询问留言 已有0条留言
  • 还没有人留言评论。精彩留言会获得点赞!
1