CN110412546A - A method and system for locating underwater targets - Google Patents
A method and system for locating underwater targets Download PDFInfo
- Publication number
- CN110412546A CN110412546A CN201910745603.7A CN201910745603A CN110412546A CN 110412546 A CN110412546 A CN 110412546A CN 201910745603 A CN201910745603 A CN 201910745603A CN 110412546 A CN110412546 A CN 110412546A
- Authority
- CN
- China
- Prior art keywords
- target
- underwater
- acoustic signal
- underwater acoustic
- distance
- 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
- 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/20—Instruments for performing navigational calculations
-
- 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
- G01S11/00—Systems for determining distance or velocity not using reflection or reradiation
- G01S11/14—Systems for determining distance or velocity not using reflection or reradiation using ultrasonic, sonic, or infrasonic waves
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Measurement Of Velocity Or Position Using Acoustic Or Ultrasonic Waves (AREA)
Abstract
Description
本申请要求在2019年06月27日提交中国专利局、申请号为201910566875.0、发明名称为《一种用于水下目标的定位方法及系统》的中国专利申请的优先权,其全部内容通过引用结合在本申请中。This application claims the priority of the Chinese patent application filed on June 27, 2019 with the application number 201910566875.0 and the invention titled "A Positioning Method and System for Underwater Targets", the entire contents of which are by reference Incorporated in this application.
技术领域technical field
本发明涉及水声学与信号处理技术领域,尤其是一种用于水下目标的定位方法及系统。The invention relates to the technical field of hydroacoustics and signal processing, in particular to a positioning method and system for underwater targets.
背景技术Background technique
近年来,随着电子技术的飞速发展,水下开发步伐的加快,水下无人航行器得到了广泛的应用,无论是水下探测,水下作战海水水下侦察都有其身影。而在实际应用中水下无人航行器常需实现长时间的自定位功能,时间可能长达半年的潜伏。这就要求着水下航体功耗不可过高,且定位算法需要有更好的长时间稳定性。In recent years, with the rapid development of electronic technology and the accelerated pace of underwater development, underwater unmanned vehicles have been widely used, whether it is underwater detection, underwater combat, seawater underwater reconnaissance. In practical applications, underwater UAVs often need to achieve long-term self-positioning functions, and the time may be as long as half a year. This requires that the power consumption of the underwater vehicle should not be too high, and the positioning algorithm needs to have better long-term stability.
常见的水下自定位方法主要以测量信号传播时间及信号到达的波达角度为基础,来测得当前目标距信标的位置。此时,为解算目标的位置,常常以多个信标进行联立解算。如长基线定位系统,短基线定位系统。由于超短基线定位系统为阵列处理的方式,其阵元分布较为集中可认为单点源。仅管这类的技术已经很成熟,但是一般而言测时延的系统硬件成本较高,需要考虑时间上的同步问题,同时声速在海洋中的变化较为多变,会带来较大的干扰。而同样,波达角一般以阵列信号处理为基本原理,这样就要求,目标自身需要携带有较为复杂的硬件设施,功耗也随之增加。Common underwater self-positioning methods are mainly based on measuring the propagation time of the signal and the arrival angle of the signal to measure the position of the current target from the beacon. At this time, in order to calculate the position of the target, multiple beacons are often used for simultaneous calculation. Such as long baseline positioning system, short baseline positioning system. Because the ultra-short baseline positioning system is an array processing method, its array element distribution is relatively concentrated and can be regarded as a single point source. Although this type of technology is very mature, generally speaking, the system hardware cost of time delay measurement is high, and the time synchronization problem needs to be considered. At the same time, the change of sound speed in the ocean is more variable, which will bring greater interference. . Similarly, the angle of arrival is generally based on array signal processing, which requires that the target itself needs to carry more complex hardware facilities, and the power consumption also increases.
此外,当前结合目标运动姿态信息的单信标自定位技术也较多。如以卡尔曼滤波为基本原理的,扩展卡尔曼、无迹卡尔曼滤波及衍生出的各类改进算法。当然还包括以贝叶斯滤波为基本原理的,粒子滤波算法等衍生改进算法。而这些算法的基本准则是建立状态转移方程及量测方程进行目标的定位。这类算法在测时延的系统中,由于有较高的硬件支撑,故而有者量测误差较低的特点,若海洋环境较为平稳时,有较高的定位精度。然而,随着环境的各种变化,往往所建立的方程本身将带来极大的误差,进而影响了算法本身的效果。In addition, there are many single-beacon self-localization technologies currently combined with target motion and attitude information. For example, based on the basic principle of Kalman filtering, extended Kalman, unscented Kalman filtering and various derived improved algorithms. Of course, it also includes derived and improved algorithms such as particle filter algorithms based on the basic principle of Bayesian filtering. The basic principle of these algorithms is to establish the state transition equation and the measurement equation to locate the target. In the system of measuring time delay, this kind of algorithm has the characteristics of low measurement error due to high hardware support. If the marine environment is relatively stable, it has higher positioning accuracy. However, with various changes in the environment, the equations established often bring great errors, which in turn affects the effect of the algorithm itself.
发明内容SUMMARY OF THE INVENTION
本发明提出了一种用于水下目标的定位方法及系统。The present invention provides a positioning method and system for underwater targets.
在一个方面,本发明提出了一种用于水下目标的定位方法,该方法包括以下步骤:In one aspect, the present invention provides a method for locating an underwater target, the method comprising the following steps:
S1:获取信号源发送的水声信号,采集目标当前位置的水声信号强度;S1: Obtain the underwater acoustic signal sent by the signal source, and collect the underwater acoustic signal strength at the current position of the target;
S2:基于斜率修正算法和水声信号强度的衰减值,计算目标与信号源的距离;S2: Calculate the distance between the target and the signal source based on the slope correction algorithm and the attenuation value of the underwater acoustic signal strength;
S3:利用惯性导航技术推算目标的估算位置,利用距离对估算位置进行目标运动姿态位置的修正,获得目标的修正位置;S3: use the inertial navigation technology to calculate the estimated position of the target, and use the distance to correct the estimated position of the target movement and posture, and obtain the corrected position of the target;
S4:基于估算位置与修正位置的精度,设定相应的权重值,利用估算位置与修正位置进行加权最小二乘,获得目标的位置信息。S4: Based on the accuracy of the estimated position and the corrected position, set a corresponding weight value, and use the estimated position and the corrected position to perform weighted least squares to obtain the position information of the target.
在具体的实施例中,信号源为单信标信号源。采用一个信标进行能量的发射,实现方式简单,便于携带安装。In a specific embodiment, the signal source is a single beacon signal source. A beacon is used to transmit energy, the implementation is simple, and it is easy to carry and install.
在优选的实施例中,步骤S2中距离计算还采用曲线滤波算法过滤信号强度野值,曲线滤波算法的过滤信号野值方法为:计算当前时刻与前一时刻的水声信号强度差值ΔPk、与ΔPk对应最近时刻的水声信号强度差值ΔPk-1,基于目标的航向信息和ΔPk-ΔPk-1的值确定当前时刻的水声信号强度值是否为野值,若当前时刻的水声信号强度为野值,则过滤该时刻的水声信号强度值。凭借曲线滤波算法可以有效的过滤信号采集中的异常信号强度值,有效的避免异常值带来的定位误差。In a preferred embodiment, the distance calculation in step S2 also uses a curve filtering algorithm to filter outliers of signal strength, and the method for filtering outliers in the curve filtering algorithm is: calculating the difference ΔPk of underwater acoustic signal strength between the current moment and the previous moment , and the difference ΔP k -1 of the underwater acoustic signal intensity at the latest moment corresponding to ΔP k, based on the heading information of the target and the value of ΔP k -ΔP k-1 to determine whether the underwater acoustic signal intensity value at the current moment is an outlier, if the current If the underwater acoustic signal strength at the moment is an outlier, then filter the underwater acoustic signal strength value at that moment. The curve filtering algorithm can effectively filter the abnormal signal strength value in the signal acquisition, and effectively avoid the positioning error caused by the abnormal value.
在具体的实施例中,野值的具体判断方式为:若航向信息为远离信号源,且ΔPk>ΔPk-1,则当前时刻的水声信号强度值为野值;若航向信息为靠近信号源,且ΔPk小于ΔPk-1,则当前时刻的水声信号强度值为野值。In a specific embodiment, the specific way of judging the outlier is: if the heading information is far away from the signal source and ΔP k >ΔP k-1 , the underwater acoustic signal strength value at the current moment is an outlier; if the heading information is close to the signal source signal source, and ΔP k is less than ΔP k-1 , the underwater acoustic signal strength value at the current moment is an outlier.
在具体的实施例中,目标与信号源的距离的计算公式为:其中Ir为当前位置的水声信号强度,I0为参考水声信号强度,n为衰减因子。In a specific embodiment, the calculation formula of the distance between the target and the signal source is: Among them, I r is the intensity of the underwater acoustic signal at the current position, I 0 is the intensity of the reference underwater acoustic signal, and n is the attenuation factor.
在具体的实施例中,参考水声信号强度I0与衰减因子n的计算方式为:在当前水域中采集至少2个点的参数值[Ia,a]及[Ib,b],利用公式Ia=I0+nlg(a),Ib=I0+nlg(b)计算出当前水域的参考水声信号强度I0与衰减因子n;其中Ia、Ib分别表示两个采集点的水声信号强度值,a、b分别表示两个采集点与信号源的距离。In a specific embodiment, the calculation method of the reference underwater acoustic signal strength I 0 and the attenuation factor n is: collect parameter values [I a , a] and [I b , b] of at least two points in the current water area, and use Formula I a =I 0 +nlg(a), I b =I 0 +nlg(b) to calculate the reference underwater acoustic signal strength I 0 and attenuation factor n of the current water area; where I a and I b represent two acquisitions respectively The underwater acoustic signal strength value of the point, a and b respectively represent the distance between the two collection points and the signal source.
在具体的实施例中,目标点的位置计算公式为其中,H表示系数矩阵,W为X系统估计误差的协方差矩阵,z表示位置量测值。In a specific embodiment, the formula for calculating the position of the target point is: Among them, H represents the coefficient matrix, W is the covariance matrix of the estimated error of the X system, and z represents the position measurement value.
在具体的实施例中,权重值的设定方式为:位置信息的精度与所述权重值成正比。In a specific embodiment, the weight value is set in the following manner: the precision of the location information is proportional to the weight value.
根据本发明的第二方面,提出了一种计算机可读存储介质,其上存储有计算机程序,该计算机程序被计算机处理器执行时上述方法。According to a second aspect of the present invention, a computer-readable storage medium is provided, on which a computer program is stored, the computer program being executed by a computer processor for the above-mentioned method.
根据本发明的第三方面,提出一种水下目标的定位系统,该系统包括:According to a third aspect of the present invention, a positioning system for an underwater target is proposed, the system comprising:
信号采集单元:配置用于获取信标发送的水声信号,采集目标当前位置的水声信号强度;Signal acquisition unit: configured to acquire the underwater acoustic signal sent by the beacon, and to collect the underwater acoustic signal strength of the current position of the target;
距离测算单元:配置用于基于斜率修正算法和水声信号强度的衰减值,计算目标与信标的距离;Distance measurement unit: configured to calculate the distance between the target and the beacon based on the slope correction algorithm and the attenuation value of the underwater acoustic signal strength;
位置修正单元:配置用于利用惯性导航技术推算目标的估算位置,利用距离修正估算位置获得目标的修正位置;Position correction unit: configured to use inertial navigation technology to calculate the estimated position of the target, and use the distance to correct the estimated position to obtain the corrected position of the target;
位置计算单元:配置用于对估算位置与修正位置进行加权最小二乘,获得目标的位置信息。Position calculation unit: configured to perform weighted least squares on the estimated position and the corrected position to obtain the position information of the target.
本发明利用水声信号强度信息进行采集分析,结合强度衰减与距离的映射惯性估计出当前目标自身与信标之间的距离信息,利用斜率修正算法具体计算获得目标与信标之间的距离,并利用曲线滤波算法过滤异常值,结合目标的自身姿态信息进行位置的推算,利用计算的距离值对推算的位置进行修正,最终对修正位置和推算位置进行加权最小二乘获得更为准确的目标位置信息。基于水声信号强度损失的定位系统IPF-RSS结合已有的惯性导航技术SINS,利用加权最小二乘设计出一种单信标的自定位系统,极大的提高了水下定位的精度,与现有基于SINS的航迹推算定位相比,定位效果更佳。The present invention uses underwater acoustic signal strength information to collect and analyze, combines the intensity attenuation and the mapping inertia of the distance to estimate the distance information between the current target itself and the beacon, uses the slope correction algorithm to specifically calculate the distance between the target and the beacon, and uses The curve filtering algorithm filters outliers, calculates the position based on the target's own attitude information, uses the calculated distance value to correct the estimated position, and finally performs weighted least squares on the corrected position and the estimated position to obtain more accurate target position information . The positioning system IPF-RSS based on the loss of underwater acoustic signal strength combines the existing inertial navigation technology SINS, and uses the weighted least squares to design a single-beacon self-positioning system, which greatly improves the accuracy of underwater positioning, and is consistent with the current situation. Compared with the dead reckoning positioning based on SINS, the positioning effect is better.
附图说明Description of drawings
包括附图以提供对实施例的进一步理解并且附图被并入本说明书中并且构成本说明书的一部分。附图图示了实施例并且与描述一起用于解释本发明的原理。将容易认识到其它实施例和实施例的很多预期优点,因为通过引用以下详细描述,它们变得被更好地理解。通过阅读参照以下附图所作的对非限制性实施例所作的详细描述,本申请的其它特征、目的和优点将会变得更明显:The accompanying drawings are included to provide a further understanding of the embodiments and are incorporated into and constitute a part of this specification. The drawings illustrate embodiments and together with the description serve to explain the principles of the invention. Other embodiments and many of the intended advantages of the embodiments will be readily recognized as they become better understood by reference to the following detailed description. Other features, objects and advantages of the present application will become more apparent by reading the detailed description of non-limiting embodiments made with reference to the following drawings:
图1是本发明的一个实施例的用于水下目标的定位方法的流程图;1 is a flowchart of a method for locating an underwater target according to an embodiment of the present invention;
图2是本发明的一个具体的实施例的水下目标定位的效果图示意图;2 is a schematic diagram of an effect diagram of underwater target positioning according to a specific embodiment of the present invention;
图3是本发明的一个具体的实施例的信号强度距离测算过程的算法流程图;Fig. 3 is the algorithm flow chart of the signal strength distance measurement process of a specific embodiment of the present invention;
图4是本发明的一个实施例的用于水下目标的定位系统的框架图;4 is a frame diagram of a positioning system for an underwater target according to an embodiment of the present invention;
图5是本发明的一个具体实施例的基于水声信号强度衰减自定位系统的结构框架图。FIG. 5 is a structural frame diagram of a self-positioning system based on attenuation of underwater acoustic signal strength according to a specific embodiment of the present invention.
具体实施方式Detailed ways
下面结合附图和实施例对本申请作进一步的详细说明。可以理解的是,此处所描述的具体实施例仅仅用于解释相关发明,而非对该发明的限定。另外还需要说明的是,为了便于描述,附图中仅示出了与有关发明相关的部分。The present application will be further described in detail below with reference to the accompanying drawings and embodiments. It should be understood that the specific embodiments described herein are only used to explain the related invention, but not to limit the invention. In addition, it should be noted that, for the convenience of description, only the parts related to the related invention are shown in the drawings.
需要说明的是,在不冲突的情况下,本申请中的实施例及实施例中的特征可以相互组合。下面将参考附图并结合实施例来详细说明本申请。It should be noted that the embodiments in the present application and the features of the embodiments may be combined with each other in the case of no conflict. The present application will be described in detail below with reference to the accompanying drawings and in conjunction with the embodiments.
根据本发明的一个实施例的用于水下目标的定位方法,图1示出了根据本发明的实施例的用于水下目标的定位方法的流程图。如图1所示,该方法包括以下步骤:According to a method for locating an underwater target according to an embodiment of the present invention, FIG. 1 shows a flowchart of a method for locating an underwater target according to an embodiment of the present invention. As shown in Figure 1, the method includes the following steps:
S101:获取信号源发送的水声信号,采集目标当前位置的水声信号强度。采用水听器获得当前定位水声信号的强度,极大的降低了设备的成本。S101: Acquire the underwater acoustic signal sent by the signal source, and collect the underwater acoustic signal strength at the current position of the target. The hydrophone is used to obtain the intensity of the current positioning underwater acoustic signal, which greatly reduces the cost of the equipment.
在优选的实施例中,水听器可以为一般的水听器,加上功率放大器即可得到当前定位信号的强度信息。无需采用阵列式换能器阵列采集信号,也无需各类高端的数字处理器平台实现时间同步,极大的降低了设备的成本和体积功耗。In a preferred embodiment, the hydrophone can be a general hydrophone, and the strength information of the current positioning signal can be obtained by adding a power amplifier. There is no need to use an array transducer array to collect signals, and no need for various high-end digital processor platforms to achieve time synchronization, which greatly reduces the cost and volume power consumption of the equipment.
在优选的实施例中,信号源为单信标发出,类比于太空中的GPS信号,如图2所示的系统效果示意图,信标只是在海面发送定位信号,其服务的定位对象可以任意多个。信标本身于需要位置信息的目标之间不存在通信的概念,仅为信标单方面发送信号,这使得定位目标本身无需发送信号,进而极大的降低了能耗输出,简化了硬件的配置。In a preferred embodiment, the signal source is sent by a single beacon, which is analogous to GPS signals in space. As shown in the schematic diagram of the system effect shown in Figure 2, the beacon only sends positioning signals on the sea surface, and the positioning objects it serves can be arbitrarily many. indivual. There is no concept of communication between the beacon itself and the target that needs location information, and only the beacon sends signals unilaterally, which makes the positioning target itself do not need to send signals, which greatly reduces the energy output and simplifies the hardware configuration. .
S102:基于斜率修正算法和水声信号强度的衰减值,计算目标与信号源的距离。基于对接收到的水声信号强度的距离测算方法,可实现低功耗、高隐蔽性的需求,且定位响应快。S102: Calculate the distance between the target and the signal source based on the slope correction algorithm and the attenuation value of the underwater acoustic signal strength. The distance measurement method based on the received underwater acoustic signal strength can meet the requirements of low power consumption, high concealment, and fast positioning response.
在优选的实施例中,目标与信号源的距离计算采用斜率修正算法。目标与信号源的距离计算公式为:其中Ir为当前位置的水声信号强度,I0为参考水声信号强度,n为衰减因子。In a preferred embodiment, a slope correction algorithm is used to calculate the distance between the target and the signal source. The formula for calculating the distance between the target and the signal source is: Among them, I r is the intensity of the underwater acoustic signal at the current position, I 0 is the intensity of the reference underwater acoustic signal, and n is the attenuation factor.
在具体的实施例中,在同一水域条件下,参考水声信号强度I0将会是定值,衰减因子n波动量不大,也视为定值。在当前水域中进行至少两次的测量获得至少两组不同的参数值[Ia,a]及[Ib,b]...,基于公式Ia=I0+nlg(a),Ib=I0+nlg(b),进行二次方程求解,计算出当前水域的水声信号强度I0和衰减因子n,其中,Ia、Ib分别表示两个采集点的水声信号强度值,a、b分别表示两个采集点与所述信号源的距离。In a specific embodiment, under the same water conditions, the reference underwater acoustic signal strength I 0 will be a fixed value, and the attenuation factor n fluctuates little, which is also regarded as a fixed value. At least two sets of different parameter values [I a , a] and [I b , b] . . . are obtained by performing at least two measurements in the current water area, based on the formula I a =I 0 +nlg(a), I b =I 0 +nlg(b), solve the quadratic equation, and calculate the underwater acoustic signal strength I 0 and attenuation factor n of the current water area, where I a and I b represent the underwater acoustic signal strength values of the two collection points respectively , a and b respectively represent the distance between the two collection points and the signal source.
在优选的实施例中,采用曲线滤波算法过滤水声信号的异常值。曲线滤波算法的过滤信号野值方法为:计算当前时刻与前一时刻的水声信号强度差值ΔPk、与ΔPk对应最近时刻的水声信号强度差值ΔPk-1,基于目标的航向信息和ΔPk-ΔPk-1的值确定当前时刻的水声信号强度值是否为野值,若当前时刻的水声信号强度为野值,则过滤该时刻的水声信号强度值。In a preferred embodiment, a curve filtering algorithm is used to filter outliers of the underwater acoustic signal. The method of filtering outliers of the curve filtering algorithm is: calculating the difference ΔP k of the underwater acoustic signal intensity between the current moment and the previous moment, and the difference ΔP k-1 of the underwater acoustic signal intensity at the latest moment corresponding to ΔP k , based on the heading of the target The information and the value of ΔP k -ΔP k-1 determine whether the underwater acoustic signal strength value at the current moment is an outlier. If the underwater acoustic signal strength at the current moment is an outlier, filter the underwater acoustic signal strength value at this moment.
在具体的实施例中,野值的具体判断方式为:若航向信息为远离所述信号源,且ΔPk>ΔPk-1,则当前时刻的水声信号强度值为野值;若航向信息为靠近所述信号源,且ΔPk小于ΔPk-1,则当前时刻的水声信号强度值为野值。In a specific embodiment, the specific judgment method of the outlier is: if the heading information is far away from the signal source, and ΔP k >ΔP k-1 , the underwater acoustic signal strength value at the current moment is an outlier; In order to be close to the signal source, and ΔP k is less than ΔP k-1 , the underwater acoustic signal strength value at the current moment is an outlier.
S103:利用惯性导航技术推算目标的估算位置,利用距离对估算位置进行目标运动姿态位置的修正,获得目标的修正位置。通过惯性导航SINS技术可以得到目标当前速度信息、位置信息、航向信息、俯仰角和翻滚角等相关参数,其定位误差存在累积误差的问题,利用修正计算的距离可以对其进行修正,减少定位误差累积所造成的定位偏差过大。S103: Calculating the estimated position of the target by using an inertial navigation technology, and correcting the estimated position by using the distance to correct the movement posture and position of the target, so as to obtain the corrected position of the target. Through inertial navigation SINS technology, relevant parameters such as the current speed information, position information, heading information, pitch angle and roll angle of the target can be obtained. The positioning error has the problem of cumulative error, and the calculated distance can be used to correct it to reduce the positioning error. The positioning deviation caused by accumulation is too large.
在具体的实施例中,假定,由惯性导航SINS技术所测得的目标推算位置为XSINS,而由斜率修正算法和曲线滤波算法测得的距离为LRSS;且二者量测的方差分别为σS,σR。为获得更加精确的估计结果,依据加权最小二乘算法及粒子滤波算法的基本思想,提出一种基于目标运动姿态的距离修正算法,即由所测得的LRSS对XSINS进行修正。In a specific embodiment, it is assumed that the estimated position of the target measured by the inertial navigation SINS technology is X SINS , and the distance measured by the slope correction algorithm and the curve filtering algorithm is L RSS ; and the variances measured by the two are respectively is σ S , σ R . In order to obtain more accurate estimation results, according to the basic idea of weighted least squares algorithm and particle filter algorithm, a distance correction algorithm based on target motion attitude is proposed, that is, X SINS is corrected by the measured L RSS .
在具体的实施例中,修正算法具体为:在区间[XSINS-σS,XSINS+σS]范围内选取N个粒子点集Γ={XS1,XS2,L,XSN}表示粒子的坐标集,则粒子集与声源的距离集为D=Γ-S0,其中S0为声源坐标。取距离集D中与LRSS间概率最高即欧式距离最近的点XSINS-RSS={D-LRSS}min做为修正后的位置结果。(公式总结如下)In a specific embodiment, the correction algorithm is as follows: in the range of the interval [X SINS -σ S , X SINS +σ S ], N particle point sets Γ={X S1 , X S2 , L, X SN } are selected to represent The coordinate set of the particle, then the distance set between the particle set and the sound source is D=Γ-S 0 , where S 0 is the sound source coordinate. Take the point X SINS-RSS = {DL RSS } min with the highest probability between the distance set D and L RSS , that is, the closest Euclidean distance, as the corrected position result. (The formula is summarized below)
D=Γ(X)-S0,X∈[XSINS-σS,XSINS+σS]D=Γ(X)-S 0 , X∈[X SINS -σ S , X SINS +σ S ]
XSINS-RSS={D-LRSS}min X SINS-RSS = {DL RSS } min
S104:基于估算位置与修正位置的精度,设定相应的权重值,并估算位置与修正位置进行加权最小二乘,获得目标的位置信息。S104: Based on the accuracy of the estimated position and the corrected position, set a corresponding weight value, and perform weighted least squares between the estimated position and the corrected position to obtain the position information of the target.
在具体的实施例中,目标位置的具体计算公式为:In a specific embodiment, the specific calculation formula of the target position is:
假定,由惯性导航SINS技术所测得的目标推算位置为XSINS,而由上面得到的修正位置为XSINS-RSS。即由两个测量精度不同的系统得到的两种不同的估计结果,若设Xreal为真实距离,则有SINS估计系统XSINS=Xreal+VSINS,VSINS表示系统的估计误差,同样对于由姿态修正的系统中XSINS-RSS=Xreal+VSINS-RSS,VSINS-RSS也为当前系统的估计误差。将两个测量系统结果合并有:It is assumed that the estimated position of the target measured by the inertial navigation SINS technology is X SINS , and the corrected position obtained from the above is X SINS-RSS . That is, two different estimation results obtained from two systems with different measurement precisions. If X real is the real distance, there is a SINS estimation system X SINS =X real +V SINS , where V SINS represents the estimation error of the system. Similarly, for In the system corrected by the attitude, X SINS-RSS =X real +V SINS-RSS , and V SINS-RSS is also the estimated error of the current system. Combine the two measurement system results with:
则由加权最小二乘有估计结果 Then there is an estimation result by weighted least squares
其中W为V的协方差矩阵。where W is the covariance matrix of V.
在具体的实施例中,权重值的设定方式为:位置信息的精度与所述权重值成正比。例如根据精度情况将估算位置与修正位置的权重设置为40%和60%。应当认识到,可以根据实际的测算场景和系统对权重值进行其他数值相应的设定,以满足不同场景下的计算要求。In a specific embodiment, the weight value is set in the following manner: the precision of the location information is proportional to the weight value. For example, the weights of the estimated position and the corrected position are set to 40% and 60% according to the accuracy. It should be recognized that the weight value may be set to other values according to the actual measurement and calculation scenarios and the system, so as to meet the calculation requirements in different scenarios.
图3示出了本发明的一个具体的实施例的信号强度距离测算过程的算法流程图。该方法具体包括以下步骤:FIG. 3 shows an algorithm flow chart of a signal strength distance measurement process according to a specific embodiment of the present invention. The method specifically includes the following steps:
S301:利用水声信号采集输入模块,获取接收到的水声信号。利用水听器加上功率放大器即可得到当前定位信号信息。极大的降低了设备的成本和体积功耗。S301: Use an underwater acoustic signal acquisition and input module to acquire the received underwater acoustic signal. The current positioning signal information can be obtained by using the hydrophone plus the power amplifier. Greatly reduces the cost and volume power consumption of the device.
S302:信号强度分析。基于获得的水声信号,分析获得该水声信号的强度信息。S302: Signal strength analysis. Based on the obtained underwater acoustic signal, the intensity information of the underwater acoustic signal is obtained by analysis.
S303:信号强度野值去除。去除信号强度野值,并基于信号强度进行距离计算。S303: signal strength outlier removal. Remove signal strength outliers and perform distance calculations based on signal strength.
在具体的实施例中,测距算法具体包括有斜率修正算法3031、曲线滤波算法3032和一维WLS-IPF算法3033。In a specific embodiment, the ranging algorithm specifically includes a slope correction algorithm 3031 , a curve filtering algorithm 3032 and a one-dimensional WLS-IPF algorithm 3033 .
在具体的实施例中,斜率修正算法3031具体的实施方式为:In a specific embodiment, the specific implementation of the slope correction algorithm 3031 is:
某两次的测量具有不同的参数值分别为及且在相同的声源距离d处收到的水声信号幅度对应为则Two measurements with different parameter values are and And the amplitude of the underwater acoustic signal received at the same sound source distance d corresponds to but
假定已知曲线1,那么可以计算其相应的参数n1及代入当前收到的强度计算出估计值为:Assuming that curve 1 is known, its corresponding parameters n 1 and Substitute the currently received strength Calculate an estimate for:
而实际值为d,则其距离估计误差相应的计算误差与实际距离的比值k:And the actual value is d, then its distance estimation error The ratio k of the corresponding calculated error to the actual distance:
而实际距离依据曲线b有则上式可变为以为参数的函数表达式:And the actual distance according to the curve b has Then the above formula can be transformed into A function expression with parameters:
进行对数变换处理同时合并公因子有:Perform logarithmic transformation processing and combine common factors as follows:
其中,in,
同时,假定已经获得了曲线2前3个点的实际值,则可以依据上式计算出α及β。进而可以根据测得的实际值修正估计误差。At the same time, assuming that the actual values of the first three points of curve 2 have been obtained, α and β can be calculated according to the above formula. This can then be based on the actual measured value Correct the estimation error.
在具体的实施例中,曲线滤波算法3032具体的实施方式为:采用曲线滤波算法过滤水声信号的异常值。曲线滤波算法的过滤信号野值方法为:计算当前时刻与前一时刻的水声信号强度差值ΔPk、与ΔPk对应最近时刻的水声信号强度差值ΔPk-1,基于目标的航向信息和ΔPk-ΔPk-1的值确定当前时刻的水声信号强度值是否为野值,若当前时刻的水声信号强度为野值,则过滤该时刻的水声信号强度值。野值的具体判断方式为:若航向信息为远离所述信号源,且ΔPk>ΔPk-1,则当前时刻的水声信号强度值为野值;若航向信息为靠近所述信号源,且ΔPk小于ΔPk-1,则当前时刻的水声信号强度值为野值。In a specific embodiment, the specific implementation of the curve filtering algorithm 3032 is as follows: using the curve filtering algorithm to filter the abnormal value of the underwater acoustic signal. The method of filtering outliers of the curve filtering algorithm is: calculating the difference ΔP k of the underwater acoustic signal intensity between the current moment and the previous moment, and the difference ΔP k-1 of the underwater acoustic signal intensity at the latest moment corresponding to ΔP k , based on the heading of the target The information and the value of ΔP k -ΔP k-1 determine whether the underwater acoustic signal strength value at the current moment is an outlier. If the underwater acoustic signal strength at the current moment is an outlier, filter the underwater acoustic signal strength value at this moment. The specific judgment method of the outlier is: if the heading information is far away from the signal source, and ΔP k >ΔP k-1 , the underwater acoustic signal strength value at the current moment is an outlier; if the heading information is close to the signal source, And ΔP k is less than ΔP k-1 , then the underwater acoustic signal strength value at the current moment is an outlier.
在具体的实施例中,一维WLS-IPF算法3033具体的计算公式为:L=(HTR-1H)-1HTR- 1Z1,其中,H代表系数矩阵(转置),R代表协方差矩阵Z1代表距离量测值矩阵。In a specific embodiment, the specific calculation formula of the one-dimensional WLS-IPF algorithm 3033 is: L=(H T R -1 H) -1 H T R - 1 Z 1 , where H represents the coefficient matrix (transpose) , R represents the covariance matrix Z 1 represents the distance measurement matrix.
S304:距离映射算法。即表征距离d与当前接收信号强度I之间的关系。S304: Distance mapping algorithm. That is, the relationship between the distance d and the current received signal strength I is represented.
具体计算公式为:其中Ir为当前位置的水声信号强度,I0为参考水声信号强度,n为衰减因子。The specific calculation formula is: Among them, I r is the intensity of the underwater acoustic signal at the current position, I 0 is the intensity of the reference underwater acoustic signal, and n is the attenuation factor.
图4示出了根据本发明的一个实施例的用于水下目标的定位系统的框架图。该系统包括信号采集单元401、距离测算单元402、位置修正单元403和位置计算单元404。FIG. 4 shows a frame diagram of a positioning system for an underwater target according to an embodiment of the present invention. The system includes a signal acquisition unit 401 , a distance measurement unit 402 , a position correction unit 403 and a position calculation unit 404 .
在具体的实施例中,信号采集单元401被配置用于获取信标发送的水声信号,采集目标当前位置的水声信号强度。信号采集单元401包括水听器和功率放大器。In a specific embodiment, the signal acquisition unit 401 is configured to acquire the underwater acoustic signal sent by the beacon, and collect the intensity of the underwater acoustic signal at the current position of the target. The signal acquisition unit 401 includes a hydrophone and a power amplifier.
在优选的实施例中,水听器可以为一般的水听器,加上功率放大器即可得到当前定位信号的强度信息。无需采用阵列式换能器阵列采集信号,也无需各类高端的数字处理器平台实现时间同步,极大的降低了设备的成本和体积功耗。In a preferred embodiment, the hydrophone can be a general hydrophone, and the strength information of the current positioning signal can be obtained by adding a power amplifier. There is no need to use an array transducer array to collect signals, and no need for various high-end digital processor platforms to achieve time synchronization, which greatly reduces the cost and volume power consumption of the equipment.
在优选的实施例中,信标采用单信标配置,信标只是在海面发送定位信号,其服务的定位对象可以任意多个。信标本身于需要位置信息的目标之间不存在通信的概念,仅为信标单方面发送信号,这使得定位目标本身无需发送信号,进而极大的降低了能耗输出,简化了硬件的配置。In a preferred embodiment, the beacon adopts a single beacon configuration, the beacon just sends a positioning signal on the sea surface, and the positioning objects it serves can be any number. There is no concept of communication between the beacon itself and the target that needs location information, and only the beacon sends signals unilaterally, which makes the positioning target itself do not need to send signals, which greatly reduces the energy output and simplifies the hardware configuration. .
在具体的实施例中,距离测算单元402被配置用于基于斜率修正算法和所述水声信号强度的衰减值,计算所述目标与所述信标的距离。位置修正单元403被配置用于利用惯性导航技术推算所述目标的估算位置,利用所述距离修正所述估算位置获得所述目标的修正位置。位置计算单元404被配置用于对所述估算位置与所述修正位置进行加权最小二乘,获得所述目标的位置信息。通过距离测算单元402、位置修正单元403和位置计算单元404的一系列算法的运算,一定程度上消除了各算法中的误差,最终可以获得较为准确的目标定位信息。In a specific embodiment, the distance calculation unit 402 is configured to calculate the distance between the target and the beacon based on a slope correction algorithm and the attenuation value of the underwater acoustic signal strength. The position correction unit 403 is configured to calculate the estimated position of the target using inertial navigation technology, and to correct the estimated position using the distance to obtain the corrected position of the target. The position calculation unit 404 is configured to perform weighted least squares on the estimated position and the corrected position to obtain position information of the target. Through the operation of a series of algorithms of the distance measurement unit 402 , the position correction unit 403 and the position calculation unit 404 , errors in each algorithm are eliminated to a certain extent, and more accurate target positioning information can be finally obtained.
在优选的实施例中,目标上设置有捷联惯性导航装置,用以获得目标的速度信息、航向信息和位置信息。捷联惯性导航装置可以快速的获取目标当前的速度信息和航向信息,并可以根据速度信息和航向信息对位置进行推算,可以估算出目标不同时刻的位置信息,作为上述算法的参考数据。In a preferred embodiment, a strapdown inertial navigation device is provided on the target to obtain speed information, heading information and position information of the target. The strapdown inertial navigation device can quickly obtain the current speed information and heading information of the target, and can calculate the position according to the speed information and heading information, and can estimate the position information of the target at different times as the reference data of the above algorithm.
图5示出了根据本发明的一个具体实施例的基于水声信号强度衰减自定位系统的结构框架图。该系统包括距离获取模块501、惯性导航模块502、融合算法WLS-IPF模块503和位置信息404。距离获取模块501和惯性导航模块502获得的位置信息数据通过融合算法WLS-IPF模块503进行计算最终输出位置信息504。利用融合算法WLS-IPF模块进行数据的融合运算,减少距离获取模块501和惯性导航模块502所获取的数据的误差,使所计算出的位置信息更加地精确。FIG. 5 shows a structural frame diagram of a self-positioning system based on attenuation of underwater acoustic signal strength according to a specific embodiment of the present invention. The system includes a distance acquisition module 501 , an inertial navigation module 502 , a fusion algorithm WLS-IPF module 503 and location information 404 . The position information data obtained by the distance acquisition module 501 and the inertial navigation module 502 are calculated by the fusion algorithm WLS-IPF module 503 and finally output position information 504 . Using the fusion algorithm WLS-IPF module to perform data fusion operation, the error of the data acquired by the distance acquisition module 501 and the inertial navigation module 502 is reduced, and the calculated position information is more accurate.
在具体的实施例中,距离获取模块501包括依次连接的水声信号采集输入单元5011、信号强度分析单元5012、信号强度野值去除单元5013和距离映射单元5014。距离获取模块501利用信号强度进行距离位置的计算可实现低功耗、高隐蔽性的需求,且定位响应快。In a specific embodiment, the distance acquisition module 501 includes an underwater acoustic signal acquisition and input unit 5011 , a signal strength analysis unit 5012 , a signal strength outlier removal unit 5013 and a distance mapping unit 5014 , which are connected in sequence. The distance acquisition module 501 uses the signal strength to calculate the distance and position, which can meet the requirements of low power consumption, high concealment, and fast positioning response.
在具体的实施例中,惯性导航模块502包括陀螺仪5021、加速度计5022和电子罗盘5023,通过陀螺仪5021、加速度计5022和电子罗盘5023运算获得目标的速度5024和姿态角5025。通过惯性导航模块502可以基于SINS技术得到目标当前速度信息、位置信息、航向信息、俯仰角和翻滚角等相关参数,用于进行后续的距离修正或位置修正计算提供数据基础。In a specific embodiment, the inertial navigation module 502 includes a gyroscope 5021, an accelerometer 5022 and an electronic compass 5023, and obtains the speed 5024 and the attitude angle 5025 of the target through the operation of the gyroscope 5021, the accelerometer 5022 and the electronic compass 5023. The inertial navigation module 502 can obtain relevant parameters such as the current speed information, position information, heading information, pitch angle and roll angle of the target based on the SINS technology, which can be used to provide a data basis for subsequent distance correction or position correction calculations.
本发明的实施例还涉及一种计算机可读存储介质,其上存储有计算机程序,该计算机程序被计算机处理器执行时实施上文中的方法。该计算机程序包含用于执行流程图所示的方法的程序代码。需要说明的是,本申请的计算机可读介质可以是计算机可读信号介质或者计算机可读介质或者是上述两者的任意组合。Embodiments of the present invention also relate to a computer-readable storage medium having stored thereon a computer program that, when executed by a computer processor, implements the above method. The computer program contains program code for carrying out the method shown in the flowchart. It should be noted that the computer-readable medium of the present application may be a computer-readable signal medium or a computer-readable medium, or any combination of the above two.
本发明利用水声信号强度信息进行采集分析,结合强度衰减与距离的映射惯性估计出当前目标自身与信标之间的距离信息,利用斜率修正算法具体计算获得目标与信标之间的距离,并利用曲线滤波算法过滤异常值,结合目标的自身姿态信息进行位置的推算,利用计算的距离值对推算的位置进行修正,最终对修正位置和推算位置进行加权最小二乘获得更为准确的目标位置信息。基于水声信号强度损失的定位系统IPF-RSS结合已有的惯性导航技术SINS,利用加权最小二乘设计出一种单信标的自定位系统,极大的提高了水下定位的精度,与现有基于SINS的航迹推算定位相比,定位效果更佳。The present invention uses underwater acoustic signal strength information to collect and analyze, combines the intensity attenuation and the mapping inertia of the distance to estimate the distance information between the current target itself and the beacon, uses the slope correction algorithm to specifically calculate the distance between the target and the beacon, and uses The curve filtering algorithm filters outliers, calculates the position based on the target's own attitude information, uses the calculated distance value to correct the estimated position, and finally performs weighted least squares on the corrected position and the estimated position to obtain more accurate target position information . The positioning system IPF-RSS based on the loss of underwater acoustic signal strength combines the existing inertial navigation technology SINS, and uses the weighted least squares to design a single-beacon self-positioning system, which greatly improves the accuracy of underwater positioning, and is consistent with the current situation. Compared with the dead reckoning positioning based on SINS, the positioning effect is better.
本申请是基于国家自然科学基金61671394和中央高校基本科研业务费专项资金资助(20720170044)的研究成果。This application is based on research results funded by the National Natural Science Foundation of China 61671394 and the Central Universities Fundamental Research Funds Special Fund (20720170044).
以上描述仅为本申请的较佳实施例以及对所运用技术原理的说明。本领域技术人员应当理解,本申请中所涉及的发明范围,并不限于上述技术特征的特定组合而成的技术方案,同时也应涵盖在不脱离上述发明构思的情况下,由上述技术特征或其等同特征进行任意组合而形成的其它技术方案。例如上述特征与本申请中公开的(但不限于)具有类似功能的技术特征进行互相替换而形成的技术方案。The above description is only a preferred embodiment of the present application and an illustration of the applied technical principles. Those skilled in the art should understand that the scope of the invention involved in this application is not limited to the technical solution formed by the specific combination of the above technical features, and should also cover the above technical features or Other technical solutions formed by any combination of its equivalent features. For example, a technical solution is formed by replacing the above-mentioned features with the technical features disclosed in this application (but not limited to) with similar functions.
Claims (10)
Applications Claiming Priority (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN2019105668750 | 2019-06-27 | ||
CN201910566875 | 2019-06-27 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN110412546A true CN110412546A (en) | 2019-11-05 |
CN110412546B CN110412546B (en) | 2022-09-16 |
Family
ID=68367200
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201910745603.7A Active CN110412546B (en) | 2019-06-27 | 2019-08-13 | Positioning method and system for underwater target |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN110412546B (en) |
Cited By (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110779519A (en) * | 2019-11-18 | 2020-02-11 | 哈尔滨工程大学 | Underwater vehicle single beacon positioning method with global convergence |
CN110779518A (en) * | 2019-11-18 | 2020-02-11 | 哈尔滨工程大学 | Underwater vehicle single beacon positioning method with global convergence |
CN113970343A (en) * | 2020-07-22 | 2022-01-25 | 中国科学院声学研究所 | Underwater mobile node inertial navigation error correction method without clock synchronization |
CN114167354A (en) * | 2021-11-25 | 2022-03-11 | 厦门大学 | An Underwater DOA Estimation Method Based on High Degree of Freedom |
US20220128647A1 (en) * | 2020-10-28 | 2022-04-28 | Zhejiang University | Method for positioning underwater glider based on virtual time difference of arrival of single beacon |
CN118244199A (en) * | 2024-03-11 | 2024-06-25 | 北京太极疆泰科技发展有限公司 | Outdoor positioning method and device |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103712625A (en) * | 2013-12-23 | 2014-04-09 | 哈尔滨工程大学 | Method for estimating initial heading deviation filtering |
US20140121961A1 (en) * | 2012-10-25 | 2014-05-01 | Symbol Technologies, Inc. | Non-echo ultrasonic doppler for corrected inertial navigation |
CN105241459A (en) * | 2015-10-19 | 2016-01-13 | 东南大学 | Delay estimation method and device used for indoor underwater target positioning |
CN106767793A (en) * | 2017-01-19 | 2017-05-31 | 东南大学 | A kind of AUV underwater navigation localization methods based on SINS/USBL tight integrations |
-
2019
- 2019-08-13 CN CN201910745603.7A patent/CN110412546B/en active Active
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20140121961A1 (en) * | 2012-10-25 | 2014-05-01 | Symbol Technologies, Inc. | Non-echo ultrasonic doppler for corrected inertial navigation |
CN103712625A (en) * | 2013-12-23 | 2014-04-09 | 哈尔滨工程大学 | Method for estimating initial heading deviation filtering |
CN105241459A (en) * | 2015-10-19 | 2016-01-13 | 东南大学 | Delay estimation method and device used for indoor underwater target positioning |
CN106767793A (en) * | 2017-01-19 | 2017-05-31 | 东南大学 | A kind of AUV underwater navigation localization methods based on SINS/USBL tight integrations |
Non-Patent Citations (1)
Title |
---|
于浩等: "水下载体SINS_USBL组合导航滤波方法研究", 《导航定位与授时》 * |
Cited By (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110779519A (en) * | 2019-11-18 | 2020-02-11 | 哈尔滨工程大学 | Underwater vehicle single beacon positioning method with global convergence |
CN110779518A (en) * | 2019-11-18 | 2020-02-11 | 哈尔滨工程大学 | Underwater vehicle single beacon positioning method with global convergence |
CN110779519B (en) * | 2019-11-18 | 2021-04-27 | 哈尔滨工程大学 | A single beacon localization method for underwater vehicle with global convergence |
CN113970343A (en) * | 2020-07-22 | 2022-01-25 | 中国科学院声学研究所 | Underwater mobile node inertial navigation error correction method without clock synchronization |
CN113970343B (en) * | 2020-07-22 | 2024-05-14 | 中国科学院声学研究所 | Underwater mobile node inertial navigation error correction method without clock synchronization |
US20220128647A1 (en) * | 2020-10-28 | 2022-04-28 | Zhejiang University | Method for positioning underwater glider based on virtual time difference of arrival of single beacon |
US11719784B2 (en) * | 2020-10-28 | 2023-08-08 | Zhejiang University | Method for positioning underwater glider based on virtual time difference of arrival of single beacon |
CN114167354A (en) * | 2021-11-25 | 2022-03-11 | 厦门大学 | An Underwater DOA Estimation Method Based on High Degree of Freedom |
CN118244199A (en) * | 2024-03-11 | 2024-06-25 | 北京太极疆泰科技发展有限公司 | Outdoor positioning method and device |
Also Published As
Publication number | Publication date |
---|---|
CN110412546B (en) | 2022-09-16 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110412546B (en) | Positioning method and system for underwater target | |
CN105424030B (en) | Fusion navigation device and method based on wireless fingerprint and MEMS sensor | |
CN111221018B (en) | GNSS multi-source information fusion navigation method for inhibiting marine multipath | |
US11035915B2 (en) | Method and system for magnetic fingerprinting | |
CN111947651B (en) | Underwater integrated navigation information fusion method, system and autonomous underwater vehicle | |
CN113311388B (en) | Ultra-short baseline positioning system of underwater robot | |
CN105547290B (en) | It is a kind of based on ultra short baseline locating system from latent device air navigation aid | |
CN108614258A (en) | A kind of Underwater Navigation method based on single acoustic beacon distance measuring | |
CN109738902B (en) | High-precision autonomous acoustic navigation method for underwater high-speed target based on synchronous beacon mode | |
CN110058222B (en) | A dual-layer particle filter detection-before-tracking method based on sensor selection | |
CN116182873B (en) | Indoor positioning method, system and computer readable medium | |
CN116337115B (en) | A method and system for calibrating inertial sensors based on sonar | |
CN110057356A (en) | Vehicle positioning method and device in a kind of tunnel | |
CN113347709B (en) | Indoor positioning method and system based on UWB | |
CN116222578A (en) | Underwater integrated navigation method and system based on self-adaptive filtering and optimal smoothing | |
CN110132281A (en) | A high-precision autonomous acoustic navigation method for underwater high-speed targets based on query-response mode | |
CN109655056A (en) | A kind of compound positioning system of Sea miner and its localization method | |
CN116106875A (en) | Method, system, electronic equipment and storage medium for joint calibration of shore-based array coordinates | |
CN110632636A (en) | A Carrier Pose Estimation Method Based on Elman Neural Network | |
CN107270890B (en) | A ranging method and system for TOF distance sensor on UAV | |
CN114252077A (en) | Dual-GPS/SINS combined navigation method and system based on federal filter | |
CN117367410B (en) | State estimation method, unmanned underwater vehicle and computer readable storage medium | |
CN110388917B (en) | Aircraft monocular vision scale estimation method and device, aircraft navigation system and aircraft | |
CN116358544A (en) | Method and system for correcting inertial navigation error based on acoustic feature matching positioning | |
CN109211240A (en) | A kind of monocular vision submarine navigation device navigator fix bearing calibration |
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 |