一种基于视觉显著性的机器人动态跟踪方法及系统与流程

文档序号:15738559发布日期:2018-10-23 21:54阅读:231来源:国知局

本发明属于机器人视觉检测领域,具体涉及一种基于视觉显著性的机器人动态跟踪方法及系统。



背景技术:

目前,公知的机器人动态物体检测与跟踪技术有背景差、光流、栅格等方法,但这些方法在机器人的应用中存在许多缺陷,比如要求静态的摄像机或者其检测与跟踪常常针对观测的所有动态物体,但是在机器人的一些应用中并非所有的动态物体都有必要进行跟踪。而采用基于视觉显著性的方法则有利于解决这类问题。视觉显著性的方法是模仿人类视觉显著性的机制,即最显著的特征(与众不同特征)常常吸引人的注意,这种方法常常通过计算某个位置的显著性值来代表注意的对象,因此非常适用于机器人利用其配备的摄像头检测和跟踪周围附近的动态物体。另外现有的跟踪系统的实现采用通用计算机系统且体积较大,嵌入应用受到限制。



技术实现要素:

本发明的目的在于针对现有技术的缺陷,提供一种基于视觉显著性的机器人动态跟踪方法及系统,采用基于视觉显著性的视觉检测方法,结合数字信号处理(DSP)系统,可实现移动机器人对动态物体更高效更精确的检测与跟踪。

本发明的技术方案如下:

一种基于视觉显著性的机器人动态跟踪方法,包括如下步骤:

S1、移动机器人按照预设的路径运动,利用两个摄像头对周围环境进行摄取而得到两路视频信息;所述两个摄像头安装于所述移动机器人上;

S2、所述移动机器人将所述两路视频信息传输到数字信号处理系统;

S3、所述数字信号处理系统中的数字信号处理器对所述两路视频信息进行特征提取,使用立体匹配算法将提取出的特征点进行演算,得到视觉特征点,并将所述视觉特征点储存至数据缓存单元;

S4、所述数字信号处理器使用Multi-RANSAC算法对所述视觉特征点的速度和运动方向进行参数估计,根据估计得到的所述视觉特征点的速度和运动方向对所述视觉特征点进行预处理;所述预处理用于消除所述视觉特征点中的静态视觉特征点;

S5、所述数字信号处理器对预处理后的剩余所述视觉特征点进行显著度计算并分割出目标动态物体信息;

S6、所述数字信号处理器根据所述目标动态物体信息对所述移动机器人发出指令;所述指令用于控制所述移动机器人对目标动态物体进行追踪。

进一步的,所述步骤S4的具体步骤为:

S41、所述数字信号处理器使用Multi-RANSAC算法对所述视觉特征点的速度进行参数估计;采用公式(1)得到所述视觉特征点运动方向:

其中分别为所述视觉特征点的速度在x、y轴方向上的速度分量;

S42、所述数字信号处理器利用公式(2)对所述视觉特征点进行预处理,消除静态视觉特征点,方程如下:

其中vR、θR为所述移动机器人速度和运动方向;为所述视觉特征点的速度和方向平均值;δ1和δ2分别为速度和方向阀值;所述静态视觉特征点为符合公式(2)的所述特征点。

进一步的,所述步骤S3中,所述立体匹配算法为动态规划算法。

进一步的,所述步骤S5的具体步骤为:

S51、所述数字信号处理器对预处理后的所述视觉特征点进行显著性计算;

S52、所述数字信号处理器按照预设的显著值阈值选择显著值符合阈值的所述视觉特征点,采用均值漂移(Mean-Shift)算法分割出目标动态物体信息。

进一步的,所述步骤S51中所述数字信号处理器对预处理后的所述视觉特征点进行显著性计算的计算公式如下:

其中kp为归一化系数,r为所述移动机器人与所述视觉特征点距离;rx、ry为r在x、y轴方向上的分量;为第i个所述视觉特征点的估计速度在x、y轴方向上的分量;vRx、vRy为所述移动机器人速度在在x、y轴方向上的分量。

一种基于视觉显著性的机器人动态跟踪系统,包括移动机器人和数字信号处理系统;所述移动机器人包括:

通讯模块,用于与所述数字信号处理系统建立连接并传输数据及指令;

机器人控制单元,用于控制机器人的移动;

马达驱动器,用于按照机器人控制单元的指令驱动移动机器人移动;

两个摄像头,对周围环境进行摄取而得到视频信息;

所述数字信号处理系统为嵌入式系统,包括:

通讯模块,用于与所述移动机器人建立连接并传输数据及指令;

数字信号处理器,用于对所述视频信息进行特征提取,使用立体匹配算法对提取出的特征点进行立体匹配得到视觉特征点,使用Multi-RANSAC算法对所述视觉特征点的速度和运动方向进行参数估计,根据估计得到的所述视觉特征点的速度和运动方向对所述视觉特征点进行消除掉静态视觉特征点的预处理;对预处理后的所述视觉特征点进行显著度计算并分割出目标动态物体信息;根据所述目标动态物体信息生成发出指令;所述指令用于控制所述机器人控制单元控制所述马达驱动器,使所述移动机器人对目标动态物体进行追踪;

数据缓冲单元,用于储存所述视觉特征点。

进一步的,,所述数字信号处理器采用Multi-RANSAC(Multi-Random Sample Consensus)算法对所述视觉特征点的进行速度参数估计;

采用公式(1)得到所述视觉特征点运动方向:

其中分别为所述视觉特征点速度在x、y轴方向上的速度分量。

进一步的,所述数字信号处理器利用公式(2)对所述视觉特征点进行预处理,消除静态视觉特征点,方程如下:

其中vR、θR为所述移动机器人速度和运动方向;为所述视觉特征点特征点的速度和方向平均值;δ1和δ2分别为速度和方向阀值。

进一步的,所述数字信号处理器对预处理后的视觉特征点进行显著性计算的计算公式如下:

其中kp为归一化系数,r为所述移动机器人与所述视觉特征点的距离;rx、ry为r在x、y轴方向上的分量;为第i个视觉特征点的速度在x、y轴方向上的分量;vRx、vRy为所述移动机器人速度在在x、y轴方向上的分量。

进一步的,所述数字信号处理器按照预设的显著值阈值选择显著值大于阈值的所述视觉特征点,采用均值漂移(Mean-Shift)算法分割出目标动态物体信息。

与现有技术相比,本发明的有益技术效果如下:

本发明提供了一种基于视觉显著性的机器人动态跟踪方法及系统,采用基于视觉显著性的视觉检测方法,结合嵌入式DSP系统,实现移动机器人对动态物体更高效更精确的检测与跟踪,同时由于系统尺寸较小且易嵌入其它系统,增加了其使用的多样性及简便性。

附图说明

图1是本发明实施例1的一种基于视觉显著性的机器人动态跟踪方法的流程示意图。

图2是本发明实施例2的一种基于视觉显著性的机器人动态跟踪系统的结构示意图。

具体实施方式

为了充分地了解本发明的目的、特征和效果,以下将结合附图对本发明的几种优选的实施方式进行说明。

实施例1

如图1所示,本实施例1公开了一种基于视觉显著性的机器人动态跟踪方法,包括如下步骤:

S1、移动机器人按照预设的路径运动,利用两个摄像头对周围环境进行摄取而得到两路视频信息;两个摄像头安装于移动机器人上;

S2、移动机器人将两路视频信息传输到数字信号处理系统;

S3、数字信号处理系统中的数字信号处理器对两路视频信息进行特征提取,使用立体匹配算法将提取出的特征点进行演算,得到视觉特征点,并将视觉特征点储存至数据缓存单元;

具体的,步骤S3的立体匹配算法为动态规划算法。

S4、数字信号处理器使用Multi-RANSAC算法对视觉特征点的速度和运动方向进行参数估计,根据估计得到的视觉特征点的速度和运动方向对视觉特征点进行预处理;预处理用于消除视觉特征点中的静态视觉特征点;

具体的,步骤S4的具体步骤为:

S41、数字信号处理器使用Multi-RANSAC算法对视觉特征点的速度进行参数估计;采用公式(1)得到视觉特征点运动方向:

其中分别为视觉特征点的速度在x、y轴方向上的速度分量;

S42、数字信号处理器利用公式(2)对视觉特征点进行预处理,消除静态视觉特征点,方程如下:

其中vR、θR为移动机器人速度和运动方向;为视觉特征点的速度和方向平均值;δ1和δ2分别为速度和方向阀值;静态视觉特征点为符合公式(2)的特征点。

S5、数字信号处理器对预处理后的剩余视觉特征点进行显著度计算并分割出目标动态物体信息;

具体的,步骤S5的具体步骤为:

S51、数字信号处理器对预处理后的视觉特征点进行显著性计算;

S52、数字信号处理器按照预设的显著值阈值选择显著值符合阈值的视觉特征点,采用均值漂移(Mean-Shift)算法分割出目标动态物体信息。

具体的,步骤S51中数字信号处理器对预处理后的视觉特征点进行显著性计算的计算公式如下:

其中kp为归一化系数,r为移动机器人与视觉特征点距离;rx、ry为r在x、y轴方向上的分量;为第i个视觉特征点的估计速度在x、y轴方向上的分量;vRx、vRy为移动机器人速度在在x、y轴方向上的分量。

S6、数字信号处理器根据目标动态物体信息对移动机器人发出指令;指令用于控制移动机器人对目标动态物体进行追踪。

实施例2

如图2所示,本实施例公开了一种基于视觉显著性的机器人动态跟踪系统,其包括移动机器人和数字信号处理系统;移动机器人包括:

通讯模块1,用于与数字信号处理系统建立连接并传输数据及指令;

机器人控制单元2,用于控制机器人的移动;

马达驱动器3,用于按照机器人控制单元的指令驱动移动机器人移动;

两个摄像头4,对周围环境进行摄取而得到视频信息;

所述数字信号处理系统为嵌入式系统,包括:

通讯模块5,用于与移动机器人建立连接并传输数据及指令;

数字信号处理器6,用于对视频信息进行特征提取,使用立体匹配算法对提取出的特征点进行立体匹配得到视觉特征点,使用Multi-RANSAC算法对视觉特征点的速度和运动方向进行参数估计,根据估计得到的视觉特征点的速度和运动方向对视觉特征点进行消除掉静态视觉特征点的预处理;对预处理后的视觉特征点进行显著度计算并分割出目标动态物体信息;根据目标动态物体信息生成发出指令;指令用于控制机器人控制单元控制马达驱动器,使移动机器人对目标动态物体进行追踪;

数据缓冲单元,用于储存视觉特征点。

具体的,,数字信号处理器6采用Multi-RANSAC(Multi-Random Sample Consensus)算法对视觉特征点的进行速度参数估计;

采用公式(1)得到视觉特征点运动方向:

其中分别为视觉特征点速度在x、y轴方向上的速度分量。

具体的,数字信号处理器6利用公式(2)对视觉特征点进行预处理,消除静态视觉特征点,方程如下:

其中vR、θR为移动机器人速度和运动方向;为视觉特征点特征点的速度和方向平均值;δ1和δ2分别为速度和方向阀值。

具体的,数字信号处理器6对预处理后的视觉特征点进行显著性计算的计算公式如下:

其中kp为归一化系数,r为移动机器人与视觉特征点的距离;rx、ry为r在x、y轴方向上的分量;为第i个视觉特征点的速度在x、y轴方向上的分量;vRx、vRy为移动机器人速度在在x、y轴方向上的分量。

具体的,数字信号处理器6按照预设的显著值阈值选择显著值大于阈值的视觉特征点,采用均值漂移(Mean-Shift)算法分割出目标动态物体信息。

通过本发明提供的一种基于视觉显著性的机器人动态跟踪方法及系统,采用基于视觉显著性的视觉检测方法,结合嵌入式DSP系统,可实现移动机器人对动态物体更高效更精确的检测与跟踪,同时由于系统尺寸较小且易嵌入其它系统,增加了其使用的多样性及简便性。

以上详细描述了本发明的较佳具体实施例,应当理解,本领域的普通技术人员无需创造性劳动就可以根据本发明的构思作出诸多修改和变化。因此,凡本技术领域中技术人员依本发明构思在现有技术基础上通过逻辑分析、推理或者根据有限的实验可以得到的技术方案,均应该在由本权利要求书所确定的保护范围之中。

当前第1页1 2 3 
网友询问留言 已有0条留言
  • 还没有人留言评论。精彩留言会获得点赞!
1