发明名称 一种高精度SINS模拟器的设计方法
摘要 本发明提供了一种高精度SINS模拟器的设计方法,涉及捷联惯导系统的仿真领域。所述方法包括:利用高精度载波相位差分GNSS与中等精度IMU融合的组合导航算法,结合Kalman滤波的部分反馈修正和三次样条拟合方法,生成平滑的轨迹参数,再通过推导SINS反演算法实现了惯性器件的模拟采样仿真,反演算法中充分考虑了姿态圆锥误差和速度划船误差的补偿。这样设计出的SINS模拟器具有极高的精度性能和良好的频率特性,满足高精度SINS对数据源仿真精度和频率复杂性的要求。
申请公布号 CN104713559A 申请公布日期 2015.06.17
申请号 CN201510059782.0 申请日期 2015.02.01
申请人 西北工业大学 发明人 严恭敏;周馨怡;翁浚;秦永元
分类号 G01C21/20(2006.01)I 主分类号 G01C21/20(2006.01)I
代理机构 代理人
主权项 一种高精度捷联惯导系统SINS模拟器的设计方法,其特征在于,包括以下步骤:S1、由实际捷联惯导原始数据,即陀螺角增量Δθ<sub>m</sub>和加速度计速度增量Δv<sub>m</sub>,进行捷联惯导更新算法,推算获得当前时刻的惯导姿态、速度和位置信息;S2、利用高精度GPS与捷联惯导构成组合导航系统,进行Kalman滤波,估计捷联惯导误差;S3、根据Kalman滤波估计的捷联惯导误差,使用部分反馈修正方法修正所述当前时刻的惯导姿态、速度和位置信息,得到精确并且平滑的姿态、速度和位置组合导航参数;S4、对姿态和位置组合导航参数作三次样条函数拟合,获得分段连续的轨迹函数,即姿态函数A(t)、速度函数v<sup>n</sup>(t)和位置函数p(t);S5、对轨迹函数A(t)、v<sup>n</sup>(t)和p(t)作等间隔插值,得到离散的轨迹序列,即姿态序列A<sub>k</sub>、速度序列<img file="FSA0000113849090000011.GIF" wi="67" he="75" />和位置序列p<sub>k</sub>;S6、根据联惯导航反演算法进行惯性器件模拟,即获得陀螺角增量Δθ<sub>k</sub>和加速度计速度增量Δv<sub>k</sub>模拟采样序列。
地址 710072 陕西省西安市友谊西路127号西北工业大学自动化学院