基于Nash迭代的分布式多移动机器人编队控制方法

文档序号:9396369阅读:723来源:国知局
基于Nash迭代的分布式多移动机器人编队控制方法
【技术领域】
[0001] 本发明涉及移动机器人控制,尤其涉及的是多移动机器人分布式编队控制方法。
【背景技术】
[0002] 随着多移动机器人的应用领域的不断扩展,人们希望多移动机器人能够更出色的 完成更艰巨的任务;利用多移动机器人可以相互协作,每个机器人都可以根据其他机器人 的运行状态调整自身的状态等,以达到协同控制的效果。在对移动机器人协同控制中,实现 多移动机器人的编队控制是其最基本也是最重要的目标。所谓编队控制指的是多个移动机 器人在前进的过程中保持某种队形,同时又需要满足环境约束(如避开障碍)的控制问题。
[0003] 多移动机器人编队控制的主要问题是如下:1)难以建立易于处理的移动机器人 模型;2)多移动机器人的集中控制计算量大、通信量大,难以保证实时性,分布式控制却难 以解决移动机器人间的耦合性。
[0004] 近些年来国内外也有很多的学者对多移动机器人编队控制问题做出了很多研究 成果。Dunbar W B 和 Murray R M 在论文(Model predictive control of coordinated multi-vehicle formations)中提出利用集中式模型预测控制方法来处理多移动机器人的 控制问题,通过最小化性能指标来保证多移动机器人按照指定队形移动。Chen X P、Serrani A和Ozbay H在文南犬(Control of leader-follower formations of terrestrial UAVs)中 提出利用集中式领航跟随法来解决多移动机器人编队问题,通过保证领航者按照指定路线 运行,各个跟随者努力跟随领航者来对多移动机器人进行编队控制,当领航者运行路线偏 离轨道时,多移动机器人依然能够保持一定队形,以此提高系统鲁棒性。Khatib等在1986 年在论文(Real-time obstacle avoidance for manipulators and mobile robots)首次 提出利用人工势场法来解决多移动机器人的编队控制问题。集中式的编队控制问题虽然解 决了移动机器人间的耦合问题,但是复杂的控制器设计和巨大的计算量和通信量给系统的 控制问题带来了难度。贾秋玲、闫建国和王新民在论文(基于势函数的多机器人系统的编 队控制)中提出一种基于人工势场法的分布式控制方法,用于处理多移动机器人的编队问 题,同时利用李雅普诺夫稳定性原理来保证多移动机器人能够有效的跟踪目标,但是该方 法不能很好地解决多移动机器人编队控制问题中的耦合问题,且系统的抗干扰能力差。

【发明内容】

[0005] 为了解决多移动机器人编队控制中控制控制器设计复杂、计算量大、通信量大和 耦合问题难以解决等问题,本发明提供了一种较为简明、易于实现并且具有较好控制效果 的分布式控制方法,用于解决多移动机器人编队控制问题。
[0006] 本发明解决其技术问题所采用的技术方案是:
[0007] -种基于Nash迭代的分布式多移动机器人编队控制方法,包括以下步骤:
[0008] 1)对移动机器人进行建模,以三轮移动机器人为对象,单个移动机器人i的连续 系统偏差模型为: CN 105116900 A 说明书 2/4 页
[0011] 其中,u yq,C^1)表示移动机器人i相对于虚拟移动机器人i的方位偏差,包 括x,y轴上的偏差和运行线速度的角度偏差a y,虚拟移动机器人是在参考轨迹 上按照设定运行状态运行的假想移动机器人,假设虚拟移动机器人i在跟踪点P附近,P点 处的曲率为kPil,k(Sl)为移动机器人i实际运行路线的曲率,'i为虚拟移动机器人i的线 速度,S1为移动机器人i的运行路程,4为S1关于时间的倒数,r Jt拟移动机器人i的角速 度;
[0012] 2)根据式(1) (2)得到移动机器人i的离散线性状态空间偏差模型如下所示:
[0015] 其中,AJPB1分别是移动机器人i的状态矩阵和输入矩阵,X1GO和化仏)分别是 移动机器人i的状态量和控制量;
[0016] 3)定义移动机器人i的性能指标函数J1 (k):
[0018] 其中,Xl(k+j|k),Ul(k+j|k)分别为k时刻预测k+j时刻的状态量和控制量,P,M分 别为预测时域和控制时域,Q1, S1, W1为移动机器人i的权重矩阵,R,R i为全局参考轨迹的半 径和移动机器人i的期望轨迹半径,Su为s D 8]的间距,η为具有耦合关系的移动机器人 集合,进一步得到移动机器人i的控制目标为:
[0020] 4)利用基于Nash迭代的分布式模型预测控制算法,解决多移动机器人编队控制 问题,过程如下:
[0021 ] 步骤4. 1 :初始化;当k = 0时刻,迭代次数p = 0,初始化移动机器人 i,i e (1,. . .,N)的状态量< 和位置量< 0+ 1 μ),其中N为移动机器人个数,.< (々)和 彳(I +11 A)表示在第P次迭代中的Xi (k)和Si (k+11 k)的值;
[0022] 步骤4. 2 :通信;移动机器人i获取相耦合的移动机器人的位置信息 + ,并发送自身的位置信息彳0 + 110;
[0023] 步骤4. 3 :计算本地控制量;利用得到的信息< (々+ I |A ),(/、/) e V,根据式⑶⑷ (5)计算最优本地控制量<+#),其中〃广㈨表示在第P+1次迭代中的U1GO的值,同时更 新自身状态.<fl以)和位置信息<+10+1 μ);
[0024] 步骤4 4 :检查收敛;对于给定的收敛误差ε i,如果存在Il?广(小wf⑷||g,/e (l,..,,iV),则 证明算法已经收敛,得到最优预测控制量< 0㈨,利用最优控制量对移动机器人进行控制,跳至 步骤4. 5,否则ρ = ρ+1,跳至步骤4. 2 ;
[0025] 步骤4. 5 :滚动时域;ρ = 0, k = k+Ι,进入下一个时域的迭代计算,跳至步骤4. 2。
[0026] 本发明的技术构思为:首先给出了一个易于处理的移动机器人的线性系统模型, 然后给出了分布式编队控制的性能指标,最后用于提出了利用基于Nash迭代的分布式模 型预测控制控制算法来解决多移动机器人编队控制问题。
[0027] 本发明的有益效果主要表现在:给出了简单的控制器设计方法,利用分布式控制 方法解决多移动机器人编队控制问题,降低了控制器的计算量和通信量,并且设计的控制 器具有良好的抗扰动能力。
【附图说明】
[0028] 图1是移动机器人轨迹跟踪示意图。
【具体实施方式】
[0029] 下面结合附图对本发明作进一步描述。
[0030] 参照图1,
当前第1页1 2 
网友询问留言 已有0条留言
  • 还没有人留言评论。精彩留言会获得点赞!
1