CN107466371A - 目标跟踪装置及系统、机器人 - Google Patents

目标跟踪装置及系统、机器人 Download PDF

Info

Publication number
CN107466371A
CN107466371A CN201680002739.3A CN201680002739A CN107466371A CN 107466371 A CN107466371 A CN 107466371A CN 201680002739 A CN201680002739 A CN 201680002739A CN 107466371 A CN107466371 A CN 107466371A
Authority
CN
China
Prior art keywords
signal
signal receiver
target
reception
time
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
CN201680002739.3A
Other languages
English (en)
Other versions
CN107466371B (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.)
Cloudminds Shanghai Robotics Co Ltd
Original Assignee
Cloudminds Shenzhen Robotics Systems 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 Cloudminds Shenzhen Robotics Systems Co Ltd filed Critical Cloudminds Shenzhen Robotics Systems Co Ltd
Publication of CN107466371A publication Critical patent/CN107466371A/zh
Application granted granted Critical
Publication of CN107466371B publication Critical patent/CN107466371B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S5/00—Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations
    • G01S5/18—Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations using ultrasonic, sonic, or infrasonic waves
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S13/00—Systems using the reflection or reradiation of radio waves, e.g. radar systems; Analogous systems using reflection or reradiation of waves whose nature or wavelength is irrelevant or unspecified
    • G01S13/66—Radar-tracking systems; Analogous systems
    • G01S13/70—Radar-tracking systems; Analogous systems for range tracking only
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S13/00—Systems using the reflection or reradiation of radio waves, e.g. radar systems; Analogous systems using reflection or reradiation of waves whose nature or wavelength is irrelevant or unspecified
    • G01S13/88—Radar or analogous systems specially adapted for specific applications
    • G01S13/881—Radar or analogous systems specially adapted for specific applications for robotics
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S15/00—Systems using the reflection or reradiation of acoustic waves, e.g. sonar systems
    • G01S15/02—Systems using the reflection or reradiation of acoustic waves, e.g. sonar systems using reflection of acoustic waves
    • G01S15/06—Systems determining the position data of a target
    • G01S15/08—Systems for measuring distance only
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S17/00—Systems using the reflection or reradiation of electromagnetic waves other than radio waves, e.g. lidar systems
    • G01S17/66—Tracking systems using electromagnetic waves other than radio waves
    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/12—Target-seeking control

Landscapes

  • Engineering & Computer Science (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Computer Networks & Wireless Communication (AREA)
  • Electromagnetism (AREA)
  • Automation & Control Theory (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Acoustics & Sound (AREA)
  • Robotics (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
  • Radar Systems Or Details Thereof (AREA)

Abstract

一种目标跟踪装置及系统、机器人，目标跟踪装置包括：信号接收天线(101)，所述信号接收天线(101)包括设置在不同位置处的第一信号接收器(1)和第二信号接收器(2)；计时单元(102)，与第一信号接收器(1)和第二信号接收器(2)相连，用于记录第一信号接收器(1)接收被跟踪目标发送的信号的接收时刻以及第二信号接收器(2)接收被跟踪目标发送的信号的接收时刻；跟踪单元(103)，与计时单元(102)相连，用于根据第一信号接收器(1)对应的接收时刻和第二信号接收器(2)对应的接收时刻生成对应的方位调整指令，使目标跟踪装置向接收信号时刻较早的信号接收器转动。目标跟踪装置、机器人及系统通过简单比较接收时刻即可调整好目标跟踪装置与被跟踪目标的方位，结构简单，方便实施。

Description

目标跟踪装置及系统、机器人
技术领域
本发明涉及人工智能技术领域，特别涉及一种目标跟踪装置及系统、机器人。
背景技术
随着人工智能技术的发展，将运动目标跟踪应用于移动机器人技术属于人工智能技术领域中一个重要的发展方向。在很多情况下，一种能够自动行走、跟踪用户的机器人可以帮助用户在诸如旅行、购物过程中搬运物品，使其免于搬运物品这种的体力劳动。
现有目标跟踪技术主要包括：基于视频图像处理的跟踪技术，以及基于无线信标定位的跟踪技术等。基于视频图像处理的跟踪技术需通过多个摄像装置采集周围环境信息，经过大量识别计算及空间计算才能确定被跟踪目标方位进行定位跟踪；基于无线信标定位的跟踪技术通过主动或被动识别信标进行定位跟踪时必须依赖于覆盖无线局域网的场景。
因此，现有技术不足在于：
现有目标跟踪装置系统复杂、需经过大量计算才能实现跟踪、依赖于特定场景，不便于实施。
发明内容
本发明实施例的一个目的是提出一种结构简单的目标跟踪装置及系统、机器人。
本发明实施例提供了一种目标跟踪装置，包括：
信号接收天线，所述信号接收天线包括设置在不同位置处的第一信号接收器和第二信号接收器；
计时单元，与第一信号接收器和第二信号接收器相连，用于记录第一信号接收器接收被跟踪目标发送的信号的接收时刻以及第二信号接收器接收被跟踪目标发送的信号的接收时刻；
跟踪单元，与计时单元相连，用于根据第一信号接收器对应的接收时刻和第二信号接收器对应的接收时刻生成对应的方位调整指令，使目标跟踪装置向接收信号时刻较早的信号接收器转动。
本发明实施例提供了一种机器人，包括：上述目标跟踪装置和与所述目标跟踪装置相连的驱动装置；
所述驱动装置，用于接收来自所述跟踪单元的指令，根据所述指令驱动所述机器人。
本发明实施例提供了一种目标跟踪系统，其特征在于，所述目标跟踪系统包括：上述目标跟踪装置和信标装置，
所述信标装置，用于发送所述信号。
有益效果如下：
本发明实施例通过在不同位置处设置第一信号接收器和第二信号接收器接收来自被跟踪目标的信号，并记录第一信号接收器接收被跟踪目标发送的信号的接收时刻以及第二信号接收器接收被跟踪目标发送的信号的接收时刻，通过比较两接收时刻调整目标跟踪装置方位。本发明实施例通过简单比较接收时刻即可调整好目标跟踪装置与被跟踪目标的方位，结构简单，且实施不依赖于特定场景，方便实施。
附图说明
下面将参照附图描述本发明的具体实施例，其中：
图1为本发明实施例中目标跟踪装置的结构示意图；
图2为本发明实施例中设置两个接收器的机器人的示意图；
图3为本发明实施例中设置三个接收器的机器人的示意图；
图4为本发明实施例中设置三个接收器的机器人正对被跟踪目标方位示意图。
具体实施方式
为了使本发明的技术方案及优点更加清楚明白，以下结合附图对本发明的示例性实施例进行进一步详细的说明，显然，所描述的实施例仅是本发明的一部分实施例，而不是所有实施例的穷举。并且在不冲突的情况下，本发明中的实施例及实施例中的特征可以互相结合。
发明人在发明过程中注意到：
现有跟踪技术多基于视频图像处理以及无线信标定位进行目标跟踪，存在结构或系统复杂度高、计算及测量量大，依赖于特定场景，不便于实施等问题。
基于此，本发明实施例提出了一种目标跟踪装置，下面进行说明。
图1为本发明实施例中目标跟踪装置的结构示意图，如1图所示，包括：
信号接收天线101，所述信号接收天线包括设置在不同位置处的第一信号接收器和第二信号接收器；
计时单元102，与第一信号接收器和第二信号接收器相连，用于记录第一信号接收器接收被跟踪目标发送的信号的接收时刻以及第二信号接收器接收被跟踪目标发送的信号的接收时刻；
跟踪单元103，与计时单元相连，用于根据第一信号接收器对应的接收时刻和第二信号接收器对应的接收时刻生成对应的方位调整指令，使目标跟踪装置向接收信号时刻较早的信号接收器转动。
本发明实施例通过简单比较接收时刻即可调整好目标跟踪装置与被跟踪目标的方位，结构简单，且实施不依赖于特定场景，方便实施。
实施中，信号接收天线可包括设置在不同位置处的两个、三个、四个或者更多个信号接收器。并且目标跟踪装置的信号接收天线在设定时间内接收不到来自被跟踪目标的信号时，可进行报警提示，以便目标方获知目标跟踪装置是否于正常工作状态中，以便目标方及时解决目标跟踪装置无法进行目标跟踪的问题，以避免带来不必要的损失及麻烦。
具体实施中，信号接收天线包括设置在不同位置处的第一信号接收器和第二信号接收器，各信号接收器均接收来自被跟踪目标的信号；计时单元记录各信号接收器接收被跟踪目标发送的信号的接收时刻；跟踪单元根据第一信号接收器对应的接收时刻和第二信号接收器对应的接收时刻生成对应的方位调整指令，使目标跟踪装置向接收信号时刻较早的信号接收器转动。
实施中，可通过比较第一信号接收器对应的接收时刻和第二信号接收器对应的接收时刻，调整目标跟踪装置向接收信号时刻较早的信号接收器转动。
实施中，第一信号接收器和第二信号接收器可位于同一水平线上。不难理解的是，这里所指的位于同一水平线上是指在正常的工作状态下，第一信号接收器和第二信号接收器位于同一水平先上。这样设置，能够使得目标跟踪装置能够在水平方向上左右转动，实现对目标跟踪装置水平方向上的跟踪。
实施中，跟踪单元用于根据第一信号接收器对应的接收时刻和第二信号接收器对应的接收时刻生成对应的方位调整指令可包括：在第一信号接收器对应的接收时刻和第二信号接收器对应的接收时刻之间的时长大于预设时长时，生成对应的方位调整指令。
需要指出的是，理想状态下，第一信号接收器对应的接收时刻和第二信号接收器对应的接收时刻相等时，实现目标跟踪装置与被跟踪目标正对，但考虑到实施中，信号传播过程中可能存在损耗导致接收信号的时刻存在误差，或者用户根据具体情况可能设定目标跟踪装置与被跟踪目标的相对方位的允许误差等因素，因此，本提案实施例中可通过确定第一信号接收器对应的接收时刻和第二信号接收器对应的接收时刻之间的时长是否满足预设时长来限定目标跟踪装置的调整，在目标跟踪装置与被跟踪目标的相对方位角度大于可接受的误差角度时才对目标跟踪装置进行方位调整，在小于或等于受的误差角度时无需对目标跟踪装置进行调整，即已正对被跟踪目标。此外，生成对应的方位调整指令也可使目标跟踪装置向接收信号时刻较晚的信号接收器转动，或使目标跟踪装置向与被跟踪目标预设的方位进行转动。
实施中，跟踪单元根据第一信号接收器对应的接收时刻和第二信号接收器对应的接收时刻生成对应的方位调整指令可包括：在第一信号接收器对应的接收时刻和第二信号接收器对应的接收时刻之间的时长为第一时长时，生成第一方位调整指令；在第一信号接收器对应的接收时刻和第二信号接收器对应的接收时刻之间的时长为第二时长时，生成第二方位调整指令；其中所述第一时长大于所述第二时长，所述第一方位调整指令所指示调整的角度大于所述第二方位调整指令所指示的角度。
具体实施中，考虑到目标跟踪装置与被跟踪目标的相对方位可能存在偏离较大或较小的情况，本发明实施中可设置第一时长及第二时长，并设置第一时长大于第二时长，第一方位调整指令所指示调整的角度大于第二方位调整指令所指示的角度。在确定第一信号接收器对应的接收时刻和第二信号接收器对应的接收时刻之间的时长为第一时长时，判别出需要调整目标跟踪装置方位，生成第一方位调整指令，使目标跟踪装置以第一方位调整指令所指示调整的角度进行调整转动；在确定第一信号接收器对应的接收时刻和第二信号接收器对应的接收时刻之间的时长为第二时长时，判别出需要调整目标跟踪装置方位，生成第二方位调整指令，使目标跟踪装置以第二方位调整指令所指示调整的角度进行调整转动。
例如，被跟踪目标在目标跟踪装置的北偏东40°方位，跟踪单元在确定第一信号接收器对应的接收时刻和第二信号接收器对应的接收时刻之间的时长为第一时长，判别需要调整目标跟踪装置方位，生成第一方位调整指令，使目标跟踪装置以第一方位调整指令所指示调整的角度(例如5°)进行调整转动，继续判别出第一信号接收器对应的接收时刻和第二信号接收器对应的接收时刻之间的时长为第二时长，判别需要调整目标跟踪装置方位，生成第二方位调整指令，使目标跟踪装置以第二方位调整指令所指示调整的角度(例如1°)进行调整转动，直至第一信号接收器对应的接收时刻和第二信号接收器对应的接收时刻相等，完成对目标跟踪装置的方位调整。
此外，由于被跟踪目标可随意移动，目标跟踪装置的方位可根据第一信号接收器和第二信号接收器对应的实时接收时刻进行调整。由于具体的实施场景或精度要求有所不同，第一时长，第二时长，第一方位调整指令所指示调整的角度以及第二方位调整指令所指示调整的角度可根据具体实施情况进行设置。
实施中，当目标跟踪装置具有用于搬运货物或载人的部件时，使目标跟踪装置向接收信号时刻较早的信号接收器转动可以为：将具有用于搬运货物或载人的部件向接收信号时刻较早的信号接收器转动，例如，若目标跟踪装置与具有用于搬运货物或载人的部件为固定不可调节设置时，将目标跟踪装置与具有用于搬运货物或载人的部件整体调整，使具有用于搬运货物或载人的部件向接收信号时刻较早的信号接收器转动；若目标跟踪装置与具有用于搬运货物或载人的部件为可调节设置时，目标跟踪装置将具有用于搬运货物或载人的部件调整，使该部件向接收信号时刻较早的信号接收器转动。
实施中，信号接收天线包括第三信号接收器，所述第三信号接收器与所述第一信号接收器和所述第二信号接收器位于同一直线上，且与所述第一信号接收器的距离和所述第三信号接收器与所述第二信号接收器的距离相等；所述计时单元与所述第三信号接收器相连，进一步用于记录所述第三信号接收器接收所述被跟踪目标发送的信号的接收时刻；所述跟踪单元，进一步用于根据相邻信号接收器对应的接收时刻确定所述目标跟踪装置与所述被跟踪目标的距离，并生成位置调整指令，使所述目标跟踪装置向所述被跟踪目标移动。
具体实施中，目标跟踪装置的信号接收器的较佳间距为50mm。当然，目标跟踪装置的信号接收器也可设置同一曲线(如圆弧)。此外，目标跟踪装置的接收器间距优选为50mm，理论上，间距为50mm时，目标跟踪装置与被跟踪目标距离10m左右可以达到2cm的精度，目标跟踪装置与被跟踪目标距离5m左右可以达到1cm的精度，非常适用作短距离小范围定位跟随。
当然，对于至少两个接收位置间距选取50mm，本领域技术人员应该知道，该参数非本发明实施例中唯一可选取的数值，其可根据具体实施情况进行选取，例如，可选取40mm、100mm或500mm等，因此，在不脱离本发明构思的前提下,进行任何可能的变化或替换,均属于本发明的保护范围。
需要指出的是，在实际应用中，为了使目标跟踪装置与被跟踪目标的距离保持在预设的距离范围内，也可以通过其他的方式进行实现，例如，接收的信号强度，例如，可以在接收的信号的强度低于预设的强度时，认为机器人与被跟踪目标的距离较大，此时可以使得机器人朝向被跟踪目标移动，保证机器人能够接收到被跟踪目标的信号。
因此，具体实施中，跟踪单元，可进一步用于根据所述信号接收器接收的信号的强度确定所述目标跟踪装置与所述被跟踪目标的距离，并生成位置调整指令，使所述目标跟踪装置向所述被跟踪目标移动。具体地，当跟踪单元判别接收器接收到的信号弱时进行位置调整，例如，在判别到接收到的信号强度小于等于预设强度，生成位置调整指令，使所述目标跟踪装置向所述被跟踪目标移动。
实施中，使所述目标跟踪装置向所述被跟踪目标移动可以包括：使所述目标跟踪装置向所述被跟踪目标移动至与所述被跟踪目标的距离小于等于设定距离。
具体实施中，目标跟踪装置与被跟踪目标保持一定距离或一定距离内进行跟踪，具体可以包括如下情况：当目标跟踪装置和被跟踪目标之间的距离大于预设距离，目标跟踪装置向被跟踪目标方向移动；当目标跟踪装置和被跟踪目标之间的距离等于预设距离，目标跟踪装置不移动；当目标跟踪装置和被跟踪目标之间的距离小于预设距离，目标跟踪装置向被跟踪目标反向移动或不移动。此外，目标跟踪装置移动时可结合实际路况信息规划合理方向移动路线。目标跟踪装置与被跟踪目标之间的距离也可通过其他方式确定，例如红外线测距、超声波测距、激光测距、电磁波测距等。
实施中，所述跟踪单元与所述信号接收天线相连，进一步用于识别所述信号接收器接收的信号中的标识信息，以确定所述信号接收器接收的信号来自所述目标跟踪装置对应的被跟踪目标。其中，标识信息可以为唯一标识，使目标跟踪装置识别唯一被跟踪目标，以便明确被跟踪目标；也可为非唯一标识，使目标跟踪装置识别同组被跟踪目标，经过相关算法排序或人为设定选择被跟踪目标组中相应被跟踪目标进行跟踪。在实际跟踪过程中，同一场景下，可能存在多个被跟踪目标发送信号或者其他用途信号，因此，目标跟踪装置可能接收到多路干扰信号，本发明实施例中通过识别接收信号中的跟标识信息，确定正确的被跟踪目标可进行准确跟踪。
实施中，信号接收天线接收的信号可以为超声波信号。当然还可以为其他无线信号，如红外线信号、射频信号等
现有技术中大多基于视频图像处理以及无线信标定位进行目标跟踪，需通过实时获取周围视频图像，进行被跟踪目标与环境背景识别计算，空间位置计算以及被跟踪目标移动速度计算等大量测量计算，系统复杂度高，或依赖于特定场景，导致现有目标跟踪装置结构系统复杂、不便于实施。相较于现有技术，本发明实施例中提供的目标跟踪装置利用两个接收器接收信号，通过简单比较接收时刻即可调整好目标跟踪装置与被跟踪目标的方位，结构简单，方便实施。
基于同一发明构思，本发明实施例中还提供了一种机器人，由于解决问题的原理与一种目标跟踪装置相似，因此该机器人的实施可以参见装置的实施，重复之处不再赘述。
本发明实施例中提供了一种机器人，该机器人包括：上述目标跟踪装置和与目标跟踪装置相连的驱动装置，所述驱动装置，用于接收来自所述跟踪单元的指令，根据所述指令驱动所述机器人。
可以理解的是，通过使得驱动装置根据所述指令驱动所述机器人，能够使得机器人在方向(和距离)上实现对被跟踪目标的跟踪。
在具体实施时，这里的驱动装置可以具体是指能够驱动该机器人产生相应的动作的装置，比如马达等，在具体实施时，这里所指的驱动机器人可以是指驱动目标跟踪装置之外的其他结构，也可以是指驱动目标跟踪装置中的结构，比如可以驱动用于支撑信号接收器的支撑结构等。
基于同一发明构思，本发明实施例中还提供了一种目标跟踪系统，由于解决问题的原理与一种目标跟踪装置相似，因此该系统的实施可以参见装置的实施，重复之处不再赘述。
发明实施例中提供了一种目标跟踪系统，该目标跟踪系统包括：上述目标跟踪装置和信标装置，所述信标装置，用于发送所述信号。
实施中，信标装置用于发送的信号为超声波信号，信标装置通常配置在被跟踪目标上，还可用于发射其他无线信号，如红外线信号、射频信号等。目标跟踪装置用于接收信标装置发射的无线信号，并根据其上不同位置接收信号的时刻确定是否进行调整，如需要则调整自身的方向和/或位置。
具体实施中，目标跟踪装置包括：信号接收天线，与信号接收天线相连的计时单元；以及与计时单元相连的跟踪单元。
其中，信号接收天线包括设置在不同位置处的第一信号接收器和第二信号接收器。接收器用于接收信标装置发射的无线信号。实施中可以在目标跟踪装置上设置两个、三个、四个或者更多个信号接收器。
计时单元，用于记录第一信号接收器接收被跟踪目标发送的信号的接收时刻以及第二信号接收器接收被跟踪目标发送的信号的接收时刻。
跟踪单元，用于根据第一信号接收器对应的接收时刻和第二信号接收器对应的接收时刻生成对应的方位调整指令，如需要则发出方位调整指令，使目标跟踪装置向接收信号时刻较早的信号接收器转动。
在一个较佳实施例中，信号接收器也可以与控制单元连接，用于将接收到的信号中携带的信息传送给控制单元，如标识信息。
在另一较佳实施例中，上述目标跟踪装置中的信号接收器也可以集成在一个信号接收器件上。
上述各实施例中，信号接收器向控制单元传送信息、计时单元记录接收的时刻信息，以及控制单元具根据时刻信息确定是否需要进行方位或位置调整等的方案详见上述装置实施例。
为了便于本发明的实施，下面以具体实例进一步说明。
实例一：
本实例以设置两个信号接收器的目标跟踪机器人为例进行说明，图2为本发明实施例中设置两个接收器的机器人的示意图，其示出了本实例中机器人上的信号接收器1和信号接收器2的位于同一水平线上，假设被跟踪目标携带信标装置A，该信标装置A发送的信号为超声波信号。
首先，信标装置A发送超声波信号，机器人上设置的两个接收器接收该信号，同时机器人的计时单元记录两个信号接收器接收信标装置A发送的信号的接收时刻，其中，记录信号接收器1接收的时刻为t1，信号接收器2接收的时刻为t2，并将时刻信息告知机器人的跟踪单元，跟踪单元通过比较t1与t2，判别出t1晚于t2，生成对应的方位调整指令，使机器人向接收信号时刻较早的信号接收器2转动，然后，机器人进行下一次信号的接收与比较判别，若t1仍晚于t2，继续调整机器人的方位，使机器人向接收信号时刻较早的信号接收器2继续转动，直至t1等于t2或者t1与t2之间的时长满足预设时长时，停止方位调整，实现机器人正对被跟踪目标方向。
机器人的跟踪单元通过判别信号接收器接收信号的信号强度，生成位置调整指令，使所述目标跟踪装置向所述被跟踪目标移动。例如，跟踪单元通过判别接收器接收信号的信号强度小于等于设定强度，生成位置调整指令，使所述目标跟踪装置向所述被跟踪目标移动，直至信号强度大于设定强度，停止目标跟踪装置向所述被跟踪目标移动。
实例二：
本例以设置三个接收器的目标跟踪机器人为例进行说明，图3为本发明实施例中设置三个接收器的机器人的示意图，其示出了本实例中机器人上的信号接收器a，信号接收器b以及信号接收器c等间距的摆放，且设置在同一水平线上。假设被跟踪目标携带信标装置B，其发送的信号为超声波信号。
首先，信标装置B发送超声波信号，机器人上设置的三个信号接收器接收该信号，同时机器人的计时单元记录三个信号接收器接收信标装置B发送的信号的接收时刻，其中，记录接收器a接收的时刻为ta，接收器b接收的时刻为tb，接收器c接收的时刻为tc，并将时刻信息告知机器人的跟踪单元，跟踪单元确定接收器a与接收器b接收信号的的接收时刻之间的时长为ta-tb，接收器c与接收器b接收信号的的接收时刻之间的时长为tc-tb，且判别出ta-tb与tc-tb的时长差值大于预设时长差值。
然后，将机器人的方向朝接收信号时刻最早的接收器c方向进行调整，确定下一次接收到的超声波信号的接收器a、接收器b、接收器c间接收信号的接收时刻的时长ta-tb与tc-tb，若判别出ta-tb与tc-tb的时长差值仍大于预设时长差值，继续将机器人的方向朝接收信号时刻最早的接收器c方向进行调整，如此持续判别调整，直至ta-tb与tc-tb的时长差值小于等于预设时长差值，实现机器人正对被跟踪目标方向，即如图4所示机器人正对被跟踪目标。
图4为本发明实施例中设置三个接收器的机器人正对被跟踪目标方位示意图，其示出，接收器a、接收器b、接收器c等距摆放的间距为d，信标装置B到机器人上接收器a的直线距离为e，信标装置B到机器人上接收器b的直线距离为f，信标装置B到机器人上接收器a的直线距离e与信标装置B到机器人上接收器b的直线距离f的差值为s，即s＝e-f。
在机器人正对被跟踪目标情况下，可通过接收器接收被跟踪目标发送的信号的接收时刻之间的时长确定机器人与被跟踪目标的相对距离，这里以接收器a与接收器b接收信号的接收时刻之间的时长ta-tb为例，考虑到此时信号为超声波信号，超声波在空气中的传播速度为340m/s(0.00034mm/ns)，可计算出s＝(ta-tb)*0.00034。由于机器人方向调整为正对被跟踪目标方向，根据直角三角形的勾股定理，可知e2＝f2+d2，且由上述可知e＝f+s，即(f+s)2＝f2+d2，从而可计算出f＝(d2-s2)/2s，即可计算出机器人与被跟踪目标之间的距离。为了使机器人可实时确定与被跟踪目标之间的距离，可在机器人安装公式编辑器进行实时距离计算。在计算出机器人与被跟踪目标之间的距离后，机器人向被跟踪目标移动至预设距离从而实现目标跟踪。
上述实例中，在机器人调整时，采取先进行方位调整，后进行距离调整的调整方式。在具体实施中，可不局限于上述实例中的方位调整方式，例如，可先距离调整，后进行方位调整，或者同时进行方位与距离的调整。具体方位调整方式，可以依据实际情况进行自由选取。
本发明实施例中提供的目标跟踪方案在不同位置处设置的第一信号接收器和第二信号接收器；记录第一信号接收器接收被跟踪目标发送的信号的接收时刻以及第二信号接收器接收被跟踪目标发送的信号的接收时刻；根据第一信号接收器对应的接收时刻和第二信号接收器对应的接收时刻生成对应的方位调整指令，使目标跟踪装置向接收信号时刻较早的信号接收器转动。通过简单比较接收时刻即可调整好目标跟踪装置与被跟踪目标的方位，结构简单，且实施不依赖于特定场景，方便实施。
本领域内的技术人员应明白，本发明的实施例可提供为装置、系统、或计算机程序产品。因此，本发明可采用完全硬件实施例、完全软件实施例、或结合软件和硬件方面的实施例的形式。而且，本发明可采用在一个或多个其中包含有计算机可用程序代码的计算机可用存储介质(包括但不限于磁盘存储器、CD-ROM、光学存储器等)上实施的计算机程序产品的形式。
本发明是参照根据本发明实施例的方法、装置(系统)、和计算机程序产品的流程图和/或方框图来描述的。应理解可由计算机程序指令实现流程图和/或方框图中的每一流程和/或方框、以及流程图和/或方框图中的流程和/或方框的结合。可提供这些计算机程序指令到通用计算机、专用计算机、嵌入式处理机或其他可编程数据处理装置的处理器以产生一个机器，使得通过计算机或其他可编程数据处理装置的处理器执行的指令产生用于实现在流程图一个流程或多个流程和/或方框图一个方框或多个方框中指定的功能的装置。
这些计算机程序指令也可存储在能引导计算机或其他可编程数据处理装置以特定方式工作的计算机可读存储器中，使得存储在该计算机可读存储器中的指令产生包括指令装置的制造品，该指令装置实现在流程图一个流程或多个流程和/或方框图一个方框或多个方框中指定的功能。
这些计算机程序指令也可装载到计算机或其他可编程数据处理装置上，使得在计算机或其他可编程装置上执行一系列操作步骤以产生计算机实现的处理，从而在计算机或其他可编程装置上执行的指令提供用于实现在流程图一个流程或多个流程和/或方框图一个方框或多个方框中指定的功能的步骤。
尽管已描述了本发明的优选实施例，但本领域内的技术人员一旦得知了基本创造性概念，则可对这些实施例作出另外的变更和修改。所以，所附权利要求意欲解释为包括优选实施例以及落入本发明范围的所有变更和修改。

Claims (11)

1.一种目标跟踪装置，其特征在于，所述装置包括：
信号接收天线，所述信号接收天线包括设置在不同位置处的第一信号接收器和第二信号接收器；
计时单元，与第一信号接收器和第二信号接收器相连，用于记录第一信号接收器接收被跟踪目标发送的信号的接收时刻以及第二信号接收器接收被跟踪目标发送的信号的接收时刻；
跟踪单元，与计时单元相连，用于根据第一信号接收器对应的接收时刻和第二信号接收器对应的接收时刻生成对应的方位调整指令，使目标跟踪装置向接收信号时刻较早的信号接收器转动。
2.如权利要求1所述的装置，其特征在于，所述第一信号接收器和第二信号接收器位于同一水平线上。
3.如权利要求1或2所述的装置，其特征在于，所述跟踪单元用于根据第一信号接收器对应的接收时刻和第二信号接收器对应的接收时刻生成对应的方位调整指令包括：
在第一信号接收器对应的接收时刻和第二信号接收器对应的接收时刻之间的时长大于预设时长时，生成对应的方位调整指令。
4.如权利要求1所述的装置，其特征在于，所述跟踪单元根据第一信号接收器对应的接收时刻和第二信号接收器对应的接收时刻生成对应的方位调整指令包括：
在第一信号接收器对应的接收时刻和第二信号接收器对应的接收时刻之间的时长为第一时长时，生成第一方位调整指令；在第一信号接收器对应的接收时刻和第二信号接收器对应的接收时刻之间的时长为第二时长时，生成第二方位调整指令；其中所述第一时长大于所述第二时长，所述第一方位调整指令所指示调整的角度大于所述第二方位调整指令所指示的角度。
5.如权利要求1至4中任一所述的装置，其特征在于，所述信号接收天线包括第三信号接收器，所述第三信号接收器与所述第一信号接收器和所述第二信号接收器位于同一直线上，且与所述第一信号接收器的距离和所述第三信号接收器与所述第二信号接收器的距离相等；
所述计时单元与所述第三信号接收器相连，进一步用于记录所述第三信号接收器接收所述被跟踪目标发送的信号的接收时刻；
所述跟踪单元，进一步用于根据相邻信号接收器对应的接收时刻确定所述目标跟踪装置与所述被跟踪目标的距离，并生成位置调整指令，使所述目标跟踪装置向所述被跟踪目标移动。
6.如权利要求1至4中任一所述的装置，其特征在于，所述跟踪单元，进一步用于根据所述信号接收器接收的信号的强度确定所述目标跟踪装置与所述被跟踪目标的距离，并生成位置调整指令，使所述目标跟踪装置向所述被跟踪目标移动。
7.如权利要求5或6所述的装置，其特征在于，所述使所述目标跟踪装置向所述被跟踪目标移动包括：
使所述目标跟踪装置向所述被跟踪目标移动至与所述被跟踪目标的距离小于等于设定距离。
8.如权利要求1至7中任一所述的装置，其特征在于，所述跟踪单元与所述信号接收天线相连，进一步用于识别所述信号接收器接收的信号中的标识信息，以确定所述信号接收器接收的信号来自所述目标跟踪装置对应的被跟踪目标。
9.如权利要求1至8中任一所述的装置，其特征在于，所述信号为超声波信号。
10.一种机器人，其特征在于，所述机器人包括：权利要求1至9中任一所述的目标跟踪装置和与所述目标跟踪装置相连的驱动装置；
所述驱动装置，用于接收来自所述跟踪单元的指令，根据所述指令驱动所述机器人。
11.一种目标跟踪系统，其特征在于，所述目标跟踪系统包括：权利要求1至9中任一所述的目标跟踪装置和信标装置，
所述信标装置，用于发送所述信号。
CN201680002739.3A 2016-07-21 2016-07-21 目标跟踪装置及系统、机器人 Active CN107466371B (zh)

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
PCT/CN2016/090792 WO2018014275A1 (zh) 2016-07-21 2016-07-21 目标跟踪装置及系统、机器人

Publications (2)

Publication Number Publication Date
CN107466371A true CN107466371A (zh) 2017-12-12
CN107466371B CN107466371B (zh) 2021-08-13

Family

ID=60545964

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201680002739.3A Active CN107466371B (zh) 2016-07-21 2016-07-21 目标跟踪装置及系统、机器人

Country Status (2)

Country Link
CN (1) CN107466371B (zh)
WO (1) WO2018014275A1 (zh)

Cited By (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN110245546A (zh) * 2018-12-06 2019-09-17 浙江大华技术股份有限公司 一种目标跟踪系统、方法及存储介质
CN110806755A (zh) * 2018-08-06 2020-02-18 中兴通讯股份有限公司 一种无人机跟踪拍摄方法、终端及计算机可读存储介质
CN114739328A (zh) * 2022-04-11 2022-07-12 莱赛激光科技股份有限公司 测量地面起伏的传感装置及地坪平整度测量机器人

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101226405A (zh) * 2008-01-18 2008-07-23 浙江工业大学 基于超声波源的二维定位控制系统
CN201266322Y (zh) * 2008-09-27 2009-07-01 苏州大学 超声波目标定位与跟踪装置
CN104020446A (zh) * 2014-06-13 2014-09-03 上海申磬产业有限公司 一种智能护理床中自主导航定位系统及定位导航方法
CN104991557A (zh) * 2015-07-02 2015-10-21 深圳乐行天下科技有限公司 一种自主跟随小车及其系统
CN105094152A (zh) * 2015-07-09 2015-11-25 深圳大学 超声波目标跟踪设备、方法和装置

Family Cites Families (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US9063218B2 (en) * 2009-11-04 2015-06-23 Gamesontrack A/S Positioning system and method
CN103914075B (zh) * 2013-12-13 2017-05-03 深圳市大疆创新科技有限公司 一种无人飞行器的控制方法及装置
CN103809174B (zh) * 2014-03-13 2016-10-05 丁一 自动跟随方法及装置
CN104049633B (zh) * 2014-06-13 2017-05-10 深圳市宇恒互动科技开发有限公司 一种随动控制方法、随动装置及随动系统
CN105357484A (zh) * 2015-11-20 2016-02-24 西安斯凯智能科技有限公司 一种目标定位跟踪系统、装置及定位跟踪方法

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101226405A (zh) * 2008-01-18 2008-07-23 浙江工业大学 基于超声波源的二维定位控制系统
CN201266322Y (zh) * 2008-09-27 2009-07-01 苏州大学 超声波目标定位与跟踪装置
CN104020446A (zh) * 2014-06-13 2014-09-03 上海申磬产业有限公司 一种智能护理床中自主导航定位系统及定位导航方法
CN104991557A (zh) * 2015-07-02 2015-10-21 深圳乐行天下科技有限公司 一种自主跟随小车及其系统
CN105094152A (zh) * 2015-07-09 2015-11-25 深圳大学 超声波目标跟踪设备、方法和装置

Cited By (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN110806755A (zh) * 2018-08-06 2020-02-18 中兴通讯股份有限公司 一种无人机跟踪拍摄方法、终端及计算机可读存储介质
CN110245546A (zh) * 2018-12-06 2019-09-17 浙江大华技术股份有限公司 一种目标跟踪系统、方法及存储介质
CN114739328A (zh) * 2022-04-11 2022-07-12 莱赛激光科技股份有限公司 测量地面起伏的传感装置及地坪平整度测量机器人

Also Published As

Publication number Publication date
WO2018014275A1 (zh) 2018-01-25
CN107466371B (zh) 2021-08-13

Similar Documents

Publication Publication Date Title
CN103477185B (zh) 用于确定对象表面的3d坐标的测量系统
EP3627269A1 (en) Target tracking method and apparatus, mobile device and storage medium
CN102818568B (zh) 室内机器人的定位与导航系统及方法
CN105119338B (zh) 移动机器人充电控制系统及方法
US11300650B2 (en) Apparatus and method for automatically orienting a camera at a target
CN104407622A (zh) 机器人跟踪方法和系统
AU2013225712B2 (en) Apparatus and method for automatic video recording
CN108762291B (zh) 一种发现和跟踪黑飞无人机遥控者的方法与系统
CN108549410A (zh) 主动跟随方法、装置、电子设备及计算机可读存储介质
CN107466371A (zh) 目标跟踪装置及系统、机器人
CN105823478A (zh) 一种自主避障导航信息共享和使用方法
CN107992035A (zh) 一种基于室内全局定位的多移动机器人编队控制方法
CN106291535A (zh) 一种障碍物检测装置、机器人及避障系统
CN106094875A (zh) 一种移动机器人的目标跟随控制方法
CN108844543A (zh) 基于uwb定位及航位推算的室内agv导航控制方法
CN107765683A (zh) 移动式机器人的即时导航方法
WO2020151663A1 (zh) 车辆定位装置、系统、方法以及车辆
CN108801269A (zh) 一种室内云机器人导航系统及方法
CN105357484A (zh) 一种目标定位跟踪系统、装置及定位跟踪方法
CN104819718B (zh) 3d光电传感定位系统
CN105182319A (zh) 一种基于射频和双目视觉的目标定位系统及方法
CN105487550A (zh) 一种飞行装置的自主降落的系统及降落方法
CN111487587A (zh) 一种基于超带宽定位的危岩崩塌灾害变形监测方法及系统
CN108931982A (zh) 用于移动机器人设备的视觉导航系统和方法
CN108919297A (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
CP03 Change of name, title or address
CP03 Change of name, title or address

Address after: 518063 a1302, building 10, Shenzhen Bay science and technology ecological park, No. 10, Gaoxin South ninth Road, high tech Zone community, Yuehai street, Nanshan District, Shenzhen, Guangdong

Patentee after: Shenzhen Da Yun Duan Intelligent Technology Co.,Ltd.

Address before: 518000 Room 201, building A, No. 1, Qian Wan Road, Qianhai Shenzhen Hong Kong cooperation zone, Shenzhen, Guangdong (Shenzhen Qianhai business secretary Co., Ltd.)

Patentee before: CLOUDMINDS (SHENZHEN) ROBOTICS SYSTEMS Co.,Ltd.

TR01 Transfer of patent right
TR01 Transfer of patent right

Effective date of registration: 20220210

Address after: 201111 Building 8, No. 207, Zhongqing Road, Minhang District, Shanghai

Patentee after: Dalu Robot Co.,Ltd.

Address before: 518063 a1302, building 10, Shenzhen Bay science and technology ecological park, No. 10, Gaoxin South ninth Road, high tech Zone community, Yuehai street, Nanshan District, Shenzhen, Guangdong

Patentee before: Shenzhen Da Yun Duan Intelligent Technology Co.,Ltd.

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

Address after: 201111 Building 8, No. 207, Zhongqing Road, Minhang District, Shanghai

Patentee after: Dayu robot Co.,Ltd.

Address before: 201111 Building 8, No. 207, Zhongqing Road, Minhang District, Shanghai

Patentee before: Dalu Robot Co.,Ltd.