Method for compensating rotational position error of robot cleaner

• US 20040128031A1
• Filed: 09/26/2003
• Published: 07/01/2004
• Est. Priority Date: 12/31/2002
• Status: Active Grant

• Current Assignee: LG Electronics, Inc. (LG Corporation)
• Original Assignee: LG Electronics, Inc. (LG Corporation)
• Inventors: Wang, Hee Il
• Granted Patent: US 7,133,745 B2
• Time in Patent Office: Days
• US Class Current: 700/258
• CPC Class Codes: G01C 25/005 initial alignment, calibration or starting-up of inertial devices

Abstract

A method for compensating a rotational position error of a robot cleaner is disclosed to reduce a rotational position error of a robot cleaner by compensating an offset value of a gyro sensor of the robot cleaner. The method includes: detecting an offset value of a sensor for detecting a rotational speed of a robot cleaner; compensating the detected offset value; and correcting a rotational position of the robot cleaner on the basis of the compensated offset value.

Claims

1. A method for compensating a rotational position error of a robot cleaner comprising:

detecting an offset value of a sensor for detecting a rotational speed of a robot cleaner;

compensating the detected offset value; and

correcting a rotational position of the robot cleaner on the basis of the compensated offset value.

2. The method of claim 1, wherein the sensor is a gyro sensor

3. The method of claim 1, wherein, in the step of detecting an offset value, an offset value of the sensor is detected whenever the robot cleaner temporarily stops.

4. The method of claim 1, wherein the step of compensating the offset value comprises:

obtaining an average value of the detected offset values and a standard deviation;

averaging the noise-removed offset value on the basis of the average value and the standard deviation; and

determining the averaged offset value as a new offset value.

5. The method of claim 4, wherein the average value and the standard deviation is calculated by an equation of

6. The method of claim 4, wherein the new offset value is calculated by an equation of

7. The method of claim 4, wherein the step of correcting a rotational position of the robot cleaner comprises:

calculating an angular velocities of the robot cleaner on the bass of the new offset value;

calculating the amount of rotation of the robot cleaner by accumulatively adding the calculated angular velocities; and

subtracting the calculated amount of rotation from the previous amount of rotation, and compensating the subtracted amount of rotation.

8. The method of claim 2, wherein the step of correcting the rotational position of the robot cleaner comprises:

calculating angular velocities of the robot cleaner on the basis of the compensated offset value of the gyro sensor;

calculating the amount of rotation of the robot cleaner by accumulatively adding the calculated angular velocities; and

subtracting the calculated amount of rotation from the previous amount of rotation, and compensating the subtracted amount of rotation.

9. The method of claim 2, wherein the step of compensating the offset value comprises:

obtaining an average value of the offset values detected by the gyro sensor when the robot cleaner temporarily stops and a standard deviation; and

averaging the average value and the standard deviation, and determining the averaged offset value as a new offset value.

10. The method of claim 2, wherein the step of correcting the rotational position of the robot cleaner comprises:

calculating angular velocities of the robot cleaner on the basis of the compensated offset value;

calculating the amount of rotation of the robot cleaner by accumulatively adding the calculated angular velocities; and

subtracting the calculated amount of rotation from the previous amount of rotation, and compensating the subtracted amount of rotation.

11. A method for compensating a rotational position error of a robot cleaner comprising:

detecting an offset value of a gyro sensor after stopping a robot cleaner for a predetermined time when the robot cleaner is in an offset compensation mode;

obtaining an average value of the detected offset values and a standard deviation;

averaging the noise-removed offset value on the basis of the average value and the standard deviation;

determining the averaged offset value as a new gyro offset value; and

compensating a rotational position error of the robot cleaner on the basis of the new gyro offset value.

12. The method of claim 11, wherein the offset compensation mode is performed at a point when the robot cleaner starts a cleaning operation.

13. The method of claim 11, wherein the offset compensation mode is performed at a start point of a step of creating map information on a cleaning region and performing a cleaning in a certain pattern on the basis of the map information.

14. The method of claim 11, wherein the offset compensation mode is performed at a point when the robot cleaner starts moving to a charger.

15. The method of claim 11, wherein the offset compensation mode is performed at each predetermined time.

16. The method of claim 11, wherein the offset compensation mode is performed when a difference between the sample average value of the offset values of the gyro sensor and the detected gyro offset value is greater than a predetermined value.

17. The method of claim 16, wherein the sample average value of the gyro offset values is calculated by an equation of

18. The method of claim 11, wherein the average value of the offset values and the standard deviation are calculated by an equation of

19. The method of claim 11, wherein the new gyro offset value is calculated by an equation of

20. The method of claim 11, wherein the step of compensating the rotational position error of the robot cleaner comprises:

calculating an angular velocities of the robot cleaner on the bass of the new offset value;

calculating the amount of rotation of the robot cleaner by accumulatively adding the calculated angular velocities; and

subtracting the calculated amount of rotation from the previous amount of rotation, and compensating the subtracted amount of rotation.

21. The method of claim 20, wherein the compensated amount of rotation is calculated by an equation of

Ψ

_n+1=Ψ

_n+1,previous−

Ψ

_compensation=Ψ

_n+1−

½

(G_offset,new−

G_offset,old)·

(t_new−

t_old)

wherein ψ

_n+1 is the compensated amount of rotation of the robot cleaner, ψ

_n+1,previous is the amount of rotation of the robot cleaner before compensation, and ψ

_compensation is the rotation compensation amount of the robot cleaner.