CN109631939B - 一种基于磁强计和加速度计的快速对准方法 - Google Patents

一种基于磁强计和加速度计的快速对准方法 Download PDF

Info

Publication number
CN109631939B
CN109631939B CN201811327470.3A CN201811327470A CN109631939B CN 109631939 B CN109631939 B CN 109631939B CN 201811327470 A CN201811327470 A CN 201811327470A CN 109631939 B CN109631939 B CN 109631939B
Authority
CN
China
Prior art keywords
matrix
magnetometer
accelerometer
calculating
attitude
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
Application number
CN201811327470.3A
Other languages
English (en)
Other versions
CN109631939A (zh
Inventor
崔莅杭
谌浩然
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Hubei Sanjiang Aerospace Hongfeng Control Co Ltd
Original Assignee
Hubei Sanjiang Aerospace Hongfeng Control Co Ltd
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Hubei Sanjiang Aerospace Hongfeng Control Co Ltd filed Critical Hubei Sanjiang Aerospace Hongfeng Control Co Ltd
Priority to CN201811327470.3A priority Critical patent/CN109631939B/zh
Publication of CN109631939A publication Critical patent/CN109631939A/zh
Application granted granted Critical
Publication of CN109631939B publication Critical patent/CN109631939B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C25/00Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass
    • G01C25/005Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass initial alignment, calibration or starting-up of inertial devices

Landscapes

  • Engineering & Computer Science (AREA)
  • Manufacturing & Machinery (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Navigation (AREA)

Abstract

本发明的一种基于磁强计和加速度计的快速对准方法,其依据上一时刻的姿态矩阵以及三轴磁强计和三轴加速度计的测量值计算量测矩阵;依据上一时刻的姿态矩阵、当地地理坐标系下的地球磁场强度的反对称矩阵和地球重力加速度的反对称矩阵计算量测模型矩阵;采用迭代最小二乘估计或单次最小二乘估计计算旋转矢量;依据旋转矢量计算旋转矩阵和当前时刻的姿态矩阵;根据当前时刻的姿态矩阵解算出载体当前俯仰角、横滚角及航向角,从而实现基于磁强计和加速度计的低精度惯性导航系统的快速对准。

Description

一种基于磁强计和加速度计的快速对准方法
技术领域
本发明属于惯性导航技术领域,具体涉及一种基于磁强计和加速度计的快速对准方法。
背景技术
惯性导航系统是一种不依赖于外部信息、也不向外部辐射能量的自主式导航系统。其工作环境不仅包括空中、地面,还可以在水下。惯导的基本工作原理是以牛顿力学定律为基础,通过测量载体在惯性参考系的加速度及角速度,将它们对时间进行积分,且把它们变换到导航坐标系中,就能够得到在导航坐标系中的速度、偏航角和位置等信息。
陀螺仪和加速度计是惯性导航系统中不可缺少的核心测量器件。高精度的惯性导航系统对所采用的陀螺仪和加速度计提出了很高的要求,而低精度惯性导航系统因惯性器件精度低无法采用陀螺自对准方法,一般采用磁强计和加速度计进行对准解算,并利用初始对准为惯性导航系统提供初始姿态航向。
在低精度惯性导航系统中,现有的对准方法一般采用磁强计和加速度计进行对准解算,并利用初始对准为惯性导航系统提供初始姿态航向,然而其对准精度和对准时间存在矛盾,缩短对准时间会降低对准精度,提高对准精度需要延长对准时间,因而其无法实现在保证对准精度的前提下减少对准时间。
发明内容
针对现有技术的以上缺陷或改进需求,本发明提供了一种基于磁强计和加速度计的快速对准方法,其依据上一时刻的姿态矩阵以及三轴磁强计和三轴加速度计的测量值计算量测矩阵;依据上一时刻的姿态矩阵、当地地理坐标系下的地球磁场强度的反对称矩阵和地球重力加速度的反对称矩阵计算量测模型矩阵;采用迭代最小二乘估计或单次最小二乘估计计算旋转矢量;依据旋转矢量计算旋转矩阵和当前时刻的姿态矩阵;根据当前时刻的姿态矩阵解算出载体当前俯仰角、横滚角及航向角,从而在确保对准精度的前提下实现基于磁强计和加速度计的低精度惯性导航系统的快速对准。
为实现上述目的,按照本发明的一个方面,提供了一种基于磁强计和加速度计的快速对准方法,具体步骤为:
S1.依据上一时刻的姿态矩阵以及三轴磁强计和三轴加速度计的测量值计算量测矩阵;
S2.依据上一时刻的姿态矩阵、当地地理坐标系下的地球磁场强度的反对称矩阵和地球重力加速度的反对称矩阵计算量测模型矩阵;
S3.当前计算次数t大于预设的计算次数阈值n时,采用迭代最小二乘估计并利用量测矩阵和量测模型矩阵计算旋转矢量;否则采用单次最小二乘估计并利用量测矩阵和量测模型矩阵计算旋转矢量;
S4.依据旋转矢量计算旋转矩阵和当前时刻的姿态矩阵;
S5.根据当前时刻的姿态矩阵解算出载体当前俯仰角、横滚角及航向角,从而在确保对准精度的前提下实现基于磁强计和加速度计的低精度惯性导航系统的快速对准。
作为本发明的进一步改进,当前计算次数t的计算方法为:初始时刻设置为t=0,间隔一个预设的采样周期计算次数t增加一次,从t=1开始计算载体当前俯仰角、横滚角及航向角信息。
作为本发明的进一步改进,步骤S1具体为:
选择东北天当地地理坐标系作为导航坐标系,载体坐标系三个轴系定义为载体右-前-上,旋转顺序为3-1-2;
间隔一个预设的采样周期利用三轴磁强计和三轴加速度计采集当前时刻载体的磁强计信息M(t)和加速度计信息Acc(t);
计算载体坐标系下的地球磁场强度投影Mb(t):
Figure BDA0001859109990000021
计算载体坐标系下的地球重力加速度投影Accb(t):
Figure BDA0001859109990000022
其中,b表示载体坐标系,n表示导航坐标系;其中
Figure BDA0001859109990000023
为上一时刻姿态矩阵
Figure BDA0001859109990000031
的转置矩阵,
Figure BDA0001859109990000032
表示当前时刻的姿态矩阵,初始值设置为
Figure BDA0001859109990000033
Mn为当地地球磁场强度;g为当地地球重力加速度;
依据磁强计信息M(t)、载体坐标系下的地球磁场强度投影Mb(t)、加速度计信息Acc(t)和载体坐标系下的地球重力加速度投影Accb(t)计算出量测矩阵Z(t):
Figure BDA0001859109990000034
作为本发明的进一步改进,步骤S2具体为:
当地地理坐标系下的地球磁场强度的反对称矩阵Mn(×)为:
Figure BDA0001859109990000035
当地地理坐标系下的地球重力加速度的反对称矩阵Accn(×)为:
Figure BDA0001859109990000036
依据上一时刻的姿态矩阵
Figure BDA0001859109990000037
当地地理系下的地球磁场强度的反对称矩阵Mn(×)和地球重力加速度的反对称矩阵Accn(×)计算量测模型矩阵H(t),
Figure BDA0001859109990000038
作为本发明的进一步改进,步骤S3具体为:
t<n时,采用单次最小二乘估计计算姿态旋转矢量φ(t)为:
φ(t)=[HT(t)*H(t)]-1*HT(t)*Z(t)
其中,HT(t)为量测模型矩阵H(t)的转置矩阵;
t≥n时,采用迭代最小二乘估计计算旋转矢量φ(t)为:依据前一时刻的增益矩阵K(t-1)、姿态等效旋转矢量φ(t-1)和估计误差协方差阵P(t-1)依次计算当前时刻的增益矩阵K(t)、姿态等效旋转矢量φ(t)和估计误差协方差阵P(t),表达式为:
K(t)=P(t-1)*HT(t)*[H(t)*P(t-1)*HT(t)+R]-1
φ(t)=K(t)*[Z(t)-K(t)*H(t)]*P(t-1)
Figure BDA0001859109990000041
其中,P(t)初始值设置为
Figure BDA0001859109990000042
R表示量测噪声阵,其为对角线矩阵且其对角线的值分别为三轴磁强计的三个磁强计精度值和三轴加速度计的三个加速度计精度值。
作为本发明的进一步改进,步骤S4具体为:
旋转矩阵C1(t)为:
Figure BDA0001859109990000043
其中,|φ(t)|为旋转矢量φ(t)的模值;φ(t)×为旋转矢量φ(t)的反对称矩阵;
作为本发明的进一步改进,步骤S5具体为:
载体当前俯仰角为:
Figure BDA0001859109990000044
载体当前横滚角为:
Figure BDA0001859109990000045
载体当前航向角为:
Figure BDA0001859109990000046
其中,
Figure BDA0001859109990000047
为当前时刻的姿态矩阵
Figure BDA0001859109990000048
的第i行第j项。
总体而言,通过本发明所构思的以上技术方案与现有技术相比,具有以下有益效果:
本发明的一种基于磁强计和加速度计的快速对准方法,其依据上一时刻的姿态矩阵以及三轴磁强计和三轴加速度计的测量值计算量测矩阵;依据上一时刻的姿态矩阵、当地地理坐标系下的地球磁场强度的反对称矩阵和地球重力加速度的反对称矩阵计算量测模型矩阵;采用迭代最小二乘估计或单次最小二乘估计计算旋转矢量;依据旋转矢量计算旋转矩阵和当前时刻的姿态矩阵;根据当前时刻的姿态矩阵解算出载体当前俯仰角、横滚角及航向角,从而在确保对准精度的前提下实现基于磁强计和加速度计的低精度惯性导航系统的快速对准。
本发明的一种基于磁强计和加速度计的快速对准方法,以三轴磁强计和三轴加速度计为基本数据传感器,依据不同计算周期分别采用单次最小二乘估计和迭代最小二乘估计计算姿态旋转矢量,确保实现姿态旋转矢量迭代算法的收敛速度和稳定性,从而能够快速获得载体姿态、航向信息,实现低精度惯性导航领域的快速对准。
本发明的一种基于磁强计和加速度计的快速对准方法,先用东北天当地地理坐标系为导航坐标系,通过计算载体坐标系下的地球磁场强度投影和重力加速度投影从而计算出量测矩阵,通过计算当地地理坐标系下的地球磁场强度投影和重力加速度投影从而计算出量测模型矩阵,从而进一步确保姿态旋转矢量迭代算法的实现,具有较高的工程化应用价值和推广价值。
附图说明
图1为本发明实施例的一种基于磁强计和加速度计的快速对准方法的示意图;
图2为本发明实施例的一种基于磁强计和加速度计的快速对准方法与传统对准方法的航向角对比示意图;
图3为本发明实施例的一种基于磁强计和加速度计的快速对准方法与传统对准方法的俯仰角对比示意图;
图4为本发明实施例的一种基于磁强计和加速度计的快速对准方法与传统对准方法的横滚角对比示意图。
具体实施方式
为了使本发明的目的、技术方案及优点更加清楚明白,以下结合附图及实施例,对本发明进行进一步详细说明。应当理解,此处所描述的具体实施例仅用以解释本发明,并不用于限定本发明。
此外,下面所描述的本发明各个实施方式中所涉及到的技术特征只要彼此之间未构成冲突就可以相互组合。下面结合具体实施方式对本发明进一步详细说明。
图1为本发明实施例的一种基于磁强计和加速度计的快速对准方法的示意图。如图1所示,该方法具体步骤如下:
S1.根据上一时刻的姿态矩阵以及三轴磁强计和三轴加速度计的测量值计算量测矩阵;
首先,选择东北天当地地理坐标系作为导航坐标系,载体坐标系三个轴系定义为载体右-前-上,旋转顺序为3-1-2。利用三轴磁强计和三轴加速度计采集当前时刻载体的磁强计信息M(t)和加速度计信息Acc(t),其中,t为当前迭代解算次数;
当前计算次数t的计算方法为:初始时刻设置为t=0,间隔一个预设的采样周期计算次数t增加一次,从t=1开始计算载体当前俯仰角、横滚角及航向角信息。
将地球磁场强度在当地地理坐标系下的投影转换为载体坐标系下的地球磁场强度投影Mb(t),具体为:
Figure BDA0001859109990000061
其中,b表示载体坐标系,n表示导航坐标系;其中
Figure BDA0001859109990000062
为上一时刻姿态矩阵
Figure BDA0001859109990000063
的转置矩阵,
Figure BDA0001859109990000064
初始值(t=0)设置为
Figure BDA0001859109990000065
Mn为当地地球磁场强度;
将地球重力加速度在当地地理坐标系下的投影转换为载体坐标系下的地球重力加速度投影Accb(t),具体为:
Figure BDA0001859109990000066
其中,
Figure BDA0001859109990000067
为上一时刻姿态矩阵
Figure BDA0001859109990000068
的转置矩阵,
Figure BDA0001859109990000069
初始值(t=0)设置为
Figure BDA00018591099900000610
g为当地地球重力加速度;
(1d)依据磁强计信息M(t)、当地地理坐标系下的地球磁场强度投影Mb(t)、加速度计信息Acc(t)和当地地理坐标系下的地球重力加速度投影Accb(t)计算出量测矩阵Z(t),Z(t)具体为:
Figure BDA0001859109990000071
S2.依据上一时刻的姿态矩阵、当地地理坐标系下的地球磁场强度的反对称矩阵和地球重力加速度的反对称矩阵计算量测模型矩阵;
当地地理坐标系下的地球磁场强度的反对称矩阵Mn(×)具体为:
Figure BDA0001859109990000072
当地地理坐标系下的地球重力加速度的反对称矩阵Accn(×)具体为:
Figure BDA0001859109990000073
依据上一时刻的姿态矩阵
Figure BDA0001859109990000074
当地地理系下的地球磁场强度的反对称矩阵Mn(×)和地球重力加速度的反对称矩阵Accn(×)计算量测模型矩阵量测模型矩阵H(t),具体为:
Figure BDA0001859109990000075
S3.当前计算次数t大于预设的计算次数阈值n时,采用迭代最小二乘估计并利用量测矩阵和量测模型矩阵计算旋转矢量;否则,采用单次最小二乘估计并利用量测矩阵和量测模型矩阵计算旋转矢量,具体为:
作为一个优选的实施例,预设的计算次数阈值为n=10;
当t<10时,采用单次最小二乘估计计算姿态旋转矢量φ(t)为:
φ(t)=[HT(t)*H(t)]-1*HT(t)*Z(t)
其中,HT(t)为量测模型矩阵H(t)的转置矩阵;
当t≥10时,采用迭代最小二乘估计计算旋转矢量φ(t)为:依据前一时刻的增益矩阵K(t-1)、姿态等效旋转矢量φ(t-1)和估计误差协方差阵P(t-1)依次计算当前时刻的增益矩阵K(t)、姿态等效旋转矢量φ(t)和估计误差协方差阵P(t),
K(t)=P(t-1)*HT(t)*[H(t)*P(t-1)*HT(t)+R]-1
φ(t)=K(t)*[Z(t)-K(t)*H(t)]*P(t-1)
Figure BDA0001859109990000081
其中,P(t)初始值(t=9)设置为
Figure BDA0001859109990000082
量测噪声阵R阵位对角线矩阵,对角线的值分别为三个磁强计精度值和三个加速度计精度值。
单次最小二乘算法能够快速收敛但稳定性较差,而迭代最小二乘估计收敛速度慢,但稳定性好,因而依据不同计算周期分别采用单次最小二乘估计和迭代最小二乘估计计算姿态旋转矢量,确保实现迭代算法的收敛速度和稳定性,从而能够快速获得载体姿态、航向信息,实现低精度惯性导航在确保对准精度的前提下的快速对准。
S4.依据旋转矢量φ(t)计算旋转矩阵C1(t)和当前时刻姿态矩阵
Figure BDA0001859109990000087
具体为:
旋转矩阵C1(t)为:
Figure BDA0001859109990000083
其中,|φ(t)|为旋转矢量φ(t)的模值;
当前时刻的姿态矩阵为
Figure BDA0001859109990000084
为:
Figure BDA0001859109990000085
S5.根据当前时刻的姿态矩阵
Figure BDA0001859109990000086
解算出载体当前俯仰角pitch(t)、横滚角roll(t)及航向角yaw(t)的信息,从而在确保对准精度的前提下实现基于磁强计和加速度计的低精度惯性导航系统的快速对准。具体为:
载体当前俯仰角为:
Figure BDA0001859109990000091
载体当前横滚角为:
Figure BDA0001859109990000092
载体当前航向角为:
Figure BDA0001859109990000093
其中,
Figure BDA0001859109990000094
为当前时刻的姿态矩阵
Figure BDA0001859109990000095
的第i行第j项。
图2、图3和图4分别为本发明实施例的一种基于磁强计和加速度计的快速对准方法与传统对准方法的航向角、俯仰角和横滚角对比示意图。如图2、3和4所示,航向角、俯仰角、横滚角的基准分别为90°、45°和45°,采用本发明所述的快速对准方法三个姿态在5s可收敛到航向角、俯仰角、横滚角的误差0.2°以内,而传统对准方法最大要20s才能收敛到航向角、俯仰角、横滚角的误差0.2°以内。其中,传统对准方法一般采用均值法,即在一段时间内计算基于磁强计和加速度计的传感器的均值,利用均值进行矢量计算获得对准结果。
综上所述,本发明提供的基于磁强计和加速度计的快速对准方法,以三轴磁强计和三轴加速度计为基本数据传感器,依据不同计算周期分别采用单次最小二乘估计和迭代最小二乘估计计算姿态旋转矢量,从而能够快速获得载体姿态、航向信息,对低精度惯性导航领域的快速对准技术有较大贡献。本发明简单巧妙,符合实际需求,进步显著且实用性强,能够大规模推广使用。
本领域的技术人员容易理解,以上所述仅为本发明的较佳实施例而已,并不用以限制本发明,凡在本发明的精神和原则之内所作的任何修改、等同替换和改进等,均应包含在本发明的保护范围之内。

Claims (7)

1.一种基于磁强计和加速度计的快速对准方法,其特征在于,具体步骤为:
S1.依据上一时刻的姿态矩阵以及三轴磁强计和三轴加速度计的测量值计算量测矩阵;
S2.依据上一时刻的姿态矩阵、当地地理坐标系下的地球磁场强度的反对称矩阵和地球重力加速度的反对称矩阵计算量测模型矩阵;
S3.当前计算次数t大于等于预设的计算次数阈值n时,采用迭代最小二乘估计并利用量测矩阵和量测模型矩阵计算旋转矢量;否则采用单次最小二乘估计并利用量测矩阵和量测模型矩阵计算旋转矢量;
S4.依据旋转矢量计算旋转矩阵和当前时刻的姿态矩阵;
S5.根据当前时刻的姿态矩阵解算出载体当前俯仰角、横滚角及航向角,从而在确保对准精度的前提下实现基于磁强计和加速度计的低精度惯性导航系统的快速对准。
2.根据权利要求1所述的一种基于磁强计和加速度计的快速对准方法,其特征在于,当前计算次数t的计算方法为:初始时刻设置为t=0,间隔一个预设的采样周期计算次数t增加一次,从t=1开始计算载体当前俯仰角、横滚角及航向角信息。
3.根据权利要求2所述的一种基于磁强计和加速度计的快速对准方法,其特征在于,步骤S1具体为:
选择东北天当地地理坐标系作为导航坐标系,载体坐标系三个轴系定义为载体右-前-上,旋转顺序为3-1-2;
间隔一个预设的采样周期利用三轴磁强计和三轴加速度计采集当前时刻载体的磁强计信息M(t)和加速度计信息Acc(t);
计算载体坐标系下的地球磁场强度投影Mb(t):
Figure FDA0002507450200000011
计算载体坐标系下的地球重力加速度投影Accb(t):
Figure FDA0002507450200000021
其中,b表示载体坐标系,n表示导航坐标系;其中
Figure FDA0002507450200000022
为上一时刻姿态矩阵
Figure FDA0002507450200000023
的转置矩阵,
Figure FDA0002507450200000024
表示当前时刻的姿态矩阵,初始值设置为
Figure FDA0002507450200000025
Mn为当地地球磁场强度;g为当地地球重力加速度;
依据磁强计信息M(t)、载体坐标系下的地球磁场强度投影Mb(t)、加速度计信息Acc(t)和载体坐标系下的地球重力加速度投影Accb(t)计算出量测矩阵Z(t):
Figure FDA0002507450200000026
4.根据权利要求3所述的一种基于磁强计和加速度计的快速对准方法,其特征在于,步骤S2具体为:
当地地理坐标系下的地球磁场强度的反对称矩阵Mn(×)为:
Figure FDA0002507450200000027
当地地理坐标系下的地球重力加速度的反对称矩阵Accn(×)为:
Figure FDA0002507450200000028
依据上一时刻的姿态矩阵
Figure FDA0002507450200000029
当地地理系下的地球磁场强度的反对称矩阵Mn(×)和地球重力加速度的反对称矩阵Accn(×)计算量测模型矩阵H(t),
Figure FDA00025074502000000210
5.根据权利要求4所述的一种基于磁强计和加速度计的快速对准方法,其特征在于,步骤S3具体为:
t<n时,采用单次最小二乘估计计算姿态旋转矢量φ(t)为:
φ(t)=[HT(t)*H(t)]-1*HT(t)*Z(t)
其中,HT(t)为量测模型矩阵H(t)的转置矩阵;
当t≥n时,采用迭代最小二乘估计计算旋转矢量φ(t)为:依据前一时刻的增益矩阵K(t-1)、姿态等效旋转矢量φ(t-1)和估计误差协方差阵P(t-1)依次计算当前时刻的增益矩阵K(t)、姿态等效旋转矢量φ(t)和估计误差协方差阵P(t),表达式为:
K(t)=P(t-1)*HT(t)*[H(t)*P(t-1)*HT(t)+R]-1
φ(t)=K(t)*[Z(t)-K(t)*H(t)]*P(t-1)
Figure FDA0002507450200000031
其中,P(t)初始值设置为
Figure FDA0002507450200000032
R表示量测噪声阵,其为对角线矩阵且其对角线的值分别为三轴磁强计的三个磁强计精度值和三轴加速度计的三个加速度计精度值。
6.根据权利要求5所述的一种基于磁强计和加速度计的快速对准方法,其特征在于,步骤S4具体为:
旋转矩阵C1(t)为:
Figure FDA0002507450200000033
其中,|φ(t)|为旋转矢量φ(t)的模值;φ(t)×为旋转矢量φ(t)的反对称矩阵;
当前时刻的姿态矩阵
Figure FDA0002507450200000034
为:
Figure FDA0002507450200000035
7.根据权利要求6所述的一种基于磁强计和加速度计的快速对准方法,其特征在于,步骤S5具体为:
载体当前俯仰角为:
Figure FDA0002507450200000041
载体当前横滚角为:
Figure FDA0002507450200000042
载体当前航向角为:
Figure FDA0002507450200000043
其中,
Figure FDA0002507450200000044
为当前时刻的姿态矩阵
Figure FDA0002507450200000045
的第i行第j项。
CN201811327470.3A 2018-11-08 2018-11-08 一种基于磁强计和加速度计的快速对准方法 Active CN109631939B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201811327470.3A CN109631939B (zh) 2018-11-08 2018-11-08 一种基于磁强计和加速度计的快速对准方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201811327470.3A CN109631939B (zh) 2018-11-08 2018-11-08 一种基于磁强计和加速度计的快速对准方法

Publications (2)

Publication Number Publication Date
CN109631939A CN109631939A (zh) 2019-04-16
CN109631939B true CN109631939B (zh) 2020-07-28

Family

ID=66067601

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201811327470.3A Active CN109631939B (zh) 2018-11-08 2018-11-08 一种基于磁强计和加速度计的快速对准方法

Country Status (1)

Country Link
CN (1) CN109631939B (zh)

Families Citing this family (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN110567491B (zh) * 2019-08-29 2021-10-08 青岛歌尔智能传感器有限公司 惯性导航系统的初始对准方法、装置及电子设备
CN112729222A (zh) * 2020-12-14 2021-04-30 北京航空航天大学 一种桩挖转杆位置的实时测量方法
CN112945271B (zh) * 2021-01-27 2022-12-06 苏州大学 磁力计信息辅助的mems陀螺仪标定方法及标定系统
CN113670334B (zh) * 2021-08-06 2024-02-20 广东汇天航空航天科技有限公司 一种飞行汽车的初始对准方法和装置

Citations (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN103994777A (zh) * 2014-05-08 2014-08-20 西安应用光学研究所 空投物资组合导航装置用空中快速对准方法

Family Cites Families (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101216321A (zh) * 2008-01-04 2008-07-09 南京航空航天大学 捷联惯性导航系统的快速精对准方法
CN101290229A (zh) * 2008-06-13 2008-10-22 哈尔滨工程大学 硅微航姿系统惯性/地磁组合方法
CN101726295B (zh) * 2008-10-24 2011-09-07 中国科学院自动化研究所 考虑加速度补偿和基于无迹卡尔曼滤波的惯性位姿跟踪方法
CN103245360B (zh) * 2013-04-24 2015-09-09 北京工业大学 晃动基座下的舰载机旋转式捷联惯导系统自对准方法
CN105806365B (zh) * 2016-03-15 2019-06-07 北京航空航天大学 一种基于自抗扰控制的车载惯导行进间快速初始对准方法
JP6705972B2 (ja) * 2016-05-20 2020-06-03 サイトセンシング株式会社 姿勢推定装置、姿勢推定方法、制御プログラム、および記録媒体
CN106092098B (zh) * 2016-08-25 2019-01-04 湖北三江航天红峰控制有限公司 一种基于陀螺和倾角仪的载体航姿测量方法
CN107607112A (zh) * 2017-09-13 2018-01-19 哈尔滨工业大学 飞行器用低成本位姿测量装置及测量方法

Patent Citations (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN103994777A (zh) * 2014-05-08 2014-08-20 西安应用光学研究所 空投物资组合导航装置用空中快速对准方法

Also Published As

Publication number Publication date
CN109631939A (zh) 2019-04-16

Similar Documents

Publication Publication Date Title
CN109631939B (zh) 一种基于磁强计和加速度计的快速对准方法
CN108225370B (zh) 一种运动姿态传感器的数据融合与解算方法
CN107063254B (zh) 一种陀螺地磁组合的姿态解算方法
CN103196445B (zh) 基于匹配技术的地磁辅助惯性的载体姿态测量方法
CN110174121A (zh) 一种基于地磁场自适应修正的航姿系统姿态解算方法
CN105910606A (zh) 一种基于角速度差值的方向修正方法
CN103299247A (zh) 用于磁近场的动态追踪及补偿的设备和方法
WO2022160391A1 (zh) 磁力计信息辅助的mems陀螺仪标定方法及标定系统
CN114485641A (zh) 一种基于惯导卫导方位融合的姿态解算方法及装置
CN108871319B (zh) 一种基于地球重力场与地磁场序贯修正的姿态解算方法
CN111189442A (zh) 基于cepf的无人机多源导航信息状态预测方法
CN108489485B (zh) 一种无误差的捷联惯导数值更新方法
JP2019120587A (ja) 測位システム及び測位方法
CN108458709A (zh) 基于视觉辅助测量的机载分布式pos数据融合方法和装置
CN106092098B (zh) 一种基于陀螺和倾角仪的载体航姿测量方法
Guan et al. Sensor fusion of gyroscope and accelerometer for low-cost attitude determination system
CN110514200A (zh) 一种惯性导航系统及高转速旋转体姿态测量方法
CN112284412B (zh) 一种避免欧拉转换奇异导致精度下降的地面静态对准方法
CN113108781A (zh) 一种应用于无人船行进间的改进粗对准算法
CN110375773B (zh) Mems惯导系统姿态初始化方法
CN111649738B (zh) 微重力场下的加速度计初始姿态解算方法
CN110733671B (zh) 一种小天体自旋角速度动力学修正方法
Zhang et al. Research on UAV attitude data fusion algorithm based on quaternion gradient descent
CN114485675A (zh) 无人机航姿解算方法
CN114279396B (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