CN107525504B - 组合导航方法、***及组合导航设备 - Google Patents
组合导航方法、***及组合导航设备 Download PDFInfo
- Publication number
- CN107525504B CN107525504B CN201710785237.9A CN201710785237A CN107525504B CN 107525504 B CN107525504 B CN 107525504B CN 201710785237 A CN201710785237 A CN 201710785237A CN 107525504 B CN107525504 B CN 107525504B
- Authority
- CN
- China
- Prior art keywords
- motion state
- signal
- threshold value
- angle threshold
- deviation angle
- 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
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/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/42—Determining position
- G01S19/48—Determining position by combining or switching between position solutions derived from the satellite radio beacon positioning system and position solutions derived from a further system
- G01S19/49—Determining position by combining or switching between position solutions derived from the satellite radio beacon positioning system and position solutions derived from a further system whereby the further system is an inertial position system, e.g. loosely-coupled
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)
- Position Fixing By Use Of Radio Waves (AREA)
- Navigation (AREA)
Abstract
本发明涉及一种组合导航方法、***及组合导航设备,其中方法包括如下步骤:在惯性导航***定位过程中,获取载体的运动状态信号;根据所述运动状态信号判断所述载体运动的方向偏转角度是否偏离预设的所述方向偏离角度阈值范围;若是,开启全球定位***定位,对当前位置进行校准,并在校准后关闭该全球定位***。通过上述技术方案,能够使得上述组合导航在需要开启全球定位***的时候开启全球定位***进行定位,不需要开启全球定位***的时候及时关闭全球定位***使用惯性导航***进行定位,根据实际需要开启或关闭全球定位***,保证对载体运动定位准确性的同时降低组合导航定位***耗电量,从而达到提高载体设备的续航能力的效果。
Description
技术领域
本发明涉及导航技术领域,特别是涉及一种组合导航方法、组合导航***及组合导航设备。
背景技术
在现有的定位技术中,全球定位***(Global Positioning System,简称GPS)定位能够实现高精度定位,然而不能提供运动载体的姿态信息,且数据更新率低,易受环境干扰。惯性定位导航***(Inertial Navigation System,简称INS)根据载体自身运动信息进行定位而不用依赖外部信息,然而存在随着时间推移定位误差增大的缺点,因此有人提出将两者结合起来,也就是组合导航。
传统的组合导航***,将全球定位***与惯性导航***结合,通过卡尔曼滤波计算组合,解决惯性导航定位误差随时间延续不断增大以及全球定位***导航数据更新率低易受环境干扰的问题,实现高精度导航的目的。
上述组合导航方式,往往需要在导航过程中开启惯性定位导航***的同时长期开启全球定位***,而由于全球定位***耗电量巨大,导致对载体设备的电量消耗巨大,降低了载体设备的续航能力。
发明内容
基于此,有必要针对当前组合导航耗电量大的问题,提供一种组合导航方法和组合导航***。
一种组合导航方法,包括如下步骤:
在惯性导航***定位过程中,获取载体的运动状态信号;
根据预设的方向偏离角度阈值以及所述运动状态信号判断所述载体运动的方向偏转角度是否偏离预设的方向偏离角度阈值范围;
若是,则开启全球定位***定位,对当前位置进行校准,并在校准后关闭该全球定位***。
一种组合导航***,包括:
信号获取模块,用于在惯性导航***定位过程中,获取载体的运动状态信号;
阈值判断模块,用于根据预设的方向偏离角度阈值以及所述运动状态信号判断所述载体运动的方向偏转角度是否偏离预设的方向偏离角度阈值范围;
位置校准模块,用于若所述载体运动的方向偏转角度偏离预设的方向偏离角度阈值范围,则开启全球定位***定位,对当前位置进行校准,并在校准后关闭该全球定位***。
上述组合导航方法和***,在惯性导航***定位过程中,获取载体的运动状态信号,根据所述运动状态信号判断所述载体运动的方向偏转角度是否偏离预设的方向偏离角度阈值范围,当载体运动的方向偏转角度偏离预设的方向偏离角度阈值范围时,开启全球定位***定位,对当前位置进行校准,并在校准后关闭该全球定位***。通过上述技术方案,在惯性导航***定位过程中,能够根据需要开启/关闭全球定位***,保证对载体运动定位准确性的同时降低组合导航定位***耗电量,从而达到提高载体设备的续航能力的效果。
另外,还提供一种组合导航设备。
一种组合导航设备,包括控制器、惯性导航***以及全球定位***;所述控制器分别控制所述惯性导航***和全球定位***进行导航;
所述控制器配置为执行前述任意一项所述的组合导航方法。
上述组合导航设备,在惯性导航***定位过程中,所述全球定位***可根据需求开启或关闭,保证对载体运动定位准确性的同时降低组合导航定位***耗电量,从而达到提高载体设备的续航能力的效果。
附图说明
图1为组合导航方法流程图;
图2为一个实施例的组合导航方法流程图;
图3为一个实施例的方向偏离角度阈值设定流程图;
图4为一个实施例的信号去噪流程图;
图5为组合导航***结构示意图;
图6为一个实施例的组合导航设备结构示意图。
具体实施方式
下面结合附图对本发明的组合导航方法和***的具体实施方式作详细的描述。
参考图1,图1为组合导航方法流程图,所述组合导航方法包括如下步骤:
S101,在惯性导航***定位过程中,获取载体的运动状态信号。
在上述步骤中,所述载体开启惯性导航***进行定位,在惯性导航***定位的过程中,通过惯性导航***实时获取载体的运动状态信号。
在一个可选的实施例中,所述运动状态信号可以包括载体的速度、加速度、姿态和/或方向信号中的至少一种。
在上述实施例中,所述惯性导航实时获取的载体的运动状态信号可以包括速度、加速度、姿态和/或方向信号中的至少一种,通过这些运动状态信号,后续步骤可以根据当前载体的运动状态决定是否开启全球定位***对当前定位进行校准。
S102,根据预设的方向偏离角度阈值以及所述运动状态信号判断所述载体运动的方向偏转角度是否偏离预设的方向偏离角度阈值范围。
在上述步骤中,所述的预设的方向偏离角度阈值是指载体运动过程中方向偏转的角度的上限值,该方向偏离角度阈值的大小可以根据实际情况比如当前载体的运动信号反映的载体当前的运动状态进行设置。
另外,根据惯性导航实时获取的载体的运动状态信号判断当前载体运动的方向偏转角度是否偏离预设的所述方向偏离角度阈值范围,根据该判断决定是否执行步骤S103。
S103,若偏离方向偏离角度阈值范围,则开启全球定位***定位,对当前位置进行校准,并在校准后关闭该全球定位***。
在上述步骤中,当判断所述载体运动的方向偏转角度偏离预设的方向偏离角度阈值范围时,说明此时载体运动方向偏转角度较大,当前载体运动状态不稳定,使用惯性导航***的导航误差较大,则开启全球定位***对载***置进行精确定位,对当前载***置进行校准,完成校准后关闭全球定位***,基于校准后的载***置继续使用惯性导航***进行定位。
进一步的,若未偏离方向偏离角度阈值范围,则可以返回步骤S101,继续开启惯性导航进行定位,并实时获取载体的运动状态信号。上述组合导航方法,在惯性导航***定位过程中,获取载体的运动状态信号,根据所述运动状态信号判断所述载体运动的方向偏转角度是否偏离预设的所述方向偏离角度阈值范围,当载体运动的方向偏转角度偏离预设的所述方向偏离角度阈值范围时,开启全球定位***定位,对当前位置进行校准,并在校准后关闭该全球定位***。
通过上述技术方案,能够使得上述组合导航在需要开启全球定位***的时候开启全球定位***进行定位,不需要开启全球定位***的时候及时关闭全球定位***使用惯性导航***进行定位,根据实际需要开启或关闭全球定位***,保证对载体运动定位准确性的同时降低定位***耗电量,还可以提高组合导航定位***的使用寿命等。
参考图2,图2为一个实施例的组合导航方法流程图,所述组合导航方法包括如下步骤:
S202,在惯性导航***定位过程中,获取载体的运动状态信号。
在上述步骤中,所述载体开启惯性导航***进行定位,在惯性导航***定位的过程中,通过惯性导航***实时获取载体的运动状态信号。
在一个可选的实施例中,所述运动状态信号可以包括载体的速度、加速度、姿态和/或方向信号中的至少一种。
在上述实施例中,所述惯性导航实时获取的载体的运动状态信号可以包括速度、加速度、姿态和/或方向信号中的至少一种,通过这些运动状态信号,后续步骤可以根据当前载体的运动状态决定是否开启全球定位***对当前定位进行校准。
在一个可选的实施例中,在所述在惯性导航***定位过程中,获取载体的运动状态信号的步骤之前,还包括步骤:
S201,在开始导航时,同时开启惯性导航***和全球定位***进行定位;并在定位到载体当前的位置信息后,关闭所述全球定位***。
在上述实施例中,在组合导航开始导航时,开启惯性导航***进行定位,同时开启全球定位***进行定位;并在全球定位***定位到载体当前的位置信息后,关闭所述全球定位***。由于全球定位***能够获得比惯性导航更精准的定位,所以在组合导航开始定位的初始阶段,可以通过开启全球定位***对当前位置进行精确定位获取当前位置,在全球定位***定位到载体当前的位置信息后,关闭所述全球定位***,基于该精确定位的位置信息,运用惯性导航***进行定位。
上述技术方案,运用全球定位***进行初始定位,可以提高组合导航***定位的准确性。
应该说明的是,上述步骤S201是可选择执行的步骤,在某些实施例中,可以选择不执行。
S205,根据预设的方向偏离角度阈值以及所述运动状态信号判断所述载体运动的方向偏转角度是否偏离预设的方向偏离角度阈值范围。
在上述步骤中,所述的预设的方向偏离角度阈值是指载体运动过程中方向偏转的角度的上限值,该方向偏离角度阈值的大小可以根据实际情况比如当前载体的运动信号反映的载体当前的运动状态进行设置。
其中,根据惯性导航实时获取的载体的运动状态信号判断当前载体运动的方向偏转角度是否偏离预设的所述方向偏离角度阈值范围,根据该判断决定是否执行步骤S206。
在一个可选的实施例中,在所述根据预设的方向偏离角度阈值以及所述运动状态信号判断所述载体运动的方向偏转角度是否在所述方向偏离角度阈值范围的步骤之前,还可以包括:
S203,获取所述运动状态信号的信号噪声,根据所述信号噪声设定载体运动的方向偏离角度阈值。
在上述实施例中,所述信号噪声是惯性导航***中的陀螺仪、加速度计在采集信号的过程中必然会存在的信号噪声,而这些信号噪声是随机的,可能由物体的运动状态变化和/或传感器漂移引起。所述预设的方向偏离角度阈值是根据运动状态信号的信号噪声设置的,可以根据当前运动状态信号的信号噪声的大小设置不同的方向偏离角度阈值,使得偏离角度值的设置更灵活,与当前载体的运动状态相匹配,能够有效提高该方向偏离角度阈值起到的判断作用的精准度,更精确地确定开启全球定位***的时机,进一步提高组合导航***导航的准确性。
应该说明的是,上述步骤S203是可选择执行的步骤,在某些实施例中,可以选择不执行。
参考图3,图3为一个实施例的方向偏离角度阈值设定流程图,在一个可选的实施例中,所述获取所述运动状态信号的信号噪声,根据所述信号噪声设定所述载体运动的方向偏离角度阈值的步骤包括:
S2031,对运动状态信号进行小波分解,获取各层的小波信号估算信号噪声;
具体的,所述对运动状态信号进行小波分解的步骤对应的小波分解层数的计算公式可以如下:
N=[log2n]
上式中,N为小波分解层数,n为运动状态信号的长度。
S2032,当信号噪声未超出设定的噪声阈值时,则设置载体运动方向偏离角度阈值为第一方向偏离角度阈值;
S2033,当信号噪声超出设定的噪声阈值时,则设置载体运动方向偏离角度阈值为第二方向偏离角度阈值,其中,第二方向偏离角度阈值小于第一方向偏离角度阈值。
上述实施例,对获取的运动状态信号进行小波分解,得到小波分解层数以及各层的小波信号,通过所述各层的小波信号估算信号噪声,当信号噪声处于正常范围内,未超出设定的噪声阈值时,则将载体运动方向偏离角度阈值设置为正常的第一方向偏离角度阈值,当信号噪声过大,超出设定的噪声阈值时,表明环境因素对惯性导航的精度有较大的影响,则设置一个较小的方向偏离角度阈值,即将载体运动方向偏离角度阈值设置为第二方向偏离角度阈值,其中,第二方向偏离角度阈值小于第一方向偏离角度阈值,从而能够在噪声过大时通过使用较小的方向偏离角度阈值范围对当前物体方向偏离进行更严格的限制,以保证组合导航***的导航精确度。
在一个可选的实施例中,在所述根据预设的方向偏离角度阈值以及所述运动状态信号判断所述载体运动的方向偏转角度是否在所述方向偏离角度阈值范围的步骤之前,还包括步骤:
S204,获取所述运动状态信号的信号噪声,根据所述信号噪声,对运动状态信号进行去噪。
在上述实施例中,在进行方向偏离角度阈值判断之前,对运动状态信号进进行小波分解,得到小波分解层数以及各层的小波信号,通过所述各层的小波信号估算信号噪声,根据估算的信号噪声,对运动状态信号进行去噪。通过上述对运动状态信号去噪的步骤,能够有效去除运动状态信号中由于惯性导航***中的陀螺仪、加速度计在采集信号的过程中,可能由物体的运动状态变化和/或传感器漂移产生的信号噪声,使得去噪后的运动状态信号更精确的反映当前载体的运动状态,从而使得后续在执行根据预设的方向偏离角度阈值以及所述运动状态信号判断所述载体运动的方向偏转角度是否在所述方向偏离角度阈值范围的步骤时获得更精确的判断结果,更精确地确定开启全球定位***的时机,进一步提高组合导航***导航的准确性。
应该说明的是,上述步骤S204是可选择执行的步骤,在某些实施例中,可以选择不执行。
参考图4,图4为一个实施例的信号去噪流程图,在一个可选的实施例中,所述获取所述运动状态信号的信号噪声,根据所述信号噪声,对运动状态信号进行去噪的步骤包括:
S2041,对运动状态信号进行小波分解,获取小波分解层数以及各层的小波信号;
具体的,所述对运动状态信号进行小波分解的步骤对应的小波分解层数的计算公式如下:
N=[log2n]
上式中,N为小波分解层数,n为运动状态信号的长度。
S2042,根据第一层到第N层的小波信号估算噪声标准方差,根据噪声标准方差得到阈值,其中所述阈值的计算公式如下:
上式中,N为小波分解层数,λ为阈值,δn为噪声标准方差;
S2043,将每一层小波信号超出阈值之外的部分置零;
S2044,对第一层到第N层的小波信号进行小波重构,得到去噪后的运动状态信号。
上述实施例,通过对运动状态信号进行小波分解得的小波信号计算信号噪声的噪声标准方差,根据噪声标准方差得到阈值,每层小波信号超出所述阈值的部分为信号噪声部分,将每一层小波信号超出阈值之外的部分置零,以去除所述运动状态信号的噪声,之后再对第一层到第N层的小波信号进行小波重构,得到去噪后的运动状态信号。通过上述对运动状态信号去噪的步骤,能够有效去除运动状态信号中由于惯性导航***中的陀螺仪、加速度计在采集信号的过程中,可能由物体的运动状态变化和/或传感器漂移产生的信号噪声,使得去噪后的运动状态信号更精确的反映当前载体的运动状态,从而使得后续在执行根据预设的方向偏离角度阈值以及所述运动状态信号判断所述载体运动的方向偏转角度是否在所述方向偏离角度阈值范围的步骤时获得更精确的判断结果,更精确地确定开启全球定位***的时机,进一步提高组合导航***导航的准确性。
S206,若偏离预设的方向偏离角度阈值范围,则开启全球定位***定位,对当前位置进行校准,并在校准后关闭该全球定位***。
在上述步骤中,当判断所述载体运动的方向偏转角度偏离预设的所述方向偏离角度阈值范围时,此时载体运动方向偏转角度较大,说明当前载体运动状态不稳定,使用惯性导航***的导航误差较大,则开启全球定位***对载***置进行精确定位,对当前载***置进行校准,完成校准后关闭全球定位***,基于校准后的载***置继续使用惯性导航***进行定位。
进一步的,若未偏离方向偏离角度阈值范围,则可以返回步骤S202,继续开启惯性导航进行定位,并实时获取载体的运动状态信号。
上述组合导航方法,在惯性导航***定位过程中,获取载体的运动状态信号,根据所述运动状态信号判断所述载体运动的方向偏转角度是否偏离预设的所述方向偏离角度阈值范围,当载体运动的方向偏转角度偏离预设的所述方向偏离角度阈值范围时,开启全球定位***定位,对当前位置进行校准,并在校准后关闭该全球定位***。
通过上述技术方案,能够使得上述组合导航在需要开启全球定位***的时候开启全球定位***进行定位,不需要开启全球定位***的时候及时关闭全球定位***使用惯性导航***进行定位,根据实际需要开启或关闭全球定位***,保证对载体运动定位准确性的同时降低定位***耗电量,提高组合导航定位***的使用寿命。
参考图5,图5为组合导航***结构示意图,所述组合导航***包括:
信号获取模块,用于在惯性导航***定位过程中,获取载体的运动状态信号;
阈值判断模块,用于根据预设的方向偏离角度阈值以及所述运动状态信号判断所述载体运动的方向偏转角度是否偏离预设的方向偏离角度阈值范围;
位置校准模块,用于若所述载体运动的方向偏转角度偏离预设的方向偏离角度阈值范围,则开启全球定位***定位,对当前位置进行校准,并在校准后关闭该全球定位***。
上述组合导航***,在惯性导航***定位过程中,获取载体的运动状态信号,根据所述运动状态信号判断所述载体运动的方向偏转角度是否偏离预设的所述方向偏离角度阈值范围,当载体运动的方向偏转角度偏离预设的所述方向偏离角度阈值范围时,开启全球定位***定位,对当前位置进行校准,并在校准后关闭该全球定位***。
通过上述技术方案,能够使得上述组合导航在需要开启全球定位***的时候开启全球定位***进行定位,不需要开启全球定位***的时候及时关闭全球定位***使用惯性导航***进行定位,根据实际需要开启或关闭全球定位***,保证对载体运动定位准确性的同时降低定位***耗电量,提高组合导航定位***的使用寿命。
本发明的组合导航***与本发明的组合导航方法一一对应,在上述组合导航方法的实施例阐述的技术特征及其有益效果均适用于组合导航***的实施例中,特此声明。
参考图6,图6为一个实施例的组合导航设备结构示意图,所述组合导航设备包括控制器、惯性导航***以及全球定位***;所述控制器分别控制所述惯性导航***和全球定位***进行导航;
所述控制器配置为执行前述任意一项所述的组合导航方法的步骤。
上述组合导航设备,惯性导航***对载体进行定位,实时获取载体的运动状态信号,并将载体的运动状态信号发送给控制器,控制器根据接收的运动状态信号判断所述载体运动的方向偏转角度是否偏离预设的方向偏离角度阈值范围,当载体运动的方向偏转角度偏离预设的方向偏离角度阈值范围时,控制器发送开启指令给全球定位***,全球定位***接收开启指令开启全球定位***进行定位,将定位的校准位置信息发送给控制器,并在定位后关闭全球定位***,控制器接收校准位置信息对当前载体的位置信息进行校准,将校准位置信息发送给惯性导航***,惯性导航***接收校准位置信息,基于校准后的位置继续对载体进行定位。
通过上述技术方案,能够使得上述组合导航设备在需要开启全球定位***的时候开启全球定位***进行定位,不需要开启全球定位***的时候及时关闭全球定位***使用惯性导航***进行定位,根据实际需要开启或关闭全球定位***,保证对载体运动定位准确性的同时降低定位***耗电量,提高组合导航设备的使用寿命。
在流程图中表示或在此以其他方式描述的逻辑和/或步骤,例如,可以被认为是用于实现逻辑功能的可执行指令的定序列表,可以具体实现在任何计算机可读介质中,以供指令执行***、装置或设备(如基于计算机的***、包括处理器的***或其他可以从指令执行***、装置或设备取指令并执行指令的***)使用,或结合这些指令执行***、装置或设备而使用。就本说明书而言,“计算机可读介质”可以是任何可以包含、存储、通信、传播或传输程序以供指令执行***、装置或设备或结合这些指令执行***、装置或设备而使用的装置。
计算机可读介质的更具体的示例(非穷尽性列表)包括以下:具有一个或多个布线的电连接部(电子装置),便携式计算机盘盒(磁装置),随机存取存储器(RAM),只读存储器(ROM),可擦除可编辑只读存储器(EPROM或闪速存储器),光纤装置,以及便携式光盘只读存储器(CDROM)。另外,计算机可读介质甚至可以是可在其上打印所述程序的纸或其他合适的介质,因为可以例如通过对纸或其他介质进行光学扫描,接着进行编辑、解译或必要时以其他合适方式进行处理来以电子方式获得所述程序,然后将其存储在计算机存储器中。
应当理解,本发明的各部分可以用硬件、软件、固件或它们的组合来实现。在上述实施方式中,多个步骤或方法可以用存储在存储器中且由合适的指令执行***执行的软件或固件来实现。例如,如果用硬件来实现,和在另一实施方式中一样,可用本领域公知的下列技术中的任一项或他们的组合来实现:具有用于对数据信号实现逻辑功能的逻辑门电路的离散逻辑电路,具有合适的组合逻辑门电路的专用集成电路,可编程门阵列(PGA),现场可编程门阵列(FPGA)等。
在本说明书的描述中,参考术语“一个实施例”、“一些实施例”、“示例”、“具体示例”、或“一些示例”等的描述意指结合该实施例或示例描述的具体特征、结构、材料或者特点包含于本发明的至少一个实施例或示例中。在本说明书中,对上述术语的示意性表述不一定指的是相同的实施例或示例。而且,描述的具体特征、结构、材料或者特点可以在任何的一个或多个实施例或示例中以合适的方式结合。
以上所述实施例的各技术特征可以进行任意的组合,为使描述简洁,未对上述实施例中的各个技术特征所有可能的组合都进行描述,然而,只要这些技术特征的组合不存在矛盾,都应当认为是本说明书记载的范围。
以上所述实施例仅表达了本发明的几种实施方式,其描述较为具体和详细,但并不能因此而理解为对发明专利范围的限制。应当指出的是,对于本领域的普通技术人员来说,在不脱离本发明构思的前提下,还可以做出若干变形和改进,这些都属于本发明的保护范围。因此,本发明专利的保护范围应以所附权利要求为准。
Claims (10)
1.一种组合导航方法,其特征在于,包括如下步骤:
在惯性导航***定位过程中,获取载体的运动状态信号;
根据预设的方向偏离角度阈值以及所述运动状态信号判断所述载体运动的方向偏转角度是否偏离预设的方向偏离角度阈值范围;所述预设的方向偏转角度阈值为所述载体运动过程中方向偏转角度的上限值;
若是,则开启全球定位***定位,对当前位置进行校准,并在校准后关闭所述全球定位***;
在根据预设的方向偏离角度阈值以及所述运动状态信号判断所述载体运动的方向偏转角度是否偏离预设的方向偏离角度阈值范围的步骤之前,还包括步骤:
获取所述运动状态信号的信号噪声,根据所述信号噪声设定所述载体运动的方向偏离角度阈值;
所述获取所述运动状态信号的信号噪声,根据所述信号噪声设定所述载体运动的方向偏离角度阈值的步骤包括:
对运动状态信号进行小波分解,获取各层的小波信号估算信号噪声;
当信号噪声未超出设定的噪声阈值时,则设置载体运动方向偏离角度阈值为第一方向偏离角度阈值;
当信号噪声超出设定的噪声阈值时,则设置载体运动方向偏离角度阈值为第二方向偏离角度阈值,其中,第二方向偏离角度阈值小于第一方向偏离角度阈值。
2.根据权利要求1所述的组合导航方法,其特征在于,在所述在惯性导航***定位过程中,获取载体的运动状态信号的步骤之前,还包括步骤:
在开始导航时,同时开启惯性导航***和全球定位***进行定位;并在定位到载体当前的位置信息后,关闭所述全球定位***。
3.根据权利要求1所述的组合导航方法,其特征在于,在根据预设的方向偏离角度阈值以及所述运动状态信号判断所述载体运动的方向偏转角度是否偏离预设的方向偏离角度阈值范围的步骤之前,还包括步骤:
获取所述运动状态信号的信号噪声,根据所述信号噪声,对运动状态信号进行去噪。
4.根据权利要求3所述的组合导航方法,其特征在于,所述获取所述运动状态信号的信号噪声,根据所述信号噪声,对运动状态信号进行去噪的步骤包括:
对运动状态信号进行小波分解,获取小波分解层数以及各层的小波信号;
根据第一层到第N层的小波信号估算噪声标准方差,根据噪声标准方差得到阈值,其中所述阈值的计算公式如下:
上式中,N为小波分解层数,λ为阈值,δn为噪声标准方差;
将每一层小波信号超出阈值之外的部分置零;
对第一层到第N层的小波信号进行小波重构,得到去噪后的运动状态信号。
5.根据权利要求1或4所述的组合导航方法,其特征在于,所述对运动状态信号进行小波分解的步骤对应的小波分解层数的计算公式如下:
N=[log2n]
上式中,N为小波分解层数,n为运动状态信号的长度。
6.根据权利要求1所述的组合导航方法,其特征在于,所述运动状态信号包括载体的速度、加速度、姿态、方向信号中的至少一种。
7.一种组合导航***,其特征在于,包括:
信号获取模块,用于在惯性导航***定位过程中,获取载体的运动状态信号;
阈值判断模块,用于根据预设的方向偏离角度阈值以及所述运动状态信号判断所述载体运动的方向偏转角度是否偏离预设的方向偏离角度阈值范围;所述预设的方向偏转角度阈值为所述载体运动过程中方向偏转角度的上限值;
位置校准模块,用于若所述载体运动的方向偏转角度偏离预设的方向偏离角度阈值范围,则开启全球定位***定位,对当前位置进行校准,并在校准后关闭所述全球定位***;
在根据预设的方向偏离角度阈值以及所述运动状态信号判断所述载体运动的方向偏转角度是否偏离预设的方向偏离角度阈值范围的步骤之前,还包括步骤:
获取所述运动状态信号的信号噪声,根据所述信号噪声设定所述载体运动的方向偏离角度阈值;
所述获取所述运动状态信号的信号噪声,根据所述信号噪声设定所述载体运动的方向偏离角度阈值的步骤包括:
对运动状态信号进行小波分解,获取各层的小波信号估算信号噪声;
当信号噪声未超出设定的噪声阈值时,则设置载体运动方向偏离角度阈值为第一方向偏离角度阈值;
当信号噪声超出设定的噪声阈值时,则设置载体运动方向偏离角度阈值为第二方向偏离角度阈值,其中,第二方向偏离角度阈值小于第一方向偏离角度阈值。
8.一种组合导航设备,其特征在于,包括控制器、惯性导航***以及全球定位***;所述控制器分别控制所述惯性导航***和全球定位***进行导航;
所述控制器配置为执行如权利要求1至6任意一项所述的组合导航方法。
9.一种计算机设备,包括存储器和处理器,所述存储器存储有计算机程序,其特征在于,所述处理器执行所述计算机程序时实现权利要求1至6中任一项所述方法的步骤。
10.一种计算机可读存储介质,其上存储有计算机程序,其特征在于,所述计算机程序被处理器执行时实现权利要求1至6中任一项所述的方法的步骤。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710785237.9A CN107525504B (zh) | 2017-09-04 | 2017-09-04 | 组合导航方法、***及组合导航设备 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710785237.9A CN107525504B (zh) | 2017-09-04 | 2017-09-04 | 组合导航方法、***及组合导航设备 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN107525504A CN107525504A (zh) | 2017-12-29 |
CN107525504B true CN107525504B (zh) | 2019-12-03 |
Family
ID=60683419
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201710785237.9A Active CN107525504B (zh) | 2017-09-04 | 2017-09-04 | 组合导航方法、***及组合导航设备 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN107525504B (zh) |
Families Citing this family (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111522034B (zh) * | 2020-04-23 | 2023-08-11 | 海能达通信股份有限公司 | 基于惯性导航的定位方法、设备及装置 |
CN114279439A (zh) * | 2020-09-27 | 2022-04-05 | 阿里巴巴集团控股有限公司 | 一种惯导数据的修正方法、装置和*** |
CN114636568B (zh) * | 2022-03-17 | 2024-04-05 | 奇瑞新能源汽车股份有限公司 | 自动紧急制动***的测试方法、装置、车辆及存储介质 |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104457789A (zh) * | 2014-11-26 | 2015-03-25 | 深圳市华颖泰科电子技术有限公司 | 基于惯性导航的参数修正方法和装置 |
CN105388503A (zh) * | 2015-11-20 | 2016-03-09 | 小米科技有限责任公司 | 一种进行导航的方法和装置 |
CN106643776A (zh) * | 2017-03-20 | 2017-05-10 | 上海卓易科技股份有限公司 | 一种导航方法、装置和终端 |
CN106679657A (zh) * | 2016-12-06 | 2017-05-17 | 北京航空航天大学 | 一种运动载体导航定位方法及装置 |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US9383209B2 (en) * | 2013-09-23 | 2016-07-05 | Texas Instruments Incorporated | Undocking and re-docking mobile device inertial measurement unit from vehicle |
-
2017
- 2017-09-04 CN CN201710785237.9A patent/CN107525504B/zh active Active
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104457789A (zh) * | 2014-11-26 | 2015-03-25 | 深圳市华颖泰科电子技术有限公司 | 基于惯性导航的参数修正方法和装置 |
CN105388503A (zh) * | 2015-11-20 | 2016-03-09 | 小米科技有限责任公司 | 一种进行导航的方法和装置 |
CN106679657A (zh) * | 2016-12-06 | 2017-05-17 | 北京航空航天大学 | 一种运动载体导航定位方法及装置 |
CN106643776A (zh) * | 2017-03-20 | 2017-05-10 | 上海卓易科技股份有限公司 | 一种导航方法、装置和终端 |
Also Published As
Publication number | Publication date |
---|---|
CN107525504A (zh) | 2017-12-29 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN107525504B (zh) | 组合导航方法、***及组合导航设备 | |
Noureldin et al. | Performance enhancement of MEMS-based INS/GPS integration for low-cost navigation applications | |
CN110487271A (zh) | 一种GNSS信号受阻时Elman神经网络辅助紧组合导航方法 | |
US7347090B1 (en) | Methods and systems for calculating atmospheric vehicle air data | |
CN106679693A (zh) | 一种基于故障检测的矢量信息分配自适应联邦滤波方法 | |
CN109855617A (zh) | 一种车辆定位方法、车辆定位装置及终端设备 | |
CN113670337B (zh) | 一种用于gnss/ins组合导航卫星缓变故障检测方法 | |
CN103822633A (zh) | 一种基于二阶量测更新的低成本姿态估计方法 | |
CN112432644B (zh) | 基于鲁棒自适应无迹卡尔曼滤波的无人艇组合导航方法 | |
CN112595313A (zh) | 基于机器学习的车载导航方法、装置和计算机设备 | |
CN110954132A (zh) | Grnn辅助自适应卡尔曼滤波进行导航故障识别的方法 | |
CN113252041B (zh) | 一种适用于小型水下机器人的组合导航方法 | |
CN106767846B (zh) | 三轴稳定卫星不用陀螺的姿态获取方法和*** | |
CN115143954A (zh) | 一种基于多源信息融合的无人车导航方法 | |
CN113847915B (zh) | 一种捷联惯导/多普勒组合导航***的导航方法 | |
CN116642482A (zh) | 基于固态激光雷达和惯性导航的定位方法、设备和介质 | |
CN115979253A (zh) | 一种基于抗差滤波的水下机器人多传感器紧组合导航方法 | |
CN114136310B (zh) | 一种惯性导航***误差自主抑制***及方法 | |
CN104819717A (zh) | 一种基于mems惯性传感器组的多旋翼飞行器姿态检测方法 | |
CN109655060A (zh) | 基于kf/fir和ls-svm融合的ins/uwb组合导航算法及*** | |
US12019170B1 (en) | GNSS and INS integrated navigation positioning method and system thereof | |
CN112781617B (zh) | 误差估计方法、组合导航处理***及存储介质 | |
CN114252077A (zh) | 基于联邦滤波器的双gps/sins的组合导航方法及*** | |
KR20200074660A (ko) | 위성 탑재용 소프트웨어에 탑재 가능한 위성 이벤트 예측 기법 | |
CN111024128B (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 |