法律状态公告日
法律状态信息
法律状态
2019-10-08
未缴年费专利权终止 IPC(主分类):G01S19/47 授权公告日:20170517 终止日期:20181013 申请日:20141013
专利权的终止
2017-05-17
授权
授权
2015-06-24
实质审查的生效 IPC(主分类):G01S19/47 申请日:20141013
实质审查的生效
2015-05-27
公开
公开
技术领域:本发明涉及一种用于组合导航半实物仿真的北斗数据建模方法,属于惯导技术领域。
背景技术:
北斗卫星导航系统是由我国自主研发的卫星导航系统,可以提供高精度的实时位置和速度信息,将惯导与北斗卫星导航系统进行组合可以抑制惯导系统误差随时间累积的缺点,实现高精度导航定位。
在进行惯导/北斗组合导航仿真研究时,一般设定仿真轨迹(包含载体的运动速度、位置、姿态)和卫星位置,由设定仿真轨迹中载体的位置和卫星位置计算得到北斗的伪距、伪距率标准值,并给定北斗的伪距误差、伪距率误差值以及噪声,将以上数据融合得到用于组合导航仿真的北斗数据。实际环境比较复杂,仿真噪声不能全面反映北斗的噪声特性,导致组合导航仿真结果不能全面地反映实际情况。为了更好地进行惯导/北斗组合导航研究,本专利申请提出了一种用于组合导航半实物仿真的北斗数据建模方法。
发明内容:
1、本发明的目的是提供一种用于组合导航半实物仿真的北斗数据建模方法,该方法能够更好地模拟北斗输出的数据。
2、技术方案:
本发明一种用于组合导航半实物仿真的北斗数据建模方法,该方法具体步骤如下:
步骤1、将惯导/北斗组合系统安装到载体上,并上电启动。
步骤2、装订初始参数(包括初始的经度、纬度、高度)至导航计算机。
步骤3、载体保持静止,惯导进行5分钟静态初始对准。
步骤4、完成对准后载体开始运动,运动过程中惯导进行惯性导航计算,采集并保存开始运动后50秒内惯导输出的载体位置(经度、纬度、高度)以及北斗接收机输出的伪距值、伪距率值、卫星位置数据。
步骤5、由采集的卫星位置和载体位置计算得到伪距参考值、伪距率参考值,将计算得到的伪距参考值、伪距率参考值分别与北斗接收机输出的伪距值、伪距率值作差,得到北斗伪距 噪声和伪距率噪声。
步骤6、设定仿真轨迹(包含载体的运动速度、位置、姿态)和卫星位置,由设定仿真轨迹中载体的位置和卫星的位置计算得到北斗的伪距标准值,伪距率标准值,给定伪距误差值,伪距率误差值,然后将以上数据与步骤5中得到的伪距噪声、伪距率噪声进行数据融合,得到用于组合导航半实物仿真的伪距、伪距率数据。
其中,步骤5中所述“得到北斗伪距噪声和伪距率噪声”,其实现过程说明如下:
北斗接收机至少要选取4颗卫星才能解算出载体的位置和钟差,所以要保存四颗星的伪距、伪距率和卫星位置。载体开始运动,采集得到了50秒内北斗四颗卫星的伪距分别为
经纬高转换直角坐标计算公式如下:
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计算得到伪距率参考值
>
北斗四颗卫星的伪距噪声为
>
伪距率噪声为
>
其中,步骤6中所述“得到用于组合导航半实物仿真的伪距、伪距率数据”,其实现过程说明如下:
设定仿真轨迹(包含载体的运动速度、位置、姿态)和卫星位置。由设定仿真轨迹中载体的位置和卫星的位置计算得到北斗的伪距标准值,伪距率标准值,给定伪距误差值,伪距率误差值,然后将以上数据与步骤5中得到的伪距噪声、伪距率噪声进行数据融合,得到用于组合导航半实物仿真的伪距、伪距率数据。定义:设定仿真轨迹中载体位置为(Lt(i) λt(i) ht(i))T,在空间直角坐标系中的位置为(xt(i) yt(i) zt(i))T;仿真设定的北斗四颗卫星的位置分别为>>给定的伪距误差值为δtu,伪距率误差值为δtru;仿真计算得到的北斗四颗卫星的伪距标准值分别为
经纬高转换直角坐标计算公式如下:
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和计算得到北斗的伪距标准值得到伪距率标准值,计算公式如下:
>
由计算得到的伪距标准值、伪距率标准值,给定伪距误差值、伪距率误差值以及提取的北斗四颗卫星的伪距噪声、伪距率噪声,得到用于组合导航半实物仿真的伪距、伪距率数据。
用于组合导航半实物仿真的伪距
>
用于组合导航半实物仿真的伪距率
>
3、优点及功效:该方法的优点是用北斗的实际噪声替代仿真噪声,为研究惯导/北斗组合导航提供了更好的支持。
附图说明
图1为北斗数据建模方法框图;
图2为本发明北斗数据建模方法流程图;
图中符号说明如下:
(L λ h)Τ:惯导输出的载体经度、纬度、高度坐标
(x y z)Τ:载体在空间直角坐标系下的坐标
(xs ys zs)Τ:北斗接收机输出的卫星位置坐标
ρB:北斗接收机输出的伪距
ρBt:由仿真数据计算得到的伪距标准值
ρI:由载体位置和卫星位置计算得到的伪距参考值
δtu:给定的北斗伪距误差
δtru:给定的北斗伪距率误差
wρ:伪距噪声
ρBf:用于组合导航半实物仿真的伪距数据
Ps:仿真设定的卫星位置
Pb:设定的仿真轨迹中的载体位置
具体实施方式:
见图1、图2,本发明一种用于组合导航半实物仿真的北斗数据建模方法,该方法具体步骤如下:
步骤1、将惯导/北斗组合系统安装到载体上,并上电启动。
步骤2、装订初始参数(包括初始的经度、纬度、高度)至导航计算机。
步骤3、载体保持静止,惯导进行5分钟静态初始对准。
步骤4、完成对准后载体开始运动,运动过程中惯导进行惯性导航计算,采集并保存开始运动后50秒内惯导输出的载体位置(经度、纬度、高度)以及北斗接收机输出的伪距值、伪距 率值、卫星位置数据。
步骤5、由采集的卫星位置和载体位置计算得到伪距参考值、伪距率参考值,将计算得到的伪距参考值、伪距率参考值分别与北斗接收机输出的伪距值、伪距率值作差,得到北斗伪距噪声和伪距率噪声。
步骤6、设定仿真轨迹(包含载体的运动速度、位置、姿态)和卫星位置,由设定仿真轨迹中载体的位置和卫星的位置计算得到北斗的伪距标准值,伪距率标准值,给定伪距误差值,伪距率误差值,然后将以上数据与步骤5中得到的伪距噪声、伪距率噪声进行数据融合,得到用于组合导航半实物仿真的伪距、伪距率数据。
其中,步骤5中所述“得到北斗伪距噪声和伪距率噪声”,其实现过程说明如下:
北斗接收机至少要选取4颗卫星才能解算出载体的位置和钟差,所以要保存四颗星的伪距、伪距率和卫星位置。载体开始运动,采集得到了50秒内北斗四颗卫星的伪距分别为
经纬高转换直角坐标计算公式如下:
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计算得到伪距率参考值
>
北斗四颗卫星的伪距噪声为
>
伪距率噪声为
>
其中,步骤6中所述“得到用于组合导航半实物仿真的伪距、伪距率数据”,其实现过程说明如下:
设定仿真轨迹(包含载体的运动速度、位置、姿态)和卫星位置。由设定仿真轨迹中载体的位置和卫星的位置计算得到北斗的伪距标准值,伪距率标准值,给定伪距误差值,伪距率误差值,然后将以上数据与步骤5中得到的伪距噪声、伪距率噪声进行数据融合,得到用于组合导航半实物仿真的伪距、伪距率数据。
定义:设定仿真轨迹中载体位置为(Lt(i) λt(i) ht(i))Τ,在空间直角坐标系中的位置为 (xt(i) yt(i) zt(i))Τ;仿真设定的北斗四颗卫星的位置分别为
经纬高转换直角坐标计算公式如下:
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和计算得到北斗的伪距标准值得到伪距率标准值,计算公式如下:
>
由计算得到的伪距标准值、伪距率标准值,给定伪距误差值、伪距率误差值以及提取的北斗四颗卫星的伪距噪声、伪距率噪声,得到用于组合导航半实物仿真的伪距、伪距率数据。
用于组合导航半实物仿真的伪距
>
用于组合导航半实物仿真的伪距率计算公式如下:
>
机译: 包含至少一种聚合物和至少一种增塑剂的组合物,用于增塑半结晶聚合物和用于制备制品的方法和/或相应的制品。
机译: 半富马酸替诺福韦alafenamida方法;制备;药物组合物,其包含;一种制备药物组合物的方法,并用于治疗HIV感染。
机译: 一种制备径向填料的方法,特别是用于造纸工业的径向填料,其由硬石膏ii和半水合物制备的填料以及用于生产该填料组合物的填料