Apparatus and method for correcting error of gyro sensor in mobile robot

• US 9,222,801 B2
• Filed: 06/26/2009
• Issued: 12/29/2015
• Est. Priority Date: 07/01/2008
• Status: Active Grant

• Current Assignee: Microinfinity, Inc.
• Original Assignee: Microinfinity, Inc.
• Inventors: Kim, Do-Hyung, Chung, Hak-Young, Song, Jin-Woo, Ryu, Guen-Rok
• Primary Examiner(s): Nguyen, Bao Long T
• Application Number:
  US13/002,331
• Publication Number:
  US 20110172820A1
• Time in Patent Office: 2,377 Days
• Field of Search: 73/17.7
• US Class Current: 1/1
• CPC Class Codes: G01C 19/5776 Signal processing not specific to any of the devices covered by groups G01C19/5607 - G01C19/5719
• CPC Class Codes: G01C 25/005 initial alignment, calibration or starting-up of inertial devices
• CPC Class Codes: G05D 1/027 comprising intertial navigation means, e.g. azimuth detector inertial navigation G01C21/16; inertial navigation combined with non-inertial navigation instruments G01C21/165

Abstract

Provided are a method and apparatus for correcting an error of a gyro sensor, and more particularly, a method and apparatus for correcting an error of a gyro sensor installed in a mobile robot.

Claims

1. An apparatus for calibrating a gyro sensor output, the apparatus comprising:

a state determination unit configured to select from successive gyro sensor outputs a set of sensor outputs whose deviation is equal to or less than a predetermined threshold;

a bias estimation unit configured to estimate a bias value using the selected set of sensor outputs; and

a gyro sensor output calibration unit configured to calibrate a new gyro sensor output using the estimated bias value.

2. The apparatus of claim 1, wherein the state determination unit is further configured to select from the successive gyro sensor outputs a different set of sensor outputs whose deviation is equal to or less than the predetermined threshold, wherein at least one sensor output in the different set of sensor outputs comes after the sensor outputs in the set of sensor outputs in time in the successive gyro sensor outputs.

3. The apparatus of claim 2, wherein the bias estimation unit is further configured to update the bias value with the selected different set of sensor outputs.

4. The apparatus of claim 3, wherein the bias estimation unit is further configured to update the bias value using the following equation:

5. The apparatus of claim 2, wherein each of the selected set of sensor outputs and the selected different set of sensor outputs includes sensor outputs taken from the successive gyro sensor outputs over a predetermined period of time.

6. The apparatus of claim 1, wherein the deviation of the selected set of sensor outputs is a standard deviation or a variance of the selected set of sensor outputs.

7. An apparatus for calibrating a gyro sensor output, the apparatus comprising:

a state determination unit configured to receive successive gyro sensor outputs and search the received successive gyro sensor outputs for a particular set of sensor outputs whose deviation is equal to or less than a predetermined threshold;

a bias estimation unit configured to estimate a bias value using the particular set of sensor outputs upon finding the particular set of sensor outputs; and

a gyro sensor output calibration unit configured to calibrate a new gyro sensor output using the estimated bias value.

8. An apparatus for calibrating a gyro sensor output, the apparatus comprising:

a state determination unit configured to receive successive gyro sensor outputs, search the received successive gyro sensor outputs for a particular set of sensor outputs whose deviation is equal to or less than a predetermined threshold, and provide a stationary state indication signal upon finding the particular set of sensor outputs;

a bias estimation unit configured to estimate a bias value using the particular set of sensor outputs in response to the stationary state indication signal; and

a gyro sensor output calibration unit configured to calibrate a new gyro sensor output using the estimated bias value.