Dynamic error correcting apparatus for inertial navigation

Abstract: A counting section (12) includes: a first gyro pulse counter (1a-1h) which counts gyro pulses from each of X-, Y-, Z- and S-axis gyroscopes during each counting period after being reset immediately before the start of the counting period and outputs the count value as a first gyro pulse count value at fixed time intervals; and a second gyro pulse counter (6a-6h) which is reset at said fixed time intervals, counts the gyro pulses and outputs the count value as a second gyro pulse count value. A dynamic error calculating section (13) includes: gyro multipliers/subtractors (3a-3l) whereby, for each combination of two different main axes, a mutual product difference of the gyro pulse count values for the two axes is calculated as a main-axis system gyro pulse error and, for each combination of one of the X, Y and Z axes and the S axis, a mutual product difference of the gyro pulse count values for the S axis and each of the X, Y and Z axes is calculated as an auxiliary-axis system gyro error; and a gyro error integrating section (9) whereby each of the X-axis, Y-axis and Z-axis system gyro errors and the auxiliary-axis system gyro error, provided at the fixed time intervals, are accumulated within each calculation period to obtain a gyro error integrated value. A strap-down calculating processor (5) uses the gyro error integrated values from the gyro error integrating section to calculate the correctional quantity of a coning error for each system wherein one of the X, Y and Z axes is replaced with the S axis.

Description: BACKGROUND OF THE INVENTION The present invention relates generally to an inertial navigation system wherein sensors such as a gyroscope and an accelerometer are provided on each of axes extended in at least four directions defined from a certain point to form a redundancy inertia sensor system and information pulses from each sensor are used to compute the velocity, position and attitude angle of an inertia object. More particularly, the invention pertains to an apparatus for correcting dynamic errors in such an inertial navigation system. In a conventional strap down inertial navigation system, for example, as shown in Fig. 3, sensors are each provided on one of three axes (X, Y and Z axes) intersecting perpendicularly to one another and a skew axis (an S axis) diagonal to them to form a redundancy inertia sensor system. In this instance, if the S axis is selected such that it is spaced the same angle (s) apart from any of the X, Y and Z axes, then the angle s will have a value which satisfies cos s = 1/ 3 . Sensors such as a gyroscope and an accelerometer are provided for each of the four axes so that data can be obtained for each axis, but information on the inertia object, such as its velocity, position and attitude angle, can be obtained with data from respective sensors in three of the four axes; in general, such information is obtained from the sensors of the three perpendicularly intersecting axes (X, Y and Z). With such a four-axis structure, even if failures occur in the sensors in one of the three axes, for example, in the Z axis, data from the S-axis sensors are converted into data equivalent to those from the Z-axis sensors so that necessary information can still be obtained as data from the sensors in the perpendicularly intersecting axes, and hence computations for navigation can be continued. The prior art utilizes this navigation system. In the case of constituting sensor systems by combinations of three axes out of the four axes, a total of four sensor systems (X, Y, Z), (X, Y, S), (Y, Z, S) and (X, Z, S) are obtainable, and the necessary inertia object information is normally derived from information which is available from the sensors of the (X, Y, Z) system. In the case of the (Y, Z, S)-axis sensor system, data from the Y-, Z- and S-axis sensors are used to calculate data equivalent to those from the X-axis sensor, and in the case of the (X, Z, S)-axis sensor system, data from the X-, Z- and S-axis sensors are used to calculate data equivalent to those from the Y-axis sensor. Since the data available from each sensor system are processed on a discrete-time basis, a motion accompanied by rotation usually develops a dynamic error except in specific cases. This error is a coning error in regard to the gyro output and a sculling error in regard to the accelerometer output. Computations for correcting such dynamic errors in the above-mentioned four sensor systems are expressed as listed below in the case of using linear expansions. In this instance, a dynamic error correcting computation is performed every preset computation cycle on the basis of the number of pulses which are provided from each sensor system during the period. Incidentally, respective symbols are explained below and suffixes, x, y, z and s indicate the axes concerned, respectively. δ xn , δ yn , δ zn : Integrated value of the correctional quantity of a coning error in the current computation cycle regarding the direction of rotation in each axis; δ xn-1 , δ yn-1 , δ zn-1 : Integrated value of the correctional quantity of a coning error in the previous computation cycle regarding the direction of rotation in each axis; Δ xn = ω x , Δ yn = ω y , Δ zn = ω z , Δ sn = ω s : Number of gyro output pulses counted in the current computation cycle regarding the direction of rotation in each axis;  xn-1 =  x ,  yn-1 =  y ,  zn-1 =  z ,  sn-1 =  s : Accumulated number of gyro output pulses counted until the previous computation cycle regarding the direction of rotation in each axis; δV xn , δV yn , δV zn : Integrated value of the correctional quantity of a sculling error in the current computation cycle regarding the direction of rotation in each axis; δV xn-1 , δV yn-1 , δV zn-1 : Integrated value of the correctional quantity of a sculling error in the previous computation cycle regarding the direction of rotation in each axis; ΔV xn = A x , ΔV yn = A y , ΔV zn = A z , ΔV sn = A s : Number of accelerometer output pulses in the current computation cycle regarding the direction of rotation in each axis. Incidentally, it is also possible to use  xn ,  yn ,  zn (the numbers of gyro output pulses counted in the current computation cycle regarding the direction of rotation in the respective axes) for  xn-1 ,  yn-1 ,  zn-1 . The symbols  x ,  y ,  s , ω x , ω y , ω z , A x , A y , A z and A s in the above have been introduced to simplify expressions in the following description and in the drawings. 1. Correctional quantity of a coning error in the (X, Y, Z)-axis sensor system: δ xn = δ xn-1 +  yn-1 ·Δ zn - Δ zn-1 ·Δ yn = δ xn-1 +  y ω z -  z ω y δ yn = δ yn-1 +  zn-1 ·Δ xn -  xn-1 ·Δ zn = δ yn-1 +  z ω x -  x ω z δ zn = δ zn-1 +  xn-1 ·Δ yn -  yn-1 ·Δ xn = δ zn-1 +  x ω y -  y ω x Expressions (1x), (1y) and (1z) represent recurrence formulae of the accumulations of δ xn , δ yn and δ zn , respectively. Let it be assumed that when n = 1, the first term δ x0 , δ y0 and δ z0 on the right sides of the above formulae are each zero.  x ,  y ,  z , ω x , ω y and ω z are updated every 0.1 msec, for example, and by repeatedly performing the recurrence formulae (1x), (1y) and (1z) for 20 msec, that is, by accumulating δ xn , δ yn and δ zn from n = 1 to 200, the correctional quantities which are given by the following expressions are obtained. Σδ xn = Σ{ y ω z -  z ω y } = ΣΔC A = C A Σδ yn = Σ{ z ω x -  x ω z } = ΣΔC B = C B Σδ zn = Σ{ x ω y -  y ω x } = ΣΔC C = C C 2. Correctional quantity of a sculling error in the (X, Y, Z)-axis sensor system: δV xn = δV xn-1 +  yn-1 ·ΔV zn -  zn-1 ·ΔV yn = δV xn-1 +  y A z -  z A y δV yn = δV yn-1 +  zn-1 ·ΔV xn -  xn-1 ·ΔV zn = δV yn-1 +  z A x -  x A z δV zn = δV zn-1 +  xn-1 ·ΔV yn -  yn-1 ·ΔV xn = δV zn-1 +  x A y -  y A x The correctional quantities which are calculated from the recurrence formulae (2x), (2y) and (2z) are given by the following expressions: ΣδV xn = Σ{ y A z -  z A y } = ΣΔS A = S A ΣδV yn = Σ{ z A x -  x A z } = ΣΔS B = S B ΣδV zn = Σ{ x A y -  y A x } = ΣΔS C = S C Incidentally, the recurrence formulae (1x), (1y) and (1z) will hereinafter be generically called a formula (1) and the recurrence formulae (2x), (2y) and (2z) will be generically called a formula (2). Formulae in the following description will also be called similarly. 3. Correctional quantity of a coning error in the (X, Y, S)-axis sensor system: δ xn = δ xn-1 +  xn-1 ·Δ yn -  yn-1 ·Δ xn - 3 ( sn-1 ·Δ yn -  yn-1 ·Δ sn) = δ xn-1 +  x ω y -  y ω x - 3 ( s ω y -  y ω s ) δ yn = δ yn-1 +  xn-1 ·Δ yn -  yn-1 ·Δ xn - 3 ( sn-1 ·Δ xn -  xn-1 ·Δ sn ) = δ yn-1 +  x ω y -  y ω x + 3 ( s ω x -  x ω s ) δ zn = δ zn-1 +  xn-1 ·Δ yn -  yn-1 ·Δ xn = δ zn-1 +  x ω y -  y ω x The correctional quantities which are calculated from the recurrence formulae (3x), (3y) and (3z) are given by the following expressions: Σδ xn = Σ{ΔC C - 3 ( s ω y -  y ω s )} Σδ yn = Σ{ΔC C + 3 ( s ω x -  x ω s )} Σδ zn = ΣΔC C = C C 4. Correctional quantity of a sculling error in the (X, Y, S)-axis sensor system: δV xn = δV xn-1 +  xn-1 ·ΔV yn -  yn-1 ·ΔV xn - 3 ( sn-1 ·ΔV yn -  yn-1 ·ΔV sn ) = δV xn-1 +  x A y -  y A x - 3 ( s A y -  y A s ) δV yn = δV yn-1 +  xn-1 ·ΔV yn -  yn-1 ·ΔV xn + 3 ( sn-1 ·ΔV xn -  xn-1 ·ΔV sn ) = δV yn-1 +  x A y -  y A x + 3 ( s A x -  x A s ) δV zn = δV zn-1 +  xn-1 ·ΔV yn -  yn-1 ·ΔV xn = δV zn-1 +  x A y -  y A x The correctional quantities which are calculated from the recurrence formulae (4x), (4y) and (4z) are given by the following expressions: ΣδV xn = Σ{ΔS C - 3 ( s A y -  y A s )} ΣδV yn = Σ{ΔS C + 3 ( s A x -  x A s )} ΣδV zn = ΣΔS C = S C 5. Correctional quantity of a coning error in the (X, Z, S)-axis sensor system: δ xn = δ xn-1 +  zn-1 ·Δ xn -  xn-1 ·Δ zn + 3 ( sn-1 ·Δ zn -  zn-1 ·Δ sn ) = δ xn-1 +  z ω x -  x ω z + 3 ( s ω z -  z ω s ) δ yn = δ yn-1 +  zn-1 ·Δ xn -  xn-1 ·Δ zn = δ yn-1 +  z ω x -  x ω z δ zn = δ zn-1 +  zn-1 ·Δ xn -  xn-1 ·Δ zn - 3 ( sn-1 ·Δ xn -  xn-1 ·Δ sn ) = δ zn-1 +  z ω x -  x ω z - 3 ( s ω x -  x ω s ) The correctional quantities which are calculated from the recurrence formulae (5x), (5y) and (5z) are given by the following expressions: Σδ xn = Σ{ΔC B + 3 ( s ω z -  z ω s )} Σδ yn = ΣΔC B = C B Σδ zn = Σ{ΔC B - 3 ( s ω x -  x ω s )} 6. Correctional quantity of a sculling error in the (X, Z, S)-axis sensor system: δV xn = δV xn-1 +  zn-1 ·ΔV xn -  xn-1 ·ΔV zn + 3 ( sn-1 ·ΔV zn -  zn-1 ·ΔV sn ) = δV xn-1 +  z A x -  x A z + 3 ( s A z -  z A s ) δV yn = δV yn-1 +  zn-1 ·ΔV xn -  xn-1 ·ΔV zn = δV yn-1 +  z A x -  x A z δV zn = δV zn-1 +  zn-1 ·ΔV xn -  xn-1 ·ΔV zn - 3 ( sn-1 ·ΔV xn -  xn-1 ·ΔV sn ) = δV zn-1 +  z A x -  x A z - 3 ( s A x -  x A s ) The correctional quantities which are calculated from the recurrence formulae (6x), (6y) and (6z) are given by the following expressions: ΣδV xn = Σ{ΔS B + 3 ( s A z -  z A s )} ΣδV yn = ΣΔS B = S B ΣδV zn = Σ{ΔS B - 3 ( s A x -  x A s )} 7. Correctional quantity of a coning error in the (X, Z, S)-axis sensor system: δ xn = δ xn-1 +  yn-1 ·Δ zn -  zn-1 ·Δ zn = δ xn-1 +  y ω z -  z ω y δ yn = δ yn-1 +  yn-1 ·Δ zn -  zn-1 ·Δ yn - 3 ( sn-1 ·Δ zn -  zn-1 ·Δ sn ) = δ yn-1 +  y ω z -  z ω y - 3 ( s ω z -  z ω s ) δ zn = δ zn-1 +  yn-1 ·Δ zn -  zn-1 ·Δ yn + 3 ( sn-1 ·Δ yn -  yn-1 ·Δ sn ) = δ zn-1 +  y ω z -  z ω y + 3 ( s ω y -  y ω s ) The correctional quantities which are calculated from the recurrence formulae (7x), (7y) and (7z) are given by the following expressions: Σδ xn = ΣΔC A = C A Σδ yn = Σ{ΔC A - 3 ( s ω z -  z ω s )} Σδ zn = Σ{ΔC A + 3 ( s ω y -  y ω s )} 8. Correctional quantity of a sculling error in the (X, Z, S)-axis sensor system: δV xn = δV xn-1 +  yn-1 ·ΔV zn -  zn-1 ·ΔV yn = δV xn-1 +  y ·A z -  z ·A y δV yn = δV yn-1 +  yn-1 ·ΔV zn -  zn-1 ·ΔV yn - 3 ( sn-1 ·ΔV zn -  zn-1 ·ΔV sn ) = δV yn-1 +  y A z -  z A y - 3 ( s A z -  z A s ) δV zn = δV zn-1 +  yn-1 ·ΔV zn -  zn-1 ·ΔV yn + 3 ( sn-1 ·ΔV yn -  yn-1 ·ΔV sn ) = δV zn-1 +  y A z -  z A y + 3 ( s A y -  y A s ) The correctional quantities which are calculated from the recurrence formulae (8x), (8y) and (8z) are given by the following expressions: ΣδV xn = ΣΔS A = S A ΣδV yn = Σ{ΔS A - 3 ( s A z -  z A s )} ΣδV zn = Σ{ΔS A + 3 ( s A y -  y A s )} where the following physical formulae are used.  xn +  yn +  zn = 3  sn  xn-1 +  yn-1 +  zn-1 = 3  sn-1 V xn + V yn + V zn = 3 V sn V xn-1 + V yn-1 + V zn-1 = 3 V sn-1 In the inertia navigation system, calculations for the velocity, position and attitude of the inertia object are usually updated with a period of about 20 msec (50 Hz) to 10 msec (100 Hz). In the inertia navigation system employing the gyro, since the frequency of dynamic noise by the gyro is hundreds of hertz, the dynamic error needs to be corrected with a period of 0.1 msec or so in the case of utilizing the above recurrence formulae. The arrangement for correcting the dynamic error has such a construction as shown in Figs. 4 and 5 for the formulae (1) and (2) corresponding to the (X, Y, Z)-axis sensor system (Fig. 4 showing the one half of the arrangement and Fig. 5 the other half, Figs. 4 and 5 being connected by reference character B ○) and such a construction as shown in Figs. 6 and 7 for the formulae (7) and (8) corresponding to the (Y, Z, S)-axis sensor system (Fig. 6 showing the one half of the arrangement and Fig. 7 the other half, Figs. 6 and 7 being connected by a reference character ©). Though not shown, the conventional apparatus further includes similar arrangements for performing the dynamic error calculations of the formulae (3) and (4) corresponding to the (X, Y, S)-axis sensor system and the formulae (5) and (6) corresponding to the (X, Z, S)-axis sensor system. Shown below each block is the counting period during which the number of pulses is counted in the block. In this case, the counting periods of the respective blocks start at the same time. A symbol Σ means that the signal pulses are counted for the period indicated in each block. Referring to Figs. 4 and 5, reference numeral 12 denotes a counting section, which includes counters 1a to 1f, latches 2a to 2f, counters 6a to 6f and latches 7a to 7c. Reference numeral 13 indicates a dynamic error calculating section, which is made up of a calculating section 3 and an integrating part 9. Respective gyros (not shown) provide gyro pulses Δ x , Δ y and Δ z each generated per unit quantity of rotation about their axes. These pulses are fed to positive or negative terminals according to the direction of rotation. The counter 1a is reset upon each completion of counting of the sequentially input gyro pulses Δ x for the 20-msec counting period. In this while, the latch 2a latches the intermediate count value Δ x with a period of 0.1 msec and provides it to the calculating section 3. The latch 4a latches every counting period of 20 msec the final count value Φ x in that period and provides it to a strap-down calculation processor 5, and at the same time, it resets the counting. In the counter 1b the gyro pulses Δ x which are input thereinto are counted for a 0.1-msec counting period, and upon each completion of the counting period, the counting is reset. The latch 2a latches, every 0.1-msec period, the number of pulses, ω x , counted by the counter 1b to the point of time immediately before its resetting, and the latch 2a provides the count value to the calculating section 3. Similarly, the gyro pulses Δ y and Δ z are also counted by the corresponding counters 1c to 1f for the 0.1-msec period, and the count values are latched by the latches 2c to 2f, from which they are provided to the calculating section 3 and the latches 4b and 4c. Accelerometers on the respective axes provide pulses ΔV x , ΔV y and ΔV z which are generated per unit magnitude of velocity variations in their axial direction. These acceleration pulses are applied to positive or negative terminals, depending upon whether the velocity is on increase or decrease. A description will be given of the processing of the acceleration pulses ΔV x . The counter 6a counts the pulses ΔV x for the 0.1-msec counting period and resets the counting upon each completion of the period. Let the number of pulses counted during one counting period be represented by A x . The latch 7a of the next stage similarly fetches therein the pulse count value A x and provides the count value to the calculating section 3. The counter 6b sequentially counts the acceleration pulses ΔV x for the 20-msec computation period and is reset upon each completion of the period. Let the number of pulses counted during this period be represented by V x . A latch 8a of an output section 4 fetches therein the pulse count value V x every 20-msec computation period (in synchronization with the counter 6b) and provides the numerical value to the strap-down calculation processor 5. The other acceleration pulses ΔV y and ΔV z are also similarly processed by the counters 6c to 6f and latches 7b, 7c, 8b and 8c. In multiplier/subtractors 3a to 3c of the calculating section 3 the calculations shown in the second and third terms on the right side of the aforementioned formula (1) are performed to obtain calculated values ΔC A , ΔC B and ΔC C every 0.1 msec. In multiplier/subtractors 3g to 3i the calculations shown in the second and third terms on the right side of the formula (2) are performed to obtain calculated values ΔS A , ΔS B and ΔS C every 0.1 msec. In accumulators 9a to 9c and 9g to 9i of the integrating section 9 the calculated values obtained every 0.1 msec are accumulated in each 20-msec computation period to obtain integrated values C A , C B , C C and S A , S B , S C as shown in the expressions (1a), (1b), (1c) and (2a), (2b), (2c), respectively. In latches 10a to 10c and 10g to 10i these integrated values C A , C B , C C and S A , S B , S C are latched with a period of 20 msec, and they are provided to the strap-down calculating processor 5. Thus, the strap-down calculating processor 5 performs dynamic error correcting calculations given by the following expressions: Φ x + C A , Φ y + C B , Φ z + C C V x + S A , V y + S B , V z + S C . Figs. 6 and 7 show an arrangement for dynamic error correcting processing shown by formulae (7) and (8) in the case of using the (Y, Z, S)-axis sensor system. The parts corresponding to those in Figs. 4 and 5 are identified by the same reference numerals. The example shown in Figs. 6 and 7 employs gyro pulses Δ y , Δ z , Δ s and acceleration pulses ΔV y , ΔV z , ΔV s . Since the processing in this example is the same as that described above in respect of Figs. 4 and 5, no description will be given thereof. Incidentally, the fourth terms of the formulae (7y), (7z), (8y) and (8z) are multiplied by a factor of 3 -- this is effected in the strap-down calculating section 5. By this processing, the calculations of the above-mentioned formulae (7) and (8) are conducted. Also in the cases of the (X, Y, S)-axis and (X, Z, S)-axis sensor systems, processing corresponding to the formulae (3), (4) and (5), (6) are executed by arrangements (not shown) as in the above, and no description will be given of them. In the event that the sensor on any one of the above-said axes has broken down or its performance has deteriorated, the calculations for navigation can be continued by use of sensors on the other three axes. However, the detection of such an abnormal sensor calls for the calculations involving all of the four sensor systems and dynamic error correcting calculations necessary therefor, that is, calculations of all of the formulae (1) to (8). Hence, large quantities of data to be processed for correction and high computation frequency are needed -- this increases the load on the computer and enlarges the scale of the system. SUMMARY OF THE INVENTION It is therefore an object of the present invention to provide a dynamic error correcting apparatus for an inertia navigation system which is small-scale and permits reduction of the computational quantity involved. This object is achieved with a dynamic error correcting apparatus as claimed in claim 1. A preferred embodiment of the invention is subject-matter of claim 2. The dynamic error correcting apparatus for an inertia navigation system according to an embodiment of the present invention includes: a counting section whereby information pulses available from inertia sensors provided on at least four axes, respectively, are counted for each predetermined computation period to obtain count values for the respective axes; a dynamic error calculating section whereby the count values of the information pulses, obtained by the counting section for the at least four axes, are calculated, in an arbitrary combination, with the predetermined computation period to obtain a plurality of combined dynamic error values; an output section which is supplied with the count values from the counting section and the dynamic error values from the dynamic error calculating section, latches them with the predetermined computation period and provides them to a strap-down calculating processor of the next stage; and a strap-down calculating processor which is supplied with the count values from the counting section and the dynamic error values from the dynamic error calculating section, fetched in the output section, and calculates inertia information of an inertia object on the basis of the said count values and dynamic error values, the strap-down calculating processor being used in common to the inertia sensors on the at least four axes. The information pulses from the sensors on the four or more axes are combined into one system and they are counted in the counting section with a predetermined computation period. In the dynamic error calculating section the count value is used to calculate dynamic errors in common to the four or more axes, and in the strap-down calculating processor the multiplication by a factor of 3 and other calculations are performed in common to the four or more axes. Thus, the computational quantity that can be processed in common to all the axes is larger than in the prior art, and hence the load on the computer can be reduced accordingly. BRIEF DESCRIPTION OF THE DRAWINGS Fig. 1 is a block diagram of one half of the construction of a dynamic error correcting apparatus of the inertia navigation system according to the present invention; Fig. 2 is a block diagram of the other half of the construction of the dynamic error correcting apparatus; Fig. 3 is a diagram illustrating an example of the prior art redundancy inertia sensor system of the inertia navigation system; Fig. 4 shows one half of a block diagram which depicts part of a dynamic error correcting apparatus of a conventional inertia navigation system; Fig. 5 is a diagram showing the other half of the apparatus depicted in Fig. 4; Fig. 6 is a block diagram showing one half of another part of the dynamic error correcting apparatus corresponding to Fig. 4; Fig. 7 is a diagram showing the other half of the part of the apparatus depicted in Fig. 6; Fig. 8 is a diagram schematically illustrating an example of the redundancy inertia sensor system for the inertia navigation system to which the present invention is applicable; and Fig. 9 is a diagram schematically illustrating another example of the redundancy inertia sensor system for the inertia navigation system to which the present invention is applicable. DESCRIPTION OF THE PREFERRED EMBODIMENTS The dynamic error correcting apparatus for an inertia navigation system according to the present invention will be described with reference to Figs. 1 and 2 (Fig. 1 showing one half of the apparatus and Fig. 2 the other half, the both figures being connected at the point indicated by reference character A ○). In Figs. 1 and 2 the parts corresponding to those in Figs. 4 and 5 are identified by the same reference numerals and no description will be given of them. In this example, the error correcting apparatus for the (X, Y, Z)-axis sensor system, shown in Figs. 4 and 5, are further provided with counters 1g, 1h and latches 2g and 2h for processing the gyro pulses Δ s in the same manner as in the case of the other gyro pulses Δ x , Δ y and Δ z and counters 6g, 6h and latches 7d, 8d for processing the acceleration pulses ΔV s in the same manner as in the case of the other acceleration pulses ΔV x , ΔV y and ΔV z . The pulse count values thus fetched in the latches 2g, 2h and 7d are similarly provided to the calculating section 3. In the calculating section 3, additionally-provided multiplier/subtractors 3d to 3f and 3j to 3l perform multiplication/subtraction processing on the basis of the data that are provided every 0.1-msec computation period, as described previously with reference to Figs. 4 and 5 (or Figs. 6 and 7). As a result, the following multiplied/subtracted values are obtained. ΔC D =  s ω x -  x ω s ΔC E =  s ω y -  y ω s ΔC F =  s ω z -  z ω s ΔS D =  s A x -  x A s ΔS E =  s A y -  y A s ΔS F =  s A z -  z A s These multiplied/subtracted values (values obtained with the 0.1-msec period) are accumulated by additionally-provided accumulators 9d to 9f and 9j to 9l in the integrating section 9 within a 20-msec period and these accumulators are reset after the accumulated values C D , C E , C F and S D , S E , S F are provided to latches 10d to 10f and 10j to 10l at the end of the 20-msec period. This operation is repeated. The integrated values thus accumulated are provided to the strap-down calculating processor 5 every 20-msec period, together with the accumulated values C A , C B , C C and S A , S B , S C generated by the structure similar to that shown in Figs. 4 and 5. For example, since the terms having a coefficient 3 in expressions (3a) and (3b) are equivalent to expressions (9b) and (9a), respectively, expressions (3a) and (3b) become as follows: Σ{ΔC C - 3 ΔC E } = {C C - 3 C E } Σ{ΔC C + 3 ΔC D } = {C C + 3 C D }. The strap-dawn calculating processor 5 is able to perform these expressions on the basis of the values C C , C D and C E provided thereto. That is, the correctional quantities given by the expressions (3a), (3b) and (3c) can be calculated. Similarly, the strap-down calculating processor 5 can calculate all the correctional quantities given by the expressions (4a), (4b), (4c), ... (8a), (8b), (8c). Conventionally, since calculation processing for navigation is performed for each of the four sensor systems, the processing overlaps among the sensor systems in considerable quantities, resulting in the load on the computer being large. According to the present invention, however, such overlapping calculations are processed in common to all of the four sensor systems, reducing the load on the computer accordingly. Figs. 8 and 9 illustrate other examples of the redundancy inertia sensor system, and the present invention is also applicable to such systems in the same manner as described above. As described above, according to the dynamic error correcting apparatus of the present invention, dynamic errors are calculated by the dynamic error calculating section in common to all the sensor systems involved and calculation processing such as multiplication by a factor of 3 is performed by the strap-dawn calculating processor, that is, minimum units for calculations are calculated, and combinations of such minimum units are used to calculate correcting values. As compared with the conventional inertia navigation system wherein calculations are carried out for each of a plurality of sensor systems, the present invention increases the number of the calculations that can be processed in common to all the sensor systems. Hence, the present invention reduces the load on the computer or reduces the scale of dedicated hardware for correction. It will be apparent that many modifications and variations may be effected without departing from the scope of the novel concepts of the present invention.

Claims: A dynamic error correcting apparatus for an inertial navigation system having inertia sensors provided on at least four axes, respectively, each of said inertia sensors including a gyroscope, said apparatus comprising: a counting section (12) including first gyro pulse counting means (1a, 1c, 1e, 1g) which counts gyro pulses from said gyroscope of each axis during each of a plurality of predetermined calculation periods after being reset immediately before the start of said calculation period and outputs, at fixed time intervals, the count value as a first gyro pulse count value, and second gyro pulse counting means (1b, 1d, 1f, 1h) which is reset at said fixed time intervals, counts said gyro pulses and outputs the count value as a second gyro pulse count value; a dynamic error calculating section (13) including gyro multiplying/subtracting means (3a-3f) whereby if three predetermined ones of said at least four axes are used as main axes and one of the remaining axes is used as an auxiliary axis, a difference between the product of said first gyro count value for one main axis in each of all combinations of two different main axes selected from said at least three main axes and said second gyro pulse count value for the other main axis and the product of said first gyro pulse count value for said other main axis and said second gyro pulse count value for said one main axis is calculated as a main axis system gyro pulse error, and a difference between the product of said first gyro pulse count value for said auxiliary axis in each combination of said auxiliary axis and one of said main axes and said second gyro pulse count value for said one of said main axes and the product of said first gyro pulse count value for said one of said main axes and said second gyro pulse count value for said auxiliary axis is calculated as an auxiliary-axis system gyro error, and gyro error integrating means (9a-9f) whereby said main-axis system gyro errors and said auxiliary-axis system gyro errors, obtained at said fixed time intervals, are accumulated within each of said calculation periods to obtain respective gyro error integrated values; and a strap-down calculation processor (5) which is supplied with the count values from said first gyro pulse counting means (1a, 1c, 1e, 1g) at the end of each of said calculation periods and said gyro error integrated values from said dynamic error calculating section and calculates inertia information of an inertial object on the basis of said count values and said gyro error integrated values, said strap-down calculating processor being used in common to said inertia sensors of said at least four axes and being operative to use said gyro error integrated values from said gyro error integrating means to calculate a correctional quantity of a coning error in each system in which one of said main axes is replaced by said auxiliary axis. The apparatus of claim 1, wherein said inertia sensor of each axis further includes an accelerometer; wherein said counting section (12) further includes acceleration pulse counting means (6b, 6d, 6f, 6h) which is reset for each axis at said fixed time intervals, counts acceleration pulses from said accelerometer and outputs the count value as an acceleration pulse count value; wherein said dynamic error calculating section (13) further includes: acceleration error multiplying/subtracting means (3g-3l) whereby a difference between the product of said first gyro pulse count value for one main axis in each of all combinations of two different main axes selected from said main axes and said acceleration pulse count value for the other main axis and the product of said first gyro pulse count value for said other main axis and said acceleration pulse count value for said one main axis is calculated as a main-axis system acceleration error, and a difference between the product of said first gyro pulse count value for said auxiliary axis in each combination of said auxiliary axis and one of said main axes and said acceleration pulse count value for said main axis and the product of said first gyro pulse count value for said main axis and said acceleration pulse count value for said auxiliary axis is calculated as an auxiliary-axis system acceleration error; and acceleration error integrating means (9g-9l) whereby said main-axis acceleration error and said auxiliary-axis acceleration error, obtained at said fixed time intervals, are accumulated within each of said calculation periods to obtain an acceleration error integrated value; and wherein said strap-down calculating processor (5) uses said acceleration error integrated value from said acceleration error integrating means to calculate the correctional quantity of a sculling error in each system wherein one of said main axes is replaced with said auxiliary axis.

Inventors: HIROSE YOSHIO, ITO SATOSHI, KOBAYASHI MASAO, OKAYAMA HIROSHI, HIROSE, YOSHIO, ITO, SATOSHI, KOBAYASHI,MASAO, OKAYAMA, HIROSHI, Hirose, Yoshio, c/o Japan Aviation Electronics, Ito, Satoshi, c/o Japan Aviation Electronics, Kobayashi,Masao, c/o Japan Aviation Electronics, Okayama, Hiroshi, c/o Japan Aviation Electronics
Applicants: JAPAN AVIATION ELECTRON, JAPAN AVIATION ELECTRONICS INDUSTRY, LIMITED
Application year: 1993
Main classification: G01C21
IPC codes: G01C21, G01C25