**METHOD AND SYSTEM FOR DETERMINING HEAVE AND HEAVE RATE OF VESSELS**

Vaujin, Michael O. (5 Harbor Woods Circle, Safety Harbor, FL, 34695, US)

Morgan, Kenneth S. (6360 18th Street, N.E. St. Petersburg, FL, 33702, US)

Marsh, Vernon F. (7848 93rd St. North, Seminole, FL, 33777, US)

*;*

**B63B39/00***; (IPC1-7): B63B39/00*

**G01C21/16**US6382022B1 | 2002-05-07 | |||

US4986121A | 1991-01-22 | |||

EP0261731A2 | 1988-03-30 |

SCHERZINGER B M ET AL: "Low cost inertial/GPS integrated position and orientation system for marine applications" POSITION LOCATION AND NAVIGATION SYMPOSIUM, 1996., IEEE 1996 ATLANTA, GA, USA 22-26 APRIL 1996, NEW YORK, NY, USA,IEEE, US, 22 April 1996 (1996-04-22), pages 452-456, XP010163310 ISBN: 0-7803-3085-4

See also references of EP 1507700A2

1. | A method for determining heave and heave rate at a point C on a vessel (40), the vessel (40) having an inertial navigation system (INS) (10), sensors (22) for the INS (10) being located at a point A on the vessel (40), the vessel (40) having a zero heave reference point B, said method comprising: determining reference coordinates for points A, B, and C; generating a velocity signal representative of a velocity at a point on the vessel; generating a heave rate signal based on the velocity signal; and generating a heave signal based upon the heave rate signal. |

2. | A method according to Claim 1 wherein determining reference coordinates comprises: determining body coordinates for the vessel (40) at points A, B, and C; and determining local level coordinates for the vessel (40) at points A, B, and C. |

3. | A method according to Claim 2 wherein, for point C of the vessel (40), determining a velocity of the vessel (40) comprises: defining a transformation direction cosine matrix CBL, which redefines a vector expressed in body frame coordinates into a vector expressed in local level coordinates; determining a lever arm from point A to point C, RAC ; and calculating a velocity at point C, using a known velocity at point A according to Vc =VAL +CBIB B xRAc), where VAL is the local level velocity at point A, VcL is the local level velocity at point C, and we is the body frame angular rate of the vessel. |

4. | A method according to Claim 3 wherein filtering the velocity signal (62) to provide a heave rate signal comprises filtering a third element of VCL I Vct (3), with a high pass filter (60) to determine a heave rate, P (3) (64). |

5. | A method according to Claim 4 wherein integrating the heave rate signal (62) to determine a heave comprises calculating a heave according to Heave=Y (3) t+CBRB (3) ro, where represents heave rate integration, and CBLRBC (3),, is an initial condition on the integration, the initial condition being a local level vertical distance between point B and point C, which was valid at time to, the starting time of the integration. |

6. | A method according to Claim 2 further comprising: defining a transformation direction cosine matrix CBE, which redefines a vector expressed in body frame coordinates into a vector expressed in local level coordinates; and determining a lever arm from point A to point C, RAC. |

7. | A method according to Claim 6, wherein velocity of the vessel is known at point A, and wherein filtering the velocity signal (72) to provide a heave rate signal (74) comprises determining heave rate of the vessel according to V, (3) = #AL (3) + [C L (0) Bx RAC) 13) t, where VA (3) is a filtered third element of local level velocity at point A, Vct (3) is the third element of local level velocity at point C, ooB is the body frame angular rate of the vessel, and the subscript tk indicates that the term is updated every iteration. |

8. | A method according to Claim 7 wherein integrating the heave rate signal (74) to determine a heave comprises determining a heave according to where the subscript tk indicates that the term is updated at every iteration. |

9. | A method according to Claim 1 wherein filtering the velocity signal (104) to provide a heave rate signal (106) comprises filtering the velocity signal according to the transfer function [(1+z1)(1+z2)/4] # [4/(3348z1+19z2)] # [1((1_z 4) (1+Z 8) (l+zl6)/ (15,50030, 750z16+15, 254z32) (125123zl6))]. |

10. | A method according to Claim 1 wherein integrating the heave rate signal (106) to provide a heave (120) comprises filtering the heave rate signal (106) according to the transfer function (1/200)/ (1z1). |

11. | A method according to Claim 10 further comprising filtering the heave (120) according to 1 [(l+z4) (1+z8) (1+z'6)/(15, 50030, 750z16+15, 254z 32) (125123z16)]. |

12. | An inertial navigation system (INS) (10) for determining a heave and a heave rate for a vessel (40), said system (10) comprising: a main unit (12); a user interface unit (16); a global positioning satellite (GPS) receiver (18); and a sensor unit (20) comprising an inertial sensor assembly (ISA) (22), said ISA (22) located at a point A of the vessel (40), the vessel (40) having a zero heave reference point B, said main unit (12) comprising interfaces for communication of inertial navigation information to other system on the vessel (40), said user interface unit (16) comprising a display and keypad, said system (10) configured with reference coordinates for points A, B, and C, point C being a location at which it is desired to be provided heave and heave rate data, said system (10) configured to determine a velocity of the vessel (40) at a point on the vessel (40), velocity being represented by a signal, filter the velocity signal to provide a heave rate signal, and integrate the heave rate signal to determine a heave. |

13. | An INS system (10) according to Claim 12 wherein the reference coordinates for points A, B, and C of the vessel (40) comprise: body coordinates for the vessel (40) at points A, B, and C; and local level coordinates for the vessel (40) at points A, B, and C. |

14. | An INS system (10) according to Claim 13 wherein to determine a velocity for point C of the vessel (40) said system (10) is configured to: define a transformation direction cosine matrix Which redefines a vector expressed in body frame coordinates into a vector expressed in local level coordinates; determine a lever arm from point A to point C, RAC ; and calculate a velocity signal (62) at point C, using a known velocity at point A according to V =VA +CB (wB xRA), where VA is the local level velocity at point A, Zizis the local level velocity at point C, and #B is the body frame angular rate of the vessel (40). |

15. | An INS system (10) according to Claim 14 wherein to filter the velocity signal (62) to provide a heave rate signal (64), said system (10) is configured to filter a third element of VCL, V, (3), with a high pass filter (60) to determine a heave ratesignal, t (3) (64). |

16. | An INS system (10) according to Claim 15 wherein to integrate the heave rate signal (64) to determine a heave, said system is configured to calculate a heave according to Heave = ##CL(3)#t + CBLRBC(3)t0, where E ^ (3) At, represents heave rate integration, and CBtRBC (3)"is an initial condition on the integration, the initial condition being a local level vertical distance between point B and point C, which was valid at time to, the starting time of the integration. |

17. | An INS system (10) according to Claim 13 wherein said system (10) is configured to: define a transformation direction cosine matrix CBE, which redefines a vector expressed in body frame coordinates into a vector expressed in local level coordinates; and determine a lever arm from point A to point C, RAC. |

18. | An INS system (10) according to Claim 17, wherein said system (10) is provided a velocity (72) of the vessel at point A, and wherein to filter the velocity signal (72) to provide a heave rate signal (74), said system (10) is configured to determine heave rate of the vessel according to Vc (3) = VA (3) + [C (#B # RAC)](3)tk, where VA (3) is a filtered third element of local level velocity at point A, Vc (3) is the third element of local level velocity at point C, coB is the body frame angular rate of the vessel (40), and the subscript tk indicates that the term is updated every iteration. |

19. | An INS system (10) according to Claim 18 wherein to integrate the heave rate signal (74) to determine a heave, said system (10) is configured to determine a heave according to where the subscript to indicates that the term is an initial condition and is only calculated once at the start of integration. |

20. | A filter comprising: a first stage (100) configured to provide a heave rate signal (106) based upon a velocity signal input (104); and a second stage (102) configured to provide a heave signal (128) by filtering the heave rate signal (106) output by said first stage (100). |

21. | A filter according to Claim 20 wherein said first stage (100) is configured to filter the velocity signal (104) input according to the transfer function <BR> <BR> <BR> [(1+z1)(1+z2)/4] # [4/(3348z1+19z2)] # [1((1+z4)(1+z8)(1+z16) / (15,500 30, 750zl6+15, 254z32) (125123z16))], and said second stage (102) is configured to filter the heave rate signal (106) according to the transfer function (1/200)/(1zl). |

22. | A filter according to Claim 21 wherein said second stage (102) is configured to filter the heave signal (120) according to according to the transfer function 1 [ (1+z4)(1+z8)(1+z16)/(15,50030,750z16+15,254z32)(125123z16)], providing a filtered heave distance signal (128). |

Heave is the vertical distance of motion relative to sea-level. and a vertical motion of a vessel riding waves at sea, relative to sea level, is generally referred to as heave rate. For a vessel riding the waves, the vertical motion is simply an oscillation about sea-level, having a zero long-term average of earth-relative displacement and velocity. Heave and heave rate values are utilized in controlling various operations, such as, to control a tether to a submerged diver, submarine, and for other underwater operations, as well as to define a motion of a sonar transmitter, and to define deck motion at a point for landing operations of a helicopter.

Some known inertial systems are used to measure heave and heave rate. However, a vertical channel of a pure inertial system typically has divergent errors. A global positioning satellite (GPS) system can be used to compensate for such divergence, but the GPS system itself may introduce errors into the heave and heave rate determinations.

BRIEF SUMMARY OF THE INVENTION In one aspect, a method for determining heave and heave rate for a vessel is provided. In an exemplary embodiment, the vessel is equipped with an inertial navigation system (INS), and sensors for the INS are located at a selected point of the vessel, e. g. point A. The vessel further has a zero heave reference point B. The method is utilized to determine heave and heave rate at a point C of the vessel, where point C is a different point than points A and B. More particularly, the method comprises determining reference coordinates for points A, B, and C of the vessel, generating a signal representative of velocity at a point on the vessel, generating a

heave rate signal based upon the velocity signal, and generating a heave signal based upon the heave rate signal.

In another aspect, an inertial navigation system (INS) for determining a heave and a heave rate for a vessel is provided. The INS system comprises, in an exemplary embodiment, a main unit, a user interface, a global positioning satellite (GPS) receiver, and a sensor unit. The sensor unit comprises an inertial sensor assembly located at a point A of the vessel. The main unit comprises interfaces for communication of inertial navigation information to other control systems on the vessel. The INS is configured to determine reference coordinates for points A, B, and C of the vessel, a heave, and a heave rate for the vessel.

In a further aspect, a filter is provided which comprises a first stage and a second stage. The first stage is configured to generate an output signal representative of a heave rate based, at least in part on a velocity signal input. The second stage is configured to generate an output signal representative of heave by filtering the heave rate signal output by the first stage.

BRIEF DESCRIPTION OF THE DRAWINGS Figure 1 is a block diagram of an inertial navigation system.

Figure 2 is a diagram illustrating factors utilized in determining heave and heave rate.

Figure 3 is a block diagram of a filter.

Figure 4 is a block diagram of a filter utilizing a different input than the filter of Figure 3.

Figure 5 is a detailed block diagram of two filters, illustrating transfer functions for each filter.

DETAILED DESCRIPTION OF THE INVENTION The features and principles are described herein relative to an exemplary embodiment thereof. It will be apparent to those skilled in the art that numerous variations and modifications may be made to the exemplary embodiment without departing from the spirit and scope. The systems and methods are not limited to the specific embodiments described herein. Components of each system and method can be practiced independent and separate from other components and methods. Each system and method also can be used in combination with other components, systems, and methods.

A system that provides an accurate representation of heave and heave rate of a vessel, as measured by a strapdown inertial system (INS), is described in detail below. Generally, the system utilizes digital band pass filtering to remove long- term bias errors due to specific force measurement and modeling of local gravity. In addition, the system performs lever-arm corrections to define velocity at points of the vessel other than points at which sensors of the INS are located, using measured values of angular velocity of the vessel. As used herein, the term vessel means any structure which may incorporate a system for determining heave and heave rate including, but not limited to, ships, boats, submarines, submersibles, marine vessels, unmanned water vehicles, military vessels, amphibious aircraft, torpedoes, and any other watercraft in a marine environment.

Figure 1 is a block diagram of an inertial navigation system (INS) 10 for marine use. System 10 includes a main unit 12 to which is connected a power supply 14. Also connected to main unit 12 are a user interface unit 16, a global positioning satellite (GPS) receiver 18, and a sensor unit 20 which includes an inertial sensor assembly (ISA) 22. Main unit 12 is configured with interfaces 24 to provide inertial navigation information to, for example, a main navigation system within a vessel, or other systems within a vessel that may utilize navigation information. ISA 22, within sensor unit 20 incorporates gyroscopes and accelerometers (not shown) and sensor unit 20 includes gyroscope electronics. In one embodiment, the gyroscope is a laser gyro. User interface unit 16 provides a user interface, including a display and

keypad (neither shown) for display of inertial information and alteration of display modes and operating parameters.

Figure 2 is a diagram of a vessel 40 illustrating a location of ISA 22, herein denoted as point A. Point B is referred to as a heave zero reference point. In one embodiment, point B is chosen to be at a mean water line and at a mean center of rotation of vessel 40. One purpose for designating point B is to compensate for a static tilt of vessel 40. Another purpose for the designation is compensation for how high or low vessel 40 is riding in water 42 due to buoyancy. Point C is a point at which it is desirable to know heave and heave rate for vessel 40, for example, where a winching system is connected to a submersible (not shown).

To determine heave and heave rate for vessel 40, reference coordinates are defined. Specifically, body frame coordinates are defined with respect to a bow, a starboard side and a belly of vessel 40. Local level frame coordinates are defined as north, east, and down. CL is a transformation direction cosine matrix that redefines a vector expressed in body frame coordinates into a vector expressed in local level coordinates. For transformation matrices, the subscript indicates the frame the vector is to be taken from, and the superscript indicates the frame the vector is to be taken to.

Therefore referring to the above transformation direction cosine matrix, the"B"refers to body frame coordinate vectors, and"L"refers to local level frame vectors.

A lever arm from point A to point C is given as RAC'and a lever arm from point A to point B is given as RAB. Lever arms, as known in the art, are vectors representing distance and direction. Lever arms herein are defined in body frame coordinates. Referring to Figure 2, a lever arm from point B to point C can be described as: RBC =RAC RAB Eq (1) Velocity of vessel 40 is known at point A, based upon data from INS 10. Therefore velocity at point C is calculated as:

VCL = VAL + CBL(#B # RAC). Eq (2) Superscripts on the above variables indicate which frame, body coordinates or local level coordinates, the variable is defined in. Therefore, VA is the local level velocity at point A, VcL is the local level velocity at point C, and (ยป B is the body frame angular rate of vessel 40.

In one embodiment, inertial navigation system (INS) 10 includes a filter module that provides heave and heave rate by filtering an altitude channel of INS 10. In at least some known applications, the altitude channel of INS 10 is augmented with external measurements from a global positioning satellite (GPS), for example.

Other applications provide augmentations for the altitude channel of INS 10 from one or more of GPS, pressure altitude, or simply loosely slaving the altitude channel of INS 10 to zero (i. e. sea-level altitude).

To remove bias errors, such as bias errors from altitude and altitude rate, high pass filtering is used to arrive at signals representative of heave and heave rate, thereby avoiding the errors associated with GPS, baro-altimeter or other measurement systems.

Referring to Figure 3 a filter module within INS 10 is shown. A third element of VCL referred to herein as VCt (3), is input into a high pass filter 60 to remove any DC or very low frequency components. Providing an input 62 of VcL (3) to filter 60 results in an output 64 of P^CL (3). Output 64, the signal that results from filtering through filter 60, is the heave rate of vessel 40. Heave rate is therefore stated mathematically as follows: HeaveRate= t (3). Eq (3) In one embodiment of system 10 (shown in Figure 1), a 200 Hz attitude rate is utilized in conjunction with Eq (2) which contains an inherent white noise variance of 6. 0e-6 (radians) 2/(second) 2.

A change in vertical position of vessel 40, that is, heave or heave distance, is then calculated by integration of the heave rate signal. An example calculation for heave signal, utilizing a heave rate signal follows: Heave=V (3) Ot+CBRB (3) 0. Eq (4) In Eq (4), the first term, represents heave rate integration, and the second term, CB RB (3) ro, is the initial condition on the integration. The initial condition represents a local level vertical distance between point B and point C, which was valid at time to, a starting time of the integration.

Since white noise is inherent in the attitude rate, as determined by INS 10, output 64 of high pass filter 60 may be unpredictable when input 62 contains such white noise. It is therefore desirable that the data to be filtered in a for determination of heave and heave rate be as accurate as possible. In the embodiments described herein, the most accurate data is the data for point A. Therefore, an alternative embodiment of a heave algorithm implemented within a filter module in INS 10 is provided which results in a calculation for heave and heave rate with results similar to those described above. This alternative embodiment, illustrated in Figure 4, introduces less noise.

Referring specifically to Figure 4, high pass filter 70 receives a local level vertical velocity signal at an input 72, the local level vertical velocity is provided from INS 10 at point A, as represented by the input variable in the Figure. In one specific embodiment, local level vertical velocity is a signal provided at 200 Hz. In such an embodiment, a heave rate signal is calculated as: The subscript tk in the second term of Eq (5) indicates that the term is updated every iteration. Utilizing Eq (4), heave is then calculated as an integration of Eq (5), which follows:

The subscript t, in the second term and in the third term indicates that the term is updated every iteration. Equations 5 and 6 provide signals for heave and heave rate which are similar to those provided by filter 60 (shown in Figure 3), but with less potential for noise and unpredictable behavior in the filtering process.

Figure 5 illustrates a specific embodiment of a filter 100 implemented within INS 10. Filter 100 determines heave rate utilizing vertical velocity, and a filter 102 which determines a filtered heave distance utilizing heave rate. Referring specifically to filter 100, vertical velocity is received at input 104 and heave rate is placed at output 106. Referring specifically to elements within filter 100, a first filter element 108, which has a transfer function of (1+z-1)(1+z-2)/4, receives vertical velocity as input. An output of first filter element 108 is input to both of a positive input of a subtraction element 110 and an input of a second delay element 112.

Second delay element 112 has a transfer function of (1+z04)(1+z-8)/(15, 500-30, 750z- 16+15, 254z 32). An output of element 112 is input to a third delay element 114. Third delay element 114 has a transfer function of (l+z~16)/(125-123z~l6). An output of third delay element 114 is input to a negative input of subtraction element 110. An output of subtraction element 110 is provided to an input of a fourth delay element 116 that has a transfer function of 4/(33-48z~l+19z~2). Output of fourth delay element 116 is output 106, and therefore the heave rate of vessel 40.

Output of fourth delay element 116, or heave rate is input to filter 102, at a first delay element 118. First delay element 118 has a transfer function of (1/200)/ (l-z''). Output of first delay element 118 is heave 120. Heave 120 is input to a positive input of subtraction element 122 and an input of a second delay element 124. Second delay element 124 has a transfer function of (l+z-4) (1+z-8)/ (15, 500- 30, 750z-l6+15, 254z-32). An output of second delay element 124 is input to a third delay element 126. Third delay element 126 has a transfer function of (1+z-16)/(125- 123z-'6). An output of third delay element 126 is input to a negative input of subtraction element 122. An output of subtraction element 122 is the filtered heave distance of vessel 40.

Utilization of filters 100 and 102 within INS 10, in one embodiment, provide signals with an accuracy of at least 0.1 meter for heave and 0.1 meter per second for heave rate. Filters 100 and 102 further provide a pass band of 0.1 to 2 Hertz and a group delay of less than 25 milliseconds. In the embodiments described, heave has a range of plus to minus four meters.

A particular approach is provided in the elements of filters 100 and 102. An upper edge, of the filters, out to 2 Hertz and above is configured with unity gain, within 0.015 dB, and with anti-aliasing zeros for either 50 or 200 sample per second outputs. Instead of two zeros at 100 Hertz, as is typical in certain known bi- linear transformation second order complex-pole filters, one of the zeros is moved to 50 Hertz. Filters 100 and 102 therefore do not exhibit aliasing errors, due to near 50 and 100 Hertz content, when filter output is utilized at 50 samples per second.

A low-frequency end of filters 100 and 102 is configured as a high pass filter and has unity gain, within about 0.20 dB, at 0.1 Hertz. A ratio of filter break frequency to sampling frequency, raised to the power equal to the number of filter poles, causes small differences in filter coefficients which thereby locates the poles of the filters. Although data from filters 100 and 102 is available at a high sampling rate, the poles are realized in a computation repeated at a slow rate. The purpose of the low-frequency end of filters 100 and 102 is to extract an average value for the signals.

The reduction in processing rate is therefore done in a manner that attenuates signal content that can alias to a near-zero frequency, before the reduction in frequency occurs. An analysis of such a process shows that content near the zeros is removed before an aliasing to a near-zero frequency occurs with the reduction in sampling rate. Further reduction in effect of small differences of large coefficients is to implement the overall transfer function as a cascade of first and second-order sections, rather than implementing as higher order sections.

While the invention has been described in terms of various specific embodiments, those skilled in the art will recognize that the invention can be practiced with modification within the spirit and scope of the claims.

**Previous Patent:**CONTROL AND FIXING DEVICE FOR THE SAIL OF A KITE

**Next Patent: APPARATUS FOR RECOVERY OF BURIED UNDERWATER CABLE/PIPE**