主权项 |
考虑干扰与模型不确定性的多机器人系统分布式有限时间跟踪控制方法,其特征在于包括以下步骤:步骤1:建立多机器人系统的领航机器人和跟随机器人的动力学模型:多机器人系统的动力学模型表示为如下Euler‑Lagrange方程形式<maths num="0001" id="cmaths0001"><math><![CDATA[<mrow><msub><mi>M</mi><mi>i</mi></msub><mrow><mo>(</mo><msub><mi>q</mi><mi>i</mi></msub><mo>)</mo></mrow><msub><mover><mi>q</mi><mo>··</mo></mover><mi>i</mi></msub><mo>+</mo><msub><mi>C</mi><mi>i</mi></msub><mrow><mo>(</mo><msub><mi>q</mi><mi>i</mi></msub><mo>,</mo><msub><mover><mi>q</mi><mo>·</mo></mover><mi>i</mi></msub><mo>)</mo></mrow><msub><mover><mi>q</mi><mo>·</mo></mover><mi>i</mi></msub><mo>+</mo><msub><mi>G</mi><mi>i</mi></msub><mrow><mo>(</mo><msub><mi>q</mi><mi>i</mi></msub><mo>)</mo></mrow><mo>=</mo><msub><mi>u</mi><mi>i</mi></msub><mo>+</mo><msub><mi>ρ</mi><mi>i</mi></msub></mrow>]]></math><img file="FDA0000783053360000011.GIF" wi="797" he="71" /></maths>其中,q<sub>i</sub>∈R<sup>n</sup>为广义坐标;<img file="FDA0000783053360000012.GIF" wi="156" he="75" />为广义速度,<img file="FDA0000783053360000013.GIF" wi="152" he="75" />为广义加速度;M<sub>i</sub>(q<sub>i</sub>)∈R<sup>n×n</sup>为惯量矩阵,是对称正定的;<img file="FDA0000783053360000014.GIF" wi="327" he="77" />为Coriolis力/偏心力;G<sub>i</sub>(q<sub>i</sub>)∈R<sup>n</sup>为广义有势力;u<sub>i</sub>∈R<sup>n</sup>为多机器人系统的控制输入;ρ<sub>i</sub>∈R<sup>n</sup>为广义干扰项;n是多机器人系统中机器人的维数;i为多机器人系统中机器人的序号;则有,N个跟随机器人的动力学模型如下:<maths num="0002" id="cmaths0002"><math><![CDATA[<mrow><msub><mi>M</mi><msub><mi>i</mi><mi>F</mi></msub></msub><mrow><mo>(</mo><msub><mi>q</mi><msub><mi>i</mi><mi>F</mi></msub></msub><mo>)</mo></mrow><msub><mover><mi>q</mi><mo>··</mo></mover><msub><mi>i</mi><mi>F</mi></msub></msub><mo>+</mo><msub><mi>C</mi><msub><mi>i</mi><mi>F</mi></msub></msub><mrow><mo>(</mo><msub><mi>q</mi><msub><mi>i</mi><mi>F</mi></msub></msub><mo>,</mo><msub><mover><mi>q</mi><mo>·</mo></mover><msub><mi>i</mi><mi>F</mi></msub></msub><mo>)</mo></mrow><msub><mover><mi>q</mi><mo>·</mo></mover><msub><mi>i</mi><mi>F</mi></msub></msub><mo>+</mo><msub><mi>G</mi><msub><mi>i</mi><mi>F</mi></msub></msub><mrow><mo>(</mo><msub><mi>q</mi><msub><mi>i</mi><mi>F</mi></msub></msub><mo>)</mo></mrow><mo>=</mo><msub><mi>u</mi><msub><mi>i</mi><mi>F</mi></msub></msub><mo>+</mo><msub><mi>ρ</mi><msub><mi>i</mi><mi>F</mi></msub></msub><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>1</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA0000783053360000015.GIF" wi="1371" he="106" /></maths>一个领航机器人的动力学模型如下:<maths num="0003" id="cmaths0003"><math><![CDATA[<mrow><msub><mi>M</mi><msub><mi>i</mi><mi>L</mi></msub></msub><mrow><mo>(</mo><msub><mi>q</mi><msub><mi>i</mi><mi>L</mi></msub></msub><mo>)</mo></mrow><msub><mover><mi>q</mi><mo>··</mo></mover><msub><mi>i</mi><mi>L</mi></msub></msub><mo>+</mo><msub><mi>C</mi><msub><mi>i</mi><mi>L</mi></msub></msub><mrow><mo>(</mo><msub><mi>q</mi><msub><mi>i</mi><mi>L</mi></msub></msub><mo>,</mo><msub><mover><mi>q</mi><mo>·</mo></mover><msub><mi>i</mi><mi>L</mi></msub></msub><mo>)</mo></mrow><msub><mover><mi>q</mi><mo>·</mo></mover><msub><mi>i</mi><mi>L</mi></msub></msub><mo>+</mo><msub><mi>G</mi><msub><mi>i</mi><mi>L</mi></msub></msub><mrow><mo>(</mo><msub><mi>q</mi><msub><mi>i</mi><mi>L</mi></msub></msub><mo>)</mo></mrow><mo>=</mo><msub><mi>u</mi><msub><mi>i</mi><mi>L</mi></msub></msub><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>2</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA0000783053360000016.GIF" wi="1329" he="78" /></maths>其中,多机器人系统中机器人的序号的角标L表示所有的参数均是针对领航机器人而言的,i<sub>L</sub>=N+1,角标F表示所有的参数均是针对跟随机器人而言的,并且i<sub>F</sub>=1,…,N;步骤2:针对多机器人系统,计算多机器人系统的有向图图论中的加权邻接矩阵A及Laplacian矩阵;步骤3:在多机器人系统的有向图的基础上,设计多机器人系统的分布式有限时间跟踪控制律,实现每个跟随机器人在有限时间内追随具有动态时变轨迹的领航机器人,完成多机器人系统有限时间跟踪控制。 |