The present invention relates to velocity measurement systems.
There are a number of benefits to being able to accurately estimate the velocity of a sea-faring vessel. One is that an accurate estimation of velocity results in improved estimates of ship's position when using dead-reckoning navigation, such as for submerged vehicles (e.g., submarines, AUVs, UUVs, etc.). This is particularly important when a submerged vehicle is unable to obtain Global Positioning System (GPS) fix information, such as when the vessel must maintain covert status. Another benefit of accurate velocity estimation is that it improves the accuracy of certain on-board missile-delivery systems that require an initial velocity as part of an initialization data set provided to the missile before launch (i.e., for the reduction of missile Circular Error Probable (CEP)).
Correlation SONAR technology is widely-used to estimate velocity. See, for example, U.S. Pat. No. 4,244,026 to Dickey and U.S. Pat. No. 5,315,562 to Bradley et al. These systems typically include a sonar source and a receiver array (i.e., hydrophone array). The positions of the receivers within the array are fixed and known. The SONAR source directs a series of acoustic pulses towards the ocean floor, and the receivers detect echoes of those pulses. The velocity of the vessel is then calculated based upon the best correlated pair of receivers within the array and/or the best correlated pulses detected by the receiver array.
Correlation SONAR systems can be water or ground referenced, and spatial- or temporal-based. A water-referenced correlation SONAR uses echoes reflected from the water beneath a vessel, whereas a ground-referenced correlation SONAR uses echoes reflected from the ocean bottom. A correlation SONAR can also be both ground and water based in the sense of having both ground- and water-referenced modes of operation.
Correlation SONARS rely on selecting a best or maximum correlation between hydrophones and/or pulses, for an estimation of velocity. Maximum correlation occurs when the ray path of an initial SONAR transmission (from the transmitter to the ocean floor, etc., and back to a receiver) of a first detected pulse is equal to the ray path of a second SONAR transmission.
Spatial-correlation SONAR estimates the velocity of a vessel by transmitting two or more pulses towards the ocean bottom, detecting echoes of the pulses on a planar two-dimensional array of hydrophones, determining which two hydrophones in the array correlate the best, and dividing the distance between those hydrophones by twice the time differential between the pulses. The time differential between the detected pulses for which maximum correlation occurs is referred to as the “optimal-correlation time,” CTo. In some cases, no two hydrophones will have a spacing that results in a maximum correlation. For example, peak correlation may occur between two hydrophone locations. In this case, an interpolation scheme is used as a part of the velocity estimation. Interpolation, however, reduces the accuracy of the velocity estimate.
Temporal-correlation SONAR also estimates the velocity of a vessel by transmitting two or more pulses toward the ocean bottom and detecting echoes of the pulses at a hydrophone array. For a given pair of hydrophones, the temporal system determines which two pulses correlate the best, and calculates velocity by dividing the fixed distance between the hydrophones by twice the time differential between the two correlated pulses.
Velocity estimates from correlation SONAR are subject to a variety of different random errors and bias errors. To the extent that these types of errors can be reduced, the accuracy of the velocity estimates will improve. Correlation SONARS also have integrity issues in which serious performance degradation can occur in the event that there is an undetected failure in a hydrophone or hydrophone channel and the SONAR uses the faulty channel data for its velocity solution. The phrase “hydrophone channel” means the hydrophone itself, as well as the connectors and cabling to channel electronics, the electronics, and associated data-processing components.
In prior-art correlation SONAR systems, velocity estimates are determined by processing pulse-pairs that are separated by only the optimal-correlation time. As a result, the number of pulse-pairs processed is limited to a fixed, maximum number of pulse-pairs available for processing. This number is determined by the relationship of the optimal-correlation time and the number of pulses and pulse spacings included in the pulse train transmitted by the SONAR system.
The present invention provides a correlation SONAR that generates a velocity estimate with improved accuracy. The improvement in accuracy is achieved by determining a velocity estimate based on all “available pulse-pairs.” The “available pulse-pairs” include those characterized by the ship speed-dependent optimal-correlation time as well as pulse-pairs characterized by other correlation times.
There are many sources of error in a velocity estimate provided by a practical SONAR system, such as:
The inventors recognized that there is an advantage to processing as many pulse-pairs as possible, not just those pulse-pairs characterized by the optimal-correlation time. In other words, the inventors recognized that velocity estimation can be improved by processing pulse-pairs characterized by “sub-optimal” correlation times in addition to those pulse-pairs characterized by the optimal-correlation time. A weighting methodology is applied to all processed pulse-pairs, to develop an SONAR-cycle velocity estimate that is a weighted average of all processed pairs. As a result, the SONAR-cycle velocity estimate is improved by a reduction of the random velocity estimate error.
In some embodiments, the present invention determines weighting factors using direct calculation. In some embodiments, weighting factors are determined using well-known models such as the Kalman filter mechanism.
A method for a velocity-measuring correlation SONAR in accordance with the illustrative embodiment of the present invention comprises developing a first estimate of vessel velocity based on a hydrophone pair characterized by an optimal-correlation time. The method further comprises developing additional estimates of vessel velocity based on hydrophone pairs correlated using sub-optimal-correlation times, and calculating an improved estimate of vessel velocity based on a weighted average of all hydrophone-pair-based velocity estimates.
The particular arrangement depicted as array 104 is the Trident SSBN Navigation Sonar System sixteen-hydrophone box array, and is mounted to the underside of a ship that is traveling in a generally-forward direction as defined by
Detected pulse train 202 comprises echoes detected by best-correlated receiver pair 106 of receiver array 104. Detected pulse train 202 has equal pulse spacing, A, as transmitted by transmitter 102. Detected echo pulses 204 and 206 exhibit the best pulse-pair correlation between detected pulses at all receiver pairs in receiver array 104, as will be described below, and with respect to
The standard deviation of velocity error for a single SONAR pulse-pair velocity estimate is given by:
where N is the number of data points used to perform the correlation of the pulse-pairs, CT is the correlation time, γ is the wavelength of the acoustic signal, φ is the angular composite transmit/receive beam width, and PN/PS is the noise-to-signal power ratio. The error in a prior-art SONAR pulse-pair velocity estimate, therefore, is inversely proportional to the correlation time. The standard deviation of velocity error for a SONAR pulse-pair velocity estimate based on the optimal correlation time, CTo, is designated herein as σCTO.
The accuracy of a SONAR-cycle velocity estimate is improved by averaging multiple pulse-pair velocity estimates made within that SONAR-cycle. The mean-square velocity estimation error is given by:
where n is the total number of SONAR pulse-pair velocity estimates. In a processor-speed-limited case, the number of pulse-pairs that can be processed to develop SONAR pulse-pair velocity estimates is limited.
The improved processor speed for the case depicted in
For the prior-art example shown here, therefore, the maximum improvement due to improved processor speed is a reduction by a factor of only √{square root over (7/3)}.
In accordance with operation 302 of prior-art method 300, a series of pulses are transmitted vertically towards the ocean bottom. In the example depicted in
At operation 306, pulse echo data is amplified, converted to digital, and then digitally filtered to yield in-phase (“I”) and quadrature (“Q”) data for each hydrophone channel. This I and Q data contains all of the amplitude and phase information contained in the echo pulses, but is base-banded and thus vastly reduced in data rate from the A/D converted echo signals.
At operation 308, a pair of hydrophones is identified for each of the various possible ships' velocity vectors, given the arrangement of receiver array 104. A channel-selection pair array, which includes all of the possible non-redundant ship's velocity vectors, is created.
At operation 310, I and Q data from a first echo pulse in a reference channel is correlated with I and Q data from a second (later) echo pulse for each of the other channels. These calculations will form a measured correlation function.
At operation 312, receiver pair 13, 2 is identified as having the best correlation (i.e., receiver pair 13, 2, is “the best-correlated receiver pair”), based on the correlation of I and Q data from echo pulse 204 and echo pulse 206. The time between the detection of detected echo pulses 204 and 206 is the “optimal-correlation time,” as defined above. As depicted in
In accordance with operation 314, a pulse-pair velocity estimate is made based on echo pulses 204 and 206 by dividing the distance between hydrophones 13 and 2 by twice the time differential between echo pulses 204 and 206. Operation 314 continues with the development of a pulse-pair velocity estimate for each available pulse-pair in the sonar cycle. The number of pulse-pairs that can be processed is determined by available processor speed. In the example shown in
As mentioned above, in general the correlation peak lies between receiver pairs. In these instances, an interpolation algorithm is used to define different spacing and orientation between the receivers. The interpolation provides “correlation distances” in the forward and athwart ship's directions, and the velocity is estimated by dividing the correlation distances by twice the optimal-correlation time, 4A.
At operation 316, an SONAR-cycle velocity estimate for the given SONAR cycle is developed based on an average of all pulse-pair-based velocity estimates of that SONAR cycle.
FIGS. 5A-D depict graphical representations of pulse-pairs in a SONAR cycle using correlation times of 4A, 3A, 2A, and A, respectively. The accuracy of a pulse-pair velocity estimate is proportional to its correlation time and correlation distance. Typically, the optimal correlation time is associated with correlated receiver pairs having the largest physical separation. Since receiver pair 13, 1 has the largest separation along the direction of vessel travel; it is characterized by the optimal correlation time, which in this case is equal to 4A, as depicted in
In the prior art, an SONAR-cycle velocity estimate is generated, which is based on an average of equally-weighted pulse-pair velocity estimates, which are based on only the optimal correlation time. In contrast to the prior art, the present invention develops an SONAR-cycle velocity estimate based on a weighted average of all available pulse-pair measurements in a SONAR cycle—including those velocity estimates based on optimal and sub-optimal correlation times.
A weighted average of velocity estimates is used in order to obtain an improved estimate of velocity from data provided by the receiver array by reducing the contribution of the errors inherent to the noisy environment that the receiver array represents. Stochastic models designed to obtain “optimal” estimates of a desired quantity from data provided by a noisy environment are well-known. One example of such a stochastic model is the Kalman filter, which is a recursive data processing algorithm. Heretofore, however, stochastic models have not been applied to SONAR technology as disclosed in this specification.
A SONAR-cycle velocity estimate generated according to the present invention is a weighted average of a plurality of SONAR pulse-pair velocity estimates, where the weighted average SONAR-cycle velocity estimate, XSC, of n SONAR pulse-pair velocity estimates in the SONAR cycle is computed as:
XSC=a1*x1+a2*x2+ . . . +an*xn. (4)
Weighting coefficients, ai, are based on the mean-square velocity estimation error, σi, for each SONAR pulse-pair velocity estimate, xi, where i is a number from 1 to n, and are given by:
According to the method disclosed herein and using equations (2) and (3), the mean-square velocity estimation error for a SONAR-cycle velocity estimate made using a weighted average of SONAR pulse-pair velocity estimates can be expressed as:
where CT1 is equal to CTo.
An improvement in the accuracy of a velocity estimate is achieved by the method disclosed in this specification. For example, and referring now to
A weighted average of SONAR pulse-pair velocity estimates, therefore, yields an improvement in the accuracy of a velocity estimate of at least (14.4/7)1/2 over the prior art example depicted in
At operation 602, a series of pulses are transmitted vertically towards the ocean bottom. As in the example depicted in
At operation 606, best-correlated receiver pair 406 is identified, as is the optimal correlation time (in this example, 4A).
At operation 608, SONAR pulse-pair velocity estimates are generated based on correlated pulses at the best-correlated receiver pair. These velocity estimates are based on the optimal correlation time, CTo. One velocity estimate is made for each of the seven pulse-pairs correlated. These seven SONAR pulse-pair velocity estimates are made in similar fashion to a SONAR-cycle velocity estimate generated using the prior art method described above and with respect to
At operation 610, available sub-optimal correlation times are identified. The available sub-optimal correlation times are 3A, 2A, and A. Also at operation 610, a receiver pair characterized by each sub-optimal correlation time is identified and selected. For example, receiver pair 408 is identified as being characterized by a correlation time of 3A, receiver pair 410 is identified as being characterized by a correlation time of 2A, and receiver pair 412 is identified as being characterized by a correlation time of A.
At operation 612, additional SONAR pulse-pair velocity estimates are generated. These include 8 estimates based on correlated pulses at receiver pair 408, characterized by a CT of 3A; 9 estimates based on correlated pulses at receiver pair 410, characterized by a CT of 2A; and 10 estimates based on correlated pulses at receiver pair 412, characterized by a CT of A. In some embodiments, a SONAR-cycle velocity estimate includes SONAR pulse-pair velocity estimates from multiple receiver pairs characterized by the same correlation time. For example, multiple receiver pairs in array 404 are characterized by a correlation time of 3A (i.e., 13 and 16; 14 and 1; 9 and 6; and 8 and 5). A SONAR-cycle velocity estimate may, therefore, include the contributions from SONAR pulse-pair velocity estimates based on multiple receiver pairs such as receivers 13 and 16 and:
At operation 614, weighting coefficients for each SONAR pulse-pair velocity estimate are determined based on equation (5) above. In some alternative embodiments, weighting coefficients are determined by direct calculation. In some alternative embodiments, weighting coefficients are estimated. Although in the illustrative embodiment, weighting coefficients are determined using equation (5), it will be clear to those skilled in the art, after reading this specification, how to make and use alternative embodiments of the present invention that determine weighting coefficients by means other than equation (5).
At operation 616, a weighted SONAR-cycle velocity estimate is calculated based on the calculated weighting coefficients and the pulse-pair velocity estimates determined in operations 608, 612, and 614.
In some embodiments of the present invention, an optimal recursive stochastic filter, such as a Kalman filter, is used to continuously refine the estimated velocity for a vessel.
It is to be understood that the above-described embodiments are merely illustrative of the present invention and that many variations of the above-described embodiments can be devised by those skilled in the art without departing from the scope of the invention. For example, in this Specification, numerous specific details are provided in order to provide a thorough description and understanding of the illustrative embodiments of the present invention. Those skilled in the art will recognize, however, that the invention can be practiced without one or more of those details, or with other methods, materials, components, etc.
Furthermore, in some instances, well-known structures, materials, or operations are not shown or described in detail to avoid obscuring aspects of the illustrative embodiments. It is understood that the various embodiments shown in the Figures are illustrative, and are not necessarily drawn to scale. Reference throughout the specification to “one embodiment” or “an embodiment” or “some embodiments” means that a particular feature, structure, material, or characteristic described in connection with the embodiment(s) is included in at least one embodiment of the present invention, but not necessarily all embodiments. Consequently, the appearances of the phrase “in one embodiment,” “in an embodiment,” or “in some embodiments” in various places throughout the Specification are not necessarily all referring to the same embodiment. Furthermore, the particular features, structures, materials, or characteristics can be combined in any suitable manner in one or more embodiments. It is therefore intended that such variations be included within the scope of the following claims and their equivalents.
This case claims priority of U.S. Provisional Patent Application 60/677,522, filed May 4, 2005, which is incorporated by reference herein. In addition, U.S. Provisional Patent Application 60/690,881, filed Jun. 15, 2005, and U.S. patent application Ser. No. 11/327,702, filed Jan. 6, 2006, are incorporated by reference herein.
Number | Date | Country | |
---|---|---|---|
60677522 | May 2005 | US |