CN110231052A - 一种陀螺仪异常温漂的检测方法 - Google Patents

一种陀螺仪异常温漂的检测方法 Download PDF

Info

Publication number
CN110231052A
CN110231052A CN201910339255.3A CN201910339255A CN110231052A CN 110231052 A CN110231052 A CN 110231052A CN 201910339255 A CN201910339255 A CN 201910339255A CN 110231052 A CN110231052 A CN 110231052A
Authority
CN
China
Prior art keywords
temperature
gyroscope
drift
information
angular velocity
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
Application number
CN201910339255.3A
Other languages
English (en)
Other versions
CN110231052B (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.)
Shenzhen Desert Intelligence Control Technology Co Ltd
Original Assignee
Shenzhen Desert Intelligence Control Technology 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 Shenzhen Desert Intelligence Control Technology Co Ltd filed Critical Shenzhen Desert Intelligence Control Technology Co Ltd
Priority to CN201910339255.3A priority Critical patent/CN110231052B/zh
Publication of CN110231052A publication Critical patent/CN110231052A/zh
Application granted granted Critical
Publication of CN110231052B publication Critical patent/CN110231052B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C25/00—Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass
    • G01C25/005—Manufacturing, 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)
  • Gyroscopes (AREA)

Abstract

本发明公开了一种陀螺仪异常温漂的检测方法，该方法包括：采集待测陀螺仪的原始角速度信息以及对应时刻的原始温度信息；根据设定的采样频率对角速度信息和温度信息进行采样；判断采样时间是否达到设定的间隔时间；若是，则将间隔时间内采样的角速度信息与温度信息进行平均；判断当前温度与开始采集时的初始温度相比温度变化是否超过设定值；若是，则计算当前温度与初始温度区间内的角速度漂移率；判断漂移率是否超过设定阈值；若是，则判定待侧陀螺仪存在异常温漂。本发明由于没有使用偏差值的绝对大小，而改用偏差值随温度变化的速率，从而提高了检测的速度和准确率。

Description

一种陀螺仪异常温漂的检测方法
技术领域
本发明涉及陀螺仪，更具体地说是一种陀螺仪异常温漂的检测方法。
背景技术
陀螺仪是一种测量物体角速度的惯性传感器，它是小型无人机进行航姿解算的核心传感器，其性能好坏直接影响无人机飞行的稳定性。MPU6000是目前在无人机上应用较为广泛的一款陀螺仪，具有高精度，低价格等优势。然而市面上的MPU6000陀螺仪质量良莠不齐，某些MPU6000陀螺仪存在异常温漂问题。异常温漂问题反映在陀螺仪在某个特定的温度下，测量到的角速度会急剧变化，从而严重影响飞行的稳定性。因此事先筛选出具有异常温漂的陀螺仪对提高无人机的稳定性至关重要。
目前，筛选异常陀螺仪的方法主要是通过测量一定温度范围内陀螺仪静止时输出的角速度信息，根据输出信息偏离真实值的绝对大小来判断陀螺仪是否存在异常。该方法存在以下缺陷：(1)有可能将正常温漂误识别为异常温漂，导致正常的陀螺仪被筛除；(2)检测阈值难以确定，有可能导致异常的陀螺仪被漏检。
发明内容
本发明的目的在于克服现有技术的不足，提供一种陀螺仪异常温漂的检测方法，以准确、快速地检测出有异常温漂的陀螺仪。
为实现上述目的，本发明采用以下技术方案：一种陀螺仪异常温漂的检测方法，所述方法包括：
采集待测陀螺仪的原始角速度信息以及对应时刻的原始温度信息；
根据设定的采样频率对角速度信息和温度信息进行采样；
判断采样时间是否达到设定的间隔时间；
若是，则将间隔时间内采样的角速度信息与温度信息进行平均；
判断当前温度与开始采集时的初始温度相比温度变化是否超过设定值；
若是，则计算当前温度与初始温度区间内的角速度漂移率；
判断漂移率是否超过设定阈值；
若是，则判定待侧陀螺仪存在异常温漂。
其进一步技术方案为：所述计算当前温度与初始温度区间内的角速度漂移率的步骤中，计算公式为：
X＝(ATA)-1ATB，其中，x1为[t1,t1+Δt]的角速度漂移速率，ti为第i秒平均后的温度，gi为第i秒平均后的角速度。
其进一步技术方案为：所述采集待测陀螺仪的原始角速度信息以及对应时刻的原始温度信息的步骤之后，还包括以下步骤：
通过滤波器滤除原始角速度信息以及对应时刻的原始温度信息的20Hz以上的噪声。
其进一步技术方案为：所述采集待测陀螺仪的原始角速度信息以及对应时刻的原始温度信息的步骤之前，包括以下步骤：
设定检测结果最终温度值。
其进一步技术方案为：所述判断漂移率是否超过设定阈值的步骤之后，还包括以下步骤：
若否，则判断当前温度是否超过最终温度值；
若是，则判定待侧陀螺仪不存在异常温漂。
其进一步技术方案为：所述根据设定的采样频率对角速度信息和温度信息进行采样的步骤中，设定的采用频率为200Hz～400Hz。
其进一步技术方案为：所述根据设定的采样频率对角速度信息和温度信息进行采样的步骤中，设定的采用频率为333Hz。
其进一步技术方案为：所述判断采样时间是否达到设定的间隔时间的步骤中，设定的间隔时间为1秒。
本发明与现有技术相比的有益效果是：本发明提供的一种陀螺仪异常温漂的检测方法，通过记录一定温度范围内待测陀螺仪输出的角速度信息及其对应时刻的温度信息，并将记录的角速度信息根据温度不同划分为若干小段，对每一小段的角速度信息随温度变化进行直线拟合计算，从而获得角速度误差随温度的变化速率，最后根据漂移速率的大小甄别异常温漂的陀螺仪。由于没有使用偏差值的绝对大小，而改用偏差值随温度变化的速率，从而提高了检测的速度和准确率。
上述说明仅是本发明技术方案的概述，为了能够更清楚了解本发明技术手段，可依照说明书的内容予以实施，并且为了让本发明的上述和其它目的、特征及优点能够更明显易懂，以下特举较佳实施例，详细说明如下。
附图说明
图1为本发明一种陀螺仪异常温漂的检测方法具体实施例的流程图。
具体实施方式
为了更充分理解本发明的技术内容，下面结合具体实施例对本发明的技术方案进一步介绍和说明，但不局限于此。
应当理解，在本文中，诸如第一和第二等之类的关系术语仅仅用来将一个实体/操作/对象与另一个实体/操作/对象区分开来，而不一定要求或者暗示这些实体/操作/对象之间存在任何这种实际的关系或者顺序。
还应当理解，术语“包括”、“包含”或者其任何其他变体意在涵盖非排他性的包含，从而使得包括一系列要素的过程、方法、物品或者系统不仅包括那些要素，而且还包括没有明确列出的其他要素，或者是还包括为这种过程、方法、物品或者系统所固有的要素。在没有更多限制的情况下，由语句“包括一个……”限定的要素，并不排除在包括该要素的过程、方法、物品或者系统中还存在另外的相同要素。
如图1所示，本发明提供了一种陀螺仪异常温漂的检测方法，采用该方法用于判断角速率误差的变化速率而非误差的绝对大小。通过该方法能够快速、有效的提高检测出异常温漂的陀螺仪，具体的，该方法包括以下步骤：
S10、设定检测结果最终温度值；
S20、采集待测陀螺仪的原始角速度信息以及对应时刻的原始温度信息；
S30、通过滤波器滤除原始角速度信息以及对应时刻的原始温度信息的20Hz以上的噪声；
S40、根据设定的采样频率对角速度信息和温度信息进行采样；
S50、判断采样时间是否达到设定的间隔时间，若否，则重复此步骤，若是，则进入步骤S60；
S60、将间隔时间内采样的角速度信息与温度信息进行平均；
S70、判断当前温度与开始采集时的初始温度相比温度变化是否超过设定值，若否，则返回步骤S50，若是，进入步骤S80；
S80、计算当前温度与初始温度区间内的角速度漂移率；
S90、判断漂移率是否超过设定阈值，若是，则进入步骤S902，若否，则进入步骤S901；
S901、判断当前温度是否超过最终温度值；若是，则进入步骤S9011，若否，则返回步骤S50。
S9011、判定待侧陀螺仪不存在异常温漂。
S902、判定待侧陀螺仪存在异常温漂。
具体的，本实施例以检测MPU6000陀螺仪为例，首先需要设定检测结果最终温度值(设定的最终温度值可根据实际检测情况进行选定)。采集MPU6000陀螺仪原始角速度信息以及对应时刻的温度信息，由于采集的原始角速度信息以及对应时刻的温度信息中有噪声，因此，需要进行去噪，可选用巴特沃斯低通滤波器滤除20Hz以上的噪声。
在步骤S40中，设定的采样频率为330Hz。在步骤S50中，设定的间隔时间为1秒。
对于步骤S60，将间隔时间内采样的角速度信息与温度信息进行平均，将平均后的角速度与温度作为一组待处理数据，标为(gi,ti)，其中ti为第i秒平均后的温度，gi为第i秒平均后的角速度。
对于步骤S70，设定值为0.5°，如果当前温度值与初始温度值的差值小于0.5°，则认为没有超过设定值。
对于步骤S80、S90，通过对当前的多组待处理数据进行一次最小二乘直线拟合，则可求得角度度漂移速率。具体的，拟合公式为：
X＝(ATA)-1ATB，其中，x1为[t1,t1+Δt]的角速度漂移速率。将本次得到的x1记为rn，判断rn是否超过设定阈值，如果是，则判定待侧陀螺仪存在异常温漂。
上述仅以实施例来进一步说明本发明的技术内容，以便于读者更容易理解，但不代表本发明的实施方式仅限于此，任何依本发明所做的技术延伸或再创造，均受本发明的保护。本发明的保护范围以权利要求书为准。

Claims (8)

1.一种陀螺仪异常温漂的检测方法，其特征在于，所述方法包括：
采集待测陀螺仪的原始角速度信息以及对应时刻的原始温度信息；
根据设定的采样频率对角速度信息和温度信息进行采样；
判断采样时间是否达到设定的间隔时间；
若是，则将间隔时间内采样的角速度信息与温度信息进行平均；
判断当前温度与开始采集时的初始温度相比温度变化是否超过设定值；
若是，则计算当前温度与初始温度区间内的角速度漂移率；
判断漂移率是否超过设定阈值；
若是，则判定待侧陀螺仪存在异常温漂。
2.根据权利要求1所述的一种陀螺仪异常温漂的检测方法，其特征在于，所述计算当前温度与初始温度区间内的角速度漂移率的步骤中，计算公式为：
X＝(ATA)-1ATB，其中，x1为[t1,t1+Δt]的角速度漂移速率，ti为第i秒平均后的温度，gi为第i秒平均后的角速度。
3.根据权利要求1所述的一种陀螺仪异常温漂的检测方法，其特征在于，所述采集待测陀螺仪的原始角速度信息以及对应时刻的原始温度信息的步骤之后，还包括以下步骤：
通过滤波器滤除原始角速度信息以及对应时刻的原始温度信息的20Hz以上的噪声。
4.根据权利要求1所述的一种陀螺仪异常温漂的检测方法，其特征在于，所述采集待测陀螺仪的原始角速度信息以及对应时刻的原始温度信息的步骤之前，包括以下步骤：
设定检测结果最终温度值。
5.根据权利要求4所述的一种陀螺仪异常温漂的检测方法，其特征在于，所述判断漂移率是否超过设定阈值的步骤之后，还包括以下步骤：
若否，则判断当前温度是否超过最终温度值；
若是，则判定待侧陀螺仪不存在异常温漂。
6.根据权利要求1所述的一种陀螺仪异常温漂的检测方法，其特征在于，所述根据设定的采样频率对角速度信息和温度信息进行采样的步骤中，设定的采用频率为200Hz～400Hz。
7.根据权利要求6所述的一种陀螺仪异常温漂的检测方法，其特征在于，所述根据设定的采样频率对角速度信息和温度信息进行采样的步骤中，设定的采用频率为333Hz。
8.根据权利要求1所述的一种陀螺仪异常温漂的检测方法，其特征在于，所述判断采样时间是否达到设定的间隔时间的步骤中，设定的间隔时间为1秒。
CN201910339255.3A 2019-04-25 2019-04-25 一种陀螺仪异常温漂的检测方法 Active CN110231052B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201910339255.3A CN110231052B (zh) 2019-04-25 2019-04-25 一种陀螺仪异常温漂的检测方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201910339255.3A CN110231052B (zh) 2019-04-25 2019-04-25 一种陀螺仪异常温漂的检测方法

Publications (2)

Publication Number Publication Date
CN110231052A true CN110231052A (zh) 2019-09-13
CN110231052B CN110231052B (zh) 2023-02-10

Family

ID=67860244

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201910339255.3A Active CN110231052B (zh) 2019-04-25 2019-04-25 一种陀螺仪异常温漂的检测方法

Country Status (1)

Country Link
CN (1) CN110231052B (zh)

Citations (10)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH09126784A (ja) * 1995-10-30 1997-05-16 Daihatsu Motor Co Ltd 車両用旋回検出センサの温度ドリフト補正装置
JP2007315926A (ja) * 2006-05-26 2007-12-06 Ngk Spark Plug Co Ltd ガスセンサシステムの異常診断方法、及び、ガスセンサシステム
CN102230806A (zh) * 2011-04-26 2011-11-02 中国科学院软件研究所 一种陀螺仪温度漂移补偿方法
CN102997933A (zh) * 2011-09-14 2013-03-27 意法半导体(中国)投资有限公司 一种确定陀螺仪零偏误差的方法、装置及包括该装置的系统
CN103256941A (zh) * 2013-04-19 2013-08-21 中国兵器工业集团第二一四研究所苏州研发中心 一种mems陀螺仪高阶温度补偿的实用方法
CN103411628A (zh) * 2013-08-14 2013-11-27 西北工业大学 一种mems陀螺仪随机漂移误差的处理方法
CN104596513A (zh) * 2014-12-26 2015-05-06 北京爱科迪通信技术股份有限公司 一种光纤陀螺与微机械陀螺组合的惯导系统及导航方法
CN106500728A (zh) * 2016-10-26 2017-03-15 北京小鸟看看科技有限公司 一种陀螺仪的温度漂移补偿方法和装置
CN106527480A (zh) * 2016-12-02 2017-03-22 南京航空航天大学 一种无人机的多传感器融合避障控制系统及方法
CN109297509A (zh) * 2018-08-28 2019-02-01 北京航天时代激光导航技术有限责任公司 一种基于三态理论的激光陀螺零偏漂移误差建模与补偿方法

Patent Citations (10)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH09126784A (ja) * 1995-10-30 1997-05-16 Daihatsu Motor Co Ltd 車両用旋回検出センサの温度ドリフト補正装置
JP2007315926A (ja) * 2006-05-26 2007-12-06 Ngk Spark Plug Co Ltd ガスセンサシステムの異常診断方法、及び、ガスセンサシステム
CN102230806A (zh) * 2011-04-26 2011-11-02 中国科学院软件研究所 一种陀螺仪温度漂移补偿方法
CN102997933A (zh) * 2011-09-14 2013-03-27 意法半导体(中国)投资有限公司 一种确定陀螺仪零偏误差的方法、装置及包括该装置的系统
CN103256941A (zh) * 2013-04-19 2013-08-21 中国兵器工业集团第二一四研究所苏州研发中心 一种mems陀螺仪高阶温度补偿的实用方法
CN103411628A (zh) * 2013-08-14 2013-11-27 西北工业大学 一种mems陀螺仪随机漂移误差的处理方法
CN104596513A (zh) * 2014-12-26 2015-05-06 北京爱科迪通信技术股份有限公司 一种光纤陀螺与微机械陀螺组合的惯导系统及导航方法
CN106500728A (zh) * 2016-10-26 2017-03-15 北京小鸟看看科技有限公司 一种陀螺仪的温度漂移补偿方法和装置
CN106527480A (zh) * 2016-12-02 2017-03-22 南京航空航天大学 一种无人机的多传感器融合避障控制系统及方法
CN109297509A (zh) * 2018-08-28 2019-02-01 北京航天时代激光导航技术有限责任公司 一种基于三态理论的激光陀螺零偏漂移误差建模与补偿方法

Non-Patent Citations (2)

* Cited by examiner, † Cited by third party
Title
杨国梁等: "基于RBF神经网络的光纤陀螺温度补偿", 《压电与声光》 *
顾广清等: "硅微陀螺仪数字化温度补偿系统的实现", 《舰船电子工程》 *

Also Published As

Publication number Publication date
CN110231052B (zh) 2023-02-10

Similar Documents

Publication Publication Date Title
CN106225786B (zh) 一种自适应的行人导航系统零速区间检测方法
CN112525531B (zh) 一种嵌入式智能轴承监测系统及其监测方法
CN106441632B (zh) 一种温度计的检测方法及温度计的检测装置
CN103323624B (zh) 校验飞行器迎角探测器的测量值一致性的方法和装置
CN106842094B (zh) 磁力计校准的数据处理方法和装置
CN108692711B (zh) 基于低空探空火箭的海洋数据处理的实现方法
CN106840093A (zh) 一种无人机飞行高度的检测方法、装置及无人机
WO2023088471A1 (zh) 基于多传感信息融合的管道缺陷检测及定位方法
CN105405134B (zh) 一种相机检校标志中心坐标提取方法
CN108362493B (zh) 一种数控机床直线轴转角误差快速检测方法
CN105737793A (zh) 滚转角测量单元及测量方法
CN106778588A (zh) 基于同名点的飞行状态检测方法及装置
EP2488829B1 (en) A method of detecting parasitic movements while aligning an inertial unit
CN110231052A (zh) 一种陀螺仪异常温漂的检测方法
CN104122412A (zh) 一种基于北斗二代速度信息的加速度计标定方法
CN116862887A (zh) 基于激光扫描和红外成像的气体泄漏定量检测方法及系统
CN201710159U (zh) 烹饪过程中锅具运动信息检测装置
CN109033646B (zh) 基于小量程mems加速度传感器的随钻测斜仪重力工具面角计算方法
CN106291752B (zh) 地震仪系统延迟测试方法
CN117734963B (zh) 一种直升机旋翼共锥度检测方法与装置
CN104697551B (zh) 一种基于四元数夹角的惯导精度检测方法
CN211926882U (zh) 高精度的惯性测量装置
CN103791911B (zh) 准确性较高的导航仪的道路匹配的工作方法
CN106289075A (zh) 光电测距仪的矫正方法和系统
CN115684076B (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