CN111413992B - 无人机安全控制设备及方法 - Google Patents
无人机安全控制设备及方法 Download PDFInfo
- Publication number
- CN111413992B CN111413992B CN201910816672.2A CN201910816672A CN111413992B CN 111413992 B CN111413992 B CN 111413992B CN 201910816672 A CN201910816672 A CN 201910816672A CN 111413992 B CN111413992 B CN 111413992B
- Authority
- CN
- China
- Prior art keywords
- unmanned aerial
- aerial vehicle
- wind speed
- data
- vector
- 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
Links
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
- G05D1/08—Control of attitude, i.e. control of roll, pitch, or yaw
- G05D1/0808—Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for aircraft
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
- G05D1/10—Simultaneous control of position or course in three dimensions
- G05D1/101—Simultaneous control of position or course in three dimensions specially adapted for aircraft
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02A—TECHNOLOGIES FOR ADAPTATION TO CLIMATE CHANGE
- Y02A90/00—Technologies having an indirect contribution to adaptation to climate change
- Y02A90/10—Information and communication technologies [ICT] supporting adaptation to climate change, e.g. for weather forecasting or climate simulation
Abstract
一种无人机安全控制设备及方法是利用无人机安全控制设备建立一套无人机风向风速观测数据的质量控制算法,该算法基于飞行姿态信息和环境信息等因子与风速风向数据误差之间的关系,通过理论分析和订正模型,实现基于无人机测量风速风向的数据质量控制并获得校准数据,实时监控无人机飞行环境并根据校准数据判断危险程度,当高空环境处于危险状态下给予无人机返回指令,迫使无人机自动返航,提供大气环境探测安全保障。
Description
【技术领域】
本发明涉及无人机控制技术领域,具体为一种无人机安全控制设备及方法。
【背景技术】
大气边界层气象廓线观测需满足世界气象组织和中国气象局对常规高空气象观测业务技术的统一规范。近年来,一系列小型化、轻量化的气象环境观测仪器的成功研发,为开展基于旋翼无人机平台的大气边界层廓线观测提供了新的契机,是替代传统探空气球探测低层大气情况的有效补充手段,具有准垂直观测、升限稳定、可悬停、高时空分辨率、低成本等特点。但旋翼无人机的飞行姿态(翻滚角、俯仰角、偏航角、真高)、旋翼气流干扰、仪器放置位置及仪器观测性能等诸多因素都会对边界层内风速风向的廓线及水平观测产生显著影响,观测数据质量可能低于相应观测标准的要求。此外,由于空中湍流的不确定性,基于旋翼无人机的探空作业具有一定的风险。因此,本发明直接在无人机端实现无人机状态数据和气象环境数据的融合,通过实测的风速风向及其它环境量瞬时及廓线特征,实现飞行任务危险条件的诊断和预判,激发机载飞控中的安全模块,从而提升作业工作中的安全系数。随着相关实验研究和业务观测的逐渐增多,基于风速风向观测数据质量的控制、数据融合和安全措施制定的技术就显得愈发重要。现阶段多采用无人机姿态来直接估算空中的风速风向,该种方法不属于直接的接触式探测,并且在小风情形下,旋翼无人机处于自平衡状态,存在反演数据与真实情况误差较大的情况。
由此可见,提供一种精确的无人机飞行安全控制设备及方法是本领域亟需解决的问题。
【发明内容】
针对上述问题,本发明无人机安全控制设备及方法根据环境气象传感器模块获取的数据,实时监控无人机飞行环境并判断危险程度,当处于危险状态下给予无人机返回指令,迫使无人机自动返航,为无人机探测大气环境时提供安全保障。
为解决上述问题,本发明无人机安全控制设备包括微型计算机以及连接在微型计算机上的惯性测量单元、全球定位系统、环境气象传感器模块,其中所述环境气象传感器模块通过多串口采集板连接在微型计算机上,所述微型计算机上还连接有机载存储单元和地面工作站,惯性测量单元和环境气体传感器获取无人机的飞行姿态信息和环境信息,并将获取的信息传递到微型计算机进行计算和融合,通过计算得出数据,通过数据分析无人机飞行是否安全,微型计算机根据分析结果发出指令。
进一步的,所述无人机安全控制方法是利用无人机安全控制设备建立一套无人机风向风速观测数据的质量控制算法,该算法基于飞行姿态信息和环境信息等因子与风速风向数据误差之间的关系,通过理论分析和订正模型,实现基于无人机测量风速风向的数据质量控制并获得校准数据,实时监控无人机飞行环境并根据校准数据判断危险程度,当高空环境处于危险状态下给予无人机返回指令,迫使无人机自动返航,提供大气环境探测安全保障。
进一步的,所述算法首先基于风的矢量拆解,校准由于无人机空中姿态(翻滚角、俯仰角、偏航角、垂直移动速度)导致的风速风向的观测误差,接着对于仍存在的风速误差,算法将进一步寻找其他无人机状态数据等外部环境因子(旋翼转速、传感器在无人机的位置等)与观测差异之间的关系,拟合各未知待定参数,确定订正方程。
进一步的,所述算法步骤如下:
S1:获取当前环境气象传感器模块获得的风速WS和风向WD,并获取当前无人机的朝向角度yaw、无人机的翻滚角度roll、无人机的俯仰角度pitch以及无人机的水平移动速度DroneU和无人机的垂直升降速度DroneV;
S10:经过S1至S9的订正后,对于仍存在的风速误差,算法将进一步寻找其他无人机状态数据及外部环境因子。
进一步的,所述其他无人机状态数据包括旋翼转速、传感器在无人机的位置,并拟合各未知待定参数,确定订正方程:ΔWS=f(Power,Dx,Dy,E);
进一步的,所述无人机安全控制方法根据校准数据及温度、湿度、气压等环境气象传感器获得的数据,并通过微型计算机进行计算分析,实时监控无人机飞行环境并判断危险程度,微型计算机根据判断出的危险程度对无人机发出不同的指令,为大气环境探测提供安全保障。
进一步的,当微型计算机计算出的风速差小于12m/s,且风向变率小于10°/s时,无人机正常飞行,微型电脑无指令发出;当风速差为12至18m/s,或风向变率为10至60°/s时,微型电脑发出指令,将无人机垂直速度减为1m/s;当风速差大于18m/s,或风向变率大于60°/s时,微型电脑发出指令,将强制无人机返航,返航时保持稳定的飞行姿态。
进一步的,当环境气象传感器模块获得的温度为0到40摄氏度时无人机正常飞行,微型电脑无指令发出;当温度为-5到0摄氏度时,微型电脑发出指令,将无人机垂直速度增加到4m/s;当温度小于-5摄氏度或大于40摄氏度时,微型电脑发出指令强制无人机返航。
再者,本发明无人机安全控制设备及方法根据环境气象传感器模块获取的数据,实时监控无人机飞行环境并判断危险程度,当处于危险状态下给予无人机返回指令,迫使无人机自动返航,为无人机探测大气环境时提供安全保障。
【附图说明】
图1是本发明无人机安全控制设备及方法中无人机安全控制设备的组成结构示意图。
图2是本发明无人机安全控制设备及方法中三维旋转矩阵R的函数表达式。
图3是本发明无人机安全控制设备及方法中arctanEX的函数表达式。
【具体实施方式】
本发明所提到的方向用语,例如「上」、「下」、「前」、「后」、「左」、「右」、「内」、「外」、「侧面」等,仅是附图中的方向,只是用来解释和说明本发明,而不是用来限定本发明的保护范围。
参见图1,给出了本发明中无人机安全控制设备的结构示意图,其包括惯性测量单元、全球定位系统、环境气象传感器模块、多串口采集板和微型计算机,其中惯性测量单元连接到微型计算机,其包括用于获取无人机姿态信息的速度计、陀螺仪和磁力计,其中姿态信息包括旋翼转速、翻转角、俯仰角、偏航角和位移;其中全球定位系统为连接到微型计算机上的GPS模块,用于获取无人机实时位置和相对高度信息;其中环境气象传感器模块通过多串口采集板连接到微型计算机,用于获取高精度的风俗风向、温湿度、气压等环境要素;其中多串口采集板包括UART、RS485、USB2.0等无人机常用通讯接口,可实现各种传感器和其他设备之间的连接;其中微型计算机作为算法计算平台,给出安全指令;微型计算机连接到机载储存单元,并将相关的无人机姿态信息和环境气象传感器模块信息融合成数据表记录到储存单元中,同时微型计算机也将融合成的数据表传回地面站实时显示。
本发明中无人机安全控制方法如下:利用无人机安全控制设备建立一套无人机风向风速观测数据的质量控制算法,该算法基于无人机参数和大气环境参数等因子与风速风向数据误差之间的关系,通过理论分析和订正模型,实现基于无人机测量风速风向的数据质量控制并获得校准数据,实时监控无人机飞行环境并根据校准数据判断危险程度,当高空环境处于危险状态下给予无人机返回指令,迫使无人机自动返航,提供大气环境探测安全保障。其中算法首先基于风的矢量拆解,校准由于无人机空中姿态(翻滚角、俯仰角、偏航角、垂直移动速度)导致的风速风向的观测误差,接着对于仍存在的风速误差,算法将进一步寻找其他无人机状态数据等外部环境因子(旋翼转速/油门、传感器在无人机的位置等)与观测差异之间的关系,拟合各未知待定参数,确定订正方程。
其中具体算法步骤如下:
S1:获取当前环境气象传感器模块获得的风速WS和风向WD,并获取当前无人机的朝向角度yaw、无人机的翻滚角度roll、无人机的俯仰角度pitch以及无人机的水平移动速度DroneU和无人机的垂直升降速度DroneV;
S9:根据正北坐标系下的水平风速向量计算调校后的风速WST和风向WDT:调校后的风速/>调校后的风向WDT=arctanEX(fx,fy);其中,arctanEX为扩展后的反正切函数(如图3所示):其中,AngleR为弧、度转角度函数,arctan为反正切函数。
S10:经过S1至S9的订正后,对于仍存在的风速误差,算法将进一步寻找其他无人机状态数据的外部环境因子(旋翼转速、传感器在无人机的位置等)与观测差异之间的关系,拟合各未知待定参数,确定订正方程:ΔWS=f(Power,Dx,Dy,E),其中△WS为仍存在的风速误差;Power为旋翼转速,用于表征旋翼风带来的可能影响,Dx和Dy分别为传感离无人机中心点x轴和y轴的距离,E为残差项,表征系统误差。
危险程度的判断是根据校准数据及温度、湿度、气压等环境气象传感器获得的数据,实时监控无人机飞行环境并判断危险程度,当高空环境处于危险状态下给予无人机返回指令,迫使无人机自动返航,为大气环境探测提供安全保障。
其中风量危险程度与控制指令标准如下:
控制指令 | 风速差 | 风向变率 | 备注 |
正常,无指令 | <12m/s | <10°/s | |
垂直速度减为1m/s | 12-18m/s | 10-60°/s | |
强制返航 | >18m/s | >60°/s | 稳定安全返航 |
注:表中风速差为相邻两秒WST的差值,风向变率为相邻两秒WDT差的绝对值。当风速差小于12m/s,且风向变率小于10°/s时,无人机正常飞行,微型电脑无指令发出;当风速差为12至18m/s,或风向变率为10至60°/s时,微型电脑发出指令,将无人机垂直速度减为1m/s;当风速差大于18m/s,或风向变率大于60°/s时,微型电脑发出指令,将强制无人机返航,返航时保持稳定的飞行姿态。
其中温度危险程度与控制指令标准如下:
注:表中温度由环境气象传感器模块获得,当温度为0到40摄氏度时无人机正常飞行,微型电脑无指令发出;当温度为-5到0摄氏度时,微型电脑发出指令,将无人机垂直速度增加到4m/s;当温度小于-5摄氏度或大于40摄氏度时,微型电脑发出指令强制无人机返航。
本发明无人机安全控制设备及方法根据环境气象传感器模块获取的数据,实时监控无人机飞行环境并判断危险程度,当处于危险状态下给予无人机指令,迫使无人机调整飞行姿态或自动返航,为无人机探测大气环境时提供安全保障。
此外,应当理解,虽然本说明书按照实施方式加以描述,但并非每个实施方式仅包含一个独立的技术方案,说明书的这种叙述方式仅仅是为清楚起见,本领域技术人员应当将说明书作为一个整体,各实施例中的技术方案也可以经适当组合,形成本领域技术人员可以理解的其他实施方式。
Claims (4)
1.一种无人机气象环境数据校准及飞行安全控制方法,其特征在于,所述无人机气象环境数据校准所涉及的设备包括微型计算机以及连接在微型计算机上的惯性测量单元、全球定位系统、环境气象传感器模块,其中所述环境气象传感器模块通过多串口采集板连接在微型计算机上,所述微型计算机上还连接有机载存储单元和地面工作站,惯性测量单元和环境气体传感器获取无人机的飞行姿态信息和环境信息,并将获取的信息传递到微型计算机进行计算和融合,通过计算得出数据,通过数据分析无人机飞行是否安全,微型计算机根据分析结果发出指令;
其中,所述飞行安全控制方法是利用无人机安全控制设备建立一套无人机风向风速观测数据的质量控制算法,该算法基于飞行姿态信息和环境信息因子与风速风向数据误差之间的关系,通过理论分析和订正模型,实现基于无人机测量风速风向的数据质量控制并获得校准数据,实时监控无人机飞行环境并根据校准数据判断危险程度,当高空环境处于危险状态下给予无人机返回指令,迫使无人机自动返航,提供大气环境探测安全保障;
所述算法步骤如下:
S1:获取当前环境气象传感器模块获得的风速WS和风向WD,并获取当前无人机的朝向角度yaw、无人机的翻滚角度roll、无人机的俯仰角度pitch以及无人机的水平移动速度DroneU和无人机的垂直升降速度DroneV;
S10:经过S1至S9的订正后,对于仍存在的风速误差,算法将进一步寻找其他无人机状态数据。
2.根据权利要求1所述的无人机气象环境数据校准及飞行安全控制方法,其特征在于,所述算法首先基于风的矢量拆解,校准由于无人机空中姿态导致的风速风向的观测误差,接着对于仍存在的风速误差,算法将进一步寻找其他无人机状态数据与观测差异之间的关系,拟合各未知待定参数,确定订正方程;其中,所述无人机空中姿态包括翻滚角、俯仰角、偏航角、垂直移动速度,所述其他无人机状态数据包括旋翼转速、传感器在无人机的位置。
4.根据权利要求1所述的无人机气象环境数据校准及飞行安全控制方法,其特征在于,所述飞行安全控制方法根据校准数据及温度、湿度、气压环境气象传感器获得的数据,并通过微型计算机进行计算分析,实时监控无人机飞行环境并判断危险程度,微型计算机根据判断出的危险程度对无人机发出不同的指令,为大气环境探测提供安全保障。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910816672.2A CN111413992B (zh) | 2019-08-30 | 2019-08-30 | 无人机安全控制设备及方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910816672.2A CN111413992B (zh) | 2019-08-30 | 2019-08-30 | 无人机安全控制设备及方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN111413992A CN111413992A (zh) | 2020-07-14 |
CN111413992B true CN111413992B (zh) | 2023-03-28 |
Family
ID=71490803
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201910816672.2A Active CN111413992B (zh) | 2019-08-30 | 2019-08-30 | 无人机安全控制设备及方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN111413992B (zh) |
Family Cites Families (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US8498756B1 (en) * | 2011-08-18 | 2013-07-30 | The United States of America as Represented by the Adminstrator of the National Aeronautics & Space Administration (NASA) | Movable ground based recovery system for reuseable space flight hardware |
CN106054915A (zh) * | 2016-05-24 | 2016-10-26 | 北京小米移动软件有限公司 | 无人机的控制方法及装置 |
CN106125755B (zh) * | 2016-08-31 | 2023-03-24 | 中国科学院南海海洋研究所 | 一种无人机的大气边界层环境自主探测系统及其方法 |
KR20180031298A (ko) * | 2016-09-19 | 2018-03-28 | 쓰리디토시스 주식회사 | 실시간 기상 관측용 복합센서와 자체 풍향과 풍속 측정 기능을 탑재한 드론 및 이를 활용한 기상 관측 시스템 |
CN206939079U (zh) * | 2017-05-25 | 2018-01-30 | 成都川通达科技有限公司 | 一种可在恶劣环境下实现预警的无人机 |
CN109782793A (zh) * | 2018-11-28 | 2019-05-21 | 北京汉能光伏投资有限公司 | 无人机救援方法及系统 |
-
2019
- 2019-08-30 CN CN201910816672.2A patent/CN111413992B/zh active Active
Also Published As
Publication number | Publication date |
---|---|
CN111413992A (zh) | 2020-07-14 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106767804B (zh) | 一种运动物体的多维数据测量装置及方法 | |
CN206649345U (zh) | 一种基于超宽带通信的无人机导航装置 | |
CN103472503B (zh) | 探空仪及基于ins的高空风探测方法 | |
CN110501024A (zh) | 一种车载ins/激光雷达组合导航系统的量测误差补偿方法 | |
CN108051839B (zh) | 一种车载三维定位装置及三维定位的方法 | |
CN112986612B (zh) | 一种基于四旋翼无人机的低空移动式风速测量方法 | |
CN105737858A (zh) | 一种机载惯导系统姿态参数校准方法与装置 | |
CN108253966A (zh) | 无人机飞行三维模拟显示方法 | |
CN112304304B (zh) | 一种适用于变电站的巡检无人机、系统及方法 | |
CN213259512U (zh) | 一种用于桥梁挠度检测的飞行吸附机器人 | |
CN109084760A (zh) | 一种楼宇间导航系统 | |
CN107101636A (zh) | 一种使用卡尔曼滤波器辨识多旋翼动力学模型参数的方法 | |
Rodi et al. | Correction of static pressure on a research aircraft in accelerated flight using differential pressure measurements | |
CN111625021A (zh) | 一种基于电磁场的无人机电力巡线测距系统及方法 | |
CN112859923B (zh) | 一种无人机视觉编队飞行控制系统 | |
CN111141286A (zh) | 一种无人机飞控多传感器姿态置信解算方法 | |
CN110726851A (zh) | 一种利用旋翼无人机测算风速的方法 | |
CN105181995B (zh) | 一种用于高空低速飞行器的风速风向实时测量装置 | |
CN111413992B (zh) | 无人机安全控制设备及方法 | |
CN107063248A (zh) | 基于旋翼转速的动力学模型辅助惯导的导航方法 | |
CN211529002U (zh) | 双天线gps无人机及应用其的无人机系统 | |
CN104748734A (zh) | 一种带倾角补偿的车载电子海拔罗盘仪 | |
CN113885352B (zh) | 火星edl全过程自主gnc数学仿真验证系统 | |
CN112484751B (zh) | 一种航天验证器相对大空间试验场坐标系位置姿态测量方法 | |
WO2021223122A1 (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 |