CN112947419A - 避障方法、装置及设备 - Google Patents

避障方法、装置及设备 Download PDF

Info

Publication number
CN112947419A
CN112947419A CN202110112386.5A CN202110112386A CN112947419A CN 112947419 A CN112947419 A CN 112947419A CN 202110112386 A CN202110112386 A CN 202110112386A CN 112947419 A CN112947419 A CN 112947419A
Authority
CN
China
Prior art keywords
obstacle
robot
obstacle avoidance
tracking target
static
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Granted
Application number
CN202110112386.5A
Other languages
English (en)
Other versions
CN112947419B (zh
Inventor
陈旭凤
王丽佳
李香服
温彬彬
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Dragon Totem Technology Hefei Co ltd
Shenzhen Dragon Totem Technology Achievement Transformation Co ltd
Original Assignee
Hebei College of Industry and Technology
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Hebei College of Industry and Technology filed Critical Hebei College of Industry and Technology
Priority to CN202110112386.5A priority Critical patent/CN112947419B/zh
Publication of CN112947419A publication Critical patent/CN112947419A/zh
Application granted granted Critical
Publication of CN112947419B publication Critical patent/CN112947419B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0231Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
    • G05D1/0238Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using obstacle or wall sensors
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0231Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
    • G05D1/0246Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using a video camera in combination with image processing means

Landscapes

  • Engineering & Computer Science (AREA)
  • Physics & Mathematics (AREA)
  • Electromagnetism (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Computer Vision & Pattern Recognition (AREA)
  • Multimedia (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
  • Image Analysis (AREA)

Abstract

本发明提供了一种避障方法、装置及设备,该方法包括:获取包含跟踪目标的场景图像,所述场景图像包括彩色图像和深度图像;根据所述场景图像,确定机器人和跟踪目标之间是否存在障碍物:若无障碍物,则控制移动机器人沿直线方向移动;若存在障碍物,则判断所述障碍物的类型,所述障碍物的类型包括静态障碍物和动态障碍物,根据障碍物的类型,选择不同的避障策略。本发明能够减少避障所需处理的数据量,降低机器人的能耗。

Description

避障方法、装置及设备
技术领域
本发明属于机器人技术领域,更具体地说,是涉及一种避障方法、装置及设备。
背景技术
现有技术中,在机器人对跟踪目标进行移动跟踪时,需要对障碍物进行避障。通常,机器人获取到跟踪目标所处的场景信息后,通过运行基于神经网络的避障算法程序对所处环境中可能存在的障碍物进行检测,并对检测结果做出避障行为。现有的基于神经网络的避障算法程序需要占用大量的计算资源,导致机器人能耗高。
发明内容
本发明的目的在于提供一种避障方法、装置及设备,以解决机器人能耗高的问题。
本发明实施例的第一方面,提供了一种避障方法,包括:
获取包含跟踪目标的场景图像;
根据所述场景图像,确定所述机器人和所述跟踪目标之间是否存在障碍物;
若是,则确定所述障碍物所属的障碍物类型和边界信息,其中,每种障碍物类型对应于一种预设避障策略;
根据所述边界信息和所述障碍物所属的障碍物类型所对应的预设避障策略,控制所述机器人移动。
本发明实施例的第二方面,提供了一种避障装置,包括:
采集模块,用于获取包含跟踪目标的场景图像;
处理模块,用于根据所述场景图像,确定机器人和所述跟踪目标之间是否存在障碍物;若是,则确定所述障碍物所属的障碍物类型和边界信息,其中,每种障碍物类型对应于一种预设避障策略;
所述处理模块,还用于根据所述边界信息和所述障碍物所属的障碍物类型所对应的预设避障策略,控制所述机器人移动。
本发明实施例的第三方面,提供了一种电子设备,包括存储器、处理器以及存储在所述存储器中并可在所述处理器上运行的计算机程序,所述处理器执行所述计算机程序时实现上述的避障方法的步骤。
本发明实施例的第四方面,提供了一种计算机可读存储介质,所述计算机可读存储介质存储有计算机程序,所述计算机程序被处理器执行时实现上述的避障方法的步骤。
本发明实施例的有益效果在于:本发明实施例通过获取包含跟踪目标的场景图像;根据场景图像,确定机器人和跟踪目标之间是否存在障碍物;若是,则确定障碍物所属的障碍物类型和边界信息,其中,每种障碍物类型对应于一种预设避障策略;根据边界信息和障碍物所属的障碍物类型所对应的预设避障策略,控制机器人移动。本发明实施例通过设置障碍物类型对应的预设避障策略,在识别到存在障碍物时,根据障碍物所属的类型对应的预设避障策略对机器人进行避障控制,能够减少避障所需处理的数据量,降低机器人的能耗。
附图说明
为了更清楚地说明本申请实施例中的技术方案,下面将对实施例或现有技术描述中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图仅仅是本发明的一些实施例,对于本领域技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图获得其它的附图。
图1为本申请一实施例提供的避障方法的流程示意图;
图2为本申请另一实施例提供的避障方法的流程示意图;
图3为本申请再一实施例提供的避障方法的流程示意图;
图4为本申请又一实施例提供的避障方法流程示意图;
图5为本申请又一实施例提供的避障方法流程示意图;
图6为本申请又一实施例提供的避障方法流程示意图;
图7为本申请一实施示例中的深度直方图的示意图;
图8为本申请一实施例提供的避障装置的结构框图;
图9为本申请一实施例提供的电子设备的示意框图。
具体实施方式
为了使本申请所要解决的技术问题、技术方案及有益效果更加明白,以下结合附图及实施例,对本发明进行进一步详细说明。应当理解,此处所描述的具体实施例仅仅用以解释本发明,并不用于限定本发明。
请参考图1,图1为本申请一实施例提供的避障方法的流程示意图,该方法包括:
S101:获取跟踪目标的场景图像。
在本实施例中,获取移动机器人与跟踪目标之间的场景图像。场景图像可以是彩色图像和/或深度图像,在此不做限定。
S102:根据场景图像,确定移动机器人和跟踪目标之间是否存在障碍物。
在本实施例中,可以通过图像处理方法或者卷积神经网络等方式识别场景图像,从而判断移动机器人和跟踪目标之间是否存在障碍物。
利用深度直方图来判断移动机器人和跟踪目标之间是否存在障碍物。深度直方图可根据获取到的深度图像,利用计算机程序直接获得。
S103:若是,则确定障碍物所属的障碍物类型和边界信息,其中,每种障碍物类型对应于一种预设避障策略。
在本实施例中,障碍物类型的个数和分类方式可以根据实际需求进行设定,在此不做限定。例如,障碍物类型可以分为两类:静态障碍物和动态障碍物;或者,障碍物也可以分为三类:静态障碍物、低速运动障碍物、高速运动障碍物。
边界信息可以是当前行驶平面中障碍物所在区域的边界轮廓信息,或者障碍物所在三维空间的边界轮廓信息等,在此不对边界信息进行限定。预设障碍策略可以根据障碍物类型的形状特点、运动特点等预先进行设定,在此不作限定。
如果存在障碍物,可以采用三帧差分法与金字塔LK流光法结合的方法,判断该障碍物的类型为静态障碍物还是动态障碍物。也可以利用雷达获取机器人的位置坐标及周围环境坐标信息,将当前坐标信息与坐标信息库进行比对,从而判断障碍物类型;或者结合雷达、场景图像等多种感测数据进行分析,以判断判断障碍物类型,在此不做限定。
S104:根据边界信息和障碍物所属的障碍物类型所对应的预设避障策略,控制机器人移动。
在本实施例中,根据障碍物所属的障碍物类型,机器人选择对应的预设避障策略进行避障。
本发明实施例通过获取包含跟踪目标的场景图像;根据场景图像,确定机器人和跟踪目标之间是否存在障碍物;若是,则确定障碍物所属的障碍物类型和边界信息,其中,每种障碍物类型对应于一种预设避障策略;根据边界信息和障碍物所属的障碍物类型所对应的预设避障策略,控制机器人移动,通过设置障碍物类型对应的预设避障策略,在识别到存在障碍物时,根据障碍物所属的类型对应的预设避障策略对机器人进行避障控制,能够减少避障所需处理的数据量,降低机器人的能耗。
图2为本申请另一实施例提供的避障方法的流程示意图。在上述实施例的基础上,障碍物类型包括动态障碍物和静态障碍物;动态障碍物对应于动态避障策略,静态障碍物对应于静态避障策略。根据边界信息和障碍物所属的障碍物类型所对应的预设避障策略,控制机器人移动,可以包括:
S201:在障碍物所属的障碍物类型为动态障碍物时,根据边界信息和动态避障策略控制机器人移动。
在本实施例中,当确定障碍物类型为动态障碍物时,机器人执行动态避障策略。动态避障策略可以采用机器人原地等待,待障碍物通过后继续跟踪目标的方法,也可以采用机器人获取动态障碍物的移动范围后,直接避开动态障碍物的移动范围,或者也可以采用机器人实时获取动态障碍物的移动位置,实时避障,在此不作限定。
S202:在障碍物所属的障碍物类型为静态障碍物时,根据边界信息和静态避障策略控制机器人移动。
在本实施例中,当确定障碍物类型为静态障碍物时,机器人执行静态避障策略。静态避障策略可以采用机器人直接绕开静态障碍物的方法,也可以采用机器人距离静态障碍物距离较远时保持直线跟踪,当机器人与静态障碍物之间的距离达到阈值后,机器人采取绕开静态障碍物的行为,在此不作限定。
本实施例通过将障碍物分为静态障碍物和动态障碍物两类,并相应设置静态避障策略和动态避障策略,能够以是否运动的特点对障碍物进行划分,以对机器人进行不同的避障控制,能够提高避障的精准性。
图3为本申请再一实施例提供的避障方法的流程示意图,在上述图2所示实施例的基础上,根据边界信息和动态避障策略控制机器人移动可以包括:
S301:根据向量场直方图和边界信息,确定机器人的目标运动方向。
在本实施例中,可以将移动机器人运动场景的环境信息表征成若干个二维栅格,每个二维栅格都有一个概率值用来表示该像素点存在障碍物的可能性大小,即可信度(Certainty Value,CV)。
(1)对当前视频图像进行二维栅格向量化,具体计算公式为:mi,j=(ci,j)2(a-bdi,j);其中a、b是正常数,Ci,j为视频图像中栅格(i,j)的CV值,di,j是该栅格到机器人中心点的距离。移动机器人下一时刻的运动方向由当前时刻与障碍物的相对位置决定:
Figure BDA0002919634530000071
其中(x0,y0)是当前时刻移动机器人中心点的绝对位置坐标,(xj,yj)是栅格的绝对位置。
(2)确定活动窗口分区:假设图像的分辨率为α,此时一共包括n个区间,其中
Figure BDA0002919634530000072
对于任意区间k,(k=0,1,2,...,n-1),有k=int(βi,j/α),障碍密度为:
Figure BDA0002919634530000073
各个分区计算得到的CV值大小不一,也就意味着图像中障碍物的标注较为离散,因此需要对上述算法进行平滑处理:
Figure BDA0002919634530000081
(3)确定移动机器人的运动方向θ。
在本实施例中,经上式(1-1)的计算得到环境图像每个分区中障碍物的概率密度,通过与预先设定的阈值τ做对比来确定区间是否可以供移动机器人行走。当障碍物的概率密度小于预先设定的阈值τ时,定义该区域为“安全区域”,当有连续多个区间都为“安全区域”时,定义它们为“宽谷”,否则称之为“窄道”。所述“宽谷”的最左边区间记为kl,最右边区间记为kr,那么此时移动机器人的移动方向为:
Figure BDA0002919634530000082
S302:控制机器人向目标方向移动。
在判断出障碍物类型为动态障碍物并得到该障碍物的位置与边缘信息的基础上,将移动机器人运动场景的环境信息表征成若干个若干二维栅格,其中所述每个二维栅格都用一个概率值(可信度CV)来表示该像素点存在障碍物的可能性大小,使用VFH算法进行移动机器人的动态障避障策略——栅格向量化、活动窗口分区、确定移动机器人的移动方向。
本实施例中,通过向量场直方图算法和障碍物的边界信息能够准确控制机器人避开动态的障碍物,提高避障的精准度。
图4为本申请另一实施例提供的避障方法的流程示意图,在上述图2或图3所示实施例的基础上,根据边界信息和静态避障策略控制机器人移动可以包括:
S401:根据边界信息和机器人的位置信息,确定静态障碍物与机器人之间的距离。
在本实施例中,可以利用雷达直接获取到障碍物与机器人之间的距离,也可以利用边界信息和机器人的位置信息确定障碍物与机器人之间的距离,在此不做限定。
S402:在距离大于或等于预设距离阈值时,控制机器人沿直线方向移动。
在本实施例中,静态障碍物与机器人之间的距离阈值可以人为地根据机器人体积或移动速度进行设定,在此不做限定。
S403:在距离小于预设距离阈值时,根据边界信息确定静态障碍物位于机器人的视场,在静态障碍物位于机器人的左视场或左中视场时,控制机器人右转;在静态障碍物位于机器人的右视场或右中视场时,控制机器人左转;在静态障碍物位于机器人的中间视场时,控制机器人左转或右转。
在本实施例中,对视场进行划分的方式和划分的范围可以根据实际需求确定,在此不做限定。例如,可以将视场从机器人运动前方的左侧向右侧依次划分为左视场、左中视场、中视场、右中视场、右视场,左视场或左中视场;也可以将机器人前方视场平均分为左、右视场,且只有当静态障碍物框图的垂直平分线与机器人前方视场垂直平分线重合时,确定静态障碍物位于机器人前方视场的中间视场,控制机器人左转或右转;当静态障碍物框图位于机器人前方视场的左视场或左中视场时,控制机器人右转;当静态障碍物框图位于机器人前方视场的右视场或右中视场时,控制机器人左转。
本实施例中,在机器人执行静态避障策略时,首先计算静态障碍物与机器人之间的距离,当静态障碍物与机器人之间的距离大于或等于预设距离阈值时,控制机器人沿直线方向移动。当静态障碍物与机器人之间的距离小于预设距离阈值时,根据静态障碍物框图在机器人前方视场所处的位置,控制机器人左转或右转,使得机器人与跟踪目标之间出现静态障碍物时,机器人能够及时根据静态障碍物与机器人之间的距离以及预设距离阈值做出相应的调整,从而在降低机器人避障的能耗的同时,提高避障的精准度。
图5为本申请另一实施例提供的避障方法的流程示意图,在上述任一实施例的基础上,场景图像包括多个视频帧,确定障碍物所属的障碍物类型可以包括:
S501:获取连续的三帧图像,并将三帧图像中每相邻的两帧图像做差分运算处理,以得到两帧帧差图像。
在本实施例中,将三帧图像中每相邻的两帧图像做差分运算,以得到两帧帧差图像具体过程可以包括:
(1)对机器人的视觉成像系统获取到的视频序列预处理、去噪;
(2)取视频序列的连续三帧图像Ii-1(x,y)、Ii(x,y)、Ii+1(x,y),对Ii-1(x,y)、Ii(x,y)做差分运算,得到帧差图像fi(x,y),对Ii(x,y)、Ii+1(x,y)做差分运算,得到帧差图像fi+1(x,y)。
S502:对两帧帧差图像进行二值化处理和逻辑与运算处理,以得到运动区域图像。
在本实施例中,对帧差图像fi(x,y)、fi+1(x,y)做二值化处理,并进行逻辑与运算处理,得到运动区域图像J(x,y)。
S503:根据金字塔LK光流法对运动区域图像处理,以确定障碍物是否属于动态障碍物。
在本实施例中,利用金字塔LK光流法确定障碍物是否属于动态障碍物具体过程包括:
(1)将J(x,y)建立金字塔模型JL,L=0,1,……,Lm。初始化金字塔最底层即Lm层的光流估计值
Figure BDA0002919634530000117
Lm层图像上特征点U的速度为:
Figure BDA0002919634530000111
(2)对图像JL求x、y的偏导数
Figure BDA0002919634530000112
求:
Figure BDA0002919634530000113
(3)初始化光流
Figure BDA0002919634530000114
Figure BDA0002919634530000115
计算:
Figure BDA0002919634530000116
(4)计算得到Lm层的光流值dL=G-1b,计算Lm-1层的光流gL-1=2(gL+dL),以此类推得到最后的光流值d=g0+d0
(5)图像P(x,y)的对应特征点为ν=u+d;
(6)得到运动目标图像P(x,y)。
S504:若否,则确定障碍物属于静态障碍物。
在本实施例中,若检测到存在其它运动物体的有效图像时,则确定障碍物类型为动态障碍物,否则确定障碍物类型为静态障碍物。
本实施例中,在已确定机器人和跟踪目标之间存在障碍物的基础上,采用三帧差分法与金字塔LK流光法结合的方法,判断该障碍物是否为动态障碍物,并且得到该动态障碍物的运动图像,以便于后期的避障,能够提高障碍物类型识别的准确度,并且减少了运算数据量,降低了功耗。
图6为本申请另一实施例提供的避障方法的流程示意图,在上述任一实施例的基础上,场景图像包括彩色图像和深度图像;根据所述场景图像,确定机器人和跟踪目标之间是否存在障碍物可以包括:
S601:通过贝叶斯分类器对彩色图像和深度图像中的跟踪目标进行识别,以得到跟踪目标在深度图像中的位置框。
在本实施例中,第t帧中目标位置记为A=(xt,yt,wt,ht),然后在目标位置附近提取一些正样本并且在远离目标位置提取一些负样本,分别在彩色图像和深度图像中计算其特性来更新贝叶斯分类器的参数。在接下来的t+1帧,获取位置A周围的样本,把样本数据放入更新后的贝叶斯分类器。分类器中得分最高的样本数据被认为是当前帧的目标位置(xt+1,yt+1,wt+1,ht+1)。
S602:对深度图像中的深度值进行归一化处理,其中,归一化处理后的深度图像中各像素点的深度值与各像素点所对应的对象到相机的距离呈负相关。
在本实施例中,对场景深度图进行预处理时,把深度值归一化到0-255之间,靠近机器人则深度值越大,远离机器人则深度值越小。因此,当发生遮挡时,遮挡物的深度值将大于目标的深度值。
S603:根据归一化处理后的深度图像,生成深度直方图,其中,深度直方图中跟踪目标所对应的像素点呈高斯分布。
在本实施例中,对于同一个目标,其融合后的高斯分布深度值是连续的:
Figure BDA0002919634530000131
所以在直方图中会有一个最大值的峰值,如图7中左图箭头a指向的位置所示,其中坐标轴横轴代表当前图像中跟踪目标的深度值,坐标轴纵轴代表某个深度值所对应的像素数量占整个图像像素数量的百分比。对于后续获得的每一帧,在得到跟踪目标的位置后,计算新一帧的深度直方图。
S604:若深度直方图中除跟踪目标所对应的像素点所对应的峰值之外,存在满足高斯分布均值和标准差的预设条件的峰值,则确定机器人和跟踪目标之间存在障碍物。
在本实施例中,如果出现了满足高斯分布均值和标准差特定条件的新的峰值,则认为发生了遮挡,即在移动机器人和跟踪目标之间存在障碍物,如图7中右图箭头b指向的位置所示,其中坐标轴横轴代表当前图像中跟踪目标的深度值,坐标轴纵轴代表某个深度值所对应的像素数量占整个图像像素数量的百分比。
预设条件可以为:|μ-largerdepthvalue|>2*σ (2-1)
其中μ代表高斯分布中的均值,σ代表是高斯分布中的标准差,largerdepthvalue代表“更大的深度值”,即表现为图7中右图箭头b指向的峰值,其深度值大于跟踪目标的深度值。若满足式(2-1),则表明图7中右图箭头b指向的峰值,与跟踪目标即箭头a指向的峰值之间是相互独立的,并非跟踪目标峰值的延伸值,而是确定存在的障碍物的峰值,可以避免误判。
S605:否则,确定机器人和跟踪目标之间不存在障碍物。
本实施例通过结合彩色图像和深度图像,而深度图像包含空间信息、深度图像编码等。将深度图像进行预处理后得到跟踪目标及障碍物的深度值信息,根据深度值信息将深度图像融合成深度直方图,利用跟踪目标与障碍物在深度直方图中高斯分布峰值的不同,可以直接确定机器人与障碍物之间是否存在障碍物,算法过程简单,处理数据量少,数据结果直观准确。同时,彩色图像与深度图像相结合,能够使障碍物的边界信息更加清楚,提高机器人避障过程的精准度。
作为一种实施方式,在上述任一实施例的基础上,该方法还可以包括:
若所述机器人和所述跟踪目标之间不存在障碍物,则控制所述机器人沿直线方向移动,以使所述跟踪目标处于所述机器人的中间视场。
由以上描述可知,在本申请所列举的具体实施例中,将彩色图像与深度图像相结合,能够获得更加清晰的障碍物边缘;将深度图像与深度值信息融合成深度直方图,根据深度直方图判断机器人与跟踪目标之间是否存在障碍物,减少了计算量,数据结果直观准确;对障碍物类型进行分类,根据障碍物类型,选择不同的避障策略,当检测到机器人与跟踪目标之间存在障碍物时,开始运行避障算法,与现有技术中机器人在跟踪目标时,在未知环境下需要实时运行避障算法相比,本申请具体实施例中的技术方案能够降低机器人的功耗,同时根据障碍物类型选择对应的避障策略,能够提高机器人的避障效率;在判断障碍物类型时,将三帧差分法与金字塔LK光流法结合,可以避免光照环境对检测结果的影响,同时还可以检测到运动速度过大的障碍物。
对于上文实施例提供的避障方法,图8为本申请一实施例提供的避障装置的结构框图。为了便于说明,仅示出了与本发明实施例相关的部分。如图8,该装置包括:
采集模块100,用于获取包含跟踪目标的场景图像。
处理模块200,用于根据场景图像,确定机器人和跟踪目标之间是否存在障碍物;若是,则确定障碍物所属的障碍物类型和边界信息,其中,每种障碍物类型对应于一种预设避障策略;
处理模块200,还用于根据边界信息和障碍物所属的障碍物类型所对应的预设避障策略,控制机器人移动。
本发明实施例通过获取包含跟踪目标的场景图像;根据场景图像,确定机器人和跟踪目标之间是否存在障碍物;若是,则确定障碍物所属的障碍物类型和边界信息,其中,每种障碍物类型对应于一种预设避障策略;根据边界信息和障碍物所属的障碍物类型所对应的预设避障策略,控制机器人移动。本发明实施例通过设置障碍物类型对应的预设避障策略,在识别到存在障碍物时,根据障碍物所属的类型对应的预设避障策略对机器人进行避障控制,能够减少避障所需处理的数据量,降低机器人的能耗。
可选地,障碍物类型包括动态障碍物和静态障碍物;动态障碍物对应于动态避障策略,静态障碍物对应于静态避障策略;
处理模块200,用于:
在障碍物所属的障碍物类型为动态障碍物时,根据边界信息和动态避障策略控制机器人移动;
在障碍物所属的障碍物类型为静态障碍物时,根据边界信息和静态避障策略控制机器人移动。
可选地,处理模块200,用于:
根据向量场直方图算法和边界信息,确定机器人的目标运动方向;
控制机器人向跟踪目标运动方向移动。
可选地,处理模块200,用于:
根据边界信息和机器人的位置信息,确定静态障碍物与机器人之间的距离;
在静态障碍物与机器人之间的距离大于或等于预设距离阈值时,控制机器人沿直线方向移动;
在距离小于预设距离阈值时,根据边界信息确定静态障碍物位于机器人的视场,在静态障碍物位于机器人的左视场或左中视场时,控制机器人右转;在静态障碍物位于机器人的右视场或右中视场时,控制机器人左转;在静态障碍物位于机器人的中间视场时,控制机器人左转或右转。
可选地,场景图像包括多个视频帧;处理模块200,用于:
确定障碍物所属的障碍物类型,包括:获取连续的三帧图像,并将三帧图像中每相邻的两帧图像做差分运算处理,以得到两帧帧差图像;
对两帧帧差图像进行二值化处理和逻辑与运算处理,以得到运动区域图像;
根据金字塔LK光流法对运动区域图像处理,以确定障碍物是否属于动态障碍物;
若否,则确定障碍物属于静态障碍物。
可选地,场景图像包括彩色图像和深度图像,处理模块200,用于:
通过贝叶斯分类器对彩色图像和深度图像中的跟踪目标进行识别,以得到跟踪目标在深度图像中的位置框;
对深度图像中的深度值进行归一化处理,其中,归一化处理后的深度图像中各像素点的深度值与各像素点所对应的对象到相机的距离呈负相关;
根据归一化处理后的深度图像,生成深度直方图,其中,深度直方图中跟踪目标所对应的像素点呈高斯分布;
若深度直方图中除跟踪目标所对应的像素点所对应的峰值之外,存在满足高斯分布均值和标准差的预设条件的峰值,则确定机器人和跟踪目标之间存在障碍物;
否则,确定机器人和跟踪目标之间不存在障碍物。
可选地,处理模块200,还用于:
若机器人和跟踪目标之间不存在障碍物,则控制机器人沿直线方向移动,以使跟踪目标处于机器人的中间视场。
本实施例提供的避障装置,可用于执行上述的方法实施例,其实现原理和技术效果类似,本实施例此处不再赘述。
参见图9,图9为本发明一实施例提供的电子设备的示意框图。如图9所示的本实施例中的电子设备900可以包括但不限于下述至少一项:一个或多个处理器901、一个或多个输入设备902、一个或多个输出设备903及一个或多个存储器904。上述处理器901、输入设备902、则输出设备903及存储器904通过通信总线905完成相互间的通信。存储器904用于存储计算机程序,计算机程序包括程序指令。处理器901用于执行存储器904存储的程序指令。其中,处理器901被配置用于调用程序指令执行以下操作上述各装置实施例中各模块/单元的功能,例如图8所示模块100至200的功能。
应当理解,在本发明实施例中,所称处理器901可以是中央处理单元(CentralProcessing Unit,CPU),该处理器还可以是其他通用处理器、数字信号处理器(DigitalSignal Processor,DSP)、专用集成电路(Application Specific Integrated Circuit,ASIC)、现成可编程门阵列(Field-Programmable Gate Array,FPGA)或者其他可编程逻辑器件、分立门或者晶体管逻辑器件、分立硬件组件等。通用处理器可以是微处理器或者该处理器也可以是任何常规的处理器等。
输入设备902可以包括触控板、指纹采传感器(用于采集用户的指纹信息和指纹的方向信息)、麦克风等,输出设备903可以包括显示器(LCD等)、扬声器等。
该存储器904可以包括只读存储器和随机存取存储器,并向处理器901提供指令和数据。存储器904的一部分还可以包括非易失性随机存取存储器。例如,存储器904还可以存储设备类型的信息。
具体实现中,本发明实施例中所描述的处理器901、输入设备902、输出设备903可执行本发明实施例提供的方法实施例所描述的实现方式,在此不再赘述。
在本发明的另一实施例中提供一种计算机可读存储介质,计算机可读存储介质存储有计算机程序,计算机程序包括程序指令,程序指令被处理器执行时实现上述实施例方法中的全部或部分流程,也可以通过计算机程序来指令相关的硬件来完成,计算机程序可存储于一计算机可读存储介质中,该计算机程序在被处理器执行时,可实现上述各个方法实施例的步骤。其中,计算机程序包括计算机程序代码,计算机程序代码可以为源代码形式、对象代码形式、可执行文件或某些中间形式等。计算机可读介质可以包括:能够携带计算机程序代码的任何实体或装置、记录介质、U盘、移动硬盘、磁碟、光盘、计算机存储器、只读存储器(ROM,Read-Only Memory)、随机存取存储器(RAM,Random Access Memory)、电载波信号、电信信号以及软件分发介质等。需要说明的是,计算机可读介质包含的内容可以根据司法管辖区内立法和专利实践的要求进行适当的增减,例如在某些司法管辖区,根据立法和专利实践,计算机可读介质不包括是电载波信号和电信信号。
计算机可读存储介质可以是前述任一实施例的终端的内部存储单元,例如终端的硬盘或内存。计算机可读存储介质也可以是终端的外部存储设备,例如终端上配备的插接式硬盘,智能存储卡(Smart Media Card,SMC),安全数字(Secure Digital,SD)卡,闪存卡(Flash Card)等。进一步地,计算机可读存储介质还可以既包括终端的内部存储单元也包括外部存储设备。计算机可读存储介质用于存储计算机程序及终端所需的其他程序和数据。计算机可读存储介质还可以用于暂时地存储已经输出或者将要输出的数据。
本领域技术人员可以意识到,结合本文中所公开的实施例描述的各示例的单元及算法步骤,能够以电子硬件、计算机软件或者二者的结合来实现,为了清楚地说明硬件和软件的可互换性,在上述说明中已经按照功能一般性地描述了各示例的组成及步骤。这些功能究竟以硬件还是软件方式来执行,取决于技术方案的特定应用和设计约束条件。专业技术人员可以对每个特定的应用来使用不同方法来实现所描述的功能,但是这种实现不应认为超出本发明的范围。
所属领域的技术人员可以清楚地了解到,为了描述的方便和简洁,上述描述的终端和单元的具体工作过程,可以参考前述方法实施例中的对应过程,在此不再赘述。
在本申请所提供的几个实施例中,应该理解到,所揭露的终端和方法,可以通过其它的方式实现。例如,以上所描述的装置实施例仅仅是示意性的,例如,单元的划分,仅仅为一种逻辑功能划分,实际实现时可以有另外的划分方式,例如多个单元或组件可以结合或者可以集成到另一个系统,或一些特征可以忽略,或不执行。另外,所显示或讨论的相互之间的耦合或直接耦合或通信连接可以是通过一些接口、装置或单元的间接耦合或通信连接,也可以是电的,机械的或其它的形式连接。
作为分离部件说明的单元可以是或者也可以不是物理上分开的,作为单元显示的部件可以是或者也可以不是物理单元,即可以位于一个地方,或者也可以分布到多个网络单元上。可以根据实际的需要选择其中的部分或者全部单元来实现本发明实施例方案的目的。
另外,在本发明各个实施例中的各功能单元可以集成在一个处理单元中,也可以是各个单元单独物理存在,也可以是两个或两个以上单元集成在一个单元中。上述集成的单元既可以采用硬件的形式实现,也可以采用软件功能单元的形式实现。
以上,仅为本发明的具体实施方式,但本发明的保护范围并不局限于此,任何熟悉本技术领域的技术人员在本发明揭露的技术范围内,可轻易想到各种等效的修改或替换,这些修改或替换都应涵盖在本发明的保护范围之内。因此,本发明的保护范围应以权利要求的保护范围为准。

Claims (10)

1.一种避障方法,其特征在于,包括:
获取包含跟踪目标的场景图像;
根据所述场景图像,确定所述机器人和所述跟踪目标之间是否存在障碍物;
若是,则确定所述障碍物所属的障碍物类型和边界信息,其中,每种障碍物类型对应于一种预设避障策略;
根据所述边界信息和所述障碍物所属的障碍物类型所对应的预设避障策略,控制所述机器人移动。
2.如权利要求1所述的避障方法,其特征在于,所述障碍物类型包括动态障碍物和静态障碍物;所述动态障碍物对应于动态避障策略,所述静态障碍物对应于静态避障策略;
根据所述边界信息和所述障碍物所属的障碍物类型所对应的避障策略,控制所述机器人移动,包括:
在所述障碍物所属的障碍物类型为所述动态障碍物时,根据所述边界信息和所述动态避障策略控制所述机器人移动;
在所述障碍物所属的障碍物类型为所述静态障碍物时,根据所述边界信息和所述静态避障策略控制所述机器人移动。
3.如权利要求2所述的避障方法,其特征在于,根据所述边界信息和所述动态避障策略控制所述机器人移动,包括:
根据向量场直方图算法和所述边界信息,确定所述机器人的目标运动方向;
控制所述机器人向所述目标运动方向移动。
4.如权利要求2所述的避障方法,其特征在于,根据所述边界信息和所述静态避障策略控制所述机器人移动,包括:
根据所述边界信息和所述机器人的位置信息,确定所述静态障碍物与所述机器人之间的距离;
在所述距离大于或等于预设距离阈值时,控制所述机器人沿直线方向移动;
在所述距离小于所述预设距离阈值时,根据所述边界信息确定所述静态障碍物位于所述机器人的视场,在所述静态障碍物位于所述机器人的左视场或左中视场时,控制所述机器人右转;在所述静态障碍物位于所述机器人的右视场或右中视场时,控制所述机器人左转;在所述静态障碍物位于所述机器人的中间视场时,控制所述机器人左转或右转。
5.如权利要求2所述的避障方法,其特征在于,所述场景图像包括多个视频帧;
确定所述障碍物所属的障碍物类型,包括:获取连续的三帧图像,并将所述三帧图像中每相邻的两帧图像做差分运算处理,以得到两帧帧差图像;
对所述两帧帧差图像进行二值化处理和逻辑与运算处理,以得到运动区域图像;
根据金字塔LK光流法对所述运动区域图像处理,以确定所述障碍物是否属于所述动态障碍物;
若否,则确定所述障碍物属于所述静态障碍物。
6.如权利要求1-5任一项所述的避障方法,其特征在于,所述场景图像包括彩色图像和深度图像;
根据所述场景图像,确定所述机器人和跟踪目标之间是否存在障碍物,包括:
通过贝叶斯分类器对所述彩色图像和所述深度图像中的跟踪目标进行识别,以得到所述跟踪目标在所述深度图像中的位置框;
对所述深度图像中的深度值进行归一化处理,其中,归一化处理后的深度图像中各像素点的深度值与各像素点所对应的对象到相机的距离呈负相关;
根据归一化处理后的深度图像,生成深度直方图,其中,所述深度直方图中所述跟踪目标所对应的像素点呈高斯分布;
若所述深度直方图中除所述跟踪目标所对应的像素点所对应的峰值之外,存在满足高斯分布均值和标准差的预设条件的峰值,则确定所述机器人和跟踪目标之间存在障碍物;
否则,确定所述机器人和所述跟踪目标之间不存在障碍物。
7.如权利要求1-5任一项所述的避障方法,其特征在于,所述方法还包括:若所述机器人和所述跟踪目标之间不存在障碍物,则控制所述机器人沿直线方向移动,以使所述跟踪目标处于所述机器人的中间视场。
8.一种避障装置,其特征在于,包括:
采集模块,用于获取包含跟踪目标的场景图像;
处理模块,用于根据所述场景图像,确定所述机器人和所述跟踪目标之间是否存在障碍物;若是,则确定所述障碍物所属的障碍物类型和边界信息,其中,每种障碍物类型对应于一种预设避障策略;
所述处理模块,还用于根据所述边界信息和所述障碍物所属的障碍物类型所对应的预设避障策略,控制所述机器人移动。
9.一种电子设备,包括存储器、处理器以及存储在所述存储器中并可在所述处理器上运行的计算机程序,其特征在于,所述处理器执行所述计算机程序时实现如权利要求1至7任一项所述方法的步骤。
10.一种计算机可读存储介质,所述计算机可读存储介质存储有计算机程序,其特征在于,所述计算机程序被处理器执行时实现如权利要求1至7任一项所述方法的步骤。
CN202110112386.5A 2021-01-27 2021-01-27 避障方法、装置及设备 Active CN112947419B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202110112386.5A CN112947419B (zh) 2021-01-27 2021-01-27 避障方法、装置及设备

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202110112386.5A CN112947419B (zh) 2021-01-27 2021-01-27 避障方法、装置及设备

Publications (2)

Publication Number Publication Date
CN112947419A true CN112947419A (zh) 2021-06-11
CN112947419B CN112947419B (zh) 2023-03-21

Family

ID=76237994

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202110112386.5A Active CN112947419B (zh) 2021-01-27 2021-01-27 避障方法、装置及设备

Country Status (1)

Country Link
CN (1) CN112947419B (zh)

Cited By (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN114332635A (zh) * 2022-03-11 2022-04-12 科大天工智能装备技术(天津)有限公司 一种智能搬运机器人障碍物自动识别方法和系统
CN115230719A (zh) * 2021-12-01 2022-10-25 上海仙途智能科技有限公司 一种行驶轨迹规划方法和装置
WO2023123117A1 (zh) * 2021-12-29 2023-07-06 广东美的白色家电技术创新中心有限公司 一种割草机器人避障方法和割草机器人
CN116755562A (zh) * 2023-07-04 2023-09-15 深圳市仙瞬科技有限公司 一种避障方法、装置、介质及ar/vr设备
WO2023178910A1 (zh) * 2022-03-21 2023-09-28 江苏集萃清联智控科技有限公司 一种具备多型避障方式的车辆局部轨迹规划方法及系统

Citations (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN105652873A (zh) * 2016-03-04 2016-06-08 中山大学 一种基于Kinect的移动机器人避障方法
US20180204111A1 (en) * 2013-02-28 2018-07-19 Z Advanced Computing, Inc. System and Method for Extremely Efficient Image and Pattern Recognition and Artificial Intelligence Platform
CN109711431A (zh) * 2018-11-27 2019-05-03 哈尔滨工业大学(深圳) 一处局部分块卷积的目标跟踪方法、系统及存储介质
CN109828528A (zh) * 2019-01-21 2019-05-31 河北工业职业技术学院 机器人轨迹跟踪方法及装置
CN109859243A (zh) * 2019-01-18 2019-06-07 昆明理工大学 一种基于尺度自适应块粒子的运动目标跟踪方法
CN110135500A (zh) * 2019-05-17 2019-08-16 南京大学 一种基于自适应深度特征滤波器的多场景下目标跟踪方法
CN110826508A (zh) * 2019-11-12 2020-02-21 浙江工商大学 一种基于视频流的行人非机动车违章检测与跟踪方法
CN110955241A (zh) * 2019-11-22 2020-04-03 深圳市优必选科技股份有限公司 移动机器人避障方法、装置、移动机器人及存储介质
CN112171675A (zh) * 2020-09-28 2021-01-05 深圳市丹芽科技有限公司 一种移动机器人的避障方法、装置、机器人及存储介质

Patent Citations (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20180204111A1 (en) * 2013-02-28 2018-07-19 Z Advanced Computing, Inc. System and Method for Extremely Efficient Image and Pattern Recognition and Artificial Intelligence Platform
CN105652873A (zh) * 2016-03-04 2016-06-08 中山大学 一种基于Kinect的移动机器人避障方法
CN109711431A (zh) * 2018-11-27 2019-05-03 哈尔滨工业大学(深圳) 一处局部分块卷积的目标跟踪方法、系统及存储介质
CN109859243A (zh) * 2019-01-18 2019-06-07 昆明理工大学 一种基于尺度自适应块粒子的运动目标跟踪方法
CN109828528A (zh) * 2019-01-21 2019-05-31 河北工业职业技术学院 机器人轨迹跟踪方法及装置
CN110135500A (zh) * 2019-05-17 2019-08-16 南京大学 一种基于自适应深度特征滤波器的多场景下目标跟踪方法
CN110826508A (zh) * 2019-11-12 2020-02-21 浙江工商大学 一种基于视频流的行人非机动车违章检测与跟踪方法
CN110955241A (zh) * 2019-11-22 2020-04-03 深圳市优必选科技股份有限公司 移动机器人避障方法、装置、移动机器人及存储介质
CN112171675A (zh) * 2020-09-28 2021-01-05 深圳市丹芽科技有限公司 一种移动机器人的避障方法、装置、机器人及存储介质

Non-Patent Citations (5)

* Cited by examiner, † Cited by third party
Title
WANG LIJIA 等: "《An Adaptive Kernel based Correlation Filter Algorithm for Real Time Object》", 《2020 12TH INTERNATIONAL CONFERENCE ON INTELLIGENT HUMAN-MACHINE SYSTEMS AND CYBERNETICS》 *
张微: "《基于相关滤波的时空上下文感知目标跟踪方法研究》", 《中国优秀博硕士学位论文全文数据库(博士) 信息科技辑》 *
王铮 等: "《基于双目视觉的AGV障碍物检测与避障》", 《计算机集成制造系统》 *
郝慧琴: "《基于单目视觉移动机器人的避障研究》", 《中国优秀硕士学位论文全文数据库 信息科技辑》 *
陈至坤 等: "《基于光流法的移动机器人避障平衡策略的改进》", 《华北理工大学学报(自然科学版)》 *

Cited By (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN115230719A (zh) * 2021-12-01 2022-10-25 上海仙途智能科技有限公司 一种行驶轨迹规划方法和装置
CN115230719B (zh) * 2021-12-01 2023-09-26 上海仙途智能科技有限公司 一种行驶轨迹规划方法和装置
WO2023123117A1 (zh) * 2021-12-29 2023-07-06 广东美的白色家电技术创新中心有限公司 一种割草机器人避障方法和割草机器人
CN114332635A (zh) * 2022-03-11 2022-04-12 科大天工智能装备技术(天津)有限公司 一种智能搬运机器人障碍物自动识别方法和系统
CN114332635B (zh) * 2022-03-11 2022-05-31 科大天工智能装备技术(天津)有限公司 一种智能搬运机器人障碍物自动识别方法和系统
WO2023178910A1 (zh) * 2022-03-21 2023-09-28 江苏集萃清联智控科技有限公司 一种具备多型避障方式的车辆局部轨迹规划方法及系统
CN116755562A (zh) * 2023-07-04 2023-09-15 深圳市仙瞬科技有限公司 一种避障方法、装置、介质及ar/vr设备
CN116755562B (zh) * 2023-07-04 2024-04-05 深圳市仙瞬科技有限公司 一种避障方法、装置、介质及ar/vr设备

Also Published As

Publication number Publication date
CN112947419B (zh) 2023-03-21

Similar Documents

Publication Publication Date Title
CN112947419B (zh) 避障方法、装置及设备
CN111666921B (zh) 车辆控制方法、装置、计算机设备和计算机可读存储介质
CN112417967B (zh) 障碍物检测方法、装置、计算机设备和存储介质
EP3510561B1 (en) Predicting depth from image data using a statistical model
US9990736B2 (en) Robust anytime tracking combining 3D shape, color, and motion with annealed dynamic histograms
CN105825173B (zh) 通用道路和车道检测系统与方法
CN111797657A (zh) 车辆周边障碍检测方法、装置、存储介质及电子设备
CN113286194A (zh) 视频处理方法、装置、电子设备及可读存储介质
CN111488812B (zh) 障碍物位置识别方法、装置、计算机设备和存储介质
CN111062263B (zh) 手部姿态估计的方法、设备、计算机设备和存储介质
WO2020154990A1 (zh) 目标物体运动状态检测方法、设备及存储介质
CN110827320B (zh) 基于时序预测的目标跟踪方法和装置
CN111967396A (zh) 障碍物检测的处理方法、装置、设备及存储介质
Berriel et al. A particle filter-based lane marker tracking approach using a cubic spline model
Mitzel et al. Real-Time Multi-Person Tracking with Time-Constrained Detection.
CN110992424A (zh) 基于双目视觉的定位方法和系统
CN114022531A (zh) 图像处理方法、电子设备和存储介质
CN116665179A (zh) 数据处理方法、装置、域控制器以及存储介质
CN110864670A (zh) 目标障碍物位置的获取方法和系统
EP4207066A1 (en) Object tracking method and apparatus, device, and a computer-readable storage medium
CN115249269A (zh) 目标检测方法、计算机程序产品、存储介质及电子设备
CN115100565A (zh) 一种基于空间相关性与光流配准的多目标跟踪方法
CN115431968B (zh) 车辆控制器、车辆及车辆控制方法
CN117949942B (zh) 基于雷达数据和视频数据融合的目标跟踪方法及系统
CN115994934B (zh) 数据时间对齐方法、装置以及域控制器

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant
TR01 Transfer of patent right

Effective date of registration: 20230927

Address after: Room 2202, 22 / F, Wantong building, No. 3002, Sungang East Road, Sungang street, Luohu District, Shenzhen City, Guangdong Province

Patentee after: Shenzhen dragon totem technology achievement transformation Co.,Ltd.

Address before: 230000 floor 1, building 2, phase I, e-commerce Park, Jinggang Road, Shushan Economic Development Zone, Hefei City, Anhui Province

Patentee before: Dragon totem Technology (Hefei) Co.,Ltd.

Effective date of registration: 20230927

Address after: 230000 floor 1, building 2, phase I, e-commerce Park, Jinggang Road, Shushan Economic Development Zone, Hefei City, Anhui Province

Patentee after: Dragon totem Technology (Hefei) Co.,Ltd.

Address before: 050091 no.626, Hongqi Street, Qiaoxi District, Shijiazhuang City, Hebei Province

Patentee before: HEBEI College OF INDUSTRY AND TECHNOLOGY

TR01 Transfer of patent right