CN112817322A - 一种头戴式无人直升机控制系统及其控制方法 - Google Patents

一种头戴式无人直升机控制系统及其控制方法 Download PDF

Info

Publication number
CN112817322A
CN112817322A CN202011645049.4A CN202011645049A CN112817322A CN 112817322 A CN112817322 A CN 112817322A CN 202011645049 A CN202011645049 A CN 202011645049A CN 112817322 A CN112817322 A CN 112817322A
Authority
CN
China
Prior art keywords
control
formula
data
attitude
head
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.)
Pending
Application number
CN202011645049.4A
Other languages
English (en)
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.)
Zhuhai Ziyan Unmanned Aerial Vehicle Co ltd
Original Assignee
Zhuhai Ziyan Unmanned Aerial Vehicle 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 Zhuhai Ziyan Unmanned Aerial Vehicle Co ltd filed Critical Zhuhai Ziyan Unmanned Aerial Vehicle Co ltd
Priority to CN202011645049.4A priority Critical patent/CN112817322A/zh
Publication of CN112817322A publication Critical patent/CN112817322A/zh
Pending legal-status Critical Current

Links

Images

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/08Control of attitude, i.e. control of roll, pitch, or yaw
    • G05D1/0808Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for aircraft
    • G05D1/0858Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for aircraft specially adapted for vertical take-off of aircraft
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B13/00Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion
    • G05B13/02Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric
    • G05B13/04Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators
    • G05B13/042Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators in which a parameter or coefficient is automatically adjusted to optimise the performance
    • 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/0011Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot associated with a remote control arrangement
    • G05D1/0022Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot associated with a remote control arrangement characterised by the communication link

Abstract

本发明提供的一种头戴式无人直升机控制系统及其控制方法,包括机载单元和地面站系统;机载单元包括飞行处理器、传感器模块、内置算法模块、无线传输模块、遥控接收机和用于实时跟踪对准目标物的执行机构,地面控制单元包括测控终端,测控终端包括PC控制台、头控器、手控器及路由器,机载单元通过遥控信号接收机、无线传输模块与地面站系统通讯,通过头控器与所述机载单元形成的云台精密控制模块,形成一整套无人机云台精密控制解决方案,满足交互精度、速度及范围最优,操作更加便捷,控制传输距离仅跟无人机数据链通信距离有关,突破传统和现有遥控器传输距离受限的特点。

Description

一种头戴式无人直升机控制系统及其控制方法
【技术领域】
本发明涉及无人机控制技术,尤其是一种头戴式无人直升机控制系统及其控制方法。
【背景技术】
无人直升机是一个多学科交叉耦合的具有挑战性的前沿研究方向,涉及带无人直升机的机械结构、空气动力学、飞行动力学、系统建模、传感器数据融合、捷联导航系统、嵌入式系统等领域。一套完整的无人直升机控制平台由航空电子系统、导航系统、地面站系统组成:
1.航空电子系统是无人直升机的基本组件,主要分为硬件系统、软件系统。硬件系统至少有一个MCU或计算机系统及相关的扩展板组成,实现在线分析飞行数据、运行控制算法、与地面站通信、记录必要的飞行数据。
2.导航系统由航姿参考系统、位置参考系统组成,其中的航姿参考系统向航空电子系统提供飞行必要的飞行姿态数据,位置参考系统提供飞行器实际所在位置的相关信息。
3.地面站系统由地面站软件以及无线通讯设备组成,通过无线通讯设备与无人直升机交互信息,实时监测无人直升机的。
但是,当前市场上的遥控模型直升机工作在信号直通的方式,即操纵手通过控制手机或手持平板遥控器发出信号,透过体感方式操作无人机;和传统的遥控器相比,手机/平板遥控更小巧、轻便,因为是透过体感操作,所以也更加上手;但手机/平板遥控也存在一些缺点,比如信号很不稳定、长距离飞行很容易断线(在市郊空旷环境,一般在50-100米左右就会断线),这会很大程度影响飞行体验;而且,它的操作虽然比较直观,但要完成很精确的动作,却比较困难,换而言之,就是“易学难精”。部分直升机还配有机载陀螺仪,能增加一定的阻尼,便于控制。而且,传统的遥控器虽然比较笨重、操作不够轻便,也更难上手,控制无人机吊舱跟踪时候,但它的信号稳定性强,而且遥控距离也更远(一般遥控范围在100米或以上)。
另外,现有手控的工作方式简单方便,但带来一个问题:遥控模型直升机控制难度大,且无法实现自主飞行。直升机与固定翼飞机相比,气动特性更加复杂,动特性都是不稳定的,并且各个通道间存在很强的轴间耦合,且现有技术中直升机控制系统体积及重量大,不便于安装,且成本较高。
【发明内容】
本发明提供一种头戴式无人直升机控制系统及其控制方法,采用头盔和手控组合方式的控制,解决了直升机控制系统体积重量大不方便安装及成本高的问题,具有精调微控功能,操作更加便捷,控制传输距离仅跟无人机数据链通信距离有关,突破传统和现有遥控器传输距离受限的特点。
为达到上述明目的,采用的技术方案如下:
一种头戴式无人直升机控制系统,包括机载单元和地面站系统;
所述机载单元包括飞行处理器、传感器模块、内置算法模块、无线传输模块、遥控接收机和用于实时跟踪对准目标物的执行机构,内置算法模块包括姿态解算算法、数据融合算法和飞行控制算法,所述飞行处理器与内置算法模块之间采用有线连接或\和无线连接;
所述地面控制单元包括具有无线传输功能的测控终端,所述测控终端包括PC控制台、头控器、手控器及路由器,所述地面控制单元通过无线通讯模块与所述机载单元的飞行处理器通讯连接;
所述机载单元通过遥控信号接收机、无线传输模块与所述地面站系统通讯,获取头控器和手控器的控制信号、PC控制台的控制命令以及将实时的飞行位置姿态等数据发送到地面站系统,以供实时监测无人直升机的飞行状态;
所述传感器模块实时采集直升机的姿态数据、高度数据、速度数据,并将采集到的数据分别发送至飞行处理器和内置算法模块,并通过无线传输模块或有线连接将数据传输至所述PC控制台,将数据处理后定时发送至遥控接收机,遥控接收机接收遥控器信号传输至飞行处理器和内置算法模块,所述飞行处理器对接收的信号处理后分别输出至执行机构,控制执行机构工作。
进一步地,所述头控器由穿戴于头部的头盔设备和惯导设备组成,所述惯导设备包括IMU惯性测量传感器和compass磁罗盘,所述IMU惯性测量传感器由三个加速度计和三个陀螺仪组成的组合单元,三个加速度计和三个陀螺仪安装在互相垂直的测量轴上,进行六自由度姿态感知、并将感知到的数据存放入所述机载单元的内置算法模块中,解算出无人机云台控制的横摇、俯仰、偏航角度姿态,以及进行加密后通过无线传输或\和有线传输给所述地面控制单元的PC控制台。
进一步地,所述手控器包括采用双手控制的手柄、安装于手柄上的电子罗盘和安装于手柄上的GPS定位器。
进一步地,所述机载单元上的执行机构包括无人机挂载机枪和无人机挂载吊舱。
一种头戴式无人直升机控制系统的控制方法,包括以下步骤:
步骤S1,根据三维电子罗盘和加速度的输出求取姿态角,如公式(1)所示:
Figure BDA0002878793690000041
其中,姿态角度为横滚roll和俯仰pitch,横向加速度为ax、纵向加速度为ay、垂向加速度为az
将机体坐标系相对地理坐标系的方位为机体的姿态,设θ、φ、ψ分别为机体的横滚角、俯仰角和航向角,三轴磁分量数据为mx、my、mz,则机体坐标系于地理坐标系间的转换矩阵如下:
Figure BDA0002878793690000042
步骤S2,根据姿态角信息与电子罗盘的三轴磁力数据、求取计算偏航角所需的参数,如公式(3)所示:
Figure BDA0002878793690000043
公式(3)中:Xh、Yh、Zh分别为机体水平姿态角为零时的磁场在机体坐标系Xb、Yb、Zb方向的分量,则航向角可以用如下公式(4)计算得到:
Figure BDA0002878793690000051
根据Xh、Yh数值一般的变化范围可以得到公式(5)和公式(6):
Figure BDA0002878793690000052
Figure BDA0002878793690000053
步骤S3,航向角就可以通过
Figure BDA0002878793690000054
求得,所以姿态角如公式(7)所示:
Figure BDA0002878793690000061
步骤S4,根据姿态角α、β、γ,可以求得对应的无人直升机的四元数如公式(8)所示:
Figure BDA0002878793690000062
步骤S5,根据四元数求取转换矩阵,如公式(9)和公式(10)所示:
Figure BDA0002878793690000063
Figure BDA0002878793690000071
步骤S6,对罗盘输出的数据进行归一化处理,如公式(11)所示:
Figure BDA0002878793690000072
步骤S7,由电子罗盘的输出计算地球磁场的参考方向,如公式(12)和公式(13)所示:
Figure BDA0002878793690000073
Figure BDA0002878793690000074
步骤S8,估计磁场方向,如公式(14)所示:
Figure BDA0002878793690000081
步骤S9,估计方位和量测方位向量叉乘之后累积,如公式(15)所示:
Figure BDA0002878793690000082
步骤S10,归一化加速度计输出,如公式(16)所示:
Figure BDA0002878793690000083
步骤S11,计算重力和磁场的方位,如公式(17)所示:
Figure BDA0002878793690000091
步骤S12,估计方位和量测方位向量叉乘后累积,如公式(18)所示:
Figure BDA0002878793690000092
步骤S13,对陀螺仪输出的角速度进行修正,如公式(19)所示:
Figure BDA0002878793690000093
步骤S14,通过修正后的角速度与四元数计算四元数的导数,如公式(20)所示:
Figure BDA0002878793690000101
步骤S15,积分四元数的导数得到新的四元数,如公式(21)所示:
Figure BDA0002878793690000102
步骤S16,姿态转换阵如公式(22)所示:
Figure BDA0002878793690000103
步骤S17,姿态角如公式(23)所示:
Figure BDA0002878793690000111
以上述控制律进行小型无人直升机的姿态控制。
本发明的优点:
本发明的机载单元包括飞行处理器、传感器模块、内置算法模块、无线传输模块、遥控接收机和用于实时跟踪对准目标物的执行机构,地面控制单元包括测控终端,测控终端包括PC控制台、头控器、手控器及路由器,机载单元通过遥控信号接收机、无线传输模块与地面站系统通讯,通过头控器与所述机载单元形成的云台精密控制模块,形成一整套无人机云台精密控制解决方案,满足交互精度、速度及范围最优,操作更加便捷,控制传输距离仅跟无人机数据链通信距离有关,突破传统和现有遥控器传输距离受限的特点。
通过头控器与所述机载单元形成的云台精密控制模块,形成一整套无人机云台(或者火控)精密控制解决方案,在有线传输时通过数据线路直接与地面站系统连接,人戴上头控器看地面站显示的图像,根据不同任务,无人机挂载不同载荷,常用吊舱和武器,每种都需要云台进行控制,使用手控遥控器对云台先进行大角度调试,在使用头控器进行微调。满足交互精度、速度及范围最优,操作更加便捷,控制传输距离仅跟无人机数据链通信距离有关,突破传统和现有遥控器传输距离受限的特点。
以及利用无人机挂载吊舱的变焦,通过云台控制姿态,无人机挂载机枪通过头控器可将武器打击精度从半径为5米左右的范围,精调到0.5米,实现无人机云台挂载设备的精调微控。
【说明书附图】
图1是本发明的无人直升机控制平台系统示意图;
图2是本发明的无人直升机硬件结构框图。
【具体实施方式】
下面通过具体实例对本发明的内容作进一步的说明。
一种头戴式无人直升机控制系统,如图1和图2所示,包括机载单元1和地面站系统2;该机载单元1包括飞行处理器、传感器模块、内置算法模块、无线传输模块、遥控接收机和用于实时跟踪对准目标物的执行机构,该目标物包括枪械、战车、假想敌、桥梁和碉堡;内置算法模块包括姿态解算算法、数据融合算法和飞行控制算法,飞行处理器与内置算法模块之间采用有线连接和无线连接。
继续如图1和图2所示,该地面控制单元包括具有无线传输功能的测控终端,测控终端包括PC控制台、头控器、手控器及路由器,地面控制单元通过无线通讯模块与机载单元的飞行处理器通讯连接。
该机载单元通过遥控信号接收机、无线传输模块与所述地面站系统通讯,获取头控器和手控器的控制信号、PC控制台的控制命令以及将实时的飞行位置姿态等数据发送到地面站系统,以供实时监测无人直升机的飞行状态;传感器模块实时采集直升机的姿态数据、高度数据、速度数据,并将采集到的数据分别发送至飞行处理器和内置算法模块,并通过无线传输模块或有线连接将数据传输至所述PC控制台,将数据处理后定时发送至遥控接收机,遥控接收机接收遥控器信号传输至飞行处理器和内置算法模块,所述飞行处理器对接收的信号处理后分别输出至执行机构,控制执行机构工作。
其中,手控器包括采用双手控制的手柄、安装于手柄上的电子罗盘和安装于手柄上的GPS定位器。头控器由穿戴于头部的头盔设备和惯导设备组成,所述惯导设备包括IMU惯性测量传感器和compass磁罗盘,IMU惯性测量传感器由三个加速度计和三个陀螺仪组成的组合单元,三个加速度计和三个陀螺仪安装在互相垂直的测量轴上,进行六自由度姿态感知、并将感知到的数据存放入所述机载单元的内置算法模块中,解算出无人机云台控制的横摇、俯仰、偏航角度姿态,以及进行加密后通过无线传输或\和有线传输给所述地面控制单元的PC控制台。通过头控器与机载单元形成的云台精密控制模块,形成一整套无人机云台(或者火控)精密控制解决方案,在有线传输时通过数据线路直接与地面站系统连接,人戴上头控器看地面站显示的图像,根据不同任务,无人机挂载不同载荷,常用吊舱和武器,每种都需要云台进行控制,使用手控遥控器对云台先进行大角度调试,在使用头控器进行微调。满足交互精度、速度及范围最优,操作更加便捷,控制传输距离仅跟无人机数据链通信距离有关,突破传统和现有遥控器传输距离受限的特点。
而且,机载单元上的执行机构包括无人机挂载机枪和无人机挂载吊舱,利用无人机挂载吊舱的变焦,通过云台控制姿态,无人机挂载机枪通过头控器精调到0.5米,可将武器打击精度从半径为5米左右的范围,实现无人机云台挂载设备的精调微控。
该头戴式无人直升机控制系统的控制方法,包括以下步骤:
步骤S1,根据三维电子罗盘和加速度的输出求取姿态角,如公式(1)所示:
Figure BDA0002878793690000141
其中,姿态角度为横滚roll和俯仰pitch,横向加速度为ax、纵向加速度为ay、垂向加速度为az
将机体坐标系相对地理坐标系的方位为机体的姿态,设θ、φ、ψ分别为机体的横滚角、俯仰角和航向角,三轴磁分量数据为mx、my、mz,则机体坐标系于地理坐标系间的转换矩阵如下:
Figure BDA0002878793690000142
步骤S2,根据姿态角信息与电子罗盘的三轴磁力数据、求取计算偏航角所需的参数,如公式(3)所示:
Figure BDA0002878793690000143
公式(3)中:Xh、Yh、Zh分别为机体水平姿态角为零时的磁场在机体坐标系Xb、Yb、Zb方向的分量,则航向角可以用如下公式(4)计算得到:
Figure BDA0002878793690000151
根据Xh、Yh数值一般的变化范围可以得到公式(5)和公式(6):
Figure BDA0002878793690000152
Figure BDA0002878793690000153
步骤S3,航向角就可以通过
Figure BDA0002878793690000154
求得,所以姿态角如公式(7)所示:
Figure BDA0002878793690000161
步骤S4,根据姿态角α、β、γ,可以求得对应的无人直升机的四元数如公式(8)所示:
Figure BDA0002878793690000162
步骤S5,根据四元数求取转换矩阵,如公式(9)和公式(10)所示:
Figure BDA0002878793690000163
Figure BDA0002878793690000171
步骤S6,对罗盘输出的数据进行归一化处理,如公式(11)所示:
Figure BDA0002878793690000172
步骤S7,由电子罗盘的输出计算地球磁场的参考方向,如公式(12)和公式(13)所示:
Figure BDA0002878793690000173
Figure BDA0002878793690000174
步骤S8,估计磁场方向,如公式(14)所示:
Figure BDA0002878793690000181
步骤S9,估计方位和量测方位向量叉乘之后累积,如公式(15)所示:
Figure BDA0002878793690000182
步骤S10,归一化加速度计输出,如公式(16)所示:
Figure BDA0002878793690000183
步骤S11,计算重力和磁场的方位,如公式(17)所示:
Figure BDA0002878793690000191
步骤S12,估计方位和量测方位向量叉乘后累积,如公式(18)所示:
Figure BDA0002878793690000192
步骤S13,对陀螺仪输出的角速度进行修正,如公式(19)所示:
Figure BDA0002878793690000193
步骤S14,通过修正后的角速度与四元数计算四元数的导数,如公式(20)所示:
Figure BDA0002878793690000201
步骤S15,积分四元数的导数得到新的四元数,如公式(21)所示:
Figure BDA0002878793690000202
步骤S16,姿态转换阵如公式(22)所示:
Figure BDA0002878793690000203
步骤S17,姿态角如公式(23)所示:
Figure BDA0002878793690000211
以上述控制律进行小型无人直升机的姿态控制。
通过采用头盔和手控组合方式的控制,结合上述控制律进行小型无人直升机的姿态控制,具有精调微控功能,操作更加便捷,控制传输距离仅跟无人机数据链通信距离有关,突破传统和现有遥控器传输距离受限的特点。
以上所述实施例只是为本发明的较佳实施例,并非以此限制本发明的实施范围,除了具体实施例中列举的情况外;凡依本发明之方法及原理所作的等效变化,均应涵盖于本发明的保护范围内。

Claims (5)

1.一种头戴式无人直升机控制系统,包括机载单元和地面站系统;其特征在于:
所述机载单元包括飞行处理器、传感器模块、内置算法模块、无线传输模块、遥控接收机和用于实时跟踪对准目标物的执行机构,内置算法模块包括姿态解算算法、数据融合算法和飞行控制算法,所述飞行处理器与内置算法模块之间采用有线连接或\和无线连接;
所述地面控制单元包括具有无线传输功能的测控终端,所述测控终端包括PC控制台、头控器、手控器及路由器,所述地面控制单元通过无线通讯模块与所述机载单元的飞行处理器通讯连接;
所述机载单元通过遥控信号接收机、无线传输模块与所述地面站系统通讯,获取头控器和手控器的控制信号、PC控制台的控制命令以及将实时的飞行位置姿态等数据发送到地面站系统,以供实时监测无人直升机的飞行状态;
所述传感器模块实时采集直升机的姿态数据、高度数据、速度数据,并将采集到的数据分别发送至飞行处理器和内置算法模块,并通过无线传输模块或有线连接将数据传输至所述PC控制台,将数据处理后定时发送至遥控接收机,遥控接收机接收遥控器信号传输至飞行处理器和内置算法模块,所述飞行处理器对接收的信号处理后分别输出至执行机构,控制执行机构工作。
2.根据权利要求1所述的一种头戴式无人直升机控制系统,其特征在于,所述头控器由穿戴于头部的头盔设备和惯导设备组成,所述惯导设备包括IMU惯性测量传感器和compass磁罗盘,所述IMU惯性测量传感器由三个加速度计和三个陀螺仪组成的组合单元,三个加速度计和三个陀螺仪安装在互相垂直的测量轴上,进行六自由度姿态感知、并将感知到的数据存放入所述机载单元的内置算法模块中,解算出无人机云台控制的横摇、俯仰、偏航角度姿态,以及进行加密后通过无线传输或\和有线传输给所述地面控制单元的PC控制台。
3.根据权利要求1所述的一种头戴式无人直升机控制系统,其特征在于,所述手控器包括采用双手控制的手柄、安装于手柄上的电子罗盘和安装于手柄上的GPS定位器。
4.根据权利要求1所述的一种头戴式无人直升机控制系统,其特征在于,所述机载单元上的执行机构包括无人机挂载机枪和无人机挂载吊舱。
5.基于权利要求1至4所述的一种头戴式无人直升机控制系统的控制方法,其特征在于,包括以下步骤:
步骤S1,根据三维电子罗盘和加速度的输出求取姿态角,如公式(1)所示:
Figure FDA0002878793680000021
其中,姿态角度为横滚roll和俯仰pitch,横向加速度为ax、纵向加速度为ay、垂向加速度为az;
将机体坐标系相对地理坐标系的方位为机体的姿态,设θ、φ、ψ分别为机体的横滚角、俯仰角和航向角,三轴磁分量数据为mx、my、mz,则机体坐标系于地理坐标系间的转换矩阵如下:
Figure FDA0002878793680000031
步骤S2,根据姿态角信息与电子罗盘的三轴磁力数据、求取计算偏航角所需的参数,如公式(3)所示:
Figure FDA0002878793680000032
公式(3)中:Xh、Yh、Zh分别为机体水平姿态角为零时的磁场在机体坐标系Xb、Yb、Zb方向的分量,则航向角可以用如下公式(4)计算得到:
Figure FDA0002878793680000033
根据Xh、Yh数值一般的变化范围可以得到公式(5)和公式(6):
Figure FDA0002878793680000034
Figure FDA0002878793680000041
步骤S3,航向角就可以通过
Figure FDA0002878793680000042
求得,所以姿态角如公式(7)所示:
Figure FDA0002878793680000043
步骤S4,根据姿态角α、β、γ,可以求得对应的无人直升机的四元数如公式(8)所示:
Figure FDA0002878793680000044
步骤S5,根据四元数求取转换矩阵,如公式(9)和公式(10)所示:
Figure FDA0002878793680000051
Figure FDA0002878793680000052
步骤S6,对罗盘输出的数据进行归一化处理,如公式(11)所示:
Figure FDA0002878793680000053
步骤S7,由电子罗盘的输出计算地球磁场的参考方向,如公式(12)和公式(13)所示:
Figure FDA0002878793680000054
Figure FDA0002878793680000061
步骤S8,估计磁场方向,如公式(14)所示:
Figure FDA0002878793680000062
步骤S9,估计方位和量测方位向量叉乘之后累积,如公式(15)所示:
Figure FDA0002878793680000063
步骤S10,归一化加速度计输出,如公式(16)所示:
Figure FDA0002878793680000064
步骤S11,计算重力和磁场的方位,如公式(17)所示:
Figure FDA0002878793680000071
步骤S12,估计方位和量测方位向量叉乘后累积,如公式(18)所示:
Figure FDA0002878793680000072
步骤S13,对陀螺仪输出的角速度进行修正,如公式(19)所示:
Figure FDA0002878793680000073
步骤S14,通过修正后的角速度与四元数计算四元数的导数,如公式(20)所示:
Figure FDA0002878793680000074
步骤S15,积分四元数的导数得到新的四元数,如公式(21)所示:
Figure FDA0002878793680000081
步骤S16,姿态转换阵如公式(22)所示:
Figure FDA0002878793680000082
步骤S17,姿态角如公式(23)所示:
Figure FDA0002878793680000083
以上述控制律进行小型无人直升机的姿态控制。
CN202011645049.4A 2020-12-31 2020-12-31 一种头戴式无人直升机控制系统及其控制方法 Pending CN112817322A (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202011645049.4A CN112817322A (zh) 2020-12-31 2020-12-31 一种头戴式无人直升机控制系统及其控制方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202011645049.4A CN112817322A (zh) 2020-12-31 2020-12-31 一种头戴式无人直升机控制系统及其控制方法

Publications (1)

Publication Number Publication Date
CN112817322A true CN112817322A (zh) 2021-05-18

Family

ID=75856652

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202011645049.4A Pending CN112817322A (zh) 2020-12-31 2020-12-31 一种头戴式无人直升机控制系统及其控制方法

Country Status (1)

Country Link
CN (1) CN112817322A (zh)

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN113253750A (zh) * 2021-06-28 2021-08-13 北京科技大学 一种面向扑翼飞行器的多模态控制系统
CN116956109A (zh) * 2023-03-07 2023-10-27 珠海紫燕无人飞行器有限公司 一种基于频谱分析无人飞行器震动问题的方法及系统

Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN103426282A (zh) * 2013-07-31 2013-12-04 深圳市大疆创新科技有限公司 遥控方法及终端
CN104503458A (zh) * 2014-11-17 2015-04-08 兰博 一种小型单兵作战无人机系统
CN104656660A (zh) * 2015-01-22 2015-05-27 南京航空航天大学 微小型无人直升机多模态自主飞行的控制系统及其方法
CN107037880A (zh) * 2017-03-02 2017-08-11 深圳前海极客船长网络科技有限公司 基于虚拟现实技术的空间定位定姿系统及其方法
CN108170153A (zh) * 2017-12-19 2018-06-15 广州亿航智能技术有限公司 无人机飞行控制系统及其方法
CN108255752A (zh) * 2018-01-16 2018-07-06 深圳创维新世界科技有限公司 惯性测量方法、系统及头戴显示设备
CN108780324A (zh) * 2017-12-27 2018-11-09 深圳市大疆创新科技有限公司 无人机、无人机控制方法和装置
CN109062398A (zh) * 2018-06-07 2018-12-21 中国航天员科研训练中心 一种基于虚拟现实与多模态人机接口的航天器交会对接方法

Patent Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN103426282A (zh) * 2013-07-31 2013-12-04 深圳市大疆创新科技有限公司 遥控方法及终端
CN104503458A (zh) * 2014-11-17 2015-04-08 兰博 一种小型单兵作战无人机系统
CN104656660A (zh) * 2015-01-22 2015-05-27 南京航空航天大学 微小型无人直升机多模态自主飞行的控制系统及其方法
CN107037880A (zh) * 2017-03-02 2017-08-11 深圳前海极客船长网络科技有限公司 基于虚拟现实技术的空间定位定姿系统及其方法
CN108170153A (zh) * 2017-12-19 2018-06-15 广州亿航智能技术有限公司 无人机飞行控制系统及其方法
CN108780324A (zh) * 2017-12-27 2018-11-09 深圳市大疆创新科技有限公司 无人机、无人机控制方法和装置
CN108255752A (zh) * 2018-01-16 2018-07-06 深圳创维新世界科技有限公司 惯性测量方法、系统及头戴显示设备
CN109062398A (zh) * 2018-06-07 2018-12-21 中国航天员科研训练中心 一种基于虚拟现实与多模态人机接口的航天器交会对接方法

Cited By (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN113253750A (zh) * 2021-06-28 2021-08-13 北京科技大学 一种面向扑翼飞行器的多模态控制系统
CN116956109A (zh) * 2023-03-07 2023-10-27 珠海紫燕无人飞行器有限公司 一种基于频谱分析无人飞行器震动问题的方法及系统
CN116956109B (zh) * 2023-03-07 2024-04-09 珠海紫燕无人飞行器有限公司 一种基于频谱分析无人飞行器震动问题的方法及系统

Similar Documents

Publication Publication Date Title
CN109911188B (zh) 非卫星导航定位环境的桥梁检测无人机系统
CN109813311B (zh) 一种无人机编队协同导航方法
CN104808675B (zh) 基于智能终端的体感飞行操控系统及终端设备
US8229163B2 (en) 4D GIS based virtual reality for moving target prediction
CN103587708B (zh) 超小型无人旋翼飞行器野外定点零盲区自主软着陆方法
García Carrillo et al. Stabilization and trajectory tracking of a quad-rotor using vision
CN102707725B (zh) 固定翼自动导航飞行控制系统及其使用方法
US20150346721A1 (en) Aircraft
CN104503466B (zh) 一种微小型无人机导航装置
CN205540288U (zh) 一种具有多功能地面站的无人机系统
CN108253966B (zh) 无人机飞行三维模拟显示方法
CN106125747A (zh) 基于vr交互的无人机机载第一视角随动吊舱系统
CN103135549A (zh) 一种具有视觉反馈的球形机器人运动控制系统及运动控制方法
CN112817322A (zh) 一种头戴式无人直升机控制系统及其控制方法
TWI394687B (zh) 手擲式無人飛行系統
CN202771262U (zh) 固定翼自动导航飞行控制系统
KR101348797B1 (ko) 지피에스(gps)와 아이엔에스(ins)를 이용한 초정밀 항공촬영 장치
CN105841698A (zh) 一种无需调零的auv舵角精确实时测量系统
CN102654917B (zh) 运动体运动姿态感知方法及系统
KR20120036684A (ko) 지피에스를 이용한 지능형 항공로봇
Kritskiy et al. Increasing the reliability of drones due to the use of quaternions in motion
CN110411443A (zh) 一种采煤机摇臂惯性/视觉组合定姿装置和方法
Romero et al. A new UAV configuration having eight rotors: dynamical model and real-time control
KR101350930B1 (ko) 지형지물 영상이미지를 정밀하게 촬영 및 합성처리하는 항공촬영시스템
CN114295145B (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
RJ01 Rejection of invention patent application after publication

Application publication date: 20210518

RJ01 Rejection of invention patent application after publication