CN109725532B - 一种应用于多智能体间相对距离控制及自适应矫正方法 - Google Patents
一种应用于多智能体间相对距离控制及自适应矫正方法 Download PDFInfo
- Publication number
- CN109725532B CN109725532B CN201811581645.3A CN201811581645A CN109725532B CN 109725532 B CN109725532 B CN 109725532B CN 201811581645 A CN201811581645 A CN 201811581645A CN 109725532 B CN109725532 B CN 109725532B
- Authority
- CN
- China
- Prior art keywords
- relative distance
- distance
- control
- offset
- detection points
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Active
Links
Images
Abstract
本发明公开了一种应用于多智能体间相对距离控制及自适应矫正方法;可以有效保证多智能体之间的相对距离的控制,避免多智能体之间的碰撞,通过使用ESO可以使系统具有很强的适应性及鲁棒性。另外,设计了一种基于自适应检测点配置的横向校正算法,通过自适应动态设置分段检测点,根据设定的阈值判断自适应调整剩下路线内的检测点数量,可以提高整个系统的时效性。在每个检测点矫正偏移轨迹的距离,使整个多智能体系统中跟随者准确跟随领导者,保证了整个多智能体系统的一致性。并且该算法不需要复杂的通信协议和更高的实时信息处理能力。
Description
技术领域
本发明涉及多智能体领域,研究了关于多智能体间相对距离控制问题,具体提出了一种应用于多智能体间相对距离控制及自适应矫正方法。
背景技术
随着人工智能、通信及信息等技术的发展,多智能体的研究近年来一直是很多人关注的研究热点。多智能体系统可以被广泛应用于公共设施检测、灾难环境调查、军事侦察、仓储搬运等领域,无论在军用方面还是在民用都得到了广泛应用。在实际应用过程中多智能体间的相对距离的控制往往至关重要,多智能体间相对距离控制往往是指跟随者与领导者之间的相对距离控制,领导者可以是某一个智能体作为领导者,也可以是虚拟领导者(通常为编队几何中心,如图1所示),其他成员与领导者保持一定的相对距离。多智能体之间精确地相对距离控制可以保证系统内部成员之间的防碰撞,以及整个多智能体系统的编队控制。尤其是在外部产生很大的干扰时,比如空中智能体遇到阵风、地面智能体遇到负载变化等一些外部干扰时,如何使系统可以表现出很强的适应性和鲁棒性,保证多智能体编队控制成为多智能体系统在实际应用中过程中需关注的问题。另外一个问题是由于路线的偏转以及外部的干扰,相对距离的控制只能保证多智能体之间的距离,并不能完全保证跟随者遵循领导者的路线,这就需要及时纠正偏移的距离。在传统的相对距离控制中,面对多智能体协同处理干扰时,简单的PID控制很难满足系统的控制要求,而且多智能体之间往往需要很复杂的通信协议和很高的实时信息处理能力。
发明内容
本发明针对现有技术的不足,提出了一种应用于多智能体间相对距离控制及自适应矫正方法;可以有效保证多智能体之间的相对距离的控制,避免多智能体之间的碰撞,通过使用ESO可以使系统具有很强的适应性及鲁棒性。另外,设计了一种基于自适应检测点配置的横向校正算法,通过自适应动态设置分段检测点,根据设定的阈值判断自适应调整剩下路线内的检测点数量,可以提高整个系统的时效性。在每个检测点矫正偏移轨迹的距离,使整个多智能体系统中跟随者准确跟随领导者,保证了整个多智能体系统的一致性。并且该算法不需要复杂的通信协议和更高的实时信息处理能力。
本发明具体包括以下步骤::
步骤一:在多智能体系统相对距离控制中,建立一阶控制模型,模型建立过程如下:受控对象是跟随者与领导者之间的相对位置,观察对象是跟随者与领导者之间的距离,假设一阶受控对象模型如下:
其中,u是控制输入,d是系统的输出,b是控制量系数,f(d,w,t)是和当前相对距离和扰动有关的函数,是系统的总的扰动。
系统的误差e=dg-d,dg系统给定距离,为实际跟随者与领导者之间需要的相对距离,则系统的误差状态方程为
采用非线性状态误差反馈空置率进行误差收敛得到
其中k为控制增益,α为非线性指数,0<α<1,fal(e,α,h)为反馈控制规律,通常情况选
其中h为平衡点线性区范围,sgn(x)为符号函数。如果α的选择较小,则跟踪的过程会更快,但过滤效果会变差;h越大,滤波的效果会越好,但会增加跟踪的延迟。
步骤二:建立扩张状态器模型。将总的扰动f(d,w,t)扩张成一个新的状态变量x2,则系统变为
系统建立的扩张状态观测器为:
其中β1和β2是ESO的增益,ε为状态观测器系统误差。
步骤三:结合ESO和PD控制器实现相对距离控制。
扩张状态观测器可以根据系统的输出d和系统的控制输入u来实现系统输出和干扰的实时观测,其中z1对应系统的输出d,z2对应系统总的干扰 f(d,w,t)。则此时扩张状态观测器可以写为:
其中Kp和Kd是PD控制器的控制增益,u0设定通过ESO和PD控制器的输入中间变量。
采用建立的ESO与PD控制器结合的系统模型实现当受控对象的参数变化很大或者存在大的外部干扰时,快速实现所需相对距离控制,并且系统可以表现出很强的鲁棒性和是响应性。
步骤四:根据智能体在每个检测点处对应的位置,计算出相对于检测点的偏移距离和偏移角。假设多智能体的起始位置和终点分别是S和E,相对应的纬度和经度坐标是(LA0,LO0),(LAn,LOn),整个路线其实设置n+1 个检测点,第i检测点对应坐标是(LAi,LOi),那么可以根据当前时刻信息计算出偏移路线的距离:
步骤五:自适应动态设置下一时刻检测点个数。从起点开始检测,在第k时刻时计算出来的此时刻的偏移角度和横向偏移距离通过与设定的角度阈值与设定的阈值dt相比较,来决定是否改变接下来的检测点的数量Nk是否改变,例如正常未改变检测点个数的情况下k时刻剩下的检测点个数为Nk=n-k个,并实现只能体的横向自适应偏移距离矫正。当并且Δdk<dt时,说明当前的智能体偏移较小,可以减少接下来的检测点个数;当并且Δdk>dt时,需要增加接下来的检测点数量;其他情况下检测点数量不变。检测点改变的算法为:
其中Nk+1为第k+1时刻的检测点数量,ktk为检测点数量增益,α1和α2为方向角度偏移权重和横向距离偏移权重,且α1+α2=1,方向角度偏移权重往往大于横向距离偏移权重,所以α1>α2。
步骤七:在每一次矫正相对角度和横向相对距离控制后,检测多智能体间的相对距离是否满足便对编队控制要求,如果满足,则直接判断是否为终点,如果是终点则结束任务,如果不是终点,则继续进行任务,按照既定路线继续执行任务;如果相对距离不满足编队控制要求,则按照基于 ESO和PD控制器结合相对距离控制方法进行相对距离控制,直至满足要求,完成相对距离控制后判断是否为终点,如果是终点则结束任务,如果不是终点,则继续进行任务,按照既定路线继续执行任务。
本发明方法相对已有方法的优点及创新点:首先采用ESO与PD控制控制器结合的方法,相比于单纯传统的PID控制算法,可以实现系统本身很强的自抗干扰性,可以保证在外部干扰较大的情况下仍然能领导者与跟随者之间的相对距离的控制避免,多智能体之间的碰撞,并且保证编队的控制,系统的适应性及鲁棒性都大大加强;在实现相对距离控制满足所需的相对距离的基础上,基于采用自适应检测点配置的横向校正的方法,可以保证在智能体偏离规定路线时及时校正,并且基于自适应检测点配置的方法,当处于规定路线上时,可以减少后续的检测点个数,减少了智能体之间复杂的通信协议,具有更高的实时信息处理能力。
附图说明
图1多智能体系统编队模型图;
图2ES0与PD控制器结合的控制器系统模型图;
图3多检测点横向偏移示意图;
图4基于自适应检测点配置的横向校正算法流程图。
具体实施方式
本发明一种应用于多智能体间相对距离控制及自适应矫正方法,具体包括以下步骤:
步骤一:在多智能体系统相对距离控制中,建立一阶控制模型,模型建立过程如下:受控对象是跟随者与领导者之间的相对位置,观察对象是跟随者与领导者之间的距离,假设一阶受控对象模型如下:
其中,u是控制输入,d是系统的输出,b是控制量系数,f(d,w,t)是和当前相对距离和扰动有关的函数,是系统的总的扰动。
系统的误差e=dg-d,dg系统给定距离,为实际跟随者与领导者之间需要的相对距离,则系统的误差状态方程为
采用非线性状态误差反馈空置率进行误差收敛得到
其中k为控制增益,α为非线性指数,0<α<1,fal(e,α,h)为反馈控制规律,通常情况选
其中h为平衡点线性区范围,sgn(x)为符号函数。如果α的选择较小,则跟踪的过程会更快,但过滤效果会变差;h越大,滤波的效果会越好,但会增加跟踪的延迟。
步骤二:建立扩张状态器模型。将总的扰动f(d,w,t)扩张成一个新的状态变量x2,则系统变为
系统建立的扩张状态观测器为:
其中β1和β2是ESO的增益,ε为状态观测器系统误差。
步骤三:结合ESO和PD控制器实现相对距离控制。扩张状态观测器可以根据系统的输出d和系统的控制输入u来实现系统输出和干扰的实时观测,其中z1对应系统的输出d,z2对应系统总的干扰f(d,w,t)。则此时扩张状态观测器可以写为:
其中Kp和Kd是PD控制器的控制增益,u0设定通过ESO和PD控制器的输入中间变量。
上述建立的ESO与PD控制器结合的系统模型如图2。采用上述的数学模型实现当受控对象的参数变化很大或者存在大的外部干扰时,快速实现所需相对距离控制,并且系统可以表现出很强的鲁棒性和是响应性。
步骤四:根据智能体在每个检测点处对应的位置,计算出相对于检测点的偏移距离和偏移角。如图3所示,假设多智能体的起始位置和终点分别是S和E,相对应的纬度和经度坐标是(LA0,LO0),(LAn,LOn),整个路线其实设置n+1个检测点,第i检测点对应坐标是(LAi,LOi),那么可以根据当前时刻信息计算出偏移路线的距离:
步骤五:自适应动态设置下一时刻检测点个数。从起点开始检测,在第k时刻时计算出来的此时刻的偏移角度和横向偏移距离通过与设定的角度阈值与设定的阈值dt相比较,来决定是否改变接下来的检测点的数量Nk是否改变,例如正常未改变检测点个数的情况下k时刻剩下的检测点个数为Nk=n-k个,并实现只能体的横向自适应偏移距离矫正。当并且Δdk<dt时,说明当前的智能体偏移较小,可以减少接下来的检测点个数;当并且Δdk>dt时,需要增加接下来的检测点数量;其他情况下检测点数量不变。检测点改变的算法为:
其中Nk+1为第k+1时刻的检测点数量,ktk为检测点数量增益,α1和α2为方向角度偏移权重和横向距离偏移权重,且α1+α2=1,方向角度偏移权重往往大于横向距离偏移权重,所以α1>α2。
步骤七:在每一次矫正相对角度和横向相对距离控制后,检测多智能体间的相对距离是否满足便对编队控制要求,如果满足,则直接判断是否为终点,如果是终点则结束任务,如果不是终点,则继续进行任务,按照既定路线继续执行任务;如果相对距离不满足编队控制要求,则按照基于 ESO和PD控制器结合相对距离控制方法进行相对距离控制,直至满足要求,完成相对距离控制后判断是否为终点,如果是终点则结束任务,如果不是终点,则继续进行任务,按照既定路线继续执行任务。整个方法流程图如图4所示。
Claims (1)
1.一种应用于多智能体间相对距离控制及自适应矫正方法,其特征在于,具体包括以下步骤:
步骤一:在多智能体系统相对距离控制中,建立一阶控制模型,模型建立过程如下:受控对象是跟随者与领导者之间的相对位置,观察对象是跟随者与领导者之间的距离,假设一阶受控对象模型如下:
其中,u是控制输入,d是系统的输出,b是控制量系数,f(d,w,t)是和当前相对距离和扰动有关的函数,是系统的总的扰动;
系统的误差e=dg-d,dg系统给定距离,为实际跟随者与领导者之间需要的相对距离,则系统的误差状态方程为
采用非线性状态误差反馈控制率 进行误差收敛得到
其中k为控制增益,α为非线性指数,0<α<1,fal(e,α,h)为反馈控制规律,通常情况选
其中h为平衡点线性区范围,sgn(x)为符号函数;
步骤二:建立扩张状态器模型;将总的扰动f(d,w,t)扩张成一个新的状态变量x2,则系统变为
系统建立的扩张状态观测器为:
其中β1和β2是ESO的增益,ε为状态观测器系统误差;
步骤三:结合ESO和PD控制器实现相对距离控制;
扩张状态观测器根据系统的输出d和系统的控制输入u来实现系统输出和干扰的实时观测,其中z1对应系统的输出d,z2对应系统总的干扰f(d,w,t);则此时扩张状态观测器写为:
其中Kp和Kd是PD控制器的控制增益,u0设定为通过ESO和PD控制器的输入中间变量;
步骤四:根据智能体在每个检测点处对应的位置,计算出相对于检测点的偏移距离和偏移角;
假设多智能体的起、止位置分别是S和E,相对应的纬度和经度坐标是(LA0,LO0),(LAn,LOn),整个路线其实设置n+1个检测点,第i检测点对应坐标是(LAi,LOi),那么可以根据当前时刻信息计算出偏移路线的距离:
步骤五:自适应动态设置下一时刻检测点个数;
从起点开始检测,在第k时刻时计算出来的此时刻的偏移角度和横向偏移距离通过与设定的角度阈值与设定的阈值dt相比较,来决定是否改变接下来的检测点的数量Nk;未改变检测点个数的情况下k时刻剩下的检测点个数为Nk=n-k个,并实现智能体的横向自适应偏移距离矫正;当并且Δdk<dt时,说明当前的智能体偏移较小,减少接下来的检测点个数;当并且Δdk>dt时,需要增加接下来的检测点数量;其他情况下检测点数量不变;检测点改变的算法为:
其中Nk+1为第k+1时刻的检测点数量,ktk为检测点数量增益,α1和α2为方向角度偏移权重和横向距离偏移权重,且α1+α2=1,方向角度偏移权重往往大于横向距离偏移权重,所以α1>α2;
步骤六:根据实际情况设置校正系数,得到实际矫正参数;
步骤七:在每一次矫正相对角度和横向相对距离控制后,检测多智能体间的相对距离是否满足编队控制要求,如果满足,则直接判断是否为终点,如果是终点则结束任务,如果不是终点,则继续进行任务,按照既定路线继续执行任务;如果相对距离不满足编队控制要求,则按照基于ESO和PD控制器结合相对距离控制方法进行相对距离控制,直至满足要求,完成相对距离控制后判断是否为终点,如果是终点则结束任务,如果不是终点,则继续进行任务,按照既定路线继续执行任务。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201811581645.3A CN109725532B (zh) | 2018-12-24 | 2018-12-24 | 一种应用于多智能体间相对距离控制及自适应矫正方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201811581645.3A CN109725532B (zh) | 2018-12-24 | 2018-12-24 | 一种应用于多智能体间相对距离控制及自适应矫正方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN109725532A CN109725532A (zh) | 2019-05-07 |
CN109725532B true CN109725532B (zh) | 2021-11-16 |
Family
ID=66296287
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201811581645.3A Active CN109725532B (zh) | 2018-12-24 | 2018-12-24 | 一种应用于多智能体间相对距离控制及自适应矫正方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN109725532B (zh) |
Families Citing this family (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110209175B (zh) * | 2019-06-28 | 2021-09-03 | 同济大学 | 基于分布式有限时间状态观测器的多智能车辆编队方法 |
CN110687776B (zh) * | 2019-10-30 | 2022-08-02 | 长江三峡通航管理局 | 一种多船同步过闸自适应巡航编队控制系统及方法 |
CN110928185B (zh) * | 2019-11-22 | 2022-07-05 | 广东工业大学 | 一种多智能体系统的量化控制方法 |
CN111897316B (zh) * | 2020-06-22 | 2021-05-14 | 北京航空航天大学 | 一种场景快变条件下的多飞行器自主决策方法 |
CN114296473B (zh) * | 2021-11-30 | 2022-09-09 | 北京航空航天大学 | 一种避免碰撞和通信中断的多智能体自适应编队控制方法 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP0649089A1 (en) * | 1993-10-14 | 1995-04-19 | Digital Equipment Corporation | System and method for optimizing message flows between agents in distributed computations |
CN104281053A (zh) * | 2013-07-08 | 2015-01-14 | 哈尔滨点石仿真科技有限公司 | 一种解决通信时滞的多智能体协同控制方法 |
CN105527960A (zh) * | 2015-12-18 | 2016-04-27 | 燕山大学 | 一种基于领航跟随的移动机器人编队控制方法 |
CN106444701A (zh) * | 2016-09-14 | 2017-02-22 | 南京航空航天大学 | 领导‑跟随型多智能体系统的有限时间鲁棒故障诊断设计方法 |
CN108646550A (zh) * | 2018-04-03 | 2018-10-12 | 江苏江荣智能科技有限公司 | 一种基于行为选择的多智能体编队方法 |
Family Cites Families (15)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US6027112A (en) * | 1998-03-02 | 2000-02-22 | Xerox Corporation | Adaptive multiagent control system for controlling object motion with smart matter |
CN100445046C (zh) * | 2000-10-13 | 2008-12-24 | 索尼公司 | 机器人装置及其行为控制方法 |
US7742845B2 (en) * | 2002-07-22 | 2010-06-22 | California Institute Of Technology | Multi-agent autonomous system and method |
WO2004018158A2 (en) * | 2002-08-21 | 2004-03-04 | Neal Solomon | Organizing groups of self-configurable mobile robotic agents |
CN104281052A (zh) * | 2013-07-06 | 2015-01-14 | 哈尔滨点石仿真科技有限公司 | 一种基于行为的领航者-跟随者多智能体队形控制方法 |
US9216745B2 (en) * | 2013-09-16 | 2015-12-22 | Disney Enterprises, Inc. | Shared control of semi-autonomous vehicles including collision avoidance in multi-agent scenarios |
KR101416916B1 (ko) * | 2013-12-13 | 2014-07-09 | 국방과학연구소 | 에이전트 기반의 군사 시뮬레이션 환경에서 물자의 최적 분배 시스템 및 그것의 제어방법 |
SG10201505848SA (en) * | 2014-10-03 | 2016-05-30 | Infinium Robotics Pte Ltd | Method and apparatus for controlling agent movement in an operating space |
CN104865960B (zh) * | 2015-04-29 | 2017-09-12 | 山东师范大学 | 基于平面的一种多智能体队形控制方法 |
CN105467981A (zh) * | 2015-12-24 | 2016-04-06 | 中南大学 | 一种针对多个智能体的编队方法以及装置 |
CN106200379B (zh) * | 2016-07-05 | 2018-11-16 | 杭州电子科技大学 | 一种非自衡对象的分布式动态矩阵控制方法 |
US10409230B2 (en) * | 2016-11-01 | 2019-09-10 | Mitsubishi Electric Research Laboratories, Inc | Multi-agent control system and method |
KR101925203B1 (ko) * | 2017-02-01 | 2019-02-28 | 한국기술교육대학교 산학협력단 | 무인 화재 진압 시뮬레이션 장치 및 그 방법 |
CN108181926A (zh) * | 2017-12-28 | 2018-06-19 | 南京邮电大学 | 基于快速有限时间一致性协议的多智能体系统的编队方法 |
CN108628169B (zh) * | 2018-06-01 | 2021-05-18 | 湖南工业大学 | 基于多智能体的动车组停车一致性控制方法 |
-
2018
- 2018-12-24 CN CN201811581645.3A patent/CN109725532B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP0649089A1 (en) * | 1993-10-14 | 1995-04-19 | Digital Equipment Corporation | System and method for optimizing message flows between agents in distributed computations |
CN104281053A (zh) * | 2013-07-08 | 2015-01-14 | 哈尔滨点石仿真科技有限公司 | 一种解决通信时滞的多智能体协同控制方法 |
CN105527960A (zh) * | 2015-12-18 | 2016-04-27 | 燕山大学 | 一种基于领航跟随的移动机器人编队控制方法 |
CN106444701A (zh) * | 2016-09-14 | 2017-02-22 | 南京航空航天大学 | 领导‑跟随型多智能体系统的有限时间鲁棒故障诊断设计方法 |
CN108646550A (zh) * | 2018-04-03 | 2018-10-12 | 江苏江荣智能科技有限公司 | 一种基于行为选择的多智能体编队方法 |
Also Published As
Publication number | Publication date |
---|---|
CN109725532A (zh) | 2019-05-07 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109725532B (zh) | 一种应用于多智能体间相对距离控制及自适应矫正方法 | |
Zheng et al. | NN-based fixed-time attitude tracking control for multiple unmanned aerial vehicles with nonlinear faults | |
Al-Dhaifallah et al. | Fuzzy fractional-order PID controller for fractional model of pneumatic pressure system | |
Dong et al. | A high-performance flight control approach for quadrotors using a modified active disturbance rejection technique | |
CN110362075B (zh) | 一种具有预设性能的无人艇输出反馈编队控制设计方法 | |
Liu et al. | Robust trajectory tracking control of marine surface vessels with uncertain disturbances and input saturations | |
WO2022160618A1 (zh) | 载人飞行器飞行姿态控制方法、系统及载人飞行器 | |
Faulwasser et al. | Nonlinear model predictive path-following control | |
KR101849464B1 (ko) | Pid 게인 자동 튜닝 방법 | |
CN111665855A (zh) | 一种机器人预设性编队控制方法 | |
CN107450320B (zh) | 一种执行器失效的模糊自适应补偿控制方法 | |
Chen et al. | Robust distributed average tracking for coupled general linear systems | |
CN110865655B (zh) | 无人机系统中无人机的编队和避障控制方法 | |
Mondal et al. | Homogeneous finite-time consensus control for higher-order multi-agent systems by full order sliding mode | |
CN114721275A (zh) | 一种基于预设性能的视觉伺服机器人自适应跟踪控制方法 | |
Ahmadi et al. | Optimization of a self-tuning PID type fuzzy controller and a PID controller for an inverted pendulum | |
Das et al. | UDE based backstepping design for ship autopilot | |
CN114859725A (zh) | 一种非线性系统自适应事件触发控制方法及系统 | |
Bai et al. | A new state observer for active disturbance rejection control with measurement noise and output delay using the PDE-backstepping predictor | |
Deniz et al. | Experimental verification of lead-lag compensators on a twin rotor system | |
JPH0363704A (ja) | モデル規範型適応制御器 | |
Karumanchi et al. | Reactive control in environments with hard and soft hazards | |
CN111355887A (zh) | 一种高速球型摄像机目标跟踪聚焦的优化方法 | |
Ou et al. | Finite-time tracking control for multiple nonholonomic mobile robots with external disturbances and uncertainties | |
CN115648227B (zh) | 一种机器人运动轨迹神经网络模糊控制优化方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |