CN108871319A - 一种基于地球重力场与地磁场序贯修正的姿态解算方法 - Google Patents
一种基于地球重力场与地磁场序贯修正的姿态解算方法 Download PDFInfo
- Publication number
- CN108871319A CN108871319A CN201810384477.2A CN201810384477A CN108871319A CN 108871319 A CN108871319 A CN 108871319A CN 201810384477 A CN201810384477 A CN 201810384477A CN 108871319 A CN108871319 A CN 108871319A
- Authority
- CN
- China
- Prior art keywords
- attitude
- carrier
- matrix
- coordinate system
- earth
- 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
- 238000000034 method Methods 0.000 title claims abstract description 16
- 239000011159 matrix material Substances 0.000 claims abstract description 68
- 230000001133 acceleration Effects 0.000 claims abstract description 32
- 230000005484 gravity Effects 0.000 claims abstract description 27
- 238000005259 measurement Methods 0.000 claims description 23
- 230000009466 transformation Effects 0.000 claims description 8
- 238000001914 filtration Methods 0.000 claims description 7
- 238000004364 calculation method Methods 0.000 claims description 5
- 238000012546 transfer Methods 0.000 claims description 4
- 238000006467 substitution reaction Methods 0.000 claims description 2
- 230000007812 deficiency Effects 0.000 abstract description 2
- 230000005358 geomagnetic field Effects 0.000 abstract description 2
- 238000010586 diagram Methods 0.000 description 9
- 230000000295 complement effect Effects 0.000 description 4
- 238000012986 modification Methods 0.000 description 2
- 230000004048 modification Effects 0.000 description 2
- 238000012795 verification Methods 0.000 description 2
- 230000003044 adaptive effect Effects 0.000 description 1
- 230000001186 cumulative effect Effects 0.000 description 1
- 230000005389 magnetism Effects 0.000 description 1
- 238000002156 mixing 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/04—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by terrestrial means
- G01C21/08—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by terrestrial means involving use of the magnetic field of the earth
Landscapes
- Engineering & Computer Science (AREA)
- Remote Sensing (AREA)
- Radar, Positioning & Navigation (AREA)
- Life Sciences & Earth Sciences (AREA)
- Environmental & Geological Engineering (AREA)
- General Life Sciences & Earth Sciences (AREA)
- Geology (AREA)
- Automation & Control Theory (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Navigation (AREA)
Abstract
本发明提供一种基于地球重力场与地磁场序贯修正的姿态解算方法,其步骤包括如下:(1)根据航姿***中陀螺仪采集的角速率计算***模型的状态转移矩阵,并利用离散化的四元数微分方程更新载体姿态四元数;(2)根据航姿***中加速度计采集的载体重力加速度对步骤(1)中更新得到的姿态四元数由均方误差最小原则进行修正;(3)根据航姿***中磁力计采集的载体地磁场矢量对步骤(2)中修正得到的姿态四元数由均方误差最小原则进行第二次修正。本发明利用地球物理场信息对更新得到的姿态四元数进行了两次序贯最优估计,在该算法中,不需向***提供先验地磁场信息,只需提供先验重力加速度矢量,克服了上述地磁场在应用中的不足。
Description
技术领域
本发明属于定位导航技术领域,具体涉及一种基于地球重力场与地磁场序贯修正的姿态解算方法。
技术背景
航姿参考***(Attitude and Heading Reference System,AHRS)中集成了MEMS传感器(陀螺仪、加速度计、磁力计),其有成本低、集成度高以及体积小等优点,但是在进行姿态解算时,却存在输出噪声过大、零点漂移无法完全消除、角速率输出易受干扰等所导致的姿态解算精度低、累计误差大等问题。因此,通常情况下,需要采用多个传感器经过信息融合算法实现高精度的姿态解算。相较于利用欧拉角进行姿态解算,四元数作为一种非常有用的数学工具,由于其参数少且避免了欧拉角产生的奇异,在现代姿态解算应用中,得到了广泛的应用。地磁场作为地球固有的物理特征,在导航中的应用越来越广泛,但是地磁场易受周围建筑物及钢性结构的影响,在地球表面的不同位置,地磁场矢量各不相同且未知,大大限制的地磁场在导航中的应用。
发明内容
为解决以上技术问题本发明提供一种基于地球重力场与地磁场序贯修正的姿态解算方法。
本发明的技术方案是:一种基于地球重力场与地磁场序贯修正的姿态解算方法,包括如下三个步骤:
(1)根据航姿***(AHRS)中MEMS陀螺仪采集的角速率计算***模型的状态转移矩阵,并利用离散化的四元数微分方程更新载体姿态四元数;
(2)根据航姿***(AHRS)中MEMS加速度计采集的载体重力加速度对步骤(1)中更新得到的姿态四元数由均方误差最小原则进行修正;
(3)根据航姿***(AHRS)中MEMS磁力计采集的载体地磁场矢量对步骤(2)中修正得到的姿态四元数由均方误差最小原则进行第二次修正。
详细地,步骤(1)具体包括:
a.建立陀螺仪动力学模型:
即
其中,X=[X0 X1 X2 X3]T表示全局坐标系G到载体坐标系B的旋转四元数,表示在载体坐标系中测量的MEMS陀螺角速度信息,且
利用四元数微分方程的比卡求解法,使上式离散化可得
其中,Xk-1为tk-1时刻全局坐标系G到载体坐标系B的旋转四元数,Xk为tk时刻全局坐标系G到载体坐标系B的旋转四元数,
且
b.获得载体坐标系B下的载体角速度信息
c.根据所述载体角速度信息计算***状态转移矩阵
c.载体姿态四元数状态一步预测
d.计算***噪声协方差矩阵Qk。
对于MEMS陀螺仪在微小时间间隔Δt,其真实的角增量Δθ°是无法测量的,假设在tk-1时刻到tk时刻的时间间隔内,陀螺仪的实际输出与真实角增量的误差为δθk/k-1,有
其中,Δθk/k-1表示陀螺仪的实际角增量,表示陀螺仪的真实角增量。
相应的,实际状态转移矩阵与真实状态转移矩阵的误差为ΔΦk/k-1,则有
将上式代入步骤a中陀螺仪离散化的动力学模型中,可得
变形为
-δΘk/k-1Xk-1=-Ξ(Xk-1)δθk/k-1
式中
设陀螺仪的输出噪声为ngyro,则有
则***噪声协方差矩阵为:
其中,Σgyro为陀螺仪噪声协方差矩阵。
f.计算姿态四元数状态一步预测均方误差Pk/k-1。
其中,Pk-1表示步骤(3)中的状态估计均方误差。
详细地,步骤(2)具体包括:
a.建立加速度计观测模型:
将三维矢量g与a看作零标量的四元数,则g与a间的变换关系可用四元数乘法表示为
其中,g为在全局坐标系G中测量的重力加速度,a为在载体坐标系B中测量的重力加速度,且满足||g||=||a||=1;表示姿态四元数Xk的逆。
上式经过变换可得
M′(a)Xk-M(g)Xk=0
其中,M′(a)与M(g)表示由零标量的四元数g与a构成的矩阵,如下
b.获得载体坐标系B下的载体重力加速度信息a=[ax ay az]T;
c.根据所述载体重力加速度信息及先验重力加速度计算量测矩阵
d.计算重力加速度量测噪声协方差矩阵Rg′k
设加速度计的输出噪声为nacc,则有
nacc=a-a°
其中,a°表示载体坐标系下加速度计的真实值。
实际量测矩阵与理想量测矩阵误差为
其中,表示理想量测矩阵。
将上式代入步骤a中的加速度计观测模型,可得
0=HgkXk-ΔHgkXk
-ΔHgkXk变形为
其中,
令则量测噪声协方差矩阵为
其中,Σacc为加速度计噪声协方差矩阵。
上式得到的量测噪声协方差矩阵在应用的过程中很有可能是奇异的,为了避免矩阵的奇异,需要对该量测噪声协方差矩阵进行改进,即
Rg′k=Rgk+βgI βg>0
e.计算重力加速度修正的滤波增益Kgk
Kgk=Pk/k-1(Hgk)T(HgkPk/k-1(Hgk)T+Rg′k)-1
f.基于重力加速度的姿态四元数状态估计。
g.基于重力加速度的姿态四元数状态估计均方误差Pgk。
Pgk=(I-KgkHgk)Pk/k-1
详细地,步骤(3)具体包括:
a.建立磁力计观测模型:
把三维矢量h与m看作零标量的四元数,则h与m间的变换关系可用四元数乘法表示为
其中,h为在全局坐标系G中测量的地磁场矢量,m为在载体坐标系B中测量的地磁场矢量,且满足||g||=||a||=1。
上式经过变换可得
M′(m)Xk-M(h)Xk=0
其中,M′(m)与M(h)表示由零标量的四元数h与m构成的矩阵,如下
b.获得载体坐标系B下的载体地磁场矢量信息m=[mx my mz]T;
c.计算先验地磁场矢量h。
全局参考坐标系G的Gz轴选取重力加速度g的反方向,Gx轴选取地磁北极,Gy按照右手法则选取,则先验地磁场矢量h与全局参考坐标系G的GxoGz面重合即h=[hx 0 hy]T,则有
其中,l=[lx ly lz]T表示带有误差的先验地磁场矢量。
则有
式中
Γ=lx 2+ly 2
d.根据所述载体地磁场矢量信息及先验地磁场矢量计算量测矩阵
e.计算地磁场矢量量测噪声协方差矩阵Rm′k。
设磁力计的输出噪声为nmag,则有
nmag=m-m°
其中,m°表示载体坐标系下加速度计的真实值。
实际量测矩阵与理想量测矩阵误差为
其中,表示理想量测矩阵。
把上式代入步骤a中的磁力计观测模型,可得
0=HmkXk-ΔHmkXk
-ΔHmkXk变形为
其中,
令则量测噪声协方差矩阵为
其中,Σmag为磁力计噪声协方差矩阵。
上式得到的量测噪声协方差矩阵在应用的过程中很有可能是奇异的,为了避免矩阵的奇异,需要对该量测噪声协方差矩阵进行改进,即
Rm′k=Rmk+βmI βm>0
f.计算地磁场矢量修正的滤波增益Kmk。
Kmk=Pgk(Hmk)T(HmkPgk(Hmk)T+Rm′k)-1
g.基于地磁场矢量的姿态四元数状态估计。
h.基于地磁场矢量的姿态四元数状态估计均方误差Pmk。
Pmk=(I-KmkHmk)Pgk
其中,I表示单位矩阵。
本发明的优点是:该算法利用地球物理场(地球重力场、地磁场)信息对更新得到的姿态四元数进行了两次序贯最优估计。在该算法中,不需向***提供先验地磁场信息,只需提供先验重力加速度矢量,克服了上述地磁场在应用中的不足。
附图说明
图1是重力加速度矢量在全局坐标系G与载体坐标系B中的示意图;
图2是地磁场矢量在全局坐标系G与载体坐标系B中的示意图;
图3是全局坐标系G的构建示意图;
图4是本发明实施例提供的一种基于地球重力场与地磁场序贯修正的姿态解算方法流程图;
图5是在ROS验证平台下,利用本发明输出的载体姿态四元数波形图;
图6是在ROS验证平台下,利用本发明输出的载体姿态欧拉角波形图;
图7是本发明提出的算法与基于互补滤波器、扩展卡尔曼滤波器、自适应扩展卡尔曼滤波器姿态解算算法的姿态欧拉角的俯仰角输出波形对比图;
图8是本发明提出的算法与基于互补滤波器、扩展卡尔曼滤波器、自适应扩展卡尔曼滤波器姿态解算算法的姿态欧拉角的横滚角输出波形对比图;
图9是本发明提出的算法与基于互补滤波器、扩展卡尔曼滤波器、自适应扩展卡尔曼滤波器姿态解算算法的姿态欧拉角的航向角输出波形对比图。
具体实施方式
下面结合附图对本发明做清楚完整的描述,以使本领域的技术人员在不需要作出创造性劳动的条件下,能够充分实施本发明。
如图1-4所示,本发明实施例提供的一种基于地球重力场与地磁场序贯修正的姿态解算方法,使用AH-100B AHRS传感器输出的三轴陀螺、三轴加速度、三轴磁场计数据,分别为ω、a和m,包括以下几个步骤:
步骤1:载体初始姿态四元数初始化,初始姿态四元数均方误差初始化;
步骤2:读取陀螺仪数据,并进行载体姿态四元数更新;
步骤3:读取加速度计数据,并对步骤2中更新的姿态四元数进行第一次修正;
步骤4:读取磁力计数据,并对步骤3中一次修正的姿态四元数进行第二次修正。
作为本发明的一个实施例,步骤1中姿态四元数与均方误差矩阵初始化为P0=I。
作为本发明的一个实施例,步骤2中读取陀螺仪数据,并进行载体姿态四元数更新,具体通过以下步骤实现:
(2a)在载体坐标系B,下从陀螺仪中获得载体角速度信息
(2b)根据所述载体角速度信息计算***状态转移矩阵
(2c)陀螺仪噪声协方差矩阵设置
(2d)计算***噪声协方差矩阵
(2e)载体姿态四元数状态一步预测
(2f)姿态四元数状态一步预测均方误差
作为本发明的一个实施例,步骤3中读取加速度计数据,并对步骤2中更新的姿态四元数进行第一次修正,具体通过以下步骤实现:
(3a)在载体坐标系B下从加速度计中获得载体角速度信息a=[ax ay az]T;
(3b)根据所述载体重力加速度信息及先验重力加速度计算量测矩阵
(3c)加速度计噪声协方差矩阵设置
(3d)计算重力加速度量测噪声协方差矩阵
(3e)计算重力加速度修正的滤波增Kgk=Pk/k-1(Hgk)T(HgkPk/k-1(Hgk)T+Rg′k)-1;
(3f)估计基于重力加速度修正的姿态四元数
(3g)基于重力加速度的姿态四元数状态估计均方误差Pgk=(I-KgkHgk)Pk/k-1。
作为本发明的一个实施例,步骤4中读取磁力计数据,并对步骤3中一次修正的姿态四元数进行第二次修正,具体通过以下步骤实现:
(4a)在载体坐标系B下从磁力计中获得载体角速度信息m=[mx my mz]T;
(4b)计算先验地磁场矢量h;
(4c)根据所述载体地磁场矢量信息及先验地磁场矢量计算量测矩阵
(4d)磁力计噪声协方差矩阵设置
(4e)计算地磁场矢量量测噪声协方差矩阵
(4f)计算地磁场矢量修正的滤波增Kmk=Pgk(Hmk)T(HmkPgk(Hmk)T+Rm′k)-1;
(4g)估计基于地磁场矢量的姿态四元数状态
(4h)基于地磁场矢量的姿态四元数状态估计均方误差Pmk=(I-KmkHmk)Pgk。
利用该姿态解算算法解算出的载体姿态四元数输出波形如图5所示,其w、x、y分量的精度为0.001,z分量的精度为0.002。载体姿态欧拉角输出波形如图6所示,其横滚与俯仰分量的精度为0.1°,航向分量的精度为0.2°。
将本发明与基于互补滤波器、扩展卡尔曼滤波器、自适应扩展卡尔曼滤波器姿态解算算法的姿态欧拉角输出波形进行对比,对比图如图7-9所示。
以上对本发明的较佳实施例进行了描述,需要指出的是,本发明并不局限于上述特定实施方式,其中未尽详细描述的设备和结构应该理解为用本领域中的普通方式予以实施;任何熟悉本领域的技术人员,在不脱离本发明技术方案范围情况下,依据本发明的技术实质对以上实施例所做的任何简单修改、等同变化及修饰,均仍属于本发明技术方案保护的范围内。
Claims (4)
1.一种基于地球重力场与地磁场序贯修正的姿态解算方法,其特征在于,具体步骤为:
(1)根据航姿***中MEMS陀螺仪采集的角速率计算***模型的状态转移矩阵,并利用离散化的四元数微分方程更新载体姿态四元数;
(2)根据航姿***中MEMS加速度计采集的载体重力加速度对步骤(1)中更新得到的姿态四元数由均方误差最小原则进行修正;
(3)根据航姿***中MEMS磁力计采集的载体地磁场矢量对步骤(2)中修正得到的姿态四元数由均方误差最小原则进行第二次修正。
2.根据权利要求1所述的一种基于地球重力场与地磁场序贯修正的姿态解算方法,其特征在于,步骤(1)的具体过程是:
a.建立陀螺仪动力学模型:
即
其中,X=[X0 X1 X2 X3]T表示全局坐标系G到载体坐标系B的旋转四元数,表示在载体坐标系中测量的MEMS陀螺角速度信息,且
利用四元数微分方程的比卡求解法,使上式离散化可得
其中,Xk-1为tk-1时刻全局坐标系G到载体坐标系B的旋转四元数,Xk为tk时刻全局坐标系G到载体坐标系B的旋转四元数,
且
b.获得载体坐标系B下的载体角速度信息
c.根据所述载体角速度信息计算***状态转移矩阵
c.载体姿态四元数状态一步预测
d.计算***噪声协方差矩阵Qk
对于MEMS陀螺仪在微小时间间隔Δt,其真实的角增量Δθ°是无法测量的,假设在tk-1时刻到tk时刻的时间间隔内,陀螺仪的实际输出与真实角增量的误差为δθk/k-1,有
其中,Δθk/k-1表示陀螺仪的实际角增量,表示陀螺仪的真实角增量;
相应的,实际状态转移矩阵与真实状态转移矩阵的误差为ΔΦk/k-1,则有
将上式代入步骤a中陀螺仪离散化的动力学模型中,可得
变形为
-δΘk/k-1Xk-1=-Ξ(Xk-1)δθk/k-1
式中
设陀螺仪的输出噪声为ngyro,则有
则***噪声协方差矩阵为:
其中,Σgyro为陀螺仪噪声协方差矩阵;
f.计算姿态四元数状态一步预测均方误差Pk/k-1
其中,Pk-1表示步骤(3)中的状态估计均方误差。
3.根据权利要求1所述的一种基于地球重力场与地磁场序贯修正的姿态解算方法,其特征在于,步骤(2)的具体过程是:
a.建立加速度计观测模型:
将三维矢量g与a看作零标量的四元数,则g与a间的变换关系可用四元数乘法表示为
其中,g为在全局坐标系G中测量的重力加速度,a为在载体坐标系B中测量的重力加速度,且满足||g||=||a||=1;表示姿态四元数Xk的逆;
上式经过变换可得
M′(a)Xk-M(g)Xk=0
其中,M′(a)与M(g)表示由零标量的四元数g与a构成的矩阵,如下
b.获得载体坐标系B下的载体重力加速度信息a=[ax ay az]T;
c.根据所述载体重力加速度信息及先验重力加速度计算量测矩阵
d.计算重力加速度量测噪声协方差矩阵Rg′k
设加速度计的输出噪声为nacc,则有
nacc=a-a°
其中,a°表示载体坐标系下加速度计的真实值;
实际量测矩阵与理想量测矩阵误差为
其中,表示理想量测矩阵;
将上式代入步骤a中的加速度计观测模型,可得
0=HgkXk-ΔHgkXk
-ΔHgkXk变形为
其中,
令则量测噪声协方差矩阵为
其中,Σacc为加速度计噪声协方差矩阵;
上式得到的量测噪声协方差矩阵在应用的过程中很有可能是奇异的,为了避免矩阵的奇异,需要对该量测噪声协方差矩阵进行改进,即
Rg′k=Rgk+βgI βg>0;
e.计算重力加速度修正的滤波增益Kgk
Kgk=Pk/k-1(Hgk)T(HgkPk/k-1(Hgk)T+Rg′k)-1;
f.基于重力加速度的姿态四元数状态估计
g.基于重力加速度的姿态四元数状态估计均方误差Pgk
Pgk=(I-KgkHgk)Pk/k-1。
4.根据权利要求1所述的一种基于地球重力场与地磁场序贯修正的姿态解算方法,其特征在于,步骤(3)的具体过程是:
a.建立磁力计观测模型:
把三维矢量h与m看作零标量的四元数,则h与m间的变换关系可用四元数乘法表示为
其中,h为在全局坐标系G中测量的地磁场矢量,m为在载体坐标系B中测量的地磁场矢量,且满足||g||=||a||=1,
上式经过变换可得
M′(m)Xk-M(h)Xk=0
其中,M′(m)与M(h)表示由零标量的四元数h与m构成的矩阵,如下
b.获得载体坐标系B下的载体地磁场矢量信息m=[mx my mz]T;
c.计算先验地磁场矢量h
全局参考坐标系G的Gz轴选取重力加速度g的反方向,Gx轴选取地磁北极,Gy按照右手法则选取,则先验地磁场矢量h与全局参考坐标系G的GxoGz面重合即h=[hx 0 hy]T,则有
其中,l=[lx ly lz]T表示带有误差的先验地磁场矢量,
则有
式中
Γ=lx 2+ly 2
d.根据所述载体地磁场矢量信息及先验地磁场矢量计算量测矩阵
e.计算地磁场矢量量测噪声协方差矩阵Rm′k
设磁力计的输出噪声为nmag,则有
nmag=m-m°
其中,m°表示载体坐标系下加速度计的真实值;
实际量测矩阵与理想量测矩阵误差为
其中,表示理想量测矩阵;
把上式代入步骤a中的磁力计观测模型,可得
0=HmkXk-ΔHmkXk
-ΔHmkXk变形为
其中,
令则量测噪声协方差矩阵为
其中,Σmag为磁力计噪声协方差矩阵;
上式得到的量测噪声协方差矩阵在应用的过程中很有可能是奇异的,为了避免矩阵的奇异,需要对该量测噪声协方差矩阵进行改进,即
Rm′k=Rmk+βmI βm>0;
f.计算地磁场矢量修正的滤波增益Kmk
Kmk=Pgk(Hmk)T(HmkPgk(Hmk)T+Rm′k)-1;
g.基于地磁场矢量的姿态四元数状态估计
h.基于地磁场矢量的姿态四元数状态估计均方误差Pmk
Pmk=(I-KmkHmk)Pgk
其中,I表示单位矩阵;
i.Pmk→Pk-1。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810384477.2A CN108871319B (zh) | 2018-04-26 | 2018-04-26 | 一种基于地球重力场与地磁场序贯修正的姿态解算方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810384477.2A CN108871319B (zh) | 2018-04-26 | 2018-04-26 | 一种基于地球重力场与地磁场序贯修正的姿态解算方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN108871319A true CN108871319A (zh) | 2018-11-23 |
CN108871319B CN108871319B (zh) | 2022-05-17 |
Family
ID=64326785
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201810384477.2A Expired - Fee Related CN108871319B (zh) | 2018-04-26 | 2018-04-26 | 一种基于地球重力场与地磁场序贯修正的姿态解算方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN108871319B (zh) |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110017837A (zh) * | 2019-04-26 | 2019-07-16 | 沈阳航空航天大学 | 一种姿态抗磁干扰的组合导航方法 |
CN110174121A (zh) * | 2019-04-30 | 2019-08-27 | 西北工业大学 | 一种基于地磁场自适应修正的航姿***姿态解算方法 |
CN113063416A (zh) * | 2021-02-05 | 2021-07-02 | 重庆大学 | 一种基于自适应参数互补滤波的机器人姿态融合方法 |
Citations (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20050240347A1 (en) * | 2004-04-23 | 2005-10-27 | Yun-Chun Yang | Method and apparatus for adaptive filter based attitude updating |
US20120166082A1 (en) * | 2010-12-22 | 2012-06-28 | Custom Sensors & Technologies, Inc. | Method and system for initial quaternion and attitude estimation |
WO2012168357A1 (fr) * | 2011-06-07 | 2012-12-13 | Movea | Procede d'estimation simplifie de l'orientation d'un objet et centrale d'attitude mettant en œuvre un tel procede |
US20130245984A1 (en) * | 2010-11-17 | 2013-09-19 | Hillcrest Laboratories, Inc. | Apparatuses and methods for magnetometer alignment calibration without prior knowledge of the local magnetic field |
CN103363992A (zh) * | 2013-06-29 | 2013-10-23 | 天津大学 | 基于梯度下降的四旋翼无人机姿态航向参考***解算方法 |
CN103822633A (zh) * | 2014-02-11 | 2014-05-28 | 哈尔滨工程大学 | 一种基于二阶量测更新的低成本姿态估计方法 |
CN106500695A (zh) * | 2017-01-05 | 2017-03-15 | 大连理工大学 | 一种基于自适应扩展卡尔曼滤波的人体姿态识别方法 |
CN107478223A (zh) * | 2016-06-08 | 2017-12-15 | 南京理工大学 | 一种基于四元数和卡尔曼滤波的人体姿态解算方法 |
CN107621261A (zh) * | 2017-09-08 | 2018-01-23 | 常州大学 | 用于惯性‑地磁组合姿态解算的自适应optimal‑REQUEST算法 |
CN110887481A (zh) * | 2019-12-11 | 2020-03-17 | 中国空气动力研究与发展中心低速空气动力研究所 | 基于mems惯性传感器的载体动态姿态估计方法 |
-
2018
- 2018-04-26 CN CN201810384477.2A patent/CN108871319B/zh not_active Expired - Fee Related
Patent Citations (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20050240347A1 (en) * | 2004-04-23 | 2005-10-27 | Yun-Chun Yang | Method and apparatus for adaptive filter based attitude updating |
US20130245984A1 (en) * | 2010-11-17 | 2013-09-19 | Hillcrest Laboratories, Inc. | Apparatuses and methods for magnetometer alignment calibration without prior knowledge of the local magnetic field |
US20120166082A1 (en) * | 2010-12-22 | 2012-06-28 | Custom Sensors & Technologies, Inc. | Method and system for initial quaternion and attitude estimation |
WO2012168357A1 (fr) * | 2011-06-07 | 2012-12-13 | Movea | Procede d'estimation simplifie de l'orientation d'un objet et centrale d'attitude mettant en œuvre un tel procede |
CN103363992A (zh) * | 2013-06-29 | 2013-10-23 | 天津大学 | 基于梯度下降的四旋翼无人机姿态航向参考***解算方法 |
CN103822633A (zh) * | 2014-02-11 | 2014-05-28 | 哈尔滨工程大学 | 一种基于二阶量测更新的低成本姿态估计方法 |
CN107478223A (zh) * | 2016-06-08 | 2017-12-15 | 南京理工大学 | 一种基于四元数和卡尔曼滤波的人体姿态解算方法 |
CN106500695A (zh) * | 2017-01-05 | 2017-03-15 | 大连理工大学 | 一种基于自适应扩展卡尔曼滤波的人体姿态识别方法 |
CN107621261A (zh) * | 2017-09-08 | 2018-01-23 | 常州大学 | 用于惯性‑地磁组合姿态解算的自适应optimal‑REQUEST算法 |
CN110887481A (zh) * | 2019-12-11 | 2020-03-17 | 中国空气动力研究与发展中心低速空气动力研究所 | 基于mems惯性传感器的载体动态姿态估计方法 |
Non-Patent Citations (2)
Title |
---|
A.M. SABATINI: "Quaternion-based extended Kalman filter for determining orientation by inertial and magnetic sensing", 《IEEE TRANSACTIONS ON BIOMEDICAL ENGINEERING》 * |
盛汉霖等: "基于扩展卡尔曼滤波器的低成本航姿***设计", 《***工程与电子技术》 * |
Cited By (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110017837A (zh) * | 2019-04-26 | 2019-07-16 | 沈阳航空航天大学 | 一种姿态抗磁干扰的组合导航方法 |
CN110017837B (zh) * | 2019-04-26 | 2022-11-25 | 沈阳航空航天大学 | 一种姿态抗磁干扰的组合导航方法 |
CN110174121A (zh) * | 2019-04-30 | 2019-08-27 | 西北工业大学 | 一种基于地磁场自适应修正的航姿***姿态解算方法 |
CN113063416A (zh) * | 2021-02-05 | 2021-07-02 | 重庆大学 | 一种基于自适应参数互补滤波的机器人姿态融合方法 |
CN113063416B (zh) * | 2021-02-05 | 2023-08-08 | 重庆大学 | 一种基于自适应参数互补滤波的机器人姿态融合方法 |
Also Published As
Publication number | Publication date |
---|---|
CN108871319B (zh) | 2022-05-17 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN105180968B (zh) | 一种imu/磁强计安装失准角在线滤波标定方法 | |
CN102980577B (zh) | 一种微型捷联航姿***及其工作方法 | |
CN101726295B (zh) | 考虑加速度补偿和基于无迹卡尔曼滤波的惯性位姿跟踪方法 | |
CN103630137B (zh) | 一种用于导航***的姿态及航向角的校正方法 | |
Phuong et al. | A DCM based orientation estimation algorithm with an inertial measurement unit and a magnetic compass | |
CN109163721A (zh) | 姿态测量方法及终端设备 | |
CN105806367B (zh) | 无陀螺惯性***误差标定方法 | |
CN107314718A (zh) | 基于磁测滚转角速率信息的高速旋转弹姿态估计方法 | |
CN105203098A (zh) | 基于九轴mems传感器的农业机械全姿态角更新方法 | |
CN109870173A (zh) | 一种基于校验点的海底管道惯性导航***的轨迹修正方法 | |
CN101290229A (zh) | 硅微航姿***惯性/地磁组合方法 | |
CN110174121A (zh) | 一种基于地磁场自适应修正的航姿***姿态解算方法 | |
CN202974288U (zh) | 一种微型捷联航姿*** | |
CN108318038A (zh) | 一种四元数高斯粒子滤波移动机器人姿态解算方法 | |
Allotta et al. | Single axis FOG aided attitude estimation algorithm for mobile robots | |
CN113008227B (zh) | 一种基于三轴加速度计测姿的地磁二分量测量方法 | |
CN101839719A (zh) | 一种基于陀螺、地磁传感器的惯性测量装置 | |
CN103512584A (zh) | 导航姿态信息输出方法、装置及捷联航姿参考*** | |
CN108458714A (zh) | 一种姿态检测***中不含重力加速度的欧拉角求解方法 | |
CN103900608A (zh) | 一种基于四元数ckf的低精度惯导初始对准方法 | |
CN109916395A (zh) | 一种姿态自主冗余组合导航算法 | |
CN105910606A (zh) | 一种基于角速度差值的方向修正方法 | |
CN105806363A (zh) | 基于srqkf的sins/dvl水下大失准角对准方法 | |
CN103557864A (zh) | Mems捷联惯导自适应sckf滤波的初始对准方法 | |
CN108871319A (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 | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20220517 |
|
CF01 | Termination of patent right due to non-payment of annual fee |