发明名称 一种基于偏微分方程的柔性机械臂干扰观测器设计方法
摘要 本发明是一种基于偏微分方程的柔性机械臂干扰观测器设计方法,它有四大步骤:步骤1:柔性机械臂的动力学建模;步骤2:干扰观测器的设计;步骤3:观测器稳定性的验证;步骤4:设计结束。本发明首先利用哈密尔顿原理,求出整个系统的PDE模型;然后基于该模型,设计合理的干扰观测器以估计外界的未知干扰;最后,通过设计合适的李雅普诺夫函数,对所设计的观测器进行分析,进而验证其稳定性。
申请公布号 CN104020664B 申请公布日期 2016.08.31
申请号 CN201410261987.2 申请日期 2014.06.12
申请人 国电科学技术研究院 发明人 陈彦桥;姜婷婷;刘金琨
分类号 G05B13/00(2006.01)I 主分类号 G05B13/00(2006.01)I
代理机构 北京慧泉知识产权代理有限公司 11232 代理人 王顺荣;唐爱华
主权项 一种基于偏微分方程的柔性机械臂干扰观测器设计方法,其特征在于:该方法包括以下步骤:步骤1:柔性机械臂动力学建模柔性机械臂的动力学建模采用哈密尔顿原理的方法,建模时用到的状态变量θ(t)、y(x,t)分别表示在t时刻机械臂的关节角度和x点处的弹性变形;为了表示方便,以下分析中θ(t)、y(x,t)分别简写为θ、y(x);柔性机械臂的自然边界条件为y(0)=y<sub>x</sub>(0)=0                 (1)其中,y<sub>x</sub>(*)表示y(*)对x的一阶偏导数,定义z(x)=xθ+y(x)                 (2)其中,z(x)为z(x,t)的简写,z<sub>x</sub>(*)表示z(*)对x的一阶偏导数;由式(1)和式(2)得z(0)=y(0),从而z(0)=0,z<sub>x</sub>(0)=θ,<img file="FDA0001030852510000011.GIF" wi="669" he="119" />由<img file="FDA0001030852510000012.GIF" wi="241" he="119" />得z<sub>xx</sub>(0)=y<sub>xx</sub>(0),z<sub>xx</sub>(L)=y<sub>xx</sub>(L),z<sub>xxx</sub>(L)=y<sub>xxx</sub>(L);系统的动能、势能以及非保守力做功的表达式如下<img file="FDA0001030852510000013.GIF" wi="862" he="126" /><img file="FDA0001030852510000014.GIF" wi="437" he="119" /><img file="FDA0001030852510000015.GIF" wi="1029" he="95" />其中,EI为均匀梁的弯曲刚度,L为机械臂的长度,M为机械臂末端负载的质量,I<sub>h</sub>为中 心转动惯量,ρ为机械臂单位长度上的质量,τ为首端控制力矩输入,F为末端控制力矩输入,d<sub>1</sub>为首端控制输入慢时变干扰,d<sub>2</sub>为末端控制输入慢时变干扰;由哈密尔顿原理<img file="FDA0001030852510000021.GIF" wi="637" he="103" />得柔性机械臂的PDE模型如下<img file="FDA0001030852510000022.GIF" wi="1046" he="79" /><img file="FDA0001030852510000023.GIF" wi="1078" he="87" /><img file="FDA0001030852510000024.GIF" wi="1102" he="63" />y(0)=y<sub>x</sub>(0)=y<sub>xx</sub>(L)=0               (4d)步骤2:干扰观测器设计设计观测器的基本思想就是用估计输出与实际输出的差值对估计值进行修正,因此,取<img file="FDA0001030852510000025.GIF" wi="806" he="103" />其中,L<sub>1</sub>>0,L<sub>2</sub>>0,<img file="FDA0001030852510000026.GIF" wi="46" he="85" />为对d<sub>1</sub>的估计,<img file="FDA0001030852510000027.GIF" wi="51" he="71" />为对d<sub>2</sub>的估计;定义辅助参数向量<img file="FDA0001030852510000028.GIF" wi="954" he="87" />其中,<img file="FDA0001030852510000029.GIF" wi="366" he="95" /><img file="FDA00010308525100000210.GIF" wi="562" he="71" />则<img file="FDA00010308525100000211.GIF" wi="971" he="86" />由(4b)得<img file="FDA00010308525100000212.GIF" wi="530" he="79" />则由上述各式求得<img file="FDA00010308525100000213.GIF" wi="1494" he="431" />同理,由(4c)可得<img file="FDA00010308525100000214.GIF" wi="630" he="63" />则<img file="FDA00010308525100000215.GIF" wi="1566" he="430" />故干扰观测器设计为<img file="FDA0001030852510000031.GIF" wi="1054" he="286" /><img file="FDA0001030852510000032.GIF" wi="1206" he="183" />由式(7a)和(7b)得<img file="FDA0001030852510000033.GIF" wi="1326" he="229" /><img file="FDA0001030852510000034.GIF" wi="1358" he="199" />定义干扰误差<img file="FDA0001030852510000035.GIF" wi="619" he="82" />由于干扰均为慢时变干扰,认为<img file="FDA0001030852510000036.GIF" wi="178" he="87" /><img file="FDA0001030852510000037.GIF" wi="182" he="86" />则得<img file="FDA0001030852510000038.GIF" wi="1070" he="103" /><img file="FDA0001030852510000039.GIF" wi="1093" he="103" />所以,由式(7a)至(11)以及<img file="FDA00010308525100000310.GIF" wi="171" he="87" />和<img file="FDA00010308525100000311.GIF" wi="314" he="71" />的表达式,得观测误差方程为<img file="FDA00010308525100000312.GIF" wi="1374" he="431" /><img file="FDA00010308525100000313.GIF" wi="1438" he="375" />即<img file="FDA00010308525100000314.GIF" wi="651" he="95" />通过设计L<sub>1</sub>、L<sub>2</sub>,使估计值<img file="FDA00010308525100000315.GIF" wi="163" he="79" />按指数逼近干扰 d<sub>1</sub>、d<sub>2</sub>;针对定义<img file="FDA0001030852510000041.GIF" wi="987" he="94" />分别取<img file="FDA0001030852510000042.GIF" wi="330" he="95" />c<sub>1</sub>>0,<img file="FDA0001030852510000043.GIF" wi="542" he="78" />c<sub>2</sub>>0,则得<img file="FDA0001030852510000044.GIF" wi="990" he="135" />在仿真过程中,观测器的参数选为c<sub>1</sub>=5,c<sub>2</sub>=5;因为干扰是慢时变的,所以选取d<sub>1</sub>(t)=[10+0.1sin(t)](N·m),d<sub>2</sub>(t)=[10+0.1sin(t)](N·m);控制输入力矩选取τ=sin(t)(N·m),F=sin(t)(N·m);参数估计<img file="FDA0001030852510000045.GIF" wi="303" he="78" />的初始值均为0.5(N·m),系统其他物理参数如表1所示;表1柔性机械臂物理参数的数值<img file="FDA0001030852510000046.GIF" wi="1790" he="803" />步骤3:观测器稳定性的验证设计系统的李雅普诺夫函数为V<sub>o</sub>(t)=V<sub>1</sub>(t)+V<sub>2</sub>(t)其中,<img file="FDA0001030852510000047.GIF" wi="726" he="135" />则<img file="FDA0001030852510000048.GIF" wi="1102" he="111" /><img file="FDA0001030852510000049.GIF" wi="1182" he="111" />则<img file="FDA0001030852510000051.GIF" wi="1038" he="79" />其中<img file="FDA0001030852510000052.GIF" wi="446" he="151" />所以,上述不等式的解为<img file="FDA0001030852510000053.GIF" wi="430" he="86" />即当t→∞时,V<sub>o</sub>(t)以指数形式收敛于零,系统是稳定的;步骤4:设计结束整个设计过程重点考虑三个方面,首先是实现了柔性机械臂的动力学建模,其次针对未知的外界设计了合适的干扰观测器,最后利用李雅普诺夫函数,对设计出的观测器进行稳定性分析;综上所述,针对柔性机械臂的PDE模型,利用上述干扰观测器,在外界干扰不确定的情况下,实现对干扰的准确估计。
地址 210031 江苏省南京市浦口区浦东路10号