基于ESO的分布式多移动机器人编队控制方法技术

一种基于ESO的分布式多移动机器人编队控制方法，包括以下步骤：1)对多移动机器人进行建模，得到多移动机器人的分布式离散状态空间偏差模型；2)根据多移动机器人的离散状态空间偏差模型，设计子系统的性能指标，并计算子系统的预测控制量；3)设计移动机器人的扩张状态观测器，得到移动机器人受到的扰动估计值；4)最后，利用得到的扰动估计值设计基于扩张状态观测器的组合控制器。本发明专利技术提供一种较为简明、易于实现并且具有良好抗干扰能力的分布式多移动机器人编队控制方法。

【技术实现步骤摘要】
基于ESO的分布式多移动机器人编队控制方法
本专利技术涉及移动机器人控制，尤其涉及的是多移动机器人分布式编队控制方法。
技术介绍
随着多移动机器人的应用领域的不断扩展，人们希望多移动机器人能够更出色的完成更艰巨的任务；利用多移动机器人可以相互协作，每个机器人都可以根据其他机器人的运行状态调整自身的状态等，以达到协同控制的效果。在对移动机器人协同控制中，实现多移动机器人的编队控制是其最基本也是最重要的目标。所谓编队控制指的是多个移动机器人在前进的过程中保持某种队形，同时又需要满足环境约束(如避开障碍)的控制问题。多移动机器人编队控制的主要问题是如下：1)难以建立易于处理的移动机器人模型；2)多移动机器人的集中控制计算量大、通信量大，难以保证实时性，分布式控制却难以解决移动机器人间的耦合性。近些年来国内外也有很多的学者对多移动机器人编队控制问题做出了很多研究成果。DunbarWB和MurrayRM在论文(Modelpredictivecontrolofcoordinatedmulti-vehicleformations)中提出利用集中式模型预测控制方法来处理多移动机器人的控制问题，通过最小化性能指标来保证多移动机器人按照指定队形移动。ChenXP、SerraniA和OzbayH在文献(Controlofleader-followerformationsofterrestrialUAVs)中提出利用集中式领航跟随法来解决多移动机器人编队问题，通过保证领航者按照指定路线运行，各个跟随者努力跟随领航者来对多移动机器人进行编队控制，当领航者运行路线偏离轨道时，多移动机器人依然能够保持一定队形，以此提高系统鲁棒性。Khatib等在1986年在论文(Real-timeobstacleavoidanceformanipulatorsandmobilerobots)首次提出利用人工势场法来解决多移动机器人的编队控制问题。集中式的编队控制问题虽然解决了移动机器人间的耦合问题，但是复杂的控制器设计和巨大的计算量和通信量给系统的控制问题带来了难度。贾秋玲、闫建国和王新民在论文(基于势函数的多机器人系统的编队控制)中提出一种基于人工势场法的分布式控制方法，用于处理多移动机器人的编队问题，同时利用李雅普诺夫稳定性原理来保证多移动机器人能够有效的跟踪目标，但是该方法不能很好地解决多移动机器人编队控制问题中的耦合问题，且系统的抗干扰能力差。Dunbar等在文献(Distributedrecedinghorizoncontrolformulti-vehicleformationstabilization)中，利用基于RSBK方法的分布式模型预测控制来解决编队控制问题，通过为每个机器人添加约束条件来解决多移动机器人间的耦合问题，但是其无法处理强耦合的情况，同时算法过于复杂。KiattisinK和AndreasZ在文献(DistributedModelPredictiveControlforCoordinatedPathFollowingControlofOmnidirectionalMobileRobots)中提出，利用分布式模型预测控制解决多移动机器人编队控制问题，文中给出了非线性的移动机器人模型，但是文中没有考虑在受外界环境干扰的情况下如何解决多移动机器人的编队控制问题。
技术实现思路
为了解决多移动机器人编队控制中控制控制器设计复杂、计算量大、通信量大、受外界干扰和耦合问题难以解决等问题，本专利技术提供了一种较为简明、易于实现并且具有较好控制效果的分布式控制方法，用于解决多移动机器人编队控制问题。本专利技术解决其技术问题所采用的技术方案是：一种基于ESO的分布式多移动机器人编队控制方法，包括以下步骤：1)对移动机器人进行建模，以三轮移动机器人为对象，单个移动机器人i的连续系统偏差模型：其中，(xe,i,ye,i,αe,i)表示移动机器人i相对于虚拟移动机器人i的方位偏差，包括x,y轴上的偏差xe,i,ye,i和运行线速度的角度偏差αe,i，虚拟移动机器人是在参考轨迹上按照设定运行状态运行的假想移动机器人，假设虚拟移动机器人i在跟踪点P附近，P点处的曲率为kP,i，k(si)为移动机器人i实际运行路线的曲率，vr,i为虚拟移动机器人i的线速度，si为移动机器人i的运行路程，为si关于时间的倒数，ri虚拟移动机器人i的角速度；根据式(1)(2)得到移动机器人i的离散线性状态空间偏差模型如下所示：xi(k+1)＝Aixi(k)+Biui(k)(3)其中：xi＝[xe,i,ye,i,αe,i]T,ui＝[us,i,uk,i]T，τ为采样周期；其中，Ai和Bi分别是移动机器人i的状态矩阵和输入矩阵，xi(k)和ui(k)分别是移动机器人i的状态量和控制量；考虑运行过程中受到外界环境的干扰，根据系统(3)得到实际环境中移动机器人i的离散线性状态空间偏差模型如下：xi,m(k+1)＝Aixi,m(k)+Biui,m(k)+di(k)(4)其中，xi,m,ui,m是实际环境中移动机器人的状态量和控制量，di(k)是移动机器人i在k时刻受到的有界外界环境干扰；2)定义移动机器人i的性能指标函数Ji(k)：其中，xi(k+j|k),ui(k+j|k)分别为k时刻预测k+j时刻的状态量和控制量，P,M分别为预测时域和控制时域，Qi,Si,Wi为移动机器人i的权重矩阵，R,Ri为全局参考轨迹的半径和移动机器人i的期望轨迹半径，si,j为si,sj的间距，η为具有耦合关系的移动机器人集合，进一步得到移动机器人i的控制目标为：利用Nash迭代，通过求解最小化性能指标得到预测模型的最优预测控制量N为移动机器人个数；3)设计扩张状态观测器ESO(ExtendStateObserver,缩写为ESO)：通过ESO观测得到移动机器人i受到扰动的观测值得到移动机器人i的扩张状态方程如下：其中，I为三维单位阵，Δdi(k)＝di(k+1)-di(k)，其中di(k+1)表示下一时刻移动机器人i受到的扰动值，且Δdi有界，进一步得到移动机器人i的扩张状态观测方程：其中，是移动机器人i的扩张状态的观测值，其中是ESO对xi,m的估计值，Li是扩状态方程的观测器增益，Ci＝[I0]；4)设计组合控制器：其中，ki,c＝-(Ci,m(Ai+Biki,1)-1Bi)-1Ci,m(Ai+Biki,1)-1，表示利用误差的观测值对移动机器人的状态量中的ye,i,αe,i进行补偿，利用基于ESO的分布式模型预测控制实现对多移动机器人编队控制的过程如下：步骤4.1：初始化；当k＝0时刻，迭代次数p＝0，初始化移动机器人i,i∈(1,...,N)的状态量和位置量其中和表示在第p次迭代中的xi(k)和si(k+1|k)的值，扰动估计值步骤4.2：通信；移动机器人i获取相耦合的移动机器人的位置信息(i，j)∈η，并发送自身的位置信息步骤4.3：计算本地预测控制量；利用得到的信息根据式(4)(5)(6)计算最优本地控制量其中表示在第p+1次迭代中的ui(k)的值，，同时更新自身状态和位置信息步骤4.4：检查收敛；对于给定的收敛误差εi，如果存在则证明算法已经收敛，得到最优预测控制量跳至步骤4.5，否本文档来自技高网...

【技术保护点】
一种基于ESO的分布式多移动机器人编队控制方法，其特征在于：包括以下步骤：1)对移动机器人进行建模，以三轮移动机器人为对象，单个移动机器人i的连续系统偏差模型：x·e,iy·e,iα·e,i=0kP,ivr,i0-kP,ivr,i0vr,i000xe,iye,iαe,i+100001us,iuk,i---(1)]]>us,iuk,i=-s·i+vr,icosαe,iri-k(si)s·i---(2)]]>其中，(xe,i,ye,i,αe,i)表示移动机器人i相对于虚拟移动机器人i的方位偏差，包括x,y轴上的偏差xe,i,ye,i和运行线速度的角度偏差αe,i，虚拟移动机器人是在参考轨迹上按照设定运行状态运行的假想移动机器人，假设虚拟移动机器人i在跟踪点P附近，P点处的曲率为kP,i，k(si)为移动机器人i实际运行路线的曲率，vr,i为虚拟移动机器人i的线速度，si为移动机器人i的运行路程，为si关于时间的倒数，ri虚拟移动机器人i的角速度；根据式(1)(2)得到移动机器人i的离散线性状态空间偏差模型如下所示：xi(k+1)＝Aixi(k)+Biui(k)          (3)其中：xi＝[xe,i,ye,i,αe,i]T,ui＝[us,i,uk,i]T，A^i=0kP,ivr,i0-kP,ivr,i0vr,i000,B^i=100001,]]>τ为采样周期；其中，Ai和Bi分别是移动机器人i的状态矩阵和输入矩阵，xi(k)和ui(k)分别是移动机器人i的状态量和控制量；考虑运行过程中受到外界环境的干扰，根据系统(3)得到实际环境中移动机器人i的离散线性状态空间偏差模型如下：xi,m(k+1)＝Aixi,m(k)+Biui,m(k)+di(k)          (4)其中，xi,m,ui,m是实际环境中移动机器人的状态量和控制量，di(k)是移动机器人i在k时刻受到的有界外界环境干扰；2)定义移动机器人i的性能指标函数Ji(k)：Ji(k)=Σi=1j=PxiT(k+j|k)Qixi(k+j|k)+Σj=0j=M-1uiT(k+j|k)Siui(k+j|k)+Σ(i,j)∈ηWi(si(k+1|k)RRi-sj(k+1|k)RRj-si,j)2---(5)]]>其中，xi(k+j|k),ui(k+j|k)分别为k时刻预测k+j时刻的状态量和控制量，P,M分别为预测时域和控制时域，Qi,Si,Wi为移动机器人i的权重矩阵，R,Ri为全局参考轨迹的半径和移动机器人i的期望轨迹半径，si,j为si,sj的间距，η为具有耦合关系的移动机器人集合，进一步得到移动机器人i的控制目标为：minui(k),...,ui(k+M-1)Ji(k)---(6)]]>利用Nash迭代，通过求解最小化性能指标得到预测模型的最优预测控制量ui*(k|k)=ki,1xi(k)+ki,2,i∈(1,...,N),]]>N为移动机器人个数；3)设计ESO：通过ESO观测得到移动机器人i受到扰动的观测值得到移动机器人i的扩张状态方程如下：x‾i(k)=A‾ix‾i(k)+B‾iui,m(k)+E‾Δdi(k)---(7)]]>其中，x‾i=xi,mdi,A‾i=AiI0I,B‾i=Bi0,E‾=0I,]]>I为三维单位阵，Δdi(k)＝di(k+1)‑di(k)，其中di(k+1)表示下一时刻移动机器人i受到的扰动值，且Δdi有界，进一步得到移动机器人i的扩张状态观测方程：x~i(k)=(A‾i-LiCi)x~i(k)+B‾iui,m(k)+Lixi,m(k)---(8)]]>其中，x~i=x~i,md~i]]>是移动机器人i的扩张状态的观测值，其中是ESO对xi,m的估计值，Li是扩状态方程的观测器增益，Ci＝[I 0]；4)设计组合控制器：ui,m*(k)=ui*(k|k)+ki,cd~i(k)---(9)]]>其中，ki,c＝‑(Ci,m(Ai+Biki,1)‑1Bi)‑1Ci,m(Ai+Biki,1)‑1，Ci,m=010001]]>表示利用误差的观测值对移动机器人的状态量中的ye,i,αe,i进行补偿，利用基于ESO的分布式模型预测控制实现对多移动机器人编队控制的过程如下：步骤4.1：初始化；当k＝0时刻，迭代次数p＝0，初始化移动机器人i,i∈(1,....

【技术特征摘要】
1.一种基于ESO的分布式多移动机器人编队控制方法，其特征在于：包括以下步骤：1)对移动机器人进行建模，以三轮移动机器人为对象，单个移动机器人i的连续系统偏差模型：其中，(xe,i,ye,i,αe,i)表示移动机器人i相对于虚拟移动机器人i的方位偏差，包括x,y轴上的偏差xe,i,ye,i和运行线速度的角度偏差αe,i，虚拟移动机器人是在参考轨迹上按照设定运行状态运行的假想移动机器人，假设虚拟移动机器人i在跟踪点P附近，P点处的曲率为kP,i，k(si)为移动机器人i实际运行路线的曲率，vr,i为虚拟移动机器人i的线速度，si为移动机器人i的运行路程，为si关于时间的导数，ri为虚拟移动机器人i的角速度；根据式(1)(2)得到移动机器人i的离散线性状态空间偏差模型如下所示：xi(k+1)＝Aixi(k)+Biui(k)(3)其中：xi＝[xe,i,ye,i,αe,i]T,ui＝[us,i,uk,i]T，τ为采样周期；其中，Ai和Bi分别是移动机器人i的状态矩阵和输入矩阵，xi(k)和ui(k)分别是移动机器人i的状态量和控制量；考虑运行过程中受到外界环境的干扰，根据离散线性状态空间偏差模型(3)得到实际环境中移动机器人i的离散线性状态空间偏差模型如下：xi,m(k+1)＝Aixi,m(k)+Biui,m(k)+di(k)(4)其中，xi,m,ui,m是实际环境中移动机器人的状态量和控制量，di(k)是移动机器人i在k时刻受到的有界外界环境干扰；2)定义移动机器人i的性能指标函数Ji(k)：其中，xi(k+j|k),ui(k+j|k)分别为k时刻预测k+j时刻的状态量和控制量，P,M分别为预测时域和控制时域，Qi,Si,Wi为移动机器人i的权重矩阵，R,Ri为全局参考轨迹的半径和移动机器人i的期望轨迹半径，si,j为si,sj的间距，η为具有耦合关系的移动机器人集合，进一步得到移动机器人i...

【专利技术属性】
技术研发人员：刘安东，张荣超，张文安，滕游，俞立，
申请(专利权)人：浙江工业大学，
类型：发明
国别省市：浙江;33