CN103984343A - 一种多无人移动平台网络化协同控制方法 - Google Patents
一种多无人移动平台网络化协同控制方法 Download PDFInfo
- Publication number
- CN103984343A CN103984343A CN201410206019.1A CN201410206019A CN103984343A CN 103984343 A CN103984343 A CN 103984343A CN 201410206019 A CN201410206019 A CN 201410206019A CN 103984343 A CN103984343 A CN 103984343A
- Authority
- CN
- China
- Prior art keywords
- delta
- robot
- theta
- car
- control method
- 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
Landscapes
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明提供一种多无人移动平台网络化协同控制方法,针对单个机器人不能完成的作业任务,建立多机器人试验平台,进行编队、避障等基本行为的实验。第一步:采用里程计的定位方式搭建基于WIFI的UDP模式进行协调通信,实时掌握车位置与姿态;第二步:获取的位置和姿态建立差动独轮小车运动模型;第三步:分别将车与目标点看作相互吸引的正负电荷,应用之间产生的电场力作用于智能车,完成固定队形编队;第四步:编队过程中,通过第一步中相互通信过来的位置信息,判断是否将要发生碰撞,对于有碰撞可能的车,引入使它们相斥的势场来产生相互之间的斥力,避免车与车之间的碰撞;第五步:根据获取的全局信息和对小车目前位置的计算,使用相斥的势场力,来避免车与障碍物之间的碰撞。
Description
技术领域
本发明属于协同控制技术领域,涉及一种多无人移动平台网络化协同控制方法。
背景技术
多无人移动平台是由多个移动平台组成的集合,平台之间以及平台与环境之间通过通讯、协商与协作来共同完成单个平台所不能解决的问题.多个平台的使用比单个平台有更多的优点。多个平台相互合作能够完成超出它们各自能力范围的任务,使得多无人移动平台的整体能力大于个体能力之和。总体上说,多无人移动平台具有更广泛的任务领域、更高的效率、改良的***性能、错误容忍、鲁棒性、分布式的感知与作用、内在的并行性、对社会和生命科学的观察等显著特性。
多无人移动平台的网络化协同控制是当前多无人移动平台的一个重要发展方向。随着机器人应用范围的扩大,对其能力的要求越来越高,多个机器人协作可以完成单个机器人无法完成的复杂任务。编队控制是一个具有典型和通用性的多机器人协调问题,同时也是多机器人协调问题的基础,对多机器人协作***的研究有巨大的推动和促进作用。如果编队过程中存在障碍,则可能会导致智能多机器人碰撞,损失会很严重,也不能很好的完成期望的动作或达到预定的编队效果,所以相关的避障策略也是在编队过程中需要考虑的重要问题。
发明内容
本发明针对单个机器人不能完成的作业任务,使用多机器人***代替单个机器人执行复杂任务的需求,建立多机器人试验平台,进行编队、避障等基本行为的实验,以满足复杂环境下的任务需求。
本发明的技术方案如下:
一种多无人移动平台网络化协同控制方法,包括以下步骤:
第一步:采用里程计的定位方式搭建基于WIFI的UDP模式进行协调通信,实时掌握车位置与姿态;
第二步:根据第一步中获取的位置和姿态建立差动独轮小车运动模型;
第三步:根据第二步中小车的运动模型,使用人工势能场方法进行编队,分别将车与目标点看作相互吸引的正负电荷,应用之间产生的电场力作用于智能车,完成固定队形编队;
第四步:编队过程中,通过第一步中相互通信过来的位置信息,判断是否将要发生碰撞,对于有碰撞可能的车,引入使它们相斥的势场来产生相互之间的斥力,避免车与车之间的碰撞;
第五步:根据获取的全局信息和对小车目前位置的计算,使用相斥的势场力,来避免车与障碍物之间的碰撞。
本发明的有益效果:
本发明实验结果误差范围控制在0.2mm以内,成功完成了机器人之间的互相避碰,并达到指定位置。
附图说明
图1机器人转向分析坐标图;
图2坐标系中的位置坐标图;
图3实施例中基于MPLAB的环境对机器人编程流程图;
图4UDP广播模式建立通信网络原理图;
图5一号车的初始状态示意图;
图6一号车躲避二号车的状态示意图;
图7一号车躲避零号车的状态示意图;
图8一号车躲过所有障碍以后继续行驶示意图;
图9所有车到达指定的目标位置示意图。
具体实施方式
下面通过附图和实例对本发明的技术方案做进一步的详细描述。
1.里程计定位***的描述
本实施例用odometry定位方式。这种定位方式是基于光电编码器的准确数据,随着时间的推移整合位置的变化的定位方式。假设机器人按照图1运动,其中rk为运动弧线半径,Δθk为转角,b为机器人轴间距,ΔUl,k和ΔUr,k为机器人左右轮运动轨迹,c为机器人中心,Δρk为机器人运动直线距离:
rkΔθk=ΔUl,k
(rk+b)Δθk=ΔUr,k
可以得到:
而
在k-1时刻,机器人的位置为:
xk-1=[xk-1yk-1θk-1]T
其中,xk-1,yk-1为笛卡尔坐标系,θk-1为参考全局坐标系的方向角。
按照图2,按照旋转角Δθk和变化距离Δρk使得机器人运动到一个新的位置xk,
在图1和图2中,我们将机器人中心的弧线运动近似为弦,将这些公式带入上式,可以得到更新坐标方程:
基于以上原理,编写了定位程序,建立了多无人移动平台的定位***。
2.基于WIFI的通讯***的描述:
本实施例中wifi模块采用海凌科(香港)有限公司推出的HLK-WIFI-M03模块。Uart-Wifi是基于Uart接口的符合wifi无线网络标准的嵌入式模块,内置无线网络协议IEEE802.11协议栈以及TCP/IP协议栈,能够实现用户串口数据到无线网络之间的转换。多智能车***采用UDP广播模式建立通信网络,原理图如图3:
各个模块的具体配置:
网络设置:
IP地址:192.168.0.Y
子网掩码:255.255.255.0
网关地址:192.168.0.1
DNS地址:192.168.0.1
工作模式设置:
启用自动工作模式
协议类型:UDP
C/S模式:广播
端口号:6000
连接超时:0
配置好后重启模块,模块将自动连接网络,每个智能车发送的数据,将以广播形式发送给其它所有智能车,实现交互通讯。
3.基于人工势能场方法的编队和避障实验:
在物理学里面,我们把一定空间内物理量之间的影响称作场,包括力场和电场等。同时,我们用位姿信息作为这些量的物理属性,比如引力场中,我们用两个物体之间的距离计算引力的大小。人工势能场与之前的描述相同,我们将机器人所处的环境作为一个人工抽象出来的力场,这中间包括了机器人自身的场和障碍物、目标点的势能场。目标点对机器人产生吸引力,作为引力场,而障碍物对机器人产生排斥力,作为斥力场,计算引力和斥力的合力,然后控制机器人的行动。这样,机器人就可以由合力驱动来编队和避障了。
本发明提出一系列基于电势能场概念的人工势能场函数,将机器人当作电场中的负电荷,将障碍物当作静电场中具有几何外形的均匀导体,将目标位置当作正电荷,目标位置对机器人产生吸引力,然后将整个***当作一个电势能场来处理。其中的人工势能场函数主要有三种,机器人之间的势能场函数,机器人和障碍物之间的势能场函数,以及机器人和目标位置之间的势能场函数。
根据相关电场知识,我们将机器人之间的势场定义为:
对应机器人之间的力为:
其中VI为机器人i和机器人j之间的势场,αI和K为增益,Pij为机器人i和机器人j之间的距离,d0为机器人之间期望的距离,当||Pij||≤dI时,假定机器人之间的作用为固定的,显然可见,d0≤dl;
如果将障碍物看作一个质点,那么机器人与障碍物之间在电场中的影响可以表示为:
其中Vo(ril)表示机器人i与障碍物l之间的势场,ko是一个正的参数,Q表示总电量,规定为ril=pi-ol,pi表示机器人i的位置,ol表示障碍物l的位置。根据电磁学原理,机器人和障碍物上这一点之间产生的力为:
fo为Vo的梯度函数,根据上式可得:
机器人的期望位置对智能体表现为引力。但是这种引力与电场中异性电荷之间的引力不同。当机器人与期望位置之间的距离越远时,我们希望引力越大,这样有利于机器人驶向目标位置。而电场中的异性电荷之间引力刚好相反,当距离越大时,电荷之间的力越小。为了方便,我们假设机器人与目标位置之间的力与它们之间的距离成正比。根据编队的要求,我们选择势场函数为:
其中,di为机器人i的位置pi与期望位置pid之间的距离,kl为正常数。那么机器人与目标位置之间的力为:
实验采用上文中提到的模型和控制器,基于MPLAB的环境对机器人进行编程,软件流程图如图3。
根据以上流程,在修改了通讯的驱动程序以后,进行了实验。实验中,采用三个机器人为例,分别为零一二号车。零号车从(0;0)点位置出发,目标位置为(0.44;0.75);一号车从(0.5;0)位置出发,目标位置为(0;1);二号车从(1;0)位置出发,目标位置为(0;0.5)。其中,单个机器人的数据以一号车为例,数据采集如下。
图5为一号车的初始状态。左图为一号车的位置信息,包括x、y轴的坐标和朝向角,同时还显示了零号车和二号车的初始位置信息;右图为一号车的受力状况,其中,F为机器人收到的合力,Fid为各别的机器人对二号车产生的力,Fi为机器人之间势能场的合力,Ff为机器人受到目标的力。其中合力F与别的力呈线性关系。可以看到,一号车在初始位置时只受到目标位置对一号车的吸引力。
图6为一号车躲避二号车的状态。图中可以看到,三辆车互相发送位置信息,进行控制。而右图中则显示二号车进入一号车0.3m的避障范围内,使得一号车开始躲避二号车。
图7为一号车躲避零号车的状态。图中可以看到,三辆车继续互相发送位置信息,进行控制。而右图中则显示零号车进入一号车的避障范围内,使得一号车开始躲避零号车。
图8为一号车躲过所有障碍以后继续行驶。图中可以看到,三辆车继续互相发送位置信息,进行控制。而右图中则显示一号车已经躲过所有障碍,Fi为零。
图9为所有车到达指定的目标位置。从一号车的受力和坐标上来看,所有车都已经基本到达指定位置。
Claims (4)
1.一种多无人移动平台网络化协同控制方法,其特征在于,包括以下步骤:
第一步:采用里程计的定位方式搭建基于WIFI的UDP模式进行协调通信,实时掌握车位置与姿态;
第二步:根据第一步中获取的位置和姿态建立差动独轮小车运动模型;
第三步:根据第二步中小车的运动模型,使用人工势能场方法进行编队,分别将车与目标点看作相互吸引的正负电荷,应用之间产生的电场力作用于智能车,完成固定队形编队;
第四步:编队过程中,通过第一步中相互通信过来的位置信息,判断是否将要发生碰撞,对于有碰撞可能的车,引入使它们相斥的势场来产生相互之间的斥力,避免车与车之间的碰撞;
第五步:根据获取的全局信息和对小车目前位置的计算,使用相斥的势场力,来避免车与障碍物之间的碰撞。
2.如权利要求1所述的一种多无人移动平台网络化协同控制方法,其特征在于,其中所述的定位方式是基于光电编码器的准确数据随着时间的推移整合位置的变化的定位方式;其中rk为运动弧线半径,Δθk为转角,b为机器人轴间距,ΔUl,k和ΔUr,k为机器人左右轮运动轨迹,c为机器人中心,Δρk为机器人运动直线距离:
rkΔθk=ΔUl,k
(rk+b)Δθk=ΔUr,k
得到:
而
在k-1时刻,机器人的位置为:
xk-1=[xk-1yk-1θk-1]T
其中,xk-1,yk-1为笛卡尔坐标系,θk-1为参考全局坐标系的方向角;按照旋转角Δθk和变化距离Δρk使得机器人运动到一个新的位置xk,
将机器人中心的弧线运动近似为弦,则得到其中 因此 此外θk=αk+δk,其中 带入上式得到更新坐标方程:
至此建立了多无人移动平台的定位模式。
3.如权利要求1或2所述的一种多无人移动平台网络化协同控制方法,其特征在于,所述的Wifi是基于Uart接口的符合wifi无线网络标准的嵌入式模块,内置无线网络协议IEEE802.11协议栈以及TCP/IP协议栈,能够实现用户串口数据到无线网络之间的转换。
4.如权利要求1或2所述的一种多无人移动平台网络化协同控制方法,其特征在于,所述的第三步中将机器人当作电场中的负电荷,将障碍物当作静电场中具有几何外形的均匀导体,将目标位置当作正电荷,目标位置对机器人产生吸引力,然后将整个***当作一个电势能场来处理,其中的人工势能场函数包括机器人之间的势能场函数、机器人和障碍物之间的势能场函数、以及机器人和目标位置之间的势能场函数。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410206019.1A CN103984343A (zh) | 2014-05-15 | 2014-05-15 | 一种多无人移动平台网络化协同控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410206019.1A CN103984343A (zh) | 2014-05-15 | 2014-05-15 | 一种多无人移动平台网络化协同控制方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN103984343A true CN103984343A (zh) | 2014-08-13 |
Family
ID=51276358
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201410206019.1A Pending CN103984343A (zh) | 2014-05-15 | 2014-05-15 | 一种多无人移动平台网络化协同控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN103984343A (zh) |
Cited By (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104932451A (zh) * | 2015-04-17 | 2015-09-23 | 王玉娇 | 一种多设备协同控制方法及装置 |
CN106332101A (zh) * | 2016-08-18 | 2017-01-11 | 中国人民解放军国防科学技术大学 | 一种无人移动平台群体分布式格型网络拓扑的构建方法 |
CN108284764A (zh) * | 2018-01-29 | 2018-07-17 | 毛云维 | 布局在高速公路服务区的电动车智能调配充电站 |
CN108801255A (zh) * | 2017-05-04 | 2018-11-13 | 罗伯特·博世有限公司 | 用于避免机器人碰撞的方法、装置和*** |
CN109032095A (zh) * | 2018-08-23 | 2018-12-18 | 顺德职业技术学院 | 一种多个工业机器人组网下协同作业的方法及*** |
CN110262485A (zh) * | 2019-06-10 | 2019-09-20 | 华侨大学 | 一种基于自适应引力的移动机器人避障方法 |
CN111708370A (zh) * | 2020-07-21 | 2020-09-25 | 四川大学 | 基于人工势场的多机器人协同路径规划方法和*** |
CN113359437A (zh) * | 2021-05-14 | 2021-09-07 | 北京理工大学 | 基于演化博弈的多智能体编队的分层模型预测控制方法 |
Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2008250906A (ja) * | 2007-03-30 | 2008-10-16 | Sogo Keibi Hosho Co Ltd | 移動ロボット、自己位置補正方法および自己位置補正プログラム |
CN102215260A (zh) * | 2011-06-02 | 2011-10-12 | 北京理工大学 | 一种具有连通性保持的多智能体***协同控制方法 |
-
2014
- 2014-05-15 CN CN201410206019.1A patent/CN103984343A/zh active Pending
Patent Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2008250906A (ja) * | 2007-03-30 | 2008-10-16 | Sogo Keibi Hosho Co Ltd | 移動ロボット、自己位置補正方法および自己位置補正プログラム |
CN102215260A (zh) * | 2011-06-02 | 2011-10-12 | 北京理工大学 | 一种具有连通性保持的多智能体***协同控制方法 |
Non-Patent Citations (6)
Title |
---|
ZHIYUN LIN,ETC: "Necessary and Sufficient Graphical Conditions for Formation Control of Unicycles", 《IEEE TRANSACTIONS ON AUTOMATIC CONTROL》 * |
张凤等: "基于Leader-follower与人工势场的多移动机器人编队控制", 《沈阳建筑大学学报(自然科学版)》 * |
木V风: "HLK-WIFI-M03用户使用手册", 《HTTP://WENKU.BAIDU.COM》 * |
梁家海: "移动机器人编队的运动控制策略", 《计算机应用》 * |
秦天宝: "基于多传感器信息融合的移动机器人定位研究", 《PLC&FA》 * |
程磊等: "基于通信的多移动机器人编队控制***", 《华中科技大学学报(自然科学版)》 * |
Cited By (12)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104932451A (zh) * | 2015-04-17 | 2015-09-23 | 王玉娇 | 一种多设备协同控制方法及装置 |
CN106332101A (zh) * | 2016-08-18 | 2017-01-11 | 中国人民解放军国防科学技术大学 | 一种无人移动平台群体分布式格型网络拓扑的构建方法 |
CN106332101B (zh) * | 2016-08-18 | 2019-05-24 | 中国人民解放军国防科学技术大学 | 一种无人移动平台群体分布式格型网络拓扑的构建方法 |
CN108801255A (zh) * | 2017-05-04 | 2018-11-13 | 罗伯特·博世有限公司 | 用于避免机器人碰撞的方法、装置和*** |
CN108801255B (zh) * | 2017-05-04 | 2023-10-27 | 罗伯特·博世有限公司 | 用于避免机器人碰撞的方法、装置和*** |
CN108284764A (zh) * | 2018-01-29 | 2018-07-17 | 毛云维 | 布局在高速公路服务区的电动车智能调配充电站 |
CN108284764B (zh) * | 2018-01-29 | 2021-11-16 | 郑明亮 | 布局在高速公路服务区的电动车智能调配充电站 |
CN109032095A (zh) * | 2018-08-23 | 2018-12-18 | 顺德职业技术学院 | 一种多个工业机器人组网下协同作业的方法及*** |
CN110262485A (zh) * | 2019-06-10 | 2019-09-20 | 华侨大学 | 一种基于自适应引力的移动机器人避障方法 |
CN110262485B (zh) * | 2019-06-10 | 2022-06-07 | 华侨大学 | 一种基于自适应引力的移动机器人避障方法 |
CN111708370A (zh) * | 2020-07-21 | 2020-09-25 | 四川大学 | 基于人工势场的多机器人协同路径规划方法和*** |
CN113359437A (zh) * | 2021-05-14 | 2021-09-07 | 北京理工大学 | 基于演化博弈的多智能体编队的分层模型预测控制方法 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN103984343A (zh) | 一种多无人移动平台网络化协同控制方法 | |
Liu et al. | Coordinated motion planning for multiple mobile robots along designed paths with formation requirement | |
CN111308490B (zh) | 基于单线激光雷达的平衡车室内定位与导航*** | |
Pickem et al. | The GRITSBot in its natural habitat-a multi-robot testbed | |
CN110023866A (zh) | 用于自主导航中的动态路线规划的***和方法 | |
CN103699136A (zh) | 基于蛙跳算法的智能家庭服务机器人***及服务方法 | |
CN113341956B (zh) | 基于改进人工势场法的多智能体主从式编队控制方法 | |
WO2017221859A1 (ja) | 移動体、移動体制御システム、移動体制御方法、インターフェース装置、およびプログラムが記録された記録媒体 | |
CN115033016B (zh) | 一种异构无人集群编队避障方法及*** | |
Park et al. | Robust adaptive formation control and collision avoidance for electrically driven non-holonomic mobile robots | |
CN106527439A (zh) | 一种运动控制方法和装置 | |
Gong et al. | Real-time dynamic planning and tracking control of auto-docking for efficient wireless charging | |
Subramanian et al. | Obstacle avoidance using multi-point potential field approach for an underactuated flat-fish type AUV in dynamic environment | |
CN111185904A (zh) | 一种协同机器人平台及其控制*** | |
CN116501056A (zh) | 车辆轨迹跟踪控制方法和装置、无人车和存储介质 | |
Park et al. | Indoor path planning for an unmanned aerial vehicle via curriculum learning | |
Staal et al. | Towards a collaborative omnidirectional mobile robot in a smart cyber-physical environment | |
Raveendran et al. | Development of task-oriented ROS-based autonomous UGV with 3D object detection | |
Baranzadeh | A decentralized control algorithm for target search by a multi-robot team | |
Li et al. | Vision-based formation control of a heterogeneous unmanned system | |
Resende et al. | Coordinated path-following for multi-robot systems using the cluster space framework approach | |
Jiono et al. | Software Framework of Autonomous Mobile Robots on Isaac Sim and ROS | |
Teng et al. | Multi-sensor fusion based wheeled robot research on indoor positioning method | |
Balasooriya et al. | Development of the smart localization techniques for low-power autonomous rover for predetermined environments | |
Li et al. | Research on formation control algorithm of multiple inspection robots in substation |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
C02 | Deemed withdrawal of patent application after publication (patent law 2001) | ||
WD01 | Invention patent application deemed withdrawn after publication |
Application publication date: 20140813 |