CN104020664A - 一种基于偏微分方程的柔性机械臂干扰观测器设计方法 - Google Patents
一种基于偏微分方程的柔性机械臂干扰观测器设计方法 Download PDFInfo
- 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
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),从而
由可得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),从而
由得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 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)
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)
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 | 北京航空航天大学 | 一种基于干扰观测器的柔性关节机械臂的滑模控制方法 |
-
2014
- 2014-06-12 CN CN201410261987.2A patent/CN104020664B/zh active Active
Patent Citations (4)
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)
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)
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 |