CN111103887A - 一种基于多传感器的多移动机器人调度系统设计方法 - Google Patents
一种基于多传感器的多移动机器人调度系统设计方法 Download PDFInfo
- Publication number
- CN111103887A CN111103887A CN202010035287.7A CN202010035287A CN111103887A CN 111103887 A CN111103887 A CN 111103887A CN 202010035287 A CN202010035287 A CN 202010035287A CN 111103887 A CN111103887 A CN 111103887A
- Authority
- CN
- China
- Prior art keywords
- task
- mobile robot
- mobile
- robot
- nodes
- 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.)
- Granted
Links
- 238000000034 method Methods 0.000 title claims abstract description 29
- 238000013461 design Methods 0.000 title claims abstract description 17
- 230000008569 process Effects 0.000 claims abstract description 11
- 238000004891 communication Methods 0.000 claims abstract description 7
- 230000002265 prevention Effects 0.000 claims abstract description 7
- 230000036544 posture Effects 0.000 claims description 23
- 230000000694 effects Effects 0.000 claims description 9
- 230000003993 interaction Effects 0.000 claims description 9
- 238000012544 monitoring process Methods 0.000 claims description 9
- NIXOWILDQLNWCW-UHFFFAOYSA-N acrylic acid group Chemical group C(C=C)(=O)O NIXOWILDQLNWCW-UHFFFAOYSA-N 0.000 claims description 6
- PCHJSUWPFVWCPO-UHFFFAOYSA-N gold Chemical compound [Au] PCHJSUWPFVWCPO-UHFFFAOYSA-N 0.000 claims description 6
- 239000010931 gold Substances 0.000 claims description 6
- 230000009467 reduction Effects 0.000 claims description 6
- 238000011161 development Methods 0.000 claims description 5
- 238000010276 construction Methods 0.000 claims description 4
- 239000003086 colorant Substances 0.000 claims description 3
- 238000001514 detection method Methods 0.000 claims description 3
- 229910052737 gold Inorganic materials 0.000 claims description 3
- 238000013507 mapping Methods 0.000 claims description 3
- 239000011159 matrix material Substances 0.000 claims description 3
- 238000004806 packaging method and process Methods 0.000 claims description 3
- 238000012216 screening Methods 0.000 claims description 3
- 238000004088 simulation Methods 0.000 claims description 3
- 238000012360 testing method Methods 0.000 claims description 3
- 238000005516 engineering process Methods 0.000 abstract description 3
- 238000010586 diagram Methods 0.000 description 8
- 206010063385 Intellectualisation Diseases 0.000 description 2
- 230000007547 defect Effects 0.000 description 2
- 230000007613 environmental effect Effects 0.000 description 2
- 238000011160 research Methods 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000006872 improvement Effects 0.000 description 1
- 238000012423 maintenance Methods 0.000 description 1
- 238000004519 manufacturing process Methods 0.000 description 1
- 238000012545 processing Methods 0.000 description 1
- 230000009466 transformation Effects 0.000 description 1
Images
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/0231—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
-
- 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/0231—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
- G05D1/0234—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using optical markers or beacons
-
- 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/0231—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
- G05D1/0246—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using a video camera in combination with image processing means
-
- 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/0257—Control of position or course in two dimensions specially adapted to land vehicles using a radar
-
- 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)
- Physics & Mathematics (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Aviation & Aerospace Engineering (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Electromagnetism (AREA)
- Computer Vision & Pattern Recognition (AREA)
- Multimedia (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
- Manipulator (AREA)
Abstract
本发明属于计算机视觉技术及机器人控制技术领域,一种基于多传感器的多移动机器人调度系统设计方法,包括以下步骤:(1)搭建多个移动机器人平台,(2)构建二维实验场景地图及实现多移动机器人无线通讯,(3)全局路径规划的设计,(4)设计任务的分配,(5)多移动机器人预防碰撞策略的设计,(6)开发多移动机器人调度平台软件。本发明具有以下优点:一、采用无轨自主导航的方式,扩大了机器人可自由移动范围。二、对多机器人采用分布式控制,提高了整个调度系统的动态协调性和稳定性。三、利用激光雷达及深度实感相机传感器同时对机器人周围环境进行识别检测,提高了机器人在整个任务执行过程中的安全性。
Description
技术领域
本发明涉及一种基于多传感器的多移动机器人调度系统设计方法,属于计算机视觉技术及机器人控制技术领域。
背景技术
近年来,随着无线网络、计算机视觉、自主导航、SLAM等技术的快速发展,以及CPU和传感器等硬件性能的提高,机器人领域有了更广阔的发展前景。与以前相比,现在的机器人对周围环境的识别精度越来越高,处理各类数据的能力也越来越强,正在不断地朝着更智能化的方向发展,并已经开始应用于各种领域。从服务行业的服务机器人到物流行业的自主分拣搬运机器人,智能机器人的身影无处不在。然而,随着现代各行各业产业结构的快速升级,工作任务量也在不断地上涨,生产环境的日渐复杂,不仅对机器人个体的智能化提出新需求,同时也对多机器人控制提出了新挑战。多机器人调度系统是多机器人控制的研究方向之一,其中基于移动机器人的多机器人调度系统,研究内容包含多机器人路径规划、自主导航、任务分配、预防碰撞等。
目前,在许多多移动机器人调度系统中仍使用着传统的磁轨、二维码等有轨导航方式。这种导航方式存在诸多缺点,首先,将机器人限制在固定轨道上运行,极大程度地限制了机器人的移动范围;其次,工作场景空间固定,如果要改变工作场景或者增加额外的运输点,则必须重新部署局部轨道甚至全局轨道;最后,导轨长期使用还可能出现磨损状况,会需要增加额外维修成本。此外,现在的多移动机器人调度系统多采用集中式的控制方式,虽然这种方式协调性好,任务分配时容易获取最优解,但当控制中心出现问题时,整个系统容易出现运行故障。同时,对于机器人个体来说,在现在许多复杂的动态环境下,仅仅依靠单个传感器采集的环境信息,可能难以保证移动机器人在整个运输过程中的安全性。基于以上三个方面考虑,有必要对现阶段的多移动机器人调度系统设计提出更新的策略,使移动机器人在实际调度过程中拥有更自由的移动空间,能够更安全、更流畅地执行工作任务,同时使调度系统能长时间保持在更稳定的运行状态,确保任务准确无误完成。
发明内容
为了克服现有技术中存在的不足,本发明目的是提供一种基于多传感器的多移动机器人调度系统设计方法。该方法旨在对多移动机器人采用分布式控制的方式,使多机器人能以自主协商的方式进行任务分配。同时,对机器人采用激光导航的方式,引入一种在多机器人环境下的全局路径规划方法以及预防碰撞策略,使多机器人能够达到安全稳定地完成运送任务的目的。
为了实现上述发明目的,解决已有技术中所存在的问题,本发明采取的技术方案是:一种基于多传感器的多移动机器人调度系统设计方法,包括以下步骤:
步骤1、搭建多个移动机器人平台,以TurtleBot2移动机器人作为移动底盘,在移动底盘周围外侧设置有红位姿识别标靶,红位姿识别标靶前侧即机器人前侧设置有两道红色条纹,红位姿识别标靶后侧设置有单道红色条纹,红位姿识别标靶前、后侧连接处留出长度为1.5-1.6cm的空白区;在移动底盘上设置有两层亚克力板并与移动底盘形成三层空间,将NVIDIA Jeston TX2开发板作为上位机,安装在第二层中间位置,同时将IntelRealsense ZR300深度实感相机安装第二层前侧正中间;在第三层搭载RPLIDAR-A3激光雷达;
步骤2、构建二维实验场景地图及实现多移动机器人无线通讯,包括以下子步骤:
(a)控制移动机器人在实验场景范围内移动,利用RPLIDAR-A3激光雷达扫描环境信息,通过cartographer建图算法构建二维的实验场景地图;
(b)以一台台式电脑作为多移动机器人调度平台,设置调度平台与移动机器人之间的信息交互方式,使调度平台与移动机器人之间的交互方式为调度平台发送总任务信息给移动机器人、移动机器人反馈位置信息给调度平台;使移动机器人之间的信息交互方式为移动机器人之间任务信息相互交换;
(c)定义任务消息格式,基于TCP/IP协议在移动机器人及调度平台上创建基于不同网络端口的TCP服务器及客户端,在机器人之间及机器人与调度平台之间建立起TCP连接,通过socket实现任务信息、机器人位置信息、总任务消息的收发;
(d)在移动机器人上创建两个ROS节点,一个用于将其它移动机器人的任务消息通过ROS话题发布,另一个用来将不同移动机器人的任务消息同步订阅下来,用作任务协商;
步骤3、全局路径规划的设计,基于实验场景地图创建一个简化地图,结合A*算法和二阶Bezier曲线实现全局路径规划;全局路径规划具体执行过程包括以下四个方面的内容,一是将起点与终点动态地加入简化地图,二是在简化地图上利用A*算法计算得到一条粗略路径,三是基于实际地图,在粗略路径的相邻节点间,通过A*算法以及二阶Bezier曲线得到各节点间的精确路径,四是将各节点间的路径按节点顺序串联起来作为最终路径;全局路径规划具体包含以下三个设计要点:
(1)基于实验场景地图上创建一个简单有向图G(V,E),即简化地图,图中节点V对应着实际地图中特定的坐标点,主要分布在道路的两侧及弯道处,节点之间的边E为有向边,用于限制移动机器人路径规划时的路径方向;
(2)设定起点和终点动态添加的规则,起点动态添加规则为:先添加图G中起点周围的节点作为起点下一步可达点,再筛选出这些节点中满足存在出边向外的节点,即有出边不是指向这些周围节点的节点,作为最终与起点相连的节点;终点动态添加规则与前者唯一不同的地方在于它是筛选出周围节点中满足存在外来入边的点作为最终与终点相连的节点,即有入边来自于周围节点之外的节点的节点;
(3)在大弧度转弯处采用二阶Bezier曲线构造路径,首先,判断是否位于大弧度转弯处,即判断是否满足式(1)条件,
式中,start、goal分别表示粗略路径中相邻节点中的起点和终点,x、y分别表示实际地图中的横坐标与纵坐标,单位为m,Ksg表示起点与终点间的斜率,表示起点与粗略路径中起点的前一节点ps间的斜率;其次,若满足上述条件,则确定二阶Bezier曲线中的定点point2,即直线与的交点为point2,为粗略路径中过goal和goal下一个节点ng的直线,若该交点位于障碍区,则将该点沿着与直线lsg相互垂直的方向移动,直至其位于无障碍区;最后,再利用二阶Bezier曲线构造公式(2)求解构造弯道局部路径的点,
P=(1-t)2S+2t(1-t)P2+t2G (2)
式中,S、P2、G分别对应着上述start、goal、point2,P为待求取的路径上的点,t取值范围为[0,1]的变量;
步骤4、设计任务的分配,多移动机器人调度平台负责向多移动机器人发送总任务,多移动机器人在接收到总任务后开始协商并分配任务,任务分配方式采用多轮分配的方式,每个移动机器人每一轮只分配下一刻要执行的任务,在移动机器人完成当前任务后,再开始下一轮任务分配,直至各移动机器人总任务槽为空才停止任务分配,移动机器人每轮任务协商、分配,具体包括以下子步骤:
(a)在接受到总任务信息后获取自身位置信息,根据总任务信息中各任务的起止点信息,从移动机器人角度考虑,选取代价最小的n个任务t,n为移动机器人数量;有3个移动机器人,故取n为3,选取3个代价最小的任务组成自身任务序列l1=(t1,t2,t3)T,任务选取可根据移动机器人自身约束条件以及任务条件建立代价函数,通过式(3)进行描述,
c(i)=distance(cur,starti)+distance(starti,goali) (3)
式中c(i)表示执行任务i所花费的代价值大小,cur表示移动机器人的当前位置,starti表示任务i起点,goali表示任务i终点,distance表示两点间的曼哈顿距离;
(b)将自身任务序列打包成任务消息发送给其它移动机器人,同时接收来自于其它移动机器人的任务序列l2、l3,若一段时间T内未接收到移动机器人i发送过来的任务序列,则取上次协商完成后机器人i分配的任务t′,重新构建一个任务序列li=(t′,t′,t′),并将任务序列li作为移动机器人i此刻的任务序列,然后,将步骤(a)中自身挑选的任务序列与接收到的其它移动机器人的任务序列汇总到一个任务序列集S=(l1,l2,l3);
(c)根据任务争取规则,若存在多个移动机器人争取同一个任务t情况,则选取离任务t起点近的机器人作为任务t的接收者,从任务序列集S第一行开始,根据各移动机器人与任务起点之间的距离信息,循环比较任务序列集S中的每一行元素值即任务标号,直到某行的所有元素均互异为止,此时每个移动机器人都能分配到不同的任务,倘若当前移动机器人对应的任务序列为lj,第i行各元素的比较过程存在以下两种情况:若任务lij异于所在行的第i行的其它元素,则将任务lij分配给当前移动机器人j,并将lj中当第i个元素以后的元素均置为当前元素值lij;若第i行存在与任务lij相同的元素,则按照任务争取规则,将任务lij分配给距离任务lij起点最近的移动机器人k,即令lik等于lij,将第i行中其它与lik元素相同的元素置0值,同时将任务序列lk中第i行以后的元素置为lik值;
步骤5、多移动机器人预防碰撞策略的设计,一方面,通过RPLIDAR-A3激光雷达实时扫描移动机器人周围环境信息,当检测到行进路线上出现障碍物时,在障碍物的一定范围内重新规划局部路径,调整当前全局路径;另一方面,通过ZR300深度实感相机实时检测移动机器人周围的其它移动机器人,并对其位姿进行识别,再根据减速策略对移动机器人速度进行调节,以此保证移动机器人之间的相对安全性,包括红色位姿识别标靶检测及减速策略的设计;
(1)红色位姿识别标靶检测,通过ZR300深度实感相机采集移动机器人正前方的环境信息,在ZR300深度实感相机输出的RGB图像基础上根据红色位姿识别标靶的颜色和形状特征检测红色位姿识别标靶,红色位姿识别标靶共有三种姿态,每种姿态都具有不同的矩形形态,且矩形之间存在一定的空间位置关系,姿态一为单个矩形形态,姿态二为三个矩形形态,姿态三为两个矩形形态;若检测到红色识别标靶,则先求出红色识别标靶整体的形心在图像坐标系下的位置,记作(uc,vc);然后,将此刻ZR300深度实感相机采集到的RGB图像与深度图对齐,读取深度图中对应的形心位置处的深度值,记作Zc;最后,根据相机的内参数矩阵K求出图像坐标系下的红色位姿识别标靶形心在相机坐标系下的空间位置P=(Xc,Yc,Zc)T,通过式(4)进行描述,
估计移动机器人在相机坐标系下的姿态,由于所有移动机器人均在同一地图平面上,所以也就是估计欧拉角rpy中的偏航角yaw;当检测到的移动机器人姿态为姿态一时,说明此时移动机器人正处于背对着相机的状态,移动机器人坐标系与相机坐标系x轴方向一致,yaw设为0°;当检测到的移动机器人姿态为位姿三时,说明此时移动机器人与相机正处于面对面的状态,此时yaw设为180°;当检测到的移动机器人姿态为姿态二时,说明此时移动机器人相对于相机正处于横行的状态,可根据移动机器人底盘半径、行走方向、红色位姿识别标靶的转向标识点与形心之间的距离计算yaw,转向标志点即红色位姿识别标靶前侧与后侧衔接区域的中心位置,通过下式(5)进行描述,
式(5)中dir代表识别到的目标机器人的方向,当dir等于0时,表示目标机器人正处于姿态一或姿态三状态;当dir大于0时,表示目标机器人正处于向右状态;当dir小于0时,表示机器人正处于向左的状态;分别表示标靶转向标识点和标靶中心点在相机坐标系下的y坐标;
(2)减速策略的设计,当与识别到的移动机器人之间的距离大于2m时,保持原有最大移动速度;当与识别到的移动机器人之间的距离小于2m,但自身接下来仍然会处于直行状态时或者接下来行走方向跟识别到的移动机器人当前行走方向相反,则依旧保持原有最大移动速度;排除以上两种情况后,当与识别到的移动机器人之间的距离d小于2m且大于0.7m时,移动机器人的最大速度随着距离d的减小而减小,保证距离d越小,最大移动速度减小的幅度就越大;当与识别到的移动机器人之间的距离d小于0.7m时,最大移动速度强制设置为0,停止当前移动机器人运行;
步骤6、开发多移动机器人调度平台软件,通过Qt以及ROS开发多移动机器人调度平台软件,设计总任务消息格式,创建总任务发布功能以及多移动机器人监控界面,移动机器人监控界面中加载实验环境地图,以不同颜色的圆形图标表示不同的移动机器人,测试和监控多移动机器人调度及运行效果;设计总任务输入框,可输入模拟收集到的总任务,通过点击“Send”按键向多移动机器人发送总任务;设置系统停止运行按钮“Stop”,以便出现紧急状况时,能够即时停止系统的运行。
本发明有益效果是:一种基于多传感器的多移动机器人调度系统设计方法,包括以下步骤:(1)搭建多个移动机器人平台,(2)构建二维实验场景地图及实现多移动机器人无线通讯,(3)全局路径规划的设计,(4)设计任务的分配,(5)多移动机器人预防碰撞策略的设计,(6)开发多移动机器人调度平台软件。与已有技术相比,本发明具有以下几个优点:一、采用无轨自主导航的方式,极大程度上扩大了机器人可自由移动范围,同时在多机器人运行环境中使用靠右全局路径规划的方式,有效地减小了机器人之间发生正面冲突的可能,在机器人多的情况下可大幅度提高机器人运输效率。二、对多机器人采用分布式控制以及多轮协商的任务分配方式,有效地提高了整个调度系统的动态协调性和稳定性。三、利用激光雷达及深度实感相机传感器同时对机器人周围环境进行识别检测,实时调整移动机器人自身运行状态,进一步提高了机器人在整个任务执行过程中的安全性。
附图说明
图1是本发明方法步骤流程图。
图2是实验移动机器人组装模型图。
图3是实验移动机器人实物图。
图4是构建的二维实验场景地图。
图5是多机器人无线通讯拓扑图。
图6是两个机器人之间TCP连接示意图。
图7是靠右全局路径规划方法的路径规划最终效果图。
图8是基于实验场景二维地图构造的简单有向图。
图9是未采用二阶Bezier曲线构造前的弯道局部路径规划图。
图10是基于二阶Bezier曲线构造的弯道局部路径图。
图11是红色位姿识别标靶识别效果图。
图12是机器人位姿识别效果图。
图13是多机器人调度平台软件界面图。
具体实施方式
下面结合附图对本发明作进一步说明。
如图1所示,一种基于多传感器的多移动机器人调度系统设计方法,包括以下步骤:
步骤1、搭建多个移动机器人平台,实验移动机器人组装模型如图2所示,以TurtleBot2移动机器人作为移动底盘,在移动底盘周围外侧设置有红位姿识别标靶,红位姿识别标靶前侧即机器人前侧设置有两道红色条纹,红位姿识别标靶后侧设置有单道红色条纹,红位姿识别标靶前、后侧连接处留出长度为1.5-1.6cm的空白区;在移动底盘上设置有两层亚克力板并与移动底盘形成三层空间,将NVIDIA Jeston TX2开发板作为上位机,安装在第二层中间位置,同时将Intel Realsense ZR300深度实感相机安装第二层前侧正中间;在第三层搭载RPLIDAR-A3激光雷达,最终实验移动机器人搭建效果如图3所示;
步骤2、构建二维实验场景地图及实现多移动机器人无线通讯,包括以下子步骤:
(a)控制移动机器人在实验场景范围内移动,利用RPLIDAR-A3激光雷达扫描环境信息,通过cartographer建图算法构建二维的实验场景地图,最终构建的二维实验场景地图如图4所示;
(b)以一台台式电脑作为多移动机器人调度平台,设置调度平台与移动机器人之间的信息交互方式,使调度平台与移动机器人之间的交互方式为调度平台发送总任务信息给移动机器人、移动机器人反馈位置信息给调度平台;使移动机器人之间的信息交互方式为移动机器人之间任务信息相互交换,整体通讯拓扑图如图5所示;
(c)定义任务消息格式,基于TCP/IP协议在移动机器人及调度平台上创建基于不同网络端口的TCP服务器及客户端,在机器人之间及机器人与调度平台之间建立起TCP连接,机器人之间TCP连接过程如图6所示,通过socket实现任务信息、机器人位置信息、总任务消息的收发;
(d)在移动机器人上创建两个ROS节点,一个用于将其它移动机器人的任务消息通过ROS话题发布,另一个用来将不同移动机器人的任务消息同步订阅下来,用作任务协商;
步骤3、全局路径规划的设计,基于实验场景地图创建一个简化地图,结合A*算法和二阶Bezier曲线实现全局路径规划;全局路径规划具体执行过程包括以下四个方面的内容,一是将起点与终点动态地加入简化地图,二是在简化地图上利用A*算法计算得到一条粗略路径,三是基于实际地图,在粗略路径的相邻节点间,通过A*算法以及二阶Bezier曲线得到各节点间的精确路径,四是将各节点间的路径按节点顺序串联起来作为最终路径,最终全局路径规划效果如图7所示;全局路径规划具体包含以下三个设计要点:
(1)基于实验场景地图上创建一个简单有向图G(V,E),即简化地图,如图8所示,图中节点V对应着实际地图中特定的坐标点,主要分布在道路的两侧及弯道处,节点之间的边E为有向边,用于限制移动机器人路径规划时的路径方向;
(2)设定起点和终点动态添加的规则,起点动态添加规则为:先添加图G中起点周围的节点作为起点下一步可达点,再筛选出这些节点中满足存在出边向外的节点,即有出边不是指向这些周围节点的节点,作为最终与起点相连的节点;终点动态添加规则与前者唯一不同的地方在于它是筛选出周围节点中满足存在外来入边的点作为最终与终点相连的节点,即有入边来自于周围节点之外的节点的节点;
(3)在大弧度转弯处采用二阶Bezier曲线构造路径,若转弯处直接采用A*算法求取路径会存在图9所示问题,因此需要利用二阶Bezier曲线构造转弯处的局部路径,如图10所示;首先,判断是否位于大弧度转弯处,即判断是否满足式(1)条件,
式中,start、goal分别表示粗略路径中相邻节点中的起点和终点,x、y分别表示实际地图中的横坐标与纵坐标,单位为m,Ksg表示起点与终点间的斜率,表示起点与粗略路径中起点的前一节点ps间的斜率;其次,若满足上述条件,则确定二阶Bezier曲线中的定点point2,即直线与的交点为point2,为粗略路径中过goal和goal下一个节点ng的直线,若该交点位于障碍区,则将该点沿着与直线lsg相互垂直的方向移动,直至其位于无障碍区;最后,再利用二阶Bezier曲线构造公式(2)求解构造弯道局部路径的点,
P=(1-t)2S+2t(1-t)P2+t2G (2)
式中,S、P2、G分别对应着上述start、goal、point2,P为待求取的路径上的点,t取值范围为[0,1]的变量;
步骤4、设计任务的分配,多移动机器人调度平台负责向多移动机器人发送总任务,多移动机器人在接收到总任务后开始协商并分配任务,任务分配方式采用多轮分配的方式,每个移动机器人每一轮只分配下一刻要执行的任务,在移动机器人完成当前任务后,再开始下一轮任务分配,直至各移动机器人总任务槽为空才停止任务分配,移动机器人每轮任务协商、分配,具体包括以下子步骤:
(a)在接受到总任务信息后获取自身位置信息,根据总任务信息中各任务的起止点信息,从移动机器人角度考虑,选取代价最小的n个任务t,n为移动机器人数量;有3个移动机器人,故取n为3,选取3个代价最小的任务组成自身任务序列l1=(t1,t2,t3)T,任务选取可根据移动机器人自身约束条件以及任务条件建立代价函数,通过式(3)进行描述,
c(i)=distance(cur,starti)+distance(starti,goali) (3)
式中c(i)表示执行任务i所花费的代价值大小,cur表示移动机器人的当前位置,starti表示任务i起点,goali表示任务i终点,distance表示两点间的曼哈顿距离;
(b)将自身任务序列打包成任务消息发送给其它移动机器人,同时接收来自于其它移动机器人的任务序列l2、l3,若一段时间T内未接收到移动机器人i发送过来的任务序列,则取上次协商完成后机器人i分配的任务t′,重新构建一个任务序列li=(t′,t′,t′),并将任务序列li作为移动机器人i此刻的任务序列,然后,将步骤(a)中自身挑选的任务序列与接收到的其它移动机器人的任务序列汇总到一个任务序列集S=(l1,l2,l3);
(c)根据任务争取规则,若存在多个移动机器人争取同一个任务t情况,则选取离任务t起点近的机器人作为任务t的接收者,从任务序列集S第一行开始,根据各移动机器人与任务起点之间的距离信息,循环比较任务序列集S中的每一行元素值即任务标号,直到某行的所有元素均互异为止,此时每个移动机器人都能分配到不同的任务,倘若当前移动机器人对应的任务序列为lj,第i行各元素的比较过程存在以下两种情况:若任务lij异于所在行的第i行的其它元素,则将任务lij分配给当前移动机器人j,并将lj中当第i个元素以后的元素均置为当前元素值lij;若第i行存在与任务lij相同的元素,则按照任务争取规则,将任务lij分配给距离任务lij起点最近的移动机器人k,即令lik等于lij,将第i行中其它与lik元素相同的元素置0值,同时将任务序列lk中第i行以后的元素置为lik值;
步骤5、多移动机器人预防碰撞策略的设计,一方面,通过RPLIDAR-A3激光雷达实时扫描移动机器人周围环境信息,当检测到行进路线上出现障碍物时,在障碍物的一定范围内重新规划局部路径,调整当前全局路径;另一方面,通过ZR300深度实感相机实时检测移动机器人周围的其它移动机器人,并对其位姿进行识别,再根据减速策略对移动机器人速度进行调节,以此保证移动机器人之间的相对安全性,包括红色位姿识别标靶检测及减速策略的设计;
(1)红色位姿识别标靶检测,通过ZR300深度实感相机采集移动机器人正前方的环境信息,在ZR300深度实感相机输出的RGB图像基础上根据红色位姿识别标靶的颜色和形状特征检测红色位姿识别标靶,红色位姿识别标靶共有三种姿态,如图11从左到右所示,每种姿态都具有不同的矩形形态,且矩形之间存在一定的空间位置关系,姿态一为单个矩形形态,姿态二为三个矩形形态,姿态三为两个矩形形态;若检测到红色识别标靶,则先求出红色识别标靶整体的形心在图像坐标系下的位置,记作(uc,vc);然后,将此刻ZR300深度实感相机采集到的RGB图像与深度图对齐,读取深度图中对应的形心位置处的深度值,记作Zc;最后,根据相机的内参数矩阵K求出图像坐标系下的红色位姿识别标靶形心在相机坐标系下的空间位置P=(Xc,Yc,Zc)T,通过式(4)进行描述,
估计移动机器人在相机坐标系下的姿态,由于所有移动机器人均在同一地图平面上,所以也就是估计欧拉角rpy中的偏航角yaw;当检测到的移动机器人姿态为姿态一时,说明此时移动机器人正处于背对着相机的状态,移动机器人坐标系与相机坐标系x轴方向一致,yaw设为0°;当检测到的移动机器人姿态为位姿三时,说明此时移动机器人与相机正处于面对面的状态,此时yaw设为180°;当检测到的移动机器人姿态为姿态二时,说明此时移动机器人相对于相机正处于横行的状态,可根据移动机器人底盘半径、行走方向、红色位姿识别标靶的转向标识点与形心之间的距离计算yaw,转向标志点即红色位姿识别标靶前侧与后侧衔接区域的中心位置,通过下式(5)进行描述,
式(5)中dir代表识别到的目标机器人的方向,当dir等于0时,表示目标机器人正处于姿态一或姿态三状态;当dir大于0时,表示目标机器人正处于向右状态;当dir小于0时,表示机器人正处于向左的状态;分别表示标靶转向标识点和标靶中心点在相机坐标系下的y坐标;最终,经ROS中的tf变换,通过ROS的rviz工具显示出来的机器人位姿识别效果如图12所示;
(2)减速策略的设计,当与识别到的移动机器人之间的距离大于2m时,保持原有最大移动速度;当与识别到的移动机器人之间的距离小于2m,但自身接下来仍然会处于直行状态时或者接下来行走方向跟识别到的移动机器人当前行走方向相反,则依旧保持原有最大移动速度;排除以上两种情况后,当与识别到的移动机器人之间的距离d小于2m且大于0.7m时,移动机器人的最大速度随着距离d的减小而减小,保证距离d越小,最大移动速度减小的幅度就越大;当与识别到的移动机器人之间的距离d小于0.7m时,最大移动速度强制设置为0,停止当前移动机器人运行;
步骤6、开发多移动机器人调度平台软件,通过Qt以及ROS开发多移动机器人调度平台软件,设计总任务消息格式,创建总任务发布功能以及多移动机器人监控界面,移动机器人监控界面中加载实验环境地图,以不同颜色的圆形图标表示不同的移动机器人,测试和监控多移动机器人调度及运行效果;设计总任务输入框,可输入模拟收集到的总任务,通过点击“Send”按键向多移动机器人发送总任务;设置系统停止运行按钮“Stop”,以便出现紧急状况时,能够即时停止系统的运行,软件界面如图13所示。
Claims (1)
1.一种基于多传感器的多移动机器人调度系统设计方法,其特征在于包括以下步骤:
步骤1、搭建多个移动机器人平台,以TurtleBot2轮式机器人作为移动底盘,在移动底盘周围外侧设置有红位姿识别标靶,红位姿识别标靶前侧即机器人前侧设置有两道红色条纹,红位姿识别标靶后侧设置有单道红色条纹,红位姿识别标靶前、后侧连接处留出长度为1.5-1.6cm的空白区;在移动底盘上设置有两层亚克力板并与移动底盘形成三层空间,将NVIDIA Jeston TX2开发板作为上位机,安装在第二层中间位置,同时将Intel RealsenseZR300深度实感相机安装第二层前侧正中间;在第三层搭载RPLIDAR-A3激光雷达;
步骤2、构建二维实验场景地图及实现多移动机器人无线通讯,包含以下子步骤:
(a)控制移动机器人在实验场景范围内移动,利用RPLIDAR-A3激光雷达扫描环境信息,通过cartographer建图算法构建二维的实验场景地图;
(b)以一台台式电脑作为多移动机器人调度平台,设置调度平台与移动机器人之间的信息交互方式,使调度平台与移动机器人之间的交互方式为调度平台发送总任务信息给移动机器人、移动机器人反馈位置信息给调度平台;使移动机器人之间的信息交互方式为移动机器人之间任务信息相互交换;
(c)定义任务消息格式,基于TCP/IP协议在移动机器人及调度平台上创建基于不同网络端口的TCP服务器及客户端,在机器人之间及机器人与调度平台之间建立起TCP连接,通过socket实现任务信息、机器人位置信息、总任务消息的收发;
(d)在移动机器人上创建两个ROS节点,一个用于将其它移动机器人的任务消息通过ROS话题发布,另一个用来将不同移动机器人的任务消息同步订阅下来,用作任务协商;
步骤3、全局路径规划的设计,基于实验场景地图创建一个简化地图,结合A*算法和二阶Bezier曲线实现全局路径规划;全局路径规划具体执行过程包括以下四个方面的内容,一是将起点与终点动态地加入简化地图,二是在简化地图上利用A*算法计算得到一条粗略路径,三是基于实际地图,在粗略路径的相邻节点间,通过A*算法以及二阶Bezier曲线得到各节点间的精确路径,四是将各节点间的路径按节点顺序串联起来作为最终路径;全局路径规划具体包含以下三个设计要点:
(1)基于实验场景地图上创建一个简单有向图G(V,E),即简化地图,图中节点V对应着实际地图中特定的坐标点,主要分布在道路的两侧及弯道处,节点之间的边E为有向边,用于限制移动机器人路径规划时的路径方向;
(2)设定起点和终点动态添加的规则,起点动态添加规则为:先添加图G中起点周围的节点作为起点下一步可达点,再筛选出这些节点中满足存在出边向外的节点,即有出边不是指向这些周围节点的节点,作为最终与起点相连的节点;终点动态添加规则与前者唯一不同的地方在于它是筛选出周围节点中满足存在外来入边的点作为最终与终点相连的节点,即有入边来自于周围节点之外的节点的节点;
(3)在大弧度转弯处采用二阶Bezier曲线构造路径,首先,判断是否位于大弧度转弯处,即判断是否满足式(1)条件,
式中,start、goal分别表示粗略路径中相邻节点中的起点和终点,x、y分别表示实际地图中的横坐标与纵坐标,单位为m,Ksg表示起点与终点间的斜率,表示起点与粗略路径中起点的前一节点ps间的斜率;其次,若满足上述条件,则确定二阶Bezier曲线中的定点point2,即直线与的交点为point2,为粗略路径中过goal和goal下一个节点ng的直线,若该交点位于障碍区,则将该点沿着与直线lsg相互垂直的方向移动,直至其位于无障碍区;最后,再利用二阶Bezier曲线构造公式(2)求解构造弯道局部路径的点,
P=(1-t)2S+2t(1-t)P2+t2G (2)
式中,S、P2、G分别对应着上述start、goal、point2,P为待求取的路径上的点,t取值范围为[0,1]的变量;
步骤4、设计任务的分配,多移动机器人调度平台负责向多移动机器人发送总任务,多移动机器人在接收到总任务后开始协商并分配任务,任务分配方式采用多轮分配的方式,每个移动机器人每一轮只分配下一刻要执行的任务,在移动机器人完成当前任务后,再开始下一轮任务分配,直至各移动机器人总任务槽为空才停止任务分配,移动机器人每轮任务协商、分配,具体包括以下子步骤:
(a)在接受到总任务信息后获取自身位置信息,根据总任务信息中各任务的起止点信息,从移动机器人角度考虑,选取代价最小的n个任务t,n为移动机器人数量;有3个移动机器人,故取n为3,选取3个代价最小的任务组成自身任务序列l1=(t1,t2,t3)T,任务选取可根据移动机器人自身约束条件以及任务条件建立代价函数,通过式(3)进行描述,
c(i)=distance(cur,starti)+distance(starti,goali) (3)
式中c(i)表示执行任务i所花费的代价值大小,cur表示移动机器人的当前位置,starti表示任务i起点,goali表示任务i终点,distance表示两点间的曼哈顿距离;
(b)将自身任务序列打包成任务消息发送给其它移动机器人,同时接收来自于其它移动机器人的任务序列l2、l3,若一段时间T内未接收到移动机器人i发送过来的任务序列,则取上次协商完成后机器人i分配的任务t′,重新构建一个任务序列li=(t′,t′,t′),并将任务序列li作为移动机器人i此刻的任务序列,然后,将步骤(a)中自身挑选的任务序列与接收到的其它移动机器人的任务序列汇总到一个任务序列集S=(l1,l2,l3);
(c)根据任务争取规则,若存在多个移动机器人争取同一个任务t情况,则选取离任务t起点近的机器人作为任务t的接收者,从任务序列集S第一行开始,根据各移动机器人与任务起点之间的距离信息,循环比较任务序列集S中的每一行元素值即任务标号,直到某行的所有元素均互异为止,此时每个移动机器人都能分配到不同的任务,倘若当前移动机器人对应的任务序列为lj,第i行各元素的比较过程存在以下两种情况:若任务lij异于所在行的第i行的其它元素,则将任务lij分配给当前移动机器人j,并将lj中当第i个元素以后的元素均置为当前元素值lij;若第i行存在与任务lij相同的元素,则按照任务争取规则,将任务lij分配给距离任务lij起点最近的移动机器人k,即令lik等于lij,将第i行中其它与lik元素相同的元素置0值,同时将任务序列lk中第i行以后的元素置为lik值;
步骤5、多移动机器人预防碰撞策略的设计,一方面,通过RPLIDAR-A3激光雷达实时扫描移动机器人周围环境信息,当检测到行进路线上出现障碍物时,在障碍物的一定范围内重新规划局部路径,调整当前全局路径;另一方面,通过ZR300深度实感相机实时检测移动机器人周围的其它移动机器人,并对其位姿进行识别,再根据减速策略对移动机器人速度进行调节,以此保证移动机器人之间的相对安全性,包括红色位姿识别标靶检测及减速策略的设计;
(1)红色位姿识别标靶检测,通过ZR300深度实感相机采集移动机器人正前方的环境信息,在ZR300深度实感相机输出的RGB图像基础上根据红色位姿识别标靶的颜色和形状特征检测红色位姿识别标靶,红色位姿识别标靶共有三种姿态,每种姿态都具有不同的矩形形态,且矩形之间存在一定的空间位置关系,姿态一为单个矩形形态,姿态二为三个矩形形态,姿态三为两个矩形形态;若检测到红色识别标靶,则先求出红色识别标靶整体的形心在图像坐标系下的位置,记作(uc,vc);然后,将此刻ZR300深度实感相机采集到的RGB图像与深度图对齐,读取深度图中对应的形心位置处的深度值,记作Zc;最后,根据相机的内参数矩阵K求出图像坐标系下的红色位姿识别标靶形心在相机坐标系下的空间位置P=(Xc,Yc,Zc)T,通过式(4)进行描述,
估计移动机器人在相机坐标系下的姿态,由于所有移动机器人均在同一地图平面上,所以也就是估计欧拉角rpy中的偏航角yaw;当检测到的移动机器人姿态为姿态一时,说明此时移动机器人正处于背对着相机的状态,移动机器人坐标系与相机坐标系x轴方向一致,yaw设为0°;当检测到的移动机器人姿态为位姿三时,说明此时移动机器人与相机正处于面对面的状态,此时yaw设为180°;当检测到的移动机器人姿态为姿态二时,说明此时移动机器人相对于相机正处于横行的状态,可根据移动机器人底盘半径、行走方向、红色位姿识别标靶的转向标识点与形心之间的距离计算yaw,转向标志点即红色位姿识别标靶前侧与后侧衔接区域的中心位置,通过下式(5)进行描述,
式(5)中dir代表识别到的目标机器人的方向,当dir等于0时,表示目标机器人正处于姿态一或姿态三状态;当dir大于0时,表示目标机器人正处于向右状态;当dir小于0时,表示机器人正处于向左的状态;分别表示标靶转向标识点和标靶中心点在相机坐标系下的y坐标;
(2)减速策略的设计,当与识别到的移动机器人之间的距离大于2m时,保持原有最大移动速度;当与识别到的移动机器人之间的距离小于2m,但自身接下来仍然会处于直行状态时或者接下来行走方向跟识别到的移动机器人当前行走方向相反,则依旧保持原有最大移动速度;排除以上两种情况后,当与识别到的移动机器人之间的距离d小于2m且大于0.7m时,移动机器人的最大速度随着距离d的减小而减小,保证距离d越小,最大移动速度减小的幅度就越大;当与识别到的移动机器人之间的距离d小于0.7m时,最大移动速度强制设置为0,停止当前移动机器人运行;
步骤6、开发多移动机器人调度平台软件,通过Qt以及ROS开发多移动机器人调度平台软件,设计总任务消息格式,创建总任务发布功能以及多移动机器人监控界面,移动机器人监控界面中加载实验环境地图,以不同颜色的圆形图标表示不同的移动机器人,测试和监控多移动机器人调度及运行效果;设计总任务输入框,可输入模拟收集到的总任务,通过点击“Send”按键向多移动机器人发送总任务;设置系统停止运行按钮“Stop”,以便出现紧急状况时,能够即时停止系统的运行。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010035287.7A CN111103887B (zh) | 2020-01-14 | 2020-01-14 | 一种基于多传感器的多移动机器人调度系统设计方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010035287.7A CN111103887B (zh) | 2020-01-14 | 2020-01-14 | 一种基于多传感器的多移动机器人调度系统设计方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN111103887A true CN111103887A (zh) | 2020-05-05 |
CN111103887B CN111103887B (zh) | 2021-11-12 |
Family
ID=70426043
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202010035287.7A Active CN111103887B (zh) | 2020-01-14 | 2020-01-14 | 一种基于多传感器的多移动机器人调度系统设计方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN111103887B (zh) |
Cited By (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111885550A (zh) * | 2020-06-06 | 2020-11-03 | 浙江中力机械有限公司 | 一种分布式自主移动机器人调度系统 |
CN112033423A (zh) * | 2020-09-09 | 2020-12-04 | 上海有个机器人有限公司 | 一种基于道路共识的机器人路径规划方法、装置和机器人 |
CN112123339A (zh) * | 2020-10-19 | 2020-12-25 | 哈尔滨理工大学 | 一种位置约束的多移动机械臂协同运输控制系统 |
CN112631232A (zh) * | 2020-12-28 | 2021-04-09 | 北京星航机电装备有限公司 | 基于openTCS实现对自动导引车调度控制方法及系统 |
CN112904854A (zh) * | 2021-03-31 | 2021-06-04 | 江苏智库智能科技有限公司 | 多机器人多目标实时动态避障方法、系统及存储介质 |
CN113189949A (zh) * | 2021-04-28 | 2021-07-30 | 铽罗(上海)机器人科技有限公司 | 一种导航调度控制方法和系统 |
CN113359751A (zh) * | 2021-06-23 | 2021-09-07 | 武汉理工大学 | 一种无人安防巡逻系统 |
CN113934228A (zh) * | 2021-10-18 | 2022-01-14 | 天津大学 | 基于协商共识的集群四旋翼无人机任务规划方法 |
CN114434458A (zh) * | 2022-01-27 | 2022-05-06 | 国科温州研究院(温州生物材料与工程研究所) | 集群机器人与虚拟环境的互动方法及其系统 |
CN114815857A (zh) * | 2022-06-28 | 2022-07-29 | 广东邦盛北斗科技股份公司 | 基于北斗导航的智能化农机管理方法、系统及云平台 |
Citations (25)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102033536A (zh) * | 2010-12-22 | 2011-04-27 | 大连理工大学 | 一种多机器人系统的调度组织协作系统及方法 |
US20120004796A1 (en) * | 2010-04-01 | 2012-01-05 | Alstom Transport Sa | Method for managing the circulation of vehicles on a railway network and related system |
WO2012141601A2 (en) * | 2011-04-11 | 2012-10-18 | Crown Equipment Limited | Method and apparatus for efficient scheduling for multiple automated non-holonomic vehicles using a coordinated path planner |
CN102929279A (zh) * | 2012-11-07 | 2013-02-13 | 无锡普智联科高新技术有限公司 | 基于三维空间密集存储区域的多机器人路径规划方法 |
CN103198366A (zh) * | 2013-04-09 | 2013-07-10 | 北京理工大学 | 一种考虑目标节点时效性的多目标路径规划方法 |
CN103955221A (zh) * | 2014-05-05 | 2014-07-30 | 北京理工大学 | 带任务时效性的多平台协作路径规划系统和方法 |
CN104750814A (zh) * | 2015-03-30 | 2015-07-01 | 大连理工大学 | 基于多传感器的多元异构数据流自动入库方法 |
CN104933473A (zh) * | 2015-05-22 | 2015-09-23 | 南京邮电大学 | 基于变邻域搜索蚁群算法的城市智能交通调度方法 |
WO2016135378A1 (en) * | 2015-02-27 | 2016-09-01 | Rocla Oyj | Resolution of route conflict |
CN106370189A (zh) * | 2016-12-02 | 2017-02-01 | 华中科技大学 | 一种基于多传感器融合的室内导航装置及方法 |
CN107168337A (zh) * | 2017-07-04 | 2017-09-15 | 武汉视览科技有限公司 | 一种基于视觉识别的移动机器人路径规划与调度方法 |
CN108268040A (zh) * | 2018-01-19 | 2018-07-10 | 广东美的智能机器人有限公司 | 多移动机器人的冲突管理方法及系统 |
CN108334998A (zh) * | 2018-04-16 | 2018-07-27 | 大连理工大学 | 一种多地面无人车辆的多目标协同跟踪方法 |
CN109559062A (zh) * | 2019-01-07 | 2019-04-02 | 大连理工大学 | 一种合作式物流问题的任务分配与路径规划方法 |
US10255577B1 (en) * | 2011-12-22 | 2019-04-09 | Amazon Technologies, Inc. | System and method for generating a delivery plan for multi-tier delivery schemes |
CN109634187A (zh) * | 2018-12-26 | 2019-04-16 | 芜湖哈特机器人产业技术研究院有限公司 | 一种agv远程监控系统 |
CN109828588A (zh) * | 2019-03-11 | 2019-05-31 | 浙江工业大学 | 一种基于多传感器融合的机器人室内路径规划方法 |
CN109947119A (zh) * | 2019-04-23 | 2019-06-28 | 东北大学 | 一种基于多传感器融合的移动机器人自主跟随系统及方法 |
CN109978272A (zh) * | 2019-03-30 | 2019-07-05 | 华南理工大学 | 一种基于多个全向移动机器人的路径规划系统及方法 |
CN110110903A (zh) * | 2019-04-17 | 2019-08-09 | 大连理工大学 | 一种基于神经进化的配送车辆路径规划方法 |
CN110174111A (zh) * | 2019-05-31 | 2019-08-27 | 山东华锐智能技术有限公司 | 基于时间窗的任务分段式的多agv路径规划算法 |
CN110398967A (zh) * | 2019-07-24 | 2019-11-01 | 西安电子科技大学 | 一种采用离散化方法的多机器人协同轨迹信息处理方法 |
CN110398253A (zh) * | 2019-07-22 | 2019-11-01 | 北京特种机械研究所 | Agv导航调度实现系统及agv控制系统 |
US20190339703A1 (en) * | 2017-01-18 | 2019-11-07 | Huawei Technologies Co., Ltd. | Path Planning Method and Apparatus |
CN110632922A (zh) * | 2019-09-10 | 2019-12-31 | 青岛理工大学 | 一种基于蝙蝠算法与强化学习的路径规划方法 |
-
2020
- 2020-01-14 CN CN202010035287.7A patent/CN111103887B/zh active Active
Patent Citations (25)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20120004796A1 (en) * | 2010-04-01 | 2012-01-05 | Alstom Transport Sa | Method for managing the circulation of vehicles on a railway network and related system |
CN102033536A (zh) * | 2010-12-22 | 2011-04-27 | 大连理工大学 | 一种多机器人系统的调度组织协作系统及方法 |
WO2012141601A2 (en) * | 2011-04-11 | 2012-10-18 | Crown Equipment Limited | Method and apparatus for efficient scheduling for multiple automated non-holonomic vehicles using a coordinated path planner |
US10255577B1 (en) * | 2011-12-22 | 2019-04-09 | Amazon Technologies, Inc. | System and method for generating a delivery plan for multi-tier delivery schemes |
CN102929279A (zh) * | 2012-11-07 | 2013-02-13 | 无锡普智联科高新技术有限公司 | 基于三维空间密集存储区域的多机器人路径规划方法 |
CN103198366A (zh) * | 2013-04-09 | 2013-07-10 | 北京理工大学 | 一种考虑目标节点时效性的多目标路径规划方法 |
CN103955221A (zh) * | 2014-05-05 | 2014-07-30 | 北京理工大学 | 带任务时效性的多平台协作路径规划系统和方法 |
WO2016135378A1 (en) * | 2015-02-27 | 2016-09-01 | Rocla Oyj | Resolution of route conflict |
CN104750814A (zh) * | 2015-03-30 | 2015-07-01 | 大连理工大学 | 基于多传感器的多元异构数据流自动入库方法 |
CN104933473A (zh) * | 2015-05-22 | 2015-09-23 | 南京邮电大学 | 基于变邻域搜索蚁群算法的城市智能交通调度方法 |
CN106370189A (zh) * | 2016-12-02 | 2017-02-01 | 华中科技大学 | 一种基于多传感器融合的室内导航装置及方法 |
US20190339703A1 (en) * | 2017-01-18 | 2019-11-07 | Huawei Technologies Co., Ltd. | Path Planning Method and Apparatus |
CN107168337A (zh) * | 2017-07-04 | 2017-09-15 | 武汉视览科技有限公司 | 一种基于视觉识别的移动机器人路径规划与调度方法 |
CN108268040A (zh) * | 2018-01-19 | 2018-07-10 | 广东美的智能机器人有限公司 | 多移动机器人的冲突管理方法及系统 |
CN108334998A (zh) * | 2018-04-16 | 2018-07-27 | 大连理工大学 | 一种多地面无人车辆的多目标协同跟踪方法 |
CN109634187A (zh) * | 2018-12-26 | 2019-04-16 | 芜湖哈特机器人产业技术研究院有限公司 | 一种agv远程监控系统 |
CN109559062A (zh) * | 2019-01-07 | 2019-04-02 | 大连理工大学 | 一种合作式物流问题的任务分配与路径规划方法 |
CN109828588A (zh) * | 2019-03-11 | 2019-05-31 | 浙江工业大学 | 一种基于多传感器融合的机器人室内路径规划方法 |
CN109978272A (zh) * | 2019-03-30 | 2019-07-05 | 华南理工大学 | 一种基于多个全向移动机器人的路径规划系统及方法 |
CN110110903A (zh) * | 2019-04-17 | 2019-08-09 | 大连理工大学 | 一种基于神经进化的配送车辆路径规划方法 |
CN109947119A (zh) * | 2019-04-23 | 2019-06-28 | 东北大学 | 一种基于多传感器融合的移动机器人自主跟随系统及方法 |
CN110174111A (zh) * | 2019-05-31 | 2019-08-27 | 山东华锐智能技术有限公司 | 基于时间窗的任务分段式的多agv路径规划算法 |
CN110398253A (zh) * | 2019-07-22 | 2019-11-01 | 北京特种机械研究所 | Agv导航调度实现系统及agv控制系统 |
CN110398967A (zh) * | 2019-07-24 | 2019-11-01 | 西安电子科技大学 | 一种采用离散化方法的多机器人协同轨迹信息处理方法 |
CN110632922A (zh) * | 2019-09-10 | 2019-12-31 | 青岛理工大学 | 一种基于蝙蝠算法与强化学习的路径规划方法 |
Non-Patent Citations (9)
Title |
---|
CHENGBAO LIU1 ETAL .: "Path planning and intelligent scheduling of multi-AGV systems in workshop", 《2017 36TH CHINESE CONTROL CONFERENCE (CCC)》 * |
HUANG MING;WANG FEI: "A New Multi-Agent Model of Workshop Scheduling", 《2018 IEEE 3RD INTERNATIONAL CONFERENCE ON CLOUD COMPUTING AND INTERNET OF THINGS (CCIOT)》 * |
SEBASTIÁN A. ETAL.: "Multi-robot Scheduling and Path-Planning for Non-overlapping Operator Attention", 《2018 SECOND IEEE INTERNATIONAL CONFERENCE ON ROBOTIC COMPUTING (IRC)》 * |
SHAWN STEPHENS;SATYANARAYANA G. MANYAM;DAVID W. CASBEER;VENANZIO: "Randomized Continuous Monitoring of a Target by Agents with Turn Radius Constraints", 《2019 INTERNATIONAL CONFERENCE ON UNMANNED AIRCRAFT SYSTEMS (ICUAS)》 * |
刘二辉: "面向制造物联的AGV路径规划及其集成的作业车间调度研究", 《中国优秀硕士学位论文全文数据库 信息科技辑》 * |
包翔宇等: "多机器人协同系统的研究综述及发展趋势", 《制造技术与机床》 * |
叶刚等: "多机器人系统中基于环境侧信息的移动任务调度算法", 《计算机应用与软件》 * |
李伟: "作业车间生产系统调度及仿真", 《中国优秀硕士学位论文全文数据库 工程科技Ⅱ辑》 * |
王东: "基于多传感器的自行车机器人系统搭建", 《中国优秀硕士学位论文全文数据库 信息科技辑》 * |
Cited By (16)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111885550A (zh) * | 2020-06-06 | 2020-11-03 | 浙江中力机械有限公司 | 一种分布式自主移动机器人调度系统 |
CN111885550B (zh) * | 2020-06-06 | 2023-09-19 | 浙江中力机械股份有限公司 | 一种分布式自主移动机器人调度系统 |
CN112033423A (zh) * | 2020-09-09 | 2020-12-04 | 上海有个机器人有限公司 | 一种基于道路共识的机器人路径规划方法、装置和机器人 |
CN112033423B (zh) * | 2020-09-09 | 2022-09-13 | 上海有个机器人有限公司 | 一种基于道路共识的机器人路径规划方法、装置和机器人 |
CN112123339A (zh) * | 2020-10-19 | 2020-12-25 | 哈尔滨理工大学 | 一种位置约束的多移动机械臂协同运输控制系统 |
CN112631232B (zh) * | 2020-12-28 | 2022-04-22 | 北京星航机电装备有限公司 | 基于openTCS实现对自动导引车调度控制方法及系统 |
CN112631232A (zh) * | 2020-12-28 | 2021-04-09 | 北京星航机电装备有限公司 | 基于openTCS实现对自动导引车调度控制方法及系统 |
CN112904854A (zh) * | 2021-03-31 | 2021-06-04 | 江苏智库智能科技有限公司 | 多机器人多目标实时动态避障方法、系统及存储介质 |
CN113189949A (zh) * | 2021-04-28 | 2021-07-30 | 铽罗(上海)机器人科技有限公司 | 一种导航调度控制方法和系统 |
CN113359751A (zh) * | 2021-06-23 | 2021-09-07 | 武汉理工大学 | 一种无人安防巡逻系统 |
CN113934228A (zh) * | 2021-10-18 | 2022-01-14 | 天津大学 | 基于协商共识的集群四旋翼无人机任务规划方法 |
CN113934228B (zh) * | 2021-10-18 | 2023-12-19 | 天津大学 | 基于协商共识的集群四旋翼无人机任务规划方法 |
CN114434458A (zh) * | 2022-01-27 | 2022-05-06 | 国科温州研究院(温州生物材料与工程研究所) | 集群机器人与虚拟环境的互动方法及其系统 |
CN114434458B (zh) * | 2022-01-27 | 2024-02-27 | 国科温州研究院(温州生物材料与工程研究所) | 集群机器人与虚拟环境的互动方法及其系统 |
CN114815857A (zh) * | 2022-06-28 | 2022-07-29 | 广东邦盛北斗科技股份公司 | 基于北斗导航的智能化农机管理方法、系统及云平台 |
CN114815857B (zh) * | 2022-06-28 | 2022-10-11 | 广东邦盛北斗科技股份公司 | 基于北斗导航的智能化农机管理方法、系统及云平台 |
Also Published As
Publication number | Publication date |
---|---|
CN111103887B (zh) | 2021-11-12 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN111103887B (zh) | 一种基于多传感器的多移动机器人调度系统设计方法 | |
Cardarelli et al. | Cooperative cloud robotics architecture for the coordination of multi-AGV systems in industrial warehouses | |
Draganjac et al. | Decentralized control of multi-AGV systems in autonomous warehousing applications | |
Wen et al. | CL-MAPF: Multi-agent path finding for car-like robots with kinematic and spatiotemporal constraints | |
WO2022083292A1 (zh) | 一种智能移动机器人全局路径规划方法和系统 | |
Tiwari | Intelligent planning for mobile robotics: algorithmic approaches: algorithmic approaches | |
EP4141599B1 (en) | Multi-robot route planning | |
Xidias et al. | Path planning and scheduling for a fleet of autonomous vehicles | |
Ali et al. | Multi-robot path planning and trajectory smoothing | |
Ma et al. | Efficient reciprocal collision avoidance between heterogeneous agents using ctmat | |
Dharmasiri et al. | Novel implementation of multiple automated ground vehicles traffic real time control algorithm for warehouse operations: djikstra approach | |
CN112083727A (zh) | 基于速度障碍物的多自主体系统分布式避碰编队控制方法 | |
Lian et al. | Improved coding landmark-based visual sensor position measurement and planning strategy for multiwarehouse automated guided vehicle | |
Pal et al. | Modified A* algorithm for mobile robot path planning | |
Katevas et al. | The approximate cell decomposition with local node refinement global path planning method: Path nodes refinement and curve parametric interpolation | |
Lutz et al. | Towards a robot fleet for intra-logistic tasks: Combining free robot navigation with multi-robot coordination at bottlenecks | |
CN116774603B (zh) | 多agv协同调度仿真平台及仿真方法 | |
Lin et al. | Lift path planning for tower cranes based on environmental point clouds | |
Nagatani et al. | Sensor-based navigation for car-like mobile robots based on a generalized Voronoi graph | |
Zhao et al. | A study of the global topological map construction algorithm based on grid map representation for multirobot | |
Zhao et al. | Dynamic node allocation-based multirobot path planning | |
WO2022030216A1 (ja) | 環境変更提案システムおよび環境変更提案プログラム | |
CN115907245A (zh) | 用于agv调度的碰撞检测方法、装置、设备及存储介质 | |
Duinkerken et al. | Dynamic free range routing for automated guided vehicles | |
Nevliudov et al. | Modeling of a Decentralized System for Maintenance of Production Equipment Based on Transport Robots |
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 |