Closed-loop baseband controller for a rebalance loop of a quartz angular rate sensor
First Claim
1. A method of operating a servo-control system controlled by a control signal, said servo-control system producing a modulated signal responsive to said control signal, said modulated signal having a carrier frequency, said method comprising the steps of:
- a) measuring the open loop response of the systemb) complex digital demodulating said modulated signal by said carrier frequency to produce an in-phase demodulated signal and a quadrature-phase demodulated signal;
c) complex digital filtering said in-phase demodulated signal and said quadrature-phase demodulated signal to produce a filtered in-phase signal and a filtered quadrature-phase signal using scale factors computed from the open loop response measurement; and
d) complex digital modulating said filtered in-phase signal and said filtered quadrature-phase signal by said carrier frequency to produce said control signal.
4 Assignments
0 Petitions
Accused Products
Abstract
A sensor such as a quartz angular rate sensor is operated in a closed-loop mode including feedback of a control signal. The sensor produces a modulated carrier frequency signal. For stable operation of the feedback loop, the control signal is obtained from the modulated carrier frequency signal by complex demodulation of the modulated signal to produce an in-phase demodulated signal and a quadrature-phase demodulated signal, and the in-phase demodulated signal and the quadrature-phase demodulated signal are filtered by a complex equalizing filter to produce an equalized in-phase signal and an equalized quadrature-phase signal. The equalized in-phase signal represents information sensed by the sensor, and phase of a demodulation reference signal is adjusted to minimize appearance of the information in the equalized quadrature-phase signal. The equalized in-phase and quadrature-phase signals are complex modulated at the carrier frequency to produce the control signal. To compensate for variable delay or phase shift through the feedback loop, the phase of the control signal is adjusted by a phase adjustment signal. For equalization of an angular rate signal from a quartz angular rate sensor, the complex filtering includes compensation for peaking at the drive fork resonant frequency, compensation for secondary modes of vibration of the drive fork, and phase lead compensation for a relatively flat frequency response over the bandwidth of the angular rate signal.
47 Citations
26 Claims
-
1. A method of operating a servo-control system controlled by a control signal, said servo-control system producing a modulated signal responsive to said control signal, said modulated signal having a carrier frequency, said method comprising the steps of:
-
a) measuring the open loop response of the system b) complex digital demodulating said modulated signal by said carrier frequency to produce an in-phase demodulated signal and a quadrature-phase demodulated signal; c) complex digital filtering said in-phase demodulated signal and said quadrature-phase demodulated signal to produce a filtered in-phase signal and a filtered quadrature-phase signal using scale factors computed from the open loop response measurement; and d) complex digital modulating said filtered in-phase signal and said filtered quadrature-phase signal by said carrier frequency to produce said control signal. - View Dependent Claims (2, 3, 4, 5, 6, 7, 8)
-
-
9. A sensor system comprising, in combination:
-
a sensor responsive to a control signal for producing a modulated signal having a carrier frequency; a complex digital demodulator connected to said sensor for demodulating said modulated signal by said carrier frequency to produce an in-phase demodulated signal and a quadrature-phase demodulated signal; a complex digital filter connected to said complex demodulator for filtering said in-phase demodulated signal and said quadrature-phase demodulated signal to produce an equalized in-phase signal and an equalized quadrature-phase signal wherein the filter has scale factors computed from an open loop response measurement of the sensor; and a complex digital modulator connected to said complex digital filter and said sensor for modulating said equalized in-phase signal and said equalized quadrature-phase signal by said carrier frequency to produce said control signal. - View Dependent Claims (10, 11, 12, 13, 14, 15)
-
-
16. A sensor system comprising, in combination:
-
(a) a sensor responsive to a control signal for producing a modulated signal having a carrier frequency; (b) a complex digital demodulator connected to said sensor for demodulating said modulated signal by said carrier frequency to produce an in-phase demodulated signal and a quadrature-phase demodulated signal; (c) a complex digital filter connected to said complex digital demodulator for filtering said in-phase demodulated signal and said quadrature phase demodulated signal to produce an equalized in-phase signal and an equalized quadrature-phase signal, wherein said complex digital filter includes; (1) a first filter section connected to said complex digital demodulator for filtering said in-phase demodulated signal to produce a first filtered signal; (2) a second filter section connected to said complex digital demodulator for filtering said in-phase demodulated signal to produce a second filtered signal; (3) a third filter section connected to said complex digital demodulator for filtering said quadrature-phase signal to produce a third filtered signal; (4) a fourth filter section connected to said complex digital demodulator for filtering said quadrature phase signal to produce a fourth filtered signal; (5) a first summing node connected to said first filter section, said third filter section, and said complex digital modulator for combining said first filtered signal and said third filtered signal to produce a combined signal component of said equalized in-phase signal; and (6) a second summing node connected to said second filter section, said fourth filter section, and said complex digital modulator for combining said second filtered signal and said fourth filtered signal to produce a combined signal component of said equalized quadrature-phase signal and wherein the complex digital filter has scale factors computed from an open loop response measurement of the sensor; and (d) a complex digital modulator connected to said complex digital filter and said sensor for modulating said equalized in-phase signal and said equalized quadrature-phase signal by said carrier frequency to produce said control signal. - View Dependent Claims (17, 18)
-
-
19. A sensor system comprising, in combination:
-
(a) a sensor responsive to a control signal for producing a modulated signal having a carrier frequency; (b) a complex digital demodulator connected to said sensor for demodulating said modulated signal by said carrier frequency to produce an in-phase demodulated signal and a quadrature-phase demodulated signal; (c) a complex digital filter connected to said complex demodulator for filtering said in-phase demodulated signal and said quadrature phase demodulated signal to produce an equalized in-phase signal and an equalized quadrature-phase signal wherein the complex digital filter has scale factors computed from an open loop response measurement of the sensor; (d) a complex digital modulator connected to said complex digital filter and said sensor for modulating said equalized in-phase signal and said equalized quadrature-phase signal by said carrier frequency to produce said control signal, wherein said complex digital modulator includes; (1) a first multiplier connected to said complex digital filter for multiplying said equalized in-phase signal by an in-phase reference signal to produce a first product signal; (2) a second multiplier connected to said complex digital filter for multiplying said equalized in-phase signal by a quadrature-phase reference signal to produce a second product signal; (3) a third multiplier connected to said complex digital filter for multiplying said equalized quadrature-phase signal by said quadrature-phase reference signal to produce a third product signal; (4) a fourth multiplier connected to said complex digital filter for multiplying said equalized quadrature-phase signal by said in-phase reference signal to produce a fourth product signal; (5) a first summing node connected to said first multiplier and said third multiplier for combining said first product signal and said third product signal to produce an in-phase product signal; and (6) a second summing node connected to said second multiplier and said fourth multiplier for combining said second product signal and said fourth product signal to produce a quadrature-phase product signal; and (e) a phase shifter connected between said complex digital modulator and said sensor for shifting phase of said control signal in response to a phase adjustment signal, wherein said phase shifter includes; (1) a fifth multiplier for multiplying said in-phase product signal by a first sinusoidal function of a phase shift angle to produce a first scaled product signal; (2) a sixth multiplier for multiplying said quadrature-phase product signal by a second sinusoidal function of said phase shift angle to produce a second scaled product signal; and (3) a third summing node for combining said first scaled product signal and said second scaled product signal to produce said control signal. - View Dependent Claims (20)
-
-
21. An angular-rate sensing system comprising, in combination:
-
an angular rate sensor having a drive signal input, a drive signal output, a nulling signal input, and a rate signal output;
said angular rate sensor producing at said rate signal output an angular rate signal modulated on a carrier frequency when said drive signal input is excited at said carrier frequency;
said angular rate sensor having a drive resonant frequency at which there is approximately zero phase shift from said drive signal input to said drive signal output;
said angular rate sensor having pick-up resonant frequency offset from said drive resonant frequency;a drive circuit connected to said drive signal input and said drive signal output for exciting said drive signal input at a drive frequency approximately equal to said drive resonant frequency; a reference signal generator connected to said drive signal output for producing an in-phase reference signal and a quadrature-phase reference signal at said drive frequency; a complex digital demodulator connected to said rate signal output and said reference signal generator for complex demodulation of said angular rate signal by said in-phase reference signal and said quadrature-phase reference signal to produce an in-phase demodulated signal and a quadrature-phase demodulated signal; a complex digital filter connected to said complex digital demodulator for filtering said in-phase demodulated signal and said quadrature-phase demodulated signal to produce an equalized in-phase signal and an equalized quadrature-phase signal, said complex digital filter having zeros for compensating for said pick-up resonant frequency of said angular rate sensor wherein the complex digital filter has scale factors computed from an open loop response measurement of the sensor; and a complex digital modulator connected to said complex digital filter, said reference signal generator, and said nulling signal input for modulating said equalized in-phase signal and said equalized quadrature-phase signal to produce a nulling signal on said nulling signal input. - View Dependent Claims (22, 23, 24, 25, 26)
-
Specification