Underwater positioning system and underwater positioning method

The system addresses sound wave reflection errors in underwater positioning by using a transmitter and two receivers to detect the shortest time position in cross-correlation functions, ensuring accurate and reliable positioning with adjustable thresholds and error indicators.

JP7953787B2Active Publication Date: 2026-11-19株式会社SIX VOICE
View PDF 11 Cites 0 Cited by

Patent Information

Application Number
JP2022133139
Authority / Receiving Office
JP · JP
Patent Type
Patents
Current Assignee / Owner
Filing Date
2022-08-24
Publication Date
2026-11-19
Estimated Expiration
2042-08-24

AI Technical Summary

Technical Problem

Conventional underwater positioning systems face significant errors in distance measurements due to sound wave reflections, leading to inaccurate positioning, especially when multiple peaks appear on the cross-correlation function, and require multiple devices or data sets for reliability assessment.

Method used

An underwater positioning system that uses a transmitter and two receivers to calculate the propagation time of acoustic waves by detecting the peak at the shortest time position exceeding a variable threshold in the cross-correlation function, and includes a determination unit to validate the positioning position, adjusting the threshold as needed to accurately measure distances and positions.

Benefits of technology

The system achieves high-accuracy positioning even in environments with strong sound wave reflection, independently determining reliability without requiring multiple devices or data sets, and provides positioning error indicators.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure 0007953787000011
    Figure 0007953787000011
  • Figure 0007953787000012
    Figure 0007953787000012
  • Figure 0007953787000013
    Figure 0007953787000013
Patent Text Reader

Abstract

To provide an underwater positioning system capable of precisely measuring a position of an underwater positioning object even in environment having strong sound wave refection.SOLUTION: An underwater positioning system includes: a transmitter 3 for emitting a sound wave into water; a receiver A for receiving a sound wave and converting it to a first reception signal; a receiver B that is provided with an interval from the receiver A, and receives a sound wave and converts it to a second reception signal; a correlation calculation portion 41 for calculating cross-correlation functions between each of the first and second reception signals and a reference signal having the same waveform as that of a sound wave each and obtaining propagation time of a sound wave from the transmitter to the receiver A and B each on the basis of the cross-correlation functions; and a position calculation portion 42 for obtaining distance between the transmitter and the receiver A and the receiver B each on the basis of propagation time. The correlation calculation portion detects a peak in the shortest time position from among peaks exceeding a variable threshold in a time waveform of the cross-correlation function and calculates propagation time on the basis of the time position.SELECTED DRAWING: Figure 1
Need to check novelty before this filing date? Find Prior Art

Description

[Technical Field]

[0001] The present invention relates to an underwater positioning system and an underwater positioning method. [Background technology]

[0002] Conventional underwater positioning systems measure the distance between a sound source (transmitter) and a receiver installed in the positioning device by the propagation time of sound waves, and determine the two-dimensional or three-dimensional position of the sound source from the distances measured at multiple locations (see, for example, Non-Patent Document 1, Patent Document 1, and Patent Document 2).

[0003] Non-patent document 1 discloses a method for determining the position of a positioning object by measuring the distance between the positioning object equipped with an ultrasonic wave transmitter and a receiver based on the propagation time of the sound waves, and then solving a system of equations that includes the obtained distance and the three-dimensional coordinates of the positioning object. In measuring the propagation time of the sound waves, the cross-correlation function between the received signal of the receiver and a reference signal which is a replica of the transmitted signal of the transmitter is calculated, and the propagation time of the sound waves is determined from the position where the amplitude is at its maximum in the waveform of the cross-correlation function.

[0004] Patent Document 1 discloses a method for receiving acoustic signals emitted from an underwater positioning target object with multiple receivers, performing a correlation function calculation for each acoustic signal, and determining the arrival time difference of acoustic signals received by two different receivers based on the calculation results. In Patent Document 1, to address the problem of relatively large errors in the arrival time difference when the intensity relationship between the fundamental wave and noise is reversed, a method is used to generate a noise-suppressed signal by acquiring the impulse response for a pair of received signals and performing a time difference detection process using a generalized cross-correlation phase transform (GCC-PHAT).

[0005] Patent Document 2 discloses a method for improving positioning accuracy by determining the range from which to extract positioning data based on the median value, carrier-to-noise power ratio (C / N), etc., according to the variation in positioning results obtained by multiple underwater positioning devices, and using only the positioning data extracted from the determined range. [Prior art documents] [Patent Documents]

[0006] [Patent Document 1] Japanese Patent Publication No. 2020-176902 [Patent Document 2] Japanese Patent Publication No. 2019-219274 [Non-patent literature]

[0007] [Non-Patent Document 1] Port and Airport Research Institute, Japan, Document No. 1059, "Development of Underwater Coordinate Measurement Technology Using Ultrasound," September 2003. [Overview of the Initiative] [Problems that the invention aims to solve]

[0008] However, in conventional underwater positioning systems, in environments with strong sound wave reflection, multiple peaks representing the propagation times of direct and reflected waves appear on the waveform of the cross-correlation function, and the relative amplitudes of the direct and reflected wave peaks may be reversed. Conventional methods that detect arrival time at the position where the amplitude is maximum in the waveform of the cross-correlation function may mistakenly detect the propagation time of the reflected wave instead of the propagation time of the direct wave, potentially leading to significant errors in distance measurements calculated from propagation times.

[0009] For example, the method disclosed in Non-Patent Document 1 involves receiving an acoustic signal from a positioning target object located in water, detecting the position of maximum amplitude from the cross-correlation function of the received signal and a reference signal, measuring the propagation time, converting the propagation time into distance, and determining the position of the positioning target object. However, in some bodies of water, the acoustic signal is reflected off the water surface or bottom and propagates as a reflected wave, so the receiver receives both the original direct wave and the reflected wave. The reflected wave acts as a disturbance when determining the propagation time of the sound wave, reducing the accuracy of the propagation time measurement.

[0010] Patent Document 1 presents a solution using impulse response acquisition processing to suppress the influence of reflected waves when measuring the arrival time difference of a pair of received signals. However, Patent Document 1 has a limitation in that when determining the arrival angle from the arrival time difference, the resolution of the arrival angle depends on the receiver spacing. Narrowing the receiver spacing reduces the resolution of the arrival angle, and widening the spacing improves the resolution, but it becomes impossible to consider the received waves reaching the pair of receivers as parallel waves, so there is a problem that the estimation error of the arrival angle increases when the distance between the positioning target and the receivers is short.

[0011] Patent Document 2 estimates a location by extracting a positioning result from a range corresponding to the variability of the positioning results among multiple positioning results, and does not evaluate the reliability of positioning for a single positioning device or data from a single positioning result. In other words, Patent Document 2 has the problem that in order to determine the reliability of positioning from positioning result data, multiple positioning devices are required or multiple positioning result data must be acquired.

[0012] The present invention was made to solve these conventional problems, and aims to provide an underwater positioning system and method that can measure the position of an object to be positioned underwater with high accuracy, even in environments with strong sound wave reflection.

[0013] Furthermore, the present invention aims to provide an underwater positioning system and an underwater positioning method that can independently present an indicator of positioning reliability without requiring multiple positioning devices or multiple positioning result data. [Means for solving the problem]

[0014] To solve the above problems, the underwater positioning system according to the present invention includes a transmitter that emits acoustic waves into the water and is installed on a positioning target object in the water, a first receiver that receives the acoustic waves and converts them into a first received signal which is an electrical signal, a second receiver that is installed at a distance from the first receiver and receives the acoustic waves and converts them into a second received signal which is an electrical signal, and calculates the cross-correlation function between each of the first received signal and the second received signal and a reference signal having the same waveform as the time waveform of the acoustic wave, and The system comprises a correlation calculation unit that determines the propagation time of the acoustic wave from the transmitter to the first receiver and the second receiver based on a cross-correlation function, and a position calculation unit that determines the distance between the transmitter and the first receiver and the second receiver based on the propagation time and calculates the position of the transmitter, wherein the correlation calculation unit detects the peak at the shortest time position among the peaks that exceed a variable threshold in the time waveform of the cross-correlation function and calculates the propagation time based on the time position.

[0015] As described above, the underwater positioning system according to the present invention has a correlation calculation unit that detects the peak at the shortest time position among the peaks that exceed a variable threshold in the time waveform of the cross-correlation function, and calculates the propagation time of the acoustic wave based on that time position. When reflected waves are present, the propagation path of the direct wave is shorter than the propagation path of the reflected wave, so the direct wave reaches the receiver earlier than the reflected wave. Therefore, even if the peak indicating the propagation time of the reflected wave in the time waveform of the cross-correlation function is higher than the peak indicating the propagation time of the direct wave, the direct wave can be detected by detecting the peak at the shortest time position. In this way, even when there are multiple peaks indicating the propagation times of the direct wave and the reflected wave, the peak position of the direct wave can be found, which improves the accuracy of measuring the distance between the transmitter and receiver, and thus improves the positioning accuracy. Therefore, even in environments with strong sound wave reflection, the position of the object to be positioned underwater can be measured with high accuracy.

[0016] Furthermore, the underwater positioning system of the present invention may further include a determination unit that determines the validity of the positioning position of the transmitter calculated by the position calculation unit, and a variable threshold setting unit that changes the variable threshold when the determination unit determines that the positioning position is not valid.

[0017] With this configuration, the underwater positioning system according to the present invention has a setting that changes the threshold applied to the waveform of the cross-correlation function. By changing the threshold, even when there are multiple peaks indicating the propagation time of direct waves and reflected waves, the peak position of the direct wave can be found with a higher probability. As a result, the position of the object to be positioned underwater can be measured with high accuracy, even in environments with strong sound wave reflection.

[0018] Furthermore, in the underwater positioning system of the present invention, the determination unit may be configured to determine that the position is valid when the difference in propagation time Δt satisfies the condition cΔt / d < 1, and to determine that the position is not valid when the condition is not met. Here, c is the speed of the acoustic wave in water, and d is the distance between the first receiver and the second receiver.

[0019] With this configuration, the underwater positioning system according to the present invention can more accurately determine the validity of the positioning location, and can measure the position of an object to be positioned underwater with high accuracy, even in environments with strong sound wave reflection.

[0020] Furthermore, in the underwater positioning system of the present invention, the variable threshold setting unit may, when the determination unit determines that the positioning position is not valid, change the variable threshold so that it gradually increases starting from an initial value higher than the noise level of the cross-correlation function, the correlation calculation unit may determine the propagation time each time the variable threshold is changed, and the position calculation unit may calculate the position of the transmitter.

[0021] With this configuration, the underwater positioning system according to the present invention can find the peak position of the direct wave even when there are multiple peaks indicating the propagation times of direct and reflected waves in the waveform of the cross-correlation function, by starting from an initial value higher than the noise level (background noise) of the cross-correlation function and gradually increasing the variable threshold. Specifically, by starting from an initial value higher than the background noise of the cross-correlation function, it is difficult to falsely detect background noise. Furthermore, by gradually increasing the variable threshold, it is difficult to falsely detect reflected waves that arrive later than the direct wave, and by always being able to detect the peak position of the direct wave, the rate at which accurate distance can be measured increases, and positioning accuracy is improved. Therefore, even in environments with strong sound wave reflection, the position of the object to be positioned underwater can be measured with high accuracy.

[0022] Furthermore, in the underwater positioning system of the present invention, the correlation calculation unit may be configured to include a reliability information output unit that calculates the peak power to average power ratio (PAPR) from the cross-correlation function and outputs the positioning error level assigned according to the PAPR value as positioning reliability information.

[0023] This configuration allows the underwater positioning system according to the present invention to improve positioning accuracy by, for example, extracting data according to the error level when statistically processing positioning data. Therefore, it can provide an indicator of positioning reliability on its own, without requiring multiple positioning devices or multiple sets of positioning result data.

[0024] Furthermore, the underwater positioning system according to the present invention is provided on a positioning target object located underwater and includes a transmitter that emits acoustic waves into the water, a first receiver that receives the acoustic waves and converts them into a first received signal which is an electrical signal, a second receiver provided at a distance from the first receiver and converts the acoustic waves into a second received signal which is an electrical signal, a third receiver provided at a distance from the first receiver and the second receiver and converts the acoustic waves into a third received signal which is an electrical signal, and each of the first received signal, the second received signal, and the third received signal has the same waveform as the time waveform of the acoustic wave. The system comprises: a correlation calculation unit that calculates cross-correlation functions with a reference signal and determines the propagation time of the acoustic wave from the transmitter to the first receiver, the second receiver, and the third receiver based on the cross-correlation functions; and a position calculation unit that determines the distance between the transmitter and the first receiver, the second receiver, and the third receiver based on the propagation time and calculates the three-dimensional position of the transmitter, wherein the correlation calculation unit detects the peak at the shortest time position among the peaks that exceed a variable threshold in the time waveform of the cross-correlation function and calculates the propagation time based on the time position.

[0025] With this configuration, the underwater positioning system according to the present invention can measure the three-dimensional position of an object to be positioned underwater with high accuracy, even in environments with strong sound wave reflection.

[0026] Furthermore, the underwater positioning method of the present invention comprises: a transmission step of emitting acoustic waves into the water from a transmitter installed on a positioning target object located underwater; a first receiving step of receiving the acoustic waves with a first receiver and converting them into a first received signal which is an electrical signal; a second receiving step of receiving the acoustic waves with a second receiver installed at a distance from the first receiver and converting them into a second received signal which is an electrical signal; and the cross-correlation function of each of the first received signal and the second received signal and a reference signal having the same waveform as the time waveform of the acoustic wave. The system includes a correlation calculation step of calculating the propagation time of the acoustic wave from the transmitter to the first receiver and the second receiver based on the cross-correlation function, and a position calculation step of calculating the position of the transmitter by determining the distance between the transmitter and the first receiver and the second receiver based on the propagation time, wherein the correlation calculation step is characterized by detecting the peak at the shortest time position among the peaks that exceed a variable threshold in the time waveform of the cross-correlation function and calculating the propagation time based on the time position.

[0027] As described above, the underwater positioning method according to the present invention, in the correlation calculation step, detects the peak at the shortest time position among the peaks that exceed a variable threshold in the time waveform of the cross-correlation function, and calculates the propagation time of the acoustic wave based on this time position. When reflected waves are present, the propagation path of the direct wave is shorter than the propagation path of the reflected wave, so the direct wave reaches the receiver earlier than the reflected wave. Therefore, even if the peak indicating the propagation time of the reflected wave in the time waveform of the cross-correlation function is higher than the peak indicating the propagation time of the direct wave, the direct wave can be detected by detecting the peak at the shortest time position. In this way, even when there are multiple peaks indicating the propagation times of the direct wave and the reflected wave, the peak position of the direct wave can be found, which improves the accuracy of measuring the distance between the transmitter and receiver, and thus improves the positioning accuracy. Therefore, even in environments with strong sound wave reflection, the position of the object to be positioned underwater can be measured with high accuracy. [Effects of the Invention]

[0028] According to the present invention, it is possible to provide an underwater positioning system and an underwater positioning method that can measure the position of an object to be positioned underwater with high accuracy, even in environments with strong sound wave reflection. [Brief explanation of the drawing]

[0029] [Figure 1] This is a block diagram showing the configuration of an underwater positioning system according to one embodiment of the present invention. [Figure 2] This figure shows an example of the configuration of the positioning calculation processing unit. [Figure 3] (a) shows an example of the cross-correlation function waveform when there is no sound wave reflection, and (b) shows an example of the cross-correlation function waveform when sound wave reflection is present. [Figure 4] The left diagram shows the sound wave propagation path from the transmitter to the receiver when there is sound wave reflection at the water surface and bottom, and the right diagram shows the cross-correlation function in that case. [Figure 5] This diagram illustrates a method for detecting propagation time from the waveform of the cross-correlation function using a threshold value. [Figure 6] This is a flowchart for the variable threshold detection method. [Figure 7] This diagram shows the relative positions of the sound waves emitted by the transmitter, which become parallel waves, when they arrive at receivers A and B. [Figure 8] (a) is an example of the waveform and PAPR value of the cross-correlation function under conditions of no sound wave reflection and low ambient noise, (b) is an example of the waveform and PAPR value of the cross-correlation function under conditions of sound wave reflection and low ambient noise, and (c) is an example of the waveform and PAPR value of the cross-correlation function under conditions of sound wave reflection and high ambient noise. [Figure 9] The results of positioning evaluations performed on two prior art technologies and the present invention are shown. [Figure 10] This is a block diagram showing the configuration of an underwater positioning system according to another embodiment of the present invention. [Modes for carrying out the invention]

[0030] Hereinafter, an underwater positioning system and an underwater positioning method according to an embodiment of the present invention will be described in detail with reference to the drawings.

[0031] (First embodiment) Figure 1 is a block diagram showing the configuration of an underwater positioning system 1 according to a first embodiment of the present invention. As shown in Figure 1, the underwater positioning system 1 comprises an underwater positioning device 10 and a transmitter 3 attached to a positioning target object 2, and is configured to measure the position of the positioning target object 2, specifically the position of the transmitter 3, while it is underwater.

[0032] The transmitter 3 is installed on the positioning target object 2 located in the water and is configured to emit acoustic waves into the water. Acoustic waves are also simply referred to as sound waves below, and are preferably ultrasonic waves.

[0033] The underwater positioning device 10 includes a receiver 11 (hereinafter also referred to as receiver A), an amplifier / AD converter 12, a receiver 21 (hereinafter also referred to as receiver B), an amplifier / AD converter 22, and a positioning calculation processing unit 40.

[0034] Receiver A is, for example, a hydrophone, and receives an acoustic wave and a first received signal s which is an electrical signal. A It is designed to convert to [this format]. Note that receiver A corresponds to the first receiver of the present invention.

[0035] Receiver B is, for example, a hydrophone, which is installed at a distance from receiver A and receives acoustic waves to form a second received signal s, which is an electrical signal. B It is designed to convert to [this]. Note that receiver B corresponds to the second receiver of the present invention.

[0036] The amplifier / AD converter 12 receives the received signal s output from receiver A. A It amplifies the signal, converts it from analog to digital, and converts the received digital signal to u A It is designed to output the signal s from receiver B. Similarly, the amplifier / AD converter 22 receives the received signal s from receiver B. B It amplifies the signal, converts it from analog to digital, and converts the received digital signal to u Bis configured to output. Note that the amplification and AD converters 12, 22 may be configured to have an amplifier and an AD converter as separate individual components.

[0037] (Positioning Calculation Processing Unit) The positioning calculation processing unit 40 is configured to calculate the position of the positioning target object 2 (specifically, the acoustic wave transmitter 3) and, as necessary, the positioning error level ξ based on the received signals u A , u B , and includes a correlation calculation unit 41 and a two-dimensional position calculation unit 42. Note that the two-dimensional position calculation unit 42 corresponds to the position calculation unit of the present invention.

[0038] (Correlation Calculation Unit) The correlation calculation unit 41 is configured to calculate the cross-correlation functions r A and r B between each of the received signals and a reference signal s' having the same waveform as the time waveform of the acoustic wave A , r B respectively, and use variable thresholds γ A , r B for the time waveforms of the cross-correlation functions A , γ B to determine the propagation times τ A , τ B of the acoustic wave from the acoustic wave transmitter 3 to the wave receiver A and the wave receiver B respectively.

[0039] Figure 2 is a diagram showing a configuration example of the correlation calculation unit 41 in the positioning calculation processing unit 40. As shown in Figure 2, the correlation calculation unit 41 includes a reference signal storage unit 411, a cross-correlation function calculation unit 412, a propagation time detection unit 413, a variable threshold setting unit 414, and a positioning reliability calculation unit 415.

[0040] The reference signal storage unit 411 is configured to store data of the reference signal s' having the same waveform as the time waveform of the acoustic wave.

[0041] The cross-correlation function calculation unit 412 is configured to calculate the cross-correlation function r A between the received signal u and the reference signal s' having the same waveform as the time waveform of the acoustic wave A , and also calculate the cross-correlation function with the received signal uB The cross-correlation function r between the reference signal s′ and the reference signal s′ B It is designed to calculate [something].

[0042] The propagation time detection unit 413 detects the cross-correlation function r A Variable threshold γ for the time waveform A The propagation time τ of the acoustic wave from transmitter 3 to receiver A using A We will find the cross-correlation function r B Variable threshold γ for the time waveform B The propagation time τ of the acoustic wave from transmitter 3 to receiver B is calculated using [this method]. B It is now seeking this.

[0043] The variable threshold setting unit 414 sets the variable threshold γ when the determination unit 422 determines that the positioning position is not valid. A γ B The cross-correlation function r is modified when the determination unit 422 determines that the positioning location is not valid. A ,r B Starting from an initial value higher than the noise level, the variable threshold γ A γ B Variable threshold γ gradually increases A γ B It is designed to change the variable threshold γ. A γ B Each time the propagation time is changed, the correlation calculation unit 41 calculates the propagation time again, and the two-dimensional position calculation unit 42 calculates the position of the transmitter 3.

[0044] The positioning reliability calculation unit 415 calculates the cross-correlation function r A ,r B The system calculates the peak power to average power ratio (PAPR) ρ from the data and outputs the positioning error level ξ, which is assigned according to the PAPR value ρ, as positioning confidence information.

[0045] (2D position calculation part) The 2D position calculation unit 42 calculates the sound wave propagation time τ A ,τ BBased on this, the distances between transmitter 3 and receivers A and B are determined, and the two-dimensional position of transmitter 3 is calculated.

[0046] Specifically, as shown in Figure 2, the two-dimensional position calculation unit 42 comprises a position calculation unit 421 and a determination unit 422.

[0047] The position calculation unit 421 calculates the propagation time τ A ,τ B Based on this, the 2D position of the transmitter 3 [x′ T ,y′ T It is designed to calculate [ ].

[0048] The determination unit 422 is configured to determine the validity of the positioning location. The validity of the positioning location can be determined from various perspectives. For example, the unit may determine that the positioning location is not valid if it deviates from the expected underwater range, if the positioning location is above the water surface, if the positioning location is below the seabed, or if the positioning location cannot be calculated.

[0049] In this embodiment, the determination unit 422 determines the propagation time τ A ,τ B The system determines that the positioning location is valid when the difference Δt satisfies the condition cΔt / d < 1, and invalid when this condition is not met. Here, c is the speed of the acoustic wave in water, and d is the distance between receiver A and receiver B. This configuration allows for a more accurate determination of the validity of the positioning location, enabling high-precision measurement of the position of the object 2 underwater, even in environments with strong sound wave reflection.

[0050] (Hardware configuration) The positioning calculation processing unit 40 of the underwater positioning device 10 is composed of a computer device having a CPU (Central Processing Unit), ROM (Read Only Memory), RAM (Random Access Memory), auxiliary storage device, communication interface, etc.

[0051] The ROM and auxiliary storage devices of the computer device that constitutes the underwater positioning device 10 store programs that enable the computer device to function as the underwater positioning device 10. In other words, the CPU executes the programs stored in the ROM, etc., using RAM as a working area, thereby enabling the computer device to function as the underwater positioning device 10.

[0052] Part or all of the underwater positioning device 10 may be implemented by an integrated circuit, such as an ASIC (Application Specific Integrated Circuit) or an FPGA (Field Programmable Gate Array). Part or all of the underwater positioning device 10 may also be implemented by a combination of software and hardware circuits.

[0053] (Positioning method) Next, I will explain the positioning method. As shown in Figure 1, the position of the transmitter 3 in the 2D coordinate system is [x T ,y T Let ] and set the positions of receiver A and receiver B respectively to [x A ,y A ], [x B ,y B The sound waves emitted by transmitter 3 reach receivers A and B via a predetermined propagation path. The sound wave signals received by receivers A and B are electrical signals, which are the received signals s A ,s B These are converted to the received signal s. A ,s B These signals are amplified by the amplifier / AD converters 12 and 22 respectively, converted from analog to digital, and the digital received signal u A ,u B This is obtained and input to the correlation calculation unit 41.

[0054] The received signal after analog-to-digital conversion by the amplifier / AD converters 12 and 22 is u A (t),u B Expressed as (t)(where t is the discrete time sampled with sampling interval T), the correlation calculation unit 41 calculates the cross-correlation function r between the received signal and the reference signal.A (τ),r B (τ) is calculated using the following formula.

[0055]

number

[0056] Here, s'(t) is the reference signal, which is the waveform data of the transmission signal output from transmitter 3 that has been recorded in advance. < > represents a convolution operation.

[0057] The correlation calculation unit 41 calculates the propagation time τ of sound waves from the transmitter 3 to receivers A and B. A ,τ B The cross-correlation function r A ,r B The waveform is detected, and the 2D position calculation unit 42 calculates the distance R using the following formula. A ,R B Convert to [m]

[0058]

number

[0059] Here, c [m / s] represents the speed of sound in water.

[0060] The 2D position calculation unit 42 calculates the distance R A ,R B and the position coordinates [x A ,y A ],[x B ,y B From ], by finding the solution to the following system of equations, the position of the transmitter 3 on the 2D plane [x T ,y T Get and output ].

[0061]

number

[0062] In Figures 1 and 2, the position calculated from the above simultaneous equations is shown as the true position of the transmitter 3 [x T ,y T To distinguish it from ], [x′ T ,y′ T It is written as ].

[0063] <Challenges when sound wave reflection is present> Figure 3 shows the cross-correlation function r calculated from the received signal received by receiver A. A An example of the waveform of (τ) is shown. Specifically, Figure 3(a) shows the cross-correlation function r under the condition that there is no sound wave reflection. A Figure 3(b) shows an example of the waveform of (τ), and the cross-correlation function r when sound wave reflections from the water surface, bottom, and surrounding walls are present. A This is an example of the waveform of (τ).

[0064] In Figure 3(a), the cross-correlation function r A The point where the amplitude is maximum in the waveform (τ) is indicated by a triangle mark. In the prior art shown in Non-Patent Document 1, the propagation time of the sound wave τ is measured from the point where the amplitude is maximum. A It is detecting something.

[0065] In Figure 3(b), the cross-correlation function r A In the waveform of (τ), the point where the amplitude is maximum is indicated by a triangle. In Figure 3(b), the cross-correlation function r is indicated by a circle at a position preceding the point where the amplitude is maximum. A Another peak in (τ) is observed. The point indicated by the circle mark represents the position of the original propagation time. Under conditions of sound wave reflection, many false peaks occur on the waveform of the correlation function, and the time position of the point of maximum amplitude does not coincide with the point representing the original propagation time.

[0066] Next, we will explain, with reference to Figure 4, why the time position of the point where the amplitude is maximum under the condition of sound wave reflection does not coincide with the time position of the point that indicates the actual propagation time.

[0067] Figure 4 is a diagram (left diagram) showing the sound wave propagation path from the transmitter to the receiver when sound wave reflection occurs at the water surface and the water bottom, and a diagram (right diagram) showing the cross-correlation function in that case. A sound wave propagating along the path connecting the transmitter 3 and the receiver A in a straight line is referred to as a direct wave, and the direct wave is first observed at the receiver A. A wave that propagates after the sound wave is reflected at the water surface or the water bottom is referred to as a reflected wave, and is observed later than the direct wave by an amount corresponding to the longer path length. When the reflected wave a propagating along the path reflected at the water surface and the reflected wave b propagating along the path reflected at the water bottom have the same path length, the reflected wave a and the reflected wave b are combined on the receiving side, and the combined reflected wave may have a larger amplitude than the direct wave. Since this amplitude magnitude relationship appears as the amplitude of the cross-correlation function waveform, in the prior art, the propagation time for the reflected wave instead of the direct wave is detected, resulting in a large positioning error.

[0068] <Variable Threshold Detection Method> In the present embodiment, the cross-correlation function r A In order to detect the propagation time from the waveform of (τ), a variable threshold detection method is used which detects the propagation time of the direct wave with a variable threshold. Specifically, a threshold γ for detecting the propagation time is set, and the shortest time position that satisfies the condition of r A (τ)>γ (τ>0) is detected. Figure 5 shows an example in which the threshold is set to 0.015, and compared with the conventional method that detects the maximum amplitude point as the propagation time position in Figure 3(b), the original propagation time position can be detected even when there is sound wave reflection.

[0069] However, detection using a threshold has a problem in the threshold setting method. For example, in Figure 5, when the threshold is set to 0.025, the propagation time of the reflected wave is detected, and when the threshold is set to less than 0.005, detection is disturbed by background noise, and a time position completely unrelated to the propagation time of the sound wave is detected.

[0070] Therefore, in the present embodiment, the correlation calculation unit 41 in Figure 1 performs propagation time detection with a variable threshold. In order to determine the setting range of the threshold, the cross-correlation function r given by the above equations (1) and (2) A (τ), r BNormalization is performed on (τ) using the following equation. Through the normalization process, the maximum amplitude value becomes 1, and the variable range of the threshold is 0 to 1 (greater than or equal to 0 and less than or equal to 1).

[0071]

Equation

[0072] Then, the thresholds γ A , γ B are set by the following equations. Here, q is the repetition number (q=1,2,...) when performing repeated propagation time detection, and N is the number of signal points indicating the range in which propagation time detection is performed.

[0073]

Equation

[0074] That is, the thresholds γ A , γ B are values that are varied according to the repetition number q and added with the average amplitude value of background noise. Specifically, the thresholds γ A , γ B are values that are gradually increased by a predetermined step width (for example, 0.3) according to the repetition number q and added with the average amplitude value of background noise. The step width is not limited to 0.3, and may be 0.1, 0.2, 0.4, etc., and may be set to any value greater than 0 and less than 1.

[0075] Figure 6 shows a flowchart of the variable threshold detection method used in the present embodiment. In the variable threshold detection method, first, the correlation calculation unit 41 sets 1 to the repetition number q, and calculates the thresholds γ from Equations (7) to (10) A , γ B (step S1). Next, based on the thresholds γ A , γ B , the propagation time τ of the sound wave from the transmitter 3 to the receiver A and the receiver B A , τ BThe following steps are performed (Step S2): Specifically, the peak at the shortest time position among the peaks exceeding a variable threshold in the time waveform of the cross-correlation function is detected, and the propagation time is calculated based on that time position.

[0076] Next, in the two-dimensional position calculation unit 42, the propagation time τ A ,τ B Based on this, the distance R from transmitter 3 to receiver A and receiver B. A ,R B Calculate (step S3). Then, the distance R A ,R B and the positions of receiver A and receiver B [x A ,y A ],[x B ,y B Based on ], the position of the transmitter 3 [x T ,y T Calculate (step S4).

[0077] Next, if the positioning location satisfies the predetermined conditions, or threshold γ A γ B It is determined whether the value exceeds the set range (step S5). If the result of the determination is positive (YES), the loop process is terminated. If the result of the determination is negative (NO), the value of the loop number q is incremented by 1, and the threshold γ is set. A γ B Recalculate (step S6) and return to step S2.

[0078] Figure 6 corresponds to the case of identifying the two-dimensional position in Figure 1, but the same method applies to identifying the three-dimensional position in Figure 10, which will be explained later.

[0079] One method for determining the positioning location is to calculate the angle of arrival θ when the sound waves reaching receivers A and B are considered to be parallel waves, and use this calculation to verify the positioning location. Figure 7 shows the positional relationship when the sound waves emitted by transmitter 3 become parallel waves and arrive at receivers A and B. The angle of arrival θ of the parallel waves is expressed by the following equation, with respect to the time difference Δt between the arrival of the parallel waves at receivers A and B.

[0080]

number

[0081] The time difference Δt is determined from the difference in the propagation time of sound waves to receiver A and receiver B. The time difference Δt and the receiver distance d are given by the following equation.

[0082]

number

[0083] The angle of arrival θ calculated by equation (11) assumes that the receiver spacing d is extremely short compared to the distance from transmitter 3 to receivers A and B, and therefore does not match the actual azimuth angle that can be calculated from the positions of transmitter 3 and receiver A. However, the validity of the positioning position can be determined by checking whether the value of θ in equation (11) is a real number. In other words, if the absolute value of cΔt / d is less than 1 (θ is a real number), then the cross-correlation function r A ,r B Propagation time τ detected from A , τ B It is determined to be valid and satisfy the above-mentioned conditions. However, if the absolute value of cΔt / d exceeds 1 (θ becomes a complex number), it is not possible to determine a realistic angle, so the propagation time τ A ,τ B It is suspected that one or both of these statements are incorrect.

[0084] Patent Document 1 discloses a method for directly measuring the arrival time difference Δt for a pair of received signals and determining the arrival angle from equation (11). Since the arrival time difference is measured on the signal after analog-to-digital conversion, the resolution (minimum distinguishable time) of the arrival time difference Δt is the sampling interval T [s]. For this reason, the arrival angle obtained from equation (11) is constrained by the resolution of the time difference measurement.

[0085] Specifically, for example, if the sampling frequency is 200 kHz, the receiver spacing is 0.3 m, and the speed of sound in water is 1500 m / s, the resolution of the angle of arrival is Δθ = 1.43 [deg]. To increase the resolution of the angle of arrival (to reduce the minimum angle that can be identified), it is good to widen the receiver spacing d, but when the receiver spacing d is widened, the sound waves reaching the receivers cannot be considered as parallel waves, so the difference between the calculated angle of arrival and the actual azimuth angle becomes large. On the other hand, in the positioning calculation of this embodiment, the positioning position is determined from equations (3), (4), (5), and (6) without using equation (11), so the positioning accuracy is improved by the amount by which the receiver spacing is widened.

[0086] <Positioning reliability> Next, I will explain positioning reliability. The positioning reliability calculation unit 415 of the correlation calculation unit 41 calculates and outputs the peak-to-average power ratio (PAPR) ρ, which represents the reliability of the positioning. The peak-to-average power ratio ρ is the cross-correlation function r′ after normalization processing. A For (τ), the calculation is performed using the following formula.

[0087]

number

[0088] Figure 8 shows the cross-correlation function r′ after normalization. A This is an example of the waveform (τ) and PAPR value ρ. It is possible to measure the propagation time of sound waves from Figures 8(a) and 8(b). In the example shown in Figure 8(c), the ambient noise level is much higher than the sound wave emitted from transmitter 3 (S / N ratio -10dB), making it difficult to accurately measure the propagation time of sound waves even with the variable threshold detection method (only inaccurate results are obtained).

[0089] When the 2D position calculation unit 42 (or the 3D position calculation unit 42A, which will be described later) outputs a positioned position, the correlation calculation unit 41 outputs an error level ξ shown by the following equation according to the PAPR value ρ.

[0090]

number

[0091] An error level ξ=0 indicates that positioning is possible, an error level ξ=1 indicates that positioning is possible but the error may be large, and an error level ξ=2 indicates that positioning is impossible or the positioning error is large.

[0092] In this way, by assigning an error level ξ to the obtained positioning location, visualization and statistical processing of positioning data can be performed efficiently, effectively, and conveniently. For example, if the object to be positioned 2 is moving, positioning coordinate points with error levels ξ of 0 and 1 are plotted on the graph, and tracking of the object to be positioned 2 is prioritized. When the object to be positioned 2 is stationary, only positioning data with an error level ξ of 0 may be extracted to determine the accurate positioning location.

[0093] (Positioning experiment) Next, I will explain the positioning experiment. A positioning experiment was conducted at the Kitami Municipal Heated Swimming Pool in Hokkaido to determine the 2D position of an object using a transmitter attached to a ladder. The pool dimensions were 25m wide, 15m deep, and 1.35m deep. The frequency bandwidth of the transmitted signal output from the transmitter was 12kHz to 32kHz, the sampling frequency for analog-to-digital conversion of the received signal was 200kHz, and the duration of the transmitted signal output from transmitter 3 was 82ms. The height positions of the transmitter and receivers A and B were known to be the same, 0.8m from the bottom of the water. The positioning evaluation results are shown in Figure 9. Positioning evaluations were performed on two conventional technologies and the present invention under the following conditions.

[0094] Conventional Technology 1: The propagation time of the sound waves was measured based on the method described in Non-Patent Document 1 (detecting the point of maximum amplitude from the waveform of the cross-correlation function) for the received signals when sound waves emitted from the transmitter were received by receivers A and B, and the two-dimensional position of the transmitter was determined. The x and y coordinates of receivers A and B were set to [12.5, 0.6] and [11.1, 0.6], respectively, and the distance between receivers was set to 1.4 m. Figure 9(a) shows the results of the positioning experiment.

[0095] Conventional technology 2: The angle of arrival was calculated for the received signals when sound waves emitted from a transmitter were received by receivers A and B, using the method described in Patent Document 1 (acquisition of impulse response from a pair of received signals and measurement of time difference using GCC-PHAT). Since Patent Document 1 does not describe a method for distance positioning, the distance between the transmitter and receiver A was assumed to be known, and the two-dimensional position of the transmitter was determined from the distance and the angle of arrival. The x and y coordinates of receivers A and B were set to [12.5, 0.6] and [12.2, 0.6], respectively, and the distance between receivers was set to 0.3 m. Figure 9(b) shows the results of the positioning experiment.

[0096] This invention: The propagation time of the sound waves was measured based on a variable threshold detection method for the received signals when sound waves emitted from the transmitter were received by receivers A and B, and the two-dimensional position of the transmitter was determined. The x and y coordinates of receivers A and B were set to [12.5, 0.6] and [11.1, 0.6], respectively, and the distance between receivers was set to 1.4 m. Figure 9(c) shows the results of the positioning experiment.

[0097] In Figure 9, the true value indicates the actual position of the transmitter, specifically the position of the transmitter measured with a tape measure and rope when the ladder was moved within the pool. The positioning point indicates the position obtained by measuring the position of the transmitter from the sound waves. The average positioning errors for Conventional Technology 1, Conventional Technology 2, and the present invention were 1.62m, 0.80m, and 0.29m, respectively, and the present invention was found to have higher positioning accuracy than the Conventional Technology.

[0098] (Effects and Benefits) As described above, in the underwater positioning system 1 according to this embodiment, the correlation calculation unit 41 calculates a variable threshold γ in the time waveform of the cross-correlation function. A γ B The system detects the peak at the shortest time position among the peaks exceeding a certain value, and based on that time position, determines the propagation time of the sound wave τ. A ,τ B The system is designed to calculate the cross-correlation function r. When a reflected wave is present, the propagation path of the direct wave is shorter than the propagation path of the reflected wave, so the direct wave reaches the receiver earlier than the reflected wave. Therefore, the cross-correlation function r A,r B Even if the peak indicating the propagation time of the reflected wave is higher than the peak indicating the propagation time of the direct wave in the time waveform, the direct wave can be detected by detecting the peak at the shortest time position. In this way, even when there are multiple peaks indicating the propagation times of the direct wave and the reflected wave, the peak position of the direct wave can be found, improving the measurement accuracy of the distance between transmitter 3 and receivers A and B, and thus improving the positioning accuracy. Therefore, even in environments with strong sound wave reflection, the position of the object to be positioned underwater can be measured with high accuracy.

[0099] Furthermore, in the underwater positioning system 1 according to this embodiment, the variable threshold setting unit 414, when the determination unit 422 determines that the positioning position is not valid, sets the cross-correlation function r A ,r B Starting from an initial value higher than the noise level, the variable threshold γ A γ B Variable threshold γ gradually increases A γ B The correlation calculation unit 41 changes the variable threshold γ A γ B Each time the propagation time τ changes A ,τ B The position calculation unit 42 determines the position of the transmitter 3 [x T ,y T The structure is designed to calculate the cross-correlation function r. A ,r B Starting from an initial value higher than the noise level (background noise), the variable threshold γ A γ B By gradually increasing the cross-correlation function r A ,r B In measuring the propagation time of a waveform, even when multiple peaks indicating the propagation times of the direct wave and the reflected wave are present, the peak position of the direct wave can be found. Specifically, the cross-correlation function r A ,r B By starting with an initial value higher than the background noise, it becomes less likely to falsely detect background noise. Furthermore, the variable threshold γ A γ BBy gradually increasing the frequency, it becomes less likely to misdetect reflected waves that arrive later than the direct wave, and the rate at which the peak position of the direct wave can always be detected increases, thereby improving positioning accuracy. Therefore, even in environments with strong sound wave reflection, the position of objects to be positioned underwater can be measured with high accuracy.

[0100] Furthermore, in the underwater positioning system 1 of this embodiment, the correlation calculation unit 41 calculates the cross-correlation function r A ,r B The system includes a reliability information output unit 415 that calculates the peak power to average power ratio (PAPR) ρ and outputs the positioning error level ξ assigned according to the PAPR value ρ as positioning reliability information. With this configuration, for example, when statistically processing positioning data, the positioning accuracy can be further improved by extracting data according to the error level ξ. Therefore, it is possible to present an index of positioning reliability on its own without requiring multiple positioning devices or multiple positioning result data.

[0101] (Second embodiment) Next, an underwater positioning system 1A according to a second embodiment of the present invention will be described with reference to the drawings.

[0102] The underwater positioning system 1A according to the second embodiment differs from the first embodiment, which calculates the two-dimensional position of the transmitter 3, in that it further includes a receiver 31 (hereinafter also referred to as receiver C), which is a hydrophone, and an amplifier / AD converter 32, for example, and calculates the three-dimensional position of the transmitter 3. The other components are the same as those of the first embodiment, and the same components are denoted by the same reference numerals, and detailed descriptions are omitted as appropriate.

[0103] Figure 10 is a block diagram showing the configuration of the underwater positioning system 1A according to the second embodiment. The underwater positioning system 1A of this embodiment includes receiver A, receiver B, receiver C, and amplifier / AD converter 32. The received signal s obtained by receiver C C The signal is sent to the amplifier / AD converter 32, where it is amplified and AD converted into a digital received signal u CThe correlation calculation unit 41A of the positioning calculation processing unit 40A calculates the received signal u A ,u B ,u C Based on this, the propagation time τ of sound waves from transmitter 3 to receivers A, B, and C. A ,τ B ,τ C These values ​​are calculated and sent to the 3D position calculation unit 42A.

[0104] The 3D position calculation unit 42A calculates the propagation time τ obtained by the correlation calculation unit 41A. A ,τ B ,τ C Based on this, the distance R between transmitter 3 and receivers A, B, and C A ,R B ,R C The 3D position calculation unit 42A then calculates the distance R. A ,R B ,R C and the position coordinates [x A ,y A ],[x B ,y B ],[x C ,y C From ], by finding the solution to the following system of equations, the position of the transmitter 3 in three-dimensional space [x T ,y T ,z T Get and output ].

[0105]

number

[0106] Furthermore, a method of measuring the distance from the transmitter using four or more receivers and obtaining an approximate solution for the three-dimensional position using the least squares method is widely known as the GPS positioning principle, and the same method can be applied in the present invention.

[0107] In the underwater positioning system 1A according to this embodiment, similar to the first embodiment, the validity of the positioning location is determined, and the cross-correlation function r is used according to the determination result. A ,r B ,rC The threshold γ to apply to the waveform A γ B γ C The configuration for this modification remains the same. This configuration allows the peak position of the direct wave to be found even when multiple peaks indicating the propagation time of the direct and reflected waves are present, thereby improving the accuracy of measuring the distance between the transmitter and receiver, and thus improving positioning accuracy. Consequently, the position of objects to be positioned underwater can be measured with high accuracy, even in environments with strong sound wave reflection. [Industrial applicability]

[0108] As described above, the present invention has the effect of being able to measure the position of an object to be measured underwater with high accuracy even in environments with strong sound wave reflection, and is useful in general for underwater positioning systems and underwater positioning methods that can be applied to underwater positioning targets such as underwater acoustic devices, underwater robots, and underwater machine tools. [Explanation of Symbols]

[0109] 1. 1A Underwater Positioning System 2. Objects to be positioned 3 Transmitter 10, 10A Underwater positioning device 11. Receiver A (First receiver) 21. Receiver B (Second Receiver) 31. Receiver C (Third receiver) 12, 22, 32 Amplifier / AD Converter 40, 40A Positioning calculation processing unit 41, 41A Correlation Calculation Unit 411 Reference signal storage unit 412 Cross-correlation function calculation unit 413 Propagation time detection unit 414 Variable threshold setting unit 415 Positioning reliability calculation unit 42 2D position calculation section (position calculation section) 42A 3D position calculation section 421 Position calculation part 422 Judgment section

Claims

1. A transmitter installed on a positioning target object located underwater, which emits acoustic waves into the water, A first receiver that receives the aforementioned acoustic wave and converts it into a first received signal which is an electrical signal, A second receiver is provided at a distance from the first receiver and receives the acoustic wave and converts it into a second received signal which is an electrical signal. A correlation calculation unit calculates the cross-correlation function between each of the first and second received signals and a reference signal having the same waveform as the time waveform of the acoustic wave, and determines the propagation time of the acoustic wave from the transmitter to the first receiver and the second receiver based on the cross-correlation function, A position calculation unit calculates the position of the transmitter by determining the distances between the transmitter and the first receiver and the second receiver, respectively, based on the propagation time, A determination unit for determining the validity of the positioning position of the transmitter calculated by the position calculation unit, A variable threshold setting unit that changes the variable threshold when the determination unit determines that the positioning location is not valid, It is equipped with, The correlation calculation unit detects the peak at the shortest time position among the peaks that exceed the variable threshold in the time waveform of the cross-correlation function, and calculates the propagation time based on the time position. When the determination unit determines that the positioning position is not valid, the variable threshold setting unit changes the variable threshold so that it gradually increases, starting from an initial value higher than the noise level of the cross-correlation function. An underwater positioning system characterized in that the correlation calculation unit determines the propagation time each time the variable threshold is changed, and the position calculation unit calculates the position of the transmitter.

2. The determination unit determines that the position is valid when the difference in propagation time Δt satisfies the condition cΔt / d < 1, and determines that the position is not valid when the condition is not met, where c is the speed of the acoustic wave in water and d is the distance between the first receiver and the second receiver, according to claim 1.

3. The underwater positioning system according to claim 1, wherein the correlation calculation unit calculates the peak power to average power ratio (PAPR) from the cross-correlation function and includes a reliability information output unit that outputs the positioning error level assigned according to the PAPR value as positioning reliability information.

4. A transmission step in which a transmitter installed on a positioning target object located underwater emits acoustic waves into the water, A first receiving step in which the acoustic wave is received by a first receiver and converted into a first received signal which is an electrical signal, A second receiving step in which the acoustic wave is received by a second receiver, which is provided at a distance from the first receiver, and converted into a second received signal, which is an electrical signal, A correlation calculation step involves calculating the cross-correlation function between each of the first and second received signals and a reference signal having the same waveform as the time waveform of the acoustic wave, and determining the propagation time of the acoustic wave from the transmitter to the first receiver and the second receiver based on the cross-correlation function, A position calculation step to calculate the position of the transmitter by determining the distances between the transmitter and the first receiver and the second receiver based on the propagation time, A determination step to determine the validity of the positioning position of the transmitter calculated by the position calculation step, If the determination step determines that the positioning location is not valid, a variable threshold setting step is performed to change the variable threshold. Includes, The correlation calculation step involves detecting the peak at the shortest time position among the peaks exceeding the variable threshold in the time waveform of the cross-correlation function, and calculating the propagation time based on the time position. The variable threshold setting step, when the determination step determines that the positioning position is not valid, modifies the variable threshold so that it gradually increases starting from an initial value higher than the noise level of the cross-correlation function. The underwater positioning method is characterized in that the correlation calculation step determines the propagation time each time the variable threshold is changed, and the position calculation step calculates the position of the transmitter.

Citation Information

Patent Citations

  • Position transducer for underwater navigation body

    JP1995260922A

  • Underwater position measuring method and underwater position measuring device

    JP2004191125A

  • Underwater object searching system, underwater object searching method and underwater object searching program

    JP2011038993A

  • Sound source position estimation device

    JP2012215490A

  • Sound wave reception time calculation device, method, and program, and distance estimation system equipped with said device

    JP2015232502A