一种多机器人系统有限时间鲁棒协同跟踪控制方法技术方案

一种多机器人系统有限时间鲁棒协同跟踪控制方法，涉及多机器人系统的控制方法。为了解决现有的多机器人控制系统控制方法的鲁棒性较差的问题和多机器人系统的整体通讯负担过重的问题。本发明专利技术首先建立多机器人系统中跟随机器人的动力学模型动力学模型可线性化为：定义变量qri、z1i、z2i，结合虚拟控制器α1i得到设计分布式控制律和线性化参数自适应律实现每个跟随机器人在有限时间内追随具有动态时变轨迹的领航机器人且跟踪误差有界，完成多机器人系统有限时间跟踪控制。本发明专利技术适用于多机器人系统的控制领域。

【技术实现步骤摘要】
一种多机器人系统有限时间鲁棒协同跟踪控制方法
本专利技术涉及多机器人系统的控制方法。
技术介绍
机器人技术的不断发展，机器人的应用领域以及范围都不断随之扩展，人们对机器人的要求也越来越高，因此希望研制出功能更为复杂的机器人，但是机器人本身的系统结构就非常复杂，如果再增加其它更多的功能，那么它的系统可靠性和效率都有可能降低。此外还有很多任务仅凭单个机器人无法完成，需要多个机器人协调合作完成。随着计算机技术和无线通信技术的发展，多机器人协调合作已经成为可能，且得到了越来越多的应用。从多机器人系统控制框架的角度来看，多机器人编队控制主要可以分为：集中控制式、分布式和监控式三种方式。根据多机器人系统中领航机器人个数分类，多机器人协调控制问题分为无领航机器人的一致性控制问题、单领航机器人的跟踪控制问题和多领航机器人的包含控制问题。现有研究大多使用一阶或二阶线性积分系统描述机器人的动力学特性。然而多数实际物理系统中往往存在非线性特性，因此，用线性模型去刻画实际的物理系统明显具有一定的缺陷。相比之下，用Euler-Lagrange系统模型(一种二阶非线性模型)可以很好地描述众多实际系统(如机械人、航天器等)，使得用Euler-Lagrange方程描述的多机器人系统的协调控制具有广阔的应用前景。在多机器人系统协调控制领域，目前的许多工作都关注于无领航机器人的一致性问题，但在实际中，存在单个领航机器人的情况具有更广阔的应用价值。存在单领航机器人的协调跟踪控制问题中，通过对每一个跟随机器人设计分布式的控制算法使整个闭环系统的状态或输出渐近趋向于由领航机器人产生的轨迹。由于领航机器人独立于其他的所有跟随机器人，但领航机器人可以影响所有跟随机器人的运动，因此，通过控制领航机器人，就可以实现由领航机器人和跟随机器人组成的整个网络系统的控制目标，即达到规则有序的协调运动。这样的控制方法不但简化了系统设计还节省了系统的能源消耗。《Decentralizedadaptiveleaderfollowercontrolofmulti-manipulatorsystemwithuncertaindynamics》对领航机器人为动态情况下的分布式协调跟踪控制问题进行了研究。考虑系统中存在参数不确定性，以Euler-Lagrange系统模型作为动力学模型，利用YI线性化方法，设计分布式自适应跟踪控制算法，使系统中所有跟随机器人渐近跟踪领航机器人的运动轨迹。该方案中设计的分布式自适应跟踪控制算法，使系统中所有跟随机器人渐近跟踪领航机器人的运动轨迹。基于系统渐近收敛设计的控制器在实际应用时具有一定的局限性，因为渐近收敛未考虑到时间的限制；现实情况下，在时间趋于无穷大后才能得到误差趋于零的条件很难得到满足。《Backstepping-basedsynchronisationofuncertainnetworkedLagrangiansystems》基于有向图研究了多机器人系统协调跟踪问题。文中分别针对标称Euler-Lagrange系统模型和带有参数不确定性的Euler-Lagrange系统模型，利用back-stepping方法设计分布式控制律，使跟随机器人可以渐近跟踪领航机器人轨迹。本方案中每个跟随机器人均可以获得领航机器人速度和加速度信息，增加了传感器配置且加重了通讯负担。同样方案中设计的分布式自适应跟踪控制算法，是使系统中所有跟随机器人渐近跟踪领航机器人的运动轨迹。基于系统渐近收敛设计的控制器在实际应用时具有一定的局限性。
技术实现思路
本专利技术为了解决现有的多机器人控制系统控制方法的鲁棒性较差的问题和多机器人系统的整体通讯负担过重的问题。一种多机器人系统有限时间鲁棒协同跟踪控制方法，包括以下步骤：步骤1、建立含有1个领航机器人和n个跟随机器人的多机器人系统，领航机器人标记为0，跟随机器人记为vL＝{1,2,…n}；忽略外界干扰的情况下，跟随机器人i∈vL的动力学模型可由如下Euler-Lagrange方程描述：其中，qi∈Rn为广义坐标；为广义速度，为广义加速度；Mi(qi)∈Rn×n为惯量矩阵，是对称正定的；为Coriolis力/偏心力；gi(qi)∈Rn为广义有势力；τi∈Rn为作用于跟随机器人i的广义控制力矢量；n是多机器人系统中机器人的维数；其中，矩阵Mi(qi)、和矢量gi(qi)均为未知量，矩阵Mi(qi)、和矢量gi(qi)均有界；而且矩阵为反对称矩阵，即对于任意向量x∈Rn，对于任意向量x∈Rn,y∈Rn，式(1)所示的动力学模型可线性化为：其中，Yi为已知回归矩阵，Θi为包含跟随机器人i物理参数的未知常值向量；步骤2、根据多机器人系统的通讯拓扑，计算多机器人系统的有向图图论中的加权邻接矩阵A和Laplacian矩阵；步骤3、定义以下变量：z1i＝qi-qri(4)其中，qri为辅助变量，z1i为跟踪误差，z2i为构造的误差，a为一正常数，为加权邻接矩阵A的元素，元素表示跟随机器人i和机器人j*之间信息传递关系；i和j表示参数针对的是跟随机器人，i和j分别属于vL＝{1,2,…n}；i*和j*表示参数针对的是所有机器人(包括领航机器人和跟随机器人)，i*和j*分别属于v＝{0,1,2,…,n}；α1i为虚拟控制器，其形式如式(6)所示：其中，K1为参数矩阵，K1＝diag(K11,K12,…,K1n)；K11,K12,…,K1n为K1中的元素；α为一正常数，α∈(0,1)；为qri的一阶导数；对变量z1i求导后，再引入如公式(6)所示的虚拟控制器，可得其中，函数Sig(·)α定义为Sig(ξ)α＝[|ξ1|αsgn(ξ1),…,|ξn|αsgn(ξn)]T其中，ξ＝[ξ1,ξ2,…,ξn]T∈Rn，sgn(·)为符号函数；步骤4、设计分布式跟踪控制律和线性化参数自适应律，完成多机器人系统有限时间跟踪控制。本专利技术具有以下有益效果：1、本专利技术考虑多机器人系统模型采用非线性的Euler-Lagrange动力学方程，考虑了系统模型非线性不确定性的情况；同时本专利技术考虑系统存在的不确定性，通过参数线性化的方法进行处理，使得系统具有较好的鲁棒性。2、本专利技术的多机器人系统间通讯拓扑为有向图，比一般的无向图更有实际应用价值，而且避免了信息全局可知带来的通讯负担。3、本专利技术设计的控制律具有有限时间特性，具有更快的收敛速度。通过仿真分析，本专利技术的控制精度数值更低，收敛时间更短。4、本专利技术有较高的精度，且在到达时间内所消耗的燃料消耗少，且干扰越大，其优势越明显。附图说明图1为领航机器人与跟随机器人之间的通讯拓扑图；图2的运动轨迹图，i*＝0，…，4；图3的运动轨迹图，i*＝0，…，4；图4τi1的变化曲线图，i＝1,…,4；图5τi2的变化曲线图，i＝1,…,4；图6辅助变量z1i_1变化曲线图，i＝1,…,4；图7辅助变量z1i_2变化曲线图，i＝1,…,4；图8本专利技术的流程图。具体实施方式具体实施方式一：一种多机器人系统有限时间鲁棒协同跟踪控制方法，包括以下步骤：步骤1、建立含有1个领航机器人和n个跟随机器人的多机器人系统，领航机器人标记为0，跟随机器人记为vL＝{1,2,…n}；忽略外界干扰的情况下，跟随机器人i∈vL的动力学模型可由如本文档来自技高网...

【技术保护点】
一种多机器人系统有限时间鲁棒协同跟踪控制方法，其特征在于包括以下步骤：步骤1、建立含有1个领航机器人和n个跟随机器人的多机器人系统，领航机器人标记为0，跟随机器人记为vL＝{1,2,…n}；跟随机器人i∈vL的动力学模型可由如下Euler‑Lagrange方程描述：Mi(qi)q··i+Ci(qi,q·i)q·i+gi(qi)=τi,i∈vL---(1)]]>其中，qi∈Rn为广义坐标；为广义速度，为广义加速度；Mi(qi)∈Rn×n为惯量矩阵，是对称正定的；为Coriolis力/偏心力；gi(qi)∈Rn为广义有势力；τi∈Rn为作用于跟随机器人i的广义控制力矢量；n是多机器人系统中机器人的维数；对于任意向量x∈Rn,y∈Rn，式(1)所示的动力学模型线性化为：Mi(qi)x+Ci(qi,q·i)y+gi(qi)=-Yi(qi,q·i,x,x·)Θi---(2)]]>其中，Yi为回归矩阵，Θi为包含跟随机器人i物理参数的常值向量；步骤2、根据多机器人系统的通讯拓扑，计算多机器人系统的有向图图论中的加权邻接矩阵A和Laplacian矩阵；步骤3、定义以下变量：qri=-aΣj*=0naij*(qi-qj*)---(3)]]>z1i＝qi‑qri     (4)z2i=q·i-α1i---(5)]]>其中，qri为辅助变量，z1i为跟踪误差，z2i为构造的误差，a为一正常数，为加权邻接矩阵A的元素，元素表示跟随机器人i和机器人j*之间信息传递关系；i和j表示参数针对的是跟随机器人，i和j分别属于vL＝{1,2,…n}；i*和j*表示参数针对的是所有机器人，i*和j*分别属于v＝{0,1,2,…,n}；α1i为虚拟控制器，其形式如式(6)所示：α1i=q·ri-K1Sig(z1i)α---(6)]]>其中，K1为参数矩阵，K1＝diag(K11,K12,…,K1n)；K11,K12,…,K1n为K1中的元素；α∈(0,1)；为qri的一阶导数；对变量z1i求导后，再引入如公式(6)所示的虚拟控制器，可得z·1i=z2i-K1Sig(z1i)α---(7)]]>其中，函数Sig(·)α定义为Sig(ξ)α＝[|ξ1|αsgn(ξ1),…,|ξn|αsgn(ξn)]T其中，ξ＝[ξ1,ξ2,…,ξn]T∈Rn，sgn(·)为符号函数；步骤4、设计分布式跟踪控制律和线性化参数自适应律，完成多机器人系统有限时间跟踪控制。...

【技术特征摘要】
1.一种多机器人系统有限时间鲁棒协同跟踪控制方法，其特征在于包括以下步骤：步骤1、建立含有1个领航机器人和n个跟随机器人的多机器人系统，领航机器人标记为0，跟随机器人记为vL＝{1,2,…n}；跟随机器人i∈vL的动力学模型可由如下Euler-Lagrange方程描述：其中，qi∈Rn为广义坐标；为广义速度，为广义加速度；Mi(qi)∈Rn×n为惯量矩阵，是对称正定的；为偏心力；gi(qi)∈Rn为广义有势力；τi∈Rn为作用于跟随机器人i的广义控制力矢量；n是多机器人系统中机器人的维数；对于任意向量x∈Rn,y∈Rn，式(1)所示的动力学模型线性化为：其中，Yi为回归矩阵，Θi为包含跟随机器人i物理参数的常值向量；步骤2、根据多机器人系统的通讯拓扑，计算多机器人系统的有向图图论中的加权邻接矩阵A和Laplacian矩阵；步骤3、定义以下变量：z1i＝qi-qri(4)其中，qri为辅助变量，z1i为跟踪误差，z2i为构造的误差，a为一正常数，为加权邻接矩阵A的元素，元素表示跟随机器人i和机器人j*之间信息传递关系；i和j表示参数针对的是跟随机器人，i和j分别属于vL＝{1,2,…n}；i*和j*表示参数针对的是所有机器人，i*和j*分别属于v＝{0,1,2,…,n}；α1i为虚拟控制器，其形式如式(6)所示：其中，K1为参数矩阵，K1＝diag(K11,K12,…,K1n)；K11,K12,…,K1n为K1中的元素；α∈(0,1)；为qri的一阶导数；对变量z1i求导后，再引入如公式(6)所示的虚拟控制器，可得其中，函数Sig(·)α定义为

【专利技术属性】
技术研发人员：姚俊羽，孙延超，李传江，王鹏宇，马广富，李东禹，
申请(专利权)人：哈尔滨工业大学，
类型：发明
国别省市：黑龙江;23