[发明专利]一种多无人移动平台网络化协同控制方法

说明书

技术领域

本发明属于协同控制技术领域，涉及一种多无人移动平台网络化协同控制方法。

背景技术

多无人移动平台是由多个移动平台组成的集合，平台之间以及平台与环境之间通过通讯、协商与协作来共同完成单个平台所不能解决的问题.多个平台的使用比单个平台有更多的优点。多个平台相互合作能够完成超出它们各自能力范围的任务，使得多无人移动平台的整体能力大于个体能力之和。总体上说，多无人移动平台具有更广泛的任务领域、更高的效率、改良的系统性能、错误容忍、鲁棒性、分布式的感知与作用、内在的并行性、对社会和生命科学的观察等显著特性。

多无人移动平台的网络化协同控制是当前多无人移动平台的一个重要发展方向。随着机器人应用范围的扩大，对其能力的要求越来越高，多个机器人协作可以完成单个机器人无法完成的复杂任务。编队控制是一个具有典型和通用性的多机器人协调问题，同时也是多机器人协调问题的基础，对多机器人协作系统的研究有巨大的推动和促进作用。如果编队过程中存在障碍，则可能会导致智能多机器人碰撞，损失会很严重，也不能很好的完成期望的动作或达到预定的编队效果，所以相关的避障策略也是在编队过程中需要考虑的重要问题。

发明内容

本发明针对单个机器人不能完成的作业任务，使用多机器人系统代替单个机器人执行复杂任务的需求，建立多机器人试验平台，进行编队、避障等基本行为的实验，以满足复杂环境下的任务需求。

本发明的技术方案如下：

一种多无人移动平台网络化协同控制方法，包括以下步骤：

第一步：采用里程计的定位方式搭建基于WIFI的UDP模式进行协调通信,实时掌握车位置与姿态；

第二步：根据第一步中获取的位置和姿态建立差动独轮小车运动模型；

第三步：根据第二步中小车的运动模型,使用人工势能场方法进行编队，分别将车与目标点看作相互吸引的正负电荷，应用之间产生的电场力作用于智能车，完成固定队形编队；

第四步：编队过程中，通过第一步中相互通信过来的位置信息,判断是否将要发生碰撞,对于有碰撞可能的车,引入使它们相斥的势场来产生相互之间的斥力,避免车与车之间的碰撞；

第五步:根据获取的全局信息和对小车目前位置的计算,使用相斥的势场力,来避免车与障碍物之间的碰撞。

本发明的有益效果：

本发明实验结果误差范围控制在0.2mm以内，成功完成了机器人之间的互相避碰，并达到指定位置。

附图说明

图1机器人转向分析坐标图；

图2坐标系中的位置坐标图；

图3实施例中基于MPLAB的环境对机器人编程流程图；

图4UDP广播模式建立通信网络原理图；

图5一号车的初始状态示意图；

图6一号车躲避二号车的状态示意图；

图7一号车躲避零号车的状态示意图；

图8一号车躲过所有障碍以后继续行驶示意图；

图9所有车到达指定的目标位置示意图。

具体实施方式

下面通过附图和实例对本发明的技术方案做进一步的详细描述。

1.里程计定位系统的描述

本实施例用odometry定位方式。这种定位方式是基于光电编码器的准确数据，随着时间的推移整合位置的变化的定位方式。假设机器人按照图1运动，其中r_k为运动弧线半径，Δθ_k为转角，b为机器人轴间距，ΔU_l,k和ΔU_r,k为机器人左右轮运动轨迹，c为机器人中心，Δρ_k为机器人运动直线距离：

r_kΔθ_k＝ΔU_l，k

(r_k+b)Δθ_k＝ΔU_r，k

可以得到：