发明名称 基于输入受限式自激发驱动的多机器人协同控制方法
摘要 本发明涉及一种基于输入受限式自激发驱动的多机器人协同控制方法,抛弃了传统控制方法中需要进行周期性采样的反馈控制方式,而是在满足稳定性和优化特性前提下,等到闭环系统真正需要时,利用上一时刻智能体自身信息获取下一时刻控制量,完成自激发采样控制。此外,在上述自激发驱动机制上,采用多胞方法处理饱和非线性环节,可以有效进行输入受限系统的<i>L</i><sub>1</sub>增益优化设计,该算法能有效处理输入饱和非线性因素,可有效满足多机器人协同作业的需求,且通信负担相对于传统时间驱动机制大幅降低,降低数据冗余,提升系统性能,更具工程可行性。
申请公布号 CN105301966A 申请公布日期 2016.02.03
申请号 CN201510851883.1 申请日期 2015.11.27
申请人 上海无线电设备研究所 发明人 吴雄君;曹培培;陈潜
分类号 G05B13/04(2006.01)I 主分类号 G05B13/04(2006.01)I
代理机构 上海信好专利代理事务所(普通合伙) 31249 代理人 张妍;包姝晴
主权项 一种基于输入受限式自激发驱动的多机器人协同控制方法,其特征在于:对于带输入受限约束的自激发驱动闭环系统,在其控制器的表达式为<img file="FDA0000860147250000011.GIF" wi="837" he="103" />的情况下,求取使下列多目标优化问题具有可行解的矩阵<img file="FDA0000860147250000012.GIF" wi="324" he="79" />和常数的标量δ:<maths num="0001" id="cmaths0001"><math><![CDATA[<mfenced open = "" close = ""><mtable><mtr><mtd><munder><mrow><mi>i</mi><mi>n</mi><mi>f</mi></mrow><mrow><mi>Q</mi><mo>&gt;</mo><mn>0</mn><mo>,</mo><mover><mi>F</mi><mo>&OverBar;</mo></mover><mo>,</mo><mover><mi>H</mi><mo>&OverBar;</mo></mover><mo>,</mo><mi>&delta;</mi></mrow></munder></mtd><mtd><mrow><mi>j</mi><mo>=</mo><mi>&delta;</mi></mrow></mtd></mtr></mtable></mfenced>]]></math><img file="FDA0000860147250000013.GIF" wi="573" he="135" /></maths>其中,<maths num="0002" id="cmaths0002"><math><![CDATA[<mrow><msub><mi>w</mi><mi>i</mi></msub><mrow><mo>(</mo><msubsup><mi>t</mi><mi>k</mi><mi>i</mi></msubsup><mo>)</mo></mrow><mo>=</mo><msub><mi>&Sigma;</mi><mrow><mi>j</mi><mo>&Element;</mo><msub><mi>N</mi><mi>i</mi></msub></mrow></msub><msub><mi>a</mi><mrow><mi>i</mi><mi>j</mi></mrow></msub><mrow><mo>(</mo><msub><mi>x</mi><mi>i</mi></msub><mo>(</mo><msubsup><mi>t</mi><mi>k</mi><mi>i</mi></msubsup><mo>)</mo><mo>-</mo><msub><mi>x</mi><mi>j</mi></msub><mo>(</mo><msubsup><mi>t</mi><mi>k</mi><mi>i</mi></msubsup><mo>)</mo><mo>)</mo></mrow><mo>,</mo></mrow>]]></math><img file="FDA0000860147250000014.GIF" wi="939" he="119" /></maths>a<sub>ij</sub>为邻接矩阵A<sub>0</sub>中的元素,表示第i和第j个节点之间的连接关系,其中邻接矩阵A<sub>0</sub>=[a<sub>ij</sub>]∈R<sup>N×N</sup>为带有非负元素a<sub>ij</sub>,且对角线均为0的矩阵;<img file="FDA0000860147250000015.GIF" wi="64" he="85" />为自激发驱动时刻,u为控制器输入,μ为正常数,F为状态反馈增益值,x<sub>i</sub>,x<sub>j</sub>分别是相邻近的第i个和第j个机器人的系统状态;通过满足第一约束条件,确定带输入受限约束的自激发驱动闭环系统的不变集,使表示系统稳定性要求的李雅普诺夫函数的导数<img file="FDA0000860147250000018.GIF" wi="161" he="71" />第一约束条件为:<maths num="0003" id="cmaths0003"><math><![CDATA[<mrow><mi>A</mi><mi>Q</mi><mo>+</mo><msup><mi>QA</mi><mi>T</mi></msup><mo>-</mo><mn>2</mn><mi>B</mi><mrow><mo>(</mo><msub><mi>E</mi><mi>s</mi></msub><mover><mi>F</mi><mo>&OverBar;</mo></mover><mo>+</mo><msubsup><mi>E</mi><mi>s</mi><mo>-</mo></msubsup><mover><mi>H</mi><mo>&OverBar;</mo></mover><mo>)</mo></mrow><mo>&lt;</mo><mn>0</mn></mrow>]]></math><img file="FDA0000860147250000016.GIF" wi="845" he="118" /></maths>通过满足第二约束条件,确定多机器人协同自激发驱动闭环系统的椭球范围,确保椭球处于使系统不发生饱和的线性区间<img file="FDA0000860147250000019.GIF" wi="412" he="87" />第二约束条件为:<maths num="0004" id="cmaths0004"><math><![CDATA[<mrow><mfenced open = "[" close = "]"><mtable><mtr><mtd><mrow><mo>-</mo><mfrac><mi>Q</mi><mi>&rho;</mi></mfrac></mrow></mtd><mtd><msubsup><mover><mi>H</mi><mo>&OverBar;</mo></mover><mi>i</mi><mi>T</mi></msubsup></mtd></mtr><mtr><mtd><mo>*</mo></mtd><mtd><mrow><mo>-</mo><mi>I</mi></mrow></mtd></mtr></mtable></mfenced><mo>&le;</mo><mn>0.</mn><mo>&ForAll;</mo><mi>i</mi><mo>&Element;</mo><msub><mi>I</mi><msup><mn>2</mn><mi>m</mi></msup></msub></mrow>]]></math><img file="FDA0000860147250000017.GIF" wi="605" he="246" /></maths>其中,ρ为正的标量,<img file="FDA00008601472500000210.GIF" wi="77" he="79" />表示集合<img file="FDA0000860147250000029.GIF" wi="430" he="103" />符号“*”表示共轭对称关系;<img file="FDA0000860147250000027.GIF" wi="67" he="75" />为矩阵<img file="FDA0000860147250000028.GIF" wi="60" he="63" />的第i行;ε(P,ρ)是带输入受限约束的自激发驱动闭环系统的一个不变集;通过满足第三约束条件,根据估计的控制输出的峰值大小进行自激发驱动闭环系统的L<sub>1</sub>增益优化,使得从噪声w到性能输出z的L<sub>1</sub>增益不大于δ;第三约束条件为:<maths num="0005" id="cmaths0005"><math><![CDATA[<mrow><mfenced open = "[" close = "]"><mtable><mtr><mtd><mrow><mo>-</mo><mi>&delta;</mi><mi>I</mi></mrow></mtd><mtd><mn>0</mn></mtd><mtd><msubsup><mi>D</mi><mrow><mi>z</mi><mi>w</mi></mrow><mi>T</mi></msubsup></mtd></mtr><mtr><mtd><mo>*</mo></mtd><mtd><mn>0</mn></mtd><mtd><msubsup><mi>C</mi><mi>z</mi><mi>T</mi></msubsup></mtd></mtr><mtr><mtd><mo>*</mo></mtd><mtd><mo>*</mo></mtd><mtd><mrow><mo>-</mo><mi>I</mi></mrow></mtd></mtr></mtable></mfenced><mo>&le;</mo><mn>0</mn></mrow>]]></math><img file="FDA0000860147250000021.GIF" wi="485" he="294" /></maths>其中,A,B,C<sub>z</sub>,D<sub>zw</sub>为第i个机器人的被控对象方程中的参数,机器人对象的描述方程为:<maths num="0006" id="cmaths0006"><math><![CDATA[<mrow><msub><mi>&Sigma;</mi><mrow><mi>A</mi><mi>i</mi></mrow></msub><mo>:</mo><mrow><mo>{</mo><mrow><mtable><mtr><mtd><mrow><msub><mover><mi>x</mi><mo>&CenterDot;</mo></mover><mi>i</mi></msub><mo>=</mo><msub><mi>Ax</mi><mi>i</mi></msub><mo>+</mo><msub><mi>Bsat</mi><mi>l</mi></msub><mrow><mo>(</mo><msub><mi>u</mi><mi>i</mi></msub><mo>)</mo></mrow><mo>+</mo><msub><mi>B</mi><mn>2</mn></msub><mi>w</mi></mrow></mtd></mtr><mtr><mtd><mrow><msub><mi>y</mi><mi>i</mi></msub><mo>=</mo><msub><mi>C</mi><mi>y</mi></msub><msub><mi>x</mi><mi>i</mi></msub><mo>+</mo><msub><mi>D</mi><mrow><mi>y</mi><mi>u</mi></mrow></msub><msub><mi>sat</mi><mi>l</mi></msub><mrow><mo>(</mo><msub><mi>u</mi><mi>i</mi></msub><mo>)</mo></mrow><mo>+</mo><msub><mi>D</mi><mrow><mi>y</mi><mi>w</mi></mrow></msub><mi>w</mi></mrow></mtd></mtr><mtr><mtd><mrow><msub><mi>z</mi><mi>i</mi></msub><mo>=</mo><msub><mi>C</mi><mi>z</mi></msub><msub><mi>x</mi><mi>i</mi></msub><mo>+</mo><msub><mi>D</mi><mrow><mi>z</mi><mi>u</mi></mrow></msub><msub><mi>sat</mi><mi>l</mi></msub><mrow><mo>(</mo><msub><mi>u</mi><mi>i</mi></msub><mo>)</mo></mrow><mo>+</mo><msub><mi>D</mi><mrow><mi>z</mi><mi>w</mi></mrow></msub><mi>w</mi><mo>,</mo><mi>i</mi><mo>=</mo><mn>1</mn><mo>,</mo><mn>2</mn><mo>,</mo><mo>...</mo><mo>,</mo><mi>N</mi></mrow></mtd></mtr></mtable><mo>.</mo></mrow></mrow></mrow>]]></math><img file="FDA0000860147250000022.GIF" wi="1141" he="285" /></maths>所述多机器人协同控制方法使多个平面关节型机器人构成的系统达到状态一致,完成多机器人协同制导与控制。
地址 200090 上海市杨浦区黎平路203号