飞行器控制方法及飞行器的制造方法
【技术领域】
[0001] 本发明涉及航空航天、无人机技术领域,尤其涉及一种飞行器控制方法及飞行器。
【背景技术】
[0002] 飞行器(比如无人直升机)上通常采用指南针来判断航向,当指南针失效或异常 后,飞行器将无法判断航向。但是,现有技术中,在指南针失效或异常后,无法实现对飞行器 的有效控制和保护,导致飞行器失常。
【发明内容】
[0003] 本发明的主要目的在于提出一种飞行器控制方法及飞行器,在指南针失效或异常 时,能够实现对飞行器的有效控制和保护,提高飞行器的飞行安全性。
[0004] 为实现上述目的,本发明提供的一种飞行器控制方法,包括:
[0005] 监测飞行器上指南针的测试值;
[0006] 根据监测到的指南针的测试值,判断指南针是否异常或失效;
[0007] 当所述指南针异常或失效时,以预设保护措施对所述飞行器进行保护控制。
[0008] 优选地,所述根据监测到的指南针的测试值,判断指南针是否异常或失效的步骤 包括:
[0009] 若监测到所述指南针无测试值,则判断所述指南针失效;或者
[0010] 若监测到所述指南针的测试数据无变化或在预定时间内产生突变,则判断所述指 南针异常。
[0011] 优选地,所述当所述指南针异常或失效时,以预设保护措施对所述飞行器进行保 护控制的步骤包括:
[0012] 当所述指南针异常或失效时,关闭所述指南针的数据接口,并检测GPS是否正常;
[0013] 若GPS正常,则读取GPS所采集的位置信息,根据所述GPS所采集的位置信息保持 飞行器当前的偏航角不变,进入自学习模式,控制飞行器降落到HOME点;
[0014] 若GPS异常或失效,则按照GPS异常或失效对应的保护措施,对所述飞行器进行保 护控制。
[0015] 优选地,所述进入自学习模式,控制飞行器降落到HOME点的步骤包括:
[0016] 在第一时间段中,控制所述飞行器朝向第一方向飞行预设距离,并实时判断当前 点位置与HOME点位置的距离,若该距离越来越远,则:
[0017] 在第二时间段中,控制飞行器朝向第二方向飞行预设距离,在实时判断当前点位 置与HOME点位置的距离越来越近时,控制飞行器继续该朝向的飞行,直到判断当前点位置 与HOME点位置的距离越来越远时,则控制飞行器停止该朝向的飞行;所述第二方向与所述 第一方向相对;
[0018] 在第三时间段中,控制飞行器朝向第三方向飞行预设距离,并实时判断当前点位 置与HOME点位置的距离,若该距离越来越远,则:
[0019] 在第四时间段中,控制飞行器朝向第四方向飞行预设距离,在实时判断当前点位 置与HOME点位置的距离越来越近时,控制飞行器继续该朝向的飞行,直到判断当前点位置 与HOME点位置的距离越来越远时,则控制飞行器停止该朝向的飞行;所述第三方向与第一 方向垂直,所述第四方向与所述第三方向相对;
[0020] 在第五时间段中,控制飞行器垂直降落到HOME点;
[0021] 若在所述第一时间段中,判断当前点位置与HOME点位置的距离越来越近,则:
[0022] 控制飞行器继续该朝向的飞行,直到判断当前点位置与HOME点位置的距离越来 越远时,则控制飞行器停止该朝向的飞行;
[0023] 进入所述第三时间段,若在第三时间段中,当前点位置与HOME点位置的距离越来 越近,则:
[0024] 控制飞行器继续该朝向的飞行,直到判断当前点位置与HOME点位置的距离越来 越远时,则控制飞行器停止该朝向的飞行,并进入第五时间段。
[0025] 优选地,所述第一方向为朝向机头的方向、朝向机尾的方向、朝向机身的左侧方向 或者朝向机身的右侧方向。
[0026] 优选地,所述若GPS异常或失效,则按照GPS异常或失效对应的保护措施,对所述 飞行器进行保护控制的步骤包括:
[0027] 若GPS异常或失效,则控制飞行器进行悬停或原地降落,并通知所述飞行器的控 制终端,将所述GPS对所述飞行器的最后一次测试值发送至所述控制终端;拍摄所述飞行 器的当前环境照片并传输至控制终端,用于辅助控制终端判断飞行器所在位置;以及将飞 行器切换到混合控制模式。
[0028] 本发明实施例还提出一种飞行器,包括:
[0029] 监测模块,用于监测飞行器上指南针的测试值;
[0030] 判断模块,用于根据监测到的指南针的测试值,判断指南针是否异常或失效;
[0031] 控制模块,用于当所述指南针异常或失效时,以预设保护措施对所述飞行器进行 保护控制。
[0032] 优选地,所述判断模块,还用于若监测到所述指南针无测试值,则判断所述指南针 失效;或者若监测到所述指南针的测试数据无变化或在预定时间内产生突变,则判断所述 指南针异常。
[0033] 优选地,所述控制模块,还用于当所述指南针异常或失效时,关闭所述指南针的数 据接口,并检测GPS是否正常;若GPS正常,则读取GPS所采集的位置信息,根据所述GPS所 采集的位置信息保持飞行器当前的偏航角不变,进入自学习模式,控制飞行器降落到HOME 点;若GPS异常或失效,则按照GPS异常或失效对应的保护措施,对所述飞行器进行保护控 制。
[0034] 优选地,所述控制模块,还用于在所述自学习模式下,在第一时间段中,控制所述 飞行器朝向第一方向飞行预设距离,并实时判断当前点位置与HOME点位置的距离,若该距 离越来越远,则:
[0035] 在第二时间段中,控制飞行器朝向第二方向飞行预设距离,在实时判断当前点位 置与HOME点位置的距离越来越近时,控制飞行器继续该朝向的飞行,直到判断当前点位置 与HOME点位置的距离越来越远时,则控制飞行器停止该朝向的飞行;所述第二方向与所述 第一方向相对;
[0036] 在第三时间段中,控制飞行器朝向第三方向飞行预设距离,并实时判断当前点位 置与HOME点位置的距离,若该距离越来越远,则:
[0037] 在第四时间段中,控制飞行器朝向第四方向飞行预设距离,在实时判断当前点位 置与HOME点位置的距离越来越近时,控制飞行器继续该朝向的飞行,直到判断当前点位置 与HOME点位置的距离越来越远时,则控制飞行器停止该朝向的飞行;所述第三方向与第一 方向垂直,所述第四方向与所述第三方向相对;
[0038] 在第五时间段中,控制飞行器垂直降落到HOME点;以及
[0039] 所述控制模块,还用于若在所述第一时间段中,判断当前点位置与HOME点位置的 距离越来越近,则:控制飞行器继续该朝向的飞行,直到判断当前点位置与HOME点位置的 距离越来越远时,则控制飞行器停止该朝向的飞行;进入所述第三时间段,若在第三时间段 中,当前点位置与HOME点位置的距离越来越近,则:控制飞行器继续该朝向的飞行,直到判 断当前点位置与HOME点位置的距离越来越远时,则控制飞行器停止该朝向的飞行,并进入 第五时间段。
[0040] 优选地,所述控制模块,还用于若GPS异常或失效,则控制飞行器进行悬停或原地 降落,并通知所述飞行器的控制终端,将所述GPS对所述飞行器的最后一次测试值发送至 所述控制终端;拍摄所述飞行器的当前环境照片并传输至控制终端,用于辅助控制终端判 断飞行器所在位置;以及将飞行器切换到混合控制模式。
[0041] 本发明提出的一种飞行器控制方法及飞行器,通过监测飞行器上指南针的测试 值;根据监测到的指南针的测试值,判断指南针是否异常或失效;当指南针异常或失效时, 以预设保护措施对飞行器进行保护控制,比如检测GPS是否正常、控制飞行器进行悬停或 原地降落以及将飞行器切换到混合控制模式等,从而实现对飞行器的有效控制和保护,提 高飞行器的飞行安全性。
【附图说明】
[0042] 图1是本发明飞行器控制方法较佳实施例的流程示意图;
[0043] 图2是本发明飞行器较佳实施例的功能模块示意图。
[0044] 本发明目的的实现、功能特点及优点将结合实施例,参照附图做进一步说明。
【具体实施方式】
[0045] 应当理解,此处所描述的具体实施例仅仅用以解释本发明,并不用于限定本发明。
[0046] 本发明实施例的主要解决方案是:通过监测飞行器上指南针的测试值;根据监测 到的指南针的测试值,判断指南针是否异常或失效;当指南针异常或失效时,以预设保护措 施对飞行器进行保护控制,比如检测GPS是否正常、控制飞行器进行悬停或原地降落以及 将飞行器切换到混合控制模式等,从而实现对飞行器的有效控制和保护,提高飞行器的飞 行安全性。
[0047] 本发明实施例考虑到:现有技术中,当指南针异常或失效时,无法实现对飞行器的 有效控制和保护,导致飞行器失常。
[0048] 本发明实施例方案可以通过监测飞行器上指南针的测试值,判断指南针是否异常 或失效;当指南针异常或失效时,以预设保护措施对飞行器进行保护控制,比如检测GPS是 否正常,若GPS正常,则读取GPS所采集的位置信息,控制飞行器降落到HOME点;若GPS异 常或失效,则按照GPS异常或失效对应的保护措施,对飞行器进行保护控制,比如控制飞行 器进行悬停或原地降落以及将飞行器切换到混合控制模式等,从而实现对飞行器的有效控 制和保护。
[0049] 具体地,如图1所示,本发明较佳实施例提出一种飞行器控制方法,包括:
[0050] 步骤S101,监测飞行器上指南针的测试值;
[0051] 首先,监测飞行器上指南针的测量数据,以便根据监测到的指南针的测试值判断 指南针是否异常或失效。
[0052] 步骤S102,根据监测到的指南针的测试值,判断指南针是否异常或失效;
[0053] 其中,作为一种实现方式,判断指南针是否异常或失效可以采用如下方案:
[0054] 实时或定期监测指南针的状态,若监测到指南针无测试数据,则判断指南针失 效;若监测到指南针的测试数据无变化或在预定时间内产生突变(即在预定时间内变化很 大),则判断指南针异常。
[0055] 步骤S103,当所述指南针异常或失效时,以预设保护措施对所述飞行器进行保护 控制。
[0056] 具体地,当判断指南针异常或失效时,关闭指南针的数据接口,并检测GPS是否正 常。GPS是否正常包括GPS是否失效或异常。
[0057] 其中,作为一种实现方式,判断GPS是否失效可以采用如下方案:
[0058] 实时或定期监测GPS的测试值,根据监测到的GPS的测试值,判断GPS是否以预定 频率进行数据更新,若不是,则判定GPS失效。
[0059] 比如,GPS的数据更新频率设定是1秒钟5次,如果1秒钟后GPS还没有数据更新, 那就判断GPS失效,因为即使飞行器在悬停状态下,正常情况下GPS也会有数据更新。
[0060] 作为另一种实现方式,判断GPS是否失效还可以采用如下方案:
[0061] 设μ为GPS失效门限,Κ、δ 1、δ 2分别为GPS的收星颗数、定位误差、测速误差, 若K彡4,且μ,则判断GPS正常工作,反之则认为GPS失效。 〇16ζ
[0062] 其中,作为一种实现方式,判断GPS是否异常可以采用如下方案:
[0063] 实时或定期监测GPS的测试值,根据监测到的GPS的测试值,判断GPS是否产生数 据突变,若是,则丢弃突变数据;若GPS的数据持续预设时间被丢弃,则判断GPS异常。
[0064] 其中,GPS数据突变的判断方法可以采用如下方案:
[0065] 前后两次GPS数据的差值H4-H3>Vmax*T2+1GPS误差I,则判断GPS的数据突变。
[0066] 其中,Vmax为飞行器高度方向最大速度,T2为GPS数据更新周期。
[0067] 在判断GPS正常时,读取GPS所采集的测量位置信息,根据GPS所采集的位置信息 保持飞行器当前的偏航角不变,进入自学习模式,控制飞行器降落到HOME点。
[0068] 若GPS异常或失效,则按照GPS异常或失效对应的保护措施,对飞行器进行保护控 制。
[0069] 更为具体地,作为一种实施方式,在自学习模式下,控制飞行器降落到HOME点的 过程可以如下:
[0070] 保持飞行器当前的偏航角不变,进入自学习模式:
[0071] 在第一时间段中,控制所述飞行器朝向第一方向飞行预设距离,并实时判断当前 点位置与HOME点位置的距离,若该距离越来越远,则:
[0072] 在第二时间段中,控制飞行器朝向第二方向飞行预设距离,在实时判断当前点位 置与HOME点位置的距离越来越近时,控制飞行器继续该朝向的飞行,直到判断当前点位置 与HOME点位置的距离越来越远时,则控制飞行器停止该朝向的飞行;其中,第二方向与第 一方向相对;
[0073] 在第三时间段中,控制飞行器朝向第三方向飞行预设距离,并实时判断当前点位 置与HOME点位置的距离,若该距离越来越远,则:
[0074] 在第四时间段中,控制飞行器朝向第四方向飞行预设距离,在实时判断当前点位 置与HOME点位置的距离越来越近时,控制飞行器继续该朝向的飞行,直到判断当前点位置 与HOME点位置的距离越来越远时,则控制飞行器停止该朝向的飞行;其中,第三方向与第 一方向垂直,第四方向与第三方向相对;
[0075] 在第五时间段中,控制飞行器垂直降落到HOME点。
[0076] 上述过程中,在第一时间段中,若控制飞行器朝向第一方向飞行预设距离,并实时 判断当前点位置与HOME点位置的距离越来越近时,则:
[0077] 控制飞行器继续该朝向的飞行,直到判断当前点位置与HOME点位置的距离越来 越远时,则控制飞行器停止该朝向的飞行;
[0078] 进入所述第三时间段,若在第三时间段中,当前点位置与HOME点位置的距离越来 越近,则:
[0079] 控制飞行器继续该朝向的飞行,直到判断当前点位置与HOME点位置的距离越来 越远时,则控制飞行器停止该朝向的飞行,并进入第五时间段。
[0080] 需要说明的是,上述第一方向、第二方向、第三方向和第四方向可以选定飞行器的 机头、机尾和机身两侧作为相应的参考基准,并根据需要进行组合,比如:第一方向为朝向 机头的方向,第二方向为朝向机尾的方向,第三方向为朝向机身的左侧方向、第四方向为朝 向机身的右侧方向;或者,第一方向为朝向机尾的方向、第二方向为朝向机头的方向、第三 方向为朝向机身的右侧方向、第四方向为朝向机身的左侧方向;或者,第一方向为朝向机身 的左侧方向、第二方向为朝向机身的右侧方向、第三方向为朝向机头的方向,第四方向为朝 向机尾的方向,等等,只要满足:第二方向与第一方向相对;第三方向与第一方向或第二方 向垂直,第四方向与第三方向相对即可。
[0081 ] 因此,第一方向可以选择朝向机头的方向、朝向机尾的方向、朝向机身的左侧方向 或者朝向机身的右侧方向,其他三个方向则可以根据实际情况进行选择。
[0082] 下面以第一方向为朝向机头的方向、第二方向为朝向机尾的方向、第三方向为朝 向机身的左侧方向、第四方向为朝向机身的右侧方向为例,对飞行器自学习模式下的控制 过程描述如下:
[0083] 在第一时间段中,控制飞行器朝向机头的方向飞行预设距离,并实时判断当前点 位置与HOME点位置的距离,若该距离越来越远,则:
[0084] 在第二时间段中,控制飞行器朝向机尾的方向飞行预设距离,在实时判断当前点 位置与home点位置的距离越来越近时,控制飞行器继续该朝向的飞行,直到判断当前点位 置与HOME点位置的距离越来越远时,则控制飞行器停止该朝向的飞行;然后进入第三时间 段;
[0085] 在第三时间段中,控制飞行器朝向机身的左侧方向飞行预设距离,并实时判断当 前点位置与HOME点位置的距离,若该距离越来越远,则进入第四时间段;
[0086] 在第四时间段中,控制飞行器朝向机身的右侧方向飞行预设距离,在实时判断当 前点位置与HOME点位置的距离越来越近时,控制飞行器继续该朝向的飞行,直到判断当前 点位置与HOME点位置的距离越来越远时,则控制飞行器停止该朝向的飞行,进入第五时间 段;
[0087] 在第五时间段中,控制飞行器垂直降落到HOME点。
[0088] 上述过程中,在第一时间段中,若控制飞行器朝向机头的方向飞行预设距离,并实 时判断当前点位置与HOME点位置的距离越来越近,则:
[0089] 控制飞行器继续该朝向的飞行,直到判断当前点位置与HOME点位置的距离越来 越远时,则控制飞行器停止该朝向的飞行;进入所述第三时间段,若在第三时间段中,当前 点位置与HOME点位置的距离越来越近,则:控制飞行器继续该朝向的飞行,直到判断当前 点位置与HOME点位置的距离越来越远时,则控制飞行器停止该朝向的飞行,并进入第五时 间段,在第五时间段中,控制飞行器垂直降落。
[0090] 作为一种实施方式,若GPS异常或失效,则按照GPS异常或失效对应的保护措施, 对所述飞行器进行保护控制的过程可以如下:
[0091] 若GPS异常或失效,则控制飞行器进行悬停或原地降落,并通知飞行器的控制终 端,将GPS对飞行器的最后一次测试值发送至控制终端。
[0092] 其中,在控制飞行器进行悬停或原地降落时,具体采用如下方案:
[0093] 若GPS异常或失效,则判断飞行器的电量是否达到原地降落的极限电量(此时可 以通过飞行器上的气压计检测高度以供判断),若是,则执行原地降落的操作,否则进行悬 停。
[0094] 进一步地,在GPS异常或失效时,对飞行器进行保护控制方案中还可以包括如下 方案:
[0095] 拍摄飞行器的当前环境照片并传输至控制终端,用于辅助控制终端判断飞行器所 在位置。
[0096] 另外,在GPS异常或失效时,无论飞行器是否在操控手的可视范围内,飞行器都将 切换到混合控制模式,其中,混合控制模式是指既可手动控制,也能自动飞行,但手动控制 的命令优先级别可以高于自动飞行的指令。
[0097] 因此,若飞行器在操控手的可视范围内,可以由操控手对飞行器进行控制。当然 也可以在进入第五时间段之前,以小于第一预设距离的第二预设距离飞行以无限接近HOME 点,类似显微镜的先粗调后微调原理。
[0098] 本实施例通过上述方案,通过监测飞行器上指南针的测试值;根据监测到的指南 针的测试值,判断指南针是否异常或失效;当指南针异常或失效时,以预设保护措施对飞行 器进行保护控制,比如检测GPS是否正常、控制飞行器进行悬停或原地降落以及将飞行器 切换到混合控制模式等,从而实现对飞行器的有效控制和保护,提高飞行器的飞行安全性。
[0099] 对应地,提出本发明飞行器实施例。
[0100] 如图2所示,本发明较佳实施例提出一种飞行器,包括:监测模块201、判断模块 202及控制模块203,其中:
[0101] 监测模块201,用于监测飞行器上指南针的测试值;
[0102] 判断模块202,用于根据监测到的指南针的测试值,判断指南针是否异常或失效;
[0103] 控制模块203,用于当所述指南针异常或失效时,以预设保护措施对所述飞行器进 行保护控制。
[0104] 进一步地,所述判
断模块202,还用于若监测到所述指南针无测试值,则判断所述 指南针失效;或者若监测到所述指南针的测试数据无变化或在预定时间内产生突变,则判 断所述指南针异常。
[0105] 进一步地,所述控制模块203,还用于当所述指南针异常或失效时,关闭所述指南 针的数据接口,并检测GPS是否正常;若GPS正常,则读取GPS所采集的位置信息,根据所述 GPS所采集的位置信息保持飞行器当前的偏航角不变,进入自学习模式,控制飞行器降落到 HOME点;若GPS异常或失效,则按照GPS异常或失效对应的保护措施,对所述飞行器进行保 护控制。
[0106] 进一步地,所述控制模块203,还用于在所述自学习模式下,在第一时间段中,控制 所述飞行器朝向第一方向飞行预设距离,并实时判断当前点位置与HOME点位置的距离,若 该距离越来越远,则:
[0107] 在第二时间段中,控制飞行器朝向第二方向飞行预设距离,在实时判断当前点位 置与HOME点位置的距离越来越近时,控制飞行器继续该朝向的飞行,直到判断当前点位置 与HOME点位置的距离越来越远时,则控制飞行器停止该朝向的飞行;其中,第二方向与第 一方向相对;
[0108] 在第三时间段中,控制飞行器朝向第三方向飞行预设距离,并实时判断当前点位 置与HOME点位置的距离,若该距离越来越远,则:
[0109] 在第四时间段中,控制飞行器朝向第四方向飞行预设距离,在实时判断当前点位 置与HOME点位置的距离越来越近时,控制飞行器继续该朝向的飞行,直到判断当前点位置 与HOME点位置的距离越来越远时,则控制飞行器停止该朝向的飞行;其中,第三方向与第 一方向垂直,第四方向与所述第三方向相对;
[0110] 在第五时间段中,控制飞行器垂直降落到HOME点。
[0111] 进一步地,所述控制模块203还用于若在所述第一时间段中,判断当前点位置与 HOME点位置的距离越来越近,则:控制飞行器继续该朝向的飞行,直到判断当前点位置与 HOME点位置的距离越来越远时,则控制飞行器停止该朝向的飞行;进入所述第三时间段, 若在第三时间段中,当前点位置与HOME点位置的距离越来越近,则:控制飞行器继续该朝 向的飞行,直到判断当前点位置与HOME点位置的距离越来越远时,则控制飞行器停止该朝 向的飞行,并进入第五时间段。
[0112] 进一步地,所述控制模块203还用于若GPS异常或失效,则控制飞行器进行悬停或 原地降落,并通知所述飞行器的控制终端,将所述GPS对所述飞行器的最后一次测试值发 送至所述控制终端;拍摄所述飞行器的当前环境照片并传输至控制终端,用于辅助控制终 端判断飞行器所在位置;以及将飞行器切换到混合控制模式。
[0113] 具体地,首先,监测飞行器上指南针的测量数据,以便根据监测到的指南针的测试 值判断指南针是否异常或失效。
[0114] 其中,作为一种实现方式,判断指南针是否异常或失效可以采用如下方案:
[0115] 实时或定期监测指南针的状态,若监测到指南针无测试数据,则判断指南针失 效;若监测到指南针的测试数据无变化或在预定时间内产生突变(即在预定时间内变化很 大),则判断指南针异常。
[0116] 当判断指南针异常或失效时,关闭指南针的数据接口,并检测GPS是否正常。GPS 是否正常包括GPS是否失效或异常。
[0117] 其中,作为一种实现方式,判断GPS是否失效可以采用如下方案:
[0118] 实时或定期监测GPS的测试值,根据监测到的GPS的测试值,判断GPS是否以预定 频率进行数据更新,若不是,则判定GPS失效。
[0119] 比如,GPS的数据更新频率设定是1秒钟5次,如果1秒钟后GPS还没有数据更新, 那就判断GPS失效,因为即使飞行器在悬停状态下,正常情况下GPS也会有数据更新。
[0120] 作为另一种实现方式,判断GPS是否失效还可以采用如下方案:
[0121] 设μ为GPS失效门限,Κ、δ 1、δ 2分别为GPS的收星颗数、定位误差、测速误差, 若K彡4,且μ,则判断GPS正常工作,反之则认为GPS失效。 6162
[0122] 其中,作为一种实现方式,判断GPS是否异常可以采用如下方案:
[0123] 实时或定期监测GPS的测试值,根据监测到的GPS的测试值,判断GPS是否产生数 据突变,若是,则丢弃突变数据;若GPS的数据持续预设时间被丢弃,则判断GPS异常。
[0124] 其中,GPS数据突变的判断方法可以采用如下方案:
[0125] 前后两次GPS数据的差值H4-H3>Vmax*T2+1GPS误差I,则判断GPS的数据突变。
[0126] 其中,Vmax为飞行器高度方向最大速度,T2为GPS数据更新周期。
[0127] 在判断GPS正常时,读取GPS所采集的测量位置信息,根据GPS所采集的位置信息 保持飞行器当前的偏航角不变,进入自学习模式,控制飞行器降落到HOME点。
[0128] 若GPS异常或失效,则按照GPS异常或失效对应的保护措施,对飞行器进行保护控 制。
[0129] 更为具体地,作为一种实施方式,在自学习模式下,控制飞行器降落到HOME点的 过程可以如下:
[0130] 保持飞行器当前的偏航角不变,进入自学习模式:
[0131] 在第一时间段中,控制所述飞行器朝向第一方向飞行预设距离,并实时判断当前 点位置与HOME点位置的距离,若该距离越来越远,则:
[0132] 在第二时间段中,控制飞行器朝向第二方向飞行预设距离,在实时判断当前点位 置与HOME点位置的距离越来越近时,控制飞行器继续该朝向的飞行,直到判断当前点位置 与HOME点位置的距离越来越远时,则控制飞行器停止该朝向的飞行;其中,第二方向与第 一方向相对;
[0133] 在第三时间段中,控制飞行器朝向第三方向飞行预设距离,并实时判断当前点位 置与HOME点位置的距离,若该距离越来越远,则:
[0134] 在第四时间段中,控制飞行器朝向第四方向飞行预设距离,在实时判断当前点位 置与HOME点位置的距离越来越近时,控制飞行器继续该朝向的飞行,直到判断当前点位置 与HOME点位置的距离越来越远时,则控制飞行器停止该朝向的飞行;其中,第三方向与第 一方向垂直,第四方向与第三方向相对;
[0135] 在第五时间段中,控制飞行器垂直降落到HOME点。
[0136] 上述过程中,在第一时间段中,若控制飞行器朝向第一方向飞行预设距离,并实时 判断当前点位置与HOME点位置的距离越来越近时,则:
[0137] 控制飞行器继续该朝向的飞行,直到判断当前点位置与HOME点位置的距离越来 越远时,则控制飞行器停止该朝向的飞行;
[0138] 进入所述第三时间段,若在第三时间段中,当前点位置与HOME点位置的距离越来 越近,则:
[0139] 控制飞行器继续该朝向的飞行,直到判断当前点位置与HOME点位置的距离越来 越远时,则控制飞行器停止该朝向的飞行,并进入第五时间段。
[0140] 需要说明的是,上述第一方向、第二方向、第三方向和第四方向可以选定飞行器的 机头、机尾和机身两侧作为相应的参考基准,并根据需要进行组合,比如:第一方向为朝向 机头的方向,第二方向为朝向机尾的方向,第三方向为朝向机身的左侧方向、第四方向为朝 向机身的右侧方向;或者,第一方向为朝向机尾的方向、第二方向为朝向机头的方向、第三 方向为朝向机身的右侧方向、第四方向为朝向机身的左侧方向;或者,第一方向为朝向机身 的左侧方向、第二方向为朝向机身的右侧方向、第三方向为朝向机头的方向,第四方向为朝 向机尾的方向,等等,只要满足:第二方向与第一方向相对;第三方向与第一方向或第二方 向垂直,第四方向与第三方向相对即可。
[0141] 因此,第一方向可以选择朝向机头的方向、朝向机尾的方向、朝向机身的左侧方向 或者朝向机身的右侧方向,其他三个方向则可以根据实际情况进行选择。
[0142] 下面以第一方向为朝向机头的方向、第二方向为朝向机尾的方向、第三方向为朝 向机身的左侧方向、第四方向为朝向机身的右侧方向为例,对飞行器自学习模式下的控制 过程描述如下:
[0143] 在第一时间段中,控制飞行器朝向机头的方向飞行预设距离,并实时判断当前点 位置与HOME点位置的距离,若该距离越来越远,则:
[0144] 在第二时间段中,控制飞行器朝向机尾的方向飞行预设距离,在实时判断当前点 位置与HOME点位置的距离越来越近时,继续该朝向的飞行,直到判断当前点位置与HOME点 位置的距离越来越远时,则停止该朝向的飞行;然后进入第三时间段;
[0145] 在第三时间段中,朝向机身的左侧方向飞行预设距离,并实时判断当前点位置与 HOME点位置的距离,若该距离越来越远,则进入第四时间段;
[0146] 在第四时间段中,朝向机身的右侧方向飞行预设距离,在实时判断当前点位置与 HOME点位置的距离越来越近时,继续该朝向的飞行,直到判断当前点位置与HOME点位置的 距离越来越远时,则停止该朝向的飞行,进入第五时间段;
[0147] 在第五时间段中,垂直降落到HOME点。
[0148] 上述过程中,在第一时间段中,若控制飞行器朝向机头的方向飞行预设距离,并实 时判断当前点位置与HOME点位置的距离越来越近,则:
[0149] 继续该朝向的飞行,直到判断当前点位置与HOME点位置的距离越来越远时,则停 止该朝向的飞行;进入所述第三时间段,若在第三时间段中,当前点位置与HOME点位置的 距离越来越近,则:继续该朝向的飞行,直到判断当前点位置与HOME点位置的距离越来越 远时,则停止该朝向的飞行,并进
入第五时间段,在第五时间段中,垂直降落到HOME点。
[0150] 作为一种实施方式,若GPS异常或失效,则按照GPS异常或失效对应的保护措施, 对所述飞行器进行保护控制的过程可以如下:
[0151] 若GPS异常或失效,则控制飞行器进行悬停或原地降落,并通知飞行器的控制终 端,将GPS对飞行器的最后一次测试值发送至控制终端。
[0152] 其中,在控制飞行器进行悬停或原地降落时,具体采用如下方案:
[0153] 若GPS异常或失效,则判断飞行器的电量是否达到原地降落的极限电量(此时可 以通过飞行器上的气压计检测高度以供判断),若是,则执行原地降落的操作,否则进行悬 停。
[0154] 进一步地,在GPS异常或失效时,对飞行器进行保护控制方案中还可以包括如下 方案:
[0155] 拍摄飞行器的当前环境照片并传输至控制终端,用于辅助控制终端判断飞行器所 在位置。
[0156] 另外,在GPS异常或失效时,无论飞行器是否在操控手的可视范围内,飞行器都将 切换到混合控制模式,其中,混合控制模式是指既可手动控制,也能自动飞行,但手动控制 的命令优先级别可以高于自动飞行的指令。
[0157] 因此,若飞行器在操控手的可视范围内,可以由操控手对飞行器进行控制。当然 也可以在进入第五时间段之前,以小于第一预设距离的第二预设距离飞行以无限接近HOME 点,类似显微镜的先粗调后微调原理。
[0158] 本实施例通过上述方案,通过监测飞行器上指南针的测试值;根据监测到的指南 针的测试值,判断指南针是否异常或失效;当指南针异常或失效时,以预设保护措施对飞行 器进行保护控制,比如检测GPS是否正常、控制飞行器进行悬停或原地降落以及将飞行器 切换到混合控制模式等,从而实现对飞行器的有效控制和保护,提高飞行器的飞行安全性。
[0159] 需要说明的是,在本文中,术语"包括"、"包含"或者其任何其他变体意在涵盖非排 他性的包含,从而使得包括一系列要素的过程、方法、物品或者装置不仅包括那些要素,而 且还包括没有明确列出的其他要素,或者是还包括为这种过程、方法、物品或者装置所固有 的要素。在没有更多限制的情况下,由语句"包括一个……"限定的要素,并不排除在包括 该要素的过程、方法、物品或者装置中还存在另外的相同要素。
[0160] 上述本发明实施例序号仅仅为了描述,不代表实施例的优劣。
[0161] 通过以上的实施方式的描述,本领域的技术人员可以清楚地了解到上述实施例方 法可借助软件加必需的通用硬件平台的方式来实现,当然也可以通过硬件,但很多情况下 前者是更佳的实施方式。基于这样的理解,本发明的技术方案本质上或者说对现有技术做 出贡献的部分可以以软件产品的形式体现出来,该计算机软件产品存储在一个存储介质 (如R0M/RAM、磁碟、光盘)中,包括若干指令用以使得一台终端设备(可以是手机,计算机, 服务器,空调器,或者网络设备等)执行本发明各个实施例所述的方法。
[0162] 以上仅为本发明的优选实施例,并非因此限制本发明的专利范围,凡是利用本发 明说明书及附图内容所作的等效结构或等效流程变换,或直接或间接运用在其他相关的技 术领域,均同理包括在本发明的专利保护范围内。
【主权项】
1. 一种飞行器控制方法,其特征在于,包括: 监测飞行器上指南针的测试值; 根据监测到的指南针的测试值,判断指南针是否异常或失效; 当所述指南针异常或失效时,以预设保护措施对所述飞行器进行保护控制。2. 根据权利要求1所述的方法,其特征在于,所述根据监测到的指南针的测试值,判断 指南针是否异常或失效的步骤包括: 若监测到所述指南针无测试值,则判断所述指南针失效;或者 若监测到所述指南针的测试数据无变化或在预定时间内产生突变,则判断所述指南针 异常。3. 根据权利要求1所述的方法,其特征在于,所述当所述指南针异常或失效时,以预设 保护措施对所述飞行器进行保护控制的步骤包括: 当所述指南针异常或失效时,关闭所述指南针的数据接口,并检测GPS是否正常; 若GPS正常,则读取GPS所采集的位置信息,根据所述GPS所采集的位置信息保持飞行 器当前的偏航角不变,进入自学习模式,控制飞行器降落到HOME点; 若GPS异常或失效,则按照GPS异常或失效对应的保护措施,对所述飞行器进行保护控 制。4. 根据权利要求3所述的方法,其特征在于,所述进入自学习模式,控制飞行器降落到 HOME点的步骤包括: 在第一时间段中,控制所述飞行器朝向第一方向飞行预设距离,并实时判断当前点位 置与HOME点位置的距离,若该距离越来越远,则: 在第二时间段中,控制飞行器朝向第二方向飞行预设距离,在实时判断当前点位置与HOME点位置的距离越来越近时,控制飞行器继续该朝向的飞行,直到判断当前点位置与 HOME点位置的距离越来越远时,则控制飞行器停止该朝向的飞行;所述第二方向与所述第 一方向相对; 在第三时间段中,控制飞行器朝向第三方向飞行预设距离,并实时判断当前点位置与HOME点位置的距离,若该距离越来越远,则: 在第四时间段中,控制飞行器朝向第四方向飞行预设距离,在实时判断当前点位置与HOME点位置的距离越来越近时,控制飞行器继续该朝向的飞行,直到判断当前点位置与 HOME点位置的距离越来越远时,则控制飞行器停止该朝向的飞行;所述第三方向与第一方 向垂直,所述第四方向与所述第三方向相对; 在第五时间段中,控制飞行器垂直降落到HOME点; 若在所述第一时间段中,判断当前点位置与HOME点位置的距离越来越近,则: 控制飞行器继续该朝向的飞行,直到判断当前点位置与HOME点位置的距离越来越远 时,则控制飞行器停止该朝向的飞行; 进入所述第三时间段,若在第三时间段中,当前点位置与HOME点位置的距离越来越 近,则: 控制飞行器继续该朝向的飞行,直到判断当前点位置与HOME点位置的距离越来越远 时,则控制飞行器停止该朝向的飞行,并进入第五时间段。5. 根据权利要求4所述的方法,其特征在于,所述第一方向为朝向机头的方向、朝向机 尾的方向、朝向机身的左侧方向或者朝向机身的右侧方向。6. 根据权利要求3、4或5所述的方法,其特征在于,所述若GPS异常或失效,则按照GPS 异常或失效对应的保护措施,对所述飞行器进行保护控制的步骤包括: 若GPS异常或失效,则控制飞行器进行悬停或原地降落,并通知所述飞行器的控制终 端,将所述GPS对所述飞行器的最后一次测试值发送至所述控制终端;拍摄所述飞行器的 当前环境照片并传输至控制终端,用于辅助控制终端判断飞行器所在位置;以及将飞行器 切换到混合控制模式。7. -种飞行器,其特征在于,包括: 监测模块,用于监测飞行器上指南针的测试值; 判断模块,用于根据监测到的指南针的测试值,判断指南针是否异常或失效; 控制模块,用于当所述指南针异常或失效时,以预设保护措施对所述飞行器进行保护 控制。8. 根据权利要求7所述的飞行器,其特征在于, 所述判断模块,还用于若监测到所述指南针无测试值,则判断所述指南针失效;或者若 监测到所述指南针的测试数据无变化或在预定时间内产生突变,则判断所述指南针异常。9. 根据权利要求7所述的飞行器,其特征在于, 所述控制模块,还用于当所述指南针异常或失效时,关闭所述指南针的数据接口,并检 测GPS是否正常;若GPS正常,则读取GPS所采集的位置信息,根据所述GPS所采集的位置 信息保持飞行器当前的偏航角不变,进入自学习模式,控制飞行器降落到HOME点;若GPS异 常或失效,则按照GPS异常或失效对应的保护措施,对所述飞行器进行保护控制。10. 根据权利要求9所述的飞行器,其特征在于, 所述控制模块,还用于在所述自学习模式下,在第一时间段中,控制所述飞行器朝向第 一方向飞行预设距离,并实时判断当前点位置与HOME点位置的距离,若该距离越来越远, 则: 在第二时间段中,控制飞行器朝向第二方向飞行预设距离,在实时判断当前点位置与HOME点位置的距离越来越近时,控制飞行器继续该朝向的飞行,直到判断当前点位置与 HOME点位置的距离越来越远时,则控制飞行器停止该朝向的飞行;所述第二方向与所述第 一方向相对; 在第三时间段中,控制飞行器朝向第三方向飞行预设距离,并实时判断当前点位置与HOME点位置的距离,若该距离越来越远,则: 在第四时间段中,控制飞行器朝向第四方向飞行预设距离,在实时判断当前点位置与HOME点位置的距离越来越近时,控制飞行器继续该朝向的飞行,直到判断当前点位置与 HOME点位置的距离越来越远时,则控制飞行器停止该朝向的飞行;所述第三方向与第一方 向垂直,所述第四方向与所述第三方向相对; 在第五时间段中,控制飞行器垂直降落到HOME点;以及 所述控制模块,还用于若在所述第一时间段中,判断当前点位置与HOME点位置的距离 越来越近,则:控制飞行器继续该朝向的飞行,直到判断当前点位置与HOME点位置的距离 越来越远时,则控制飞行器停止该朝向的飞行;进入所述第三时间段,若在第三时间段中, 当前点位置与HOME点位置的距离越来越近,则:控制飞行器继续该朝向的飞行,直到判断
【专利摘要】本发明公开了一种飞行器控制方法及飞行器,其方法包括:监测飞行器上指南针的测试值;根据监测到的指南针的测试值,判断指南针是否异常或失效;当指南针异常或失效时,以预设保护措施对所述飞行器进行保护控制。本发明实现了对飞行器的有效控制和保护,提高飞行器的飞行安全性。
【IPC分类】B64D45/00, B64D43/00
【公开号】CN104890889
【申请号】CN201510242360
【发明人】张显志
【申请人】深圳一电科技有限公司, 深圳一电航空技术有限公司, 深圳一电智能技术有限公司
【公开日】2015年9月9日
【申请日】2015年5月13日