一种基于单目摄像头测距的机器人跟随系统及方法与流程

本发明涉及机器人技术领域，特别是涉及一种基于单目摄像头测距的机器人跟随方法及系统。

背景技术：

目前，机器人跟随一般使用红外传感器或超声波传感器，通过红外传感器或超声波传感器测量目标物距离变化进行跟随。但他们各自都存在着明显的缺陷，红外传感器由于光线的影响只能用于室内，而超声波传感器由于障碍物反射的影响只能用于室外，且他们都无法辨别特定的目标物，无法实现特定目标物的跟随。超声波雷达跟超声波传感器存在同样的问题，虽然激光雷达克服了红外传感器容易受光线影响的的弱点能够用于室外测距，但也无法辨别特定的目标物，无法实现特定目标物的跟随。

深度相机的产生克服了传统传感器的不足，既能辨别特定目标物，又能测距，但成本较高，使用比较复杂，一般用于三维成像领域，很少用于目标物跟随。

技术实现要素：

基于此，本发明提供一种可以让机器人跟随目标物行进的方法更简单，更易用，成本更低的基于单目摄像头测距的机器人跟随系统及方法。

一种基于单目摄像头测距的机器人跟随系统，包括摄像头、图像处理器、中央控制器、存储器及运动机构，所述中央控制器连接所述图像处理器、存储器及运动机构；所述摄像头用于实时捕获包括标记物的且具有设定总像素值的图像；所述图像处理器用于对图像进行处理并识别出所述标记物占所述图像中的像素值；所述存储器预先存储有前进阈值像素及停止阈值像素；所述中央控制器在所述标记物占所述图像中的像素值大于或等于所述前进阈值像素时控制所述运动机构前进，或者在所述标记物占所述图像中的像素值小于所述停止阈值像素时控制所述运动机构停止前进。

一种基于单目摄像头测距的机器人跟随方法，包括以下步骤：

实时捕获包括标记物的且具有设定总像素值的图像；

对图像进行处理并识别出所述标记物占所述图像中的像素值；

预先存储前进阈值像素及停止阈值像素；

在所述标记物占所述图像中的像素值大于或等于所述前进阈值像素时控制所述运动机构前进，或者在所述标记物占所述图像中的像素值小于所述停止阈值像素时控制所述运动机构停止前进。

本发明机器人利用单目相机实现目标物跟随的方法及系统，从来获知标记物的距离大小，如果计算出来的像素值大于前进阈值，机器人就开始前进，直到所获得的图像中标记物的像素值小于停止阈值再停止；如果计算出来的像素值小于停止阈值，机器人就停止前进，直到所获得的图像中标记物的像素值大于前进阈值再前进，系统简单、成本低且具有很好的跟随性能。

附图说明

图1为本发明提供的基于单目摄像头测距的机器人跟随系统的原理示意图。

图2为图1所示的基于单目摄像头测距的机器人跟随系统的摄像头获取的图像的示意图。

图3为本发明提供的基于单目摄像头测距的机器人跟随方法的流程示意图。

具体实施方式

下面将结合本发明实施例中的附图，对本发明实施例中的技术方案进行清楚、完整地描述，显然，所描述的实施例仅仅是本发明一部分实施例，而不是全部的实施例。基于本发明中的实施例，本领域普通技术人士在没有做出创造性劳动前提下所获得的所有其他实施例，都属于本发明保护的范围。

请参阅图1，本发明提供的一种基于单目摄像头测距的机器人跟随系统100，包括摄像头、图像处理器、中央控制器、存储器及运动机构，所述中央控制器连接所述图像处理器、存储器及运动机构；所述摄像头用于实时捕获包括标记物的且具有设定总像素值的图像；所述图像处理器用于对图像进行处理并识别出所述标记物占所述图像中的像素值；所述存储器存储有预先设定的前进阈值像素及停止阈值像素；所述中央控制器在所述标记物占所述图像中的像素值大于或等于所述前进阈值时控制所述运动机构前进，或者在所述标记物占所述图像中的像素值小于所述停止阈值时控制所述运动机构停止前进。

请参阅图2，为了便于理解本发明，在一个举例中，所述摄像头实时捕获包括标记物101的且具有设定总像素值的图像10，其中图像10为矩形且总设定像素为2048×1536像素(长×宽)。所述图像处理器对图像10进行处理并识别出所述标记物101占所述图像10中的像素值，其中图像处理器可以通过基于神经网络、基于小波矩、基于分开特征等现有的方法对标识物101进行识别。例如标记物101为人体，由于人体为非规则的矩形，因此图像处理器识别到的标记物以总像素计算，而非以长×宽的方式计算，对应的所述存储器存储的前进阈值像素为300000像素以及停止阈值像素为200000像素。例如，所述图像处理器识别出所述标记物101占所述图像101中的像素值为310000像素，此时，所述中央控制器比较出所述标记物101占所述图像101中的像素值为310000大于所述前进阈值像素310000，因此，控制所述运动机构前进以对标记物101进行跟随。可以理解的是，若所述图像处理器识别出所述标记物101占所述图像101中的像素值为190000，此时，所述中央控制器比较出所述标记物101占所述图像101中的像素值为190000h于所述停止阈值像素200000，因此，控制所述运动机构停止运动以停止对标记物101进行跟随。在其他实施方式中，所述前进阈值像素和停止阈值像素也可是占所述图像的总设定像素的比例，例如，前进阈值像素为占所述图像的总设像素的10％，停止阈值像素为占所述图像的总设定像素的5％。以上举例的数值仅为了便于理解本发明，并不是对本发明的限定，在实际设计中，可以根据需求设置图像的总设定像素、前进阈值像素和停止阈值像素。

在本实施方式中，所述存储器还存储有所述标记物占所述图像中的像素值与标记物相对于摄像头的距离关系；在所述标记物占所述图像中的像素值大于或等于所述前进阈值像素时，所述标记物相对于摄像头的距离小于或等于第一距离；所述标记物占所述图像中的像素值小于所述停止阈值像素时，所述标记物相对于摄像头的距离大于第二距离。以图2的图像10为例，所述标记物101占所述图像101中的像素值为310000像素时，例如在存储器中存储的与标记物相对于摄像头的距离为4米，所述第一距离例如可以为5米，所述第二距离可以为8米。

在本实施方式中，所述摄像头采用rgb单目相机。所述前进阈值像素大于所述停止阈值像素，机器人在前进阈值像素与停止阈值像素之间为隔离距离，在间隔距离范围上机器人可以为待机状态，等待控制指令，可以减少扰动。

本发明基于单目摄像头测距的机器人跟随系统100结构更简单，更易用，成本更低，由于前进阈值像素和停止阈值像素不同，中间有段隔离距离，避免了机器人扰动。

如图3所示，为本发明提供的一种基于单目摄像头测距的机器人跟随方法，包括以下步骤：

s1：实时捕获包括标记物的且具有设定总像素值的图像；

s2：对图像进行处理并识别出所述标记物占所述图像中的像素值；

s3：预先存储前进阈值像素及停止阈值像素；

s4：在所述标记物占所述图像中的像素值大于或等于所述前进阈值时控制所述运动机构前进，或者在所述标记物占所述图像中的像素值小于所述前进阈值时控制所述运动机构停止前进。

步骤s2“对图像进行处理并识别出所述标记物占所述图像中的像素值”还进一步包括：存储所述标记物占所述图像中的像素值与标记物相对于摄像头的距离关系；在所述标记物占所述图像中的像素值大于或等于所述前进阈值时，所述标记物相对于摄像头的距离小于或等于第一距离；所述标记物占所述图像中的像素值小于所述停止阈值时，所述标记物相对于摄像头的距离大于第二距离。

在步骤s3“预先存储前进阈值像素及停止阈值像素”之后及步骤s4之前进一步包括以下步骤：将识别出的所述标记物占所述图像中的像素值与前进阈值像素及停止阈值像素进行比对。

在本实施方式中，所述前进阈值像素的值大于所述停止阈值像素的值。

以上所述实施例仅表达了本发明的一种或几种实施方式，其描述较为具体和详细，但并不能因此而理解为对发明专利范围的限制。应当指出的是，对于本领域的普通技术人员来说，在不脱离本发明构思的前提下，还可以做出若干变形和改进，这些都属于本发明的保护范围。因此，本发明专利的保护范围应以所附权利要求为准。