Abstract:
First and second inertial instruments have parallel sense axes and produce respective first and second output signals using associated first and second scale factors. Bias errors are estimated using the change in state of sign of the first and second scale factors. A substitute scale factor is determined to be an equivalent of the second scale factor and is based on the first scale factor and a difference between the first and second scale factors. Errors in the second scale factor are calculated based on the first scale factor and the substitute scale factor where a sign of one of first and second scale factors changes going from the first time interval to the succeeding time intervals. First and second corrected output signals are generated based on the respective first and second output signals and correction of the second scale factor error.

Description:
BACKGROUND 
   This invention relates to inertial instruments such as gyroscopes and accelerometers, and more specifically to the detection of errors in real time for inertial instruments providing the ability to correct for such errors while the inertial instruments remain in operation. 
   The ability to independently reverse the sign of the scale factor (SF) terms for gyros is described in U.S. Pat. No. 7,103,477. A solution is described for scale factored input rates for two gyros A and B involving equations with scale factors (SFA and SFB), and bias terms (BiasA and BiasB). However, if SFA and/or SFB are in disagreement, the results of the equations are adversely affected. 
   SUMMARY 
   An exemplary inertial measurement apparatus in accordance with the present invention has first and second inertial instruments that are oriented to have parallel sense axes and that produce respective first and second sensed output signals representative of an inertial attribute to be measured. Respective first and second scale factors are used in producing the first and second sensed output signals. A substitute scale factor is determined to be an equivalent of the second scale factor and is based on the first scale factor and a difference between the first and second scale factors. Differences in the first and second scale factors are calculated based on the first scale factor and the substitute scale factor during first and second time intervals where a sign of one of first and second scale factors changes from one state during the first time interval to the other state during the second time interval. First and second corrected output signals are generated based on the respective first and second sensed output signals and correction of said second scale factor error. 
   A method for implementing error corrections is a further embodiment of the present invention. 

   
     DESCRIPTION OF THE DRAWINGS 
     Features of exemplary implementations of the invention will become apparent from the description, the claims, and the accompanying drawings in which: 
       FIG. 1  is a functional diagram of an exemplary embodiment of an inertial instrument in accordance with the present invention. 
       FIG. 2  is a block diagram of an exemplary embodiment of an inertial instrument suited to carry out the functions of  FIG. 1 . 
       FIG. 3  is a graph illustrating the polarity of signals associated with two exemplary gyroscopes. 
   

   DETAILED DESCRIPTION 
   One aspect of the present invention resides in the recognition of the difficulties associated with inertial instrument errors in the scale factors, especially in a real time environment in which it is desirable maintain the inertial instruments in continuing operation while minimizing such errors. 
     FIG. 1  is a functional representation of an exemplary embodiment of an inertial instrument  1  in accordance with the present invention. Computer algorithms implemented by a micro processing unit  15  compute gyro bias errors and scale factor imbalance in the manner described herein. Gyroscopes  2  and  3  having parallel sensing axes sense the same true input rate, dTheta_in, with scale factors  4  and  6 , and bias errors  5  and  7 , respectively. The resulting measurement outputs MEASA and MEASB from the respective instruments are input to a micro processing unit  15  and operated on by a hosted algorithm further described herein. A Kalman Filter  9  implemented in the microprocessor computes the bias errors, BiasA and BiasB, of each instrument and the scale factor imbalance  12  between the instruments. Gyro measurements are corrected by the resulting computations and feedback of bias summations  10 ,  11  and scale factor imbalance  12 , combined and provided as output dTheta_out based on summation  14 . Summation  8  of the corrected gyro measurements have a controlled sign output in accordance with the present invention and is an input to the Kalman Filter. 
     FIG. 2  is a block diagram of an exemplary embodiment of an inertial instrument  1  in accordance with the present invention. Micro processing unit  15  includes a microprocessor  22  is supported by read only memory (ROM)  24  and a random access memory (RAM)  26 . Microprocessor  22  is coupled to an input/output device  28  that supports receiving and transmitting digital signals as shown. The microprocessor  32  operates under stored program control instructions that may be contained initially in ROM  24 . Operational instructions as well as data are stored in RAM  26  for processing by microprocessor  32 . Those skilled in the art will be able to provide appropriate software or firmware control instructions for microprocessor  22  in order to implement the functions and calculations discussed herein. A gyroscope “Gyro” A  2  and a gyro B  3  generate respective outputs of an angular measurement such as measured in degrees coupled to I/O device  28 . The input information sensed by these gyros, which have parallel sense axes, is represented as MeasA and MeasB. The outputs calculated by MPU  15  for gyros  2  and  3  are represented by dTheta_out_A and dTheta_out_B, respectively. The output dTheta_out calculated by MPU  15  is a dynamically computed output of an angle based on inputs from gyros  2  and  3 . As will be explained below, the output dTheta_out is corrected based on real time measurement of the bias errors of the two gyros, and any imbalance between the scale factors of the two gyros while the gyros operate continuously in a dynamic environment. 
   Alternatively, the functions and calculations can be implemented in an application specific integrated circuit or other form of hardware implementation. In addition to the functionality and calculations made by the instrument  15 , additional functionality provided by the two or more gyros could be incorporated into a single device. 
   The bias errors may be directly observable if the sense axes of two instruments, gyroscopes (gyros) in this exemplary embodiment, are located along the same axis relative to the attribute being sensed and are sequenced as described. Both gyros sense rotations about the same axis. The measurements MeasA and MeasB made by gyros A and B during each i th  measurement interval are:
 
Meas A ( i )=SF A*d Theta_in+Bias A* Ti  (Eq1)
 
Meas B ( i )=SF B*d Theta_in+Bias B* Ti  (Eq2)
 
where:
 
   MeasA and MeasB are the measurement of incremental angle made by two gyros A and B, respectively; 
   dTheta_in is the true input angle displaced by the two gyros A and B having parallel sense axes; 
   SFA and SFB are the scale factor coefficients of gyros A and B respectively which relate the physical output of the gyros to input angle; 
   Ti is the time interval over which the two gyros are angularly displaced. 
   Independently reversing the sign of the scale factor terms of each gyro yields equations:
 
Meas A ( i )= K mode A *SF A*d Theta_in+Bias A *Ti  (Eq3)
 
Meas B ( i )= K mode B *SF B*d Theta_in+Bias B *Ti  (Eq4)
 
where:
 
KmodeA and KmodeB independently take on the values of +1 or −1 to provide a sequence of measurements in which the scale factor terms are reversed.
 
   The 8 equations for the combination of Kmode values are:
 
Meas A (1)=+1 *SF A*d Theta_in+Bias A *Ti  (Eq5)
 
Meas B (1)=+1 *SF B*d Theta_in+Bias B *Ti  (Eq6)
 
Meas A (2)=+1 *SF A*d Theta_in+Bias A *Ti  (Eq7)
 
Meas B (2)=−1 *SF B*d Theta_in+Bias B *Ti  (Eq8)
 
Meas A (3)=−1 *SF A*d Theta_in+Bias A *Ti  (Eq9)
 
Meas B (3)=−1 *SF B*d Theta_in+Bias B *Ti  (Eq10)
 
Meas A (4)=−1 *SF A*d Theta_in+Bias A *Ti  (Eq11)
 
Meas B (4)=+1 *SF B*d Theta_in+Bias B *Ti  (Eq12)
 
These 8 equations provide a solution for the four scale factored input rates SFA*dTheta_in through SFA*dTheta_in 4 , and the two bias terms BiasA and BiasB.
 
   In this embodiment the term SFB is modeled as:
 
SF B =SF A *(1 +d SF B )  (Eq13)
 
where dSFB is the difference between SFA and SFB.
 
Substituting the equivalent of SFB from Eq13 into Eq3 and Eq4 yields:
 
Meas A ( i )= K mode A *SF A*d Theta_in+Bias A *Ti  (Eq14)
 
Meas B ( i )= K mode B *(SF A +SF A*d SF B )* d Theta_in+Bias B *Ti  (Eq15)
 
If the measurements MeasA and MeasB over successive intervals are summed or differenced, the product of SFA*dTheata_in(i) can be made to drop out, leaving a remainder containing elements of dSFB*SFA*dTheta_in, BiasA and BiasB.
 
   The differencing of the A and B gyro measurements may be selected to provide observability of the bias errors and scale factor imbalance. A sequence of KmodeA, KmodeB and summing or differencing of equations Eq14 and Eq15 can be found that makes the errors dSFB, BiasA and BiasB observable as frequency and phase multiplexed signals in the combined measurement from gyroscopes A and B; this is explained in more detail below.
 
Meas A ( i )= KA *( K mode A *SF A*d Theta_in+Bias A *Ti)  (Eq16)
 
Meas B ( i )= KB *( K mode B *(SF A +SF A*d SF B )* d Theta_in+Bias B *Ti)  (Eq17)
 
In the above equations Eq16 and Eq17 coefficients KmodeA and KmodeB represent the sign of the A and B gyro scale factors, respectively. The coefficients KA and KB are also given the values of +/−1. Values of KA, KB, KmodeA and KmodeB are selected to force the following:
 
( KA*K mode A + KB*K mode B )* d Theta_in( i )=0  (Eq18)
 
KA and KB serve to control whether Eq16 and Eq17 are summed or differenced, and to control the order of difference: Eq16−Eq17 or Eq17−Eq16.
 
     FIG. 3  is a graph that shows a sequence of the polarity of determinable errors resulting from sequential sums and differences of equations Eq16 and Eq17. These results can be achieved by selecting appropriate values KA, KB, KmodeA and KmodeB so that summing Eq16 and Eq17 satisfies Eq18. When Eq18 is satisfied, the resulting summation of Eq16 and Eq17 yields: 
                     MeasA   ⁡     (   i   )       +     MeasB   ⁡     (   i   )         =       KA   *   BiasA   *   Ti     +     KB   *   KmodeB   *   dSFB   *   SFA   *   dTheta_in   ⁢     (   i   )       +     KB   *   BiasB   *   Ti               (   Eq18a   )               
The summation of Eq16 and Eq17, assuming Eq18 is satisfied, has only terms containing the errors desired. Neglecting the product containing dSFB*SFA*dTheta_in for the moment, by sequentially alternating the signs of KA and KB, the effect of BiasA and BiasB on Eq18a changes sign, effectively “modulating” the error caused by these terms in the summation Eq18a. Waveforms  40  and  42  represent this effect from BiasB and BiasA, respectively.
 
The effect of dSFB on Eq18a is affected only by KmodeB. Changing the sign of the scale factor of GyroB in  FIG. 1  reverses the sign of KmodeB and changes the sign of the error caused by dSFB in Eq18a. KmodeB can be selected to achieve a waveform such as waveform  44  in  FIG. 2 . Waveform  44  appears at a different frequency from that of waveforms  40  and  42 , and thus the effect of dSFB on Eq18a can be separated from that of BiasA and BiasB. The value for SFA*dTheta_in(i) in Eq18a is, to first order, the value at the output of summation  10  in  FIG. 1 . As the value for BiasA is refined by the Kalman Filter process  9  in  FIG. 1 , this correlation becomes stronger.
 
Once a sequence for KA, KB and KmodeB are selected, KmodeA, the sign of the scale factor of Gyro A, can be selected to force the condition prescribed by Eq18. The result is that BiasA, BiasB, and dSFB appear in the summation of Eq16 and Eq17 as square waves correlated with  FIG. 2  waveforms  40 ,  42  and  44  respectively. These square waves are separated by phase, as in waveforms  40  and  42  for BiasA and BiasB respectively, and by frequency as in the case of waveform  44  for dSFB. These correlations are effectively amplitude modulations of the respective errors impressed on the summation of Eq16 and Eq17. Subsequent demodulation of the summation of Eq16 and Eq17 with the waveforms in  FIG. 2  will yield the value of the underlying errors.
 
   Exemplary instrument  10  implements a Kalman filter to demodulate the error signals shown in  FIG. 2  and uses the observation of values at each ‘i’ interval: 
   
     
       
         
           
             
               
                 
                   Z 
                   ⁡ 
                   
                     ( 
                     i 
                     ) 
                   
                 
                 = 
                 
                   
                     [ 
                     
                       
                         
                           KB 
                           ⁡ 
                           
                             ( 
                             i 
                             ) 
                           
                         
                         * 
                         
                           KmodeB 
                           ⁡ 
                           
                             ( 
                             i 
                             ) 
                           
                         
                         * 
                         SFA 
                         * 
                         dTheta_in 
                         ⁢ 
                         
                           ( 
                           i 
                           ) 
                         
                       
                       , 
                       
                         
                           KA 
                           ⁡ 
                           
                             ( 
                             i 
                             ) 
                           
                         
                         * 
                         Ti 
                       
                       , 
                       
                         
                           KB 
                           ⁡ 
                           
                             ( 
                             i 
                             ) 
                           
                         
                         * 
                         Ti 
                       
                     
                     ] 
                   
                   * 
                   
                     
                       [ 
                       
                         dSFB 
                         , 
                         BiasA 
                         , 
                         BiasB 
                       
                       ] 
                     
                     T 
                   
                 
               
             
             
               
                 ( 
                 
                   Eq 
                   ⁢ 
                   
                       
                   
                   ⁢ 
                   19 
                 
                 ) 
               
             
           
         
       
     
   
   The Kalman filter H matrix for each observation is:
 
 H ( i )=[ KB ( i )* K mode B ( i )*SF A*d Theta_in( i ), KA ( i )*Ti,  KB ( i )*Ti]  (Eq20)
 
Those skilled in the art will understand the operation of the Kalman Filter with regard to Z(i) and H(i).
 
All of the elements within the H matrix are known at each interval: KA, KB, KmodeA, KmodeB and the raw (uncorrected) measurement from gyro A, i.e. SFA*dTheta_in(i). Hence, the above process can be applied recursively by instrument  1  to determine the real time measurement of the bias errors of gyros A and B, and the imbalance (if any) between the scale factors of gyros A and B. The output dTheta_out of instrument  1  consists of a constantly updated angle measurement based on the raw output from gyros A and B, and as corrected to compensate for any bias and/or scale factor errors determined as explained above. Thus, correction of such errors is implemented while the gyros continuously operate in a dynamic environment, i.e. dynamic updates are performed during times where the gyro inputs are subject to change.
 
   With regard to the illustrative embodiment, a digital implementation will contain counts, i.e. numerical values, corresponding to inputs and outputs of the inertial instrument measurements from two parallel instrument inputs/channels Win(A) and Win(B). The instrument  10  preferably processes the required inputs and generates outputs in substantially real time. 
   Although exemplary implementations of the invention have been depicted and described in detail herein, it will be apparent to those skilled in the art that various modifications, additions, substitutions, and the like can be made without departing from the spirit of the invention. The above implementation, described in terms of a gyroscope, is equally applicable to a pair of parallel accelerometers having controllable reversibility of the sign of the scale factors. 
   The scope of the invention is defined in the following claims.