一种采用干扰估计器的多运动体跟踪控制方法
【专利摘要】该发明公开了一种采用干扰估计器的多运动体跟踪控制方法，属于运动控制领域,特别是通过一致性控制算法保持多个运动物体运动一致的方法。首先设定各运动体的通讯关系网，保证各运动体能直接或间接的获得领头运动体的运动状态，然后领头运动体发送信号，各运动体接收到与之有关联的运动体的运动状态信号后进行分析、计算，根据计算结果控制本身运动状态，从而达到发明目的。从而在控制多运动体保持运动一致性过程中具有抗干扰能力强、计算量小、实时性强的效果。
【专利说明】一种采用干扰估计器的多运动体跟踪控制方法
【技术领域】
[0001]本发明属于运动控制领域，特别是通过基于干扰估计器的控制算法保持多个运动物体状态鲁棒一致。
【背景技术】
[0002]对于多个运动体，“一致”是指多个运动体形成某种同步或者匹配，比如速度一致或者位置一致，达到某个状态具有相同的步调。运动体的分布式“一致性算法”是指它通过收集与其相邻运动体的信息，加上自身的信息，汇总后都得到的一种可执行方案，从而实现多运动体运动状态的一致。
[0003]然而，运动体运动过程中不可避免的要受到各种干扰，这些干扰都是无法确定和预估的。运动体的外部干扰主要来自于环境的影响，比如紊流、雨滴等对飞行器飞行的影响，会导致飞行器的受力产生变化，从而影响飞行器的飞行轨迹和姿态。另一方面，运动体内部的不确定因素也会对运动体状态产生不可预知的影响。典型的内部干扰表现为由于燃料不停的燃烧或者燃料的加入导致运动体的质量产生变化，比如对于在轨运行的卫星，其转动惯量的精确值一般难以获取，而且该值一般是慢时变的(燃料消耗，导致转动惯量的变化)，这种特点会给卫星姿态的精确调节带来一定难度。
[0004]外部干扰和内部不确定因素会对系统造成不可预测的影响，针对这种影响的解决方案主要有H2控制、H00控制和滑模控制等。其中，前两者具有很好鲁棒性效果，然而它们主要针对的是线性系统，指 标的设定和权函数的选取比较复杂；滑模控制是一种特殊的切换控制，可以在非线性系统中发挥良好的鲁棒控制效果，但是其输出的控制信号存在抖颤，这对于系统的性能非常不利。
【发明内容】
[0005]本发明的目的是针对【背景技术】的不足之处改进设计了一种采用干扰估计器的多运动体跟踪控制方法，从而在控制多运动体保持运动一致性过程中达到抗干扰能力强、计算量小、实时性强的目的。
[0006]本发明的技术方案是首先设定各运动体的通讯关系网，保证各运动体能直接或间接的获得领头运动体的运动状态；然后领头运动体发送信号，各运动体接收到与之有关联的运动体的运动状态信号后进行分析、计算，根据计算结果控制本身运动状态，从而达到发明目的，因而本发明一种采用干扰估计器的多运动体跟踪控制方法包括:
[0007]步骤1:设定各运动体间的通讯关系网，保证各运动体能直接或间接的获得领头运动体的运动状态；
[0008]步骤2:领头运动体发送信号，各运动体接收与之有关联运动体的运动状态信号，然后基于运动体的运动模型:
[0009]训=丨⑴ /(O
v:{t) = μχο + ?^?)[0010]确定控制信号μ i (t)的表达式如下:
[0011]
【权利要求】
1.一种采用干扰估计器的多运动体跟踪控制方法，该方法包括: 步骤1:设定各运动体间的通讯关系网，保证各运动体能直接或间接的获得领头运动体的运动状态； 步骤2:领头运动体发送信号，各运动体接收与之有关联运动体的运动状态信号，然后基于运动体的运动模型:⑴m ⑴
ViU) = μXt) +d (O 确定控制信号Ui(t)的表达式如下: ,",.(O = 4 (O 其中Ti (t)为第i个运动体的位置信息，Vi (t)为第i个运动体的速度信，(Ii (t)为干扰信号，4⑴为干扰估计信号，Ui (t)为标定控制信号， 信号Ui (t)保证如下的标定模型: ? (O = Vi (O ⑵ ?，,.(0 = ",.(/) 实现状态一致性跟踪； 步骤3:标定控制信号Ui (t)的确定，其具体表达式如下:
2.如权利要求1所述的一种采用干扰估计器的多运动体跟踪控制方法，其特征摘要步骤4的具体步骤为: 步骤4-1:建立式(O的拉普拉斯关系式:式=Qxdj = QO;.-//,.)， 其中:Q代表低通滤波器，步骤4-2:取步骤4-1中拉氏变换为，得到:
【文档编号】G05B13/02GK104035328SQ201410280413
【公开日】2014年9月10日 申请日期:2014年6月21日 优先权日:2014年6月21日
【发明者】朱波, 孟长 申请人:电子科技大学