Apparatus and method for processing the output signals of a coriolis rate sensor
First Claim
1. Apparatus for processing signals produced by an angular rate and linear acceleration sensor to determine an angular rate of rotation and a linear acceleration of a body, said sensor including a pair of accelerometers having their sensitive axes aligned in parallel with each other and orthogonal to a rate axis about which the angular rate of rotation of the body is sensed by periodically moving the pair of accelerometers in a direction orthogonal to both the sensitive axes of the accelerometers and to the rate axis as a function of a periodic movement signal, whereby a Coriolis acceleration proportional to the angular rate of rotation about the rate axis and aligned in the direction of the sensitive axes results, said accelerometers each producing an output signal proportional to the combined linear and Coriolis accelerations to which they are subjected along their sensitive axes, said apparatus comprising:
- (a) summing means for determining a sum and a difference of the output signals produced by the pair of accelerometers during a fractional portion of a complete period of the movement signal;
(b) processing means for determining as a function of said sum and difference;
(i) an incremental change in velocity of the body along a sensitive axis of the body that is aligned with the sensitive axes of the accelerometers; and
(ii) an incremental change in angular position of the body about the rate axis;
with(c) said processing means including means for correcting said incremental change in angular position for cross-coupling of an error component of the incremental change in velocity, and means for determining the angular rate of rotation of the body about the rate axis and the linear acceleration of the body along the sensitive axis, as a function of;
(i) the corrected incremental change in angular position,(ii) the incremental change in velocity, and(iii) a duration of said fractional portion of the period of the movement signal.
5 Assignments
0 Petitions
Accused Products
Abstract
Apparatus and method for increasing the resolution of angular rate of rotation and linear acceleration of a body with respect to three orthogonal axes. Three pairs of accelerometers (10, 12; 14, 16; and 18, 20) are arranged with their sensitive axes antiparallel to each other, and each pair is vibrated back and forth along one of the orthogonal axes. The signals output from the accelerometers are processed to determine Srate and Svel for each of the rate axes as a function of the sum and differences of the signals produced by each of the accelerometers. The value of Svel for each axis is used by a microprocessor (82) to produce a signal equal to an incremental change in velocity for each axis. The incremental change in velocity is then used in conjunction with errors estimated from previous fractional portions of the dither period for each pair of accelerometers to calculate the rate of rotation of the body about each of the axes as a function fo the values for Srate. As a further aspect of the invention, the incremental change in velocity and incremental changes in angular position may be determined as a running average of previous fractional portions of the dither frequency.
57 Citations
25 Claims
-
1. Apparatus for processing signals produced by an angular rate and linear acceleration sensor to determine an angular rate of rotation and a linear acceleration of a body, said sensor including a pair of accelerometers having their sensitive axes aligned in parallel with each other and orthogonal to a rate axis about which the angular rate of rotation of the body is sensed by periodically moving the pair of accelerometers in a direction orthogonal to both the sensitive axes of the accelerometers and to the rate axis as a function of a periodic movement signal, whereby a Coriolis acceleration proportional to the angular rate of rotation about the rate axis and aligned in the direction of the sensitive axes results, said accelerometers each producing an output signal proportional to the combined linear and Coriolis accelerations to which they are subjected along their sensitive axes, said apparatus comprising:
-
(a) summing means for determining a sum and a difference of the output signals produced by the pair of accelerometers during a fractional portion of a complete period of the movement signal; (b) processing means for determining as a function of said sum and difference; (i) an incremental change in velocity of the body along a sensitive axis of the body that is aligned with the sensitive axes of the accelerometers; and (ii) an incremental change in angular position of the body about the rate axis;
with(c) said processing means including means for correcting said incremental change in angular position for cross-coupling of an error component of the incremental change in velocity, and means for determining the angular rate of rotation of the body about the rate axis and the linear acceleration of the body along the sensitive axis, as a function of; (i) the corrected incremental change in angular position, (ii) the incremental change in velocity, and (iii) a duration of said fractional portion of the period of the movement signal. - View Dependent Claims (2, 3, 4)
-
-
5. Apparatus for processing signals produced by an angular rate and linear acceleration sensor to determine an angular rate of rotation of a body about a linear acceleration along each of a plurality of rate axes, said sensor including a plurality of pairs of accelerometers, each accelerometer of a pair having its sensitive axis aligned in parallel with the sensitive axis of the other and orthogonal to a rate axis of the plurality of rate axes with which the pair is associated and about which the angular rate of rotation of a body is sensed by moving the pair of accelerometers in a periodic motion directed orthogonally to both the sensitive axes of the pair of accelerometers and to their associated rate axis as a function of a periodic movement signal, whereby a Coriolis accleration proportional to the angular rate of rotation about the rate axis and aligned in the direction of the sensitive axes results, said accelerometers each producing an output signal proportional to the combined linear and Coriolis accelerations to which they are subjected along their sensitive axes, said apparatus comprising:
-
(a) means for determining a sum and a difference of the output signals from each pair of accelerometers during a fractional portion of a complete period of the movement signal; (b) processing means for determining as a function of said sum and difference for each pair of accelerometers; (i) an incremental change in velocity of the body along the sensitive axis of each pair of accelerometers, and (ii) an incremental change in angular position of the body about the rate axis associated with each pair of accelerometers;
with(c) said processing means including means for correcting the incremental changes in angular position and angular velocity for each pair of accelerometers by determining and subtracting therefrom cross-axis and cross-coupling error components, and means for determining the angular rate of rotation of the body about each of the rate axes and the linear acceleration of the body along each of the sensitive axes, as a function of; (i) the corrected incremental change in angular position, (ii) the corrected incremental change in velocity, and (iii) a duration of said fractional portion of the period of the movement signal. - View Dependent Claims (6, 7, 8, 9)
-
-
10. Apparatus for determining components of an angular rate of rotation of a body about a plurality of orthogonal rate axes and of a linear acceleration of the body along the rate axes, comprising:
-
(a) a plurality of pairs of accelerometers, each pair of accelerometers being associated with an angular rate of rotation about one of the rate axes, with the sensitive axes of the accelerometers comprising each pair being aligned in parallel with each other and perpendicular to said one rate axis with which that pair is associated, each accelerometer producing an output signal having a frequency corresponding to an acceleration sensed by said accelerometer along its sensitive axis; (b) driver means, including means for producing a periodic movement signal, for periodically moving each pair of accelerometers as a function of the periodic movement signal, in a direction generally orthogonal both to the sensitive axes of the pair of accelerometers and to the rate axis with which the pair of accelerometers is associated, so that the output signal from each accelerometer of the pair includes a periodic Coriolis acceleration component that is proportional to the angular rate of rotation of the body about the rate axis with which the pair of accelerometers is associated; and (c) signal processing means, connected to receive the output signals from each accelerometer and the periodic movement signal, for determining an incremental change in velocity and an incremental change in angular position of the body along each of the rate axes for a fractional portion of a complete period of the periodic movement signal as a function of the sum and difference of the output signals of each pair of accelerometers, said incremental changes in velocity and angular position for each of the rate axes including cross-axis components from each of the other rate axes, said signal processing means being further operative to determine the cross-axis components and to subtract their contribution, producing a corrected incremental change in velocity and incremental change in angular position for each rate axis, and further operative to determine as a function of the corrected incremental change of velocity and angular position and the duration of the fractional portion of the periodic movement signal, the linear acceleration and angular rate of rotation for each rate axis. - View Dependent Claims (11, 12, 13, 14, 15)
-
-
16. A method for determining the rate of angular rotation of a body about a rate axis and of determining its linear acceleration along an axis perpendicular to the rate axis, comprising the steps of:
-
(a) providing a pair of accelerometers having their sensitive axes aligned in parallel with the axis along which the linear acceleration is to be determined and orthogonal to the rate axis; (b) periodically moving the accelerometers in a direction orthogonal to both their sensitive axes and the rate axis as a function of a periodic movement signal, said accelerometers producing an output signal, which is a function of the combined linear acceleration, and the rate of rotation about the rate axis; (c) subtracting the output signals of the two accelerometers to produce a difference signal; (d) adding the output signals of the two accelerometers to produce a sum signal; (e) determining an incremental change in velocity of the body along the sensitive axes as a function of the sum and difference signals during a fractional portion of a complete period of the periodic movement signal; (f) determining an incremental change in angular position of the body about the rate axis as a function of the sum and difference signals; (g) determining an error component of the incremental change in velocity that cross couples into the incremental change in angular position; (h) correcting the incremental change in angular position for the error component of the incremental change of velocity; and (i) determining the angular rate of rotation and the linear acceleration of the body relative to the rate axis and sensitive axes, respectively, as a function of; (i) the corrected incremental change in angular position, (ii) the incremental change in velocity, and (iii) the duration of the fractional portion of the period of the movement signal. - View Dependent Claims (17, 18, 19)
-
-
20. A method for determining the rate of angular rotation of a body about a plurality of orthogonal rate axes and determining its linear acceleration along each of the rate axes, comprising the steps of:
-
(a) providing a plurality of pairs of accelerometers, each pair having their sensitive axes aligned in parallel with one of the rate axes and orthogonal to another rate axis with which that pair of accelerometers is associated; (b) periodically moving each pair of accelerometers in a direction orthogonal to both their sensitive axes and the rate axis with which the pair is associated, as a function of a periodic movement signal, the accelerometers of each pair each producing an output signal that is a function of the combined linear acceleration along their sensitive axes, and the rate of rotation about the rate axis with which the pair of accelerometers is associated; (c) for each pair of accelerometers, subtracting the output signal of one accelerometer of the pair to produce a difference signal for that pair; (d) for each pair of accelerometers, adding the output signal of one accelerometer to that of the other accelerometer to produce a sum signal for that pair; (e) determining an incremental change in velocity of the body along the sensitive axes of each pair of accelerometers as a function of the sum and difference signals for that pair, during a fractional portion of a complete period of the periodic movement signal; (f) determining an incremental change in angular position of the body about each rate axis as a function of the sum and difference signals for the pair of accelerometers associated with that rate axis; (g) determining an error component of each of the incremental changes in velocity that cross couples into the incremental changes in angular position for each rate axis; (h) determining an error component for the incremental changes in angular position of each rate axis due to cross-axis errors from the other rate axes; (i) correcting the incremental change in angular position for each rate axis for the error component of the incremental change of velocity; (j) correcting the incremental change in angular position for each rate axis for the error component due to cross-axis errors; (k) determining the angular rate of rotation and the linear acceleration of the body relative to each of the rate axes as a function of; (i) the corrected incremental change in angular position for that rate axis, (ii) the corrected incremental change in velocity for that rate axis, and (iii) the duration of the fractional portion of the period of the movement signal. - View Dependent Claims (21, 22, 23, 24, 25)
-
Specification