首页> 中国专利> 一种基于偏微分方程的柔性机械臂干扰观测器设计方法

一种基于偏微分方程的柔性机械臂干扰观测器设计方法

摘要

本发明是一种基于偏微分方程的柔性机械臂干扰观测器设计方法,它有四大步骤:步骤1:柔性机械臂的动力学建模;步骤2:干扰观测器的设计;步骤3:观测器稳定性的验证;步骤4:设计结束。本发明首先利用哈密尔顿原理,求出整个系统的PDE模型;然后基于该模型,设计合理的干扰观测器以估计外界的未知干扰;最后,通过设计合适的李雅普诺夫函数,对所设计的观测器进行分析,进而验证其稳定性。

著录项

  • 公开/公告号CN104020664A

    专利类型发明专利

  • 公开/公告日2014-09-03

    原文格式PDF

  • 申请/专利权人 国电科学技术研究院;

    申请/专利号CN201410261987.2

  • 发明设计人 陈彦桥;姜婷婷;刘金琨;

    申请日2014-06-12

  • 分类号G05B13/00;

  • 代理机构北京慧泉知识产权代理有限公司;

  • 代理人王顺荣

  • 地址 210031 江苏省南京市浦口区浦东路10号

  • 入库时间 2023-12-17 01:29:34

法律信息

  • 法律状态公告日

    法律状态信息

    法律状态

  • 2016-08-31

    授权

    授权

  • 2014-10-08

    实质审查的生效 IPC(主分类):G05B13/00 申请日:20140612

    实质审查的生效

  • 2014-09-03

    公开

    公开

说明书

技术领域

本发明涉及一种基于偏微分方程的柔性机械臂干扰观测器设计方法,它是针对柔性机械臂 的偏微分方程(Partial Differential Equation,PDE)动力学模型(以下简称PDE模型),而给出一种干 扰观测器的设计方法,属于机械臂控制技术领域。

背景技术

由于具有质量轻、速度快、能耗低等优点,柔性机械臂越来越多地应用于航天和工业领域。 以往,关于柔性机械臂观测器的研究大都基于常微分方程(Ordinary Differential Equation,ODE) 动力学模型(以下简称ODE模型)。ODE模型在形式上简单并为控制律设计提供了方便。然而, 由于ODE模型是通过忽略高阶振荡模态获得的,它难以精确描述柔性系统的分布式参数特性并 可能造成溢出不稳定性。因此,针对柔性机械臂的PDE模型进行干扰观测器的设计有重要的现 实意义。

传统的基于PDE模型的研究往往忽略了外部干扰的影响,然而在实际工作环境下,系统运 行时一般都会受到来自外界干扰的影响,比如柔性机械臂驱动电机的干扰等。于是,传统的研 究方式将会降低系统的性能。在这种技术背景下,针对柔性机械臂的PDE模型,本发明给出了 一种干扰观测器的设计方法。采用这种方法,可以实现对未知干扰的观测,从而为之后控制律 的研究打下良好的基础。

发明内容

1、发明目的

本发明是一种基于偏微分方程的柔性机械臂干扰观测器设计方法,其目的是:针对柔性机 械臂的PDE模型,克服现有研究方法的不足,给出一种干扰观测器及其具体的设计方法,使得 在外界干扰不确定的情况下,实现对干扰的准确估计。

2、技术方案

本发明设计思想是:针对柔性机械臂的PDE模型,设计合适的干扰观测器,再利用李雅普 诺夫函数,对所设计的观测器进行收敛性分析,以验证其合理性及稳定性。

下面结合流程框图1中的步骤,具体介绍该设计方法的技术方案。

本发明一种基于偏微分方程的柔性机械臂干扰观测器设计方法,该方法具体步骤如下:

步骤1:柔性机械臂动力学建模

本发明所针对的柔性机械臂的模型如图2所示,利用哈密尔顿原理,通过对系统的分析, 可以求出其PDE模型。

建模时用到的状态变量θ(t)、y(x,t)分别表示在t时刻机械臂的关节角度和x点处的弹性变 形。为了表示方便,以下分析中θ(t)、y(x,t)分别简写为θ、y(x)。

柔性机械臂的自然边界条件为

y(0)=yx(0)=0          (1)

其中,yx(*)表示y(*)对x的一阶偏导数。

定义

z(x)=xθ+y(x)          (2)

其中,z(x)为z(x,t)的简写,zx(*)表示z(*)对x的一阶偏导数。

由式(1)和式(2)可得z(0)=y(0),从而

z(0)=0,zx(0)=θ,nzxn=nyxn(n2)---(3)

由可得zxx(0)=yxx(0),zxx(L)=yxx(L),zxxx(L)=yxxx(L)。

系统的动能、势能以及非保守力做功的表达式如下

Ek=12Ihθ·2+120Lρz.2(x)dx+12mz.2(L)

Ep=120LEIzxx2(x)dx

Wnc=(τ+d1)θ+(F+d2)z(L)+0Lf(x)z(x)dx

其中,EI为均匀梁的弯曲刚度,L为机械臂的长度,m为机械臂末端负载的质量,Ih为中心 转动惯量,ρ为机械臂单位长度上的质量,τ为首端控制力矩输入,F为末端控制力矩输入, d1为首端控制输入慢时变干扰,d2为末端控制输入慢时变干扰。

由哈密尔顿原理可得柔性机械臂的PDE模型如下

ρz..(x)=-EIzxxxx(x)---(4a)

τ+d1=Ihθ..-EIzxx(0)---(4b)

F+d2=mz..(L)-EIzxxx(L)---(4c)

y(0)=yx(0)=yxx(L)=0       (4d)

步骤2:干扰观测器设计

根据柔性机械臂系统的模型信息,用估计输出与实际输出的差值对估计值进行修正,从而 设计出合适的干扰观测器,对系统受到的未知干扰进行准确的估计。

设计观测器的基本思想就是用估计输出与实际输出的差值对估计值进行修正,因此,取 d.1=L1(d1-d1),d.2=L2(d2-d2).其中,L1>0,L2>0,为对d1的估计,为对d2的 估计。

定义辅助参数向量w1=d1-P1(θ,θ·),w2=d2-P2(z(L),z.(L));其中,P1(θ,θ.)=L1Ihθ.,P2(z(L),z·(L))=L2mz.(L),P.1=(θ,θ.)=L1Ihθ..,P.2(z(L),z.(L))=L2mz..(L);

由(4b)可得则由上述各式可求得

d.1=L1(d1-d1)=L1(Ihθ..-EIzxx(0)-τ)-L1d1

w.1=d.1-P.1(θ,θ.)=L1(Ihθ..-EIZxx(0)-τ)-L1d1-L1Ihθ..=L1(-EIzxx(0)-τ)-L1d1---(5)

同理,由(4c)可得d2=mz..(L)-EIzxxx(L)-F,

d.2=L2(d2-d2)=L2(m..-EIzxxx(L)-)-L2d2

w.2=d.2-P.2(z(L)θ,.(L))=L2(m..(L)-EIZxx(L)-)-,L2d2-L2mz..(L)=L2(-EIzxxx(L)-)-L2d2---(6)

故干扰观测器设计为

w.1=L1(-EIzxxx(0)-τ)-L1d1d1=w1+P1(θ,θ.)---(7a)

w.2=L2(-EIzxxx(L)-)-L2d2d2=w2+P2(z(L)θ,θ.(L))---(7b)

由式(7a)和(7b)可得

w.1=L1(-EIzxx(0)-τ)-L1(w1+P1(θ,θ.))=L1(-EIzxx(0)-τ-P1(θ,θ.))-L1w1---(8)

w.2=L2(-EIzxxx(0)-)-L2(w2+P2(z(L)θ,θ.(L)))=L2(-EIzxx(L)--P2(z(L)θ,.(L)))-L2w2---(9)

定义干扰误差由于干扰均为慢时变干扰,可认为d.2=0,则可得

d~.1=d.1-d.1=-d.1---(10)

d~.2=d.2-d.2=-d.2---(11)

所以,由式(7a)至(11)以及和的表达式,可得观测误差方程为

d~.1=-d.1=-w.1-P.1(θ,θ.)=-L1(-EIzxx(0)-τ-P1(θ,θ.))+L1w1-L1Lhθ..=L1(w1+P1(θ,θ.))-L1(Ihθ..-EIzxx(0)-τ)=L1d1-L1d1=-L1d~1---(12)

d~.2=-d.2=-w.2-P.2(z(L)θ,.(L))=-L2(-EIzxxx(L)--P2(z(L)θ,.(L)))+L2w2-L2m..=L2(w2+P2(z(L)θ,.(L)))-L2(m..-EIzxxx(L)-)=L2d2-L2d2=-L2d~2---(13)

即通过设计L1、L2,使估计值按指数逼近干扰d1、 d2

针对定义P·1(θ,θ.)=L1Ihθ..,P..2(z(L),z.(L))=L2mz..(L),分别取P1(θ,θ.)=c1θ.,c1>0, P2(z(L),z·(L))=c2z.(L),c2>0,则可得

L1=c1Ih,L2=c2m---(14)

在仿真过程中,观测器的参数选为c1=5,c2=5;因为干扰是慢时变的,所以选取 d1(t)=10+0.1sin(t)(N·m),d2(t)=10+0.1sin(t)(N·m);控制输入力矩选取 τ=sin(t)(N·m),F=sin(t)(N·m);参数估计的初始值均为0.5(N·m),系 统其他物理参数如表1所示。

表1柔性机械臂物理参数的数值

步骤3:观测器稳定性的验证

基于上面设计的干扰观测器,设计合适的李雅普诺夫函数Vo(t),验证证明该观测器以指数形式收敛于零,是稳定的。

设计系统的李雅普诺夫函数为

Vo(t)=V1(t)+V2(t)

其中,V1(t)=12Ihd~12,V2(t)=12md~22;

V.1(t)=Ihd~1d~.1=Ihd~1(-L1d~1)=-L1Ihd~12=-c1d~12

V.2(t)=md~2d~.2=md~2(-L2d~2)=-L2md~22=-c2d~22

V.o(t)=V.1(t)+V.2(t)=-c1d~12-c2d~22-λ0Vo(t)

其中λ0=min(2c1Ih,2c2m);

所以,上述不等式的解为

Vo(t)Vo(0)e-λ0t

即当t→∞时,Vo(t)以指数形式收敛于零,系统是稳定的。

步骤4:设计结束

整个设计过程重点考虑三个方面,分别是柔性机械臂的动力学建模,干扰观测器的设计, 及其稳定性分析。围绕这三个方面,首先在上述步骤1中利用哈密尔顿原理求出了整个系统的 PDE模型;步骤2考虑系统外界干扰的不确定性,重点给出了干扰观测器的设计方法;步骤3 在所得到的观测器的基础上,给出了一种验证观测器稳定性的方法,对所设计的观测器进行了 分析。经过上述各步骤后,设计结束。

3、优点及功效

本发明的优点在于与目前存在的处理方法相比,这种方法在设计时,不仅考虑了柔性机械 臂的空间上的分布参数特性,而且还考虑了外界干扰的不确定性。在实际工程中,由于观测噪 声,很难通过微分速度信号来得到加速度信号,本发明通过设计辅助参数向量,在不需要加速 度信号的情况下,设计干扰观测器,实现柔性机械臂这种分布式参数系统的干扰观测。

附图说明

图1:本发明实施步骤流程框图

图2:本发明中柔性机械臂示意图

图3:本发明实施方式中的柔性机械臂干扰观测图

图4:本发明实施方式中的柔性机械臂干扰观测误差图

图中的标号、符号和线条等说明如下:

图2中,坐标轴XOY表示固定的惯性坐标系,坐标轴xOy表示随动坐标系。EI为均匀梁 的弯曲刚度,L为机械臂的长度,m为机械臂末端负载的质量,Ih为中心转动惯量,ρ为机 械臂单位长度上的质量,θ为关节角度,τ(t)为首端控制力矩输入,F(t)为末端控制力矩输 入,y(x,t)为机械臂的弹性变形,d1(t)为首端控制输入慢时变干扰,d2(t)为末端控制输入 慢时变干扰。图3–图4中的横坐标表示仿真时间,单位是秒;图3中的纵坐标表示外界干扰;图 3中的虚线分别表示干扰d1(t)、d2(t)的估计值,实线分别表示外界干扰d1(t)、d2(t)的实 际值;图4中的纵坐标分别表示干扰d1(t)、d2(t)的估计误差。

具体实施方式

下面将结合附图和技术方案对本发明做进一步的详细说明。

见图1,本发明一种基于偏微分方程的柔性机械臂干扰观测器设计方法,该方法具体步骤 如下:

步骤1:柔性机械臂动力学建模

柔性机械臂的模型如图2所示,其动力学建模采用哈密尔顿原理的方法。需要提前说明的 是,建模时用到的状态变量θ(t)、y(x,t)分别表示在t时刻机械臂的关节角度和x点处的弹性变 形。为了表示方便,以下分析中θ(t)、y(x,t)分别简写为θ、y(x)。

柔性机械臂的自然边界条件为

y(0)=yx(0)=0          (1)

其中,yx(*)表示y(*)对x的一阶偏导数。

定义

z(x)=xθ+y(x)          (2)

其中,z(x)为z(x,t)的简写,zx(*)表示z(*)对x的一阶偏导数。

由式(1)和式(2)可得z(0)=y(0),从而

z(0)=0,zx(0)=θ,nzxn=nyxn(n2)---(3)

由可得zxx(0)=yxx(0),zxx(L)=yxx(L),zxxx(L)=yxxx(L)。

系统的动能、势能以及非保守力做功的表达式如下

Ek=12Ihθ·2+120Lρz.2(x)dx+12mz.2(L)

Ep=120LEIzxx2(x)dx

Wnc=(τ+d1)θ+(F+d2)z(L)+0Lf(x)z(x)dx

其中,EI为均匀梁的弯曲刚度,L为机械臂的长度,m为机械臂末端负载的质量,Ih为中心 转动惯量,ρ为机械臂单位长度上的质量,τ为首端控制力矩输入,F为末端控制力矩输入, d1为首端控制输入慢时变干扰,d2为末端控制输入慢时变干扰。

由哈密尔顿原理可得柔性机械臂的PDE模型如下

ρz..(x)=-EIzxxxx(x)---(4a)

τ+d1=Ihθ..-EIzxx(0)---(4b)

F+d2=mz..(L)-EIzxxx(L)---(4c)

y(0)=yx(0)=yxx(L)=0       (4d)

步骤2:干扰观测器设计

设计观测器的基本思想就是用估计输出与实际输出的差值对估计值进行修正,因此,取 d.1=L1(d1-d1),d.2=L2(d2-d2).其中,L1>0,L2>0,为对d1的估计,为对d2的 估计。

定义辅助参数向量w1=d1-P1(θ,θ·),w2=d2-P2(z(L),z.(L));其中,P1(θ,θ.)=L1Ihθ.,P2(z(L),z·(L))=L2mz.(L),P.1=(θ,θ.)=L1Ihθ..,P.2(z(L),z.(L))=L2mz..(L);

由(4b)可得则由上述各式可求得

d.1=L1(d1-d1)=L1(Ihθ..-EIzxx(0)-τ)-L1d1

w.1=d.1-P.1(θ,θ.)=L1(Ihθ..-EIZxx(0)-τ)-L1d1-L1Ihθ..=L1(-EIzxx(0)-τ)-L1d1---(5)

同理,由(4c)可得d2=mz..(L)-EIzxxx(L)-F,

d.2=L2(d2-d2)=L2(m..-EIzxxx(L)-)-L2d2

w.2=d.2-P.2(z(L)θ,.(L))=L2(m..(L)-EIZxx(L)-)-,L2d2-L2mz..(L)=L2(-EIzxxx(L)-)-L2d2---(6)

故干扰观测器设计为

w.1=L1(-EIzxxx(0)-τ)-L1d1d1=w1+P1(θ,θ.)---(7a)

w.2=L2(-EIzxxx(L)-)-L2d2d2=w2+P2(z(L)θ,θ.(L))---(7b)

由式(7a)和(7b)可得

w.1=L1(-EIzxx(0)-τ)-L1(w1+P1(θ,θ.))=L1(-EIzxx(0)-τ-P1(θ,θ.))-L1w1---(8)

w.2=L2(-EIzxxx(0)-)-L2(w2+P2(z(L)θ,θ.(L)))=L2(-EIzxx(L)--P2(z(L)θ,.(L)))-L2w2---(9)

定义干扰误差由于干扰均为慢时变干扰,可认为d.2=0,则可得

d~.1=d.1-d.1=-d.1---(10)

d~.2=d.2-d.2=-d.2---(11)

所以,由式(7a)至(11)以及和P2(z(L),)的表达式,可得观测误差方程为

d~.1=-d.1=-w.1-P.1(θ,θ.)=-L1(-EIzxx(0)-τ-P1(θ,θ.))+L1w1-L1Lhθ..=L1(w1+P1(θ,θ.))-L1(Ihθ..-EIzxx(0)-τ)=L1d1-L1d1=-L1d~1---(12)

d~.2=-d.2=-w.2-P.2(z(L)θ,.(L))=-L2(-EIzxxx(L)--P2(z(L)θ,.(L)))+L2w2-L2m..=L2(w2+P2(z(L)θ,.(L)))-L2(m..-EIzxxx(L)-)=L2d2-L2d2=-L2d~2---(13)

即通过设计L1、L2,使估计值按指数逼近干扰d1、 d2

针对定义P·1(θ,θ.)=L1Ihθ..,P..2(z(L),z.(L))=L2mz..(L),分别取c1>0, P2(z(L),z·(L))=c2z.(L),c2>0,则可得

L1=c1Ih,L2=c2m---(14)

在仿真过程中,观测器的参数选为c1=5,c2=5;因为干扰是慢时变的,所以选取 d1(t)=10+0.1sin(t)(N·m),d2(t)=10+0.1sin(t)(N·m);控制输入力矩选取 τ=sin(t)(N·m),F=sin(t)(N·m);参数估计的初始值均为0.5(N·m),系 统其他物理参数如表1所示。

表1柔性机械臂物理参数的数值

步骤3:观测器稳定性的验证

设计系统的李雅普诺夫函数为

Vo(t)=V1(t)+V2(t)

其中,V1(t)=12Ihd~12,V2(t)=12md~22;

V.1(t)=Ihd~1d~.1=Ihd~1(-L1d~1)=-L1Ihd~12=-c1d~12

V.2(t)=md~2d~.2=md~2(-L2d~2)=-L2md~22=-c2d~22

V.o(t)=V.1(t)+V.2(t)=-c1d~12-c2d~22-λ0Vo(t)

其中λ0=min(2c1Ih,2c2m);

所以,上述不等式的解为

Vo(t)Vo(0)e-λ0t

即当t→∞时,Vo(t)以指数形式收敛于零,系统是稳定的。

图3是本发明实施方式中的柔性机械臂干扰观测图,图4是本发明实施方式中的柔性机械臂 干扰观测误差图。

步骤4:设计结束

整个设计过程重点考虑了三个方面,首先是实现了柔性机械臂的动力学建模,其次针对未 知的外界干扰设计了合适的干扰观测器,最后利用李雅普诺夫函数,对设计出的观测器进行稳 定性分析。

综上所述,针对柔性机械臂的PDE模型,利用上述干扰观测器,可以在不需要加速度信号 且外界干扰不确定的情况下,实现对干扰的准确估计。

去获取专利,查看全文>

相似文献

  • 专利
  • 中文文献
  • 外文文献
获取专利

客服邮箱:kefu@zhangqiaokeyan.com

京公网安备:11010802029741号 ICP备案号:京ICP备15016152号-6 六维联合信息科技 (北京) 有限公司©版权所有
  • 客服微信

  • 服务号