[发明专利]一种姿态监控方法、装置、存储介质及无人设备在审
申请号: | 202111461598.0 | 申请日: | 2021-12-02 |
公开(公告)号: | CN116225035A | 公开(公告)日: | 2023-06-06 |
发明(设计)人: | 张培磊;李熊;毛一年;续立军 | 申请(专利权)人: | 北京三快在线科技有限公司 |
主分类号: | G05D1/08 | 分类号: | G05D1/08;G05D1/10 |
代理公司: | 北京曼威知识产权代理有限公司 11709 | 代理人: | 方志炜 |
地址: | 100080 北京市海*** | 国省代码: | 北京;11 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | |||
搜索关键词: | 一种 姿态 监控 方法 装置 存储 介质 无人 设备 | ||
1.一种姿态监控方法,应用于无人设备,其特征在于,所述无人设备包括监控模块,其中
接收控制端向无人设备发送的控制指令,并确定所述控制指令中包含的目标姿态;根据所述无人设备自身采集的传感数据,确定所述无人设备的当前姿态;
将所述目标姿态以及所述当前姿态输入监控模块,以通过所述监控模根据所述目标姿态和/或所述当前姿态判断所述无人设备的姿态是否异常;通过所述监控模块中的自检模块判断所述监控模块自身是否存在异常;
当所述无人设备的姿态异常或者所述监控模块自身存在异常时,输出报警。
2.如权利要求1所述的方法,其特征在于,所述监控模块包括:第一监控模块;
通过所述监控模根据所述目标姿态和/或所述当前姿态判断所述无人设备的姿态是否异常,具体包括:
通过所述第一监控模块判断所述目标姿态是否在所述无人设备的标准姿态范围内,若所述目标姿态不在所述无人设备的标准姿态范围内,则确定所述无人设备的姿态异常。
3.如权利要求1所述的方法,其特征在于,所述监控模块包括:第二监控模块;
通过所述监控模根据所述目标姿态和/或所述当前姿态判断所述无人设备的姿态是否异常,具体包括:
通过所述第二监控模块,采用除确定所述当前姿态的解算方法以外的其它解算方法确定所述无人设备的姿态,作为对比姿态;
判断所述当前姿态与所述对比姿态之间的差异是否不大于第一指定阈值,若所述当前姿态与所述对比姿态之间的差异大于第一指定阈值,则确定所述无人设备的姿态异常。
4.如权利要求3所述的方法,其特征在于,确定所述当前姿态的解算方法和所述其它解算方法均包括:根据全球导航卫星系统GNSS航向进行解算、根据磁力计航向进行解算、根据地图数据进行解算以及通过GNNS航向、磁力计航向、地图数据形成航向冗余观测中的至少一种;其中,确定所述当前姿态的解算方法和所述其它解算方法为不同的方法。
5.如权利要求1所述的方法,其特征在于,所述监控模块包括:第三监控模块;
通过所述监控模根据所述目标姿态和/或所述当前姿态判断所述无人设备的姿态是否异常,具体包括:
通过所述第三监控模块判断所述目标姿态与所述当前姿态之间的差异是否不大于第二指定阈值,若所述目标姿态与所述当前姿态之间的差异大于第二指定阈值,则确定所述无人设备的姿态异常。
6.如权利要求2~5任一所述的方法,其特征在于,通过所述监控模块中的自检模块判断所述监控模块自身是否存在异常,具体包括:
通过所述监控模块中的自检模块判断,所述监控模块中除自检模块以外的其他模块对应的软件和/或硬件是否存在异常。
7.如权利要求1所述的方法,其特征在于,所述无人设备包括:无人机;
所述姿态包括:航向角、横滚角、俯仰角中的至少一种。
8.如权利要求1所述的方法,其特征在于,当所述无人设备的姿态异常或者所述监控模块自身存在异常时,输出报警,具体包括:
当所述无人设备的姿态异常或者所述监控模块自身存在异常时,根据所发生的异常确定对应的异常等级;
根据所述异常等级,确定与所述异常等级对应的报警等级;
根据所述报警等级输出报警。
9.一种姿态监控装置,其特征在于,包括:
确定模块,接收控制端向无人设备发送的控制指令,并确定所述控制指令中包含的目标姿态;根据所述无人设备自身采集的传感数据,确定所述无人设备的当前姿态;
判断模块,将所述目标姿态以及所述当前姿态输入监控模块,以通过所述监控模根据所述目标姿态和/或所述当前姿态判断所述无人设备的姿态是否异常;通过所述监控模块中的自检模块判断所述监控模块自身是否存在异常;
报警模块,当所述无人设备的姿态异常或者所述监控模块自身存在异常时,输出报警。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于北京三快在线科技有限公司,未经北京三快在线科技有限公司许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/pat/books/202111461598.0/1.html,转载请声明来源钻瓜专利网。