- 专利标题: 基于约束卡尔曼滤波的集群组网协同导航方法及系统
-
申请号: CN202110361651.3申请日: 2021-04-02
-
公开(公告)号: CN113175931B公开(公告)日: 2022-08-16
- 发明人: 秦峰 , 宋振华 , 刘伟鹏 , 崔闪 , 李云龙 , 吴镇 , 李勇 , 袁杰波 , 韩琳 , 王晖辉
- 申请人: 上海机电工程研究所
- 申请人地址: 上海市闵行区元江路3888号(八部)
- 专利权人: 上海机电工程研究所
- 当前专利权人: 上海机电工程研究所
- 当前专利权人地址: 上海市闵行区元江路3888号(八部)
- 代理机构: 上海汉声知识产权代理有限公司
- 代理商 胡晶
- 主分类号: G01C21/20
- IPC分类号: G01C21/20 ; G01C21/16 ; G01C25/00
摘要:
本发明提供了一种基于约束卡尔曼滤波的集群组网协同导航方法及系统,涉及协同导航技术领域,该方法包括:步骤S1:确定集群组网节点数量,并测量各节点间的相对距离;步骤S2:基于测量的各节点间的相对距离,建立集群组网协同导航滤波方程;步骤S3:设计集群组网各节点惯导位置误差加权和最小约束条件;步骤S4:构建集群组网协同导航的约束卡尔曼滤波;步骤S5:利用约束卡尔曼滤波估计出的各节点惯导误差估计值对纯惯导误差补偿。本发明能够实时递推估计出惯导误差对惯导系统进行修正,抑制各个节点纯惯导误差发散。
公开/授权文献
- CN113175931A 基于约束卡尔曼滤波的集群组网协同导航方法及系统 公开/授权日:2021-07-27
IPC分类: