CN103217984B - 基于手持终端的无人飞行器控制指令发送/接收方法及设备 - Google Patents

基于手持终端的无人飞行器控制指令发送/接收方法及设备 Download PDF

Info

Publication number
CN103217984B
CN103217984B CN201310140866.8A CN201310140866A CN103217984B CN 103217984 B CN103217984 B CN 103217984B CN 201310140866 A CN201310140866 A CN 201310140866A CN 103217984 B CN103217984 B CN 103217984B
Authority
CN
China
Prior art keywords
rudder
itype
pitch
roll
vdata
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
CN201310140866.8A
Other languages
English (en)
Other versions
CN103217984A (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.)
ZEROTECH (BEIJING) INTELLIGENCE TECHNOLOGY Co.,Ltd.
Original Assignee
Individual
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 Individual filed Critical Individual
Priority to CN201310140866.8A priority Critical patent/CN103217984B/zh
Publication of CN103217984A publication Critical patent/CN103217984A/zh
Application granted granted Critical
Publication of CN103217984B publication Critical patent/CN103217984B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Landscapes

  • Toys (AREA)

Abstract

本发明提供基于手持终端的无人飞行器控制指令发送方法,包括:S1、采集手持终端设备的传感器加速度信息;S2、根据所述传感器加速度信息计算手持终端设备的姿态角度和速度数据;S3、根据操作模式、所述姿态角度和速度数据,形成无人飞行器控制指令;S4、发送所述控制指令。本发明还提供与之相对应的接收方法和发送/接收设备。本发明将无人飞行器的控制***与手持终端设备相结合,因而携带起来方便,同时,减少了控制器的硬件设备,因而也降低了产品的成本;以图形化界面来显示控制指令,对于操作者来说不仅减少了操作的繁琐步骤,而且增加了操作时的直观性和娱乐性,同时,可以实现控制距离的巨大突破,这也将扩展无人飞行器的应用领域。

Description

基于手持终端的无人飞行器控制指令发送/接收方法及设备
技术领域
本发明涉及无人飞行器遥控方式,尤其涉及基于手持终端设备的无人飞行器遥控方法及装置。
背景技术
随着无人飞行器技术的不断进步发展,小型固定翼飞机、多旋翼飞机、直升机、飞艇等无人飞行器的应用越来越广泛。针对无人飞行器无人这一特点,必须提供对无人飞行器进行远程操控的能力,因此建立一种简便、可靠的操控方法显得尤为重要。
目前在无人飞行器操控中较常用到的是无线遥控器,通过无线遥控器上的操纵杆动作来控制无人飞行器的飞行,即现有的遥控技术通常由无线遥控器模块、无线接收机模块、无人飞行器控制模块组成无人飞行器的遥控***,其中无线接收机模块、无人飞行器控制模块装在无人飞行器上,无线遥控器模块在地面上供操作员操作。无线遥控器采集摇杆位置及相关开关位置信息并把采集到的位置信息通过射频链路发送到无线接收机模块,无人飞行器控制模块实时读取无线接收机模块接收到的控制数据,经过计算处理,控制无人飞行器的飞行,并且控制距离范围有限。使用这种无线遥控器的缺点是:体积大携带不方便,使用前需要校准造成使用起来也不方便。同时,使用这种无线遥控器能够实现遥控的距离十分的有限,也不利于无人飞行器的推广。
随着小型智能手持终端设备(如手机、平板电脑等)的普及,使用具有三轴加速度的智能移动终端来代替无线遥控器,对无人飞行器的操控就会更加简便、可靠。
发明内容
为了克服现有技术的不足,本发明提供一种基于手持终端的无人飞行器控制指令发送方法,其技术方案为:
一种基于手持终端的无人飞行器控制指令发送方法,其特征在于,包括如下步骤:
S1、采集手持终端设备的传感器加速度信息;
S2、根据所述传感器加速度信息计算手持终端设备的姿态角度和速度数据;
S3、根据操作模式、所述姿态角度和速度数据,形成无人飞行器控制指令;
S4、发送所述控制指令。
优选地,所述步骤S1包括:采集手持终端设备的传感器三轴加速度信息。
优选地,所述步骤S2包括:依据公式:Pitch=atan(x,z)和Roll=atan(y,z)计算手持终端设备的姿态角度;
其中,x表示手持终端设备横向线加速度分量;
y表示手持终端设备纵向线加速度分量;
z表示手持终端设备垂向线加速度分量;
atan表示反正切函数;
Pitch表示纵向姿态角度;
Roll表示横向姿态角度;
依据公式:速度数据Vdata=Adata*(Vmax/Amax)计算速度数据;
其中,Vdata表示速度数据;
Vmax表示最大速度;
Amax表示最大角度;
Adata表示当前姿态角度并且为Pitch或者Roll二者中的非零角度数值。
进一步优选地,其特征在于:所述速度数据Vdata数值范围为0-500;
Vmax=500;
Amax=90;
Pitch、Roll范围为:0-90度。
再进一步优选地,所述控制指令包括指令类型Itype和速度数据Vdata;
所述指令类型,根据操作模式和姿态角度进行判断;
所述操作模式,用Mode表示,设置为1或0;
当Mode=0:Pitch=0,Roll=0,则指令类型Itype=0,为保持;
Pitch>0,Roll=0,则指令类型Itype=1,为前进;
Pitch<0,Roll=0,则指令类型Itype=2,为后退;
Pitch=0,Roll<0,则指令类型Itype=3,为左飞;
Pitch=0,Roll>0,则指令类型Itype=4,为右飞;
当Mode=1:Pitch=0,Roll=0,则指令类型Itype=0,为保持;
Pitch=0,Roll<0,则指令类型Itype=5,为左转;
Pitch=0,Roll>0,则指令类型Itype=6,为右转;
Pitch>0,Roll=0,则指令类型Itype=7,为上升;
Pitch<0,Roll=0,则指令类型Itype=8,为下降。
本发明还提供一种基于手持终端的无人飞行器控制指令接收方法,包括如下步骤:
S1、接收手持终端设备的控制指令;
S2、提取所述控制指令的指令类型Itype和速度数据Vdata;
S3、根据所述指令类型和速度数据形成无人飞行器的执行指令;
S4、根据所述执行指令控制无人飞行器的飞行状态。
优选地,所述步骤S3包括:根据所述指令类型和速度数据形成无人飞行器的升降舵、副翼舵、方向舵、油门舵的输入信号。
进一步优选地,所述无人飞行器的升降舵、副翼舵、方向舵、油门舵的输入信号为PWM方波;
升降舵的输入信号Elevator、副翼舵的输入信号Aileron、方向舵的输入信号Rudder、油门舵的输入信号Throttle的具体数值通过如下公式计算:
Itype=0时,则Elevator=M,Aileron=M,Rudder=M,Throttle=M;
Itype=1时,则Elevator=M+Vdata,Aileron=M,Rudder=M,Throttle=M;
Itype=2时,则Elevator=M-Vdata,Aileron=M,Rudder=M,Throttle=M;
Itype=3时,则Elevator=M,Aileron=M-Vdata,Rudder=M,Throttle=M;
Itype=4时,则Elevator=M,Aileron=M+Vdata,Rudder=M,Throttle=M;
Itype=5时,则Elevator=M,Aileron=M,Rudder=M-Vdata,Throttle=M;
Itype=6时,则Elevator=M,Aileron=M,Rudder=M+Vdata,Throttle=M;
Itype=7时,则Elevator=M,Aileron=M,Rudder=M,Throttle=M+Vdata;
Itype=8时,则Elevator=M,Aileron=M,Rudder=M,Throttle=M-Vdata;
其中,M代表PWM方波范围的中间数值。
再进一步优选地,PWM方波范围为1000-2000,M=1500。
本发明还提供一种用于进行无人飞行器控制指令发送的手持终端设备,所述手持终端设备:用于采集手持终端设备的传感器加速度信息,根据所述传感器加速度信息计算手持终端设备的姿态角度和速度数据,并根据操作模式、所述姿态角度和速度数据,形成无人飞行器控制指令以供发射。
优选地,所述加速度信息为三轴加速度信息。
进一步优选地,包括:所述手持终端设备依据公式:Pitch=atan(x,z)和Roll=atan(y,z)计算手持终端设备的姿态角度;
其中,x表示手持终端设备横向线加速度分量;
y表示手持终端设备纵向线加速度分量;
z表示手持终端设备垂向线加速度分量;
atan表示反正切函数;
Pitch表示纵向姿态角度;
Roll表示横向姿态角度;
依据公式:速度数据Vdata=Adata*(Vmax/Amax)计算速度数据;
其中,Vdata表示速度数据;
Vmax表示最大速度;
Amax表示最大角度;
Adata表示当前姿态角度并且为Pitch或者Roll二者中的非零角度数值。
再进一步优选地,所述速度数据Vdata数值范围为0-500;
Vmax=500;
Amax=90;
Pitch、Roll范围为:0-90度。
更进一步优选地,所述无人飞行器控制指令包括指令类型Itype和速度数据Vdata;
所述指令类型,根据操作模式和姿态角度进行判断;
所述操作模式,用Mode表示,设置为1或0;
当Mode=0:Pitch=0,Roll=0,则指令类型Itype=0,为保持;
Pitch>0,Roll=0,则指令类型Itype=1,为前进;
Pitch<0,Roll=0,则指令类型Itype=2,为后退;
Pitch=0,Roll<0,则指令类型Itype=3,为左飞;
Pitch=0,Roll>0,则指令类型Itype=4,为右飞;
当Mode=1:Pitch=0,Roll=0,则指令类型Itype=0,为保持;
Pitch=0,Roll<0,则指令类型Itype=5,为左转;
Pitch=0,Roll>0,则指令类型Itype=6,为右转;
Pitch>0,Roll=0,则指令类型Itype=7,为上升;
Pitch<0,Roll=0,则指令类型Itype=8,为下降。
本发明还提供一种用于进行无人飞行器控制指令接收的设备,包括:数据接收模块、无人飞行器控制模块;
所述数据接收模块,用于接收手持终端设备的控制指令,并提取所述控制指令的指令类型Itype和速度数据Vdata;
所述无人飞行器控制模块,用于根据所述指令类型Itype和速度数据Vdata形成无人飞行器的执行指令,根据所述执行指令控制无人飞行器的飞行状态。
优选地,所述无人飞行器的执行指令为无人飞行器的升降舵、副翼舵、方向舵、油门舵的输入信号。
进一步优选地,所述无人飞行器的升降舵、副翼舵、方向舵、油门舵的输入信号为PWM方波;
升降舵的输入信号Elevator、副翼舵的输入信号Aileron、方向舵的输入信号Rudder、油门舵的输入信号Throttle的具体数值通过如下公式计算:
Itype=0时,则Elevator=M,Aileron=M,Rudder=M,Throttle=M;
Itype=1时,则Elevator=M+Vdata,Aileron=M,Rudder=M,Throttle=M;
Itype=2时,则Elevator=M-Vdata,Aileron=M,Rudder=M,Throttle=M;
Itype=3时,则Elevator=M,Aileron=M-Vdata,Rudder=M,Throttle=M;
Itype=4时,则Elevator=M,Aileron=M+Vdata,Rudder=M,Throttle=M;
Itype=5时,则Elevator-=M,Aileron=M,Rudder=M-Vdata,Throttle=M;
Itype=6时,则Elevator=M,Aileron=M,Rudder=M+Vdata,Throttle=M;
Itype=7时,则Elevator=M,Aileron=M,Rudder=M,Throttle=M+Vdata;
Itype=8时,则Elevator=M,Aileron=M,Rudder=M,Throttle=M-Vdata;
其中:M代表PWM方波范围的中间数值。
再进一步优选地,PWM方波范围为1000-2000,M=1500。
本发明相较于现有技术的有益效果为:
1、本发明将无人飞行器的控制***与手持终端设备(如手机、平板电脑等)相结合,使用者不必再另外配备控制器,因而携带起来方便。将控制***置于手持终端设备中,减少了控制器的硬件设备,因而也降低了产品的成本。同时,随着手持终端设备的普及,也会使更多人群能够接触、了解、使用无人飞行器,便于无人飞行器的推广。
2、本发明提供的控制方法在使用前不需要校准,因而使用简单,操作方便的。
3、本发明提供的控制方法可以用图形化界面来显示控制指令,对于操作者来说不仅减少了操作的繁琐步骤,而且增加了操作时的直观性和娱乐性。
4、现有技术对于无人飞行器的控制距离有很大限制,本发明提供的控制方法通过增加数据传输设备,可以实现控制距离的巨大突破,这也将扩展无人飞行器的应用领域。
附图说明
图1一种基于手持终端的无人飞行器控制指令发送方法的流程图;
图2一种基于手持终端的无人飞行器控制指令接收方法的流程图;
图3一种用于进行无人飞行器控制指令发送的手持终端设备结构图;
图4一种用于进行无人飞行器控制指令接收的设备结构图。
图5为本发明中对于横向、纵向、垂向的解释示意图
具体实施方式
为使本发明的目的、技术方案和优点更加清楚,下面将结合附图对本发明的具体实施方式作进一步地详细描述。显然,所描述的实施例仅是本发明的一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有付出创造性劳动的前提下所得到的所有实施例都属于本发明的保护范围。
图1为一种基于手持终端的无人飞行器控制指令发送方法的流程图。从图中可以看出,本发明一种基于手持终端设备的无人飞行器控制方法包括如下步骤:S1、采集手持终端设备的传感器加速度信息;S2、根据所述传感器加速度信息计算手持终端设备的姿态角度和速度数据;S3、根据操作模式、所述姿态角度和速度数据,形成无人飞行器控制指令;S4、发送所述控制指令。
在本发明中,S1步骤中采集手持终端设备的传感器加速度信息。其中,所述传感器的加速度信息优选地为三轴加速度信息。所述三轴加速度信息,为手持终端设备所处三维立体空间三个方向线加速度分量,即手持终端设备纵向线加速度分量、手持终端设备横向线加速度分量和手持终端设备垂向线加速度分量。其中,在本发明中,纵向,横向,垂向含义如图5所示,为:将手持终端设备屏幕向上水平放置,垂直于手持终端设备屏幕的方向为垂向z,面向手持终端设备屏幕,左右方向为横向x,上下方向为纵向y。
在本发明中,S2步骤中根据所述传感器加速度信息计算手持终端设备的姿态角度和速度数据。所述计算手持终端设备的姿态角度,首先通过所述手持终端设备的三轴加速度传感器测量所述手持终端设备所处三维立体空间三个方向线加速度分量,由所述手持终端设备所处三维立体空间三个方向线加速度分量计算手持终端设备的姿态角度。
计算方法如下:
姿态角度依据公式:Pitch=atan(x,z)和Roll=atan(y,z)进行计算;
x表示手持终端设备横向线加速度分量;
y表示手持终端设备纵向线加速度分量;
z表示手持终端设备垂向线加速度分量;
atan表示反正切函数;
Pitch表示纵向姿态角度,优选地,pitch范围为:0-90度;
Roll表示横向姿态角度,优选地,roll范围为:0-90度。
依据公式:速度数据Vdata=Adata*(Vmax/Amax)计算速度数据;
其中,Vdata表示速度数据;
Vmax表示最大速度;
Amax表示最大角度;
Adata表示当前姿态角度并且为Pitch或者Roll二者中的非零角度数值。
优选地,所述速度数据Vdata数值范围为0-500;Vmax=500;Amax=90;Pitch、Roll范围为:0-90度。
在本发明中,S3步骤中根据操作模式、所述姿态角度和速度数据,形成无人飞行器控制指令。所述操作模式,用Mode表示,优选地,Mode可以设置为1或0,***默认为0,可以由操作员通过软件界面设置。所述控制指令包括控制无人飞行器前进、后退、左飞,右飞、左转、右转、上升、下降指令。对于所述控制指令的理解也不应当限于上述列举,包括所有使用三轴加速度数据经过计算分析形成的控制无人飞行器飞行的控制指令。所述形成无人飞行器的控制指令是指由手持终端设备的前后移动、左右移动、上下移动、前后翻转、左右翻转状态形成的控制指令,包括:控制无人飞行器前进、后退控制指令;控制无人飞行器向左飞行,向右飞行控制指令;控制无人飞行器左转、右转控制指令;控制无人飞行器上升、下降控制指令等。
下面结合实施例详细介绍具体的控制指令的形成过程:
当手持终端设备水平静止放置时,三轴加速度值x=0,y=0,z=9.8,计算出的姿态角度值为pitch=0,roll=0。pitch范围为:0-90度,roll范围为:0-90度。
控制指令由指令类型Itype和速度数据Vdata组成。
其中,指令类型,根据操作模式和姿态角度进行判断。
所述操作模式,用Mode表示,优选地,可以设置为1或0,***默认为0。
在本实施例中:
当Mode=0:Pitch=0,Roll=0,则指令类型Itype=0,为保持;
Pitch>0,Roll=0,则指令类型Itype=1,为前进;
Pitch<0,Roll=0,则指令类型Itype=2,为后退;
Pitch=0,Roll<0,则指令类型Itype=3,为左飞;
Pitch=0,Roll>0,则指令类型Itype=4,为右飞;
当Mode=1:Pitch=0,Roll=0,则指令类型Itype=0,为保持;
Pitch=0,Roll<0,则指令类型Itype=5,为左转;
Pitch=0,Roll>0,则指令类型Itype=6,为右转;
Pitch>0,Roll=0,则指令类型Itype=7,为上升;
Pitch<0,Roll=0,则指令类型Itype=8,为下降。
其中,速度数据依据Vdata=Adata*(Vmax/Amax)进行计算;
其中,Vdata表示速度数据;
Vmax表示最大速度;
Amax表示最大角度;
Adata表示当前姿态角度并且为Pitch或者Roll二者中的非零角度数值。
优选地,所述速度数据Vdata数值范围为0-500;Vmax=500;Amax=90;Pitch、Roll范围为:0-90度。
下面再具体介绍每一个具体指令的生成:
1、前进指令的生成:
手持终端设备沿y轴做一个旋转动作,优选地,设三轴加速度值分别为x=4.9,y=0,z=4.9,计算出的姿态角度值为pitch=45度,roll=0度,***默认Mode=0,则生成前进指令,速度数据Vdata为45*(500/90)=250。
2、后退指令的生成:
手持终端设备沿y轴做一个旋转动作,优选地,设三轴加速度值分别为x=-4.9,y=0,z=4.9,计算出的姿态角度值为pitch=-45度,roll=0度,***默认Mode=0,则生成后退指令,速度数据Vdata为45*(500/90)=250。
3、左飞指令的生成:
手持终端设备沿x轴做一个旋转动作,优选地,设三轴加速度值分别为x=0,y=-4.9,z=4.9,计算出的姿态角度值为pitch=0度,roll=-45度,***默认Mode=0,则生成左飞指令,速度数据Vdata为45*(500/90)=250。
4、右飞指令的生成:
手持终端设备沿x轴做一个旋转动作,优选地,设三轴加速度值分别为x=0,y=4.9,z=4.9,计算出的姿态角度值为pitch=0度,roll=45度,***默认Mode=0,则生成右飞指令,速度数据Vdata为45*(500/90)=250。
5、左转指令的生成:
手持终端设备沿x轴做一个旋转动作,优选地,设三轴加速度值分别为x=0,y=-4.9,z=4.9,计算出的姿态角度值为pitch=0度,roll=-45度,***设置Mode=1,则生成左转指令,速度数据Vdata为45*(500/90)=250。
6、右转指令的生成:
手持终端设备沿x轴做一个旋转动作,优选地,设三轴加速度值分别为x=0,y=4.9,z=4.9,计算出的姿态角度值为pitch=0度,roll=45度,***设置Mode=1,则生成右转指令,速度数据Vdata为45*(500/90)=250。
7、上升指令的生成:
手持终端设备沿y轴做一个旋转动作,优选地,设三轴加速度值分别为x=4.9,y=0,z=4.9,计算出的姿态角度值为pitch=45度,roll=0度,***设置Mode=1,则成上升指令,速度数据Vdata为45*(500/90)=250。
8、下降指令的生成:
手持终端设备沿y轴做一个旋转动作,优选地,设三轴加速度值分别为x=-4.9,y=0,z=4.9,计算出的姿态角度值为pitch=-45度,roll=0度,***设置Mode=1,则成下降指令,速度数据Vdata为45*(500/90)=250。
上述八种控制指令只是作为典型指令在此详细说明,但是不应当把本发明所提供的方法所能生成的指令理解为仅为上述八种控制指令,而应当理解为依据不同的细分标准而产生的所有分组情况与操作模式相结合而可能产生的所有控制指令。
在本发明中,S4步骤为发送所述控制指令,可以通过wifi模式、蓝牙模式或无线链路发送控制指令;优选地,通过无线链路发送控制指令。
优选地,在本发明中,还包括在所述手持终端设备上显示所述控制指令的步骤。进一步优选地,在所述手持终端设备上显示所述控制指令的步骤包括在所述手持终端设备上以图形化界面显示所述控制指令。当优选地以图形化界面显示控制指令时,操作模式Mode如果设置为1可以优选地表示用手指按住屏幕界面的中心;操作模式Mode如果设置为0可以优选地表示没有用手指按住屏幕界面的中心。当然,显示所述控制指令优选地以图形化界面显示所述控制指令,但是不限于以图形化界面方式显示一种方式,还可以包括以文字信息等方式来显示所述控制指令。所述以图形化界面显示所述控制指令,指采用图形界面显示无人飞行器前进、后退控制指令,向左飞行,向右飞行控制指令,左转、右转控制指令,上升、下降控制指令等。
在本发明中,对于以上所有的步骤中所述手持终端设备包括手机、平板电脑等具有三轴加速度传感器的终端设备,但不限于手机、平板电脑。
图2为一种基于手持终端的无人飞行器控制指令接收方法的流程图,从图中可以看出,一种基于手持终端的无人飞行器控制指令接收方法,包括步骤:S1、接收手持终端设备的控制指令;S2、提取所述控制指令的指令类型Itype和速度数据Vdata;S3、根据所述的指令类型Itype和速度数据Vdata形成无人飞行器的执行指令;S4、根据所述执行指令控制无人飞行器的飞行状态。
优选地,对于无人飞行器的飞行控制是通过改变无人飞行器的升降舵、副翼舵、方向舵、油门舵的输入信号来实现。所以无人飞行器的执行指令即为无人飞行器的升降舵、副翼舵、方向舵、油门舵的输入信号。在本发明中,无人飞行器的升降舵、副翼舵、方向舵、油门舵的输入信号优选地为PWM方波。
为了便于说明本发明的方法,优选地以四旋翼无人飞行器为典型实施例介绍本发明的实现方式,具体为:
升降舵的输入信号Elevator、副翼舵的输入信号Aileron、方向舵的输入信号Rudder、油门舵的输入信号Throttle的具体数值通过如下公式计算:
Itype=0时,则Elevator=M,Aileron=M,Rudder=M,Throttle=M;
Itype=1时,则Elevator=M+Vdata,Aileron=M,Rudder=M,Throttle=M;
Itype=2时,则Elevator=M-Vdata,Aileron=M,Rudder=M,Throttle=M;
Itype=3时,则Elevator=M,Aileron=M-Vdata,Rudder=M,Throttle=M;
Itype=4时,则Elevator=M,Aileron=M+Vdata,Rudder=M,Throttle=M;
Itype=5时,则Elevator=M,Aileron=M,Rudder=M-Vdata,Throttle=M;
Itype=6时,则Elevator=M,Aileron=M,Rudder=M+Vdata,Throttle=M;
Itype=7时,则Elevator=M,Aileron=M,Rudder=M,Throttle=M+Vdata;
Itype=8时,则Elevator=M,Aileron=M,Rudder=M,Throttle=M-Vdata;
其中,M代表PWM方波范围的中间数值。
优选地,PWM方波范围为1000-2000,M=1500。
然后,根据升降舵、副翼舵、方向舵、油门舵的具体输入信号实现对无人飞行器的控制,即由Elevator、Aileron、Rudder、Throttle作为升降舵、副翼舵、方向舵、油门舵的输入PWM方波信号实现对升降舵、副翼舵、方向舵、油门舵的控制,进而实现对无人行器的飞行状态控制,即:
当Elevator=M,Aileron=M,Rudder=M,Throttle=M,则无人飞行器保持现状;
当Elevator=M+Vdata,Aileron=M,Rudder=M,Throttle=M,则无人飞行器前进;
当Elevator=M-Vdata,Aileron=M,Rudder=M,Throttle=M,则无人飞行器后退;
当Elevator=M,Aileron=M-Vdata,Rudder=M,Throttle=M,则无人飞行器左飞;
当Elevator=M,Aileron=M+Vdata,Rudder=M,Throttle=M,则无人飞行器右飞;
当Elevator=M,Aileron=M,Rudder=M-Vdata,Throttle=M,则无人飞行器左转;
当Elevator=M,Aileron=M,Rudder=M+Vdata,Throttle=M,则无人飞行器右转;
当Elevator=M,Aileron=M,Rudder=M,Throttle=M+Vdata,则无人飞行器上升;
当Elevator=M,Aileron=M,Rudder=M,Throttle=M-Vdata,则无人飞行器下降。
图3为一种用于进行无人飞行器控制指令发送的手持终端设备结构图。从图中可以看出,一种基于手持终端的无人飞行器控制指令发送设备,包括:手持终端设备;所述手持终端设备:用于采集手持终端设备的传感器加速度信息,根据所述传感器加速度信息计算手持终端设备的姿态角度和速度数据,并根据操作模式、所述姿态角度和速度数据,形成无人飞行器控制指令以供发射。
优选地,所述加速度信息为三轴加速度信息。
进一步优选地,所述手持终端设备依据公式:Pitch=atan(x,z)和Roll=atan(y,z)计算手持终端设备的姿态角度;
其中,x表示手持终端设备横向线加速度分量;
y表示手持终端设备纵向线加速度分量;
z表示手持终端设备垂向线加速度分量;
atan表示反正切函数;
Pitch表示纵向姿态角度;
Roll表示横向姿态角度;
依据公式:速度数据Vdata=Adata*(Vmax/Amax)计算速度数据;
其中,Vdata表示速度数据;
Vmax表示最大速度;
Amax表示最大角度;
Adata表示当前姿态角度并且为Pitch或者Roll二者中的非零角度数值。
再进一步优选地,所述速度数据Vdata数值范围为0-500;
Vmax=500;
Amax=90;
Pitch、Roll范围为:0-90度。
更进一步优选地,所述无人飞行器控制指令包括指令类型Itype和速度数据Vdata;
所述指令类型,根据操作模式和姿态角度进行判断;
所述操作模式,用Mode表示,设置为1或0;
当Mode=0:Pitch=0,Roll=0,则指令类型Itype=0,为保持;
Pitch>0,Roll=0,则指令类型Itype=1,为前进;
Pitch<0,Roll=0,则指令类型Itype=2,为后退;
Pitch=0,Roll<0,则指令类型Itype=3,为左飞;
Pitch=0,Roll>0,则指令类型Itype=4,为右飞;
当Mode=1:Pitch=0,Roll=0,则指令类型Itype=0,为保持;
Pitch=0,Roll<0,则指令类型Itype=5,为左转;
Pitch=0,Roll>0,则指令类型Itype=6,为右转;
Pitch>0,Roll=0,则指令类型Itype=7,为上升;
Pitch<0,Roll=0,则指令类型Itype=8,为下降。
当然,本发明还可以优选地包括数据传输模块,用于通过wifi模式、蓝牙模式或无线链路发送控制指令;优选地,通过无线链路发送控制指令。
图4为一种用于进行无人飞行器控制指令接收的设备结构图。从图中可以看出,本发明一种基于手持终端的无人飞行器控制指令接收设备,包括:数据接收模块、无人飞行器控制模块;所述数据接收模块,用于接收手持终端设备的控制指令,并提取所述控制指令的指令类型Itype和速度数据Vdata;所述无人飞行器控制模块,用于根据所述指令类型Itype和速度数据Vdata形成无人飞行器的执行指令,根据所述执行指令控制无人飞行器的飞行状态。
优选地,所述无人飞行器的执行指令为无人飞行器的升降舵、副翼舵、方向舵、油门舵的输入信号。
进一步优选地,所述无人飞行器的升降舵、副翼舵、方向舵、油门舵的输入信号为PWM方波;
升降舵的输入信号Elevator、副翼舵的输入信号Aileron、方向舵的输入信号Rudder、油门舵的输入信号Throttle的具体数值通过如下公式计算:
Itype=0时,则Elevator=M,Aileron=M,Rudder=M,Throttle=M;
Itype=1时,则Elevator=M+Vdata,Aileron=M,Rudder=M,Throttle=M;
Itype=2时,则Elevator=M-Vdata,Aileron=M,Rudder=M,Throttle=M;
Itype=3时,则Elevator=M,Aileron=M-Vdata,Rudder=M,Throttle=M;
Itype=4时,则Elevator=M,Aileron=M+Vdata,Rudder=M,Throttle=M;
Itype=5时,则Elevator=M,Aileron=M,Rudder=M-Vdata,Throttle=M;
Itype=6时,则Elevator=M,Aileron=M,Rudder=M+Vdata,Throttle=M;
Itype=7时,则Elevator=M,Aileron=M,Rudder=M,Throttle=M+Vdata;
Itype=8时,则Elevator=M,Aileron=M,Rudder=M,Throttle=M-Vdata;
其中:M代表PWM方波范围的中间数值。
更进一步优选地,PWM方波范围为1000-2000,M=1500。
采用以上技术方案后,手持终端设备的运动状态转变为无人飞行器的控制指令,控制无人飞行器飞行。无人飞行器操作员通过控制手持终端设备的运动,实现对无人飞行器的遥控。同时,在手持终端设备的屏幕上显示无人飞行器的控制指令,很容易确定无人飞行器执行控制指令之后的飞行状态。本发明提供的一种基于手持终端设备的无人飞行器控制方法经过实际的应用测试,证明了操作直观简便、性能安全可靠。
以上所述仅为本发明的较佳实施例,并不用以限制本发明,凡在本发明的精神和原则之内,所作的任何修改、等同替换、改进等,均应包含在本发明的保护范围之内。

Claims (10)

1.一种基于手持终端的无人飞行器控制指令发送方法,其特征在于,包括如下步骤:
S1、采集手持终端设备的传感器三轴加速度信息;
S2、根据所述传感器加速度信息计算手持终端设备的姿态角度和速度数据;
所述步骤S2包括:依据公式:Pitch=atan(x,z)和Roll=atan(y,z)计算手持终端设备的姿态角度;
其中,x表示手持终端设备横向线加速度分量;
y表示手持终端设备纵向线加速度分量;
z表示手持终端设备垂向线加速度分量;
atan表示反正切函数;
Pitch表示纵向姿态角度;
Roll表示横向姿态角度;
依据公式:速度数据Vdata=Adata*(Vmax/Amax)计算速度数据;
其中,Vdata表示速度数据;
Vmax表示最大速度;
Amax表示最大角度;
Adata表示当前姿态角度并且为Pitch或者Roll二者中的非零角度数值;
S3、根据操作模式、所述姿态角度和速度数据,形成无人飞行器控制指令;所述控制指令包括指令类型Itype和速度数据Vdata;所述指令类型,根据操作模式和姿态角度进行判断;
S4、发送所述控制指令。
2.如权利要求1所述方法,其特征在于:
所述速度数据Vdata数值范围为0-500;
Vmax=500;
Amax=90;
Pitch、Roll范围为:0-90度。
3.如权利要求2所述方法,其特征在于:
所述操作模式,用Mode表示,设置为1或0;
当Mode=0:Pitch=0,Roll=0,则指令类型Itype=0,为保持;
Pitch>0,Roll=0,则指令类型Itype=1,为前进;
Pitch<0,Roll=0,则指令类型Itype=2,为后退;
Pitch=0,Roll<0,则指令类型Itype=3,为左飞;
Pitch=0,Roll>0,则指令类型Itype=4,为右飞;
当Mode=1:Pitch=0,Roll=0,则指令类型Itype=0,为保持;
Pitch=0,Roll<0,则指令类型Itype=5,为左转;
Pitch=0,Roll>0,则指令类型Itype=6,为右转;
Pitch>0,Roll=0,则指令类型Itype=7,为上升;
Pitch<0,Roll=0,则指令类型Itype=8,为下降。
4.一种基于手持终端的无人飞行器控制指令接收方法,其特征在于,包括如下步骤:
S1、接收手持终端设备的控制指令;
S2、提取所述控制指令的指令类型Itype和速度数据Vdata;
S3、根据所述指令类型和速度数据形成无人飞行器的执行指令;包括:根据所述指令类型和速度数据形成无人飞行器的升降舵、副翼舵、方向舵、油门舵的输入信号;
所述无人飞行器的升降舵、副翼舵、方向舵、油门舵的输入信号为PWM方波;
升降舵的输入信号Elevator、副翼舵的输入信号Aileron、方向舵的输入信号Rudder、油门舵的输入信号Throttle的具体数值通过如下公式计算:
Itype=0时,则Elevator=M,Aileron=M,Rudder=M,Throttle=M;
Itype=1时,则Elevator=M+Vdata,Aileron=M,Rudder=M,Throttle=M;
Itype=2时,则Elevator=M-Vdata,Aileron=M,Rudder=M,Throttle=M;
Itype=3时,则Elevator=M,Aileron=M-Vdata,Rudder=M,Throttle=M;
Itype=4时,则Elevator=M,Aileron=M+Vdata,Rudder=M,Throttle=M;
Itype=5时,则Elevator=M,Aileron=M,Rudder=M-Vdata,Throttle=M;
Itype=6时,则Elevator=M,Aileron=M,Rudder=M+Vdata,Throttle=M;
Itype=7时,则Elevator=M,Aileron=M,Rudder=M,Throttle=M+Vdata;
Itype=8时,则Elevator=M,Aileron=M,Rudder=M,Throttle=M–Vdata;
其中,M代表PWM方波范围的中间数值;
S4、根据所述执行指令控制无人飞行器的飞行状态。
5.如权利要求4所述方法,其特征在于:
PWM方波范围为1000-2000,M=1500。
6.一种用于进行无人飞行器控制指令发送的手持终端设备,其特征在于,所述手持终端设备:用于采集手持终端设备的传感器三轴加速度信息,根据所述传感器加速度信息计算手持终端设备的姿态角度和速度数据,并根据操作模式、所述姿态角度和速度数据,形成无人飞行器控制指令以供发射;
其中,所述手持终端设备依据公式:Pitch=atan(x,z)和Roll=atan(y,z)计算手持终端设备的姿态角度;
其中,x表示手持终端设备横向线加速度分量;
y表示手持终端设备纵向线加速度分量;
z表示手持终端设备垂向线加速度分量;
atan表示反正切函数;
Pitch表示纵向姿态角度;
Roll表示横向姿态角度;
依据公式:速度数据Vdata=Adata*(Vmax/Amax)计算速度数据;
其中,Vdata表示速度数据;
Vmax表示最大速度;
Amax表示最大角度;
Adata表示当前姿态角度并且为Pitch或者Roll二者中的非零角度数值;
其中,所述无人飞行器控制指令包括指令类型Itype和速度数据Vdata;所述指令类型,根据操作模式和姿态角度进行判断。
7.如权利要求6所述的设备,其特征在于:
所述速度数据Vdata数值范围为0-500;
Vmax=500;
Amax=90;
Pitch、Roll范围为:0-90度。
8.如权利要求7所述的设备,其特征在于,包括:
所述操作模式,用Mode表示,设置为1或0;
当Mode=0:Pitch=0,Roll=0,则指令类型Itype=0,为保持;
Pitch>0,Roll=0,则指令类型Itype=1,为前进;
Pitch<0,Roll=0,则指令类型Itype=2,为后退;
Pitch=0,Roll<0,则指令类型Itype=3,为左飞;
Pitch=0,Roll>0,则指令类型Itype=4,为右飞;
当Mode=1:Pitch=0,Roll=0,则指令类型Itype=0,为保持;
Pitch=0,Roll<0,则指令类型Itype=5,为左转;
Pitch=0,Roll>0,则指令类型Itype=6,为右转;
Pitch>0,Roll=0,则指令类型Itype=7,为上升;
Pitch<0,Roll=0,则指令类型Itype=8,为下降。
9.一种用于进行无人飞行器控制指令接收的设备,其特征在于,包括:数据接收模块、无人飞行器控制模块;
所述数据接收模块,用于接收手持终端设备的控制指令,并提取所述控制指令的指令类型Itype和速度数据Vdata;
所述无人飞行器控制模块,用于根据所述指令类型Itype和速度数据Vdata形成无人飞行器的执行指令,根据所述执行指令控制无人飞行器的飞行状态;
其中,所述无人飞行器的执行指令为无人飞行器的升降舵、副翼舵、方向舵、油门舵的输入信号;
所述无人飞行器的升降舵、副翼舵、方向舵、油门舵的输入信号为PWM方波;
升降舵的输入信号Elevator、副翼舵的输入信号Aileron、方向舵的输入信号Rudder、油门舵的输入信号Throttle的具体数值通过如下公式计算:
Itype=0时,则Elevator=M,Aileron=M,Rudder=M,Throttle=M;
Itype=1时,则Elevator=M+Vdata,Aileron=M,Rudder=M,Throttle=M;
Itype=2时,则Elevator=M-Vdata,Aileron=M,Rudder=M,Throttle=M;
Itype=3时,则Elevator=M,Aileron=M-Vdata,Rudder=M,Throttle=M;
Itype=4时,则Elevator=M,Aileron=M+Vdata,Rudder=M,Throttle=M;
Itype=5时,则Elevator=M,Aileron=M,Rudder=M-Vdata,Throttle=M;
Itype=6时,则Elevator=M,Aileron=M,Rudder=M+Vdata,Throttle=M;
Itype=7时,则Elevator=M,Aileron=M,Rudder=M,Throttle=M+Vdata;
Itype=8时,则Elevator=M,Aileron=M,Rudder=M,Throttle=M–Vdata;
其中:M代表PWM方波范围的中间数值。
10.如权利要求9所述的设备,其特征在于:
PWM方波范围为1000-2000,M=1500。
CN201310140866.8A 2013-04-22 2013-04-22 基于手持终端的无人飞行器控制指令发送/接收方法及设备 Active CN103217984B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201310140866.8A CN103217984B (zh) 2013-04-22 2013-04-22 基于手持终端的无人飞行器控制指令发送/接收方法及设备

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201310140866.8A CN103217984B (zh) 2013-04-22 2013-04-22 基于手持终端的无人飞行器控制指令发送/接收方法及设备

Publications (2)

Publication Number Publication Date
CN103217984A CN103217984A (zh) 2013-07-24
CN103217984B true CN103217984B (zh) 2016-01-20

Family

ID=48815880

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201310140866.8A Active CN103217984B (zh) 2013-04-22 2013-04-22 基于手持终端的无人飞行器控制指令发送/接收方法及设备

Country Status (1)

Country Link
CN (1) CN103217984B (zh)

Families Citing this family (10)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN104977936A (zh) * 2014-04-09 2015-10-14 上海九鹰电子科技有限公司 遥控信号的发送/接收方法和装置以及遥控器和遥控模型
CN105573330B (zh) * 2015-03-03 2018-11-09 广州亿航智能技术有限公司 基于智能终端的飞行器操控方法
KR102319802B1 (ko) * 2015-04-21 2021-11-01 삼성전자주식회사 도킹에 의한 기능 확장 방법 및 이를 위한 전자 장치
CN104991563B (zh) * 2015-05-12 2023-10-03 零度智控(北京)智能科技有限公司 一种无人机分级操作的方法及***
CN105549582A (zh) * 2015-07-23 2016-05-04 黄中一 带体感控制的智能小车
CN105511496B (zh) * 2016-02-16 2018-08-03 谭圆圆 一种无人飞行器的控制方法及装置
CN105549620B (zh) * 2016-02-25 2019-07-19 上海未来伙伴机器人有限公司 飞行器遥控棒及控制飞行器飞行的方法
CN106020220B (zh) * 2016-05-24 2023-12-08 零度智控(北京)智能科技有限公司 无人机、无人机飞行控制方法及装置
CN110223565B (zh) * 2019-06-25 2022-02-22 深圳市道通智能航空技术股份有限公司 一种飞行模拟方法、装置、设备及存储介质
CN111086509B (zh) * 2019-12-30 2021-09-17 北汽福田汽车股份有限公司 车辆控制方法、装置、存储介质以及车辆

Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN201904829U (zh) * 2010-09-01 2011-07-20 黄俊升 手机遥控装置
CN201978499U (zh) * 2011-01-28 2011-09-21 深圳市格兰之特科技有限公司 一种动作感知的遥控器及飞行器
CN102445947A (zh) * 2010-10-06 2012-05-09 鸿富锦精密工业(深圳)有限公司 无人飞行载具控制***及方法

Family Cites Families (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2004359002A (ja) * 2003-06-02 2004-12-24 Tamagawa Seiki Co Ltd 無人ヘリコプターの自立制御方法及び装置
US20070244608A1 (en) * 2006-04-13 2007-10-18 Honeywell International Inc. Ground control station for UAV
US20080174448A1 (en) * 2006-10-31 2008-07-24 Edison Hudson Modular Controller

Patent Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN201904829U (zh) * 2010-09-01 2011-07-20 黄俊升 手机遥控装置
CN102445947A (zh) * 2010-10-06 2012-05-09 鸿富锦精密工业(深圳)有限公司 无人飞行载具控制***及方法
CN201978499U (zh) * 2011-01-28 2011-09-21 深圳市格兰之特科技有限公司 一种动作感知的遥控器及飞行器

Also Published As

Publication number Publication date
CN103217984A (zh) 2013-07-24

Similar Documents

Publication Publication Date Title
CN103217984B (zh) 基于手持终端的无人飞行器控制指令发送/接收方法及设备
CN104598108B (zh) 一种智能终端触控方式比例遥控被遥控设备的方法
CN103218061A (zh) 一种基于手持终端设备的控制方法及设备
CN102789327B (zh) 一种基于手势的移动机器人控制方法
TWI459234B (zh) 手持裝置及利用其控制無人飛行載具的方法
CN202758243U (zh) 一种无人机飞行操控***
KR101117207B1 (ko) 스마트폰을 이용한 무인비행체 자동 및 수동 조종시스템
CN104808675B (zh) 基于智能终端的体感飞行操控***及终端设备
CN102854887A (zh) 一种无人机航迹规划和远程同步操控方法
CN104597912A (zh) 一种六旋翼无人直升机跟踪飞行控制***及方法
US20110288695A1 (en) Control interface for unmanned vehicles
CN104965522A (zh) 基于gps的多旋翼无人机自动跟踪***
CN107000839A (zh) 无人机的控制方法、装置、设备和无人机的控制***
WO2014187205A1 (zh) 遥控信号的发送及接收的装置和方法、遥控设备
KR20210089603A (ko) 차량 순항 제어 방법, 장치, 전자 기기 및 저장 매체
CN104950885A (zh) 一种基于视觉和力觉反馈的uav群双边遥操作控制***及其方法
CN104898524A (zh) 基于手势的无人机遥控***
US20230280763A1 (en) Method for protection unmanned aerial vehicle and unmanned aerial vehicle
CN103558853A (zh) 自由路径下能自动升降agv控制***
CN102331778B (zh) 手持装置及利用其控制无人飞行载具的方法
CN105549582A (zh) 带体感控制的智能小车
JP2015091282A (ja) ラジコン玩具自動操縦装置及びコンピュータプログラム
KR101751864B1 (ko) 무인이동체 조종 방법, 이를 구현하기 위한 프로그램이 저장된 기록매체 및 이를 구현하기 위해 매체에 저장된 컴퓨터프로그램
CN204790577U (zh) 基于gps的多旋翼无人机自动跟踪***
US20190101912A1 (en) Remote Control Apparatus and Remote Control System

Legal Events

Date Code Title Description
C06 Publication
PB01 Publication
C10 Entry into substantive examination
SE01 Entry into force of request for substantive examination
C14 Grant of patent or utility model
GR01 Patent grant
C41 Transfer of patent application or patent right or utility model
TR01 Transfer of patent right

Effective date of registration: 20160420

Address after: 100193 Beijing city Haidian District Dongbeiwang West Road No. 8 Zhongguancun Software Park Building 9, 2 District 203

Patentee after: ZEROTECH (BEIJING) INTELLIGENCE TECHNOLOGY Co.,Ltd.

Address before: 100085 Beijing city Haidian District on the ten Street No. 1, No. 4 Building 5 layer 506

Patentee before: Yang Jianjun

Patentee before: Zhao Guodong

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

Denomination of invention: Unmanned aerial vehicle control instruction sending / receiving method based on hand-held terminal and unmanned aerial vehicle control instruction sending / receiving equipment

Effective date of registration: 20170327

Granted publication date: 20160120

Pledgee: XinDa national equity investment fund (Shanghai) partnership (L.P.)|Beijing Civil Aviation Heyuan Investment Center (L.P.)

Pledgor: ZEROTECH (BEIJING) INTELLIGENCE TECHNOLOGY Co.,Ltd.

Registration number: 2017990000242

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

Effective date of registration: 20190906

Granted publication date: 20160120

PD01 Discharge of preservation of patent

Date of cancellation: 20220406

Granted publication date: 20160120

PD01 Discharge of preservation of patent
PP01 Preservation of patent right

Effective date of registration: 20220406

Granted publication date: 20160120

PP01 Preservation of patent right
PC01 Cancellation of the registration of the contract for pledge of patent right

Date of cancellation: 20221008

Granted publication date: 20160120

Pledgee: XinDa national equity investment fund (Shanghai) partnership (L.P.)|Beijing Civil Aviation Heyuan Investment Center (L.P.)

Pledgor: ZEROTECH (BEIJING) INTELLIGENCE TECHNOLOGY Co.,Ltd.

Registration number: 2017990000242

PC01 Cancellation of the registration of the contract for pledge of patent right
PD01 Discharge of preservation of patent

Date of cancellation: 20220918

Granted publication date: 20160120

PD01 Discharge of preservation of patent
PP01 Preservation of patent right

Effective date of registration: 20220918

Granted publication date: 20160120

PP01 Preservation of patent right