CN110502016A - 一种保持多机器人队列巡逻一致性的方法 - Google Patents
一种保持多机器人队列巡逻一致性的方法 Download PDFInfo
- Publication number
- CN110502016A CN110502016A CN201910809810.4A CN201910809810A CN110502016A CN 110502016 A CN110502016 A CN 110502016A CN 201910809810 A CN201910809810 A CN 201910809810A CN 110502016 A CN110502016 A CN 110502016A
- Authority
- CN
- China
- Prior art keywords
- robot
- formation
- patrol
- consistency
- pilotage people
- 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.)
- Pending
Links
- 238000000034 method Methods 0.000 title claims abstract description 21
- 230000015572 biosynthetic process Effects 0.000 claims abstract description 31
- 238000004590 computer program Methods 0.000 claims description 6
- 230000017105 transposition Effects 0.000 claims description 4
- 238000004364 calculation method Methods 0.000 claims 1
- 239000011800 void material Substances 0.000 claims 1
- 230000009286 beneficial effect Effects 0.000 description 2
- 206010033799 Paralysis Diseases 0.000 description 1
- 230000006399 behavior Effects 0.000 description 1
- 230000008901 benefit Effects 0.000 description 1
- 230000007812 deficiency Effects 0.000 description 1
- 238000006073 displacement reaction Methods 0.000 description 1
- 230000006872 improvement Effects 0.000 description 1
- 230000007246 mechanism Effects 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000008569 process Effects 0.000 description 1
- 238000006467 substitution reaction Methods 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, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- 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
Landscapes
- Engineering & Computer Science (AREA)
- Aviation & Aerospace Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Manipulator (AREA)
Abstract
本发明属于移动机器人技术领域,具体涉及一种保持多机器人队列巡逻一致性的方法,包括步骤:Step1:确定队形,即确定各个机器人的相对位置关系;选择队形的中心为笛卡尔坐标系的原点,记录机器人在该坐标下的坐标;Step2:生成虚拟领航者,以step1中队形的中心为虚拟领航者的位置;step3;队形运动,向虚拟领航者发送运动控制指令。本方案根据队形生成虚拟领航者,并根据机器人运动模型更新虚拟领航者的位姿状态,保证了领航者不会受外界干扰,从而提升多机器人巡逻***的稳定性;将队形看作刚体并实时更新保证了机器人队形运动的一致性。
Description
技术领域
本发明属于移动机器人技术领域,具体涉及一种保持多机器人队列巡逻一致性的方法。
背景技术
多机器人编队是典型的多机器人***协作课题,要求从***的角度探讨机器人群体的合作行为、信息交互及进化机制等。随着多机器人学的发展,目前多机器人编队控制已成为一个广受关注的问题。
现有技术中常见的有跟随领航者法:即选定其中一个机器人作为领航者,其它机器人通过跟踪领航者的状态来控制自身运动来使整个***实现特定任务现有技术的缺点:跟随领航者法实现简单,然而一旦领航者出现问题,则整个多机器人***瘫痪,***稳定性差。
发明内容
为了解决现有技术中存在的技术缺陷,本发明提出了一种保持多机器人队列巡逻一致性的方法。
本发明通过以下技术方案实现:
一种保持多机器人队列巡逻一致性的方法,包括步骤:
Step1:确定队形,获取各个机器人的位置关系;并以队形的中心为坐标原点;
Step2:生成虚拟领航者,以step1中队形的中心为虚拟领航者的位置,记为R0;
step3;队形运动,向虚拟领航者发送运动控制指令。
进一步地,所述step3进一步包括:向虚拟领航者发送运动控制指令,控制量为ut,并根据运动模型更新虚拟领航者位姿状态xt,运动模型如下:
xt=f(ut,xt-1)
式中,xt=[x,y,θ]T,下标t为时刻,T表示转置,(x,y)为虚拟领航者世界坐标,θ为虚拟领航者朝向角。
进一步地,其他机器人基于跟踪虚拟领航者的位姿,来确定自己的目标位姿。
进一步地,所述其他机器人基于跟踪虚拟领航者的位姿,来确定自己的目标坐标具体包括:机器人Ri的目标位姿为[x+△xi,y+△yi,θ]T,
其中,i=1,2,...,n,n为机器人总数,(△xi,△yi)为机器人Ri相对于队形中心的坐标,T表示转置。
进一步地,所述step3进一步包括:控制机器人在指定的时间内运动到目标位姿。
一种计算机程序,其包括一条或多条计算机指令,所述一条或多条计算机指令在执行时实现所述的保持多机器人队列巡逻一致性的方法。
还涉及一种计算机可读存储介质,其上存储有计算机程序,该程序被处理器执行时实现所述的保持多机器人队列巡逻一致性的方法的步骤。
还涉及一种计算机设备,包括存储器、处理器及存储在存储器上并可在处理器上运行的计算机程序,所述处理器执行所述程序时实现所述的保持多机器人队列巡逻一致性的方法的步骤。
与现有技术相比,本发明至少具有下述的有益效果或优点:
1)根据队形生成虚拟领航者,并根据机器人运动模型更新虚拟领航者的位姿状态,保证了领航者不会受外界干扰,从而提升多机器人巡逻***的稳定性;
2)将队形看作刚体并实时更新保证了机器人队形运动的一致性。
附图说明
以下将结合附图对本发明做进一步详细说明;
图1为本发明的多机器人队形图;
图2为本发明的队列巡逻流程图。
具体实施方式
下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。
本发明提供一种为多机器人在队列巡逻过程中如何保持队形一致性的方案:每个机器人有唯一身份编号。
Step1:确定队形
即确定各个机器人的相对位置关系。选择队形的中心为笛卡尔坐标系的原点,记录机器人在该坐标下的坐标,R1(△x1,△y1),R2(△x2,△y2)…Rn(△xn,△yn)。式中Ri表示的为编号为i的机器人,i=1,2,...,n,(△xi,△yi)为机器人Ri相对于队形中心的坐标,n为机器人总数;多机器人队形如图1所示。
Step2:生成虚拟领航者
以step1中队形的中心为虚拟领航者的位置,记为R0。
step3;队形运动
向虚拟领航者发送运动控制指令,控制量为ut,并根据运动模型更新虚拟领航者位姿状态xt,运动模型如下:
xt=f(ut,xt-1)
这里xt=[x,y,θ]T,(x,y)为虚拟领航者世界坐标,θ为虚拟领航者朝向角。
其他机器人则跟踪虚拟领航者的位姿,来确定自己的目标坐标,以机器人R1为例,将队形看作一个刚体,则机器人R1的目标位姿为[x+△x1,y+△y1,θ]T。然后基于机器人当前位姿和目标位姿根据运动模型反解出所需运动控制量,从而控制机器人在指定的时间内运动到目标位姿,如此多机器队列巡逻就能稳定的保证队形的一致性了;队列巡逻流程图如图2所示。
本发明还提供了一种计算机程序,其包括一条或多条计算机指令,所述一条或多条计算机指令在执行时实现保持多机器人队列巡逻一致性的方法。
以上所述的具体实施例,对本发明的目的、技术方案和有益效果进行了进一步详细说明,所应理解的是,以上所述仅为本发明的具体实施例而已,并不用于限定本发明的保护范围。在不脱离本发明之精神和范围内,所做的任何修改、等同替换、改进等,同样属于本发明的保护范围之内。
Claims (8)
1.一种保持多机器人队列巡逻一致性的方法,其特征在于,包括步骤:
Step1:确定队形,获取各个机器人的位置关系;并以队形的中心为坐标原点;
Step2:生成虚拟领航者,以step1中队形的中心为虚拟领航者的位置,记为R0;
step3;队形运动,向虚拟领航者发送运动控制指令。
2.根据权利要求1所述的保持多机器人队列巡逻一致性的方法,其特征在于,所述step3进一步包括:向虚拟领航者发送运动控制指令,控制量为ut,并根据运动模型更新虚拟领航者位姿状态xt,运动模型如下:
xt=f(ut,xt-1)
式中,xt=[x,y,θ]T,下标t为时刻,T表示转置,(x,y)为虚拟领航者世界坐标,θ为虚拟领航者朝向角。
3.根据权利要求2所述的保持多机器人队列巡逻一致性的方法,其特征在于,其他机器人基于跟踪虚拟领航者的位姿,来确定自己的目标位姿。
4.根据权利要求3所述的保持多机器人队列巡逻一致性的方法,其特征在于,所述其他机器人基于跟踪虚拟领航者的位姿,来确定自己的目标坐标具体包括:机器人Ri的目标位姿为[x+△xi,y+△yi,θ]T,
其中,i=1,2,...,n,n为机器人总数,(△xi,△yi)为机器人Ri相对于队形中心的坐标,T表示转置。
5.根据权利要求1所述的保持多机器人队列巡逻一致性的方法,其特征在于,所述step3进一步包括:控制机器人在指定的时间内运动到目标位姿。
6.一种计算机程序,其特征在于,包括一条或多条计算机指令,所述一条或多条计算机指令在执行时实现权利要求1-5任一所述的保持多机器人队列巡逻一致性的方法。
7.一种计算机可读存储介质,其上存储有计算机程序,其特征在于,该程序被处理器执行时实现权利要求1-5任一所述的保持多机器人队列巡逻一致性的方法的步骤。
8.一种计算机设备,包括存储器、处理器及存储在存储器上并可在处理器上运行的计算机程序,其特征在于,所述处理器执行所述程序时实现权利要求1-5任一所述的保持多机器人队列巡逻一致性的方法的步骤。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910809810.4A CN110502016A (zh) | 2019-08-29 | 2019-08-29 | 一种保持多机器人队列巡逻一致性的方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910809810.4A CN110502016A (zh) | 2019-08-29 | 2019-08-29 | 一种保持多机器人队列巡逻一致性的方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN110502016A true CN110502016A (zh) | 2019-11-26 |
Family
ID=68590515
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201910809810.4A Pending CN110502016A (zh) | 2019-08-29 | 2019-08-29 | 一种保持多机器人队列巡逻一致性的方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN110502016A (zh) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111722625A (zh) * | 2019-12-18 | 2020-09-29 | 北京交通大学 | 时变数量群体机器人接力目标跟踪***的稳定性分析方法 |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20100168950A1 (en) * | 2009-01-01 | 2010-07-01 | Masakuni Nagano | Path Planning Device, Path Planning Method, and Computer Program |
CN105182734A (zh) * | 2015-09-17 | 2015-12-23 | 哈尔滨工程大学 | 基于虚拟领航者与导引策略的气垫船编队控制装置及方法 |
CN108549394A (zh) * | 2018-04-12 | 2018-09-18 | 哈尔滨工程大学 | 一种基于领航者和虚拟领航者的多auv直线编队控制方法 |
CN109032138A (zh) * | 2018-07-25 | 2018-12-18 | 南京理工大学 | 基于一致性算法的多机器人编队控制***及方法 |
-
2019
- 2019-08-29 CN CN201910809810.4A patent/CN110502016A/zh active Pending
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20100168950A1 (en) * | 2009-01-01 | 2010-07-01 | Masakuni Nagano | Path Planning Device, Path Planning Method, and Computer Program |
CN105182734A (zh) * | 2015-09-17 | 2015-12-23 | 哈尔滨工程大学 | 基于虚拟领航者与导引策略的气垫船编队控制装置及方法 |
CN108549394A (zh) * | 2018-04-12 | 2018-09-18 | 哈尔滨工程大学 | 一种基于领航者和虚拟领航者的多auv直线编队控制方法 |
CN109032138A (zh) * | 2018-07-25 | 2018-12-18 | 南京理工大学 | 基于一致性算法的多机器人编队控制***及方法 |
Non-Patent Citations (1)
Title |
---|
王钦钊 等: "基于多虚拟领航者的多机器人编队控制方法", 《装甲兵工程学院学报》 * |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111722625A (zh) * | 2019-12-18 | 2020-09-29 | 北京交通大学 | 时变数量群体机器人接力目标跟踪***的稳定性分析方法 |
CN111722625B (zh) * | 2019-12-18 | 2021-09-21 | 北京交通大学 | 时变数量群体机器人接力目标跟踪***的稳定性分析方法 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN114442510B (zh) | 数字孪生闭环控制方法、***、计算机设备及存储介质 | |
CN109159151A (zh) | 一种机械臂空间轨迹跟踪动态补偿方法和*** | |
CN114952868B (zh) | 7自由度srs型机械臂控制方法及装置、弹琴机器人 | |
CN110039542A (zh) | 具有速度方向控制的视觉伺服跟踪控制方法及机器人*** | |
CN106970594B (zh) | 一种柔性机械臂的轨迹规划方法 | |
CN108068113A (zh) | 7-dof仿人臂飞行物体作业最小加速度轨迹优化 | |
US20220063097A1 (en) | System for Emulating Remote Control of a Physical Robot | |
CN110861088A (zh) | 一种冗余自由度机器人的运动优化方法 | |
CN107443379A (zh) | 一种基于仿真数据的机械臂运动控制方法 | |
KR20220155921A (ko) | 로봇 디바이스를 제어하기 위한 방법 | |
CN115446867A (zh) | 一种基于数字孪生技术的工业机械臂控制方法及*** | |
CN104552299A (zh) | 一种机器人离线示教装置及补偿示教方法 | |
CN110502016A (zh) | 一种保持多机器人队列巡逻一致性的方法 | |
CN110053053A (zh) | 基于深度强化学习的机械臂旋拧阀门的自适应方法 | |
CN108393886A (zh) | 优化能量与操作度的分布式多移动机械手协同搬运方法 | |
CN109634118A (zh) | 一种机械臂的鲁棒自适应神经切换控制方法 | |
CN109366486A (zh) | 柔性机器人逆运动学求解方法、***、设备、存储介质 | |
CN113103262A (zh) | 机器人控制装置和用于控制机器人的方法 | |
CN116834014A (zh) | 一种空间多臂机器人捕获非合作目标的智能协同控制方法和*** | |
CN116276987A (zh) | 一种机械臂上下料作业路径的规划方法 | |
CN110231823B (zh) | 一种双轮机器人的直接控制方法 | |
CN115640754A (zh) | 一种可视化的uuv目标跟踪路径规划训练*** | |
Xu et al. | A learning-based object tracking strategy using visual sensors and intelligent robot arm | |
CN111975781B (zh) | 机器人修正方法及装置、机器人 | |
CN109116990B (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 | ||
RJ01 | Rejection of invention patent application after publication |
Application publication date: 20191126 |
|
RJ01 | Rejection of invention patent application after publication |