发明名称 一种改进GNSS/INS实时紧组合导航实时性能的方法
摘要 本发明公开了一种改进GNSS/INS实时紧组合导航实时性能的方法,包括(1)保存GNSS采样时刻k的预测误差协方差矩阵和机械编排解算的导航状态;(2)在时刻k时GNSS观测数据的接收时刻,采用Kalma滤波法进行组合更新解算,得时刻k的状态参数估计量<img file="DDA0000974312130000011.GIF" wi="49" he="62" />以及状态参数协方差估计量<img file="DDA0000974312130000012.GIF" wi="75" he="63" />(3)根据<img file="DDA0000974312130000013.GIF" wi="50" he="62" />和<img file="DDA0000974312130000014.GIF" wi="54" he="63" />估计组合更新解算完成时刻j的状态参数估计量<img file="DDA0000974312130000015.GIF" wi="75" he="70" />以及状态参数协方差估计量<img file="DDA0000974312130000016.GIF" wi="99" he="63" />(4)采用<img file="DDA0000974312130000018.GIF" wi="75" he="70" />以及<img file="DDA0000974312130000017.GIF" wi="78" he="62" />修正时刻j的惯导误差。本发明可降低GNSS数据延迟和组合解算耗时对实时导航输出的影响,可有效改善实时组合导航的实时性能,对组合导航算法在运算能力较低的处理器上的实现以及对实时性要求严格的应用场合有格外重要的意义。
申请公布号 CN105954783B 申请公布日期 2017.03.29
申请号 CN201610262477.6 申请日期 2016.04.26
申请人 武汉大学 发明人 常乐;牛小骥;章红平;张全
分类号 G01S19/49(2010.01)I;G01C21/16(2006.01)I 主分类号 G01S19/49(2010.01)I
代理机构 武汉科皓知识产权代理事务所(特殊普通合伙) 42222 代理人 胡艳
主权项 一种改进GNSS/INS实时紧组合导航实时性能的方法,其特征是:将GNSS/INS紧组合分解成机械编排、Kalman预测任务和Kalman观测更新任务,下述步骤实施过程中保持机械编排、Kalman预测任务优先级高于Kalman观测更新任务:(1)将GNSS采样时刻记为时刻k,保存时刻k的预测误差协方差矩阵<img file="FDA0001166047790000011.GIF" wi="107" he="62" />和机械编排解算的导航状态;(2)在时刻k时GNSS观测数据的接收时刻,基于时刻k的GNSS观测数据、<img file="FDA0001166047790000012.GIF" wi="100" he="63" />和根据时刻k的机械编排解算的导航状态形成的状态向量z<sub>k</sub>,采用Kalman滤波法进行组合更新解算,得时刻k的状态参数估计量<img file="FDA0001166047790000013.GIF" wi="53" he="62" />以及状态参数协方差估计量<img file="FDA0001166047790000014.GIF" wi="83" he="62" />(3)将组合更新解算完成时刻记为时刻j,基于公式<img file="FDA0001166047790000015.GIF" wi="543" he="174" />估计时刻j的状态参数估计量<img file="FDA0001166047790000016.GIF" wi="73" he="63" />以及状态参数协方差估计量<img file="FDA0001166047790000017.GIF" wi="99" he="70" />Φ<sub>j/k</sub>表示时刻k到时刻j的累积状态转移矩阵;M<sub>j,k+1</sub>为时刻k+1到时刻j的累计状态噪声矩阵,<img file="FDA0001166047790000018.GIF" wi="557" he="127" />Q<sub>i‑1</sub>为时刻i‑1的系统噪声的协方差矩阵;(4)采用<img file="FDA0001166047790000019.GIF" wi="75" he="63" />以及<img file="FDA00011660477900000110.GIF" wi="73" he="63" />修正时刻j的惯导误差。
地址 430072 湖北省武汉市武昌区珞珈山武汉大学