CN107368066A - 一种控制方法、设备及系统 - Google Patents

Abstract

本发明公开了一种控制方法，应用于第一设备，所述第一设备具有至少两个天线，每一天线都连接有独立的射频模块，所述方法包括：所述第一设备通过所述至少两个天线接收第二设备发送的第一射频信号；通过对所述第一射频信号的相关数据进行分析，确定所述第一设备与所述第二设备的相对位置信息；基于所述相对位置信息控制所述第一设备对所述第二设备实施跟随，保持所述第一设备与所述第二设备之间的预设相对位置关系。本发明还同时公开了一种控制设备及系统，以及应用于第二设备的控制方法。

Description

一种控制方法、设备及系统

技术领域

本发明涉及机器人技术领域，具体涉及一种控制方法、设备及系统。

背景技术

无人机、机器人是近来的热门领域，自主运动更是这些智能硬件设备的基本属性，那么如果一个运动物体(如一个机器人)可以跟踪另外一个运动物体(如另外几个机器人或者人)，则可以实现很多有意义的应用，例如汽车的自动跟踪驾驶、无人机的编队飞行等。

目前定位跟踪的方法仅局限于以下几种，例如基于计算机视觉的跟踪方法、基于激光雷达的跟踪方法、基于超声波定位的跟踪方法等。因此，如何研究出新的定位跟踪方法成为亟待解决的技术问题。

发明内容

有鉴于此，本发明期望提供一种控制方法、设备及系统，能够基于射频信号实现对运动物体的跟踪控制。

为达到上述目的，本发明的技术方案是这样实现的：

第一方面，本发明实施例提供了一种控制方法，应用于第一设备，所述第一设备具有至少两个天线，每一天线都连接有独立的射频模块，所述方法包括：

所述第一设备通过所述至少两个天线接收第二设备发送的第一射频信号；

通过对所述第一射频信号的相关数据进行分析，确定所述第一设备与所述第二设备的相对位置信息；

基于所述相对位置信息控制所述第一设备对所述第二设备实施跟随，保持所述第一设备与所述第二设备之间的预设相对位置关系。

上述方案中，可选地，所述通过对所述第一射频信号的相关数据进行分析，确定所述第二设备与所述第一设备的相对位置信息，包括：

通过第一射频信号到达所述至少两个天线的相位差和/或时间差，确定所述第二设备与所述第一设备的相对角度值；和/或

获取所述第一设备通过所述至少两个天线中的任一天线与所述第二设备通讯过程中，与所述第一射频信号相关的三次通讯数据；根据所述三次通讯数据得到与所述第一设备以及所述第二设备相关的四个时间差，并根据所述四个时间差，计算所述第一设备与所述第二设备的相对距离值。

上述方案中，可选地，所述至少两个天线至少满足下述条件：

垂直线极化天线；

主极化与交叉极化方向轴比大于或等于第一预设值；

两天线之间的距离小于通讯波长的半波长。

上述方案中，可选地，所述两天线之间的距离小于通讯波长的半波长，包括：

所述两天线之间的距离d大于0.7×λ/2，且所述d小于0.95×λ/2，其中，所述λ为通讯波长，所述d为两天线之间的距离。

上述方案中，可选地，所述基于所述相对位置信息控制所述第一设备对所述第二设备实施跟随，保持所述第一设备与所述第二设备之间的预设相对位置关系，包括：

基于所述相对位置信息判断所述第一设备与所述第二设备的相对位置是否满足预设相对位置关系；

如果不满足所述预设相对位置关系，控制所述第一设备调整当前运动状态，并基于调整后的运动状态对所述第二设备实施跟随，使所述第一设备与所述第二设备的相对位置满足预设相对位置关系；

如果满足所述预设相对位置关系，控制所述第一设备保持当前运动状态，基于当前运动状态对所述第二设备实施跟随，保持所述第一设备与所述第二设备之间的预设相对位置关系。

上述方案中，可选地，所述如果不满足所述预设相对位置关系，控制所述第一设备调整当前运动状态，并基于调整后的运动状态对所述第二设备实施跟随，使所述第一设备与所述第二设备的相对位置满足预设相对位置关系，包括：

所述相对位置为相对距离，所述相对位置关系为预设距离范围时，如果相对距离值不位于预设距离范围，则控制第一设备调整运行速度，并根据调整后的速度对所述第二设备实施跟随，直至相对距离值位于所述预设距离范围；

所述相对位置为相对角度，所述相对位置关系为预设角度范围时，如果相对角度值不位于预设角度范围，则控制第二设备旋转直至所述第一设备与所述第二设备的相对角度值位于所述预设角度范围。

上述方案中，可选地，所述第一射频信号为超宽带(UWB，Ultra Wideband)信号、或无线保真(WIFI，Wireless Fidelity)信号、或蓝牙信号。

第二方面，本发明实施例提供了一种跟踪控制方法，应用于第二设备，所述第二设备具有天线，所述天线连接有射频模块，所述第二设备能通过所述射频模块与第一设备进行通讯，所述方法包括：

在所述第二设备处于第一运动状态的过程中，

所述第二设备通过所述天线向第一设备发射第一射频信号，供所述第一设备基于所述第一射频信号的相关数据确定所述第一设备与所述第二设备的相对位置信息，所述第一设备基于所述相对位置信息对所述第二设备实施跟随，保持所述第一设备与所述第二设备之间的预设相对位置关系。

上述方案中，可选地，所述天线至少满足下述条件：

圆极化天线；

主极化方向与交叉极化方向轴比小于第二预设值；

所述天线的方向图上凹陷处增益值小于第三阈值，且所述天线的辐射方向保持一致。

上述方案中，可选地，所述第一射频信号为超宽带(UWB)信号、或无线保真(WIFI)信号、或蓝牙信号。

第三方面，本发明实施例提供了一种第一设备，所述第一设备包括：

至少两个射频模块，每个射频模块都连接有独立的天线；

第一处理器，用于通过所述至少两个天线接收第二设备发送的第一射频信号；通过对所述第一射频信号的相关数据进行分析，确定所述第一设备与所述第二设备的相对位置信息；基于所述相对位置信息控制所述第一设备对所述第二设备实施跟随，保持所述第一设备与所述第二设备之间的预设相对位置关系。

上述方案中，可选地，所述第一处理器，具体用于：

通过第一射频信号到达所述至少两个天线的相位差和/或时间差，确定所述第二设备与所述第一设备的相对角度值；和/或

获取所述第一设备通过所述至少两个天线中的任一天线与所述第二设备通讯过程中，与所述第一射频信号相关的三次通讯数据；根据所述三次通讯数据得到与所述第一设备以及所述第二设备相关的四个时间差，并根据所述四个时间差，计算所述第一设备与所述第二设备的相对距离值。

上述方案中，可选地，所述至少两个天线至少满足下述条件：

垂直线极化天线；

主极化与交叉极化方向轴比大于或等于第一预设值；

两天线之间的距离小于通讯波长的半波长。

上述方案中，可选地，所述第一处理器，具体用于：

基于所述相对位置信息判断所述第一设备与所述第二设备的相对位置是否满足预设相对位置关系；

如果不满足所述预设相对位置关系，控制所述第一设备调整当前运动状态，并基于调整后的运动状态对所述第二设备实施跟随，使所述第一设备与所述第二设备的相对位置满足预设相对位置关系；

如果满足所述预设相对位置关系，控制所述第一设备保持当前运动状态，基于当前运动状态对所述第二设备实施跟随，保持所述第一设备与所述第二设备之间的预设相对位置关系。

第四方面，本发明实施例提供了一种第二设备，所述第二设备包括：

射频模块，

与所述射频模块连接的天线，

第二处理器，用于在所述第二设备处于第一运动状态的过程中，通过所述天线向第一设备发射第一射频信号，供所述第一设备基于所述第一射频信号的相关数据确定所述第一设备与所述第二设备的相对位置信息，所述第一设备基于所述相对位置信息对所述第二设备实施跟随，保持所述第一设备与所述第二设备之间的预设相对位置关系。

上述方案中，可选地，所述天线至少满足下述条件：

圆极化天线；

主极化方向与交叉极化方向轴比小于第二预设值；

所述天线的方向图上凹陷处增益值小于第三阈值，且所述天线的辐射方向保持一致。

第五方面，本发明实施例提供了一种控制系统，所述控制系统包括：

第二设备，用于向第一设备发送第一射频信号；

第一设备，具有至少两个天线，用于通过所述至少两个天线接收第二设备发送的第一射频信号；通过对所述第一射频信号的相关数据进行分析，确定所述第一设备与所述第二设备的相对位置信息；基于所述相对位置信息控制所述第一设备对所述第二设备实施跟随，保持所述第一设备与所述第二设备之间的预设相对位置关系。

第六方面，本发明实施例提供了一种计算机存储介质，所述计算机存储介质中存储有计算机程序，所述计算机程序用于执行以上所述的应用于第一设备的控制方法。

第七方面，本发明实施例提供了一种计算机存储介质，所述计算机存储介质中存储有计算机程序，所述计算机程序用于执行以上所述的应用于第二设备的控制方法。

本发明实施例的技术方案中，第一设备通过至少两个天线接收第二设备发送的第一射频信号；通过对所述第一射频信号的相关数据进行分析，确定所述第一设备与所述第二设备的相对位置信息；基于所述相对位置信息控制所述第一设备对所述第二设备实施跟随，保持所述第一设备与所述第二设备之间的预设相对位置关系；这样，能够基于射频信号实现对运动物体即第二设备的跟踪控制。

附图说明

图1为本发明实施例提供的应用于第一设备的控制方法的实现流程示意图；

图2为本发明实施例提供的第一设备中两根UWB天线的俯视图以及三维立体图示意图；

图3为本发明实施例提供的采用TWR方法进行测距的示意图；

图4为本发明实施例提供的第一射频信号为UWB信号时，第二设备中UWB天线正视图和后视图示意图；

图5为本发明实施例提供的第一设备的组成结构示意图；

图6为本发明实施例提供的第二设备的组成结构示意图；

图7为本发明实施例提供的控制系统的一种交互示意图。

具体实施方式

为了能够更加详尽地了解本发明的特点与技术内容，下面结合附图对本发明的实现进行详细阐述，所附附图仅供参考说明之用，并非用来限定本发明。

本发明实施例提供一种控制方法，所述方法应用于第一设备，所述第一设备具有至少两个天线，每一天线都连接有独立的射频模块，如图1所示，所述方法主要包括：

步骤101、所述第一设备通过所述至少两个天线接收第二设备发送的第一射频信号。

这里，所述至少两个天线至少满足下述条件：

垂直线极化天线；

主极化与交叉极化方向轴比大于或等于第一预设值；

两天线之间的距离小于通讯波长的半波长。

这里，第一预设值可以依据经验值进行设定、并调整。当然，第一预设值还可以第一射频信号的类型而设定或调整。

可选地，所述两天线之间的距离小于通讯波长的半波长，包括：

所述两天线之间的距离d大于0.7×λ/2，且所述d小于0.95×λ/2，其中，所述λ为通讯波长，所述d为两天线之间的距离。

也就是说，两天线之间的距离d的约束距离为(0.7～0.95)的半波长。

示例性地，所述第一设备中的两个UWB天线，满足以下几个条件：

1)垂直线极化，且主极化与交叉极化方向轴比大于等于12dB。

2)两根天线之间测距离d为(0.7～0.95)的半波长。

其中，所述第一射频信号可以为UWB信号、或WIFI信号、或蓝牙信号。

以第一设备中两天线为UWB天线为例，图2示出了第一射频信号为UWB信号时，第一设备中UWB天线的俯视图以及三维立体图示意图，具体的，如图2所示，左半部分附图为两天线的俯视图，右半部分附图为两天线的三维立体图。在此应用中，UWB通讯频率为6.25GHz～6.75GHz，故，λ＝c/f＝46mm，若d取0.9×λ/2，则d为20.8mm，即两天线之间的距离为20.8mm。

以第一设备中两天线为WIFI天线为例，在此应用中，WIFI通讯频率为2.4GHz，故，λ＝c/f＝12.5cm，若d取0.9×λ/2，则d为5.625cm，即两天线之间的距离为5.625cm。

以第一设备中两天线为蓝牙天线为例，在此应用中，WIFI通讯频率为2.4GHz，故，λ＝c/f＝12.5cm，若d取0.8×λ/2，则d为5cm，即两天线之间的距离为5cm。

本实施例中，所述第一设备是对所述第二设备实施跟随的设备。

步骤102、通过对所述第一射频信号的相关数据进行分析，确定所述第一设备与所述第二设备的相对位置信息。

作为一种实施方式，所述通过对所述第一射频信号的相关数据进行分析，确定所述第二设备与所述第一设备的相对位置信息，包括：

通过第一射频信号到达所述至少两个天线的相位差和/或时间差，确定所述第二设备与所述第一设备的相对角度值。

示例性地，可使用到达相位差(PDOA，Phase Difference of Arrival)方法确定所述第二设备与所述第一设备的相对角度值。

具体地，当第二设备发送出final数据包或poll数据包的时候，第一设备端的两个射频模块可以采集到final数据包或poll数据包到达各自天线的信号相位差，第一设备中的处理器读取两个射频模块的相位值P1和P2，计算出相位差为PD＝P1-P2，可得到第二设备与第一设备的相对角度值为ang＝(PD/(2∏))/360°；其中，P₁表示第一射频信号达到第一设备的第一天线的相位，单位为弧度值；P₂表示第一射频信号达到第一设备的第二天线的相位，单位为弧度值；其中，P_D表示第一射频信号到达第一天线与第二天线的相位差，单位为弧度值；ang表示第一设备与第二设备之间的相对角度值，单位为度。

示例性地，可使用到达时间差(TDOA，Time Difference of Arrival)方法确定所述第二设备与所述第一设备的相对角度值。

具体地，当第二设备发送出final数据包或poll数据包的时候，第一设备端的两个射频模块可以采集到final数据包或poll数据包到达各自对应天线的信号时间值，第一设备中的处理器读取两个射频模块的时间值T1和T2，可以计算出第一射频信号到两个天线之间的距离差ΔS＝(T2-T1)×ν，再根据三角形的相对关系也可以计算出第二设备所在第一设备的方位。

作为一种实施方式，获取所述第一设备通过所述至少两个天线中的任一天线与所述第二设备通讯过程中，与所述第一射频信号相关的三次通讯数据；根据所述三次通讯数据得到与所述第一设备以及所述第二设备相关的四个时间差，并根据所述四个时间差，计算所述第一设备与所述第二设备的相对距离值。

具体地，第一设备与第二设备之间的距离值，可以通过多种技术检测获得第一设备与第二设备之间的距离值，例如：飞行时间(TOF，Time of Flight)技术、到达时间差(TDOA，Time Difference of Arrival)技术等等，

例如，第一设备与第二设备可以采用双向测距(TWR，Two-way ranging)的方法进行测距，每次测距需要3次通讯，其具体包括以下步骤(TWR是TOF的一种算法)，图3示出了采用TWR方法进行测距的示意图，具体步骤包括：

(1)第二设备发出一个第一数据包(也即：与第一射频信号相关的通讯数据)，发出时，第二设备记录发送的时间戳tt1；这里，所述第一数据包可以是Poll数据包；

(2)第一设备等待接收第二设备发出的第一射频信号，第一设备接收到poll数据包后，记录接收时刻的时间戳ta1，然后发送一个第二数据包，并记录发送第二数据包(与第一射频信号相关的通讯数据)的时间戳ta2；这里，所述第二数据包可以是响应(response)数据包；

(3)第二设备等待接收第一设备发出的第二射频信号，第二设备接收到response数据包后，记录接收时刻的时间戳tt2，并计算出需要发送第三数据包(与第一射频信号相关的通讯数据)的时间戳tt3，第二设备的时钟到达tt3时，发出第三数据包，第三数据包中包含3个时间戳信息(tt1，tt2，tt3)；这里，所述第三数据包可以是最终(final)数据包；

(4)第一设备收到final数据包后，记录接收时间戳ta3。此时第一设备已经记录了3个时间戳ta1，ta2，ta3，同时通过读取final数据包的内容，也可以得到第二设备的三个时间戳tt1，tt2，tt3；

(5)由于第一设备与第二设备的时间不同步，因此需要计算第一设备与第二设备各自的时间差，如图2所示，其中：

Tround1＝tt2–tt1………………………………[1]

Treply1＝ta2–ta1………………………………[2]

Tround2＝ta3–ta2………………………………[3]

Treply2＝tt3–tt2………………………………[4]

根据上述四个时间差，就可以计算出第一设备与第二设备之间的距离值，其计算公式如下：

T＝(Tround1–Treply1)/2………………………………[5]

T＝(Tround2–Treply2)/2………………………………[6]

DIS＝T*V………………………………[7]

其中，DIS表示第一设备与第二设备之间的距离值，T表示第一设备与第二设备之间的通信时长，V表示光速。

步骤103、基于所述相对位置信息控制所述第一设备对所述第二设备实施跟随，保持所述第一设备与所述第二设备之间的预设相对位置关系。

作为一种实施方式，所述基于所述相对位置信息控制所述第一设备对所述第二设备实施跟随，保持所述第一设备与所述第二设备之间的预设相对位置关系，包括：

基于所述相对位置信息判断所述第一设备与所述第二设备的相对位置是否满足预设相对位置关系；

如果不满足所述预设相对位置关系，控制所述第一设备调整当前运动状态，并基于调整后的运动状态对所述第二设备实施跟随，使所述第一设备与所述第二设备的相对位置满足预设相对位置关系；

如果满足所述预设相对位置关系，控制所述第一设备保持当前运动状态，基于当前运动状态对所述第二设备实施跟随，保持所述第一设备与所述第二设备之间的预设相对位置关系。

其中，所述预设相对位置关系可由第一设备端进行设定，或由第二设备端进行设定，并将其所设定的预设相对位置关系发送至第一设备，以由第一设备基于此标准对第二设备实施跟随。

如此，第一设备可以获取与第二设备之间的相对位置信息，且基于射频的方法可做两者之间的较高精度的相对定位。根据相对定位的结果，第一设备可对第二设备实施准确跟随。

具体地，所述如果不满足所述预设相对位置关系，控制所述第一设备调整当前运动状态，并基于调整后的运动状态对所述第二设备实施跟随，使所述第一设备与所述第二设备的相对位置满足预设相对位置关系，包括：

所述相对位置为相对距离，所述相对位置关系为预设距离范围时，如果相对距离值不位于预设距离范围，则控制第一设备调整运行速度，并根据调整后的速度对所述第二设备实施跟随，直至相对距离值位于所述预设距离范围；

所述相对位置为相对角度，所述相对位置关系为预设角度范围时，如果相对角度值不位于预设角度范围，则控制第二设备旋转直至所述第一设备与所述第二设备的相对角度值位于所述预设角度范围。

其中，所述预设距离范围、所述预设角度范围可由第一设备端进行设定，或由第二设备端进行设定，并将其所设定的所述预设距离范围、所述预设角度范围发送至第一设备，以由第一设备基于此标准对第二设备实施跟随。

如此，根据测得的第二设备与第一设备之间的距离，控制第一设备向前运动，保持与第二设备之间的相对距离，例如，可对跟随距离进行PID控制或自适应控制，保持两者之间的相对位置。

如此，根据测得的相对角度，控制第一设备调整相对角度，保持与第二设备之间的相对角度，就可以实现跟踪。

如此，第一设备可以获取与第二设备之间的相对距离与相对角度，且基于射频的方法可做两者之间的较高精度的相对定位。根据相对定位的结果，第一设备可对第二设备实施准确跟随。

这里，所述第一设备为跟踪者，比如，所述第一设备为机器人。

这里，所述第二设备为被跟踪者或信标，比如，所述第二设备能够自己运动或借助于外力而运动，如所述第二设备为机器人；或者所述第二设备为不能自行运动的设备，由运动的人或物承载所述第二设备，使得所述第二设备运动。

本实施例所述控制方法，第一设备通过至少两个天线接收第二设备发送的第一射频信号；通过对所述第一射频信号的相关数据进行分析，确定所述第一设备与所述第二设备的相对位置信息；基于所述相对位置信息控制所述第一设备对所述第二设备实施跟随，保持所述第一设备与所述第二设备之间的预设相对位置关系；这样，能够基于射频信号实现对运动物体即第二设备的跟踪控制。

实施例二

本发明实施例提供一种控制方法，所述方法应用于第二设备，所述第二设备具有天线，所述天线连接有射频模块，所述第二设备能通过所述射频模块与第一设备进行通讯，所述方法主要包括：

在所述第二设备处于第一运动状态的过程中，

所述第二设备通过所述天线向第一设备发射第一射频信号，供所述第一设备基于所述第一射频信号的相关数据确定所述第一设备与所述第二设备的相对位置信息，所述第一设备基于所述相对位置信息对所述第二设备实施跟随，保持所述第一设备与所述第二设备之间的预设相对位置关系。

这里，所述第一运动状态可以为匀速运动或变速运动，且在某一时刻或某一时间段的运动速度可以为0。

这里，所述天线至少满足下述条件：

圆极化天线；

主极化方向与交叉极化方向轴比小于第二预设值；

所述天线的方向图上凹陷处增益值小于第三阈值，且所述天线的辐射方向保持一致。

这里，第二预设值可以依据经验值进行设定、并调整。当然，第二预设值还可以第一射频信号的类型而设定或调整。

示例性地，所述第二设备中的天线为圆极化天线，且主极化方向与交叉极化方向轴比小于5dB；同时，该天线的方向图要尽量圆，从而保证各个方向辐射比较一致。

这里，第三预设值可以依据经验值进行设定、并调整。当然，第三预设值还可以第一射频信号的类型而设定或调整。

以第二设备中天线为UWB天线为例，图4示出了第一射频信号为UWB信号时，第二设备中UWB天线正视图和后视图示意图，具体的，如图4所示，左半部分附图为从PCB板正面看获得的UWB天线正视图，右半部分附图为从PCB板背面看获得的UWB天线后视图。如图4所示，该天线采用3层PCB设计，并使用威尔金森(Wilkson)功分器加延迟线的方法形成正交馈电，实现圆极化天线。

其中，所述第一射频信号可以为UWB信号、或WIFI信号、或蓝牙信号。

本发明实施例所述控制方法，在所述第二设备处于第一运动状态的过程中，所述第二设备通过所述天线向第一设备发射第一射频信号，供所述第一设备基于所述第一射频信号的相关数据确定所述第一设备与所述第二设备的相对位置信息，所述第一设备基于所述相对位置信息对所述第二设备实施跟随，保持所述第一设备与所述第二设备之间的预设相对位置关系。这样，能够基于射频信号实现对运动物体即第二设备的跟踪控制。

实施例三

本发明实施例还记载了一种第一设备，图5示出了第一设备的一种组成结构示意图，如图5所示，所述第一设备包括：

至少两个射频模块51，每个射频模块51都连接有独立的天线；

第一处理器52，用于通过所述至少两个天线接收第二设备发送的第一射频信号；通过对所述第一射频信号的相关数据进行分析，确定所述第一设备与所述第二设备的相对位置信息；基于所述相对位置信息控制所述第一设备对所述第二设备实施跟随，保持所述第一设备与所述第二设备之间的预设相对位置关系。

在一实施方式中，所述第一处理器52，具体用于：

通过第一射频信号到达所述至少两个天线的相位差和/或时间差，确定所述第二设备与所述第一设备的相对角度值；和/或

获取所述第一设备通过所述至少两个天线中的任一天线与所述第二设备通讯过程中，与所述第一射频信号相关的三次通讯数据；根据所述三次通讯数据得到与所述第一设备以及所述第二设备相关的四个时间差，并根据所述四个时间差，计算所述第一设备与所述第二设备的相对距离值。

其中，所述至少两个天线至少满足下述条件：

垂直线极化天线；

主极化与交叉极化方向轴比大于或等于第一预设值；

两天线之间的距离小于通讯波长的半波长。

其中，所述两天线之间的距离小于通讯波长的半波长，包括：

所述两天线之间的距离d大于0.7×λ/2，且所述d小于0.95×λ/2，其中，所述λ为通讯波长，所述d为两天线之间的距离。

这里，第一预设值可以依据经验值进行设定、并调整。当然，第一预设值还可以第一射频信号的类型而设定或调整。

可选地，所述两天线之间的距离小于通讯波长的半波长，包括：

所述两天线之间的距离d大于0.7×λ/2，且所述d小于0.95×λ/2，其中，所述λ为通讯波长，所述d为两天线之间的距离。

也就是说，两天线之间的距离d的约束距离为(0.7～0.95)的半波长。

示例性地，所述第一设备中的两个UWB天线，满足以下几个条件：

1)垂直线极化，且主极化与交叉极化方向轴比大于等于12dB。

2)两根天线之间测距离d为(0.7～0.95)的半波长。

这里，所述第一射频信号可以为UWB信号、或WIFI信号、或蓝牙信号。

在一实施方式中，所述第一处理器52，具体用于：

基于所述相对位置信息判断所述第一设备与所述第二设备的相对位置是否满足预设相对位置关系；

如果不满足所述预设相对位置关系，控制所述第一设备调整当前运动状态，并基于调整后的运动状态对所述第二设备实施跟随，使所述第一设备与所述第二设备的相对位置满足预设相对位置关系；

如果满足所述预设相对位置关系，控制所述第一设备保持当前运动状态，基于当前运动状态对所述第二设备实施跟随，保持所述第一设备与所述第二设备之间的预设相对位置关系。

在一实施方式中，所述第一处理器52，具体用于：

所述相对位置为相对距离，所述相对位置关系为预设距离范围时，如果相对距离值不位于预设距离范围，则控制第一设备调整运行速度，并根据调整后的速度对所述第二设备实施跟随，直至相对距离值位于所述预设距离范围；

所述相对位置为相对角度，所述相对位置关系为预设角度范围时，如果相对角度值不位于预设角度范围，则控制第二设备旋转直至所述第一设备与所述第二设备的相对角度值位于所述预设角度范围。

本领域技术人员应当理解，本实施例的第一设备中各单元的功能，可参照前述应用于第一设备中的控制方法的相关描述而理解。

实际应用中，上述第一处理器52的具体的结构可以为中央处理器(CPU，CentralProcessing Unit)、微处理器(MCU，Micro Controller Unit)、数字信号处理器(DSP，Digital Signal Processing)或可编程逻辑器件(PLC，Programmable Logic Controller)等具有处理功能的电子元器件或电子元器件的集合。其中，所述处理器包括可执行代码，所述可执行代码存储在存储介质中，所述处理器可以通过总线等通信接口与所述存储介质中相连，在执行具体的各单元的对应功能时，从所述存储介质中读取并运行所述可执行代码。所述存储介质用于存储所述可执行代码的部分优选为非瞬间存储介质。

本实施例所述第一设备，能够基于射频信号实现第一设备对第二设备的跟踪控制。

实施例四

本发明实施例还记载了一种第二设备，图6示出了第二设备的一种组成结构示意图，如图6所示，所述第二设备包括：

射频模块61，所述射频模块61连接有天线，

第二处理器62，用于在所述第二设备处于第一运动状态的过程中，通过所述天线向第一设备发射第一射频信号，供所述第一设备基于所述第一射频信号的相关数据确定所述第一设备与所述第二设备的相对位置信息，所述第一设备基于所述相对位置信息对所述第二设备实施跟随，保持所述第一设备与所述第二设备之间的预设相对位置关系。

这里，所述第一运动状态可以为匀速运动或变速运动，且在某一时刻或某一时间段的运动速度可以为0。

其中，所述天线至少满足下述条件：

圆极化天线；

主极化方向与交叉极化方向轴比小于第二预设值；

所述天线的方向图上凹陷处增益值小于第三阈值，且所述天线的辐射方向保持一致。

这里，第二预设值可以依据经验值进行设定、并调整。当然，第二预设值还可以第一射频信号的类型而设定或调整。

示例性地，所述第二设备中的天线为圆极化天线，且主极化方向与交叉极化方向轴比小于5dB；同时，该天线的方向图要尽量圆，从而保证各个方向辐射比较一致。

本领域技术人员应当理解，本实施例的第二设备中各单元的功能，可参照前述应用于第二设备中的控制方法的相关描述而理解。

实际应用中，上述第二处理器62的具体的结构可以为CPU、MCU、DSP或PLC等具有处理功能的电子元器件或电子元器件的集合。其中，所述处理器包括可执行代码，所述可执行代码存储在存储介质中，所述处理器可以通过总线等通信接口与所述存储介质中相连，在执行具体的各单元的对应功能时，从所述存储介质中读取并运行所述可执行代码。所述存储介质用于存储所述可执行代码的部分优选为非瞬间存储介质。

本实施例所述第二设备，能够基于射频信号实现第一设备对第二设备的跟踪控制。

实施例五

基于本发明实施例一至四，本发明实施例还记载了一种控制系统，图7示出了控制系统的一种组成结构示意图，如图7所示，所述控制系统包括：

第二设备10，用于向第一设备20发送第一射频信号；

第一设备20，具有至少两个天线，用于通过所述至少两个天线接收第二设备10发送的第一射频信号；通过对所述第一射频信号的相关数据进行分析，确定所述第一设备20与所述第二设备10的相对位置信息；基于所述相对位置信息控制所述第一设备20对所述第二设备10实施跟随，保持所述第一设备20与所述第二设备10之间的预设相对位置关系。

这里，所述第一设备20的具体的组成结构如图5所示，所述第二设备10的具体的组成结构如图6所示。

本实施例所涉及的第一设备为跟踪者，比如，所述第一设备为机器人。

本实施例所涉及的第二设备为被跟踪者或信标，比如，所述第二设备能够自己运动或借助于外力而运动，如所述第二设备为机器人；或者所述第二设备为不能自行运动设备，由运动的人或物承载所述第二设备，使得所述第二设备运动。

本实施例所述控制系统，能够基于射频信号实现第一设备对第二设备的跟踪控制。

本实施例还提供一种计算机存储介质，所述计算机存储介质存储有计算机程序，所述计算机程序被处理器执行之后，能够实现前述各实施例所述的任意一项或多项控制方法。

所述计算机存储介质可为各种类型的存储介质，在本实施例中可优选为非瞬间存储介质。

在本申请所提供的几个实施例中，应该理解到，所揭露的设备和方法，可以通过其它的方式实现。以上所描述的设备实施例仅仅是示意性的，例如，所述单元的划分，仅仅为一种逻辑功能划分，实际实现时可以有另外的划分方式，如：多个单元或组件可以结合，或可以集成到另一个系统，或一些特征可以忽略，或不执行。另外，所显示或讨论的各组成部分相互之间的耦合、或直接耦合、或通信连接可以是通过一些接口，设备或单元的间接耦合或通信连接，可以是电性的、机械的或其它形式的。

上述作为分离部件说明的单元可以是、或也可以不是物理上分开的，作为单元显示的部件可以是、或也可以不是物理单元，即可以位于一个地方，也可以分布到多个网络单元上；可以根据实际的需要选择其中的部分或全部单元来实现本实施例方案的目的。

另外，在本发明各实施例中的各功能单元可以全部集成在一个处理模块中，也可以是各单元分别单独作为一个单元，也可以两个或两个以上单元集成在一个单元中；上述集成的单元既可以采用硬件的形式实现，也可以采用硬件加软件功能单元的形式实现。

本领域普通技术人员可以理解：实现上述方法实施例的全部或部分步骤可以通过程序指令相关的硬件来完成，前述的程序可以存储于一计算机可读取存储介质中，该程序在执行时，执行包括上述方法实施例的步骤；而前述的存储介质包括：移动存储设备、只读存储器(ROM，Read-Only Memory)、随机存取存储器(RAM，Random Access Memory)、磁碟或者光盘等各种可以存储程序代码的介质。

以上所述，仅为本发明的具体实施方式，但本发明的保护范围并不局限于此，任何熟悉本技术领域的技术人员在本发明揭露的技术范围内，可轻易想到变化或替换，都应涵盖在本发明的保护范围之内。因此，本发明的保护范围应以所述权利要求的保护范围为准。

Claims (15)

1.一种控制方法，应用于第一设备，其特征在于，所述第一设备具有至少两个天线，每一天线都连接有独立的射频模块，所述方法包括：

所述第一设备通过所述至少两个天线接收第二设备发送的第一射频信号；

通过对所述第一射频信号的相关数据进行分析，确定所述第一设备与所述第二设备的相对位置信息；

基于所述相对位置信息控制所述第一设备对所述第二设备实施跟随，保持所述第一设备与所述第二设备之间的预设相对位置关系。

2.如权利要求1所述的方法，其特征在于，所述通过对所述第一射频信号的相关数据进行分析，确定所述第二设备与所述第一设备的相对位置信息，包括：

通过第一射频信号到达所述至少两个天线的相位差和/或时间差，确定所述第二设备与所述第一设备的相对角度值；和/或

获取所述第一设备通过所述至少两个天线中的任一天线与所述第二设备通讯过程中，与所述第一射频信号相关的三次通讯数据；根据所述三次通讯数据得到与所述第一设备以及所述第二设备相关的四个时间差，并根据所述四个时间差，计算所述第一设备与所述第二设备的相对距离值。

3.如权利要求1所述的方法，其特征在于，所述至少两个天线至少满足下述条件：

垂直线极化天线；

主极化与交叉极化方向轴比大于或等于第一预设值；

两天线之间的距离小于通讯波长的半波长。

4.如权利要求3所述的方法，其特征在于，所述两天线之间的距离小于通讯波长的半波长，包括：

所述两天线之间的距离d大于0.7×λ/2，且所述d小于0.95×λ/2，其中，所述λ为通讯波长，所述d为两天线之间的距离。

5.如权利要求1所述的方法，其特征在于，所述基于所述相对位置信息控制所述第一设备对所述第二设备实施跟随，保持所述第一设备与所述第二设备之间的预设相对位置关系，包括：

基于所述相对位置信息判断所述第一设备与所述第二设备的相对位置是否满足预设相对位置关系；

如果不满足所述预设相对位置关系，控制所述第一设备调整当前运动状态，并基于调整后的运动状态对所述第二设备实施跟随，使所述第一设备与所述第二设备的相对位置满足预设相对位置关系；

如果满足所述预设相对位置关系，控制所述第一设备保持当前运动状态，基于当前运动状态对所述第二设备实施跟随，保持所述第一设备与所述第二设备之间的预设相对位置关系。

6.如权利要求5所述的方法，其特征在于，所述如果不满足所述预设相对位置关系，控制所述第一设备调整当前运动状态，并基于调整后的运动状态对所述第二设备实施跟随，使所述第一设备与所述第二设备的相对位置满足预设相对位置关系，包括：

所述相对位置为相对距离，所述相对位置关系为预设距离范围时，如果相对距离值不位于预设距离范围，则控制第一设备调整运行速度，并根据调整后的速度对所述第二设备实施跟随，直至相对距离值位于所述预设距离范围；

所述相对位置为相对角度，所述相对位置关系为预设角度范围时，如果相对角度值不位于预设角度范围，则控制第二设备旋转直至所述第一设备与所述第二设备的相对角度值位于所述预设角度范围。

7.如权利要求1所述的方法，其特征在于，所述第一射频信号为超宽带UWB信号、或无线保真WIFI信号、或蓝牙信号。

8.一种跟踪控制方法，应用于第二设备，其特征在于，所述第二设备具有天线，所述天线连接有射频模块，所述第二设备能通过所述射频模块与第一设备进行通讯，所述方法包括：

在所述第二设备处于第一运动状态的过程中，

所述第二设备通过所述天线向第一设备发射第一射频信号，供所述第一设备基于所述第一射频信号的相关数据确定所述第一设备与所述第二设备的相对位置信息，所述第一设备基于所述相对位置信息对所述第二设备实施跟随，保持所述第一设备与所述第二设备之间的预设相对位置关系。

9.如权利要求8所述的方法，其中，所述天线至少满足下述条件：

圆极化天线；

主极化方向与交叉极化方向轴比小于第二预设值；

所述天线的方向图上凹陷处增益值小于第三阈值，且所述天线的辐射方向保持一致。

10.如权利要求8所述的方法，其特征在于，所述第一射频信号为超宽带UWB信号、或无线保真WIFI信号、或蓝牙信号。

11.一种第一设备，其特征在于，所述第一设备包括：

至少两个射频模块，每个射频模块都连接有独立的天线；

第一处理器，用于通过所述至少两个天线接收第二设备发送的第一射频信号；通过对所述第一射频信号的相关数据进行分析，确定所述第一设备与所述第二设备的相对位置信息；基于所述相对位置信息控制所述第一设备对所述第二设备实施跟随，保持所述第一设备与所述第二设备之间的预设相对位置关系。

12.如权利要求11所述的第一设备，其特征在于，所述至少两个天线至少满足下述条件：

垂直线极化天线；

主极化与交叉极化方向轴比大于或等于第一预设值；

两天线之间的距离小于通讯波长的半波长。

13.一种第二设备，其特征在于，所述第二设备包括：

射频模块，

与所述射频模块连接的天线，

第二处理器，用于在所述第二设备处于第一运动状态的过程中，通过所述天线向第一设备发射第一射频信号，供所述第一设备基于所述第一射频信号的相关数据确定所述第一设备与所述第二设备的相对位置信息，所述第一设备基于所述相对位置信息对所述第二设备实施跟随，保持所述第一设备与所述第二设备之间的预设相对位置关系。

14.如权利要求13所述的第二设备，其中，所述天线至少满足下述条件：

圆极化天线；

主极化方向与交叉极化方向轴比小于第二预设值；

所述天线的方向图上凹陷处增益值小于第三阈值，且所述天线的辐射方向保持一致。

15.一种控制系统，其特征在于，所述控制系统包括：

第二设备，用于向第一设备发送第一射频信号；

第一设备，具有至少两个天线，用于通过所述至少两个天线接收第二设备发送的第一射频信号；通过对所述第一射频信号的相关数据进行分析，确定所述第一设备与所述第二设备的相对位置信息；基于所述相对位置信息控制所述第一设备对所述第二设备实施跟随，保持所述第一设备与所述第二设备之间的预设相对位置关系。