CN117268372A - 融合磁导航信息的ins/gnss组合导航方法和*** - Google Patents
融合磁导航信息的ins/gnss组合导航方法和*** Download PDFInfo
- Publication number
- CN117268372A CN117268372A CN202311548722.6A CN202311548722A CN117268372A CN 117268372 A CN117268372 A CN 117268372A CN 202311548722 A CN202311548722 A CN 202311548722A CN 117268372 A CN117268372 A CN 117268372A
- Authority
- CN
- China
- Prior art keywords
- information
- magnetic sensor
- navigation
- magnetic
- ins
- 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.)
- Granted
Links
- 230000005291 magnetic effect Effects 0.000 title claims abstract description 158
- 238000000034 method Methods 0.000 title claims abstract description 61
- 238000001914 filtration Methods 0.000 claims abstract description 19
- 230000004927 fusion Effects 0.000 claims abstract description 12
- 230000005358 geomagnetic field Effects 0.000 claims description 10
- 238000005259 measurement Methods 0.000 claims description 7
- 230000035945 sensitivity Effects 0.000 claims description 6
- 238000003860 storage Methods 0.000 claims description 5
- 238000007499 fusion processing Methods 0.000 claims description 2
- 238000004590 computer program Methods 0.000 claims 2
- 230000008569 process Effects 0.000 abstract description 6
- 238000012937 correction Methods 0.000 description 4
- 238000005516 engineering process Methods 0.000 description 4
- 238000004364 calculation method Methods 0.000 description 2
- 230000008859 change Effects 0.000 description 2
- 238000010586 diagram Methods 0.000 description 2
- 230000000694 effects Effects 0.000 description 2
- 230000007613 environmental effect Effects 0.000 description 2
- 239000011159 matrix material Substances 0.000 description 2
- 230000004048 modification Effects 0.000 description 2
- 238000012986 modification Methods 0.000 description 2
- 230000009466 transformation Effects 0.000 description 2
- 238000009825 accumulation Methods 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000008901 benefit Effects 0.000 description 1
- 230000000295 complement effect Effects 0.000 description 1
- 230000010485 coping Effects 0.000 description 1
- 238000006880 cross-coupling reaction Methods 0.000 description 1
- 230000006872 improvement Effects 0.000 description 1
- 238000009434 installation Methods 0.000 description 1
- 238000004519 manufacturing process Methods 0.000 description 1
- 239000002245 particle Substances 0.000 description 1
- 238000012545 processing Methods 0.000 description 1
- 238000009827 uniform distribution Methods 0.000 description 1
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/005—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 with correlation of navigation data from several sources, e.g. map or contour matching
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/10—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
- G01C21/12—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning
- G01C21/16—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation
- G01C21/165—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation combined with non-inertial navigation instruments
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/20—Instruments for performing navigational calculations
-
- 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
-
- 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)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Computer Networks & Wireless Communication (AREA)
- Navigation (AREA)
Abstract
本发明属于多源导航数据融合定位技术领域，具体涉及一种融合磁导航信息的INS/GNSS组合导航方法和***，包括：采用平面校准法进行磁传感器的粗校准，得到磁传感器信息；基于卡尔曼滤波进行惯性导航***、卫星导航***与磁传感器信息的融合，计算载体真北角；根据所得到的载体真北角，计算载体航向角，实现融合磁导航信息的INS/GNSS组合导航。本发明基于卡尔曼滤波，解决了INS/GNSS组合导航***与磁传感器相融合的难题，基于Kalman滤波的算法基础上，结合磁传感器提供的真北角信息约束姿态信息中的航向角发散，从而解决了磁传感器在使用过程中需要进行校准补偿才能使用的问题。
Description
技术领域
本发明属于多源导航数据融合定位技术领域，具体涉及一种融合磁导航信息的INS/GNSS组合导航方法和***。
背景技术
本部分的陈述仅仅是提供了与本发明相关的背景技术信息，不必然构成在先技术。
随着多源导航数据融合定位技术的提出和MEMS（Micro-Electro MechanicalSystem，微机电***）传感器技术的成熟，越来越多的传感器被应用到导航定位领域，通过将来自不同导航源的同构或者异构的导航信息进行融合，得到综合性能更好的导航效果，有效的解决了单一传感器误差累积、稳定性差等问题。
基于卫星导航（GNSS）与惯性导航（INS）的组合是目前导航定位领域的主要应用方式之一，惯性导航具有的独立、连续、隐蔽特性,具备强自主性、短时高精度、动态性，能够为导航***提供无环境限制的载体运动信息，有效提升整个导航***的精度和可靠性。若仅靠六轴惯性传感器（Inertial Measurement Unit，简称IMU）数据融合得到的载体姿态信息会由于陀螺仪的积分误差无法补偿而随时间漂移和发散，而姿态角的精度又会在一定程度上影响惯导结算的速度信息和位置信息。
磁传感器可独立自主的感应测量周围的磁场强度，可广泛应用在地磁测量、姿态导航、多源融合等领域，尤其是在地磁导航***应用中；三轴磁传感器通过测量载体周围的磁场信息将其与真实的地磁场信息做对比，从而获取载体准确的姿态，因此三轴磁传感器在地磁导航中发挥了关键作用。但是由于磁传感器通常会受加工工艺和安装工艺的影响，以及在实际使用中极易受到环境磁场的干扰，在不做任何校准的情况下测量到的数据存在极大偏差，进而导致结算的姿态角精度降低，因此需要进行校准才能够使用，以保证基于其输出的地磁信息确定出的航向信息是准确的。在线磁传感器校准算法主要以滤波算法思想为主，通过对磁传感器误差模型进行建模建立状态方程，磁传感器测量到的磁场信息建立量测方差，以滤波的方式逐步迭代来解算获取误差信息，将误差信息在线补偿到原始数据中，进行姿态结算。常见的算法有卡尔曼（Kalman）滤波算法、粒子群和递推最小二乘法。
据发明人了解，磁传感器与INS/GNSS组合导航***的融合面临着一定的挑战：首先，磁传感器与IMU器件进行结合使用时，必须要对磁传感器进行内部标定和外部标定，内部标定解决了磁传感器在制造工艺上面造成的一些自身误差因素，如标度因数、敏感轴交叉耦合和偏置等误差；外部标定解决了磁传感器与IMU之间的坐标系失准角问题。此外，磁干扰类型中的软磁效应不仅会引起磁力仪内部参数的变化，也会导致磁力仪与陀螺的坐标系失准角发生改变。未经校准或校准不充分的磁传感器，如果融合到组合导航***中反而会拉低最终姿态角的精度。目前磁传感器校准方法根据实时性特征分为离线校准和在线校准，其中离线校准通常是在磁场环境比较理想的情况下进行，这样做的目的可以避免复杂环境造成对校准算法的影响，能够有效的消除磁传感器中的零偏误差、比例因子误差、非正交误差等因素，从而提升离线校准算法的效果。在线校准算法主要是对误差进行模型，通过滤波等手段拟合相关参数，从而实现校准的目的，但是往往存在误差模型复杂，待估状态量比较多，对整个***的算力要求较高。此外，目前的校准算法对校准数据的要求比较高，校准数据尽量要保证均匀分布、正交性和多样性等特征，要求设备具备能够满足大幅度的机动要求，这对于小型设备基本没有难度，若是车载或机载等应用场景，操作起来比较复杂，采集到的数据很难满足校准要求，从而导致校准过程不一定收敛，算法容易出现奇异值问题。因此现有的磁传感器校准方法不具有工程应用价值，因此限制了磁传感器在组合导航***中的应用。
发明内容
为了解决上述问题，本发明提出了一种融合磁导航信息的INS/GNSS组合导航方法和***，基于卡尔曼滤波，解决了INS/GNSS组合导航***与磁传感器相融合的难题，基于Kalman滤波的算法基础上，结合磁传感器提供的真北角信息约束姿态信息中的航向角发散，从而解决了磁传感器在使用过程中需要进行校准补偿才能使用的问题。
根据一些实施例，本发明的第一方案提供了一种融合磁导航信息的INS/GNSS组合导航方法，采用如下技术方案：
一种融合磁导航信息的INS/GNSS组合导航方法，包括：
采用平面校准法进行磁传感器的粗校准，得到磁传感器信息，其中，所得到的磁传感器信息包括磁传感器水平轴向的零偏和尺度因子；
基于卡尔曼滤波进行惯性导航***、卫星导航***与磁传感器信息的融合，计算载体真北角；
根据所得到的载体真北角，计算载体航向角，实现融合磁导航信息的INS/GNSS组合导航。
作为进一步的技术限定，将卫星导航***的位置信息、速度信息与惯性导航***的位置信息、速度信息，以及通过惯性导航***姿态信息中的航向角信息与基于磁传感器得到的真北角之差分别作为卡尔曼滤波的测量信息，结合卡尔曼滤波，完成信息融合。
进一步的，在信息融合的过程中，将磁传感器误差模型中的灵敏度因子作为卡尔曼滤波方程中的状态矢量的一个待估计参数，通过滤波迭代得到所述灵敏度因子。
作为进一步的技术限定，利用磁传感器信息计算载体真北角信息；假设磁传感器的X轴指向前方，Y轴水平向右且与X轴垂直，Z轴方向垂直向下，采集磁传感器输出数据；根据所得到的地磁场信息矢量和姿态信息，求出根据磁传感器计算得到的载体真北角信息。
进一步的，所述载体航向角为/>；其中，/>为磁偏角，表示地磁场矢量在水平面的投影与地理北向的夹角；/>为磁航向角，即载体前进方向与载体真北角之间的夹角，/>；其中，/>，；/>表示经过校正后磁场矢量在y轴方向的分量；表示磁场矢量经过校正后在x轴方向的分量。
作为进一步的技术限定，在采用平面校准法进行磁传感器的粗校准的过程中，通过水平面的旋转进行校准数据的采集，得到磁传感器水平轴向的零偏和尺度因子；即，/>；令/>，/>；其中/>、/>、/>、/>分别是磁传感器采集到的校准数据的最小值和最大值，/>和/>分别对应平面校准得到的X轴向和Y轴向的零偏信息，/>和/>对应着X轴向和Y轴向的尺度因子。
作为进一步的技术限定，所述惯性导航***的信息至少包括姿态失准角、速度误差、定位误、陀螺相关漂移、加速度计偏值、航向角偏差和磁传感器尺度因子。
根据一些实施例，本发明的第二方案提供了一种融合磁导航信息的INS/GNSS组合导航***，采用如下技术方案：
一种融合磁导航信息的INS/GNSS组合导航***，包括：
校准模块，其被配置为采用平面校准法进行磁传感器的粗校准，得到磁传感器信息，其中，所得到的磁传感器信息包括磁传感器水平轴向的零偏和尺度因子；
融合模块，其被配置为基于卡尔曼滤波进行惯性导航***、卫星导航***与磁传感器信息的融合，计算载体真北角；
导航模块，其被配置为根据所得到的载体真北角，计算载体航向角，实现融合磁导航信息的INS/GNSS组合导航。
根据一些实施例，本发明的第三方案提供了一种计算机可读存储介质，采用如下技术方案：
一种计算机可读存储介质，其上存储有程序，该程序被处理器执行时实现如本发明第一方案所述的融合磁导航信息的INS/GNSS组合导航方法中的步骤。
根据一些实施例，本发明的第四方案提供了一种电子设备，采用如下技术方案：
一种电子设备，包括存储器、处理器及存储在存储器上并可在处理器上运行的程序，所述处理器执行所述程序时实现如本发明第一方案所述的融合磁导航信息的INS/GNSS组合导航方法中的步骤。
与现有技术相比，本发明的有益效果为：
本发明利用高精度INS/GNSS组合导航***解算得到的位置信息和载体姿态信息，解决磁传感器在实际校正过程中，因无法提供精确的基准地磁场信息、无法进行复杂的操作和在线运行等复杂环境下无法完成校正操作造成的性能和精度的损失；根据位置信息查询国际地磁参考场（International Geomagnetic Reference Field，简称IGRF）标准地磁模型获取精确的基准地磁场信息，利用姿态信息进行坐标系变换从而获取更多的校正信息，完成对磁传感器的一些误差参数进行实时校正，将得到的校正参数对磁传感器进行补偿，以此得到磁航向角用于增加***航向角的冗余信息，以此提升***磁传感器的性能和精度。
附图说明
构成本实施例的一部分的说明书附图用来提供对本实施例的进一步理解，本实施例的示意性实施例及其说明用于解释本实施例，并不构成对本实施例的不当限定。
图1为本发明实施例一中的融合磁导航信息的INS/GNSS组合导航方法的流程图；
图2为本发明实施例一中的磁传感器计测量原理图；
图3为本发明实施例二中的融合磁导航信息的INS/GNSS组合导航***的结构框图。
具体实施方式
下面结合附图与实施例对本发明作进一步说明。
应该指出，以下详细说明都是示例性的，旨在对本申请提供进一步的说明。除非另有指明，本文使用的所有技术和科学术语具有与本申请所属技术领域的普通技术人员通常理解的相同含义。
需要注意的是，这里所使用的术语仅是为了描述具体实施方式，而非意图限制根据本发明的示例性实施方式。如在这里所使用的，除非上下文另外明确指出，否则单数形式也意图包括复数形式，此外，还应当理解的是，当在本说明书中使用术语“包含”和/或“包括”时，其指明存在特征、步骤、操作、器件、组件和/或它们的组合。
在本发明中，术语如“上”、“下”、“左”、“右”、“前”、“后”、“竖直”、“水平”、“侧”、“底”等指示的方位或位置关系为基于附图所示的方位或位置关系，只是为了便于叙述本发明各部件或元件结构关系而确定的关系词，并非特指本发明中任一部件或元件，不能理解为对本发明的限制。
在不冲突的情况下，本发明中的实施例及实施例中的特征可以相互组合。
实施例一
本发明实施例一介绍了一种融合磁导航信息的INS/GNSS组合导航方法。
如图1所示的一种融合磁导航信息的INS/GNSS组合导航方法，包括：
采用平面校准法进行磁传感器的粗校准，得到磁传感器信息，其中，所得到的磁传感器信息包括磁传感器水平轴向的零偏和尺度因子；
基于卡尔曼滤波进行惯性导航***、卫星导航***与磁传感器信息的融合，计算载体真北角；
根据所得到的载体真北角，计算载体航向角，实现融合磁导航信息的INS/GNSS组合导航。
作为一种或多种实施方式，利用平面校准算法对磁传感器进行粗校准。将导航设备与载体捷联安装好之后，在水平面进行旋转进行采集校准数据，求出磁传感器水平轴向的零偏和尺度因子，即：
，/>；
令，/>；其中/>、/>、/>、/>分别是磁传感器采集到的校准数据的最小值和最大值，/>和/>分别对应平面校准得到的X轴向和Y轴向的零偏信息，/>和/>对应着X轴向和Y轴向的尺度因子。
作为一种或多种实施方式，在低精度惯导/卫星/地磁组合导航***中，选择惯导***的姿态失准角、速度误差、定位误/>、陀螺相关漂移/>、加速度计相关偏值/>、航向角偏差/>，以及磁传感器尺度因子/>(共17维)，如下：；
则***状态空间模型为：
；
量测矩阵信息选取磁力计的预测值与根据地磁模型得到的真是地磁场信息的差，则表示如下：
；
量测矩阵可以表示为：
；
其中，表示从导航系b到导航系n的坐标变换矩阵，即：/>。
作为一种或多种实施方式，利用磁传感器信息计算载体真北角信息。如图2所示，假设磁传感器的X轴指向前方，Y轴水平向右且与X轴垂直，Z轴方向垂直向下，采集磁传感器输出数据。根据所得到的地磁场信息矢量、姿态信息，求出根据磁传感器计算得到的载体真北角信息/>。假设磁传感器的X轴指向前方，Y轴水平向右且与X轴垂直，Z轴方向垂直向下。同时假设X轴为载体前进的方向，将载体前进的方向与磁北的夹角定义为磁航向角/>，将载体前进的方向与真北的夹角定义为航向角，记为/>；即：；
其中，为磁偏角，表示地磁场矢量在水平面的投影与地理北向的夹角；磁航向角/>可表示为/>；其中，/>，；/>表示经过校正后磁场矢量在y轴方向的分量；表示磁场矢量经过校正后在x轴方向的分量。
本实施例利用平面校准算法对磁传感器进行粗校准，补偿水平轴的零偏误差和灵敏度；基于Kalman滤波的方式将惯导、卫导和磁传感器信息进行融合；在Kalman滤波过程中将求出的灵敏度因子补偿到磁传感器中，进行结算真北角；以此得到磁航向角用于增加***航向角的冗余信息，以此提升***磁传感器的性能和精度。
本实施例中的各功能模块相互不影响，正常工作时，通过对各个模块及其观测信息的合理配合和使用，把多传感器在空间或时间上冗余或互补信息依据需求来进行组合，以获得整个***最大的性能收益和应对复杂环境的鲁棒性。基于Kalman滤波的方式将INS/GNSS与磁传感器进行融合，利用惯导***解决卫导由于卫星信号失锁造成的无法定位的问题，利用磁传感器解决惯导***由于长时间无法修正造成的姿态角发散问题，在提升组合导航的稳定性的同时，也提升了磁传感器的工程实用性。
实施例二
本发明实施例二介绍了一种融合磁导航信息的INS/GNSS组合导航***。
如图3所示的一种融合磁导航信息的INS/GNSS组合导航***，包括：
校准模块，其被配置为采用平面校准法进行磁传感器的粗校准，得到磁传感器信息，其中，所得到的磁传感器信息包括磁传感器水平轴向的零偏和尺度因子；
融合模块，其被配置为基于卡尔曼滤波进行惯性导航***、卫星导航***与磁传感器信息的融合，计算载体真北角；
导航模块，其被配置为根据所得到的载体真北角，计算载体航向角，实现融合磁导航信息的INS/GNSS组合导航。
详细步骤与实施例一提供的融合磁导航信息的INS/GNSS组合导航方法相同，在此不再赘述。
实施例三
本发明实施例三提供了一种计算机可读存储介质。
一种计算机可读存储介质，其上存储有程序，该程序被处理器执行时实现如本发明实施例一所述的融合磁导航信息的INS/GNSS组合导航方法中的步骤。
详细步骤与实施例一提供的融合磁导航信息的INS/GNSS组合导航方法相同，在此不再赘述。
实施例四
本发明实施例四提供了一种电子设备。
一种电子设备，包括存储器、处理器及存储在存储器上并可在处理器上运行的程序，所述处理器执行所述程序时实现如本发明实施例一所述的融合磁导航信息的INS/GNSS组合导航方法中的步骤。
详细步骤与实施例一提供的融合磁导航信息的INS/GNSS组合导航方法相同，在此不再赘述。
以上所述仅为本实施例的优选实施例而已，并不用于限制本实施例，对于本领域的技术人员来说，本实施例可以有各种更改和变化。凡在本实施例的精神和原则之内，所作的任何修改、等同替换、改进等，均应包含在本实施例的保护范围之内。
Claims (10)
1.一种融合磁导航信息的INS/GNSS组合导航方法，其特征在于，包括：
采用平面校准法进行磁传感器的粗校准，得到磁传感器信息，其中，所得到的磁传感器信息包括磁传感器水平轴向的零偏和尺度因子；
基于卡尔曼滤波进行惯性导航***、卫星导航***与磁传感器信息的融合，计算载体真北角；
根据所得到的载体真北角，计算载体航向角，实现融合磁导航信息的INS/GNSS组合导航。
2.如权利要求1中所述的一种融合磁导航信息的INS/GNSS组合导航方法，其特征在于，将卫星导航***的位置信息、速度信息与惯性导航***的位置信息、速度信息，以及通过惯性导航***姿态信息中的航向角信息与基于磁传感器得到的真北角之差分别作为卡尔曼滤波的测量信息，结合卡尔曼滤波，完成信息融合。
3.如权利要求2中所述的一种融合磁导航信息的INS/GNSS组合导航方法，其特征在于，在信息融合的过程中，将磁传感器误差模型中的灵敏度因子作为卡尔曼滤波方程中的状态矢量的一个待估计参数，通过滤波迭代得到所述灵敏度因子。
4.如权利要求1中所述的一种融合磁导航信息的INS/GNSS组合导航方法，其特征在于，利用磁传感器信息计算载体真北角信息；假设磁传感器的X轴指向前方，Y轴水平向右且与X轴垂直，Z轴方向垂直向下，采集磁传感器输出数据；根据所得到的地磁场信息矢量和姿态信息，求出根据磁传感器计算得到的载体真北角信息。
5.如权利要求4中所述的一种融合磁导航信息的INS/GNSS组合导航方法，其特征在于，所述载体航向角为/>；其中，/>为磁偏角，表示地磁场矢量在水平面的投影与地理北向的夹角；/>为磁航向角，即载体前进方向与载体真北角之间的夹角，；其中，/>，/>；表示经过校正后磁场矢量在y轴方向的分量；/>表示磁场矢量经过校正后在x轴方向的分量。
6.如权利要求1中所述的一种融合磁导航信息的INS/GNSS组合导航方法，其特征在于，在采用平面校准法进行磁传感器的粗校准的过程中，通过水平面的旋转进行校准数据的采集，得到磁传感器水平轴向的零偏和尺度因子；即，；令/>，/>；其中/>、/>、/>、分别是磁传感器采集到的校准数据的最小值和最大值，/>和/>分别对应平面校准得到的X轴向和Y轴向的零偏信息，/>和/>对应着X轴向和Y轴向的尺度因子。
7.如权利要求1中所述的一种融合磁导航信息的INS/GNSS组合导航方法，其特征在于，所述惯性导航***的信息至少包括姿态失准角、速度误差、定位误、陀螺相关漂移、加速度计偏值、航向角偏差和磁传感器尺度因子。
8.一种融合磁导航信息的INS/GNSS组合导航***，其特征在于，包括：
校准模块，其被配置为采用平面校准法进行磁传感器的粗校准，得到磁传感器信息，其中，所得到的磁传感器信息包括磁传感器水平轴向的零偏和尺度因子；
融合模块，其被配置为基于卡尔曼滤波进行惯性导航***、卫星导航***与磁传感器信息的融合，计算载体真北角；
导航模块，其被配置为根据所得到的载体真北角，计算载体航向角，实现融合磁导航信息的INS/GNSS组合导航。
9.一种计算机可读存储介质，其上存储有计算机程序，其特征在于，该程序被处理器执行时实现了如权利要求1-7任一项所述的融合磁导航信息的INS/GNSS组合导航方法的步骤。
10.一种电子设备，包括存储器、处理器及存储在存储器上并可在处理器上运行的计算机程序，其特征在于，所述处理器执行所述程序时实现了如权利要求1-7任一项所述的融合磁导航信息的INS/GNSS组合导航方法的步骤。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN202311548722.6A CN117268372B (zh) | 2023-11-21 | 2023-11-21 | 融合磁导航信息的ins/gnss组合导航方法和*** |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN202311548722.6A CN117268372B (zh) | 2023-11-21 | 2023-11-21 | 融合磁导航信息的ins/gnss组合导航方法和*** |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| CN117268372A true CN117268372A (zh) | 2023-12-22 |
| CN117268372B CN117268372B (zh) | 2024-02-20 |
Family
ID=89218026
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN202311548722.6A Active CN117268372B (zh) | 2023-11-21 | 2023-11-21 | 融合磁导航信息的ins/gnss组合导航方法和*** |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN117268372B (zh) |
Cited By (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN117686952A (zh) * | 2024-02-02 | 2024-03-12 | 北京理工大学前沿技术研究院 | 一种基于多磁传感器联合进行平面校正的方法和*** |
Citations (7)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US5617317A (en) * | 1995-01-24 | 1997-04-01 | Honeywell Inc. | True north heading estimator utilizing GPS output information and inertial sensor system output information |
| CN109556632A (zh) * | 2018-11-26 | 2019-04-02 | 北方工业大学 | 一种基于卡尔曼滤波的ins/gnss/偏振/地磁组合导航对准方法 |
| WO2021208190A1 (zh) * | 2020-04-14 | 2021-10-21 | 上海华测导航技术股份有限公司 | 导航板卡、用于导航板卡的多源数据融合方法以及运载体 |
| CN114877881A (zh) * | 2022-04-11 | 2022-08-09 | 浙江华奕航空科技有限公司 | 一种无人机航向角测量数据的融合方法及融合*** |
| CN115507849A (zh) * | 2022-11-22 | 2022-12-23 | 北京理工大学前沿技术研究院 | 一种基于ins/gnss组合导航辅助的磁传感器校正方法和*** |
| CN115900770A (zh) * | 2023-02-14 | 2023-04-04 | 北京理工大学前沿技术研究院 | 一种机载环境下磁传感器的在线校正方法和*** |
| CN116222551A (zh) * | 2022-11-25 | 2023-06-06 | 宜昌测试技术研究所 | 一种融合多种数据的水下导航方法及装置 |
-
2023
- 2023-11-21 CN CN202311548722.6A patent/CN117268372B/zh active Active
Patent Citations (7)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US5617317A (en) * | 1995-01-24 | 1997-04-01 | Honeywell Inc. | True north heading estimator utilizing GPS output information and inertial sensor system output information |
| CN109556632A (zh) * | 2018-11-26 | 2019-04-02 | 北方工业大学 | 一种基于卡尔曼滤波的ins/gnss/偏振/地磁组合导航对准方法 |
| WO2021208190A1 (zh) * | 2020-04-14 | 2021-10-21 | 上海华测导航技术股份有限公司 | 导航板卡、用于导航板卡的多源数据融合方法以及运载体 |
| CN114877881A (zh) * | 2022-04-11 | 2022-08-09 | 浙江华奕航空科技有限公司 | 一种无人机航向角测量数据的融合方法及融合*** |
| CN115507849A (zh) * | 2022-11-22 | 2022-12-23 | 北京理工大学前沿技术研究院 | 一种基于ins/gnss组合导航辅助的磁传感器校正方法和*** |
| CN116222551A (zh) * | 2022-11-25 | 2023-06-06 | 宜昌测试技术研究所 | 一种融合多种数据的水下导航方法及装置 |
| CN115900770A (zh) * | 2023-02-14 | 2023-04-04 | 北京理工大学前沿技术研究院 | 一种机载环境下磁传感器的在线校正方法和*** |
Non-Patent Citations (3)
| Title |
|---|
| 张京;陈度;王书茂;禹振军;伟利国;贾全;: "农机INS/GNSS组合导航***航向信息融合方法", 农业机械学报, no. 1 * |
| 杜小菁;陈洪;王欣;李怀建;: "基于SINS解算的行人导航技术发展综述", 战术导弹技术, no. 01 * |
| 杜英;李杰;孔祥雷;王博;于希宁;: "无航向基准条件下电子罗盘的误差补偿方法研究", 传感技术学报, no. 09 * |
Cited By (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN117686952A (zh) * | 2024-02-02 | 2024-03-12 | 北京理工大学前沿技术研究院 | 一种基于多磁传感器联合进行平面校正的方法和*** |
| CN117686952B (zh) * | 2024-02-02 | 2024-05-03 | 北京理工大学前沿技术研究院 | 一种基于多磁传感器联合进行平面校正的方法和*** |
Also Published As
| Publication number | Publication date |
|---|---|
| CN117268372B (zh) | 2024-02-20 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN109269471B (zh) | 一种新型gnss接收机倾斜测量***及方法 | |
| CN109931926B (zh) | 一种基于站心坐标系的小型无人机无缝自主式导航方法 | |
| CN106647791B (zh) | 三维姿态测控装置、机械设备及三维姿态的测控方法 | |
| CN111323050B (zh) | 一种捷联惯导和多普勒组合***标定方法 | |
| Xiong et al. | G-VIDO: A vehicle dynamics and intermittent GNSS-aided visual-inertial state estimator for autonomous driving | |
| CN111102978A (zh) | 一种车辆运动状态确定的方法、装置及电子设备 | |
| CN117268372B (zh) | 融合磁导航信息的ins/gnss组合导航方法和*** | |
| Wang et al. | A quasi-Newton quaternions calibration method for DVL error aided GNSS | |
| CN109443349A (zh) | 一种姿态航向测量***及其融合方法、存储介质 | |
| CN115507849B (zh) | 一种基于ins/gnss组合导航辅助的磁传感器校正方法和*** | |
| CN115900770B (zh) | 一种机载环境下磁传感器的在线校正方法和*** | |
| CN110017837A (zh) | 一种姿态抗磁干扰的组合导航方法 | |
| CN109931955A (zh) | 基于状态相关李群滤波的捷联惯性导航***初始对准方法 | |
| WO2022160391A1 (zh) | 磁力计信息辅助的mems陀螺仪标定方法及标定*** | |
| CN116817896B (zh) | 一种基于扩展卡尔曼滤波的姿态解算方法 | |
| CN113834483A (zh) | 一种基于可观测度的惯性/偏振/地磁容错导航方法 | |
| Colomina et al. | Redundant IMUs for precise trajectory determination | |
| Chu et al. | Performance comparison of tight and loose INS-Camera integration | |
| CN111141285B (zh) | 一种航空重力测量装置 | |
| CN116753953A (zh) | 一种基于视觉的无人机组合导航方法 | |
| CN110954137A (zh) | 一种惯导加速度计装配误差标量修正的方法 | |
| CN115930959A (zh) | 视觉初始化方法、装置及飞行汽车 | |
| CN112683265B (zh) | 一种基于快速iss集员滤波的mimu/gps组合导航方法 | |
| CN114895340A (zh) | 双天线gnss/ins组合导航***的定位方法和装置 | |
| CN114413893A (zh) | 一种融合惯性测量信息的动态位置、姿态同步的测量方法 |
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 |