一种惯导/北斗组合导航的半实物仿真方法技术

一种惯导/北斗组合导航的半实物仿真方法，步骤为：一、将惯导/北斗组合装于载体并上电启动；二、装订初始参数至导航计算机；三、载体静止，保存1小时陀螺和加速度计输出数据求其平均值，并分别与其平均值作差，得到陀螺和加速度计实际噪声；四、载体静止，惯导进行5分钟静态初始对准；五、载体运动，惯导导航计算，保存运动后50秒内惯导输出载体位置及北斗接收机输出数据；六、由卫星和载体位置计算伪距、伪距率参考值、分别与北斗接收机输出伪距值、伪距率值作差，得到北斗伪距、伪距率噪声；七、设定仿真轨迹，得到北斗伪距标准值及各种相关数据，将数据与步骤3、6中得到的噪声数据融合，得到器件的模拟数据进行惯导/北斗组合导航仿真。

【技术实现步骤摘要】
一种惯导/北斗组合导航的半实物仿真方法
：本专利技术涉及一种惯导/北斗组合导航的半实物仿真方法，属于惯性导航

技术介绍
：北斗卫星导航系统是由我国自主研发的卫星导航系统，可以提供高精度的实时位置和速度信息，将惯导与北斗卫星导航系统进行组合可以抑制惯导系统误差随时间累积的缺点，实现高精度导航定位。在进行惯导/北斗组合导航仿真研究时，一般设定仿真轨迹(包含载体的运动速度、位置、姿态)和卫星位置，利用轨迹发生器生成加速度计的标准值、陀螺的标准值，由设定仿真轨迹中载体的位置和卫星位置计算得到北斗的伪距、伪距率标准值，给定北斗的伪距误差值、伪距率误差值以及北斗的伪距噪声、伪距率噪声，给定加速度计和陀螺的标度误差、零偏、失准角误差以及噪声，将以上数据融合得到用于组合导航仿真的器件模拟数据，然后采用这些模拟数据进行组合导航的仿真计算与分析。其中，仿真噪声不能全面反映北斗、加速度计、陀螺的噪声特性，导致仿真结果不能较全面地反映实际情况。为了更好地进行惯导/北斗组合导航研究，本文提出了一种惯导/北斗组合导航的半实物仿真方法。
技术实现思路
：1、本专利技术的目的是提供了一种惯导/北斗组合导航的半实物仿真方法，该方法能够更好地模拟惯导/北斗组合导航过程。2、技术方案：本专利技术一种惯导/北斗组合导航的半实物仿真方法，该方法具体步骤如下：步骤1、将惯导/北斗组合系统安装到载体上，并上电启动。步骤2、装订初始参数(包括初始的经度、纬度、高度)至导航计算机。步骤3、载体保持静止，采集保存1小时陀螺和加速度计的输出数据。求取陀螺和加速度计的输出数据的平均值，将采集的陀螺和加速度计数据分别与其平均值作差，得到陀螺和加速度计的实际噪声。步骤4、载体保持静止，惯导进行5分钟静态初始对准。步骤5、完成对准后载体开始运动，运动过程中惯导进行惯性导航计算，采集并保存开始运动后50秒内惯导输出的载体位置(经度、纬度、高度)以及北斗接收机输出的伪距值、伪距率值、卫星位置数据。步骤6、由采集的卫星位置和载体位置计算得到伪距参考值、伪距率参考值，将计算得到的伪距参考值、伪距率参考值分别与北斗接收机输出的伪距值、伪距率值作差，得到北斗伪距噪声和伪距率噪声。步骤7、设定仿真轨迹(包含载体的运动速度、位置、姿态)。由设定仿真轨迹中载体的位置和卫星的位置计算得到北斗的伪距标准值；利用轨迹发生器生成加速度计的标准值、陀螺的标准值；并给定加速度计和陀螺的标度误差、零偏、失准角误差；给定北斗的伪距误差值、伪距率误差值。将这些数据与步骤3、步骤6中得到的噪声数据融合，得到用于惯导/北斗组合导航半实物仿真的器件模拟数据，然后采用这些模拟数据进行惯导/北斗组合导航仿真。其中，步骤3中所述的“得到陀螺和加速度计的实际噪声”，其实现过程说明如下：采集1小时陀螺x、y、z三个轴输出的数据分别为ωx(i)，ωy(i)，ωz(i)，平均值分别为加速度计x、y、z三个轴输出的数据分别为ax(i)，ay(i)，az(i)，平均值分别为定义wg(i)为陀螺噪声，wa(i)为加速度计噪声，其中i＝1…n。陀螺噪声计算公式如下：加速度计噪声计算公式如下：其中，步骤6中所述的“得到北斗伪距噪声和伪距率噪声”，其实现过程说明如下：北斗接收机至少要选取4颗卫星才能解算出载体的位置和钟差，所以要保存四颗星的伪距、伪距率和卫星位置。载体开始运动，采集得到了50秒内北斗四颗卫星的伪距分别为伪距率分别为惯导输出的载体所在位置的经度为λ(i)，纬度为L(i)，高度为h(i)，在空间直角坐标系下位置为(x(i)y(i)z(i))Τ，其中i＝1…n。经纬高转换直角坐标计算公式如下：x(i)＝(RN+h(i))cosL(i)cosλ(i)y(i)＝(RN+h(i))cosLsinλ(i)z(i)＝[RN(1-e2)+h(i)]sinL(i)式中RN为卯酉圈曲率半径。由采集到的四颗卫星在空间直角坐标系下的位置和惯导输出的载体位置(x(i)y(i)z(i))Τ计算得到伪距参考值计算公式如下：由伪距参考值和北斗接收机采样时间Δt计算得到伪距率参考值计算公式如下：北斗四颗卫星的伪距噪声为计算如下：伪距率噪声为计算如下：其中，步骤7中所述的“得到用于惯导/北斗组合导航半实物仿真的器件模拟数据，然后采用这些模拟数据进行惯导/北斗组合导航仿真”，其实现过程说明如下：设定仿真轨迹(包含载体的运动速度、位置、姿态)。由设定仿真轨迹中载体的位置和卫星的位置计算得到北斗的伪距标准值；利用轨迹发生器生成加速度计的标准值、陀螺的标准值；并给定加速度计和陀螺的标度误差、零偏、失准角误差；给定北斗的伪距误差值、伪距率误差值。将这些数据与步骤3、步骤6中得到的噪声数据融合，得到用于惯导/北斗组合导航半实物仿真的器件模拟数据，然后采用这些模拟数据进行惯导/北斗组合导航仿真。定义：设定仿真轨迹中载体位置为(Lt(i)λt(i)ht(i))Τ，在空间直角坐标系中的位置为(xt(i)yt(i)zt(i))Τ；仿真设定的北斗四颗卫星的位置分别为仿真计算得到的北斗四颗卫星的伪距标准值分别为伪距率标准值分别为给定的伪距误差值为δtu，伪距率误差值为δtru；加速度计x、y、z三个轴的标准值分别为atx(i)，aty(i)，atz(i)；加速度计x、y、z三个轴的标度误差分别为δKax、δKay、δKaz；加速度计的失准角误差为δMaxy、δMaxz、δMayx、δMayz、δMazx、δMazy；加速度计x、y、z三个轴的零偏分别为δBax、δBay、δBaz；陀螺x、y、z三个轴的标准值分别为ωtx(i)，ωty(i)，ωtz(i)；陀螺x、y、z三个轴的标度误差分别为δKgx、δKgy、δKgz；陀螺的失准角误差为δMgxy、δMgxz、δMgyx、δMgyz、δMgzx、δMgzy；陀螺x、y、z三个轴的零偏分别为δBgx、δBgy、δBgz；陀螺x、y、z三个轴的噪声分别为wgx(i)，wgy(i)，wgz(i)；加速度计x、y、z三个轴的噪声分别为wax(i)，way(i)，waz(i)；北斗四颗卫星的伪距噪声分别为伪距率噪声分别为其中i＝1…n。经纬高转换直角坐标计算公式如下：xt(i)＝(RN+ht(i))cosLt(i)cosλt(i)yt(i)＝(RN+ht(i))cosLt(i)sinλt(i)(i＝1…n)zt(i)＝[RN(1-e2)+ht(i)]sinLt(i)式中RN为卯酉圈曲率半径。由设定仿真轨迹中载体的位置和卫星的位置计算得到北斗的伪距标准值，计算公式如下：由仿真设定的北斗采样时间Δt和计算得到北斗的伪距标准值得到伪距率标准值，计算公式如下：由计算得到的伪距标准值、伪距率标准值，给定伪距误差值、伪距率误差值以及提取的北斗四颗卫星的伪距噪声、伪距率噪声，得到用于组合导航半实物仿真的伪距、伪距率数据。用于组合导航半实物仿真的伪距计算式如下：用于组合导航半实物仿真的伪距率计算公式如下：由计算得到的陀螺、加速度计标准值，给定的陀螺、加速度计零偏、标度误差、失准角误差以及提取的陀螺、加速度计的噪声，综合得到用于组合导航半实物仿真的陀螺、加速度计数据。用于组合导航半实物仿真的陀螺数据计算公式如下：用于组合导航半实物仿真的加速度本文档来自技高网...

【技术保护点】
一种惯导/北斗组合导航的半实物仿真方法，其特征在于：该方法具体步骤如下：步骤1、将惯导/北斗组合系统安装到载体上，并上电启动；步骤2、装订初始参数，包括初始的经度、纬度、高度至导航计算机；步骤3、载体保持静止，采集保存1小时陀螺和加速度计的输出数据；求取陀螺和加速度计的输出数据的平均值，将采集的陀螺和加速度计数据分别与其平均值作差，得到陀螺和加速度计的实际噪声；步骤4、载体保持静止，惯导进行5分钟静态初始对准；步骤5、完成对准后载体开始运动，运动过程中惯导进行惯性导航计算，采集并保存开始运动后50秒内惯导输出的载体位置即经度、纬度、高度以及北斗接收机输出的伪距值、伪距率值、卫星位置数据；步骤6、由采集的卫星位置和载体位置计算得到伪距参考值、伪距率参考值，将计算得到的伪距参考值、伪距率参考值分别与北斗接收机输出的伪距值、伪距率值作差，得到北斗伪距噪声和伪距率噪声；步骤7、设定仿真轨迹，包含载体的运动速度、位置、姿态，由设定仿真轨迹中载体的位置和卫星的位置计算得到北斗的伪距标准值；利用轨迹发生器生成加速度计的标准值、陀螺的标准值；并给定加速度计和陀螺的标度误差、零偏、失准角误差；给定北斗的伪距误差值、伪距率误差值；将这些数据与步骤3、步骤6中得到的噪声数据融合，得到用于惯导/北斗组合导航半实物仿真的器件模拟数据，然后采用这些模拟数据进行惯导/北斗组合导航仿真。...

【技术特征摘要】
1.一种惯导/北斗组合导航的半实物仿真方法，其特征在于：该方法具体步骤如下：步骤1、将惯导/北斗组合系统安装到载体上，并上电启动；步骤2、装订初始参数，包括初始的经度、纬度、高度至导航计算机；步骤3、载体保持静止，采集保存1小时陀螺和加速度计的输出数据；求取陀螺和加速度计的输出数据的平均值，将采集的陀螺和加速度计数据分别与其平均值作差，得到陀螺和加速度计的实际噪声；步骤4、载体保持静止，惯导进行5分钟静态初始对准；步骤5、完成对准后载体开始运动，运动过程中惯导进行惯性导航计算，采集并保存开始运动后50秒内惯导输出的载体位置即经度、纬度、高度以及北斗接收机输出的伪距值、伪距率值、卫星位置数据；步骤6、由采集的卫星位置和载体位置计算得到伪距参考值、伪距率参考值，将计算得到的伪距参考值、伪距率参考值分别与北斗接收机输出的伪距值、伪距率值作差，得到北斗伪距噪声和伪距率噪声；步骤7、设定仿真轨迹，包含载体的运动速度、位置、姿态，由设定仿真轨迹中载体的位置和卫星的位置计算得到北斗的伪距标准值；利用轨迹发生器生成加速度计的标准值、陀螺的标准值；并给定加速度计和陀螺的标度误差、零偏、失准角误差；给定北斗的伪距误差值、伪距率误差值；将这些数据与步骤3、步骤6中得到的噪声数据融合，得到用于惯导/北斗组合导航半实物仿真的器件模拟数据，然后采用这些模拟数据进行惯导/北斗组合导航仿真。2.根据权利要求1所述的一种惯导/北斗组合导航的半实物仿真方法，其特征在于：步骤3中所述的“得到陀螺和加速度计的实际噪声”，其实现过程说明如下：采集1小时陀螺x、y、z三个轴输出的数据分别为ωx(i)，ωy(i)，ωz(i)，平均值分别为加速度计x、y、z三个轴输出的数据分别为ax(i)，ay(i)，az(i)，平均值分别为定义wg(i)为陀螺噪声，wa(i)为加速度计噪声，其中i＝1…n；陀螺噪声计算公式如下：其中，i＝1…n；加速度计噪声计算公式如下：其中，i＝1…n；。3.根据权利要求1所述的一种惯导/北斗组合导航的半实物仿真方法，其特征在于：步骤6中所述的“得到北斗伪距噪声和伪距率噪声”，其实现过程说明如下：北斗接收机至少要选取4颗卫星才能解算出载体的位置和钟差，所以要保存四颗星的伪距、伪距率和卫星位置；载体开始运动，采集得到了50秒内北斗四颗卫星的伪距分别为伪距率分别为惯导输出的载体所在位置的经度为λ(i)，纬度为L(i)，高度为h(i)，在空间直角坐标系下位置为(x(i)y(i)z(i))T，其中i＝1...n；经纬高转换直角坐标计算公式如下：x(i)＝(RN+h(i))cosL(i)cosλ(i)y(i)＝(RN+h(i))cosL(i)sinλ(i)z(i)＝[RN(1-e2)+h(i)]sinL(i)式中RN为卯酉圈曲率半径；由采集到的四颗卫星在空间直角坐标系下的位置和惯导输出的载体位置(x(i)y(i)z(i))T计算得到伪距参考值计算公式如下：其中，i＝1…n；由伪距参考值和北斗接收机采样时间Δt计算得到伪距率参考值计算公式如下：其中，i＝1…n；北斗四颗卫星的伪距噪声为计算如下：其中，i＝1…n；伪距率噪声为计算如下：其中，i＝1…n。4.根据权利要求1所述的一种...

【专利技术属性】
技术研发人员：张小跃，张春熹，易晓静，时海涛，潘建业，刘鹏博，
申请(专利权)人：北京航空航天大学，
类型：发明
国别省市：北京;11