首页 > 专利 > 杭州电子科技大学 > 基于事件触发的单连杆机械臂系统实际跟踪的控制方法专利详情

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

有效专利 查看PDF
专利申请流程有哪些步骤?
专利申请流程图
申请
申请号:指国家知识产权局受理一件专利申请时给予该专利申请的一个标示号码。唯一性原则。
申请日:提出专利申请之日。
2021-04-26
申请公布
申请公布指发明专利申请经初步审查合格后,自申请日(或优先权日)起18个月期满时的公布或根据申请人的请求提前进行的公布。
申请公布号:专利申请过程中,在尚未取得专利授权之前,国家专利局《专利公报》公开专利时的编号。
申请公布日:申请公开的日期,即在专利公报上予以公开的日期。
2021-07-30
授权
授权指对发明专利申请经实质审查没有发现驳回理由,授予发明专利权;或对实用新型或外观设计专利申请经初步审查没有发现驳回理由,授予实用新型专利权或外观设计专利权。
2022-04-19
预估到期
发明专利权的期限为二十年,实用新型专利权期限为十年,外观设计专利权期限为十五年,均自申请日起计算。专利届满后法律终止保护。
2041-04-26
基本信息
有效性 有效专利 专利类型 发明专利
申请号 CN202110454780.7 申请日 2021-04-26
公开/公告号 CN113110059B 公开/公告日 2022-04-19
授权日 2022-04-19 预估到期日 2041-04-26
申请年 2021年 公开/公告年 2022年
缴费截止日
分类号 G05B13/04 主分类号 G05B13/04
是否联合申请 独立申请 文献类型号 B
独权数量 1 从权数量 4
权利要求数量 5 非专利引证数量 0
引用专利数量 8 被引证专利数量 0
非专利引证
引用专利 CN111152225A、CN110253572A、CN108803326A、CN112621759A、CN110687784A、CN105807634A、CN111812973A、CN108628172A 被引证专利
专利权维持 1 专利申请国编码 CN
专利事件 事务标签 公开、实质审查、授权
申请人信息
申请人 第一申请人
专利权人 杭州电子科技大学 当前专利权人 杭州电子科技大学
发明人 鞠昕旭、贾祥磊、邵一鸣 第一发明人 鞠昕旭
地址 浙江省杭州市下沙高教园区2号大街 邮编 310018
申请人数量 1 发明人数量 3
申请人所在省 浙江省 申请人所在市 浙江省杭州市
代理人信息
代理机构
专利代理机构是经省专利管理局审核,国家知识产权局批准设立,可以接受委托人的委托,在委托权限范围内以委托人的名义办理专利申请或其他专利事务的服务机构。
杭州君度专利代理事务所 代理人
专利代理师是代理他人进行专利申请和办理其他专利事务,取得一定资格的人。
杨舟涛
摘要
本发明公开了基于事件触发的单连杆机械臂系统实际跟踪的控制方法。该方法通过确定具有旋转弹性关节的单连杆机械臂系统的数学模型,通过选择合适的状态以及对未知有界扰动和跟踪轨线进行合适的约束将系统转化为下三角形式;然后给出了高增益观测器并提出了基于事件触发机制的控制器;最后通过结合反证法、构造Lyapunov函数的方法验证系统的有界性以及跟踪特性,减少了系统的保守性;最后,仿真例子验证了该方法的有效性。该方法能对非线性机械臂系统进行有效控制,使其能够跟踪特定轨线运行且跟踪误差保持在预先设定的范围内,并且可以减少不必要的信息传输,节约带宽资源以及能在一定程度上减少马达的磨损,更符合实际的需要。
  • 摘要附图
    基于事件触发的单连杆机械臂系统实际跟踪的控制方法
  • 说明书附图:图1
    基于事件触发的单连杆机械臂系统实际跟踪的控制方法
  • 说明书附图:图2
    基于事件触发的单连杆机械臂系统实际跟踪的控制方法
  • 说明书附图:图3
    基于事件触发的单连杆机械臂系统实际跟踪的控制方法
  • 说明书附图:图4
    基于事件触发的单连杆机械臂系统实际跟踪的控制方法
  • 说明书附图:图5
    基于事件触发的单连杆机械臂系统实际跟踪的控制方法
  • 说明书附图:图6
    基于事件触发的单连杆机械臂系统实际跟踪的控制方法
  • 说明书附图:图7
    基于事件触发的单连杆机械臂系统实际跟踪的控制方法
  • 说明书附图:图8
    基于事件触发的单连杆机械臂系统实际跟踪的控制方法
  • 说明书附图:图9
    基于事件触发的单连杆机械臂系统实际跟踪的控制方法
  • 说明书附图:图10
    基于事件触发的单连杆机械臂系统实际跟踪的控制方法
法律状态
序号 法律状态公告日 法律状态 法律状态信息
1 2022-04-19 授权
2 2021-07-30 实质审查的生效 IPC(主分类): G05B 13/04 专利申请号: 202110454780.7 申请日: 2021.04.26
3 2021-07-13 公开
权利要求
权利要求书是申请文件最核心的部分,是申请人向国家申请保护他的发明创造及划定保护范围的文件。
1.基于事件触发的单连杆机械臂系统实际跟踪的控制方法,其特征在于:该方法包括以下步骤:
步骤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 , 和 将系统的空间状态表达转换为下三角结构的形
式:
步骤2、设计观测器;
设计如公式(4)所示高增益观测器:
T
其中 是公式(3)中状态x=[x1,x2,x3,x4,x5] 的估计值,a1、a2、a3、
5 4 3 2
a4、a5均大于0,是赫尔维茨多项式p(s)=s +a1s +a2s +a3s +a4s+a5的系数, L为自适应增益,τ为大于0的常数;
步骤3、设计基于事件触发的输出反馈控制器;
基于经典控制方法,引入动态增益,并补偿系统中的扰动项,得到控制器:
4 3 2
其中k1、k2、k3、k4均大于0,是赫尔维茨多项式p(s)=s+k1s+k2s+k3s+k4的系数;
设计事件触发决策机制:
其中tk代表上一控制转换时刻,tk+1代表即将要控制转换的时刻,γ>0是可设计的参数,代表控制器触发阈值,当 满足事件触发决策才传输控制信号,否则一直沿用tk时刻的控制信号;
得到基于事件触发的控制器:

2.如权利要求1所述基于事件触发的单连杆机械臂系统实际跟踪的控制方法,其特征*
在于:u为传感器造成的未知有界干扰。

3.如权利要求1或2所述基于事件触发的单连杆机械臂系统实际跟踪的控制方法,其特*
征在于:u≤c,c为大于0的常数。

4.如权利要求1所述基于事件触发的单连杆机械臂系统实际跟踪的控制方法,其特征在于:高增益观测器中的自适应增益L用于补偿系统不确定信息和扰动带来的影响以及使得跟踪误差保持在预先设定的范围内。

5.如权利要求1所述基于事件触发的单连杆机械臂系统实际跟踪的控制方法,其特征在于:设置两组赫尔维茨多项式系数分别为a1=2,a2=10,a3=6,a4=10.2,a5=1以及k1=
5,k2=5,k3=6,k4=5。
说明书

技术领域

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

背景技术

[0002] 随着科学技术不断向智能化方向发展,机器人应用领域不断拓展和深化,工业机器人已成为一种高新技术产业,为工业自动化水平发挥了巨大作用。机器人是先进制造技术和自动化装备的典型代表,是人造机器的“终极”代表,涉及到机械、电子、自动控制、计算机、人工智能、传感器、通讯与网络等多个学科和领域,是多种高新技术发展成果的综合集成,因此它的发展与众多学科发展密切相关。机械臂作为工业机器人的一种典型代表,能模仿人手和臂的某些动作功能,是一种以按固定程序抓取、搬运物件或操作工具的自动操作装置。它可代替人的繁重劳动,以实现生产的机械化和自动化,能在有害环境下操作以保护人身安全,因而广泛应用于机械制造、冶金、电子、轻工和原子能等部门。
[0003] 自适应技术是研究非线性系统的有效方法之一。在日常生活中,所谓自适应是指生物能改变自己的习性以适应新的环境的一种特征。因此,直观地讲,自适应控制器应当是这样一种控制器,它能修正自己的特性以适应对象和扰动的动态特性的变化。自适应控制的研究对象是具有一定程度不确定性的系统,这里所谓的“不确定性”是指描述被控对象及其环境的数学模型不是完全确定的,其中包含一些未知因素和随机因素。总之,自适应技术是通过时变的动态增益来解决系统中的“不确定性”,体现了“以动制动”的思想。
[0004] 所谓实际跟踪就是希望系统的输出按照预先设定的形式运行,但由于实际系统不可避免的存在各种干扰,因此系统的输出不可能复现预先设定的形式,但可以要求系统的输出与预先设计的形式的误差在一定可以接受的范围内。实际跟踪在实际生活中有很多的应用,例如智能车按照预定的轨线前行以及最常见的无人机按照预定的方式进行编队变换等,因此研究机械臂系统的实际跟踪是有必要的。
[0005] 事件触发机制是一种新型的控制策略,只有当特定的事件发生时,其控制任务才会被执行,这不同于传统的周期控制,其控制任务是周期执行的。典型的事件触发机制的设计核心就是保持系统的稳定性和性能,也就是说只有当系统的稳定性和性能有要求的时候,传感器才会对系统的状态或者输出进行采样和传输并更新控制信号,因此事件触发控制能在保持系统的稳定性和性能的情况下相应地减少对计算机资源的浪费。因此在实际机械臂系统中为了减少马达的磨损,设计基于事件触发机制的控制器方案是有必要的。

发明内容

[0006] 针对现有技术的不足,本发明提出了基于事件触发的单连杆机械臂系统实际跟踪的控制方法,利用自适应技术提出一种基于事件触发机制的输出反馈实际跟踪的控制方法,通过构造事件触发条件和设计事件触发控制器,减少浪费机械臂运行时的有限资源以及降低马达磨损,实现机械臂的实际跟踪。
[0007] 基于事件触发的单连杆机械臂系统实际跟踪的控制方法,该方法包括以下步骤:
[0008] 步骤1、建立系统空间状态模型。
[0009] 根据牛顿定理以及相关的物理学原理,对单连杆机械臂系统进行分析,建立系统的动态描述方程:
[0010]
[0011] 其中,q1、q2分别表示t时刻连杆位移、电机转子位移,·、··分别表示一次求导与两次求导,Jl、Jm分别表示连杆惯性、电机转子惯性,k0代表弹性常数,g代表重力常数,m代表连接质量,l0代表质心,Fl、Fm分别表示连杆、电子转子的粘性摩擦系数,控制u代表马达传递的*扭矩,u为未知有界干扰。
[0012] 设置控制目标为:在只有连杆位移q1可测的情况下,使q1跟踪参照信号yr,且最大允许误差为λ,参照信号yr满足 定义状态η1=q1,η2=q2, 和将系统的动态模型转换为空间状态表达:
[0013]
[0014] 其中, 是一个已知的常数,y是系统的输出信号。
[0015] 定义x5=u*, 和 i=2,3,4,将系统的空间状态表达转换为下三角结构的形式:
[0016]
[0017] 步骤2、设计高增益观测器。
[0018] 在单连杆机械臂系统只有连杆位移q1是可测的,因此步骤1建立的系统空间状态模型中只有y是已知的。利用系统输入输出信息来设计观测器重构系统状态以及未知的扰动,同时构造合适的自适应增益L,用于补偿系统不确定信息以及扰动带来的影响,得到高增益观测器:
[0019]T
[0020] 其中 是公式(3)中状态x=[x1,x2,x3,x4,x5]的估计值,a1、a2、5 4 3 2
a3、a4、a5均大于0,是赫尔维茨多项式p(s)=s+a1s+a2s+a3s+a4s+a5的系数, τ是任意的正常数。
[0021] 步骤3、设计基于事件触发的输出反馈控制器。
[0022] 基于经典控制方法,引入动态增益,并补偿系统中的扰动项,得到控制器:
[0023]
[0024] 其中k1、k2、k3、k4均大于0,是赫尔维茨多项式p(s)=s4+k1s3+k2s2+k3s+k4的系数。
[0025] 设计事件触发决策机制:
[0026]
[0027] 其中tk代表上一控制转换时刻,tk+1代表即将要控制转换的时刻,γ>0是可设计的参数代表控制器触发阈值,当 满足事件触发决策才传输控制信号,否则一直沿用tk时刻的控制信号。
[0028] 得到基于事件触发的控制器:
[0029]
[0030] 本发明具有以下有益效果:
[0031] 1、非线性机械臂系统的较为复杂,已知信息较少,而且存在传感器、执行机构或者其他因素产生的误差或者干扰,现有的研究结果无法给出合适的事件触发控制方案,本发明提出的控制器填充了这一领域的空白。
[0032] 2、非线性系统的实际跟踪问题要求连杆位移跟踪预先给定的轨迹,更符合实际生活的要求。
[0033] 3、实现非线性机械臂系统进行有效控制,使得其在运行时是稳定有界的,采用的事件触发控制是一种采样控制,可以减少不必要的信息传输,节省计算机的资源,进而减少机械臂系统马达的磨损。

实施方案

[0044] 以下结合附图对本发明作进一步的解释说明;
[0045] 基于事件触发的单连杆机械臂系统实际跟踪的控制方法,该方法包括以下步骤:
[0046] 步骤1、建立系统空间状态模型。
[0047] 根据牛顿定理以及相关的物理学原理,对如图1所示的单连杆机械臂系统进行分析,在不考虑机械臂系统本身形变的影响下,建立系统的动态描述方程:
[0048]
[0049] 其中,q1、q2分别表示t时刻连杆位移、电机转子位移,·、··分别表示一次求导与两次求导,Jl、Jm分别表示连杆惯性、电机转子惯性,k0代表弹性常数,g代表重力常数,m代表连接质量,l0代表质心,Fl、Fm分别表示连杆、电子转子的粘性摩擦系数,控制u代表马达传递的* *扭矩,u 代表由于传感器或者其他因素所造成的未知有界干扰,u ≤c,c是一个未知的正常数。
[0050] 设置控制目标为:在只有连杆位移q1可测的情况下,使q1跟踪参照信号yr,且最大允许误差为λ,参照信号yr满足 定义状态η1=q1,η2=q2, 和将系统的动态模型转换为空间状态表达:
[0051]
[0052] 其中, 是一个已知的常数,y是系统的输出信号。
[0053] 为了消去输入u前面的系数,定义x5=u*, 和 i=2,3,4,将系统的空间状态表达转换为下三角结构的形式:
[0054]
[0055] 步骤2、设计高增益观测器。
[0056] 由步骤1建立的系统空间状态模型可知,系统的状态大都不可测,因此无法用状态反馈控制方法来对系统进行控制,针对这种情况可以采用如图2所示的带有状态观测器的输出反馈控制方法,为了实现准确的控制,需要状态的确切信息,因此需要设计观测器对原系统状态进行估计,为了保证观测器能准确估计原系统的状态,首先要求观测器在形式上和原系统是一致的,又因为在单连杆机械臂系统只有连杆位移q1是可测的,因此模型中只有y是已知的。利用系统输入输出信息来设计观测器重构系统状态以及未知的扰动,同时构造合适的自适应增益L,用于补偿系统不确定信息以及扰动带来的影响,得到高增益观测器:
[0057]
[0058] 其中 是公式(3)中状态x=[x1,x2,x3,x4,x5]T的估计值,a1、a2、5 4 3 2
a3、a4、a5均大于0,是赫尔维茨多项式p(s)=s+a1s+a2s+a3s+a4s+a5的系数, τ是任意的正常数。L是自适应增益表达式中第一项保证系统的输出最终保持在[‑λ,λ]范围内,第二项保证此增益是有界的,第三项保证增益单调递增,初值使得增益始终大于1。
[0059] 步骤3、设计基于事件触发的输出反馈控制器。
[0060] 将步骤1建立的空间状态模型与步骤2建立的观测器视为一个新的系统,新系统的输出为观测器估计的状态,基于经典控制方法得到控制器:
[0061]
[0062] 其中u是控制信号,K是一系列设计参数,是观测器的输出状态。
[0063] 公式(5)展示的控制器并不能处理非线性系统,因此引入动态增益,并补偿系统中的扰动项,得到新的控制器:
[0064]
[0065] 其中k1、k2、k3、k4均大于0,是赫尔维茨多项式p(s)=s4+k1s3+k2s2+k3s+k4的系数。
[0066] 如图3所示,为了减少不必要的信息传输,引入一种机制来决定是否传输“控制信息”,且保证该传输的信息确实可以保证系统的稳定运行,从而减少传输信息的量,减少马达的磨损,设计事件触发决策机制:
[0067]
[0068] 其中tk代表上一控制转换时刻,tk+1代表即将要控制转换的时刻,γ>0是可设计的参数代表控制器触发阈值,当 满足事件触发决策才传输控制信号,否则一直沿用tk时刻的控制信号。
[0069] 得到基于事件触发的控制器:
[0070]
[0071] 步骤5、确定控制器参数。
[0072] 选择两组合适的赫尔维茨多项式系数,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,得到的观测器如下:
[0073]
[0074] 基于事件触发的控制器如下:
[0075]
[0076] 将其用于如表1所示参数的单连杆机械臂系统中,进行仿真实验。
[0077]
[0078] 表1
[0079] 利用表1中的参数值,可以得到原机械臂非线性系统的较确切的表达式,同时假设该系统的系统初始条件
[0080] 图4代表系统输出的状态轨迹图,可以看到系统的输出最总保持在[‑0.2,0.2]范围内实现了系统的实际跟踪,图5代表原系统状态η1和η2的状态轨迹图,图6是原系统状态η3和η4的状态轨迹图,图7是观测器估计状态 和 的状态轨迹图,图8是观测器估计状态 和的状态轨迹图,从图上可以看出系统在设计的控制器下的状态轨迹是有界的,图9代表动态增益L的状态轨迹,图10代表控制器u的轨迹。
[0081] 以下内容从理论角度,证明本方法得到的基于事件触发的控制器的有效性:
[0082] 定义矩阵A,K,D1和D2如下:
[0083]
[0084] 因为A和K是赫尔维茨矩阵,所以存在正定矩阵Q=QT和P=PT满足:
[0085]
[0086] 其中I代表适当维数的单位矩阵。
[0087] 首先选择如下的动态变换:
[0088]
[0089] 可以将系统空间状态模型(3)和高增益观测器(4)转换为如下的形式:
[0090]
[0091] 其中:
[0092]
[0093] 采用李亚普诺夫函数证明控制器可以实现系统的稳定运行以及实际跟踪。首先为机械臂系统构造一个李亚普诺夫函数
[0094] V=Vz+μVε=zTPz+μεTQε   (14)
[0095] 其中 基于上述变换对该李亚普诺夫函数求导可以得到:
[0096]
[0097] 进而可以得到:
[0098]
[0099] 其中 和△=2γ2||PC2
‖以及θ是未知的常数。
[0100] 证明(1)、证明L是有界的:
[0101] 根据解的存在唯一性定理和延拓定理,可以知道对于任意的初始条件闭环系统存在唯一的解在最大存在区间[0,Tm)上。采用反证法,首先假设L是无界的,即 那么一定存在一个时间T1,使得当t∈[T1,Tm), 成立,从而有
[0102]
[0103] 其中γ1是满足γ1V≤‖ε‖2+||z||2≤γ2V的常数。这意味着存在一个时间t2∈[t1,Tm),使得当t2≤t≤tm有
[0104]
[0105] 进而可以得到
[0106]
[0107] 定义Λ=LV,求导可得
[0108]
[0109] 这就意味着Λ是有界的,同时也意味着V是有界的且 因此:
[0110]
[0111] 而公式(19)和 矛盾,因此假设L无界不成立,即L是有界的。
[0112] 证明(2)、证明状态z是有界的。
[0113] 从证明(1)可知L是有界的,设置:
[0114]
[0115] 注意到Lyapunov函数Vz=zTPz,对其求导可得:
[0116]
[0117] 其中 λmax(P)代表矩阵P的最大特征值。
[0118] 注意到 进而可以得到
[0119]
[0120] 由公式(24)可以知道状态z是有界的。
[0121] 证明(3)、证明状态ε是有界的。
[0122] 重新选择坐标变换得到:
[0123]
[0124] 其中 通过系统状态模型(3)、观测器(4)以及(25)可以将系统重写为:
[0125]
[0126] 其中A在上述已经定义,而
[0127]
[0128] 构造一个正定的Lyapunov函数Vη=ηTQη,对其求导可得:
[0129]
[0130] 其中 λmax(Q)代表矩阵Q的最大特征值。注意到
[0131]
[0132] 因此对t∈[0,Tm)积分可以得到
[0133]
[0134] 由公式(29)可以知道状态η有界的,通过(12)和(25),可以知道状态ε也是有界的。
[0135] (4)证明Tm=+∞、没有Zeno现象发生。
[0136] 所述Zeno现象为在有限时间内控制无限次触发。
[0137] 首先假设Tm<+∞,可以得到:
[0138]
[0139] 由基于事件触发的控制器可知,存在一个正实数M使得下式成立
[0140]
[0141] 进一步可以得到:
[0142]
[0143] 进而可以得到:
[0144]
[0145] 因此 这也就意味着假设Tm<+∞是错误的,因此Tm=+∞以及Zeno现象不会发生。
[0146] (5)通过上述4个证明可以知道闭环系统的所有状态都是有界的,这也就意味着L(t)在[0,+∞)上是有界的以及 进一步通过 引理,可以得到:
[0147]
[0148] 从动态增益更新率中可以得知存在一个时间Tλ,当t>Tλ时
[0149]
[0150] 这也就意味着|y(t)|=|η1(t)‑yr(t)|≤λ,
[0151] 综上所述,设计的利用自适应技术基于事件触发的控制器方案最终可以实现机械臂系统的跟踪运行。

附图说明

[0034] 图1为单连杆机械臂系统结构图;
[0035] 图2为基于状态观测器的输出反馈控制原理;
[0036] 图3为基于事件触发的控制系统原理;
[0037] 图4是系统输出y的轨迹图;
[0038] 图5是状态η1和η2的状态轨迹图;
[0039] 图6是状态η3和η4的状态轨迹图;
[0040] 图7是估计状态 和 的状态轨迹图;
[0041] 图8是估计状态 和 的状态轨迹图;
[0042] 图9是动态增益L的状态轨迹图;
[0043] 图10是控制信号u的状态轨迹图。
版权所有:盲专网 ©2023 zlpt.xyz  蜀ICP备2023003576号