专利名称：一种多机器人队形变换方法
技术领域：
本发明涉多机器人系统协作领域，尤其涉及一种多机器人队形变换方法。
背景技术：
多机器人编队是典型的多机器人系统协作课题，要求从系统的角度探 讨机器人群体的合作行为、信息交互及进化机制等。随着多机器人学的发 展，目前多机器人编队控制已成为 一个广受关注的问题。
编队控制，是指多机器人之间保持某种几何位置关系向目标行进，且 保持队形或为适应周围环境的约束而变换队形的控制技术。很多研究者从
不同角度提出了一些队形控制算法，包括
几何法，从特定几何形状形成上研究机器人队形控制。这种方法易于 实现，适合控制数量不大的机器人群体。
Leader-Follower方法，这种方法将队列中的才几器人分为Leader与 Follower两种角色，通过Leader运动的控制，来控制整个队列的运动。这 种方法的优点是只需要给定Leader的行为或轨迹就可以控制整个机器人 群体的行为。而该方法的缺点是系统中没有明确的队形反馈，例如队列保 持或形变对机器人运动能力的要求超出了单个机器人的性能范围，就不能 准确的执行预定动作。
行为控制法，首先为机器人规定一些期望的基本行为， 一般情况下， 机器人行为包括避障、保持队形和队形变换等。当机器人接受到外界环境 刺激时，根据外部输入信息做出反应，并输出反应向量(比如说运动速度 与航向)作为该行为的期望反应。行为选择模块通过一定的机制来综合各 行为的输出，并将综合结果作为机器人对环境刺激的反应而输出。该方法 中，协作是通过共享机器人之间的相对位置、状态等知识实现的。
发明内容
3本发明提供了一种多机器人队形变换方法，该方法适合大群机器人的活动，而且不受单个机器人性能限制。
一种多机器人队形变换方法，包括以下步骤
将所有机器人置于一坐标系中，得到各机器人所在位置的坐标，同时将各个机器人所在的点依次连接形成一多边形，计算求出该多边形重心的
坐标，队形变换时分为静态变换和动态变换两种模式
所述静态变换是指机器人在静止的情况下的变换，在静态变换模式下，以所述的多边形重心作为所要变换队形的重心，以所有机器人的行走距离之和最短、队列收敛时间最少作为衡量指标，求出所要变换队形中各个机器人的坐标，最后根据坐标对应关系实现队形变换；
静态模式又分为两种情况， 一种是各机器人相对所要变换队形的重心的角度固定，此时所有机器人行走的距离之和最短为
min J] [(xcg +《cos (9,) - x,., + (ycg +《.sin《)- 乂'
队列收敛最小时间为min.节ax) (xcg+《cos《)-x;' + (>>cg+《.sin
其中"cg、少q)为所要变换队形的重心坐标，(X,、 乂)为第,机器人
在所要变换队形中的坐标，《.为第/个机器人与所要变换队形重心的角度，
W是指机器人的数量。
另 一种是各机器人相对所要变换队形的重心的角度不固定，此时所有
机器人行走的距离之和最短为<formula>formula see original document page 4</formula>
队列收敛最小时间为<formula>formula see original document page 4</formula>
其中M,, M^分别为；c， j;的旋转矩阵，满足:
<formula>formula see original document page 4</formula>
所述的动态变换是指机器人在移动过程当中的队形变换，在动态变换
4模式下，以所有机器人的行走距离之和最短、队列收敛时间最少以及所述 的多边形重心与所要变换队形的重心之间的约束条件作为衡量指标，求出 所要变换队形中各个机器人的坐标，最后根据坐标对应关系实现队形变 换。
所有机器人行走的距离之和最短为
min艺[(xt.g +《cos《)- x,' 队列收敛最小时间为
+
(Xg+",sin《)-乂'
mm max
xcg +《c。s《)_ ^' + (_ycg +《sin《)->>, ' 多边形重心与所要变换队形的重心之间的约束条件为:
—& S arctan
"'、
乂 "^cg ^cg 乂
其中(xCg、 yCg)为所要变换队形的重心坐标、(xc/、 _yc/ )为所述多 边形重心坐标，&、①、&、 &、 62为设定的常数。其具体的值是根据机器 人群组实际运动过程中所遭遇的外部环境，来计算得到。对队形变换而言， 这些常数都是已知值。
本发明方法不受机器人数量的限制，而且对单个机器人性能没有要 求，实现较为简单。
图l为本发明机器人群静态变换前队形示意图; 图2为图1所示机器人群静态变换示意图； 图3为本发明机器人群动态变换前队形示意图; 图4为图3所示机器人群动态变换示意图。
具体实施例方式
如图1所示，6个机器人随机分布在一平面当中，此时该6个机器人 需要去完成某个任务，需要将该6个机器人编成如图2所示的正六边形。 为了最有效率地把这6个机器人排成正六边形，通过如下方法来实现
5把每个机器人看作是平面上的一个点，然后将这6个点依次连接起来， 可以得道一不规则的多边形，同时6个机器人所在的平面看作是一个坐标 系，这里的坐标系可以是直角坐标系，也可以极坐标系，这样就可以确定 每个机器人所在位置的坐标，根据现有重心计算公式，得到该多边形的重 心坐标。为了计算方便，最好是将重心坐标设置为(0， 0)，并将该重心 坐标i殳为正六边形的重心坐标。
在图1和图2所示的机器人当中，所有的机器人是静止不动的，而且 每个机器人的性能是一样的。机器人从图1所示的多边形变换到正六边形， 其变换效率的衡量指标有两个， 一个所有机器人行走距离之和，另一个是 从不规则多边形到正六边形的变换时间(即队列收敛时间)。行走的距离 之和越短，说明机器人消耗的能量越少，收敛时间越短，变换效率越高。
根据这两个条件可以得到两个方程，其中所有机器人行走距离之和的 最小值为
mm
艺[(Ag +《c。s《)_ x,.' + (ycg +《sin ) 1'
w表示机器人数量，该处等于6,当机器人数量变化时，w也随着改变； (Xcg、凡g)为正六边形的坐标；《表示第/个机器人相对重心水平偏离的
角度；4表示第z个机器人到重心的距离。 队列收敛的最短时间为
mm max
ie{l，...,n}
+《■ cos 6>,) - x/ + (_ytg +《■ sin 6 ,) _ >>,
通过上述两个方程，就可以得到正六形中的各个机器人的坐标，机器 人通过上述坐标的对应关系，可以通过直线行走，实现队形变换，也就是 说通过上述的队形变化，其变换效率是最高的。
上述方程中，其实是假定正六边形中各机器人相对重心水平偏离的角 度是固定的，当然其偏离角度是可以变化的，即正六边形是可以绕重心旋 转的，此时所有机器人行走距离之和的最小值为
^ [(xcg + ^ft《cos《)_ x,-' + (_ycg +似,《sin《)一 乂 ' 队列收敛最短时间为min max
，…，W}
x + cos《)-+ (少 + M sin《)-x
其中A^， jl^分别为x， y的旋转矩阵，满足:
cosPsin0
COS0
通过上述两个方程，就可以得到正六形中的各个机器人的坐标，机器 人通过上述坐标的对应关系，实现最高效率的队形变换。
如图3所示，4个在运动当中的机器人，其原来的队形是呈长方形的， 当它们需要去执行某个具体任务时，需要将队形变换成菱形，4个机器人 从长方形队形变换到菱形队形，同样是将4个机器人置于一坐标系中，得 到长方形队形中各个机器人的坐标，变换效率的指标也是一样的， 一个是 机器人的行走距离之和，另一个是队列收敛的时间，通过这两个条件，得 到两个方程，其中所有机器人行走距离之和最小值为
mm
+
少cg+《sin《)-；;,
in 2 [(xcg +《cos《)-《 队列收敛最小时间为
(、+《c。s《)- x,'' + (Kg +《sin《) - 少,
min max
w表示机器人数量，该处等于4，当机器人数量变化时，"也随着改变； (xcg、 a)为菱形的坐标；《表示第/个机器人相对重心水平偏离的角度; 《表示第/个机器人到重心的距离。
因为机器人是在运动当中的，其运动带有约束条件
一《S arctan
cg 》i
Xcg 一气
，S 乂
通过拉格郎日乘子法求解可以得到菱形队形中各个机器人的坐标，通 过坐标的对应关系，实现机器人队形最优变换。
权利要求
1、一种多机器人队形变换方法，包括以下步骤将所有机器人置于一坐标系中，得到各机器人所在位置的坐标，同时将各个机器人所在的点依次连接形成一多边形，计算求出该多边形重心的坐标，队形变换时分为静态变换和动态变换两种模式在静态变换模式下，以所述的多边形重心作为所要变换队形的重心，以所有机器人的行走距离之和最短、队列收敛时间最少作为衡量指标，求出所要变换队形中各个机器人的坐标，最后根据坐标对应关系实现队形变换；在动态变换模式下，以所有机器人的行走距离之和最短、队列收敛时间最少以及所述的多边形重心与所要变换队形的重心之间的约束条件作为衡量指标，求出所要变换队形中各个机器人的坐标，最后根据坐标对应关系实现队形变换。
2、根据权利要求1所述的多机器人队形变换方法，其特征在于所述 的多边形重心与所要变换队形的重心之间的约束条件为<formula>formula see original document page 2</formula>其中(&、 A)为所要变换队形的重心坐标、(&'、》/ )为所述多边形重心的坐标，&、 ",、 "2、 &、 Z)2为设定的常数。
全文摘要
本发明公开了一种多机器人队形变换方法，包括以下步骤在坐标系中求得得到各机器人的坐标，将各个机器人所在的点依次连接形成一多边形，计算求出该多边形重心的坐标，队形变换时分为静态变换和动态变换两种模式在静态变换模式下，以所有机器人的行走距离之和最短、队列收敛时间最少作为衡量指标，求出所要变换队形中各个机器人的坐标，根据坐标对应关系实现队形变换；在动态变换模式下，以所有机器人的行走距离之和最短、队列收敛时间最少以及队形变换约束条件作为衡量指标，求出所要变换队形中各个机器人的坐标，最后根据坐标对应关系实现队形变换。本发明方法不受机器人数量的限制，而且对单个机器人性能没有要求，实现较为简单。
文档编号G05D1/00GK101515179SQ20091009589
公开日2009年8月26日 申请日期2009年2月17日 优先权日2009年2月17日
发明者亮 张, 蒋荣欣, 陈耀武 申请人:浙江大学