一种桌面集群机器人的主动共享投影面感知系统及方法技术方案

本发明专利技术公开了一种桌面集群机器人的主动共享投影面感知系统及方法。包括CMOS视觉传感器模块、RGB射灯模块、微型处理单元、MicroSD卡存储模块、2.4g无线通信模块和电源模块。该系统基于视觉传感技术，机器人个体首先要向顶层投影面发射RGB射灯标示，并利用视觉传感器捕捉顶部图像信息，识别出图像信息上所有的标示的位置和所指向的方向，计算出邻居相对与自身的相对位置和相对航向，并存储至存储器中。本发明专利技术仅需要机器人搭载廉价摄像头模块和激光发射器，便可主动共享自身的状态信息以及获取周围邻居的运动状态信息，有助于提高集群算法向机器集群的可迁移性。

【技术实现步骤摘要】
一种桌面集群机器人的主动共享投影面感知系统及方法
本专利技术属于机器人
，具体涉及一种环境感知系统及方法。
技术介绍
机器人技术是综合了计算机、控制论、机构学、信息和传感技术、人工智能、仿生学等多学科而形成的高新技术，特别是多机器人协作成为提高解决复杂任务效率的有效途径。传统的中心控制方式对所有机器人行为进行统一规划，当协作机器人规模较大时，中心控制方法的容错能力不足，难以对突发因素做出及时响应。集群机器人研究的快速发展为上述困难的解决提供了可行方案。集群机器人旨在通过个体间简单的交互规则涌现出复杂的集群行为，使多机器人系统具备高效完成复杂任务的能力。如何通过局部、简单的相互作用，使包含大量简单机器人的系统涌现出复杂、宏观的集群行为，是学者关注的重点，目前国际上经典的集群算法框架有Vicsek、Couzin以及社会力模型等。这些集群模型框架都要求个体具备全局感知的能力，综合周围邻居个体的运动状态信息完成自身的运动决策。随着对群体机器人自组织运动控制算法研究的深入，采用集群机器人验证集群算法称为工程化应用前必不可少的一部分，为完成集群算法验证实验，必须使机器人具备全局感知的能力。集群机器人系统要求每一个机器人系统简单、成本低，因此集群机器人无法安装GPS这样高成本、大功率的定位设备，采用伪分布式的全局感知成为重要突破口。
技术实现思路
为了克服现有技术的不足，本专利技术提供了一种桌面集群机器人的主动共享投影面感知系统及方法。包括CMOS视觉传感器模块、RGB射灯模块、微型处理单元、MicroSD卡存储模块、2.4g无线通信模块和电源模块。该系统基于视觉传感技术，机器人个体首先要向顶层投影面发射RGB射灯标示，并利用视觉传感器捕捉顶部图像信息，识别出图像信息上所有的标示的位置和所指向的方向，计算出邻居相对与自身的相对位置和相对航向，并存储至存储器中。本专利技术仅需要机器人搭载廉价摄像头模块和激光发射器，便可主动共享自身的状态信息以及获取周围邻居的运动状态信息，有助于提高集群算法向机器集群的可迁移性。本专利技术解决其技术问题所采用的技术方案如下：一种桌面集群机器人的主动共享投影面感知系统，该系统设置在机器人顶部，包括CMOS视觉传感器模块、RGB射灯模块、微型处理单元、MicroSD卡存储模块、2.4g无线通信模块和电源模块；所述RGB射灯模块上设置标示透板，RGB射灯射出的光线通过标示透板后在上顶层投影板形成一个标示，标示为高底比大于1的等腰三角形，在等腰三角形内部设置一圆，圆心为三角形形心，圆的半径小于三角形内切圆半径；不同机器人的RGB射灯射出的光线颜色不完全相同；每个机器人在上顶层投影板形成一个标示；所述CMOS视觉传感器模块负责获取上顶层投影板上由所有机器人形成的标示组成的顶部图像，并将顶部图像传送给微型处理单元；所述微型处理单元的输入为CMOS视觉传感器模块获取的顶部图像，根据顶部图像信息计算出与周围邻居机器人的相对距离及相对航向；微型处理单元控制RGB射灯模块发射光线到上顶层投影板；微型处理单元与Micro-SD卡存储模块双向通信，控制Micro-SD卡存储模块存取过程数据；微型处理单元与通信模块双向通信，控制通信模块将微型处理单元计算出的周围邻居机器人的状态信息发送给桌面集群机器人系统的其他终端；所述电源模块包括3.3V电源输出和5.0V电源输出，所述3.3V电源为微型处理单元、2.4g无线通信模块以及RGB射灯模块供电；所述5.0V电源输出为MicroSD卡存储模块和CMOS视觉传感器模块供电。一种应用于桌面集群机器人的主动共享投影面感知系统的标示识别方法，包括如下步骤：步骤1：将CMOS视觉传感器模块获取的顶部图像进行灰度化处理，生成灰度图像，对灰度图像进行高斯滤波形成灰度直方图，根据灰度直方图设定阈值，对灰度图像做二值化处理；步骤2：采用opencv对步骤1得到的二值化图像进行处理，得到顶部图像中所有标示里的圆心坐标；步骤3：根据步骤2中找到的圆心坐标，在每个圆半径的A倍范围内搜索图像，采用opencv，找到等腰三角形三条边的三个交点的坐标，以三条边的斜率确定出等腰三角形顶点坐标；步骤4：以每个标示内的圆心坐标作为相对应的机器人位置坐标。一种应用于桌面集群机器人的主动共享投影面感知系统的机器人相对距离计算方法如下：假设任一机器人位置坐标为(x1,y1)，邻居机器人的位置坐标为(x2,y2)，以欧拉距离l表示任一机器人与邻居机器人的相对距离，计算公式如下：一种应用于桌面集群机器人的主动共享投影面感知系统的机器人相对航向计算方法如下：假设任一机器人位置坐标为(x1,y1)，对应标示的等腰三角形的顶点坐标为(x3,y3)；邻居机器人的位置坐标为(x2,y2)，对应标示的等腰三角形的顶点坐标为(x4,y4)，则任一机器人与邻居机器人的相对航向计算如下：任一机器人的单位航向向量可表示为：其邻居机器人的单位航向向量可表示为：可得相对航向θ为θ＝sign(p1p4-p3p2)·acos(p1p3+p2p4)。优选地，所述CMOS视觉传感器模块通过DCMI接口将顶部图像传送给微型处理单元。优选地，所述Micro-SD卡存储模块存入的数据为csv形式，Micro-SD卡存储模块与微型处理单元采用SPI接口进行通信。优选地，所述周围邻居机器人的状态信息包括但不限于位置和航向信息。优选地，所述高底比大于1的等腰三角形的高底比为3:2。本专利技术提出的一种桌面集群机器人的主动共享投影面感知系统，仅需要机器人搭载廉价摄像头模块和激光发射器，便可主动共享自身的状态信息以及获取周围邻居的运动状态信息，本专利技术系统和方法有助于提高集群算法向机器集群的可迁移性。附图说明图1为本专利技术的系统结构图。图2为本专利技术的系统应用示意图。图3为本专利技术的RGB射灯模块形成的标示示意图。图4为本专利技术机器人相对航向计算方法示意图。其中：1-标示；2-上顶层投影板；3-地面；4-RGB射灯模块；5-标示内的圆；6-航向定位线。具体实施方式下面结合附图和实施例对本专利技术进一步说明。针对桌面集群机器人无法搭载高功率、高成本定位传感器、不易获取全局感知信息的瓶颈问题，本专利技术设计了一种面向桌面集群机器人的主动共享投影面环境感知系统及方法。主动共享投影面的环境感知方法是基于视觉传感技术，机器人个体首先要向顶层投影面发射RGB射灯标示，并利用视觉传感器捕捉顶部图像信息，识别出图像信息上所有的标示的位置和所指向的方向，计算出邻居相对与自身的相对位置和相对航向，并存储至存储器中。本专利技术提供一种桌面集群机器人的主动共享投影面感知系统，该系统设置在机器人顶部，包括CMOS视觉传感器模块、RGB射灯模块、微型处理单元、MicroSD卡存储模块、2.4g无线通信模块和电源模块；所本文档来自技高网...

【技术保护点】
1.一种桌面集群机器人的主动共享投影面感知系统，其特征在于，该系统设置在机器人顶部，包括CMOS视觉传感器模块、RGB射灯模块、微型处理单元、MicroSD卡存储模块、2.4g无线通信模块和电源模块；/n所述RGB射灯模块上设置标示透板，RGB射灯射出的光线通过标示透板后在上顶层投影板形成一个标示，标示为高底比大于1的等腰三角形，在等腰三角形内部设置一圆，圆心为三角形形心，圆的半径小于三角形内切圆半径；不同机器人的RGB射灯射出的光线颜色不完全相同；每个机器人在上顶层投影板形成一个标示；/n所述CMOS视觉传感器模块负责获取上顶层投影板上由所有机器人形成的标示组成的顶部图像，并将顶部图像传送给微型处理单元；/n所述微型处理单元的输入为CMOS视觉传感器模块获取的顶部图像，根据顶部图像信息计算出与周围邻居机器人的相对距离及相对航向；微型处理单元控制RGB射灯模块发射光线到上顶层投影板；微型处理单元与Micro-SD卡存储模块双向通信，控制Micro-SD卡存储模块存取过程数据；微型处理单元与通信模块双向通信，控制通信模块将微型处理单元计算出的周围邻居机器人的状态信息发送给桌面集群机器人系统的其他终端；/n所述电源模块包括3.3V电源输出和5.0V电源输出，所述3.3V电源为微型处理单元、2.4g无线通信模块以及RGB射灯模块供电；所述5.0V电源输出为MicroSD卡存储模块和CMOS视觉传感器模块供电。/n...

【技术特征摘要】
1.一种桌面集群机器人的主动共享投影面感知系统，其特征在于，该系统设置在机器人顶部，包括CMOS视觉传感器模块、RGB射灯模块、微型处理单元、MicroSD卡存储模块、2.4g无线通信模块和电源模块；
所述RGB射灯模块上设置标示透板，RGB射灯射出的光线通过标示透板后在上顶层投影板形成一个标示，标示为高底比大于1的等腰三角形，在等腰三角形内部设置一圆，圆心为三角形形心，圆的半径小于三角形内切圆半径；不同机器人的RGB射灯射出的光线颜色不完全相同；每个机器人在上顶层投影板形成一个标示；
所述CMOS视觉传感器模块负责获取上顶层投影板上由所有机器人形成的标示组成的顶部图像，并将顶部图像传送给微型处理单元；
所述微型处理单元的输入为CMOS视觉传感器模块获取的顶部图像，根据顶部图像信息计算出与周围邻居机器人的相对距离及相对航向；微型处理单元控制RGB射灯模块发射光线到上顶层投影板；微型处理单元与Micro-SD卡存储模块双向通信，控制Micro-SD卡存储模块存取过程数据；微型处理单元与通信模块双向通信，控制通信模块将微型处理单元计算出的周围邻居机器人的状态信息发送给桌面集群机器人系统的其他终端；
所述电源模块包括3.3V电源输出和5.0V电源输出，所述3.3V电源为微型处理单元、2.4g无线通信模块以及RGB射灯模块供电；所述5.0V电源输出为MicroSD卡存储模块和CMOS视觉传感器模块供电。


2.一种应用于桌面集群机器人的主动共享投影面感知系统的标示识别方法，其特征在于，包括如下步骤：
步骤1：将CMOS视觉传感器模块获取的顶部图像进行灰度化处理，生成灰度图像，对灰度图像进行高斯滤波形成灰度直方图，根据灰度直方图设定阈值，对灰度图像做二值化处理；
步骤2：采用opencv对步骤1得到的二值化图像进行处理，得到顶部图像中所有标示里的圆心坐标；
步骤3：根据步骤2中找到的圆心坐标，在每个圆半径的A倍范围内搜索图像，采用opencv，找到等腰...

【专利技术属性】
技术研发人员：彭星光，郑志成，周永建，宋保维，潘光，李乐，张福斌，高剑，张立川，
申请(专利权)人：西北工业大学，
类型：发明
国别省市：陕西;61