CN113092822A - 一种基于惯组的激光多普勒测速仪的在线标定方法和装置 - Google Patents
一种基于惯组的激光多普勒测速仪的在线标定方法和装置 Download PDFInfo
- Publication number
- CN113092822A CN113092822A CN202110422583.7A CN202110422583A CN113092822A CN 113092822 A CN113092822 A CN 113092822A CN 202110422583 A CN202110422583 A CN 202110422583A CN 113092822 A CN113092822 A CN 113092822A
- Authority
- CN
- China
- Prior art keywords
- laser doppler
- doppler velocimeter
- inertial navigation
- value
- error
- 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
- 238000000034 method Methods 0.000 title claims abstract description 42
- 238000005259 measurement Methods 0.000 title claims abstract description 14
- 238000004458 analytical method Methods 0.000 claims abstract description 18
- 238000009434 installation Methods 0.000 claims description 59
- 238000001914 filtration Methods 0.000 claims description 35
- 238000004590 computer program Methods 0.000 claims description 21
- 238000004364 calculation method Methods 0.000 claims description 8
- 230000007613 environmental effect Effects 0.000 abstract description 3
- 230000008569 process Effects 0.000 description 7
- 239000011159 matrix material Substances 0.000 description 6
- 238000010586 diagram Methods 0.000 description 4
- 238000012937 correction Methods 0.000 description 2
- 238000013461 design Methods 0.000 description 2
- 238000005516 engineering process Methods 0.000 description 2
- 239000000126 substance Substances 0.000 description 2
- 230000001360 synchronised effect Effects 0.000 description 2
- 230000001133 acceleration Effects 0.000 description 1
- 230000008859 change Effects 0.000 description 1
- 150000001875 compounds Chemical class 0.000 description 1
- 239000004973 liquid crystal related substance Substances 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 230000003068 static effect Effects 0.000 description 1
- 230000009466 transformation Effects 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01P—MEASURING LINEAR OR ANGULAR SPEED, ACCELERATION, DECELERATION, OR SHOCK; INDICATING PRESENCE, ABSENCE, OR DIRECTION, OF MOVEMENT
- G01P21/00—Testing or calibrating of apparatus or devices covered by the preceding groups
- G01P21/02—Testing or calibrating of apparatus or devices covered by the preceding groups of speedometers
-
- 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
Abstract
本申请涉及一种基于惯组的激光多普勒测速仪的在线标定方法和装置。所述方法包括:在初始时段使用惯导数据、基于参数解析法对激光多普勒测速仪的安装角和发射倾角进行粗标定,建立组合导航系统的状态方程,以激光多普勒测速仪的速度误差和惯性导航设备的速度误差的差值为观测量建立观测方程,得到激光多普勒测速仪的安装角误差估计值和发射角误差估计值,并对应补偿粗标定值,得到高精度的激光多普勒测速仪的在线标定结果。本方法充分利用了惯性导航设备的特点,不依赖卫星导航系统实时对激光测速仪进行在线高精度标定,降低了设备成本,具有自主性高、环境适应性好等特点,能提高载体的机动性。
Description
技术领域
本申请涉及组合导航技术领域,特别是涉及一种基于惯组的激光多普勒测速仪的在线标定方法和装置。
背景技术
在由捷联惯性导航设备(SINS)和激光多普勒测速仪(LDV)构成的组合导航系统中,需要对LDV的比例因子及安装角进行标定。对于LDV的比例因子,传统的标定方法是在实验室条件下利用具有固定转速的转盘、滚筒等作为标准速度源,通过将由测速仪所得到的速度与标准速度进行对比实现对LDV比例因子的标定,然后再将测速仪与惯性导航设备一起安装在测量载体上。这种线下标定方法虽然标定精度高,但无法保证在运动载体原有作业基础上完成对测速仪比例因子的标定,不能满足运动载体的机动性要求。另外在测速仪的安装过程中会产生安装角,而线下标定方法无法对安装角进行标定,而且测速仪的比例因子取决于发射倾角的大小,如果安装过程中测速仪的发射倾角与设计角度有偏差也会导致测速仪的实际比例因子与在实验室条件下标定所得到的比例因子不同,因此对测速仪的安装精度提出了很高的要求。
现有的在线标定方法主要利用GPS、北斗等卫星定位技术对LDV进行标定,将卫星导航所得到的速度作为基准速度,然后利用Kalman滤波或最小二乘法对LDV的安装角及比例因子进行标定。这种标定方法能够利用外界的准确信息,实时有效地对测速仪进行标定,标定精度高,提高导航定位精度。但卫星定位技术属于非自主的导航方式,而且受外界环境影响较大,在隧道、山区等遮挡严重的区域,卫星导航信号容易丢失,导致在线标定精度下降。另外在一些特殊的应用场合禁止使用卫星导航系统,无法从外界获取精确的速度信息作为标定基准。
发明内容
基于此,有必要针对上述技术问题,提供一种能够在线高精度标定激光多普勒测速仪的基于惯组的激光多普勒测速仪的在线标定方法和装置。
一种基于惯组的激光多普勒测速仪的在线标定方法,包括:
在预设的初始时段获取惯性导航设备的惯导数据,基于参数解析法根据惯导数据得到激光多普勒测速仪的安装角粗标定值和发射倾角粗标定值。
建立组合导航系统的状态方程,以激光多普勒测速仪的速度误差和惯性导航设备的速度误差的差值为观测量建立观测方程,通过Kalman滤波得到激光多普勒测速仪的安装角误差估计值和发射角误差估计值。组合导航系统由惯性导航设备和激光多普勒测速仪组成。
根据安装角误差估计值和发射角误差估计值对应补偿安装角粗标定值和发射倾角粗标定值,得到对激光多普勒测速仪的在线标定结果。
其中一个实施例中,得到对激光多普勒测速仪的在线标定结果的步骤之后,还包括:
基于状态方程和观测方程,通过Kalman滤波得到惯性导航设备的导航参数误差估计值。导航参数误差估计值包括:姿态误差估计值、速度误差估计值、位置误差估计值、陀螺零偏估计值和加表零偏估计值。
根据导航参数误差估计值对应补偿惯性导航设备的导航参数。
其中一个实施例中,建立组合导航系统的状态方程的步骤包括:
建立惯性导航设备的纯惯性误差模型,以及建立激光多普勒测速仪的速度误差模型。
根据纯惯性误差模型和速度误差模型,得到Kalman滤波的状态方程。
其中一个实施例中,Kalman滤波的状态方程的建立方式包括:
以组合导航系统的姿态误差、速度误差、位置误差,惯性导航设备的陀螺漂移和加速度计零偏,激光多普勒测速仪的安装角误差和发射角误差为分量,构建状态量。
基于状态量,以及惯性导航设备的陀螺噪声参数和加速度计噪声参数,构建Kalman滤波的状态方程。
其中一个实施例中,激光多普勒测速仪的安装角粗标定值和发射倾角粗标定值的计算方式包括:
在预设的初始时段,根据惯性导航设备的输出得到对应的惯导轨迹。
在初始时段,根据激光多普勒测速仪的输出得到对应的测速仪航迹推算轨迹。
根据惯导轨迹和测速仪航迹推算轨迹之间的几何关系,以惯导轨迹为基准,得到激光多普勒测速仪的安装角粗标定值和发射倾角粗标定值。
一种基于惯组的激光多普勒测速仪的在线标定装置,包括:
粗标定模块,用于在预设的初始时段获取惯性导航设备的惯导数据,基于参数解析法根据惯导数据得到激光多普勒测速仪的安装角粗标定值和发射倾角粗标定值。
误差估计模块,用于建立组合导航系统的状态方程,以激光多普勒测速仪的速度误差和惯性导航设备的速度误差的差值为观测量建立观测方程,通过Kalman滤波得到激光多普勒测速仪的安装角误差估计值和发射角误差估计值。组合导航系统由惯性导航设备和激光多普勒测速仪组成。在线标定模块,用于根据安装角误差估计值和发射角误差估计值对应补偿安装角粗标定值和发射倾角粗标定值,得到对激光多普勒测速仪的在线标定结果。
一种计算机设备,包括存储器和处理器,所述存储器存储有计算机程序,所述处理器执行所述计算机程序时实现以下步骤:
在预设的初始时段获取惯性导航设备的惯导数据,基于参数解析法根据惯导数据得到激光多普勒测速仪的安装角粗标定值和发射倾角粗标定值。
建立组合导航系统的状态方程,以激光多普勒测速仪的速度误差和惯性导航设备的速度误差的差值为观测量建立观测方程,通过Kalman滤波得到激光多普勒测速仪的安装角误差估计值和发射角误差估计值。
根据安装角误差估计值和发射角误差估计值对应补偿安装角粗标定值和发射倾角粗标定值,得到对激光多普勒测速仪的在线标定结果。
一种计算机可读存储介质,其上存储有计算机程序,所述计算机程序被处理器执行时实现以下步骤:
在预设的初始时段获取惯性导航设备的惯导数据,基于参数解析法根据惯导数据得到激光多普勒测速仪的安装角粗标定值和发射倾角粗标定值。
建立组合导航系统的状态方程,以激光多普勒测速仪的速度误差和惯性导航设备的速度误差的差值为观测量建立观测方程,通过Kalman滤波得到激光多普勒测速仪的安装角误差估计值和发射角误差估计值。组合导航系统由惯性导航设备和激光多普勒测速仪组成。
根据安装角误差估计值和发射角误差估计值对应补偿安装角粗标定值和发射倾角粗标定值,得到对激光多普勒测速仪的在线标定结果。
与现有技术相比,上述基于惯组的激光多普勒测速仪的在线标定方法、装置、计算机设备和存储介质,根据惯性导航设备在初期短时间内精度高的特点,在初始时段使用惯导数据、基于参数解析法对激光多普勒测速仪的安装角和发射倾角进行粗标定。随后建立组合导航系统的状态方程,以激光多普勒测速仪的速度误差和惯性导航设备的速度误差的差值为观测量建立观测方程,通过Kalman滤波得到激光多普勒测速仪的安装角误差估计值和发射角误差估计值。使用误差估计值对应补偿粗标定值,得到高精度的激光多普勒测速仪的在线标定结果。本申请充分利用了惯性导航设备的特点,能够在不依赖卫星导航系统的前提下,实时对激光测速仪进行在线高精度标定,不仅降低了设备成本,具有自主性高、环境适应性好等特点,还能够提高载体的机动性。
附图说明
图1为一个实施例中一种基于惯组的激光多普勒测速仪的在线标定方法的步骤图;
图2为另一个实施例中一种基于惯组的激光多普勒测速仪的在线标定方法的流程示意图;
图3为基于惯性导航设备得到的载体轨迹和基于激光多普勒测速仪得到的载体轨迹之间的几何关系示意图;
图4为基于Kalman滤波器对导航参数进行校正的流程示意图;
图5为一个实施例中计算机设备的内部结构图。
具体实施方式
为了使本申请的目的、技术方案及优点更加清楚明白,以下结合附图及实施例,对本申请进行进一步详细说明。应当理解,此处描述的具体实施例仅仅用以解释本申请,并不用于限定本申请。
在一个实施例中,如图1所示,提供了一种基于惯组的激光多普勒测速仪的在线标定方法,包括以下步骤:
步骤102,在预设的初始时段获取惯性导航设备的惯导数据,基于参数解析法根据惯导数据得到激光多普勒测速仪的安装角粗标定值和发射倾角粗标定值。
具体地,在基于参数解析法对激光多普勒测速仪进行粗标定时,需要利用初始对准完成后的一段时间内(一般是几分钟)的惯导轨迹以及基于激光多普勒测速仪得到的航迹推算载体的运动轨迹。虽然惯性导航设备的导航误差是随着时间逐渐发散的,但其在初始对准后的一段时间内相对精确。本步骤利用惯性导航设备的这一特性,利用在初始时段内的惯导轨迹对激光多普勒测速仪的安装角和发射角进行标定,得到对应的粗标定值作为后续过程的基础。
步骤104,建立组合导航系统的状态方程,以激光多普勒测速仪的速度误差和惯性导航设备的速度误差的差值为观测量建立观测方程,通过Kalman滤波得到激光多普勒测速仪的安装角误差估计值和发射角误差估计值。组合导航系统由惯性导航设备和激光多普勒测速仪组成。由于参数解析法的标定精度主要取决于初始位置精度和惯性导航设备的初始对准精度,而初始位置误差和初始对准误差是无法避免的,因此仍需要通过Kalman滤波来对参数解析法粗标定的结果以及惯导的误差进行修正补偿,得到对激光多普勒测速仪的安装角误差和发射角误差的最优估计值。
步骤106,根据安装角误差估计值和发射角误差估计值对应补偿安装角粗标定值和发射倾角粗标定值,得到对激光多普勒测速仪的在线标定结果。
使用安装角误差和发射角误差的最优估计值来修正对应的粗标定值,得到高精度的激光多普勒测速仪的安装角和发射倾角的在线标定结果。
本实施例分利用了惯性导航设备的特点,能够在不依赖卫星导航系统的前提下,在激光测速仪安装到载体上之后对其进行在线高精度标定,不依赖卫星导航信号,因此具有自主性高、环境适应性好等特点,还能够降低设备成本。
其中一个实施例中,如图2所示,提供了一种基于惯组的激光多普勒测速仪的在线标定方法,包括以下步骤:
步骤202,获取惯性导航设备的误差变化曲线,根据预设的误差取值范围得到对应的时间范围,在时间范围内设置初始时段。
本实施例中初始时段设为对初始对准时刻之后的300s。
步骤204,在预设的初始时段,根据惯性导航设备的输出得到对应的惯导轨迹。在初始时段,根据激光多普勒测速仪的输出得到对应的测速仪航迹推算轨迹。根据惯导轨迹和测速仪航迹推算轨迹之间的几何关系,以惯导轨迹为基准,得到激光多普勒测速仪的安装角粗标定值和发射倾角粗标定值。
根据初始时段中的惯导数据得到对应的惯导轨迹,对激光多普勒测速仪进行参数解析法标定。基于参数解析法进行粗标定的依据是初始时段中惯导轨迹和测速仪航迹推算轨迹之间的几何关系,如图3所示,粗标定的具体实现过程如下:
图3中,ψ为测速仪的航向安装角,O点为初始对准时刻载体的位置,其坐标为(X0,Y0),PSINS表示基于惯导轨迹得到的载体在某一时刻的位置,其坐标为(XSINS,YSINS),PLDV表示基于激光测速仪航迹推算轨迹得到的载体在某一时刻的位置,其坐标为(XLDV,YLDV),OPSINS之间的距离为LSINS,OPLDV之间的距离为LLDV。由图3中几何关系可以得到:
其中,ψi为通过参数解析法得到的安装角的粗标定结果。假设激光测速仪(LDV)的设计发射倾角为θd,实际的发射倾角为θi,则有:
由式(4)和式(5)可以得到:
由式(3)和式(6)即计算出LDV的安装角ψi以及发射倾角θi,得到对LDV的安装角和发射倾角的粗标定结果。
步骤206,建立惯性导航设备的纯惯性误差模型,以及建立激光多普勒测速仪的速度误差模型。根据纯惯性误差模型和速度误差模型,得到Kalman滤波的状态方程。
步骤208,以激光多普勒测速仪的速度误差和惯性导航设备的速度误差的差值为观测量建立观测方程,通过Kalman滤波得到激光多普勒测速仪的安装角误差估计值和发射角误差估计值。
基于惯性导航设备的纯惯性误差模型以及LDV的速度误差模型设计Kalman滤波器。滤波系统的状态量为:
式(7)中φE、φN、φU为载体的姿态误差角,δVE、δVN、δVU为载体东向速度误差、北向速度误差和天向速度误差,δL、δλ、δh为载体的纬度、经度以及高度位置误差,εx、εy、εz表示惯性导航设备(IMU)中三个陀螺的漂移,表示IMU中三个加速度计的零偏,δψ、δθ分别为测速仪的安装角误差和发射倾角误差。滤波系统的状态方程为:
系统矩阵为:
其中,
噪声驱动矩阵为:
系统的噪声矩阵为:
式中,为载体系相对于导航系的转换矩阵,VE、VN、VU分别为惯性导航设备的东向速度、北向速度和天向速度,L、h分别为惯性导航设备的纬度和高度,εwi(i=x,y,z)为陀螺的噪声,为加速度计的噪声,RM和RN分别为地球子午圈曲率半径和卯酉圈曲率半径,ωie为地球自转角速度,0m×n为m行n列的零元素矩阵。
设载体运动的真实速度为VR,惯性导航设备通过敏感载体的加速度得到载体的速度信息VSINS,速度误差为δVSINS。同时激光多普勒测速仪得到载体的运动速度VLDV,速度误差为δVLDV。系统的观测方程为:
其中v(t)为量测噪声,观测矩阵为:
经过滤波计算,得到安装角误差δψ和发射倾角误差δθ。
步骤210,根据安装角误差估计值和发射角误差估计值对应补偿安装角粗标定值和发射倾角粗标定值,得到对激光多普勒测速仪的在线标定结果。
然后利用Kalman滤波得到的估计值对LDV的安装角和发射倾角粗标定结果进行修正补偿,如式(23)和式(24)所示。
ψ=ψi+δψ (23)
θ=θi+δθ (24)
步骤212,基于状态方程和观测方程,通过Kalman滤波得到惯性导航设备的导航参数误差估计值。导航参数误差估计值包括:姿态误差估计值、速度误差估计值、位置误差估计值、陀螺零偏估计值和加表零偏估计值。根据导航参数误差估计值对应补偿惯性导航设备的导航参数。
如图4所示,在对激光多普勒测速仪的安装角和发射倾角进行在线标定的同时,使用Kalman滤波器得到惯导系统的姿态误差φ、速度误差δV、位置误差δP、陀螺零偏ε和加表零偏等参数校正惯性导航设备输出的导航参数,可以得到导航参数的最优估计结果。
应该理解的是,虽然图1的流程图中的各个步骤按照箭头的指示依次显示,但是这些步骤并不是必然按照箭头指示的顺序依次执行。除非本文中有明确的说明,这些步骤的执行并没有严格的顺序限制,这些步骤可以以其它的顺序执行。而且,图1中的至少一部分步骤可以包括多个子步骤或者多个阶段,这些子步骤或者阶段并不必然是在同一时刻执行完成,而是可以在不同的时刻执行,这些子步骤或者阶段的执行顺序也不必然是依次进行,而是可以与其它步骤或者其它步骤的子步骤或者阶段的至少一部分轮流或者交替地执行。
在一个实施例中,提供了一种基于惯组的激光多普勒测速仪的在线标定装置,包括:
粗标定模块,用于在预设的初始时段获取惯性导航设备的惯导数据,基于参数解析法根据惯导数据得到激光多普勒测速仪的安装角粗标定值和发射倾角粗标定值。
误差估计模块,用于建立组合导航系统的状态方程,以激光多普勒测速仪的速度误差和惯性导航设备的速度误差的差值为观测量建立观测方程,通过Kalman滤波得到激光多普勒测速仪的安装角误差估计值和发射角误差估计值。组合导航系统由惯性导航设备和激光多普勒测速仪组成。在线标定模块,用于根据安装角误差估计值和发射角误差估计值对应补偿安装角粗标定值和发射倾角粗标定值,得到对激光多普勒测速仪的在线标定结果。
其中一个实施例中,还包括导航参数校正模块,用于基于状态方程和观测方程,通过Kalman滤波得到惯性导航设备的导航参数误差估计值。导航参数误差估计值包括:姿态误差估计值、速度误差估计值、位置误差估计值、陀螺零偏估计值和加表零偏估计值。根据导航参数误差估计值对应补偿惯性导航设备的导航参数。
其中一个实施例中,误差估计模块用于建立惯性导航设备的纯惯性误差模型,以及建立激光多普勒测速仪的速度误差模型。根据纯惯性误差模型和速度误差模型,得到Kalman滤波的状态方程。
其中一个实施例中,还包括Kalman滤波状态方程建立模块,用于以组合导航系统的姿态误差、速度误差、位置误差,惯性导航设备的陀螺漂移和加速度计零偏,激光多普勒测速仪的安装角误差和发射角误差为分量,构建状态量。基于状态量,以及惯性导航设备的陀螺噪声参数和加速度计噪声参数,构建Kalman滤波的状态方程。
其中一个实施例中,粗标定模块用于在预设的初始时段,根据惯性导航设备的输出得到对应的惯导轨迹。在初始时段,根据激光多普勒测速仪的输出得到对应的测速仪航迹推算轨迹。根据惯导轨迹和测速仪航迹推算轨迹之间的几何关系,以惯导轨迹为基准,得到激光多普勒测速仪的安装角粗标定值和发射倾角粗标定值。
关于基于惯组的激光多普勒测速仪的在线标定装置的具体限定可以参见上文中对于基于惯组的激光多普勒测速仪的在线标定方法的限定,在此不再赘述。上述基于惯组的激光多普勒测速仪的在线标定装置中的各个模块可全部或部分通过软件、硬件及其组合来实现。上述各模块可以硬件形式内嵌于或独立于计算机设备中的处理器中,也可以以软件形式存储于计算机设备中的存储器中,以便于处理器调用执行以上各个模块对应的操作。
在一个实施例中,提供了一种计算机设备,该计算机设备可以是终端,其内部结构图可以如图5所示。该计算机设备包括通过系统总线连接的处理器、存储器、网络接口、显示屏和输入装置。其中,该计算机设备的处理器用于提供计算和控制能力。该计算机设备的存储器包括非易失性存储介质、内存储器。该非易失性存储介质存储有操作系统和计算机程序。该内存储器为非易失性存储介质中的操作系统和计算机程序的运行提供环境。该计算机设备的网络接口用于与外部的终端通过网络连接通信。该计算机程序被处理器执行时以实现一种基于惯组的激光多普勒测速仪的在线标定方法。该计算机设备的显示屏可以是液晶显示屏或者电子墨水显示屏,该计算机设备的输入装置可以是显示屏上覆盖的触摸层,也可以是计算机设备外壳上设置的按键、轨迹球或触控板,还可以是外接的键盘、触控板或鼠标等。
本领域技术人员可以理解,图5中示出的结构,仅仅是与本申请方案相关的部分结构的框图,并不构成对本申请方案所应用于其上的计算机设备的限定,具体的计算机设备可以包括比图中所示更多或更少的部件,或者组合某些部件,或者具有不同的部件布置。
在一个实施例中,提供了一种计算机设备,包括存储器和处理器,该存储器存储有计算机程序,该处理器执行计算机程序时实现以下步骤:
在预设的初始时段获取惯性导航设备的惯导数据,基于参数解析法根据惯导数据得到激光多普勒测速仪的安装角粗标定值和发射倾角粗标定值。
建立组合导航系统的状态方程,以激光多普勒测速仪的速度误差和惯性导航设备的速度误差的差值为观测量建立观测方程,通过Kalman滤波得到激光多普勒测速仪的安装角误差估计值和发射角误差估计值。组合导航系统由惯性导航设备和激光多普勒测速仪组成。根据安装角误差估计值和发射角误差估计值对应补偿安装角粗标定值和发射倾角粗标定值,得到对激光多普勒测速仪的在线标定结果。
在一个实施例中,处理器执行计算机程序时还实现以下步骤:基于状态方程和观测方程,通过Kalman滤波得到惯性导航设备的导航参数误差估计值。导航参数误差估计值包括:姿态误差估计值、速度误差估计值、位置误差估计值、陀螺零偏估计值和加表零偏估计值。根据导航参数误差估计值对应补偿惯性导航设备的导航参数。
在一个实施例中,处理器执行计算机程序时还实现以下步骤:建立惯性导航设备的纯惯性误差模型,以及建立激光多普勒测速仪的速度误差模型。根据纯惯性误差模型和速度误差模型,得到Kalman滤波的状态方程。
在一个实施例中,处理器执行计算机程序时还实现以下步骤:以组合导航系统的姿态误差、速度误差、位置误差,惯性导航设备的陀螺漂移和加速度计零偏,激光多普勒测速仪的安装角误差和发射角误差为分量,构建状态量。基于状态量,以及惯性导航设备的陀螺噪声参数和加速度计噪声参数,构建Kalman滤波的状态方程。
在一个实施例中,处理器执行计算机程序时还实现以下步骤:在预设的初始时段,根据惯性导航设备的输出得到对应的惯导轨迹。在初始时段,根据激光多普勒测速仪的输出得到对应的测速仪航迹推算轨迹。根据惯导轨迹和测速仪航迹推算轨迹之间的几何关系,以惯导轨迹为基准,得到激光多普勒测速仪的安装角粗标定值和发射倾角粗标定值。
在一个实施例中,提供了一种计算机可读存储介质,其上存储有计算机程序,计算机程序被处理器执行时实现以下步骤:
在预设的初始时段获取惯性导航设备的惯导数据,基于参数解析法根据惯导数据得到激光多普勒测速仪的安装角粗标定值和发射倾角粗标定值。
建立组合导航系统的状态方程,以激光多普勒测速仪的速度误差和惯性导航设备的速度误差的差值为观测量建立观测方程,通过Kalman滤波得到激光多普勒测速仪的安装角误差估计值和发射角误差估计值。组合导航系统由惯性导航设备和激光多普勒测速仪组成。根据安装角误差估计值和发射角误差估计值对应补偿安装角粗标定值和发射倾角粗标定值,得到对激光多普勒测速仪的在线标定结果。
在一个实施例中,计算机程序被处理器执行时还实现以下步骤:基于状态方程和观测方程,通过Kalman滤波得到惯性导航设备的导航参数误差估计值。导航参数误差估计值包括:姿态误差估计值、速度误差估计值、位置误差估计值、陀螺零偏估计值和加表零偏估计值。根据导航参数误差估计值对应补偿惯性导航设备的导航参数。
在一个实施例中,计算机程序被处理器执行时还实现以下步骤:建立惯性导航设备的纯惯性误差模型,以及建立激光多普勒测速仪的速度误差模型。根据纯惯性误差模型和速度误差模型,得到Kalman滤波的状态方程。
在一个实施例中,计算机程序被处理器执行时还实现以下步骤:以组合导航系统的姿态误差、速度误差、位置误差,惯性导航设备的陀螺漂移和加速度计零偏,激光多普勒测速仪的安装角误差和发射角误差为分量,构建状态量。基于状态量,以及惯性导航设备的陀螺噪声参数和加速度计噪声参数,构建Kalman滤波的状态方程。
在一个实施例中,计算机程序被处理器执行时还实现以下步骤:在预设的初始时段,根据惯性导航设备的输出得到对应的惯导轨迹。在初始时段,根据激光多普勒测速仪的输出得到对应的测速仪航迹推算轨迹。根据惯导轨迹和测速仪航迹推算轨迹之间的几何关系,以惯导轨迹为基准,得到激光多普勒测速仪的安装角粗标定值和发射倾角粗标定值。
本领域普通技术人员可以理解实现上述实施例方法中的全部或部分流程,是可以通过计算机程序来指令相关的硬件来完成,所述的计算机程序可存储于一非易失性计算机可读取存储介质中,该计算机程序在执行时,可包括如上述各方法的实施例的流程。其中,本申请所提供的各实施例中所使用的对存储器、存储、数据库或其它介质的任何引用,均可包括非易失性和/或易失性存储器。非易失性存储器可包括只读存储器(ROM)、可编程ROM(PROM)、电可编程ROM(EPROM)、电可擦除可编程ROM(EEPROM)或闪存。易失性存储器可包括随机存取存储器(RAM)或者外部高速缓冲存储器。作为说明而非局限,RAM以多种形式可得,诸如静态RAM(SRAM)、动态RAM(DRAM)、同步DRAM(SDRAM)、双数据率SDRAM(DDRSDRAM)、增强型SDRAM(ESDRAM)、同步链路(Synchlink)DRAM(SLDRAM)、存储器总线(Rambus)直接RAM(RDRAM)、直接存储器总线动态RAM(DRDRAM)、以及存储器总线动态RAM(RDRAM)等。
以上实施例的各技术特征可以进行任意的组合,为使描述简洁,未对上述实施例中的各个技术特征所有可能的组合都进行描述,然而,只要这些技术特征的组合不存在矛盾,都应当认为是本说明书记载的范围。
以上所述实施例仅表达了本申请的几种实施方式,其描述较为具体和详细,但并不能因此而理解为对发明专利范围的限制。应当指出的是,对于本领域的普通技术人员来说,在不脱离本申请构思的前提下,还可以做出若干变形和改进,这些都属于本申请的保护范围。因此,本申请专利的保护范围应以所附权利要求为准。
Claims (9)
1.一种基于惯组的激光多普勒测速仪的在线标定方法,其特征在于,所述方法包括:
在预设的初始时段获取惯性导航设备的惯导数据,基于参数解析法根据所述惯导数据得到激光多普勒测速仪的安装角粗标定值和发射倾角粗标定值;
建立组合导航系统的状态方程,以所述激光多普勒测速仪的速度误差和所述惯性导航设备的速度误差的差值为观测量建立观测方程,通过Kalman滤波得到所述激光多普勒测速仪的安装角误差估计值和发射角误差估计值;所述组合导航系统由所述惯性导航设备和所述激光多普勒测速仪组成;
根据所述安装角误差估计值和发射角误差估计值对应补偿所述安装角粗标定值和所述发射倾角粗标定值,得到对所述激光多普勒测速仪的在线标定结果。
2.根据权利要求1所述的方法,其特征在于,得到对所述激光多普勒测速仪的在线标定结果的步骤之后,还包括:
基于所述状态方程和所述观测方程,通过Kalman滤波得到所述惯性导航设备的导航参数误差估计值;所述导航参数误差估计值包括:姿态误差估计值、速度误差估计值、位置误差估计值、陀螺零偏估计值和加表零偏估计值;
根据所述导航参数误差估计值对应补偿所述惯性导航设备的导航参数。
3.根据权利要求1所述的方法,其特征在于,建立组合导航系统的状态方程的步骤包括:
建立所述惯性导航设备的纯惯性误差模型,以及建立所述激光多普勒测速仪的速度误差模型;
根据所述纯惯性误差模型和所述速度误差模型,得到Kalman滤波的状态方程。
4.根据权利要求1所述的方法,其特征在于,Kalman滤波的状态方程的建立方式包括:
以所述组合导航系统的姿态误差、速度误差、位置误差,所述惯性导航设备的陀螺漂移和加速度计零偏,所述激光多普勒测速仪的安装角误差和发射角误差为分量,构建状态量;
基于所述状态量,以及所述惯性导航设备的陀螺噪声参数和加速度计噪声参数,构建所述Kalman滤波的状态方程。
5.根据权利要求1至4中任意一项所述的方法,其特征在于,激光多普勒测速仪的安装角粗标定值和发射倾角粗标定值的计算方式包括:
在预设的初始时段,根据惯性导航设备的输出得到对应的惯导轨迹;
在所述初始时段,根据激光多普勒测速仪的输出得到对应的测速仪航迹推算轨迹;
根据所述惯导轨迹和所述测速仪航迹推算轨迹之间的几何关系,以所述惯导轨迹为基准,得到所述激光多普勒测速仪的安装角粗标定值和发射倾角粗标定值。
6.一种基于惯组的激光多普勒测速仪的在线标定装置,其特征在于,所述装置包括:
粗标定模块,用于在预设的初始时段获取惯性导航设备的惯导数据,基于参数解析法根据所述惯导数据得到激光多普勒测速仪的安装角粗标定值和发射倾角粗标定值;
误差估计模块,用于建立组合导航系统的状态方程,以所述激光多普勒测速仪的速度误差和所述惯性导航设备的速度误差的差值为观测量建立观测方程,通过Kalman滤波得到所述激光多普勒测速仪的安装角误差估计值和发射角误差估计值;所述组合导航系统由所述惯性导航设备和所述激光多普勒测速仪组成;
在线标定模块,用于根据所述安装角误差估计值和发射角误差估计值对应补偿所述安装角粗标定值和所述发射倾角粗标定值,得到对所述激光多普勒测速仪的在线标定结果。
7.一种组合导航系统,包括惯性导航设备和激光多普勒测速仪,其特征在于,还包括如权利要求6所述的一种基于惯组的激光多普勒测速仪的在线标定装置。
8.一种计算机设备,包括存储器和处理器,所述存储器存储有计算机程序,其特征在于,所述处理器执行所述计算机程序时实现权利要求1至5中任一项所述方法的步骤。
9.一种计算机可读存储介质,其上存储有计算机程序,其特征在于,所述计算机程序被处理器执行时实现权利要求1至5中任一项所述方法的步骤。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110422583.7A CN113092822B (zh) | 2021-04-15 | 2021-04-15 | 一种基于惯组的激光多普勒测速仪的在线标定方法和装置 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110422583.7A CN113092822B (zh) | 2021-04-15 | 2021-04-15 | 一种基于惯组的激光多普勒测速仪的在线标定方法和装置 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN113092822A true CN113092822A (zh) | 2021-07-09 |
CN113092822B CN113092822B (zh) | 2023-11-10 |
Family
ID=76678735
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202110422583.7A Active CN113092822B (zh) | 2021-04-15 | 2021-04-15 | 一种基于惯组的激光多普勒测速仪的在线标定方法和装置 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN113092822B (zh) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114609407A (zh) * | 2022-03-16 | 2022-06-10 | 苏州邈航科技有限公司 | 基于mems陀螺仪的水平测速仪及其测速方法 |
CN115979263A (zh) * | 2023-03-21 | 2023-04-18 | 中国人民解放军国防科技大学 | 一种低空飞行载体导航方法及系统 |
Citations (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH11118507A (ja) * | 1997-10-09 | 1999-04-30 | Yokogawa Denshikiki Co Ltd | 船舶の慣性航法装置 |
CN102607595A (zh) * | 2012-03-07 | 2012-07-25 | 北京航空航天大学 | 应用激光多普勒测速仪测试捷联挠性陀螺动态随机漂移的方法 |
CN102707092A (zh) * | 2012-06-19 | 2012-10-03 | 北京航空航天大学 | 一种基于角速率台的单波束激光测速仪标定方法 |
CN104596539A (zh) * | 2014-10-13 | 2015-05-06 | 北京航空航天大学 | 一种用于组合导航半实物仿真的激光测速仪数据建模方法 |
CN107015259A (zh) * | 2016-01-27 | 2017-08-04 | 北京中联星通投资管理有限公司 | 采用多普勒测速仪计算伪距/伪距率的紧组合方法 |
CN110398749A (zh) * | 2019-08-13 | 2019-11-01 | 湖南波恩光电科技有限责任公司 | 一种双斜射非对称车载激光测速装置 |
CN110763872A (zh) * | 2019-11-21 | 2020-02-07 | 中国船舶重工集团公司第七0七研究所 | 一种多普勒测速仪多参数在线标定方法 |
CN111323050A (zh) * | 2020-03-19 | 2020-06-23 | 哈尔滨工程大学 | 一种捷联惯导和多普勒组合系统标定方法 |
JP2020169953A (ja) * | 2019-04-05 | 2020-10-15 | 株式会社Ihi | 慣性航法装置の校正方法 |
-
2021
- 2021-04-15 CN CN202110422583.7A patent/CN113092822B/zh active Active
Patent Citations (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH11118507A (ja) * | 1997-10-09 | 1999-04-30 | Yokogawa Denshikiki Co Ltd | 船舶の慣性航法装置 |
CN102607595A (zh) * | 2012-03-07 | 2012-07-25 | 北京航空航天大学 | 应用激光多普勒测速仪测试捷联挠性陀螺动态随机漂移的方法 |
CN102707092A (zh) * | 2012-06-19 | 2012-10-03 | 北京航空航天大学 | 一种基于角速率台的单波束激光测速仪标定方法 |
CN104596539A (zh) * | 2014-10-13 | 2015-05-06 | 北京航空航天大学 | 一种用于组合导航半实物仿真的激光测速仪数据建模方法 |
CN107015259A (zh) * | 2016-01-27 | 2017-08-04 | 北京中联星通投资管理有限公司 | 采用多普勒测速仪计算伪距/伪距率的紧组合方法 |
JP2020169953A (ja) * | 2019-04-05 | 2020-10-15 | 株式会社Ihi | 慣性航法装置の校正方法 |
CN110398749A (zh) * | 2019-08-13 | 2019-11-01 | 湖南波恩光电科技有限责任公司 | 一种双斜射非对称车载激光测速装置 |
CN110763872A (zh) * | 2019-11-21 | 2020-02-07 | 中国船舶重工集团公司第七0七研究所 | 一种多普勒测速仪多参数在线标定方法 |
CN111323050A (zh) * | 2020-03-19 | 2020-06-23 | 哈尔滨工程大学 | 一种捷联惯导和多普勒组合系统标定方法 |
Non-Patent Citations (1)
Title |
---|
崔耀星;汤建勋;聂晓明;: "激光多普勒测速仪在线标定算法", 传感器与微系统, no. 01 * |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114609407A (zh) * | 2022-03-16 | 2022-06-10 | 苏州邈航科技有限公司 | 基于mems陀螺仪的水平测速仪及其测速方法 |
CN114609407B (zh) * | 2022-03-16 | 2024-02-06 | 苏州邈航科技有限公司 | 基于mems陀螺仪的水平测速仪及其测速方法 |
CN115979263A (zh) * | 2023-03-21 | 2023-04-18 | 中国人民解放军国防科技大学 | 一种低空飞行载体导航方法及系统 |
Also Published As
Publication number | Publication date |
---|---|
CN113092822B (zh) | 2023-11-10 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN108180925B (zh) | 一种里程计辅助车载动态对准方法 | |
CN110926468B (zh) | 基于传递对准的动中通天线多平台航姿确定方法 | |
CN112798021B (zh) | 基于激光多普勒测速仪的惯导系统行进间初始对准方法 | |
CN115585826B (zh) | 多惯导旋转调制光纤陀螺标度因数误差自校正方法与装置 | |
CN112595350B (zh) | 一种惯导系统自动标定方法及终端 | |
CN113092822B (zh) | 一种基于惯组的激光多普勒测速仪的在线标定方法和装置 | |
CN111024074B (zh) | 一种基于递推最小二乘参数辨识的惯导速度误差确定方法 | |
CN111006675A (zh) | 基于高精度重力模型的车载激光惯导系统自标定方法 | |
CN114812545A (zh) | 基于双激光多普勒测速仪和惯导系统组合导航方法及装置 | |
CN113566850B (zh) | 惯性测量单元的安装角度标定方法、装置和计算机设备 | |
CN111207734B (zh) | 一种基于ekf的无人机组合导航方法 | |
CN110940357B (zh) | 一种用于旋转惯导单轴自对准的内杆臂标定方法 | |
CN113074757A (zh) | 车载惯导安装误差角的标定方法 | |
CN115900705A (zh) | 一种紧耦合陆地组合导航方法、装置、计算机设备和介质 | |
CN115856922A (zh) | 一种松耦合陆地组合导航方法、装置、计算机设备和介质 | |
CN114019954B (zh) | 航向安装角标定方法、装置、计算机设备和存储介质 | |
CN114111840B (zh) | 一种基于组合导航的dvl误差参数在线标定方法 | |
CN114001730A (zh) | 融合定位方法、装置、计算机设备和存储介质 | |
CN114264304A (zh) | 复杂动态环境高精度水平姿态测量方法与系统 | |
CN116222619B (zh) | 一种双惯导系统外场协同在线标定方法 | |
CN114526734B (zh) | 用于车载组合导航的安装角补偿方法 | |
CN116242397B (zh) | 一种速度误差修正模型下的双惯导协同标定方法 | |
CN113758502B (zh) | 组合导航处理方法及装置 | |
CN115291266B (zh) | 基于信息滤波算法的卫星惯性紧组合实时导航定位方法 | |
CN113566849A (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 |