CN105717489A - 一种无人飞行器的追随方法、装置以及可穿戴设备 - Google Patents

一种无人飞行器的追随方法、装置以及可穿戴设备 Download PDF

Info

Publication number
CN105717489A
CN105717489A CN201610140751.2A CN201610140751A CN105717489A CN 105717489 A CN105717489 A CN 105717489A CN 201610140751 A CN201610140751 A CN 201610140751A CN 105717489 A CN105717489 A CN 105717489A
Authority
CN
China
Prior art keywords
unmanned vehicle
user
sensor
ultrasound wave
orientation
Prior art date
Application number
CN201610140751.2A
Other languages
English (en)
Inventor
谢馥励
苏鹏程
Original Assignee
歌尔声学股份有限公司
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 歌尔声学股份有限公司 filed Critical 歌尔声学股份有限公司
Priority to CN201610140751.2A priority Critical patent/CN105717489A/zh
Publication of CN105717489A publication Critical patent/CN105717489A/zh

Links

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
    • G05D1/10Simultaneous control of position or course in three dimensions
    • G05D1/101Simultaneous control of position or course in three dimensions specially adapted for aircraft
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO 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/00Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations
    • G01S5/16Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations using electromagnetic waves other than radio waves
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO 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/00Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations
    • G01S5/18Position-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
    • G01S5/22Position of source determined by co-ordinating a plurality of position lines defined by path-difference measurements
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO 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/00Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations
    • G01S5/18Position-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
    • G01S5/30Determining absolute distances from a plurality of spaced points of known location
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B64AIRCRAFT; AVIATION; COSMONAUTICS
    • B64CAEROPLANES; HELICOPTERS
    • B64C2201/00Unmanned aerial vehicles; Equipment therefor
    • B64C2201/02Unmanned aerial vehicles; Equipment therefor characterized by type of aircraft
    • B64C2201/024Helicopters, or autogiros
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B64AIRCRAFT; AVIATION; COSMONAUTICS
    • B64CAEROPLANES; HELICOPTERS
    • B64C2201/00Unmanned aerial vehicles; Equipment therefor
    • B64C2201/02Unmanned aerial vehicles; Equipment therefor characterized by type of aircraft
    • B64C2201/027Flying platforms
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B64AIRCRAFT; AVIATION; COSMONAUTICS
    • B64CAEROPLANES; HELICOPTERS
    • B64C2201/00Unmanned aerial vehicles; Equipment therefor
    • B64C2201/14Unmanned aerial vehicles; Equipment therefor characterised by flight control
    • B64C2201/141Unmanned aerial vehicles; Equipment therefor characterised by flight control autonomous, i.e. by navigating independently from ground or air stations, e.g. by using inertial navigation systems [INS]
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B64AIRCRAFT; AVIATION; COSMONAUTICS
    • B64CAEROPLANES; HELICOPTERS
    • B64C39/00Aircraft not otherwise provided for
    • B64C39/02Aircraft not otherwise provided for characterised by special use
    • B64C39/024Aircraft not otherwise provided for characterised by special use of the remote controlled vehicle type, i.e. RPV
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
    • G05D1/12Target-seeking control

Abstract

本发明公开了一种无人飞行器的追随方法、装置以及可穿戴设备,该无人飞行器的追随方法包括:在无人飞行器上安装多个接收传感器,多个接收传感器与用户侧智能控制设备中的一个发射传感器相匹配;利用接收传感器接收用户实时发射的距离信号,并根据距离信号计算无人飞行器相对用户的方位;根据方位调整无人飞行器的水平方位使无人飞行器与用户的方位满足预设方位,实现无人飞行器的自主跟随。本发明通过采用多个接收传感器配合一个发射传感器的方式来确定无人飞行器相对用户的方位,并基于该方位对无人飞行器的水平方位进行调整,保持无人飞行器与用户间的相对静止关系,实现对用户的自主跟随。

Description

一种无人飞行器的追随方法、装置以及可穿戴设备
技术领域
[0001] 本发明涉及人机交互领域,具体涉及一种无人飞行器的追随方法、装置以及可穿 戴设备。
背景技术
[0002] 随着科技的进步,人工智能逐渐开始向消费级电子产品延伸,智能手机几乎成了 人手必备。而伴随着生活品质的提升,无人飞行器(又称无人机,英文Unmanned Aerial Vehicle)开始走入人们的日常生活。微型的多旋翼无人飞行器现已成为多数人都能购买得 起的消费广品。
[0003] 目前无人飞行器一般搭载有加速度传感器、陀螺仪等运动状态检测传感器,并且 应用了蓝牙、Wi-Fi数据传输技术,以满足无人飞行器的飞行控制和状态检测需求。但是蓝 牙、Wi-Fi等常用数据传输技术只能完成无人飞行器与信号传输设备之间的无线数据通信, 而无法实现自主跟随,用户体验较差。
发明内容
[0004] 本发明提供了一种无人飞行器的追随方法、装置以及可穿戴设备,用以解决现有 技术无法实现无人飞行器的自主追随,用户体验较差的问题。
[0005] 根据本发明的一个方面,提供了一种无人飞行器的追随方法,该方法包括:
[0006] 在无人飞行器上安装多个接收传感器,多个接收传感器与用户侧智能控制设备中 的一个发射传感器相匹配;
[0007] 利用接收传感器接收用户实时发射的距离信号,并根据距离信号计算无人飞行器 相对用户的方位;
[0008] 根据方位调整无人飞行器的水平方位使无人飞行器与用户的方位满足预设方位, 实现无人飞行器的自主跟随。
[0009] 可选地,在无人飞行器上安装多个接收传感器包括:
[0010]在无人飞行器的不同位置上安装至少三个超声波接收传感器,该超声波接收传感 器与用户侧智能控制设备中的一个超声波发射传感器相匹配。
[0011] 可选地,根据接收的距离信号计算无人飞行器相对用户的方位包括:
[0012] 根据用户发射的超声波信号分别到达无人飞行器上每个超声波接收传感器的时 间,计算用户到无人飞行器上每个超声波接收传感器的距离;
[0013] 根据用户到无人飞行器上每个超声波接收传感器的距离以及无人飞行器中心点 的位置、无人飞行器中心点与每个超声波接收传感器的距离,计算无人飞行器的中心点与 用户的方位。
[0014] 可选地,根据用户到无人飞行器上每个超声波接收传感器的距离以及无人飞行器 中心点的位置、无人飞行器中心点与每个超声波接收传感器的距离,计算无人飞行器的中 心点与用户的方位包括:
[0015] 在无人飞行器上安装有四个超声波接收传感器,无人飞行器为四旋翼无人飞行 器,超声波接收传感器位置的连线呈十字交叉形,交点为无人飞行器的中心点。
[0016] 可选地,每个超声波接收传感器分别位于四旋翼无人飞行器一个旋翼的下方。
[0017] 可选地,根据用户到无人飞行器上每个超声波接收传感器的距离以及无人飞行器 中心点的位置、无人飞行器中心点与每个超声波接收传感器的距离,计算无人飞行器的中 心点与用户的方位包括:
[0018] 以无人飞行器的中心点为原点,以连线经过原点的两个超声波接收传感器所在方 向为水平坐标轴,以垂直于水平坐标轴的方向为垂直坐标轴构建空间直角坐标系,定义用 户当前的位置坐标为(x,y,z),通过如下公式计算用户当前的位置坐标值: (V - /)" + X1 + Z2 = «^ r n (v + /)2 +x2 +z2 =nl ,;,,, +y-+z-=n;; (jt + /)? + v2 + Z2 = «J2
[0020] 其中,1为无人飞行器的中心点到各超声波接收传感器的距离,m为用户到第一个 超声波接收传感器的距离,m为用户到第二个超声波接收传感器的距离,m为用户到第三个 超声波接收传感器的距离,m为用户到第四个超声波接收传感器的距离;
[0021] 根据用户当前的位置坐标值得到无人飞行器的中心点与用户的方位。
[0022] 可选地,根据方位调整无人飞行器与用户的水平方位使得无人飞行器相对用户的 方位满足预设的方位信息包括:
[0023] 根据无人飞行器相对用户的方位,利用比例积分微分PID控制器通过调整无人飞 行器的飞行速度来调整无人飞行器相对于用户的水平方位,使得无人飞行器与用户的方位 满足预设方位,实现自主追随。
[0024] 与上述方法相对应的,本发明还提供了一种无人飞行器的追随装置,无人飞行器 上安装多个接收传感器,多个接收传感器与用户侧智能控制设备中的一个发射传感器相匹 配,该无人飞行器的追随装置包括:
[0025]定位模块,用于通过接收传感器接收用户实时发射的距离信号,并根据距离信号 计算无人飞行器相对用户的方位;
[0026]跟随模块,用于根据定位模块计算的无人飞行器相对用户的方位,调整无人飞行 器的水平方位使无人飞行器与用户的方位满足预设方位,实现无人飞行器的自主跟随。 [0027]可选地,无人飞行器的不同位置上安装至少三个超声波接收传感器,超声波接收 传感器与用户侧智能控制设备中的一个超声波发射传感器相匹配;
[0028] 定位模块,具体用于根据用户发射的超声波信号分别到达无人飞行器上每个超声 波接收传感器的时间,计算用户到无人飞行器上每个超声波接收传感器的距离;并根据用 户到无人飞行器上每个超声波接收传感器的距离以及无人飞行器中心点的位置、无人飞行 器中心点与每个超声波接收传感器的距离,计算无人飞行器的中心点与用户的方位。
[0029] 可选地,无人飞行器上安装有四个超声波接收传感器,无人飞行器为四旋翼无人 飞行器,超声波接收传感器的位置的连线呈十字交叉形,交点为无人飞行器的中心点;
[0030] 定位模块,具体用于以无人飞行器的中心点为原点,以连线经过原点的两个超声 波接收传感器所在方向为水平坐标轴,以垂直于水平坐标轴的方向为垂直坐标轴构建空间 直角坐标系,定义用户当前的位置坐标为(x,y,z),通过如下公式计算用户当前的位置坐标 值: (v-/)~ +X" + Z1 =/?2 「 ] (V + /.)2 + X2 + Z..2 = «32 (A- - /)+.}' 十;:_ = /;二 (jf + /)" + v2 + z2 = /?j2
[0032]其中,1为无人飞行器的中心点到各超声波接收传感器的距离,m为用户到第一个 超声波接收传感器的距离,m为用户到第二个超声波接收传感器的距离,m为用户到第三个 超声波接收传感器的距离,m为用户到第四个超声波接收传感器的距离;
[0033]根据用户当前的位置坐标值得到无人飞行器的中心点与用户的方位。
[0034]根据本发明的又一个方面,提供了一种可穿戴设备,该可穿戴设备中设置有一个 发射传感器;
[0035] 发射传感器与无人飞行器上的多个接收传感器相匹配,用于实时向无人飞行器发 射距离信号,以使得无人飞行器根据接收的距离信号计算无人飞行器相对于用户的方位, 并根据该方位调整无人飞行器的水平方位使无人飞行器与用户的方位满足预设方位。
[0036] 可选地,可穿戴设备为智能手表、智能手环、智能眼镜或智能耳机,发射传感器为 红外线发射传感器,接收传感器为红外线接收传感器。
[0037] 本发明实施例的这种无人飞行器的追随方法和装置,采用根据用户侧智能控制设 备实时发射的距离信号计算当前无人飞行器相对用户的方位,得到无人机与用户之间的相 对位置,并基于该方位将无人飞行器相对于用户的方位调整到预设方位的技术手段,能够 保持无人飞行器与用户在预设方位下的相对静止关系,提供了一套对无人机自主追随的实 现方案,丰富了无人机产品的功能,提高了无人飞行器产品的竞争力。另外,本发明实施例 还提供了一种可穿戴设备,该可穿戴设备中设置发射传感器可以向无人飞行器上匹配的多 个接收传感器发射信号,以便于实现无人飞行器对佩戴该可穿戴设备的用户的自主追随, 从而大大提升了用户使用体验。
附图说明
[0038] 图1是本发明一个实施例一种无人飞行器的追随方法的流程示意图;
[0039] 图2是本发明一个实施例无人飞行器与用户的相对方位示意图;
[0040] 图3是本发明一个实施例基于无人飞行器与用户的方位关系构建的空间直角坐标 系不意图;
[0041] 图4是发明一个实施例一种无人飞行器的追随装置的结构框图;
[0042]图5是本发明一个实施例的一种可穿戴设备的结构框图。
具体实施方式
[0043] 本发明的设计构思是:针对现有的无人飞行器不能自主追随的问题,本发明通过 一套一发多收的传感器模块,来确定无人机与使用者之间的相对位置关系,根据相对位置 关系对无人机的位置进行微调,保持无人机与用户之间相对静止的关系,进而实现无人飞 行器的自主追随功能。
[0044] 实施例一
[0045] 图1是本发明一个实施例的一种无人飞行器的追随方法的流程示意图,参见图1, 该无人飞行器的追随方法包括如下步骤:
[0046] 步骤S11,在无人飞行器上安装多个接收传感器,多个接收传感器与用户侧智能控 制设备中的一个发射传感器相匹配;
[0047] 这里的相匹配至少包括:接收传感器与发射传感器的类型相匹配。如,当接收传感 器为超声波传感器时,发射传感器也采用超声波传感器,即保证发射传感器和接收传感器 的类型相同。以及,接收传感器与发射传感器之间的身份匹配。如,初始化过程中接收传感 器接收发射传感器的配对连接请求以完成身份认证,从而防止其他设备的干扰。
[0048]步骤S12,无人飞行器利用接收传感器接收用户实时发射的距离信号,并根据距离 信号计算无人飞行器相对用户的方位;用户的方位包括用户在空间中的方向信息和位置信 息。
[0049] 步骤S13,无人飞行器根据方位调整无人飞行器的水平方位使无人飞行器与用户 的方位满足预设方位,实现无人飞行器的自主跟随。
[0050] 这里,无人机的水平方位,是指无人机水平方向的位置,水平方向相对于无人机的 垂直方向。水平方位即无人机在用户上方预定高度,并在以用户为中心,以预定值为半径的 圆的圆周上的位置。
[0051] 开启无人飞行器的自主追随模式需首先设定无人飞行器的飞行高度,在没有特殊 情况时无人飞行器应保持自己的飞行高度不变,这样通过在无人飞行器上不同位置的接收 传感器收到的距离信号的时间差即可推断出无人飞行器与用户的准确的相对方位,然后根 据这一相对方位调整无人飞行器在水平方向上的位置到预设方位,实现无人飞行器对用户 的自主追随。
[0052] 本实施例中,用户侧智能控制设备可以为智能手表或智能手环等可穿戴设备。 [0053]通过图1所示的方法,无人飞行器利用安装的多个接收传感器接收用户侧发送的 距离信号并计算无人飞行器相对用户的方位,根据计算出的方位对无人飞行器的水平方位 进行控制,使无人飞行器相对于用户的方位满足预设方位,从而在用户运动(如跑步)时,无 人飞行器能够自主跟随用户的位置变化,保持与用户的相对方位,提升用户体验。
[0054] 实施例二
[0055]超声波信号在近场信号传输中具有优势,受环境和光照的因素的影响较小,传输 稳定,抗干扰能力强,是实现无人飞行器自主追随的理想媒介。因而本实施例中,以接收传 感器为超声波接收传感器,发射传感器为超声波发射传感器为例,对无人飞行器的追随方 法中的无人飞行器对用户的定位进行重点说明,其他内容参见本发明其他实施例的说明。 [0056]本实施例中,无人飞行器上安装至少三个超声波传感器,根据用户侧的智能控制 设备中安装的超声波发射传感器发射的超声波信号计算用户与无人飞行器之间的方位。 [00 57] 本实施例采用的定位算法的原理与GPS(全球定位系统,Global Positioning System)定位原理相似,不同的是GPS定位的信号发射端是卫星,信号接收端位于被定位的 物体上。本实施例的定位算法正好相反,信号接收端位于无人飞行器上,而信号发射端位于 被定位的设备上。
[0058]由于超声波接收传感器安装在无人飞行器上的位置是确定的,这样,通过用户端 发射的超声波信号到达不同超声波接收传感器的时间差可得到用户与无人飞行器上不同 超声波接收传感器的距离。这里,超声波发射传感器在发射超声波信号的同时会在信号中 携带发射时间信息,当该超声波信号到达无人机上每个超声波接收传感器时,每个超声波 接收传感器会得到不同的到达时间,这时每个超声波传感器都可以计算一个到达时间与发 射时间的时间差t,再根据超声波在空气中的传播速度340m/s,就可以计算出超声波发射传 感器到每个超声波接收传感器的距离(s),即:s = 340t。
[0059]在计算出用户到无人飞行器上每个超声波接收传感器的距离后,根据无人飞行器 中心点的位置、无人飞行器中心点与每个超声波接收传感器的距离,计算得到无人飞行器 的中心点与用户的方位,从而得到无人飞行器相对用户的方位,将该方位与预设方位进行 比较,如果无人飞行器相对用户的方位不满足预设方位,则可以通过PID(Pr 〇p〇rti〇n Integration Differentiation,比例积分微分)等控制器计算输出给无人飞行器各旋翼的 电机的控制信号,调整无人飞行器的飞行速度,通过调整无人飞行器的飞行速度来对无人 飞行器在水平方向的位置进行调整(由于无人飞行器在垂直方向即高度通常是保持固定, 所以垂直方向的位置不需要调整),以保证无人飞行器的位置一直位于目标周围,实现自主 追随。
[0060]需要强调的是,本实施例中的无人飞行器的追随方法示例性应用场景为:无人飞 行器与用户之间预设一个相对方位,如将无人飞行器设置在相对于用户的左前方,无人飞 行器高度固定,那么当用户处于运动状态时(如跑步、骑自行车),无人飞行器相对用户的水 平方位可能发生变化,如,无人飞行器飞行在用户的左后方,此时利用本实施例的无人飞行 器的追随方法计算无人飞行器相对用户的方位,发现该方位(左后方)不满足预设方位(左 前方),这时无人飞行器调整自身的飞行速度(如加快相应旋翼的旋转速度),以使得无人飞 行器相对用户的方位调整到预设方位,实现对用户的自主追随。
[0061 ] 实施例三
[0062] 图2是本发明一个实施例无人飞行器与用户的相对方位示意图,图3是本发明一个 实施例基于无人飞行器与用户的方位关系构建的空间直角坐标系示意图,结合图2和图3, 本实施例对无人飞行器相对用户的方位计算过程进行示例性说明。
[0063] 由图2可见,本实施例中的无人飞行器为四旋翼无人飞行器,四旋翼飞行器通过调 节四个电机转速来改变旋翼的转速,实现飞行速度和升力的变化,从而控制无人飞行器的 姿态和位置。四旋翼飞行器搭载四个超声波信号接收传感器,超声波信号接收传感器分别 位于旋翼轴的下方,与这四个超声波接收传感器相匹配的超声波信号发射传感器位于用户 侧的智能控制设备上。
[0064] 图2示出的四个超声波接收传感器为:超声波接收传感器一、超声波接收传感器 二、超声波接收传感器三、超声波接收传感器四。由图2可见,无人飞行器上安装的四个超声 波接收传感器的位置的连线呈十字交叉形,交点〇为无人飞行器的中心点,无人飞行器的中 心点到各超声波接收传感器的距离都相等。
[0065]需要说明的是,实际应用过程中在超声信号传输之前,需要对超声波信号进行匹 配识别以防止可能产生的其他设备的干扰。即建立超声波接收传感器与超声波发射传感器 之间的配对连接。
[0066]本实施例中,以无人飞行器的中心点为原点,以连线经过原点的两个超声波接收 传感器所在方向为水平坐标轴,以垂直于水平坐标轴的方向为垂直坐标轴构建空间直角坐 标系(Oxyz)。
[0067] 参见图3,直角坐标系的原点0位于无人飞行器四个旋翼的悬臂交点,以第一个、第 四个超声波接收传感器所在的悬臂为x轴,第二个、第三个超声波接收传感器所在悬臂为y 轴,且第二个、第四个超声波接收传感器分别位于x、y轴的正方向。无人飞行器的飞行高度 为已知,通过用户侧发射的超声波信号到达不同超声波接收传感器的时间即可得到用户与 无人飞行器上不同超声波接收传感器之间的距离,通过这些已知参数得到原点〇与用户之 间的相对方位。定义P点为用户当前所在位置,坐标为(x,y,z),坐标轴X和y上的共四个点分 别代表超声波接收传感器所在位置。已知超声波在空气中的传播速度约为340m/s,因此通 过超声波信号的传播时间即可反推出信号发射点与接收点之间的距离。
[0068] 由用户侧智能控制设备所发射的超声波与四个超声波接收传感器的距离分别为 m,m,m,ru,可通过如下方程组计算?点与中心点之间的距离 (v-/)2 +x2 +z2 -n; r n (v + /)2 +x2 + z2 = n; _
[x-I) + y + z = n4 (x + lf + V1 +Z1 = fly
[0070] 其中,1为无人飞行器的中心点到各超声波接收传感器的距离,m为用户到第一个 超声波接收传感器的距离,m为用户到第二个超声波接收传感器的距离,m为用户到第三个 超声波接收传感器的距离,m为用户到第四个超声波接收传感器的距离;
[0071] 上式为一个超越方程组,理论上只需要其中的3个方程即可得出确定解,因此无人 飞行器上最少需要三个接收传感器即可确定目标(即用户)的坐标,增加接收传感器的数量 可在一定程度上提尚定位的准确性进而提尚自主追随的精度。
[0072] 通过求解上式方程组,可确定P点的坐标值,即确定当前无人飞行器的中心点和用 户的方位。
[0073] 得到无人飞行器相对和用户当前位置的方位后,可以通过PID控制器对无人飞行 器的水平位置进行控制,以保证无人飞行器一直位于目标周围,实现自主追随。
[0074]需要说明的是本实施例中第一个超声波接收传感器、第二个超声波接收传感器这 样的用语不对超声波接收传感器的顺序或数量进行限定,仅用于对具有相同或相似功能的 不同器件进行区分。
[0075] 实施例四
[0076] 图4是发明一个实施例一种无人飞行器的追随装置的结构框图,参见图4,无人飞 行器上安装多个接收传感器401,多个接收传感器401与用户侧智能控制设备中的一个发射 传感器相匹配,该无人飞行器的追随装置40包括:
[0077]定位模块402,用于通过接收传感器接收用户实时发射的距离信号,并根据距离信 号计算无人飞行器相对用户的方位;
[0078]跟随模块403,用于根据定位模块402计算的无人飞行器相对用户的方位,调整无 人飞行器的水平方位使无人飞行器与用户的方位满足预设方位,实现无人飞行器的自主跟 随。
[0079]本实施例中,无人飞行器的不同位置上安装至少三个超声波接收传感器,超声波 接收传感器与用户侧智能控制设备中的一个超声波发射传感器相匹配;
[0080] 定位模块402,具体用于根据用户发射的超声波信号分别到达无人飞行器上每个 超声波接收传感器的时间,计算用户到无人飞行器上每个超声波接收传感器的距离;并根 据用户到无人飞行器上每个超声波接收传感器的距离以及无人飞行器中心点的位置、无人 飞行器中心点与每个超声波接收传感器的距离,计算无人飞行器的中心点与用户的方位。
[0081] 本实施例中,无人飞行器上安装有四个超声波接收传感器,无人飞行器为四旋翼 无人飞行器,超声波接收传感器的位置的连线呈十字交叉形,交点为无人飞行器的中心点; [0082]定位模块402,具体用于以无人飞行器的中心点为原点,以连线经过原点的两个超 声波接收传感器所在方向为水平坐标轴,以垂直于水平坐标轴的方向为垂直坐标轴构建空 间直角坐标系,定义用户当前的位置坐标为(x,y,z),通过如下公式计算用户当前的位置坐 标值: (y-lf +x2 + z2 = n\ (v + /)2 + x2 + z2 - 111 [0083] - 2 2 32 (A. - / ) + }' .十.Z "4 (x:+/)2 + y2 +z2 = n[
[0084]其中,1为无人飞行器的中心点到各超声波接收传感器的距离,m为用户到第一个 超声波接收传感器的距离,m为用户到第二个超声波接收传感器的距离,m为用户到第三个 超声波接收传感器的距离,m为用户到第四个超声波接收传感器的距离;
[0085]根据用户当前的位置坐标值得到无人飞行器的中心点与用户的方位。
[0086]需要说明的是,本实施例中的这种无人飞行器的追随装置的工作过程是和前面实 施例中无人飞行器的追随方法的实现步骤相对应的,无人飞行器的追随装置的具体工作流 程可以参见前述无人飞行器的追随方法部分的相关内容说明,在此不再赘述。
[0087] 实施例五
[0088]图5是本发明一个实施例的一种可穿戴设备的结构框图,参见图5,本实施例提供 了一种可穿戴设备50,该可穿戴设备50中设置有一个发射传感器501;
[0089]发射传感器501与无人飞行器上的多个接收传感器相匹配,用于实时向无人飞行 器发射距离信号,使得无人飞行器根据接收的距离信号计算无人飞行器相对于用户的方位 并根据该方位调整无人飞行器的水平方位使无人飞行器与用户的方位满足预设方位。
[0090] 本实施例中,可穿戴设备50为智能手表或智能手环,或其他具有相应功能的智能 可穿戴产品,如智能眼镜,智能耳机,智能服装或鞋子等。发射传感器501为红外线发射传感 器,接收传感器为红外线接收传感器。在本发明的其他实施例中,发射传感器501也可以是 超声波发射传感器,对此不作限制。
[0091] 综上所述,本发明的这种无人飞行器的自主追随装置和方法采用相匹配的一发多 收传感器(即设置在用户侧的一个信号发射传感器以及设置在无人飞行器的多个信号接收 传感器),来定位用户当前的位置,进而确定无人飞行器相对用户的方位(即方向和位置信 息),得到了无人飞行器相对用户的方位后调整无人机相对用户的水平方位,使其满足预设 方位,这样可以保持无人飞行器与用户之间相对静止关系,实现无人飞行器的自主追随,尤 其在用户运动时,实现无人飞行器自主追随效果能够极大提升用户体验。另外,本发明还提 供了一种可穿戴设备,该可穿戴设备中设置发射传感器可以向无人飞行器上匹配的多个接 收传感器发射信号,以便于实现无人飞行器对佩戴该可穿戴设备的用户的自主追随。
[0092]以上所述仅为本发明的较佳实施例而已,并非用于限定本发明的保护范围。凡在 本发明的精神和原则之内所作的任何修改、等同替换、改进等,均包含在本发明的保护范围 内。

Claims (12)

1. 一种无人飞行器的追随方法,其特征在于,所述方法包括: 在所述无人飞行器上安装多个接收传感器,所述多个接收传感器与用户侧智能控制设 备中的一个发射传感器相匹配; 利用所述接收传感器接收用户实时发射的距离信号,并根据所述距离信号计算所述无 人飞行器相对用户的方位; 根据所述方位调整无人飞行器的水平方位使无人飞行器与用户的方位满足预设方位, 实现所述无人飞行器的自主跟随。
2. 根据权利要求1所述的方法,其特征在于,在所述无人飞行器上安装多个接收传感器 包括: 在无人飞行器的不同位置上安装至少三个超声波接收传感器,该超声波接收传感器与 用户侧智能控制设备中的一个超声波发射传感器相匹配。
3. 根据权利要求2所述的方法,其特征在于,所述根据接收的所述距离信号计算所述无 人飞行器相对用户的方位包括: 根据用户发射的超声波信号分别到达所述无人飞行器上每个超声波接收传感器的时 间,计算用户到无人飞行器上每个超声波接收传感器的距离; 根据用户到无人飞行器上每个超声波接收传感器的距离以及无人飞行器中心点的位 置、无人飞行器中心点与每个超声波接收传感器的距离,计算无人飞行器的中心点与用户 的方位。
4. 根据权利要求3所述的方法,其特征在于,所述根据用户到无人飞行器上每个超声波 接收传感器的距离以及无人飞行器中心点的位置、无人飞行器中心点与每个超声波接收传 感器的距离,计算无人飞行器的中心点与用户的方位包括: 在所述无人飞行器上安装有四个超声波接收传感器,所述无人飞行器为四旋翼无人飞 行器,超声波接收传感器位置的连线呈十字交叉形,交点为所述无人飞行器的中心点。
5. 根据权利要求4所述的方法,其特征在于,每个所述超声波接收传感器分别位于四旋 翼无人飞行器一个旋翼的下方。
6. 根据权利要求4所述的方法,其特征在于,所述根据用户到无人飞行器上每个超声波 接收传感器的距离以及无人飞行器中心点的位置、无人飞行器中心点与每个超声波接收传 感器的距离,计算无人飞行器的中心点与用户的方位包括: 以所述无人飞行器的中心点为原点,以连线经过原点的两个超声波接收传感器所在方 向为水平坐标轴,以垂直于水平坐标轴的方向为垂直坐标轴构建空间直角坐标系,定义用 户当前的位置坐标为(x,y,z),通过如下公式计算用户当前的位置坐标值:
Figure CN105717489AC00021
其中,1为无人飞行器的中心点到各超声波接收传感器的距离,m为用户到第一个超声 波接收传感器的距离,m为用户到第二个超声波接收传感器的距离,m为用户到第三个超声 波接收传感器的距离,m为用户到第四个超声波接收传感器的距离; 根据用户当前的位置坐标值得到无人飞行器的中心点与用户的方位。
7. 根据权利要求6所述的方法,其特征在于,所述根据所述方位调整无人飞行器与用户 的水平方位使得无人飞行器相对用户的方位满足预设的方位信息包括: 根据无人飞行器相对用户的方位,利用比例积分微分PID控制器通过调整无人飞行器 的飞行速度来调整无人飞行器相对于用户的水平方位,使得无人飞行器与用户的方位满足 预设方位,实现自主追随。
8. -种无人飞行器的追随装置,其特征在于,所述无人飞行器上安装多个接收传感器, 多个接收传感器与用户侧智能控制设备中的一个发射传感器相匹配,该无人飞行器的追随 装置包括: 定位模块,用于通过所述接收传感器接收用户实时发射的距离信号,并根据所述距离 信号计算无人飞行器相对用户的方位; 跟随模块,用于根据定位模块计算的无人飞行器相对用户的方位,调整无人飞行器的 水平方位使无人飞行器与用户的方位满足预设方位,实现所述无人飞行器的自主跟随。
9. 根据权利要求8所述的装置,其特征在于,所述无人飞行器的不同位置上安装至少三 个超声波接收传感器,所述超声波接收传感器与用户侧智能控制设备中的一个超声波发射 传感器相匹配; 所述定位模块,具体用于根据用户发射的超声波信号分别到达所述无人飞行器上每个 超声波接收传感器的时间,计算用户到无人飞行器上每个超声波接收传感器的距离;并根 据用户到无人飞行器上每个超声波接收传感器的距离以及无人飞行器中心点的位置、无人 飞行器中心点与每个超声波接收传感器的距离,计算无人飞行器的中心点与用户的方位。
10. 根据权利要求9所述的装置,其特征在于,所述无人飞行器上安装有四个超声波接 收传感器,所述无人飞行器为四旋翼无人飞行器,超声波接收传感器的位置的连线呈十字 交叉形,交点为所述无人飞行器的中心点; 所述定位模块,具体用于以所述无人飞行器的中心点为原点,以连线经过原点的两个 超声波接收传感器所在方向为水平坐标轴,以垂直于水平坐标轴的方向为垂直坐标轴构建 空间直角坐标系,定义用户当前的位置坐标为(x,y,z),通过如下公式计算用户当前的位置 坐标值:
Figure CN105717489AC00031
其中,1为无人飞行器的中心点到各超声波接收传感器的距离,m为用户到第一个超声 波接收传感器的距离,m为用户到第二个超声波接收传感器的距离,m为用户到第三个超声 波接收传感器的距离,m为用户到第四个超声波接收传感器的距离; 根据用户当前的位置坐标值得到无人飞行器的中心点与用户的方位。
11. 一种可穿戴设备,其特征在于,该可穿戴设备中设置有一个发射传感器; 所述发射传感器与无人飞行器上的多个接收传感器相匹配,用于实时向无人飞行器发 射距离信号,以使得所述无人飞行器根据接收的距离信号计算无人飞行器相对于用户的方 位,并根据该方位调整无人飞行器的水平方位使无人飞行器与用户的方位满足预设方位。
12.根据权利要求11所述的可穿戴设备,其特征在于,所述可穿戴设备为智能手表、智 能手环、智能眼镜或智能耳机,所述发射传感器为红外线发射传感器,所述接收传感器为红 外线接收传感器。
CN201610140751.2A 2016-03-11 2016-03-11 一种无人飞行器的追随方法、装置以及可穿戴设备 CN105717489A (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201610140751.2A CN105717489A (zh) 2016-03-11 2016-03-11 一种无人飞行器的追随方法、装置以及可穿戴设备

Applications Claiming Priority (3)

Application Number Priority Date Filing Date Title
CN201610140751.2A CN105717489A (zh) 2016-03-11 2016-03-11 一种无人飞行器的追随方法、装置以及可穿戴设备
PCT/CN2017/076218 WO2017152865A1 (zh) 2016-03-11 2017-03-10 一种无人飞行器的追随方法、装置以及可穿戴设备
US16/079,099 US10816640B2 (en) 2016-03-11 2017-03-10 Following method and device for unmanned aerial vehicle and wearable device

Publications (1)

Publication Number Publication Date
CN105717489A true CN105717489A (zh) 2016-06-29

Family

ID=56158757

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201610140751.2A CN105717489A (zh) 2016-03-11 2016-03-11 一种无人飞行器的追随方法、装置以及可穿戴设备

Country Status (3)

Country Link
US (1) US10816640B2 (zh)
CN (1) CN105717489A (zh)
WO (1) WO2017152865A1 (zh)

Cited By (13)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN106094864A (zh) * 2016-06-30 2016-11-09 成都西可科技有限公司 一种飞行器手环及其交互方法
CN106482729A (zh) * 2016-10-25 2017-03-08 北京小米移动软件有限公司 无人机跟踪运动目标的方法及装置
CN106774435A (zh) * 2017-01-20 2017-05-31 亿航智能设备(广州)有限公司 一种无人机的高精度跟随方法及其系统
WO2017152865A1 (zh) * 2016-03-11 2017-09-14 歌尔股份有限公司 一种无人飞行器的追随方法、装置以及可穿戴设备
CN107167769A (zh) * 2017-05-15 2017-09-15 武汉星巡智能科技有限公司 无人飞行器室内接收器搜索方法及装置
CN107229034A (zh) * 2017-05-15 2017-10-03 武汉星巡智能科技有限公司 无人飞行器定位方法及定位系统
CN107300704A (zh) * 2017-05-15 2017-10-27 武汉星巡智能科技有限公司 无人飞行器室内定位方法及装置
CN108241142A (zh) * 2016-12-26 2018-07-03 宏达国际电子股份有限公司 追踪系统及追踪方法
CN108594842A (zh) * 2018-02-01 2018-09-28 杭州瓦屋科技有限公司 无人机步进控制方法及装置
CN109144092A (zh) * 2017-06-16 2019-01-04 昊翔电能运动科技(昆山)有限公司 无人机飞行辅助方法、装置及无人机
CN109484584A (zh) * 2018-12-20 2019-03-19 岳阳哈工特飞海工装备科技有限公司 一种智能动力浮板
WO2019194011A1 (ja) * 2018-04-06 2019-10-10 日本電信電話株式会社 飛行制御装置、方法、及びプログラム
CN111314017A (zh) * 2020-05-09 2020-06-19 上海特金信息科技有限公司 无人机信号压制设备的调度方法、装置、电子设备与介质

Families Citing this family (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20170368690A1 (en) * 2016-06-27 2017-12-28 Dilili Labs, Inc. Mobile Robot Navigation

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN104270563A (zh) * 2014-08-18 2015-01-07 吴建民 旋翼机辅助手机/平板电脑进行拍照/录像的系统和方法
CN105045281A (zh) * 2015-08-13 2015-11-11 深圳一电科技有限公司 无人机飞行控制方法及装置
CN105116859A (zh) * 2015-08-21 2015-12-02 杨珊珊 一种利用无人飞行器实现的智能家居系统及方法
CN105185083A (zh) * 2015-09-21 2015-12-23 深圳飞豹航天航空科技有限公司 可控制移动设备做跟随的智能设备及系统
CN105182348A (zh) * 2015-09-10 2015-12-23 浙江江宇电机有限公司 一种基于超声波的无人机实时定位与跟踪装置及应用技术

Family Cites Families (14)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US8521339B2 (en) * 2008-09-09 2013-08-27 Aeryon Labs Inc. Method and system for directing unmanned vehicles
CN102551993B (zh) * 2010-12-24 2014-12-24 中国科学院深圳先进技术研究院 助行机器人
US8949012B2 (en) * 2012-04-05 2015-02-03 Her Majesty The Queen In Right Of Canada, As Represented By The Minister Of National Defence Automated multi-vehicle position, orientation and identification system and method
US9367067B2 (en) * 2013-03-15 2016-06-14 Ashley A Gilmore Digital tethering for tracking with autonomous aerial robot
CN203102612U (zh) * 2013-03-29 2013-07-31 章逸凡 一种汽车行车安全防撞系统
US20150134143A1 (en) 2013-10-04 2015-05-14 Jim Willenborg Novel tracking system using unmanned aerial vehicles
US9678506B2 (en) * 2014-06-19 2017-06-13 Skydio, Inc. Magic wand interface and other user interaction paradigms for a flying digital assistant
US9599992B2 (en) * 2014-06-23 2017-03-21 Nixie Labs, Inc. Launch-controlled unmanned aerial vehicles, and associated systems and methods
CN104260092B (zh) * 2014-07-08 2015-12-30 大连理工大学 一种自动跟踪机器人控制装置及自动跟踪机器人
CN104991573A (zh) 2015-06-25 2015-10-21 北京品创汇通科技有限公司 一种基于声源阵列的定位跟踪方法及其装置
US9513629B1 (en) * 2015-10-30 2016-12-06 Sony Mobile Communications, Inc. Methods and devices for heart rate controlled drones
CN105717489A (zh) * 2016-03-11 2016-06-29 歌尔声学股份有限公司 一种无人飞行器的追随方法、装置以及可穿戴设备
KR20180103601A (ko) * 2017-03-10 2018-09-19 삼성전자주식회사 무인 비행 장치를 제어하는 방법 및 이를 지원하는 무인 비행 장치
FR3065297A1 (fr) * 2017-04-14 2018-10-19 Thales Procede de suivi de cible par un drone, programme d'ordinateur, systeme electronique et drone associes

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN104270563A (zh) * 2014-08-18 2015-01-07 吴建民 旋翼机辅助手机/平板电脑进行拍照/录像的系统和方法
CN105045281A (zh) * 2015-08-13 2015-11-11 深圳一电科技有限公司 无人机飞行控制方法及装置
CN105116859A (zh) * 2015-08-21 2015-12-02 杨珊珊 一种利用无人飞行器实现的智能家居系统及方法
CN105182348A (zh) * 2015-09-10 2015-12-23 浙江江宇电机有限公司 一种基于超声波的无人机实时定位与跟踪装置及应用技术
CN105185083A (zh) * 2015-09-21 2015-12-23 深圳飞豹航天航空科技有限公司 可控制移动设备做跟随的智能设备及系统

Cited By (15)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2017152865A1 (zh) * 2016-03-11 2017-09-14 歌尔股份有限公司 一种无人飞行器的追随方法、装置以及可穿戴设备
US10816640B2 (en) 2016-03-11 2020-10-27 Goertek Inc. Following method and device for unmanned aerial vehicle and wearable device
CN106094864A (zh) * 2016-06-30 2016-11-09 成都西可科技有限公司 一种飞行器手环及其交互方法
CN106482729A (zh) * 2016-10-25 2017-03-08 北京小米移动软件有限公司 无人机跟踪运动目标的方法及装置
CN108241142A (zh) * 2016-12-26 2018-07-03 宏达国际电子股份有限公司 追踪系统及追踪方法
CN106774435A (zh) * 2017-01-20 2017-05-31 亿航智能设备(广州)有限公司 一种无人机的高精度跟随方法及其系统
CN107167769A (zh) * 2017-05-15 2017-09-15 武汉星巡智能科技有限公司 无人飞行器室内接收器搜索方法及装置
CN107229034A (zh) * 2017-05-15 2017-10-03 武汉星巡智能科技有限公司 无人飞行器定位方法及定位系统
CN107300704A (zh) * 2017-05-15 2017-10-27 武汉星巡智能科技有限公司 无人飞行器室内定位方法及装置
CN107300704B (zh) * 2017-05-15 2020-07-28 武汉星巡智能科技有限公司 无人飞行器室内定位方法及装置
CN109144092A (zh) * 2017-06-16 2019-01-04 昊翔电能运动科技(昆山)有限公司 无人机飞行辅助方法、装置及无人机
CN108594842A (zh) * 2018-02-01 2018-09-28 杭州瓦屋科技有限公司 无人机步进控制方法及装置
WO2019194011A1 (ja) * 2018-04-06 2019-10-10 日本電信電話株式会社 飛行制御装置、方法、及びプログラム
CN109484584A (zh) * 2018-12-20 2019-03-19 岳阳哈工特飞海工装备科技有限公司 一种智能动力浮板
CN111314017A (zh) * 2020-05-09 2020-06-19 上海特金信息科技有限公司 无人机信号压制设备的调度方法、装置、电子设备与介质

Also Published As

Publication number Publication date
WO2017152865A1 (zh) 2017-09-14
US20190011531A1 (en) 2019-01-10
US10816640B2 (en) 2020-10-27

Similar Documents

Publication Publication Date Title
US9945929B2 (en) Distributed localization systems and methods and self-localizing apparatus
US9891621B2 (en) Control of an unmanned aerial vehicle through multi-touch interactive visualization
US9952590B2 (en) Self-propelled device implementing three-dimensional control
US10114384B2 (en) Formation flight path coordination of unmanned aerial vehicles
US20170153122A1 (en) System and method for automatic sensor calibration
Lugo et al. Framework for autonomous on-board navigation with the AR. Drone
EP2895819B1 (en) Sensor fusion
US10414494B2 (en) Systems and methods for reliable relative navigation and autonomous following between unmanned aerial vehicle and a target object
Meyer et al. Comprehensive simulation of quadrotor uavs using ros and gazebo
US10464661B2 (en) Volitant vehicle rotating about an axis and method for controlling the same
US20210072745A1 (en) Systems and methods for uav flight control
CN106959110B (zh) 一种云台姿态检测方法及装置
Carrillo et al. Quad rotorcraft control: vision-based hovering and navigation
US9958875B2 (en) Autonomous cargo delivery system
CN104808675B (zh) 基于智能终端的体感飞行操控系统及终端设备
Cai et al. Unmanned rotorcraft systems
Lee et al. Autonomous landing of a VTOL UAV on a moving platform using image-based visual servoing
US20160076892A1 (en) Methods and systems for determining a state of an unmanned aerial vehicle
US10571931B2 (en) Vehicle control system
US8779971B2 (en) Determining spatial orientation information of a body from multiple electromagnetic signals
US20200041234A1 (en) Aerial Vehicle Interception System
US20160327950A1 (en) Virtual camera interface and other user interaction paradigms for a flying digital assistant
Hoffmann et al. The Stanford testbed of autonomous rotorcraft for multi agent control (STARMAC)
JP5506369B2 (ja) Uavの飛行制御の方法およびシステム
EP3077879B1 (en) Imaging method and apparatus

Legal Events

Date Code Title Description
C06 Publication
PB01 Publication
C10 Entry into substantive examination
SE01 Entry into force of request for substantive examination
COR Change of bibliographic data
CB02 Change of applicant information

Address after: 261031 Dongfang Road, Weifang high tech Industrial Development Zone, Shandong, China, No. 268

Applicant after: Goertek Inc.

Address before: 261031 Dongfang Road, Weifang high tech Industrial Development Zone, Shandong, China, No. 268

Applicant before: Goertek Inc.

Address after: 261031 Dongfang Road, Weifang high tech Industrial Development Zone, Shandong, China, No. 268

Applicant after: Goertek Inc.

Address before: 261031 Dongfang Road, Weifang high tech Industrial Development Zone, Shandong, China, No. 268

Applicant before: Goertek Inc.

RJ01 Rejection of invention patent application after publication
RJ01 Rejection of invention patent application after publication

Application publication date: 20160629