CN111006691B - 传感器校漂方法、装置、可读存储介质、电子设备及无人机 - Google Patents
传感器校漂方法、装置、可读存储介质、电子设备及无人机 Download PDFInfo
- Publication number
- CN111006691B CN111006691B CN201911151711.8A CN201911151711A CN111006691B CN 111006691 B CN111006691 B CN 111006691B CN 201911151711 A CN201911151711 A CN 201911151711A CN 111006691 B CN111006691 B CN 111006691B
- Authority
- CN
- China
- Prior art keywords
- sensor
- drift
- value
- sensor data
- drift correction
- 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
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01D—MEASURING NOT SPECIALLY ADAPTED FOR A SPECIFIC VARIABLE; ARRANGEMENTS FOR MEASURING TWO OR MORE VARIABLES NOT COVERED IN A SINGLE OTHER SUBCLASS; TARIFF METERING APPARATUS; MEASURING OR TESTING NOT OTHERWISE PROVIDED FOR
- G01D18/00—Testing or calibrating apparatus or arrangements provided for in groups G01D1/00 - G01D15/00
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Manufacturing & Machinery (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Gyroscopes (AREA)
- Indication And Recording Devices For Special Purposes And Tariff Metering Devices (AREA)
Abstract
本发明公开了一种传感器校漂方法、装置、可读存储介质、电子设备及无人机,其包括如下步骤:S1、获取传感器数据,并对所述传感器数据进行状态监控;S2、若满足校漂状态需求,则对所述传感器数据进行滤波处理;S3、对经滤波处理后的传感器数据进行预测,以获取传感器数据的当前预测实际值;S4、根据步骤S3中获得的获取传感器数据的当前预测实际值进行闭环校漂计算,以获得实时漂移值;以及S5、根据所述实时漂移值更新传感器零漂值,以供传感器修正漂移误差,以完成动态校漂。本发明可以实时校正包括云台传感器在内的传感器漂移,同时可经过高精度滤波算法提高校正精度。
Description
技术领域
本发明涉及云台控制领域,具体为一种传感器校漂方法、装置、可读存储介质、电子设备及无人机。
背景技术
云台传感器(如陀螺等)会因温度、环境等因素产生零点漂移,零点漂移问题是工业控制上一个难题,目前解决其漂移的方法有固定值法,查表法等,但大多都无法做到实时校漂或者校漂精度较差。
发明内容
针对现有技术的不足,本发明提供了一种传感器校漂方法、装置、可读存储介质、电子设备及无人机,其可以实时校正包括云台传感器在内的传感器漂移,同时可经过高精度滤波算法提高校正精度。
为实现上述目的,本发明提供如下技术方案:
提供了一种传感器校漂方法,其包括如下步骤:
S1、获取传感器数据,并对所述传感器数据进行状态监控,以判断所述传感器数据是否满足传感器校漂状态需求;
S2、若满足校漂状态需求,则对所述传感器数据进行滤波处理;
S3、根据下述公式(1-2)-(1-2)对经滤波处理后的传感器数据进行预测,以获取传感器数据的当前预测实际值Pn;
Pn=A*f+B*(1-f) (1-1)
B=Pn-1+θ*T+q (1-2)
其中A为传感器测量值,B为当前预测值,Pn为当前预测实际值,Pn-1为前一时刻预测实际值,f为通过约定计算得到的隶属度,T为给定的预测系数,θ为给定的预测噪声值,q为预测波动值;
S4、根据步骤S3中获得的获取传感器数据的当前预测实际值Pn进行闭环校漂计算,以获得实时漂移值,且判断所述实时漂移值是否满足校漂完成条件;
以及S5、当实时漂移值满足校漂完成条件时,根据所述实时漂移值更新传感器零漂值,以供传感器修正漂移误差,以完成动态校漂。
优选的,所述闭环校漂计算包括:
S41、输入所述传感器数据的当前预测实际值Pn,并进行累计求和运算和归一化处理;
S42、计算数据误差系数;
S43、将所述数据误差系数与协定误差ξ进行比较,若所述数据误差系数<ξ,则进入下一步,若数据误差系数≥ξ,则返回到S41;
S44、按照公式(2)将使得所述数据误差系数<ξ的当前预测实际值Pn按照一定的权重比例计算出实时漂移值Y;
Y=∑Pn/n (2)
其中,n为正整数。
一方面,还提供一种实现上述传感器校漂方法的传感器校漂装置,其包括:数据获取模块,其用于获取传感器数据;状态观测模块,其用于对所述传感器数据进行监控,并判断所述传感器数据是否满足传感器校漂状态需求;滤波器模块,其用于对满足校漂状态需求的传感器数据进行滤波处理及预测,以获得传感器数据的当前预测实际值;校漂模块,用于接收所述传感器数据的当前预测实际值,并计算传感器的实时漂移值,且判断所述实时漂移值是否满足校漂完成条件,且当所述实时漂移值满足校漂完成条件时,根据所述实时零漂值更新传感器零漂参数,以供传感器修正漂移误差。
优选的,所述滤波器模块包括:数据滤波单元,其用于对满足校漂状态需求的传感器数据进行滤波降噪处理;以及数据预测单元,其用于根据上述步骤S3中的方法获取传感器数据的当前预测实际值。
还提供一种可读存储介质,其上存储有计算机程序,所述计算机程序被执行时实现上述传感器校漂方法。
还提供一种电子设备,其包括上述可读存储介质、处理器及存储在该可读存储介质上并可在处理器上运行的计算机程序,所述处理器执行所述程序时实现上述传感器校漂方法。
还提供一种无人机,其包括上述校漂装置,或,上述可读存储介质,或上述的电子设备。
与现有技术相比,本发明具备以下有益效果:
本发明可以实时校正包括云台传感器在内的传感器漂移,同时可经过高精度滤波算法提高校正精度。
附图说明
图1为本发明实施例一中传感器校漂方法的步骤图;
图2为本发明实施例一中传感器校漂方法的流程图;
图3为本发明实施例一中闭环校漂计算的流程图;
图4为本发明实施例二中闭环校漂装置的结构图;
图5为本发明实施例二中滤波器模块的结构图;
图6为校漂前的传感器漂移数据曲线;
图7为经本发明校漂方法处理后的传感器漂移数据曲线。
具体实施方式
下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅仅是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。
实施例一:
如图1-2所示,本发明中的传感器校漂方法包括如下步骤:
S1、开启控制系统(包括云台控制系统),使其处于实时校漂状态;控制系统获取传感器(包括陀螺仪、加速度计、角度测量传感器、GPS、温度传感器等用于获取云台相关信息的传感器)数据,并对所述传感器数据进行状态监控,以判断所述传感器数据是否满足传感器校漂状态需求;本实施例中,所述判断方法包括云台状态判断法、传感器数据判断法等,传感器校漂状态需求也可根据实际应用环境确定,在此不做具体限定;例如,本实施例中主要采用传感器数据判断法,利用方差判据对校漂数据稳定性进行判断,以确定传感器数据是否满足云台传感器校漂状态需求,其中,校漂数据稳定性判断条件如下:
其中,A为传感器累计值,M为预期稳定值,N为传感器数据样本数,δ为判断阈值;若判断“符合要求”,即说明传感器数据满足传感器校漂状态需求,则进入下一步;
S2、若满足校漂状态需求,则对所述传感器数据进行滤波处理;具体的,如下述公式(1)所示,传感器测量值A通常是由实际值S、零漂值Z加白噪声值η所组成;
A=S+η+Z (1)
当系统稳定时,传感器测量值A应与预期给定值相等,因此此处需要通过滤波算法对噪声进行滤波,以此来减少噪声η的干扰;所述滤波算法可通过巴特沃斯低通滤波器、IIR滤波器、FIR滤波器、中值滤波等方式实现,在此不做具体限定;
S3、根据下述公式(1-2)-(1-2)对经滤波处理后的传感器数据进行预测,以获取传感器数据的当前预测实际值Pn;
Pn=A*f+B*(1-f) (1-1)
B=Pn-1+θ*T+q (1-2)
其中A为传感器测量值,B为当前预测值,Pn为当前预测实际值,Pn-1为前一时刻预测实际值,f为通过约定计算得到的隶属度,T为给定的预测系数,θ为给定的预测噪声值,q为预测波动值;
S4、根据步骤S3中获得的获取传感器数据的当前预测实际值Pn进行闭环校漂计算,以获得实时漂移值,且判断所述实时漂移值是否满足校漂完成条件;具体的,如图3所示,所述闭环校漂计算包括:
S41、输入所述传感器数据的当前预测实际值Pn,并进行累计求和运算和归一化处理;
S42、计算数据误差系数;
S43、将所述数据误差系数与协定误差ξ进行比较,若所述数据误差系数<ξ,则进入下一步,若数据误差系数≥ξ,则返回到S41;
S44、按照公式(2)将使得所述数据误差系数<ξ的当前预测实际值Pn按照一定的权重比例计算出实时漂移值Y;
Y=∑Pn/n (2)
其中,n为正整数;
以及S5、当实时漂移值满足校漂完成条件时,根据所述实时漂移值Y更新传感器零漂值,以供传感器修正漂移误差,以完成动态校漂。
实施例二:
本实施例提供了一种用于实现实施例一所述传感器校漂方法的传感器校漂装置,如图4所示,其包括:
数据获取模块1,其用于获取控制系统的传感器数据;
状态观测模块2,其用于对所述传感器数据进行监控,并判断所述传感器数据是否满足传感器校漂状态需求;所述判断方法的限定参见实施例一的步骤S1,在此不再赘述,同时,所述“监控”是指通过硬件和/或软件实现的可以实时监测系统观测量状态变化的系统,该系统可以包括外部触发电路、触发式传感器等硬件,也可以包括能实时监测系统数据变化的软件;
滤波器模块3,其用于对满足校漂状态需求的传感器数据进行滤波处理及预测,以获得传感器数据的当前预测实际值;具体的,如图5所示,所述滤波器模块3包括:数据滤波单元31,其用于根据具有特定滤波作用的程序算法对满足校漂状态需求的传感器数据进行滤波降噪处理,以将数据中所叠加的特定干扰信号削弱或消除,主要用于滤除由于传感器自身所产生的白噪声干扰;以及数据预测单元32,其用于根据上述步骤S3中的方法获取传感器数据的当前预测实际值;
校漂模块4,用于接收所述传感器数据的当前预测实际值,并通过闭环算法计算传感器的实时漂移值,且判断所述实时漂移值是否满足校漂完成条件,且当所述实时漂移值满足校漂完成条件时,根据所述实时零漂值更新传感器零漂参数,以供传感器修正漂移误差,以完成动态校漂。
实施例三:
本实施例提供了一种可读存储介质,其上存储有计算机程序,所述计算机程序被执行时实现上述传感器校漂方法。
实施例四:
本实施例提供了一种电子设备,其包括实施例三所述的可读存储介质、处理器及存储在该可读存储介质上并可在处理器上运行的计算机程序,所述处理器执行所述程序时实现上述传感器校漂方法。
实施例五:
本实施例提供了一种无人机,其包括实施例二中的校漂装置,或,实施例三中的可读存储介质,或实施例四所述的电子设备。
如图所示,校漂前的传感器漂移数据曲线如图6所示,其存在有0.1度至0.4度不等的漂移,经过本发明的校漂方法校漂后,如图7所示,传感器漂移值趋近于0,基本无漂移存在。
综上所述,本发明的校漂方法简便,实时性好,能够在动态情况下,且只要满足传感器实时校漂条件的前提下即可实现传感器漂移的实时校正,可适用于包括云台传感器在内的各种传感器校漂,且无需人为干预,解决了手动校漂的非实时性与查表法的操作繁琐,由此极大提高校漂效率,同时经过高精度滤波算法对数据进行降噪处理,进一步大幅提高校正精度。
需要说明的是,上述实施例一至五中的技术特征可进行任意组合,且组合而成的技术方案均属于本发明的保护范围。在本文中,诸如术语“包括”、“包含”或者其任何其他变体意在涵盖非排他性的包含,从而使得包括一系列要素的过程、方法、物品或者设备不仅包括那些要素,而且还包括没有明确列出的其他要素,或者是还包括为这种过程、方法、物品或者设备所固有的要素。在没有更多限制的情况下,由语句“包括一个……”限定的要素,并不排除在包括所述要素的过程、方法、物品或者设备中还存在另外的相同要素。
尽管已经示出和描述了本发明的实施例,对于本领域的普通技术人员而言,可以理解在不脱离本发明的原理和精神的情况下可以对这些实施例进行多种变化、修改、替换和变型,本发明的范围由所附权利要求及其等同物限定。
Claims (7)
1.一种传感器校漂方法,其特征在于,包括如下步骤:
S1、获取传感器数据,并对所述传感器数据进行状态监控,以判断所述传感器数据是否满足传感器校漂状态需求;
S2、若满足校漂状态需求,则对所述传感器数据进行滤波处理;
S3、根据下述公式(1-1 )-(1-2)对经滤波处理后的传感器数据进行预测,以获取传感器数据的当前预测实际值Pn;
Pn=A*f+B*(1-f) (1-1)
B=Pn-1+θ*T+q (1-2)
其中A为传感器测量值,B为当前预测值,Pn为当前预测实际值,Pn-1为前一时刻预测实际值,f为通过约定计算得到的隶属度,T为给定的预测系数,θ为给定的预测噪声值,q为预测波动值;
S4、根据步骤S3中获得的传感器数据的当前预测实际值Pn进行闭环校漂计算,以获得实时漂移值,且判断所述实时漂移值是否满足校漂完成条件;
以及S5、当实时漂移值满足校漂完成条件时,根据所述实时漂移值更新传感器零漂值,以供传感器修正漂移误差,以完成动态校漂。
2.如权利要求1所述的校漂方法,其特征在于,所述闭环校漂计算包括:
S41、输入所述传感器数据的当前预测实际值Pn,并进行累计求和运算和归一化处理;
S42、计算数据误差系数;
S43、将所述数据误差系数与协定误差ξ进行比较,若所述数据误差系数<ξ,则进入下一步,若数据误差系数≥ξ,则返回到S41;
S44、按照公式(2)将使得所述数据误差系数<ξ的当前预测实际值Pn按照一定的权重比例计算出实时漂移值Y;
Y=∑Pn/n (2)
其中,n为正整数。
3.一种实现权利要求1-2任一项所述传感器校漂方法的传感器校漂装置,其特征在于,包括:数据获取模块,其用于获取传感器数据;状态观测模块,其用于对所述传感器数据进行监控,并判断所述传感器数据是否满足传感器校漂状态需求;滤波器模块,其用于对满足校漂状态需求的传感器数据进行滤波处理及预测,以获得传感器数据的当前预测实际值;校漂模块,用于接收所述传感器数据的当前预测实际值,并计算传感器的实时漂移值,且判断所述实时漂移值是否满足校漂完成条件,且当所述实时漂移值满足校漂完成条件时,根据所述实时漂移 值更新传感器零漂参数,以供传感器修正漂移误差。
4.如 权利要求3所述的校漂装置,其特征在于,所述滤波器模块包括:数据滤波单元,其用于对满足校漂状态需求的传感器数据进行滤波降噪处理;以及数据预测单元,其用于根据上述步骤S3中的方法获取传感器数据的当前预测实际值。
5.一种可读存储介质,其上存储有计算机程序,所述计算机程序被执行时实现上述权利要求1-2任一项所述的传感器校漂方法。
6.一种电子设备,其包括权利要求5所述的可读存储介质、处理器及存储在该可读存储介质上并可在处理器上运行的计算机程序,所述处理器执行所述程序时实现上述权利要求1-2任一项所述的传感器校漂方法。
7.一种无人机,其包括权利要求3所述的校漂装置,或,权利要求5所述的可读存储介质,或权利要求6所述的电子设备。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201911151711.8A CN111006691B (zh) | 2019-11-22 | 2019-11-22 | 传感器校漂方法、装置、可读存储介质、电子设备及无人机 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201911151711.8A CN111006691B (zh) | 2019-11-22 | 2019-11-22 | 传感器校漂方法、装置、可读存储介质、电子设备及无人机 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN111006691A CN111006691A (zh) | 2020-04-14 |
CN111006691B true CN111006691B (zh) | 2021-06-01 |
Family
ID=70112847
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201911151711.8A Active CN111006691B (zh) | 2019-11-22 | 2019-11-22 | 传感器校漂方法、装置、可读存储介质、电子设备及无人机 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN111006691B (zh) |
Families Citing this family (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111693019B (zh) * | 2020-05-20 | 2021-04-20 | 西安交通大学 | 一种姿态传感装置及数据融合、姿态解算方法 |
CN112781613A (zh) * | 2020-12-02 | 2021-05-11 | 普宙飞行器科技(深圳)有限公司 | 一种无人机传感器的校准方法 |
CN113392524B (zh) * | 2021-06-11 | 2023-04-28 | 广东美的暖通设备有限公司 | 一种传感器的漂移诊断方法、装置、电子设备及存储介质 |
CN113758515B (zh) * | 2021-08-16 | 2023-04-07 | 深圳市睿联技术股份有限公司 | 零点校准方法、装置、电子设备及计算机可读存储介质 |
CN118244378B (zh) * | 2024-05-27 | 2024-08-02 | 深圳市小镜科技有限公司 | 零点校正方法、装置、设备及存储介质 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102288197A (zh) * | 2010-12-30 | 2011-12-21 | 东莞易步机器人有限公司 | 一种低成本陀螺仪去噪防零漂防失真的方法 |
CN103364625A (zh) * | 2012-04-11 | 2013-10-23 | 哈尔滨佳云科技有限公司 | 一种传感器零点漂移自动在线跟踪方法 |
CN103793614A (zh) * | 2014-02-25 | 2014-05-14 | 河南理工大学 | 突变滤波算法 |
CN104406605A (zh) * | 2014-10-13 | 2015-03-11 | 中国电子科技集团公司第十研究所 | 机载多导航源综合导航仿真系统 |
CN109827571A (zh) * | 2019-03-22 | 2019-05-31 | 北京壹氢科技有限公司 | 一种无转台条件下的双加速度计标定方法 |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH06117873A (ja) * | 1992-10-02 | 1994-04-28 | Honda Motor Co Ltd | センサの零点ドリフト補正装置 |
-
2019
- 2019-11-22 CN CN201911151711.8A patent/CN111006691B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102288197A (zh) * | 2010-12-30 | 2011-12-21 | 东莞易步机器人有限公司 | 一种低成本陀螺仪去噪防零漂防失真的方法 |
CN103364625A (zh) * | 2012-04-11 | 2013-10-23 | 哈尔滨佳云科技有限公司 | 一种传感器零点漂移自动在线跟踪方法 |
CN103793614A (zh) * | 2014-02-25 | 2014-05-14 | 河南理工大学 | 突变滤波算法 |
CN104406605A (zh) * | 2014-10-13 | 2015-03-11 | 中国电子科技集团公司第十研究所 | 机载多导航源综合导航仿真系统 |
CN109827571A (zh) * | 2019-03-22 | 2019-05-31 | 北京壹氢科技有限公司 | 一种无转台条件下的双加速度计标定方法 |
Also Published As
Publication number | Publication date |
---|---|
CN111006691A (zh) | 2020-04-14 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN111006691B (zh) | 传感器校漂方法、装置、可读存储介质、电子设备及无人机 | |
CN112525218B (zh) | 一种ins/dvl组合导航系统鲁棒智能协同校准方法 | |
CN105374049B (zh) | 一种基于稀疏光流法的多角点跟踪方法及装置 | |
CN114063056A (zh) | 一种船舶航迹融合方法、系统、介质和设备 | |
JP2023503767A (ja) | データの処理方法及び装置 | |
CN115711616B (zh) | 一种室内室外穿越无人机的平顺定位方法及装置 | |
CN109916388A (zh) | 基于小波降噪和神经网络的光纤陀螺温度漂移补偿方法 | |
CN110058288A (zh) | 无人机ins/gnss组合导航系统航向误差修正方法及系统 | |
Fossen et al. | Exogenous kalman filter (xkf) for visualization and motion prediction of ships using live automatic identification systems (ais) data | |
CN116702940B (zh) | 一种航速优化方法及系统 | |
CN113538699A (zh) | 基于三维点云的定位方法、装置、设备及存储介质 | |
CN112987560A (zh) | 滤波器控制方法、装置、设备及计算机存储介质 | |
CN115615417A (zh) | 自适应滤波系统构造方法、自适应滤波方法及装置 | |
CN115047890A (zh) | 无人船控制方法、设备及计算机可读存储介质 | |
CN112556699B (zh) | 导航定位方法、装置、电子设备及可读存储介质 | |
CN110530400B (zh) | 陀螺仪漂移修正方法、装置、光电吊舱及飞行器 | |
CN110989691B (zh) | 一种云台控制方法、装置、存储介质、电子设备及无人机 | |
CN111457913B (zh) | 交通工具导航数据融合方法、装置和系统 | |
CN108230370B (zh) | 基于云台的跟踪目标速度预测方法及存储介质 | |
CN112461258A (zh) | 一种参数修正的方法及装置 | |
CN112924996B (zh) | 一种增强北斗时序分析可靠性的方法、设备及存储介质 | |
CN117195673A (zh) | 漂浮物漂移速度的预测方法、装置、设备及存储介质 | |
EP3499419A1 (en) | Information processing method, information processing apparatus, and program | |
KR101847113B1 (ko) | 이미지를 이용하는 카메라의 방향과 관련한 정보 추정장치 및 추정방법 | |
CN111123323A (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 | ||
CP01 | Change in the name or title of a patent holder |
Address after: 518000 Room 201, building A, No. 1, Qian Wan Road, Qianhai Shenzhen Hong Kong cooperation zone, Shenzhen, Guangdong (Shenzhen Qianhai business secretary Co., Ltd.) Patentee after: Puzhou Technology (Shenzhen) Co.,Ltd. Address before: 518000 Room 201, building A, No. 1, Qian Wan Road, Qianhai Shenzhen Hong Kong cooperation zone, Shenzhen, Guangdong (Shenzhen Qianhai business secretary Co., Ltd.) Patentee before: PRODRONE TECHNOLOGY (SHENZHEN) Co.,Ltd. |
|
CP01 | Change in the name or title of a patent holder |