CN110658831B - 对地高度校正方法及装置、无人飞行器 - Google Patents
对地高度校正方法及装置、无人飞行器 Download PDFInfo
- Publication number
- CN110658831B CN110658831B CN201911007421.6A CN201911007421A CN110658831B CN 110658831 B CN110658831 B CN 110658831B CN 201911007421 A CN201911007421 A CN 201911007421A CN 110658831 B CN110658831 B CN 110658831B
- Authority
- CN
- China
- Prior art keywords
- ground
- fusion
- height
- abnormal
- altitude
- 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
- 238000012937 correction Methods 0.000 title claims abstract description 195
- 238000000034 method Methods 0.000 title claims abstract description 68
- 230000002159 abnormal effect Effects 0.000 claims abstract description 160
- 230000005856 abnormality Effects 0.000 claims abstract description 63
- 230000004927 fusion Effects 0.000 claims description 237
- 238000004364 calculation method Methods 0.000 claims description 25
- 238000012545 processing Methods 0.000 claims description 9
- 238000004422 calculation algorithm Methods 0.000 claims description 8
- 239000002002 slurry Substances 0.000 claims description 8
- 238000004891 communication Methods 0.000 description 11
- 238000010586 diagram Methods 0.000 description 7
- 230000006870 function Effects 0.000 description 7
- 230000008569 process Effects 0.000 description 7
- 238000004590 computer program Methods 0.000 description 4
- 230000000007 visual effect Effects 0.000 description 4
- 230000009471 action Effects 0.000 description 3
- 230000005540 biological transmission Effects 0.000 description 3
- 238000001914 filtration Methods 0.000 description 3
- 238000012935 Averaging Methods 0.000 description 2
- XEEYBQQBJWHFJM-UHFFFAOYSA-N Iron Chemical compound [Fe] XEEYBQQBJWHFJM-UHFFFAOYSA-N 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 2
- 238000005516 engineering process Methods 0.000 description 2
- 230000010354 integration Effects 0.000 description 2
- 230000003993 interaction Effects 0.000 description 2
- 230000001133 acceleration Effects 0.000 description 1
- 230000032683 aging Effects 0.000 description 1
- 238000004458 analytical method Methods 0.000 description 1
- 230000001174 ascending effect Effects 0.000 description 1
- 230000001413 cellular effect Effects 0.000 description 1
- 238000004880 explosion Methods 0.000 description 1
- 239000011440 grout Substances 0.000 description 1
- 229910052742 iron Inorganic materials 0.000 description 1
- 238000004519 manufacturing process Methods 0.000 description 1
- 238000010295 mobile communication Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 230000003287 optical effect Effects 0.000 description 1
- 238000011084 recovery Methods 0.000 description 1
- 239000004065 semiconductor Substances 0.000 description 1
- 239000007787 solid Substances 0.000 description 1
- 238000006467 substitution reaction Methods 0.000 description 1
Images
Classifications
-
- 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/04—Control of altitude or depth
- G05D1/042—Control of altitude or depth specially adapted for aircraft
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C5/00—Measuring height; Measuring distances transverse to line of sight; Levelling between separated points; Surveyors' levels
- G01C5/005—Measuring height; Measuring distances transverse to line of sight; Levelling between separated points; Surveyors' levels altimeters for aircraft
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Aviation & Aerospace Engineering (AREA)
- Automation & Control Theory (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
- Navigation (AREA)
Abstract
本发明实施例涉及一种对地高度校正方法及装置、无人飞行器,方法应用于无人飞行器,无人飞行器包括用于检测无人飞行器与着陆点之间的对地高度的对地传感器,方法包括:获取对地传感器发生异常前的正常对地高度;计算对地传感器在异常期间的对地高度修正量;根据对地高度修正量与正常对地高度,校正无人飞行器的对地高度。方法通过获取无人飞行器的对地传感器发生异常前的正常对地高度,然后根据对地传感器在异常期间计算得到的对地高度修正量对正常对地高度进行校正,从而提高了无人飞行器的对地高度的准确度,提升了飞行器的降落性能。
Description
【技术领域】
本发明涉及无人飞行器技术领域,尤其涉及一种对地高度校正方法及装置、无人飞行器。
【背景技术】
飞行器在空中正常飞行时,其上升速度和下降速度一般都较快,而对于商业无人飞行器而言,为了达到较好的客户体验,以及从安全性角度考虑,飞行器在低空时会被限速,特别是起飞降落时的速度会被限制得较小,以便于安全、平稳地起飞和降落。
在实现本发明的过程中,发明人发现相关技术至少存在以下问题:飞行器起飞和降落时,对地高度是一个关键的信息,若对地高度不准确,会影响飞行器的起飞降落性能。
【发明内容】
本发明实施例旨在提供一种对地高度校正方法及装置、无人飞行器,以解决现有技术中无人飞行器的对地高度不准确,降落性能差的技术问题。
为解决上述技术问题,本发明实施例提供以下技术方案:一种对地高度校正方法,应用于无人飞行器,所述无人飞行器包括用于检测所述无人飞行器与着陆点之间的对地高度的对地传感器,所述方法包括:
获取所述对地传感器发生异常前的正常对地高度;
计算所述对地传感器在异常期间的对地高度修正量;
根据所述对地高度修正量与所述正常对地高度,校正所述无人飞行器的对地高度。
可选地,所述计算所述对地传感器在异常期间的对地高度修正量,包括:
获取所述对地传感器在所述异常期间的融合数据;
根据所述融合数据,计算所述对地高度修正量。
可选地,所述融合数据包括融合高度;
所述根据所述融合数据,计算对地高度修正量,包括:
锁存所述对地传感器发生异常前的正常融合高度;
将所述对地传感器在所述异常期间每时刻的融合高度与所述正常融合高度作差值运算,得到所述对地高度修正量。
可选地,所述融合数据包括融合速度,所述根据所述融合数据,计算对地高度修正量,包括:
将所述对地传感器在所述异常期间每时刻的所述融合速度作积分处理,得到所述对地高度修正量。
可选地,所述融合数据包括融合高度、融合速度及融合姿态,所述根据所述融合数据,计算对地高度修正量,包括:
锁存所述对地传感器发生异常前的正常融合高度;
将所述对地传感器在所述异常期间每时刻的融合高度与所述正常融合高度作差值运算,得到第一对地高度修正量;
将所述对地传感器在所述异常期间每时刻的融合速度作积分处理,得到第二对地高度修正量;
根据所述第一对地高度修正量、所述第二对地高度修正量及所述融合姿态,计算所述对地高度修正量。
可选地,所述根据所述第一对地高度修正量、所述第二对地高度修正量及所述融合姿态,计算对地高度修正量,包括:
根据预设加权算法,对所述第一对地高度修正量及所述第二对地高度修正量作加权处理,得到加权修正量;
根据所述融合姿态,将所述加权修正量转换至所述无人飞行器的坐标体系下,得到所述对地高度修正量。
可选地,所述方法还包括:
获取所述对地传感器在所述异常期间的异常失效信息;
判断所述异常失效信息是否满足预设校正触发条件;
若是,根据所述对地高度修正量与所述正常对地高度,校正所述无人飞行器的对地高度。
可选地,所述判断所述异常失效信息是否满足预设校正触发条件,包括:
锁存所述对地传感器出现异常时的当前融合水平速度;
将所述对地传感器在异常期间每时刻的融合水平速度与所述当前融合水平速度作差值积分运算,得到所述无人飞行器在异常期间内的水平相对距离;
判断所述水平相对距离是否小于预设距离阈值。
可选地,所述判断所述异常失效信息是否满足预设校正触发条件,包括:
计算所述对地传感器在异常期间的失效时长;
判断所述失效时长是否小于预设时长阈值。
可选地,校正所述无人飞行器的对地高度之后,所述方法还包括:
判断校正后的所述对地高度是否正常;
若正常,根据校正后的所述对地高度,调整所述无人飞行器的飞行参数;
若异常,获取当前融合高度,根据所述当前融合高度,调整所述无人飞行器的飞行参数。
可选地,所述根据校正后的所述对地高度,调整所述无人飞行器的飞行参数,包括:
判断校正后的所述对地高度是否小于预设对地高度;
若是,将所述飞行参数调整至第一预设参数范围。
可选地,所述预设参数包括飞行速度和停浆阈值;
所述将所述飞行参数调整至第一预设参数范围,包括:
将所述飞行速度调整至1.0~2.0m/s的范围内;
将所述停浆阈值调整至6.5~7.5m/s的范围内。
可选地,所述根据所述当前融合高度,调整所述无人飞行器的飞行参数,包括:
判断所述当前融合高度是否在预设融合高度范围内;
若是,将所述飞行参数调整至第二预设参数范围。
可选地,所述预设参数包括飞行速度和停浆阈值;
所述将所述飞行参数调整至第二预设参数范围,包括:
将所述飞行速度调整至0.2~0.3m/s的范围内;
将所述停浆阈值调整至2.8~3.2m/s的范围内。
为解决上述技术问题,本发明实施例还提供以下技术方案:一种对地高度校正装置,应用于无人飞行器,所述无人飞行器包括用于检测所述无人飞行器与着陆点之间的对地高度的对地传感器,包括:
复位模块,用于获取所述对地传感器在所述异常期间的异常失效信息,并判断所述异常失效信息是否满足预设校正触发条件。
预测模块,用于当所述对地传感器发生异常时,计算所述对地传感器在异常期间的对地高度修正量。
校正模块,用于当所述异常失效信息满足预设校正触发条件时,根据所述对地高度修正量与所述正常对地高度,校正所述无人飞行器的对地高度。
可选地,所述复位模块包括融合水平速度锁存单元、水平相对距离计算单元和第一判断单元;
所述融合水平速度锁存单元用于锁存所述对地传感器出现异常时的当前融合水平速度;
所述水平相对距离计算单元用于将所述对地传感器在异常期间每时刻的融合水平速度与所述当前融合水平速度作差值积分运算,得到所述无人飞行器在异常期间内的水平相对距离;
所述第一判断单元用于判断所述水平相对距离是否小于预设距离阈值。
可选地,所述复位模块包括失效时长计算单元和第二判断单元;
所述失效时长计算单元用于计算所述对地传感器在异常期间的失效时长;
所述第二判断单元用于判断所述失效时长是否小于预设时长阈值。
可选地,所述预测模块包括融合数据获取单元和对地高度修正量单元;
所述融合数据获取单元用于获取所述对地传感器在所述异常期间的融合数据;
所述对地高度修正量单元用于根据所述融合数据,计算所述对地高度修正量。
可选地,所述对地高度修正量单元包括正常融合高度获取子单元、第一对地高度修正量计算子单元、第二对地高度修正量计算子单元及对地高度修正量计算子单元;
所述正常融合高度获取子单元用于锁存所述对地传感器发生异常前的正常融合高度;
所述第一对地高度修正量计算子单元用于将所述对地传感器在所述异常期间每时刻的融合高度与所述正常融合高度作差值运算,得到第一对地高度修正量;
所述第二对地高度修正量计算子单元用于将所述对地传感器在所述异常期间每时刻的融合速度作积分处理,得到第二对地高度修正量;
所述对地高度修正量计算子单元用于根据所述第一对地高度修正量、所述第二对地高度修正量及所述融合姿态,计算所述对地高度修正量。
为解决上述技术问题,本发明实施例还提供以下技术方案:一种无人飞行器。所述飞行器包括:至少一个处理器;以及
与所述至少一个处理器通信连接的存储器;其中,所述存储器存储有可被所述至少一个处理器执行的指令,所述指令被所述至少一个处理器执行,以使所述至少一个处理器能够用于执行以上所述的飞行器对地高度校正方法。
与现有技术相比较,本发明实施例的提供飞行器对地高度校正方法通过首先获取无人飞行器的对地传感器发生异常前的正常对地高度,然后根据所述对地传感器在异常期间计算得到的对地高度修正量对所述正常对地高度进行校正,从而提高了所述无人飞行器的对地高度的准确度,提升了飞行器的降落性能。
【附图说明】
一个或多个实施例通过与之对应的附图中的图片进行示例性说明,这些示例性说明并不构成对实施例的限定,附图中具有相同参考数字标号的元件表示为类似的元件,除非有特别申明,附图中的图不构成比例限制。
图1为本发明实施例的应用环境示意图;
图2为本发明其中一实施例提供的对地高度校正方法的流程示意图;
图3是图2中S20的其中一实施例流程示意图;
图4是图3中S22的其中一实施例流程示意图;
图5是图4中S22的另一实施例流程示意图;
图6是图5中S228的其中一实施例流程示意图;
图7为本发明另一实施例提供的对地高度校正方法的流程示意图;
图8是图7中S50的其中一实施例流程示意图;
图9是图7中S50的另一实施例流程示意图;
图10为本发明再一实施例提供的对地高度校正方法的流程示意图;
图11是图10中S80的其中一实施例流程示意图;
图12是图10中S90的其中一实施例流程示意图;
图13为本发明其中一实施例提供的对地高度校正装置的结构框图;
图14为本发明其中一实施例提供的无人飞行器的结构框图。
【具体实施方式】
为了使本申请的目的、技术方案及优点更加清楚明白,以下结合附图及实施例,对本申请进行进一步详细说明。应当理解,此处所描述的具体实施例仅用以解释本申请,并不用于限定本申请。
需要说明的是,如果不冲突,本申请实施例中的各个特征可以相互结合,均在本申请的保护范围之内。另外,虽然在装置示意图中进行了功能模块划分,在流程图中示出了逻辑顺序,但是在某些情况下,可以以不同于装置中的模块划分,或流程图中的顺序执行所示出或描述的步骤。再者,本申请所采用的“第一”、“第二”、“第三”等字样并不对数据和执行次序进行限定,仅是对功能和作用基本相同的相同项或相似项进行区分。
除非另有定义,本说明书所使用的所有的技术和科学术语与属于本发明的技术领域的技术人员通常理解的含义相同。本说明书中在本发明的说明书中所使用的术语只是为了描述具体的实施例的目的,不是用于限制本发明。本说明书所使用的术语“和/或”包括一个或多个相关的所列项目的任意的和所有的组合。
此外,下面所描述的本发明不同实施例中所涉及的技术特征只要彼此之间未构成冲突就可以相互结合。
本发明实施例提供了一种对地高度校正方法和装置,应用于无人飞行器10,由于所述无人飞行器10的对地传感器在所述无人飞行器10降落过程中容易受到地面环境干扰而不稳定,进而导致所述无人飞行器10实时获取得到的对地高度不准确,因此所述方法和装置首先获取无人飞行器10的对地传感器发生异常前的正常对地高度,然后根据所述对地传感器在异常期间计算得到的对地高度修正量对所述正常对地高度进行校正,从而提高了所述无人飞行器10的对地高度的准确度,提升了飞行器的降落性能。
以下举例说明所述无人飞行器10对地高度校正方法的应用环境。
图1是本发明实施例提供的对地高度校正方法和装置的应用环境的示意图;如图1所示,所述应用场景包括无人飞行器10、无线网络20、智能终端30以及用户40。用户40可操作智能终端30通过无线网络20操控所述无人飞行器10。
无人飞行器10可以是以任何类型的动力驱动的无人飞行载具,包括但不限于旋翼无人机、固定翼无人机、伞翼无人机、扑翼无人机以及直升机模型等。
所述无人飞行器10可以根据实际情况的需要,具备相应的体积或者动力,从而提供能够满足使用需要的载重能力、飞行速度以及飞行续航里程等。无人飞行器10上还可以添加有一种或者多种功能模块,令无人飞行器10能够实现相应的功能。
例如,在本实施例中,所述无人飞行器10设置有加速度计、陀螺仪、磁力计、GPS导航仪、视觉传感器及对地传感器中的至少一种传感器。
其中,当所述无人飞行器10在降落过程中,所述无人飞行器10可根据所述加速度计获取得加速度信息判断是否执行着地动作。
其中,对地传感器用于检测所述无人飞行器10与着陆点之间的对地高度,所述对地传感器可为超声传感器、红外传感器及激光传感器等等。所述对地高度的准确度直接影响所述无人飞行器10降落过程中安全性,例如:在无人飞行器10降落时,无人飞行器10需要通过下视对地传感器来感知地面,如果下视对地传感器在某时间段出现问题则导致获取到的所述对地高度不准确,若此时所述无人飞行器10根据不准确的对地高度执行降落操作,可能会致使所述无人飞行器10出现突然停浆猛然砸地或不减速猛烈砸地的现象。
因此为了解决上述技术问题,相对应地,所述无人飞行器10设置有信息接收装置,接收并处理上述至少一种传感器采集的信息。同时相对应地,所述无人飞行器10设置有信息融合装置,所述信息融合装置可根据所述信息接收装置获取到的至少一种传感器采集的信息进行数据融合,所述融合数据可包括融合速度、融合高度及融合姿态角。所述无人飞行器10可根据所述所述融合数据计算所述对地传感器在异常期间的对地高度修正量,进而可根据所述对地高度修正量与所述正常对地高度,校正所述无人飞行器10的对地高度。
无人飞行器10上包含至少一个主控芯片,作为无人机飞行和数据传输等的控制核心,整合一个或者多个模块,以执行相应的逻辑控制程序。
例如,在一些实施例中,所述主控芯片上可以包括用于可根据所述所述融合数据计算所述对地传感器在异常期间的对地高度修正量,还用于对可根据所述对地高度修正量与所述正常对地高度,校正所述无人飞行器10的对地高度的对地高度校正装置。
智能终端30可以是任何类型,用以与无人飞行器10建立通信连接的智能装置,例如手机、平板电脑或者智能遥控器等。该智能终端30可以装配有一种或者多种不同的用户40交互装置,用以采集用户40指令或者向用户40展示和反馈信息。
这些交互装置包括但不限于:按键、显示屏、触摸屏、扬声器以及遥控操作杆。例如,智能终端30可以装配有触控显示屏,通过该触控显示屏接收用户40对无人飞行器10的遥控指令并通过触控显示屏向用户40展示航拍获得的图像信息,用户40还可以通过遥控触摸屏切换显示屏当前显示的图像信息。
在一些实施例中,无人飞行器10与智能终端30之间还可以融合现有的图像视觉处理技术,进一步的提供更智能化的服务。例如无人飞行器10可以通过双光相机采集图像的方式,由智能终端30对图像进行解析,从而实现用户40对于无人飞行器10的手势控制。
无线网络20可以是基于任何类型的数据传输原理,用于建立两个节点之间的数据传输信道的无线通信网络,例如位于不同信号频段的蓝牙网络、WiFi网络、无线蜂窝网络或者其结合。
图2为本发明实施例提供的无人飞行器10对地高度校正方法的实施例。如图2所示,该无人飞行器10对地高度校正方法包括如下步骤:
S10:获取所述对地传感器发生异常前的正常对地高度。
在所述无人飞行器10降落过程中,需要所述对地传感器实时获取所述对地高度,当所述对地传感器受到干扰而不稳定,从而导致所述对地高度不准确。例如,所述对地传感器受到周围环境(如高压线、铁矿厂等)所产生的磁场干扰,又例如,所无人飞行器10老化或者炸机多次,可能引起所述对地传感器损坏。
具体地,可根据获取到的所述对地传感器的对地高度信息来判断所述对地传感器是否发生异常。以超声传感器为例说明,所述超声传感器的对地高度信息包括噪声强度、飞行垂直速度、时间戳及与所述时间戳对应的对地高度。可采取如下方法根据所述超声传感器的对地高度信息判断所述超声传感器是否发生异常,举例说明,判断所述噪声强度是否小于预设强度阈值;判断所述飞行垂直速度与融合数据的差值是否小于预设误差阈值;判断所述时间戳更新是否正常;判断与所述时间戳对应的对地高度是否持续发生变化;若上述判断均为是,则可确认所述超声传感器为正常。否则,则可确认所述超声传感器发生异常。
当检测到所述对地传感器发生异常时,获取所述对地传感器发生异常前的正常对地高度。
举例说明,若对地传感器发生异常时刻为Ti,所述异常时刻Ti对应有一异常对地高度Hi。所述异常时刻Ti前一时刻为Ti-1,可以理解的是,所述Ti-1时刻为所述对地传感器未发生异常的时刻,即正常时刻Ti-1对应有一正常对地高度Hi-1。即当检测到所述对地传感器发生异常时,获取所述对地传感器发生异常前的正常时刻Ti-1对应的正常对地高度Hi-1。
S20:计算所述对地传感器在异常期间的对地高度修正量。
其中,所述异常时间是指当所述对地传感器发生异常起至所述对地传感器恢复正常的时间区间,例如,所述对地传感器发生异常时刻为Ti,所述对地传感器恢复的正常时刻为Ti+1,即所述异常期间为Ti+1-Ti。
其中,可通过获取到的所述无人飞行器10机载的多个传感器的融合数据,计算在异常期间的对地高度修正量。
具体地,所述传感器包括加速度计、磁力计、陀螺仪、定位仪和视觉传感器中的至少一种传感器。
具体地,数据融合的技术是对传感器采集的数据进行分析,整理,融合等一系列的操作处理,多传感器融合数据能够实现对对地高度的修正。
在本实施例中,基于加权平均法对多传感器采集的数据进行数据融合。具体地,第一步就要将所要使用到的各种软硬件进行初始化操作,如传感器初始化以及卡尔曼滤波初始化等;第二步要获取IMU里面的数据,再通过这部分数据信息做判断,看是否需要做姿态角补偿,若是需要补偿,具体数值为多少;第三步要获取加速度计、磁力计、陀螺仪、定位仪和视觉传感器等传感器采集的数据,针对这部分数据值,做相关的加权平均操作,把得到的数据值进行卡尔曼滤波,从而产生所述融合数据。
所述融合数据包括融合速度、融合高度及融合姿态角,进而将融合速度、融合高度及融合姿态角中的一个或多个融合数据结合所述对地传感器获得的对地高度得到所述对地高度修正量。
S30:根据所述对地高度修正量与所述正常对地高度,校正所述无人飞行器10的对地高度。
具体地,可将异常期间的对地高度修正量与所述对地传感器发生异常前的正常对地高度进行求和且/或求差运算得到校正后的对地高度。
举例说明,计算得到异常期间的对地高度修正量△H,所述对地传感器发生异常前的正常对地高度为Hb,即校正后的对地高度为Hb±△H。
由于所述无人飞行器10的对地传感器在所述无人飞行器10降落过程中容易受到地面环境干扰而不稳定,进而导致所述无人飞行器10实时获取得到的对地高度不准确,本发明实施例提供了一种无人飞行器10对地高度校正方法,通过首先获取无人飞行器10的对地传感器发生异常前的正常对地高度,然后根据所述对地传感器在异常期间计算得到的对地高度修正量对所述正常对地高度进行校正,从而提高了所述无人飞行器10的对地高度的准确度,提升了飞行器的降落性能。
为了准确的计算所述对地传感器在异常期间的对地高度修正量,在一些实施例中,请参阅图3,S20包括如下步骤:
S21:获取所述对地传感器在所述异常期间的融合数据。
其中,所述异常时间是指当所述对地传感器发生异常起至所述对地传感器恢复正常的时间区间,例如,所述对地传感器发生异常时刻为Ti,所述对地传感器恢复的正常时刻为Ti+1,即所述异常期间为Ti+1-Ti。
具体地,所述异常期间的融合数据是指将加速度计、磁力计、陀螺仪、定位仪和视觉传感器中的至少一种传感器采集的数据信息进行数据融合得到的,所述数据信息可采用多种不同的数据融合算法进行处理,例如:加权平均法、归一化加权平均法、卡尔曼滤波和扩展卡尔曼滤波。
在本实施例中,采用加权数据融合算计进行数据融合。
S22:根据所述融合数据,计算所述对地高度修正量。
具体地,所述融合数据包括融合速度、融合高度及融合姿态角,进而将融合速度、融合高度及融合姿态角中的一个或多个融合数据结合所述对地传感器获得的对地高度得到所述对地高度修正量。
为了更好的根据所述融合数据,得到准确的所述对地高度修正量,在一些实施例中,请参阅图4,S22包括如下步骤:
S221:锁存所述对地传感器发生异常前的正常融合高度。
具体地,可根据获取到的所述对地传感器的对地高度信息来判断所述对地传感器是否发生异常。
当检测到所述对地传感器发生异常时,获取所述对地传感器发生异常前的正常融合高度。
举例说明,若对地传感器发生异常时刻为Ti,所述异常时刻Ti对应有一异常融合高度Fi。所述异常时刻Ti前一时刻为Ti-1,可以理解的是,所述Ti-1时刻为所述对地传感器未发生异常的时刻,即正常时刻Ti-1对应有一正常融合高度Fi-1。即当检测到所述对地传感器发生异常时,获取所述对地传感器发生异常前的正常时刻Ti-1对应的正常融合高度Fi-1。
S223:将所述对地传感器在所述异常期间每时刻的融合高度与所述正常融合高度作差值运算,得到所述对地高度修正量。
其中,所述异常时间是指当所述对地传感器发生异常起至所述对地传感器恢复正常的时间区间,例如,所述对地传感器发生异常时刻为Ti,所述对地传感器恢复的正常时刻为Ti+n,即所述异常期间为Ti+n-Ti。
所述异常期间Ti+n-Ti内包括N个时刻,每个时刻对应有一所述无人飞行器10的融合高度。将所述对地传感器在所述异常期间Ti+n-Ti每时刻的融合高度与所述正常融合高度作差值运算,即可得到所述对地高度修正量。
举例说明,所述异常时间T6-T2内包括有异常时刻T3、T4及T5,异常时刻T3对应有一融合高度F3,异常时刻T4对应有一融合高度F4,异常时刻T5对应有一融合高度F5,异常时刻T2的前一时刻为T1,所述T1为正常时刻,所述正常时刻T1对应的正常融合高度F1,然后分别将异常时刻T3、T4及T5对应的融合高度F3、F4及F5与正常融合高度F1作差值运算,得到每个异常时刻的所述对地高度修正量△F3、△F4及△F5。
为了更好的根据所述融合数据,得到准确的所述对地高度修正量,在一些实施例中,请参阅图5,S22包括如下步骤:
将所述对地传感器在所述异常期间每时刻的所述融合速度作积分处理,得到所述对地高度修正量。
具体地,所述异常期间Ti+n-Ti内包括N个时刻,每个时刻对应有一所述无人飞行器10的融合速度。将所述对地传感器在所述异常期间Ti+n-Ti每时刻的融合速度作积分处理,即可得到所述对地高度修正量。
举例说明,所述异常时间T6-T2内包括有异常时刻T3、T4及T5,异常时刻T3对应有一融合速度V3,异常时刻T4对应有一融合速度V4,异常时刻T5对应有一融合速度V5,然后分别将异常时刻T3、T4及T5对应的融合速度V3、V4及V5,然后对V3、V4及V5作积分处理,即可得到所述对地高度修正量。
为了更好的根据所述融合数据,得到准确的所述对地高度修正量,在一些实施例中,请参阅图5,S22包括如下步骤:
S222:锁存所述对地传感器发生异常前的正常融合高度。
具体地,可根据获取到的所述对地传感器的对地高度信息来判断所述对地传感器是否发生异常。当检测到所述对地传感器发生异常时,获取所述对地传感器发生异常前的正常融合高度。
举例说明,若对地传感器发生异常时刻为Ti,所述异常时刻Ti对应有一异常融合高度Fi。所述异常时刻Ti前一时刻为Ti-1,可以理解的是,所述Ti-1时刻为所述对地传感器未发生异常的时刻,即正常时刻Ti-1对应有一正常融合高度Fi-1。即当检测到所述对地传感器发生异常时,获取所述对地传感器发生异常前的正常时刻Ti-1对应的正常融合高度Fi-1。
S224:将所述对地传感器在所述异常期间每时刻的融合高度与所述正常融合高度作差值运算,得到第一对地高度修正量。
其中,所述异常时间是指当所述对地传感器发生异常起至所述对地传感器恢复正常的时间区间,例如,所述对地传感器发生异常时刻为Ti,所述对地传感器恢复的正常时刻为Ti+n,即所述异常期间为Ti+n-Ti。
所述异常期间Ti+n-Ti内包括N个时刻,每个时刻对应有一所述无人飞行器10的融合高度。将所述对地传感器在所述异常期间Ti+n-Ti每时刻的融合高度与所述正常融合高度作差值运算,即可得到所述第一对地高度修正量。
举例说明,所述异常时间T6-T2内包括有异常时刻T3、T4及T5,异常时刻T3对应有一融合高度F3,异常时刻T4对应有一融合高度F4,异常时刻T5对应有一融合高度F5,异常时刻T2的前一时刻为T1,所述T1为正常时刻,所述正常时刻T1对应的正常融合高度F1,然后分别将异常时刻T3、T4及T5对应的融合高度F3、F4及F5与正常融合高度F1作差值运算,得到每个异常时刻的对应的所述第一对地高度修正量△F3、△F4及△F5。
S226:将所述对地传感器在所述异常期间每时刻的融合速度作积分处理,得到第二对地高度修正量。
具体地,所述异常期间Ti+n-Ti内包括N个时刻,每个时刻对应有一所述无人飞行器10的融合速度。将所述对地传感器在所述异常期间Ti+n-Ti每时刻的融合速度作积分处理,即可得到所述对地高度修正量。
举例说明,所述异常时间T6-T2内包括有异常时刻T3、T4及T5,异常时刻T3对应有一融合速度V3,异常时刻T4对应有一融合速度V4,异常时刻T5对应有一融合速度V5,然后分别将异常时刻T3、T4及T5对应的融合速度V3、V4及V5,然后对V3、V4及V5作积分处理,即可得到所述第二对地高度修正量。
S228:根据所述第一对地高度修正量、所述第二对地高度修正量及所述融合姿态,计算所述对地高度修正量。
为了更好的根据所述第一对地高度修正量、所述第二对地高度修正量及所述融合姿态,计算所述对地高度修正量,在一些实施例中,请参阅图6,S228包括如下步骤:
S2281:根据预设加权算法,对所述第一对地高度修正量及所述第二对地高度修正量作加权处理,得到加权修正量。
其中,所述预设加权算法可为加权平均算法、GPA标准加权算法、二进制加权算法等等。
S2282:根据所述融合姿态,将所述加权修正量转换至所述无人飞行器10的坐标体系下,得到所述对地高度修正量。
为了及时有效地校正所述无人飞行器10的对地高度,当检测到所述对地传感器发生异常时,在一些实施例中,请参阅图7,所述方法还包括:
S40:获取所述对地传感器在所述异常期间的异常失效信息。
具体地,所述异常失效信息可为在所述异常期间的所述对地传感器获取到的传感信息,例如所述传感信息包括无人飞行器10的时间、速度及高度等信息。由于所述传感信息是在传感器发生异常的期间获取到的,所以所述传感信息即为异常失效信息。
S50:判断所述异常失效信息是否满足预设校正触发条件。
具体地,判断在所述异常期间的所述对地传感器获取到的传感信息是否满足预设校正出发条件。例如判断在所述异常期间的所述对地传感器获取到的时间传感信息是否满足预设校正触发条件。又例如判断在所述异常期间的所述对地传感器获取到的速度传感信息是否满足预设校正触发条件。
S60:若是,根据所述对地高度修正量与所述正常对地高度,校正所述无人飞行器10的对地高度。
具体地,若所述异常失效信息满足预设校正触发条件,具体地,可将异常期间的对地高度修正量与所述对地传感器发生异常前的正常对地高度进行求和且/或求差运算得到校正后的对地高度。
举例说明,计算得到异常期间的对地高度修正量△H,所述对地传感器发生异常前的正常对地高度为Hb,即校正后的对地高度为Hb±△H。
为了及时所述异常失效信息是否满足预设校正触发条件,在一些实施例中,请参阅图8,S50包括如下步骤:
S51:锁存所述对地传感器出现异常时的当前融合水平速度;
具体地,当检测到所述对地传感器发生异常时,获取所述对地传感器发生异常时的当前融合水平速度。例如若对地传感器发生异常时刻为Ti,所述异常时刻Ti对应有一融合水平速度Vx。所融合水平速度Vx即为所述对地传感器出现异常时的当前融合水平速度。
S53:将所述对地传感器在异常期间每时刻的融合水平速度与所述当前融合水平速度作差值积分运算,得到所述无人飞行器10在异常期间内的水平相对距离。
其中,所述异常时间是指当所述对地传感器发生异常起至所述对地传感器恢复正常的时间区间,例如,所述对地传感器发生异常时刻为Ti,所述对地传感器恢复的正常时刻为Ti+n,即所述异常期间为Ti+n-Ti。
所述异常期间Ti+n-Ti内包括N个时刻,每个时刻对应有一所述无人飞行器10的融合水平速度。将所述对地传感器在所述异常期间Ti+n-Ti每时刻的融合水平速度与所述对地传感器出现异常时的当前融合水平速度作差值积分运算,即可得到所述无人飞行器10在异常期间内的水平相对距离。
举例说明,所述异常时间T6-T2内包括有异常时刻T3、T4及T5,异常时刻T3对应有一融合水平速度V3x,异常时刻T4对应有一融合水平速度V4x,异常时刻T5对应有一融合水平速度V5x,异常时刻T2为所述对地传感器刚开始发生异常的时刻,所述异常时刻T2对应的当前融合水平速度V2x,然后分别将异常时刻T3、T4及T5对应的融合高度V3x、V4x及V5x与当前融合水平速度V2x作差值运算,得到每个异常时刻的融合水平速度差值△V3x、△V4x及△V5x。然后将每个异常时刻的融合水平速度差值△V3x、△V4x及△V5x进行积分运算,即可得到所述无人飞行器10在异常期间内的水平相对距离。
S55:判断所述水平相对距离是否小于预设距离阈值。
具体地,将所述水平相对距离与预设距离阈值进行比较,判断所述水平相对距离是否小于预设距离阈值。
为了及时所述异常失效信息是否满足预设校正触发条件,在一些实施例中,请参阅图9,S50包括如下步骤:
S52:计算所述对地传感器在异常期间的失效时长。
其中,所述失效时长是指当所述对地传感器发生异常的时刻与所述对地传感器恢复正常时刻的之间的时间区间。
举例说明,所述对地传感器发生异常时刻为Ti,所述对地传感器恢复的正常时刻为Ti+n,即所述异常期间的失效时长为Ti+n与Ti之间的时间区间。
S54:判断所述失效时长是否小于预设时长阈值。
具体地,将所述失效时长与预设时长阈值进行比较,判断所述失效时长是否小于预设时长阈值。
为了能够根据校正后的所述无人飞行器10的对地高度,调整所述无人飞行器10的飞行参数,实施安全降落,在一些实施例中,请参阅图10,在所述校正所述无人飞行器10的对地高度之后,所述方法还包括:
S70:判断校正后的所述对地高度是否正常。
具体地,获取校正后的所述无人飞行器10的当前融合高度,将所述校正后的所述无人飞行器10的当前融合高度与所述校正后的所述对地高度差值运算,若所述当前融合高度与所述对地高度的差值小于或等于预设阈值,则可判定校正后的所述对地高度是正常的。若所述当前融合高度与所述对地高度的差值大于预设阈值,则可判定校正后的所述对地高度是不正常的。
S80:若正常,根据校正后的所述对地高度,调整所述无人飞行器10的飞行参数。
具体地,若所述当前融合高度与所述对地高度的差值小于或等于预设阈值,则根据校正后的所述对地高度,调整所述无人飞行器10的飞行参数。
S90:若异常,获取当前融合高度,根据所述当前融合高度,调整所述无人飞行器10的飞行参数。
具体地,若所述当前融合高度与所述对地高度的差值大于预设阈值,根据所述当前融合高度,调整所述无人飞行器10的飞行参数。
为了更好的根据校正后的所述对地高度,调整所述无人飞行器10的飞行参数,在一些实施例中,请参阅图11,S80包括如下步骤:
S81:判断校正后的所述对地高度是否小于预设对地高度。
具体地,将所述校正后的所述对地高度与预设对地高度进行比较,判断所述校正后的所述对地高度是否小于预设对地高度。例如,若校正后的对地高度为1.2m,预设对地高度为0.5m,校正后的对地高度1.2m大于预设对地高度0.5m,则可判定所述校正后的所述对地高度不小于预设对地高度。若校正后的对地高度为0.2m,预设对地高度为0.5m,则可判定所述校正后的所述对地高度小于预设对地高度。
S82:若是,将所述飞行参数调整至第一预设参数范围。
其中,所述预设参数包括无人飞行器10的飞行速度和停浆阈值。
具体地,若校正后的所述对地高度是否小于预设对地高度,则将所述飞行速度调整至1.0~2.0m/s的范围内;将所述停浆阈值调整至6.5~7.5m/s的范围内。
为了更好的根据所述当前融合高度,调整所述无人飞行器10的飞行参数,在一些实施例中,请参阅图12,S90包括如下步骤:
S91:判断所当前述融合高度是否在预设融合高度范围内;
具体地,将所述当前融合高度与预设融合高度进行比较,判断获取到的当前融合高度是否在预设融合高度范围内。例如,若获取到的当前融合高度为3m,预设融合高度范围为-2~2m,则可判定获取到的当前融合高度为3m不在预设融合高度范围为-2~2m内。若获取到的当前融合高度为1.5m,预设融合高度范围为-2~2m,则可判定获取到的当前融合高度为1.5m在预设融合高度范围为-2~2m内。
S92:若是,将所述飞行参数调整至第二预设参数范围。
其中,所述预设参数包括无人飞行器10的飞行速度和停浆阈值。
具体地,若所述当前融合高度在预设融合高度范围内,则将所述飞行速度调整至0.2-0.3m/s的范围内;将所述停浆阈值调整至2.8-3.2m/s的范围内。
需要说明的是,在上述各个实施例中,上述各步骤之间并不必然存在一定的先后顺序,本领域普通技术人员,根据本申请实施例的描述可以理解,不同实施例中,上述各步骤可以有不同的执行顺序,亦即,可以并行执行,亦可以交换执行等等。
作为本申请实施例的另一方面,本申请实施例提供一种对地高度校正装置,应用于无人飞行器10,所述无人飞行器10包括用于检测所述无人飞行器10与着陆点之间的对地高度的对地传感器。请参阅图13,该对地高度校正装置50包括:复位模块51、预测模块52及校正模块53。
所述复位模块51用于获取所述对地传感器在所述异常期间的异常失效信息,并判断所述异常失效信息是否满足预设校正触发条件。
所述预测模块52用于当所述对地传感器发生异常时,计算所述对地传感器在异常期间的对地高度修正量。
所述校正模块53用于当所述异常失效信息满足预设校正触发条件时,根据所述对地高度修正量与所述正常对地高度,校正所述无人飞行器10的对地高度。
因此,在本实施例中,所述飞行器对地高度校正装置通过首先获取无人飞行器10的对地传感器发生异常前的正常对地高度,然后根据所述对地传感器在异常期间计算得到的对地高度修正量对所述正常对地高度进行校正,从而提高了所述无人飞行器10的对地高度的准确度,提升了飞行器的降落性能。
在一些实施例中,飞行器对地高度校正装置50还包括飞行参数调整模块54,所述飞行参数调整模块用于判断校正后的所述对地高度是否正常;若正常,根据校正后的所述对地高度,调整所述无人飞行器10的飞行参数;若异常,获取当前融合高度,根据所述当前融合高度,调整所述无人飞行器10的飞行参数。
所述飞行参数调整模块54包括第一判定单元和第一飞行参数调整单元;
所述第一判定单元用于判断校正后的所述对地高度是否小于预设对地高度;所述第一飞行参数调整单元用于当校正后的所述对地高度小于预设对地高度时,将所述飞行参数调整至第一预设参数范围。所述所述第一飞行参数调整单元具体用于将所述飞行速度调整至1.0-2.0m/s的范围内;将所述停浆阈值调整至6.5-7.5m/s的范围内。
在一些实施例中,所述飞行参数调整模块包括第二判定单元和第二飞行参数调整单元。
所述第二判定单元用于判断所述融合高度是否在预设融合高度范围内;
所述第二飞行参数调整单元用于当所述当前融合高度在预设融合高度范围内时,将所述飞行参数调整至第二预设参数范围。所述第二飞行参数调整单元具体用于将所述飞行速度调整至0.2-0.3m/s的范围内;将所述停浆阈值调整至2.8-3.2m/s的范围内。
其中,所述复位模块51包括融合水平速度锁存单元、水平相对距离计算单元和第一判断单元。
所述融合水平速度锁存单元用于锁存所述对地传感器出现异常时的当前融合水平速度;
所述水平相对距离计算单元用于将所述对地传感器在异常期间每时刻的融合水平速度与所述当前融合水平速度作差值积分运算,得到所述无人飞行器10在异常期间内的水平相对距离;
所述第一判断单元用于判断所述水平相对距离是否小于预设距离阈值。
其中,在一些实施例中,所述复位模块51包括失效时长计算单元和第二判断单元;所述失效时长计算单元用于计算所述对地传感器在异常期间的失效时长;所述第二判断单元用于判断所述失效时长是否小于预设时长阈值。
其中,所述所述预测模块52包括融合数据获取单元和对地高度修正量单元。
所述融合数据获取单元用于获取所述对地传感器在所述异常期间的融合数据;所述对地高度修正量单元用于根据所述融合数据,计算所述对地高度修正量。
所述所述对地高度修正量单元包括正常融合高度获取子单元、第一对地高度修正量计算子单元、第二对地高度修正量计算子单元及对地高度修正量计算子单元。
所述正常融合高度获取子单元用于锁存所述对地传感器发生异常前的正常融合高度。
所述第一对地高度修正量计算子单元用于将所述对地传感器在所述异常期间每时刻的融合高度与所述正常融合高度作差值运算,得到第一对地高度修正量。
所述第二对地高度修正量计算子单元用于将所述对地传感器在所述异常期间每时刻的融合速度作积分处理,得到第二对地高度修正量。
所述对地高度修正量计算子单元用于根据所述第一对地高度修正量、所述第二对地高度修正量及所述融合姿态,计算所述对地高度修正量。
需要说明的是,上述飞行器对地高度校正装置可执行本发明实施例所提供的飞行器对地高度校正方法,具备执行方法相应的功能模块和有益效果。未在飞行器对地高度校正装置实施例中详尽描述的技术细节,可参见本发明实施例所提供的飞行器对地高度校正方法。
图14为本发明实施例提供的无人飞行器10的结构框图。该无人飞行器10可以用于实现所述主控芯片中的全部或者部分功能模块的功能。如图14所示,该无人飞行器10可以包括:处理器110、存储器120以及通信模块130。所述处理器110、存储器120以及通信模块130之间通过总线的方式,建立任意两者之间的通信连接。
处理器110可以为任何类型,具备一个或者多个处理核心的处理器110。其可以执行单线程或者多线程的操作,用于解析指令以执行获取数据、执行逻辑运算功能以及下发运算处理结果等操作。
存储器120作为一种非暂态计算机可读存储介质,可用于存储非暂态软件程序、非暂态性计算机可执行程序以及模块,如本发明实施例中的飞行器对地高度校正方法对应的程序指令/模块(例如,附图13所示的复位模块51、预测模块52、校正模块53及飞行参数调整模块54)。处理器110通过运行存储在存储器120中的非暂态软件程序、指令以及模块,从而执行飞行器对地高度校正装置50的各种功能应用以及数据处理,即实现上述任一方法实施例中飞行器对地高度校正方法。
存储器120可以包括存储程序区和存储数据区,其中,存储程序区可存储操作***、至少一个功能所需要的应用程序;存储数据区可存储根据飞行器对地高度校正装置50的使用所创建的数据等。此外,存储器120可以包括高速随机存取存储器,还可以包括非暂态存储器,例如至少一个磁盘存储器件、闪存器件、或其他非暂态固态存储器件。在一些实施例中,存储器120可选包括相对于处理器110远程设置的存储器,这些远程存储器可以通过网络连接至终端。上述网络的实例包括但不限于互联网、企业内部网、局域网、移动通信网及其组合。
所述存储器120存储有可被所述至少一个处理器110执行的指令;所述至少一个处理器110用于执行所述指令,以实现上述任意方法实施例中飞行器对地高度校正方法,例如,执行以上描述的方法步骤10、20、30等,实现图13中的模块51-54的功能。
通信模块130是用于建立通信连接,提供物理信道的功能模块。通信模块130以是任何类型的无线或者有线通信模块130,包括但不限于WiFi模块或者蓝牙模块等。所述通信模块130用于与无人飞行器10通信连接。
进一步地,本发明实施例还提供了一种非暂态终端可读存储介质,所述非暂态终端可读存储介质存储有终端可执行指令,该终端可执行指令被一个或多个处理器110执行,例如,被图14中的一个处理器110执行,可使得上述一个或多个处理器110执行上述任意方法实施例中飞行器对地高度校正方法,例如,执行以上描述的方法步骤10、20、30等等,实现图13中的模块51-54的功能。
以上所描述的装置实施例仅仅是示意性的,其中所述作为分离部件说明的单元可以是或者也可以不是物理上分开的,作为单元显示的部件可以是或者也可以不是物理单元,即可以位于一个地方,或者也可以分布到多个网络单元上。可以根据实际的需要选择其中的部分或者全部模块来实现本实施例方案的目的。
通过以上的实施方式的描述,本领域普通技术人员可以清楚地了解到各实施方式可借助软件加通用硬件平台的方式来实现,当然也可以通过硬件。本领域普通技术人员可以理解实现上述实施例方法中的全部或部分流程是可以通过计算机程序产品中的计算机程序来指令相关的硬件来完成,所述的计算机程序可存储于一非暂态计算机可读取存储介质中,该计算机程序包括程序指令,当所述程序指令被相关设备执行时,可使相关设备执行上述各方法的实施例的流程。其中,所述的存储介质可为磁碟、光盘、只读存储记忆体(Read-Only Memory,ROM)或随机存储记忆体(Random Access Memory,RAM)等。
上述产品可执行本发明实施例所提供的飞行器对地高度校正方法,具备执行飞行器对地高度校正方法相应的功能模块和有益效果。未在本实施例中详尽描述的技术细节,可参见本发明实施例所提供的飞行器对地高度校正方法。
最后应说明的是:以上实施例仅用以说明本发明的技术方案,而非对其限制;在本发明的思路下,以上实施例或者不同实施例中的技术特征之间也可以进行组合,步骤可以以任意顺序实现,并存在如上所述的本发明的不同方面的许多其它变化,为了简明,它们没有在细节中提供;尽管参照前述实施例对本发明进行了详细的说明,本领域的普通技术人员应当理解:其依然可以对前述各实施例所记载的技术方案进行修改,或者对其中部分技术特征进行等同替换;而这些修改或者替换,并不使相应技术方案的本质脱离本发明各实施例技术方案的范围。
Claims (19)
1.一种对地高度校正方法,应用于无人飞行器,所述无人飞行器包括用于检测所述无人飞行器与着陆点之间的对地高度的对地传感器,其特征在于,所述方法包括:
获取所述对地传感器发生异常前的正常对地高度;
获取所述对地传感器在所述异常期间的融合数据,其中,所述融合数据包括融合高度、融合速度及融合姿态;
根据所述融合数据,计算所述对地传感器在异常期间的对地高度修正量;
根据所述对地高度修正量与所述正常对地高度,校正所述无人飞行器的对地高度。
2.根据权利要求1所述的方法,其特征在于,所述根据所述融合数据,计算对地高度修正量,包括:
锁存所述对地传感器发生异常前的正常融合高度;
将所述对地传感器在所述异常期间每时刻的融合高度与所述正常融合高度作差值运算,得到所述对地高度修正量。
3.根据权利要求1所述的方法,其特征在于,所述根据所述融合数据,计算对地高度修正量,包括:
将所述对地传感器在所述异常期间每时刻的所述融合速度作积分处理,得到所述对地高度修正量。
4.根据权利要求1所述的方法,其特征在于,所述根据所述融合数据,计算对地高度修正量,包括:
锁存所述对地传感器发生异常前的正常融合高度;
将所述对地传感器在所述异常期间每时刻的融合高度与所述正常融合高度作差值运算,得到第一对地高度修正量;
将所述对地传感器在所述异常期间每时刻的融合速度作积分处理,得到第二对地高度修正量;
根据所述第一对地高度修正量、所述第二对地高度修正量及所述融合姿态,计算所述对地高度修正量。
5.根据权利要求4所述的方法,其特征在于,所述根据所述第一对地高度修正量、所述第二对地高度修正量及所述融合姿态,计算对地高度修正量,包括:
根据预设加权算法,对所述第一对地高度修正量及所述第二对地高度修正量作加权处理,得到加权修正量;
根据所述融合姿态,将所述加权修正量转换至所述无人飞行器的坐标体系下,得到所述对地高度修正量。
6.根据权利要求1所述的方法,其特征在于,所述方法还包括:
获取所述对地传感器在所述异常期间的异常失效信息;
判断所述异常失效信息是否满足预设校正触发条件;
若是,根据所述对地高度修正量与所述正常对地高度,校正所述无人飞行器的对地高度。
7.根据权利要求6所述的方法,其特征在于,所述判断所述异常失效信息是否满足预设校正触发条件,包括:
锁存所述对地传感器出现异常时的当前融合水平速度;
将所述对地传感器在异常期间每时刻的融合水平速度与所述当前融合水平速度作差值积分运算,得到所述无人飞行器在异常期间内的水平相对距离;
判断所述水平相对距离是否小于预设距离阈值。
8.根据权利要求6所述的方法,其特征在于,所述判断所述异常失效信息是否满足预设校正触发条件,包括:
计算所述对地传感器在异常期间的失效时长;
判断所述失效时长是否小于预设时长阈值。
9.根据权利要求1所述的方法,其特征在于,校正所述无人飞行器的对地高度之后,所述方法还包括:
判断校正后的所述对地高度是否正常;
若正常,根据校正后的所述对地高度,调整所述无人飞行器的飞行参数;
若异常,获取当前融合高度,根据所述当前融合高度,调整所述无人飞行器的飞行参数。
10.根据权利要求9所述的方法,其特征在于,所述根据校正后的所述对地高度,调整所述无人飞行器的飞行参数,包括:
判断校正后的所述对地高度是否小于预设对地高度;
若是,将所述飞行参数调整至第一预设参数范围。
11.根据权利要求10所述的方法,其特征在于,所述预设参数包括飞行速度和停浆阈值;
所述将所述飞行参数调整至第一预设参数范围,包括:
将所述飞行速度调整至1.0~2.0m/s的范围内;
将所述停浆阈值调整至6.5~7.5m/s的范围内。
12.根据权利要求9所述的方法,其特征在于,所述根据所述当前融合高度,调整所述无人飞行器的飞行参数,包括:
判断所述当前融合高度是否在预设融合高度范围内;
若是,将所述飞行参数调整至第二预设参数范围。
13.根据权利要求12所述的方法,其特征在于,所述第二预设参数包括飞行速度和停浆阈值;
所述将所述飞行参数调整至第二预设参数范围,包括:
将所述飞行速度调整至0.2~0.3m/s的范围内;
将所述停浆阈值调整至2.8~3.2m/s的范围内。
14.一种对地高度校正装置,应用于无人飞行器,所述无人飞行器包括用于检测所述无人飞行器与着陆点之间的对地高度的对地传感器,其特征在于,包括:
复位模块,用于获取所述对地传感器在异常期间的异常失效信息,并判断所述异常失效信息是否满足预设校正触发条件;
预测模块,用于当所述对地传感器发生异常时,计算所述对地传感器在所述异常期间的对地高度修正量;
校正模块,用于当所述异常失效信息满足预设校正触发条件,根据所述对地高度修正量与正常对地高度,校正所述无人飞行器的所述对地高度。
15.根据权利要求14所述的对地高度校正装置,其特征在于,
所述复位模块包括融合水平速度锁存单元、水平相对距离计算单元和第一判断单元;
所述融合水平速度锁存单元用于锁存所述对地传感器出现异常时的当前融合水平速度;
所述水平相对距离计算单元用于将所述对地传感器在异常期间每时刻的融合水平速度与所述当前融合水平速度作差值积分运算,得到所述无人飞行器在所述异常期间内的水平相对距离;
所述第一判断单元用于判断所述水平相对距离是否小于预设距离阈值。
16.根据权利要求14所述的对地高度校正装置,其特征在于,
所述复位模块包括失效时长计算单元和第二判断单元;
所述失效时长计算单元用于计算所述对地传感器在所述异常期间的失效时长;
所述第二判断单元用于判断所述失效时长是否小于预设时长阈值。
17.根据权利要求14所述的对地高度校正装置,其特征在于,
所述预测模块包括融合数据获取单元和对地高度修正量单元;
所述融合数据获取单元用于获取所述对地传感器在所述异常期间的融合数据;
所述对地高度修正量单元用于根据所述融合数据,计算所述对地高度修正量。
18.根据权利要求17所述的对地高度校正装置,其特征在于,所述融合数据包括融合高度、融合速度及融合姿态;
所述对地高度修正量单元包括正常融合高度获取子单元、第一对地高度修正量计算子单元、第二对地高度修正量计算子单元及对地高度修正量计算子单元;
所述正常融合高度获取子单元用于锁存所述对地传感器发生异常前的正常融合高度;
所述第一对地高度修正量计算子单元用于将所述对地传感器在所述异常期间每时刻的融合高度与所述正常融合高度作差值运算,得到第一对地高度修正量;
所述第二对地高度修正量计算子单元用于将所述对地传感器在所述异常期间每时刻的融合速度作积分处理,得到第二对地高度修正量;
所述对地高度修正量计算子单元用于根据所述第一对地高度修正量、所述第二对地高度修正量及所述融合姿态,计算所述对地高度修正量。
19.一种无人飞行器,其特征在于,包括:
至少一个处理器;以及
与所述至少一个处理器通信连接的存储器;其中,所述存储器存储有可被所述至少一个处理器执行的指令,所述指令被所述至少一个处理器执行,以使所述至少一个处理器能够用于执行如权利要求1-13中任一项所述的飞行器对地高度校正方法。
Priority Applications (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201911007421.6A CN110658831B (zh) | 2019-10-22 | 2019-10-22 | 对地高度校正方法及装置、无人飞行器 |
PCT/CN2020/118852 WO2021078005A1 (zh) | 2019-10-22 | 2020-09-29 | 对地高度校正方法及装置、无人飞行器 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201911007421.6A CN110658831B (zh) | 2019-10-22 | 2019-10-22 | 对地高度校正方法及装置、无人飞行器 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN110658831A CN110658831A (zh) | 2020-01-07 |
CN110658831B true CN110658831B (zh) | 2022-04-15 |
Family
ID=69042004
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201911007421.6A Active CN110658831B (zh) | 2019-10-22 | 2019-10-22 | 对地高度校正方法及装置、无人飞行器 |
Country Status (2)
Country | Link |
---|---|
CN (1) | CN110658831B (zh) |
WO (1) | WO2021078005A1 (zh) |
Families Citing this family (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110658831B (zh) * | 2019-10-22 | 2022-04-15 | 深圳市道通智能航空技术股份有限公司 | 对地高度校正方法及装置、无人飞行器 |
CN114594472B (zh) * | 2022-02-24 | 2023-06-27 | 中国电子科技集团公司第十研究所 | 基于外信息的无线电高度表数据处理方法及装置 |
CN115808186B (zh) * | 2023-01-29 | 2023-05-23 | 中国空气动力研究与发展中心高速空气动力研究所 | 一种扑翼飞行器距离测量结果的校正方法 |
CN117009908B (zh) * | 2023-09-25 | 2024-01-12 | 中国民用航空飞行学院 | 一种飞行异常状态识别与预测***及方法 |
CN118220505B (zh) * | 2024-05-23 | 2024-07-19 | 中汽北消(北京)应急装备科技有限公司 | 一种无人机锁紧模块的控制***及方法 |
Citations (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103364785A (zh) * | 2012-03-30 | 2013-10-23 | 鹦鹉股份有限公司 | 用于多转子旋翼式无人驾驶飞机的高度估计器 |
UA103633U (ru) * | 2015-06-15 | 2015-12-25 | M E Zhukovsky Nat Aerospace University Kharkiv Aviat Inst | Система автоматического управления высотой полета беспилотного летательного аппарата |
CN106225769A (zh) * | 2016-09-30 | 2016-12-14 | 深圳市富微科创电子有限公司 | 一种飞行器定高方法和*** |
CN106403940A (zh) * | 2016-08-26 | 2017-02-15 | 杨百川 | 一种抗大气参数漂移的无人机飞行导航***高度信息融合方法 |
CN106595578A (zh) * | 2017-01-25 | 2017-04-26 | 上海拓攻机器人有限公司 | 一种基于多传感器信息融合的无人机高度测量方法及*** |
CN107438751A (zh) * | 2016-09-27 | 2017-12-05 | 深圳市大疆创新科技有限公司 | 用于检测飞行高度的方法、装置及无人机 |
CN107577238A (zh) * | 2017-08-25 | 2018-01-12 | 深圳禾苗通信科技有限公司 | 基于ukf的无人机气压计异常数据处理的高度控制方法 |
CN107783548A (zh) * | 2016-08-25 | 2018-03-09 | 大连楼兰科技股份有限公司 | 基于多传感器信息融合技术的数据处理方法 |
CN109211185A (zh) * | 2017-06-30 | 2019-01-15 | 北京臻迪科技股份有限公司 | 一种飞行设备、获取位置信息的方法及装置 |
CN110146055A (zh) * | 2019-05-21 | 2019-08-20 | 深圳市道通智能航空技术有限公司 | 一种超声异常检测方法、装置及电子设备 |
Family Cites Families (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
PL407686A1 (pl) * | 2014-03-27 | 2015-09-28 | Ambiton Spółka Z Ograniczoną Odpowiedzialnością | Urządzenie do monitorowania lądowania samolotów |
CN104913775B (zh) * | 2015-06-19 | 2018-10-26 | 广州快飞计算机科技有限公司 | 无人机对地高度的测量方法、无人机定位方法及装置 |
CN105203075B (zh) * | 2015-09-15 | 2017-07-28 | 北京安达维尔航空设备有限公司 | 无线电高度表数据融合测高***以及测高方法 |
CN105346706B (zh) * | 2015-11-13 | 2018-09-04 | 深圳市道通智能航空技术有限公司 | 飞行装置、飞行控制***及方法 |
CN109282786B (zh) * | 2017-07-21 | 2021-07-09 | 昊翔电能运动科技(昆山)有限公司 | 用于固定翼无人机的测量高度方法及装置 |
CN110658831B (zh) * | 2019-10-22 | 2022-04-15 | 深圳市道通智能航空技术股份有限公司 | 对地高度校正方法及装置、无人飞行器 |
-
2019
- 2019-10-22 CN CN201911007421.6A patent/CN110658831B/zh active Active
-
2020
- 2020-09-29 WO PCT/CN2020/118852 patent/WO2021078005A1/zh active Application Filing
Patent Citations (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103364785A (zh) * | 2012-03-30 | 2013-10-23 | 鹦鹉股份有限公司 | 用于多转子旋翼式无人驾驶飞机的高度估计器 |
UA103633U (ru) * | 2015-06-15 | 2015-12-25 | M E Zhukovsky Nat Aerospace University Kharkiv Aviat Inst | Система автоматического управления высотой полета беспилотного летательного аппарата |
CN107783548A (zh) * | 2016-08-25 | 2018-03-09 | 大连楼兰科技股份有限公司 | 基于多传感器信息融合技术的数据处理方法 |
CN106403940A (zh) * | 2016-08-26 | 2017-02-15 | 杨百川 | 一种抗大气参数漂移的无人机飞行导航***高度信息融合方法 |
CN107438751A (zh) * | 2016-09-27 | 2017-12-05 | 深圳市大疆创新科技有限公司 | 用于检测飞行高度的方法、装置及无人机 |
CN106225769A (zh) * | 2016-09-30 | 2016-12-14 | 深圳市富微科创电子有限公司 | 一种飞行器定高方法和*** |
CN106595578A (zh) * | 2017-01-25 | 2017-04-26 | 上海拓攻机器人有限公司 | 一种基于多传感器信息融合的无人机高度测量方法及*** |
CN109211185A (zh) * | 2017-06-30 | 2019-01-15 | 北京臻迪科技股份有限公司 | 一种飞行设备、获取位置信息的方法及装置 |
CN107577238A (zh) * | 2017-08-25 | 2018-01-12 | 深圳禾苗通信科技有限公司 | 基于ukf的无人机气压计异常数据处理的高度控制方法 |
CN110146055A (zh) * | 2019-05-21 | 2019-08-20 | 深圳市道通智能航空技术有限公司 | 一种超声异常检测方法、装置及电子设备 |
Non-Patent Citations (1)
Title |
---|
微小型惯性/光学/磁罗盘/气压高度组合导航***研究;刘伟等;《遥测遥控》;20130531;全文 * |
Also Published As
Publication number | Publication date |
---|---|
WO2021078005A1 (zh) | 2021-04-29 |
CN110658831A (zh) | 2020-01-07 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110658831B (zh) | 对地高度校正方法及装置、无人飞行器 | |
CN110427047B (zh) | 风速测算方法、风速估算器及无人机 | |
US11094205B2 (en) | Fleet management of unmanned aerial vehicles and flight authorization system | |
US11919637B2 (en) | Automatic return method, apparatus and unmanned aerial vehicle | |
CN110244753B (zh) | 风速测算方法及无人机 | |
US10156854B2 (en) | UAV and UAV landing control device and method | |
US11302203B2 (en) | Data processing device, drone, and control device, method, and processing program therefor | |
JP6657498B2 (ja) | モバイルプラットフォームの動作情報を提示する方法、装置、およびコンピュータプログラム | |
WO2021078002A1 (zh) | 无人机航向角初值选取方法、装置及无人机 | |
US10636314B2 (en) | Adjusting flight parameters of an aerial robotic vehicle based on presence of propeller guard(s) | |
US20170344026A1 (en) | Uav, uav flight control method and device | |
US9691288B2 (en) | System and method for sending in-flight weather alerts | |
CN110488865B (zh) | 无人机航向确定方法、装置及无人机 | |
WO2021031974A1 (zh) | 无人机航向角初值选取方法及无人机 | |
CN107783106A (zh) | 无人机与障碍物之间的数据融合方法 | |
CN110597297A (zh) | 一种飞行器返航控制方法、装置、飞行器和存储介质 | |
CN106647785B (zh) | 无人机停机坪控制方法及装置 | |
CN110567493B (zh) | 一种磁力计校准数据采集方法、装置以及飞行器 | |
CN108051003B (zh) | 一种人员位姿监测方法和*** | |
CN107624096B (zh) | 一种基于飞行器的功能控制方法及装置 | |
CN110568859B (zh) | 无人机控制方法、移动终端及计算机可读存储介质 | |
CN111279399B (zh) | 可飞行设备及其控制方法、***和计算机可读存储介质 | |
CN108459619B (zh) | 无人机落地加锁方法、装置、飞行控制***及遥控器 | |
CN112256058A (zh) | 一种定高触地确定方法、装置、设备及存储介质 | |
WO2023243376A1 (ja) | 情報処理装置及び情報処理方法 |
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 | ||
CB02 | Change of applicant information |
Address after: 518055 Guangdong city of Shenzhen province Nanshan District Xili Street Xueyuan Road No. 1001 Chi Yuen Building 9 layer B1 Applicant after: Shenzhen daotong intelligent Aviation Technology Co.,Ltd. Address before: 518055 Guangdong city of Shenzhen province Nanshan District Xili Street Xueyuan Road No. 1001 Chi Yuen Building 9 layer B1 Applicant before: AUTEL ROBOTICS Co.,Ltd. |
|
CB02 | Change of applicant information | ||
GR01 | Patent grant | ||
GR01 | Patent grant |