CN102472632B - 惯性传感器的校准方法 - Google Patents

惯性传感器的校准方法 Download PDF

Info

Publication number
CN102472632B
CN102472632B CN201080028641.8A CN201080028641A CN102472632B CN 102472632 B CN102472632 B CN 102472632B CN 201080028641 A CN201080028641 A CN 201080028641A CN 102472632 B CN102472632 B CN 102472632B
Authority
CN
China
Prior art keywords
inertial sensor
working equipment
sensor
data
inertial
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
Application number
CN201080028641.8A
Other languages
English (en)
Other versions
CN102472632A (zh
Inventor
D·杜沙
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.)
Leica Geosystems AG
Original Assignee
Leica Geosystems AG
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
Priority claimed from AU2009905218A external-priority patent/AU2009905218A0/en
Application filed by Leica Geosystems AG filed Critical Leica Geosystems AG
Publication of CN102472632A publication Critical patent/CN102472632A/zh
Application granted granted Critical
Publication of CN102472632B publication Critical patent/CN102472632B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C25/00Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass
    • G01C25/005Manufacturing, 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
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/10Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
    • G01C21/12Navigation; 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/16Navigation; 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/183Compensation of inertial measurements, e.g. for temperature effects
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01PMEASURING LINEAR OR ANGULAR SPEED, ACCELERATION, DECELERATION, OR SHOCK; INDICATING PRESENCE, ABSENCE, OR DIRECTION, OF MOVEMENT
    • G01P21/00Testing or calibrating of apparatus or devices covered by the preceding groups

Abstract

一种校准诸如交通工具或测量设备的工作设备的惯性传感器的方法,该方法包括确定该工作设备是否处于工作状态。当该工作设备不处于工作状态时,从惯性传感器以及与之相关联的温度传感器采集数据。采集的数据用于更新惯性传感器的热偏离误差模型。

Description

惯性传感器的校准方法
技术领域
本发明涉及惯性传感器的校准方法及惯性测量单元。特别是,尽管并非专有地,但是本发明涉及惯性传感器的现场(in-field)自动校准。
背景技术
精确的惯性检测对于检测工作设备的“姿态”(例如,工作设备相对基准框架(通常是理论上的水平地面)的转动)是关键的。在精准农业(precision agriculture)中,需要了解交通工具的姿态以补偿由地形起伏导致的GNSS天线的运动。在测量过程中,GNSS天线经常被安装在杆上,并且为了准确确定该杆的基部的位置,必须确定该杆的姿态。
惯性传感器包括对角度的变化速率进行测量的陀螺仪和对线性加速度进行测量的加速计。来自惯性传感器的测量结果包含必须进行补偿的偏离和其他误差。可以使用以下公式来对惯性传感器的测量结果进行建模:
a ^ = Ka + b t + B ( T ) + ω n
其中:
是测得的惯性量
K是该设备的比例因子(灵敏度)
a是实际惯性量
bt是随机偏离,其随时间的推移而随机变化
B(T)是温度相关偏离
ωn是传感器噪声,假定其是高斯白噪声
每次分别对加速度和转速进行测量时,以上公式等同地适用于加速计和陀螺仪。当工作设备静止时,加速计会读出取决于该设备姿态的重力部分,并且陀螺仪会读出同样取决于该设备姿态的地球自转速率部分。当使用工业级陀螺仪时,地球自转速率与其他误差源相比贡献很小,因此可以将其假定为零以简化分析而不会引入重大误差。根据相同温度下的充分测量值,来自传感器噪声项的贡献很小并且可以归入到随机偏离中。这样该模型可以简化为:
a ^ = a ‾ + B ( T ) + ϵ
是测得的惯性量
是实际惯性量,其通过比例因数加以修正
ε是剩余误差,合并成单独项
温度相关偏离通常是主要误差。对于惯性传感器而言,温度相关偏离在温度范围内并不恒定,而是在惯性传感器的工作温度范围内变化。给定温度的温度相关偏离自身并不恒定,其将在惯性传感器老化过程中随时间的推移慢慢改变。
为了补偿温度相关偏离,一些工业级惯性传感器最初被校准为包括热偏离误差模型。由于时间和费用限制,校准可能仅仅包括惯性传感器在有限温度范围中的实际温度变化,而不是在惯性传感器可能最终工作的全部温度范围中的温度变化。随着惯性传感器的老化,必须对热偏离误差模型进行更新。通常通过每年的工厂校准或采用其他传感器的(例如,多GPS天线方案)校准来更新热偏离误差模型。所有这些策略都增加了从惯性传感器获取适当精确的姿态方案的费用和复杂度。
当诸如交通工具的工作设备正在工作时,很难将由于交通工具的移动和交通工具的振动所引起的惯性传感器信号变化同由于温度变化所引起的信号变化分离开来。因此,在交通工具静止期间尝试观察惯性传感器的输出信号是有用的。
美国专利US6374190、US6577952和US5297028都描述了当与惯性传感器和温度传感器相关联的交通工具处于静止但工作的状态时通过针对各个惯性传感器对单个惯性传感器和温度传感器信号抽样来对惯性传感器进行现场自动校准。美国专利号US5527003描述了在“在飞机滑行之前的延长的对准时间”期间的现场自动校准以及在此期间对在温度范围中的陀螺仪漂移进行抽样。由于抽样的惯性传感器信号包括由交通工具发动机引起的振动而导致的振动误差,因此现有技术专利中所揭示的现场自动校准固有地具有精度方面的问题。抽样也在有限的温度范围中进行。
发明目的
本发明的目的在于克服或至少减轻上述问题中的一个或多个和/或向消费者提供有用的或商业上的选择。
发明内容
在一种形式中,本发明公开了一种校准工作设备的惯性传感器的方法,该方法包括以下步骤:
当所述工作设备不处于工作状态时,从一个或更多个惯性传感器以及接近所述惯性传感器设置的一个或更多个温度传感器采集数据;以及
使用从所述惯性传感器和所述温度传感器采集的数据来更新所述惯性传感器的热偏离误差模型。
该方法优选地包括确定所述工作设备是否处于工作状态。
所述工作设备可以是交通工具,并且确定所述工作设备是否处于工作状态可以确定该交通工具是否被接通电源。
所述工作设备可以是测量设备,并且确定所述工作设备是否处于工作状态可以确定所述测量设备是否被接通电源。
优选地,该方法包括以下步骤:确定所述工作设备是否受到振动或意外的运动的影响;以及放弃在所述工作设备受到振动或运动影响时所采集的任何数据。
更新所述热偏离误差模型的步骤可以包括将采集的数据拟合成曲线并且利用该曲线的函数的特征来更新所述热偏离误差模型。
更新所述热偏离误差模型的步骤可以包括:相对在所述工作设备不处于工作状态时在以往周期中获取的以往数据来对在所述工作设备不处于工作状态时在一个周期中获取的数据的相关性进行加权,并且向最近的周期中的数据采集赋予更大的权重。
优选地,对具有所述惯性传感器和所述温度传感器的传感器子系统进行周期性地加电以在所述工作设备不处于工作状态时采集数据。
优选地,在所述工作设备断开电源以后将数据的采集延迟预定时间。
在另一种形式中,本发明公开了一种惯性测量单元,包括:
传感器子系统,包括:
一个或更多个惯性传感器;
与所述惯性传感器相关联的一个或更多个温度传感器;以及
低功率抽样模块,其能够操作为从所述惯性传感器和所述温度传感器采集数据;
处理模块,其具有存储有所述惯性传感器的热偏离误差模型的存储器;以及
电源控制器,其被配置为当安装有所述惯性测量单元的工作设备不处于工作状态时选择性地向所述传感器子系统供电以处所述惯性传感器和所述温度传感器采集数据。
优选地,该惯性测量单元包括计时器,该计时器被所述电源控制器使用以在所述工作设备断开电源的时段中周期地对所述传感器子系统加电。
优选地,所述低功率抽样模块包括低功率处理器,并且所述处理模块包括具有比所述低功率处理器相对更高功率要求的主处理器。
附图说明
下面将参照附图仅以示例的方式更加全面地描述本发明的优选实施方式,其中:
图1示出了现有技术的惯性测量单元的设计;
图2示出了根据本发明的惯性测量单元的一个实施方式的图示设计;
图3示出了通过计算热偏离误差模型来校准惯性测量单元的惯性传感器的方法的图示流程图;
图4示出了惯性传感器的温度在惯性传感器从操作温度冷却到环境温度的冷却阶段的温度与时间的关系的曲线;
图5示出了惯性传感器的温度在环境温度变化的环境温度变化阶段的温度与时间的关系的曲线;
图6示出了图2中的惯性测量单元的被描绘为温度偏离曲线的热偏离误差模型;以及
图7示出了在图2中的惯性测量单元的抽样模式期间所获取的温度偏离曲线中的几部分。
具体实施方式
参照图1,现有技术的惯性测量单元1包括一个或多个惯性传感器2、处理模块3以及用于控制向处理模块3和惯性传感器2供电的电源控制器4。处理模块3包括处理器6和存储装置7。在存储装置7中存储有针对各个惯性传感器2的热偏离误差模型。处理模块3能够利用由该热偏离误差模型校正了的惯性传感器的输入来计算交通工具姿态。
参照图2,显示了根据本发明一个实施方式的惯性测量单元(IMU)10的设计。IMU 10通常包括电源控制器12、惯性传感器单元14、低功率抽样模块16、处理模块16和计时器20。惯性传感器单元14和低功率抽样模块16一起形成传感器子系统22。参照IMU 10与在安装有该IMU 10的交通工具的工作关系来描述该IMU 10,但是该IMU 10可以类似地安装在诸如测量设备的任何其他使用惯性传感器的工作设备中。
电源控制器12控制对惯性传感器单元14、低功率抽样模块16和处理模块18的供电。电源控制器12能够独立地对传感器子系统22和处理模块18加电。电源控制器12被配置为在交通工具不工作在IMU 10的测量模式中的同时对传感器子系统22和处理模块18加电。当交通工具被接通电源时,其被视为处于工作状态。电源控制器12被配置为在交通工具不工作时在IMU 10的抽样模式中选择性地对传感器子系统22加电。交通工具在被断开电源时被视为不工作,并且在被接通电源时被视为工作。电源控制器12按照是否连接到交通工具的点火开关来确定该交通工具是接通电源还是断开电源。交通工具被断开电源并接着被接通电源之间的时段称为周期。交通工具在各个周期中通常将具有固定的姿态并且没有振动。
惯性传感器单元14具有内嵌的温度传感器24。另选地,在图中没有示出,温度传感器24并不嵌入在惯性传感器单元14中,而是位于与惯性传感器单元14相邻的位置。惯性传感器单元14包括陀螺仪形式或加速计形式的惯性传感器26。惯性传感器单元14从温度传感器24输出温度信号并且从惯性传感器26输出惯性信号。来自惯性传感器单元14的信号被提供给抽样模块16。
抽样模块16包括低功率处理器30、存储器31和数据存储装置32。低功率处理器30是诸如微控制器的低功率装置。在IMU 10的抽样模式中,来自惯性传感器单元14的信号数据被采集并存储在数据存储装置32中。抽样模块16连接至计时器20,使得所采集的数据在被存储在存储装置32中时也被打上时间戳。数据存储装置32具有温度与偏离的关系表,在该表中保存有各个周期的各个惯性传感器26的抽样的惯性传感器信号数据与温度数据的关系。在IMU 10的测量模式中,来自惯性传感器单元14的信号经由抽样模块16转送到处理模块18。
处理模块18包括主处理器34、存储器36和数据存储装置38。在存储器36中存储有针对各个惯性传感器26的热偏离误差模型。主处理器34利用数据存储装置38中保存的各个惯性传感器26的多批次的历史惯性传感器信号数据-温度数据来计算出该热偏离误差模型。如以下更加详细地描述的那样,所述历史数据是根据从抽样模块16的存储装置32中检索出的多批次数据汇编而来的。
图3示出了通过计算热偏离误差模型来对IMU 10的惯性传感器26进行现场自动校准的方法的图示流程图。对惯性传感器26的现场自动校准是在交通工具中就地进行的。该方法包括首先确定40安装有IMU 10的交通工具在处于工作状态还是不处于工作状态。交通工具在被断开电源时被确定为不处于工作状态,并且在被接通电源时被确定为处于工作状态。如果该交通工具被断开电源42,则在抽样模式中44对IMU 10加电。在抽样模式中44,如附图标记46所指示的那样,传感器子系统22被加电而处理模块18不被加电。如附图标记48所指示的那样,传感器子系统22从惯性传感器单元14采集温度信号数据和惯性信号数据。如附图标记50所指示的那样,所采集的数据被存储在抽样模块16的存储装置32中。
在交通工具被接通电源52时,在测量模式中54对IMU 10加电。在测量模式中,如附图标记56所指示的那样,传感器子系统22被加电,并且处理模块18被加电。如附图标记58所指示的那样,处理模块18对存储在抽样模块16的存储装置32中的数据进行检索。如附图标记60所指示的那样,处理模块18接着利用从抽样模块16中检索出的数据来计算各个惯性传感器26的热偏离误差模型,由此校准惯性传感器26。如附图标记62所指示的那样,将来自惯性传感器单元14的信号转送至处理模块18,并且通过应用在步骤60中计算出的热偏离误差模型来加以校正。
在测量模式中,传感器子系统22和处理模块18被加电,使得由惯性传感器26和温度传感器24产生的惯性传感器单元信号可以转送至处理模块18。处理模块18的主处理器34通过将热偏离误差模型应用于这些信号来校正信号。主处理器34也同时执行诸如控制与导航、姿态计算以及与抽样模块16进行联系的其他任务。由于主处理器34要执行的任务,与抽样模块16的低功率处理器30相比,主处理器34需要是相对大功率的。因此,主处理器34具有比低功率处理器30相对更高的功率要求。校正后的信号用来确定交通工具的姿态。每一次IMU 10从抽样模式改变为测量模式,处理模块18就检索保存在抽样模块16的数据存储装置32中的该周期的惯性传感器信号数据-温度数据,并将检索的数据与之前检索的数据一起存储在处理模块18的数据存储装置38中。
在IMU 10的抽样模式中,传感器子系统22被选择性地加电,但处理模块18不被加电。因此,IMU 10在抽样模式中消耗最小量的电力。子系统22在惯性传感器单元14的冷却阶段中被加电,并且在该冷却阶段之后的环境温度变化阶段中被周期性地加电。
参照图4,显示了惯性传感器单元14的冷却阶段,其中单元14从操作温度冷却到环境温度。在交通工具被断开电源后,冷却阶段立刻开始。为了避免采集驾驶员退出交通工具时的数据,抽样模块16可以在交通工具断开电源后将数据采集延迟预定时间。另选地,由于正在退出的驾驶员引起的振动,将会放弃在驾驶员退出交通工具期间采集到的数据。退出交通工具的驾驶员引起振动,使得在这个时段中采集的任何数据都将不适用于热偏离误差模型的确定。单元14通常在相对短的时间内从操作温度(该温度可以显著高于环境温度)快速冷却到环境温度。在该冷却阶段中,抽样模块16持续地执行采集直至运行时间已经过去或者温度传感器24检测到的温度没有显著变化为止。
参照图5,在惯性传感器单元14受到环境温度波动影响的时段中,子系统22被周期性地加电。这种环境温度变化阶段例如是夜间交通工具被停放时的持续时间。由于环境温度随时间推移而缓慢变化,所以仅需要周期性地进行数据采集。低功率处理器30为计时器20设置闹铃(alarm)以通过电源控制器12来周期性地对传感器子系统22加电。交通工具电池上的电力泄露由于子系统22的周期性加电而被减到最小。低功率处理器30的功率需求为,子系统22可以在交通工具电池不出现显著地电力泄露的情况下工作延长的时段。环境温度变化阶段中的抽样时间由图5中的抽样框64指出。环境温度变化阶段中的抽样是特别有用的,这是因为其使得可以在比在工厂校准中或冷却阶段中所通常发现的温度范围更大的温度范围内进行数据采集。
惯性传感器26在交通工具启动时从环境温度预热至工作温度的时段对于热偏离误差模型校正来说是有问题的,这是因为在这一温度范围内缺少数据来开发该热偏离误差模型。在环境温度远远低于工作温度的情况下更是如此。考虑到这一点,一些交通工具(诸如飞机)在使用之前要求“预热时段(warming up period)”。在驾驶员可能意识不到惯性传感器在使用中(诸如农业)的交通工具中,具有如本发明所提供的,在整个环境和工作温度范围内对数据进行的热偏离误差模型校正是显著的优点。申请人认为,如果惯性传感器26在抽样期间检测到移动或振动,则该抽样期间的数据将会被放弃并且子系统22将临时掉电。在交通工具不处于工作状态时的各个周期中的抽样生成了存储在抽样模块16的存储装置32中的不同批次的采集数据。
参照图6,将存储在处理模块18的存储器36中的各个惯性传感器26的热偏离误差模型描绘为温度偏离曲线。各个惯性传感器26将会具有唯一的温度偏离曲线,因此针对各个惯性传感器26独立地从惯性传感器单元14采集数据。
参照图7,每一次在IMU 10处于抽样模式中时采集温度偏离曲线中的部分的数据。每一次当交通工具在不同周期中以不同的角度停放时,在抽样过程中针对加速计测量到的数据将与实际偏离有偏差。这在图7中由示出的图中的间隔“由于重力而引起的偏差”指出。在当IMU 10处于抽样模式中时的不同数据采集时段中,将对温度偏离曲线的不同区段进行观察并且这些区段几乎肯定具有不同的偏差。根据采集到的充足的惯性传感器信号数据,可以从如下所描述的多个采集的部分温度偏离曲线估计出实际温度曲线:
假定温度偏离曲线为n阶多项式。也就是说:
B(T)=b0+b1T+b2T2+...+bnTn
在计算温度偏离曲线之前,该多项式的阶数是未知的并且必须加以假设。如在本发明的背景技术中所描述的,惯性传感器的测量结果可以被建模为:
a ^ = a ‾ + B ( T ) + ϵ
在IMU 10的抽样模式中执行了多个周期的采集惯性传感器数据后,将会在处理模块18的存储装置38中存在m批次的惯性传感器数据。每一批次数据由(不同数量个)mk个温度抽样、惯性传感器测量结果、噪声统计以及时间戳构成。既然由于交通工具具有固定姿态并且在各个周期中没有振动故而对于各批次而言该惯性量将会是恒定的,因此各个单独模型被测量为;
a ^ m k = a ‾ m + b 0 + b 1 T m k + b 2 ( T m k ) 2 + . . . + b n ( T m k ) n + ϵ m k
例如,第二批次的第四个测量结果将会是:
a ^ 2 4 = a ‾ 2 + b 0 + b 1 T 2 4 + b 2 ( T 2 4 ) 2 + . . . + b n ( T 2 4 ) n + ϵ 2 4
并且与来自其他批次的测量值的惯性量的贡献一起正式撰写时:
a ^ 4 2 = ( 0 a ‾ 1 + a ‾ 2 + . . . + 0 a ‾ m ) + ( b 0 + b 1 T 2 4 + b 2 ( T 2 4 ) 2 + . . . + b n ( T 2 4 ) n ) + ϵ 2 4
由于所有的部分温度偏离曲线都将具有物理惯性量的分量(除了在假定陀螺仪测得0作为地球自转速率的情况除外),所以需要在特定温度下的偏离的绝对测量值或估计值以计算参数b0。这可以通过多个手段来实现,例如:
●初始工厂校准
●交通工具的一系列预定动作
●在加速和旋转的所有三个轴都可用的情况下,可以从至少6个不同的姿态中计算出各个传感器的偏离
●其他诸如GPS或多天线GPS的传感器
由于在这些实例中,已知特定温度下的偏离或者加速,因此存在满足以下公式的i个偏离测量结果:
( a ^ i - a ‾ i ) = b 0 + b 1 T i + b 2 ( T i ) 2 + . . . + b n ( T i ) n + ϵ i
在考虑到来自各批次的部分温度曲线的姿态的贡献以后:
( a ^ i - a ‾ ik ) = ( 0 a ‾ 1 + 0 a ‾ 2 + . . . + 0 a ‾ m ) + ( b 0 + b 1 T i + b 2 ( T i ) 2 + . . . + b n ( T i ) n ) + ϵ i
因此,这些批次的测量结果(包括绝对测量结果)形成一组线性公式:
a ^ 1 1 = ( a ‾ 1 + 0 a ‾ 2 + . . . + 0 a ‾ m ) + ( b 0 + b 1 T 1 1 + b 2 ( T 1 1 ) 2 + . . . + b n ( T 1 1 ) n ) + ϵ 1 1
a ^ 1 2 = ( a ‾ 1 + 0 a ‾ 2 + . . . + 0 a ‾ m ) + ( b 0 + b 1 T 1 2 + b 2 ( T 1 2 ) 2 + . . . + b n ( T 1 2 ) n ) + ϵ 1 2
a ^ 1 m = ( a ‾ 1 + 0 a ‾ 2 + . . . + 0 a ‾ m ) + ( b 0 + b 1 T 1 m + b 2 ( T 1 m ) 2 + . . . + b n ( T 1 m ) n ) + ϵ 1 m
a ^ 2 1 = ( 0 a ‾ 1 + a ‾ 2 + . . . + 0 a ‾ m ) + ( b 0 + b 1 T 2 1 + b 2 ( T 2 1 ) 2 + . . . + b n ( T 2 1 ) n ) + ϵ 2 1
a ^ 2 2 = ( 0 a ‾ 1 + a ‾ 2 + . . . + 0 a ‾ m ) + ( b 0 + b 1 T 2 2 + b 2 ( T 2 2 ) 2 + . . . + b n ( T 2 2 ) n ) + ϵ 2 2
a ^ 2 m = ( 0 a ‾ 1 + 0 a ‾ 2 + . . . + a ‾ m ) + ( b 0 + b 1 T 2 m + b 2 ( T 2 m ) 2 + . . . + b n ( T 2 m ) n ) + ϵ 2 m
a ^ k m = ( 0 a ‾ 1 + 0 a ‾ 2 + . . . + a ‾ m ) + ( b 0 + b 1 T k m + b 2 ( T k m ) 2 + . . . + b n ( T k m ) n ) + ϵ k m
( a ^ 1 - a ‾ i 1 ) = ( 0 a ‾ 1 + 0 a ‾ 2 + . . . + 0 a ‾ m ) + ( b 0 + b 1 T 1 + b 2 ( T 1 ) 2 + . . . + b n ( T 1 ) n ) + ϵ 1
( a ^ 2 - a ‾ i 2 ) = ( 0 a ‾ 1 + 0 a ‾ 2 + . . . + 0 a ‾ m ) + ( b 0 + b 1 T 2 + b 2 ( T 2 ) 2 + . . . + b n ( T 2 ) n ) + ϵ 2
( a ^ i - a ‾ i k ) = ( 0 a ‾ 1 + 0 a ‾ 2 + . . . + 0 a ‾ m ) + ( b 0 + b 1 T i + b 2 ( T i ) 2 + . . . + b n ( T i ) n ) + ϵ i
误差ε可以被描述为是具有协方差矩性∑的、零均值的、加性的、高斯白噪声。可以根据测量的阶段通过增大测量结果的协方差而将惯性传感器老化效应考虑在内。当使用加权的估计量时,将会对较以往的测量结果比较不重视,但是在缺少较新的测量结果的情况下仍旧会使用较以往的测量结果。例如,在交通工具在秋季遭受突然的寒冷天气事件的情况下,这将会很有用。在寒冷天气温度范围内的上一次数据采集可能在数月里都不会发生,但是即使其精度存在较大的不确定性,但该数据采集对于这样的情形仍旧是有价值的。
该组线性公式可以以矩性的形式表述为:
其可以更加简洁地被写为:Xβ=y
可以通过线性最小二乘法计算来得到β的估计值(并且此后称为各惯性传感器26的温度偏离曲线的多项式系数)。一旦该多项式系数得到确定,那么就可以在IMU10的测量模式中在热偏离误差模型中使用多项式系数以对惯性传感器26的热偏离进行补偿。
申请人认为,由于处理器和存储装置的功率需求会随着技术的进步而减小,所以低功率处理器30的功率可能会足够大,使得在抽样模式期间、在交通工具电池不出现显著的电力泄露的情况下,IMU 10所需的所有处理和数据存储都可以完全由抽样模块16来完成。因此,处理模块18将会是冗余的。
本发明的方法和IMU 10使得惯性传感器26可以在没有特定用户程序以及不需要增加其他传感器或周期性的工厂再校准的情况下进行有效的自校准。
现有技术中的专利所揭示的现场自动校准的一个缺点在于,在为了校准而进行惯性传感器的信号抽样时交通工具并不断开电源,使得交通工具受到来自其发动机和驾驶员的振动的影响。根据本发明的其中一个方案在工作设备不处于工作状态中并且其发动机因此被停止时从惯性传感器和关联的温度传感器采集数据。
到近来为止,惯性传感器和与其相关联的处理电路都需要非常大量的电力来操作。因此如果在交通工具被断开电源时操作惯性传感器和与其相关联的处理电路,则会存在交通工具的电池泄露的风险。传感器技术和嵌入式运算上的进步已经充分降低了功率需求以允许传感器子系统22在如以上参照附图所描述的交通工具停放并静止时能够工作。在抽样模式期间关闭处理模块(其具有相对较高的功率需求)并且在抽样模式期间仅选择性地对抽样模块(其具有相对较低的功率需求)加电使得IMU 10能够在交通工具电池不出现显著电力泄露的情况下工作。
提供上述对本发明的各种实施方式的描述目的在于向本领域中的普通技术人员进行描述。该描述并不是要进行穷举,或者是意在将本发明限制在单个公开的实施方式中。如上面所提到的,对于上述教导的领域的技术人员而言,对本发明进行多种替换和变形都是显而易见的。例如,虽然特定描述教导了针对交通工具使用IMU 10,但是IMU 10可以类似地用于诸如杆上(on-the-pole)GNSS测量设备、测量可移动工具相对交通工具的姿态(例如铲车的刮土铲相对于铲车的牵引器)的工具姿态应用、惯性导航系统(INS)或集成的GPS/INS导航系统以及机器人(特别是工业机器人)的使用惯性传感器的其他工作设备。因此,尽管已经具体地讨论了一些另选的实施方式,可是其他实施方式将会是显而易见的或者是由本领域技术人员相对容易地开发出来的。因此,本发明意在包括在本文中已经讨论过的根据本发明的所有替换、修改和变型、以及落入以上描述的发明的精神和范围中的其他实施方式。

Claims (13)

1.一种校准工作设备的惯性传感器的方法,该方法包括:
在所述工作设备不处于工作状态时,从一个或更多个惯性传感器和位置接近所述惯性传感器的一个或更多个温度传感器采集数据;以及
利用从所述惯性传感器和所述温度传感器采集的数据来更新所述惯性传感器的热偏离误差模型,
其中具有所述惯性传感器和所述温度传感器的传感器子系统被周期性地加电,以在所述工作设备不处于工作状态时采集所述数据。
2.根据权利要求1所述的方法,该方法包括:确定所述工作设备是否处于工作状态。
3.根据权利要求2所述的方法,其中所述工作设备是交通工具,并且确定所述交通工具是否处于工作状态包括:确定所述交通工具是否被接通电源。
4.根据权利要求2所述的方法,其中所述工作设备是交通工具,并且确定所述交通工具是否处于工作状态包括:确定所述交通工具的发动机是否处于工作状态。
5.根据权利要求2所述的方法,其中所述工作设备是测量设备,并且确定所述测量设备是否处于工作状态的所述步骤包括:确定所述测量设备是否被接通电源。
6.根据权利要求1所述的方法,该方法包括:确定在所述工作设备不处于工作状态时所述工作设备是否受到振动或移动的影响;以及放弃在所述工作设备受到振动或移动影响时采集的任何数据。
7.根据权利要求1所述的方法,该方法包括:通过将采集的数据拟合成曲线来更新所述热偏离误差模型和利用所述曲线的函数的特征来更新所述热偏离误差模型。
8.根据权利要求1所述的方法,其中更新所述热偏离误差模型包括:相对于在所述工作设备不处于工作状态时的以往周期中采集的以往数据来对在所述工作设备不处于工作状态时的一个周期中采集的数据进行加权并且向在最近的周期中采集的数据赋予更大的权重。
9.根据权利要求3或5所述的方法,其中在所述工作设备被断开电源后,将数据采集延迟预定时间。
10.一种惯性测量单元,包括:
传感器子系统,包括:
一个或更多个惯性传感器;
与所述惯性传感器相关联的一个或更多个温度传感器;以及
低功率抽样模块,其能够操作为从所述惯性传感器和所述温度传感器采集数据;
处理模块,其具有存储有所述惯性传感器的热偏离误差模型的存储器;以及
电源控制器,其被配置为在安装有所述惯性测量单元的工作设备不处于工作状态时选择性地对所述传感器子系统加电,以从所述惯性传感器和所述温度传感器采集数据。
11.根据权利要求10所述的惯性测量单元,该惯性测量单元包括计时器,所述计时器被所述电源控制器用于在所述工作设备不处于工作状态时周期性地对所述传感器子系统加电。
12.根据权利要求10所述的惯性测量单元,其中所述低功率抽样模块包括低功率处理器,并且所述处理模块包括具有比所述低功率处理器相对更高功率要求的主处理器。
13.根据权利要求10所述的惯性测量单元,其中该惯性测量单元适于在所述工作设备被断开电源后延迟预定时间再从所述惯性传感器和所述温度传感器采集数据。
CN201080028641.8A 2009-10-26 2010-10-21 惯性传感器的校准方法 Active CN102472632B (zh)

Applications Claiming Priority (3)

Application Number Priority Date Filing Date Title
AU2009905218A AU2009905218A0 (en) 2009-10-26 A method of calibrating inertial sensors
AU2009905218 2009-10-26
PCT/AU2010/001401 WO2011050395A1 (en) 2009-10-26 2010-10-21 A method of calibrating inertial sensors

Publications (2)

Publication Number Publication Date
CN102472632A CN102472632A (zh) 2012-05-23
CN102472632B true CN102472632B (zh) 2015-07-08

Family

ID=43921148

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201080028641.8A Active CN102472632B (zh) 2009-10-26 2010-10-21 惯性传感器的校准方法

Country Status (13)

Country Link
US (1) US9008988B2 (zh)
EP (1) EP2494312B1 (zh)
CN (1) CN102472632B (zh)
AR (1) AR078794A1 (zh)
AU (1) AU2010312307B2 (zh)
BR (1) BRPI1012099B1 (zh)
CA (1) CA2765095C (zh)
MX (1) MX2012003000A (zh)
NZ (1) NZ596007A (zh)
RU (1) RU2527140C2 (zh)
UA (1) UA106614C2 (zh)
WO (1) WO2011050395A1 (zh)
ZA (1) ZA201109248B (zh)

Families Citing this family (27)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US8731769B2 (en) * 2011-09-27 2014-05-20 Automotive Research & Testing Center Inertial sensor calibration method for vehicles and device therefor
CN102607542B (zh) * 2012-03-28 2014-12-10 昆明物理研究所 微机械陀螺自适应补偿的方法及装置
CN102721410B (zh) * 2012-06-20 2014-04-09 唐粮 一种基于gps/imu定位定向技术的海岛空中三角测量方法
US20140088906A1 (en) * 2012-09-25 2014-03-27 John M. Wilson Inertial Sensor Bias Estimation by Flipping
US9121866B2 (en) * 2013-03-15 2015-09-01 Autoliv Asp, Inc. System and method for inertial sensor offset compensation
US20150192440A1 (en) * 2014-01-07 2015-07-09 InvenSense, Incorporated Systems and Methods for Initiating Calibration of a Sensor
CN103808349B (zh) * 2014-02-17 2016-06-22 百度在线网络技术(北京)有限公司 矢量传感器的误差校正方法和装置
KR101551817B1 (ko) * 2014-05-22 2015-09-09 한국전자통신연구원 메모리 삭제 방법 및 이를 위한 장치
DE102014210767A1 (de) * 2014-06-05 2015-12-17 Continental Automotive Gmbh Verfahren zur Offsetkorrektur eines Sensorsignals eines Inertialsensors, insbesondere Beschleunigungs- und/oder Drehratensensors für ein Kraftfahrzeug
CN111506132B (zh) 2015-04-20 2022-04-05 深圳市大疆创新科技有限公司 用于对传感器操作进行热调节的系统和方法
CN105203129B (zh) * 2015-10-13 2019-05-07 上海华测导航技术股份有限公司 一种惯导装置初始对准方法
US10173691B2 (en) * 2016-11-18 2019-01-08 Ford Global Technologies, Llc Vehicle sensor calibration using wireless network-connected sensors
US11119112B2 (en) 2017-08-02 2021-09-14 Samsung Electronics Co., Ltd. Method for compensating gyroscope drift on an electronic device
EP3447445A1 (en) * 2017-08-21 2019-02-27 Tata Consultancy Services Limited Systems and methods for estimating errors in gyroscope sensors
CN108226980B (zh) * 2017-12-23 2022-02-08 北京卫星信息工程研究所 基于惯性测量单元的差分gnss与ins自适应紧耦合导航方法
JP2021056003A (ja) * 2018-02-07 2021-04-08 アルプスアルパイン株式会社 計測装置、球体、計測システム、制御方法、およびプログラム
US20220011137A1 (en) * 2018-10-04 2022-01-13 Sony Corporation Information processing apparatus, information processing method, and program
US11680823B2 (en) * 2019-08-01 2023-06-20 IvenSense, Inc. Method and system for mobile sensor calibration
CN110987002B (zh) * 2019-11-25 2022-02-01 中国工程物理研究院电子工程研究所 惯导数据优化方法、训练方法、模型、设备及存储介质
RU2751143C1 (ru) * 2020-07-29 2021-07-08 федеральное государственное автономное образовательное учреждение высшего образования "Северо-Кавказский федеральный университет" Способ автоматизации калибровки датчиков бесплатформенной инерциальной системы роботизированного беспилотного летательного аппарата
EP3957953A1 (en) * 2020-08-19 2022-02-23 Aptiv Technologies Limited System and method for self-test of inertial measurement unit (imu)
CN112254742B (zh) * 2020-10-13 2022-08-09 天津津航计算技术研究所 Mems惯性器件温度补偿参数在线拟合方法
CN112611482A (zh) * 2020-11-24 2021-04-06 甄十信息科技(上海)有限公司 一种校准智能设备的温度传感器的方法
CN112815980A (zh) * 2020-12-31 2021-05-18 天通盛邦通信科技(苏州)有限公司 一种动中收传感器自动校准方法
US11808780B1 (en) * 2022-05-20 2023-11-07 Honeywell International Inc. Inertial sensor error modeling and compensation, and system for lifetime inertial sensor calibration and navigation enhancement
US11951962B1 (en) * 2022-12-07 2024-04-09 Alstom Holdings Acceleration detection system for a vehicle and vehicle including a brake monitoring unit with acceleration detection system
CN117073728B (zh) * 2023-10-17 2024-01-23 天津易泰炬业科技有限公司 一种柔性电容式触觉传感器

Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US5297028A (en) * 1991-08-27 1994-03-22 Zexel Corporation Daihatsu-Nissan Method and apparatus for correcting drift errors in an angular rate sensor
US5527003A (en) * 1994-07-27 1996-06-18 Litton Systems, Inc. Method for in-field updating of the gyro thermal calibration of an intertial navigation system
CN1233706A (zh) * 1998-04-24 1999-11-03 英科有限公司 适合于制作隧道平面图应用的自动导向装置
CN101156045A (zh) * 2005-04-11 2008-04-02 高级惯性测量系统瑞典股份公司 用于车辆的控制系统

Family Cites Families (17)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US4286683A (en) * 1979-08-20 1981-09-01 Zemco, Inc. Stop/start control system for engine
US4693114A (en) 1986-05-05 1987-09-15 Allied Corporation Gyrocompass navigation system for land vehicles
RU2083954C1 (ru) 1988-01-04 1997-07-10 Катюнин Валентин Владимирович Инерциальная навигационная система
JPH0918224A (ja) 1995-06-27 1997-01-17 Matsushita Electric Works Ltd Bs追尾アンテナシステム
DE19828944C1 (de) * 1998-06-29 2000-03-30 Siemens Ag Verfahren zum Kalibrieren eines Winkelsensors und Navigationssystem mit Winkelsensor
US6175807B1 (en) * 1999-06-09 2001-01-16 Litton Systems, Inc. Temperature compensation method for strapdown inertial navigation systems
DE10017278A1 (de) * 2000-04-06 2001-10-11 Bosch Gmbh Robert Verfahren zum Kalibrieren eines abhängig von einem Sensor arbeitenden Systems in einem Kraftfahrzeug
US6577952B2 (en) * 2001-01-08 2003-06-10 Motorola, Inc. Position and heading error-correction method and apparatus for vehicle navigation systems
EP1310770B1 (en) * 2001-11-13 2009-09-09 Nokia Corporation Method, device and system for calibrating angular rate measurement sensors
RU2249793C2 (ru) * 2002-08-06 2005-04-10 Открытое акционерное общество Пермская научно-производственная приборостроительная компания Способ калибровки акселерометров
US8239162B2 (en) * 2006-04-13 2012-08-07 Tanenhaus & Associates, Inc. Miniaturized inertial measurement unit and associated methods
JP2007024601A (ja) 2005-07-13 2007-02-01 Xanavi Informatics Corp 車両用角速度測定装置
DE102006041289A1 (de) * 2005-09-02 2007-04-05 Continental Teves Ag & Co. Ohg Verfahren zur Kalibrierung eines Sensors, insbesondere eines Gierratensensors
US7505364B2 (en) 2006-06-22 2009-03-17 Northrop Grumman Corporation Underwater navigation by aided light sensor
RU61789U1 (ru) 2006-11-09 2007-03-10 Общество с ограниченной ответственностью "ТехГеоБур" Инклинометр
US8718938B2 (en) * 2007-03-23 2014-05-06 Qualcomm Incorporated Multi-sensor data collection and/or processing
RU2362173C1 (ru) 2008-03-21 2009-07-20 Государственное образовательное учреждение высшего профессионального образования "Военно-космическая академия имени А.Ф. Можайского" Способ измерения линейного ускорения в системах управления ракет и устройство для его осуществления

Patent Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US5297028A (en) * 1991-08-27 1994-03-22 Zexel Corporation Daihatsu-Nissan Method and apparatus for correcting drift errors in an angular rate sensor
US5527003A (en) * 1994-07-27 1996-06-18 Litton Systems, Inc. Method for in-field updating of the gyro thermal calibration of an intertial navigation system
CN1233706A (zh) * 1998-04-24 1999-11-03 英科有限公司 适合于制作隧道平面图应用的自动导向装置
CN101156045A (zh) * 2005-04-11 2008-04-02 高级惯性测量系统瑞典股份公司 用于车辆的控制系统

Also Published As

Publication number Publication date
EP2494312B1 (en) 2020-04-08
ZA201109248B (en) 2015-05-27
BRPI1012099A2 (pt) 2018-03-13
US9008988B2 (en) 2015-04-14
NZ596007A (en) 2013-11-29
WO2011050395A1 (en) 2011-05-05
RU2527140C2 (ru) 2014-08-27
CN102472632A (zh) 2012-05-23
CA2765095C (en) 2017-02-07
AU2010312307B2 (en) 2013-07-11
CA2765095A1 (en) 2011-05-05
MX2012003000A (es) 2012-04-19
US20120203488A1 (en) 2012-08-09
AR078794A1 (es) 2011-12-07
BRPI1012099B1 (pt) 2019-10-08
RU2011142833A (ru) 2013-12-10
EP2494312A1 (en) 2012-09-05
UA106614C2 (uk) 2014-09-25
AU2010312307A1 (en) 2011-11-17
EP2494312A4 (en) 2014-03-26

Similar Documents

Publication Publication Date Title
CN102472632B (zh) 惯性传感器的校准方法
EP1941236B1 (en) Systems and methods for reducing vibration-induced errors in inertial sensors
US20140372063A1 (en) Quick calibration method for inertial measurement unit
AU2012307067B2 (en) Method of recalibrating inertial sensors
Redmill et al. DGPS/INS integrated positioning for control of automated vehicle
Akeila et al. Reducing low-cost INS error accumulation in distance estimation using self-resetting
AU2012307069A1 (en) A method and system of recalibrating an inertial sensor
Fontanella et al. An extensive analysis for the use of back propagation neural networks to perform the calibration of MEMS gyro bias thermal drift
Amirsadri et al. Practical considerations in precise calibration of a low-cost MEMS IMU for road-mapping applications
EP3350604B1 (en) High-performance inertial measurements using a redundant array of inexpensive inertial sensors
RU2661446C1 (ru) Способ определения навигационных параметров объекта и бесплатформенная инерциальная навигационная система для осуществления способа
Setlak et al. MEMS electromechanical microsystem as a support system for the position determining process with the use of the inertial navigation system INS and kalman filter
AU2012307068A1 (en) A method and system of recalibrating an inertial sensor
Bakirci et al. Improving position-time trajectory accuracy in vehicle stop-and-go scenarios by using a mobile robot as a testbed
Väljaots et al. Uncertainty in ground vehicle dynamics measurement system
Rudyk et al. Research and simulation of the local navigation system of terrestrial mobile robot
Seçer Deterministic and stochastic error modeling of inertial sensors and magnetometers
GOUGEON et al. 2D Navigation with a Differential Wheeled Unmann ed Ground Vehicle*
CN114577234A (zh) 卫星相对姿态基准误差分析方法和系统、装置
Johnson Investigating inertial measurement for human-scale motion tracking
Conner et al. Improved dead reckoning using caster wheel sensing on a differentially steered three-wheeled autonomous vehicle
Riewe Low-cost multiple sensor inertial measurement product for locomotive navigation
Salvini Direct tuning of inertia sensors of a navigation system using the neural network approach
Akeila Positioning In Indoor Environments Based on INS and RF Sensor Fusion

Legal Events

Date Code Title Description
C06 Publication
PB01 Publication
C10 Entry into substantive examination
SE01 Entry into force of request for substantive examination
C14 Grant of patent or utility model
GR01 Patent grant