跟随目标的方法、装置、机器人及计算机可读存储介质转让专利

申请号 : CN202110658055.1

文献号 : CN113253735B

文献日 :

基本信息:

PDF:

法律信息:

相似专利:

发明人 : 崔锦王虹彭志张宇哲黄玲杜珊珊张可欣乔光辉

申请人 : 同方威视技术股份有限公司

摘要 :

本公开提供了一种跟随目标的方法、装置、机器人及非瞬时性计算机可读存储介质,涉及机器人技术领域。其中的跟随目标的方法包括:通过激光雷达获取各个备选目标在激光雷达坐标系下的坐标;通过辅助定位装置获取目标在激光雷达坐标系下的辅助坐标,各个备选目标包括目标;根据各个备选目标在激光雷达坐标系下的坐标、目标在激光雷达坐标系下的辅助坐标,确定目标在激光雷达坐标系下的坐标;根据目标在激光雷达坐标系下的坐标,跟随目标移动。本公开能够使机器人自动、准确地跟随目标移动。

权利要求 :

1.一种跟随目标的方法,包括:通过激光雷达获取各个备选目标在激光雷达坐标系下的坐标;

通过辅助定位装置获取目标在激光雷达坐标系下的辅助坐标,各个备选目标包括所述目标;

根据各个备选目标在激光雷达坐标系下的坐标、所述目标在激光雷达坐标系下的辅助坐标,确定所述目标在激光雷达坐标系下的坐标;

根据所述目标在激光雷达坐标系下的坐标,跟随所述目标移动;

其中,所述通过激光雷达获取各个备选目标在激光雷达坐标系下的坐标包括:通过激光雷达获取第一扫描帧中各个备选目标在激光雷达坐标系下的第一坐标、第二扫描帧中各个备选目标在激光雷达坐标系下的第二坐标;

所述通过辅助定位装置获取目标在激光雷达坐标系下的辅助坐标包括:通过辅助定位装置获取第一扫描帧所在扫描时刻下所述目标在激光雷达坐标系下的第一辅助坐标、第二扫描帧所在扫描时刻下所述目标在激光雷达坐标系下的第二辅助坐标;

所述根据各个备选目标在激光雷达坐标系下的坐标、所述目标在激光雷达坐标系下的辅助坐标,确定所述目标在激光雷达坐标系下的坐标包括:根据所述各个备选目标在激光雷达坐标系下的第一坐标和所述第一辅助坐标,确定所述目标在激光雷达坐标系下的第一坐标;根据所述各个备选目标在激光雷达坐标系下的第二坐标和所述第二辅助坐标,确定所述目标在激光雷达坐标系下的第二坐标;

其中,所述通过激光雷达获取第一扫描帧中各个备选目标在激光雷达坐标系下的第一坐标包括:

根据第一扫描帧中各个备选目标在激光雷达坐标系下的坐标,对激光雷达通过第一扫描帧生成的激光点云进行聚类,获得多个激光点簇;

对各个激光点簇分别进行曲线拟合;

为长度在预设长度范围内的各条拟合曲线,分别确定最小外接旋转矩形;

将各个最小外接旋转矩形的中心点在激光雷达坐标系下的坐标,作为第一扫描帧中各个备选目标在激光雷达坐标系下的第一坐标;

其中,所述根据所述各个备选目标在激光雷达坐标系下的第一坐标和所述第一辅助坐标,确定所述目标在激光雷达坐标系下的第一坐标包括:确定各个最小外接旋转矩形的宽的方向;

筛选出所述宽的方向与机器人前进方向的夹角小于第一阈值的最小外接旋转矩形;

从筛选出的各个最小外接旋转矩形的中心点中,选择与激光雷达坐标系原点距离最近的中心点;

在所述距离最近的中心点与所述第一辅助坐标的距离小于第二阈值的情况下,将所述距离最近的中心点作为所述目标在激光雷达坐标系下的第一坐标;

其中,所述根据所述各个备选目标在激光雷达坐标系下的第二坐标和所述第二辅助坐标,确定所述目标在激光雷达坐标系下的第二坐标包括:将所述目标在激光雷达坐标系下的第一坐标输入卡尔曼滤波器,获得所述目标在激光雷达坐标系下的预测坐标;

从第二扫描帧中各个备选目标在激光雷达坐标系下的第二坐标中,选择与所述预测坐标距离最近的第二坐标;

在所述距离最近的第二坐标与所述第二辅助坐标的距离小于第二阈值的情况下,将所述距离最近的第二坐标作为所述目标在激光雷达坐标系下的第二坐标。

2.根据权利要求1所述的方法,其中,所述根据所述目标在激光雷达坐标系下的坐标,跟随所述目标移动包括:

根据所述目标在激光雷达坐标系下的第二坐标与所述目标在激光雷达坐标系下的第一坐标之间的坐标差,确定移动方向和移动距离;

根据第一扫描帧与第二扫描帧之间的扫描间隔以及所述坐标差,确定移动速率。

3.根据权利要求2所述的方法,其中,所述通过激光雷达获取第一扫描帧中各个备选目标在激光雷达坐标系下的第一坐标还包括:对激光雷达通过第一扫描帧生成的激光点云进行聚类之前,删除所述激光点云中第t个扫描点,其中,第t个扫描点的坐标与第(t‑1)个扫描点之间的距离大于第三阈值,且第t个扫描点的坐标与第(t+1)个扫描点之间的距离大于第三阈值,t为大于1的整数。

4.根据权利要求1所述的方法,其中,所述通过激光雷达获取第二扫描帧中各个备选目标在激光雷达坐标系下的第二坐标包括:根据第二扫描帧中各个备选目标在激光雷达坐标系下的坐标,对激光雷达通过第二扫描帧生成的激光点云进行聚类,获得多个激光点簇;

对各个激光点簇分别进行曲线拟合;

为长度在预设长度范围内的各条拟合曲线,分别确定最小外接旋转矩形;

将各个最小外接旋转矩形的中心点在激光雷达坐标系下的坐标,作为第二扫描帧中各个备选目标在激光雷达坐标系下的第二坐标。

5.根据权利要求4所述的方法,其中,所述通过激光雷达获取第二扫描帧中各个备选目标在激光雷达坐标系下的第二坐标还包括:对激光雷达通过第二扫描帧生成的激光点云进行聚类之前,删除所述激光点云中第t个扫描点,其中,第t个扫描点的坐标与第(t‑1)个扫描点之间的距离大于第三阈值,且第t个扫描点的坐标与第(t+1)个扫描点之间的距离大于第三阈值,t为大于1的整数。

6.根据权利要求1至5任一项所述的方法,其中,所述辅助定位装置包括超宽带定位装置或视觉相机。

7. 一种跟随目标的装置,包括:存储器;以及

耦接至所述存储器的处理器,所述处理器被配置为基于存储在所述存储器中的指令,执行如权利要求1至6中任一项所述的跟随目标的方法。

8.一种机器人,包括激光雷达、辅助定位装置以及如权利要求7所述的跟随目标的装置。

9.一种非瞬时性计算机可读存储介质,其中,所述非瞬时性计算机可读存储介质存储有计算机指令,所述指令被处理器执行时实现如权利要求1至6中任一项所述的跟随目标的方法。

说明书 :

跟随目标的方法、装置、机器人及计算机可读存储介质

技术领域

[0001] 本公开涉及机器人技术领域,特别涉及一种跟随目标的方法、装置、机器人及非瞬时性计算机可读存储介质。

背景技术

[0002] 机器人在搬运货物等方面有显著的作业优势。
[0003] 为了使机器人能够与工人协同作业,通常采用两种方式。一种方式是通过人工遥控,使机器人移动至指定位置;另一种方式包括对机器人进行试教以及为机器人建立地图。

发明内容

[0004] 本公开解决的一个技术问题是,如何使机器人自动、准确地跟随目标移动。
[0005] 根据本公开的第一个方面,提供了一种跟随目标的方法,包括:通过激光雷达获取各个备选目标在激光雷达坐标系下的坐标;通过辅助定位装置获取目标在激光雷达坐标系
下的辅助坐标,各个备选目标包括目标;根据各个备选目标在激光雷达坐标系下的坐标、目
标在激光雷达坐标系下的辅助坐标,确定目标在激光雷达坐标系下的坐标;根据目标在激
光雷达坐标系下的坐标,跟随目标移动。
[0006] 在一些实施例中,通过激光雷达获取各个备选目标在激光雷达坐标系下的坐标包括:通过激光雷达获取第一扫描帧中各个备选目标在激光雷达坐标系下的第一坐标、第二
扫描帧中各个备选目标在激光雷达坐标系下的第二坐标;通过辅助定位装置获取目标在激
光雷达坐标系下的辅助坐标包括:通过辅助定位装置获取第一扫描帧所在扫描时刻下目标
在激光雷达坐标系下的第一辅助坐标、第二扫描帧所在扫描时刻下目标在激光雷达坐标系
下的第二辅助坐标;根据各个备选目标在激光雷达坐标系下的坐标、目标在激光雷达坐标
系下的辅助坐标,确定目标在激光雷达坐标系下的坐标包括:根据第一坐标和第一辅助坐
标,确定目标在激光雷达坐标系下的第一坐标;根据第二坐标和第二辅助坐标,确定目标在
激光雷达坐标系下的第二坐标。
[0007] 在一些实施例中,根据目标在激光雷达坐标系下的坐标,跟随目标移动包括:根据目标在激光雷达坐标系下的第二坐标与目标在激光雷达坐标系下的第一坐标之间的坐标
差,确定移动方向和移动距离;根据第一扫描帧与第二扫描帧之间的扫描间隔以及坐标差,
确定移动速率。
[0008] 在一些实施例中,通过激光雷达获取第一扫描帧中各个备选目标在激光雷达坐标系下的第一坐标包括:根据激光雷达坐标系下的坐标,对激光雷达通过第一扫描帧生成的
激光点云进行聚类,获得多个激光点簇;对各个激光点簇分别进行曲线拟合;为长度在预设
长度范围内的各条拟合曲线,分别确定最小外接旋转矩形;将各个最小外接旋转矩形的中
心点在激光雷达坐标系下的坐标,作为第一扫描帧中各个备选目标在激光雷达坐标系下的
第一坐标。
[0009] 在一些实施例中,根据第一坐标和第一辅助坐标,确定目标在激光雷达坐标系下的第一坐标包括:确定各个最小外接旋转矩形的宽的方向;筛选出宽的方向与机器人前进
方向的夹角小于第一阈值的最小外接旋转矩形;从筛选出的各个最小外接旋转矩形的中心
点中,选择与激光雷达坐标系原点距离最近的中心点;在距离最近的中心点与第一辅助坐
标的距离小于第二阈值的情况下,将距离最近的中心点作为目标在激光雷达坐标系下的第
一坐标。
[0010] 在一些实施例中,通过激光雷达获取第一扫描帧中各个备选目标在激光雷达坐标系下的第一坐标还包括:对激光雷达通过第一扫描帧生成的激光点云进行聚类之前,删除
激光点云中第t个扫描点,其中,第t个扫描点的坐标与第(t‑1) 个扫描点之间的距离大于
第三阈值,且第t个扫描点的坐标与第(t+1)个扫描点之间的距离大于第三阈值,t为大于1
的整数。
[0011] 在一些实施例中,通过激光雷达获取第二扫描帧中各个备选目标在激光雷达坐标系下的第二坐标包括:根据激光雷达坐标系下的坐标,对激光雷达通过第二扫描帧生成的
激光点云进行聚类,获得多个激光点簇;对各个激光点簇分别进行曲线拟合;为长度在预设
长度范围内的各条拟合曲线,分别确定最小外接旋转矩形;将各个最小外接旋转矩形的中
心点在激光雷达坐标系下的坐标,作为第二扫描帧中各个备选目标在激光雷达坐标系下的
第二坐标。
[0012] 在一些实施例中,根据第二坐标和第二辅助坐标,确定目标在激光雷达坐标系下的第二坐标包括:将目标在激光雷达坐标系下的第一坐标输入卡尔曼滤波器,获得目标在
激光雷达坐标系下的预测坐标;从第二扫描帧中各个备选目标在激光雷达坐标系下的第二
坐标中,选择与预测坐标距离最近的第二坐标;在距离最近的第二坐标与第二辅助坐标的
距离小于第二阈值的情况下,将距离最近的第二坐标作为目标在激光雷达坐标系下的第二
坐标。
[0013] 在一些实施例中,通过激光雷达获取第二扫描帧中各个备选目标在激光雷达坐标系下的第二坐标还包括:对激光雷达通过第二扫描帧生成的激光点云进行聚类之前,删除
激光点云中第t个扫描点,其中,第t个扫描点的坐标与第(t‑1) 个扫描点之间的距离大于
第三阈值,且第t个扫描点的坐标与第(t+1)个扫描点之间的距离大于第三阈值,t为大于1
的整数。
[0014] 在一些实施例中,辅助定位装置包括超宽带定位装置或视觉相机。
[0015] 根据本公开的第二个方面,提供了一种跟随目标的装置,包括:存储器;以及耦接至存储器的处理器,处理器被配置为基于存储在存储器中的指令,执行前述的跟随目标的
方法。
[0016] 根据本公开的第三个方面,提供了一种机器人,包括激光雷达、辅助定位装置以及前述的跟随目标的装置。
[0017] 根据本公开的第四个方面,提供了一种非瞬时性计算机可读存储介质,其中,非瞬时性计算机可读存储介质存储有计算机指令,指令被处理器执行时实现前述的跟随目标的
方法。
[0018] 本公开能够使机器人自动、准确地跟随目标移动。
[0019] 通过以下参照附图对本公开的示例性实施例的详细描述,本公开的其它特征及其优点将会变得清楚。

附图说明

[0020] 为了更清楚地说明本公开实施例或相关技术中的技术方案,下面将对实施例或相关技术描述中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图仅仅是本
公开的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动性的前提下,还可
以根据这些附图获得其他的附图。
[0021] 图1示出了本公开一些实施例的跟随目标的方法的流程示意图。
[0022] 图2示出了各个备选目标在激光雷达坐标系下的坐标的示意图。
[0023] 图3示出了本公开另一些实施例的跟随目标的方法的流程示意图。
[0024] 图4示出了多个激光点簇、各条拟合曲线以及各个最小外接旋转矩形的示意图。
[0025] 图5示出了本公开一些实施例的跟随目标的装置的结构示意图。
[0026] 图6示出了本公开一些实施例的机器人的结构示意图。

具体实施方式

[0027] 下面将结合本公开实施例中的附图,对本公开实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅仅是本公开一部分实施例,而不是全部的实施例。以下
对至少一个示例性实施例的描述实际上仅仅是说明性的,决不作为对本公开及其应用或使
用的任何限制。基于本公开中的实施例,本领域普通技术人员在没有作出创造性劳动前提
下所获得的所有其它实施例,都属于本公开保护的范围。
[0028] 经研究发现,通过人工遥控使机器人移动至指定位置的过程中,需要熟悉机器人遥控的专业工人进行操作,且操作过程中需要反复专业工人遥控机器人进行前后左右的移
动,不仅操作灵活性差还需要耗费较长的操作时间,因此操作体验较差。而对机器人进行试
教以及为机器人建立地图的方式需要提前指定机器人的移动路线,因此不能灵活更改移动
路线。由此可见,机器人与工人协同作业的传统方法中,无法实现机器人自动、准确地跟随
目标(例如工人)移动。
[0029] 有鉴于此,本公开提供了一种跟随目标的方法。首先结合图1描述本公开跟随目标的方法的一些实施例。
[0030] 图1示出了本公开一些实施例的跟随目标的方法的流程示意图。如图1所示,该方法包括步骤S101~步骤S104。
[0031] 在步骤S101中,通过激光雷达获取各个备选目标在激光雷达坐标系下的坐标。
[0032] 机器人通过配置激光雷达(例如单线激光雷达或多线激光雷达),能够获得激光点云数据。根据激光点云数据,能够获取各个备选目标在激光雷达坐标系下的坐标,这些备选
目标中包括机器人需要跟随的目标。图2示出了各个备选目标在激光雷达坐标系下的坐标
的示意图。如图2所示,激光雷达坐标系的y轴方向表示机器人的前进方向(也是激光雷达的
扫描主方向),激光雷达坐标系的x轴方向表示机器人的右方向。
[0033] 在步骤S102中,通过辅助定位装置获取目标在激光雷达坐标系下的辅助坐标。
[0034] 其中,辅助定位装置包括UWB(Ultra Wide Band,超宽带)定位装置或具有目标检测功能的视觉相机,其中,具有目标检测功能的视觉相机可以包括深度相机、双目相机等
等。
[0035] 在步骤S103中,根据各个备选目标在激光雷达坐标系下的坐标、目标在激光雷达坐标系下的辅助坐标,确定目标在激光雷达坐标系下的坐标。
[0036] 一种具体的实现方式是,从各个备选目标在激光雷达坐标系下的坐标中,选取与目标在激光雷达坐标系下的辅助坐标距离最近坐标,作为目标在激光雷达坐标系下的坐
标。
[0037] 在步骤S104中,根据目标在激光雷达坐标系下的坐标,跟随目标移动。
[0038] 获得目标在激光雷达坐标系下的坐标后,可以根据目标在激光雷达坐标系下的坐标,确定机器人的移动方向和移动距离,从而使机器人跟随目标移动。
[0039] 由于辅助定位装置提供的辅助坐标精确性较低,激光雷达提供的坐标精确性较高却难以准确识别目标。上述实施例中,根据激光雷达提供的坐标以及辅助定位装置提供的
辅助坐标,能够更加准确的确定目标在激光雷达坐标系下的坐标,从而使机器人根据目标
在激光雷达坐标系下的坐标自动、准确地跟随目标移动。因此无需人工遥控、对机器人进行
试教或为机器人建立地图,即可实现机器人自动化跟随工人进行协同作业。同时,上述实施
例对于光线、遮挡、目标移动速度、目标形变等因素都具有较好的鲁棒性,因此具有广泛的
适用性。
[0040] 下面结合图3描述本公开跟随目标的方法的另一些实施例。
[0041] 图3示出了本公开另一些实施例的跟随目标的方法的流程示意图。如图3所示,这些实施例包括步骤S301~步骤S308。其中,步骤S301 步骤 S303为通过第一扫描帧获取目
~
标在激光雷达坐标系下坐标的过程,步骤S304 步骤S306为通过第二扫描帧获取目标在激
~
光雷达坐标系下坐标的过程,步骤S307 步骤S308为根据两个扫描帧中目标在激光雷达坐
~
标系下的坐标跟随目标移动的过程。
[0042] 在步骤S301中,通过激光雷达获取第一扫描帧中各个备选目标在激光雷达坐标系下的第一坐标。步骤S301的具体实现过程可以包括步骤S3011 步骤S3014。
~
[0043] (S3011)根据激光雷达坐标系下的坐标,对激光雷达通过第一扫描帧生成的激光点云进行聚类,获得多个激光点簇。聚类算法具体可以采用DBSCAN(Density‑Based 
Spatial Clustering of Applications with Noise,具有噪声的基于密度的空间聚类应
用)、最近邻聚类算法等等。聚类得到的每个激光点簇表示一个备选目标。
[0044] (S3012)对各个激光点簇分别进行曲线拟合。
[0045] (S3013)为长度在预设长度范围内的各条拟合曲线,分别确定最小外接旋转矩形。例如,选取长度与工人腰宽相近似的拟合曲线,确定最小外接旋转矩形。
[0046] (S3014)将各个最小外接旋转矩形的中心点在激光雷达坐标系下的坐标,作为第一扫描帧中各个备选目标在激光雷达坐标系下的第一坐标。
[0047] 多个激光点簇、各条拟合曲线以及各个最小外接旋转矩形如图4所示。
[0048] 在步骤S302中,通过辅助定位装置获取第一扫描帧所在扫描时刻下目标在激光雷达坐标系下的第一辅助坐标。
[0049] 本领域技术人员应理解,通过辅助定位装置获取到的位置信息后,需要映射至激光雷达坐标系,获得目标在激光雷达坐标系下的第一辅助坐标。第一辅助坐标既可以为具
体的坐标点,也可以为具有辅助中心坐标的辅助坐标区域。
[0050] 在步骤S303中,根据第一坐标和第一辅助坐标,确定目标在激光雷达坐标系下的第一坐标。步骤S303的具体实现过程可以包括步骤S3031 步骤S3034。
~
[0051] (S3031)确定各个最小外接旋转矩形的宽的方向。本领域技术人员能够理解,最小外接旋转矩形的宽的方向表示目标的前后方向。
[0052] (S3032)筛选出宽的方向与机器人前进方向的夹角小于第一阈值的最小外接旋转矩形,从而筛选出与背对机器人中央的目标。
[0053] (S3033)从筛选出的各个最小外接旋转矩形的中心点中,选择与激光雷达坐标系原点距离最近的中心点,从而选择出距离机器人距离最近的目标。
[0054] (S3034)在距离最近的中心点与第一辅助坐标的距离小于第二阈值的情况下,将距离最近的中心点作为目标在激光雷达坐标系下的第一坐标。
[0055] 在距离最近的中心点与第一辅助坐标的距离不小于第二阈值的情况下,重复执行步骤S301 步骤S303。如果重复执行步骤S301 步骤S303的次数达到预设的次数上限仍不能
~ ~
确定目标在激光雷达坐标系下的第一坐标,则发出报警以表示无法识别出要跟随的目标。
[0056] 在步骤S304中,通过激光雷达获取第二扫描帧中各个备选目标在激光雷达坐标系下的第二坐标。步骤S304的具体实现过程可以包括步骤S3041 步骤S3044,与S301的实现过
~
程相类似。
[0057] (S3041)根据激光雷达坐标系下的坐标,对激光雷达通过第二扫描帧生成的激光点云进行聚类,获得多个激光点簇。
[0058] (S3042)对各个激光点簇分别进行曲线拟合。
[0059] (S3043)为长度在预设长度范围内的各条拟合曲线,分别确定最小外接旋转矩形。
[0060] (S3044)将各个最小外接旋转矩形的中心点在激光雷达坐标系下的坐标,作为第二扫描帧中各个备选目标在激光雷达坐标系下的第二坐标。
[0061] 在步骤S305中,通过辅助定位装置获取第二扫描帧所在扫描时刻下目标在激光雷达坐标系下的第二辅助坐标。步骤S305与S302的实现过程相类似。
[0062] 在步骤S306中,根据第二坐标和第二辅助坐标,确定目标在激光雷达坐标系下的第二坐标。步骤S306的具体实现过程还可以包括步骤S3061 步骤S3063。
~
[0063] (S3061)将目标在激光雷达坐标系下的第一坐标输入卡尔曼滤波器,获得目标在激光雷达坐标系下的预测坐标。
[0064] (S3062)从第二扫描帧中各个备选目标在激光雷达坐标系下的第二坐标中,选择与预测坐标距离最近的第二坐标。
[0065] (S3063)在距离最近的第二坐标与第二辅助坐标的距离小于第二阈值的情况下,将距离最近的第二坐标作为目标在激光雷达坐标系下的第二坐标。
[0066] 在距离最近的中心点与第二辅助坐标的距离不小于第二阈值的情况下,重复执行步骤S304 步骤S306。如果重复执行步骤S304 步骤S306的次数达到预设的次数上限仍不能
~ ~
确定目标在激光雷达坐标系下的第一坐标,则发出报警以表示丢失要跟随的目标。
[0067] 在步骤S307中,根据目标在激光雷达坐标系下的第二坐标与目标在激光雷达坐标系下的第一坐标之间的坐标差,确定移动方向和移动距离。
[0068] 例如,该坐标差唯一对应一个向量。将该向量的方向作为机器人的移动方向,将该向量的长度与预设的比例相乘作为机器人的移动距离。
[0069] 在步骤S308中,根据第一扫描帧与第二扫描帧之间的扫描间隔以及坐标差,确定移动速率。
[0070] 例如,可以将上述向量的长度与上述扫描间隔的比值,作为机器人的移动速率。
[0071] 在一些实施例中,步骤S301的具体实现过程还可以包括步骤S3010。
[0072] (S3010)对激光雷达通过第一扫描帧生成的激光点云进行聚类之前,删除激光点云中第t个扫描点,其中,第t个扫描点的坐标与第(t‑1) 个扫描点之间的距离大于第三阈
值,且第t个扫描点的坐标与第(t+1) 个扫描点之间的距离大于第三阈值,t为大于1的整
数。
[0073] 在一些实施例中,步骤S304的具体实现过程还可以包括步骤S3040。
[0074] (S3040)对激光雷达通过第二扫描帧生成的激光点云进行聚类之前,删除激光点云中第t个扫描点,其中,第t个扫描点的坐标与第(t‑1) 个扫描点之间的距离大于第三阈
值,且第t个扫描点的坐标与第(t+1) 个扫描点之间的距离大于第三阈值,t为大于1的整
数。
[0075] 步骤S3010以及步骤S3040的作用是除去激光点云中的噪声点,以防止因反射等原因形成干扰,从而进一步提升跟随目标的准确性。
[0076] 上述实施例中,根据激光雷达提供的坐标以及辅助定位装置提供的辅助坐标,能够更加准确的确定目标在激光雷达坐标系下的坐标,从而使机器人根据目标在激光雷达坐
标系下的坐标自动、准确地跟随目标移动。因此无需人工遥控、对机器人进行试教或为机器
人建立地图,即可实现机器人自动化跟随工人进行协同作业。同时,上述实施例对于光线、
遮挡、目标移动速度、目标形变等因素都具有较好的鲁棒性,因此具有广泛的适用性。
[0077] 下面结合图5描述本公开跟随目标的装置的一些实施例。
[0078] 图5示出了本公开一些实施例的跟随目标的装置的结构示意图。如图5所示,跟随目标的装置50包括:存储器510以及耦接至该存储器510的处理器520,处理器520被配置为
基于存储在存储器510中的指令,执行前述任意一些实施例中的跟随目标的方法。
[0079] 其中,存储器510例如可以包括系统存储器、固定非易失性存储介质等。系统存储器例如存储有操作系统、应用程序、引导装载程序(Boot Loader)以及其他程序等。
[0080] 跟随目标的装置50还可以包括输入输出接口530、网络接口540、存储接口550等。这些接口530、540、550以及存储器510和处理器520之间例如可以通过总线560连接。其中,
输入输出接口530为显示器、鼠标、键盘、触摸屏等输入输出设备提供连接接口。网络接口
540为各种联网设备提供连接接口。存储接口550为SD卡、U盘等外置存储设备提供连接接
口。
[0081] 下面结合图6描述本公开机器人的一些实施例。
[0082] 图6示出了本公开一些实施例的机器人的结构示意图。如图6所示,机器人60包括:激光雷达601、辅助定位装置602以及前述的跟随目标的装置50。
[0083] 本公开还包括一种非瞬时性计算机可读存储介质,其上存储有计算机指令,该指令被处理器执行时实现前述任意一些实施例中的跟随目标的方法。
[0084] 前述集成的单元如果以软件功能单元的形式实现并作为独立的产品销售或使用时,可以存储在一个计算机可读取存储介质中。基于这样的理解,本发明的技术方案本质上
或者说对现有技术做出贡献的部分或者该技术方案的全部或部分可以以软件产品的形式
体现出来,该计算机软件产品存储在一个存储介质中,包括若干指令用以使得一台计算机
设备(可为个人计算机、服务器或者网络设备等)执行本发明各个实施例所述方法的全部或
部分步骤。而前述的存储介质包括:U盘、只读存储器(ROM,Read‑Only Memory)、随机存取存
储器(RAM,Random Access Memory)、移动硬盘、磁碟或者光盘等各种可以存储程序代码的
介质。
[0085] 本公开是参照根据本公开实施例的方法、设备(系统)、和计算机程序产品的流程图和/或方框图来描述的。应理解可由计算机程序指令实现流程图和/或方框图中的每一流
程和/或方框、以及流程图和/或方框图中的流程和/或方框的结合。可提供这些计算机程序
指令到通用计算机、专用计算机、嵌入式处理机或其他可编程数据处理设备的处理器以产
生一个机器,使得通过计算机或其他可编程数据处理设备的处理器执行的指令产生用于实
现在流程图一个流程或多个流程和/或方框图一个方框或多个方框中指定的功能的装置。
[0086] 这些计算机程序指令也可存储在能引导计算机或其他可编程数据处理设备以特定方式工作的计算机可读存储器中,使得存储在该计算机可读存储器中的指令产生包括指
令装置的制造品,该指令装置实现在流程图一个流程或多个流程和/或方框图一个方框或
多个方框中指定的功能。
[0087] 这些计算机程序指令也可装载到计算机或其他可编程数据处理设备上,使得在计算机或其他可编程设备上执行一系列操作步骤以产生计算机实现的处理,从而在计算机或
其他可编程设备上执行的指令提供用于实现在流程图一个流程或多个流程和/或方框图一
个方框或多个方框中指定的功能的步骤。
[0088] 需要说明的是,本申请的说明书和权利要求书及上述附图中的术语“第一”、“第二”等是用于区别类似的对象,而不必用于描述特定的顺序或先后次序。应该理解这样使用
的数据在适当情况下可以互换,以便这里描述的本申请的实施例。此外,术语“包括”和“具
有”以及他们的任何变形,意图在于覆盖不排他的包含,例如,包含了一系列步骤或单元的
过程、方法、系统、产品或设备不必限于清楚地列出的那些步骤或单元,而是可包括没有清
楚地列出的或对于这些过程、方法、产品或设备固有的其它步骤或单元。
[0089] 还需要说明的是,术语“包括”、“包含”或者其任何其他变体意在涵盖非排他性的包含,从而使得包括一系列要素的过程、方法、商品或者设备不仅包括那些要素,而且还包
括没有明确列出的其他要素,或者是还包括为这种过程、方法、商品或者设备所固有的要
素。在没有更多限制的情况下,由语句“包括一个……”限定的要素,并不排除在包括要素的
过程、方法、商品或者设备中还存在另外的相同要素。
[0090] 以上所述仅为本公开的较佳实施例,并不用以限制本公开,凡在本公开的精神和原则之内,所作的任何修改、等同替换、改进等,均应包含在本公开的保护范围之内。