CN106482734A - 一种用于imu多传感器数据融合的滤波方法 - Google Patents
一种用于imu多传感器数据融合的滤波方法 Download PDFInfo
- Publication number
- CN106482734A CN106482734A CN201610860273.2A CN201610860273A CN106482734A CN 106482734 A CN106482734 A CN 106482734A CN 201610860273 A CN201610860273 A CN 201610860273A CN 106482734 A CN106482734 A CN 106482734A
- Authority
- CN
- China
- Prior art keywords
- theta
- angle
- attitude
- filter
- sin
- 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.)
- Pending
Links
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/18—Stabilised platforms, e.g. by gyroscope
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Automation & Control Theory (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Gyroscopes (AREA)
- Navigation (AREA)
Abstract
本发明提出了一种用于IMU多传感器数据融合的滤波方法,首先对数据进行采集,由陀螺仪、加速度计等多个传感器组成的IMU惯性测量单元获取飞行器的姿态数据,并建立传感器输出信息的数学模型表达式;其次对输出数据进行处理,主要包括利用滑动均值滤波去除干扰信息和噪声,再基于四元素法解算各传感器的旋转角度;然后利用高通滤波器和低通滤波器相结合,在低通滤波部分加入PI控制参数,引入比例系数变量Kp和积分系数变量KI设计二阶互补滤波器的误差修正负反馈,实现各传感器数据融合,最后输出姿态角。本发明通过对PI控制参数的引入和设定,设计含有负反馈的二阶互补滤波算法对各传感器信息融合,提高系统的测量精度和动态性能。
Description
技术领域
本发明属于数字图像处理领域,涉及滤波方法,特指一种用于IMU多传感器数据融合的滤波方法。
背景技术
随着微机电系统技术的发展,为了满足广泛应用的需求,采用微机械陀螺仪、加速度计、磁力计等构造微小型低成本的航姿参考系统。同时微小型无人机具有成本低、隐蔽性好、生存能力强等特点,近年来在军事、民用等相关领域中得到越来越多的应用。姿态测量是无人机实现姿态控制的前提,也是导航系统中不可分割的重要组成部分。无人机飞行器姿态主要包括姿态解算和飞行控制两部分,其中,姿态解算是飞行器设计的核心和重点。
姿态解算需要依靠惯性测量器件,加速度计测量载体的姿态角主要利用地球重力场,当载体偏转时,在各方向轴上受的重力不同,容易受其他力矩的影响,但具有较好的静态特性,即低频段的动态响应好;陀螺仪以较短时间间隔读取测量载体坐标系下机体在各方向轴上的角速度,存在温度漂移和零点漂移,随着时间累积其通过积分计算的角速度信息会有较大的姿态误差,但具有较好的高频段动态特性。因此研究具有高可靠性、高精度的IMU多传感器数据融合算法一直是国内外学者关注的焦点。
航姿参考系统利用惯性器件来测量载体姿态角,通常采用多种传感器组合测量,输出含有噪声的姿态信息,经信息滤波筛选之后进行姿态解算,由于各传感器的特点如动态响应速度、累计误差等不同,需要采用相关算法对每个传感器的数据信号进行融合,提高测量精度和系统的动态特性。
常用的数据融合算法有:卡尔曼滤波方法、扩展卡尔曼滤波方法、粒子滤波姿态估计法、梯度下降法、互补滤波方法等。卡尔曼滤波方法应用于惯性导航中取得了较大的成功,但该算法较复杂、运算量大,需要较高的硬件成本,电量耗损大。扩展卡尔曼滤波方法是应用最广泛的一种非线性系统滤波方法,但存在线性化误差、截断误差及发散问题。粒子滤波姿态估计法提高了滤波精度,解决了系统非线性和非白噪声对姿态解算的影响,但计算量较大,不适用于低成本的航姿系统。梯度下降法在姿态解算中性能优于卡尔曼滤波,计算量少,对初始点要求低,但收敛速度较慢。互补滤波方法原理简单、计算量小,通过平率分辨消除噪声,能较好地结合加速度计的静态精度和陀螺仪的高动态姿态数据,利用两者在频域角度的互补特性,提高姿态测量的精度和动态响应,以减少测量和估计的误差,但其高通滤波器和低通滤波器的转接频率难以确定。
发明内容
针对现有方法的不足,本发明提出一种用于IMU多传感器数据融合的滤波方法。其创新性在于各传感器信息的动态响应速度、累计误差不同,解算出的姿态信息具有一定的互补性,通过对PI控制参数的引入和设定,设计含有负反馈信息的二阶互补滤波算法对各传感器信息融合,提高系统的测量精度和动态性能。
为实现上述技术目的,本发明的技术方案是,
一种用于IMU多传感器数据融合的滤波方法,包括以下步骤:
(1)利用陀螺仪、加速度计组成的IMU惯性检测系统获取飞行器的姿态信息,对各传感器的输出信号进行表示,建立传感器输出信号的数学模型表达式;
陀螺仪的误差主要由随机漂移和噪声构成,设ywt为陀螺仪的输出信号,wt为真实角速度值,vwt为测量噪声,b为漂移量,则数学模型可表示为:
ywt=wt+vwt+b (1)
同理,加速度计的输出信号为yat,载体运动的加速度为at,地球重力加速度为gt,其中 为旋转矩阵,vat表示高斯白噪声,则加速度计的数学模型可表示为:
yat=at-gt+vat (2)
(2)利用滑动均值滤波去除步骤(1)数学模型表达式中的测量噪声和高斯白噪声以及干扰信息,提高系统的精度;其中滑动均值滤波器公式为:
其中yi为各传感器输出的原始数据,w为滑动均值滤波器的输出结果,n为滑动均值滤波器阶数。
由公式(3)可以看出,每次参与滤波的传感器数据始终为当前传感器最新采样的n个数据,滑动均值滤波器只涉及线性运算,可以保证滤波的实时性。
(3)基于四元素向量法,将各传感器去噪后的输出数据转化为四元素,建立载体坐标系与参考坐标系之间的空间角位置关系,利用变换矩阵得到姿态角的四元素表达式,分别进行加速度计和陀螺仪的旋转加速度和旋转角速度姿态角解算。
a.确定两坐标系间的关系
飞行器的姿态由俯仰角θ、横滚角φ、偏航角ψ描述,选取东北天坐标系(g系)为参考坐标系,即以坐标系载体的重心为坐标原点,Xg指向正北方向,Yg指向正东方向,Zg轴与Xg轴和Yg轴构成的平面垂直,指向天空;载体坐标系(b系)以载体作为参考,坐标原点为载体重心,Xb为载体横轴,Yb为载体纵轴,Zb轴垂直于Xb轴和Yb轴构成的平面,XbYbZb构成右手坐标系。
参考坐标系被认为是固定不变的,载体坐标系相对于参考坐标系的方位变化,相对变化情况即为待求的载体姿态,常用姿态角表示,两坐标系之间的关系可以用旋转矩阵表示为:
b.将各传感器经步骤(2)去噪处理后的输出数据转化为四元素表示形式。
由式(4)可知,当俯仰角θ为正负90°时,欧拉角计算中会出现奇异点,导致数值不稳定,因此可将传感器采集到的姿态数据经过去噪处理之后,转化为四元素表示方法,其表达式为:
其中q0、q1、q2、q3均为实数,i、j、k为相互正交的单位向量。
c.将四元素向量规范化处理之后,变换矩阵可表示为:
d.用四元素法中的参数推导得到姿态角表达式为:
基于四元素法进行姿态解算利用了加速度计和陀螺仪所测数据,加速度计主要是测量载体坐标系下旋转加速度,陀螺仪主要测量载体坐标系下的旋转角速度。以加速度计在无加速状态(即静止或匀速运动)时的输出结果计算IMU惯性检测系统的初始欧拉角,联立(4)(5)(6)式求出初始四元素,对陀螺仪的角速度进行等时间间隔定时采样得到IMU惯性检测系统角增量,结合四元素微分方程,根据上一时刻姿态四元素求解当前时刻更新的姿态四元素,代入(7)式完成姿态解算。
四元素微分方程如下式所示:
其中Δθx、Δθy、Δθz分别为定时采样时三个轴的角增量,I为单位矩阵,由th时刻定时采样的角增量,结合四元素微分方程式可求得th+1时刻的四元素Q(th+1)。
(4)设计二阶互补滤波器对姿态解算得到的加速度计姿态角进行低通滤波,对陀螺仪姿态角进行高通滤波,并实现各传感器数据融合,最后输出姿态角。
以俯仰角θ为例,θa为姿态解算得到的加速度计俯仰角,θw为姿态解算得到的陀螺仪俯仰角,在二阶互补滤波器中的低通滤波部分,通过姿态解算得到的加速度计俯仰角θa与前一次滤波更新后姿态角中的俯仰角θ之间存在的误差值θerr作为二阶互补滤波器的二次输入值即反馈角度作为新的输入值形成负反馈,实现二阶互补滤波的误差修正,二阶互补滤波器各部分的具体表达式为:
上式中,x1和x2为中间变量,Kp为比例系数变量,KI为积分系数变量,τ为滤波器时间常数,1/τ为滤波器截止频率,dt为滤波器采样时间,θt为最终输出的俯仰角。
同理,利用二阶互补滤波器对横滚角φw和偏航角ψw姿态数据融合,得到最终输出的横滚角φt和偏航角ψt。
其中,Kp为比例系数变量,KI为积分系数变量的确定方法有很多,主要有临界比例法、反映曲线法、衰减法等,一般先确定比例系数Kp,再确定积分系数KI。具体方法为首先设定积分系数KI为0,将二阶互补滤波器变为纯比例调节,然后将Kp的值由零开始逐步增大,直至二阶互补滤波器出现振荡,再反过来调节将Kp值逐步减小,直至二阶互补滤波器振荡消失,记录当前的比例系数值Kp;比例系数值Kp确定之后,设定一个较大的积分时间常数Ti(一般设置为允许输出最大值的60%至70%。),然后逐渐减小,直至二阶互补滤波器出现振荡,再反过来增大Ti,直至二阶互补滤波器振荡消失,记录当前的Ti值,积分系数Ki=Kp/Ti。
本发明通过对PI控制参数的引入和设定,设计含有负反馈的二阶互补滤波算法对各传感器信息融合,提高系统的测量精度和动态性能。
附图说明
图1为本发明的原理图
图2为两坐标系角度转换关系示意图
图3为二阶互补滤波器的原理图
具体实施方式
为使本发明的目的、技术方案和优点更加清楚,下面将结合附图对本发明实施方式作进一步地详细描述。
参照图1本发明提出了一种用于IMU多传感器数据融合的滤波方法,首先对数据进行采集,由陀螺仪、加速度计等多个传感器组成的IMU惯性检测系统获取飞行器的姿态数据,并建立传感器输出信号的数学模型表达式;其次对各传感器的输出数据进行处理,主要包括利用滑动均值滤波去除干扰信息和噪声,再基于四元素法解算各传感器的旋转角度;然后利用高通滤波器和低通滤波器相结合,在低通滤波部分加入PI控制参数,引入比例系数变量Kp和积分系数变量KI设计二阶互补滤波器的误差修正负反馈,实现各传感器数据融合,最后输出姿态角。下面对本发明的各个步骤作进一步的详细说明。
(1)以三轴陀螺仪和三轴加速度计传感器为例,首先建立传感器的数学模型。
陀螺仪的误差主要由随机漂移和噪声构成,设ywt为陀螺仪输出信号,wt为真实角速度值,vwt为测量噪声,b为漂移量,则数学模型可表示为:
ywt=wt+vwt+b (1)
同理,加速度计的输出信号为yat,载体运动的加速度为at,地球重力加速度为gt,其中 为旋转矩阵,vat表示高斯白噪声,则加速度计的数学模型可表示为:
yat=at-gt+vat (2)
(2)如图1所示,首先对各传感器采集的信号建立数学模型表示式,输出值主要包括真实测量值、漂移量和干扰噪声。加速度传感器可以将物体的加速度信息转换为数字量的传感器,其输出信号主要代表了直线的加速度大小和重力方向夹角,以低频信号为主,陀螺仪传感器输出信号具有高动态相应特点,输出信号中含有噪声,主要为高斯白噪声,在姿态解算之前,可以利用低通滤波器或均值滤波器对传感器输出信息去噪。
由传感器的误差分析和数学建模表达式可知,无论是加速度计还是陀螺仪,输出值中都存在着不同程度的测量误差,为了剥离干扰信号和噪声的影响,提高系统的精度,对传感器输出信息进行数据处理。本实施例采用滑动均值滤波的方法,其滤波器公式为:
其中:yi为各传感器输出的原始数据,w为滑动均值滤波器的输出结果,n为滑动滤波器阶数。
由公式(3)可以看出,每次参与滤波的传感器数据始终为当前传感器最新采样的n个数据,滑动滤波器只涉及线性运算,可以保证滤波的实时性。
(3)传感器输出信号去除噪声之后,基于四元素法对其进行姿态角解算。
首先建立坐标系关系,如图2所示。物体的运动都是相对的,计算载体的位置和姿态,需要选定参考坐标系,以参考坐标系为基准,研究载体坐标系与参考坐标系的相对运动。
飞行器的姿态由俯仰角θ、横滚角φ、偏航角ψ描述,选取东北天坐标系(g系)为参考坐标系,即以坐标系载体的重心为坐标原点,Xg指向正北方向,Yg指向正东方向,Zg轴与Xg轴和Yg轴构成的平面垂直,指向天空;
载体坐标系(b系)以载体作为参考,载体与六轴传感器固定相连,坐标原点为载体重心,Xb为载体横轴,Yb为载体纵轴,Zb轴垂直于Xb轴和Yb轴构成的平面,XbYbZb构成右手坐标系。
参考坐标系被认为是固定不变的,载体坐标系相对于参考坐标系的方位变化,相对变化情况即为我们所求的载体姿态,常用姿态角表示,如图2所示,两坐标系之间的关系可以用旋转矩阵表示为:
由式子(4)可知,当俯仰角θ为正负90°时,欧拉角计算中会出现奇异点,导致数值不稳定,因此可将传感器采集到的姿态数据经过去噪处理之后,转化为四元素表示方法,其表达式为:
其中q0、q1、q2、q3均为实数,i、j、k为相互正交的单位向量。
将四元素向量规范化处理之后,变换矩阵可表示为:
其中四元素向量规范化处理的过程:
进一步,可用四元素法中的参数推导得到姿态角表达式为:
基于四元素法进行姿态解算利用了加速度计和陀螺仪所测数据,加速度计主要是测量载体坐标系下旋转加速度,陀螺仪主要测量载体坐标系下的旋转角速度。以加速度计在无加速状态(即静止或匀速运动)时的输出结果计算IMU惯性检测系统的初始欧拉角,联立(4)(5)(6)式求出初始四元素,对陀螺仪的角速度进行等时间间隔定时采样得到IMU惯性检测系统角增量,结合四元素微分方程,根据上一时刻姿态四元素求解当前时刻更新的姿态四元素,代入(7)式完成姿态解算。
(4)陀螺仪短时间内测量精度高,但存在漂移误差,随着时间累积,精度变差;加速度计短期精度差,但测量误差不会随着时间累积而增加。
由互补滤波器的设计原理可知,加速度计的测量输出进行低通滤波,能有效的抑制加速度计的高频噪声,高通滤波器能很好地抑制陀螺仪输出信号的低频漂移。因此,利用两者在频率上的互补关系,设计互补滤波算法对姿态数据进行融合,提高姿态的测量精度和动态响应。
由于互补滤波算法中的低通滤波器阻带衰减较慢,当噪声较大时滤波效果不理想,因此在低通滤波部分加入PI参数控制,引入参数变量Kp作为比例系数和参数KI为积分系数,设计改进的互补滤波器即本实施例中提供的二阶互补滤波器。其中PI控制器参数的工程整定方法有很多,主要有临界比例法、反映曲线法、衰减法等,一般先确定比例系数Kp,再确定积分系数KI。具体方法为首先设定积分系数KI为0,将系统变为纯比例调节,然后将Kp的值由零开始逐步增大,直至系统出现振荡,再反过来调节将Kp值逐步减小,直至系统振荡消失,记录当前的比例系数值Kp;比例系数值确定之后,设定一个较大的积分时间常数Ti(一般设置为允许输出最大值的60%至70%),然后逐渐减小,直至系统出现振荡,再反过来增大Ti,直至系统振荡消失,记录当前的Ti值,积分系数Ki=Kp/Ti。
以俯仰角θ为例,θa为加速度计数据处理后输出的俯仰角,θw为陀螺仪数据处理后输出的俯仰角,如图3所示。以x1和x2为中间变量,对低通滤波部分进行了改进,通过加速度计姿态解算后的俯仰角θa与前一次滤波更新后的俯仰角θ之间存在的误差值θerr,然后将误差值作为改进的互补滤波器的二次输入值即反馈角度作为新的输入值形成负反馈,实现二阶互补滤波的误差修正。
由图3可知,改进后的互补滤波器各部分的具体表达式为:
上式中,τ为滤波器时间常数,1/τ为滤波器截止频率,dt为滤波器采样时间,θt为最终输出的俯仰角。
同理,利用二阶互补滤波器对横滚角φw和偏航角ψw姿态数据融合,得到最终输出的横滚角φt和偏航角ψt。
以上包含了本发明优选实施例的说明,这是为了详细说明本发明的技术特征,并不是想要将发明内容限制在实施例所描述的具体形式中,依据本发明内容主旨进行的其他修改和变型也受本专利保护。本发明内容的主旨是由权利要求书所界定,而非由实施例的具体描述所界定。
Claims (6)
1.一种用于IMU多传感器数据融合的滤波方法,其特征在于,包括以下步骤:
(1)利用陀螺仪、加速度计获取飞行器的姿态信息,建立传感器输出信号的数学模型表达式;
陀螺仪的误差主要由随机漂移和噪声构成,设ywt为陀螺仪的输出信号,wt为真实角速度值,vwt为测量噪声,b为漂移量,则数学模型可表示为:
ywt=wt+vwt+b (1)
加速度计的输出信号为yat,载体运动的加速度为at,地球重力加速度为gt,其中 为旋转矩阵,vat表示高斯白噪声,则加速度计的数学模型可表示为:
yat=at-gt+vat (2)
(2)利用滑动均值滤波器去除步骤(1)数学模型表达式中的测量噪声和高斯白噪声以及干扰信息,提高系统的精度;
(3)基于四元素向量法,将各传感器去噪后的输出数据转化为四元素,建立载体坐标系与参考坐标系之间的空间角位置关系,利用变换矩阵得到姿态角的四元素表达式,分别进行加速度计和陀螺仪的旋转加速度和旋转角速度姿态角解算;
(4)设计二阶互补滤波器对姿态解算得到的加速度计姿态角进行低通滤波,对陀螺仪姿态角进行高通滤波,并实现各传感器数据融合,最后输出姿态角。
2.根据权利要求1所述的用于IMU多传感器数据融合的滤波方法,其特征在于,步骤(2)中滑动均值滤波器的公式为:
其中yi为各传感器输出的原始数据,w为滑动均值滤波器的输出结果,n为滑动均值滤波器阶数。
3.根据权利要求1所述的用于IMU多传感器数据融合的滤波方法,其特征在于,步骤(3)的方法为:
a.飞行器的姿态由俯仰角θ、横滚角φ、偏航角ψ描述,选取东北天坐标系为参考坐标系,即以坐标系载体的重心为坐标原点,Xg指向正北方向,Yg指向正东方向,Zg轴与Xg轴和Yg轴构成的平面垂直,指向天空;载体坐标系以载体作为参考,坐标原点为载体重心,Xb为载体横轴,Yb为载体纵轴,Zb轴垂直于Xb轴和Yb轴构成的平面,XbYbZb构成右手坐标系;
参考坐标系被认为是固定不变的,载体坐标系相对于参考坐标系的方位变化,相对变化情况即为待求的载体姿态,用姿态角表示,两坐标系之间的关系可以用旋转矩阵表示为:
b.将各传感器经步骤(2)去噪处理后的输出数据转化为四元素表示形式,其表达式为:
其中q0、q1、q2、q3均为实数,i、j、k为相互正交的单位向量;
c.将四元素向量规范化处理之后,变换矩阵可表示为:
d.用四元素法中的参数推导得到姿态角表达式为:
加速度计测量载体坐标系下旋转加速度,陀螺仪测量载体坐标系下的旋转角速度;以加速度计在无加速状态时的输出结果计算由陀螺仪和加速度计组成的检测系统的初始欧拉角,联立(4)(5)(6)式求出初始四元素,对陀螺仪的角速度进行等时间间隔定时采样得到由陀螺仪和加速度计组成的检测系统的角增量,结合四元素微分方程,根据上一时刻姿态四元素求解当前时刻更新的姿态四元素,代入(7)式完成姿态解算。
4.根据权利要求3所述的用于IMU多传感器数据融合的滤波方法,其特征在于,步骤(3)中,四元素微分方程如下式所示:
其中Δθx、Δθy、Δθz分别为定时采样时三个轴的角增量,I为单位矩阵,由th时刻定时采样的角增量,结合四元素微分方程式可求得th+1时刻的四元素Q(th+1)。
5.根据权利要求3所述的用于IMU多传感器数据融合的滤波方法,其特征在于,步骤(4)的方法为:
以俯仰角θ为例,θa为姿态解算得到的加速度计俯仰角,θw为姿态解算得到的陀螺仪俯仰角,在二阶互补滤波器中的低通滤波部分,通过姿态解算得到的加速度计俯仰角θa与前一次滤波更新后的俯仰角θ之间存在的误差值θerr,然后将误差值作为改进的互补滤波器的二次输入值即反馈角度作为新的输入值形成负反馈,实现二阶互补滤波的误差修正,二阶互补滤波器各部分的具体表达式为:
上式中,x1和x2为中间变量,Kp为比例系数变量,KI为积分系数变量,τ为滤波器时间常数,1/τ为滤波器截止频率,dt为滤波器采样时间,θt为最终输出的俯仰角;
同理,利用二阶互补滤波器对横滚角φw和偏航角ψw姿态数据融合,得到最终输出的横滚角φt和偏航角ψt。
6.根据权利要求4所述的用于IMU多传感器数据融合的滤波方法,其特征在于,步骤(4)中Kp和KI的确定方法为:
首先设定积分系数KI为0,将二阶互补滤波器变为纯比例调节,然后将Kp的值由零开始逐步增大,直至二阶互补滤波器出现振荡,再反过来调节将Kp值逐步减小,直至二阶互补滤波器振荡消失,记录当前的比例系数值Kp;比例系数值Kp确定之后,设定一个较大的积分时间常数Ti,然后逐渐减小,直至二阶互补滤波器出现振荡,再反过来增大Ti,直至二阶互补滤波器振荡消失,记录当前的Ti值,积分系数KI=Kp/Ti。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610860273.2A CN106482734A (zh) | 2016-09-28 | 2016-09-28 | 一种用于imu多传感器数据融合的滤波方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610860273.2A CN106482734A (zh) | 2016-09-28 | 2016-09-28 | 一种用于imu多传感器数据融合的滤波方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN106482734A true CN106482734A (zh) | 2017-03-08 |
Family
ID=58267896
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201610860273.2A Pending CN106482734A (zh) | 2016-09-28 | 2016-09-28 | 一种用于imu多传感器数据融合的滤波方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN106482734A (zh) |
Cited By (34)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107883951A (zh) * | 2017-10-19 | 2018-04-06 | 福建海图智能科技有限公司 | 一种水下机器人三维姿态的计算方法及终端 |
CN108120439A (zh) * | 2017-12-21 | 2018-06-05 | 北华航天工业学院 | 一种三分量感应线圈姿态测量方法及装置 |
CN108748220A (zh) * | 2018-05-28 | 2018-11-06 | 武汉理工大学 | 一种基于惯性测量单元的脚-机跟随控制方法及控制系统 |
CN108827299A (zh) * | 2018-03-29 | 2018-11-16 | 南京航空航天大学 | 一种基于改进四元数二阶互补滤波的飞行器姿态解算方法 |
CN108958362A (zh) * | 2017-05-25 | 2018-12-07 | 意法半导体股份有限公司 | 实现融合来自惯性传感器的数据的算法的计算系统和方法 |
CN109186571A (zh) * | 2018-09-14 | 2019-01-11 | 高新兴科技集团股份有限公司 | 一种陀螺仪滤波去噪方法 |
CN109470613A (zh) * | 2018-11-12 | 2019-03-15 | 湖南电气职业技术学院 | 一种基于互补滤波姿态融合算法的无人机pm2.5检测装置 |
CN109625205A (zh) * | 2019-01-09 | 2019-04-16 | 哈尔滨理工大学 | 一种减摇鳍多反馈升力信号的分步融合方法 |
CN109674480A (zh) * | 2019-02-02 | 2019-04-26 | 北京理工大学 | 一种基于改进互补滤波的人体运动姿态解算方法 |
CN109724602A (zh) * | 2018-12-17 | 2019-05-07 | 南京理工大学 | 一种基于硬件fpu的姿态解算系统及其解算方法 |
CN109781107A (zh) * | 2017-11-15 | 2019-05-21 | 北京自动化控制设备研究所 | 一种低精度惯导滚动角确定方法 |
CN109931929A (zh) * | 2019-01-25 | 2019-06-25 | 南京薄幕软件科技有限公司 | 一种基于四元数的无人机姿态解算方法 |
CN110101388A (zh) * | 2019-05-17 | 2019-08-09 | 南京东奇智能制造研究院有限公司 | 一种基于mimu的便携脊柱测量仪及方法 |
CN110377058A (zh) * | 2019-08-30 | 2019-10-25 | 深圳市道通智能航空技术有限公司 | 一种飞行器的偏航角修正方法、装置及飞行器 |
CN110645976A (zh) * | 2019-10-16 | 2020-01-03 | 浙江大华技术股份有限公司 | 一种移动机器人的姿态估计方法及终端设备 |
CN110689513A (zh) * | 2019-09-26 | 2020-01-14 | 石家庄铁道大学 | 彩色图像融合方法、装置和终端设备 |
CN110887463A (zh) * | 2019-10-14 | 2020-03-17 | 交通运输部水运科学研究所 | 一种基于惯性传感器的海浪起伏幅度检测方法及系统 |
CN110887481A (zh) * | 2019-12-11 | 2020-03-17 | 中国空气动力研究与发展中心低速空气动力研究所 | 基于mems惯性传感器的载体动态姿态估计方法 |
CN112166304A (zh) * | 2018-04-03 | 2021-01-01 | 祖克斯有限公司 | 传感器数据的误差检测 |
CN112462793A (zh) * | 2019-09-09 | 2021-03-09 | 顺丰科技有限公司 | 基于传感器的设备控制方法、装置、计算机设备 |
CN113218391A (zh) * | 2021-03-23 | 2021-08-06 | 合肥工业大学 | 一种基于ewt算法的姿态解算方法 |
CN113535812A (zh) * | 2021-06-29 | 2021-10-22 | 浙江中控技术股份有限公司 | 工况稳态检测方法、过程优化方法 |
CN113992846A (zh) * | 2021-10-19 | 2022-01-28 | 上海艾为电子技术股份有限公司 | 姿态角的获取方法、防抖控制方法以及移动终端 |
CN113985778A (zh) * | 2021-10-28 | 2022-01-28 | 北京环境特性研究所 | 车载光电传感器的控制系统及方法 |
CN114676552A (zh) * | 2022-01-27 | 2022-06-28 | 西安电子科技大学 | 一种基于互补滤波的钻具重力加速度提取方法 |
US11407098B2 (en) | 2019-11-26 | 2022-08-09 | Stmicroelectronics S.R.L. | Smart push button device utilizing MEMS sensors |
CN115063945A (zh) * | 2022-06-20 | 2022-09-16 | 浙江科技学院 | 基于姿态融合解算的跌倒检测报警方法及系统 |
CN115060259A (zh) * | 2022-08-19 | 2022-09-16 | 江苏德一佳安防科技有限公司 | 多imu融合的定位系统及方法 |
CN115444405A (zh) * | 2022-08-29 | 2022-12-09 | 同济大学 | 基于腰骶部穿戴式设备的摔倒预判方法、装置及存储介质 |
CN115683112A (zh) * | 2022-10-24 | 2023-02-03 | 中国航空工业集团公司洛阳电光设备研究所 | 一种基于互补滤波器的光电跟踪系统量化误差抑制方法 |
CN115855170A (zh) * | 2023-03-02 | 2023-03-28 | 深圳市瑞芬科技有限公司 | 一种基于融合模型算法的倾斜角与振动特性测量系统 |
US11656071B2 (en) | 2020-05-05 | 2023-05-23 | Stmicroelectronics S.R.L. | Electronic apparatus control method performed through lid angle calculation, electronic apparatus thereof and software product |
CN116953290A (zh) * | 2023-09-18 | 2023-10-27 | 浙江力夫传感技术有限公司 | 风速变送器探杆角度调整方法及风速变送器 |
US12007237B2 (en) | 2020-05-05 | 2024-06-11 | Stmicroelectronics S.R.L. | Electronic apparatus control method performed through lid angle calculation, electronic apparatus thereof and software product |
Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101413800A (zh) * | 2008-01-18 | 2009-04-22 | 南京航空航天大学 | 导航/稳瞄一体化系统的导航、稳瞄方法 |
US20110313705A1 (en) * | 2008-12-23 | 2011-12-22 | Patrick Esser | Gait monitor |
CN102435167A (zh) * | 2011-09-15 | 2012-05-02 | 北京自动化控制设备研究所 | 基于互补滤波器的成像负载稳定系统控制信息预处理方法 |
CN102692225A (zh) * | 2011-03-24 | 2012-09-26 | 北京理工大学 | 一种用于低成本小型无人机的姿态航向参考系统 |
CN105136145A (zh) * | 2015-08-11 | 2015-12-09 | 哈尔滨工业大学 | 一种基于卡尔曼滤波的四旋翼无人机姿态数据融合的方法 |
CN105300381A (zh) * | 2015-11-23 | 2016-02-03 | 南京航空航天大学 | 一种基于改进互补滤波的自平衡移动机器人姿态快速收敛方法 |
CN105651242A (zh) * | 2016-04-05 | 2016-06-08 | 清华大学深圳研究生院 | 一种基于互补卡尔曼滤波算法计算融合姿态角度的方法 |
CN105652306A (zh) * | 2016-01-08 | 2016-06-08 | 重庆邮电大学 | 基于航迹推算的低成本北斗与mems紧耦合定位系统及方法 |
-
2016
- 2016-09-28 CN CN201610860273.2A patent/CN106482734A/zh active Pending
Patent Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101413800A (zh) * | 2008-01-18 | 2009-04-22 | 南京航空航天大学 | 导航/稳瞄一体化系统的导航、稳瞄方法 |
US20110313705A1 (en) * | 2008-12-23 | 2011-12-22 | Patrick Esser | Gait monitor |
CN102692225A (zh) * | 2011-03-24 | 2012-09-26 | 北京理工大学 | 一种用于低成本小型无人机的姿态航向参考系统 |
CN102435167A (zh) * | 2011-09-15 | 2012-05-02 | 北京自动化控制设备研究所 | 基于互补滤波器的成像负载稳定系统控制信息预处理方法 |
CN105136145A (zh) * | 2015-08-11 | 2015-12-09 | 哈尔滨工业大学 | 一种基于卡尔曼滤波的四旋翼无人机姿态数据融合的方法 |
CN105300381A (zh) * | 2015-11-23 | 2016-02-03 | 南京航空航天大学 | 一种基于改进互补滤波的自平衡移动机器人姿态快速收敛方法 |
CN105652306A (zh) * | 2016-01-08 | 2016-06-08 | 重庆邮电大学 | 基于航迹推算的低成本北斗与mems紧耦合定位系统及方法 |
CN105651242A (zh) * | 2016-04-05 | 2016-06-08 | 清华大学深圳研究生院 | 一种基于互补卡尔曼滤波算法计算融合姿态角度的方法 |
Cited By (50)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108958362A (zh) * | 2017-05-25 | 2018-12-07 | 意法半导体股份有限公司 | 实现融合来自惯性传感器的数据的算法的计算系统和方法 |
CN108958362B (zh) * | 2017-05-25 | 2021-12-17 | 意法半导体股份有限公司 | 实现融合来自惯性传感器的数据的算法的计算系统和方法 |
US11473894B2 (en) | 2017-05-25 | 2022-10-18 | Stmicroelectronics S.R.L. | Computing system implementing an algorithm for fusing data from inertial sensors, and method |
US10976150B2 (en) | 2017-05-25 | 2021-04-13 | Stmicroelectronics S.R.L. | Computing system implementing an algorithm for fusing data from inertial sensors, and method |
CN107883951A (zh) * | 2017-10-19 | 2018-04-06 | 福建海图智能科技有限公司 | 一种水下机器人三维姿态的计算方法及终端 |
CN109781107A (zh) * | 2017-11-15 | 2019-05-21 | 北京自动化控制设备研究所 | 一种低精度惯导滚动角确定方法 |
CN108120439A (zh) * | 2017-12-21 | 2018-06-05 | 北华航天工业学院 | 一种三分量感应线圈姿态测量方法及装置 |
CN108827299B (zh) * | 2018-03-29 | 2022-04-12 | 南京航空航天大学 | 一种基于改进四元数二阶互补滤波的飞行器姿态解算方法 |
CN108827299A (zh) * | 2018-03-29 | 2018-11-16 | 南京航空航天大学 | 一种基于改进四元数二阶互补滤波的飞行器姿态解算方法 |
CN112166304B (zh) * | 2018-04-03 | 2023-07-25 | 祖克斯有限公司 | 传感器数据的误差检测 |
CN112166304A (zh) * | 2018-04-03 | 2021-01-01 | 祖克斯有限公司 | 传感器数据的误差检测 |
CN108748220A (zh) * | 2018-05-28 | 2018-11-06 | 武汉理工大学 | 一种基于惯性测量单元的脚-机跟随控制方法及控制系统 |
CN109186571A (zh) * | 2018-09-14 | 2019-01-11 | 高新兴科技集团股份有限公司 | 一种陀螺仪滤波去噪方法 |
CN109470613B (zh) * | 2018-11-12 | 2020-07-03 | 湖南电气职业技术学院 | 一种基于互补滤波姿态融合算法的无人机pm2.5检测装置 |
CN109470613A (zh) * | 2018-11-12 | 2019-03-15 | 湖南电气职业技术学院 | 一种基于互补滤波姿态融合算法的无人机pm2.5检测装置 |
CN109724602A (zh) * | 2018-12-17 | 2019-05-07 | 南京理工大学 | 一种基于硬件fpu的姿态解算系统及其解算方法 |
CN109625205A (zh) * | 2019-01-09 | 2019-04-16 | 哈尔滨理工大学 | 一种减摇鳍多反馈升力信号的分步融合方法 |
CN109931929A (zh) * | 2019-01-25 | 2019-06-25 | 南京薄幕软件科技有限公司 | 一种基于四元数的无人机姿态解算方法 |
CN109674480A (zh) * | 2019-02-02 | 2019-04-26 | 北京理工大学 | 一种基于改进互补滤波的人体运动姿态解算方法 |
CN110101388A (zh) * | 2019-05-17 | 2019-08-09 | 南京东奇智能制造研究院有限公司 | 一种基于mimu的便携脊柱测量仪及方法 |
CN110101388B (zh) * | 2019-05-17 | 2022-02-18 | 南京东奇智能制造研究院有限公司 | 一种基于mimu的便携脊柱测量仪及方法 |
WO2021037047A1 (zh) * | 2019-08-30 | 2021-03-04 | 深圳市道通智能航空技术有限公司 | 一种飞行器的偏航角修正方法、装置及飞行器 |
CN110377058A (zh) * | 2019-08-30 | 2019-10-25 | 深圳市道通智能航空技术有限公司 | 一种飞行器的偏航角修正方法、装置及飞行器 |
CN110377058B (zh) * | 2019-08-30 | 2021-11-09 | 深圳市道通智能航空技术股份有限公司 | 一种飞行器的偏航角修正方法、装置及飞行器 |
CN112462793A (zh) * | 2019-09-09 | 2021-03-09 | 顺丰科技有限公司 | 基于传感器的设备控制方法、装置、计算机设备 |
CN110689513B (zh) * | 2019-09-26 | 2022-09-02 | 石家庄铁道大学 | 彩色图像融合方法、装置和终端设备 |
CN110689513A (zh) * | 2019-09-26 | 2020-01-14 | 石家庄铁道大学 | 彩色图像融合方法、装置和终端设备 |
CN110887463A (zh) * | 2019-10-14 | 2020-03-17 | 交通运输部水运科学研究所 | 一种基于惯性传感器的海浪起伏幅度检测方法及系统 |
CN110645976B (zh) * | 2019-10-16 | 2021-09-14 | 浙江华睿科技股份有限公司 | 一种移动机器人的姿态估计方法及终端设备 |
CN110645976A (zh) * | 2019-10-16 | 2020-01-03 | 浙江大华技术股份有限公司 | 一种移动机器人的姿态估计方法及终端设备 |
US11407098B2 (en) | 2019-11-26 | 2022-08-09 | Stmicroelectronics S.R.L. | Smart push button device utilizing MEMS sensors |
CN110887481A (zh) * | 2019-12-11 | 2020-03-17 | 中国空气动力研究与发展中心低速空气动力研究所 | 基于mems惯性传感器的载体动态姿态估计方法 |
US12007237B2 (en) | 2020-05-05 | 2024-06-11 | Stmicroelectronics S.R.L. | Electronic apparatus control method performed through lid angle calculation, electronic apparatus thereof and software product |
US11656071B2 (en) | 2020-05-05 | 2023-05-23 | Stmicroelectronics S.R.L. | Electronic apparatus control method performed through lid angle calculation, electronic apparatus thereof and software product |
CN113218391A (zh) * | 2021-03-23 | 2021-08-06 | 合肥工业大学 | 一种基于ewt算法的姿态解算方法 |
CN113535812A (zh) * | 2021-06-29 | 2021-10-22 | 浙江中控技术股份有限公司 | 工况稳态检测方法、过程优化方法 |
CN113535812B (zh) * | 2021-06-29 | 2024-01-30 | 浙江中控技术股份有限公司 | 工况稳态检测方法、过程优化方法 |
CN113992846A (zh) * | 2021-10-19 | 2022-01-28 | 上海艾为电子技术股份有限公司 | 姿态角的获取方法、防抖控制方法以及移动终端 |
CN113985778A (zh) * | 2021-10-28 | 2022-01-28 | 北京环境特性研究所 | 车载光电传感器的控制系统及方法 |
CN113985778B (zh) * | 2021-10-28 | 2024-01-19 | 北京环境特性研究所 | 车载光电传感器的控制系统及方法 |
CN114676552A (zh) * | 2022-01-27 | 2022-06-28 | 西安电子科技大学 | 一种基于互补滤波的钻具重力加速度提取方法 |
CN115063945B (zh) * | 2022-06-20 | 2023-12-29 | 浙江科技学院 | 基于姿态融合解算的跌倒检测报警方法及系统 |
CN115063945A (zh) * | 2022-06-20 | 2022-09-16 | 浙江科技学院 | 基于姿态融合解算的跌倒检测报警方法及系统 |
CN115060259A (zh) * | 2022-08-19 | 2022-09-16 | 江苏德一佳安防科技有限公司 | 多imu融合的定位系统及方法 |
CN115444405A (zh) * | 2022-08-29 | 2022-12-09 | 同济大学 | 基于腰骶部穿戴式设备的摔倒预判方法、装置及存储介质 |
CN115683112A (zh) * | 2022-10-24 | 2023-02-03 | 中国航空工业集团公司洛阳电光设备研究所 | 一种基于互补滤波器的光电跟踪系统量化误差抑制方法 |
CN115683112B (zh) * | 2022-10-24 | 2024-04-09 | 中国航空工业集团公司洛阳电光设备研究所 | 一种基于互补滤波器的光电跟踪系统量化误差抑制方法 |
CN115855170A (zh) * | 2023-03-02 | 2023-03-28 | 深圳市瑞芬科技有限公司 | 一种基于融合模型算法的倾斜角与振动特性测量系统 |
CN116953290A (zh) * | 2023-09-18 | 2023-10-27 | 浙江力夫传感技术有限公司 | 风速变送器探杆角度调整方法及风速变送器 |
CN116953290B (zh) * | 2023-09-18 | 2024-01-12 | 浙江力夫传感技术有限公司 | 风速变送器探杆角度调整方法及风速变送器 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106482734A (zh) | 一种用于imu多传感器数据融合的滤波方法 | |
CN101672649B (zh) | 一种基于数字低通滤波的船用光纤捷联系统系泊对准方法 | |
CN107525503B (zh) | 基于双天线gps和mimu组合的自适应级联卡尔曼滤波方法 | |
CN106342284B (zh) | 一种飞行载体姿态确定方法 | |
CN101033973B (zh) | 微小型飞行器微惯性组合导航系统的姿态确定方法 | |
CN108318038A (zh) | 一种四元数高斯粒子滤波移动机器人姿态解算方法 | |
CN104698485B (zh) | 基于bd、gps及mems的组合导航系统及导航方法 | |
CN109425339B (zh) | 一种基于惯性技术的考虑杆臂效应的舰船升沉误差补偿方法 | |
CN100405014C (zh) | 一种载体姿态测量方法 | |
CN101074881B (zh) | 一种月球探测器软着陆阶段惯性导航方法 | |
CN102519460A (zh) | 一种捷联惯性导航系统非线性对准方法 | |
CN103712598B (zh) | 一种小型无人机姿态确定方法 | |
CN104165638B (zh) | 一种双轴旋转惯导系统多位置自主标定方法 | |
CN102538821B (zh) | 一种快速、参数分段式捷联惯性导航系统自对准方法 | |
CN109682377A (zh) | 一种基于动态步长梯度下降的姿态估计方法 | |
CN107063262A (zh) | 一种用于无人机姿态解算的互补滤波方法 | |
CN112630813A (zh) | 基于捷联惯导和北斗卫星导航系统的无人机姿态测量方法 | |
CN105300381A (zh) | 一种基于改进互补滤波的自平衡移动机器人姿态快速收敛方法 | |
CN105890593A (zh) | 一种mems惯性导航系统及基于该系统的轨迹重构方法 | |
CN108981694A (zh) | 基于小波神经网络与ekf的姿态解算方法及系统 | |
CN104764467A (zh) | 空天飞行器惯性传感器误差在线自适应标定方法 | |
CN107255474A (zh) | 一种融合电子罗盘和陀螺仪的pdr航向角确定方法 | |
CN102305635B (zh) | 一种光纤捷联罗经系统的对准方法 | |
CN112683274A (zh) | 一种基于无迹卡尔曼滤波的无人机组合导航方法和系统 | |
CN107830861A (zh) | 基于自适应增益互补滤波运动物体姿态测量方法及装置 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
RJ01 | Rejection of invention patent application after publication |
Application publication date: 20170308 |
|
RJ01 | Rejection of invention patent application after publication |