Not applicable.
Not applicable.
Not applicable.
Not applicable.
1. Field of the Invention
The present invention relates to processes and systems for the precise positioning of subsea units. More particularly, the present invention relates to the integrated use of inertial measurement units, doppler velocity logs and baseline measurement devices for producing a Kalman-filtered output indicative of subsea position.
2. Description of Related Art Including Information Disclosed Under 37 CFR 1.97 and 37 CFR 1.98.
Few techniques presently exist for reliable three-dimensional position sensing for underwater vehicles. Depth, altitude, heading and roll/pitch attitude can all be instrumented with high bandwidth internal sensors. XY position, in contrast, remains difficult to instrument and is normally measured acoustically in oceanographic and commercial applications.
Conventional long-baseline acoustic navigation systems require multiple fixed transponders, i.e., fixed or moored on the sea floor, on the hull of a surface ship, or on sea-ice. With a maximum acoustic range of 5 to 10 kilometers, fixed long-baseline networks can cover only limited mission areas. Moreover, existing long-baseline navigation systems are designed to navigate one vehicle per interrogation-response acoustic cycle during a time division multiple access scheme. This is acceptable for single vehicle deployments, but less desirable for multi-vehicle deployments because the interrogation-response navigation update period increases linearly with the number of vehicles (thereby proportionately decreasing each vehicle's overall navigation update rate). In practice, this limits multi-vehicle log baseline navigation to networks of a few vehicles. The existing prevalence of long baseline systems within the oceanographic community is due to a lacuna of alternative means for obtaining bounded-error subsea XY position.
While the advent of the global positioning systems allows bounded-error terrestrial navigation for both surface and air vehicles, seawater is opaque to the radio-frequencies upon which GPS relies and, thus, GPS cannot be used by submerged underwater vehicles. Though ultra-short-baseline acoustic navigation systems are preferred for short-range navigation, they are of limited usefulness for long-range navigation and, furthermore, also suffer from the same update problem as long baseline navigation systems.
The high cost and power consumption of inertial navigation systems has, until now, precluded their widespread use in non-military undersea vehicles. Compact, low-cost, low-power inertial navigation systems have recently become commercially available so as to offer an alternative method for instrumenting absolute XYZ displacement. Modern commercial navigation system position error is in the order of one percent of path-length, hence, inertial navigation systems alone are inadequate to support the needs of long-range bounded-error navigation.
Acoustic doppler current profilers are types of sonar that attempt to produce a record of water current velocities over a range of depths. The most popular acoustic doppler current profilers use a scheme of four ceramic transducers which work in water similar to loudspeakers in air. These transducers are aimed in such a way that the monofrequency, sound pulse they produce travels through the water in four different, but known directions. If the acoustic doppler current profiler is looking down into the water, each transducer would be aligned at 12, 3, 6 and 9 o'clock positions facing away from the perimeter of the clock. These are tilted down 90 degrees in elevation below the horizon. As the echo of the sound is returned by scatterers in the water, it is shifted in frequency due to the doppler effect. In addition to the transducers, the acoustic doppler current profiler typically has a receiver, an amplifier, a clock, a temperature sensor, a compass, a pitch-and-roll sensor, analog-to-digital converters, memory, digital signal processors and an instruction set. The analog-to-digital converters and digital signal processors are used to sample the returning signal, determine the doppler shift, and sample the compass and other sensors. Trigonometry, averaging and some critical assumptions are used to calculate the horizontal velocity of the group of echoing scatters in a volume of water. By repetitive sampling of the return echo, and by “gating” the return data in time, the acoustic doppler current profiler can produce a profile of the water currents over a range of depths.
The acoustic doppler current profiler can also be an acoustic doppler velocity log if it is programmed with the correct signal processing logic. The doppler velocity log bounces sound off of the bottom and can determine the velocity vector of a subsea vehicle moving across the sea floor. This information can be combined with a starting fix to calculate the position of the vehicle. Doppler velocity logs are used to help navigate submarines, autonomous underwater vehicles, and remotely-operated vehicles for precise positioning in an environment where GPS, and other navigational aids, will not work.
Long baseline systems consist of an array of at least three transponders. The initial position of the transponders is determined by USBL and/or by measuring the baselines between the transponders. Once that is done, only the ranges to the transponders need to be measured to determine a relative position. The positions should theoretically be located at the intersection of the imaginary spheres, one around each transponder, with a radius equal to the time between transmission and reception multiplied by the speed of sound through the water. Because angle measurement is not necessary, the accuracy in great water depths is better than ultra-short baseline measurement.
The inertial measurement unit is a closed system that is used to detect altitude, location and motion. Typically installed in aircrafts, it normally uses a combination of accelerometers and angular rate sensors (i.e., gyroscopes) to track how long the craft is moving and where it is. Typically, an inertial measurement unit detects the current acceleration and rate of change in attitude, (i.e. pitch, roll and yaw rates) and then sums them to find the total change from the initial position. IMU's typically suffer from accumulated error. Because an IMU is continually adding detected changes to the current position, any error in the measurement is accumulated. This leads to “drift”, or an ever increasing error between what the IMU thinks the position is and the actual position. IMU's are normally one component of a navigation system. Other systems such as GPS (used to correct for long term drift in position), a barometric system (for altitude correction), or a magnetic compass (for attitude correction) compensate for the limitations of an IMU. The IMU will typically contain three accelerometers and 3 gyroscopes. The accelerometers are placed such that their measuring axes are orthogonal to each other. They measure so-called “specific forces” (inertial acceleration—gravity). Three gyros are placed such that their measuring axis are orthogonal to each other so as to measure the rotation rates.
As stated previously, each of these systems has its own problems. Often, the problems will result in the transmitted signal to accumulating “noise” over time. This “noise” is the error in the measured data as the result of the particular problems associated with each of these systems. As stated herein before, inertial measurement units tend to have very accurate initial measurements but tend to accumulate error over time. The doppler velocity logs require that all of the transducers work perfectly in order to achieve the requisite data. If any of the transducers should fail or if any of the transducers should become misaligned, then the positioning data from such doppler velocity logs can become compromised. Often, the analysis from a doppler velocity log is terminated whenever one of the transducers should fail to work or should go into misalignment. The long baseline measurement systems require a great deal of time and effort to install. Initially, each of the transponders must be installed on the ocean floor at a precise location. Once these are installed in the precise location, then the movement of the ROV through this array of transponders can be monitored very accurately. However, in many circumstances, a cable will run from the ROV to a ship whereby the “ping” for the initiation of the acoustic signal is ordered from the ship and the data is accumulated by way of the long line extending from the ROV to the ship on the surface of the water. As a result, there is some time delay in the transmission of the signal from the ROV to the ship. Pressure transducers are only effective at measuring the depth of the ROV and do not provide effective information regarding the position of the ROV beyond the depth measurement. As such, a need is developed so as to create a processing system which would overcome the problems associated with each of the components of the prior art.
In the past, various patents have issued related to systems for the tracking of various vehicles. For example, U.S. Pat. No. 7,132,982, issued on Nov. 7, 2006 to Smith et al., describes a direct multilateration target tracking system that is provided with a TOA time stamp as an input. The system includes a technique of tracking targets with varying receiver combinations. A method is provided for correlating and combining various modes of messages to enhance target tracking in a passive surveillance system. The system provides a technique for selecting the best receiver combination and/or solution of multilateration equations from a multitude of combinations.
U.S. Pat. No. 7,171,303, issued to Nordmark et al., provides a navigation method and apparatus for generating at least one high-accuracy navigation parameter. This system includes a relative sensor system adapted to register relative movements of the apparatus in response thereto to produce one relative data signal. A radio receiver system is adapted to receive navigation data signals from a plurality of external signal sources so as to produce at least one tracking data signal. The radio receiver system includes a central processing unit adapted to receive the tracking data signal, receive the relative data signal, and produce at least one navigation parameter. A clock unit is adapted to produce a first clock signal to form a sampling basis in the radio receiver system and a second clock signal to form a sampling basis in the relative sensor system. A common software module is adapted to realize at least one function of the radio receiver system and at least one function of the relative sensor system. The common software module includes the central processing unit which includes a Kalman filter.
U.S. Pat. No. 7,046,188, issued to Zaugg, et al., provides an active tracking system that has a Kalman filter used to track a target while the plurality of detections occur within a gate over a period of time. A blind-zone particle filter is used to concurrently propagate with the Kalman Filter when an absence of detections occur with the gate following the polarity of detections until a probability that the target is in a blind zone exceeds a threshold. An unrestricted-zone particle filter is provided to concurrently propagate with the blind-zone particle filter after a gated detection is received and while a probability that the target is in an unrestricted zone exceeds a threshold. A controller is provided to return the Kalman filter to tracking the target when a covariance of the unrestricted-zone particle filter falls below a predetermined covariance.
It is an object of the present invention to provide a process and system for the precise positioning of subsea units which is very reliable and very accurate.
It is another object of the present invention to provide a process and system for position detection that enhances productivity.
It is a further object of the present invention to provide a positioning system that can be carried out in poor visibility conditions.
It is another object of the present invention to provide a positioning system which optimizes safety.
It is still another object of the present invention to provide a positioning system that allows for dynamic measurement of subsea position.
It is a further object of the present invention to provide a positioning system that can compensate for the errors found in existing systems so as to produce an improved result through the use of a Kalman filter.
It is still another object of the present invention to provide a positioning system and process which avoids any time delay from the transmission of signals to the surface of the water during long baseline measurement.
It is still a further object of the present invention to provide a positioning system and process which avoids any problems associated with the failure of one or more transducers associated with a doppler velocity log.
These and other objects and advantages of the present invention will become apparent from a reading of the attached specification and appended claims.
The present invention is a system for the precise measurement of subsea units that comprises a remotely operated vehicle, an inertial measurement unit positioned on the remotely operated vehicle so as to produce a signal relative to a position of the subsea unit, a doppler velocity log coupled to the remotely operated vehicle so as to produce a signal relative to the position of the subsea unit, a baseline measurement device coupled to the remotely operated vehicle for producing a signal relative to the position of the subsea unit, a Kalman filter cooperative with the signal from the inertial measurement unit, the doppler velocity log and the baseline measurement device. A processing means is cooperative with the Kalman filter for producing an output indicative of the position of the subsea unit.
In the present invention, the doppler velocity log has a plurality of beams. The Kalman filter is coupled individually to this plurality of beams. The baseline measurement device includes a transmitter affixed to the remotely operated vehicle, a receiver affixed to the remotely operated vehicle, and a transponder positioned on a subsea surface. The transponder means is interactive with the transmitter and the receiver for producing the signal relative to the position of the subsea unit. The receiver time tags a signal as passed by the transmitter immediately as the signal is transmitted.
There is a pressure transducer that is connected to the remotely operated vehicle and cooperative with the Kalman filter for producing a signal relative to a depth of the remotely operated vehicle. The processing means records data from the Kalman filter in relation to time. The processing means can include a UART interposed between the inertial measurement unit and the doppler velocity log and the baseline measurement device. The processing means also includes a time-tagging means coupled to the UART for time-tagging data immediately upon receipt by the UART.
The remotely operated vehicle can be either a towfish, a cable-connected remotely operated vehicle or a non-cable connected remotely operated vehicle. The transponder can include a pair of transponders positioned on the subsea surface. Each of the pair of transponders is placed in a desired position relative to a path of travel of the remotely operated vehicle. A clock is cooperative with the processing means for assigning a time relative to the signals as received from the Kalman filter. The Kalman filter serves to compensate for any deviations occurring between the signals received from the inertial measurement unit, the doppler velocity log and the baseline measurement device.
The present invention is also a process for determining a precise position of a subsea unit comprised of the steps of: (1) producing a first signal from an inertial measurement unit relative to the position to the subsea unit; (2) producing a second signal from a doppler velocity log relative to the position of the subsea unit; (3) producing a third signal from a baseline measurement device relative to the position of the subsea unit; (4) Kalman filtering the first signal, the second signal and the third signal so as to compensate for any deviations between the signals so as to produce a measurement signal; and (5) processing the measurement signal so as to produce an output indicative of the precise position of the subsea unit.
The process of the present invention also includes the step of emitting a plurality of beams from the doppler velocity log such that the second signal is transmitted from each of the plurality of beams. The process also includes the steps of placing at least a pair of transducers on a subsea surface, transmitting an acoustic signal from the subsea unit to the transponders, and receiving the acoustic signals by the subsea unit. The acoustic signal is timed-tagged immediately upon transmission by the subsea unit. The receiver is positioned in proximity to the transmitter on the subsea unit. The receiver time tags the acoustic signal upon an initiation of the transmission by the transmitter. The subsea unit is moved relative to the transponders during the steps of transmitting and receiving.
The method of the present invention can also include producing a fourth signal from a pressure transducer relative to a depth of the subsea unit, and Kalman filtering the fourth signal so as to compensate for any deviations between the fourth signal and the first, second and third signals. The measurement signals are time-tagged immediately prior to the step of processing.
Referring to
From the diagram of
An “Additional Essential Data” block 56 allows further information to be provided during the processing of the “Primary Position Aiding Observations” block 58. This “Additional Essential Data” can include time (as measured by the GPS), the speed of sound, the time of validity, and other precision estimates. The information from the “Primary Position Aiding Observations” block 58 and “Additional Essential Data” block 56 are transmitted as an input into the “Sensor Data Handling” block 60. In the Sensor Data Handling, the signals are time-tagged, preprocessed, initialized and calibrated. The signals are then transmitted to Kalman filter 62. Kalman filter 62 will analyze the data and correct the data, as required in corrections block 64, prior to being delivered to processor 66.
The Kalman filter 62 is a recursive estimator. This means that only the estimated state from the previous time step and the current measurement are needed to compute the estimate for the current state. In contrast to batch estimation techniques, no history of observations and/or estimates is required. It is unusual in being purely a time domain filter. Most filters (for example, a low-pass filter) are formulated in the frequency domain and then transformed back to the time domain for implementation. The Kalman filter has two distinct phases: predict and update. The predict phase uses the estimate from the previous time step to produce an estimate of the current state. In the update phase, measurement information from the current time step is used to refine this prediction to arrive at a new, more accurate estimate. As such, the Kalman filter provides an accurate estimate in the state of a dynamic system from a series of incomplete and noisy measurements. The Kalman filter exploits the dynamics of the target, which govern its time evolution, to remove the effects of the noise and to obtain a good estimate of the location of the target at the present time (filtering), at a future time (prediction), or at a time in the past (interpolation or smoothing).
The inertial measurement unit 32 transmits its signal directly to the processor 66 or to the Sensor Data Handling block 60. As such, the Kalman filter 62 can reconcile the signal from the inertial measurement unit 32 with the data from the Primary Position Aiding Observations block 58 so as to allow the processor 66 to determine the precise position of the subsea unit 10.
The foregoing disclosure and description of the invention is illustrative and explanatory thereof. Various changes in the details of the illustrated system or in the steps of the described method can be made within the scope of the appended claims without departing from the true spirit of the invention. The present invention should only be limited by the following claims and their legal equivalents.