CN107544506A - 机器人跟随方法、机器人以及存储介质 - Google Patents

机器人跟随方法、机器人以及存储介质 Download PDF

Info

Publication number
CN107544506A
CN107544506A CN201710891403.3A CN201710891403A CN107544506A CN 107544506 A CN107544506 A CN 107544506A CN 201710891403 A CN201710891403 A CN 201710891403A CN 107544506 A CN107544506 A CN 107544506A
Authority
CN
China
Prior art keywords
msub
robot
mrow
theta
people
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
CN201710891403.3A
Other languages
English (en)
Other versions
CN107544506B (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.)
Shanghai Has A Robot Co Ltd
Shanghai Yogo Robot Co Ltd
Original Assignee
Shanghai Has A Robot Co Ltd
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 Shanghai Has A Robot Co Ltd filed Critical Shanghai Has A Robot Co Ltd
Priority to CN201710891403.3A priority Critical patent/CN107544506B/zh
Publication of CN107544506A publication Critical patent/CN107544506A/zh
Application granted granted Critical
Publication of CN107544506B publication Critical patent/CN107544506B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Landscapes

  • Manipulator (AREA)

Abstract

本发明提供一种机器人跟随方法、机器人以及存储介质,所述方法包括:检测被跟随体并确定所述被跟随体的位置;获取机器人与所述被跟随体之间的夹角和实时距离;根据所述机器人与所述被跟随体之间的夹角确定所述机器人的夹角的旋转角速度,根据所述机器人与所述被跟随体之间的实时距离和所述机器人所要保持的固定跟随距离确定所述机器人朝向所述跟随体平移的平移线速度。本发明中用户走到哪里,机器人就跟随到哪里,方便用户及时与机器人交互,使得机器人从被动与人交互转换为主动与人交互,可以增强娱乐性,增强对周围环境感知能力,为机器人应用提供良好的体验。

Description

机器人跟随方法、机器人以及存储介质
技术领域
本发明属于机器人技术领域,特别是涉及一种机器人跟随方法、机器人以及存储介质。
背景技术
随着现有技术的迅速发展,机器人开始走进老百姓的生活中,机器人的使用领域较为广泛,以服务行业为例,机器人可从事餐饮、维护保养、修理、运输、清洗、救援或监护等工作,能完成有益于人类健康的服务工作,给人民的生活带来的极大的便利。
通常情况下,智能机器人与遥控器建立连接后,接受遥控器的遥控,根据遥控器的遥控指令进行相应的操作实现跟随。但是,遥控器不进行操作时,机器人通常不会进行相应跟随操作。并且,机器人在远离遥控器之后,受制于地理环境和通信环境影响,机器人无法随时待命为用户服务。
可见目前在实现机器人跟随交互任务中,还未有合适的交互系统,未能同时实现跟随并与人交互,互动能力较差。
发明内容
鉴于以上所述现有技术的缺点,本发明的目的在于提供一种机器人跟随方法、机器人以及存储介质,用于解决现有技术中机器人在远离遥控器之后,受制于地理环境和通信环境影响,机器人无法随时待命为用户服务的问题。
为实现上述目的及其他相关目的,本发明提供一种机器人跟随方法,所述机器人跟随方法包括:检测被跟随体并确定所述被跟随体的位置;获取机器人与所述被跟随体之间的夹角和实时距离;根据所述机器人与所述被跟随体之间的夹角确定所述机器人的夹角的旋转角速度,根据所述机器人与所述被跟随体之间的实时距离和所述机器人所要保持的固定跟随距离确定所述机器人朝向所述跟随体平移的平移线速度。
于本发明的一实施例中,所述被跟随体为人;所述检测被跟随体并确定所述被跟随体的位置具体包括:检测人腿位置;根据所述人腿位置确定人的中心位置。
于本发明的一实施例中,所述根据所述人腿位置确定人的中心位置具体包括:若检测到两条人腿,则两条人腿的位置的中心做为人的中心位置;若检测到一条人腿,则该人腿的位置作为人的中心位置;若检测到多条人腿,则根据两条人腿之间的通常距离确定同属一个人的两条人腿,形成多组人腿或单个人腿,两条人腿的位置的中心做为人的中心位置,单个人腿的位置作为人的中心位置。
于本发明的一实施例中,建立机器人跟随运动的运动坐标系,所述运动坐标系以所述机器人的中心为原点,机器人右侧水平方向为X轴,以机器人正前方方向为Y轴。
于本发明的一实施例中,所述机器人与所述被跟随体之间的夹角为机器人的中心与所述被跟随体的中心的连线与所述机器人的朝向之间的夹角;定义所述夹角于所述运动坐标系中顺时针方向为正,逆时针方向为负。
于本发明的一实施例中,所述机器人的夹角的旋转角速度为:
其中,ω为以机器人的中心为圆心的夹角θ的旋转角速度,于所述运动坐标系中顺时针方向为正,逆时针方向为负;θ为机器人的中心与所述被跟随体的中心的连线与所述机器人的朝向之间的夹角,RotateSpeedmax为ω的最大值,θ1,θ2分别为定义的机器人的中心与所述被跟随体的中心的连线与所述机器人的朝向之间的夹角数值,θ1<θ2
于本实施例中,所述机器人朝向所述跟随体平移的平移线速度为:
LinerSpeed=LinerSpeedBase×SlowdownRate;
其中,LinerSpeed为平移线速度,LinerSpeedBase为平移线速度基数,SlowdownRate为设定的降速比例常数,LinerSpeedmax为平移线速度的最大值,d为机器人与被跟随体之间的实时距离,D1为机器人所要保持的固定跟随距离,D2为距离设定值,D2>D1
于本发明的一实施例中,所述设定的降速比例常数为:
其中,θ3,θ4分别为定义的机器人的中心与所述被跟随体的中心的连线与所述机器人的朝向之间的夹角数值,θ3<θ4
本发明的实施例还提供一种计算机可读存储介质,其上存储有计算机程序,该程序被处理器执行时实现如上所述的机器人跟随方法。
本发明的实施例还提供一种机器人,包括处理器、存储器和激光器,所述存储器存储有程序指令,所述处理器运行所述程序指令实现如上所述的机器人跟随方法。
如上所述,本发明的机器人跟随方法、机器人以及存储介质,具有以下有益效果:
1、本发明根据机器人与被跟随体之间的夹角确定所述机器人的夹角的旋转角速度,根据所述机器人与所述被跟随体之间的实时距离和所述机器人所要保持的固定跟随距离确定所述机器人朝向所述跟随体平移的平移线速度,从而实现机器人对人体的跟随,用户走到哪里,机器人就跟随到哪里,方便用户及时与机器人交互,使得机器人从被动与人交互转换为主动与人交互,可以增强娱乐性,增强对周围环境感知能力,为机器人应用提供良好的体验。
2、本发明的机器人的人体跟随方法使得机器人更加智能化,能更好的为用户服务。
附图说明
图1显示为本发明的机器人跟随方法于一实施例中的流程示意图。
图2显示为本发明的机器人跟随方法中机器人与被跟随体之间的夹角示意图。
图3显示为本发明的机器人跟随方法中旋转角速度的取值示意图。
图4显示为本发明的机器人跟随方法中平移的平移线速度的取值示意图。
图5显示为本发明的机器人跟随方法中设定的降速比例常数的取值示意图。
具体实施方式
以下通过特定的具体实例说明本发明的实施方式,本领域技术人员可由本说明书所揭露的内容轻易地了解本发明的其他优点与功效。本发明还可以通过另外不同的具体实施方式加以实施或应用,本说明书中的各项细节也可以基于不同观点与应用,在没有背离本发明的精神下进行各种修饰或改变。需说明的是,在不冲突的情况下,以下实施例及实施例中的特征可以相互组合。
请参阅图1至图5,需要说明的是,以下实施例中所提供的图示仅以示意方式说明本发明的基本构想,遂图式中仅显示与本发明中有关的组件而非按照实际实施时的组件数目、形状及尺寸绘制,其实际实施时各组件的型态、数量及比例可为一种随意的改变,且其组件布局型态也可能更为复杂。
本实施例的目的在于提供一种机器人跟随方法、机器人以及存储介质,用于解决现有技术中机器人在远离遥控器之后,受制于地理环境和通信环境影响,机器人无法随时待命为用户服务的问题。以下将详细阐述本发明的机器人跟随方法、机器人以及存储介质的原理及实施方式,使本领域技术人员不需要创造性劳动即可理解本发明的机器人跟随方法、机器人以及存储介质。
本实施例的机器人跟随方法和机器人通过平面激光识别出的人的腿部截面特征,预估人的相对位置。机器人根据和人的相对位置,采取跟随并保持相对距离。以下对本实施例的机器人跟随方法、机器人以及存储介质进行具体说明。
本实施例提供一种机器人跟随方法,如图1所示,所述机器人跟随方法包括以下步骤:
步骤S110,检测被跟随体并确定所述被跟随体的位置。
步骤S120,获取机器人与所述被跟随体之间的夹角和实时距离。
步骤S130,根据所述机器人与所述被跟随体之间的夹角确定所述机器人的夹角的旋转角速度。
步骤S140,根据所述机器人与所述被跟随体之间的实时距离和所述机器人所要保持的固定跟随距离确定所述机器人朝向所述跟随体平移的平移线速度。
以下对本实施例的机器人跟随方法进行详细说明。
步骤S110,检测被跟随体并确定所述被跟随体的位置。
于本实施例中,所述被跟随体为人;所述检测被跟随体并确定所述被跟随体的位置具体包括:检测人腿位置;根据所述人腿位置确定人的中心位置。
例如,机器人通过平面激光器来观测人的腿部,识别出人的位置。
具体地,于本实施例中,所述根据所述人腿位置确定人的中心位置具体包括:
若检测到两条人腿,则两条人腿的位置的中心做为人的中心位置。
若检测到一条人腿,则该人腿的位置作为人的中心位置。
若检测到多条人腿,则根据两条人腿之间的通常距离确定同属一个人的两条人腿,形成多组人腿或单个人腿,两条人腿的位置的中心做为人的中心位置,单个人腿的位置作为人的中心位置。
具体地,对上述几种情况进行说明。
1)若检测到两条人腿,则两条人腿的位置的中心做为人的中心位置:人的两条腿之间的距离应小于一定的距离(如一米),人的位置在两腿坐标的几何中心。
2)若检测到一条人腿,则该人腿的位置作为人的中心位置:因遮挡或是识别缺陷造成的某个时刻只有一条腿被识别,这条腿的位置当作人的位置。人的位置不应该发生突变,这个可以根据时间差来换算,比如1秒内移动的距离超过2米则认为新发现的人。其中,较短时间内检测到的人腿忽略不计。
若检测到多条人腿,则根据两条人腿之间的通常距离确定同属一个人的两条人腿,形成多组人腿或单个人腿,两条人腿的位置的中心做为人的中心位置,单个人腿的位置作为人的中心位置,也就是说,多人的识别需要根据以上1)或2)中的检测规则划分多种组合的集合分别判断。
步骤S120,获取机器人与所述被跟随体之间的夹角和实时距离。
于本实施例中,建立机器人跟随运动的运动坐标系,所述运动坐标系以所述机器人的中心为原点,机器人右侧水平方向为X轴,以机器人正前方方向为Y轴。
其中,具体地,于本实施例中,如图2所示,所述机器人与所述被跟随体之间的夹角为机器人的中心与所述被跟随体的中心的连线与所述机器人的朝向之间的夹角,即角度θ是机器人的朝向和机器人到人的位置连线的夹角。
于本实施例中,定义所述夹角于所述运动坐标系中顺时针方向为正,逆时针方向为负。
步骤S130,根据所述机器人与所述被跟随体之间的夹角确定所述机器人的夹角的旋转角速度。旋转角速度是角度θ对应的旋转速度。
具体地,于本实施例中,如图3所示,所述机器人的夹角的旋转角速度为:
其中,ω为以机器人的中心为圆心的夹角θ的旋转角速度,于所述运动坐标系中顺时针方向为正,逆时针方向为负;θ为机器人的中心与所述被跟随体的中心的连线与所述机器人的朝向之间的夹角,RotateSpeedmax为ω的最大值,θ1,θ2分别为定义的机器人的中心与所述被跟随体的中心的连线与所述机器人的朝向之间的夹角数值,θ1<θ2
为了让角速度ω的变化较为平滑,需要对其做线性变化的约束。主要得分为正负两个方向,两个方向上的速度是相反的,其中每个方向又分三段,当偏差角θ小于θ1时,运动的方向不需要调整,即角速度ω为零;当偏差角θ大于θ1小于θ2时,在这个区间角速度ω随偏差角θ的变化做线性变化调整;当大于θ2时,以最大的角速度RotateSpeedmax旋转,使其尽快朝向人。
步骤S140,根据所述机器人与所述被跟随体之间的实时距离和所述机器人所要保持的固定跟随距离确定所述机器人朝向所述跟随体平移的平移线速度。
于本实施例中,具体地,如图4所示,所述机器人朝向所述跟随体平移的平移线速度为:
LinerSpeed=LinerSpeedBase×SlowdownRate;
其中,LinerSpeed为平移线速度,LinerSpeedBase为平移线速度基数,SlowdownRate为设定的降速比例常数,LinerSpeedmax为平移线速度的最大值,d为机器人与被跟随体之间的实时距离,D1为机器人所要保持的固定跟随距离,D2为距离设定值,D2>D1
为了让机器人和人保持在距离D1,线速度基数LinerSpeedBase要随着距离d做调整。分为三段,当距离小于等于D1时,应停止移动,线速度基数为0;当距离大于D2,时以最大速度跟进,即线速度基数LinerSpeedBase为其最大值LinerSpeedmax;中间区段,速度基数随距离d线性变化,即
最终的平移线速度LinerSpeed是由线速度基数LinerSpeedBase和降速比例SlowdownRate两个合成的,即LinerSpeed=LinerSpeedBase×SlowdownRate。
其中,于本实施例中,如图5所示,所述设定的降速比例常数为:
其中,θ3,θ4分别为定义的机器人的中心与所述被跟随体的中心的连线与所述机器人的朝向之间的夹角数值,θ3<θ4
要保持机器人始终朝向人,角度的旋转要优先于为平移线速度LinerSpeed,用来抑制方向偏差的运动位移,使用降速比例SlowdownRate这一线速度因子,用来约束平移速度。角度偏差越大时,线速度要越小。当偏差角θ小于θ3,线速度不做约束,即降速比例SlowdownRate为1;当偏差角θ大于θ4,线速度为0,即降速比例SlowdownRate为0;中间区段,降速比例SlowdownRate随着偏差角θ线性调整,即
本实施例还提供一种计算机可读存储介质,其上存储有计算机程序,该程序被处理器执行时实现如上所述的机器人跟随方法。上述已经对所述机器人跟随方法进行了详细描述,在此不再赘述。
本实施例还提供一种机器人,包括处理器、存储器和激光器,所述存储器存储有程序指令,所述处理器运行所述程序指令实现如上所述的机器人跟随方法。上述已经对所述机器人跟随方法进行了详细描述,在此不再赘述。于本实施例中,例如,机器人通过轮式驱动装置来跟随人的行走,并和人保持相对距离。
综上所述,本发明根据机器人与被跟随体之间的夹角确定所述机器人的夹角的旋转角速度,根据所述机器人与所述被跟随体之间的实时距离和所述机器人所要保持的固定跟随距离确定所述机器人朝向所述跟随体平移的平移线速度,从而实现机器人对人体的跟随,用户走到哪里,机器人就跟随到哪里,方便用户及时与机器人交互,使得机器人从被动与人交互转换为主动与人交互,可以增强娱乐性,增强对周围环境感知能力,为机器人应用提供良好的体验;本发明的机器人的人体跟随方法使得机器人更加智能化,能更好的为用户服务。所以,本发明有效克服了现有技术中的种种缺点而具高度产业利用价值。
上述实施例仅例示性说明本发明的原理及其功效,而非用于限制本发明。任何熟悉此技术的人士皆可在不违背本发明的精神及范畴下,对上述实施例进行修饰或改变。因此,举凡所属技术领域中具有通常知识者在未脱离本发明所揭示的精神与技术思想下所完成的一切等效修饰或改变,仍应由本发明的权利要求所涵盖。

Claims (10)

1.一种机器人跟随方法,其特征在于,所述机器人跟随方法包括:
检测被跟随体并确定所述被跟随体的位置;
获取机器人与所述被跟随体之间的夹角和实时距离;
根据所述机器人与所述被跟随体之间的夹角确定所述机器人的夹角的旋转角速度,根据所述机器人与所述被跟随体之间的实时距离和所述机器人所要保持的固定跟随距离确定所述机器人朝向所述跟随体平移的平移线速度。
2.根据权利要求1所述的机器人跟随方法,其特征在于,所述被跟随体为人;所述检测被跟随体并确定所述被跟随体的位置具体包括:
检测人腿位置;
根据所述人腿位置确定人的中心位置。
3.根据权利要求2所述的机器人跟随方法,其特征在于,所述根据所述人腿位置确定人的中心位置具体包括:
若检测到两条人腿,则两条人腿的位置的中心做为人的中心位置;
若检测到一条人腿,则该人腿的位置作为人的中心位置;
若检测到多条人腿,则根据两条人腿之间的通常距离确定同属一个人的两条人腿,形成多组人腿或单个人腿,两条人腿的位置的中心做为人的中心位置,单个人腿的位置作为人的中心位置。
4.根据权利要求1或3所述的机器人跟随方法,其特征在于,建立机器人跟随运动的运动坐标系,所述运动坐标系以所述机器人的中心为原点,机器人右侧水平方向为X轴,以机器人正前方方向为Y轴。
5.根据权利要求4所述的机器人跟随方法,其特征在于,所述机器人与所述被跟随体之间的夹角为机器人的中心与所述被跟随体的中心的连线与所述机器人的朝向之间的夹角;定义所述夹角于所述运动坐标系中顺时针方向为正,逆时针方向为负。
6.根据权利要求5所述的机器人跟随方法,其特征在于,所述机器人的夹角的旋转角速度为:
<mrow> <mi>&amp;omega;</mi> <mo>=</mo> <mfenced open = "{" close = "}"> <mtable> <mtr> <mtd> <mi>R</mi> <mi>o</mi> <mi>t</mi> <mi>a</mi> <mi>t</mi> <mi>e</mi> <mi>S</mi> <mi>p</mi> <mi>e</mi> <mi>e</mi> <msub> <mi>d</mi> <mrow> <mi>m</mi> <mi>a</mi> <mi>x</mi> </mrow> </msub> <mo>,</mo> <msub> <mi>&amp;theta;</mi> <mn>2</mn> </msub> <mo>&lt;</mo> <mi>&amp;theta;</mi> <mo>&amp;le;</mo> <mi>&amp;pi;</mi> </mtd> </mtr> <mtr> <mtd> <mi>R</mi> <mi>o</mi> <mi>t</mi> <mi>a</mi> <mi>t</mi> <mi>e</mi> <mi>S</mi> <mi>p</mi> <mi>e</mi> <mi>e</mi> <msub> <mi>d</mi> <mrow> <mi>m</mi> <mi>a</mi> <mi>x</mi> </mrow> </msub> <mo>&amp;times;</mo> <mfrac> <mrow> <mi>&amp;theta;</mi> <mo>-</mo> <msub> <mi>&amp;theta;</mi> <mn>1</mn> </msub> </mrow> <mrow> <msub> <mi>&amp;theta;</mi> <mn>2</mn> </msub> <mo>-</mo> <msub> <mi>&amp;theta;</mi> <mn>1</mn> </msub> </mrow> </mfrac> <mo>,</mo> <msub> <mi>&amp;theta;</mi> <mn>1</mn> </msub> <mo>&lt;</mo> <mi>&amp;theta;</mi> <mo>&amp;le;</mo> <msub> <mi>&amp;theta;</mi> <mn>2</mn> </msub> </mtd> </mtr> <mtr> <mtd> <mrow> <mn>0</mn> <mo>,</mo> <mo>-</mo> <msub> <mi>&amp;theta;</mi> <mn>1</mn> </msub> <mo>&lt;</mo> <mi>&amp;theta;</mi> <mo>&amp;le;</mo> <msub> <mi>&amp;theta;</mi> <mn>1</mn> </msub> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <msub> <mi>RotateSpeed</mi> <mi>max</mi> </msub> <mo>&amp;times;</mo> <mfrac> <mrow> <mo>-</mo> <mi>&amp;theta;</mi> <mo>-</mo> <msub> <mi>&amp;theta;</mi> <mn>1</mn> </msub> </mrow> <mrow> <msub> <mi>&amp;theta;</mi> <mn>2</mn> </msub> <mo>-</mo> <msub> <mi>&amp;theta;</mi> <mn>1</mn> </msub> </mrow> </mfrac> <mo>,</mo> <mo>-</mo> <msub> <mi>&amp;theta;</mi> <mn>2</mn> </msub> <mo>&lt;</mo> <mi>&amp;theta;</mi> <mo>&amp;le;</mo> <mo>-</mo> <msub> <mi>&amp;theta;</mi> <mn>1</mn> </msub> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mo>-</mo> <msub> <mi>Rotatespeed</mi> <mi>max</mi> </msub> <mo>,</mo> <mo>-</mo> <mi>&amp;pi;</mi> <mo>&lt;</mo> <mi>&amp;theta;</mi> <mo>&amp;le;</mo> <msub> <mi>&amp;theta;</mi> <mn>2</mn> </msub> </mrow> </mtd> </mtr> </mtable> </mfenced> <mo>;</mo> </mrow>
其中,ω为以机器人的中心为圆心的夹角θ的旋转角速度,于所述运动坐标系中顺时针方向为正,逆时针方向为负;θ为机器人的中心与所述被跟随体的中心的连线与所述机器人的朝向之间的夹角,RotateSpeedmax为ω的最大值,θ1,θ2分别为定义的机器人的中心与所述被跟随体的中心的连线与所述机器人的朝向之间的夹角数值,θ1<θ2
7.根据权利要求1所述的机器人跟随方法,其特征在于,所述机器人朝向所述跟随体平移的平移线速度为:
LinerSpeed=LinerSpeedBase×SlowdownRate;
<mrow> <mi>L</mi> <mi>i</mi> <mi>n</mi> <mi>e</mi> <mi>r</mi> <mi>S</mi> <mi>p</mi> <mi>e</mi> <mi>e</mi> <mi>d</mi> <mi>B</mi> <mi>a</mi> <mi>s</mi> <mi>e</mi> <mo>=</mo> <mfenced open = "{" close = ""> <mtable> <mtr> <mtd> <mrow> <msub> <mi>LinerSpeed</mi> <mrow> <mi>m</mi> <mi>a</mi> <mi>x</mi> </mrow> </msub> <mo>,</mo> <mi>d</mi> <mo>&gt;</mo> <msub> <mi>D</mi> <mn>2</mn> </msub> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <msub> <mi>LinerSpeed</mi> <mrow> <mi>m</mi> <mi>a</mi> <mi>x</mi> </mrow> </msub> <mo>&amp;times;</mo> <mfrac> <mrow> <mi>d</mi> <mo>-</mo> <msub> <mi>D</mi> <mn>1</mn> </msub> </mrow> <mrow> <msub> <mi>D</mi> <mn>2</mn> </msub> <mo>-</mo> <msub> <mi>D</mi> <mn>1</mn> </msub> </mrow> </mfrac> <mo>,</mo> <msub> <mi>D</mi> <mn>1</mn> </msub> <mo>&lt;</mo> <mi>d</mi> <mo>&amp;le;</mo> <msub> <mi>D</mi> <mn>2</mn> </msub> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mn>0</mn> <mo>,</mo> <mn>0</mn> <mo>&amp;le;</mo> <mi>d</mi> <mo>&amp;le;</mo> <msub> <mi>D</mi> <mn>1</mn> </msub> </mrow> </mtd> </mtr> </mtable> </mfenced> <mo>;</mo> </mrow>
其中,LinerSpeed为平移线速度,LinerSpeedBase为平移线速度基数,SlowdownRate为设定的降速比例常数,LinerSpeedmax为平移线速度的最大值,d为机器人与被跟随体之间的实时距离,D1为机器人所要保持的固定跟随距离,D2为距离设定值,D2>D1
8.根据权利要求7所述的机器人跟随方法,其特征在于,所述设定的降速比例常数为:
<mrow> <mi>S</mi> <mi>l</mi> <mi>o</mi> <mi>w</mi> <mi>d</mi> <mi>o</mi> <mi>w</mi> <mi>n</mi> <mi>R</mi> <mi>a</mi> <mi>t</mi> <mi>e</mi> <mo>=</mo> <mfenced open = "{" close = "}"> <mtable> <mtr> <mtd> <mn>0</mn> <mo>,</mo> <msub> <mi>&amp;theta;</mi> <mn>4</mn> </msub> <mo>&lt;</mo> <mi>&amp;theta;</mi> <mo>&amp;le;</mo> <mi>&amp;pi;</mi> </mtd> </mtr> <mtr> <mtd> <mfrac> <mrow> <msub> <mi>&amp;theta;</mi> <mn>4</mn> </msub> <mo>-</mo> <mi>&amp;theta;</mi> </mrow> <mrow> <msub> <mi>&amp;theta;</mi> <mn>4</mn> </msub> <mo>-</mo> <msub> <mi>&amp;theta;</mi> <mn>3</mn> </msub> </mrow> </mfrac> <mo>,</mo> <msub> <mi>&amp;theta;</mi> <mn>3</mn> </msub> <mo>&lt;</mo> <mi>&amp;theta;</mi> <mo>&amp;le;</mo> <msub> <mi>&amp;theta;</mi> <mn>4</mn> </msub> </mtd> </mtr> <mtr> <mtd> <mrow> <mn>1</mn> <mo>,</mo> <mo>-</mo> <msub> <mi>&amp;theta;</mi> <mn>3</mn> </msub> <mo>&lt;</mo> <mi>&amp;theta;</mi> <mo>&amp;le;</mo> <msub> <mi>&amp;theta;</mi> <mn>3</mn> </msub> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mfrac> <mrow> <msub> <mi>&amp;theta;</mi> <mn>4</mn> </msub> <mo>+</mo> <mi>&amp;theta;</mi> </mrow> <mrow> <msub> <mi>&amp;theta;</mi> <mn>4</mn> </msub> <mo>-</mo> <msub> <mi>&amp;theta;</mi> <mn>3</mn> </msub> </mrow> </mfrac> <mo>,</mo> <mo>-</mo> <msub> <mi>&amp;theta;</mi> <mn>4</mn> </msub> <mo>&lt;</mo> <mi>&amp;theta;</mi> <mo>&amp;le;</mo> <mo>-</mo> <msub> <mi>&amp;theta;</mi> <mn>3</mn> </msub> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mn>0</mn> <mo>,</mo> <mo>-</mo> <mi>&amp;pi;</mi> <mo>&lt;</mo> <mi>&amp;theta;</mi> <mo>&amp;le;</mo> <mo>-</mo> <msub> <mi>&amp;theta;</mi> <mn>4</mn> </msub> </mrow> </mtd> </mtr> </mtable> </mfenced> <mo>;</mo> </mrow>
其中,θ3,θ4分别为定义的机器人的中心与所述被跟随体的中心的连线与所述机器人的朝向之间的夹角数值,θ3<θ4
9.一种计算机可读存储介质,其上存储有计算机程序,其特征在于,该程序被处理器执行时实现如权利要求1~8任一项所述的机器人跟随方法。
10.一种机器人,其特征在于,包括处理器、存储器和激光器,所述存储器存储有程序指令,所述处理器运行所述程序指令实现如1~8任一项所述的机器人跟随方法。
CN201710891403.3A 2017-09-27 2017-09-27 机器人跟随方法、机器人以及存储介质 Active CN107544506B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201710891403.3A CN107544506B (zh) 2017-09-27 2017-09-27 机器人跟随方法、机器人以及存储介质

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201710891403.3A CN107544506B (zh) 2017-09-27 2017-09-27 机器人跟随方法、机器人以及存储介质

Publications (2)

Publication Number Publication Date
CN107544506A true CN107544506A (zh) 2018-01-05
CN107544506B CN107544506B (zh) 2021-05-18

Family

ID=60964614

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201710891403.3A Active CN107544506B (zh) 2017-09-27 2017-09-27 机器人跟随方法、机器人以及存储介质

Country Status (1)

Country Link
CN (1) CN107544506B (zh)

Cited By (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN108274467A (zh) * 2018-01-24 2018-07-13 珠海市微半导体有限公司 机器人走直线的控制方法和芯片及机器人
CN108345004A (zh) * 2018-02-09 2018-07-31 弗徕威智能机器人科技(上海)有限公司 一种移动机器人的人体跟随方法
CN109445466A (zh) * 2018-11-09 2019-03-08 浙江国自机器人技术有限公司 机器人跟随控制方法、系统、设备及计算机可读存储介质
CN109740462A (zh) * 2018-12-21 2019-05-10 北京智行者科技有限公司 目标的识别跟随方法
CN110046831A (zh) * 2019-04-25 2019-07-23 上海快仓智能科技有限公司 跟随移动控制方法和装置
CN112346460A (zh) * 2020-11-05 2021-02-09 泉州装备制造研究所 一种适用于多人场景的移动机器人自动跟随方法
CN112351087A (zh) * 2020-10-29 2021-02-09 上海有个机器人有限公司 一种远程呼叫机器人的方法以及设备

Citations (10)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101923351A (zh) * 2009-06-12 2010-12-22 三星电子株式会社 机器人清洁器及其控制方法
CN202025084U (zh) * 2010-12-24 2011-11-02 无锡物联网产业研究院 一种激光雷达监测系统
US20130131910A1 (en) * 2009-11-20 2013-05-23 Keio University Autonomous mobile body and control method of same
CN104268598A (zh) * 2014-09-26 2015-01-07 东南大学 一种基于二维扫描激光的人腿检测方法
CN105652895A (zh) * 2014-11-12 2016-06-08 沈阳新松机器人自动化股份有限公司 基于激光传感器的移动机器人人体跟踪系统及跟踪方法
CN106094875A (zh) * 2016-06-27 2016-11-09 南京邮电大学 一种移动机器人的目标跟随控制方法
CN106203361A (zh) * 2016-07-15 2016-12-07 苏州宾果智能科技有限公司 一种机器人跟踪方法和装置
CN106778445A (zh) * 2015-11-20 2017-05-31 沈阳新松机器人自动化股份有限公司 基于人脸检测的服务机器人视觉引领方法
CN106843280A (zh) * 2017-02-17 2017-06-13 深圳市踏路科技有限公司 一种机器人智能跟随系统
CN106881716A (zh) * 2017-02-21 2017-06-23 深圳市锐曼智能装备有限公司 基于3d摄像头机器人的人体跟随方法及系统

Patent Citations (10)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101923351A (zh) * 2009-06-12 2010-12-22 三星电子株式会社 机器人清洁器及其控制方法
US20130131910A1 (en) * 2009-11-20 2013-05-23 Keio University Autonomous mobile body and control method of same
CN202025084U (zh) * 2010-12-24 2011-11-02 无锡物联网产业研究院 一种激光雷达监测系统
CN104268598A (zh) * 2014-09-26 2015-01-07 东南大学 一种基于二维扫描激光的人腿检测方法
CN105652895A (zh) * 2014-11-12 2016-06-08 沈阳新松机器人自动化股份有限公司 基于激光传感器的移动机器人人体跟踪系统及跟踪方法
CN106778445A (zh) * 2015-11-20 2017-05-31 沈阳新松机器人自动化股份有限公司 基于人脸检测的服务机器人视觉引领方法
CN106094875A (zh) * 2016-06-27 2016-11-09 南京邮电大学 一种移动机器人的目标跟随控制方法
CN106203361A (zh) * 2016-07-15 2016-12-07 苏州宾果智能科技有限公司 一种机器人跟踪方法和装置
CN106843280A (zh) * 2017-02-17 2017-06-13 深圳市踏路科技有限公司 一种机器人智能跟随系统
CN106881716A (zh) * 2017-02-21 2017-06-23 深圳市锐曼智能装备有限公司 基于3d摄像头机器人的人体跟随方法及系统

Cited By (10)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN108274467A (zh) * 2018-01-24 2018-07-13 珠海市微半导体有限公司 机器人走直线的控制方法和芯片及机器人
CN108274467B (zh) * 2018-01-24 2020-05-05 珠海市一微半导体有限公司 机器人走直线的控制方法和芯片及机器人
CN108345004A (zh) * 2018-02-09 2018-07-31 弗徕威智能机器人科技(上海)有限公司 一种移动机器人的人体跟随方法
CN109445466A (zh) * 2018-11-09 2019-03-08 浙江国自机器人技术有限公司 机器人跟随控制方法、系统、设备及计算机可读存储介质
CN109740462A (zh) * 2018-12-21 2019-05-10 北京智行者科技有限公司 目标的识别跟随方法
CN109740462B (zh) * 2018-12-21 2020-10-27 北京智行者科技有限公司 目标的识别跟随方法
CN110046831A (zh) * 2019-04-25 2019-07-23 上海快仓智能科技有限公司 跟随移动控制方法和装置
CN112351087A (zh) * 2020-10-29 2021-02-09 上海有个机器人有限公司 一种远程呼叫机器人的方法以及设备
CN112346460A (zh) * 2020-11-05 2021-02-09 泉州装备制造研究所 一种适用于多人场景的移动机器人自动跟随方法
CN112346460B (zh) * 2020-11-05 2022-08-09 泉州装备制造研究所 一种适用于多人场景的移动机器人自动跟随方法

Also Published As

Publication number Publication date
CN107544506B (zh) 2021-05-18

Similar Documents

Publication Publication Date Title
CN107544506A (zh) 机器人跟随方法、机器人以及存储介质
WO2019212818A3 (en) Robot navigation using 2d and 3d path planning
WO2023104207A1 (zh) 一种协同三维建图方法及系统
CN106313047A (zh) 一种基于Bezier样条的机器人实时拐角过渡方法
CN105204515B (zh) 无人机自主着陆的测量解析及控制方法和装置
CN105892493B (zh) 一种信息处理方法和移动装置
CN103596263B (zh) 一种室内定位中获取位置的方法及装置
CN105067011A (zh) 一种基于视觉标定及坐标转换的测量系统整体校准方法
CN105573143A (zh) 用于六自由度的工业机器人的逆运动学求解方法
CN105643619B (zh) 一种采用框架描述的工业机器人工具位姿控制方法
CN108326845A (zh) 基于双目相机和激光雷达的机器人定位方法、装置及系统
US20230316736A1 (en) Method for feature detection of complex defects based on multimodal data
CN103927744A (zh) 一种基于指向姿态的敏捷卫星观测目标条带分割方法
CN104239678B (zh) 一种实现干涉仪测向定位的方法和装置
CN103646377B (zh) 一种坐标转换方法及装置
CN105947239B (zh) 一种基于矢量投影的航天器光学敏感器视场分析方法
CN104154918A (zh) 单目视觉导航特征点丢失故障处理方法
Kim et al. Autonomous mobile robot localization and mapping for unknown construction environments
CN107085756A (zh) 计算公交站点覆盖叠加强度值的方法
CN107797556A (zh) 一种利用巡维机器人实现服务器启停的方法
CN101937577A (zh) 生成具有边界像素超采样效果的阴影的方法
CN104298345B (zh) 一种人机交互系统的控制方法
Su et al. Kinematic mechanism and path planning of the essboard
CN110901384B (zh) 无人车控制方法、装置、介质及电子设备
CN107330934A (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