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

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

Info

Publication number
CN104020664A
CN104020664A CN201410261987.2A CN201410261987A CN104020664A CN 104020664 A CN104020664 A CN 104020664A CN 201410261987 A CN201410261987 A CN 201410261987A CN 104020664 A CN104020664 A CN 104020664A
Authority
CN
China
Prior art keywords
theta
cap
eiz
tau
mechanical arm
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Granted
Application number
CN201410261987.2A
Other languages
English (en)
Other versions
CN104020664B (zh
Inventor
陈彦桥
姜婷婷
刘金琨
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Guodian Science and Technology Research Institute Co Ltd
Original Assignee
Guodian Science and Technology Research Institute Co Ltd
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Guodian Science and Technology Research Institute Co Ltd filed Critical Guodian Science and Technology Research Institute Co Ltd
Priority to CN201410261987.2A priority Critical patent/CN104020664B/zh
Publication of CN104020664A publication Critical patent/CN104020664A/zh
Application granted granted Critical
Publication of CN104020664B publication Critical patent/CN104020664B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Landscapes

  • Feedback Control In General (AREA)

Abstract

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

Description

一种基于偏微分方程的柔性机械臂干扰观测器设计方法
技术领域
本发明涉及一种基于偏微分方程的柔性机械臂干扰观测器设计方法,它是针对柔性机械臂的偏微分方程(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 , z x ( 0 ) = θ , ∂ n z ∂ x n = ∂ n y ∂ x n ( n ≥ 2 ) - - - ( 3 )
可得zxx(0)=yxx(0),zxx(L)=yxx(L),zxxx(L)=yxxx(L)。
系统的动能、势能以及非保守力做功的表达式如下
E k = 1 2 I h θ · 2 + 1 2 ∫ 0 L ρ z . 2 ( x ) dx + 1 2 m z . 2 ( L )
E p = 1 2 ∫ 0 L EIz xx 2 ( x ) dx
W nc = ( τ + d 1 ) θ + ( F + d 2 ) z ( L ) + ∫ 0 L f ( x ) z ( x ) dx
其中,EI为均匀梁的弯曲刚度,L为机械臂的长度,m为机械臂末端负载的质量,Ih为中心转动惯量,ρ为机械臂单位长度上的质量,τ为首端控制力矩输入,F为末端控制力矩输入,d1为首端控制输入慢时变干扰,d2为末端控制输入慢时变干扰。
由哈密尔顿原理可得柔性机械臂的PDE模型如下
ρ z . . ( x ) = - EIz xxxx ( x ) - - - ( 4 a )
τ + d 1 = I h θ . . - EIz xx ( 0 ) - - - ( 4 b )
F + d 2 = m z . . ( L ) - EIz xxx ( L ) - - - ( 4 c )
y(0)=yx(0)=yxx(L)=0       (4d)
步骤2:干扰观测器设计
根据柔性机械臂系统的模型信息,用估计输出与实际输出的差值对估计值进行修正,从而设计出合适的干扰观测器,对系统受到的未知干扰进行准确的估计。
设计观测器的基本思想就是用估计输出与实际输出的差值对估计值进行修正,因此,取 d ∩ . 1 = L 1 ( d 1 - d ∩ 1 ) , d ∩ . 2 = L 2 ( d 2 - d ∩ 2 ) . 其中,L1>0,L2>0,为对d1的估计,为对d2的估计。
定义辅助参数向量 w 1 = d ∩ 1 - P 1 ( θ , θ · ) , w 2 = d ∩ 2 - P 2 ( z ( L ) , z . ( L ) ) ; 其中, P 1 ( θ , θ . ) = L 1 I h θ . , P 2 ( z ( L ) , z · ( L ) ) = L 2 m z . ( L ) , P . 1 = ( θ , θ . ) = L 1 I h θ . . , P . 2 ( z ( L ) , z . ( L ) ) = L 2 m z . . ( L ) ;
由(4b)可得则由上述各式可求得
d ∩ . 1 = L 1 ( d 1 - d ∩ 1 ) = L 1 ( I h θ . . - EIz xx ( 0 ) - τ ) - L 1 d ∩ 1
w . 1 = d ∩ . 1 - P . 1 ( θ , θ . ) = L 1 ( I h θ . . - EIZ xx ( 0 ) - τ ) - L 1 d ∩ 1 - L 1 I h θ . . = L 1 ( - EIz xx ( 0 ) - τ ) - L 1 d ∩ 1 - - - ( 5 )
同理,由(4c)可得 d 2 = m z . . ( L ) - EIz xxx ( L ) - F ,
d ∩ . 2 = L 2 ( d 2 - d ∩ 2 ) = L 2 ( m zθ . . - EIz xxx ( L ) - Fτ ) - L 2 d ∩ 2
w . 2 = d ∩ . 2 - P . 2 ( z ( L ) θ , zθ . ( L ) ) = L 2 ( m zθ . . ( L ) - EIZ xx ( L ) - Fτ ) - , L 2 d ∩ 2 - L 2 m z . . ( L ) = L 2 ( - EIz xxx ( L ) - Fτ ) - L 2 d ∩ 2 - - - ( 6 )
故干扰观测器设计为
w . 1 = L 1 ( - EIz xxx ( 0 ) - τ ) - L 1 d ∩ 1 d ∩ 1 = w 1 + P 1 ( θ , θ . ) - - - ( 7 a )
w . 2 = L 2 ( - EIz xxx ( L ) - Fτ ) - L 2 d ∩ 2 d ∩ 2 = w 2 + P 2 ( z ( L ) θ , θ . ( L ) ) - - - ( 7 b )
由式(7a)和(7b)可得
w . 1 = L 1 ( - EIz xx ( 0 ) - τ ) - L 1 ( w 1 + P 1 ( θ , θ . ) ) = L 1 ( - EIz xx ( 0 ) - τ - P 1 ( θ , θ . ) ) - L 1 w 1 - - - ( 8 )
w . 2 = L 2 ( - EIz xxx ( 0 ) - Fτ ) - L 2 ( w 2 + P 2 ( z ( L ) θ , θ . ( L ) ) ) = L 2 ( - EIz xx ( L ) - Fτ - P 2 ( z ( L ) θ , zθ . ( L ) ) ) - L 2 w 2 - - - ( 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 ( θ , θ . ) = - L 1 ( - EIz xx ( 0 ) - τ - P 1 ( θ , θ . ) ) + L 1 w 1 - L 1 L h θ . . = L 1 ( w 1 + P 1 ( θ , θ . ) ) - L 1 ( I h θ . . - EIz xx ( 0 ) - τ ) = L 1 d ∩ 1 - L 1 d 1 = - L 1 d ~ 1 - - - ( 12 )
d ~ . 2 = - d ∩ . 2 = - w . 2 - P . 2 ( z ( L ) θ , zθ . ( L ) ) = - L 2 ( - EIz xxx ( L ) - Fτ - P 2 ( z ( L ) θ , zθ . ( L ) ) ) + L 2 w 2 - L 2 m zθ . . = L 2 ( w 2 + P 2 ( z ( L ) θ , zθ . ( L ) ) ) - L 2 ( m zθ . . - EIz xxx ( L ) - Fτ ) = L 2 d ∩ 2 - L 2 d 2 = - L 2 d ~ 2 - - - ( 13 )
通过设计L1、L2,使估计值按指数逼近干扰d1、d2
针对定义 P · 1 ( θ , θ . ) = L 1 I h θ . . , P . . 2 ( z ( L ) , z . ( L ) ) = L 2 m z . . ( L ) , 分别取 P 1 ( θ , θ . ) = c 1 θ . , c1>0, P 2 ( z ( L ) , z · ( L ) ) = c 2 z . ( L ) , c2>0,则可得
L 1 = c 1 I h , L 2 = c 2 m - - - ( 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)
其中, V 1 ( t ) = 1 2 I h d ~ 1 2 , V 2 ( t ) = 1 2 m d ~ 2 2 ;
V . 1 ( t ) = I h d ~ 1 d ~ . 1 = I h d ~ 1 ( - L 1 d ~ 1 ) = - L 1 I h d ~ 1 2 = - c 1 d ~ 1 2
V . 2 ( t ) = m d ~ 2 d ~ . 2 = m d ~ 2 ( - L 2 d ~ 2 ) = - L 2 m d ~ 2 2 = - c 2 d ~ 2 2
V . o ( t ) = V . 1 ( t ) + V . 2 ( t ) = - c 1 d ~ 1 2 - c 2 d ~ 2 2 ≤ - λ 0 V o ( t )
其中 λ 0 = min ( 2 c 1 I h , 2 c 2 m ) ;
所以,上述不等式的解为
V o ( t ) ≤ V o ( 0 ) e - λ 0 t
即当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 , z x ( 0 ) = θ , ∂ n z ∂ x n = ∂ n y ∂ x n ( n ≥ 2 ) - - - ( 3 )
可得zxx(0)=yxx(0),zxx(L)=yxx(L),zxxx(L)=yxxx(L)。
系统的动能、势能以及非保守力做功的表达式如下
E k = 1 2 I h θ · 2 + 1 2 ∫ 0 L ρ z . 2 ( x ) dx + 1 2 m z . 2 ( L )
E p = 1 2 ∫ 0 L EIz xx 2 ( x ) dx
W nc = ( τ + d 1 ) θ + ( F + d 2 ) z ( L ) + ∫ 0 L f ( x ) z ( x ) dx
其中,EI为均匀梁的弯曲刚度,L为机械臂的长度,m为机械臂末端负载的质量,Ih为中心转动惯量,ρ为机械臂单位长度上的质量,τ为首端控制力矩输入,F为末端控制力矩输入,d1为首端控制输入慢时变干扰,d2为末端控制输入慢时变干扰。
由哈密尔顿原理可得柔性机械臂的PDE模型如下
ρ z . . ( x ) = - EIz xxxx ( x ) - - - ( 4 a )
τ + d 1 = I h θ . . - EIz xx ( 0 ) - - - ( 4 b )
F + d 2 = m z . . ( L ) - EIz xxx ( L ) - - - ( 4 c )
y(0)=yx(0)=yxx(L)=0       (4d)
步骤2:干扰观测器设计
设计观测器的基本思想就是用估计输出与实际输出的差值对估计值进行修正,因此,取 d ∩ . 1 = L 1 ( d 1 - d ∩ 1 ) , d ∩ . 2 = L 2 ( d 2 - d ∩ 2 ) . 其中,L1>0,L2>0,为对d1的估计,为对d2的估计。
定义辅助参数向量 w 1 = d ∩ 1 - P 1 ( θ , θ · ) , w 2 = d ∩ 2 - P 2 ( z ( L ) , z . ( L ) ) ; 其中, P 1 ( θ , θ . ) = L 1 I h θ . , P 2 ( z ( L ) , z · ( L ) ) = L 2 m z . ( L ) , P . 1 = ( θ , θ . ) = L 1 I h θ . . , P . 2 ( z ( L ) , z . ( L ) ) = L 2 m z . . ( L ) ;
由(4b)可得则由上述各式可求得
d ∩ . 1 = L 1 ( d 1 - d ∩ 1 ) = L 1 ( I h θ . . - EIz xx ( 0 ) - τ ) - L 1 d ∩ 1
w . 1 = d ∩ . 1 - P . 1 ( θ , θ . ) = L 1 ( I h θ . . - EIZ xx ( 0 ) - τ ) - L 1 d ∩ 1 - L 1 I h θ . . = L 1 ( - EIz xx ( 0 ) - τ ) - L 1 d ∩ 1 - - - ( 5 )
同理,由(4c)可得 d 2 = m z . . ( L ) - EIz xxx ( L ) - F ,
d ∩ . 2 = L 2 ( d 2 - d ∩ 2 ) = L 2 ( m zθ . . - EIz xxx ( L ) - Fτ ) - L 2 d ∩ 2
w . 2 = d ∩ . 2 - P . 2 ( z ( L ) θ , zθ . ( L ) ) = L 2 ( m zθ . . ( L ) - EIZ xx ( L ) - Fτ ) - , L 2 d ∩ 2 - L 2 m z . . ( L ) = L 2 ( - EIz xxx ( L ) - Fτ ) - L 2 d ∩ 2 - - - ( 6 )
故干扰观测器设计为
w . 1 = L 1 ( - EIz xxx ( 0 ) - τ ) - L 1 d ∩ 1 d ∩ 1 = w 1 + P 1 ( θ , θ . ) - - - ( 7 a )
w . 2 = L 2 ( - EIz xxx ( L ) - Fτ ) - L 2 d ∩ 2 d ∩ 2 = w 2 + P 2 ( z ( L ) θ , θ . ( L ) ) - - - ( 7 b )
由式(7a)和(7b)可得
w . 1 = L 1 ( - EIz xx ( 0 ) - τ ) - L 1 ( w 1 + P 1 ( θ , θ . ) ) = L 1 ( - EIz xx ( 0 ) - τ - P 1 ( θ , θ . ) ) - L 1 w 1 - - - ( 8 )
w . 2 = L 2 ( - EIz xxx ( 0 ) - Fτ ) - L 2 ( w 2 + P 2 ( z ( L ) θ , θ . ( L ) ) ) = L 2 ( - EIz xx ( L ) - Fτ - P 2 ( z ( L ) θ , zθ . ( L ) ) ) - L 2 w 2 - - - ( 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 ( θ , θ . ) = - L 1 ( - EIz xx ( 0 ) - τ - P 1 ( θ , θ . ) ) + L 1 w 1 - L 1 L h θ . . = L 1 ( w 1 + P 1 ( θ , θ . ) ) - L 1 ( I h θ . . - EIz xx ( 0 ) - τ ) = L 1 d ∩ 1 - L 1 d 1 = - L 1 d ~ 1 - - - ( 12 )
d ~ . 2 = - d ∩ . 2 = - w . 2 - P . 2 ( z ( L ) θ , zθ . ( L ) ) = - L 2 ( - EIz xxx ( L ) - Fτ - P 2 ( z ( L ) θ , zθ . ( L ) ) ) + L 2 w 2 - L 2 m zθ . . = L 2 ( w 2 + P 2 ( z ( L ) θ , zθ . ( L ) ) ) - L 2 ( m zθ . . - EIz xxx ( L ) - Fτ ) = L 2 d ∩ 2 - L 2 d 2 = - L 2 d ~ 2 - - - ( 13 )
通过设计L1、L2,使估计值按指数逼近干扰d1、d2
针对定义 P · 1 ( θ , θ . ) = L 1 I h θ . . , P . . 2 ( z ( L ) , z . ( L ) ) = L 2 m z . . ( L ) , 分别取c1>0, P 2 ( z ( L ) , z · ( L ) ) = c 2 z . ( L ) , c2>0,则可得
L 1 = c 1 I h , L 2 = c 2 m - - - ( 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)
其中, V 1 ( t ) = 1 2 I h d ~ 1 2 , V 2 ( t ) = 1 2 m d ~ 2 2 ;
V . 1 ( t ) = I h d ~ 1 d ~ . 1 = I h d ~ 1 ( - L 1 d ~ 1 ) = - L 1 I h d ~ 1 2 = - c 1 d ~ 1 2
V . 2 ( t ) = m d ~ 2 d ~ . 2 = m d ~ 2 ( - L 2 d ~ 2 ) = - L 2 m d ~ 2 2 = - c 2 d ~ 2 2
V . o ( t ) = V . 1 ( t ) + V . 2 ( t ) = - c 1 d ~ 1 2 - c 2 d ~ 2 2 ≤ - λ 0 V o ( t )
其中 λ 0 = min ( 2 c 1 I h , 2 c 2 m ) ;
所以,上述不等式的解为
V o ( t ) ≤ V o ( 0 ) e - λ 0 t
即当t→∞时,Vo(t)以指数形式收敛于零,系统是稳定的。
图3是本发明实施方式中的柔性机械臂干扰观测图,图4是本发明实施方式中的柔性机械臂干扰观测误差图。
步骤4:设计结束
整个设计过程重点考虑了三个方面,首先是实现了柔性机械臂的动力学建模,其次针对未知的外界干扰设计了合适的干扰观测器,最后利用李雅普诺夫函数,对设计出的观测器进行稳定性分析。
综上所述,针对柔性机械臂的PDE模型,利用上述干扰观测器,可以在不需要加速度信号且外界干扰不确定的情况下,实现对干扰的准确估计。

Claims (1)

1.一种基于偏微分方程的柔性机械臂干扰观测器设计方法,其特征在于:该方法包括以下步骤:
步骤1:柔性机械臂动力学建模
柔性机械臂的动力学建模采用哈密尔顿原理的方法,建模时用到的状态变量θ(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 , z x ( 0 ) = θ , ∂ n z ∂ x n = ∂ n y ∂ x n ( n ≥ 2 ) - - - ( 3 )
得zxx(0)=yxx(0),zxx(L)=yxx(L),zxxx(L)=yxxx(L);
系统的动能、势能以及非保守力做功的表达式如下
E k = 1 2 I h θ · 2 + 1 2 ∫ 0 L ρ z . 2 ( x ) dx + 1 2 m z . 2 ( L )
E p = 1 2 ∫ 0 L EIz xx 2 ( x ) dx
W nc = ( τ + d 1 ) θ + ( F + d 2 ) z ( L ) + ∫ 0 L f ( x ) z ( x ) dx
其中,EI为均匀梁的弯曲刚度,L为机械臂的长度,m为机械臂末端负载的质量,Ih为中心转动惯量,ρ为机械臂单位长度上的质量,τ为首端控制力矩输入,F为末端控制力矩输入,d1为首端控制输入慢时变干扰,d2为末端控制输入慢时变干扰;
由哈密尔顿原理得柔性机械臂的PDE模型如下
ρ z . . ( x ) = - EIz xxxx ( x ) - - - ( 4 a )
τ + d 1 = I h θ . . - EIz xx ( 0 ) - - - ( 4 b )
F + d 2 = m z . . ( L ) - EIz xxx ( L ) - - - ( 4 c )
y(0)=yx(0)=yxx(L)=0     (4d)
步骤2:干扰观测器设计
设计观测器的基本思想就是用估计输出与实际输出的差值对估计值进行修正,因此,取 d ∩ . 1 = L 1 ( d 1 - d ∩ 1 ) , d ∩ . 2 = L 2 ( d 2 - d ∩ 2 ) , 其中,L1>0,L2>0,为对d1的估计,为对d2的估计;
定义辅助参数向量 w 1 = d ∩ 1 - P 1 ( θ , θ · ) , w 2 = d ∩ 2 - P 2 ( z ( L ) , z . ( L ) ) ; 其中, P 1 ( θ , θ . ) = L 1 I h θ . , P 2 ( z ( L ) , z · ( L ) ) = L 2 m z . ( L ) , P . 1 = ( θ , θ . ) = L 1 I h θ . . , P . 2 ( z ( L ) , z . ( L ) ) = L 2 m z . . ( L ) ;
由(4b)得则由上述各式求得
d ∩ . 1 = L 1 ( d 1 - d ∩ 1 ) = L 1 ( I h θ . . - EIz xx ( 0 ) - τ ) - L 1 d ∩ 1
w . 1 = d ∩ . 1 - P . 1 ( θ , θ . ) = L 1 ( I h θ . . - EIZ xx ( 0 ) - τ ) - L 1 d ∩ 1 - L 1 I h θ . . = L 1 ( - EIz xx ( 0 ) - τ ) - L 1 d ∩ 1 - - - ( 5 )
同理,由(4c)可得 d 2 = m z . . ( L ) - EIz xxx ( L ) - F ,
d ∩ . 2 = L 2 ( d 2 - d ∩ 2 ) = L 2 ( m zθ . . - EIz xxx ( L ) - Fτ ) - L 2 d ∩ 2
w . 2 = d ∩ . 2 - P . 2 ( z ( L ) θ , zθ . ( L ) ) = L 2 ( m zθ . . ( L ) - EIZ xx ( L ) - Fτ ) - , L 2 d ∩ 2 - L 2 m z . . ( L ) = L 2 ( - EIz xxx ( L ) - Fτ ) - L 2 d ∩ 2 - - - ( 6 )
故干扰观测器设计为
w . 1 = L 1 ( - EIz xxx ( 0 ) - τ ) - L 1 d ∩ 1 d ∩ 1 = w 1 + P 1 ( θ , θ . ) - - - ( 7 a )
w . 2 = L 2 ( - EIz xxx ( L ) - Fτ ) - L 2 d ∩ 2 d ∩ 2 = w 2 + P 2 ( z ( L ) θ , θ . ( L ) ) - - - ( 7 b )
由式(7a)和(7b)得
w . 1 = L 1 ( - EIz xx ( 0 ) - τ ) - L 1 ( w 1 + P 1 ( θ , θ . ) ) = L 1 ( - EIz xx ( 0 ) - τ - P 1 ( θ , θ . ) ) - L 1 w 1 - - - ( 8 )
w . 2 = L 2 ( - EIz xxx ( 0 ) - Fτ ) - L 2 ( w 2 + P 2 ( z ( L ) θ , θ . ( L ) ) ) = L 2 ( - EIz xx ( L ) - Fτ - P 2 ( z ( L ) θ , zθ . ( L ) ) ) - L 2 w 2 - - - ( 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 ( θ , θ . ) = - L 1 ( - EIz xx ( 0 ) - τ - P 1 ( θ , θ . ) ) + L 1 w 1 - L 1 L h θ . . = L 1 ( w 1 + P 1 ( θ , θ . ) ) - L 1 ( I h θ . . - EIz xx ( 0 ) - τ ) = L 1 d ∩ 1 - L 1 d 1 = - L 1 d ~ 1 - - - ( 12 )
d ~ . 2 = - d ∩ . 2 = - w . 2 - P . 2 ( z ( L ) θ , zθ . ( L ) ) = - L 2 ( - EIz xxx ( L ) - Fτ - P 2 ( z ( L ) θ , zθ . ( L ) ) ) + L 2 w 2 - L 2 m zθ . . = L 2 ( w 2 + P 2 ( z ( L ) θ , zθ . ( L ) ) ) - L 2 ( m zθ . . - EIz xxx ( L ) - Fτ ) = L 2 d ∩ 2 - L 2 d 2 = - L 2 d ~ 2 - - - ( 13 )
通过设计L1、L2,使估计值按指数逼近干扰d1、d2
针对定义 P · 1 ( θ , θ . ) = L 1 I h θ . . , P . . 2 ( z ( L ) , z . ( L ) ) = L 2 m z . . ( L ) , 分别取 P 1 ( θ , θ . ) = c 1 θ . , c1>0, P 2 ( z ( L ) , z · ( L ) ) = c 2 z . ( L ) , c2>0,则得
L 1 = c 1 I h , L 2 = c 2 m - - - ( 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)
其中, V 1 ( t ) = 1 2 I h d ~ 1 2 , V 2 ( t ) = 1 2 m d ~ 2 2 ;
V . 1 ( t ) = I h d ~ 1 d ~ . 1 = I h d ~ 1 ( - L 1 d ~ 1 ) = - L 1 I h d ~ 1 2 = - c 1 d ~ 1 2
V . 2 ( t ) = m d ~ 2 d ~ . 2 = m d ~ 2 ( - L 2 d ~ 2 ) = - L 2 m d ~ 2 2 = - c 2 d ~ 2 2
V . o ( t ) = V . 1 ( t ) + V . 2 ( t ) = - c 1 d ~ 1 2 - c 2 d ~ 2 2 ≤ - λ 0 V o ( t )
其中 λ 0 = min ( 2 c 1 I h , 2 c 2 m ) ;
所以,上述不等式的解为
V o ( t ) ≤ V o ( 0 ) e - λ 0 t
即当t→∞时,Vo(t)以指数形式收敛于零,系统是稳定的;
步骤4:设计结束
整个设计过程重点考虑三个方面,首先是实现了柔性机械臂的动力学建模,其次针对未知的外界设计了合适的干扰观测器,最后利用李雅普诺夫函数,对设计出的观测器进行稳定性分析;综上所述,针对柔性机械臂的PDE模型,利用上述干扰观测器,在外界干扰不确定的情况下,实现对干扰的准确估计。
CN201410261987.2A 2014-06-12 2014-06-12 一种基于偏微分方程的柔性机械臂干扰观测器设计方法 Active CN104020664B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201410261987.2A CN104020664B (zh) 2014-06-12 2014-06-12 一种基于偏微分方程的柔性机械臂干扰观测器设计方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201410261987.2A CN104020664B (zh) 2014-06-12 2014-06-12 一种基于偏微分方程的柔性机械臂干扰观测器设计方法

Publications (2)

Publication Number Publication Date
CN104020664A true CN104020664A (zh) 2014-09-03
CN104020664B CN104020664B (zh) 2016-08-31

Family

ID=51437481

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201410261987.2A Active CN104020664B (zh) 2014-06-12 2014-06-12 一种基于偏微分方程的柔性机械臂干扰观测器设计方法

Country Status (1)

Country Link
CN (1) CN104020664B (zh)

Cited By (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN104570741A (zh) * 2015-01-22 2015-04-29 华南理工大学 一种柔性机械臂横向振动pd边界控制模拟方法
CN108015761A (zh) * 2016-11-02 2018-05-11 香港理工大学深圳研究院 一种单连杆柔性机械臂控制方法及系统
CN109240092A (zh) * 2018-11-30 2019-01-18 长春工业大学 基于多智能体可重构模块化柔性机械臂轨迹跟踪控制方法
CN110774286A (zh) * 2019-11-22 2020-02-11 天津理工大学 一种基于刚柔耦合动力学的五自由度机械手的控制方法

Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US5091683A (en) * 1989-09-20 1992-02-25 Seiko Instruments Inc. Servo control apparatus
JP2007043884A (ja) * 2005-06-30 2007-02-15 Juki Corp 多慣性共振系の振動抑制制御方法及び装置
CN102540881A (zh) * 2012-02-17 2012-07-04 国电科学技术研究院 基于柔性机械臂的偏微分模型的边界控制律的设计方法
CN102591207A (zh) * 2012-03-01 2012-07-18 北京航空航天大学 一种基于干扰观测器的柔性关节机械臂的滑模控制方法

Patent Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US5091683A (en) * 1989-09-20 1992-02-25 Seiko Instruments Inc. Servo control apparatus
JP2007043884A (ja) * 2005-06-30 2007-02-15 Juki Corp 多慣性共振系の振動抑制制御方法及び装置
CN102540881A (zh) * 2012-02-17 2012-07-04 国电科学技术研究院 基于柔性机械臂的偏微分模型的边界控制律的设计方法
CN102591207A (zh) * 2012-03-01 2012-07-18 北京航空航天大学 一种基于干扰观测器的柔性关节机械臂的滑模控制方法

Non-Patent Citations (3)

* Cited by examiner, † Cited by third party
Title
于登云等: "空间机械臂关节动力学建模与分析的研究进展", 《航天器工程》, vol. 19, no. 2, 31 March 2010 (2010-03-31), pages 1 - 10 *
王光庆等: "空间柔性臂的解耦动力学模型及其控制", 《宇航学报》, vol. 25, no. 5, 30 September 2004 (2004-09-30) *
黄华等: "基于观测器的柔性关节机械臂滑模控制", 《湖南工业大学学报》, vol. 28, no. 1, 31 January 2014 (2014-01-31), pages 62 - 66 *

Cited By (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN104570741A (zh) * 2015-01-22 2015-04-29 华南理工大学 一种柔性机械臂横向振动pd边界控制模拟方法
CN108015761A (zh) * 2016-11-02 2018-05-11 香港理工大学深圳研究院 一种单连杆柔性机械臂控制方法及系统
CN109240092A (zh) * 2018-11-30 2019-01-18 长春工业大学 基于多智能体可重构模块化柔性机械臂轨迹跟踪控制方法
CN109240092B (zh) * 2018-11-30 2021-09-10 长春工业大学 基于多智能体可重构模块化柔性机械臂轨迹跟踪控制方法
CN110774286A (zh) * 2019-11-22 2020-02-11 天津理工大学 一种基于刚柔耦合动力学的五自由度机械手的控制方法
CN110774286B (zh) * 2019-11-22 2024-03-29 天津理工大学 一种基于刚柔耦合动力学的五自由度机械手的控制方法

Also Published As

Publication number Publication date
CN104020664B (zh) 2016-08-31

Similar Documents

Publication Publication Date Title
CN104035337B (zh) 一种基于奇异摄动理论的柔性机械臂滑模控制设计方法
CN110376882A (zh) 基于有限时间扩张状态观测器的预定性能控制方法
CN102508434B (zh) 用于微陀螺仪的自适应模糊滑模控制器
CN103324083B (zh) 基于鲁棒观测器的非线性船舶运动控制方法
CN106493735B (zh) 存在外界扰动的柔性机械臂扰动观测控制方法
CN106774373A (zh) 一种四旋翼无人机有限时间姿态跟踪控制方法
CN103728882B (zh) 微陀螺仪的自适应反演非奇异终端滑模控制方法
WO2015188514A1 (zh) 基于非线性有限元动力学响应仿真的非对称变加速度规划方法
CN104020664A (zh) 一种基于偏微分方程的柔性机械臂干扰观测器设计方法
CN104443427A (zh) 飞行器颤振预测系统及方法
CN106681343B (zh) 一种航天器姿态跟踪低复杂度预设性能控制方法
CN106406098B (zh) 一种机器人系统在未知环境下的人机交互控制方法
CN103197596B (zh) 一种数控加工参数自适应模糊控制规则优化方法
CN110116409A (zh) 一种基于扰动观测器的四通道遥操作双边控制方法
CN104876128B (zh) 带有状态约束的三维桥式吊车增强耦合非线性控制方法
CN104723341A (zh) 基于连接和阻尼配置的柔性关节机械臂的位置控制方法
CN104049534B (zh) 微陀螺仪的自适应迭代学习控制方法
CN105404744A (zh) 一种空间机械臂全状态动力学半物理仿真系统
CN105740525A (zh) 一种飞行器的气动力数据处理方法及气动力数据处理系统
CN107976908B (zh) 一种飞行器耦合动稳定性特征分析方法
CN114355959B (zh) 空中机器人的姿态输出反馈控制方法、装置、介质和设备
CN114297797B (zh) 基于ann的燃机透平阻尼叶片结构等效刚度阻尼分析方法
CN104267604A (zh) 微陀螺仪自适应神经网络全局滑模控制方法
CN108988710A (zh) 考虑长时延的网络化h∞模型参考直流电机调速方法和系统
Fei et al. Robust adaptive fractional fast terminal sliding mode controller for microgyroscope

Legal Events

Date Code Title Description
C06 Publication
PB01 Publication
C10 Entry into substantive examination
SE01 Entry into force of request for substantive examination
C14 Grant of patent or utility model
GR01 Patent grant