发明名称 考虑干扰与模型不确定性的多机器人系统分布式有限时间跟踪控制方法
摘要 考虑干扰与模型不确定性的多机器人系统分布式有限时间跟踪控制方法,涉及多机器人系统的控制方法。为了解决现有的多机器人控制系统控制方法的鲁棒性较差的问题和多机器人系统的整体通讯负担过重的问题。本发明首先建立多机器人系统中领航机器人的动力学模型<img file="DDA0000783053390000011.GIF" wi="845" he="86" /></maths>和跟随机器人的动力学模型<img file="DDA0000783053390000012.GIF" wi="1008" he="84" /></maths>针对多机器人系统,计算多机器人系统的有向图图论中的加权邻接矩阵A及Laplacian矩阵;然后设计多机器人系统的分布式有限时间跟踪控制律<img file="DDA0000783053390000013.GIF" wi="1515" he="299" /></maths>实现每个跟随机器人在有限时间内追随具有动态时变轨迹的领航机器人,完成多机器人系统有限时间跟踪控制。本发明适用于多机器人系统的控制领域。
申请公布号 CN105093934A 申请公布日期 2015.11.25
申请号 CN201510505266.6 申请日期 2015.08.17
申请人 哈尔滨工业大学 发明人 刘萌萌;孙延超;马广富;苏雄飞;刘昱晗;李传江
分类号 G05B13/04(2006.01)I 主分类号 G05B13/04(2006.01)I
代理机构 哈尔滨市松花江专利商标事务所 23109 代理人 杨立超
主权项 考虑干扰与模型不确定性的多机器人系统分布式有限时间跟踪控制方法,其特征在于包括以下步骤:步骤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>&CenterDot;&CenterDot;</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>&CenterDot;</mo></mover><mi>i</mi></msub><mo>)</mo></mrow><msub><mover><mi>q</mi><mo>&CenterDot;</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>&rho;</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>&CenterDot;&CenterDot;</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>&CenterDot;</mo></mover><msub><mi>i</mi><mi>F</mi></msub></msub><mo>)</mo></mrow><msub><mover><mi>q</mi><mo>&CenterDot;</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>&rho;</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>&CenterDot;&CenterDot;</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>&CenterDot;</mo></mover><msub><mi>i</mi><mi>L</mi></msub></msub><mo>)</mo></mrow><msub><mover><mi>q</mi><mo>&CenterDot;</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:在多机器人系统的有向图的基础上,设计多机器人系统的分布式有限时间跟踪控制律,实现每个跟随机器人在有限时间内追随具有动态时变轨迹的领航机器人,完成多机器人系统有限时间跟踪控制。
地址 150001 黑龙江省哈尔滨市南岗区西大直街92号