CN104020664B - 一种基于偏微分方程的柔性机械臂干扰观测器设计方法 - Google Patents
一种基于偏微分方程的柔性机械臂干扰观测器设计方法 Download PDFInfo
- Publication number
- CN104020664B CN104020664B CN201410261987.2A CN201410261987A CN104020664B CN 104020664 B CN104020664 B CN 104020664B CN 201410261987 A CN201410261987 A CN 201410261987A CN 104020664 B CN104020664 B CN 104020664B
- Authority
- CN
- China
- Prior art keywords
- mechanical arm
- theta
- interference
- observer
- cap
- 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.)
- Active
Links
- 238000000034 method Methods 0.000 title claims abstract description 23
- 238000013461 design Methods 0.000 claims abstract description 24
- 238000004458 analytical method Methods 0.000 claims description 5
- 238000005452 bending Methods 0.000 claims description 4
- 238000012938 design process Methods 0.000 claims description 4
- 230000005489 elastic deformation Effects 0.000 claims description 4
- 238000004088 simulation Methods 0.000 claims description 4
- 239000013598 vector Substances 0.000 claims description 4
- 238000012795 verification Methods 0.000 claims description 4
- 230000014509 gene expression Effects 0.000 claims description 3
- 238000005381 potential energy Methods 0.000 claims description 3
- 238000011160 research Methods 0.000 description 4
- 230000001133 acceleration Effects 0.000 description 3
- 238000013459 approach Methods 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 238000005265 energy consumption Methods 0.000 description 1
- 230000010355 oscillation Effects 0.000 description 1
- 238000003672 processing method Methods 0.000 description 1
Landscapes
- Feedback Control In General (AREA)
Abstract
本发明是一种基于偏微分方程的柔性机械臂干扰观测器设计方法,它有四大步骤:步骤1:柔性机械臂的动力学建模;步骤2:干扰观测器的设计;步骤3:观测器稳定性的验证;步骤4:设计结束。本发明首先利用哈密尔顿原理,求出整个***的PDE模型;然后基于该模型,设计合理的干扰观测器以估计外界的未知干扰;最后,通过设计合适的李雅普诺夫函数,对所设计的观测器进行分析,进而验证其稳定性。
Description
技术领域
本发明涉及一种基于偏微分方程的柔性机械臂干扰观测器设计方法,它是针对柔性机械臂的偏微分方程(Partial Differential Equation,PDE)动力学模型(以下简称PDE模型),而给出一种干扰观测器的设计方法,属于机械臂控制技术领域。
背景技术
由于具有质量轻、速度快、能耗低等优点,柔性机械臂越来越多地应用于航天和工业领域。以往,关于柔性机械臂观测器的研究大都基于常微分方程(OrdinaryDifferential 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),从而
由可得zxx(0)=yxx(0),zxx(L)=yxx(L),zxxx(L)=yxxx(L)。
***的动能、势能以及非保守力做功的表达式如下
其中,EI为均匀梁的弯曲刚度,L为机械臂的长度,m为机械臂末端负载的质量,Ih为中心转动惯量,ρ为机械臂单位长度上的质量,τ为首端控制力矩输入,F为末端控制力矩输入,d1为首端控制输入慢时变干扰,d2为末端控制输入慢时变干扰。
由哈密尔顿原理可得柔性机械臂的PDE模型如下
y(0)=yx(0)=yxx(L)=0 (4d)
步骤2:干扰观测器设计
根据柔性机械臂***的模型信息,用估计输出与实际输出的差值对估计值进行修正,从而设计出合适的干扰观测器,对***受到的未知干扰进行准确的估计。
设计观测器的基本思想就是用估计输出与实际输出的差值对估计值进行修正,因此,取 其中,L1>0,L2>0,为对d1的估计,为对d2的估计。
定义辅助参数向量 其中, 则
由(4b)可得则由上述各式可求得
同理,由(4c)可得 则
故干扰观测器设计为
由式(7a)和(7b)可得
定义干扰误差由于干扰均为慢时变干扰,可认为 则可得
所以,由式(7a)至(11)以及和的表达式,可得观测误差方程为
即通过设计L1、L2,使估计值按指数逼近干扰d1、d2。
针对定义 分别取 c1>0, c2>0,则可得
在仿真过程中,观测器的参数选为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)
其中, 则
则
其中
所以,上述不等式的解为
即当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),从而
由可得zxx(0)=yxx(0),zxx(L)=yxx(L),zxxx(L)=yxxx(L)。
***的动能、势能以及非保守力做功的表达式如下
其中,EI为均匀梁的弯曲刚度,L为机械臂的长度,m为机械臂末端负载的质量,Ih为中心转动惯量,ρ为机械臂单位长度上的质量,τ为首端控制力矩输入,F为末端控制力矩输入,d1为首端控制输入慢时变干扰,d2为末端控制输入慢时变干扰。
由哈密尔顿原理可得柔性机械臂的PDE模型如下
y(0)=yx(0)=yxx(L)=0 (4d)
步骤2:干扰观测器设计
设计观测器的基本思想就是用估计输出与实际输出的差值对估计值进行修正,因此,取 其中,L1>0,L2>0,为对d1的估计,为对d2的估计。
定义辅助参数向量 其中, 则
由(4b)可得则由上述各式可求得
同理,由(4c)可得 则
故干扰观测器设计为
由式(7a)和(7b)可得
定义干扰误差由于干扰均为慢时变干扰,可认为 则可得
所以,由式(7a)至(11)以及和P2(z(L),)的表达式,可得观测误差方程为
即通过设计L1、L2,使估计值按指数逼近干扰d1、d2。
针对定义 分别取c1>0, c2>0,则可得
在仿真过程中,观测器的参数选为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)
其中, 则
则
其中
所以,上述不等式的解为
即当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,zx(0)=θ,
由得zxx(0)=yxx(0),zxx(L)=yxx(L),zxxx(L)=yxxx(L);
***的动能、势能以及非保守力做功的表达式如下
其中,EI为均匀梁的弯曲刚度,L为机械臂的长度,M为机械臂末端负载的质量,Ih为中心转动惯量,ρ为机械臂单位长度上的质量,τ为首端控制力矩输入,F为末端控制力矩输入,d1为首端控制输入慢时变干扰,d2为末端控制输入慢时变干扰;
由哈密尔顿原理得柔性机械臂的PDE模型如下
y(0)=yx(0)=yxx(L)=0 (4d)
步骤2:干扰观测器设计
设计观测器的基本思想就是用估计输出与实际输出的差值对估计值进行修正,因此,取 其中,L1>0,L2>0,为对d1的估计,为对d2的估计;
定义辅助参数向量其中, 则
由(4b)得则由上述各式求得
同理,由(4c)可得则
故干扰观测器设计为
由式(7a)和(7b)得
定义干扰误差由于干扰均为慢时变干扰,认为 则得
所以,由式(7a)至(11)以及和的表达式,得观测误差方程为
即通过设计L1、L2,使估计值按指数逼近干扰 d1、d2;
针对定义分别取c1>0,c2>0,则得
在仿真过程中,观测器的参数选为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)
其中,则
则
其中
所以,上述不等式的解为
即当t→∞时,Vo(t)以指数形式收敛于零,***是稳定的;
步骤4:设计结束
整个设计过程重点考虑三个方面,首先是实现了柔性机械臂的动力学建模,其次针对未知的外界设计了合适的干扰观测器,最后利用李雅普诺夫函数,对设计出的观测器进行稳定性分析;综上所述,针对柔性机械臂的PDE模型,利用上述干扰观测器,在外界干扰不确定的情况下,实现对干扰的准确估计。
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 CN104020664A (zh) | 2014-09-03 |
CN104020664B true 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) |
Families Citing this family (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104570741A (zh) * | 2015-01-22 | 2015-04-29 | 华南理工大学 | 一种柔性机械臂横向振动pd边界控制模拟方法 |
CN108015761B (zh) * | 2016-11-02 | 2021-05-07 | 香港理工大学深圳研究院 | 一种单连杆柔性机械臂控制方法及*** |
CN109240092B (zh) * | 2018-11-30 | 2021-09-10 | 长春工业大学 | 基于多智能体可重构模块化柔性机械臂轨迹跟踪控制方法 |
CN110774286B (zh) * | 2019-11-22 | 2024-03-29 | 天津理工大学 | 一种基于刚柔耦合动力学的五自由度机械手的控制方法 |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5091683A (en) * | 1989-09-20 | 1992-02-25 | Seiko Instruments Inc. | Servo control apparatus |
CN102540881A (zh) * | 2012-02-17 | 2012-07-04 | 国电科学技术研究院 | 基于柔性机械臂的偏微分模型的边界控制律的设计方法 |
CN102591207A (zh) * | 2012-03-01 | 2012-07-18 | 北京航空航天大学 | 一种基于干扰观测器的柔性关节机械臂的滑模控制方法 |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP4860277B2 (ja) * | 2005-06-30 | 2012-01-25 | Juki株式会社 | 多慣性共振系の振動抑制制御方法及び装置 |
-
2014
- 2014-06-12 CN CN201410261987.2A patent/CN104020664B/zh active Active
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5091683A (en) * | 1989-09-20 | 1992-02-25 | Seiko Instruments Inc. | Servo control apparatus |
CN102540881A (zh) * | 2012-02-17 | 2012-07-04 | 国电科学技术研究院 | 基于柔性机械臂的偏微分模型的边界控制律的设计方法 |
CN102591207A (zh) * | 2012-03-01 | 2012-07-18 | 北京航空航天大学 | 一种基于干扰观测器的柔性关节机械臂的滑模控制方法 |
Non-Patent Citations (3)
Title |
---|
于登云等.空间机械臂关节动力学建模与分析的研究进展.《航天器工程》.2010,第19卷(第2期),第1-10页. * |
空间柔性臂的解耦动力学模型及其控制;王光庆等;《宇航学报》;20040930;第25卷(第5期);第580-582、586页 * |
黄华等.基于观测器的柔性关节机械臂滑模控制.《湖南工业大学学报》.2014,第28卷(第1期),第62-66页. * |
Also Published As
Publication number | Publication date |
---|---|
CN104020664A (zh) | 2014-09-03 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
Fareh et al. | Robust active disturbance rejection control for flexible link manipulator | |
Wahrburg et al. | Cartesian contact force estimation for robotic manipulators using Kalman filters and the generalized momentum | |
Zeng et al. | Force/torque sensorless compliant control strategy for assembly tasks using a 6-DOF collaborative robot | |
CN110421569B (zh) | 一种基于有限时间扰动观测器的反演滑模机械臂控制器设计方法 | |
Van Damme et al. | Estimating robot end-effector force from noisy actuator torque measurements | |
CN104035337B (zh) | 一种基于奇异摄动理论的柔性机械臂滑模控制设计方法 | |
Kulakov et al. | Modeling and control of robot manipulators with the constraints at the moving objects | |
CN104020664B (zh) | 一种基于偏微分方程的柔性机械臂干扰观测器设计方法 | |
Dogan et al. | On the control of two-link flexible robot arm with nonuniform cross section | |
CN112859600B (zh) | 一种基于扩张状态观测器的机械***有限时间控制方法 | |
CN107351086B (zh) | 一种scara机器人关节力矩的卡尔曼估计方法 | |
Yue et al. | Robust adaptive control of a three-axis motion simulator with state observers | |
CN115981162A (zh) | 一种基于新型扰动观测器的机器人***滑模控制轨迹跟踪方法 | |
Ma et al. | Boundary control of a flexible manipulator based on a high order disturbance observer with input saturation | |
CN108988710B (zh) | 考虑长时延的网络化h∞模型参考直流电机调速方法和*** | |
Tavasoli | Adaptive robust boundary control of shaft vibrations under perturbations with unknown upper bounds | |
Nunes et al. | Global tracking for robot manipulators using a simple causal PD controller plus feedforward | |
Rigatos | Control and disturbances compensation in underactuated robotic systems using the derivative-free nonlinear Kalman filter | |
Salmasi et al. | A manoeuvre control strategy for flexible-joint manipulators with joint dry friction | |
Mercère et al. | Analytical modelling and grey-box identification of a flexible arm using a linear parameter-varying model | |
Ni et al. | Payload parameter identification of a flexible space manipulator system via complex eigenvalue estimation | |
Post et al. | A robust nonlinear observation strategy for the control of flexible manipulators | |
Ebrahimi | Regulated model-based and non-model-based sliding mode control of a MEMS vibratory gyroscope | |
Sanyal et al. | An observer for rigid body motion with almost global finite-time convergence | |
CN109814393B (zh) | 一种悬吊漂浮物随动***的降维观测器和控制器设计方法 |
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 |