CN104656111B - 一种用于组合导航半实物仿真的北斗数据建模方法 - Google Patents
一种用于组合导航半实物仿真的北斗数据建模方法 Download PDFInfo
- Publication number
- CN104656111B CN104656111B CN201410538352.2A CN201410538352A CN104656111B CN 104656111 B CN104656111 B CN 104656111B CN 201410538352 A CN201410538352 A CN 201410538352A CN 104656111 B CN104656111 B CN 104656111B
- Authority
- CN
- China
- Prior art keywords
- rho
- pseudorange
- centerdot
- pseudo
- carrier
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Expired - Fee Related
Links
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S19/00—Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
- G01S19/38—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system
- G01S19/39—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system the satellite radio beacon positioning system transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
- G01S19/42—Determining position
- G01S19/45—Determining position by combining measurements of signals from the satellite radio beacon positioning system with a supplementary measurement
- G01S19/47—Determining position by combining measurements of signals from the satellite radio beacon positioning system with a supplementary measurement the supplementary measurement being an inertial measurement, e.g. tightly coupled inertial
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Computer Networks & Wireless Communication (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Position Fixing By Use Of Radio Waves (AREA)
Abstract
一种用于组合导航半实物仿真的北斗数据建模方法,有六大步骤:一、将惯导/北斗组合***安装到载体上并上电启动;二、装订初始参数至导航计算机;三、载体静止,惯导进行5分钟静态初始对准;四、载体运动,惯导导航计算,采集并保存运动后50秒内惯导输出载***置以及北斗接收机输出伪距值、伪距率值、卫星位置数据;五、由采集的卫星和载***置计算得到伪距参考值、伪距率参考值,并分别与北斗接收机输出的伪距值、伪距率值作差,得到北斗伪距噪声和伪距率噪声;六、设定仿真轨迹,计算得到北斗的伪距、伪距率标准值,给定伪距、伪距率误差值,将以上数据与伪距噪声、伪距率噪声进行数据融合,得到用于组合导航半实物仿真的伪距、伪距率数据。
Description
技术领域: 本发明涉及一种用于组合导航半实物仿真的北斗数据建模方法,属于惯导技术领域。
背景技术:
北斗卫星导航***是由我国自主研发的卫星导航***,可以提供高精度的实时位置和速度信息,将惯导与北斗卫星导航***进行组合可以抑制惯导***误差随时间累积的缺点,实现高精度导航定位。
在进行惯导/北斗组合导航仿真研究时,一般设定仿真轨迹(包含载体的运动速度、位置、姿态)和卫星位置,由设定仿真轨迹中载体的位置和卫星位置计算得到北斗的伪距、伪距率标准值,并给定北斗的伪距误差、伪距率误差值以及噪声,将以上数据融合得到用于组合导航仿真的北斗数据。实际环境比较复杂,仿真噪声不能全面反映北斗的噪声特性,导致组合导航仿真结果不能全面地反映实际情况。为了更好地进行惯导/北斗组合导航研究,本专利申请提出了一种用于组合导航半实物仿真的北斗数据建模方法。
发明内容:
1、本发明的目的是提供一种用于组合导航半实物仿真的北斗数据建模方法,该方法能够更好地模拟北斗输出的数据。
2、技术方案:
本发明一种用于组合导航半实物仿真的北斗数据建模方法,该方法具体步骤如下:
步骤1、将惯导/北斗组合***安装到载体上,并上电启动。
步骤2、装订初始参数(包括初始的经度、纬度、高度)至导航计算机。
步骤3、载体保持静止,惯导进行5分钟静态初始对准。
步骤4、完成对准后载体开始运动,运动过程中惯导进行惯性导航计算,采集并保存开始运动后50秒内惯导输出的载***置(经度、纬度、高度)以及北斗接收机输出的伪距值、伪距率值、卫星位置数据。
步骤5、由采集的卫星位置和载***置计算得到伪距参考值、伪距率参考值,将计算得到的伪距参考值、伪距率参考值分别与北斗接收机输出的伪距值、伪距率值作差,得到北斗伪距噪声和伪距率噪声。
步骤6、设定仿真轨迹(包含载体的运动速度、位置、姿态)和卫星位置,由设定仿真轨迹中载体的位置和卫星的位置计算得到北斗的伪距标准值,伪距率标准值,给定伪距误差值,伪距率误差值,然后将以上数据与步骤5中得到的伪距噪声、伪距率噪声进行数据融合,得到用于组合导航半实物仿真的伪距、伪距率数据。
其中,步骤5中所述“得到北斗伪距噪声和伪距率噪声”,其实现过程说明如下:
北斗接收机至少要选取4颗卫星才能解算出载体的位置和钟差,所以要保存四颗星的伪距、伪距率和卫星位置。载体开始运动,采集得到了50秒内北斗四颗卫星的伪距分别为 伪距率分别为惯导输出的载体所在位置的经度为λ(i),纬度为L(i),高度为h(i),在空间直角坐标系下位置为(x(i) y(i) z(i))Τ,其中i=1…n。
经纬高转换直角坐标计算公式如下:
x(i)=(RN+h(i))cos L(i)cosλ(i)
y(i)=(RN+h(i))cos L sinλ(i)
z(i)=[RN(1-e2)+h(i)]sin L(i)
式中RN为卯酉圈曲率半径。
由采集到的四颗卫星在空间直角坐标系下的位置 和载***置(x(i) y(i) z(i))Τ计算得到伪距参考值计算公式如下:
由伪距参考值和北斗接收机采样时间Δt计算得到伪距率参考值 计算公式如下:
北斗四颗卫星的伪距噪声为计算如下:
伪距率噪声为计算如下:
其中,步骤6中所述“得到用于组合导航半实物仿真的伪距、伪距率数据”,其实现过程说明如下:
设定仿真轨迹(包含载体的运动速度、位置、姿态)和卫星位置。由设定仿真轨迹中载体的位置和卫星的位置计算得到北斗的伪距标准值,伪距率标准值,给定伪距误差值,伪距率误差值,然后将以上数据与步骤5中得到的伪距噪声、伪距率噪声进行数据融合,得到用于组合导航半实物仿真的伪距、伪距率数据。定义:设定仿真轨迹中载***置为(Lt(i) λt(i) ht(i))Τ,在空间直角坐标系中的位置为(xt(i) yt(i) zt(i))Τ;仿真设定的北斗四颗卫星的位置分别为 给定的伪距误差值为δtu,伪距率误差值为δtru;仿真计算得到的北斗四颗卫星的伪距标准值分别为伪距率标准值分别为 其中i=1…n。
经纬高转换直角坐标计算公式如下:
xt(i)=(RN+ht(i))cos Lt(i)cosλt(i)
yt(i)=(RN+ht(i))cos Lt(i)sinλt(i) (i=1…n)
zt(i)=[RN(1-e2)+ht(i)]sin Lt(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秒内北斗四颗卫星的伪距分别为 伪距率分别为惯导输出的载体所在位置的经度为λ(i),纬度为L(i),高度为h(i),在空间直角坐标系下位置为(x(i) y(i)z(i))Τ,其中i=1…n。
经纬高转换直角坐标计算公式如下:
x(i)=(RN+h(i))cos L(i)cosλ(i)
y(i)=(RN+h(i))cos L sinλ(i)
z(i)=[RN(1-e2)+h(i)]sin L(i)
式中RN为卯酉圈曲率半径。
由采集到的四颗卫星在空间直角坐标系下的位置 和载***置(x(i) y(i) z(i))Τ计算得到伪距参考值计算公式如下:
由伪距参考值和北斗接收机采样时间Δt计算得到伪距率参考值 计算公式如下:
北斗四颗卫星的伪距噪声为计算如下:
伪距率噪声为计算如下:
其中,步骤6中所述“得到用于组合导航半实物仿真的伪距、伪距率数据”,其实现过程说明如下:
设定仿真轨迹(包含载体的运动速度、位置、姿态)和卫星位置。由设定仿真轨迹中载体的位置和卫星的位置计算得到北斗的伪距标准值,伪距率标准值,给定伪距误差值,伪距率误差值,然后将以上数据与步骤5中得到的伪距噪声、伪距率噪声进行数据融合,得到用于组合导航半实物仿真的伪距、伪距率数据。
定义:设定仿真轨迹中载***置为(Lt(i) λt(i) ht(i))Τ,在空间直角坐标系中的位置为(xt(i) yt(i) zt(i))Τ;仿真设定的北斗四颗卫星的位置分别为给定的伪距误差值为δtu,伪距率误差值为δtru;仿真计算得到的北斗四颗卫星的伪距标准值分别为伪距率标准值分别为其中i=1…n。
经纬高转换直角坐标计算公式如下:
xt(i)=(RN+ht(i))cos Lt(i)cosλt(i)
yt(i)=(RN+ht(i))cos Lt(i)sinλt(i) (i=1…n)
zt(i)=[RN(1-e2)+ht(i)]sin Lt(i)
式中RN为卯酉圈曲率半径。
由设定仿真轨迹中载体的位置和卫星的位置计算得到北斗的伪距标准值,计算公式如下:
由仿真设定的北斗采样时间Δt和计算得到北斗的伪距标准值得到伪距率标准值,计算公式如下:
由计算得到的伪距标准值、伪距率标准值,给定伪距误差值、伪距率误差值以及提取的北斗四颗卫星的伪距噪声、伪距率噪声,得到用于组合导航半实物仿真的伪距、伪距率数据。
用于组合导航半实物仿真的伪距计算式如下:
用于组合导航半实物仿真的伪距率计算公式如下:
Claims (3)
1.一种用于组合导航半实物仿真的北斗数据建模方法,其特征在于:该方法具体步骤如下:
步骤1、将惯导/北斗组合***安装到载体上,并上电启动;
步骤2、装订初始参数,包括初始的经度、纬度、高度至导航计算机;
步骤3、载体保持静止,惯导进行5分钟静态初始对准;
步骤4、完成对准后载体开始运动,运动过程中惯导进行惯性导航计算,采集并保存开始运动后50秒内惯导输出的载***置即经度、纬度、高度以及北斗接收机输出的伪距值、伪距率值、卫星位置数据;
步骤5、由采集的卫星位置和载***置计算得到伪距参考值、伪距率参考值,将计算得到的伪距参考值、伪距率参考值分别与北斗接收机输出的伪距值、伪距率值作差,得到北斗伪距噪声和伪距率噪声;
步骤6、设定仿真轨迹,包含载体的运动速度、位置、姿态和卫星位置,由设定仿真轨迹中载体的位置和卫星的位置计算得到北斗的伪距标准值,伪距率标准值,给定伪距误差值,伪距率误差值,然后将以上数据与步骤5中得到的伪距噪声、伪距率噪声进行数据融合,得到用于组合导航半实物仿真的伪距、伪距率数据。
2.根据权利要求1所述的一种用于组合导航半实物仿真的北斗数据建模方法,其特征在于:步骤5中所述“得到北斗伪距噪声和伪距率噪声”,其实现过程说明如下:
北斗接收机至少要选取4颗卫星才能解算出载体的位置和钟差,所以要保存四颗星的伪距、伪距率和卫星位置;载体开始运动,采集得到了50秒内北斗四颗卫星的伪距分别为 伪距率分别为惯导输出的载体所在位置的经度为λ(i),纬度为L(i),高度为h(i),在空间直角坐标系下位置为(x(i) y(i)z(i))Τ,其中i=1...n;
经纬高转换直角坐标计算公式如下:
x(i)=(RN+h(i))cos L(i)cosλ(i)
y(i)=(RN+h(i))cos L(i)sinλ(i)
z(i)=[RN(1-e2)+h(i)]sin L(i)
式中RN为卯酉圈曲率半径;
由采集到的四颗卫星在空间直角坐标系下的位置 和载***置(x(i) y(i) z(i))Τ计算得到伪距参考值计算公式如下:
由伪距参考值和北斗接收机采样时间Δt计算得到伪距率参考值 计算公式如下:
北斗四颗卫星的伪距噪声为计算如下:
伪距率噪声为计算如下:
3.根据权利要求1所述的一种用于组合导航半实物仿真的北斗数据建模方法,其特征在于:步骤6中所述“得到用于组合导航半实物仿真的伪距、伪距率数据”,其实现过程说明如下:
设定仿真轨迹,包含载体的运动速度、位置、姿态和卫星位置,由设定仿真轨迹中载体的位置和卫星的位置计算得到北斗的伪距标准值,伪距率标准值,给定伪距误差值,伪距率误差值,然后将以上数据与步骤5中得到的伪距噪声、伪距率噪声进行数据融合,得到用于组合导航半实物仿真的伪距、伪距率数据;定义:设定仿真轨迹中载***置为(Lt(i) λt(i) ht(i))Τ,在空间直角坐标系中的位置为(xt(i) yt(i) zt(i))Τ;仿真设定的北斗四颗卫星的位置分别为 给定的伪距误差值为δtu,伪距率误差值为δtru;仿真计算得到的北斗四颗卫星的伪距标准值分别为伪距率标准值分别为 其中i=1...n;
经纬高转换直角坐标计算公式如下:
xt(i)=(RN+ht(i))cos Lt(i)cosλt(i)
yt(i)=(RN+ht(i))cos Lt(i)sinλt(i) (i=1...n)
zt(i)=[RN(1-e2)+ht(i)]sin Lt(i)
式中RN为卯酉圈曲率半径;
由设定仿真轨迹中载体的位置和卫星的位置计算得到北斗的伪距标准值,计算公式如下:
由仿真设定的北斗接收机采样时间Δt和计算得到北斗的伪距标准值得到伪距率标准值,计算公式如下:
由计算得到的伪距标准值、伪距率标准值,给定伪距误差值、伪距率误差值以及提取的北斗四颗卫星的伪距噪声、伪距率噪声,得到用于组合导航半实物仿真的伪距、伪距率数据;
用于组合导航半实物仿真的伪距计算式如下:
用于组合导航半实物仿真的伪距率计算公式如下:
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410538352.2A CN104656111B (zh) | 2014-10-13 | 2014-10-13 | 一种用于组合导航半实物仿真的北斗数据建模方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410538352.2A CN104656111B (zh) | 2014-10-13 | 2014-10-13 | 一种用于组合导航半实物仿真的北斗数据建模方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN104656111A CN104656111A (zh) | 2015-05-27 |
CN104656111B true CN104656111B (zh) | 2017-05-17 |
Family
ID=53247463
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201410538352.2A Expired - Fee Related CN104656111B (zh) | 2014-10-13 | 2014-10-13 | 一种用于组合导航半实物仿真的北斗数据建模方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN104656111B (zh) |
Families Citing this family (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105549057B (zh) * | 2015-12-07 | 2018-08-17 | 韩厚增 | 一种惯性辅助的gps/bds融合大比例尺快速宗地测量装置与方法 |
CN115201866B (zh) * | 2022-09-16 | 2022-12-09 | 中国船舶重工集团公司第七0七研究所 | 一种大型水面舰船惯导及北斗紧耦合方案空间修正方法 |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102508954A (zh) * | 2011-10-21 | 2012-06-20 | 天津大学 | Gps/sins组合导航全数字仿真方法及装置 |
CN102620605A (zh) * | 2012-03-31 | 2012-08-01 | 林德福 | 半实物仿真用gps和ins组合制导*** |
CN103675844A (zh) * | 2013-11-18 | 2014-03-26 | 航天恒星科技有限公司 | 一种gnss/ins组合导航同步模拟*** |
CN104076372A (zh) * | 2013-03-27 | 2014-10-01 | 北京大学 | 一种产生多场景多***的卫星数字中频信号的方法及装置 |
-
2014
- 2014-10-13 CN CN201410538352.2A patent/CN104656111B/zh not_active Expired - Fee Related
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102508954A (zh) * | 2011-10-21 | 2012-06-20 | 天津大学 | Gps/sins组合导航全数字仿真方法及装置 |
CN102620605A (zh) * | 2012-03-31 | 2012-08-01 | 林德福 | 半实物仿真用gps和ins组合制导*** |
CN104076372A (zh) * | 2013-03-27 | 2014-10-01 | 北京大学 | 一种产生多场景多***的卫星数字中频信号的方法及装置 |
CN103675844A (zh) * | 2013-11-18 | 2014-03-26 | 航天恒星科技有限公司 | 一种gnss/ins组合导航同步模拟*** |
Non-Patent Citations (2)
Title |
---|
GPS-INS组合导航***半实物仿真研究;王艳东等;《北京航空航天大学学报》;19990630;第25卷(第3期);全文 * |
卫星-INS组合导航仿真平台研究与实现;彭健;《中国优秀硕士学位论文全文数据库》;20061115;第2006年卷(第11期);全文 * |
Also Published As
Publication number | Publication date |
---|---|
CN104656111A (zh) | 2015-05-27 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN108535755B (zh) | 基于mems的gnss/imu车载实时组合导航方法 | |
CN104597471B (zh) | 面向时钟同步多天线gnss接收机的定向测姿方法 | |
CN102928858B (zh) | 基于改进扩展卡尔曼滤波的gnss单点动态定位方法 | |
CN101424534B (zh) | 惯性/重力组合导航半实物模拟装置 | |
JP5352422B2 (ja) | 測位装置及びプログラム | |
CN103453906B (zh) | 卫星轨道的预测方法 | |
CN106507913B (zh) | 用于管道测绘的组合定位方法 | |
CN102818567A (zh) | 集合卡尔曼滤波-粒子滤波相结合的auv组合导航方法 | |
CN105259787A (zh) | 一种组合导航半物理仿真测试同步控制方法 | |
CN103604430A (zh) | 一种基于边缘化ckf重力辅助导航的方法 | |
CN103149580A (zh) | 一种基于stkf和wnn的gps/ins组合导航方法 | |
CN105043415A (zh) | 基于四元数模型的惯性系自对准方法 | |
CN105371844A (zh) | 一种基于惯性/天文互助的惯性导航***初始化方法 | |
CN109983361A (zh) | 机会信号辅助惯性导航 | |
CN103557864A (zh) | Mems捷联惯导自适应sckf滤波的初始对准方法 | |
CN103868514A (zh) | 一种在轨飞行器自主导航*** | |
CN104133231B (zh) | 一种基于积分多普勒平滑伪距的导航定位方法 | |
CN103777218A (zh) | Gnss/ins超紧组合导航***的性能评估***及方法 | |
CN104048664A (zh) | 一种导航卫星星座自主定轨的方法 | |
CN103487820A (zh) | 一种车载捷联/卫星紧组合无缝导航方法 | |
CN106093992A (zh) | 一种基于cors的亚米级组合定位导航***及导航方法 | |
CN103033822B (zh) | 移动信息确定装置、方法以及接收机 | |
CN103454662A (zh) | 一种基于ckf的sins/北斗/dvl组合对准方法 | |
CN102707080B (zh) | 一种星敏感器模拟捷联惯导陀螺的方法 | |
CN104597460A (zh) | 一种基于北斗卫星导航接收机的载波跟踪环路晶体振荡器加速度敏感系数标定方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20170517 Termination date: 20181013 |
|
CF01 | Termination of patent right due to non-payment of annual fee |