Claims
- 1. Navigational instrument for a vehicle, wherein the north direction is determined by means of a gyro, comprising:
- a two-axis gyro having a spin axis, a first and a second input axis,
- a first angle pick-off and a first torquer on the first input axis,
- a second angle pick-off and a second torquer on the second input axis,
- first amplifier means for applying the amplified angle signal from the first angle pick-off to the second torquer, second amplifier means for applying the amplified angle signal from the second angle pick-off to the first torquer, and
- signal processing means, to which the amplified angle signals are applied,
- characterized in that:
- (a) the gyro with the angle pick-offs and the torquers is arranged in an intermediate housing,
- (b) the intermediate housing is mounted for rotation about an axis of rotation parallel to one input axis through 90.degree. from a first position with substantially vertical spin axis into a second position,
- (c) a pair of vehicle-fixed accelerometers is arranged with its input axes parallel to the transverse and longitudinal axes, respectively, of the vehicle, said accelerometers producing accelerometer signals A.sub.x.sup.F, A.sub.y.sup.F respectively,
- (d) the signal processing means comprise
- (d.sub.1) first computer means for providing initial vehicle attitude signals from the amplified angle signals with stationary vehicle and said first position of the intermediate housing, and
- (d.sub.2) second computer means for continuously providing vehicle attitude signals representing the attitude of the moving vehicle in an earth-fixed coordinate system from said initial vehicle attitude signals, said angle signals from the angle pick-offs and said accelerometer signals with the second position of the intermediate housing.
- 2. Navigational instrument as set forth in claim 1, characterized by
- (a) speed measuring means for generating a speed signal representing the longitudinal speed of the vehicle in a vehicle-fixed coordinate system,
- (b) a coordinate transformation computer to which vehicle attitude signals and said speed signal are supplied for providing speed component signals indicative of the components of the vehicle speed in an earth-fixed coordinate system, and
- (c) integrating computer means, to which the speed component signals are supplied for computing the vehicle position in the earth-fixed coordinate system.
- 3. Navigational instrument as set forth in claim 1, characterized in that said first computer means comprise
- (a) matrix element forming means connected to receive the acceleration signals A.sub.x.sup.F, A.sub.y.sup.F of the accelerometers and for forming therefrom estimated values of the elements C.sub.31 and C.sub.32 of the directional cosine matrix for the transformation from a vehicle-fixed coordinate system (x.sup.F, y.sup.F, z.sup.F) into an earth-fixed coordinate system (x.sup.R, y.sup.R, z.sup.R) in accordance with the relation
- C.sub.31 (O)=-A.sub.x.sup.F /g
- C.sub.32 (O)=-A.sub.y.sup.F /g ,
- (b) squaring, adding and root extracting means connected to receive the estimated values thus obtained and for forming therefrom an estimated value of the third element C.sub.33 of the last line of the directional cosine matrix C.sub.F.sup.R in accordance with the relation ##EQU42## (c) means connected to receive the signals applied to the torquers and for deriving therefrom signals representing the rotary speeds w.sub.y.sup.F and w.sub.x.sup.F,
- (d) heading angle means connected to receive the signals C.sub.31, C.sub.32 and C.sub.33 and the signals representing the rotary speeds w.sub.y.sup.F and w.sub.x.sup.F, and producing a signal representing the initial heading angle .psi. (O) of the vehicle in an earth-fixed coordinate system in accordance with the relations ##EQU43## wherein .PHI. is geographic latitude and
- .PSI..sub.E is the rotary speed of the earth.
- 4. Navigational instrument as set forth in claim 3, characterized by
- (a) the signals supplied to the torquers from the angle pick-offs, which signals are proportional to the rotary speeds, and the acceleration signals from the accelerometers constituting sensor signals,
- (b) a pair of filters, each filter comprises three integrators, three multipliers and a summing point, each filter being connected to receive a respective sensor signal,
- (c) as to each of the filters:
- (1) each of the three integrators produces a respective output signal,
- (2) the summing point receives three input signals and produces an output signal therefrom,
- (3) a first of the integrators is connected to receive the respective sensor signal and integrates it with respect to time to produce one of said three input signals,
- (4) two of the multipliers being connected to receive the output signal of the summing point and to respectively multiply that output signal by factors of K.sub.1 (t) and K.sub.o (t) to produce respective output signals,
- (5) a second of the integrators is set to the instantaneous value of the respective sensor signal at the beginning of each cycle and is connected to receive the output signal of the K.sub.1 (t) multiplier to produce an output signal,
- (6) a third of the multipliers is connected to receive the output signal of said second integrator, to multiply that signal by the time t and to feed it back to the summing point with reversed sign as a second of said three input signals,
- (7) a third of the integrators is connected to receive the output signal of the K.sub.o (t) multiplier and to produce an output signal which is fed to the summing point with reversed sign as the third of said three input signals.
- 5. Navigational instrument as set forth in claim 4, characterized in that the third integrator is reset to zero at the beginning of each cycle.
- 6. Navigational instrument as set forth in claim 3, characterized by
- (a) the signals supplied to the torquers from the angle pick-offs, which signals are proportional to the rotary speeds, and the acceleration signals from the accelerometers constituting sensor signals, said sensor signals being detected in cycles with each cycle having a duration T,
- (b) a pair of filters, each filter comprises clock means for producing clock pulses with intervals therebetween, five multipliers, two dividers, four delay loops, eight adders and an analog reset integrator,
- (c) as to each of the filters:
- (1) said integrator is connected to receive the respective sensor signal and resets it with respect to time and produces an increment pulse y.sub.i each time the resulting signal reaches a predetermined level and is reset to zero thereafter,
- (2) a first of the adders is connected to receive said increment pulses, said adder adding each increment pulse y.sub.i to the sum y.sub.i of the preceding increment pulses, which sum has been delayed by one clock interval through one of said delay loops,
- (3) a second of the adders is connected to receive said clock pulses, said second adder adding each clock pulse to the sum i-1 of the preceding clock pulses, which sum i-1 has been delayed by one clock interval through another of said delay loops, to produce a sum signal n,
- (4) a first of the multipliers is connected to the first and second adders to multiply the sum y.sub.i of the increment pulse numbers by the sum i of the clock pulses to produce a pulse signal iy.sub.i,
- (5) a third of the adders is connected to said first multiplier for adding each pulse signal iy.sub.i to the sum of the preceding signals iy.sub.i, which sum iy.sub.i has been delayed by one clock interval through another of the delay loops, to produce a pulse signal .SIGMA.iy.sub.i,
- (6) a fourth of the adders is connected to the third adder to add the pulse signal .SIGMA.iy.sub.i by itself to produce a pulse signal 2.SIGMA.iy.sub.i,
- (7) a fifth of the adders is connected to receive the sum y.sub.i of the increment pulses, said fifth adder adding said sum y.sub.i to the sum y.sub.i of the preceding y.sub.i signals which have been delayed through another of the delay loops to produce a signal .SIGMA.y.sub.i,
- (8) a sixth of the adders is connected to receive the signal n representing the sum of the clock pulses and to increase it by one to produce a signal (n+1),
- (9) a second of the multipliers being connected to receive and multiply the signals .SIGMA.y.sub.i and (n+1) to produce a signal (n+1).SIGMA.y.sub.i,
- (10) a seventh of the adders being connected to receive the signals 2.SIGMA.y.sub.i and (n+1).SIGMA.y.sub.i and to subtract the latter from the former to produce a signal 2.SIGMA.y.sub.i -(n+1).SIGMA.y.sub.i,
- (11) a third of the multipliers being connected to receive the signal n representing the sum of the clock pulses and to multiply that signal by itself to produce a signal n.sup.2,
- (12) an eighth of the adders being connected to receive the signal n.sup.2 and to reduce it by one to produce a signal (n.sup.2 -1),
- (13) a fourth of the multipliers being connected to receive the signal n representing the sum of the clock pulses and to multiply it by the duration T of the cycle to produce a signal nT,
- (14) a fifth of the multipliers being connected to receive the signals (n.sup.2 -1) and nT and to multiply those signals with each other, to produce a signal nT(n.sup.2 -1),
- (15) a first of the dividers being connected to receive the signal nT(n.sup.2 -1) and to divide it by a given number x to produce a signal nT(n.sup.2 -1)/x,
- (16) a second of the dividers being connected to receive the signals from the seventh adder and the first divider and to divide the signal from the former by the signal from the latter to produce a quotient signal.
- 7. Navigation instrument as set forth in claim 6, characterized in that each of the filters further comprises
- (17) a fifth delay loop,
- (18) a ninth adder connected to receive said quotient signal of the second divider after a predetermined number of clock pulses, said ninth adder adding the quotient signal so received to the sum of the quotient signals previously received, which sum has been delayed by one clock interval by the fifth delay loop, to produce a sum output signal,
- (19) a third divider connected to receive said sum output signal and to divide it by the total number of quotient signals.
- 8. Heading-attitude reference unit for determining the heading and the attitude of a vehicle, comprising: rotary speed sensor means, which are arranged to respond to the rotary speeds about three mutually perpendicular, vehicle-fixed input axes, said means including at least two rotary speed sensors producing sensor signals, two accelerometers having vehicle-fixed, mutually perpendicular input axes which respectively are parallel to the input axes of the two rotary speed sensors, said accelerometers producing sensor signals, and computer means, to which the signals from the rotary speed sensors and from the accelerometers are supplied for providing signals representing transformation parameters between a vehicle-fixed coordinate system and an earth fixed coordinate system, as well as the heading angle in the earth-fixed coordinate system, said computer means comprising
- (a) means for receiving said sensor signals and providing signals
- (4) C.sub.31 =C.sub.32 .omega..sub.z.sup.F -C.sub.33 .omega..sub.y.sup.F
- (5) C.sub.32 =C.sub.33 .omega..sub.x.sup.F -C.sub.31 .omega..sub.z.sup.F
- wherein
- C.sub.31,C.sub.32,C.sub.33 are the elements of the last line of the directional cosine matrix,
- C.sub.31,C.sub.32 are the associated time derivatives,
- .omega..sub.x.sup.F is the rotary speed about an input axis x.sup.F in the vehicle-fixed coordinate system,
- .omega..sub.y.sup.F is the rotary speed about the second input axis y.sup.F in the vehicle-fixed coordinate system, and
- .omega..sub.z.sup.F is the rotary speed about the third input axis z.sup.F in the vehicle-fixed coordinate system,
- (b) means connected to receive the signals C.sub.31 and C.sub.32 and integrate the received signals with respect to time to provide signals C.sub.31 and C.sub.32, respectively,
- (c) means connected to receive the signals C.sub.31 and C.sub.32 from the integration means and for producing a signal ##EQU44## (d) from the signal C.sub.31 and C.sub.32 thus obtained, means connected to feed the signals C.sub.31,C.sub.32 and C.sub.33 back to the computer for providing C.sub.31 and C.sub.32 from the rotary speed signals,
- (e) means connected to receive the signals C.sub.31,C.sub.32 and C.sub.33 and the rotary speed signals .omega..sub.z.sup.F and .omega..sub.y.sup.F and for producing a signal ##EQU45## therefrom, and (f) means connected to receive this signal .psi..sub.I and integrating it with respect to time to provide a signal .psi..sub.I representing the heading angle in the earth-fixed coordinate system.
- 9. Heading-attitude reference unit as set forth in claim 8 further characterized by
- (g) means connected to receive the signals C.sub.32 and C.sub.31 and to multiply each by the acceleration g due to gravity to produce signals gC.sub.32 and gC.sub.31,
- (h) means connected to receive the signals gC.sub.32 and gC.sub.31 and the signals A.sub.y.sup.F and A.sub.x.sup.F, respectively, from the accelerometers and to superpose the former and the latter respectively,
- (i) means connected to receive the signals from the accelerometers and for superposing additional signals to each signal from an accelerometer,
- (j) means connected to receive the signals from the last mentioned means and for integrating those signals with respect to time to provide inertial speed signals,
- (k) at least one speed sensor, which provides a speed signal indicative of the component of the vehicle speed in the direction of the input axis of an accelerometer,
- (l) means connected to receive the inertial speed signal with opposite sign to the speed signal from the speed sensor and for superposing the two to provide a difference signal,
- (m) means connected to receive said difference signal and to multiply it by a factor K.sub.v (t), which is a function of time, to provide said additional signal superposed to the signal from the accelerometer, and
- (n) means connected to receive said difference signal and the C.sub.32 and C.sub.31 signals, multiplying the difference signal with a factor K.sub.c (t), which is a function of time, and superposing the resulting product to the C.sub.32 - and C.sub.31 -signals, respectively.
- 10. Heading-attitude reference unit as set forth in claim 8, and further characterized by
- (a) magnetic field responsive means for determining the direction .psi..sub.M of the magnetic field of the earth in the earth fixed coordinate system and for providing a signal representing this direction, and
- (b) means connected to receive the .psi..sub.I signal prior to the integration with respect to time and for superposing thereon a signal D.sub.z with opposite sign to produce a signal D.sub.z .psi..sub.I, said signal D.sub.z representing an estimated value of the heading drift derived by means of the direction of the magnetic field of the earth, the last mentioned integrating means then integrating this D.sub.z .psi..sub.I signal.
- 11. Heading-attitude reference unit as set forth in claim 10, and further characterized by
- (a) means connected to receive signal .psi..sub.M and the signal .psi..sub.I and producing a difference signal (.psi..sub.I -.psi..sub.M) therefrom,
- (b) means connected to receive the difference signal (.psi..sub.I -.psi..sub.M) and for superposing a first signal .DELTA..psi..sub.M with the same and a second signal .DELTA..psi..sub.I with opposite sign to this difference signal,
- (c) means connected to receive the last mentioned superposed signals and for multiplying them by a factor K.sub.1 (t), which is a function of time, and for integrating the product with respect to time to provide said first signal .DELTA..psi..sub.M which is then supplied to the last mentioned superposing means,
- (d) means connected to receive the last mentioned superposed signals and for multiplying them by a second factor K.sub.2 (t), which is function of time, and for integrating the product with respect to time to produce a signal representing signal estimated value D.sub.z of the heading drift, and
- (e) means connected to receive the last mentioned superposed signals and the D.sub.z signal and for multiplying the said superposed signals with a third factor, which is a function of time, for superposing the product to said D.sub.z signal and for integrating the latter superposed signal with respect to time to provide said second signal .DELTA..psi..sub.I which is then supplied to said last mentioned superposing means.
- 12. Instrument for the automatic determination of the north direction by means of a gyro affected by the rotation of the earth, wherein
- the gyro is a two-axis gyro the spin axis of which is substantially vertical,
- the position of the gyro is picked off by position pick-offs and torquer is arranged to exert erecting torques on the gyro to keep the spin axis of the gyro vertical,
- a position pick-off and a torquer is provided on each of two mutually perpendicular input axes of the gyro,
- the signal from each position pick-off associated with one input axis is supplied crosswise to the torquer on the respective input axis to restrain the spin axis of the gyro to the vertical, and
- the signal supplied to the two torquers are, at the same time, applied to a north deviation computer, which provides, from the ratio of the signals, a signal representing the deviation of an instrument-fixed reference direction from north,
- characterized in that
- (a) the north deviation computer comprises a memory for storing the two signals T.sub.y.sup.(1), T.sub.x.sup.(1) supplied to the torquers,
- (b) the gyro is arranged to be rotated through 180.degree. about a horizontal axis by a servomotor, after the signals have been stored,
- (c) the signals T.sub.y.sup.(2), T.sub.x.sup.(2) then supplied to the torquers are supplied to the north deviation computer,
- (d) the north deviation computer comprises means for providing signals
- .DELTA.T.sub.y =T.sub.y.sup.(1) -T.sub.y.sup.(2) ( 8)
- .SIGMA.T.sub.x =T.sub.x.sup.(1) +T.sub.x.sup.(2) ( 9)
- wherein ##EQU46## M.sub.x.sup.(1) and M.sub.x.sup.(2) are the stored signals and the signals applied after the 180.degree.-rotation to that torquer, which acts about one axis,
- M.sub.y.sup.(1) and M.sub.y.sup.(2) are the stored signals and the signals applied after the 180.degree.-rotation to the other torquer, and
- H is the rotary momentum of the gyro, and
- (e) the north deviation computer comprises means for providing a signal ##EQU47## as north deviation signal.
- 13. Instrument as set forth in claim 12, characterized in that
- (a) the housing of the gyro is mounted for rotation and is rotatable through 90.degree. about one of the input axes of the gyro by means of a servomotor, whereby the gyro can be used as heading reference unit, and
- (b) the same servomotor is arranged to optionally rotate the housing through 180.degree..
- 14. Instrument for the automatic determination of the north direction by means of a gyro affected by the rotation of the earth, wherein
- the gyro is a two-axis gyro the spin axis of which is substantially vertical,
- the position of the gyro is picked off by position pick-offs and a torquer is arranged to exert erecting torquers on the gyro ot keep the spin axis of the gyro vertical,
- a position pick-off and a torquer is provided on each of two mutually perpendicular input axes of the gyro,
- the signal from each position pick-off associated with one input axis is supplied crosswise to the torquer on the respective input axis to restrain the spin axis of the gyro to the vertical, and
- the signals supplied to the two torquers are, at the same time, applied to a north deviation computer, which provides, from the ratio of the signals, a signal representing the deviation of an instrument-fixed reference direction from north,
- characterized in that
- (a) the north deviating computer comprises a memory for storing the two signals T.sub.y.sup.(1), T.sub.x.sup.(1) supplied to the torquers,
- (b) the gyro is arranged to be rotated by a servomotor through 180.degree. about a vertical axis coinciding with the gyro spin axis, after these signals T.sub.x.sup.(1), T.sub.y.sup.(1) have been stored,
- (c) the signals T.sub.x.sup.(3), T.sub.y.sup.(3) then supplied to the torquers are applied to the north deviataion computer,
- (d) the north deviation computer comprises means for providing signals
- DT.sub.x =T.sub.x.sup.(1) -T.sub.x.sup.(3) ( 15)
- DT.sub.y =T.sub.y.sup.(3) -T.sub.y.sup.(1) ( 16)
- wherein ##EQU48## M.sub.x.sup.(1) and M.sub.x.sup.(3) are the stored signals and the signals applied to one torquer, after the 180.degree.-rotation,
- M.sub.y.sup.(1) and M.sub.y.sup.(2) are the stored signal and the signals applied to the other torquer after the 180.degree. rotation, and
- H is the rotary momentum of the gyro, and
- (e) the north deviation computer comprises means for providing a signal ##EQU49## as north deviation signal.
- 15. Instrument for the automatic determination of the north direction by means of a gyro affected by the rotation of the earth, wherein the gyro is a two-axis gyro the spin axis of which is substantially vertical,
- the position of the gyro is picked off by position pick-offs and a torquer is arranged to exert erecting torques on the gyro to keep the spin axis of the gyro vertical,
- a position pick-off and a torquer is provided on each of two mutually perpendicular input axes of the gyro, the signal from each position pick-off associated with one input axis is supplied crosswise to the torquer on the respective input axis to restrain the spin axis of the gyro to the vertical, and
- the signals supplied to the two torquers are, at the same time, applied to a north deviation computer, which provides, from the ratio of the signals, a signal representing the deviation of an instrument-fixed reference direction from north,
- characterized in that
- (a) the north deviation computer comprises a memory for storing the two signals T.sub.y.sup.(1), T.sub.x.sup.(1) supplied to the torquers,
- (b) the gyro is arranged to be rotated by a first servomotor through 180.degree. about a vertical axis coinciding with the gyro spin axis, after these signals T.sub.x.sup.(1), T.sub.y.sup.(1) have been stored
- (c) the north deviation computer comprises a memory for storing the two signals T.sub.x.sup.(3), T.sub.y.sup.(3) then supplied to the torquers,
- (d) the first servomotor is controlled to rotate the gyro housing through 180.degree. back into the initial position, after these latter signals have been stored,
- (e) the gyro is arranged to be rotated by a second servomotor through 180.degree. about a horizontal input axis, after it has been rotated back by the first servomotor,
- (f) the signals T.sub.x.sup.(2), T.sub.y.sup.(2) then supplied to the torquers are applied to the north deviation computer,
- (g) the north deviation computer comprises means for providing signals
- .SIGMA.T.sub.xc =T.sub.x.sup.(2) -T.sub.x.sup.(3) ( 22)
- .DELTA.T.sub.y =T.sub.y.sup.(1) -T.sub.y.sup.(2) ( 23)
- wherein
- T.sub.x.sup.(2) is the signal which, after rotation of the gyro about said one input axis y, is applied to that torquer which acts on the other input axis,
- T.sub.x.sup.(3) is the signal which, after rotation of the gyro about the vertical axis, is supplied to that torquer which acts on said other input axis,
- T.sub.y.sup.(1) is the signal which, in the initial position prior to the rotation about the vertical axis, is supplied to that torquer which acts about said one input axis,
- T.sub.y.sup.(2) is the signal which, after the rotation about the horizontal axis, is supplied to that torquer which acts on said one input axis, and
- (h) the north deviation computer comprises means for providing a signal ##EQU50## as north deviation signal.
- 16. Instrument as set forth in claim 15, characterized in that the north deviation computer comprises means for providing signals
- ST.sub.x =T.sub.x.sup.(1) +T.sub.x.sup.(3) and (25)
- ST.sub.y =-T.sub.y.sup.(1) -T.sub.y.sup.(3), (26)
- said signals representing the components of the gyro drifts, wherein
- T.sub.x.sup.(1) is the signal which, in the initial position prior to the rotation about the vertical axis, is supplied to that torquer which acts on said other input axis, and
- T.sub.y.sup.(3) is the signal which, after the rotation about the vertical axis is supplied to that torquer which acts on said one input axis.
- 17. Instrument as set forth in claim 15, characterized in that
- (a) the north deviation computer comprises an additional memory for for storing the two signals T.sub.x.sup.(2), T.sub.y.sup.(2) supplied to the torquers, after the gyro has been rotated back about the vertical axis into its initial position,
- (b) the north deviation computer comprises means for providing the mean values
- T.sub.x.sup.(1) =1/2(T.sub.x1.sup.(1) +T.sub.x2.sup.(1)) and (27)
- T.sub.y.sup.(1) =1/2(T.sub.y1.sup.(1) +T.sub.y2.sup.(1)), (28)
- wherein the index "1" indicates the signal prior to the rotation about the vertical axis and the index "2" indicates the signal after the rotation back into the initial position.
- 18. An instrument for the automatic determination of the north direction by means of a gyroscope affected by the rotation of the earth and having a spin axis, said instrument having an instrument-fixed reference direction and being characterized by: gyroscope positioning means secured to said gyroscope and mounting said gyroscope for pivotal movement about two input axes at right angles to each other, said positioning means positioning said spin axis substantially vertical, said positioning means including first and second torquers associated with said input axes respectively for controlling the angular position of the spin axis about the input axes respectively, first and second pickups associated with said input axes respectively for producing signals indicative of the angular position of the spin axis about the input axes respectively, and control means including said pickups and said torquers for actuating the torquer associated with one axis in response to the signal from the pickup associated with the other axis and for actuating the torquer associated with said other axis in response to the signal from the pickup associated with said one axis; and a north direction computer, connected to said control means to receive said signals, for producing from the ratio of the signals a north deviation signal indicative of the deviation from north of the instrument-fixed reference direction, said north deviation computer providing a signal ##EQU51## wherein U.sub.x is the voltage which is supplied to the one torquer acting about the one input axis of the gyroscope,
- K.sub.Tx is the constant of said one torquer,
- U.sub.y is the voltage which is supplied to the other torquer acting about the other input axis of the gyroscope, and
- K.sub.Ty is the constant of said other torquer,
- said north deviation computer comprising a quadrant logic circuit for determining the quadrant of the north deviation, said quadrant logic circuit being connected to receive the two signals supplied to the torquers, and a quadrant computer, to which the signal ##EQU52## is applied together with an output signal from the quadrant logic circuit and which provides a north deviation signal .psi. taking the quadrant of the north deviation into consideration.
- 19. An instrument as set forth in claim 18 characterized in that the quadrant logic circuit comprises a comparator circuit, which specifies the quadrant of the north deviation in accordance with the following criteria: ##EQU53## and that the quadrant computer provides the north deviation signal .psi., as a function of an output signal of the quadrant logic circuit representing the quadrant of the north deviation, in the following manner: ##EQU54##
- 20. An instrument as set forth in claim 19, characterized in that the quadrant logic circuit comprises a null detector circuit for detecting singular values of the north deviation signal in accordance with the following criteria: ##EQU55##
- 21. An instrument as set forth in any one of the claims 18 through 20, wherein said gyroscope is casing-fixed and including:
- accelerometer means operatively associated with the gyroscope for providing a pair of error signals indicative of the deviation of the gyroscope spin axis from the vertical; an error signal computer connected to receive the north deviation signal from the north deviation computer as an estimated value .psi. of the north deviation .psi. together with the signals which are applied to the torquers and the error signals from the accelerometer means, said error signal computer computing error signals of transformation parameters between said gyroscope and an earth-fixed coordinate system on the basis of estimated values of these transformation parameters, said estimated values of the transformation parameters being, at first, determined by the output signal of the north deviation computer;
- a correction signal computer connected to receive the error signals from the error signal computer for computing correction signals to be applied to the transformation parameters from the error signals thus obtained and weighted, if appropriate;
- a transformation parameter computer connected to receive said correction signals and for supplying corrected transformation parameters;
- means connecting the transformation parameter computer and the error signal computer to supply said corrected transformation parameters to the error signal computer for the computation of the error signals by the error signal computer in a closed loop as new estimated values of the transformation parameters; and
- a computer connected to receive the corrected transformation parameters from the transformation parameter computer and producing a signal representing a corrected north deviation corresponding to the corrected transformation parameters.
- 22. An instrument as set forth in claim 21, wherein the accelerometer means comprises a pair of accelerometers mounted in fixed attitude relation to the gyroscope, said accelerometers having axes of sensitivity which are perpendicular to each other and respectively parallel to the two input axes of the gyroscope.
- 23. An instrument for the automatic determination of the north direction by means of a gyroscope affected by the rotation of the earth and having a spin axis, said instrument having an instrument-fixed reference direction and for use with a vehicle, said instrument being characterized by:
- gyroscope positioning means secured to said gyroscope and mounting said gyroscope for pivotal movement about two input axes at right angles to each other, said positioning means positioning said spin axis substantially vertical, said positioning means including first and second torquers associated with said input axes respectively for controlling the angular position of the spin axis about the input axes respectively, first and second pickups associated with said input axes respectively for producing signals indicative of the angular position of the spin axis about the input axes respectively, and control means including said pickups and said torquers for actuating the torquer associated with one axis in response to the signal from the pickup associated with the other axis and for actuating the torquer associated with said other axis in response to the signal from the pickup associated with said one axis;
- a north direction computer, connected to said control means to receive said signals, for producing from the ratio of the signals a north deviation signal indicative of the deviation from north of the instrument-fixed reference direction; accelerometer means operatively associated with the gyroscope for providing a pair of error signals indicative of the deviation of the gyroscope spin axis from the vertical, the accelerometer means comprising a pair of accelerometers mounted in a fixed orientation with respect to the vehicle, said accelerometers having axes of sensitivity which are perpendicular to each other and respectively parallel to the two input axes of the gyroscope;
- the gyroscope being rotatable through 90.degree. about one of the input axes of the gyroscope between the position at which the spin axis is vertical and a position at which the spin axis is horizontal; and including a computer for computing the true heading of the vehicle from the information provided by the accelerometers about the attitude of the vehicle relative to a horizontal plane, and from the angular speed about the vehicle-fixed input axes of the gyroscope provided by the gyroscope.
- 24. Navigational instrument for a land vehicle having a fixed longitudinal axis x, a fixed transverse axis y and a fixed vertical axis z, said instrument comprising:
- an inertial measuring unit producing inertial speed signals and having rotation-responsive inertial sensors, which respond to rotary movements about said axes and have known drifts d.sub.x, d.sub.y, d.sub.z about their longitudinal, transverse and vertical axes x, y and z respectively, and accelerometers, which respond to linear accelerations along vehicle-fixed axes, the accelerometer sensitive in the direction of the longitudinal axis x producing a signal A.sub.x.sup.F and having a known deviation b.sub.x,
- a speed sensor having a scale factor, which speed sensor responds to the speed of the vehicle with respect to ground in the direction of the longitudinal axis of the vehicle and produces a speed singal v.sub.x.sup.F in the direction of the vehicle longitudinal axis,
- a transformation parameter computer connected to receive the signals from the inertial measuring unit and which comprises means for computing transformation parameters for the transformation of vector components from a vehicle-fixed coordinate system into an earth-fixed coordinate system,
- corrective signal generators connected to receive the accelerometer signals and the transformation parameters from the transformation parameter computer and which provide signals representing the components due to gravity of the accelerations detected by the accelerometers, said gravity component signals being superposed to the signals from the accelerometers to provide translation acceleration signals,
- integrators connected to receive the translation acceleration signals to produce inertial speed signals v.sub.Ix.sup.F and v.sub.Iy.sup.F, an optimal filter connected to receive the inertial speed signals and the speed signals from the speed sensor and which, on the basis of these signals, produces estimated speed signals .DELTA.v.sub.Ix.sup.F and .DELTA.v.sub.Iy.sup.F referenced to vehicle-fixed coordinates v.sub.Ix.sup.F and v.sub.Iy.sup.F,
- a coordinate transformation computer connected to receive the estimated speed signals and the transformation parameters from the transformation parameter computer and which comprises first means for transforming these speed signals into transformed speed signals, which are referenced to an earth-fixed coordinate system, said computer producing signals C.sub.31, C.sub.32, C.sub.33 from the last line of a directional cosine matrix for the transformation from a vehicle-fixed coordinate system into an earth-fixed coordinate system, and
- a position computer connected to receive the transformed speed signals and which comprises second means for providing position signals representing the position of the vehicle,
- said optimal filter comprising:
- (a) a first summing point connected to receive the estimated value .DELTA.v.sub.Ix.sup.F of the error of the longitudinal component signal v.sub.Ix.sup.F of the inertial speed and the estimated value .DELTA.v.sub.x.sup.F of the error of the speed signal v.sub.x.sup.F and to produce a difference signal therefrom,
- (b) a second summing point connected to receive the inertial speed signal v.sub.Ix.sup.F and the speed sensor speed signal v.sub.x.sup.F and to produce a difference signal v.sub.Ix.sup.F -v.sub.x.sup.F therefrom.
- (c) a third summing point connected to receive said two difference signals and to produce a third difference signal z.sub.1 therefrom,
- (d) a fourth summing point connected to receive the inertial speed signal v.sub.Iy.sup.F and the estimated value .DELTA.v.sub.y.sup.F of the error of the transverse component signal v.sub.Iy.sup.F of the inertial speed and to provide a fourth difference signal z.sub.2 therefrom,
- (e) a first multiplier connected to receive the difference signal z.sub.1 and to multiply it by a given factor K.sub.11 to produce a signal K.sub.11 z.sub.1,
- (f) third means connected to receive signals d.sub.z, d.sub.y from the inertial measuring unit and signals C.sub.32, C.sub.33 from the coordinate transformation computer and to produce a signal C.sub.32 d.sub.z -C.sub.33 d.sub.y therefrom,
- (g) a fifth summing point connected to said third means and said first multiplier to produce a signal representing the sum of the signals from said third means and the first multiplier,
- (h) a first integrator connected to said fifth summing point to integrate said sum of said signals and thereby produce a signal .DELTA.C.sub.31 which represents an estimated value of the error of the signal C.sub.31 of the directional cosine matrix,
- (i) a second multiplier connected to receive the difference signal z.sub.2 and to multiply it by a given factor K.sub.22 to produce a signal K.sub.22 z.sub.2,
- (j) fourth means connected to receive signals d.sub.x, d.sub.y from the inertial measuring unit and signals C.sub.31, C.sub.33 from the coordinate transformation computer and to produce a signal C.sub.33 d.sub.x -C.sub.31 d.sub.y therefrom,
- (k) a sixth summing point connected to said fourth means and said second multiplier to produce a signal representing the sum of the signals from the fourth means and the second multiplier,
- (l) a second integrator connected to said sixth summing point to integrate the sum signal of the sixth summing point and thereby produce a signal .DELTA.C.sub.32 which represents an estimated value of the error of the signal C.sub.32 of the directional cosine matrix,
- (m) multiplying means connected to receive signals C.sub.31 and z.sub.1 and to multiply the signal C.sub.31 by the accelerating due to gravity and to multiply the signal z.sub.1 by a given factor K.sub.31 and by the known accelerator deviation b.sub.x to produce output signals gC.sub.31 and K.sub.31 z.sub.1 b.sub.x,
- (n) a seventh summing point connected to said multiplying means to receive the output signals therefrom and to add those signals together to produce a sum signal,
- (o) a third integrator connected to said seventh summing point to receive the sum signal therefrom and to integrate it to produce a signal .DELTA.v.sub.Ix.sup.F representing the estimated value of the error of the longitudinal component signal v.sub.Ix.sup.F of the inertial speed,
- (p) an eighth summing point connected to receive the signals A.sub.x.sup.F and gC.sub.31 and add them to produce a signal v.sub.x.sup.F representing the translatory acceleration in the direction of the longitudinal axis of the vehicle,
- (q) multiplying means and a fourth integrator connected to receive the difference signal z.sub.1 multiply it by a given factor K.sub.61 and integrate the product K.sub.61 z.sub.1 thereof to produce a signal .DELTA.k.sub.x representing the estimated value of the error of the scale factor of the speed sensor,
- (r) multiplying means and a ninth summing point connected to receive the difference signal z.sub.1 and the translatory acceleration signal v.sub.x.sup.F, to multiply the difference signal z.sub.1 with a given factor K.sub.51 and to add the product K.sub.51 z.sub.1 thereof with the signal v.sub.x.sup.F to produce an output signal,
- (s) a sixth integrator connected to receive and integrate the last mentioned output signal to produce a signal .DELTA.v.sub.x.sup.F which represents the estimated value of the error of the speed signal from the speed sensor,
- (t) multiplying means connected to receive the signals C.sub.32 and z.sub.2, to multiply the signal C.sub.32 by the acceleration g due to gravity and to multiply the signal z.sub.2 by a given factor K.sub.42 and by the known zero deviation b.sub.x to produce output signals gC.sub.32 and K.sub.42 z.sub.1 b.sub.x,
- (u) a tenth summing point connected to receive the output signals of the last mentioned multiplying means and to add those signals together to produce a sum signal,
- (v) a seventh integrator connected to receive the sum signal from the tenth summing point and to integrate that signal to produce a signal .DELTA.v.sub.Iy.sup.F which represents the estimated value of the error of the transverse component signal v.sub.Iy.sup.F, and
- (w) means connected to receive the speed signal v.sub.x.sup.F and the estimated speed error signal .DELTA.v.sub.x.sup.F and to subtract the latter from the former to produce a corrected speed signal.
- 25. Navigational instrument as set forth in claim 24, and wherein the vehicle has a significant rotary speed .omega..sub.z.sup.F about its vertical axis z, said instrument further comprising
- (a) multiplying means connected to receive the difference signals z.sub.1 and z.sub.2 and to multiply the z.sub.1 signal by a given factor K.sub.21 to produce a product signal K.sub.21 z.sub.1 and to multiply the z.sub.2 signal by given factors K.sub.12, K.sub.32 and K.sub.52 to produce product signals K.sub.12 z.sub.2, K.sub.32 z.sub.2 and K.sub.52 z.sub.2 respectively,
- (b) multiplying means connected to receive the .DELTA.C.sub.32 signal and to multiply it by the rotary speed .omega..sub.2.sup.F to produce a signal .omega..sub.2.sup.F .DELTA.C.sub.32,
- (c) said fifth summing point being connected to receive and additionally add said product signal K.sub.12 z.sub.2 and said .omega..sub.z.sup.F .DELTA.C.sub.32 signal in the production of the signal by the fifth summing point,
- (d) said sixth summing point being connected to receive and additionally add said product signal K.sub.21 z.sub.1 and said .omega..sub.z.sup.F .DELTA.C.sub.32 signal in the production of the signal by the sixth summing point,
- (e) said seventh summing point being connected to receive and additionally add said product signal K.sub.32 z.sub.2 in the production of the signal by the seventh summing point, and
- (f) said ninth summing point being connected to receive and additionally add said product signal K.sub.52 z.sub.2 in the production of the signal by the ninth summing point.
Priority Claims (5)
Number |
Date |
Country |
Kind |
2741274 |
Sep 1977 |
DEX |
|
2903282 |
Jan 1979 |
DEX |
|
2922411 |
Jun 1979 |
DEX |
|
2922414 |
Jun 1979 |
DEX |
|
2922415 |
Jun 1979 |
DEX |
|
RELATED APPLICATIONS
This application is a Continuation-in-Part of applicant's patent application 904,926, filed May 11, 1978 and entitled "Instrument for the Automatic Determination of the North Direction" and now abandoned. The disclosure of this application is incorporated in the present application by reference.
US Referenced Citations (8)
Continuation in Parts (1)
|
Number |
Date |
Country |
Parent |
904926 |
May 1978 |
|