This invention relates generally to fiber optic gyroscope rotation sensing systems. More particularly, this invention relates to the processing of signals output from a fiber optic gyroscope to measure rotation rates. Still more particularly, this invention relates to an improved dither system and method using a low amplitude dither signal in a fiber optic gyroscope signal processing system.
U.S. Pat. No. 5,020,912, which issued Jun. 4, 1991 to George A. Pavlath, one of the inventors of the present invention, discloses a deadband circumvention technique for a closed loop fiber gyro that uses deterministic phase modulation. A periodic zero mean dither signal is input to an integrator that also has the gyro demodulated rate signal as an input. A key requirement is that the gyro loop bandwidth be greater than the dither frequency, which in turn is larger than the sampling frequency. Ideally the dither frequency is at least ten times the sampling frequency, and the loop bandwidth is at least ten times the dither frequency. If these conditions are not met, problems occur in operation of the fiber optic gyro as a rotation sensor. The problems include saturation of the front end of the gyro control loop for large dither amplitudes due to the limited loop bandwidth and finite analog to digital converter input range and large dither residuals in the output if there are not precisely an integer number of dither cycles in the sampling period. Saturation in the control loop leads to increased random walk through failure to cancel the dither signal and other undesirable nonlinearities. Decreasing the amplitude of the dither signal to avoid saturation could result in there not being sufficient dither to break up the deadband at high sampling rates. Applying a small amplitude dither signal for a time longer than the sampling time causes each sample to include a large amount of residual dither. The disclosure of U.S. Pat. No. 5,020,912 is incorporated by reference into the present disclosure.
The present invention provides a dither system and method that permits application of a low amplitude dither signal for many sampling periods without increasing the noise in the sampled outputs due to residual dither signals. The advantages of the invention over the prior art are achieved by adding a dither loop and an accumulator to the signal processing system of fiber optic gyroscope rotation sensing system. The dither loop has a delay and a gain that are adjusted to match the gain and delay of the fiber gyro loop. A zero mean dither of amplitude sufficient to break up the deadband is injected into to gyro and the dither loop. The dither loop filters the dither signal in the same manner as the gyro loop to provide a signal that is input to a differencing circuit to remove the dither signal from the gyro output.
A method for circumventing a deadband in signals output from a fiber optic gyroscope comprises the steps of providing a fiber optic gyroscope loop that includes signal processing apparatus connected between an input and an output of the fiber optic gyroscope and injecting a dither signal into the signal processing apparatus so that the dither signal is added to signals output from the fiber optic gyroscope. The method further includes integrating the sum of the dither signal and the signals output from the fiber optic gyroscope with an integrator to produce a gyro output plus dither signal. The dither signal is injected into a dither loop that is arranged to provide a filtered dither signal that is filtered in the same manner that the fiber optic gyroscope loop filters the dither signal input thereto. The gyro output plus dither signal output from the fiber optic gyroscope and the filtered dither signal output from the dither loop are input to a differencing apparatus to provide a gyro signal output that includes no dither signal.
The method preferably comprises the step of adjusting the gain of the dither loop to equal the gain of the fiber optic gyroscope loop so that the signal output from the dither loop has an amplitude that is the same as the amplitude of the dither signal component of the signal output from the fiber optic gyroscope loop.
The method preferably also further comprises the steps of accumulating the gyro output plus dither signal from the integrator with a gyro accumulator and accumulating the filtered dither signal output from the dither loop with a dither accumulator. The gyro accumulator and the dither accumulator are sampled simultaneously and their outputs are input to the differencing apparatus to produce the gyro signal output.
The method may further comprise the steps of forming the dither loop to include a dither summing circuit arranged to receive the dither signal as an input, connecting an output of the dither summing circuit to a dither integrator, and connecting a dither delay circuit to the dither integrator to receive a signal output therefrom and to produce a delayed dither signal. The delayed dither signal is amplified and input to a dither multiplier that multiplies the amplified dither signal by a fine gain adjust signal. The dither multiplier is connected to the dither summing circuit so that signals output from the dither multiplier are added to the dither signal.
The method according to the present invention preferably further comprises the step of providing a pilot signal that is input to the dither loop so that the dither loop produces a dither plus pilot signal output and so that the fiber optic gyroscope loop produces gyro plurality dither plus pilot signal output.
The method according to the present invention also preferably further comprises the steps of combining the gyro plus dither plus pilot signal output from the fiber optic gyroscope loop with the dither plus pilot signal in a differencing circuit to produce a gyro plus residual dither plus residual pilot signal output; and processing the pilot signal and the gyro plus residual dither plus residual pilot signal with a gain adjust loop arranged to provide a fine gain adjust signal that is input to both the dither loop and the pilot loop to adjust the gains thereof so that the residual dither signal and the residual pilot signal have zero amplitude so that the differencing circuit output is the gyro output without any dither or pilot signal component.
The method may further comprise the steps of forming the pilot loop to include a pilot summing circuit arranged to receive the pilot signal as an input, connecting an output of the pilot summing circuit to a pilot integrator, and connecting a pilot delay circuit to the pilot integrator to receive a signal output therefrom and to produce a delayed pilot signal. The delayed pilot signal is amplified and then input to a pilot multiplier that multiplies the amplified pilot signal by the fine gain adjust signal output from the gain adjust loop. The pilot multiplier is connected to the pilot summing circuit so that signals output from the pilot multiplier are added to the pilot signal.
The method may also further comprise the steps of multiplying a filtered gyro plus residual dither plus residual pilot signal by a filtered signal output from the pilot integrator with a multiplier circuit and amplifying signals output from the multiplier with a variable gain amplifier. Signals output from the variable gain amplifier are integrated with a gain adjust integrator to produce an output that is amplified by a static gain amplifier. Signals output from the static gain amplifier are sampled with a sampling circuit to produce an error signal that is differenced from unity to obtain the fine gain adjust signal.
Referring to
The digitized signal is input to a summer 20. A dither circuit 22 provides a dither signal to the summer 20. The summer 20 sums the digitized gyro output and the dither signal and input thereto and inputs a sum signal into a gyro integrator 24. The output of the gyro integrator 24 is input to both a ramp generator 26 and a gyro accumulator 28. The output of the ramp generator 26 is input to a digital to analog circuit 29 that is connected to the fiber gyro 12 so that the fiber gyro 12 receives a dithered ramp signal input.
The dither signal from the dither circuit 22 is also input to a summer 30 that is included in a dither loop 32. Signals output from the summer 30 are input to a dither integrator 34. The dither integrator 34 has an output that is connected to a delay circuit 36 in the dither loop 32. The delay circuit 36 is connected to an amplifier 38, which provides an amplified signal to a multiplier 40 that also receives a fine gain adjust signal from a fine gain circuit 42.
The output of the dither integrator 34 is also input to a dither accumulator 44. Signals output from the gyro accumulator 28 and the dither accumulator 44 are input to a differencing circuit 46.
The delay and gain of the dither loop 32 are adjusted to match the delay and gain of the fiber gyro loop 11. The dither circuit 22 provides a zero mean dither signal of amplitude sufficient to break up the deadband. The zero mean dither signal is injected into the gyro loop 11 at the summer 20, which is connected to the input of the gyro integrator 24. The zero mean dither signal is input to the dither loop 32 at the summer 30, which is connected to the input of the dither integrator 34. The function of the dither loop 32 is to filter the dither signal in essentially the same manner that the gyro loop 11 filters the dither signal to permit removal of the dither signal from the gyro output.
The output of the gyro integrator 24 is fed into the gyro accumulator 28, which is sampled and cleared at the gyro output frequency. As indicated in
The dither circuit of
The dither+pilot integrator 60 is also connected to a differencing circuit 68, which also receives the output of the fiber gyro loop 11 provided by the gyro integrator 24. The output of the differencing circuit 68 is input to an accumulator 70 and to a filter 72 in a gain adjust loop 74.
The output of the pilot signal generator 55 is also input to a summer 76 that is included in a pilot loop 78. The output of the summer 76 is input to a pilot integrator 80 that is arranged to provide the integrated pilot signal to a pilot delay circuit 82. The output of the pilot delay circuit 82 is input to an amplifier 84, which has its output connected to an input of a multiplier 86.
The output of the pilot integrator 80 is also input to a filter 86 that is included in the gain adjust loop 74. The filter 86 output is input to a multiplier 88, which is also arranged to receive signals output from the filter 72. The multiplier 88 output is input to a variable gain amplifier 90 that provides amplified signals to a gain adjust integrator 92. The integrated signal output from the gain adjust integrator 92 is input to an amplifier 94 that has a static gain. The output of the amplifier 94 is connected to a sampler 96, which produces a gain error signal output. A differencing circuit 98 receives both the gain error signal and a numerical signal input that is preferably unity from a signal generator 100. The differencing circuit calculates the difference between unity and the gain error signal to produce a fine gain adjust signal that is input to the multiplier 66 in the dither+pilot loop 58 and to the multiplier 86 in the pilot loop 78. The multiplier 66 inputs the product of the fine gain adjust signal from the differencing circuit and the signal output from the amplifier 64 into the summer 56. The summer 56 adds the dither signal, the pilot signal and the output from the multiplier 66 to produce the signal that is input to the dither+pilot integrator 60 and also input to the gyro loop 11 at the summer 20.
The pilot signal is also a zero mean signal. The frequency of the pilot signal is selected to be higher that the required gyro bandwidth. A convenient choice for the pilot signal frequency is the sampling frequency of the gyro or an integer multiple thereof. This choice of pilot signal frequency simplifies implementing the invention digitally, but is not required. The relationship of the dither frequency, pilot frequency and the gyro bandwidth is shown in the expression:
fdither<fgyro bandwidth<fpilot.
Now that the structure of the embodiment of the invention shown in
The first filter 72 is a high pass filter that can be mechanized in many ways known in the art. The purpose of the first filter 72 is to attenuate DC terms, the dither signal and the gyro signal while passing the residual pilot signal through with minimal attenuation. Any residual pilot signal after the filter indicates a gain error between the gyro loop 11 and the dither+pilot loop 58.
The output of the pilot loop is fed into the second filter 86 that preferably is identical to the first filter 72. The purpose of the second filter 86 is to provide exactly the same delay to the pilot signal so that the pilot signal is well aligned in time with the residual dither+pilot signal from the first filter 72.
The filtered gyro+dither+pilot signal is multiplied by the filtered pilot signal. Any residual pilot signal from the first filter 72 will rectify with the filtered pilot signal and create a DC term and higher harmonics. The DC term first is amplified by the variable gain amplifier 90. The variable gain amplifier 90 is provided to permit rapid capture of the proper fine gain at turn on (high gain) and the gain is lowered to permit tracking of the gain. The signal is next integrated, which accentuates the DC term and reduces the higher harmonics. The signal next sees the static gain amplifier 94, which has a gain chosen to ensure stable operation of the gain adjust loop 74. The signal is next sent to the resetting accumulator, which is sampled at an integer multiple of the pilot signal period by sampler 96. The number of pilot periods between samples is chosen to permit the gain adjust loop to track the gain fluctuations in the gyro loop 11.
The sampled DC term from the sampler 96 constitutes a gain error signal. This gain error signal is differenced from unity and is fed back into both the multiplier 66 in the dither+pilot loop 58 and the multiplier 86 in the pilot loop 78. Feeding the gain error signal into the multipliers 66 and 86 adjusts the dither+pilot loop gain 58 the pilot loop 78 gain to ensure that they track the gyro loop gain in real time.
The present invention provides means for introducing a low amplitude, low frequency dither signal into a fiber gyro to break up the deadband. The amplitude of the dither signal is sufficiently low that any saturation in the gyro loop is avoided. The present invention provides means for removing the low frequency dither signal from the higher frequency gyro output by use of the dither+pilot loop 58 as described above. The present invention also provides a method using the pilot loop 78 to enable the gain of the dither+pilot loop 58 and the gain of the pilot loop 78 to track the gain of the gyro loop 11, which ensures that adequate removal of the dither+pilot signal from the gyro output occurs as the gyro changes temperature or ages.
The present invention can be used in deterministically modulated, closed loop fiber gyros that have low gyro loop bandwidths and high sampling frequencies. It should be noted that all of the components shown in the block diagrams of