US 5,406,489 AGrant
Instrument for Measuring an Aircraft's Roll, Pitch, and Heading by Matching Position Changes Along Two Sets of Axes
Issue Date:1995-04-11
•11 Claims
•4 Drawing Sheets
Abstract
An instrument for indirectly measuring the attitude of a moving aircraft includes three accelerometers, a GPS radio receiver, an electronic estimating module, and an electronic output module. The three accelerometers indicate three accelerations of the aircraft respectively along three aircraft body axes. The GPS radio receiver receives from GPS satellites the position and velocity of the aircraft along an earth fixed axis. The electronic estimating module estimates a vector such that a series of aircraft position changes along the three body axes that are caused by the measured accelerations, times the vector, approximately matches a corresponding series of position changes along the earth fixed axis as given by the receiver. The electronic output module generates a visual display of the roll, pitch, or heading of the aircraft by performing trigonometric functions on the vector.
Metadata
Assignee
- Unisys Corporation
Inventors
- LaMar K. Timothy
- Douglas G. Bowen
- Michael L. Ownby
- John D. Timothy
Application Information
Application Number:US 9114300
Filing Date:1992-07-10
Priority Date:1992-07-10
Art Unit:234
Classifications
IPC:
G06F 1550
Field of Search:
364342340434;559;449357;451974;975;979
Patent Drawings (4 sheets)
Description
Background of the Invention
This invention relates to aircraft navigation instruments; and more particularly, it relates to instruments which measure an aircraft's attitude in terms of roll, pitch, and heading.
In the prior art, the instruments which measure an aircraft's roll, pitch and heading have operated on inertial navigation principles. These inertial navigation instruments include three wide angle gyroscopes, and the reactions of the gyroscopes along three axes to the aircraft's movements are measured and translated into roll, pitch, and heading. An example of such an instrument is the LN-100 strap down initial navigation system by Litton Corporation.
A major drawback, however, of the above-described inertial navigation instruments is that they are too expensive to be practicable for use in many kinds of aircraft. Just the three wide angle gyroscopes, by themselves, cost about fifty-sixty thousand dollars. Consequently, in low cost drones that are shot down by the military as targets and in low cost private airplanes, inertial navigation instruments have found very little use.
Another prior instrument for measuring an aircraft's roll, pitch, and heading which operates on a different principle is disclosed is U.S. Pat. No. 5,101,356. Basically, that instrument operates on the principle of an interferometer wherein roll, pitch, and heading are measured by comparing the phases of three radio signals from three GPS receivers that are included in the instrument.
However, in the patent '356 instrument, the three GPS receivers must be separated from each other on the aircraft by as large a distance as possible (e.g.--they are located on the aircraft's nose, tail, and wing). At the same time, the three GPS receives must not move relative to each other. If both constraints are not met, the instrument will give erroneous results. But, in many cases both constraints cannot be met since an aircraft's wings generally will bend or flex during flight.
Accordingly, a primary object of the invention is to provide a novel structure for an instrument which measures the roll, pitch, and heading of an aircraft such that all of the above problems are overcome.
Brief Summary of the Invention
In accordance with the present invention, an instrument which measures the attitude of a moving aircraft has the following make-up.
1. Three accelerometers are mounted on the aircraft such that they indicate three accelerations of the aircraft respectively along three aircraft body axes.
2. A radio receiver is provided which receives from an external source, the position and velocity of the aircraft along an earth fixed axis.
3. An electronic estimating module is coupled to the accelerometers and the receiver, and it estimates a vector such that a series of aircraft position changes along the three body axes that are caused by the measured accelerations, times the vector, approximately matches a corresponding series of position changes along the earth fixed axis as indicated by the receiver.
4. An electronic output module is coupled to the estimating module, and it generates an output signal that indicates the roll, pitch, or heading of the aircraft by performing trigonometric functions on the vector.
With the above instrument, all gyroscopes are eliminated; and, each of the components that are in the instrument (i.e., the accelerometers, the radio receiver, the electronic estimating module, and the output module) are orders of magnitude less expensive than a gyroscope. Also, with the above instrument, the three accelerations need not be separated from each other by large distances. Consequently, the above instrument is both inexpensive and accurate, and that opens up a whole new market which was unreachable by the prior art.
Brief Description of the Drawings
FIG. 1 shows an aircraft which incorporates an instrument that is structured according to the present invention, and it shows some of the input signals which the instrument receives and processes to obtain the aircraft's roll, pitch, and heading;
FIG. 2 shows a detailed structure of the instrument in the FIG. 1 aircraft and that structure is a preferred embodiment of the present invention; and,
FIG. 3 shows a signal flow diagram which describes the internal operations of the electronic estimating module in FIG. 2.
Detailed Description
In order to obtain a detailed understanding of a preferred embodiment of the present invention, reference should now be made to FIGS. 1 and 2. Reference numeral 10 in FIG. 1 shows an aircraft at three consecutive time instants i-2, i-1, and i as the aircraft moves along a curved path 11. At each of those time instants, the aircraft 10 has a certain roll, pitch, and heading (R,P,H); and, FIG. 2 shows the internal structure of an instrument 20 which is on the aircraft 10 and which operates according to the present invention to indirectly measure the aircrafts R, P, H.
These indirect measurements of R, P, H are made by the instrument 20 as a function of two sets of input signals. In FIG. 1, one set of the input signals is shown as a.sub.XB (i), a.sub.YB (i), and a.sub.ZB (i); and, the other set of input signals is shownas P.sub.XE (i), P.sub.YE (i), P.sub.ZE (i), V.sub.XE (i), V.sub.YE (i), and V.sub.ZE (i), where i=1, 2, 3, 4, etc.
Signal a.sub.XB (i) indicates the acceleration of the aircraft 10 at time instant "i" in a direction "XB" along the aircraft's wing axis. Likewise, symbol a.sub.YB (i) indicates the aircraft's acceleration at time instant "i" in a direction "YB" along the aircraft's body axis and perpendicular to the direction "XB". Signal a.sub.ZB (i) indicates the aircraft's acceleration at the instant "i" in a direction "ZB" which is perpendicular to the directions "XB" and "YB". Each of these accelerations is measured by a respective accelerometer that is mounted on the aircraft 10; and, they are shown in FIG. 2 as components 30-1, 30-2, and 30-3.
By comparison, the signals P.sub.XE (i), P.sub.YE (i) and P.sub.ZE (i) respectively indicate the position of the aircraft 10 at time instant "i" along three earth fixed "XE", "YE", and "ZE". Preferably, these earth fixed axis "XE", "YE", and "ZE" respectively are in the directions of East, North, and vertical. Likewise the signals V.sub.XE (i), V.sub.YE (i), and V.sub.ZE (i) respectively indicate the velocity of the aircraft 10 at time instant "i" along the axes "XE", "YE", and "ZE". All of the aircraft's earth fixed positions and velocities are received on the aircraft 10 by a radio receiver from global positioning satellites (GPS) which orbit the earth. This GPS radio receiver is shown in FIG. 2 as item 40-1.
Each of the acceleration signals a.sub.XB (i), a.sub.XB (i) and a.sub.ZB (i) that occur at any particular time instant are doubly integrated over a time interval .DELTA.t, which occurs from time instant "i" to the next time instant "i+1", respectively by three integrator circuits 31-1, 31-2 and 31-3 in FIG. 2. This integration gives the aircraft's change in position due to the measured accelerations along the aircraft's axes XB, YB, and ZB. Then, the results of the three most recent integrations (i.e.--the integrations, starting at times i, i-1, and i-2) are stored as a 3.times.3 matrix in a memory. In FIG. 2, this memory is identified by reference numeral 32; and the 3.times.3 matrix is identified by a signal [A(i)]. Signal .DELTA.P.sub.aXB (i) in matrix [A(i)] indicates the aircraft's change in position along its body axis XB from time "i" to "i+1" due to the measured acceleration a.sub.XE (i); signal .DELTA.P.sub.aYB (i) indicates the aircrafts change in position along its body axis YB from time "i" to "i+1" due to the measured acceleration a.sub.YB (i); etc.
In parallel with the above, the earth referenced position and velocity signals from the radio receiver 40-1 are held in three registers 41-1, 41-2, and 41-3 in FIG. 2. Then, the signals in those registers are operated on by three arithmetic units 42-1, 42-2, and 42-3 to obtain the aircraft's changes in position along the earth fixed axes which are due solely to accelerations other than gravity. In FIG. 2, this change in the aircraft's position from time "i" to time "i+1" along the earth fixed xE axis is indicated by the signal .DELTA.P.sub.aXE (i); this change in the aircraft's position from time "i" to time "i+1" along the earth fixed axis YE is indicated by the signal .DELTA.P.sub.aYE (i); etc.
To obtain the position change .DELTA.P.sub.aXE (i), the arithmetic unit 42-1 makes a subtraction P.sub.XE (i+1)-P.sub.XE (i), and from that result subtracts the quantity V.sub.XE (i).DELTA.t. Similarly to obtain the position change .DELTA.P.sub.aYE (i), the arithmetic unit 42-2 makes a subtraction P.sub.YE (i+1)-P.sub.YE (i), and from that result subtracts the quantity V.sub.YE (i) .DELTA.t. Lastly to obtain the position change .DELTA.P.sub.aZE (i), the arithmetic unit 42-3 makes a subtraction P.sub.ZE (i+1)-P.sub.ZE (i), and from that result subtracts the quantity V.sub.ZE (i).DELTA.t and adds the quantity .intg..intg.gdt.sup.2 where g is gravity and the integration occurs over time period .DELTA.t.
Thereafter in FIG. 2, an estimating module 43-1 estimates a 3.times.1 vector b.sub.1 (i) which relates the XE earth axis position changes .DELTA.P.sub.aXE (i), .DELTA.P.sub.aXE (i-1), and .DELTA.P.sub.aXE (i-2) to the three body axes position changes as given by the 3.times.3 matrix [A(i)]. This relation is expressed as equation 1 in module 43-1. In equation 1, the leftmost term .DELTA.P.sub.aXE (i) represents the XE earth axis position changes .DELTA.P.sub.aXE (i), .DELTA.P.sub.aXE (i-1), and .DELTA.P.sub.aXE (i-2) when they are arranged in a column as shown in the arithmetic unit 42-1, and the rightmost term is the b.sub.1 (i) vector.
Similarly, a second estimating module 43-2 estimates a 3.times.1 vector b.sub.2 (i) which relates the YE earth axis position changes .DELTA.P.sub.aYE (i), .DELTA.P.sub.aYE (i-1), and .DELTA.P.sub.aYE (i-2) to the 3.times.3 matrix [A(i)]; and, this relation is given by equation 2 in the module 43-2. Likewise, a third estimating module 43-3 estimates a 3.times.1 vector b.sub.3 (i) which relates the ZE earth axis position changes .DELTA.P.sub.aZE (i), .DELTA.P.sub.aZE (i-1), and .DELTA.P.sub.aZE (i-2) to the 3.times.3 matrix [A(i)]; and, this relation is given by equation 3 in the module 43-3.
In each of the equations 1, 2, and 3, the left hand side is related to the right hand side by an approximately equal sign ".apprxeq." rather than an equal sign. That is because, in general, the vectors b.sub.1 (i), b.sub.2 (i), and b.sub.3 (i) change with time each time instant "i"; those vectors b.sub.1 (i), b.sub.2 (i), and b.sub.3 (i) will be constant only when the aircraft travels in a straight path. This approximation is depicted in FIG. 1 wherein the aircraft's approximated straight line path at time instant "i" is shown by reference numeral 12. Such an approximation will be accurate enough to give meaningful results so long as any curves in the aircraft's path remain small over three successive time intervals .DELTA.t.
Once the terms .DELTA.P.sub.aXE (i), .DELTA.P.sub.aYE (i), .DELTA.P.sub.aZE (i), and [A(i)] in the equations 1, 2, and 3 are established, it might seem that the vectors b.sub.1 (i), b.sub.2 (i), and b.sub.3 (i) can be determined by simply multiplying both sides of the equations 1, 2 and 3 the inverse matrix [A(i)].sup.-1. But, for many practical cases, the inverse matrix [A(i)].sup.-1 does not exists because of singularity problems. For example, when the aircraft is not turning to either side, the center column of the matrix [A(i)] will be all zeros. Also, when the aircraft is not moving up or down, the right most column of the matrix [A(i)] will be all zeros.
To solve this problem, the estimating modules 43-1, 43-2 and 43-3 of FIG. 2 do not attempt to determine the inverse matrix [A(i)].sup.-1. Instead, module 43-1 estimates the b.sub.1 (i) vector by performing all of the operations on .DELTA.P.sub.aXE (i) and [A(i)] which are indicated in the flow diagram of FIG. 3. Likewise, module 43-2 estimates the b.sub.2 (i) vector by performing similar operations on .DELTA.P.sub.aYE (i) and [A(i)]; and module 43-3 estimates the b.sub.3 (i) vector by performing similar operations on .DELTA.P.sub.aZE (i) and [A(i)]. Those operations that are performed by module 43-2 can be seen from FIG. 3 by changing all of the "1" subscripts to "2" and changing .DELTA.P.sub.aXT (i) to .DELTA.P.sub.aYT (i). Those operations that are performed by module 43-3 can be seen from FIG. 3 by changing all of the "1" subscripts to "3" and changing .DELTA.P.sub.aXT (i) to .DELTA.P.sub.aZT (i).
Before going into the details of FIG. 3 flow diagram, consider what happens after the steps of the diagram are carried out and the b.sub.1 (i), b.sub.2 (i), b.sub.3 (i) vectors are thereby estimated. When that occurs, an output module 44 in FIG. 2 uses the b.sub.1 (i), b.sub.2 (i), and b.sub.3 (i) vectors to determine the aircraft's roll, pitch, and heading as trigometric functions of them. These functions, which are called Euler rotations, are as follows wherein C=cosine, S=sine, R=roll, P=pitch, and H=heading: ##EQU1## Preferably, the output module 44 determines the aircrafts R, P, H by utilizing just the terms b.sub.32, b.sub.31, b.sub.12, and b.sub.22 as shown below; and thereafter provides a visual digital display 44a of those R, P, H values. ##EQU2##
Turning now to FIG. 3, the details of the estimating module 43-1 will be described. As inputs, at each time instant "i", this module 43-1 receives the signals .DELTA.P.sub.aXE (i) and [A(i)]. In response to those inputs, module 43-1 estimates the b.sub.1 (i) vector such that .DELTA.P.sub.aXE (i).apprxeq.[A(i)]b.sub.1 (i). This estimate is made by module 43-1 by performing all of the signal processing operation that are identified in FIG. 3 by reference numerals 50-55. Those operations 50-55 can be performed even when input signals .DELTA.P.sub.aXE and/or [A(i)] contain any number of zeros or singularities because they do not include finding the inverse matrix [A(i)].sup.-1.
Operation 50 is a recursive operation wherein a previously estimated vector b.sub.1 (i-1) is modified to obtain the next estimated vector b.sub.1 (i). To start this recursive operation, an initial estimate of the vector b.sub.1 (0) is made by evaluating the trigonometric functions that were given above for a known initial R, P, H of the aircraft. For example, if the aircraft 10 is initially sitting on a runway and pointing due North, then b.sub.11 (0)=SRSPSH+CRCH=1, b.sub.12 (0)=CPSH=0, and b.sub.13 (0)=CHSR-CRSPSH=0.
Also, as operation 50 shows, the modification which is made to the previously estimated vector b.sub.1 (i-1) is to add a term K.sub.1 (i) [.DELTA.P.sub.aXE (i)-A(i) b.sub.1 (i-1 )]. In this term, the factor K.sub.1 (i) is a 3.times.3 gain matrix, and that gain matrix is multiplied by an "error" that results if the previous estimate b.sub.1 (i-1) were used as the new estimate b.sub.1 (i). In other words, .DELTA.P.sub.aXE (i)-A(i)b.sub.1 (i) is approximately zero, but .DELTA.P.sub.aXE (i)-A(i)b.sub.1 (i-1) is not and represents an error.
To obtain the 3.times.3 gain matrix K.sub.1 (i), operation 51 is performed. There, the term A.sup.T (i) is the transpose of the matrix A(i), and that transpose is performed by operation 52. Also, the term R.sup.-1 is a constant 3.times.3 matrix which is obtained by taking the inverse of a 3.times.3 covariance matrix R of the errors in the GPS signals. For example, if the GPS position signals are each in error by six feet, then R a 3.times.3 matrix with 6.sup.2 on the diagonal and zero for the off diagonal terms.
Further, to obtain the term P.sub.1 (i) in operation 51, another operation 53 must be performed. In operation 53, the terms A.sup.T (i), R.sup.-1 and A(i) are all as explained above; and, the only new term is M.sub.1 (i).sup.-1. This term M.sub.1 (i).sup.-1 is obtained by performing an inverse operation 54 on a 3.times.3 matrix M(i), and the matrix M(i) is obtained by the final operation 55.
In operation 55, the term Q is a 3.times.3 covariance matrix of the accelerometer errors. For example, if each of the accelerometers 30-1 thru 30-3 has an accuracy of 0.5 feet per second.sup.2, then the diagonal terms of the matrix Q are (0.5).sup.2 and the off diagonal terms are all zero. Lastly, term P.sub.1 (i-1) is recursively formed from term P.sub.1 (i) of operation 51. To start this recursive operation, P.sub.1 (0) is obtained as a 3.times.3 matrix of the uncertainties of the initially estimated b.sub.1 (0) vector. For example, if the initial uncertainty of R, P, H is each 10.degree., then: the initial uncertainty of b.sub.11 is (C10.degree. S10.degree. S10.degree.+C10.degree. C10.degree.).sup.2 ; the initial uncertainty of b.sub.12 is (C10.degree. S10.degree.).sup.2 ; and the initial uncertainty of b.sub.13 is (C10.degree. S10.degree.-C10.degree. S10.degree. S10.degree.).sup.2. Those terms from the diagonal of P.sub.1 (0), and the off diagonal terms are all zero.
One preferred embodiment of the invention has now been described in detail. In addition, however, many changes and modifications can be made to this embodiment without departing from the nature and spirit of the invention.
For example, if it is only necessary to measure the pitch and/or roll of the aircraft, then several of the modules in FIG. 2 can be eliminated. Specifically, the modules that can be eliminated are 41-1, 42-1, 43-1, 41-2, 42-2, and 43-2. With the remaining modules, the vector b.sub.3 (i) is estimated. Then from b.sub.3 (i), the pitch P is determined as sine.sup.-1 (b.sub.32) and roll is determined as ##EQU3##
Similarly, if it is only necessary to measure heading with a reduced accuracy, then in FIG. 2 the modules 41-1, 42-1, and 43-1 can be eliminated. In that case, heading is measured as ##EQU4## for all angles of H. Alternatively, modules 41-2, 42-2, and 43-2 can be eliminated, and heading is measured ##EQU5## for all angles of H.
As still another modification, the number of rows in the FIG. 2 terms .DELTA.P.sub.aXE (i), .DELTA.P.sub.aYE (i), .DELTA.P.sub.aZE (i), [A(i)].sup.-1 can be increased to more than three. For example, each such term can each include five rows that have indexes "i", "i-1", "i-2", "i-3", and "i-4". However, to keep the processing of the terms .DELTA.P.sub.aXE (i), .DELTA.P.sub.aYE (i), .DELTA.P.sub.aZE (i), [A(i)].sup.-1 from being too time consuming, they preferably are limited to ten rows each.
As yet another modification, the accelerometers 30-1, 30-2, and 30-3 of FIG. 2 can be implemented with any one of several physical structures. For example, each accelerometer can include a strain gauge as a transducer wherein aircraft acceleration along a certain body axis produces a mechanical strain in the gauge which alters the flow of current through it. Alternatively, each accelerometer can include a piezoelectric crystal as a transducer wherein aircraft acceleration is a certain body axis produces a strain on the crystal which alters the frequency of its oscitation. For these implementations, the cost of each accelerometer is only about twenty dollars.
As another modification, the estimating modules 43-1, 43-2, and 43-3 can be implemented with a variety of electrical circuitry. For each example, each such module can be structured as a special purpose sequential digital logic circuit. How to construct a sequential logic circuit from digital logic gates and registers is taught by the textbook "Fundamentals of Logic Design", published by West Publishing Co., Copyright 1979, author C. H. Roth, Jr.
Alternatively, estimating the modules 43-1, 43-2, and 43-3 can be implemented as a general purpose microprocessor which runs a special purpose estimating program. Such a program would receive as inputs, the terms .DELTA.P.sub.aXE (i), .DELTA.P.sub.aYE (i), .DELTA.P.sub.aZE (i), [A(i)].sup.-1 from the radio receiver and the accelerometers, and would generate as outputs the vectors b.sub.1 (i), b.sub.2 (i), and b.sub.3 (i) by carrying out all of the FIG. 3 operations.
Similarly, the output module 44 can be implemented as a combinational logic circuit. Alternatively, the inverse sine and cosine operations that yield R, P, and H can be achieved simply by two read-only memories wherein, the term b.sub.32, -b.sub.31 /cosP, b.sub.13 /cosP, and b.sub.22 /cosP are sent as a memory address, and from which the inverse sine and inverse cosine terms are read.
Accordingly, it is to be understood that the invention is not limited to just the illustrated preferred embodiment but is defined by the appended claims.
Claims
What is claimed is:
1. An instrument for indirectly measuring the attitude of a moving aircraft; said instrument comprising: three accelerometers mounted on said aircraft such that they indicate three accelerations of said aircraft respectively along three aircraft body axes; a radio receiver in said aircraft which receives from an external source, the position and velocity of said aircraft along an earth fixed axis; an electronic estimating module, coupled to said accelerometers and said receiver, which a) estimates a vector such that a series of aircraft position changes along said three body axes that are caused by said measured accelerations, times said vector, approximately match a corresponding series of position changes along said earth fixed axis as indicated by said receiver, and b) estimates said vector in a recursire fashion such that the vector estimates at time instant "i" is a modification of the preceding vector estimate at time instant i-1; and, an electronic output module, coupled to said estimating module, which generates an output signal that indicates the roll, pitch, or heading of said aircraft by performing trigonometric functions on said vector.
2. An instrument according to claim 1 wherein said modification is of the form: where b(i) is an estimate of said vector at time instant "i"; b(i-1) is a preceding estimate of said vector at time instant "i-1"; .DELTA.P.sub.aE (i) is said series of position changes along said earth fixed axis; A(i) is said series of position changes along said three aircraft body axes; and, K is a gain matrix.
3. An instrument according to claim 2 wherein said electronic estimating module is a special purpose sequential digital logic circuit.
4. An instrument according to claim 2 wherein said electronic estimating module is a programmable general purpose microprocessor with a special purpose estimating program.
5. An instrument according to claim 1 wherein said series of position changes consists of exactly three position changes per axis.
6. An instrument according to claim 1 wherein said series of position changes consists of from three to ten position changes per axis.
7. An instrument according to claim 1 wherein each position change of said series occurs during a time interval of from one-half to two seconds.
8. An instrument according to claim 1 wherein said radio receiver receives the position and velocity of said aircraft along multiple earth fixed axes; and, said estimating module estimates a vector for each earth fixed axis such that a series of aircraft position changes along said three body axis times a respective one of said vectors approximately matches a series of position changes along a corresponding one of said earth fixed axes.
9. An instrument according to claim 1 wherein said accelerometers are mounted on said aircraft such that they measure accelerations in the direction of the aircraft's nose and the aircraft's wing and another axis which is perpendicular thereto.
10. An instrument according to claim 1 wherein each of said accelerometers is selected from a group which consists of a strain gauge accelerometer and a piezoelectric accelerometer.
11. An instrument according to claim 1 wherein said radio receiver has an input which receives said position and velocity of said aircraft along said earth fixed axis from global positioning satellites in orbit around the earth.