[发明专利]一种机器人集群协同定位系统和方法

权利要求书

1.一种机器人集群协同定位系统，其特征在于，所述机器人集群由多个机器人组成，所述机器人的组成结构包括：

视觉采集器，用于采集协同定位的视觉定位图像；

芬斯勒自动运算模块，用于将所述视觉定位图像转换成对应的芬斯勒距离偏差；

三栖滚动牵引转轮，用于根据所述芬斯勒距离偏差调整机器人的相对位置。

2.根据权利要求1所述的一种机器人集群协同定位系统，其特征在于，所述视觉采集器包括以下至少一种波长的摄像机：红外波段摄像机、红光波段摄像机、绿光波段摄像机、蓝光波段摄像机和紫外光波段摄像机。

3.根据权利要求1所述的一种机器人集群协同定位系统，其特征在于，所述三栖滚动牵引转轮包括直流无刷电机组、摆线滚翼桨、护栏地滚轮和调速齿轮箱；

所述直流无刷电机用于分别带动所述摆线滚翼桨、所述护栏地滚轮和所述调速齿轮箱运动，以根据所述芬斯勒距离偏差调整机器人的相对位置，其中，

所述摆线滚翼浆用于当所述机器人处于空中运动状态或水面运动状态时，为机器人提供空气或水面的驱动力；

所述护栏地滚轮用于当所述机器人处于地面运动状态时，提供滚动的摩擦力；

所述调速齿轮箱用于根据所述机器人不同的运动状态，调节所述机器人的运转速度和运动方向。

4.根据权利要求2所述的一种机器人集群协同定位系统，其特征在于，所述芬斯勒自动运算模块包括输入综合器和几何计算器；

所述输入综合器用于根据所述视觉定位图像获取视觉距离；

所述几何计算器用于根据芬斯勒转换方式将所述视觉距离转换为芬斯勒距离。

5.根据权利要求4所述的一种机器人集群协同定位系统，其特征在于，所述输入综合器包括距离采集模块和距离去噪模块，所述距离采集模块用于根据距离获取方法将所述摄像机采集的视觉定位图像转换为粗略视觉距离，所述距离去噪模块对所述视觉距离进行平均加权和滤波，得到精确视觉距离。

6.根据权利要求4所述的一种机器人集群协同定位系统，其特征在于，所述芬斯勒转换方式具体为：

A_E＝(xy)/2

df＝A_E-A_F+S

其中，x表示当前机器人与相邻机器人在东西方向上的欧几里得距离，称为左右偏距，y表示当前机器人与相邻机器人在南北方向上的欧几里得距离，称为前后偏距，A_E表示第一芬斯勒参数，A_F表示第二芬斯勒距离参数，df表示芬斯勒距离偏差，S是最小安全距离。

7.根据权利要求6所述的一种机器人集群协同定位系统，其特征在于，所述根据所述芬斯勒距离偏差调整机器人的相对位置具体包括以下调整方式：远离、靠近和保持不变；

当df＞S时，机器人靠近与其距离最接近的机器人；

当df<S时，机器人远离与其距离最接近的机器人；

当df＝S时，机器人的位置保持不变。

8.一种机器人集群协同定位方法，其特征在于，应用于权利要求1至7任一项所述的一种机器人集群协同定位系统，包括步骤：

判断当前工作状态，机器人根据当前工作状态打开对应波长的视觉采集器，获取用于视觉定位的视觉图像，所述当前工作状态包括：无紧急状况，地面紧急情况、空中紧急情况和水面紧急情况；

所述芬斯勒自动运算模块采用芬斯勒转换方式，将所述视觉采集器获取的所述视觉图像转换成对应的芬斯勒距离；

所述机器人根据所述芬斯勒距离偏差通过所述三栖滚动牵引转轮调整自己与相邻机器人之间的距离。

9.根据权利要求8所述的一种机器人集群协同定位方法，其特征在于，还包括步骤：

利用图像匹配算法匹配目标图像，得出目标类型；

根据所述目标类型采取相应的处理措施。