Borehole survey system utilizing strapdown inertial navigation

Claim 2

A signal processing method for use in borehole surveys of the type wherein a probe supplies inertial acceleration signals representative of probe inertial acceleration relative to the three axes of a first coordinate system that is referenced to said probe and angular rate signals representative of angular rotation of the probe about the three axes of the first coordinate system as the probe is moved along a borehole by a cable, said signal processing method comprising the steps of: (a) transforming said acceleration signals in said first coordinate system to obtain inertial signals representative of movement of said probe in a second coordinate system that is fixed relative to the earth, said inertial signals in said second coordinate system including probe velocity signals; (b) generating a signal representative of the amount of cable being fed into the entrance opening of said borehole; (c) processing said signal representative of the amount of cable being fed into said entrance opening of said borehole to obtain a signal that is representative of the progress of said probe along said borehole and is corrected for cable stretch and misalignment of the probe in the borehole and of the probe relative to the first coordinate system; (d) transforming said inertial signals representative of movement of said probe in said second coordinate system into inertial signals representative of movement of said probe in said first coordinate system; (e) combining said signal representative of said progress of said probe along said borehole with said inertial signals representative of movement of said probe in said first coordinate system to obtain error signals; (f) transforming said error signals into said second coordinate system to obtain error correction signals; (g) combining said error correction signals with said inertial signals representative of movement of said probe in said second coordinate system to obtain corrected probe velocity signals; and (h) integrating said corrected probe velocity signals to obtain signals representative of the course of said borehole relative to said second coordinate system.

Claim 3

The signal processing method of claim 1, wherein: (a) said step of transforming said acceleration signals to obtain signals representative of the movement of said probe in said second coordinate system comprises the steps of: (i) transforming said acceleration signals into said second coordinate system to obtain transformed acceleration signals representative of the probe's acceleration; and (ii) integrating said transformed acceleration signals to obtain said probe velocity signals in said second coordinate system; (b) said step of processing said signal representative of the amount of cable being fed into said entrance opening of said borehole comprises the step of generating a corrected cable length signal representative of borehole path length between said entrance opening and said probe; (c) said step of transforming said inertial signals representative of said movement of said probe in said second coordinate system to obtain the inertial signals representative of movement of said probe in said first coordinate system includes the steps of: (i) transforming said probe velocity signals from the above step (a)(ii) into said first coordinate system to obtain transformed probe velocity signals; and (ii) integrating said transformed probe velocity signals to obtain signals representative of the position of said probe in said first coordinate system; and (d) said step of combining said signal representative of progress of said probe along said borehole with said signals representative of said movement of said probe in said first coordinate system comprises subtracting said cable length signal from said signals representative of the position of said probe in said first coordinate system.

Claim 4

The signal processing method of claim 2, wherein said step of combining said error correction signals with said signals representative of movement of said probe in said second coordinate system includes the steps of: (i) scaling said error correction signals by a first set of predetermined scaling factors to obtain probe position error signals; (ii) combining said probe position error signals with said probe velocity signals in said second coordinate system to obtain corrected probe velocity signals for aiding stabilization; (iii) sealing said error correction signals by a second set of predetermined scaling factors to obtain velocity error correction signals with the magnitude of each scaling factor of said second set of scaling factors being less than the magnitude of the scaling factors of said first set of scaling factors; and (iv) combining said velocity error correction signals with said transformed acceleration signals representative of acceleration of said probe in said second coordinate system to obtain corrected transformed acceleration signals for aiding stabilization.

Claim 5

The signal processing method of claim 3 wherein the step of transforming said probe acceleration signals from said first coordinate system into said second coordinate system mathematically corresponds to matrix multiplication of said accleration signals in said first coordinate system by a transformation matrix and said signal processing method further comprises the step of updating said transformation matrix each time said signal processing method supplies one of said signals representative of said course of said borehole in said second coordinate system.

Claim 6

The signal processing method of claim 4 wherein said step of updating said transformation matrix includes the steps of: (a) generating earth rate signals; (b) generating transport rate signals based on said probe velocity signal representative of the velocity of said probe in said second coordinate system; (c) scaling said error correction signals by a third set of predetermined scaling factors to obtain tilt error correction signals; and, (d) combining said earth rate signals, said transport rate signals, said tilt error correction signals and said angular rate signals representative of angular rotation of said probe relative to said first coordinate system.

Claim 7

The signal processing method of claim 5 wherein said step of generating said earth rate signals mathematically corresponds to D E L ω IE E where ##EQU19## with l representing the latitude of the location of said borehole and a representing the wander angle associated with said location; and where ##EQU20## with ω E representing the rotation rate of the earth to obtain an incremental transformation matrix update.

Claim 8

The signal processing method of claim 6 wherein said step of generating said transport rate signals mathemetically corresponds to ω.sub.EL.sup.L =(U.sub.R.sup.L xv.sup.L)/R where v L represents said probe velocity signals representative of said velocity of said probe in said second coordinate system; R represents the radius of the earth; x denotes the vector cross-product operation; and, U R L is a column vector in which the first two entries are zero and the third entry is unity.

Claim 9

The signal processing method of claim 7 wherein said step of updating said transformation matrix further includes the steps of: (a) generating signals representative of the time rate of change in said transformation matrix; and (b) integrating with respect to time said signals representative of said time rate of change in said transformation matrix.

Claim 10

The signal processing method of claim 8 wherein said step of generating said signals representative of said time rate of change in said transformation matrix mathematically corresponds to C.sub.B.sup.L =C.sub.B.sup.L (ω.sub.IB.sup.B)-(ω.sub.IE.sup.L +ω.sub.EL.sup.L)C.sub.B.sup.L where C B L represents said signals representative of said time rate of change in said transformation matrix; C B L represents said transformation matrix; parenthenses enclosing a vector represent a skew symmetric matrix formed from the enclosed vector; and ##EQU21## with ω B x , ω B y , and ω B z respectively indicating said angular rate signals representative of angular rotation of said probe about the three axes of said first coordinate system.

Claim 11

The signal processing method of claim 9 further comprising the step of correcting said transformed acceleration signals representative of probe acceleration in said second coordinate system for Coriolis effect, the effects of centrifugal acceleration and the effect of variation in gravitational field as a function of probe depth, prior to the step of integrating said transformed acceleration signals.

Claim 12

The signal processing method of claim 10 wherein of a time rate of change in said probe velocity signals that represent said velocity of said probe in said second coordinate system corresponds to the mathematical expression: V.sup.L =TC.sub.B.sup.L A.sup.B -(2ω.sub.IE.sup.L +ω.sub.EL.sup.L)xV.sup.L -G.sup.L where V L represents said time rate of change in said probe velocity signals; V L represents said probe velocity signals; A B represents said acceleration signals representative of said probe acceleration relative to said three axes of said first coordinate system; and ##EQU22## with g z L denoting acceleration due to gravity for the current depth position of said probe.

Claim 13

The signal processing method of claim 7 wherein said step of generating said earth rate signals further comprises the steps of: (a) scaling said probe position error signal by a third set of predetermined scaling factors; and (b) generating a signal representative of the integral with respect to time of the scaled probe position error signals; and, (c) combining said signal representative of said integral with said earth rate signal to update said earth rate signal.

Claim 14

The signal processing method of claim 12 wherein said step of updating said transformation matrix further includes the steps of: (a) generating signals representative of the time rate of change in said transformation matrix; and (b) integrating with respect to time said signals representative of said time rate of change in said transformation matrix.

Claim 15

The signal processing method of claim 13 wherein said step of generating said signals representative of said time rate of change in said transformation matrix mathematically corresponds to C.sub.B.sup.L =C.sub.B.sup.L (ω.sub.IB.sup.B)-(ω.sub.IE.sup.L +ω.sub.EL.sup.L)C.sub.B.sup.L where C B L represents said signal representative of said time rate of change in said transformation matrix; C B L represents said transformation matrix; parenthenses enclosing a vector represent a skew symmetric matrix formed from the enclosed vector; and ##EQU23## with ω B x , ω B y , and ω B z respectively indicating said angular rate signals representative of angular rotation of said probe about the three axes of said first coordinate system.

Claim 16

The signal processing method of claim 3 wherein said step of generating said cable length signal representative of borehole pathlength between said entrance opening and said probe includes the step of generating a cable feed rate signal representative of the rate at which cable passes through said entrance opening; said step of processing said signal representative of said progress of said probe along said borehole comprising the steps of: (a) detecting whether the magnitude of the difference between said probe velocity signal and said cable feed rate signal exceeds a predetermined value; (b) selecting said cable feed rate signal when said magnitude of said difference between said probe velocity signal and said cable feed rate signal does not exceed said predetermined value; (c) selecting said probe velocity signal when said magnitude of said difference between said probe velocity signal and said cable feed rate signal exceeds said predetermined value; and (d) integrating with respect to time the selected one of said probe velocity signals and cable feed rate signals.

Claim 17

The signal processing method of claim 15 wherein the step of transforming said probe accleration signals from said first coordinate system into said second coordinate system mathematically corresponds to matrix multiplication of said acceleration signals in said first coordinate system by a transformation matrix and said signal processing method further comprises the step of updating said transformation matrix each time said signal processing method supplies one of said signals representative of said course of said borehole in said second coordinate system.

Claim 18

The signal processing method of claim 16 wherein said step of updating said transformation matrix includes the steps of: (a) generating earth rate signals; (b) generating transport rate signals based on said probe velocity signal representative of the velocity of said probe in said second coordinate system; (c) scaling said transformed probe position error signal by a third set of predetermined scaling factors to obtain tilt error correction signals; and, (d) combining said earth rate signals, said transport rate signals, said tilt error correction signals and said angular rate signals representative of angular rotation of said probe relative to said first coordinate system.

Claim 19

The signal processing method of claim 17 wherein said step of generating said earth rate signals mathematically corresponds to D E L ω IE E where ##EQU24## with l representing the latitude of the location of said borehole and α representing the wander angle associated with said location; and where ##EQU25## with ω E representing the rotation of the earth.

Claim 20

The signal processing method of claim 18 wherein said step of generating said transport rate signals mathematically corresponds to ω.sub.EL.sup.L =(U.sub.R.sup.L xv.sup.L)/R where v L represents said probe velocity signals representative of said velocity of said probe in said coordinate system; R represents the radius of the earth; x denotes the vector cross-product operation; and, U R L is a column vector in which the first two entries are zero and the third entry is unity.

Claim 21

The signal processing method of claim 19 wherein said step of updating said transformation matrix further includes the steps of: (a) generating signals representative of the time rate of change in said transformation matrix; and (b) integrating with respect to time said signals representative of said time rate of change in said transformation matrix.

Claim 22

The signal processing method of claim 20 wherein said step of generating said signals representative of said time rate of change in said transformation matrix mathematically corresponds to C.sub.B.sup.L =C.sub.B.sup.L (ω.sub.IB.sup.B)-(ω.sub.IE.sup.L +ω.sub.EL.sup.L)C.sub.B.sup.L where C B L represents said signal representative of said time rate of change in said transformation matrix; C B L represents said transformation matrix; parentheses enclosing a vector represent a skew symmetric matrix formed from the enclosed vector; and ##EQU26## with ω B x , ω B y , and ω B z respectively indicating said angular rate signals representative of angular rotation of said probe about the three axes of said first coordinate system.

Claim 23

The signal processing method of claim 21 further comprising the step of correcting said transformed acceleration signals representative of probe acceleration in said second coordinate system for Coriolis effect, the effects of centrifugal acceleration and the effect of variation in gravitational field as a function of probe depth, prior to the step of integrating said transformed acceleration signals.

Claim 24

The signal processing method of claim 22 wherein a time rate of change in said probe velocity signals that represent said velocity of said probe in said second coordinate system corresponds to the mathematical expression: V.sup.L =TC.sub.B.sup.L A.sup.B -(2ω.sub.IE.sup.L +ω.sub.EL.sup.L)xV.sup.L -G.sup.L where V L represents said time rate of change in said probe velocity signals; V L represents said probe velocity signals; A B represents said acceleration signals representative of said probe acceleration relative to said three axes of said first coordinate system; and ##EQU27## with g z L denoting acceleration due to gravity for the current depth position of said probe.

Claim 25

A borehole survey system comprising: a probe configured and arranged for passage along said borehole, said probe including acceleration sensing means for supplying inertial acceleration signals representative of the acceleration of said probe relative to three axes of a first coordinate system of fixed orientation relative to said probe, said probe further including angular rate sensing means for supplying angular rate signals representative of angular rotation of said probe about said axes of said first coordinate system; a cable affixed to said probe for raising and lowering said probe through said borehole; cable control means for paying out and retrieving said cable to lower said probe into and retrieve said probe from said borehole; cable measurement means for supplying a cable measurement signal representative of the amount of cable being paid out and retrieved by said cable control means; and, signal processing means connected for receiving said acceleration signals and said angular rate signals from said probe and connected for receiving said cable measurement signals from said cable measurement means, said signal processing means providing: (a) means for transforming said acceleration signals supplied by said probe into level coordinate system acceleration signals representing acceleration of said probe with respect to a second coordinate system that is fixed relative to the earth; (b) means for converting said level coordinate system acceleration signals into level coordinate system signals representing movement of said probe in said second coordinate system, said signals representing said movement of said probe including signals representing the velocity of said probe relative to said second coordinate system; (c) means for converting said level coordinate system signals representing movement of said probe into inertially derived signals representative of the movement of said probe in said first coordinate system; (d) means responsive to said cable measurement signals for supplying signals representative of the progress of said probe along said borehole and correcting those signals for cable stretch and misalignment of the probe in the borehole and of the probe relative to the first coordinate system; (e) means for combining said signal representative of progress of said probe along said borehole and said signals representative of movement of said probe in said first coordinate system to provide probe movement error signals; (f) means for transforming said probe movement error signals from said first coordinate system to said second coordinate system to obtain probe movement correction signals; (g) means for combining probe movement correction signals with said signals representing movement of said probe in said second coordinate system to provide corrected probe velocity signals; and (h) means for integrating said corrected probe velocity signals to provide signals representative of the coordinates of said borehole relative to said second coordinate system.

Claim 26

A borehole survey system comprising: a probe configured and arranged for passage along said borehole, said probe including acceleration sensing means for supplying inertial acceleration signals representative of the acceleration of said probe relative to three axes of a first coordinate system of fixed orientation relative to said probe, said probe further including angular rate sensing means for supplying angular rate signals representative of angular rotation of said probe about said axes of said first coordinate system; a cable affixed to said probe for raising and lowering said probe through said borehole; cable control means for paying out and retrieving said cable to lower said probe into and retrieve said probe from said borehole; cable measurement means for supplying a cable measurement signal representative of the amount of cable being paid out and retrieved by said cable control means; and, signal processing means connected for receiving said acceleration signals and said angular rate signals from said probe and connected for receiving said cable measurement signals from said cable measurement means, said signal processing means providing: (a) means for transforming said acceleration signals supplied by said probe into level coordinate system acceleration signals representing acceleration of said probe with respect to a second coordinate system that is fixed relative to the earth; (b) means for converting said level coordinate system acceleration signals into level coordinate system signals representing movement of said probe in said second coordinate system, said signals representing said movement of said probe including signals representing the velocity of said probe relative to said second coordinate system; (c) means for converting said level coordinate system signals representing movement of said probe into inertially derived signals representative of the movement of said probe in said first coordinate system; (d) means responsive to said cable measurement signals for supplying signals representative of the progress of said probe along said borehole and correcting those signals for cable stretch and misalignment of the probe in the borehole and of the probe relative to the first coordinate system; (e) means for combining said signal representative of progress of said probe along said borehole and said signals representative of movement of said probe in said first coordinate system to provide probe movement error signals; (f) means for transforming said probe movement error signals from said first coordinate system to said second coordinate system to obtain probe movement correction signals; (g) means for combining probe movement correction signals with said signals representing movement of said probe in said second coordinate system to provide corrected probe velocity signals; and (h) means for integrating said corrected probe velocity signals to provide signals representative of the coordinates of said borehole relative to said second coordinate system.

Claim 27

The borehole survey system of claim 24 wherein: (a) said means for supplying signals representative of progress of said probe along said borehole includes means for supplying a path length signal representative of the path length between said probe and the entrance opening of said borehole; (b) said means for converting said level coordinate system acceleration signals includes means for supplying inertially derived probe position signals comprising a part of the signals representative of movement of the probe; (c) said means for combining said signal representative of progress of said probe along said borehole and said signals representative of movement of said probe in said first coordinate system includes means for supplying said probe movement error signals by subtracting said path length signals from said probe position signals; (d) said means for transforming said probe movement error signals to obtain said probe movement correction signals includes: (i) means for scaling said probe movement error signals by a first set of predetermined scaling factors to produce a first set of probe movement correction signals; and (ii) means for scaling said probe movement error signals by a second set of predetermined scaling factors of magnitude less than said first set of predetermined scaling factors to produce a second set of probe movement correction signals; and (e) said means for combining said probe movement correction signals with said signals representing movement of said probe in said second coordinate system includes: (i) means for combining said first set of probe movement correction signals with said signals representing the velocity of said probe relative to said second coordinate system; and (ii) means for combining said second set of probe movement correction signals with said level coordinate acceleration signals.

Claim 28

The borehole survey system of claim 25, wherein said means for supplying said path length signal includes: (a) means for generating a cable feed rate signal representative of the rate at which cable passes through said entrance opening; (b) means for detecting whether the magnitude of the difference between said probe velocity signal and said cable feed rate signal exceeds a predetermined value; (c) means for selecting said cable feed rate signal when said magnitude of said difference between said probe velocity signal and said cable feed rate signal does not exceed said predetermined value; (d) means for selecting said probe velocity signal when said magnitude of said difference between said probe velocity signal and said cable feed rate signal exceeds said predetermined value; and (e) means for integrating with respect to time the selected one of said probe velocity signals and cable feed rate signals.

Claim 29

The borehole survey system of claim 25 wherein said means for transforming said acceleration signals supplied by said probe into level coordinate system acceleration signals includes means for implementing matrix multiplication of said acceleration signals supplied by said probe by a transformation matrix and wherein said signal processing means further includes means for updating said transformation matrix each time said signal processing means supplies one of said signals representative of the coordinates of said borehole relative to said second coordinate system.

Claim 30

The borehole survey system of claim 27 wherein said means for updating said transformation matrix includes: (a) means for generating earth rate signals; (b) means for generating transport rate signals based on said probe velocity signal representative of the velocity of said probe in said second coordinate system; (c) means for scaling said transformed probe position error signal by a third set of predetermined scaling factors to obtain tilt error correction signals; and (d) means for combining said earth rate signals, said transport rate signals, said tilt error correction signals and said angular rate signals representative of angular rotation of said probe relative to said first coordinate system.

Claim 31

The borehole survey system of claim 28 wherein said means for generating said earth rate signals generates said signals characterized by D E L ω IE E where ##EQU28## with l representing the latitude of the location of said borehole and a representing the wander angle associated with said location; and where ##EQU29## with ω E representing the rotation rate of the earth.

Claim 32

The borehole survey system of claim 29 wherein said means for generating said transport rate signals supplies signals characterized by: ω.sub.EL.sup.L =(U.sub.R.sup.L xv.sup.L)/R where v L represents said probe velocity signals representative of said velocity of said probe in said coordinate system; R represents the radius of the earth; x denotes the vector cross-product operation; and, U R L is a column vector in which the first two entries are zero and the third entry is unity.

Claim 33

The borehole survey system of claim 30 wherein said means for updating said transformation matrix further includes: (a) means for generating signals representative of the time rate of change in said transformation matrix; and (b) means for integrating with respect to time said signals representative of said time rate of change in said transformation matrix.

Claim 34

The borehole survey system of claim 29 wherein said means for generating said signals representative of said time rate of change in said transformation matrix generates signals characterized by the expression C.sub.B.sup.L =C.sub.B.sup.L (ω.sub.IB.sup.B)-(ω.sub.IE.sup.L +ω.sub.EL.sup.L)C.sub.B.sup.L where C B L represents said signal representative of said time rate of change in said transformation matrix; C B L represents said transformation matrix; parentheses enclosing a vector represent a skew symmetric matrix formed from the enclosed vector; and ##EQU30## with ω B x , ω B y , and ω B z respectively indicating said angular rate signals representative of angular rotation of said probe about the three axes of said first coordinate system.

Claim 35

The borehole survey system of claim 32 further comprising means for correcting said probe acceleration signals representative of probe acceleration in said second coordinate system for Coriolis effect, the effects of centrifugal acceleration and the effect of variation in gravitational field as a function of probe depth.

Claim 36

The borehole survey system of claim 33 wherein a time rate of change in said level coordinate system velocity signals is characterized by the mathematical expression: V.sup.L =TC.sub.B.sup.L A.sup.B -(2ω.sub.IE.sup.L +ω.sub.EL.sup.L)xV.sup.L -G.sup.L where V L represents said time rate of change in said velocity signals; V L represents said velocity signals; A B represents said acceleration signals representative of said probe acceleration relative to said three axes of said first coordinate system; and ##EQU31## with g z L denoting acceleration due to gravity for the current depth position of said probe.