CN111007553A - 被测对象的导航方法、装置、计算机设备和存储介质 - Google Patents
被测对象的导航方法、装置、计算机设备和存储介质 Download PDFInfo
- Publication number
- CN111007553A CN111007553A CN201911141071.2A CN201911141071A CN111007553A CN 111007553 A CN111007553 A CN 111007553A CN 201911141071 A CN201911141071 A CN 201911141071A CN 111007553 A CN111007553 A CN 111007553A
- Authority
- CN
- China
- Prior art keywords
- measured object
- motion state
- state quantity
- difference
- measured
- 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
Images
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
- 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
- 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/40—Correcting position, velocity or attitude
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Computer Networks & Wireless Communication (AREA)
- Automation & Control Theory (AREA)
- Navigation (AREA)
Abstract
本申请涉及一种被测对象的导航方法、装置、计算机设备和存储介质。所述方法包括:获取所述被测对象的预估状态差异;所述预估状态差异为所述被测对象在当前时刻的预估运动状态量与所述被测对象在前一时刻的优化后运动状态量之间的差异;获取所述被测对象的测量状态差异;所述测量状态差异为所述被测对象在当前时刻的测量运动状态量与所述被测对象在前一时刻的测量运动状态量之间的差异;根据所述预估状态差异与所述测量状态差异,对所述被测对象在当前时刻的预估运动状态量进行优化,得到所述被测对象在当前时刻的优化后运动状态量;所述被测对象在当前时刻的优化后运动状态量用于对所述被测对象进行导航。采用本方法能够提高导航精度。
Description
技术领域
本申请涉及导航技术领域,特别是涉及一种被测对象的导航方法、装置、计算机设备和存储介质。
背景技术
随着智能化的发展,工业自动化、无人机、机器人、自动驾驶等领域对动态载体实时三维位置和姿态感知有了更高的要求,单一传感器难以满足不同应用环境的使用需求。惯性/卫星(INS/GNSS)组合导航渐渐成为普遍认为最佳的组合导航方式。
然而,在使用惯性/卫星组合导航的过程中,常常会面临载体振动、室外信号遮挡及多路径效应等受扰工况,这往往会影响到惯性/卫星组合导航不能保证在任意环境下的导航精度。
因此,现有技术中的导航方法存在导航精度不高的问题。
发明内容
基于此,有必要针对现有技术导航精度不高的问题,提供一种能够提高导航精度的一种被测对象的导航方法、装置、计算机设备和存储介质。
一种被测对象的导航方法,所述方法包括:
获取所述被测对象的预估状态差异;所述预估状态差异为所述被测对象在当前时刻的预估运动状态量与所述被测对象在前一时刻的优化后运动状态量之间的差异;
获取所述被测对象的测量状态差异;所述测量状态差异为所述被测对象在当前时刻的测量运动状态量与所述被测对象在前一时刻的测量运动状态量之间的差异;
根据所述预估状态差异与所述测量状态差异,确定所述被测对象在当前时刻的测量运动状态量的可靠程度,并根据所述可靠程度对所述被测对象在当前时刻的预估运动状态量进行优化,得到所述被测对象在当前时刻的优化后运动状态量;所述被测对象在当前时刻的优化后运动状态量用于对所述被测对象进行导航。
在其中一个实施例中,所述根据所述预估状态差异与所述测量状态差异,确定所述被测对象在当前时刻的测量运动状态量的可靠程度,并根据所述可靠程度对所述被测对象在当前时刻的预估运动状态量进行优化,得到所述被测对象在当前时刻的优化后运动状态量,包括:
获取所述预估状态差异对应的预估状态差值,以及,获取所述测量状态差异对应的测量状态差值;
计算所述测量状态差值与所述预估状态差值之间的第一差值,并将所述第一差值的绝对值作为状态优化参数;所述状态优化参数为用于表征所述被测对象在当前时刻的测量运动状态量的可靠程度;
根据所述状态优化参数,对所述被测对象在当前时刻的预估运动状态量进行优化,得到所述被测对象在当前时刻的优化后运动状态量。
在其中一个实施例中,所述获取所述预估状态差异对应的预估状态差值,包括:
获取所述被测对象在当前时刻的预估运动状态量;以及,获取所述被测对象在前一时刻的优化后运动状态量;
计算所述被测对象在当前时刻的预估运动状态量与所述被测对象在前一时刻的优化后运动状态量之间的差值,得到所述预估状态差值。
在其中一个实施例中,所述获取所述测量状态差异对应的测量状态差值,包括:
获取所述被测对象在当前时刻的测量运动状态量,以及,获取所述被测对象在前一时刻的测量运动状态量;
计算所述被测对象在当前时刻的测量运动状态量与所述被测对象在前一时刻的测量运动状态量之间的差值,得到所述测量状态差值。
在其中一个实施例中,所述根据所述状态优化参数,对所述被测对象在当前时刻的预估运动状态量进行优化,得到所述被测对象在当前时刻的优化后运动状态量,包括:
获取状态优化阈值;
判断所述状态优化参数是否大于所述状态优化阈值;
若否,则使用所述被测对象在当前时刻的测量运动状态量,对所述被测对象在当前时刻的预估运动状态量进行优化,得到所述被测对象在当前时刻的优化后运动状态量。
在其中一个实施例中,当所述状态优化参数大于所述状态优化阈值时,还包括:
将所述被测对象在当前时刻的预估运动状态量,作为所述被测对象在当前时刻的优化后运动状态量。
在其中一个实施例中,所述使用所述被测对象在当前时刻的测量运动状态量,对所述被测对象在当前时刻的预估运动状态量进行优化,得到所述被测对象在当前时刻的优化后运动状态量,包括:
获取所述被测对象在当前时刻的卡尔曼增益;
根据所述卡尔曼增益和所述被测对象在当前时刻的测量运动状态量,对所述被测对象在当前时刻的预估运动状态量进行更新,得到所述被测对象在当前时刻的优化后运动状态量。
一种被测对象的导航装置,所述装置包括:
第一获取模块,用于获取所述被测对象的预估状态差异;所述预估状态差异为所述被测对象在当前时刻的预估运动状态量与所述被测对象在前一时刻的优化后运动状态量之间的差异;
第二获取模块,用于获取所述被测对象的测量状态差异;所述测量状态差异为所述被测对象在当前时刻的测量运动状态量与所述被测对象在前一时刻的测量运动状态量之间的差异;
优化模块,用于根据所述预估状态差异与所述测量状态差异,确定所述被测对象在当前时刻的测量运动状态量的可靠程度,并根据所述可靠程度对所述被测对象在当前时刻的预估运动状态量进行优化,得到所述被测对象在当前时刻的优化后运动状态量;所述被测对象在当前时刻的优化后运动状态量用于对所述被测对象进行导航。
一种计算机设备,包括存储器和处理器,所述存储器存储有计算机程序,所述处理器执行所述计算机程序时实现以下步骤:
获取所述被测对象的预估状态差异;所述预估状态差异为所述被测对象在当前时刻的预估运动状态量与所述被测对象在前一时刻的优化后运动状态量之间的差异;
获取所述被测对象的测量状态差异;所述测量状态差异为所述被测对象在当前时刻的测量运动状态量与所述被测对象在前一时刻的测量运动状态量之间的差异;
根据所述预估状态差异与所述测量状态差异,确定所述被测对象在当前时刻的测量运动状态量的可靠程度,并根据所述可靠程度对所述被测对象在当前时刻的预估运动状态量进行优化,得到所述被测对象在当前时刻的优化后运动状态量;所述被测对象在当前时刻的优化后运动状态量用于对所述被测对象进行导航。
一种计算机可读存储介质,其上存储有计算机程序,所述计算机程序被处理器执行时实现以下步骤:
获取所述被测对象的预估状态差异;所述预估状态差异为所述被测对象在当前时刻的预估运动状态量与所述被测对象在前一时刻的优化后运动状态量之间的差异;
获取所述被测对象的测量状态差异;所述测量状态差异为所述被测对象在当前时刻的测量运动状态量与所述被测对象在前一时刻的测量运动状态量之间的差异;
根据所述预估状态差异与所述测量状态差异,确定所述被测对象在当前时刻的测量运动状态量的可靠程度,并根据所述可靠程度对所述被测对象在当前时刻的预估运动状态量进行优化,得到所述被测对象在当前时刻的优化后运动状态量;所述被测对象在当前时刻的优化后运动状态量用于对所述被测对象进行导航。
上述一种被测对象的导航方法、装置、计算机设备和存储介质,通过获取被测对象的测量状态差异和被测对象的预估状态差异;其中,预估状态差异为被测对象在当前时刻的预估运动状态量与被测对象在前一时刻的优化后运动状态量之间的差异;测量状态差异为被测对象在当前时刻的测量运动状态量与被测对象在前一时刻的测量运动状态量之间的差异;并通过对预估状态差异与测量状态差异进行比对,及时且高效地分辨出被测对象当前是否处于干扰工况下,进而确定被测对象在当前时刻测得的测量运动状态量的可靠程度,通过根据该可靠程度对被测对象在当前时刻的预估运动状态量进行相适应地优化,得到用于对被测对象进行导航的当前时刻的优化后运动状态量,提高在干扰环境下对被测对象的导航定位精度与导航定位鲁棒性。
附图说明
图1为一个实施例中一种被测对象的导航方法的应用环境图;
图2为一个实施例中一种被测对象的导航方法的流程示意图;
图3为另一个实施例中一种被测对象的导航方法的流程示意图;
图4为一个实施例中一种被测对象的导航方法的逻辑框图;
图5A为一个实施例中一种被测对象的导航方法的被测对象水平运动轨迹示意图;
图5B为一个实施例中一种被测对象的导航方法的被测对象水平运动轨迹局部放大图;
图6为一个实施例中一种被测对象的导航装置的结构框图;
图7为一个实施例中计算机设备的内部结构图。
具体实施方式
为了使本申请的目的、技术方案及优点更加清楚明白,以下结合附图及实施例,对本申请进行进一步详细说明。应当理解,此处描述的具体实施例仅仅用以解释本申请,并不用于限定本申请。
本申请提供的一种被测对象的导航方法,可以应用于如图1所示的应用环境中。其中,服务器110获取所述被测对象的预估状态差异;所述预估状态差异为所述被测对象在当前时刻的预估运动状态量与所述被测对象在前一时刻的优化后运动状态量之间的变化差异。然后,服务器110获取被测对象的测量状态差异;测量状态差异为被测对象在当前时刻的测量运动状态量与被测对象在前一时刻的测量运动状态量之间的变化差异;最后,服务器110根据预估状态差异与测量状态差异,确定被测对象在当前时刻的测量运动状态量的可靠程度,并根据可靠程度对被测对象在当前时刻的预估运动状态量进行优化,得到被测对象在当前时刻的优化后运动状态量;被测对象在当前时刻的优化后运动状态量用于对被测对象进行导航。实际应用中,服务器110可以但不限于是各种个人计算机、笔记本电脑、智能手机、平板电脑、便携式可穿戴设备、嵌入式平台、行车电脑、独立的服务器或者是多个服务器组成的服务器集群来实现。
在一个实施例中,如图2所示,提供了一种被测对象的导航方法,包括以下步骤:
S210,获取被测对象的预估状态差异。
其中,被测对象可以是指需要确定运动状态的对象。实际应用中,被测对象可以是无人机、机器人、自动驾驶汽车等。
其中,预估状态差异为被测对象在当前时刻的预估运动状态量与被测对象在前一时刻的优化后运动状态量之间的差异。
其中,运动状态量可以是指用于表征被测对象所处的运动状态的状态量。实际应用中,运动状态量可以是被测对象的航姿、速度、位置等。
其中,当前时刻的预估运动状态量可以是指使用被测对象在前一时刻(K-1)的优化后运动状态量对被测对象在当前时刻(K)的运动状态量进行预估而得到的运动状态量。
需要说明的是,前一时刻与当前时刻可以为相邻的两个采样点。
具体地,服务器110可以使用状态方程,根据被测对象在前一时刻。的优化后运动状态量对被测对象在当前时刻。的运动状态量进行预估而得到的运动状态量。
实际应用中,预估运动状态量也可以命名为先验估计值。优化后运动状态量也可以命名为后验估计值。
实际应用中,服务器110获取被测对象的预估状态差异,即服务器110获取被测对象在当前时刻的预估运动状态量与被测对象在前一时刻的优化后运动状态量之间的差异。
S220,获取被测对象的测量状态差异。
其中,测量状态差异为被测对象在当前时刻的测量运动状态量与被测对象在前一时刻的测量运动状态量之间的差异。
其中,测量运动状态量可以是对被测对象进行测量得到的运动状态量。实际应用中,测量运动状态量也可以命名为观测量。
具体实现中,服务器110获取被测对象的测量状态差异,即服务器110获取被测对象在当前时刻的测量运动状态量与被测对象在前一时刻的测量运动状态量之间的差异。
S230,根据预估状态差异与测量状态差异,确定被测对象在当前时刻的测量运动状态量的可靠程度,并根据可靠程度对被测对象在当前时刻的预估运动状态量进行优化,得到被测对象在当前时刻的优化后运动状态量。
其中,被测对象在当前时刻的优化后运动状态量用于对被测对象进行导航。
具体实现中,服务器110通过对预估状态差异与测量状态差异进行比较,服务器110先前得到的被测对象在当前时刻的测量运动状态量的可靠程度;然后,服务器110在根据该可靠程度,确定是否需要使用被测对象在当前时刻的测量运动状态量,对服务器110预估得到的被测对象在当前时刻的预估运动状态量进行优化和更新,进而得到被测对象在当前时刻的优化后运动状态量,如此服务器110可以使用当前时刻的优化后运动状态量对被测对象进行导航。
例如,当服务器110使用INS/GNSS(惯性/卫星)组合导航法对被测对象进行导航时,服务器110根据INS对被测对象的运动状态量进行估计,确定被测对象在当前时刻的预估运动状态量与被测对象在前一时刻的优化后运动状态量之间的差异;以及,根据GNSS对被测对象的运动状态量进行测量,确定被测对象在当前时刻的测量运动状态量与被测对象在前一时刻的测量运动状态量之间的差异。
然后,服务器110根据预估状态差异与测量状态差异,确定通过GNSS测得的被测对象在当前时刻的测量运动状态量的可靠程度,进而确定是否需要使用通过GNSS测得的被测对象在当前时刻的测量运动状态量,对服务器110通过INS预估得到的被测对象在当前时刻的预估运动状态量进行优化和更新,进而得到被测对象在当前时刻的优化后运动状态量。
上述被测对象的导航方法中,通过获取被测对象的测量状态差异和被测对象的预估状态差异;其中,预估状态差异为被测对象在当前时刻的预估运动状态量与被测对象在前一时刻的优化后运动状态量之间的差异;测量状态差异为被测对象在当前时刻的测量运动状态量与被测对象在前一时刻的测量运动状态量之间的差异;并通过对预估状态差异与测量状态差异进行比对,及时且高效地分辨出被测对象当前是否处于干扰工况下,进而确定被测对象在当前时刻的测量运动状态量的可靠程度,通过根据该可靠程度对被测对象在当前时刻的预估运动状态量进行相适应地优化,得到用于对被测对象进行导航的当前时刻的优化后运动状态量,提高在干扰环境下对被测对象的导航定位精度与导航定位鲁棒性。
在另一个实施例中,根据预估状态差异与测量状态差异,确定被测对象在当前时刻的测量运动状态量的可靠程度,并根据可靠程度对被测对象在当前时刻的预估运动状态量进行优化,得到被测对象在当前时刻的优化后运动状态量,包括:获取预估状态差异对应的预估状态差值,以及,获取测量状态差异对应的测量状态差值;计算测量状态差值与预估状态差值之间的第一差值,并将第一差值的绝对值作为状态优化参数;状态优化参数为用于表征被测对象在当前时刻的测量运动状态量的可靠程度;根据状态优化参数,对被测对象在当前时刻的预估运动状态量进行优化,得到被测对象在当前时刻的优化后运动状态量。
其中,预估状态差值可以是指被测对象在当前时刻的预估运动状态量与被测对象在前一时刻的优化后运动状态量之间的差值。
其中,测量状态差值可以是指被测对象在当前时刻的测量运动状态量与被测对象在前一时刻的测量运动状态量之间的差值。
其中,状态优化参数用于表征被测对象在当前时刻的测量运动状态量的可靠程度。
具体实现中,服务器110在根据预估状态差异与测量状态差异,确定被测对象在当前时刻的测量运动状态量的可靠程度,并根据可靠程度对被测对象在当前时刻的预估运动状态量进行优化,得到被测对象在当前时刻的优化后运动状态量,具体包括:服务器110获取预估状态差异对应的预估状态差值,以及,获取测量状态差异对应的测量状态差值;然后,服务器110计算测量状态差值与预估状态差值之间的第一差值,并将第一差值的绝对值作为用于表征被测对象在当前时刻的测量运动状态量的可靠程度的状态优化参数。最后,服务器110根据状态优化参数,对被测对象在当前时刻的预估运动状态量进行优化,得到被测对象在当前时刻的优化后运动状态量。
例如,服务器110可以状态优化参数的大小,判断测得的被测对象在当前时刻的测量运动状态量的可靠程度;若状态优化参数大于预设的阈值,判定此时存在GNSS信号遮挡、多路径或载体振动较严重等干扰情况,所测得的被测对象在当前时刻的测量运动状态量的可靠程度低,若用测得的被测对象在当前时刻的测量运动状态量对被测对象在当前时刻的预估运动状态量进行优化,不能准确地得到被测对象在当前时刻的优化后运动状态量;因此,服务器110直接将被测对象在当前时刻的预估运动状态量,作为被测对象在当前时刻的优化后运动状态量,即将被测对象在当前时刻的后验估计值置为先验预估值,可以获得更加准确地短时估计效果。
若状态优化参数小于预设的阈值,则认为环境干扰的影响在卡尔曼滤波噪声模型中被评估较为充分,继续依照卡尔曼增益及测得的被测对象在当前时刻的测量运动状态量即当前时刻的观测值完成卡尔曼滤波迭代,得到被测对象在当前时刻的优化后运动状态量即针对被测对象最优状态的后验估计值。
本实施例的技术方案,通过获取预估状态差异对应的预估状态差值,以及,获取测量状态差异对应的测量状态差值;并计算测量状态差值与预估状态差值之间的第一差值,并将第一差值的绝对值作为用于表征被测对象在当前时刻的测量运动状态量的可靠程度的状态优化参数;通过根据状态优化参数,准确地分辨出被测对象当前是否处于干扰工况下,进而对被测对象在当前时刻的预估运动状态量进行相适应地优化,从而准确地得到用于对被测对象进行导航的当前时刻的优化后运动状态量,提高在干扰环境下对被测对象的导航定位精度与导航定位鲁棒性。
在另一个实施例中,获取预估状态差异对应的预估状态差值,包括:获取被测对象在当前时刻的预估运动状态量;以及,获取被测对象在前一时刻的优化后运动状态量;计算被测对象在当前时刻的预估运动状态量与被测对象在前一时刻的优化后运动状态量之间的差值,得到预估状态差值。
具体实现中,服务器110在获取预估状态差异对应的预估状态差值的过程中,具体包括:服务器110获取被测对象在当前时刻的预估运动状态量,以及,服务器110获取被测对象在前一时刻的优化后运动状态量;然后,服务器110计算被测对象在当前时刻的预估运动状态量与被测对象在前一时刻的优化后运动状态量之间的差值,得到预估状态差值。
其中,预估状态差值可以为X_d=X'(k)-X(k-1);
其中,X'(k)为当前时刻的预估运动状态量;X(k-1)为前一时刻的优化后运动状态量;X_d为预估状态差值。
本实施例的技术方案,通过计算被测对象在当前时刻的预估运动状态量与被测对象在前一时刻的优化后运动状态量之间的差值,准确地得到预估状态差值,进而可以在后续得到准确地状态优化参数,并根据该状态优化参数准确地分辨出被测对象当前是否处于干扰工况下,进而对被测对象在当前时刻的预估运动状态量进行相适应地优化,从而准确地得到用于对被测对象进行导航的当前时刻的优化后运动状态量,提高在干扰环境下对被测对象的导航定位精度与导航定位鲁棒性。
在另一个实施例中,获取测量状态差异对应的测量状态差值,包括:获取被测对象在当前时刻的测量运动状态量,以及,获取被测对象在前一时刻的测量运动状态量;计算被测对象在当前时刻的测量运动状态量与被测对象在前一时刻的测量运动状态量之间的差值,得到测量状态差值。
具体实现中,服务器110在获取测量状态差异对应的测量状态差值的过程中,具体包括:服务器110获取被测对象在当前时刻的测量运动状态量,以及,服务器110获取被测对象在前一时刻的测量运动状态量;然后,服务器110计算被测对象在当前时刻的测量运动状态量与被测对象在前一时刻的测量运动状态量之间的差值,得到测量状态差值。
其中,测量状态差值可以为Z_d=Z(k)-Z(k-1);
其中,Z(k)为当前时刻的测量运动状态量;Z(k-1)为前一时刻的测量运动状态量;Z_d为预估状态差值。
本实施例的技术方案,通过计算被测对象在当前时刻的测量运动状态量与被测对象在前一时刻的测量运动状态量之间的差值,准确地得到测量状态差值,进而可以在后续得到准确地状态优化参数,并根据该状态优化参数准确地分辨出被测对象当前是否处于干扰工况下,进而对被测对象在当前时刻的预估运动状态量进行相适应地优化,从而准确地得到用于对被测对象进行导航的当前时刻的优化后运动状态量,提高在干扰环境下对被测对象的导航定位精度与导航定位鲁棒性。
在另一个实施例中,根据状态优化参数,对被测对象在当前时刻的预估运动状态量进行优化,得到被测对象在当前时刻的优化后运动状态量,包括:获取状态优化阈值;判断状态优化参数是否大于状态优化阈值;若否,则使用被测对象在当前时刻的测量运动状态量,对被测对象在当前时刻的预估运动状态量进行优化,得到被测对象在当前时刻的优化后运动状态量。
具体实现中,服务器110根据状态优化参数,对被测对象在当前时刻的预估运动状态量进行优化,得到被测对象在当前时刻的优化后运动状态量的过程中,具体包括:获取状态优化阈值;判断状态优化参数是否大于状态优化阈值;若否,则说明环境干扰的影响在卡尔曼滤波噪声模型中被评估较为充分,继续依照卡尔曼增益及被测对象在当前时刻的测量运动状态量即当前时刻的观测值完成原卡尔曼滤波迭代,得到被测对象在当前时刻的优化后运动状态量即当前时刻的后验估计值X(k)。
实际应用中,本领域的技术人员可以使用上述方法并进行充分测试各干扰环境下的组合导航效果,进而得到上述的状态优化阈值,状态优化阈值的具体数值,在此不作进一步限定。
需要说明的是,当服务器110使用被测对象在当前时刻的测量运动状态量,对被测对象在当前时刻的预估运动状态量进行优化,得到被测对象在当前时刻的优化后运动状态量之后,服务器110对当前时刻的误差协方差进行更新。
本实施例的技术方案,通过获取状态优化阈值;判断状态优化参数是否大于状态优化阈值;准确地分辨出被测对象当前是否处于干扰工况下;若否,则说明环境干扰的影响在卡尔曼滤波噪声模型中被评估较为充分,继续依照卡尔曼增益及被测对象在当前时刻的测量运动状态量即当前时刻的观测值完成原卡尔曼滤波迭代,得到高精度的当前时刻的优化后运动状态量,进而提高在干扰环境下对被测对象的导航定位精度。
在另一个实施例中,当状态优化参数大于状态优化阈值时,还包括:将被测对象在当前时刻的预估运动状态量,作为被测对象在当前时刻的优化后运动状态量。
具体实现中,当状态优化参数大于状态优化阈值时,则服务器110判定此时存在量测信号遮挡、多路径或载体振动较严重等干扰情况,所测得的被测对象在当前时刻的测量运动状态量的可靠程度低,若用测得的被测对象在当前时刻的测量运动状态量对被测对象在当前时刻的预估运动状态量进行优化,不能准确地得到被测对象在当前时刻的优化后运动状态量;因此,服务器110直接将被测对象在当前时刻的预估运动状态量,作为被测对象在当前时刻的优化后运动状态量,即将,认为观测量偏离量测模型较严重,而直接取后验估计值X(k)为先验估计值X'(k),以短时依靠状态推算来限制误差的扩大或发散。
需要说明的是,当服务器110将被测对象在当前时刻的预估运动状态量,作为被测对象在当前时刻的优化后运动状态量之后,服务器110对当前时刻的误差协方差进行更新。
本实施例的技术方案,当状态优化参数大于状态优化阈值时,则判定此时存在量测信号遮挡、多路径或载体振动较严重等干扰情况,所测得的被测对象在当前时刻的测量运动状态量的可靠程度低,通过直接将被测对象在当前时刻的预估运动状态量,作为被测对象在当前时刻的优化后运动状态量以短时依靠状态推算来限制误差的扩大或发散,可以提高在干扰环境下对被测对象的导航定位精度。
在另一个实施例中,使用被测对象在当前时刻的测量运动状态量,对被测对象在当前时刻的预估运动状态量进行优化,得到被测对象在当前时刻的优化后运动状态量,包括:获取被测对象在当前时刻的卡尔曼增益;根据卡尔曼增益和被测对象在当前时刻的测量运动状态量,对被测对象在当前时刻的预估运动状态量进行更新,得到被测对象在当前时刻的优化后运动状态量。
具体实现中,服务器110在使用被测对象在当前时刻的测量运动状态量,对被测对象在当前时刻的预估运动状态量进行优化,得到被测对象在当前时刻的优化后运动状态量的过程中,具体包括:服务器110获取被测对象在当前时刻的卡尔曼增益;根据卡尔曼增益和被测对象在当前时刻的测量运动状态量,对被测对象在当前时刻的预估运动状态量进行更新,得到被测对象在当前时刻的优化后运动状态量。
其中,当前时刻的优化后运动状态量X(k)=X'(k)+K(Z(k)-HX'(k));
其中,K为当前时刻的卡尔曼增益;Z(k)为当前时刻的测量运动状态量;X'(k)为当前时刻的预估运动状态量;H为误差。
本实施例的技术方案,通过获取被测对象在当前时刻的卡尔曼增益;根据卡尔曼增益和被测对象在当前时刻的测量运动状态量,对被测对象在当前时刻的预估运动状态量进行更新,得到被测对象在当前时刻的优化后运动状态量,从而得到高精度的当前时刻的优化后运动状态量,进而提高在干扰环境下对被测对象的导航定位精度。
在另一个实施例中,如图3所示,提供了一种被测对象的导航方法,包括以下步骤:
S310,获取所述被测对象在当前时刻的预估运动状态量;以及,获取所述被测对象在前一时刻的优化后运动状态量。
S320,计算所述被测对象在当前时刻的预估运动状态量与所述被测对象在前一时刻的优化后运动状态量之间的差值,得到所述预估状态差值。
S330,获取所述被测对象在当前时刻的测量运动状态量,以及,获取所述被测对象在前一时刻的测量运动状态量。
S340,计算所述被测对象在当前时刻的测量运动状态量与所述被测对象在前一时刻的测量运动状态量之间的差值,得到所述测量状态差值。
S350,计算所述测量状态差值与所述预估状态差值之间的第一差值,并将所述第一差值的绝对值作为状态优化参数;所述状态优化参数为用于表征所述被测对象在当前时刻的测量运动状态量的可靠程度。
S360,获取状态优化阈值。
S370,判断所述状态优化参数是否大于所述状态优化阈值。
S380,若否,则获取所述被测对象在当前时刻的卡尔曼增益。
S390,根据所述卡尔曼增益和所述被测对象在当前时刻的测量运动状态量,对所述被测对象在当前时刻的预估运动状态量进行更新,得到所述被测对象在当前时刻的优化后运动状态量。
上述步骤的具体限定可以参见上文对一种被测对象的导航方法的具体限定,在此不再赘述。
上述的一种被测对象的导航方法,可以及时且高效地分辨出被测对象当前是否处于干扰工况下,进而可以对被测对象在当前时刻的预估运动状态量进行相适应地优化,得到用于对被测对象进行导航的当前时刻的优化后运动状态量,提高在干扰环境下对被测对象的导航定位精度与导航定位鲁棒性。
应该理解的是,虽然图2和图3的流程图中的各个步骤按照箭头的指示依次显示,但是这些步骤并不是必然按照箭头指示的顺序依次执行。除非本文中有明确的说明,这些步骤的执行并没有严格的顺序限制,这些步骤可以以其它的顺序执行。而且,图2和图3中的至少一部分步骤可以包括多个子步骤或者多个阶段,这些子步骤或者阶段并不必然是在同一时刻执行完成,而是可以在不同的时刻执行,这些子步骤或者阶段的执行顺序也不必然是依次进行,而是可以与其它步骤或者其它步骤的子步骤或者阶段的至少一部分轮流或者交替地执行。
为了便于本领域技术人员的理解,图4提供了一种被测对象的导航方法的逻辑框图;其中,迭代开始;首先;获取前一时刻的状态量X(k-1)和前一时刻的观测量Z(k-1);获取先验估计值X'(k)和当前时刻的观测量Z(k);计算测量状态差值Z_d=Z(k)-Z(k-1)和计算预估状态差值X_d=X'(k)-X(k-1);计算状态优化参数D=|Z_d-X_d|;判断状态优化参数是否大于状态优化阈值;若是,则使用卡尔曼增益计算后验估计值;若否,则将先验估计值置为后验估计值。最后,更新误差协方差结束本次迭代,返回迭代开始的步骤。如此,可以及时且高效地分辨出被测对象当前是否处于干扰工况下,进而可以对被测对象在当前时刻的预估运动状态量进行相适应地优化,得到用于对被测对象进行导航的当前时刻的优化后运动状态量,提高在干扰环境下对被测对象的导航定位精度与导航定位鲁棒性。
为了便于本领域技术人员的理解,图5A提供了一种被测对象的导航方法的被测对象水平运动轨迹示意图;图5B提供了一种被测对象的导航方法的被测对象水平运动轨迹局部放大图;其中,轨迹环形区域为卫星遮挡区域;可见,与普通卡尔曼滤波算法相比,本改进卡尔曼滤波算法在未遮挡区域无明显区别;而在GNSS信号遮挡区域,则对定位精度和平滑性有明显的改善。其中遮挡区域放大图如图5B所示,GNSS信号遮挡严重时,虚线表示的普通卡尔曼滤波方法定位误差显著增大,最大误差超过10米,且存在局部发散的问题;而如实线所示,经修正后的改进卡尔曼滤波方法依然能获取较高精度且较平滑的定位效果,不存在收敛问题。
在一个实施例中,如图6所示,提供了一种被测对象的导航装置,包括:
第一获取模块610,用于获取所述被测对象的预估状态差异;所述预估状态差异为所述被测对象在当前时刻的预估运动状态量与所述被测对象在前一时刻的优化后运动状态量之间的差异;
第二获取模块620,用于获取所述被测对象的测量状态差异;所述测量状态差异为所述被测对象在当前时刻的测量运动状态量与所述被测对象在前一时刻的测量运动状态量之间的差异;
优化模块630,用于根据所述预估状态差异与所述测量状态差异,确定所述被测对象在当前时刻的测量运动状态量的可靠程度,并根据所述可靠程度对所述被测对象在当前时刻的预估运动状态量进行优化,得到所述被测对象在当前时刻的优化后运动状态量;所述被测对象在当前时刻的优化后运动状态量用于对所述被测对象进行导航。
上述的一种被测对象的导航装置,通过获取被测对象的测量状态差异和被测对象的预估状态差异;其中,预估状态差异为被测对象在当前时刻的预估运动状态量与被测对象在前一时刻的优化后运动状态量之间的差异;测量状态差异为被测对象在当前时刻的测量运动状态量与被测对象在前一时刻的测量运动状态量之间的差异;并通过对预估状态差异与测量状态差异进行比对,及时且高效地分辨出被测对象当前是否处于干扰工况下,进而确定被测对象在当前时刻的测量运动状态量的可靠程度,通过根据该可靠程度对被测对象在当前时刻的预估运动状态量进行相适应地优化,得到用于对被测对象进行导航的当前时刻的优化后运动状态量,提高在干扰环境下对被测对象的导航定位精度与导航定位鲁棒性。
在其中一个实施例中,上述的优化模块630,包括:
获取子模块,用于获取所述预估状态差异对应的预估状态差值,以及,获取所述测量状态差异对应的测量状态差值;
计算子模块,用于计算所述测量状态差值与所述预估状态差值之间的第一差值,并将所述第一差值的绝对值作为状态优化参数;所述状态优化参数为用于表征所述被测对象在当前时刻的测量运动状态量的可靠程度;
优化子模块,用于根据所述状态优化参数,对所述被测对象在当前时刻的预估运动状态量进行优化,得到所述被测对象在当前时刻的优化后运动状态量。
在其中一个实施例中,上述的获取子模块,具体用于获取所述被测对象在当前时刻的预估运动状态量;以及,获取所述被测对象在前一时刻的优化后运动状态量;计算所述被测对象在当前时刻的预估运动状态量与所述被测对象在前一时刻的优化后运动状态量之间的差值,得到所述预估状态差值。
在其中一个实施例中,上述的获取子模块,具体用于获取所述被测对象在当前时刻的测量运动状态量,以及,获取所述被测对象在前一时刻的测量运动状态量;计算所述被测对象在当前时刻的测量运动状态量与所述被测对象在前一时刻的测量运动状态量之间的差值,得到所述测量状态差值。
在其中一个实施例中,上述的优化子模块,具体用于获取状态优化阈值;判断所述状态优化参数是否大于所述状态优化阈值;若否,则使用所述被测对象在当前时刻的测量运动状态量,对所述被测对象在当前时刻的预估运动状态量进行优化,得到所述被测对象在当前时刻的优化后运动状态量。
在其中一个实施例中,当所述状态优化参数大于所述状态优化阈值时,上述的优化子模块,具体还用于将所述被测对象在当前时刻的预估运动状态量,作为所述被测对象在当前时刻的优化后运动状态量。
在其中一个实施例中,上述的优化子模块,具体还用于获取所述被测对象在当前时刻的卡尔曼增益;根据所述卡尔曼增益和所述被测对象在当前时刻的测量运动状态量,对所述被测对象在当前时刻的预估运动状态量进行更新,得到所述被测对象在当前时刻的优化后运动状态量。
关于一种被测对象的导航装置的具体限定可以参见上文中对于一种被测对象的导航方法的限定,在此不再赘述。上述一种被测对象的导航装置中的各个模块可全部或部分通过软件、硬件及其组合来实现。上述各模块可以硬件形式内嵌于或独立于计算机设备中的处理器中,也可以以软件形式存储于计算机设备中的存储器中,以便于处理器调用执行以上各个模块对应的操作。
在一个实施例中,提供了一种计算机设备,该计算机设备可以是服务器,其内部结构图可以如图7所示。该计算机设备包括通过系统总线连接的处理器、存储器、网络接口和数据库。其中,该计算机设备的处理器用于提供计算和控制能力。该计算机设备的存储器包括非易失性存储介质、内存储器。该非易失性存储介质存储有操作系统、计算机程序和数据库。该内存储器为非易失性存储介质中的操作系统和计算机程序的运行提供环境。该计算机设备的数据库用于存储被测对象的导航数据。该计算机设备的网络接口用于与外部的终端通过网络连接通信。该计算机程序被处理器执行时以实现一种被测对象的导航方法。
本领域技术人员可以理解,图7中示出的结构,仅仅是与本申请方案相关的部分结构的框图,并不构成对本申请方案所应用于其上的计算机设备的限定,具体的计算机设备可以包括比图中所示更多或更少的部件,或者组合某些部件,或者具有不同的部件布置。
在一个实施例中,提供了一种计算机设备,包括存储器和处理器,存储器中存储有计算机程序,该处理器执行计算机程序时实现以下步骤:
S210,获取所述被测对象的预估状态差异;所述预估状态差异为所述被测对象在当前时刻的预估运动状态量与所述被测对象在前一时刻的优化后运动状态量之间的差异;
S220,获取所述被测对象的测量状态差异;所述测量状态差异为所述被测对象在当前时刻的测量运动状态量与所述被测对象在前一时刻的测量运动状态量之间的差异;
S230,根据所述预估状态差异与所述测量状态差异,确定所述被测对象在当前时刻的测量运动状态量的可靠程度,并根据所述可靠程度对所述被测对象在当前时刻的预估运动状态量进行优化,得到所述被测对象在当前时刻的优化后运动状态量;所述被测对象在当前时刻的优化后运动状态量用于对所述被测对象进行导航。
在一个实施例中,处理器执行计算机程序时还实现以下步骤:获取所述预估状态差异对应的预估状态差值,以及,获取所述测量状态差异对应的测量状态差值;计算所述测量状态差值与所述预估状态差值之间的第一差值,并将所述第一差值的绝对值作为状态优化参数;所述状态优化参数为用于表征所述被测对象在当前时刻的测量运动状态量的可靠程度;根据所述状态优化参数,对所述被测对象在当前时刻的预估运动状态量进行优化,得到所述被测对象在当前时刻的优化后运动状态量。
在一个实施例中,处理器执行计算机程序时还实现以下步骤:获取所述被测对象在当前时刻的预估运动状态量;以及,获取所述被测对象在前一时刻的优化后运动状态量;计算所述被测对象在当前时刻的预估运动状态量与所述被测对象在前一时刻的优化后运动状态量之间的差值,得到所述预估状态差值。
在一个实施例中,处理器执行计算机程序时还实现以下步骤:获取所述被测对象在当前时刻的测量运动状态量,以及,获取所述被测对象在前一时刻的测量运动状态量;计算所述被测对象在当前时刻的测量运动状态量与所述被测对象在前一时刻的测量运动状态量之间的差值,得到所述测量状态差值。
在一个实施例中,处理器执行计算机程序时还实现以下步骤:获取状态优化阈值;判断所述状态优化参数是否大于所述状态优化阈值;若否,则使用所述被测对象在当前时刻的测量运动状态量,对所述被测对象在当前时刻的预估运动状态量进行优化,得到所述被测对象在当前时刻的优化后运动状态量。
在一个实施例中,处理器执行计算机程序时还实现以下步骤:将所述被测对象在当前时刻的预估运动状态量,作为所述被测对象在当前时刻的优化后运动状态量。
在一个实施例中,处理器执行计算机程序时还实现以下步骤:获取所述被测对象在当前时刻的卡尔曼增益;根据所述卡尔曼增益和所述被测对象在当前时刻的测量运动状态量,对所述被测对象在当前时刻的预估运动状态量进行更新,得到所述被测对象在当前时刻的优化后运动状态量。
在一个实施例中,提供了一种计算机可读存储介质,其上存储有计算机程序,计算机程序被处理器执行时实现以下步骤:
S210,获取所述被测对象的预估状态差异;所述预估状态差异为所述被测对象在当前时刻的预估运动状态量与所述被测对象在前一时刻的优化后运动状态量之间的差异;
S220,获取所述被测对象的测量状态差异;所述测量状态差异为所述被测对象在当前时刻的测量运动状态量与所述被测对象在前一时刻的测量运动状态量之间的差异;
S230,根据所述预估状态差异与所述测量状态差异,确定所述被测对象在当前时刻的测量运动状态量的可靠程度,并根据所述可靠程度对所述被测对象在当前时刻的预估运动状态量进行优化,得到所述被测对象在当前时刻的优化后运动状态量;所述被测对象在当前时刻的优化后运动状态量用于对所述被测对象进行导航。
在一个实施例中,计算机程序被处理器执行时还实现以下步骤:获取所述预估状态差异对应的预估状态差值,以及,获取所述测量状态差异对应的测量状态差值;计算所述测量状态差值与所述预估状态差值之间的第一差值,并将所述第一差值的绝对值作为状态优化参数;所述状态优化参数为用于表征所述被测对象在当前时刻的测量运动状态量的可靠程度;根据所述状态优化参数,对所述被测对象在当前时刻的预估运动状态量进行优化,得到所述被测对象在当前时刻的优化后运动状态量。
在一个实施例中,计算机程序被处理器执行时还实现以下步骤:获取所述被测对象在当前时刻的预估运动状态量;以及,获取所述被测对象在前一时刻的优化后运动状态量;计算所述被测对象在当前时刻的预估运动状态量与所述被测对象在前一时刻的优化后运动状态量之间的差值,得到所述预估状态差值。
在一个实施例中,计算机程序被处理器执行时还实现以下步骤:获取所述被测对象在当前时刻的测量运动状态量,以及,获取所述被测对象在前一时刻的测量运动状态量;计算所述被测对象在当前时刻的测量运动状态量与所述被测对象在前一时刻的测量运动状态量之间的差值,得到所述测量状态差值。
在一个实施例中,计算机程序被处理器执行时还实现以下步骤:获取状态优化阈值;判断所述状态优化参数是否大于所述状态优化阈值;若否,则使用所述被测对象在当前时刻的测量运动状态量,对所述被测对象在当前时刻的预估运动状态量进行优化,得到所述被测对象在当前时刻的优化后运动状态量。
在一个实施例中,计算机程序被处理器执行时还实现以下步骤:将所述被测对象在当前时刻的预估运动状态量,作为所述被测对象在当前时刻的优化后运动状态量。
在一个实施例中,计算机程序被处理器执行时还实现以下步骤:获取所述被测对象在当前时刻的卡尔曼增益;根据所述卡尔曼增益和所述被测对象在当前时刻的测量运动状态量,对所述被测对象在当前时刻的预估运动状态量进行更新,得到所述被测对象在当前时刻的优化后运动状态量。
本领域普通技术人员可以理解实现上述实施例方法中的全部或部分流程,是可以通过计算机程序来指令相关的硬件来完成,所述的计算机程序可存储于一非易失性计算机可读取存储介质中,该计算机程序在执行时,可包括如上述各方法的实施例的流程。其中,本申请所提供的各实施例中所使用的对存储器、存储、数据库或其它介质的任何引用,均可包括非易失性和/或易失性存储器。非易失性存储器可包括只读存储器(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 (10)
1.一种被测对象的导航方法,其特征在于,所述方法包括:
获取所述被测对象的预估状态差异;所述预估状态差异为所述被测对象在当前时刻的预估运动状态量与所述被测对象在前一时刻的优化后运动状态量之间的差异;
获取所述被测对象的测量状态差异;所述测量状态差异为所述被测对象在当前时刻的测量运动状态量与所述被测对象在前一时刻的测量运动状态量之间的差异;
根据所述预估状态差异与所述测量状态差异,确定所述被测对象在当前时刻的测量运动状态量的可靠程度,并根据所述可靠程度对所述被测对象在当前时刻的预估运动状态量进行优化,得到所述被测对象在当前时刻的优化后运动状态量;所述被测对象在当前时刻的优化后运动状态量用于对所述被测对象进行导航。
2.根据权利要求1所述的方法,其特征在于,所述根据所述预估状态差异与所述测量状态差异,确定所述被测对象在当前时刻的测量运动状态量的可靠程度,并根据所述可靠程度对所述被测对象在当前时刻的预估运动状态量进行优化,得到所述被测对象在当前时刻的优化后运动状态量,包括:
获取所述预估状态差异对应的预估状态差值,以及,获取所述测量状态差异对应的测量状态差值;
计算所述测量状态差值与所述预估状态差值之间的第一差值,并将所述第一差值的绝对值作为状态优化参数;所述状态优化参数为用于表征所述被测对象在当前时刻的测量运动状态量的可靠程度;
根据所述状态优化参数,对所述被测对象在当前时刻的预估运动状态量进行优化,得到所述被测对象在当前时刻的优化后运动状态量。
3.根据权利要求2所述的方法,其特征在于,所述获取所述预估状态差异对应的预估状态差值,包括:
获取所述被测对象在当前时刻的预估运动状态量;以及,获取所述被测对象在前一时刻的优化后运动状态量;
计算所述被测对象在当前时刻的预估运动状态量与所述被测对象在前一时刻的优化后运动状态量之间的差值,得到所述预估状态差值。
4.根据权利要求2所述的方法,其特征在于,所述获取所述测量状态差异对应的测量状态差值,包括:
获取所述被测对象在当前时刻的测量运动状态量,以及,获取所述被测对象在前一时刻的测量运动状态量;
计算所述被测对象在当前时刻的测量运动状态量与所述被测对象在前一时刻的测量运动状态量之间的差值,得到所述测量状态差值。
5.根据权利要求2所述的方法,其特征在于,所述根据所述状态优化参数,对所述被测对象在当前时刻的预估运动状态量进行优化,得到所述被测对象在当前时刻的优化后运动状态量,包括:
获取状态优化阈值;
判断所述状态优化参数是否大于所述状态优化阈值;
若否,则使用所述被测对象在当前时刻的测量运动状态量,对所述被测对象在当前时刻的预估运动状态量进行优化,得到所述被测对象在当前时刻的优化后运动状态量。
6.根据权利要求5所述的方法,其特征在于,当所述状态优化参数大于所述状态优化阈值时,还包括:
将所述被测对象在当前时刻的预估运动状态量,作为所述被测对象在当前时刻的优化后运动状态量。
7.根据权利要求5所述的方法,其特征在于,所述使用所述被测对象在当前时刻的测量运动状态量,对所述被测对象在当前时刻的预估运动状态量进行优化,得到所述被测对象在当前时刻的优化后运动状态量,包括:
获取所述被测对象在当前时刻的卡尔曼增益;
根据所述卡尔曼增益和所述被测对象在当前时刻的测量运动状态量,对所述被测对象在当前时刻的预估运动状态量进行更新,得到所述被测对象在当前时刻的优化后运动状态量。
8.一种被测对象的导航装置,其特征在于,所述装置包括:
第一获取模块,用于获取所述被测对象的预估状态差异;所述预估状态差异为所述被测对象在当前时刻的预估运动状态量与所述被测对象在前一时刻的优化后运动状态量之间的差异;
第二获取模块,用于获取所述被测对象的测量状态差异;所述测量状态差异为所述被测对象在当前时刻的测量运动状态量与所述被测对象在前一时刻的测量运动状态量之间的差异;
优化模块,用于根据所述预估状态差异与所述测量状态差异,确定所述被测对象在当前时刻的测量运动状态量的可靠程度,并根据所述可靠程度对所述被测对象在当前时刻的预估运动状态量进行优化,得到所述被测对象在当前时刻的优化后运动状态量;所述被测对象在当前时刻的优化后运动状态量用于对所述被测对象进行导航。
9.一种计算机设备,包括存储器和处理器,所述存储器存储有计算机程序,其特征在于,所述处理器执行所述计算机程序时实现权利要求1至7中任一项所述方法的步骤。
10.一种计算机可读存储介质,其上存储有计算机程序,其特征在于,所述计算机程序被处理器执行时实现权利要求1至7中任一项所述的方法的步骤。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201911141071.2A CN111007553B (zh) | 2019-11-20 | 2019-11-20 | 被测对象的导航方法、装置、计算机设备和存储介质 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201911141071.2A CN111007553B (zh) | 2019-11-20 | 2019-11-20 | 被测对象的导航方法、装置、计算机设备和存储介质 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN111007553A true CN111007553A (zh) | 2020-04-14 |
CN111007553B CN111007553B (zh) | 2022-01-04 |
Family
ID=70113182
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201911141071.2A Active CN111007553B (zh) | 2019-11-20 | 2019-11-20 | 被测对象的导航方法、装置、计算机设备和存储介质 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN111007553B (zh) |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102506857A (zh) * | 2011-11-28 | 2012-06-20 | 北京航空航天大学 | 一种基于双imu/dgps组合的相对姿态测量实时动态滤波方法 |
CN104459747A (zh) * | 2014-12-19 | 2015-03-25 | 北京临近空间飞艇技术开发有限公司 | 一种gnss/ins组合导航方法及系统 |
CN108957495A (zh) * | 2018-05-03 | 2018-12-07 | 广州中海达卫星导航技术股份有限公司 | Gnss与mimu组合导航方法 |
CN109946723A (zh) * | 2019-03-07 | 2019-06-28 | 深圳开阳电子股份有限公司 | 一种自适应扩展卡尔曼跟踪方法、装置及存储介质 |
-
2019
- 2019-11-20 CN CN201911141071.2A patent/CN111007553B/zh active Active
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102506857A (zh) * | 2011-11-28 | 2012-06-20 | 北京航空航天大学 | 一种基于双imu/dgps组合的相对姿态测量实时动态滤波方法 |
CN104459747A (zh) * | 2014-12-19 | 2015-03-25 | 北京临近空间飞艇技术开发有限公司 | 一种gnss/ins组合导航方法及系统 |
CN108957495A (zh) * | 2018-05-03 | 2018-12-07 | 广州中海达卫星导航技术股份有限公司 | Gnss与mimu组合导航方法 |
CN109946723A (zh) * | 2019-03-07 | 2019-06-28 | 深圳开阳电子股份有限公司 | 一种自适应扩展卡尔曼跟踪方法、装置及存储介质 |
Non-Patent Citations (2)
Title |
---|
廖锐: "复杂动态环境中导航接收机卡尔曼解算技术实现及优化", 《中国优秀硕士学位论文全文数据库信息科技辑》 * |
范双菲 等: "基于SINS/CNS组合导航系统的多模型自适应估计算法", 《深空探测学报》 * |
Also Published As
Publication number | Publication date |
---|---|
CN111007553B (zh) | 2022-01-04 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US10852139B2 (en) | Positioning method, positioning device, and robot | |
CN108332758B (zh) | 一种移动机器人的走廊识别方法及装置 | |
CN108957466B (zh) | 移动机器人的雷达数据补偿方法、装置、设备和存储介质 | |
CN111208492A (zh) | 车载激光雷达外参标定方法及装置、计算机设备及存储介质 | |
CN111060125B (zh) | 碰撞检测方法、装置、计算机设备和存储介质 | |
CN113108791A (zh) | 一种导航定位方法及导航定位设备 | |
CN111578928B (zh) | 一种基于多源融合定位系统的定位方法及装置 | |
CN111637877B (zh) | 机器人定位方法、装置、电子设备和非易失性存储介质 | |
US11874666B2 (en) | Self-location estimation method | |
CN111707294B (zh) | 基于最优区间估计的行人导航零速区间检测方法和装置 | |
CN114264301A (zh) | 车载多传感器融合定位方法、装置、芯片及终端 | |
CN111678513A (zh) | 一种超宽带/惯导紧耦合的室内定位装置与系统 | |
CN109769206B (zh) | 一种室内定位融合方法、装置、存储介质及终端设备 | |
CN114593735A (zh) | 一种位姿预测方法及装置 | |
CN114323007A (zh) | 一种载体运动状态估计方法及装置 | |
CN111007553B (zh) | 被测对象的导航方法、装置、计算机设备和存储介质 | |
CN110824496B (zh) | 运动估计方法、装置、计算机设备和存储介质 | |
CN109945864B (zh) | 室内行车定位融合方法、装置、存储介质及终端设备 | |
CN114001730B (zh) | 融合定位方法、装置、计算机设备和存储介质 | |
CN109459769A (zh) | 一种自主定位方法与系统 | |
CN114019954B (zh) | 航向安装角标定方法、装置、计算机设备和存储介质 | |
CN115540854A (zh) | 一种基于uwb辅助的主动定位方法、设备和介质 | |
CN111060127B (zh) | 车辆起点定位方法、装置、计算机设备和存储介质 | |
CN117015719A (zh) | 用于确定刚体的运动状态的方法 | |
CN114245459B (zh) | 基于pdr模型的融合定位方法、装置、计算机设备及介质 |
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 |