CN115793009B - 基于高精度北斗组合测量的多站无源定位方法 - Google Patents
基于高精度北斗组合测量的多站无源定位方法 Download PDFInfo
- Publication number
- CN115793009B CN115793009B CN202310054424.5A CN202310054424A CN115793009B CN 115793009 B CN115793009 B CN 115793009B CN 202310054424 A CN202310054424 A CN 202310054424A CN 115793009 B CN115793009 B CN 115793009B
- Authority
- CN
- China
- Prior art keywords
- information
- error
- navigation
- speed
- equation
- 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.)
- Active
Links
- 238000000034 method Methods 0.000 title claims abstract description 25
- 238000005259 measurement Methods 0.000 title claims abstract description 14
- 230000001133 acceleration Effects 0.000 claims abstract description 21
- 238000012937 correction Methods 0.000 claims abstract description 14
- 239000011159 matrix material Substances 0.000 claims abstract description 10
- 238000001914 filtration Methods 0.000 claims abstract description 6
- 238000004364 calculation method Methods 0.000 claims abstract description 4
- 238000006073 displacement reaction Methods 0.000 claims abstract description 4
- 230000009977 dual effect Effects 0.000 claims abstract description 4
- 238000006243 chemical reaction Methods 0.000 claims description 8
- 230000008569 process Effects 0.000 claims description 5
- 238000013500 data storage Methods 0.000 claims description 3
- 239000010453 quartz Substances 0.000 claims description 3
- VYPSYNLAJGMNEJ-UHFFFAOYSA-N silicon dioxide Inorganic materials O=[Si]=O VYPSYNLAJGMNEJ-UHFFFAOYSA-N 0.000 claims description 3
- 230000009471 action Effects 0.000 description 3
- 239000005436 troposphere Substances 0.000 description 2
- 230000004075 alteration Effects 0.000 description 1
- 239000005433 ionosphere Substances 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000012545 processing Methods 0.000 description 1
- 238000006467 substitution reaction Methods 0.000 description 1
- 230000003313 weakening effect Effects 0.000 description 1
Images
Classifications
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02D—CLIMATE CHANGE MITIGATION TECHNOLOGIES IN INFORMATION AND COMMUNICATION TECHNOLOGIES [ICT], I.E. INFORMATION AND COMMUNICATION TECHNOLOGIES AIMING AT THE REDUCTION OF THEIR OWN ENERGY USE
- Y02D30/00—Reducing energy consumption in communication networks
- Y02D30/70—Reducing energy consumption in communication networks in wireless communication networks
Landscapes
- Navigation (AREA)
Abstract
本发明提供了基于高精度北斗组合测量的多站无源定位方法,先分别利用陀螺和加速度计测得载体的角速度信息和加速度信息,并送入导航计算机;导航计算机根据角速度信息和加速度信息进行捷联导航计算,利用四元数方程得到四元数向量,得出姿态矩阵和姿态角,通过导航方程得到载体的速度和位移,同时解出各项导航参数的误差方程,并运用卡尔曼滤波技术,对IMU补偿单元和北斗双天线的信息进行融合,根据接收到的基准站差分修正信息进行差分修正,准确得到载体的航向角、姿态角、速度和位置的导航参数。本发明可以获得多个测量站高精度的位置信息,并可提供连续的航向、姿态信息,提高北斗卫星信号的快速重捕获能力。
Description
技术领域
本发明属于基于卫星定位技术领域,具体涉及基于高精度北斗组合测量的多站无源定位方法。
背景技术
利用北斗卫星导航信号可以用于多站地面设备的定位、测速和授时。由于接收机钟差、电离层误差、对流层误差、相对论误差等因素的影响,其单点定位的精度为米级,无法应用于高精度定位的场合。载波相位差分定位技术利用在短基线下移动站与基准站的各项观测误差具有较高的时间相关性和空间相关性的特性,通过对基准站和移动站的观测信号进行载波相位差分处理,达到了削弱甚至消除电离层、对流层、相对论、多径等多种观测误差的目的,从而实现了高精度的相对定位测量。
北斗导航卫星轨道高度约为2万至4万公里,对应信号传输到地面其信号强度约为-130dBm,信号很弱易受到干扰。采用惯性组合导航的方式可以在北斗卫星信号不可用时提供连续的位置、航向和姿态数据,并在卫星信号可用时,提供辅助捕获,更快进入北斗导航模式。
基于此,提出基于高精度北斗组合测量的多站无源定位方法。
发明内容
本发明所要解决的技术问题在于针对上述现有技术的不足,提供基于高精度北斗组合测量的多站无源定位方法,以解决上述背景技术中提出的问题。
为解决上述技术问题,本发明采用的技术方案是:基于高精度北斗组合测量的多站无源定位方法,包括
先分别利用陀螺和加速度计测得载体的角速度信息和加速度信息,并将测得的角速度信息和加速度信息由数据采集器进行模/数转换后被送入导航计算机;
导航计算机根据角速度信息和加速度信息进行捷联导航计算,利用四元数方程得到四元数向量,得出姿态矩阵和姿态角,通过导航方程得到载体的速度和位移,同时解出各项导航参数的误差方程,并运用卡尔曼滤波技术,对IMU补偿单元和北斗双天线的信息进行融合,根据接收到的基准站差分修正信息进行差分修正,准确得到载体的航向角、姿态角、速度和位置的导航参数。
进一步的,所述陀螺的陀螺数据采集单元采集MEMS陀螺的三轴角速度及陀螺内部的温度信息,然后传送给IMU补偿单元,所述加速度计的加速度表数据采集单元采集高精度的石英加速度计的三轴线加速度及加速度计内部的温度信息,并将采集数据传送给IMU补偿单元。
进一步的,所述IMU补偿单元用于对陀螺数及加速度计的输出信号进行误差补偿,然后将补偿后的三轴角速度和三轴线加速度数据传送给组合导航计算机的航向解算单元。
进一步的,所述的航向解算单元通过接收由北斗基准站和北斗从站的信息,解算出北斗航向。
进一步的,所述的航向解算单元对于对载体的三轴角速度、三轴线加速度、及北斗航向、位置、速度的信息进行组合导航解算,根据差分修正信息进行差分修正,计算得到载体准确的位置、速度、姿态信息,然后传送给接口转换单元接口,转换单元用于将组合导航解算单元传输来的信息按照用户需求进行数据转换,然后通过数据接口单元输出,通过数据存储单元存储组合导航设备的导航输出信息。
进一步的,所述的卡尔曼滤波方程具体如下:
其中:X(t)为18阶状态变量,分别有3个位置误差、3个速度误差、3个姿态误差、3个陀螺漂移、3个加速度计零偏和3个陀螺比例系数变量;
F(t)为状态因子;
G(t)为系统参数矩阵;
w(t)为过程噪声;
并根据IMU系统平台误差角方程、速度误差方程、位置误差方程和陀螺、加速度计的随机误差方程,建立系统误差向量z(t)状态方程组;
H(t)为观测矩阵;
X(t)为状态变量;
n(t)为系统噪声;
当系统在惯性/北斗用户差分接收机组合导航模式时,由差分用户机提供系统的观测信息,构成观测方程,观测量如下,由5个观测变量组成,分别是3个位置误差观测量、2个速度误差观测量;
其中,VGe为接收机测量东向速度误差;
VIe为惯性测量东向速度误差;
VGn为接收机测量北向速度误差;
VIn为惯性测量北向速度误差;
LG为接收机经度位置误差观测量;
LI为惯性测量经度位置误差观测量;
λG为接收机纬度位置误差观测量;
λI为惯性测量纬度位置误差观测量;
hG为接收机高度位置误差观测量;
hI为惯性测量高度位置误差观测量;
观测方程如下:
其中,I2×2为2乘2对角单位阵;
I3×3为3乘3对角单位阵;
02×3为2乘3零阵;
05×1为5乘1零阵;
03×2为3乘2零阵;
05×12为5乘12零阵;
X18为18阶状态变量;
υVE为东向速度误差量;
υVN为北向速度误差量;
υL为经度误差量;
υλ为纬度误差量;
υH为高度误差量。
进一步的,在载波相位单差时间比对中,采用多历元模型通过对观测方程递归的方法解算初始整周模糊度。
本发明与现有技术相比具有以下优点:
本发明提出了基于北斗卫星载波相位差分和组合导航的进行多站无源定位的技术,利用本方法可以获得多个测量站高精度的位置信息,并可提供连续的航向、姿态信息。提高北斗卫星信号的快速重捕获能力。
附图说明
图1是本发明整体方法流程图。
具体实施方式
下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅仅是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。
如图1所示,本发明提供一种技术方案:基于高精度北斗组合测量的多站无源定位方法,包括以下步骤:
S1、先分别利用陀螺和加速度计测得载体的角速度信息和加速度信息,并将测得的角速度信息和加速度信息由数据采集器进行模/数转换后被送入导航计算机;
S2、导航计算机根据角速度信息和加速度信息进行捷联导航计算,利用四元数方程得到四元数向量,得出姿态矩阵和姿态角,通过导航方程得到载体的速度和位移,同时解出各项导航参数的误差方程;
S3、运用卡尔曼滤波技术,对IMU补偿单元和北斗双天线的信息进行融合,根据接收到的基准站差分修正信息进行差分修正,准确得到载体的航向角、姿态角、速度和位置的导航参数。
所述陀螺的陀螺数据采集单元采集MEMS陀螺的三轴角速度及陀螺内部的温度信息,然后传送给IMU补偿单元,所述加速度计的加速度表数据采集单元采集高精度的石英加速度计的三轴线加速度及加速度计内部的温度信息,并将采集数据传送给IMU补偿单元。
所述IMU补偿单元用于对陀螺数及加速度计的输出信号进行误差补偿,然后将补偿后的三轴角速度和三轴线加速度数据传送给组合导航计算机的航向解算单元。
所述的航向解算单元通过接收由北斗基准站和北斗从站的信息,解算出北斗航向。
所述的航向解算单元对于对载体的三轴角速度、三轴线加速度、及北斗航向、位置、速度的信息进行组合导航解算,根据差分修正信息进行差分修正,计算得到载体准确的位置、速度、姿态信息;
所述的卡尔曼滤波方程具体如下:
其中:X(t)为18阶状态变量,分别有3个位置误差、3个速度误差、3个姿态误差、3个陀螺漂移、3个加速度计零偏和3个陀螺比例系数变量;
F(t)为状态因子;
G(t)为系统参数矩阵;
w(t)为过程噪声;
并根据IMU系统平台误差角方程、速度误差方程、位置误差方程和陀螺、加速度计的随机误差方程,建立系统误差向量z(t)状态方程组;
H(t)为观测矩阵;
X(t)为状态变量;
n(t)为系统噪声;
当系统在惯性/北斗用户差分接收机组合导航模式时,由差分用户机提供系统的观测信息,构成观测方程,观测量如下,由5个观测变量组成,分别是3个位置误差观测量、2个速度误差观测量;
其中,VGe为接收机测量东向速度误差;
VIe为惯性测量东向速度误差;
VGn为接收机测量北向速度误差;
VIn为惯性测量北向速度误差;
LG为接收机经度位置误差观测量;
LI为惯性测量经度位置误差观测量;
λG为接收机纬度位置误差观测量;
λI为惯性测量纬度位置误差观测量;
hG为接收机高度位置误差观测量;
hI为惯性测量高度位置误差观测量;
观测方程如下:
其中,I2×2为2乘2对角单位阵;
I3×3为3乘3对角单位阵;
02×3为2乘3零阵;
05×1为5乘1零阵;
03×2为3乘2零阵;
05×12为5乘12零阵;
X18为18阶状态变量;
υVE为东向速度误差量;
υVN为北向速度误差量;
υL为经度误差量;
υλ为纬度误差量;
υH为高度误差量。
在载波相位单差时间比对中,采用多历元模型通过对观测方程递归的方法解算初始整周模糊度;
然后传送给接口转换单元接口,转换单元用于将组合导航解算单元传输来的信息按照用户需求进行数据转换,然后通过数据接口单元输出,通过数据存储单元存储组合导航设备的导航输出信息。
需要说明的是,在本文中,诸如第一和第二等之类的关系术语仅仅用来将一个实体或者操作与另一个实体或操作区分开来,而不一定要求或者暗示这些实体或操作之间存在任何这种实际的关系或者顺序。而且,术语“包括”、“包含”或者其任何其他变体意在涵盖非排他性的包含,从而使得包括一系列要素的过程、方法、物品或者设备不仅包括那些要素,而且还包括没有明确列出的其他要素,或者是还包括为这种过程、方法、物品或者设备所固有的要素。
尽管已经示出和描述了本发明的实施例,对于本领域的普通技术人员而言,可以理解在不脱离本发明的原理和精神的情况下可以对这些实施例进行多种变化、修改、替换和变型,本发明的范围由所附权利要求及其等同物限定。
Claims (4)
1.基于高精度北斗组合测量的多站无源定位方法,其特征在于:包括
先分别利用陀螺和加速度计测得载体的角速度信息和加速度信息,并将测得的角速度信息和加速度信息由数据采集器进行模/数转换后被送入导航计算机;
导航计算机根据角速度信息和加速度信息进行捷联导航计算,利用四元数方程得到四元数向量,得出姿态矩阵和姿态角,通过导航方程得到载体的速度和位移,同时解出各项导航参数的误差方程,并运用卡尔曼滤波技术,对IMU补偿单元和北斗双天线的信息进行融合,根据接收到的基准站差分修正信息进行差分修正,准确得到载体的航向角、姿态角、速度和位置的导航参数;
所述陀螺的陀螺数据采集单元采集MEMS陀螺的三轴角速度及陀螺内部的温度信息,然后传送给IMU补偿单元,所述加速度计的加速度表数据采集单元采集高精度的石英加速度计的三轴线加速度及加速度计内部的温度信息,并将采集数据传送给IMU补偿单元;
所述IMU补偿单元用于对陀螺数及加速度计的输出信号进行误差补偿,然后将补偿后的三轴角速度和三轴线加速度数据传送给组合导航计算机的航向解算单元;
所述的卡尔曼滤波方程具体如下:
其中:X(t)为18阶状态变量,分别有3个位置误差、3个速度误差、3个姿态误差、3个陀螺漂移、3个加速度计零偏和3个陀螺比例系数变量;
F(t)为状态因子;
G(t)为系统参数矩阵;
w(t)为过程噪声;
并根据IMU系统平台误差角方程、速度误差方程、位置误差方程和陀螺、加速度计的随机误差方程,建立系统误差向量z(t)状态方程组;
H(t)为观测矩阵;
X(t)为状态变量;
n(t)为系统噪声;
当系统在惯性/北斗用户差分接收机组合导航模式时,由差分用户机提供系统的观测信息,构成观测方程,观测量如下,由5个观测变量组成,分别是3个位置误差观测量、2个速度误差观测量;
其中,VGe为接收机测量东向速度误差;
VIe为惯性测量东向速度误差;
VGn为接收机测量北向速度误差;
VIn为惯性测量北向速度误差;
LG为接收机经度位置误差观测量;
LI为惯性测量经度位置误差观测量;
λG为接收机纬度位置误差观测量;
λI为惯性测量纬度位置误差观测量;
hG为接收机高度位置误差观测量;
hI为惯性测量高度位置误差观测量;
观测方程如下:
其中,I2×2为2乘2对角单位阵;
I3×3为3乘3对角单位阵;
02×3为2乘3零阵;
05×1为5乘1零阵;
03×2为3乘2零阵;
05×12为5乘12零阵;
X18为18阶状态变量;
υVE为东向速度误差量;
υVN为北向速度误差量;
υL为经度误差量;
υλ为纬度误差量;
υH为高度误差量。
2.根据权利要求1所述的基于高精度北斗组合测量的多站无源定位方法,其特征在于,所述的航向解算单元通过接收由北斗基准站和北斗从站的信息,解算出北斗航向。
3.根据权利要求2所述的基于高精度北斗组合测量的多站无源定位方法,其特征在于,所述的航向解算单元对于对载体的三轴角速度、三轴线加速度、及北斗航向、位置、速度的信息进行组合导航解算,根据差分修正信息进行差分修正,计算得到载体准确的位置、速度、姿态信息,然后传送给接口转换单元接口,转换单元用于将组合导航解算单元传输来的信息按照用户需求进行数据转换,然后通过数据接口单元输出,通过数据存储单元存储组合导航设备的导航输出信息。
4.根据权利要求1所述的基于高精度北斗组合测量的多站无源定位方法,其特征在于,在载波相位单差时间比对中,采用多历元模型通过对观测方程递归的方法解算初始整周模糊度。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202310054424.5A CN115793009B (zh) | 2023-02-03 | 2023-02-03 | 基于高精度北斗组合测量的多站无源定位方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202310054424.5A CN115793009B (zh) | 2023-02-03 | 2023-02-03 | 基于高精度北斗组合测量的多站无源定位方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN115793009A CN115793009A (zh) | 2023-03-14 |
CN115793009B true CN115793009B (zh) | 2023-05-09 |
Family
ID=85429655
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202310054424.5A Active CN115793009B (zh) | 2023-02-03 | 2023-02-03 | 基于高精度北斗组合测量的多站无源定位方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN115793009B (zh) |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN117214933B (zh) * | 2023-11-07 | 2024-02-06 | 中国船舶集团有限公司第七〇七研究所 | 水面船用惯导/北斗紧耦合长周期惯导速度品质提升方法 |
Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110780326A (zh) * | 2019-09-26 | 2020-02-11 | 上海瀚所信息技术有限公司 | 一种车载组合导航系统和定位方法 |
CN114739404A (zh) * | 2022-04-29 | 2022-07-12 | 深圳亿嘉和科技研发有限公司 | 高精度定位方法、装置及带电作业机器人定位系统 |
Family Cites Families (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US6697736B2 (en) * | 2002-02-06 | 2004-02-24 | American Gnc Corporation | Positioning and navigation method and system thereof |
CN114167416B (zh) * | 2022-02-15 | 2022-04-29 | 中国人民解放军火箭军工程大学 | 一种基于射频延时的收发共用超低空测高雷达系统及方法 |
-
2023
- 2023-02-03 CN CN202310054424.5A patent/CN115793009B/zh active Active
Patent Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110780326A (zh) * | 2019-09-26 | 2020-02-11 | 上海瀚所信息技术有限公司 | 一种车载组合导航系统和定位方法 |
CN114739404A (zh) * | 2022-04-29 | 2022-07-12 | 深圳亿嘉和科技研发有限公司 | 高精度定位方法、装置及带电作业机器人定位系统 |
Also Published As
Publication number | Publication date |
---|---|
CN115793009A (zh) | 2023-03-14 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN113203418B (zh) | 基于序贯卡尔曼滤波的gnssins视觉融合定位方法及系统 | |
CN106255065B (zh) | 智能手机室内外无缝定位系统及其方法 | |
US7171303B1 (en) | Navigation method and apparatus | |
US7292185B2 (en) | Attitude determination exploiting geometry constraints | |
CN105425261B (zh) | 基于GPS/Beidou2/INS的组合导航与定位方法 | |
CN102176041B (zh) | 一种基于gnss/sins组合的车辆导航监控系统 | |
CN107656300B (zh) | 基于北斗/gps双模软件接收机的卫星/惯性超紧组合方法 | |
CN106767787A (zh) | 一种紧耦合gnss/ins组合导航装置 | |
CN102608642A (zh) | 北斗/惯性组合导航系统 | |
CN105607093A (zh) | 一种组合导航系统及获取导航坐标的方法 | |
CN110986879A (zh) | 一种电力线塔倾斜实时监测方法及系统 | |
CN102508277A (zh) | 精密单点定位与惯性测量紧组合导航系统及数据处理方法 | |
CN110133692B (zh) | 惯导技术辅助的高精度gnss动态倾斜测量系统及方法 | |
CN110988955B (zh) | 一种导航定位的方法及装置 | |
CN115793009B (zh) | 基于高精度北斗组合测量的多站无源定位方法 | |
CN115523920B (zh) | 一种基于视觉惯性gnss紧耦合的无缝定位方法 | |
CN202305821U (zh) | 精密单点定位与惯性测量紧组合导航系统 | |
Sheta et al. | Improved localization for Android smartphones based on integration of raw GNSS measurements and IMU sensors | |
CN108205151B (zh) | 一种低成本gps单天线姿态测量方法 | |
CN105549058B (zh) | 原子钟、微惯性测量组合和导航系统的耦合方法及系统 | |
CN117320148A (zh) | 多源数据融合定位方法、系统、电子设备及存储介质 | |
CN111288990A (zh) | 一种架空检修机器人组合姿态测量方法 | |
CN115950419A (zh) | 超小型无人机用组合导航方法、装置及系统 | |
CN115184977A (zh) | 一体化组合导航装置及导航系统 | |
Ding | Optimal integration of GPS with inertial sensors: Modelling and implementation |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |