CN104407622B - 机器人跟踪方法和*** - Google Patents

机器人跟踪方法和*** Download PDF

Info

Publication number
CN104407622B
CN104407622B CN201410287533.2A CN201410287533A CN104407622B CN 104407622 B CN104407622 B CN 104407622B CN 201410287533 A CN201410287533 A CN 201410287533A CN 104407622 B CN104407622 B CN 104407622B
Authority
CN
China
Prior art keywords
robot
tracking
target
optical signal
target robot
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.)
Active
Application number
CN201410287533.2A
Other languages
English (en)
Other versions
CN104407622A (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.)
Jiaxing Yunche Online Technology Co ltd
Original Assignee
Hangzhou Baowei Intelligent Technology 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 Hangzhou Baowei Intelligent Technology Co Ltd filed Critical Hangzhou Baowei Intelligent Technology Co Ltd
Priority to CN201410287533.2A priority Critical patent/CN104407622B/zh
Publication of CN104407622A publication Critical patent/CN104407622A/zh
Application granted granted Critical
Publication of CN104407622B publication Critical patent/CN104407622B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Landscapes

  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
  • Manipulator (AREA)

Abstract

本发明公开了一种机器人跟踪方法。所述方法包括:目标机器人发射光信号;跟踪机器人接收所述光信号,并确定所述目标机器人相对于所述跟踪机器人的相对方位;所述跟踪机器人根据所述相对方位,利用超声波进行测距得到与所述目标机器人之间的距离,并向所述目标机器人移动直至预设距离。本发明还相应公开了一种机器人跟踪***。应用本发明技术方案,能够在机器人教学、表演等应用场景中,降低实现定位跟踪的成本。

Description

机器人跟踪方法和***
技术领域
本发明涉及人工智能技术领域,特别是涉及一种机器人跟踪方法和***。
背景技术
随着人工智能技术的发展,机器人越来越多地应用到各种场景中。例如,目前已经出现了作为教学用途、娱乐用途的机器人,人们可以利用机器人进行节目表演等活动。
在机器人教学、表演的场景中,可能会出现一种机器人相互跟踪的需要。而目前的跟踪技术,首先必须定位,通常有基站定位、惯性定位等技术,而这些技术依赖无线基站等多种外设,实现成本比较高,应用在机器人教学、表演场景中定位跟踪效果并不理想。
发明内容
基于此,有必要提供一种机器人跟踪方法和***,能够在机器人教学、表演等应用场景中,降低实现定位跟踪的成本。
一种机器人跟踪方法,包括:
目标机器人发射光信号;
跟踪机器人接收所述光信号,并确定所述目标机器人相对于所述跟踪机器人的相对方位;
所述跟踪机器人根据所述相对方位,利用超声波进行测距得到与所述目标机器人之间的距离,并向所述目标机器人移动直至预设距离。
在一个实施例中,在所述目标机器人发射光信号的步骤之前,所述方法还包括:
预定义所述目标机器人和所述跟踪机器人;或
从两机器人中确定出所述目标机器人和所述跟踪机器人。
在一个实施例中,所述目标机器人发射光信号的步骤包括:
所述目标机器人通过安装在一自旋转装置上的光发射模块发射光信号。
在一个实施例中,所述方法还包括:
所述目标机器人进行编码,得到所述目标机器人对应的机器人标识,所述目标机器人通过安装在一自旋转装置上的光发射模块发射对应于所述机器人标识的光信号。
在一个实施例中,所述跟踪机器人接收所述光信号,并确定所述目标机器人相对于所述跟踪机器人的相对方位的步骤,包括:
所述跟踪机器人通过环绕在所述跟踪机器人四周的光接收模块接收所述光信号;
所述跟踪机器人根据所述光接收模块的位置,确定所述目标机器人相对于所述跟踪机器人的转角,所述转角为所述跟踪机器人超声波探测方向与所述目标机器人光信号发射方向的夹角。
在一个实施例中,所述跟踪机器人根据所述相对方位,利用超声波进行测距得到与所述目标机器人之间的距离,并向所述目标机器人移动至默认的距离的步骤,包括:
所述跟踪机器人根据所述转角进行转动,将超声波探测方向对准所述目标机器人,并进行测距;
所述跟踪机器人根据所述预设距离,基于PID算法,控制所述跟踪机器人向所述目标机器人移动。
在一个实施例中,所述方法还包括:
在所述跟踪机器人接收到所述目标机器人发射的光信号之后,所述跟踪机器人通过无线通信,通知所述目标机器人停止所述自旋转装置的自转;
在所述跟踪机器人向所述目标机器人移动过程中,所述跟踪机器人实时接收所述目标机器人发射的光信号,并基于PID算法,对所述转角进行修正。
在一个实施例中,所述光信号为红外光信号、紫外光信号、可见光信号中的任意一种。
在一个实施例中,所述跟踪机器人包括至少一个机器人。
在一个实施例中,所述目标机器人根据预定义的运动轨迹进行运动。
一种机器人跟踪***,包括目标机器人和跟踪机器人;所述目标机器人包括控制模块和光发射模块;所述跟踪机器人包括控制模块、光接收模块、超声波测距模块和机械运动模块;
所述目标机器人的光发射模块,用于发射光信号;
所述跟踪机器人的光接收模块,用于接收所述光信号;
所述跟踪机器人的控制模块,用于确定所述目标机器人相对于所述跟踪机器人的相对方位;
所述跟踪机器人的超声波测距模块,用于进行测距得到与所述目标机器人之间的距离;
所述跟踪机器人的控制模块,还用于控制所述机械运动模块,驱动所述跟踪机器人向所述目标机器人移动直至预设距离。
在一个实施例中,所述目标机器人和所述跟踪机器人均包括控制模块、光发射模块、光接收模块、超声波测距模块和机械运动模块;
所述目标机器人和所述跟踪机器人由程序预定义;或根据光信号接收的先后,从两机器人中确定出所述目标机器人和所述跟踪机器人。
在一个实施例中,所述光发射模块安装在所述目标机器人的一自旋转装置上。
在一个实施例中,所述目标机器人的控制模块还用于进行编码,得到所述目标机器人对应的机器人标识,并通过安装在自旋转装置上的光发射模块发射对应于所述机器人标识的光信号。
在一个实施例中,所述光接收模块为环绕在所述跟踪机器人四周的光接收模块;
所述跟踪机器人的控制模块,用于根据所述光接收模块的位置,确定所述目标机器人相对于所述跟踪机器人的转角,所述转角为所述跟踪机器人超声波探测方向与所述目标机器人光信号发射方向的夹角。
在一个实施例中,所述跟踪机器人的控制模块,还用于根据所述转角,控制所述跟踪机器人进行转动,将超声波探测方向对准所述目标机器人,并进行测距;
所述控制模块,还用于根据所述预设距离,基于PID算法,控制所述跟踪机器人向所述目标机器人移动。
在一个实施例中,所述目标机器人和所述跟踪机器人还包括无线通信模块;
在所述跟踪机器人接收到所述目标机器人发射的光信号之后,所述跟踪机器人通过无线通信模块,通知所述目标机器人停止所述自旋转装置的自转;
所述跟踪机器人在向所述目标机器人移动过程中,所述跟踪机器人的光接收模块,还用于实时接收光信号;所述跟踪机器人的控制模块,用于基于PID算法,对所述转角进行修正。
在一个实施例中,所述光发射模块,用于发射红外光信号、紫外光信号、可见光信号中的任意一种。
在一个实施例中,所述跟踪机器人包括至少一个机器人。
在一个实施例中,所述目标机器人还包括机械运动模块;
所述目标机器人的控制模块,还用于控制所述机械运动模块,根据预定义的运动轨迹进行运动。
上述机器人跟踪方法和***,目标机器人发射光信号,跟踪机器人接收到光信号,确定目标机器人相对于跟踪机器人的相对方位,再利用超声波进行测距,确定目标机器人位置,相对于基站定位元等方式,这里通过光信号和超声波进行定位,降低了实现成本。
附图说明
图1为一个实施例中的机器人跟踪方法的流程示意图;
图2为一个实施例中的机器人跟踪方法的流程示意图;
图3为一个实施例中的机器人跟踪方法的应用场景图;
图4为一个实施例中的机器人跟踪方法的流程示意图;
图5为一个实施例中的机器人跟踪方法的应用场景图;
图6为一个实施例中的机器人跟踪方法的时序图;
图7为一个实施例中基于PID算法对距离进行修正的示意图;
图8为一个实施例中的机器人跟踪方法的应用场景示意图;
图9为一个实施例中的机器人跟踪***的结构示意图;
图10为一个实施例中的机器人跟踪***的结构示意图。
具体实施方式
为了使本发明的目的、技术方案及优点更加清楚明白,以下结合附图及实施例,对本发明进行进一步详细说明。应当理解,此处所描述的具体实施例仅仅用以解释本发明,并不用于限定本发明。
参见图1,在一个实施例中,提供了一种机器人跟踪方法。该方法可以应用在室内、室外机器人表演或教学等应用场景中,在这些场景中,出于表演或教学的需求,机器人之间会作出相互跟踪的动作。在本实施例中,该方法包括下列流程:
步骤101,目标机器人发射光信号。
具体的,本实施例中的机器人跟踪是基于二维平面内的相互跟踪。在跟踪机器人跟踪目标机器人之间,跟踪机器人需要对目标机器人进行定位。目标机器人通过光发射模块发射出一定波长的光信号,根据波长的范围,该光信号可以是红外光信号、紫外光信号、可见光信号中的任意一种。当跟踪机器人接收到该波长范围的光信号,根据预先的约定,就可以确认是目标机器人所发出的光信号。
步骤102,跟踪机器人接收光信号,并确定目标机器人相对于跟踪机器人的相对方位。
具体的,跟踪机器人通过光接收模块接收目标机器人发射的光信号,该光接收模块接收光线的波长范围与目标机器人发射波长相对应。例如,目标机器人发射的光信号为红外光信号时,跟踪机器人的光接收模块接收波长范围为760nm至1mm,此时光接收模块可以选用PIR(Passive Infrared Detector,被动式红外探测器)或红外摄像头。同理,目标机器人也可以发射红、橙、黄、绿等单色可见光,跟踪机器人的光接收模块能够接收对应单色光,或者该光接收模块为通用的光接收器件,可接收整个可见光波长范围的光信号。跟踪机器人接收到目标机器人发射的光信号之后,可以根据光接收模块预先安放在跟踪机器人上的位置,来确定目标机器人相对于跟踪机器人的相对方位。例如,跟踪机器人可以但不限于通过环绕在跟踪机器人四周的多个光接收模块去接收光信号,例如跟踪机器人前、后、左、右方向各安装一个光接收模块,当后方的光接收模块接收到目标机器人发射的光信号,就可以确定目标机器人在跟踪机器人的“后方”。此外,在其它实施方式中,光接收模块之间还可以设置为更小的间隔角度,以提高相对方位判断的精确度。光接收模块还可以设置为环状结构光接收器件,在环状光接收器件上标记不同的方位角度,根据环状接收器件接收光信号的位置,就可以对应确定目标机器人相对于跟踪机器人的相对方位。
步骤103,跟踪机器人根据相对方位,利用超声波进行测距得到与目标机器人之间的距离,并向目标机器人移动直至预设距离。
具体的,在本实施例中,跟踪机器人确定目标机器人相对于跟踪机器人的相对方位后,利用超声波测距技术向该相对方位发射超声波,从而测量出目标机器人和跟踪机器人之间的距离,也就精确定位出目标机器人相对于跟踪机器人的位置。之后,跟踪机器人可以驱动自身的电机,向目标机器人进行移动直至预设距离。达到该预设距离后,跟踪机器人可以停止目标机器人,目标机器人停止发射光信号,降低能源消耗。此外,目标机器人和跟踪机器人都可以内置无线通信模块,当达到默认距离,跟踪机器人还可以通知目标机器人继续按照默认的运动轨迹运动一段距离,跟踪机器人再次进行跟踪,从而实现跟踪机器人和目标机器人之间的循环跟踪。
在本实施例中,目标机器人可以是静止的,也可以是按照默认的程序,根据预定义的运动轨迹进行运动。若目标机器人为静止的,跟踪机器人在定位目标机器人后,以直线向目标机器人进行移动。若目标机器人也是实时运动的,跟踪机器人依照默认的频率定位目标机器人,每一次定位瞬间可假定目标机器人为静止状态,并向目标机器人进行移动,从而最终跟踪机器人以曲线式向目标机器人进行靠近。
在本实施例中,目标机器人发射光信号,跟踪机器人接收到光信号,确定目标机器人相对于跟踪机器人的相对方位,再利用超声波进行测距,确定目标机器人位置,相对于基站定位等方式,这里通过光信号和超声波进行定位,降低了实现成本。
参见图2,在一个实施例中,提供了一种机器人跟踪方法。该方法可以应用在诸如室内、室外机器人表演或教学等应用场景中。在本实施例中,该方法包括:
步骤201,预定义目标机器人和跟踪机器人。
具体的,在一些机器人简单表演应用场景中,通常预先定义好目标机器人和跟踪机器人。如图3所示,301为被跟踪的目标机器人的平面俯视示意图,302为跟踪机器人的平面俯视示意图。目标机器人301和跟踪机器人302根据地位的不同,安装了不同的设备。目标机器人301内置了控制模块(图中未示出,例如可以是FPGA、CPLD等),并设有自旋转装置3011,在自旋转装置3011上方设置有光发射模块3012,光发射模块3012与控制模块电连接。当自旋转装置3011按照一定的角速度自转时,光发射模块3012就可以向不同方向发射光信号,该光信号可以但不限于是红外光信号。跟踪机器人内置控制模块(未示出),并且设有环绕在跟踪机器人四周的的多个光接收模块3021,跟踪机器人302还设有向某一方向(例如向跟踪机器人的前方)进行测距的超声波测距模块3022。当然,跟踪机器人设有机械运动模块,例如包含电机、滚轮等装置,能够使得跟踪机器人执行转向、移动等动作,从而跟踪目标机器人。目标机器人可以不设有机械运动模块,保持静止,也可以安装机械运动模块,从而能够根据预定义的运动轨迹进行运动。此外,目标机器人和跟踪机器人还可以进一步设置无线通信模块,进行交互。
步骤202,目标机器人发射光信号。
具体的,目标机器人301在发射光信号之间,由内置的控制模块按预先约定的编译码协议进行编码,得到目标机器人对应的机器人标识。目标机器人再通过安装在自旋转装置3011上的光发射模块3012发射对应于该机器人标识(电信号)的光信号。
步骤203,跟踪机器人接收光信号,并确定目标机器人相对于跟踪机器人的相对方位。
具体的,参见图3,跟踪机器人302通过环绕在跟踪机器人四周的多个光接收模块来接收光信号(在图中示意性绘出四个光接收模块)。当其中一个光接收模块3021接收到光信号后,跟踪机器人的控制模块依据编译码协议,将光信号转换为目标机器人的机器人标识,从而识别出接收到了目标机器人发出的光信号。此时,跟踪机器人根据接收到光信号的光接收模块3021的位置,以及自身超声波探测方向,确定出目标机器人相对于跟踪机器人的转角,如图3所示,该转角为跟踪机器人超声波探测方向与目标机器人光信号发射方向的夹角。
步骤204,跟踪机器人根据相对方位,利用超声波进行测距得到与目标机器人之间的距离,并向目标机器人移动直至预设距离。
具体的,如图3,跟踪机器人302确定目标机器人相对于跟踪机器人302的转角后,跟踪机器人302驱动机械运动模块根据该转角进行转动,将超声波探测方向对准目标机器人301,并进行定向测距,从而得到目标机器人301的相对位置。
跟踪机器人302确定目标机器人301的位置后,根据默认距离,基于PID(比例-积分-微分)算法,控制跟踪机器人向目标机器人进行移动。PID算法的原理图如图7所示,图中与目标距离的设定值(预设距离)为跟踪机器人跟踪到目标机器人的距离。e1(t)为预设距离与超声波测距模块测得的距离的差值,对该差值进行比例、积分、微分运算,近似认为输出与输入误差成比例关系,并消除***稳态误差、抑制误差的超前变化,从而控制电机使跟踪机器人向目标机器人前进相应的距离。
当达到预设距离后,跟踪机器人可以停止目标机器人,目标机器人停止发射光信号,降低能源消耗。
参见图4,在一个实施例中提供了另一种机器人跟踪方法。该方法包括:
步骤401,从两机器人中确定出目标机器人和跟踪机器人。
具体的,本实施例的应用场景图如图5所示,501为机器人A,502为机器人B。机器人A和机器人B具有相同的结构,都内置了控制芯片,分别设有自旋转装置5011和5021。自旋转装置5011上设有光发射模块5012,自旋转装置5021上设置了光发射模块5022。机器人A设有环绕机器人A的多个光接收模块5013,机器人B设有环绕机器人B的多个光接收模块5023。机器人A和机器人B分别设有定向测距的超声波测距模块5014和5024,测距方向例如可以是机器人的正面。机器人A和B都设有机械运动模块,能够在运动中相互跟踪。且机器人A和B设置了无线通信模块,能够在跟踪过程中进行无线交互。
从两机器人A和B中确定出目标机器人和跟踪机器人,可以按如下机制来实现:
机器人A和B的自旋转装置进行自转,其各自的控制模块进行编码,得到各自的机器人标识,光发射模块发射出对应于各自机器人标识的光信号。机器人A和B的光接收模块实时接收光信号。当某时刻,机器人B的光接收模块接收到机器人A发射的光信号,则机器人A作为目标机器人,机器人B作为跟踪机器人。同理,若机器人A接收到B发射的光信号,则机器人A作为跟踪机器人。在本实施例中,以机器人A为目标机器人,机器人B作为跟踪机器人,相反的情形,其工作原理类似,不再赘述。
步骤402,目标机器人发射光信号。
具体的,目标机器人(机器人A)发射的光信号被跟踪机器人(机器人B)接收到之后,跟踪机器人通过无线通信,通知目标机器人停止自旋转装置5011的自转,但目标机器人的光发射模块5014继续定向发射光信号。
步骤203,跟踪机器人接收光信号,并确定目标机器人相对于跟踪机器人的相对方位。
具体的,参见图5,跟踪机器人502通过环绕在跟踪机器人四周的多个光接收模块来接收光信号(在图中示意性绘出四个光接收模块)。当其中一个光接收模块5023接收到光信号后,跟踪机器人的控制模块依据编译码协议,将光信号转换为目标机器人的机器人标识,从而识别出接收到了目标机器人发出的光信号。此时,跟踪机器人根据接收到光信号的光接收模块5023的位置,以及自身超声波探测方向,确定出目标机器人相对于跟踪机器人的转角,如图5所示,该转角为跟踪机器人超声波探测方向与目标机器人光信号发射方向的夹角。
步骤204,跟踪机器人根据相对方位,利用超声波进行测距得到与目标机器人之间的距离,并向目标机器人移动直至预设距离。
具体的,如图5,跟踪机器人502确定目标机器人501相对于跟踪机器人502的转角后,跟踪机器人502驱动机械运动模块根据该转角进行转动,将超声波探测方向对准目标机器人501,并进行定向测距,从而得到目标机器人501的相对位置。
跟踪机器人502确定目标机器人501的位置后,根据默认距离,基于PID(比例-积分-微分)算法,控制跟踪机器人向目标机器人进行移动。PID算法的原理图如图7所示,图中与目标距离的设定值(预设距离)为跟踪机器人跟踪到目标机器人的距离。e1(t)为预设距离与超声波测距模块测得的距离的差值,对该差值进行比例、积分、微分运算,近似认为输出与输入误差成比例关系,并消除***稳态误差、抑制误差的超前变化,从而控制电机使跟踪机器人向目标机器人前进相应的距离。
在本实施例中,目标机器人501停止自旋转装置的自转,定向发射光信号,在跟踪机器人502向目标机器人501移动过程中,跟踪机器人502实时接收目标机器人501发射的光信号,并基于PID算法,对转角进行修正(PID算法的原理与图7类似,在此不详细分析)。本实施例中,基于PID算法,对距离和转角同时进行修正,保证了跟踪机器人502在运动过程中更加精确,从而不会走偏。
当达到预设距离后,跟踪机器人可以停止目标机器人,目标机器人停止发射光信号,降低能源消耗。此外,在其它可选的实施方式中,当达到预设距离后,跟踪机器人可以通过无线通信模块,通知目标机器人继续运动一段距离,跟踪机器人继续本实施例介绍的上述跟踪过程。
本实施例中的机器人跟踪方法,机器人A和机器人B的交互时序图,在图6中,机器人B先接收到机器人A发出的光(红外)信号,则机器人B作为跟踪机器人,机器人A作为目标机器人。反过来,若机器人A先接收到机器人B发出的光信号,则机器人A作为跟踪机器人,其交互时序与图6相类似,在此不作赘述。
如图6所示,机器人A与机器人B的交互时序包括:
601a,机器人A的自旋进行自转,同时发射红外信号(这里以红外信号为例,其它光谱信号也可以)。
601b,机器人B的自旋进行自转,同时发射红外信号。
602,机器人B接收到A发射的红外信号。
603,机器人B通过无线向A发送回应信号。
604a,机器人A接收到响应信号,停止自旋转装置的自转,但保持定向发射红外信号。
604b,机器人B根据接收到红外信号的光接收模块的位置,以及超声波探测方向,计算转角。
605,机器人B根据转角进行转动,将超声波探测方向对转机器人A。
606a,机器人A利用超声波进行定向测距。
606b,机器人B利用超声波进行定向测距。
607,机器人A和机器人B通过无线通信,比较测距结果,当误差在设定范围内,确定机器人A与B为正面相对,否则,返回601a和601b重新确定目标机器人和跟踪机器人,由此,进一步保证跟踪路径的精确,减少跟踪偏差。
608,机器人B根据预设距离(该距离,认为B已经追踪到A),基于PID算法向机器人A移动。
609,机器人B实时接收机器人A发射的红外信号,基于PID算法修正转角。
610,达到预设距离后,机器人B通过无线向机器人A发送确认信号。
611a,机器人A收到确认信号,停止发射红外信号。
611b,机器人B停止跟踪机器人A。
参见图8,在一个实施例中,提供了一种机器人跟踪方法的应用场景。在本实施例中,有一个目标机器人,跟踪机器人包括至少一个机器人:跟踪机器人1、跟踪机器人2......跟踪机器人n等。在本实施例中,跟踪机器人1至n按照不同时间段来跟踪目标机器人。例如,先由跟踪机器人1跟踪目标机器人,当跟踪机器人1与目标机器人达到默认距离后,跟踪机器人1停止运动。目标机器人通过无线通知跟踪机器人2继续上述跟踪......在本实施例中,跟踪机器人1至n对目标机器人进行跟踪,其原理与前述实施例相类似,在此不再赘述。
参见图9,在一个实施例中,提供了一种机器人跟踪***。该***包括目标机器人901和跟踪机器人902。目标机器人901包括控制模块9011和光发射模块9012。跟踪机器人包括控制模块9021、光接收模块9022、超声波测距模块9023和机械运动模块9024。在本实施例中,目标机器人901和跟踪机器人902还可以进一步包括无线通信模块9013和9025,用于两机器人之间的无线通信。目标机器人901的光发射模块9012,用于发射光信号。光发射模块9012可以但不限于安装在目标机器人901的一自旋转装置上,如此目标机器人901就可以按照一定的角速度向二维平面外发射光信号,以供跟踪机器人进行接收。目标机器人901通过光发射模块9012发射出一定波长的光信号,根据波长的范围,该光信号可以是红外光信号、紫外光信号、可见光信号中的任意一种。
跟踪机器人902的光接收模块9022,用于接收光信号。跟踪机器人902通过光接收模块9022接收目标机器人901发射的光信号,该光接收模块接收光线的波长范围与目标机器人发射波长相对应。例如,目标机器人发射的光信号为红外光信号时跟踪机器人的光接收模块接收波长范围为760nm至1mm,此时光接收模块可以选用PIR(Passive InfraredDetector,被动式红外探测器)或红外摄像头。同理,目标机器人也可以发射红、橙、黄、绿等单色可见光,跟踪机器人的光接收模块能够接收对应单色光,或者该光接收模块为通用的光接收器件,可接收整个可见光波长范围的光信号。
跟踪机器人902的控制模块9021,用于确定目标机器人901相对于跟踪机器人902的相对方位。跟踪机器人接收到目标机器人发射的光信号之后,可以根据光接收模块预先安放在跟踪机器人上的位置,来确定目标机器人相对于跟踪机器人的相对方位。例如,跟踪机器人可以但不限于通过环绕在跟踪机器人四周的多个光接收模块去接收光信号,例如跟踪机器人前、后、左、右方向各安装一个光接收模块,当后方的光接收模块接收到目标机器人发射的光信号,就可以确定目标机器人在跟踪机器人的“后方”。此外,在其它实施方式中,光接收模块之间还可以设置为更小的间隔角度,以提高相对方位判断的精确度。光接收模块还可以设置为环状结构光接收器件,在环状光接收器件上标记不同的方位角度,根据环状接收器件接收光信号的位置,就可以对应确定目标机器人相对于跟踪机器人的相对方位。
跟踪机器人902的超声波测距模块9023,用于进行测距。跟踪机器人902的控制模块9021,还用于控制机械运动模块9024,驱动跟踪机器人902向目标机器人901移动直至预设距离。跟踪机器人确定目标机器人相对于跟踪机器人的相对方位后,利用超声波测距技术向该相对方位发射超声波,从而测量出目标机器人和跟踪机器人之间的距离,也就精确定位出目标机器人相对于跟踪机器人的位置。之后,跟踪机器人可以驱动自身的电机,向目标机器人进行移动直至预设距离。达到该预设距离后,跟踪机器人可以通过无线通信模块9025发送通知信号给目标机器人的无线通信模块9013,目标机器人在收到通知信号后停止发射光信号,降低能源消耗。
参见图10,在一个实施例中,提供了一种机器人跟踪***。该机器人***包括目标机器人和跟踪机器人。目标机器人和跟踪机器人结构相同,均包括控制模块、光发射模块、光接收模块、超声波测距模块、机械运动模块和无线通信模块。目标机器人和跟踪机器人可以由程序预定义,或者根据光信号接收的先后,从两机器人中确定出目标机器人和跟踪机器人。
在本实施例中,光发射模块安装在目标机器人的一自旋转装置上。目标机器人的控制模块进行编码,得到目标机器人对应的机器人标识,并通过安装在自旋转装置上的光发射模块发射对应于机器人标识的光信号。
本实施例中,跟踪机器人的光接收模块为环绕在跟踪机器人四周的多个光接收模块。跟踪机器人在接收到目标机器人发射的光信号后,根据接收到光信号的光接收模块的位置以及超声波探测方向,确定目标机器人相对于跟踪机器人的转角,该转角为跟踪机器人超声波探测方向与目标机器人光信号发射方向的夹角。
跟踪机器人的控制模块,进一步根据转角,控制跟踪机器人进行转动,将超声波探测方向对准所述目标机器人,并利用超声波测距模块进行测距。
本实施例中,跟踪机器人的控制模块,还根据默认距离,基于PID算法,控制跟踪机器人向目标机器人移动。
可选的,在跟踪机器人接收到目标机器人发射的光信号之后,跟踪机器人通过无线通信模块,通知目标机器人停止自旋转装置的自转。在跟踪机器人在向目标机器人移动过程中,跟踪机器人的光接收模块,还用于实时接收光信号;跟踪机器人的控制模块,还用于基于PID算法,对转角进行修正。
本实施例中,目标机器人可以是静止,也可以由其控制模块,控制机械运动模块,根据预定义的运动轨迹进行运动。
在一个实施例中,跟踪机器人还可以包括至少一个机器人,不同的机器人在不同的时间段对目标机器人进行跟踪。
本领域普通技术人员可以理解实现上述实施例方法中的全部或部分流程,是可以通过计算机程序来指令相关的硬件来完成,所述的程序可存储于一计算机可读取存储介质中,该程序在执行时,可包括如上述各方法的实施例的流程。其中,所述的存储介质可为磁盘、光盘、只读存储内存(Read-Only Memory,ROM)或随机存储内存(Random AccessMemory,RAM)等。
以上所述实施例仅表达了本发明的几种实施方式,其描述较为具体和详细,但并不能因此而理解为对本发明专利范围的限制。应当指出的是,对于本领域的普通技术人员来说,在不脱离本发明构思的前提下,还可以做出若干变形和改进,这些都属于本发明的保护范围。因此,本发明专利的保护范围应以所附权利要求为准。

Claims (8)

1.一种机器人跟踪方法,其特征在于,所述方法包括:
目标机器人发射光信号;
跟踪机器人接收所述光信号,并确定所述目标机器人相对于所述跟踪机器人的相对方位;
所述跟踪机器人根据所述相对方位,利用超声波进行测距得到与所述目标机器人之间的距离,并向所述目标机器人移动直至预设距离;
在所述目标机器人发射光信号的步骤之前,所述方法还包括:
由程序预定义所述目标机器人和所述跟踪机器人;或根据光信号接收的先后,从两机器人中确定出所述目标机器人和所述跟踪机器人;
所述目标机器人和所述跟踪机器人之间进行无线通信。
2.根据权利要求1所述的方法,其特征在于,所述目标机器人发射光信号的步骤包括:
所述目标机器人通过安装在一自旋转装置上的光发射模块发射光信号;所述方法还包括:
所述目标机器人进行编码,得到所述目标机器人对应的机器人标识,所述目标机器人通过安装在一自旋转装置上的光发射模块发射对应于所述机器人标识的光信号。
3.根据权利要求2所述的方法,其特征在于,所述跟踪机器人接收所述光信号,并确定所述目标机器人相对于所述跟踪机器人的相对方位的步骤,包括:
所述跟踪机器人通过环绕在所述跟踪机器人四周的光接收模块接收所述光信号;
所述跟踪机器人根据所述光接收模块的位置,确定所述目标机器人相对于所述跟踪机器人的转角,所述转角为所述跟踪机器人超声波探测方向与所述目标机器人光信号发射方向的夹角。
4.根据权利要求3所述的方法,其特征在于,所述跟踪机器人根据所述相对方位,利用超声波进行测距得到与所述目标机器人之间的距离,并向所述目标机器人移动至默认的距离的步骤,包括:
所述跟踪机器人根据所述转角进行转动,将超声波探测方向对准所述目标机器人,并进行测距;
所述跟踪机器人根据所述预设距离,基于PID算法,控制所述跟踪机器人向所述目标机器人移动。
5.根据权利要求4所述的方法,其特征在于,所述方法还包括:
在所述跟踪机器人接收到所述目标机器人发射的光信号之后,所述跟踪机器人通过无线通信,通知所述目标机器人停止所述自旋转装置的自转;
在所述跟踪机器人向所述目标机器人移动过程中,所述跟踪机器人实时接收所述目标机器人发射的光信号,并基于PID算法,对所述转角进行修正。
6.根据权利要求1所述的方法,其特征在于,所述光信号为红外光信号、紫外光信号、可见光信号中的任意一种;所述跟踪机器人包括至少一个机器人。
7.根据权利要求1所述的方法,其特征在于,所述目标机器人根据预定义的运动轨迹进行运动。
8.一种机器人跟踪***,其特征在于,所述***包括目标机器人和跟踪机器人;所述目标机器人包括控制模块和光发射模块;所述跟踪机器人包括控制模块、光接收模块、超声波测距模块和机械运动模块;
所述目标机器人的光发射模块,用于发射光信号;
所述跟踪机器人的光接收模块,用于接收所述光信号;
所述跟踪机器人的控制模块,用于确定所述目标机器人相对于所述跟踪机器人的相对方位;
所述跟踪机器人的超声波测距模块,用于进行测距得到与所述目标机器人之间的距离;
所述跟踪机器人的控制模块,还用于控制所述机械运动模块,驱动所述跟踪机器人向所述目标机器人移动直至预设距离;
所述目标机器人和所述跟踪机器人均包括控制模块、光发射模块、光接收模块、超声波测距模块和机械运动模块;
所述目标机器人和所述跟踪机器人由程序预定义;或根据光信号接收的先后,从两机器人中确定出所述目标机器人和所述跟踪机器人;
所述目标机器人和所述跟踪机器人还均包括无线通信模块,用于两机器人之间的无线通信。
CN201410287533.2A 2014-06-24 2014-06-24 机器人跟踪方法和*** Active CN104407622B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201410287533.2A CN104407622B (zh) 2014-06-24 2014-06-24 机器人跟踪方法和***

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201410287533.2A CN104407622B (zh) 2014-06-24 2014-06-24 机器人跟踪方法和***

Publications (2)

Publication Number Publication Date
CN104407622A CN104407622A (zh) 2015-03-11
CN104407622B true CN104407622B (zh) 2017-05-03

Family

ID=52645260

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201410287533.2A Active CN104407622B (zh) 2014-06-24 2014-06-24 机器人跟踪方法和***

Country Status (1)

Country Link
CN (1) CN104407622B (zh)

Families Citing this family (13)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN104991560B (zh) * 2015-07-12 2018-08-14 仲恺农业工程学院 自主移动式智能机器人
CN105005306B (zh) * 2015-07-24 2017-08-25 杭州德宝威智能科技有限公司 机器人表演中复位方法
CN105487558A (zh) * 2015-12-24 2016-04-13 青岛海通机器人***有限公司 基于移动机器人的目标跟随***及方法
CN106054699A (zh) * 2016-06-02 2016-10-26 苏州杰姆斯特机械有限公司 一种基于微处理器远程ccd自动控制***
CN105955129A (zh) * 2016-06-02 2016-09-21 苏州杰姆斯特机械有限公司 一种基于lifi远程ccd机器人控制管理***
CN106197396B (zh) * 2016-06-27 2020-11-03 湖南云辙科技有限公司 一种基于光学信号发射和接收的定位导引***及方法
CN107200143A (zh) * 2017-06-08 2017-09-26 中国科学院半导体研究所 一种基于vlc的垂直起降飞行器盲降***
CN108107914B (zh) * 2017-11-14 2020-07-28 北京臻迪科技股份有限公司 浮游移动体、跟随***及控制方法
CN107976197A (zh) * 2017-12-03 2018-05-01 丁云广 一种移动平台组合导航方法
CN108267740B (zh) * 2018-01-03 2020-11-20 纳恩博(北京)科技有限公司 信息处理方法、超声波装置、移动设备和存储介质
CN110162056A (zh) * 2019-06-02 2019-08-23 安徽工业大学 一种光引导追踪装置及方法
CN110539821A (zh) * 2019-09-06 2019-12-06 燕山大学 一种带有自动循迹功能的小型气动四足机器人
CN117741602A (zh) * 2022-09-22 2024-03-22 华为终端有限公司 一种信号处理方法与电子设备

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN2569862Y (zh) * 2002-06-12 2003-09-03 汕头市龙湖区汕龙电子有限公司 一种跟踪玩具
CN1808169A (zh) * 2005-01-19 2006-07-26 北京创先泰克科技有限公司 自动测定两个物体间相对方向的***和实施方法
CN101014097A (zh) * 2006-10-17 2007-08-08 马涛 主动红外跟踪***
CN102305923A (zh) * 2011-07-29 2012-01-04 上海交通大学 微型机器人集群的相对定位方法
CN102608574A (zh) * 2012-03-20 2012-07-25 浙江大学 多智能体中两两之间的相对位置测量装置及方法

Family Cites Families (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US9283677B2 (en) * 2012-04-05 2016-03-15 Rethink Robotics, Inc. Visual indication of target tracking

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN2569862Y (zh) * 2002-06-12 2003-09-03 汕头市龙湖区汕龙电子有限公司 一种跟踪玩具
CN1808169A (zh) * 2005-01-19 2006-07-26 北京创先泰克科技有限公司 自动测定两个物体间相对方向的***和实施方法
CN101014097A (zh) * 2006-10-17 2007-08-08 马涛 主动红外跟踪***
CN102305923A (zh) * 2011-07-29 2012-01-04 上海交通大学 微型机器人集群的相对定位方法
CN102608574A (zh) * 2012-03-20 2012-07-25 浙江大学 多智能体中两两之间的相对位置测量装置及方法

Non-Patent Citations (1)

* Cited by examiner, † Cited by third party
Title
多传感器融合实现的机器人随动跟踪;赫明潇等;《第八届中国多智能体***与控制会议论文集》;20121010;第356-359页 *

Also Published As

Publication number Publication date
CN104407622A (zh) 2015-03-11

Similar Documents

Publication Publication Date Title
CN104407622B (zh) 机器人跟踪方法和***
US10816967B2 (en) Magic wand interface and other user interaction paradigms for a flying digital assistant
CN106598081B (zh) 一种图像采集方法及电子设备
Pugh et al. A fast onboard relative positioning module for multirobot systems
US11300650B2 (en) Apparatus and method for automatically orienting a camera at a target
CN106526537A (zh) 一种三维空间定位方法及***
CN105849579B (zh) 目标设备的定位方法和移动终端
WO2017166766A1 (zh) 一种信息处理方法和电子设备、计算机存储介质
US20190202067A1 (en) Method and device for localizing robot and robot
CN105352508A (zh) 机器人定位导航方法及装置
WO2015123966A1 (zh) 无线接入服务方法和设备
CN105931263A (zh) 一种目标跟踪方法及电子设备
CN106646380B (zh) 一种多基站空间定位方法和***
CN105979478B (zh) 一种定位方法和设备
CN107357310A (zh) 无人机飞行控制设备、***、方法和无人机控制方法
CN104486536A (zh) 一种自动影像拍摄***及其实现方法
EP2612208A1 (en) Mobile robot
US10976407B2 (en) Locating radio transmission source by scene reconstruction
CN104869312A (zh) 智能跟踪拍摄装置
CN104865846A (zh) 组合自主导航***的地面半物理仿真平台
CN104793618B (zh) 机器人表演定位阵列***、定位毯以及表演方法
WO2018094863A1 (zh) 一种定位方法、装置和计算机存储介质
US20160259030A1 (en) Methods, apparatuses and computer program products for calibration of antenna array
CN107290713A (zh) 一种室内定位方法及装置
CN107402571A (zh) 声音强度定位引导***及方法

Legal Events

Date Code Title Description
C06 Publication
PB01 Publication
C53 Correction of patent of invention or patent application
CB03 Change of inventor or designer information

Inventor after: Cheng Mingxuan

Inventor after: Zhang Hui

Inventor after: Ding Xiaogang

Inventor after: Yan Jianguo

Inventor before: Cheng Mingxuan

Inventor before: Yan Yifeng

Inventor before: Zhang Hui

Inventor before: Ding Xiaogang

Inventor before: Yan Jianguo

COR Change of bibliographic data

Free format text: CORRECT: INVENTOR; FROM: CHENG MINGXUAN YAN YIFENG ZHANG HUI DING XIAOGANG YAN JIANGUO TO: CHENG MINGXUAN ZHANG HUI DING XIAOGANG YAN JIANGUO

C10 Entry into substantive examination
SE01 Entry into force of request for substantive examination
TA01 Transfer of patent application right
TA01 Transfer of patent application right

Effective date of registration: 20170323

Address after: Room 19, building 101-37, No. 1399, Hao Rong Road, Yuhang District, Zhejiang, Hangzhou, China

Applicant after: HANGZHOU DEBAOWEI INTELLIGENT TECHNOLOGY CO.,LTD.

Address before: 314006 Zhejiang, South Lake District, Jiaxing No. 599 Middle Road, software park, building No. 2

Applicant before: JIAXING DOUBLEWELL MICROELECTRONICS. Ltd.

GR01 Patent grant
GR01 Patent grant
TR01 Transfer of patent right
TR01 Transfer of patent right

Effective date of registration: 20200903

Address after: Room 102-2, floor 1, building 42, Zhifu center, No. 966, Xiuyuan Road, Xiuzhou District, Jiaxing City, Zhejiang Province

Patentee after: JIAXING YUNQIE SUPPLY CHAIN MANAGEMENT Co.,Ltd.

Address before: Room 19, building 101-37, No. 1399, Hao Rong Road, Yuhang District, Zhejiang, Hangzhou, China

Patentee before: HANGZHOU DEBAOWEI INTELLIGENT TECHNOLOGY Co.,Ltd.

PE01 Entry into force of the registration of the contract for pledge of patent right
PE01 Entry into force of the registration of the contract for pledge of patent right

Denomination of invention: Robot tracking method and system

Effective date of registration: 20210819

Granted publication date: 20170503

Pledgee: Agricultural Bank of China Limited by Share Ltd. South Lake branch

Pledgor: JIAXING YUNQIE SUPPLY CHAIN MANAGEMENT Co.,Ltd.

Registration number: Y2021980008006

CP01 Change in the name or title of a patent holder
CP01 Change in the name or title of a patent holder

Address after: Room 102-2, 1st floor, building 42, Zhifu center, 966 Xiuyuan Road, Xiuzhou District, Jiaxing City, Zhejiang Province, 314031

Patentee after: Jiaxing Yunche Online Technology Co.,Ltd.

Address before: Room 102-2, 1st floor, building 42, Zhifu center, 966 Xiuyuan Road, Xiuzhou District, Jiaxing City, Zhejiang Province, 314031

Patentee before: JIAXING YUNQIE SUPPLY CHAIN MANAGEMENT CO.,LTD.