Method and apparatus for detecting movement error in mobile robot

Information

  • Patent Grant
  • 8135498
  • Patent Number
    8,135,498
  • Date Filed
    Wednesday, December 24, 2008
    16 years ago
  • Date Issued
    Tuesday, March 13, 2012
    12 years ago
Abstract
An apparatus and method for detecting movement errors due to the wheel slip or transient current generated while a mobile robot is traveling. The movement error detecting method includes: detecting movement of the wheels in a sensor part according to a movement command input to a drive motor, and outputting an actual output value from the sensor part; calculating an ideal output value for output from the sensor part as the wheels are moved according to the movement command; and comparing the actual output value with the ideal output value to determine and residual fault and detect movement errors.
Description
CLAIM OF PRIORITY

This application claims priority under 35 U.S.C. §119 from an application entitled “METHOD AND APPARATUS FOR DETECTING MOVEMENT ERROR IN MOBILE ROBOT” filed in the Korean Intellectual Property Office on Dec. 26, 2007 and assigned Serial No. 2007-0137307, the contents of which are incorporated herein by reference in its entirety.


BACKGROUND OF THE INVENTION

1. Field of the Invention


The present invention relates to mobile robots and the tracking of their movement. More particularly, the present invention relates to an apparatus and method for detecting movement errors due to wheel slippage or transient current generated while a mobile robot is traveling.


2. Description of the Related Art


Mobile robots, such as cleaning robots, require precise recognition of locations while they are moving. To this end, mobile robots adopt an absolute navigation and a dead-reckoning navigation.


Absolute navigation is performed conventionally using a global positioning system (GPS). When GPS is applied to navigation in mobile robots, it allows the mobile robots to obtain an absolute position. On the other hand, GPS increases the manufacturing costs of mobile robots, and GPS use does not reduce or restrict certain errors in the position accuracy of mobile robots. In particular, since GPS cannot be used in a restricted area, such as inside building, it is difficult to apply GPS to mobile robots used indoors.


Dead-reckoning navigation, which estimates a current position based upon a previously determined position or fix, is performed using an encoder, an acceleration sensor or a gyro sensor. When dead-reckoning navigation using sensors is applied to mobile robots, it reduces the manufacturing costs of mobile robots and allows the mobile robots to calculate a precise position. On the other hand, since the position is obtained by an integral method, as the mobile robots travel further and increase their rotation movement errors increase.


In particular, when wheel slippage occurs while the mobile robot is traveling, a large positional error is generated. in addition, when the wheels cannot roll due to an obstacle, the drive motors of the wheels are overloaded (i.e., transient current flows to the driver motors), which reduces the life span of the drive motors and can even cause the driver motors to malfunction.


SUMMARY OF THE INVENTION

The present invention provides an apparatus and method for detecting movement errors due to wheel slippage and/or transient current(s) generated while a mobile robot is traveling.


In accordance with an exemplary embodiment of the present invention, the present invention provides a method and apparatus that provides a mathematical model of the dynamic characteristics of a mobile robot, and detects errors in movement of the mobile robot by comparing the input value with the output value.


In accordance with another exemplary embodiment of the present invention, the present invention provides a method for detecting movement errors in a mobile robot having wheels, including: detecting an actual movement of the wheels in a sensor part, according to a movement command input to a drive motor, and outputting an actual output value from the sensor part; calculating an ideal output value that is expected as an output from the sensor part as the wheels are normally moved according to the movement command; and comparing the actual output value with the ideal output value and detecting the movement errors.


In accordance with another exemplary embodiment of the present invention, the present invention provides an apparatus for detecting movement errors in a mobile robot having wheels, including: a sensor part for detecting an actual movement of the wheels, according to a movement command input to a drive motor of the wheels, and outputting an actual output value; an ideal output calculating unit for calculating an ideal output value that is expected to be output from the sensor part as the wheels are normally moved according to the movement command; and a movement error detecting unit for comparing the actual output value with the ideal output value and detecting the movement errors. The detecting movement or a controller may also provide an output indicating that an error has occurred.





BRIEF DESCRIPTION OF THE DRAWINGS

The features and advantages of the present invention will be more apparent from the following detailed description in conjunction with the accompanying drawings, in which:



FIG. 1 is a perspective view depicting a mobile robot adapted to a movement error detecting apparatus according to an exemplary embodiment of the present invention;



FIG. 2 is a schematic block diagram illustrating a movement error detecting apparatus according to an exemplary embodiment of the present invention;



FIG. 3 is a flow chart illustrating exemplary steps of a method for detecting a movement error in a movement error detecting apparatus of FIG. 2; and



FIG. 4 is a fault residual-time graph calculated according to the movement error detecting method of FIG. 3.





DETAILED DESCRIPTION

Hereinafter, exemplary embodiments of the present invention are described in detail with reference to the accompanying drawings. The same reference numbers are used throughout the drawings to refer to the same or similar parts. Detailed descriptions of well-known functions and structures incorporated herein may be omitted to avoid obscuring appreciation of the subject matter of the method and apparatus for detecting movement error according to the present invention by a person of ordinary skill in the art.


As shown in FIG. 1 and FIG. 2, an example of a mobile robot 100 is shown that includes an apparatus for detecting movement errors 50 (FIG. 2), hereinafter called a movement error detecting apparatus 50, according to the present invention. The mobile robot 100 in this example includes a body 12 and a pair of wheels 14 and 16 installed to the body 12. A drive motor 18 (represented in FIG. 2) for driving the wheels 14 and 16 is installed within the body 12. The movement error detecting apparatus 50 includes a sensor part for detecting movement of the wheels 14 and 16 and is installed within the body 12. The sensor part includes a left encoder 41, right encoder 43 and a gyro sensor 45.


The wheels 14 and 16 are installed at both outer lateral sides of the body 2 in this exemplary embodiment of the present invention shown in FIG. 1. However, it should be understood that the present invention is not limited by the exemplary embodiment. For example, the wheels 14 and 16 may be installed underneath the body 12 or installed in such a way so as to extend from the underside to the upper side of the body 12.


The movement error detecting apparatus 50 includes a controller 20, memory 30 and sensor part.


The controller 20 may comprise, for example, a microprocessor that controls the whole operation of the mobile robot 100, including the movement error detecting apparatus 50. The controller 20 controls the movement of the mobile robot 100 and detects movement errors generated while the mobile robot 100 is traveling.


The left wheel 14 and right wheel 16 are connected to the drive motor 18. The drive motor 18 may rotate the left and right wheels 14 and 16 according to the movement commands ul and ur from the controller 20, where ul is a movement command for the left wheel 14 and ur is a movement command for the right wheel 16. The drive motor 18 may be a DC motor and inputs the movement commands ul and ur generated by pulse width modulation (PWM). The memory 30 stores a program for controlling the operation of the mobile robot 100 and data generated while the program is executed. The memory 30 may include more than one volatile memory device and non-volatile memory device. The memory 30 also stores a movement error detecting program 31 for detecting movement errors and data generated while the movement error detecting program 31 is executed.


Referring now to FIG. 2, the sensor part detects the actual movement of the wheels 14 and 16 that are moved according to the movement commands ul and ur input to the drive motor 18 and then outputs actual output values yl, yr and w to the controller 20. The left encoder 41, which is connected to the shaft of the left wheel 14, detects the rotation of the left wheel 14 and outputs the detected result to the controller 20. The right encoder 43, which is connected to the shaft of the right wheel 16, detects the rotation of the right wheel 16 and outputs the detected result to the controller 20. The gyro sensor 45 detects the rotation of the mobile robot 100 and outputs the detected result to the controller 20. The left and right encoders 41 and 43 output the rotational velocities and linear velocities, in proportion to the rotation number of the wheels 14 and 16, to the controller 20. The controller 20 integrates the output values to calculate the position of the mobile robot 100. The gyro sensor 45 detects the rotation of the mobile robot 100 and outputs an angular velocity to the controller 20. The controller 20 integrates the output value to calculate the movement direction of the mobile robot 100. Here, yl is the output value of the left encoder 41, yr is the output value of the right encoder 43 and w is the output value of the gyro sensor 45.


In particular, the controller 20 includes an ideal output calculating unit 21 and the movement error detector 23. The ideal output calculating unit 21 calculates an ideal output value that is intended (i.e. expected/predicted) to be output from the sensor part as the wheels 14 and 16 are normally moved according to the movement commands ul and ur. The movement error detector 23 compares the actual output value with the ideal output value to detect whether a movement error has occurred.


The ideal output calculating unit 21 calculates the ideal output value by the following Equation 1.










[






v
^

.

l








v
^

.

r




]

=




[




a
11




a
12






a
21




a
22




]



[





v
^

l







v
^

r




]


+



[




b
11




b
12






b
21




b
22




]



[




u
l






u
r




]






[





y
^

l







y
^

r






w
^




]


=


[



1


0




0


1






-
2

/
l




2
/
l




]



[





v
^

l







v
^

r




]







[

Equation





1

]







wherein vl denotes the left wheel velocity, vr denotes the right wheel velocity, ul denotes the movement command for the left wheel, ur denotes the movement command for the right wheel, a and b denote system parameters, yl denotes the output value of the left encoder, yr denotes the output value of the right encoder, w denotes the angular velocity of the gyro sensor, and l denotes the distance between the left and right wheels.


Equation 1 is a state space equation that expresses a mathematical model of the mobile robot 100. In other words, the dynamic systems including the mobile robot 100 may be all expressed through a state space equation. Equation 1 is a specific mathematical model that is obtained by analyzing the dynamic characteristics of the mobile robot 100 from a general state space equation.


More specifically, the mathematical model is a state space equation obtained as input and output data are collected through various operations of the mobile robot 100, and parameters are then extracted from the collected input and output data through the least square method. In order to obtain a precise mathematical model, output data should be acquired though the input of a variety of frequency bands. A mathematical model comprises a system for predicting output values yl, yr and w, serving as a function that associates an output to movement commands ul and ur that are input to the mobile robot 100 in a certain state. This mathematical model typically is not precisely consistent with the actual model in all cases. However, the mathematical model can specify that it is effective within a certain range of error for extracted parameters. After the above described processes are performed, Equation 1 as a mathematical model is obtained. Since the mobile robot 100 according to an exemplary embodiment of the present invention moves using the two wheels 14 and 16, it is analyzed as a multi-input multi-output system. Therefore, the mobile robot 100 can be expressed by a state space equation that inputs two movement command ul and ur and outputs three output values yl, yr and w. Here, ul is a movement command of the left wheel and ur is a movement command of the right wheel 16. yl is an output value of the left encoder 41, yr is an output value of the right encoder 43 and w is an angular velocity of the gyro sensor 45. In that case, although the state space equation is a non-linear system, it can be linearized in the vicinity of the operating point, thereby obtaining Equation 1.


In a case where, for example, a slip occurs at the left wheel 14, the mobile robot 100 does not react in a normal state where its input and output operations are normally conducted, but operates in such a way to output different output values. Since the coefficient of dynamic friction is smaller than that of static friction, the system parameters are varied and the state space equation is expressed as the following Equation 2.















[





v
.

l







v
.

r




]

=





[





a
11

+

Δ






a
11







a
12

+

Δ






a
12








a
21




a
22




]



[




v
l






v
r




]


+












[





b
11

+

Δ






b
11







b
12

+

Δ






b
12








b
21




b
22




]



[




u
l






u
r




]


+

[




f
1





0



]








=





[




a
11




a
12






a
21




a
22




]



[




v
l






v
r




]


+


[




b
11




b
12






b
21




b
22




]



[




u
l






u
r




]


+










[





Δ






a
11



v
l


+

Δ






a
12



v
r


+

Δ






b
11



u
l


+

Δ






b
12



u
r


+

f
1






0



]









[




y
l






y
r





w



]

=


[



1


0




0


1






-
2

/
l




2
/
l




]



[




v
l






v
r




]






[

Equation





2

]







wherein Δa, Δb and f are errors generated at respective parameters.


When such movement errors have occurred, the different outputs (yl, yr and w) to the same movement commands ul and ur are output, as expressed in Equations 1 and 2.


The movement error detecting unit 23 (shown in FIG. 2 as part of controller 20) detects the movement errors through the difference in value between the actual output value and the ideal output value, which is hereinafter called a fault residual. That is, the movement error can be detected by the difference between the actual output value, output from the sensor part according to the movement of the mobile robot 100, and the ideal output value calculated by Equation 1.


On the other hand, since the actual output value can be expressed by Equation 2, the fault residual is expressed by the following Equation 3. Equation 3 can be obtained by taking the Laplace transform of Equations 1 and 2.










[





y
l

-


y
.

l








y
r

-


y
.

r







w
-

w
.





]

=


[



1


0




0


1






-
2

/
l




2
/
l




]





(

sI
-

[




a
11




a
12






a
21




a
22




]


)


-
1










[









Δ






a
11



v
l


+

Δ






a
12



v
r


+

Δ






b
11



u
l


+

Δ






b
12



u
r


+

f
1






0







]






[

Equation





3

]







wherein s is the Laplace variable.


As shown in the graph in FIG. 4, the movement error detecting unit 23 detects a movement error through the fault residual calculated by Equation 3. That is, when the fault residual is close to “zero”, the movement error detecting unit 23 concludes that the whole operation of the mobile robot 100 is normal.


On the contrary, according to this exemplary embodiment of the present invention, when the fault residual exceeds a certain limit, the movement error detecting unit 23 determines that a movement error has occurred. Furthermore, when an error duration, during which the limit exceeds, exceeds a time limit t2−t1, the movement error detecting unit 23 also determines that a movement error has occurred.


The movement error detecting unit 23 performs the detection of a movement error through the limit and the error duration. In the case where the mathematical model is significantly different from the actual model, the limit must be selected as a larger value. When a large amount of noise is generated in the sensor part, the time limit t2−t1 must be also selected as a large value. That is, it is preferable that the limit is adjusted in proportion to the difference between the actual output value and the output value calculated by Equation 2 and the time limit is also adjusted in proportion to the amount of noises generated in the sensor part.


Equations 2 and 3 express an exemplary case where a slip occurs at the left wheel 14 of the mobile robot 100. However, the wheel slip can, in general, be expressed by the following Equations 4 and 5.















[





v
.

l







v
.

r




]

=





[





a
11

+

Δ






a
11







a
12

+

Δ






a
12









a
21

+

Δ






a
21







a
22

+

Δ






a
22






]



[




v
l






v
r




]


+











[





b
11

+

Δ






b
11







b
12

+

Δ






b
12









b
21

+

Δ






b
21







b
22

+

Δ






b
22






]

+

[




f
l





0



]








=





[




a
11




a
12






a
21




a
22




]



[




v
l






v
r




]


+


[




b
11




b
12






b
21




b
22




]



[




u
l






u
r




]


+










[





Δ






a
11



v
l


+

Δ






a
12



v
r


+

Δ






b
11



u
l


+

Δ






b
12



u
r


+

Δ






f
l









Δ






a
21



v
l


+

Δ






a
22



v
r


+

Δ






b
21



u
l


+

Δ






b
22



u
r


+

Δ






f
2






]









[




y
l






y
r





w



]

=


[



1


0




0


1






-
2

/
l




2
/
l




]



[




v
l






v
r




]






[

Equation





4

]







Wherein Δa, Δb and f are errors generated at respective parameters.










[





y
l

-


y
^

l








y
r

-


y
^

r







w
-

w
^





]

=



[



1


0




0


1






-
2

/
l




2
/
l




]




(

sI
-

[




a
11




a
12






a
21




a
22




]


)

-


+













[









Δ






a
11



v
l


+

Δ






a
12



v
r


+

Δ






b
11



u
l


+

Δ






b
12



u
r


+

Δ






f
l









Δ






a
21



v
l


+

Δ






a
22



v
r


+

Δ






b
21



u
l


+

Δ






b
22



u
r


+

Δ






f
2






]






[

Equation





5

]







wherein s is the Laplace variable.


In particular, the element, Δa21vl+Δa22vr+Δb21ul+Δb22ur+f2 in Equation 4, is related to the movement error of the right wheel 16, and becomes zero when the right wheel 16 is normally operated. That is, Equation 2 for the movement error of the left wheel 14 can be derived from Equation 4.


As described in Equation 5, the fault residual is a vector. The magnitude of the vector is extracted for the limit in order to detect the movement error and the direction of the vector shows which type of movement error has occurred. That is, since the movement error detecting apparatus 50 has the left encoder 41, right encoder 43 and gyro sensor 45, which are all independent from each other, it can analyze the calculated vector and classify the types of movement errors, and detect the movement errors.


For example, when one of the left encoder 41, right encoder 43 and gyro sensor 45 malfunctions, the fault residuals of the left encoder 41, right encoder 43 and gyro sensor 45 are expressed as







[



X




0




0



]

,

[



0




X




0



]

,

and




[



0




0




X



]






correspondingly and respectively.


When a wheel slips or does not roll due to an obstacle, all components are not consistent between the ideal output value and the actual output value and thus the fault residual is expressed as







[




X
1






X
2






X
3




]

.




The movement error detecting method according to an exemplary embodiment of the present invention is described in detail with reference to FIG. 1 to FIG. 4. In particular, FIG. 3 is a flow chart describing an example of the movement error detecting method that is adapted to the movement error detecting apparatus of FIG. 2.


With reference to FIG. 2, when the controller 20 inputs movement commands ul and ur to the drive motor 18 (S61), the drive motor 18 rotates the left and right wheels 14 and 16 so that the mobile robot 100 is moved (S63).


The sensor part detects the actual movement of the wheels 14 and 16 and outputs the actual output value to the controller 20 (S65). That is, the left encoder 41 outputs the rotational velocity and linear velocity, in proportion to the rotational number of the left wheel 14, to the controller 20. Similarly, the right encoder 43 outputs the rotational velocity and linear velocity, in proportion to the rotation number of the right wheel 16, to the controller 20. The gyro sensor 45 detects the rotation of the mobile robot 100 and outputs the angular velocity to the controller 20. The controller 20 integrates the output values output from the sensor part and calculates the position and moving direction of the mobile robot 100.


After that, the ideal output calculating unit 21 calculates an ideal output value according to the movement commands ul and ur input to the drive motor 18 (S67). The ideal output value may be calculated through Equation 1. However, it should be understood that it is within the spirit and scope of the claimed invention that the ideal output value could be calculated prior to, simultaneously, or overlapping with the input of the movement commands to the drive motor.


The movement error detecting unit 23 determines whether the fault residual, a difference between the actual output value and the ideal output value, exceeds the limit (S69). The fault residual may be calculated by Equation 5.


When the fault residual exceeds the limit at S69, the movement error detecting unit 23 determines whether the error duration, during which the limit exceeds, exceeds a time limit (S71).


When the error duration exceeds a time limit at S71, the movement error detecting unit 23 determines that a movement error has occurred (S73). The controller 20 controls the movement of the mobile robot 100 according to the detected movement error (S75). For example, when detecting a movement error, the controller 20 may provide a warning by sounding an alarm, flashing a light, interrupting inputting the movement commands ul and ur to the drive motor 18 to temporarily suspend the movement of the mobile robot 100. It is also possible that the type or severity of the error could be ranked and relatively less serious one could be stored in the memory 30 for future retrieval. On the contrary, when the fault residual does not exceed the limit at S69 or when the error duration does not exceed a time limit at S71, the movement error detecting unit 23 concludes that the mobile robot 100 has moved normally (S77).


As described in the above examples, the method and apparatus according to the present invention may produce a mathematical model of the dynamic characteristics of a mobile robot and detect movement errors by comparing the actual output value with the ideal output value. The method and apparatus according to the present invention can detect movement errors through the software approach without the addition of hardware elements, overcoming costs associated with the addition of hardware, and preventing system complexity from being increased due to further changes in the hardware design, thereby enhancing the reliability of mobile robot.


Although exemplary embodiments of the present invention have been described in detail hereinabove, it should be understood that many variations and modifications of the basic inventive concept herein described, which may be apparent to those skilled in the art, will still fall within the spirit and scope of the exemplary embodiments of the present invention as defined in the appended claims. For example, a person of ordinary skill in the art should appreciate that only one of the wheels may be a drive wheel, or it is possible that each wheel is a drive wheel having has a separate drive motor. Also, it is within the spirit and scope of the claimed invention that the mobile robot may include tractor or tank treads in addition to or in lieu of wheels.

Claims
  • 1. A method, operable in a controller, for determining detecting a movement error in a mobile robot comprising a sensor part and at least one wheel, the method comprising: sensing a movement of the mobile robot according to a movement command, corresponding to a rotation number of the at least one wheel and a movement direction of the mobile robot;outputting an actual-movement value corresponding to the movement of the mobile robot from the sensor part;calculating an ideal movement value predicted as an ideal movement of the mobile robot according to the movement command;comparing the actual movement value with the ideal movement value; anddetecting the movement error as the compared result,wherein detecting the movement error comprises: determining that the movement error has occurred when the calculated difference exceeds a limit and when an error duration during which the limit exceeds, exceeds a time limit.
  • 2. The method of claim 1, wherein the sensor part comprises at least one of an encoder and a gyro sensor.
  • 3. The method of claim 1, wherein: sensing a movement of the mobile robot comprises: detecting movement of a left wheel and a right wheel, and wherein said left wheel and said right wheel are spaced apart from each other at a predetermined distance; andthe sensing a movement of the mobile robot by the sensor part comprises:detecting a rotation of the left wheel by a left encoder;detecting a rotation of the right wheel by a right encoder; anddetecting a rotation of the mobile robot by a gyro sensor.
  • 4. The method of claim 3, wherein the ideal movement value is calculated as:
  • 5. The method of claim 4, wherein the calculated actual movement value is calculated as:
  • 6. The method of claim 5, wherein determining the movement error is expressed as
  • 7. The method of claim 1, wherein: the limit is adjusted in proportion to a difference between the actual movement value and the calculated actual movement value.
  • 8. An apparatus for detecting a movement error in a mobile robot comprising a left wheel and a right wheel separated by a predetermined difference; the apparatus comprising: a sensor part for sensing a movement of the mobile robot according to a movement command, corresponding to a rotation number of at least one of the left wheel and the right wheel and a movement direction of the mobile robot, said sensor part outputting an actual movement value corresponding to the movement of the mobile robot;an ideal output calculating unit for calculating an ideal movement value predicted for the mobile robot according to the movement command; anda movement error detecting unit for:comparing the actual movement value with the ideal movement value; anddetecting the movement error as the compared result, wherein detecting the movement error comprises:determining that the movement error has occurred when the calculated difference exceeds a limit and when an error duration during which the limit exceeds, exceeds a time limit.
  • 9. The apparatus of claim 8, wherein the sensor part comprises at least one of an encoder and a gyro sensor.
  • 10. The apparatus of claim 8, wherein: the sensor part comprises:a left encoder for detecting a rotation of the left wheel;a right encoder for detecting a rotation of the right wheel; anda gyro sensor for detecting a rotation of the mobile robot.
  • 11. The apparatus of claim 10, wherein the ideal movement value is calculated as
  • 12. The apparatus of claim 11, wherein the calculated actual movement value is calculated as:
  • 13. The apparatus of claim 12, wherein the movement error detecting unit determines the movement error as:
  • 14. The apparatus of claim 8, wherein: the limit is adjusted in proportion to the difference between the actual movement value and the calculated actual movement value.
  • 15. The apparatus of claim 8, wherein the time limit is adjusted in proportion to an amount of noise generated in the sensor part.
  • 16. The method of claim 1, wherein the time limit is adjusted in proportion to an amount of noise generated in the sensor part.
Priority Claims (1)
Number Date Country Kind
2007-0137307 Dec 2007 KR national
US Referenced Citations (6)
Number Name Date Kind
5911767 Garibotto et al. Jun 1999 A
7133745 Wang Nov 2006 B2
20060238156 Kim Oct 2006 A1
20070290828 Choi et al. Dec 2007 A1
20080065267 Hong et al. Mar 2008 A1
20090171504 Hyung et al. Jul 2009 A1
Related Publications (1)
Number Date Country
20090171504 A1 Jul 2009 US