CN107084743A - 利用gnss/ins数据的六自由度惯性测量单元的偏移和失准补偿 - Google Patents
利用gnss/ins数据的六自由度惯性测量单元的偏移和失准补偿 Download PDFInfo
- Publication number
- CN107084743A CN107084743A CN201710071722.XA CN201710071722A CN107084743A CN 107084743 A CN107084743 A CN 107084743A CN 201710071722 A CN201710071722 A CN 201710071722A CN 107084743 A CN107084743 A CN 107084743A
- Authority
- CN
- China
- Prior art keywords
- mrow
- msup
- mtd
- msubsup
- speed
- 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
Links
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S19/00—Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
- G01S19/38—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system
- G01S19/39—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system the satellite radio beacon positioning system transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
- G01S19/42—Determining position
- G01S19/45—Determining position by combining measurements of signals from the satellite radio beacon positioning system with a supplementary measurement
- G01S19/47—Determining position by combining measurements of signals from the satellite radio beacon positioning system with a supplementary measurement the supplementary measurement being an inertial measurement, e.g. tightly coupled inertial
-
- 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
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/10—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
- G01C21/12—Navigation; 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
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/10—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
- G01C21/12—Navigation; 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/16—Navigation; 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/165—Navigation; 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 combined with non-inertial navigation instruments
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/10—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
- G01C21/12—Navigation; 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/16—Navigation; 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/183—Compensation of inertial measurements, e.g. for temperature effects
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S19/00—Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
- G01S19/38—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system
- G01S19/39—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system the satellite radio beacon positioning system transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
- G01S19/53—Determining attitude
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Computer Networks & Wireless Communication (AREA)
- Manufacturing & Machinery (AREA)
- Navigation (AREA)
Abstract
一种用于校正来自安装至车辆的六自由度IMU的角速度和加速度输出中的偏移和角度失准误差的***和方法。该方法包括:从例如GNSS/INS提供惯性框架中的速度和评估姿态数据,以及利用该速度和姿态数据来确定车辆框架中的理想的加速度评估和理想的速度评估。然后,该方法利用该理想的加速度和速度评估以及来自IMU的IMU主体框架中的角速度和加速度输出来确定IMU偏移误差和失准误差。
Description
发明背景
技术领域
本发明总体涉及用于确定六自由度(DOF)惯性测量单元(IMU)的输出的偏移和失准误差的***和方法,且更具体地涉及用于利用来自全球导航卫星***(GNSS)和/或惯性导航***(INS)的速度和姿态数据来确定车辆上六自由度(6-DOF)IMU的输出的偏移和失准误差的***和方法,其中,该方法包括利用速度和姿态来确定车辆框架中的理想加速度评估和理想角速度评估,以及利用理想加速度和角速度以及测得的来自IMU的角速度和加速度输出来确定IMU的偏移误差和失准误差。
背景技术
现代车辆的操作正变得更加自动化,即车辆能够提供需要更少驾驶员介入的驾驶控制。在车辆上使用巡航控制***已经多年,其中,车辆操作员可以设置一特定的车辆速度,且车辆将维持该速度而无需驾驶员对油门进行操作。在本领域中,最近已经开发了自适应巡航控制***,其中,该***不仅维持设定速度,而且还将自动地减缓车辆(在利用各种传感器(例如雷达和相机)来检测到在前车辆移动移动的情况下)。某些现代车辆还提供自动泊车,其中,车辆将自动地提供用于泊车的转向控制。一些车辆***提供无需驾驶员介入的自动制动,以避免后端碰撞。随着车辆***的改进,它们将变得更自动,其目标是成为完全自动驾驶车辆。例如,未来车辆很可能将采用用于换道、让车、转离交通、转向交通等的自动***。
车辆上各种主动安全控制***、驾驶员辅助***和自动驾驶操作,例如提供电子稳定控制(ECS)、自适应巡航控制(ACC)、车道保持(LK)、车道改变(LC)等,需要用于评估各种车辆动力学的高鲁棒性和精确性的模块。这种模块有必要提供获知车辆位置和速度以控制车辆。
以上所述的用于***的主动安全性控制以及其它控制依赖于用于实现适当性能的精确的车辆速度评估。目前,提出的这些类型的***依赖于车轮速度传感器和其它车辆运动输入,以提供车辆速度评估。然而,有时,确定车辆速度的传感器和控制模块失效或操作不当,在该情况下,车辆速度的损失可是严重的。在初级评估处理器失效的情况下,某些自动安全性需求(例如ASIL-D)需要多余的车辆速度评估过程。例如,针对那些需要主动控制的***,需要控制***在失效事件发生之后5秒之内来提供精确的速度评估,以便给驾驶员时间来控制车辆。
本领域已知可在车辆上提供六自由度(6-DOF)IMU,其提供6个测量变化率,具体地,为车辆滚动、俯仰和偏转的角速度测量,以及纵向加速度、横向加速度和向上/向下加速度的角速度测量。在车辆上提供的典型的IMU将包括三个提供角速度测量的陀螺仪以及三个提供加速度测量的加速计。
本领域中已经提出利用来自车辆上IMU的角速度和加速度测量来提供能够被车辆使用用于实现车辆速度评估的信号。2015年4月7日提出申请的、标题为通过六自由度IMU、GPS和雷达的数据融合实现的故障后可操作的车辆速度评估的美国专利申请系列号No.14/680,894,公开了用于提供多余车辆速度评估的***和方法,其可确定一个或多个提供车辆速度的初级传感器是否已经失效,且倘若如此,则在次级模块中利用缓存的车辆速度值以及来自IMU的惯性测量信号来评估车辆速度。该方法还利用GPS信号数据和/或由来自静止物体的距离传感器(倘若它们是可用的)提供的速度数据来改进评估的车辆速度。
在'894申请中讨论的过程中,次级车辆速度评估的精确度很大地依赖于IMU加速度和角速度测量的精确度。然而,为此,由车辆上的IMU提供的角速度和角速度的测量由于一些误差源而通常偏离实际的加速度和角速度值。IMU测量中的两个主要误差源为加速计和陀螺仪偏移部件以及相应于将IMU安装至车辆的框架失准。每个轴上都有一偏移项,其相应于6个偏移误差项(除了3个失准误差之外)。尽管期望将IMU与车辆框架完美地对齐,但是仍有安装误差,即使它们很小,在计算中它们可提供显著的失准误差。另外,在车辆的制造过程中,通过移动车辆以及识别误差可以改进偏移和失准误差。然而,也很难精确地获取这种偏移和失准误差校正。另外,在车辆的制造阶段过程中,这些偏移和失准误差校正经常需要特殊的车辆操纵,且另外,由于不同的道路、车辆和环境状况,偏移项并不固定且可及时地改变。
发明内容
本公开描述了一种用于校正来自安装至车辆的六自由度IMU的角速度和加速度输出中的偏移和角度失准误差的***和方法。该方法包括:从例如GNSS/INS提供惯性框架中的精确的速度和评估姿态数据,以及利用该速度和姿态数据来确定车辆框架中的理想的加速度评估和理想的速度评估。然后,该方法利用理想的加速度和速度评估以及来自IMU的IMU主体框架中的角速度和加速度输出来确定IMU偏移误差和失准误差。
从以下的说明和所附权利要求并结合附图,本发明的附加的特征将变得显而易见。
附图说明
图1是车辆的等比示意图,其示出了车辆基准框架和IMU主体框架;
图2是IMU误差评估***的方框图;以及
图3是示出了用于提供IMU误差评估的过程的流程图。
具体实施方式
以下本发明的实施例的讨论涉及一种用于识别车辆上六自由度IMU中的IMU偏移和失准误差的***和方法,其在本质上仅仅是示例性的,且决不以任何方式意于限制本发明或它的应用或使用。例如,该***和方法针对次级车辆速度评估有特定的应用。然而,如本领域技术人员将理解的,该***和方法可具有其它应用并可用于其它移动平台,例如,在火车、机器、拖拉机、轮船、露营车辆上等。
图1为车辆10的等比示意图,该车辆包括GNSS/INS单元12,其以已知的方式提供精确的车辆速度和姿态数据(包括滚动、偏转和俯仰角度)。另外,车辆10包括传感器14,该传感器旨在表示车轮速度传感器、方向盘角度传感器、偏转率传感器、纵向和横向加速度传感器等(如本文讨论所需)中的一个或多个。车辆10还包括六自由度IMU 16,其提供如本文还讨论的加速度和角速度测量。如上所述,IMU 16为包括3个加速计和3个陀螺仪的已知设备。例如,在'894申请中,当车辆速度测量数据不可用时,可采用来自IMU 16的测量以提供所讨论的车辆速度评估。
本文的讨论将涉及包括惯性框架(N-框架)的三坐标框架,其为位于地面上的固定参考框架,其中,X-轴朝向东,Y-轴朝向北,且Z-轴朝向上。如图1所示,车辆框架20(V-框架)为位于车辆10的重心处的主体固定框架,且X-轴朝向前,Y轴朝向左,且Z-轴朝向上。主体框架22(b-框架)为IMU 16的中心处的主体固定框架,且其中X-Y-Z轴与IMU 16中的加速计和陀螺仪的X-Y-Z轴相对齐。IMU误差包括每个加速计和陀螺仪沿着主体框架22的X-Y-Z轴的6个偏移分量,以及对应于主体框架22与车辆框架20之间的旋转角度的3个失准角度。主体框架22的每个轴线有两个偏移项,具体地,为一个加速度偏移和一个角速度偏移。
图2为***30的方框图,其采用了IMU误差评估模型以校正以上所述的偏移和失准误差。***30包括IMU误差评估模块32和状态评估模块34,该IMU误差评估模块评估IMU偏移和失准误差,该状态评估模块校正来自IMU 16的偏转测量并在速度和姿态评估模块中利用它们(偏转测量)。在误差评估模块32中,例如,在方框36处利用GNSS/INS数据来提供精确的车辆速度和姿态。利用来自方框36的车辆速度和姿态数据,模块32在方框38处确定车辆框架20的理想的加速度和角速度。
以下讨论详细说明了怎样确定理想的加速度和角速度。以下等式限定了车辆框架20中的速度和角速度。
其中,是车辆框架20中的车辆速度的时间导数,gn=[0,0,-9.80665]t是惯性框架中的重力加速度矢量,fv是车辆框架20中的加速度矢量,且是从惯性框架到车辆框架20的变换矩阵,其对应于滚动φ、俯仰θ和偏转ψ的欧拉角度旋转,其中:
且其中,Ωv=[ωvX]是IMU的车辆角速度ωv的反对称矩阵:
假定从GNSS/INS数据可以已知车辆速度Vv和滚动角度φ,俯仰角度θ和偏转角度ψ,通过利用等式(1),车辆框架20中的理想的IMU加速度矢量fv和角速度测量Ωv可如下得到:
其中,利用速度数据的数值导数来获取以及利用等式(3)来获取如下:
其中,和被数值计算。
来自方框38的理想的IMU加速度矢量fv和理想的角速度Ωv被传送至IMU偏移和失准评估方框40,其将理想的加速度矢量fv和理想的角速度Ωv评估值与主体框架22中的角速度ωb(来自在方框42处提供的IMU 16中的陀螺仪)和主体框架22中的加速度值fb(来自在方框44处提供的IMU16中的加速计)进行比较,以计算偏移和失准评估误差。只要GNSS/INS数据提供精确的信息以在方框36处确定车辆速度和姿态,在方框40处就可精确地获得主体框架22的X-Y-Z轴上的每个加速计的偏移和失准误差以及3个失准角度误差。
为了计算偏移和失准评估误差,获取理想的测量与实际的测量之间的关系。在等式(5)中的IMU测量为理想的测量,在某种意义上,它们不包括任何IMU误差。将偏移和失准视为两种显著的误差,理想的值和实际的IMU测量的关系如下所示:
其中,fb和ωb是主体框架22中的实际的IMU测量,f偏移和ω偏移】分别是加速计和陀螺仪的偏移矢量,且是从车辆框架20到主体框架22的变换矩阵,其对应于IMU失准角度,如下:
其中,α、β和γ分别是关于X轴、Y轴和Z轴的失准欧拉角度。
等式(8)和(9)包括具有9个未知数的6个等式。为了获得等式的唯一解,与不同时间点的加速度测量有关的3个等式是必要的。
在方框40处,在以下两种情况下,利用理想的在两个不同的时间点的加速度测量来首次获取3个失准角度α、β和γ。第一种情况下,纵向加速度变化,而横向和竖向加速度恒定。在该情况下,为了在时间t1和t2处的IMU 16的理想的加速度测量,满足以下条件:
假定偏移项在时间t1和t2处保持恒定,且利用等式(8)-(13),可得实际的IMU测量在时间t1和t2处的差异如下:
其中,Δf=f(t2)-f(t1),且其中,在车辆框架20中的恒定的横向和竖向加速度项以及偏移项通过相减被消除。
在((α,β,γ)=(0,0,0,)附近对等式(14)进行线性化,得出:
得出:
倘若β≠0或γ≠0,则通过将等式(16)和(17)代入等式(14)可获得失准角度α,如下:
其中:
第二种情况下,纵向和竖向加速度变化,而横向加速度恒定。在这情况下,以下条件被提供。
假定偏移项在时间t1和t2处保持恒定,且利用等式(8)、(9)、(21)、(22)和(23),可得实际的IMU测量在时间t1和t2处的差异如下:
其中,在车辆框架20中的恒定横向加速度项以及偏移项通过相减被消除。
在(α,β,γ)=(0,0,0,)附近对等式(24)进行线性化,得出:
从等式(25)可获得失准角度β如下:
倘若从先前的时间可获得失准角度γ的评估,则:
为了实现失准评估算法,在等式(5)和(6)中的理想的IMU测量在模块32中被缓冲持续一段较短的时间(例如,1秒)。时间t2被设置成等于当前时间,且通过检索缓冲数据来确定时间t1,其满足在第一种情况或第二种情况下的条件。由于失准角度是恒定的,它们随着在每个时刻的当前值与先前值的平均而被更新。
一旦失准角度α,β和γ被计算出,利用等式(8)、(9)和(10)可获得用于加速计和陀螺仪的偏移分量,如下:
图3是流程图60,其示出了如以上所讨论的用于在方框38和40处用于提供IMU误差评估计算的过程。在方框62处,来自GNSS/INS的数据进行滚动φ、俯仰θ和偏转ψ的车辆姿态测量,到方框64处,将来自惯性框架的车辆姿态测量变换至车辆框架20,以获取如由等式(2)和(3)提供的变换矩阵和然后变换矩阵和被传送至方框66,以提供车辆框架20中的补偿速度,其包括角速度ωv以及由等式(5)提供的反对称矩阵Ωv。在方框68处提供来自GNSS/INS数据的车辆速度和加速度值Vv和且在方框70处利用来自方框66的由等式(5)提供的反对称矩阵Ωv对车辆框架20中的加速度进行补偿,以获取测得的由等式(6)提供的在车辆框架20中的加速度向量fv。算法利用来自方框70的向量fv以及来自方框74的IMU加速度测量值fb来计算失准角度α,β和γ(或者在第一种情况下利用等式(16)、(17)和(18),或在第二种情况下利用等式(26)和(27))。算法产生变换矩阵用于在方框76处利用等式(10)来实现从车辆框架20到主体框架22的变换。然后,变换矩阵以及来自在方框80处的IMU 16的主体框架22中的角速度ωb和来自方框74的主体框架22中的加速度fb被提供至方框78,以利用等式(28)和(29)来产生偏移分量f偏移和ω偏移,其中,从等式(16)、(17)和(18)或等式(26)和(27),以及等式(28)和(29)获得的结果给出了9个值。
识别来自方框40的偏移和失准误差的9个值被提供至模块34,以使得倘若GNSS/INS数据在任何特定时间点不可用时,则先前计算出的误差可被用于识别车辆速度和姿态(在这些值是需要的但车辆速度传感器失效的情况下)。因此,如在'894申请中,倘若需要IMU数据来评估车辆速度,则那些值在被用于那些计算之前先被针对误差进行调整。来自方框40的误差以及方框48处的IMU角速度ωb和方框50处的IMU加速度值fb被应用至在模块34中的IMU偏移和失准补偿方框46,以如下被校正。
一旦在方框46处校正IMU角速度和加速度值,那些校正后的值在方框52处就可被用于确定例如如在'894申请中所述的车辆速度和姿态。
如本领域技术人员将很好地理解,本文所讨论的用于描述本发明的一些或各种步骤和过程可以指代由计算机、处理器或其它电子计算装置(利用电现象来操作和/或变换数据)执行的操作。那些计算机和电子装置可采用各种易失性和/或非易失性存储器,包括具有在其上储存的可执行程序(包括可由计算机或处理器执行的各种代码或可执行指令)的非暂时性计算机可读介质,其中,存储器和/或计算机可读介质可包括所有形式和类型的存储器和其它计算机可读介质。
以上讨论仅仅公开并描述了本发明的示例性实施例。从这种讨论以及从附图和权利要求,本领域技术人员将容易地认识到,在不脱离由以下权利要求限定的本发明的精神和范围的情况下,可以在其中作出各种改变、修改和变体。
Claims (10)
1.一种用于校正来自六自由度(DOF)惯性测量单元(IMU)的角速度和加速度输出中的偏移和角度失准误差的方法,所述IMU被安装在平台上,所述方法包括:
提供位于惯性框架中的速度和评估姿态数据;
利用所述速度和姿态数据来确定位于平台框架中的理想的加速度评估和理想的速度评估;以及
利用所述理想的加速度和速度评估以及来自所述IMU的角速度和加速度输出来确定IMU偏移误差和失准误差。
2.根据权利要求1所述的方法,其中,提供速度和姿态数据包括提供来自全球导航卫星***(GNSS)和/或惯性导航***(INS)的速度和姿态数据。
3.根据权利要求1所述的方法,其中,确定理想的加速度评估和理想的速度评估包括将位于所述惯性框架中的所述平台的速度、滚动角度、俯仰角度和偏转角度转换至所述平台框架中。
4.根据权利要求3所述的方法,其中,转换速度和滚动、俯仰和偏转包括利用以下等式:
<mrow>
<msup>
<mover>
<mi>V</mi>
<mo>&CenterDot;</mo>
</mover>
<mi>v</mi>
</msup>
<mo>=</mo>
<mo>-</mo>
<msup>
<mi>&Omega;</mi>
<mi>v</mi>
</msup>
<msup>
<mi>V</mi>
<mi>v</mi>
</msup>
<mo>+</mo>
<msubsup>
<mi>R</mi>
<mi>n</mi>
<mi>v</mi>
</msubsup>
<msup>
<mn>9</mn>
<mi>n</mi>
</msup>
<mo>+</mo>
<msup>
<mi>f</mi>
<mi>v</mi>
</msup>
</mrow>
<mrow>
<msubsup>
<mover>
<mi>R</mi>
<mo>&CenterDot;</mo>
</mover>
<mi>n</mi>
<mi>v</mi>
</msubsup>
<mo>=</mo>
<mo>-</mo>
<msup>
<mi>&Omega;</mi>
<mi>v</mi>
</msup>
<msubsup>
<mi>R</mi>
<mi>n</mi>
<mi>v</mi>
</msubsup>
</mrow>
其中,是所述平台框架中的速度的时间导数,gn=[0,0,-9.80665]t是所述惯性框架中的重力加速度矢量,fv是所述平台框架中的加速度矢量,且是从所述惯性框架到所述平台框架的变换矩阵,其对应于滚动φ、俯仰θ和偏转ψ的角度旋转,其中:
<mrow>
<msubsup>
<mi>R</mi>
<mi>n</mi>
<mi>v</mi>
</msubsup>
<mo>=</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mrow>
<mi>cos</mi>
<mi>&theta;</mi>
<mi>cos</mi>
<mi>&psi;</mi>
</mrow>
</mtd>
<mtd>
<mrow>
<mi>cos</mi>
<mi>&theta;</mi>
<mi>sin</mi>
<mi>&psi;</mi>
</mrow>
</mtd>
<mtd>
<mrow>
<mo>-</mo>
<mi>sin</mi>
<mi>&theta;</mi>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mi>cos</mi>
<mi>&psi;</mi>
<mi>sin</mi>
<mi>&phi;</mi>
<mi>sin</mi>
<mi>&theta;</mi>
<mo>-</mo>
<mi>cos</mi>
<mi>&phi;</mi>
<mi>sin</mi>
<mi>&psi;</mi>
</mrow>
</mtd>
<mtd>
<mrow>
<mi>sin</mi>
<mi>&phi;</mi>
<mi>sin</mi>
<mi>&theta;</mi>
<mi>sin</mi>
<mi>&psi;</mi>
<mo>+</mo>
<mi>cos</mi>
<mi>&phi;</mi>
<mi>cos</mi>
<mi>&psi;</mi>
</mrow>
</mtd>
<mtd>
<mrow>
<mi>cos</mi>
<mi>&theta;</mi>
<mi>sin</mi>
<mi>&phi;</mi>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mi>cos</mi>
<mi>&psi;</mi>
<mi>cos</mi>
<mi>&phi;</mi>
<mi>cos</mi>
<mi>&theta;</mi>
<mo>+</mo>
<mi>sin</mi>
<mi>&phi;</mi>
<mi>sin</mi>
<mi>&psi;</mi>
</mrow>
</mtd>
<mtd>
<mrow>
<mi>cos</mi>
<mi>&phi;</mi>
<mi>sin</mi>
<mi>&theta;</mi>
<mi>sin</mi>
<mi>&psi;</mi>
<mo>-</mo>
<mi>sin</mi>
<mi>&phi;</mi>
<mi>cos</mi>
<mi>&psi;</mi>
</mrow>
</mtd>
<mtd>
<mrow>
<mi>cos</mi>
<mi>&theta;</mi>
<mi>cos</mi>
<mi>&phi;</mi>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
</mrow>
且其中,Ωv=[ωvx]是所述IMU角速度输出的反对称矩阵,如下:
<mrow>
<msup>
<mi>&Omega;</mi>
<mi>v</mi>
</msup>
<mo>=</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mrow>
<mo>-</mo>
<msub>
<mi>&omega;</mi>
<mi>&psi;</mi>
</msub>
</mrow>
</mtd>
<mtd>
<msub>
<mi>&omega;</mi>
<mi>&theta;</mi>
</msub>
</mtd>
</mtr>
<mtr>
<mtd>
<msub>
<mi>&omega;</mi>
<mi>&psi;</mi>
</msub>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mrow>
<mo>-</mo>
<msub>
<mi>&omega;</mi>
<mi>&phi;</mi>
</msub>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mo>-</mo>
<msub>
<mi>&omega;</mi>
<mi>&theta;</mi>
</msub>
</mrow>
</mtd>
<mtd>
<msub>
<mi>&omega;</mi>
<mi>&phi;</mi>
</msub>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
</mtable>
</mfenced>
</mrow>
<mrow>
<msup>
<mi>&Omega;</mi>
<mi>v</mi>
</msup>
<mo>=</mo>
<mo>-</mo>
<msubsup>
<mover>
<mi>R</mi>
<mo>&CenterDot;</mo>
</mover>
<mi>n</mi>
<mi>v</mi>
</msubsup>
<msup>
<mrow>
<mo>(</mo>
<msubsup>
<mi>R</mi>
<mi>n</mi>
<mi>v</mi>
</msubsup>
<mo>)</mo>
</mrow>
<mi>T</mi>
</msup>
</mrow>
<mrow>
<msup>
<mi>f</mi>
<mi>v</mi>
</msup>
<mo>=</mo>
<msup>
<mover>
<mi>V</mi>
<mo>&CenterDot;</mo>
</mover>
<mi>v</mi>
</msup>
<mo>+</mo>
<msup>
<mi>&Omega;</mi>
<mi>v</mi>
</msup>
<msup>
<mi>V</mi>
<mi>v</mi>
</msup>
<mo>-</mo>
<msubsup>
<mi>R</mi>
<mi>n</mi>
<mi>v</mi>
</msubsup>
<msup>
<mi>g</mi>
<mi>n</mi>
</msup>
</mrow>
其中,ω为角速度,利用所述速度数据的数值导数来获取以及如下获得:
<mrow>
<msubsup>
<mover>
<mi>R</mi>
<mo>&CenterDot;</mo>
</mover>
<mi>n</mi>
<mi>v</mi>
</msubsup>
<mo>=</mo>
<mfrac>
<mrow>
<mo>&part;</mo>
<msubsup>
<mi>R</mi>
<mi>n</mi>
<mi>v</mi>
</msubsup>
</mrow>
<mi>&phi;</mi>
</mfrac>
<mover>
<mi>&phi;</mi>
<mo>&CenterDot;</mo>
</mover>
<mo>+</mo>
<mfrac>
<mrow>
<mo>&part;</mo>
<msubsup>
<mi>R</mi>
<mi>n</mi>
<mi>v</mi>
</msubsup>
</mrow>
<mi>&theta;</mi>
</mfrac>
<mover>
<mi>&theta;</mi>
<mo>&CenterDot;</mo>
</mover>
<mo>+</mo>
<mfrac>
<mrow>
<mo>&part;</mo>
<msubsup>
<mi>R</mi>
<mi>n</mi>
<mi>v</mi>
</msubsup>
</mrow>
<mi>&psi;</mi>
</mfrac>
<mover>
<mi>&psi;</mi>
<mo>&CenterDot;</mo>
</mover>
</mrow>
其中,和被数值计算。
5.根据权利要求1所述的方法,其中,确定IMU偏移误差和失准误差包括将所述理想的加速度评估和所述理想的速度评估与来自所述IMU的所述角速度和加速度输出进行比较。
6.根据权利要求5所述的方法,其中,比较所述理想的加速度评估和所述理想的速度评估包括将来自所述平台框架的所述加速度和角速度评估转换至IMU主体框架。
7.根据权利要求6所述的方法,其中,确定所述IMU偏移误差和失准误差包括利用在两个不同采样时间处的理想的加速度评估来识别三个失准角度。
8.根据权利要求7所述的方法,其中,确定所述失准角度包括改变所述平台的纵向加速度,但横向和竖向加速度保持恒定。
9.根据权利要求7所述的方法,其中,确定所述失准角度包括改变所述平台的所述纵向和竖向加速度,但横向加速度保持恒定。
10.根据权利要求7所述的方法,其中,确定所述IMU偏移误差和失准误差包括使用等式:
<mrow>
<msub>
<mi>f</mi>
<mrow>
<mi>b</mi>
<mi>i</mi>
<mi>a</mi>
<mi>s</mi>
</mrow>
</msub>
<mo>=</mo>
<msup>
<mi>f</mi>
<mi>b</mi>
</msup>
<mo>-</mo>
<msubsup>
<mi>R</mi>
<mi>v</mi>
<mi>b</mi>
</msubsup>
<msup>
<mi>f</mi>
<mi>v</mi>
</msup>
<mo>,</mo>
</mrow>
<mrow>
<msub>
<mi>&omega;</mi>
<mrow>
<mi>b</mi>
<mi>i</mi>
<mi>a</mi>
<mi>s</mi>
</mrow>
</msub>
<mo>=</mo>
<msup>
<mi>&omega;</mi>
<mi>b</mi>
</msup>
<mo>-</mo>
<msubsup>
<mi>R</mi>
<mi>v</mi>
<mi>b</mi>
</msubsup>
<msup>
<mi>&omega;</mi>
<mi>v</mi>
</msup>
<mo>.</mo>
</mrow>
2
Applications Claiming Priority (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
US15/042,758 US9753144B1 (en) | 2016-02-12 | 2016-02-12 | Bias and misalignment compensation for 6-DOF IMU using GNSS/INS data |
US15/042758 | 2016-02-12 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN107084743A true CN107084743A (zh) | 2017-08-22 |
CN107084743B CN107084743B (zh) | 2020-07-07 |
Family
ID=59410307
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201710071722.XA Active CN107084743B (zh) | 2016-02-12 | 2017-02-09 | 利用gnss/ins数据的六自由度惯性测量单元的偏移和失准补偿 |
Country Status (3)
Country | Link |
---|---|
US (1) | US9753144B1 (zh) |
CN (1) | CN107084743B (zh) |
DE (1) | DE102017102269A1 (zh) |
Cited By (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109606372A (zh) * | 2017-10-02 | 2019-04-12 | 迪尔公司 | 用于调节机器的加速度的方法 |
CN109631940A (zh) * | 2018-12-09 | 2019-04-16 | 西安航天精密机电研究所 | 一种四环惯性稳定平台框架零位标校方法 |
CN110430270A (zh) * | 2019-08-08 | 2019-11-08 | 网易(杭州)网络有限公司 | 载具数据的同步方法及装置 |
CN110887978A (zh) * | 2018-09-07 | 2020-03-17 | 卡特彼勒公司 | 使用有效载荷***校准加速度传感器的***和方法 |
CN111504584A (zh) * | 2019-01-31 | 2020-08-07 | 北京图森智途科技有限公司 | 传感器支架的振动评估方法、装置、***及可移动设备 |
CN111976722A (zh) * | 2019-05-23 | 2020-11-24 | 通用汽车环球科技运作有限责任公司 | 包括自主控制***的用于控制车辆的方法和设备 |
Families Citing this family (23)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2017175361A1 (ja) * | 2016-04-07 | 2017-10-12 | 株式会社小松製作所 | 走行車両及び走行車両の制御方法 |
US11136040B2 (en) * | 2018-05-21 | 2021-10-05 | Deere & Company | IMU based traction control for wheeled or tracked machine |
US10308259B1 (en) | 2018-06-11 | 2019-06-04 | Caterpillar Inc. | Slip determining system and methods for a machine |
EP3611541B1 (en) * | 2018-08-16 | 2024-07-03 | Aptiv Technologies AG | Method of determining an uncertainty estimate of an estimated velocity |
CN109211269B (zh) * | 2018-08-16 | 2022-06-24 | 昆山天地睿航智能科技有限公司 | 一种双轴旋转惯导***姿态角误差标定方法 |
CN110873563B (zh) * | 2018-08-30 | 2022-03-08 | 杭州海康机器人技术有限公司 | 一种云台姿态估计方法及装置 |
WO2020080459A1 (ja) * | 2018-10-19 | 2020-04-23 | パナソニックIpマネジメント株式会社 | 表示システム、表示装置、及び表示制御方法 |
CN109443356A (zh) * | 2019-01-07 | 2019-03-08 | 大连海事大学 | 一种含测量噪声的无人船位置与速度估计结构及设计方法 |
US11199410B2 (en) * | 2019-04-30 | 2021-12-14 | Stmicroelectronics, Inc. | Dead reckoning by determining misalignment angle between movement direction and sensor heading direction |
US11747142B2 (en) * | 2019-04-30 | 2023-09-05 | Stmicroelectronics, Inc. | Inertial navigation system capable of dead reckoning in vehicles |
DE102019003238B4 (de) * | 2019-05-08 | 2023-04-20 | Mercedes-Benz Group AG | Fahrzeugortung durch Kartenabgleich unter Berücksichtigung eines Straßenprofils |
CN110146111B (zh) * | 2019-06-03 | 2023-07-21 | 西安精准测控有限责任公司 | 一种对中杆的初始对准方法 |
CN110501712B (zh) * | 2019-09-05 | 2022-06-28 | 北京百度网讯科技有限公司 | 无人驾驶中用于确定位置姿态数据的方法、装置和设备 |
CN112526570A (zh) * | 2019-09-18 | 2021-03-19 | 中车株洲电力机车研究所有限公司 | 列车定位方法及装置 |
CN110850447B (zh) * | 2019-11-11 | 2022-03-25 | 北京交通大学 | 对列车定位单元的定位精度进行综合评估的方法 |
KR20220038213A (ko) * | 2020-09-18 | 2022-03-28 | 현대자동차주식회사 | 차량 및 그 제어 방법 |
CN112197792A (zh) * | 2020-10-10 | 2021-01-08 | 江西洪都航空工业集团有限责任公司 | 一种用于教练机航姿***的提升航向精度方法 |
DE102020131669B3 (de) | 2020-11-30 | 2021-12-23 | Daimler Ag | Verfahren zur Erkennung von Fehlfunktionen in Inertialmesseinheiten |
EP4256365A1 (en) * | 2020-12-10 | 2023-10-11 | Preco Electronics, LLC | Calibration and operation of vehicle object detection radar with inertial measurement unit (imu) |
CN112797979B (zh) * | 2020-12-31 | 2022-07-01 | 苏州精源创智能科技有限公司 | 一种应用于agv的惯性姿态导航*** |
CN114111771A (zh) * | 2021-11-25 | 2022-03-01 | 九江中船仪表有限责任公司(四四一厂) | 一种双轴稳定平台的动态姿态测量方法 |
CN114485641B (zh) * | 2022-01-24 | 2024-03-26 | 武汉梦芯科技有限公司 | 一种基于惯导卫导方位融合的姿态解算方法及装置 |
DE102022128870B3 (de) | 2022-11-01 | 2024-02-08 | Marelli Automotive Lighting Reutlingen (Germany) GmbH | Verfahren zur Ermittlung einer Fehlorientierung einer Inertialmesseinheit eines Fahrzeugs und Fahrzeug mit einer Inertialmesseinheit |
Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US6240367B1 (en) * | 1998-11-27 | 2001-05-29 | Ching-Fang Lin | Full fusion positioning method for vehicle |
US20030236604A1 (en) * | 2002-06-19 | 2003-12-25 | Jianbo Lu | Method and apparatus for compensating misalignments of a sensor system used in a vehicle dynamic control system |
CN101233413A (zh) * | 2005-08-01 | 2008-07-30 | 丰田自动车株式会社 | 加速度传感器校正设备及加速度传感器的输出值校正方法 |
US20100299003A1 (en) * | 2009-05-21 | 2010-11-25 | Honeywell International Inc. | Real-time compensation of inertial sensor bias errors under high spin rate conditions |
CN103292811A (zh) * | 2013-06-20 | 2013-09-11 | 哈尔滨工程大学 | 一种虚拟旋转地理坐标系下解算速度的捷联惯性导航方法 |
JP2013200162A (ja) * | 2012-03-23 | 2013-10-03 | Chiba Univ | 小型姿勢センサ |
CN104215262A (zh) * | 2014-08-29 | 2014-12-17 | 南京航空航天大学 | 一种惯性导航***惯性传感器误差在线动态辨识方法 |
CN104792340A (zh) * | 2015-05-15 | 2015-07-22 | 哈尔滨工业大学 | 一种星敏感器安装误差矩阵与导航***星地联合标定与校正的方法 |
Family Cites Families (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US8155819B2 (en) | 2007-08-13 | 2012-04-10 | Raytheon Company | System and method for effecting vehicle maneuver to compensate for IMU error |
US8473207B2 (en) | 2008-10-21 | 2013-06-25 | Texas Instruments Incorporated | Tightly-coupled GNSS/IMU integration filter having calibration features |
US9140802B2 (en) | 2013-08-05 | 2015-09-22 | Texas Instruments Incorporated | Auxiliary as vehicle speed when difference between auxiliary and propagation above threshold |
-
2016
- 2016-02-12 US US15/042,758 patent/US9753144B1/en active Active
-
2017
- 2017-02-06 DE DE102017102269.4A patent/DE102017102269A1/de active Pending
- 2017-02-09 CN CN201710071722.XA patent/CN107084743B/zh active Active
Patent Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US6240367B1 (en) * | 1998-11-27 | 2001-05-29 | Ching-Fang Lin | Full fusion positioning method for vehicle |
US20030236604A1 (en) * | 2002-06-19 | 2003-12-25 | Jianbo Lu | Method and apparatus for compensating misalignments of a sensor system used in a vehicle dynamic control system |
CN101233413A (zh) * | 2005-08-01 | 2008-07-30 | 丰田自动车株式会社 | 加速度传感器校正设备及加速度传感器的输出值校正方法 |
US20100299003A1 (en) * | 2009-05-21 | 2010-11-25 | Honeywell International Inc. | Real-time compensation of inertial sensor bias errors under high spin rate conditions |
JP2013200162A (ja) * | 2012-03-23 | 2013-10-03 | Chiba Univ | 小型姿勢センサ |
CN103292811A (zh) * | 2013-06-20 | 2013-09-11 | 哈尔滨工程大学 | 一种虚拟旋转地理坐标系下解算速度的捷联惯性导航方法 |
CN104215262A (zh) * | 2014-08-29 | 2014-12-17 | 南京航空航天大学 | 一种惯性导航***惯性传感器误差在线动态辨识方法 |
CN104792340A (zh) * | 2015-05-15 | 2015-07-22 | 哈尔滨工业大学 | 一种星敏感器安装误差矩阵与导航***星地联合标定与校正的方法 |
Non-Patent Citations (2)
Title |
---|
SHENG-CHIH 等: "A New Calibration Method for Low Cost MEMS Inertial Sensor Module", 《JOURNAL OF MARINE SCIENCE AND TECHNOLOGY》 * |
***等: "高速自旋飞行器惯性制导***技术研究", 《测控技术》 * |
Cited By (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109606372A (zh) * | 2017-10-02 | 2019-04-12 | 迪尔公司 | 用于调节机器的加速度的方法 |
CN109606372B (zh) * | 2017-10-02 | 2023-09-26 | 迪尔公司 | 用于调节机器的加速度的方法 |
CN110887978A (zh) * | 2018-09-07 | 2020-03-17 | 卡特彼勒公司 | 使用有效载荷***校准加速度传感器的***和方法 |
CN109631940A (zh) * | 2018-12-09 | 2019-04-16 | 西安航天精密机电研究所 | 一种四环惯性稳定平台框架零位标校方法 |
CN111504584A (zh) * | 2019-01-31 | 2020-08-07 | 北京图森智途科技有限公司 | 传感器支架的振动评估方法、装置、***及可移动设备 |
CN111504584B (zh) * | 2019-01-31 | 2022-09-13 | 北京图森智途科技有限公司 | 传感器支架的振动评估方法、装置、***及可移动设备 |
CN111976722A (zh) * | 2019-05-23 | 2020-11-24 | 通用汽车环球科技运作有限责任公司 | 包括自主控制***的用于控制车辆的方法和设备 |
CN110430270A (zh) * | 2019-08-08 | 2019-11-08 | 网易(杭州)网络有限公司 | 载具数据的同步方法及装置 |
CN110430270B (zh) * | 2019-08-08 | 2022-03-25 | 网易(杭州)网络有限公司 | 载具数据的同步方法及装置 |
Also Published As
Publication number | Publication date |
---|---|
US20170234988A1 (en) | 2017-08-17 |
CN107084743B (zh) | 2020-07-07 |
US9753144B1 (en) | 2017-09-05 |
DE102017102269A1 (de) | 2017-08-17 |
DE102017102269A9 (de) | 2019-03-21 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN107084743A (zh) | 利用gnss/ins数据的六自由度惯性测量单元的偏移和失准补偿 | |
US9645250B2 (en) | Fail operational vehicle speed estimation through data fusion of 6-DOF IMU, GPS, and radar | |
CN106476883B (zh) | 车辆的行驶控制装置 | |
US8280586B2 (en) | Determination of the actual yaw angle and the actual slip angle of a land vehicle | |
US9650039B2 (en) | Vehicle location accuracy | |
US7222007B2 (en) | Attitude sensing system for an automotive vehicle relative to the road | |
US7451033B2 (en) | Lateral and longitudinal velocity determination for an automotive vehicle | |
US9403415B2 (en) | GPS based pitch sensing for an integrated stability control system | |
CN103309349B (zh) | 行进方向确定方法和装置 | |
EP3264036B1 (en) | System for and method of determining angular position of a vehicle | |
US9616900B2 (en) | Integrated bank and roll estimation using a three-axis inertial-measuring device | |
US11441905B2 (en) | Inertial navigation device and inertial navigation method | |
KR102331312B1 (ko) | 차량 내부 센서, 카메라, 및 gnss 단말기를 이용한 3차원 차량 항법 시스템 | |
CN103217158B (zh) | 一种提高车载sins/od组合导航精度的方法 | |
CN111284478A (zh) | 预瞄路径跟踪计算方法及跟踪计算模块 | |
JP2009198185A (ja) | 車両位置姿勢推測装置 | |
EP3429910B1 (en) | Control of a two-wheeled self-balancing vehicle | |
Katriniok | Optimal vehicle dynamics control and state estimation for a low-cost GNSS-based collision avoidance system | |
CN108860137A (zh) | 失稳车辆的控制方法、装置及智能车辆 | |
JP2018167735A (ja) | 車両の操舵支援装置 | |
US20090319186A1 (en) | Method and apparatus for determining a navigational state of a vehicle | |
US11794751B2 (en) | Pro-active trajectory tracking control for automated driving during elevation transitions | |
KR20230127352A (ko) | 무게중심 위치 판정 장치 및 방법 | |
WO2014009187A1 (de) | Übertragung von daten von einem mobilen endgerät zu einem fahrzeug | |
KR102044027B1 (ko) | Gps를 이용한 차량 기울기 산출 장치 및 그것의 동작 방법 |
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 |