CN110887481B - 基于mems惯性传感器的载体动态姿态估计方法 - Google Patents
基于mems惯性传感器的载体动态姿态估计方法 Download PDFInfo
- Publication number
- CN110887481B CN110887481B CN201911262998.1A CN201911262998A CN110887481B CN 110887481 B CN110887481 B CN 110887481B CN 201911262998 A CN201911262998 A CN 201911262998A CN 110887481 B CN110887481 B CN 110887481B
- Authority
- CN
- China
- Prior art keywords
- gyroscope
- data
- axis
- accelerometer
- 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.)
- Active
Links
- 238000000034 method Methods 0.000 title claims abstract description 23
- 238000012545 processing Methods 0.000 claims abstract description 11
- 230000004927 fusion Effects 0.000 claims abstract description 6
- 239000011159 matrix material Substances 0.000 claims description 45
- 239000013598 vector Substances 0.000 claims description 37
- 238000005259 measurement Methods 0.000 claims description 34
- 230000001133 acceleration Effects 0.000 claims description 14
- 230000008569 process Effects 0.000 claims description 8
- 101000802640 Homo sapiens Lactosylceramide 4-alpha-galactosyltransferase Proteins 0.000 claims description 5
- 102100035838 Lactosylceramide 4-alpha-galactosyltransferase Human genes 0.000 claims description 5
- 238000005096 rolling process Methods 0.000 claims description 3
- 230000007704 transition Effects 0.000 claims description 3
- 238000004422 calculation algorithm Methods 0.000 description 15
- 230000005484 gravity Effects 0.000 description 7
- 238000002474 experimental method Methods 0.000 description 6
- 238000001914 filtration Methods 0.000 description 5
- 238000012360 testing method Methods 0.000 description 4
- 230000009286 beneficial effect Effects 0.000 description 3
- 238000004364 calculation method Methods 0.000 description 3
- 230000008859 change Effects 0.000 description 2
- 238000013461 design Methods 0.000 description 2
- 238000011161 development Methods 0.000 description 2
- 239000006185 dispersion Substances 0.000 description 2
- 230000010354 integration Effects 0.000 description 2
- 230000003068 static effect Effects 0.000 description 2
- 230000009466 transformation Effects 0.000 description 2
- 206010063385 Intellectualisation Diseases 0.000 description 1
- 238000013459 approach Methods 0.000 description 1
- 238000006243 chemical reaction Methods 0.000 description 1
- 230000000052 comparative effect Effects 0.000 description 1
- 238000012937 correction Methods 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 238000004519 manufacturing process Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000007500 overflow downdraw method Methods 0.000 description 1
- 238000003672 processing method Methods 0.000 description 1
- 238000006467 substitution reaction Methods 0.000 description 1
Images
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/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
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Automation & Control Theory (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Navigation (AREA)
Abstract
一种基于MEMS惯性传感器的载体动态姿态估计方法，包括以下步骤：获取三轴加速度计数据并通过加速度计噪声模型进行处理；获取三轴陀螺仪数据并通过陀螺仪噪声模型进行处理；将以上三轴陀螺仪处理后的数据和三轴加速度计数据处理后的数据通过EKF滤波器处理，然后再进行多传感信息融合，求取姿态角，更新姿态信息。由此，通过加速度计噪声模型对加速度计数据进行处理，通过陀螺仪噪声模型对陀螺仪数据进行处理，将以上三轴陀螺仪处理后的数据和三轴加速度计数据处理后的数据通过EKF滤波器进行多传感信息融合，进而稳定准确地得到动态载体的姿态信息。
Description
技术领域
本申请涉及MEMS传感技术领域，尤其涉及基于MEMS惯性传感器的载体动态姿态估计方法。
背景技术
智能化、无人化是当今车辆行业的发展趋势，无论是无人驾驶汽车的发展还是智能化操作的工程车辆的应用，实时、精确、稳定的姿态信息是实现智能操作、无人驾驶网络的前提。MEMS传感器由于其体积小、质量轻、功耗低和高可靠性的特点，在当今工业界得到了广泛的应用。但是MEMS惯性器件同时存在以下缺点：1)陀螺仪存在漂移误差，长时间使用会存在误差积累；2)加速度计在运动状态下受线性加速度和向心加速度影响较大，单独使用求解姿态时存在较大误差，动态性能较差。并且由于现实中磁场的干扰是随机的，误差进行预消除，单独求解航向角时误差较大。所以，使用MEMS惯性器件求解载体的姿态角时必须使用多种传感器组成姿态测量系统，运用合理的数据融合方法对传感器的误差进行消除和补偿，得到稳定、准确的姿态。
发明内容
本申请提供一种基于MEMS惯性传感器的载体动态姿态估计方法，能够稳定准确的得到动态载体的姿态信息。
一种基于MEMS惯性传感器的载体动态姿态估计方法，包括以下步骤：
获取三轴加速度计数据并通过加速度计噪声模型进行处理；
获取三轴陀螺仪数据并通过陀螺仪噪声模型进行处理；
将以上三轴陀螺仪处理后的数据和三轴加速度计数据处理后的数据通过EKF滤波器进行处理，求取姿态角，更新姿态信息。其有益效果是：由于利用MEMS传感器求解载体姿态时主要存在以下几种误差：1)传感器的安装误差；2)陀螺仪的漂移和线性度误差；3)加速度计和陀螺仪的零位误差；所以通过加速度计噪声模型对加速度计数据进行处理，通过陀螺仪噪声模型对陀螺仪数据进行处理，进而稳定准确地得到动态载体的姿态信息。
在一些实施方式中，EKF滤波器处理包括以下步骤：构建卡尔曼滤波器系统模型：
其中：x(k)∈Rn表示k时刻系统的状态矢量；z(k)∈Rm表示k时刻系统的观测矢量；f(·)为n维矢量函数，h(·)为m维矢量函数，f(·)和h(·)对其自变量都是非线性的；w(k)∈Rn和v(k)∈Rm是协方差分别为Q(k)和R(k)的过程噪声矢量；
建立EKF滤波器方程：包括时间更新、测量更新；
其中，时间更新包括系统状态量的先验估计和预测误差协方差矩阵的先验估计；
量测更新包括系统的卡尔曼增益、系统状态量的后验估计和预测误差协方差矩阵的后验估计。
在一些实施方式中，设系统的状态向量为：
x(k)＝(abx(k)aby(k)abz(k)ωx(k)ωy(k)ωz(k)bωx(k)bωy(k)bωz(k))T
其中，abx(k) aby(k) abz(k)表示载体坐标系中三轴加速度测量值，ωx(k) ωy(k)ωz(k)表示载体坐标系中三轴陀螺仪测量值，bωx(k) bωy(k) bωz(k)分别为绕滚转轴、俯仰轴和航向轴的陀螺仪随机漂移向量，则所述系统的状态方程为：
对f(x(k-1),(k-1))求取Jacobi矩阵：
由状态转移函数可得状态的一步预测值：
计算状态向量一步预测误差方差矩阵：
P(k)＝Φ(k,k-1)P(k,k-1)ΦT(k,k-1)+Q(k)。
在一些实施方式中，设系统的观测向量为z(k)＝(ωbx(k) ωby(k) ωbz(k))T，其中，ωbx(k) ωby(k) ωbz(k)表示载体坐标系中三轴加速度测量值，则所述系统的观测方程为：
对h(x(k)，k)求取Jacobi矩阵，可得系统量测矩阵为：
由量测函数可得量测向量的一步预测值：
在一些实施方式中，计算状态增益矩阵：
K(k)＝P(k，k-1)HT(k)[H(k)P(k，k-1)HT(k)+R(k)]-1。
在一些实施方式中，K时刻的状态向量估计值为：
在一些实时方式中，更新状态误差协方差矩阵为：
P(k)＝[I-K(k)H(k)]P(k，k-1)[I-K(k)H(k)]T+K(k)R(k)KT(k)。
在一些实施方式中，过程噪声协方差为：
量测噪声协方差矩阵
为定常数对角阵。
在一些实施方式中，还包括以下步骤：
将所述EKF滤波器输出数据和修正后的加速度计输出数据进行融合求取姿态角，更新姿态信息。
本申请技术方案与现有技术相比，具有以下有益效果：
本申请的技术方案通过建立载体姿态测量模型，将三轴陀螺仪和三轴加速度计的输出量作为状态量，将三轴陀螺仪的输出做为观测量设计扩展卡尔曼滤波。应用载体的重力加速度和角速度进行时间更新，利用载体自身的角速度进行时间更新。从而有效降低了MEMS陀螺仪的漂移误差，解决了微机电系统用于载体姿态测量时精度低、易发散、易被干扰的问题，有效提高了姿态解算的精度。
通过数据融合算法，实现了利用加速度计对EKF滤波器输出结果的修正，进一步提高了系统的精度。
附图说明
为了更清楚地说明本发明实施例或现有技术中的技术方案，下面将对实施例或现有技术描述中所需要使用的附图作一简单地介绍，显而易见地，下面描述中的附图是本发明的一些实施例，对于本领域普通技术人员来讲，在不付出创造性劳动的前提下，还可以根据这些附图获得其他的附图。
图1是本技术方案一实施方式的姿态角示意图；
图2是本申请技术方案一实施方式的方法流程图；
图3是本申请技术方案一实施方式的静止状态加高频振动实验的对比图；
图4是本申请技术方案一实施方式的以0.5Hz的频率，±5°的幅度进行摇摆测试；
图5是本申请技术方案一实施方式的以50°/s的角速度进行旋转测试。
具体实施方式
为使本发明实施例的目的、技术方案和优点更加清楚，下面将结合本发明实施例中的附图，对本发明实施例中的技术方案进行清楚、完整地描述，显然，所描述的实施例是本发明一部分实施例，而不是全部的实施例。基于本发明中的实施例，本领域普通技术人员在没有作出创造性劳动前提下所获得的所有其他实施例，都属于本发明保护的范围。
如图2所示，一种基于MEMS惯性传感器的载体动态姿态估计方法，包括以下步骤：
所用的传感器由一个三轴MEMS陀螺仪、一个三轴MEMS加速度计组成，传感器直接固联在载体上，各传感器内部测量轴相互正交且与载体坐标系重合，各传感器输出为三维矢量，角速度输出为ωb、加速度输出为ab。
步骤1：获取三轴加速度计数据并通过加速度计噪声模型进行处理。
其中，加速度计通过测量重力加速度在载体三轴上的分量来计算载体的姿态角。当载体做非匀速运动、机体存在较大振动时，会使姿态解算失效，因此需要对测量值进行校正：
加速度计的测量模型为
其中：ab表示加速度计的测量值；Ka表示标度系数矩阵；g＝(0 0 -g)T表示地理坐标系下的重力加速度矢量，g表示重力加速度常量；af表示载体的线性加速度矩阵；ba表示偏置误差矩阵；va表示测量噪声矩阵，为零均值的高斯白噪声，协方差为
步骤2：获取三轴陀螺仪数据并通过陀螺仪噪声模型进行处理。
陀螺仪通过测量载体的角速度，积分后既可以得到载体转动角度，但是由于MEMS陀螺仪制造工艺等因素，陀螺仪输出存在随机漂移和测量噪声误差。因此，单独使用陀螺仪进行姿态测量时，积分时间越长，姿态估计的误差越大，因此需要对测量值进行校正：
陀螺仪测量模型为ωb＝Kωω+bω+vω,其中ωb表示陀螺仪的测量值；ω表示陀螺仪真值角速度；Kω表示标度系数矩阵；bω表示陀螺仪随机漂移矩阵；vω表示测量噪声矩阵，为零均值的高斯白噪声，协方差为
步骤3：将以上三轴陀螺仪处理后的数据和三轴加速度计数据处理后的数据通过EKF滤波器进行处理，然后EKF滤波器输出数据和加速度计输出数据再进行融合，求取姿态角，更新姿态信息。
其中，EKF滤波器进行处理包括以下步骤：
构建卡尔曼滤波器系统模型：
其中：x(k)∈Rn表示k时刻系统的状态矢量；z(k)∈Rm表示k时刻系统的观测矢量；f(·)为n维矢量函数，h(·)为m维矢量函数，f(·)和h(·)对其自变量都是非线性的；w(k)∈Rn和v(k)∈Rm是协方差分别为Q(k)和R(k)的过程噪声矢量；
建立扩展EKF滤波器方程：包括时间更新、测量更新；其中，时间更新包括系统状态量的先验估计和预测误差协方差矩阵的先验估计；量测更新包括系统的卡尔曼增益、系统状态量的后验估计和预测误差协方差矩阵的后验估计。具体描述如下：
1.初始化
计算状态初始值x(0)，设定过程噪声协方差Q(k)、量测噪声协方差R(k)额误差方差矩阵P(0)。
2.时间更新
设系统的状态向量为：
x(k)＝(abx(k)aby(k)abz(k)ωx(k)ωy(k)ωz(k)bωx(k)bωy(k)bωz(k))T
其中，abx(k) aby(k) abz(k)表示载体坐标系中三轴加速度测量值，ωx(k) ωy(k)ωz(k)表示载体坐标系中三轴陀螺仪测量值，bωx(k) bωy(k) bωz(k)分别为绕滚转轴、俯仰轴和航向轴的陀螺仪随机漂移向量，则所述系统的状态方程为：
对f(x(k-1)，(k-1))求取Jacobi矩阵：
由状态转移函数可得状态的一步预测值：
计算状态向量一步预测误差方差矩阵：
P(k)＝Φ(k，k-1)P(k，k-1)ΦT(k，k-1)+Q(k)。
3.量测更新
设系统的观测向量为z(k)＝(ωbx(k) ωby(k) ωbz(k))T，其中，ωbx(k) ωby(k)ωbz(k)表示载体坐标系中三轴陀螺仪测量值，则所述系统的观测方程为：
对h(x(k)，k)求取Jacobi矩阵，可得系统量测矩阵为：
由量测函数可得量测向量的一步预测值：
计算状态增益矩阵：
K(k)＝P(k，k-1)HT(k)[H(k)P(k，k-1)HT(k)+R(k)]-1。
K时刻的状态向量估计值为：
更新状态误差协方差矩阵为：
P(k)＝[I-K(k)H(k)]P(k，k-1)[I-K(k)H(k)]T+K(k)R(k)KT(k)。
其中，过程噪声协方差为：
量测噪声协方差矩阵
为定常数对角阵。
而加速度计输出值和卡尔曼滤波输出姿态值之间的融合包括以下步骤：
一.判断两个惯性器件的值，其中，判定条件设为：
1.加速度计的矢量和
与理想重力加速度g作比较；
2.三轴陀螺仪的输出值
(1)当|a-g|<0.01且ω<0.01时，载体姿态输出为：
其中，其中k为动态变化系数，
att为卡尔曼输出的载体姿态角度
(2)当|a-g|<0.001g且ω<0.001g时，此时的载体姿态输出为
(3)当|a-g|>0.01g或ω>0.01g时Att＝att，即完全置信卡尔曼滤波器的输出值。
二、判断陀螺仪输出前后差值：
当ωk,x-ωk-1,x<0.05且ωk,y-ωk-1,y<0.05且ωk,z-ωk-1,z<0.05时，完全置信加速度计的输出值，即
另外，需要说明的是：载体姿态运动模型的设置。
1.参考坐标系
定义载体坐标系为OXbYbZb，该坐标系原点选为载体质心，Xb轴沿载体横轴向右，Yb轴沿载体纵轴向前，Zb轴垂直载体指向上方，构成右手坐标系。定义地理坐标系OXnYnZn作为导航坐标系，导航坐标系采用东北天坐标系，采用载体质心为原点。姿态角的定义如图1所示，绕X轴旋转对应俯仰角pitch、绕Y轴旋转对应横滚角roll、绕Z轴旋转对应偏航角yaw，分别为三轴欧拉角φ、θ、ψ。
2.坐标系间的转换
导航坐标系和载体坐标系两者可以通过姿态矩阵进行转换。本技术方案采用的是y→x→z的旋转顺序，分别旋转
角度得到。则载体坐标系和导航坐标系之间的旋转关系可表示为：
其中：
式(1)为坐标转换矩阵，即姿态矩阵，对于坐标转换矩阵可知重力加速度在载体坐标上的三轴矢量为：
其中，
由式(1)(2)可得载体三轴与水平面的夹角分别为：
实施例2效果实验对比
本文设置了三组实验进行对比，以验证本文算法的有效性，三组实验分别是：1)静止状态加高频振动实验，结果如图3所示；2)以0.5Hz的频率，±5°的幅度进行摇摆测试，结果如图4所示；3)以50°/s的角速度进行旋转测试，结果如图5所示。每组实验都是极三种姿态计算算法：利用加速度计的姿态解算算法(G-A)，采用FIR滤波的姿态解算算法(FIR)，以及本申请设计的EKF滤波算法(EKF)，通过对比检验三种算法的不同情况下的性能。
由图3可见，在震动状态下，G-A算法有较大的波动，误差达到3°左右，而FIR算法虽然解决了振动引起的角度变化的问题，但是Z轴的角度有较大误差，而EKF算法则是有效的修正了Z轴的角度，并且将角度的变化幅度控制在0.3°之内，能够准确的获得载体的姿态信息。
由图4和图5可得，在旋转和摇摆的运动状态下，G-A算法和FIR算法存在较大的误差，尤其是在摇摆运动状态下，G-A算法和FIR算法存在最大3-5°的误差，不能够准确的描述载体的姿态和运动状态；EKF算法则能够准确的对载体的姿态进行描述，在这两种运动状态下误差小于0.2°，能够有效的反应当前时刻的载体姿态。
本申请技术方案与现有技术相比，具有以下有益效果：
由于利用MEMS传感器求解载体姿态时主要存在以下几种误差：1)传感器的安装误差；2)陀螺仪的漂移和线性度误差；3)加速度计和陀螺仪的零位误差；所以通过加速度计噪声模型对加速度计数据进行处理，通过陀螺仪噪声模型对陀螺仪数据进行处理，将以上三轴陀螺仪处理后的数据和三轴加速度计数据处理后的数据通过EKF滤波器处理，稳定准确地得到动态载体的姿态信息。
其次，本技术方案通过建立载体姿态测量模型，将三轴陀螺仪和三轴加速度计的输出量作为状态量，将三轴陀螺仪的输出做为观测量设计扩展卡尔曼滤波。应用载体的重力加速度和角速度进行时间更新，利用载体自身的角速度进行时间更新。从而有效降低了MEMS陀螺仪的漂移误差，解决了微机电系统用于载体姿态测量时精度低、易发散、易被干扰的问题，有效提高了姿态解算的精度。在此基础上进行多传感信息融合，进一步稳定准确地得到动态载体的姿态信息。
最后应说明的是：以上实施例仅用以说明本发明的技术方案，而非对其限制；尽管参照前述实施例对本发明进行了详细的说明，本领域的普通技术人员应当理解：其依然可以对前述各实施例所记载的技术方案进行修改，或者对其中部分技术特征进行等同替换；而这些修改或者替换，并不使相应技术方案的本质脱离本发明各实施例技术方案的精神和范围。
Claims (5)
1.基于MEMS惯性传感器的载体动态姿态估计方法，其特征在于，包括以下步骤：
获取三轴加速度计数据并通过加速度计噪声模型进行处理；
获取三轴陀螺仪数据并通过陀螺仪噪声模型进行处理；
将以上三轴陀螺仪处理后的数据和三轴加速度计数据处理后的数据通过EKF滤波器进行处理，求取姿态角，更新姿态信息；
所述EKF滤波器进行多传感信息融合包括以下步骤：构建卡尔曼滤波器系统模型：
其中：x(k)∈Rn表示k时刻系统的状态矢量；z(k)∈Rm表示k时刻系统的观测矢量；f(·)为n维矢量函数，h(·)为m维矢量函数，f(·)和h(·)对其自变量都是非线性的；w(k)∈Rn和v(k)∈Rm是协方差分别为Q(k)和R(k)的过程噪声矢量；
建立EKF滤波器方程：包括时间更新、量测更新；
其中，时间更新包括系统状态量的先验估计和预测误差协方差矩阵的先验估计；
量测更新包括系统的卡尔曼增益、系统状态量的后验估计和预测误差协方差矩阵的后验估计；
设系统的状态向量为：
x(k)＝(abx(k)aby(k)abz(k)ωx(k)ωy(k)ωz(k)bωx(k)bωy(k)bωz(k))T
其中，abx(k) aby(k) abz(k)表示载体坐标系中三轴加速度测量值，ωx(k) ωy(k) ωz(k)表示载体坐标系中三轴陀螺仪测量值，bωx(k) bωy(k) bωz(k)分别为绕滚转轴、俯仰轴和航向轴的陀螺仪随机漂移向量，则所述系统的状态方程为：
对f(x(k-1)，(k-1))求取Jacobi矩阵：
由状态转移函数可得状态的一步预测值：
计算状态向量一步预测误差方差矩阵：
P(k，k-1)＝Φ(k，k-1)P(k-1)ΦT(k，k-1)+Q(k)；
设系统的观测向量为z(k)＝(ωbx(k) ωby(k) ωbz(k))T，其中，ωbx(k) ωby(k) ωbz(k)表示载体坐标系中三轴陀螺仪测量值，则所述系统的观测方程为：
对h(x(k)，k)求取Jacobi矩阵，可得系统量测矩阵为：
由量测函数可得量测向量的一步预测值：
将所述EKF滤波器输出数据和修正后的加速度计输出数据进行融合。
2.根据权利要求1所述的基于MEMS惯性传感器的载体动态姿态估计方法.
计算状态增益矩阵：
K(k)＝P(k，k-1)HT(k)[H(k)P(k，k-1)HT(k)+R(k)]-1。
3.根据权利要求2所述的基于MEMS惯性传感器的载体动态姿态估计方法，其特征在于，K时刻的状态向量估计值为：
4.根据权利要求3所述的基于MEMS惯性传感器的载体动态姿态估计方法，其特征在于，更新状态误差协方差矩阵为：
P(k)＝[I-K(k)H(k)]P(k，k-1)[I-K(k)H(k)]T+K(k)R(k)KT(k)。
5.根据权利要求1所述的基于MEMS惯性传感器的载体动态姿态估计方法，其特征在于，过程噪声协方差为：
其中，
为加速度计测量噪声协方差矩阵；
为量测噪声协方差矩阵；
为陀螺仪漂移噪声的协方差矩阵；
量测噪声协方差矩阵
为定常数对角阵。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201911262998.1A CN110887481B (zh) | 2019-12-11 | 2019-12-11 | 基于mems惯性传感器的载体动态姿态估计方法 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201911262998.1A CN110887481B (zh) | 2019-12-11 | 2019-12-11 | 基于mems惯性传感器的载体动态姿态估计方法 |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| CN110887481A CN110887481A (zh) | 2020-03-17 |
| CN110887481B true CN110887481B (zh) | 2020-07-24 |
Family
ID=69751447
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN201911262998.1A Active CN110887481B (zh) | 2019-12-11 | 2019-12-11 | 基于mems惯性传感器的载体动态姿态估计方法 |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN110887481B (zh) |
Families Citing this family (8)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN108871319B (zh) * | 2018-04-26 | 2022-05-17 | 李志� | 一种基于地球重力场与地磁场序贯修正的姿态解算方法 |
| CN111678514B (zh) * | 2020-06-09 | 2023-03-28 | 电子科技大学 | 一种基于载体运动条件约束和单轴旋转调制的车载自主导航方法 |
| CN111912426A (zh) * | 2020-08-10 | 2020-11-10 | 电子科技大学 | 一种基于mems imu的低成本里程计设计方法 |
| CN114585879A (zh) * | 2020-09-27 | 2022-06-03 | 深圳市大疆创新科技有限公司 | 位姿估计的方法和装置 |
| CN112902954A (zh) * | 2021-03-05 | 2021-06-04 | 上海竹格智能传感技术有限公司 | 塔架晃动传感器和塔架晃动角度测量方法 |
| CN114526729B (zh) * | 2022-01-14 | 2023-11-17 | 重庆邮电大学 | 一种基于冗余技术的mems惯性定位系统航向优化方法 |
| CN114440926A (zh) * | 2022-01-18 | 2022-05-06 | 武汉元生创新科技有限公司 | 一种陀螺仪检测量程扩展方法及系统 |
| CN114509071B (zh) * | 2022-04-20 | 2022-07-08 | 中国空气动力研究与发展中心低速空气动力研究所 | 一种风洞试验模型姿态测量方法 |
Citations (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN103575299A (zh) * | 2013-11-13 | 2014-02-12 | 北京理工大学 | 利用外观测信息的双轴旋转惯导系统对准及误差修正方法 |
| CN105737854A (zh) * | 2016-02-04 | 2016-07-06 | 北京航天发射技术研究所 | 一种捷联惯导系统在线标定方法 |
Family Cites Families (11)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN100405014C (zh) * | 2004-03-05 | 2008-07-23 | 清华大学 | 一种载体姿态测量方法 |
| CN103256943A (zh) * | 2013-04-26 | 2013-08-21 | 哈尔滨工程大学 | 一种在单轴旋转捷联惯导系统中刻度因数误差的补偿方法 |
| CN103414451B (zh) * | 2013-07-22 | 2015-11-25 | 北京理工大学 | 一种应用于飞行器姿态估计的扩展卡尔曼滤波方法 |
| CN105043385B (zh) * | 2015-06-05 | 2018-10-26 | 北京信息科技大学 | 一种行人自主导航定位的自适应卡尔曼滤波方法 |
| CN105300379B (zh) * | 2015-10-13 | 2017-12-12 | 上海新纪元机器人有限公司 | 一种基于加速度的卡尔曼滤波姿态估计方法及系统 |
| CN106482734A (zh) * | 2016-09-28 | 2017-03-08 | 湖南优象科技有限公司 | 一种用于imu多传感器数据融合的滤波方法 |
| CN106885568B (zh) * | 2017-02-21 | 2020-09-01 | 北京京东尚科信息技术有限公司 | 无人机数据处理方法和装置 |
| FR3070515B1 (fr) * | 2017-08-25 | 2022-04-08 | Institut Francais Des Sciences Et Technologies Des Transp De Lamenagement Et Des Reseaux | Procede de determination de la trajectoire d'un objet mobile, programme et dispositif aptes a la mise en oeuvre de ce procede |
| CN109376785B (zh) * | 2018-10-31 | 2021-09-24 | 东南大学 | 基于迭代扩展卡尔曼滤波融合惯性与单目视觉的导航方法 |
| CN110398245B (zh) * | 2019-07-09 | 2021-04-16 | 武汉大学 | 基于脚戴式惯性测量单元的室内行人导航姿态估计方法 |
| CN110440799A (zh) * | 2019-09-19 | 2019-11-12 | 哈尔滨工程大学 | 一种基于陀螺仪和加速度计的姿态角度测量融合系统及方法 |
-
2019
- 2019-12-11 CN CN201911262998.1A patent/CN110887481B/zh active Active
Patent Citations (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN103575299A (zh) * | 2013-11-13 | 2014-02-12 | 北京理工大学 | 利用外观测信息的双轴旋转惯导系统对准及误差修正方法 |
| CN105737854A (zh) * | 2016-02-04 | 2016-07-06 | 北京航天发射技术研究所 | 一种捷联惯导系统在线标定方法 |
Also Published As
| Publication number | Publication date |
|---|---|
| CN110887481A (zh) | 2020-03-17 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN110887481B (zh) | 基于mems惯性传感器的载体动态姿态估计方法 | |
| CN111551174A (zh) | 基于多传感器惯性导航系统的高动态车辆姿态计算方法及系统 | |
| CN112629538A (zh) | 基于融合互补滤波和卡尔曼滤波的舰船水平姿态测量方法 | |
| CN110954102B (zh) | 用于机器人定位的磁力计辅助惯性导航系统及方法 | |
| CN109459019A (zh) | 一种基于级联自适应鲁棒联邦滤波的车载导航计算方法 | |
| KR20170104621A (ko) | 9축 mems 센서에 기반하여 농기계의 전-자세 각도를 갱신하는 방법 | |
| CN111272158B (zh) | 复杂磁扰动场景mems电子罗盘的动态方位角解算方法 | |
| CN108398128A (zh) | 一种姿态角的融合解算方法和装置 | |
| CN106370178B (zh) | 移动终端设备的姿态测量方法及装置 | |
| CN110887480A (zh) | 基于mems传感器的飞行姿态估计方法及系统 | |
| CN106403952A (zh) | 一种动中通低成本组合姿态测量方法 | |
| JP2012173190A (ja) | 測位システム、測位方法 | |
| CN115540860A (zh) | 一种多传感器融合位姿估计算法 | |
| CN108627152A (zh) | 一种微型无人机基于多传感器数据融合的导航方法 | |
| CN116147624B (zh) | 一种基于低成本mems航姿参考系统的船舶运动姿态解算方法 | |
| CN108871319B (zh) | 一种基于地球重力场与地磁场序贯修正的姿态解算方法 | |
| CN108871323B (zh) | 一种低成本惯性传感器在机动环境下的高精度导航方法 | |
| CN114964222A (zh) | 一种车载imu姿态初始化方法、安装角估计方法及装置 | |
| CN115855048A (zh) | 一种多传感器融合位姿估计方法 | |
| CN106595669B (zh) | 一种旋转体姿态解算方法 | |
| CN109916399B (zh) | 一种阴影下的载体姿态估计方法 | |
| CN110779553A (zh) | 磁力计数据的校准方法 | |
| CN114459466A (zh) | 一种基于模糊控制的mems多传感器数据融合处理方法 | |
| CN112033405B (zh) | 一种室内环境磁异常实时修正与导航方法及装置 | |
| CN109506674B (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 | ||
| TR01 | Transfer of patent right | ||
| TR01 | Transfer of patent right |
Effective date of registration: 20210918 Address after: 621000 No.6, south section of the Second Ring Road, Fucheng District, Mianyang City, Sichuan Province Patentee after: LOW SPEED AERODYNAMIC INSTITUTE OF CHINESE AERODYNAMIC RESEARCH AND DEVELOPMENT CENTER Address before: 621000 No.6, south section of the Second Ring Road, Fucheng District, Mianyang City, Sichuan Province Patentee before: LOW SPEED AERODYNAMIC INSTITUTE OF CHINESE AERODYNAMIC RESEARCH AND DEVELOPMENT CENTER Patentee before: WUXI BEWIS SENSING TECHNOLOGY Co.,Ltd. |