[发明专利]一种通信受限的多机器人协同等值面跟踪方法

说明书

本发明提出一种通信受限的多机器人协同等值面跟踪方法，包括，建立移动机器人的三维动力学模型；针对通信受限环境，机器人之间无法相互通信的情况，通过机器人携带的传感器测量场强、次目标数值以及相邻机器人的相对位置；在本地对相对位置数据进行主成分分析，计算机器人协同运动方向；最后基于本地传感器测量值和协同运动方向设计控制方法。本发明提供了一种通信受限环境下的多机器人等值面跟踪方法，该方法能够实现多机器人在互不通信的情况下协同跟踪等值面，同时优化次目标，并通过中心收缩的方法控制距离，为多机器人在环境监测领域的实际应用奠定了关键基础。

技术领域

本发明属于多机器人协同环境监测领域，主要涉及一种通信受限条件下的多机器人协同等值面跟踪方法。

背景技术

近年来，机器人等值面跟踪技术在环境监测领域的应用得到快速发展，比如森林火灾监测、海洋污染物监测、空气污染监测等。对于大规模的复杂任务，多机器人协同的等值面方法跟踪相较于单机器人方法，具有更高的效率、更好的鲁棒性与精度。

等值面跟踪是场源搜索的拓展方式：三维空间中，机器人搜索期望的场强位置，并跟踪该场强对应的等值面，以此获得信号场的分布情况，监测或记录信号场。当期望场强的大小等于场源大小时，等值面跟踪等同于场源搜索。

现有的多机器人等值面跟踪方法往往通过机器人之间的彼此通信获得各自的传感器测量值和GPS位置信息，以此对信号场的梯度信息进行联合估计，从而实现对期望等值面的跟踪。

然而，在特殊的极端环境(如强电磁干扰的敌对环境、深海环境等)下，多机器人系统通常无法保证稳定的通信信道，即无法获得GPS位置信息和除本身以外其他机器人的传感器信息。因此，现有的多机器人等值面跟踪方法无法在通信受限的条件下使用。

在通信受限的条件下，多机器人等值面跟踪方法主要有两个难点：(1)通信受限下，多机器人如何实现协同控制与高效协同决策；(2)机器人运动轨迹是二维线性的，如何实现三维等值面的跟踪估计。

目前，针对(1)通信受限下多机器人控制与决策的常见方案有：a、领导-跟随方案；b、间歇性通信方案。其中a方案核心思想为设定一个领导机器人，所有决策仅在领导机器人本地做出，而其余机器人跟随领导机器人。这种方法在互不通信的情况下，无法共享机器人之间的有效信息，这可能导致决策的效益低下。b方案则要求提供间歇性通信，允许机器人主动断开通信，并在一段时间后重新通信，例如水下环境中的机器人定期上浮至水面进行通信。这种方法增加了额外的通信成本，限制了系统的灵活性，同时通信的信息有很强的滞后性。

发明内容

本发明的目的在于，针对现有技术的不足，提供一种通信受限下的多机器人协同等值面跟踪方法，解决通信受限时，多机器人在无法交互传感器测量值与GPS位置信息情况下的等值面跟踪问题。

为了解决上述问题，本发明提供了如下技术方案：

本发明首先提供了一种通信受限下的多机器人协同等值面跟踪方法，其包括以下步骤：

步骤1：在三维空间中建立移动机器人的动力学模型：

其中，r_i(t)＝[x(t),y(t),z(t)]表示第i个移动机器人t时刻在三维空间中的位置；i＝1,2,…,N，N为机器人的个数；表示第i个移动机器人t时刻的运动速度；u_i(t)表示第i个移动机器人t时刻的控制输入；

步骤2：考虑通信受限问题，所有移动机器人仅通过自身携带的传感器进行探测；得到机器人自身所在位置的场强、机器人自身所在位置的次目标强度，以及机器人自身与所有其他机器人的相对位置；

步骤3：将步骤2得到的相对位置信息进行主成分分析，在互不通信的条件下，得到多机器人系统的协同运动方向，