CN108168579B - 擦窗机陀螺仪动态校准方法 - Google Patents
擦窗机陀螺仪动态校准方法 Download PDFInfo
- Publication number
- CN108168579B CN108168579B CN201711435631.6A CN201711435631A CN108168579B CN 108168579 B CN108168579 B CN 108168579B CN 201711435631 A CN201711435631 A CN 201711435631A CN 108168579 B CN108168579 B CN 108168579B
- Authority
- CN
- China
- Prior art keywords
- gyroscope
- controller
- variance
- output data
- value
- 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
Images
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
Abstract
本发明公开一种擦窗机陀螺仪动态校准方法,涉及擦窗机领域,包括以下步骤:在擦窗机的控制器内设置一个阀值τ和一个校准值A0,擦窗机开始工作;陀螺仪的采样数据减去校准值A0后得到输出数据,输出数据经低通滤波后传输给控制器,控制器记录陀螺仪的输出数据;控制器计算相邻上一个时间段T内的陀螺仪输出数据方差S1;控制器计算相邻上一个时间段T内的陀螺仪输出数据的平均值X1,控制器通过算法判断方差S1是否超过阀值τ;控制器计算相邻上一个时间段T内的陀螺仪输出数据的平均值X2,控制器通过算法判断方差S2是否超过阀值τ,能够克服多种噪声对陀螺仪的影响、数据计算量小、校准精度高。
Description
技术领域
本发明涉及擦窗机领域,尤其涉及校准陀螺仪的方法。
背景技术
旋转物体的旋转轴所指的方向在不受外力影响时,是不会改变的。人们根据这个道理,用它来保持方向。然后用多种方法读取轴所指示的方向,并自动将数据信号传给控制系统,可以精确地确定运动物体的方位的仪器,它在现代航空,航海,航天和国防工业中广泛使用的一种惯性导航仪器,陀螺仪是用来测量角速度信号的,通过对角速度积分,能得到角度值,但由于温度变化、摩擦力、不稳定力矩等因素,陀螺仪会产生漂移误差。
申请号为201210572030.0的发明专利申请公开一种陀螺仪静态校准方法,但是该方案依据环境参数,进行数据补偿,需要数据庞大,且仅能够有限的克服温度对陀螺仪的影响,而陀螺仪还要克服振动、使用寿命等其它因素的影响。
发明内容
本发明的目的在于克服现有技术中的不足,提供一种能够克服多种噪声对陀螺仪的影响、数据计算量小、校准精度高的擦窗机陀螺仪动态校准方法。
本发明是通过以下技术方案实现的:一种擦窗机陀螺仪动态校准方法,包括以下步骤:
步骤101,在擦窗机的控制器内设置一个阀值τ和一个校准值A0,开启擦窗机,擦窗机开始工作;
步骤102,计时器清零后开始计时,陀螺仪的采样数据减去校准值A0后得到输出数据,输出数据经低通滤波后传输给控制器,控制器记录陀螺仪的输出数据;
步骤103,控制器计算相邻上一个时间段T内的陀螺仪输出数据方差S1;
步骤104,控制器计算相邻上一个时间段T内的陀螺仪输出数据的平均值X1,平均值X1与校准值A0相加,得到校准值A1,控制器通过算法判断步骤103所得方差S1是否超过阀值τ,若方差S1超出阀值τ,则跳转至步骤102,若方差S1不超出阀值τ,执行下一步操作;
步骤105,控制器计算相邻下一个时间段T内的陀螺仪输出数据方差S2;
步骤106,控制器计算相邻下一个时间段T内的陀螺仪输出数据的平均值X2,平均值X2与校准值A1相加,得到校准值A2,控制器通过算法判断步骤105所得方差S2是否超过阀值τ,若方差S2超出阀值τ,则跳转至步骤102,若方差S2不超出阀值τ,执行下一步操作;
步骤107,重复步骤105-106,即能够对擦窗机陀螺仪进行动态校准。
进一步地,所述阀值τ的模在30%-35%内取值,
步骤104与步骤106中控制器判断方差是否超过阀值的算法包括以下步骤:
步骤一,控制器计算出Sn与An的比值εn;
步骤二,控制器计算出εn与τ的差值,若差值大于零,则方差超过阀值。
进一步地,所述时间段T为150ms、180ms、200ms和220ms其中的一个。
进一步地,所述控制器选用DSP控制器或单片机控制器。
进一步地,所述A0为0deg/s。
本发明的有益效果在于:计算相邻上一个时间段T内的平均值作为校准值,计算相邻下一个时间段T内的输出数据的方差,以前一个时间段为基础,在温度、使用周期、电源电压等连续变化的噪声中对陀螺仪进行动态校准,由于时间段T为150-220ms,而擦窗机的运行速度为3-5cm/s,即在擦窗机每运行1cm,至少进行一次校准,连续性高;陀螺仪的输出数据经低通滤波后传输给控制器,能够避免脉冲噪声对陀螺仪输出数据的影响,提高校准精度;设置阀值,记录单位时间内方差超出阀值次数,能够帮助维护人员判断擦窗机的工作作态。
附图说明
图1为擦窗机陀螺仪动态校准方法流程图。
具体实施方式
以下结合具体实施例对本发明的技术方案进行说明。
实施例1
如图1所示,一种擦窗机陀螺仪动态校准方法,包括以下步骤:
步骤101,在擦窗机的控制器内输入一个阀值τ和一个校准值A0,阀值τ的模设定为30%,A0为0deg/s,控制器为单片机控制器,开启擦窗机,擦窗机开始工作;
步骤102,计时器清零后开始计时,陀螺仪的采样数据减去校准值A0后得到输出数据,输出数据经低通滤波后传输给控制器,控制器记录陀螺仪的输出数据,能够有效的避免脉冲噪声对陀螺仪输出数据的影响,提高校准精度,控制器记录陀螺仪的输出数据,输出数据为数字信号,由于陀螺仪的输出数据经过滤波处理,输出数据的平均值能够表征在时间段T内的状态;
步骤103,控制器计算相邻上一个时间段T内的陀螺仪输出数据方差S1,方差能够表征在该时间段T内陀螺仪输出值的稳定性;
步骤104,控制器计算相邻上一个时间段T内的陀螺仪输出数据的平均值X1,平均值X1与校准值A0相加,得到校准值A1,控制器通过算法判断步骤103所得方差S1是否超过阀值τ,若方差S1超出阀值τ,则跳转至步骤102,若方差S1不超出阀值τ,执行下一步操作;
步骤105,控制器计算相邻下一个时间段T内的陀螺仪输出数据方差S2;
步骤106,控制器计算相邻下一个时间段T内的陀螺仪输出数据的平均值X2,平均值X2与校准值A1相加,得到校准值A2,控制器通过算法判断步骤105所得方差S2是否超过阀值τ,若方差S2超出阀值τ,则跳转至步骤102,若方差S2不超出阀值τ,执行下一步操作;
步骤107,重复步骤105-106,即能够对擦窗机陀螺仪进行动态校准。
其中时间段T为150ms,能够保证收集足够多的陀螺仪输出值,还能够快速的根据噪声跳变重新得到校准值,如果噪声连续变化,则陀螺仪的校准值变化也是线性的,如果噪声跳变,则陀螺仪的校准值跳变,控制器记录单位时间内比值εn大于阀值τ的次数,能够帮助维护人员判断故障原因,及故障时间。
实施例2
如图1所示,一种擦窗机陀螺仪动态校准方法,包括以下步骤:
步骤101,在擦窗机的控制器内输入一个阀值τ和一个校准值A0,阀值τ的模设定为35%,A0为0deg/s,控制器为DSP控制器,开启擦窗机,擦窗机开始工作;
步骤102,计时器清零后开始计时,陀螺仪的采样数据减去校准值A0后得到输出数据,输出数据经低通滤波后传输给控制器,控制器记录陀螺仪的输出数据,能够有效的避免脉冲噪声对陀螺仪输出数据的影响,提高校准精度,控制器记录陀螺仪的输出数据,输出数据为数字信号,由于陀螺仪的输出数据经过滤波处理,输出数据的平均值能够表征在时间段T内的状态;
步骤103,控制器计算相邻上一个时间段T内的陀螺仪输出数据方差S1,方差能够表征在该时间段T内陀螺仪输出值的稳定性;
步骤104,控制器计算相邻上一个时间段T内的陀螺仪输出数据的平均值X1,平均值X1与校准值A0相加,得到校准值A1,控制器通过算法判断步骤103所得方差S1是否超过阀值τ,若方差S1超出阀值τ,则跳转至步骤102,若方差S1不超出阀值τ,执行下一步操作;
步骤105,控制器计算相邻下一个时间段T内的陀螺仪输出数据方差S2;
步骤106,控制器计算相邻下一个时间段T内的陀螺仪输出数据的平均值X2,平均值X2与校准值A1相加,得到校准值A2,控制器通过算法判断步骤105所得方差S2是否超过阀值τ,若方差S2超出阀值τ,则跳转至步骤102,若方差S2不超出阀值τ,执行下一步操作;
步骤107,重复步骤105-106,即能够对擦窗机陀螺仪进行动态校准。
其中时间段T为200ms,能够保证收集足够多的陀螺仪输出值,还能够快速的根据噪声跳变重新得到校准值,如果噪声连续变化,则陀螺仪的校准值变化也是线性的,如果噪声跳变,则陀螺仪的校准值跳变,控制器记录单位时间内比值εn大于阀值τ的次数,能够帮助维护人员判断故障原因,及故障时间。
通过本发明提出的擦窗机陀螺仪动态校准方法,能够针对连续变化的噪声进行连续性的校准,并不需要存储大量的参数,运算量降低,同时校准精度得到提高,在噪声发生跳变时,能够快速进行调整,如果单位时间内比值εn大于阀值τ的次数超过预定的值,通过报警装置进行报警,方便维护人员及时维护。
在实施例1和实施例2中,使用MPU-6050型陀螺仪,工作电压为3-5V,以500Hz的固有频率采样并输出X、Y、Z三轴的瞬时角速度,瞬时角速度范围值是±1000deg/s,控制器分别对X、Y、Z三轴的瞬时角速度值进行校准,将经过校准的瞬时角速度值进行积分运算,即能够得到擦窗机的角位移,擦窗机以角位移和线位移为基础,测算运动轨迹。
以实施例2为例,选取X轴的输出数据,测试结果见附表1,计算结果见附表2。
附表1
附表2
如附表1和附表2可以知道,校准值不断变化,输出数据为瞬时角速度与校准值之间的差值,以差值作为瞬时角速度实际值,进而判断擦窗机的运动状态、测算擦窗机的运行轨迹,精确度高,另外,由于差值的波动幅度小,方便进行低通滤波,另外输出数据平均值还能够帮助确定陀螺仪漂移方向,为补偿和维护提供依据,通过阀值判断陀螺仪是否符合使用要求,通过输出数据来判断陀螺仪的漂移状态,以达到对陀螺仪进行连续动态校准的目的,占用存储空间小,控制器运行负载减小,稳定性增加,同时避免了静态校准依赖温度梯度、不能克服应广泛的噪声影响等问题。
Claims (5)
1.一种擦窗机陀螺仪动态校准方法,其特征在于,包括以下步骤:
步骤101,在擦窗机的控制器内设置一个阀值τ和一个校准值A0,开启擦窗机,擦窗机开始工作;
步骤102,计时器清零后开始计时,陀螺仪的采样数据减去校准值A0后得到输出数据,输出数据经低通滤波后传输给控制器,控制器记录陀螺仪的输出数据;
步骤103,控制器计算相邻上一个时间段T内的陀螺仪输出数据方差S1;
步骤104,控制器计算相邻上一个时间段T内的陀螺仪输出数据的平均值X1,平均值X1与校准值A0相加,得到校准值A1,控制器通过算法判断步骤103所得方差S1是否超过阀值τ,若方差S1超出阀值τ,则跳转至步骤102,若方差S1未超出阀值τ,执行下一步操作;
步骤105,控制器计算相邻下一个时间段T内的陀螺仪输出数据方差S2;
步骤106,控制器计算相邻下一个时间段T内的陀螺仪输出数据的平均值X2,平均值X2与校准值A1相加,得到校准值A2,控制器通过算法判断步骤105所得方差S2是否超过阀值τ,若方差S2超出阀值τ,则跳转至步骤102,若方差S2未超出阀值τ,执行下一步操作;
步骤107,重复步骤105-106,能够对擦窗机陀螺仪进行动态校准。
2.根据权利要求1所述的擦窗机陀螺仪动态校准方法,其特征在于,所述阀值τ的模在30%-35%内取值,
步骤104与步骤106中控制器判断方差是否超过阀值的算法包括以下步骤:
步骤一,控制器计算出Sn与An的比值εn;
步骤二,控制器计算出εn与τ的差值,若差值大于零,则方差超过阀值。
3.根据权利要求1所述的擦窗机陀螺仪动态校准方法,其特征在于,所述时间段T为150ms、180ms、200ms和220ms其中的一个。
4.根据权利要求1所述的擦窗机陀螺仪动态校准方法,其特征在于,所述控制器选用DSP控制器或单片机控制器。
5.根据权利要求1所述的擦窗机陀螺仪动态校准方法,其特征在于,所述A0为0deg/s。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201711435631.6A CN108168579B (zh) | 2017-12-26 | 2017-12-26 | 擦窗机陀螺仪动态校准方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201711435631.6A CN108168579B (zh) | 2017-12-26 | 2017-12-26 | 擦窗机陀螺仪动态校准方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN108168579A CN108168579A (zh) | 2018-06-15 |
CN108168579B true CN108168579B (zh) | 2020-09-11 |
Family
ID=62521712
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201711435631.6A Active CN108168579B (zh) | 2017-12-26 | 2017-12-26 | 擦窗机陀螺仪动态校准方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN108168579B (zh) |
Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101619978A (zh) * | 2008-06-30 | 2010-01-06 | 鼎亿数码科技(上海)有限公司 | 基于陀螺仪和加速度传感器的定位方法 |
CN102095419A (zh) * | 2010-12-01 | 2011-06-15 | 东南大学 | 光纤陀螺温度漂移建模及误差补偿方法 |
CN103063228A (zh) * | 2012-12-25 | 2013-04-24 | 深圳市欧克蓝科技有限公司 | 一种陀螺仪静态校准方法 |
CN103399175A (zh) * | 2013-07-11 | 2013-11-20 | 广东欧珀移动通信有限公司 | 一种校准加速度传感器的方法及移动终端 |
CN103674062A (zh) * | 2013-12-05 | 2014-03-26 | 广东电网公司电力科学研究院 | 基于Allan方差与ARMA模型分析提高陀螺仪测量精度的方法 |
CN105021210A (zh) * | 2014-04-16 | 2015-11-04 | 苏州圣赛诺尔传感器技术有限公司 | Mems陀螺仪随机漂移误差的处理方法 |
US9273966B2 (en) * | 2010-11-08 | 2016-03-01 | Elektrobit Automotive Gmbh | Technique for calibrating dead reckoning positioning data |
CN106500728A (zh) * | 2016-10-26 | 2017-03-15 | 北京小鸟看看科技有限公司 | 一种陀螺仪的温度漂移补偿方法和装置 |
-
2017
- 2017-12-26 CN CN201711435631.6A patent/CN108168579B/zh active Active
Patent Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101619978A (zh) * | 2008-06-30 | 2010-01-06 | 鼎亿数码科技(上海)有限公司 | 基于陀螺仪和加速度传感器的定位方法 |
US9273966B2 (en) * | 2010-11-08 | 2016-03-01 | Elektrobit Automotive Gmbh | Technique for calibrating dead reckoning positioning data |
CN102095419A (zh) * | 2010-12-01 | 2011-06-15 | 东南大学 | 光纤陀螺温度漂移建模及误差补偿方法 |
CN103063228A (zh) * | 2012-12-25 | 2013-04-24 | 深圳市欧克蓝科技有限公司 | 一种陀螺仪静态校准方法 |
CN103399175A (zh) * | 2013-07-11 | 2013-11-20 | 广东欧珀移动通信有限公司 | 一种校准加速度传感器的方法及移动终端 |
CN103674062A (zh) * | 2013-12-05 | 2014-03-26 | 广东电网公司电力科学研究院 | 基于Allan方差与ARMA模型分析提高陀螺仪测量精度的方法 |
CN105021210A (zh) * | 2014-04-16 | 2015-11-04 | 苏州圣赛诺尔传感器技术有限公司 | Mems陀螺仪随机漂移误差的处理方法 |
CN106500728A (zh) * | 2016-10-26 | 2017-03-15 | 北京小鸟看看科技有限公司 | 一种陀螺仪的温度漂移补偿方法和装置 |
Non-Patent Citations (1)
Title |
---|
适用于MEMS振动陀螺仪的相位读出自校准方法;许建军等;《微型机与应用》;20171013;第36卷(第19期);第41-44页 * |
Also Published As
Publication number | Publication date |
---|---|
CN108168579A (zh) | 2018-06-15 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US8442685B2 (en) | Robot control apparatus | |
JP5243956B2 (ja) | リアルタイムバイアス推定器に基づく慣性機器のための自己較正 | |
US8762091B1 (en) | Inertial measurement system | |
US9533414B2 (en) | Torque detecting method and arm device | |
CN109323711B (zh) | 一种陀螺仪模态反转零位自校正方法及系统 | |
KR101824741B1 (ko) | 손떨림 보정 카메라에서의 게인 조정방법 | |
RU2285902C1 (ru) | Способ определения и компенсации ухода гиростабилизированной платформы и устройство для его осуществления | |
JP2007086076A (ja) | ジャイロセンサの補正方法及び補正装置 | |
CA2381196A1 (en) | Vibration compensation for sensors | |
JP5139412B2 (ja) | 角度測定の方法およびそれを実施するための角度測定ジャイロシステム | |
KR101106048B1 (ko) | 센서오차의 작동 중 자동교정 방법과 이를 이용한 관성항법장치 | |
US6677722B2 (en) | Servo control method | |
CN108168579B (zh) | 擦窗机陀螺仪动态校准方法 | |
CN112556688A (zh) | 测量装置 | |
CN103345149A (zh) | 一种动力调谐陀螺仪伺服控制回路 | |
CN109426143A (zh) | 负载转矩估算方法、系统、机电控制系统、方法及电机 | |
JP4390539B2 (ja) | 負荷特性演算装置及びモータ制御装置 | |
Lele et al. | Evaluation of solid state accelerometer sensor for effective position estimation | |
EP2619528B1 (en) | System and process for determining offsets of measuring instruments | |
US11619492B2 (en) | Sensor linearization based upon correction of static and frequency-dependent non-linearities | |
JP5553215B2 (ja) | アンバランス量測定方法と装置 | |
JP2015182141A (ja) | 運動誤差測定方法、運動誤差測定装置及びこれを備えた工作機械 | |
Boggarpu et al. | New learning algorithm for high-quality velocity measurement from low-cost optical encoders | |
CN108551282B (zh) | 双通道旋转变压器解算校正方法、模块及电机控制系统 | |
Kubus et al. | A sensor fusion approach to angle and angular rate estimation |
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 |