Methods, devices and systems for determining the zero rate output of a sensor

• US 8,649,999 B1
• Filed: 12/27/2010
• Issued: 02/11/2014
• Est. Priority Date: 12/28/2009
• Status: Active Grant

• Current Assignee: DRNC Holdings, Inc. (InterDigital, Inc.)
• Original Assignee: Hillcrest Laboratories Incorporated (CEVA Incorporated)
• Inventors: Sheng, Hua, Cook, Bryan A., Liberty, Matthew G.
• Primary Examiner(s): Armand, Marc
• Assistant Examiner(s): RABOVIANSKI, IVAN I
• Application Number:
  US12/978,956
• Time in Patent Office: 1,142 Days
• Field of Search: 702/87, 702/92, 702/104, 702/141, 702/150, 702/151
• US Class Current: 702/141
• CPC Class Codes: G01P 21/00 Testing or calibrating of apparatus or devices covered by the preceding groups
• CPC Class Codes: G01P 21/02 of speedometers
• CPC Class Codes: G06F 3/0346 with detection of the device orientation or free movement in a 3D space, e.g. 3D mice, 6-DOF [six degrees of freedom] pointers using gyroscopes, accelerometers or tilt-sensors
• CPC Class Codes: G06F 3/038 Control and interface arrangements therefor, e.g. drivers or device-embedded control circuitry
• CPC Class Codes: H04N 21/42222 Additional components integrated in the remote control device, e.g. timer, speaker, sensors for detecting position, direction or movement of the remote control, microphone or battery charging device

Abstract

A bias value associated with a sensor, e.g., a time-varying, non-zero value which is output from a sensor when it is motionless, is estimated using a ZRO-tracking filter which is a combination of a moving-average filter and a Kalman filter having at least one constraint enforced against at least one operating parameter of the Kalman filter. It achieves faster convergence on an estimated bias value and produces less estimate error after convergence. A resultant bias estimate may then be used to compensate the biased output of the sensor in, e.g., a 3D pointing device.

Claims

1. A device comprising:

at least one sensor configured to sense rotation of said device about at least one axis and to generate at least one output associated therewith; and

a zero-rate output (ZRO) tracking filter configured to receive said at least one output and to compensate said at least one output for a bias associated with said at least one sensor,

wherein said ZRO filter is implemented as a Kalman filter having at least one constraint enforced on at least one parameter associated therewith,

further wherein said at least one constraint is selected based on whether said ZRO filter has converged on an estimate of said bias, such that a first constraint is applied before said ZRO filter has converged on said estimate of said bias and that a second constraint, different from said first constraint, is applied after said ZRO filter has converged on said estimate of said bias,

wherein said first constraint ensures a minimum convergence speed by using a minimum Kalman gain before convergence (K₁) and said second constraint, different from said first constraint, limits a convergence speed by using a maximum Kalman gain after convergence (K₂), and

wherein K₁ and K₂ are calculated to determine a total Kalman gain.

2. The device of claim 1, wherein said sensed rotation of said device involves at least one of:

an angular velocity, an angular rate, and an angular position of said device.

3. The device of claim 1, wherein said bias is associated with a non-zero value output from said at least one sensor when said device is stationary.

4. The device of claim 1, wherein said at least one constraint is a lower bound enforced on an error variance (P) of an estimate of said bias.

5. The device of claim 1, wherein said at least one constraint is an upper bound enforced on an error variance (P) of an estimate of said bias.

6. The device of claim 1, wherein said at least one constraint is a lower bound enforced on a gain of said Kalman filter.

7. The device of claim 6, wherein said lower bound is enforced using at least one moving average.

8. The device of claim 7, wherein said at least one moving average is a cumulative moving average during a first number of samples of said at least one first output, and is an exponential moving average after said first number of samples.

9. The device of claim 1, wherein said at least one constraint is an upper bound enforced on a gain of said Kalman filter.

10. The device of claim 1, wherein said at least one constraint includes both an upper bound and a lower bound on an error variance (P) of an estimate of said bias and an upper bound and a lower bound on a gain of said Kalman filter.

11. The device of claim 1, wherein said convergence on said estimate of said bias is determined based on a convergence confidence factor of said ZRO filter.

12. The device of claim 1, wherein said at least one sensor includes a gyroscope.

13. A device comprising:

at least one sensor configured to sense rotation of said device about at least one axis and to generate at least one output associated therewith; and

a zero rate output (ZRO) filter configured to receive said at least one output and to compensate said at least one output for a bias associated with said at least one sensor,

wherein said ZRO filter is implemented as a combination of a Kalman filter and a moving-average filter,

wherein said Kalman filter has at least one constraint enforced on at least one parameter associated therewith,

further wherein said at least one constraint is selected based on whether said Kalman filter has converged on an estimate of said bias, such that a first constraint is applied before said Kalman filter has converged on said estimate of said bias and that a second constraint, different from said first constraint, is applied after said Kalman filter has converged on said estimate of said bias,

wherein said first constraint ensures a minimum convergence speed by using a minimum Kalman gain before convergence (K₁) and said second constraint, different from said first constraint, limits a convergence speed by using a maximum Kalman gain after convergence (K₂), and

wherein K₁ and K₂ are calculated to determine a total Kalman gain.

14. The device of claim 13, wherein said moving average filter is a cumulative moving average filter during a first number of samples of said at least one first output, and is an exponential moving average filter after said first number of samples.

15. The device of claim 13, wherein said ZRO filter switches its computation method for a coefficient from a first technique prior to convergence on a bias estimate to a second technique after convergence on said bias estimate.

16. The device of claim 13, wherein said ZRO filter evaluates whether a current estimate of said bias has converged to a true value of said bias.

17. The device of claim 13, wherein said ZRO filter computes measurement variance for a phase “

before convergence”

of an estimate of said bias using a technique which does not directly count a DC portion of said at least one first output.

18. The device of claim 13, further comprising:

a plurality of instances of said ZRO filters running together with at least one of different conditions and initializations to generate both a quick convergence to said bias and less likelihood of false convergence to said bias.

19. The device of claim 13, wherein said ZRO filter enforces different bounds on prediction variation before convergence to a bias estimate and after convergence to a bias estimate to reduce backlash pickup.

20. The device of claim 13, wherein said at least one sensor includes a gyroscope.

21. A method for filtering an output of a sensor to compensate for bias error, the method comprising:

filtering said output of said sensor using a shared recursive computation architecture of a standard Kalman filter, a cumulative moving-average filter, and an exponential moving-average filter, wherein a filter gain is adaptively modified as a function of Kalman gain, a cumulative moving-average coefficient, and an exponential moving-average coefficient.

22. The method of claim 21, further comprising:

enforcing constraints on a predicted estimate covariance used in a Kalman gain computation.

23. The method of claim 21, wherein said function is a first function before convergence of a bias estimate and a second function, different from said first function, after convergence of said bias estimate.

24. The method of claim 22, wherein said constraints include a first set of constraints used before convergence to a bias estimate and a second set of constraints, different than said first set of constraints, after convergence to said bias estimate.