主权项 |
一种多机器人队形变换方法,包括以下步骤:将所有机器人置于一坐标系中,得到各机器人所在位置的坐标,同时将各个机器人所在的点依次连接形成一多边形,计算求出该多边形重心的坐标,队形变换时分为静态变换和动态变换两种模式:在静态变换模式下,以所述的多边形重心作为所要变换队形的重心,以所有机器人的行走距离之和最短、队列收敛时间最少作为衡量指标,求出所要变换队形中各个机器人的坐标,最后根据坐标对应关系实现队形变换;在动态变换模式下,以所有机器人的行走距离之和最短、队列收敛时间最少以及所述的多边形重心与所要变换队形的重心之间的约束条件作为衡量指标,求出所要变换队形中各个机器人的坐标,最后根据坐标对应关系实现队形变换;所述的多边形重心与所要变换队形的重心之间的约束条件为: <mfenced open='{' close=''> <mtable> <mtr> <mtd> <mo>-</mo> <msub> <mi>θ</mi> <mi>q</mi> </msub> <mo>≤</mo> <mi>arctan</mi> <mrow> <mo>(</mo> <mfrac> <mrow> <msub> <mi>y</mi> <mi>cg</mi> </msub> <mo>-</mo> <msup> <msub> <mi>y</mi> <mi>cg</mi> </msub> <mo>′</mo> </msup> </mrow> <mrow> <msub> <mi>x</mi> <mi>cg</mi> </msub> <mo>-</mo> <msup> <msub> <mi>x</mi> <mi>cg</mi> </msub> <mo>′</mo> </msup> </mrow> </mfrac> <mo>)</mo> </mrow> <mo>≤</mo> <msub> <mi>θ</mi> <mi>q</mi> </msub> </mtd> </mtr> <mtr> <mtd> <msub> <mi>a</mi> <mn>1</mn> </msub> <msub> <mi>x</mi> <mi>cg</mi> </msub> <mo>+</mo> <msub> <mi>b</mi> <mn>1</mn> </msub> <mo>≤</mo> <msub> <mi>y</mi> <mi>cg</mi> </msub> <mo>≤</mo> <msub> <mi>a</mi> <mn>2</mn> </msub> <msub> <mi>x</mi> <mi>cg</mi> </msub> <mo>+</mo> <msub> <mi>b</mi> <mn>2</mn> </msub> </mtd> </mtr> </mtable> </mfenced>其中(xcg、ycg)为所要变换队形的重心坐标、(xcg’、ycg’)为所述多边形重心的坐标,θq、a1、a2、b1、b2为设定的常数。 |