CN105955274B - 基于分布式圆心和半径估计的多机器人圆形编队控制方法 - Google Patents
基于分布式圆心和半径估计的多机器人圆形编队控制方法 Download PDFInfo
- Publication number
- CN105955274B CN105955274B CN201610356953.0A CN201610356953A CN105955274B CN 105955274 B CN105955274 B CN 105955274B CN 201610356953 A CN201610356953 A CN 201610356953A CN 105955274 B CN105955274 B CN 105955274B
- Authority
- CN
- China
- Prior art keywords
- circle
- robot
- formation
- radius
- center
- 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.)
- Expired - Fee Related
Links
- 230000015572 biosynthetic process Effects 0.000 title claims abstract description 65
- 238000000034 method Methods 0.000 title claims abstract description 25
- 238000009795 derivation Methods 0.000 claims description 3
- 238000004891 communication Methods 0.000 description 8
- 230000033001 locomotion Effects 0.000 description 8
- 238000010586 diagram Methods 0.000 description 5
- 230000008901 benefit Effects 0.000 description 3
- 238000005516 engineering process Methods 0.000 description 3
- 230000004048 modification Effects 0.000 description 3
- 238000012986 modification Methods 0.000 description 3
- 230000004888 barrier function Effects 0.000 description 2
- 230000008859 change Effects 0.000 description 2
- 230000000694 effects Effects 0.000 description 2
- 230000004927 fusion Effects 0.000 description 2
- 230000008569 process Effects 0.000 description 2
- 238000011160 research Methods 0.000 description 2
- 230000005856 abnormality Effects 0.000 description 1
- 238000013473 artificial intelligence Methods 0.000 description 1
- 230000005540 biological transmission Effects 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 230000007613 environmental effect Effects 0.000 description 1
- 239000004744 fabric Substances 0.000 description 1
- 230000001681 protective effect Effects 0.000 description 1
- 230000002459 sustained effect Effects 0.000 description 1
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0287—Control of position or course in two dimensions specially adapted to land vehicles involving a plurality of land vehicles, e.g. fleet or convoy travelling
- G05D1/0291—Fleet control
Abstract
本发明公开了一种基于分布式圆心和半径估计的多机器人圆形编队控制方法，包括以下步骤：S1.第i护卫机器人获取相邻作业机器人的位置信息ril(t)；S2.与相邻护卫机器人进行通讯，利用分布式位置估计器得到编队圆心的估计值pi(t)；S3.根据最大值一致性算法得到编队半径ρi(t)；S4.利用编队控制器实现圆形编队控制。本发明在编队过程中使用了分布式位置估计的思想，能够在编队中避免使用所有机器人的位置信息，提高系统鲁棒性、可靠性、经济性。
Description
技术领域
本发明涉及机器人控制领域，具体涉及一种基于分布式圆心和半径估计的多机器人圆形编队控制方法。
背景技术
随着通讯技术及控制理论的日益发展，人工智能等相关应用在处理大型、复杂的实际问题时逐渐体现出巨大的优势。移动机器人通过各类传感器对自身状态及环境信息的感知，能够按照任务的需求自主地完成任务。然而单个机器人往往因为自身的局限性而无法完成某些任务，而需要多个机器人共同完成。早期，这类问题都普遍采用的是集中式控制算法，但全局信息的需求给集中式系统带来一系列问题。随着多机器人协调合作相关研究飞速发展，分布式控制问题成为一大热点。在分布式控制问题中，多个机器人通过局部信息的传递，相互作用并相互影响最终达到状态一致进而完成任务。这样的分布式控制方法能够有效的节约成本并利用局部协调作用得到最大化的群体优势。
随着机器人向应用系统的方向发展，多机器人编队控制问题已成为研究的热点问题。根据不同解决思路，编队控制研究方法分为跟随-领航者法、模型预测控制法和分布式控制法等等。现有方法或是解决了领航跟随编队运动中的通信异常问题，使得通信更加稳定；或是调整队形的尺度来躲避障碍物，使得在进行任务中，能更加适应环境的变化；或是利用位置估计器来实现期望编队。但这些技术方案的队形往往是预先设定好的或者能够根据静止障碍物来进行调整。在多个机器人进行圆形编队时，当圆心和半径在不断发生变化时，上述方法就将不再适用。
发明内容
鉴于此，本发明的目的是提供一种基于分布式圆心和半径估计的多机器人圆形编队控制方法。
本发明的目的是通过以下技术方案实现的，一种基于分布式圆心和半径估计的多机器人圆形编队控制方法，包括以下步骤：S1.第i护卫机器人获取相邻作业机器人的位置信息ril(t)；S2.与相邻护卫机器人进行通讯，利用分布式位置估计器得到编队圆心的估计值pi(t)；S3.根据最大值一致性算法得到编队半径ρi(t)；S4.利用编队控制器实现圆形编队控制。
进一步，在步骤S2中用以下方法获得编队圆心的估计值pi(t)：
其中m为作业机器人的数目，n为护卫机器人的数目，ni表示第i护卫机器人的相邻作业机器人的个数，l∈{1,2,…,ni}，ril(t)表示第i护卫机器人的第l相邻作业机器人的位置信息，Ni(t)为第i护卫机器人的相邻护卫机器人集合，若j∈Ni(t)，则pj(t)表示第i护卫机器人的相邻护卫机器人对圆心的估计值，α为非负常数，是对时间求导。
进一步，在步骤S3中，编队半径ρi(t)通过以下方法获得：
其中，定义ρi(t)表示第i护卫机器人获得的编队半径，ρi(0)表示取第i护卫机器人的各相邻作业机器人与编队圆心距离的最大值作为初始编队半径。
进一步，所述编队控制器如下所述：
其中，yi(t)是护卫机器人的位置信息，pi(t)为编队圆心估计值，ρi(t)为编队半径，保证n个护卫机器人以任意偏转角度θ均匀地分布在圆形编队圆周上，k为常数k＞1保证以pi(t)为圆心，ρi(t)为半径的护卫机器人编队位于作业机器人的外部。
由于采用了上述技术方案，本发明具有如下的优点：
1、在编队过程中使用了分布式位置估计的思想，能够在编队中避免使用所有机器人的位置信息，提高系统鲁棒性、可靠性、经济性。
2、考虑到机器人动态运动情形，在编队过程中加入最大值一致半径算法来获得编队半径。与固定编队半径方案相比，本编队更加灵活，能更加有效的对作业机器人进行保护。
3、结合分布式位置估计器及最大值一致性算法，当多机器人形成的拓扑结构图满足连通的条件下，可以实现有效的编队运动，达到期望的圆形编队，且编队效果与护卫机器人的初始位置无关。
附图说明
为了使本发明的目的、技术方案和优点更加清楚，下面将结合附图对本发明作进一步的详细描述，其中：
图1为圆形编队原理示意图；
图2为通讯拓扑图；
图3为基于分布式圆心和半径估计的机器人圆形编队控制方法流程图。
具体实施方式
以下将结合附图，对本发明的优选实施例进行详细的描述；应当理解，优选实施例仅为了说明本发明，而不是为了限制本发明的保护范围。
一种基于分布式圆心和圆半径估计的机器人圆形编队控制方法，具体过程为：
首先，为了减少传统集中式算法带来的缺陷，引入分布式位置估计器获取编队的中心位置信息，其中编队中心位置与要护卫的所有作业机器人位置相关。每个护卫机器人能够获知各自所需护卫的作业机器人的实时位置信息，各护卫机器人与其相邻的护卫机器人进行通讯，即能获取相邻护卫机器人对应的作业机器人的位置信息。通过局部信息交互，采用本发明位置估计器获取编队中心位置信息。
其次，由于作业机器人在作业过程中是不断运动变化的，则护卫机器人所形成的保护范围需要随着作业机器人的运动而做出相应变动。为了解决这个问题，本发明采用最大值一致半径算法获取编队半径。每个护卫机器人能够获知各自对应的作业机器人与编队中心位置的距离信息，各护卫机器人筛选出最大值作为各自的编队半径并和相邻护卫机器人进行通讯。通过局部通讯，本发明采用的最大值一致性算法能够使得各护卫机器人的编队半径达到一致并满足功能需求。
假设此时有m个作业机器人在作业，指派n个护卫机器人对该m个作业机器人进行保护，确保其不受外来力量干扰以能顺利完成作业。在保证护卫质量的前提下，通常希望n＜m以此节约成本。由于护卫机器人所形成的保护范围需要随着作业机器人的运动而做出相应变动，为了避免使用全局信息，提高系统鲁棒性、可靠性、以及经济性，令每个护卫机器人能够获取邻近作业机器人的位置信息，且同一个作业机器人的位置信息不能被多个护卫机器人同时获取。为了让队形能随作业机器人的运动而变化，令所有作业机器人的位置中心为编队的圆心，各作业机器人到圆心距离的最大值的k倍为编队半径(k＞1)，将护卫机器人均匀的散布在此圆的圆周上形成保护屏障。
如图1所示，有①-⑦号七个作业机器人(图中为无人机)正在进行高空作业(处于同一高度)，选派1-3号三个护卫机器人对其进行保护。其中，1号护卫机器人能够获取①、②号作业机器人的位置信息，2号护卫机器人能够获取③、④号作业机器人的位置信息及3号护卫机器人能够获取⑤、⑥、⑦号作业机器人的位置信息。三个护卫机器人通过局部通讯最终得到七个作业机器人的位置中心，以此作为编队圆心。同时，各自计算出对应作业机器人到圆心的距离，选出最大值作为局部通讯的信息，最终得到一个全局最大值作为编队的半径。三个护卫机器人以该圆心和该半径为依据，均匀的散布在该圆上，从而达到保护作业机器人的目的。
分布式位置估计器获取编队圆心，如式(1)所示，
其中，α为非负常数，m为作业机器人的数目，n为护卫机器人的数目。pi(t)是本发明的分布式估计器对于编队圆心的估计值，该估计值的估计是基于和ψi(t)的值。从式(1)可以看出，是对时间求导，是关于pi(t)的中间变量，Ni为第i个护卫机器人的相邻作业机器人集合。特别地，本发明能够满足n＜m情况，其核心思想在于ψi(t)的定义。通过系统模型知道，每个护卫机器人分别能获取相邻作业机器人的位置信息，且同一个作业机器人的位置信息不被多个护卫机器人同时获取。假设第i个护卫机器人能获取ni个作业机器人的位置信息，则n1+n2+…+nn＝m，ril为对应的作业机器人的位置信息。
再次，根据分布式圆心估计器及最大值一致半径算法，实现对机器人圆形编队的控制。本发明以估计器得到的编队中心位置作为圆心，最大值一致半径算法得到的值作为编队半径，护卫机器人以圆形队形的形式均匀的分布在作业机器人的外部，从而达到保护作业机器人的作用。
最大值一致性算法获取编队半径，如式(2)所示，
其中，定义本发明中将kρ(t)作为编队半径。
基于分布式圆心估计器及最大值一致半径算法圆形编队控制器，如式(3)所示，
其中，yi(t)是护卫机器人的位置信息。常数k＞1，常数θ可以控制n个护卫机器人在圆形编队中均匀分布的偏转角度。
特别地，在本发明中对于实时获取机器人的位置信息与传递该信息的技术显得十分关键。首先，本发明采用基站定位来获得各机器人的实时位置信息，将定位基站固定在预设运动范围的各边上并且将定位标签安装在机器人上。定位标签通过获得与各定位基站的相对位置并结合基站的初始位置信息，从而获得该机器人的位置信息。其次，本发明使用UWB无载波通信技术实现各机器人间的交流通讯。综合运用编码技术实现局部通讯，实现分布式拓扑网络结构。
在多机器人系统模型中，只有当多机器人形成的拓扑结构图满足一定条件时，才可以实现有效的编队运动，达到期望的圆形编队。如图2所示，拓扑图中每个节点代表一个护卫机器人，若节点间有线段连接表示互为邻接点。只有当通讯拓扑图为连通图时，本发明的分布式圆心估计器能够得到期望的编队圆心，同时最大值一致半径算法能得到期望的编队半径。
以上所述仅为本发明的优选实施例，并不用于限制本发明，显然，本领域的技术人员可以对本发明进行各种改动和变型而不脱离本发明的精神和范围。这样，倘若本发明的这些修改和变型属于本发明权利要求及其等同技术的范围之内，则本发明也意图包含这些改动和变型在内。
Claims (3)
1.一种基于分布式圆心和半径估计的多机器人圆形编队控制方法，其特征在于：包括以下步骤：
S1.第i护卫机器人获取第l相邻作业机器人的位置信息ril(t)；
S2.与相邻护卫机器人进行通讯，利用分布式位置估计器得到编队圆心的估计值pi(t)；
S3.根据最大值一致性算法得到编队半径ρi(t)；
S4.利用编队控制器实现圆形编队控制；
在步骤S2中用以下方法获得编队圆心的估计值pi(t)：
其中，m为作业机器人的数目，n为护卫机器人的数目，ni表示第i护卫机器人的相邻作业机器人的个数，l∈{1,2,…,ni}，Ni(t)为第i护卫机器人的相邻护卫机器人集合，若j∈Ni(t)，则pj(t)表示第i护卫机器人的相邻护卫机器人对圆心的估计值，α为非负常数，是对时间求导。
2.根据权利要求1所述的基于分布式圆心和半径估计的多机器人圆形编队控制方法，其特征在于：在步骤S3中，编队半径ρi(t)通过以下方法获得：
其中，定义ρi(t)表示第i护卫机器人获得的编队半径，ρi(0)表示取第i护卫机器人的各相邻作业机器人与编队圆心距离的最大值作为初始编队半径。
3.根据权利要求2所述的基于分布式圆心和半径估计的多机器人圆形编队控制方法，其特征在于：所述编队控制器如下所述：
其中，yi(t)是护卫机器人的位置信息，保证n个护卫机器人以任意偏转角度θ均匀地分布在圆形编队圆周上，k为常数k＞1保证以pi(t)为圆心，ρi(t)为半径的护卫机器人编队位于作业机器人的外端。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201610356953.0A CN105955274B (zh) | 2016-05-25 | 2016-05-25 | 基于分布式圆心和半径估计的多机器人圆形编队控制方法 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201610356953.0A CN105955274B (zh) | 2016-05-25 | 2016-05-25 | 基于分布式圆心和半径估计的多机器人圆形编队控制方法 |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| CN105955274A CN105955274A (zh) | 2016-09-21 |
| CN105955274B true CN105955274B (zh) | 2018-07-03 |
Family
ID=56909869
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN201610356953.0A Expired - Fee Related CN105955274B (zh) | 2016-05-25 | 2016-05-25 | 基于分布式圆心和半径估计的多机器人圆形编队控制方法 |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN105955274B (zh) |
Families Citing this family (4)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN106502250B (zh) * | 2016-11-23 | 2019-03-26 | 北京邮电大学 | 三维空间内多机器人编队的路径规划算法 |
| US11366481B2 (en) * | 2017-08-07 | 2022-06-21 | Panasonic Holdings Corporation | Mobile body and method of controlling mobile body |
| CN111259546B (zh) * | 2020-01-15 | 2022-05-13 | 中国科学技术大学 | 一种自驱动交通工具圆周编队控制方法、系统及存储介质 |
| CN112087718B (zh) * | 2020-08-26 | 2021-07-13 | 电子科技大学 | 基于uwb定位广播式多移动机器人动态虚拟交互方法 |
Family Cites Families (3)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN101515179B (zh) * | 2009-02-17 | 2010-07-28 | 浙江大学 | 一种多机器人队形变换方法 |
| US8318512B2 (en) * | 2009-04-29 | 2012-11-27 | Applied Materials, Inc. | Automated substrate handling and film quality inspection in solar cell processing |
| CN102331711A (zh) * | 2011-08-12 | 2012-01-25 | 江苏合成物联网科技有限公司 | 一种移动自主机器人的编队控制方法 |
-
2016
- 2016-05-25 CN CN201610356953.0A patent/CN105955274B/zh not_active Expired - Fee Related
Also Published As
| Publication number | Publication date |
|---|---|
| CN105955274A (zh) | 2016-09-21 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN105955274B (zh) | 基于分布式圆心和半径估计的多机器人圆形编队控制方法 | |
| CN106426164B (zh) | 一种冗余度双机械臂的多指标协调运动规划方法 | |
| CN104440864B (zh) | 一种主从式遥操作工业机器人系统及其控制方法 | |
| CN105382835B (zh) | 一种可穿越腕部奇异点的机器人路径规划方法 | |
| CN104942809B (zh) | 基于视觉伺服系统的机械臂动态模糊逼近器 | |
| CN106054882A (zh) | 一种机器人避障方法 | |
| CN107662195A (zh) | 一种具有临场感的机器手主从异构遥操作控制系统及控制方法 | |
| CN104834309A (zh) | 基于目标跟踪控制策略的单移动机器人最优巡回控制方法 | |
| CN108638065A (zh) | 一种排爆机器人双臂协同控制系统 | |
| CN105527960A (zh) | 一种基于领航跟随的移动机器人编队控制方法 | |
| CN103271784A (zh) | 基于双目视觉的人机交互式机械手控制系统和控制方法 | |
| CN104133375B (zh) | 一种多auv同步控制器结构及设计方法 | |
| CN106383517A (zh) | 一种自主移动机器人平台用控制系统、方法及装置 | |
| CN103019239A (zh) | 用于喷药移动机器人的轨迹跟踪滑模控制系统和控制方法 | |
| Zhang et al. | A cooperative-control-based underwater target escorting mechanism with multiple autonomous underwater vehicles for underwater Internet of Things | |
| CN103398702A (zh) | 一种移动机器人远程操控装置及其操控技术 | |
| CN111522341A (zh) | 网络异构机器人系统的多时变编队跟踪控制方法及系统 | |
| CN104298244B (zh) | 一种工业机器人三维实时高精度定位装置的定位方法 | |
| CN113829343B (zh) | 基于环境感知的实时多任务多人人机交互系统 | |
| Cheng et al. | Decentralized control of multi-agent systems for swarming with a given geometric pattern | |
| CN106845037A (zh) | 一种五自由度串联机器人的逆运动学通用求解方法 | |
| CN103481288A (zh) | 一种5关节机器人末端工具位姿控制方法 | |
| CN109048897A (zh) | 一种主从机器人遥操作的方法 | |
| Ni et al. | Dynamic bioinspired neural network for multi-robot formation control in unknown environments | |
| CN109491381A (zh) | 基于观测器的多移动机器人自适应编队跟踪控制方法 |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| C06 | Publication | ||
| PB01 | Publication | ||
| C10 | Entry into substantive examination | ||
| SE01 | Entry into force of request for substantive examination | ||
| GR01 | Patent grant | ||
| GR01 | Patent grant | ||
| CF01 | Termination of patent right due to non-payment of annual fee | ||
| CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20180703 Termination date: 20190525 |