CN105739510A - 一种用于救灾无人机姿态控制的互补滤波方法 - Google Patents
一种用于救灾无人机姿态控制的互补滤波方法 Download PDFInfo
- Publication number
- CN105739510A CN105739510A CN201610020471.8A CN201610020471A CN105739510A CN 105739510 A CN105739510 A CN 105739510A CN 201610020471 A CN201610020471 A CN 201610020471A CN 105739510 A CN105739510 A CN 105739510A
- Authority
- CN
- China
- Prior art keywords
- frequency
- low
- pass filtering
- accelerometer
- acceleration
- 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
- 238000001914 filtration Methods 0.000 title claims abstract description 54
- 230000000295 complement effect Effects 0.000 title claims abstract description 29
- 238000000034 method Methods 0.000 title claims abstract description 21
- 230000004927 fusion Effects 0.000 claims abstract description 16
- 230000001186 cumulative effect Effects 0.000 claims abstract description 6
- 230000001133 acceleration Effects 0.000 claims description 58
- 238000004364 calculation method Methods 0.000 claims description 23
- 238000005070 sampling Methods 0.000 claims description 15
- 230000005484 gravity Effects 0.000 claims description 9
- 238000001228 spectrum Methods 0.000 claims description 6
- 230000004048 modification Effects 0.000 claims description 5
- 238000012986 modification Methods 0.000 claims description 5
- 238000000354 decomposition reaction Methods 0.000 claims description 4
- 230000002238 attenuated effect Effects 0.000 claims description 3
- 230000005540 biological transmission Effects 0.000 claims description 3
- 238000012423 maintenance Methods 0.000 claims description 3
- 230000003068 static effect Effects 0.000 abstract description 2
- 230000008901 benefit Effects 0.000 description 3
- 230000008859 change Effects 0.000 description 3
- 230000006378 damage Effects 0.000 description 2
- 230000010354 integration Effects 0.000 description 2
- 238000012271 agricultural production Methods 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 230000007812 deficiency Effects 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 230000007613 environmental effect Effects 0.000 description 1
- 238000009776 industrial production Methods 0.000 description 1
- 238000009440 infrastructure construction Methods 0.000 description 1
- 230000007774 longterm Effects 0.000 description 1
- 230000007246 mechanism Effects 0.000 description 1
- 238000002360 preparation method Methods 0.000 description 1
- 230000002265 prevention Effects 0.000 description 1
- 230000008569 process Effects 0.000 description 1
- 230000004044 response Effects 0.000 description 1
- 239000011435 rock Substances 0.000 description 1
- 230000008054 signal transmission Effects 0.000 description 1
- 238000005728 strengthening Methods 0.000 description 1
- CCEKAJIANROZEO-UHFFFAOYSA-N sulfluramid Chemical group CCNS(=O)(=O)C(F)(F)C(F)(F)C(F)(F)C(F)(F)C(F)(F)C(F)(F)C(F)(F)C(F)(F)F CCEKAJIANROZEO-UHFFFAOYSA-N 0.000 description 1
- 230000001052 transient effect Effects 0.000 description 1
- 230000000007 visual effect Effects 0.000 description 1
- 230000003313 weakening effect Effects 0.000 description 1
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/08—Control of attitude, i.e. control of roll, pitch, or yaw
- G05D1/0808—Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for aircraft
Landscapes
- Engineering & Computer Science (AREA)
- Aviation & Aerospace Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Gyroscopes (AREA)
Abstract
本发明公开了一种用于救灾无人机姿态控制的互补滤波方法,所述方法包括如下步骤:(1)由于加速度计的输出中含有高平噪声,在数据融合之前,对加速度计的解算值进行低通滤波,滤除噪声干扰和累积增量;(2)由于陀螺仪在静态下,存在温度漂移现象,因此对陀螺仪的解算结果进行高通滤波;(3)加速度计解算姿态角具有较好的低频特性,而高频特性较差,而陀螺仪具有较好的高频动态特性,利用二者频率特性的互补性,进行数据的重构融合。利用本发明的方法,可以较为准确地计算姿态角的值,从而对无人机的姿态进行控制。
Description
技术领域
本发明涉及防灾减灾技术领域,特别是涉及一种用于救灾无人机姿态控制的互补滤波方法。
背景技术
我国幅员辽阔,气候及自然环境复杂多变,各类极端天气与气候日益频发,地震、火山、台风、龙卷、山洪、泥石流等自然灾害已经对我国人民生命财产安全构成了极大的威胁,对基础设施建设、工农业生产、林牧养殖造成了严重破坏。灾害预警是指灾害发生前应急网络的建立和灾害信息的发布,以提前做出针对灾害的防范工作,尽最大可能降低灾害所带来的破坏。在与自然灾害的长期斗争过程中,我国已逐步形成了一系列基于观测数据的灾害预警机制,自然灾害的预警信息***已在实际工作中得到应用。但传统的灾害预警方法信息化和智能化程度不高,预警不及时、信息发布缓慢,且覆盖范围有限,在恶劣的天气环境下信号的传输更是得不到保证。难以做好应对灾害的充分准备。传统的气象基于多终端的灾害预警及信息发布***存在着严重缺陷。
无人机具有速度快、视野广、机动性好、不惧怕恶劣自然环境的优点,搭载智能探测设备的无人机在自然灾害预警信息采集中发挥着重要作用。传统的无人机姿态控制中,姿态角可以由陀螺仪积分得出,也可以通过加速度传感器测量重力加速度在载体系三轴上的向量分解坐标推导得出。其中陀螺仪解算姿态角具有如下优势:(1)高频动态响应特性良好,其输出能够迅速响应姿态角的变化;(2)无高频噪声干扰,输出值平滑;(3)陀螺仪的输出不受外部加速度的干扰,在载体处于剧烈震动的情况下仍能维持稳定的输出;但也具有如下缺陷:(1)陀螺仪的零点会随温度及其它外部环境因素的改变而产生漂移;(2)对陀螺仪输出值的积分会产生累计误差,长时间运行后解算误差较大。利用加速度计解算姿态角具有如下优势:(1)低频特性良好,静态输出稳定,没有漂移和累积误差;(2)姿态解算计算量小,在没有外部加速度时(仅有重力加速度)的情况下,能够迅速得出准确的瞬时姿态角数据;但也具有如下缺陷:(1)有高频噪声干扰;(2)高频动态特性较差,其输出不能迅速响应姿态角的快速变化;(3)容易受到外部加速度的干扰,如果存在除重力加速度之外的加速度,将无法得出准确的姿态角。
发明内容
本发明的目的是针对现有技术中存在的技术缺陷,而提供一种用于救灾无人机姿态控制的互补滤波方法。
为实现本发明的目的,本发明所采用的技术方案是:
一种用于救灾无人机姿态控制的互补滤波方法,所述方法包括如下步骤:
(1)由于加速度计的输出中含有高平噪声,在数据融合之前,对加速度计的解算值进行低通滤波,滤除噪声干扰和累积增量;
(2)由于陀螺仪在静态下,存在温度漂移现象,因此对陀螺仪的解算结果进行高通滤波;
(3)加速度计解算姿态角具有较好的低频特性,而高频特性较差,而陀螺仪具有较好的高频动态特性,利用二者频率特性的互补性,进行数据的重构融合。
所述方法包括如下步骤:将原始输入信号按傅立叶分解展开,即:
对于原始信号中的正弦分量,将会被低通滤波器极大的衰减,但能以很小的衰减通过高通滤波器;对于原始信号中的正弦分量,将会被高通滤波器极大的衰减,但能以很小的衰减通过低通滤波器,将高通滤波器和低通滤波器的输出进行整合,即可得到全部频域内的信号。
所述高通滤波算法如下:
设某一采样时刻,由陀螺仪解算直接得到的姿态角度为θgyro(k)(俯仰角、横滚角或偏航角),前一次采样时刻由陀螺仪解算直接得到的结果为θgyro(k-1),前一次采样时刻高通滤波之后的姿态角为θHighpass(k-1),则当前采样时刻高通滤波之后的姿态角θHighpass(k)的表达式为:
理想的高通滤波的输出量中,仅包含原始信号中频谱高于截止频率的动态部分信号,当原始信号处于低频或维持状态时,高通滤波的输出为0,由于高通滤波器滤掉了原始信号中的直流成分和低频成分,因此高通滤波的输出不能真实的反映原始信号相对于零点的实际值,但能够真实的反映原始信号在任一时刻的采样值相对于上一次采样值的高频改变量。
所述低通滤波算法如下:
设某一采样时刻,由加速度计解算直接得到的姿态角为θacc(k),前一次采样低通滤波之后的姿态角为θLowpass(k-1),则当前采样时刻低通滤波之后的姿态角θLowpass(k)的表达式为:
低通滤波的输出量中,仅包含原始信号中频谱低于截止频率的部分信号,原始信号中频率高于截止频率的信号和噪声都被衰减。因此低通滤波的输出能够反映原始信号中的低频部分。
所述高通滤波算法如下:
在没有外加速度干扰的情况下,互补滤波姿态解算数据融合的基本公式为:
θ(k)=θHighpass(k)+θLowpass(k)
加速度计解算角度的准确度受外部加速度的影响很大,只有在没有外部加速度的情况下,加速度计的解算结果才是完全可信的,当存在外部加速度时,加速度计解算结果的准确性明显变差,且变差趋势随着外部加速度的增大而加剧,因此,在存在外加速度的情况下,就要降低互补滤波器高通和低通滤波器的截止频率,削弱加速度计解算结果在数据融合中所占的权重而加强陀螺仪解算结果在数据融合中所占的权重,ae为外部加速度,fc为截止频率,外加速度越大,截止频率越低,当外加速度大至一定程度时,使截止频率接近于0,完全由陀螺仪进行姿态的解算,
用加速度计在载体系XYZ三轴上测量值所构成的向量模值,与重力加速度进行比较,评估外加速度的影响度,设置参数:
其中,ax、ay、az分别为加速度计在载体系XYZ三轴上的测量值;g为重力加速度的模值,ξ的值越大,则表示作用于载体的外部加速越大;ξ的值越接近于0,表示作用于载体的外部加速越小,
令互补滤波器中,高通滤波器和低通滤波器的传递函数分别为:
则当ξ∈[0,0.125)时,互补滤波器的截止频率为:
可以发现,若ξ=0,则当ξ逐渐增大至接近0.125时,fc→0。当ξ≥0.125时,认为此时的外部加速度过大,完全由陀螺仪进行姿态角的解算。
与现有技术相比,本发明的有益效果是:
利用本发明的方法,可以较为准确地计算姿态角的值,从而对无人机的姿态进行控制。
附图说明
图1所示为本发明方法示意图;
具体实施方式
以下结合附图和具体实施例对本发明作进一步详细说明。应当理解,此处所描述的具体实施例仅仅用以解释本发明,并不用于限定本发明。
应当说明的是,本申请中所述的“连接”和用于表达“连接”的词语,如“相连接”、“相连”等,其既可以指代某一部件与另一部件直接连接,也可以指代某一部件通过其他部件与另一部件相连接。
如图1所示,由于加速度计的输出中含有高平噪声,在数据融合之前,对加速度计的解算值进行低通滤波,滤除噪声干扰和累积增量;由于陀螺仪在静态下,存在温度漂移现象,因此对陀螺仪的解算结果进行高通滤波。加速度计解算姿态角具有较好的低频特性,而高频特性较差,而陀螺仪具有较好的高频动态特性,利用二者频率特性的互补性,进行数据的重构融合。对于陀螺仪解算结果,认为其动态量是准确的。对于加速度计,认为在没有外部加速的情况下,其解算结果是准确的。加速度计解算结果的准确度受外部加速度的影响较大,需要根据外部加速度的大小实时的改变互补滤波其参数,消除外加速度对解算结果的影响。
互补滤波算法说明
互补虑波器的基本原理,将原始输入信号按傅立叶分解展开,即:
对于原始信号中的正弦分量,将会被低通滤波器极大的衰减,但能以很小的衰减通过高通滤波器;对于原始信号中的正弦分量,将会被高通滤波器极大的衰减,但能以很小的衰减通过低通滤波器。将高通滤波器和低通滤波器的输出进行整合,即可得到全部频域内的信号。
陀螺仪部分数据的高通滤波
为滤除陀螺仪输出结果中由于温漂等因素造成的低频干扰,要对陀螺仪的解算结果进行高通滤波。设某一采样时刻,由陀螺仪解算直接得到的姿态角度为θgyro(k)(俯仰角、横滚角或偏航角),前一次采样时刻由陀螺仪解算直接得到的结果为θgyro(k-1),前一次采样时刻高通滤波之后的姿态角为θHighpass(k-1),则当前采样时刻高通滤波之后的姿态角θHighpass(k)的表达式为:
理想的高通滤波的输出量中,仅包含原始信号中频谱高于截止频率的动态部分信号,当原始信号处于低频或维持状态时,高通滤波的输出为0。由于高通滤波器滤掉了原始信号中的直流成分和低频成分,因此高通滤波的输出不能真实的反映原始信号相对于零点的实际值,但能够真实的反映原始信号在任一时刻的采样值相对于上一次采样值的高频改变量。
3.3.2加速度传感器部分数据的低通滤波
加速度计的解算结果中,存在高频噪声干扰和由于高频动态特性变差造成的存在较大误差的结果,但认为其静态值或低频动态值是准确的。因此,为同时消除加速度计解算结果中的高频噪声干扰和动态特性变差造成的误差,取加速计解算值低通滤波后的角度参与数据融合。
设某一采样时刻,由加速度计解算直接得到的姿态角为θacc(k),前一次采样低通滤波之后的姿态角为θLowpass(k-1),则当前采样时刻低通滤波之后的姿态角θLowpass(k)的表达式为:
低通滤波的输出量中,仅包含原始信号中频谱低于截止频率的部分信号,原始信号中频率高于截止频率的信号和噪声都被衰减。因此低通滤波的输出能够反映原始信号中的低频部分。
在没有外加速度干扰的情况下,互补滤波姿态解算数据融合的基本公式为:
θ(k)=θHighpass(k)+θLowpass(k)
加速度计解算角度的准确度受外部加速度的影响很大,只有在没有外部加速度的情况下,加速度计的解算结果才是完全可信的。当存在外部加速度时,加速度计解算结果的准确性明显变差,且变差趋势随着外部加速度的增大而加剧。因此,在存在外加速度的情况下,就要降低互补滤波器高通和低通滤波器的截止频率,削弱加速度计解算结果在数据融合中所占的权重而加强陀螺仪解算结果在数据融合中所占的权重。ae为外部加速度,fc为截止频率。外加速度越大,截止频率越低,当外加速度大至一定程度时,使截止频率接近于0,完全由陀螺仪进行姿态的解算。
用加速度计在载体系XYZ三轴上测量值所构成的向量模值,与重力加速度进行比较,评估外加速度的影响度。设置参数:
其中,ax、ay、az分别为加速度计在载体系XYZ三轴上的测量值;g为重力加速度的模值。ξ的值越大,则表示作用于载体的外部加速越大;ξ的值越接近于0,表示作用于载体的外部加速越小。
令互补滤波器中,高通滤波器和低通滤波器的传递函数分别为:
则当ξ∈[0,0.125)时,互补滤波器的截止频率为:
可以发现,若ξ=0,则当ξ逐渐增大至接近0.125时,fc→0。当ξ≥0.125时,认为此时的外部加速度过大,完全由陀螺仪进行姿态角的解算。
互补滤波算法总结:
(1)计算
(2)按以下两种情况进行数据融合
①当0≤ξ<0.125时
θ(k)=θHighpass(k)+θLowpass(k)
②当ξ≥0.125时
此时仅使用陀螺仪进行姿态的解算θ(k)=θgyro(k)-θgyro(k-1)+θ(k-1)
以上所述仅是本发明的优选实施方式,应当指出的是,对于本技术领域的普通技术人员来说,在不脱离本发明原理的前提下,还可以做出若干改进和润饰,这些改进和润饰也应视为本发明的保护范围。
Claims (6)
1.一种用于救灾无人机姿态控制的互补滤波方法,其特征在于,所述方法包括如下步骤:
(1)由于加速度计的输出中含有高平噪声,在数据融合之前,对加速度计的解算值进行低通滤波,滤除噪声干扰和累积增量;
(2)由于陀螺仪在静态下,存在温度漂移现象,因此对陀螺仪的解算结果进行高通滤波;
(3)加速度计解算姿态角具有较好的低频特性,而高频特性较差,而陀螺仪具有较好的高频动态特性,利用二者频率特性的互补性,进行数据的重构融合。
2.根据权利要求1所述的一种用于救灾无人机姿态控制的互补滤波方法,其特征在于,
所述方法包括如下步骤:将原始输入信号按傅立叶分解展开,即:
对于原始信号中的正弦分量,将会被低通滤波器极大的衰减,但能以很小的衰减通过高通滤波器;对于原始信号中的正弦分量,将会被高通滤波器极大的衰减,但能以很小的衰减通过低通滤波器,将高通滤波器和低通滤波器的输出进行整合,即可得到全部频域内的信号。
3.根据权利要求1所述的一种用于救灾无人机姿态控制的互补滤波方法,其特征在于,所述高通滤波算法如下:
设某一采样时刻,由陀螺仪解算直接得到的姿态角度为θgyro(k)(俯仰角、横滚角或偏航角),前一次采样时刻由陀螺仪解算直接得到的结果为θgyro(k-1),前一次采样时刻高通滤波之后的姿态角为θHighpass(k-1),则当前采样时刻高通滤波之后的姿态角θHighpass(k)的表达式为:
理想的高通滤波的输出量中,仅包含原始信号中频谱高于截止频率的动态部分信号,当原始信号处于低频或维持状态时,高通滤波的输出为0,由于高通滤波器滤掉了原始信号中的直流成分和低频成分,因此高通滤波的输出不能真实的反映原始信号相对于零点的实际值,但能够真实的反映原始信号在任一时刻的采样值相对于上一次采样值的高频改变量。
4.根据权利要求3所述的一种用于救灾无人机姿态控制的互补滤波方法,其特征在于,所述低通滤波算法如下:
设某一采样时刻,由加速度计解算直接得到的姿态角为θacc(k),前一次采样低通滤波之后的姿态角为θLowpass(k-1),则当前采样时刻低通滤波之后的姿态角θLowpass(k)的表达式为:
低通滤波的输出量中,仅包含原始信号中频谱低于截止频率的部分信号,原始信号中频率高于截止频率的信号和噪声都被衰减。因此低通滤波的输出能够反映原始信号中的低频部分。
5.根据权利要求4所述的一种用于救灾无人机姿态控制的互补滤波方法,其特征在于,所述高通滤波算法如下:
在没有外加速度干扰的情况下,互补滤波姿态解算数据融合的基本公式为:
θ(k)=θHighpass(k)+θLowpass(k)
6.根据权利要求1所述的一种用于救灾无人机姿态控制的互补滤波方法,其特征在于,加速度计解算角度的准确度受外部加速度的影响很大,只有在没有外部加速度的情况下,加速度计的解算结果才是完全可信的,当存在外部加速度时,加速度计解算结果的准确性明显变差,且变差趋势随着外部加速度的增大而加剧,因此,在存在外加速度的情况下,就要降低互补滤波器高通和低通滤波器的截止频率,削弱加速度计解算结果在数据融合中所占的权重而加强陀螺仪解算结果在数据融合中所占的权重,ae为外部加速度,fc为截止频率,外加速度越大,截止频率越低,当外加速度大至一定程度时,使截止频率接近于0,完全由陀螺仪进行姿态的解算,
用加速度计在载体系XYZ三轴上测量值所构成的向量模值,与重力加速度进行比较,评估外加速度的影响度,设置参数:
其中,ax、ay、az分别为加速度计在载体系XYZ三轴上的测量值;g为重力加速度的模值,ξ的值越大,则表示作用于载体的外部加速越大;ξ的值越接近于0,表示作用于载体的外部加速越小,
令互补滤波器中,高通滤波器和低通滤波器的传递函数分别为:
则当ξ∈[0,0.125)时,互补滤波器的截止频率为:
可以发现,若ξ=0,则当ξ逐渐增大至接近0.125时,fc→0。当ξ≥0.125时,认为此时的外部加速度过大,完全由陀螺仪进行姿态角的解算。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610020471.8A CN105739510A (zh) | 2016-01-13 | 2016-01-13 | 一种用于救灾无人机姿态控制的互补滤波方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610020471.8A CN105739510A (zh) | 2016-01-13 | 2016-01-13 | 一种用于救灾无人机姿态控制的互补滤波方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN105739510A true CN105739510A (zh) | 2016-07-06 |
Family
ID=56246322
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201610020471.8A Pending CN105739510A (zh) | 2016-01-13 | 2016-01-13 | 一种用于救灾无人机姿态控制的互补滤波方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN105739510A (zh) |
Cited By (14)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106197376A (zh) * | 2016-09-23 | 2016-12-07 | 华南农业大学 | 基于单轴mems惯性传感器的车身倾角测量方法 |
CN107063262A (zh) * | 2017-04-07 | 2017-08-18 | 武汉理工大学 | 一种用于无人机姿态解算的互补滤波方法 |
CN107065932A (zh) * | 2017-06-15 | 2017-08-18 | 西安电子科技大学 | 一种灾情探测四旋翼无人机的控制方法 |
CN109814707A (zh) * | 2018-12-19 | 2019-05-28 | 东北大学秦皇岛分校 | 一种基于智能指环的虚拟输入方法及*** |
CN109896385A (zh) * | 2019-03-08 | 2019-06-18 | 浙江新再灵科技股份有限公司 | 一种针对一段运行过程中存在振动的电梯的速度离线处理方法 |
CN110060609A (zh) * | 2018-01-18 | 2019-07-26 | 北京京东金融科技控股有限公司 | 一种智能展示***及方法 |
CN111189447A (zh) * | 2018-11-15 | 2020-05-22 | 北京自动化控制设备研究所 | 一种位置测量惯性导航***的低通滤波方法 |
CN112462793A (zh) * | 2019-09-09 | 2021-03-09 | 顺丰科技有限公司 | 基于传感器的设备控制方法、装置、计算机设备 |
CN112773338A (zh) * | 2021-01-29 | 2021-05-11 | 中山大学 | 一种监测人体生理信息的牙套及头部运动数据采集方法 |
CN113282005A (zh) * | 2021-05-26 | 2021-08-20 | 惠州中国科学院遥感与数字地球研究所空间信息技术研究院 | 无刷云台调控方法、装置、计算机设备和存储介质 |
CN113514049A (zh) * | 2020-04-10 | 2021-10-19 | 北京三快在线科技有限公司 | 无人机姿态测量方法、装置、无人机及存储介质 |
WO2021223474A1 (zh) * | 2020-05-06 | 2021-11-11 | 仿翼(深圳)科技有限公司 | 飞行器、飞行器的控制方法及计算机可读存储介质 |
CN113992846A (zh) * | 2021-10-19 | 2022-01-28 | 上海艾为电子技术股份有限公司 | 姿态角的获取方法、防抖控制方法以及移动终端 |
CN115420306A (zh) * | 2022-11-07 | 2022-12-02 | 浙江芯昇电子技术有限公司 | 基于数字滤波方式的陀螺仪温漂补偿的实施方法和*** |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5608634A (en) * | 1992-06-12 | 1997-03-04 | Martin Marietta Corp. | Low noise spacecraft body rate sensing arrangement for attitude control |
CN103913171A (zh) * | 2014-04-28 | 2014-07-09 | 北京理工大学 | 基于加速度计和陀螺仪的载体转速与转角补偿测量方法 |
CN104280047A (zh) * | 2014-09-10 | 2015-01-14 | 天津航天中为数据***科技有限公司 | 一种多传感器融合的陀螺漂移滤波***及方法 |
CN104914874A (zh) * | 2015-06-09 | 2015-09-16 | 长安大学 | 一种基于自适应互补融合的无人机姿态控制***及方法 |
-
2016
- 2016-01-13 CN CN201610020471.8A patent/CN105739510A/zh active Pending
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5608634A (en) * | 1992-06-12 | 1997-03-04 | Martin Marietta Corp. | Low noise spacecraft body rate sensing arrangement for attitude control |
CN103913171A (zh) * | 2014-04-28 | 2014-07-09 | 北京理工大学 | 基于加速度计和陀螺仪的载体转速与转角补偿测量方法 |
CN104280047A (zh) * | 2014-09-10 | 2015-01-14 | 天津航天中为数据***科技有限公司 | 一种多传感器融合的陀螺漂移滤波***及方法 |
CN104914874A (zh) * | 2015-06-09 | 2015-09-16 | 长安大学 | 一种基于自适应互补融合的无人机姿态控制***及方法 |
Non-Patent Citations (3)
Title |
---|
万晓凤等: "互补滤波算法在四旋翼飞行器姿态解算中的应用", 《测控技术》 * |
梁光胜等: "基于互补滤波的两轮自平衡车姿态控制", 《测控技术》 * |
沈晓卫等: "基于互补滤波的动中通天线姿态估计", 《中国惯性技术学报》 * |
Cited By (15)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106197376A (zh) * | 2016-09-23 | 2016-12-07 | 华南农业大学 | 基于单轴mems惯性传感器的车身倾角测量方法 |
CN107063262A (zh) * | 2017-04-07 | 2017-08-18 | 武汉理工大学 | 一种用于无人机姿态解算的互补滤波方法 |
CN107065932A (zh) * | 2017-06-15 | 2017-08-18 | 西安电子科技大学 | 一种灾情探测四旋翼无人机的控制方法 |
CN110060609A (zh) * | 2018-01-18 | 2019-07-26 | 北京京东金融科技控股有限公司 | 一种智能展示***及方法 |
CN111189447A (zh) * | 2018-11-15 | 2020-05-22 | 北京自动化控制设备研究所 | 一种位置测量惯性导航***的低通滤波方法 |
CN109814707A (zh) * | 2018-12-19 | 2019-05-28 | 东北大学秦皇岛分校 | 一种基于智能指环的虚拟输入方法及*** |
CN109896385A (zh) * | 2019-03-08 | 2019-06-18 | 浙江新再灵科技股份有限公司 | 一种针对一段运行过程中存在振动的电梯的速度离线处理方法 |
CN109896385B (zh) * | 2019-03-08 | 2021-03-09 | 浙江新再灵科技股份有限公司 | 一种针对一段运行过程中存在振动的电梯的速度离线处理方法 |
CN112462793A (zh) * | 2019-09-09 | 2021-03-09 | 顺丰科技有限公司 | 基于传感器的设备控制方法、装置、计算机设备 |
CN113514049A (zh) * | 2020-04-10 | 2021-10-19 | 北京三快在线科技有限公司 | 无人机姿态测量方法、装置、无人机及存储介质 |
WO2021223474A1 (zh) * | 2020-05-06 | 2021-11-11 | 仿翼(深圳)科技有限公司 | 飞行器、飞行器的控制方法及计算机可读存储介质 |
CN112773338A (zh) * | 2021-01-29 | 2021-05-11 | 中山大学 | 一种监测人体生理信息的牙套及头部运动数据采集方法 |
CN113282005A (zh) * | 2021-05-26 | 2021-08-20 | 惠州中国科学院遥感与数字地球研究所空间信息技术研究院 | 无刷云台调控方法、装置、计算机设备和存储介质 |
CN113992846A (zh) * | 2021-10-19 | 2022-01-28 | 上海艾为电子技术股份有限公司 | 姿态角的获取方法、防抖控制方法以及移动终端 |
CN115420306A (zh) * | 2022-11-07 | 2022-12-02 | 浙江芯昇电子技术有限公司 | 基于数字滤波方式的陀螺仪温漂补偿的实施方法和*** |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN105739510A (zh) | 一种用于救灾无人机姿态控制的互补滤波方法 | |
Bu et al. | Integrated method for the UAV navigation sensor anomaly detection | |
Smyth et al. | Airflow and aeolian sediment transport patterns within a coastal trough blowout during lateral wind conditions | |
CN109443349A (zh) | 一种姿态航向测量***及其融合方法、存储介质 | |
CN103712598A (zh) | 一种小型无人机姿态确定***与确定方法 | |
CN104503432A (zh) | 一种基于小波能量的自主式水下机器人故障辨识方法 | |
CN103344963A (zh) | 一种基于激光雷达的鲁棒航迹推算方法 | |
CN105403250A (zh) | 一种电力防灾预警*** | |
CN106568462A (zh) | 一种多探头星敏感器融合姿态测试方法 | |
CN108260079A (zh) | 一种基于网格划分的老人轨迹异常的检测防走丢方法 | |
CN104462803A (zh) | 一种基于小波近似熵的自主式水下机器人故障辨识方法 | |
CN101545778B (zh) | 一种基于非线性滤波的电控罗经初始对准方法 | |
CN104597503A (zh) | 一种用于海上拖缆勘探收放缆的网络解算方法和装置 | |
CN104344835B (zh) | 一种基于切换式自适应控制罗经的捷联惯导动基座对准方法 | |
CN106601032A (zh) | 一种基于下视传感器的多路径地形完整性检测方法 | |
Claro et al. | Detection and mapping of monopiles in offshore wind farms using autonomous surface vehicles | |
CN104748734A (zh) | 一种带倾角补偿的车载电子海拔罗盘仪 | |
CN115542277B (zh) | 一种雷达法线标定方法、装置、***、设备和存储介质 | |
CN106679659A (zh) | 一种基于参数可调非线性跟踪微分器的信号去噪方法 | |
Liu et al. | A Morphology Filter‐Assisted Extreme‐Point Symmetric Mode Decomposition (MF‐ESMD) Denoising Method for Bridge Dynamic Deflection Based on Ground‐Based Microwave Interferometry | |
CN103759740A (zh) | 一种巡视器静态时陀螺故障自主诊断方法 | |
Zhao et al. | Extraction and filter algorithm of roll angular rate for high spinning projectiles | |
Wang et al. | Periodic error detection and separation of magnetic levitation gyroscope signals based on continuous wavelet transform and singular spectrum analysis | |
CN107664499B (zh) | 一种船用捷联惯导***的加速度计在线降噪方法 | |
Ma et al. | Outlier correction method of telemetry data based on wavelet transformation and Wright criterion |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
RJ01 | Rejection of invention patent application after publication |
Application publication date: 20160706 |
|
RJ01 | Rejection of invention patent application after publication |