CN115164888B - 一种误差修正方法、装置、电子设备和存储介质 - Google Patents
一种误差修正方法、装置、电子设备和存储介质 Download PDFInfo
- Publication number
- CN115164888B CN115164888B CN202211081446.2A CN202211081446A CN115164888B CN 115164888 B CN115164888 B CN 115164888B CN 202211081446 A CN202211081446 A CN 202211081446A CN 115164888 B CN115164888 B CN 115164888B
- Authority
- CN
- China
- Prior art keywords
- error
- determining
- velocity
- carrier
- undamped
- 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
- 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
- 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
本申请公开了一种误差修正方法、装置、电子设备和存储介质。具体包括:获取载体的加速度计信息和陀螺仪信息,以及载体的无阻尼误差模型和有阻尼误差模型;对加速度计信息和陀螺仪信息进行惯性解算,确定载体的无阻尼速度和内阻尼速度;根据载体的无阻尼误差模型和有阻尼误差模型,确定载体的传递函数状态量;根据无阻尼速度、内阻尼速度和传递函数状态量,确定载体的误差值;根据误差值,修正载体的惯导系统的导航参数。本方案高效且准确的计算出误差值,并对导航参数进行修正,有效的降低了长航时惯导系统在水平阻尼工作状态中的各类误差波动,进一步提高了惯导系统的导航精度。
Description
技术领域
本申请涉及惯性导航技术领域,尤其涉及一种误差修正方法、装置、电子设备和存储介质。
背景技术
惯性导航系统(简称惯导)是一种不依赖于外部信息、也不向外部辐射能量的自主式导航系统。其工作环境不仅包括空中、地面,还可以在水下。惯导系统被广泛的应用于航海、航空等领域。
在船舶的长航状态下,惯导系统经惯性解算,在惯性元件误差的激励下会产生导航误差,导航过程的导航误差按波动周期可以分为舒拉周期误差、傅科周期误差、地球自转周期误差。积累的导航误差会严重影响船舶的正常行驶,降低导航准确度,使惯导系统的适用性较差,因此需要对导航误差进行纠正。
发明内容
本申请提供了一种误差修正方法、装置、电子设备和存储介质,以提高惯导系统的导航精确度和适用性。
根据本申请的一方面,提供了一种误差修正方法,所述方法包括:
获取载体的加速度计信息和陀螺仪信息,以及载体的无阻尼误差模型和有阻尼误差模型;
对加速度计信息和陀螺仪信息进行惯性解算,确定载体的无阻尼速度和内阻尼速度;
根据载体的无阻尼误差模型和有阻尼误差模型,确定载体的传递函数状态量;
根据无阻尼速度、内阻尼速度和传递函数状态量,确定载体的误差值;
根据误差值,修正载体的惯导系统的导航参数。
根据本申请的另一方面,提供了一种误差修正装置,包括:
信息和模型获取模块,用于获取载体的加速度计信息和陀螺仪信息,以及载体的无阻尼误差模型和有阻尼误差模型;
惯性解算模块,用于对加速度计信息和陀螺仪信息进行惯性解算,确定载体的无阻尼速度和内阻尼速度;
状态量确定模块,用于根据载体的无阻尼误差模型和有阻尼误差模型,确定载体的传递函数状态量;
误差值确定模块,用于根据无阻尼速度、内阻尼速度和传递函数状态量,确定载体的误差值;
导航参数修正模块,用于根据误差值,修正载体的惯导系统的导航参数。
根据本申请的另一方面,提供了一种电子设备,所述电子设备包括:
至少一个处理器;以及
与所述至少一个处理器通信连接的存储器;其中,
所述存储器存储有可被所述至少一个处理器执行的计算机程序,所述计算机程序被所述至少一个处理器执行,以使所述至少一个处理器能够执行本申请任一实施例所述的误差修正方法。
根据本申请的另一方面,提供了一种计算机可读存储介质,所述计算机可读存储介质存储有计算机指令,所述计算机指令用于使处理器执行时实现本申请任一实施例所述的误差修正方法。
本申请实施例的技术方案,高效且准确的计算出误差值,并对导航参数进行修正,有效的降低了长航时惯导系统在水平阻尼工作状态中的各类误差波动,进一步提高了惯导系统的导航精度。
应当理解,本部分所描述的内容并非旨在标识本申请的实施例的关键或重要特征,也不用于限制本申请的范围。本申请的其它特征将通过以下的说明书而变得容易理解。
附图说明
为了更清楚地说明本申请实施例中的技术方案,下面将对实施例描述中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图仅仅是本申请的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图获得其他的附图。
图1A是根据本申请实施例一提供的一种误差修正方法的流程图;
图1B是根据本申请实施例一提供的惯导系统的东向通道误差信号传递流程图;
图1C是根据本申请实施例一提供的东向通道阻尼网络误差信号传递流程图;
图1D是根据本申请实施例一提供的机动条件下内阻尼误差信号传递流程图;
图2是根据本申请实施例二提供的一种误差修正装置的结构示意图;
图3是实现本申请实施例的误差修正方法的电子设备的结构示意图。
具体实施方式
为了使本技术领域的人员更好地理解本申请方案,下面将结合本申请实施例中的附图,对本申请实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅仅是本申请一部分的实施例,而不是全部的实施例。基于本申请中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都应当属于本申请保护的范围。
需要说明的是,本申请的说明书和权利要求书及上述附图中的术语“第一”、“第二”等是用于区别类似的对象,而不必用于描述特定的顺序或先后次序。应该理解这样使用的数据在适当情况下可以互换,以便这里描述的本申请的实施例能够以除了在这里图示或描述的那些以外的顺序实施。此外,术语“包括”和“具有”以及他们的任何变形,意图在于覆盖不排他的包含,例如,包含了一系列步骤或单元的过程、方法、系统、产品或设备不必限于清楚地列出的那些步骤或单元,而是可包括没有清楚地列出的或对于这些过程、方法、产品或设备固有的其它步骤或单元。
实施例一
图1A为本申请实施例一提供了一种误差修正方法的流程图,本实施例可适用于长航时惯导系统误差抑制的情况,该方法可以由误差修正装置来执行,该装置可以采用硬件和/或软件的形式实现,该误差修正装置可配置于电子设备中。如图1A所示,该方法包括:
S110、获取载体的加速度计信息和陀螺仪信息,以及载体的无阻尼误差模型和有阻尼误差模型。
其中,载体可以是任何能够装载惯导系统的载具,例如可以包括但不限于船舶、飞机和车辆等。加速度计信息可以是设置于载体惯导系统中的加速度计反馈的加速度信息,该加速度信息可以包括任何方向的加速度,例如船舶行驶中的东西方向加速度和/或南北方向的加速度等。陀螺仪信息可以是设置于载体上的陀螺仪输出的数据信息。加速度计信息和陀螺仪信息可以直接通过设置于载体上的仪器(传感器等)直接获取得到。
此外,无阻尼误差模型和有阻尼误差模型是在航海航行等领域用于研究载体的速
度信号中携带的误差传递的常规方法,无阻尼误差模型和有阻尼误差模型不随载体的变化
而变化。载体的无阻尼误差模型可以表示为图1B所示,本申请实施例以水平通道的无阻尼
结算误差模型为例,由于水平通道中,东向通道的误差传递与北向通道的误差传递的形式
与规则相同,因此本申请实施例以东向通道的误差传递为例进行解释说明。设惯导系统所
在地的中立加速度为g,地球半径为R,惯导系统的东向通道误差信号传递流程图如图1B所
示,其中,输入量是东向通道误差值,是北向陀螺漂移量。从图1B可以得到北向水平姿
态误差引起东向水平速度误差的无阻尼模型:
为了抑制惯导系统在自主导航过程中误差的波动,引入阻尼环节使惯导系统自主导航误差波动幅值逐渐减小,从而转化为有阻尼误差模型,如图1C所示,在阻尼环节中可以通过预先设定的比例阻尼参数、积分阻尼参数和微分阻尼参数进行阻尼的控制,如图1C所示,延续前例,增加阻尼环节后的北向水平姿态误差引起东向水平姿态误差的有阻尼误差模型为:
其中,K1为比例阻尼参数,K2为积分阻尼参数,K3为微分阻尼参数。
通过调节不同的预设阻尼参数,可以使上式的传递函数趋于稳定状态,从而使该传递函数的冲击响应曲线逐渐收敛。
在实际航行情况中,长航时惯导系统工作在水平阻尼工作状态可效抑制惯导系统误差波动,提高惯导系统精度。但在载体机动条件下,由于阻尼网络破坏了惯导系统的舒拉回路,会引起响应的误差。并在海上无有效速度信息的条件下,惯导系统由于无法准确计算速度误差,从而无法准确进行水平阻尼,若强制将惯导系统计算得到的载体速度直接反馈到系统中进行水平阻尼,由于载体速度与速度误差之间的较大差异,会引起惯导系统解算的快速发散。惯导系统内阻尼模型如图1D所示,其中,vel为载体速度,该惯导系统的内阻尼模型的传递函数与前述有阻尼误差模型的传递函数通用,本申请实施例在此不作赘述。需要补充说明的是,前述有阻尼误差模型可以理解为无机动条件下(例如船舶相对地球静止)的带有阻尼网络的误差模型;而内阻尼模型则可以理解为机动条件下的带有阻尼网络的误差模型。
S120、对加速度计信息和陀螺仪信息进行惯性解算,确定载体的无阻尼速度和内阻尼速度。
其中,惯性解算可以采用现有技术中任意一种惯性解算方法,本申请实施例对此不作限定。对加速度计信息和陀螺仪信息的解算可以得到载体的无阻尼速度和内阻尼速度。
S130、根据载体的无阻尼误差模型和有阻尼误差模型,确定载体的传递函数状态量。
其中,载体的传递函数状态量可以是无阻尼误差模型和有阻尼误差模型的传递函数中的过程量,这些传递函数状态量可以表征速度值、加速度值和姿态值等等。因此,根据前述步骤获得的无阻尼误差模型和有阻尼误差模型,确定内阻尼状况下载体的惯导系统中的状态量。
S140、根据无阻尼速度、内阻尼速度和传递函数状态量,确定载体的误差值。
载体的误差值可以包括但不限于速度误差、加速度误差和姿态误差等。通过对无阻尼速度、内阻尼速度和传递函数状态量的计算,得出载体的各项误差值。可选的,所述根据无阻尼速度、内阻尼速度和传递函数状态量,确定载体的误差值,可以包括:根据无阻尼速度和内阻尼速度的差,以及传递函数状态量,确定误差值。通过无阻尼速度和内阻尼速度的差来对误差值进行计算,表征了不同阻尼情况的差值对误差的影响。
进一步的,所述根据无阻尼速度和内阻尼速度的差,以及传递函数状态量,确定误差值,可以包括:根据无阻尼速度和内阻尼速度的差,以及传递函数状态量,确定载体的惯导系统的状态方程与量测方程;根据状态方程与量测方程,基于卡尔曼滤波器,确定误差值。
根据各传递函数状态量,可以构建状态方程;根据无阻尼速度和内阻尼速度的差,以及无阻尼速度值本身,可以构建量测方程。状态方程和量测方程作为卡尔曼滤波器的输入,由卡尔曼滤波器进行方程的解算,以确定各传递函数的状态量的值,从而确定状态量中的误差值。
示例性的,根据惯导系统强制阻尼解算相比无阻尼解算的速度误差,通过卡尔曼滤波的方式,估计得到惯导系统由于强制阻尼引起的速度误差,并在强制阻尼解算通道进行输出校正。
具体的,延续前例,根据前述无阻尼误差模型和有阻尼误差模型中的各个传递函数状态量,确定该模型的状态方程为:
该模型的量测方程为:
Z = Hx;
可以理解的是,所述误差值包括姿态误差和速度误差;相应的,所述根据状态方程与量测方程,基于卡尔曼滤波器,确定误差值,可以包括:根据状态方程与量测方程,基于卡尔曼滤波器,分别确定姿态误差和速度误差。
延续前例,根据已知的无阻尼速度与强制内阻尼速度的差,以及无阻尼通道输出的速度值,可以进一步计算x的中各过程量的值,其中即包括姿态误差的值和速度误差的值。
S150、根据误差值,修正载体的惯导系统的导航参数。
根据前述实施方式中确定的姿态误差和速度误差的值,对载体的导航参数进行校正,以减小误差导致的导航不准的问题。
可选的,所述导航参数包括姿态值和速度值;相应的,所述根据误差值,修正载体的惯导系统的导航参数,可以包括:将姿态值与姿态误差的差值,替代姿态值;将速度值与速度误差的差值,替代速度值。
可以理解的是,将惯导系统输出的姿态值减去姿态误差的值,即可得到较为准确的姿态值作为导航参数进行导航;同理,将惯导系统输出的速度值减去速度误差的值,即可得到较为准确的速度值作为导航参数进行导航。
本申请实施例的技术方案中,根据无阻尼速度和内阻尼速度的差值构建量测方程,根据无阻尼模型和有阻尼模型中的状态量构建状态方程,作为卡尔曼滤波器的输入,高效且准确的计算出误差值,并对导航参数进行修正,有效的降低了长航时惯导系统在水平阻尼工作状态中的各类误差波动,进一步提高了惯导系统的导航精度。
实施例二
图2为本申请实施例三提供的一种误差修正装置的结构示意图。如图2所示,该装置200包括:
信息和模型获取模块210,用于获取载体的加速度计信息和陀螺仪信息,以及载体的无阻尼误差模型和有阻尼误差模型;
惯性解算模块220,用于对加速度计信息和陀螺仪信息进行惯性解算,确定载体的无阻尼速度和内阻尼速度;
状态量确定模块230,用于根据载体的无阻尼误差模型和有阻尼误差模型,确定载体的传递函数状态量;
误差值确定模块240,用于根据无阻尼速度、内阻尼速度和传递函数状态量,确定载体的误差值;
导航参数修正模块250,用于根据误差值,修正载体的惯导系统的导航参数。
在一种可选实施方式中,所述误差值确定模块240可以包括:
误差值确定单元,用于根据无阻尼速度和内阻尼速度的差,以及传递函数状态量,确定误差值。
在一种可选实施方式中,所述误差值确定单元可以包括:
系统方程确定子单元,用于根据无阻尼速度和内阻尼速度的差,以及传递函数状态量,确定载体的惯导系统的状态方程与量测方程;
误差确定子单元,用于根据状态方程与量测方程,基于卡尔曼滤波器,确定误差值。
在一种可选实施方式中,所述误差值包括姿态误差和速度误差;相应的,所述误差确定子单元,可以具体用于:
根据状态方程与量测方程,基于卡尔曼滤波器,分别确定姿态误差和速度误差。
在一种可选实施方式中,所述导航参数包括姿态值和速度值;相应的,所述导航参数修正模块250,可以包括:
姿态修正单元,用于将姿态值与姿态误差的差值,替代姿态值;
速度修正单元,用于将速度值与速度误差的差值,替代速度值。
本申请实施例的技术方案中,根据无阻尼速度和内阻尼速度的差值构建量测方程,根据无阻尼模型和有阻尼模型中的状态量构建状态方程,作为卡尔曼滤波器的输入,高效且准确的计算出误差值,并对导航参数进行修正,有效的降低了长航时惯导系统在水平阻尼工作状态中的各类误差波动,进一步提高了惯导系统的导航精度。
本申请实施例所提供的误差修正装置可执行本申请任意实施例所提供的误差修正方法,具备执行各误差修正方法相应的功能模块和有益效果。
实施例三
图3示出了可以用来实施本申请的实施例的电子设备10的结构示意图。电子设备旨在表示各种形式的数字计算机,诸如,膝上型计算机、台式计算机、工作台、个人数字助理、服务器、刀片式服务器、大型计算机、和其它适合的计算机。电子设备还可以表示各种形式的移动装置,诸如,个人数字处理、蜂窝电话、智能电话、可穿戴设备(如头盔、眼镜、手表等)和其它类似的计算装置。本文所示的部件、它们的连接和关系、以及它们的功能仅仅作为示例,并且不意在限制本文中描述的和/或者要求的本申请的实现。
如图3所示,电子设备10包括至少一个处理器11,以及与至少一个处理器11通信连接的存储器,如只读存储器(ROM)12、随机访问存储器(RAM)13等,其中,存储器存储有可被至少一个处理器执行的计算机程序,处理器11可以根据存储在只读存储器(ROM)12中的计算机程序或者从存储单元18加载到随机访问存储器(RAM)13中的计算机程序,来执行各种适当的动作和处理。在RAM 13中,还可存储电子设备10操作所需的各种程序和数据。处理器11、ROM 12以及RAM 13通过总线14彼此相连。输入/输出(I/O)接口15也连接至总线14。
电子设备10中的多个部件连接至I/O接口15,包括:输入单元16,例如键盘、鼠标等;输出单元17,例如各种类型的显示器、扬声器等;存储单元18,例如磁盘、光盘等;以及通信单元19,例如网卡、调制解调器、无线通信收发机等。通信单元19允许电子设备10通过诸如因特网的计算机网络和/或各种电信网络与其他设备交换信息/数据。
处理器11可以是各种具有处理和计算能力的通用和/或专用处理组件。处理器11的一些示例包括但不限于中央处理单元(CPU)、图形处理单元(GPU)、各种专用的人工智能(AI)计算芯片、各种运行机器学习模型算法的处理器、数字信号处理器(DSP)、以及任何适当的处理器、控制器、微控制器等。处理器11执行上文所描述的各个方法和处理,例如误差修正方法。
在一些实施例中,误差修正方法可被实现为计算机程序,其被有形地包含于计算机可读存储介质,例如存储单元18。在一些实施例中,计算机程序的部分或者全部可以经由ROM 12和/或通信单元19而被载入和/或安装到电子设备10上。当计算机程序加载到RAM 13并由处理器11执行时,可以执行上文描述的误差修正方法的一个或多个步骤。备选地,在其他实施例中,处理器11可以通过其他任何适当的方式(例如,借助于固件)而被配置为执行误差修正方法。
本文中以上描述的系统和技术的各种实施方式可以在数字电子电路系统、集成电路系统、场可编程门阵列(FPGA)、专用集成电路(ASIC)、专用标准产品(ASSP)、芯片上系统的系统(SOC)、负载可编程逻辑设备(CPLD)、计算机硬件、固件、软件、和/或它们的组合中实现。这些各种实施方式可以包括:实施在一个或者多个计算机程序中,该一个或者多个计算机程序可在包括至少一个可编程处理器的可编程系统上执行和/或解释,该可编程处理器可以是专用或者通用可编程处理器,可以从存储系统、至少一个输入装置、和至少一个输出装置接收数据和指令,并且将数据和指令传输至该存储系统、该至少一个输入装置、和该至少一个输出装置。
用于实施本申请的方法的计算机程序可以采用一个或多个编程语言的任何组合来编写。这些计算机程序可以提供给通用计算机、专用计算机或其他可编程数据处理装置的处理器,使得计算机程序当由处理器执行时使流程图和/或框图中所规定的功能/操作被实施。计算机程序可以完全在机器上执行、部分地在机器上执行,作为独立软件包部分地在机器上执行且部分地在远程机器上执行或完全在远程机器或服务器上执行。
在本申请的上下文中,计算机可读存储介质可以是有形的介质,其可以包含或存储以供指令执行系统、装置或设备使用或与指令执行系统、装置或设备结合地使用的计算机程序。计算机可读存储介质可以包括但不限于电子的、磁性的、光学的、电磁的、红外的、或半导体系统、装置或设备,或者上述内容的任何合适组合。备选地,计算机可读存储介质可以是机器可读信号介质。机器可读存储介质的更具体示例会包括基于一个或多个线的电气连接、便携式计算机盘、硬盘、随机存取存储器(RAM)、只读存储器(ROM)、可擦除可编程只读存储器(EPROM或快闪存储器)、光纤、便捷式紧凑盘只读存储器(CD-ROM)、光学储存设备、磁储存设备、或上述内容的任何合适组合。
为了提供与用户的交互,可以在电子设备上实施此处描述的系统和技术,该电子设备具有:用于向用户显示信息的显示装置(例如,CRT(阴极射线管)或者LCD(液晶显示器)监视器);以及键盘和指向装置(例如,鼠标或者轨迹球),用户可以通过该键盘和该指向装置来将输入提供给电子设备。其它种类的装置还可以用于提供与用户的交互;例如,提供给用户的反馈可以是任何形式的传感反馈(例如,视觉反馈、听觉反馈、或者触觉反馈);并且可以用任何形式(包括声输入、语音输入或者、触觉输入)来接收来自用户的输入。
可以将此处描述的系统和技术实施在包括后台部件的计算系统(例如,作为数据服务器)、或者包括中间件部件的计算系统(例如,应用服务器)、或者包括前端部件的计算系统(例如,具有图形用户界面或者网络浏览器的用户计算机,用户可以通过该图形用户界面或者该网络浏览器来与此处描述的系统和技术的实施方式交互)、或者包括这种后台部件、中间件部件、或者前端部件的任何组合的计算系统中。可以通过任何形式或者介质的数字数据通信(例如,通信网络)来将系统的部件相互连接。通信网络的示例包括:局域网(LAN)、广域网(WAN)、区块链网络和互联网。
计算系统可以包括客户端和服务器。客户端和服务器一般远离彼此并且通常通过通信网络进行交互。通过在相应的计算机上运行并且彼此具有客户端-服务器关系的计算机程序来产生客户端和服务器的关系。服务器可以是云服务器,又称为云计算服务器或云主机,是云计算服务体系中的一项主机产品,以解决了传统物理主机与VPS服务中,存在的管理难度大,业务扩展性弱的缺陷。
应该理解,可以使用上面所示的各种形式的流程,重新排序、增加或删除步骤。例如,本申请中记载的各步骤可以并行地执行也可以顺序地执行也可以不同的次序执行,只要能够实现本申请的技术方案所期望的结果,本文在此不进行限制。
上述具体实施方式,并不构成对本申请保护范围的限制。本领域技术人员应该明白的是,根据设计要求和其他因素,可以进行各种修改、组合、子组合和替代。任何在本申请的精神和原则之内所作的修改、等同替换和改进等,均应包含在本申请保护范围之内。
Claims (8)
1.一种误差修正方法,其特征在于,所述方法包括:
获取载体的加速度计信息和陀螺仪信息,以及所述载体的无阻尼误差模型和有阻尼误差模型;
对所述加速度计信息和所述陀螺仪信息进行惯性解算,确定所述载体的无阻尼速度和内阻尼速度;
根据所述载体的无阻尼误差模型和有阻尼误差模型,确定所述载体的传递函数状态量;
根据所述无阻尼速度和内阻尼速度的差,以及所述传递函数状态量,确定所述载体的惯导系统的状态方程与量测方程;
根据所述状态方程与所述量测方程,基于卡尔曼滤波器,确定所述误差值;
根据所述误差值,修正所述载体的惯导系统的导航参数;
其中,所述根据所述无阻尼速度和内阻尼速度的差,以及所述传递函数状态量,确定所述载体的惯导系统的状态方程与量测方程,包括:
根据所述无阻尼速度与所述内阻尼速度的差,以及无阻尼通道输出速度值,构建所述量测方程。
2.根据权利要求1所述的方法,其特征在于,所述误差值包括姿态误差和速度误差;相应的,所述根据所述状态方程与所述量测方程,基于卡尔曼滤波器,确定所述误差值,包括:
根据所述状态方程与所述量测方程,基于所述卡尔曼滤波器,分别确定所述姿态误差和所述速度误差。
3.根据权利要求2所述的方法,其特征在于,所述导航参数包括姿态值和速度值;相应的,所述根据所述误差值,修正所述载体的惯导系统的导航参数,包括:
将所述姿态值与所述姿态误差的差值,替代所述姿态值;
将所述速度值与所述速度误差的差值,替代所述速度值。
4.一种误差修正装置,其特征在于,包括:
信息和模型获取模块,用于获取载体的加速度计信息和陀螺仪信息,以及所述载体的无阻尼误差模型和有阻尼误差模型;
惯性解算模块,用于对所述加速度计信息和所述陀螺仪信息进行惯性解算,确定所述载体的无阻尼速度和内阻尼速度;
状态量确定模块,用于根据所述载体的无阻尼误差模型和有阻尼误差模型,确定所述载体的传递函数状态量;
误差值确定模块,用于根据所述无阻尼速度、所述内阻尼速度和所述传递函数状态量,确定所述载体的误差值;
导航参数修正模块,用于根据所述误差值,修正所述载体的惯导系统的导航参数;
其中,所述误差值确定模块包括:
误差值确定单元,用于根据无阻尼速度和内阻尼速度的差,以及传递函数状态量,确定误差值;
所述误差值确定单元包括:
系统方程确定子单元,用于根据无阻尼速度和内阻尼速度的差,以及传递函数状态量,确定载体的惯导系统的状态方程与量测方程;
误差确定子单元,用于根据状态方程与量测方程,基于卡尔曼滤波器,确定误差值;
其中,所述系统方程确定子单元具体用于:根据所述无阻尼速度与所述内阻尼速度的差,以及无阻尼通道输出速度值,构建所述量测方程。
5.根据权利要求4所述的装置,其特征在于,所述误差值确定模块包括:
误差值确定单元,用于根据所述无阻尼速度和内阻尼速度的差,以及所述传递函数状态量,确定所述误差值。
6.根据权利要求5所述的装置,其特征在于,所述误差值确定单元包括:
系统方程确定子单元,用于根据所述无阻尼速度和内阻尼速度的差,以及所述传递函数状态量,确定所述载体的惯导系统的状态方程与量测方程;
误差确定子单元,用于根据所述状态方程与所述量测方程,基于卡尔曼滤波器,确定所述误差值。
7.一种电子设备,其特征在于,所述电子设备包括:
至少一个处理器;以及
与所述至少一个处理器通信连接的存储器;其中,
所述存储器存储有可被所述至少一个处理器执行的计算机程序,所述计算机程序被所述至少一个处理器执行,以使所述至少一个处理器能够执行权利要求1-3中任一项所述的误差修正方法。
8.一种计算机可读存储介质,其特征在于,所述计算机可读存储介质存储有计算机指令,所述计算机指令用于使处理器执行时实现权利要求1-3中任一项所述的误差修正方法。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202211081446.2A CN115164888B (zh) | 2022-09-06 | 2022-09-06 | 一种误差修正方法、装置、电子设备和存储介质 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202211081446.2A CN115164888B (zh) | 2022-09-06 | 2022-09-06 | 一种误差修正方法、装置、电子设备和存储介质 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN115164888A CN115164888A (zh) | 2022-10-11 |
CN115164888B true CN115164888B (zh) | 2022-12-09 |
Family
ID=83481500
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202211081446.2A Active CN115164888B (zh) | 2022-09-06 | 2022-09-06 | 一种误差修正方法、装置、电子设备和存储介质 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN115164888B (zh) |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101696883A (zh) * | 2009-10-29 | 2010-04-21 | 哈尔滨工程大学 | 光纤陀螺捷联惯性导航系统阻尼方法 |
CN107941216A (zh) * | 2017-09-18 | 2018-04-20 | 哈尔滨工程大学 | 一种基于自适应互补滤波的捷联惯导系统外水平阻尼方法 |
CN109115212A (zh) * | 2018-10-30 | 2019-01-01 | 中国船舶重工集团公司第七0七研究所 | 一种惯导系统全范围姿态角提取方法 |
CN112697139A (zh) * | 2020-12-08 | 2021-04-23 | 中国人民解放军海军工程大学 | 光纤陀螺捷联惯导阻尼方法、系统、载体机、终端及应用 |
Family Cites Families (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US6697736B2 (en) * | 2002-02-06 | 2004-02-24 | American Gnc Corporation | Positioning and navigation method and system thereof |
DE102015226365A1 (de) * | 2015-12-21 | 2017-06-22 | Robert Bosch Gmbh | Verfahren zur Messung der Varianz in einem Messsignal, Verfahren zur Datenfusion, Computerprogramm, Maschinenlesbares Speichermedium und Vorrichtung |
CN109470243A (zh) * | 2018-12-18 | 2019-03-15 | 高勇 | 一种基于加计内阻尼的组合导航系统及其导航方法 |
CN111811521A (zh) * | 2020-07-09 | 2020-10-23 | 北京百度网讯科技有限公司 | 定位方法和装置、电子设备、车端设备、自动驾驶汽车 |
CN112066985B (zh) * | 2020-09-22 | 2022-08-09 | 峰飞航空科技(昆山)有限公司 | 一种组合导航系统初始化方法、装置、介质及电子设备 |
-
2022
- 2022-09-06 CN CN202211081446.2A patent/CN115164888B/zh active Active
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101696883A (zh) * | 2009-10-29 | 2010-04-21 | 哈尔滨工程大学 | 光纤陀螺捷联惯性导航系统阻尼方法 |
CN107941216A (zh) * | 2017-09-18 | 2018-04-20 | 哈尔滨工程大学 | 一种基于自适应互补滤波的捷联惯导系统外水平阻尼方法 |
CN109115212A (zh) * | 2018-10-30 | 2019-01-01 | 中国船舶重工集团公司第七0七研究所 | 一种惯导系统全范围姿态角提取方法 |
CN112697139A (zh) * | 2020-12-08 | 2021-04-23 | 中国人民解放军海军工程大学 | 光纤陀螺捷联惯导阻尼方法、系统、载体机、终端及应用 |
Non-Patent Citations (1)
Title |
---|
基于卡尔曼滤波的惯导系统误差阻尼技术研究;吴发超;《中国优秀硕士学位论文全文数据库 工程科技Ⅱ辑》;20180315(第03期);第43-45页 * |
Also Published As
Publication number | Publication date |
---|---|
CN115164888A (zh) | 2022-10-11 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN111721289B (zh) | 自动驾驶中车辆定位方法、装置、设备、存储介质及车辆 | |
US20210206390A1 (en) | Positioning method and apparatus, vehicle device, and autonomous vehicle | |
CN110058288B (zh) | 无人机ins/gnss组合导航系统航向误差修正方法及系统 | |
CN114179825B (zh) | 多传感器融合获取量测值置信度方法及自动驾驶车辆 | |
US20230366680A1 (en) | Initialization method, device, medium and electronic equipment of integrated navigation system | |
CN103557864A (zh) | Mems捷联惯导自适应sckf滤波的初始对准方法 | |
CN116147624B (zh) | 一种基于低成本mems航姿参考系统的船舶运动姿态解算方法 | |
CN112800159A (zh) | 地图数据处理方法及装置 | |
CN115451952A (zh) | 一种故障检测及抗差自适应滤波的多系统组合导航方法和装置 | |
CN111521187B (zh) | 自动驾驶定位组合导航方法、装置、设备及存储介质 | |
CN115164888B (zh) | 一种误差修正方法、装置、电子设备和存储介质 | |
CN115790665B (zh) | 一种陀螺误差补偿方法、装置、电子设备及存储介质 | |
CN115792985A (zh) | 一种车辆定位方法、装置、电子设备、存储介质及车辆 | |
CN115727871A (zh) | 一种轨迹质量检测方法、装置、电子设备和存储介质 | |
CN109459769A (zh) | 一种自主定位方法与系统 | |
CN114199236A (zh) | 定位数据处理的方法、装置、电子设备和自动驾驶车辆 | |
CN114323007A (zh) | 一种载体运动状态估计方法及装置 | |
CN115096304B (zh) | 延时误差修正方法、装置、电子设备和存储介质 | |
CN116295389B (zh) | 一种捷联罗经系统状态平稳切换方法、装置、设备和介质 | |
CN116380056B (zh) | 惯性定位方法、装置、电子设备及存储介质 | |
CN116817928B (zh) | 基于因子图优化的卫导/惯导列车多源融合定位的方法 | |
CN115824225B (zh) | 一种静电陀螺监控器航向误差补偿方法和装置 | |
CN116774263B (zh) | 面向组合导航系统的导航定位方法及装置 | |
CN116358606B (zh) | 惯导系统的初始粗对准方法、装置、设备及介质 | |
CN117889851A (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 |