一种多无人移动平台网络化协同控制方法技术

技术编号:10322862 阅读:265 留言:0更新日期:2014-08-14 10:03
本发明专利技术提供一种多无人移动平台网络化协同控制方法,针对单个机器人不能完成的作业任务,建立多机器人试验平台,进行编队、避障等基本行为的实验。第一步:采用里程计的定位方式搭建基于WIFI的UDP模式进行协调通信,实时掌握车位置与姿态;第二步:获取的位置和姿态建立差动独轮小车运动模型;第三步:分别将车与目标点看作相互吸引的正负电荷,应用之间产生的电场力作用于智能车,完成固定队形编队;第四步:编队过程中,通过第一步中相互通信过来的位置信息,判断是否将要发生碰撞,对于有碰撞可能的车,引入使它们相斥的势场来产生相互之间的斥力,避免车与车之间的碰撞;第五步:根据获取的全局信息和对小车目前位置的计算,使用相斥的势场力,来避免车与障碍物之间的碰撞。

【技术实现步骤摘要】

本专利技术属于协同控制
,涉及。
技术介绍
多无人移动平台是由多个移动平台组成的集合,平台之间以及平台与环境之间通过通讯、协商与协作来共同完成单个平台所不能解决的问题.多个平台的使用比单个平台有更多的优点。多个平台相互合作能够完成超出它们各自能力范围的任务,使得多无人移动平台的整体能力大于个体能力之和。总体上说,多无人移动平台具有更广泛的任务领域、更高的效率、改良的系统性能、错误容忍、鲁棒性、分布式的感知与作用、内在的并行性、对社会和生命科学的观察等显著特性。多无人移动平台的网络化协同控制是当前多无人移动平台的一个重要发展方向。随着机器人应用范围的扩大,对其能力的要求越来越高,多个机器人协作可以完成单个机器人无法完成的复杂任务。编队控制是一个具有典型和通用性的多机器人协调问题,同时也是多机器人协调问题的基础,对多机器人协作系统的研究有巨大的推动和促进作用。如果编队过程中存在障碍,则可能会导致智能多机器人碰撞,损失会很严重,也不能很好的完成期望的动作或达到预定的编队效果,所以相关的避障策略也是在编队过程中需要考虑的重要问题。
技术实现思路
本专利技术针对单个机器人不能完成的作业任务,使用多机器人系统代替单个机器人执行复杂任务的需求,建立多机器人试验平台,进行编队、避障等基本行为的实验,以满足复杂环境下的任务需求。本专利技术的技术方案如下:,包括以下步骤:第一步:采用里程计的定位方式搭建基于WIFI的UDP模式进行协调通信,实时掌握车位置与姿态;第二步:根据第一步中获取的位置和姿态建立差动独轮小车运动模型;第三步:根据第二步中小车的运动模型,使用人工势能场方法进行编队,分别将车与目标点看作相互吸引的正负电荷,应用之间产生的电场力作用于智能车,完成固定队形编队;第四步:编队过程中,通过第一步中相互通信过来的位置信息,判断是否将要发生碰撞,对于有碰撞可能的车,引入使它们相斥的势场来产生相互之间的斥力,避免车与车之间的碰撞;第五步:根据获取的全局信息和对小车目前位置的计算,使用相斥的势场力,来避免车与障碍物之间的碰撞。本专利技术的有益效果:本专利技术实验结果误差范围控制在0.2mm以内,成功完成了机器人之间的互相避碰,并达到指定位置。【附图说明】 图1机器人转向分析坐标图;图2坐标系中的位置坐标图;图3实施例中基于MPLAB的环境对机器人编程流程图;图4UDP广播模式建立通信网络原理图;图5 —号车的初始状态示意图;图6 —号车躲避二号车的状态示意图;图7 —号车躲避零号车的状态示意图;图8 一号车躲过所有障碍以后继续行驶示意图;图9所有车到达指定的目标位置示意图。【具体实施方式】下面通过附图和实例对本专利技术的技术方案做进一步的详细描述。1.里程计定位系统的描述本实施例用odometry定位方式。这种定位方式是基于光电编码器的准确数据,随着时间的推移整合位置的变化的定位方式。假设机器人按照图1运动,其中rk为运动弧线半径,Δ 0,为转角,b为机器人轴间距,AUu和ΔΙ,为机器人左右轮运动轨迹,c为机器人中心,Λ P k为机器人运动直线距离:rkA Θ k = AUljk(rk+b) Δ θ k = AUrjk可以得到:本文档来自技高网...

【技术保护点】
一种多无人移动平台网络化协同控制方法,其特征在于,包括以下步骤:第一步:采用里程计的定位方式搭建基于WIFI的UDP模式进行协调通信,实时掌握车位置与姿态;第二步:根据第一步中获取的位置和姿态建立差动独轮小车运动模型;第三步:根据第二步中小车的运动模型,使用人工势能场方法进行编队,分别将车与目标点看作相互吸引的正负电荷,应用之间产生的电场力作用于智能车,完成固定队形编队;第四步:编队过程中,通过第一步中相互通信过来的位置信息,判断是否将要发生碰撞,对于有碰撞可能的车,引入使它们相斥的势场来产生相互之间的斥力,避免车与车之间的碰撞;第五步:根据获取的全局信息和对小车目前位置的计算,使用相斥的势场力,来避免车与障碍物之间的碰撞。

【技术特征摘要】
1.一种多无人移动平台网络化协同控制方法,其特征在于,包括以下步骤: 第一步:采用里程计的定位方式搭建基于WIFI的UDP模式进行协调通信,实时掌握车位置与姿态; 第二步:根据第一步中获取的位置和姿态建立差动独轮小车运动模型; 第三步:根据第二步中小车的运动模型,使用人工势能场方法进行编队,分别将车与目标点看作相互吸引的正负电荷,应用之间产生的电场力作用于智能车,完成固定队形编队; 第四步:编队过程中,通过第一步中相互通信过来的位置信息,判断是否将要发生碰撞,对于有碰撞可能的车,引入使它们相斥的势场来产生相互之间的斥力,避免车与车之间的碰撞; 第五步:根据获取的全局信息和对小车目前位置的计算,使用相斥的势场力,来避免车与障碍物之间的碰撞。2.如权利要求1所述的一种多无人移动平台网络化协同控制方法,其特征在于,其中所述的定位方式是基于光电编码器的准确数据随着时间的推移整合位置的变化的定位方式;其中rk为运动弧线半...

【专利技术属性】
技术研发人员:夏元清蒲钒陈静付梦印李春明李贺邓志红任雪梅
申请(专利权)人:北京理工大学
类型:发明
国别省市:北京;11

网友询问留言 已有0条评论
  • 还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。

1