发明名称 机械臂伺服系统的有限时间协同控制方法
摘要 机械臂伺服系统的有限时间协同控制方法,包括:建立机械臂伺服系统的动态模型,初始化系统状态、采样时间以及相关控制参数;根据微分中值定理,将系统中的非线性输入死区线性近似为一个简单的时变系统,推导出带有未知死区的机械臂伺服系统模型;计算控制系统的跟踪误差、非奇异终端滑模面及其一阶导数;基于带有未知死区的机械臂伺服系统模型,选择神经网络逼近未知函数,并根据系统跟踪误差、非奇异终端滑模面,设计神经网络有限时间协同控制器,更新神经网络权值矩阵;该方法不仅能够避免非线性死区的附加逆补偿,减小滑模高频抖振问题,而且可以实现机械臂伺服系统的有限时间快速跟踪。
申请公布号 CN104216284A 申请公布日期 2014.12.17
申请号 CN201410398181.8 申请日期 2014.08.14
申请人 浙江工业大学 发明人 陈强;汤筱晴;翟双坡
分类号 G05B13/04(2006.01)I 主分类号 G05B13/04(2006.01)I
代理机构 杭州天正专利事务所有限公司 33201 代理人 王兵;黄美娟
主权项 机械臂伺服系统的有限时间协同控制方法,包含以下步骤:步骤1,建立如式(1)所示机械臂伺服系统的动态模型,初始化系统状态、采样时间以及相关控制参数;<maths num="0001" id="cmaths0001"><math><![CDATA[<mrow><mi>M</mi><mrow><mo>(</mo><mi>x</mi><mo>)</mo></mrow><mover><mi>x</mi><mrow><mo>.</mo><mo>.</mo></mrow></mover><mo>+</mo><msub><mi>V</mi><mi>m</mi></msub><mrow><mo>(</mo><mi>x</mi><mo>,</mo><mover><mi>x</mi><mo>.</mo></mover><mo>)</mo></mrow><mover><mi>x</mi><mo>.</mo></mover><mo>+</mo><mi>G</mi><mrow><mo>(</mo><mi>x</mi><mo>)</mo></mrow><mo>+</mo><mi>F</mi><mrow><mo>(</mo><mover><mi>x</mi><mo>.</mo></mover><mo>)</mo></mrow><mo>=</mo><mi>&tau;</mi><mo>-</mo><msub><mi>&tau;</mi><mi>d</mi></msub><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>1</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA0000553621600000011.GIF" wi="1321" he="74" /></maths>其中<img file="FDA0000553621600000012.GIF" wi="256" he="73" />分别为位置,速度和加速度;M(x)∈R<sup>n×n</sup>为对称正定矩阵;<img file="FDA0000553621600000013.GIF" wi="324" he="73" />为科式力;G(x)∈R<sup>n</sup>为重力;<img file="FDA0000553621600000014.GIF" wi="245" he="69" />表示摩擦力;τ<sub>d</sub>∈R<sup>n×1</sup>为外部扰动;τ∈R<sup>n×1</sup>为死区输出值,表示为:<maths num="0002" id="cmaths0002"><math><![CDATA[<mrow><mi>&tau;</mi><mo>=</mo><mi>D</mi><mrow><mo>(</mo><mi>u</mi><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow><mo>)</mo></mrow><mo>=</mo><mfenced open='{' close=''><mtable><mtr><mtd><msub><mi>g</mi><mi>r</mi></msub><mrow><mo>(</mo><mi>u</mi><mo>)</mo></mrow></mtd><mtd><mi>if</mi></mtd><mtd><mi>u</mi><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow><mo>&GreaterEqual;</mo><msub><mi>b</mi><mi>r</mi></msub></mtd></mtr><mtr><mtd><mn>0</mn></mtd><mtd><mi>if</mi></mtd><mtd><msub><mi>b</mi><mi>l</mi></msub><mo>&lt;</mo><mi>u</mi><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow><mo>&lt;</mo><msub><mi>b</mi><mi>r</mi></msub></mtd></mtr><mtr><mtd><msub><mi>g</mi><mi>l</mi></msub><mrow><mo>(</mo><mi>u</mi><mo>)</mo></mrow></mtd><mtd><mi>if</mi></mtd><mtd><mi>u</mi><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow><mo>&le;</mo><msub><mi>b</mi><mi>l</mi></msub></mtd></mtr></mtable></mfenced><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>2</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA0000553621600000015.GIF" wi="1306" he="232" /></maths>其中u(t)∈R是实际控制信号;g<sub>l</sub>(u),g<sub>r</sub>(u)为未知非线性函数;b<sub>l</sub>和b<sub>r</sub>为死区未知宽度参数,并且满足b<sub>l</sub>&lt;0,b<sub>r</sub>&gt;0;步骤2,根据微分中值定理,将系统中的非线性输入死区线性近似为一个简单的时变系统,推导出带有未知死区的机械臂伺服系统模型;2.1根据微分中值定理,存在ξ<sub>l</sub>∈(‑∞,b<sub>l</sub>)和ξ<sub>r</sub>∈(b<sub>r</sub>,+∞)使g<sub>l</sub>(u)=g′<sub>l</sub>(ξ′<sub>l</sub>)(u‑b<sub>l</sub>)<img file="FDA0000553621600000017.GIF" wi="282" he="68" />(3)其中ξ′<sub>l</sub>∈(‑∞,b<sub>l</sub>],g′<sub>l</sub>(ξ<sub>l</sub>)为函数g<sub>l</sub>(u)在ξ′<sub>l</sub>处的倒数;g<sub>r</sub>(u)=g′<sub>r</sub>(ξ′<sub>r</sub>)(u‑b<sub>r</sub>)<img file="FDA0000553621600000018.GIF" wi="274" he="68" />(4)其中ξ′<sub>r</sub>∈[b<sub>l</sub>,+∞),g′<sub>r</sub>(ξ<sub>r</sub>)为函数g<sub>r</sub>(u)在ξ′<sub>r</sub>处的倒数;根据式(3)和式(4),可将式(2)改写为<img file="FDA0000553621600000016.GIF" wi="1110" he="74" />其中<maths num="0003" id="cmaths0003"><math><![CDATA[<mrow><mi>&rho;</mi><mrow><mo>(</mo><mi>u</mi><mo>)</mo></mrow><mo>=</mo><mfenced open='{' close=''><mtable><mtr><mtd><mo>-</mo><msubsup><mi>g</mi><mi>r</mi><mo>&prime;</mo></msubsup><mrow><mo>(</mo><msub><mi>&xi;</mi><mi>r</mi></msub><mo>)</mo></mrow><msub><mi>b</mi><mi>r</mi></msub></mtd><mtd><mi>if</mi></mtd><mtd><mi>u</mi><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow><mo>&GreaterEqual;</mo><msub><mi>b</mi><mi>r</mi></msub></mtd></mtr><mtr><mtd><mo>-</mo><mo>[</mo><msubsup><mi>g</mi><mi>l</mi><mo>&prime;</mo></msubsup><mrow><mo>(</mo><msub><mi>&xi;</mi><mi>l</mi></msub><mo>)</mo></mrow><mo>+</mo><msubsup><mi>g</mi><mi>r</mi><mo>&prime;</mo></msubsup><mrow><mo>(</mo><msub><mi>&xi;</mi><mi>r</mi></msub><mo>)</mo></mrow><mo>]</mo><mi>u</mi><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow></mtd><mtd><mi>if</mi></mtd><mtd><msub><mi>b</mi><mi>l</mi></msub><mo>&lt;</mo><mi>u</mi><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow><mo>&lt;</mo><msub><mi>b</mi><mi>r</mi></msub></mtd></mtr><mtr><mtd><mo>-</mo><msubsup><mi>g</mi><mi>l</mi><mo>&prime;</mo></msubsup><mrow><mo>(</mo><msub><mi>&xi;</mi><mi>l</mi></msub><mo>)</mo></mrow></mtd><mtd><mi>if</mi></mtd><mtd><mi>u</mi><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow><mo>&le;</mo><msub><mi>b</mi><mi>l</mi></msub></mtd></mtr></mtable></mfenced><mo>.</mo><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>6</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA0000553621600000021.GIF" wi="1291" he="228" /></maths>其中ξ<sub>l</sub>∈(‑∞,b<sub>l</sub>],ξ<sub>r</sub>∈[b<sub>l</sub>,+∞),并且<img file="FDA0000553621600000022.GIF" wi="1104" he="75" /><img file="FDA0000553621600000023.GIF" wi="1205" he="156" /><img file="FDA0000553621600000024.GIF" wi="1222" he="156" />2.2由式(1)和式(5)可得带有未知死区的机械臂伺服系统模型为:<img file="FDA0000553621600000025.GIF" wi="1463" he="77" />其中|ρ(u)|≤ρ<sub>N</sub>,ρ<sub>N</sub>是未知正常数,满足ρ<sub>N</sub>=(g<sub>r1</sub>+g<sub>l1</sub>)max{b<sub>r</sub>,b<sub>l</sub>};步骤3,计算控制系统的跟踪误差、非奇异终端滑模面及其一阶导数;3.1定义控制系统的跟踪误差为e(t)=x<sub>d</sub>‑x    (11)其中x<sub>d</sub>为二阶可导期望轨迹;3.2在设计协同控制器的过程中,定义协同流型为:<maths num="0004" id="cmaths0004"><math><![CDATA[<mrow><mi>s</mi><mo>=</mo><mover><mi>e</mi><mo>.</mo></mover><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow><mo>+</mo><mi>&lambda;e</mi><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>12</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA0000553621600000026.GIF" wi="1051" he="72" /></maths>其中λ为影响系统收敛的正常数;根据如式(13)所示的非奇异终端滑模面,设计有限时间协同控制器,使系统误差快速趋向于式(12)所示的协同流型;<maths num="0005" id="cmaths0005"><math><![CDATA[<mrow><mi>q</mi><msup><mover><mi>s</mi><mo>.</mo></mover><mrow><mi>p</mi><mo>/</mo><mi>r</mi></mrow></msup><mo>+</mo><mi>s</mi><mo>=</mo><mn>0</mn><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>13</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA0000553621600000027.GIF" wi="1054" he="78" /></maths>其中q为正定常数,p&gt;0,r&gt;0,1&lt;p/r&lt;2;3.3对式(12)求导,结合式(6)和式(11)可以推导出<img file="FDA0000553621600000031.GIF" wi="1161" he="74" />其中非线性未知函数h为<maths num="0006" id="cmaths0006"><math><![CDATA[<mrow><mi>h</mi><mo>=</mo><mi>M</mi><mrow><mo>(</mo><msub><mover><mi>x</mi><mrow><mo>.</mo><mo>.</mo></mrow></mover><mi>d</mi></msub><mo>+</mo><mi>&lambda;</mi><mover><mi>e</mi><mo>.</mo></mover><mo>)</mo></mrow><mo>+</mo><msub><mi>V</mi><mi>m</mi></msub><mrow><mo>(</mo><msub><mover><mi>x</mi><mo>.</mo></mover><mi>d</mi></msub><mo>+</mo><mi>&lambda;e</mi><mo>)</mo></mrow><mo>+</mo><mi>G</mi><mo>+</mo><mi>F</mi><mo>-</mo><mi>&rho;</mi><mrow><mo>(</mo><mi>u</mi><mo>)</mo></mrow><mo>.</mo><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>15</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA0000553621600000032.GIF" wi="1305" he="74" /></maths>步骤4,基于带有未知死区的机械臂伺服系统模型,选择神经网络逼近未知函数,并根据系统跟踪误差、非奇异终端滑模面,设计神经网络有限时间协同控制器,更新神经网络权值矩阵;4.1根据式(13)和式(14),控制器的表达式为<maths num="0007" id="cmaths0007"><math><![CDATA[<mrow><mi>u</mi><mo>=</mo><msubsup><mover><mi>W</mi><mo>^</mo></mover><mi>a</mi><mi>T</mi></msubsup><mi>&phi;</mi><mrow><mo>(</mo><mi>x</mi><mo>)</mo></mrow><mo>+</mo><mi>k</mi><msup><mi>s</mi><mrow><mi>r</mi><mo>/</mo><mi>p</mi></mrow></msup><mo>+</mo><mi>&delta;sgn</mi><mrow><mo>(</mo><mi>s</mi><mo>)</mo></mrow><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>16</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA0000553621600000033.GIF" wi="1239" he="81" /></maths>其中<img file="FDA0000553621600000034.GIF" wi="69" he="81" />为理想权重<img file="FDA0000553621600000035.GIF" wi="229" he="73" />的估计值,<img file="FDA0000553621600000036.GIF" wi="235" he="76" />为神经网络基函数,x为神经网络输入向量,k=q<sup>‑1</sup>是控制参数,δ是一个正的常数,满足<img file="FDA0000553621600000037.GIF" wi="479" he="99" />ε<sub>N</sub>为一个正常数,表示神经网络逼近误差的上限,τ<sub>N</sub>为外部扰动的上限常数,<img file="FDA0000553621600000038.GIF" wi="282" he="82" />为神经网络权值估计误差;4.2设计神经网络的权值更新律为:<maths num="0008" id="cmaths0008"><math><![CDATA[<mrow><msub><mover><mi>W</mi><mover><mo>^</mo><mo>.</mo></mover></mover><mi>a</mi></msub><mo>=</mo><msub><mi>K</mi><mi>C</mi></msub><mi>&phi;</mi><mrow><mo>(</mo><mi>x</mi><mo>)</mo></mrow><msup><mi>s</mi><mi>T</mi></msup><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>17</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA0000553621600000039.GIF" wi="1082" he="92" /></maths>其中K<sub>C</sub>为正定对角矩阵,φ(x)通常取为以下高斯函数:<maths num="0009" id="cmaths0009"><math><![CDATA[<mrow><mi>&phi;</mi><mrow><mo>(</mo><mi>x</mi><mo>)</mo></mrow><mo>=</mo><mi>exp</mi><mrow><mo>(</mo><mo>-</mo><mfrac><msup><mrow><mo>|</mo><mi>x</mi><mo>-</mo><mi>c</mi><mo>|</mo></mrow><mn>2</mn></msup><mrow><mn>2</mn><msup><mi>b</mi><mn>2</mn></msup></mrow></mfrac><mo>)</mo></mrow><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>18</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA00005536216000000310.GIF" wi="1126" he="147" /></maths>其中c=[c<sub>1</sub>,c<sub>2</sub>,...,c<sub>n</sub>]<sup>T</sup>是高斯函数的中心;b是高斯函数的宽度;由式(18)可以推出0&lt;φ(x)≤1;步骤5,设计李雅普诺夫函数<img file="FDA0000553621600000041.GIF" wi="952" he="140" />和<img file="FDA0000553621600000042.GIF" wi="216" he="127" />则可以证明闭环控制系统中的所有信号均是一致有界的;同时,系统误差e可以在有限时间内收敛至平衡点e=0。
地址 310014 浙江省杭州市下城区潮王路18号