摘要
本发明提供一种面向卫星拒止的区域内导航定位方法及系统,方法包括:投放布设多个数据链终端以组成多个地面节点;将空中装有数据链终端及惯导系统的武器装备,作为空中节点;计算标较后的所述地面节点在大地坐标系下的坐标;通过数据链终端测量得到空中节点相对地面多个节点的相对距离;建立惯性/数据链导航卡尔曼滤波模型,对惯导系统误差进行实时估计,其中,所述模型中,以多个相对距离为量测信息构建量测向量Z;滤波过程中,实时判断数据链测距有效性,进行地面节点故障检测,并剔除故障节点。本发明实现了复杂环境下的导航定位精度演进,弥补了卫星失效场景下战术武器装备的高精度定位需求。
技术关键词
导航定位方法
节点故障检测
卡尔曼滤波模型
地面
坐标系
导航定位精度
系统误差
导航定位系统
终端
有效性
陀螺
矩阵