Robot and method of controlling the same

This application claims the benefit of Korean Patent Application No. 2008-0131033, filed Dec. 22, 2008, in the Korean Intellectual Property Office, the disclosure of which is incorporated herein by reference.

1. Field

The present invention relates to a robot and a method of controlling the same, and more particularly, to a method of defining control angles to use a limit cycle in order to balance a biped walking robot on a three-dimensional space.

2. Description of the Related Art

In general, machines, which conduct motions similar to those of a human being using an electrical or magnetic action, are known as robots. Early robots were industrial robots, such as manipulators or transfer robots, for work automation and unmanned operation in a production field. These robots performed dangerous work, simple repetitive work, or work requiring large forces, in place of a human being. Recently, biped walking robots, which have a joint system similar to that of a human being, live together with the human being in human working and living spaces, and walk with two feet, have been vigorously researched and developed.

Methods of controlling the walking of a biped robot include a position-based zero moment point (ZMP) control method, and a torque-based finite state machine (FSM) control method. The FSM control method refers to all methods which use a torque control but do not use a ZMP control. In the FSM control method, finite states of the biped robot are defined in advance, and then the finite states of the biped robot are sequentially changed while walking, thus allowing the biped robot to properly walk.

The above FSM-based biped robot uses a limit cycle in order to balance itself on a two-dimensional space. The limit cycle refers to a trajectory movement, which forms a closed loop according to time on the two-dimensional space. When values of a function according to time form a random route in the closed loop as time passes by, the closed loop is referred to as the limit cycle (with reference to FIG. 1 ).

The limit cycle is divided into stable regions and unstable regions, and performs a nonlinear control. A region of the limit cycle, which is in a regular closed loop range, is referred to as a stable region, and a region of the limit cycle, which is not in the regular closed loop range but diverges radially or converges into one point, is referred to as an unstable region. On the assumption that a biped robot is on a two-dimensional space, control angles are defined by the center of gravity of the biped robot and the foot of the robot contacting the ground and the relationships between the control angles and their differential components, i.e., control angular velocities, are expressed on the two-dimensional space, thus obtaining the limit cycle of FIG. 1 . Since the vector of the foot of a biped robot on the two-dimensional space is perpendicular to the ground and the center of the gravity of the biped robot is defined on the two-dimensional space, it is easy to define limit cycle control angles on the two-dimensional space. However, since a biped robot on a three-dimensional space has joints with different positions and directions, it is not easy to define limit cycle control angles of the biped robot on the three-dimensional space. Further, although results of a two-dimensional simulation are combined on a three-dimensional simulation, all data cannot be expressed, and thus in order to balance the biped robot on the three-dimensional space, where the biped robot actually walks, control angles to use the limit cycle should be defined.

Therefore, one aspect of the invention is to provide a method of defining control angles to use a limit cycle in order to balance a FSM-based biped robot on a three-dimensional space.

Additional aspects and/or advantages will be set forth in part in the description which follows and, in part, will be apparent from the description, or may be learned by practice of the invention.

The foregoing and/or other aspects of the present invention are achieved by providing a method of controlling a robot including setting limit cycle control angles to balance the robot on a three-dimensional space; and controlling the set limit cycle control angles on the three-dimensional space using a sinusoidal function to balance the robot within a limit cycle.

The robot may be a finite state machine (FSM)-based biped walking robot.

The limit cycle control angles may be set in consideration of position, direction, tilt data of the robot according to states of the FSM.

The states of the FSM may include a double support (DS) state, in which the robot is supported with both feet thereof, a single support right (SS(R)) state, in which the robot is supported only with its right foot, and a single support left (SS(L)) state, in which the robot is supported only with its left foot.

The setting of the limit cycle control angles may include defining a virtual plane on the basis of a torso of the robot, and generating a contact point on the virtual plane by projecting a contact point of the robot with the ground onto the virtual plane; generating a contact point on the space using positions of the contact point on the plane and the center of gravity of the robot; generating vectors on the space using positions of the contact point on the space, the contact point on the plane, and the center of gravity; and obtaining the limit cycle control angles using the vectors on the space.

The contact point on the plane and the contact point on the space may correspond to the contact point of the robot with the ground. The limit cycle control angles may arise from the contact point of the robot with the ground, and control ankles of the robot. The limit cycle control angles may control the angles of the ankles to allow the limit cycle to form a stable closed loop. The controlling of the limit cycle control angles using the sinusoidal function may be achieved such that the limit cycle forms a stable closed loop according to the states of the FSM.

The control of the limit cycle control angles using the sinusoidal function may be achieved such that relations of the limit cycle control angles and control angular velocities, which are differential components of the limit cycle control angles, form the limit cycle in the stable closed loop on the space.

The angles of the ankles of the robot may be controlled within the limit cycle by controlling the limit cycle control angles using the sinusoidal function.

The foregoing and/or other aspects of the present invention are achieved by providing a robot including ankles; a set unit to set limit cycle control angles of the ankles on a three-dimensional space; and a control unit to control the set limit cycle control angles on the three-dimensional space using a sinusoidal function and thus control the angles of the ankles within a limit cycle using the sinusoidal function.

The set unit may set the limit cycle control angles in consideration of position, direction, tilt data of the robot on the three-dimensional space to balance the robot.

The control unit may control the limit cycle control angles using the sinusoidal function such that the limit cycle forms a stable closed loop on the three-dimensional space.

The control unit may control the angles of the ankles within the limit cycle by controlling the limit cycle control angles using the sinusoidal function.

These and/or other aspects and advantages of the invention will become apparent and more readily appreciated from the following description of the embodiments, taken in conjunction with the accompanying drawings in which:

FIG. 1 is a view illustrating the concept of a limit cycle applied to the present invention;

FIG. 2 is a schematic view illustrating the external appearance of a robot in accordance with an embodiment of the present invention;

FIG. 3 is a view illustrating structures of main joints of the robot of FIG. 2 ;

FIG. 4 is a view illustrating limit cycle control angles of an FSM-based robot in accordance with the embodiment of the present invention, defined on a two-dimensional space;

FIG. 5A is a view illustrating the FSM-based robot in accordance with the embodiment of the present invention on a three-dimensional space;

FIG. 5B is a view illustrating the FSM-based robot of FIG. 5A , viewed in the direction {circle around (s)};

FIG. 6A is a view illustrating the FSM-based robot of FIG. 5A on a virtual plane on the basis of the torso of the robot;

FIG. 6B is a view illustrating the FSM-based robot of FIG. 5B on the virtual plane on the basis of the torso of the robot;

FIG. 7 is a view illustrating a limit cycle control angle of the FSM-based robot in accordance with the embodiment of the present invention, defined on a three-dimensional space; and

FIG. 8 is a control block diagram to balance the FSM-based robot in accordance with the embodiment of the present invention.

Reference will now be made in detail to the embodiment of the present invention, an example of which is illustrated in the accompanying drawings, wherein like reference numerals refer to like elements throughout. The embodiment is described below to explain the present invention by referring to the annexed drawings.

FIG. 1 is a view illustrating the concept of a limit cycle applied to the present invention and FIG. 2 is a schematic view illustrating the external appearance of a robot in accordance with an embodiment of the present invention.

In FIG. 2 , a robot 10 in accordance with this embodiment is a biped walking robot, which walks upright with two legs 11 R and 11 L in the same way as a human being, and includes a torso 12 , two arms 13 R and 13 L and a head 14 provided at the upper portion of the torso 12 , and feet 15 R and 15 L and hands 16 R and 16 L respectively provided at tips of the two legs 11 R and 11 L and the two arms 13 R and 13 L.

Here, R represents the right side of the robot 10 , L represents the left side of the robot 10 , and COG represents the center of gravity of the robot 10 .

FIG. 3 is a view illustrating structures of main joints of the robot of FIG. 2 .

In FIG. 3 , the two legs 11 R and 11 L respectively include ankle joints 17 R and 17 L, knee joints 18 R and 18 L, and hip joints 19 R and 19 L, such that parts of the robot 10 corresponding to ankles, knees, and hips are rotatable, and the hip joints 19 R and 19 L are located at both sides of the lower portion of the torso 12 connected with the two legs 11 R and 11 L.

The ankle joints 17 R and 17 L of the respective legs 11 R and 11 L are movable in the directions of the X-axis (roll axis) and the Y-axis (pitch axis), the knee joints 18 R and 18 L of the respective legs 11 R and 11 L are movable in the direction of the Y-axis (pitch axis), and the hip joints 19 R and 19 L of the respective legs 11 R and 11 L are movable in the directions of the X-axis (roll axis), the Y-axis (pitch axis), and the Z-axis (yaw axis).

Further, the two legs 11 R and 11 L respectively include thigh links 20 R and 20 L connecting the hip joints 19 R and 19 L and the knee joints 18 R and 18 L, and calf links 21 R and 21 L connecting the knee joints 18 R and 18 L and the ankle joints 17 R and 17 L, and thus have a designated degree of freedom according to the movements of the respective joints 17 R, 17 L, 18 R, 18 L, 19 R, and 19 L.

The torso 12 connected with the two legs 11 R and 11 L includes a waist joint 23 such that a part of the robot 10 corresponding to a waist is rotatable, and the waist joint 23 is located coaxially with the center 22 G of a hip link 22 connecting the hip joints 19 R and 19 L located at both sides of the lower portion of the torso 12 , i.e., the center of gravity COG of the robot 10 , and thus is movable in the directions of the X-axis (roll axis), the Y-axis (pitch axis), and the Z-axis (yaw axis).

Each of the joints 17 R, 17 L, 18 R, 18 L, 19 R, 19 L, and 23 of the robot 10 includes an actuator (not shown, for example, a driving device, such as a motor) to drive the corresponding joint.

FIG. 4 is a view illustrating limit cycle control angles of an FSM-based robot in accordance with the embodiment of the present invention, defined on a two-dimensional space, i.e., respectively illustrating the torso 12 and the right and left legs 11 R and 11 L of the robot 10 on a Y-Z plane (two-dimensional space) formed by the Y-axis (pitch axis) and the Z-axis (yaw axis), modeled on the figure of a human, in which both feet alternately swing, when the human walks forward.

In FIG. 4 , there are three states of the FSM-based robot 10 , i.e., a double support (hereinafter, is referred to as ‘DS’) state, in which the robot 10 is supported with both feet thereof, a single support right (hereinafter, is referred to as ‘SS(R)’) state, in which the robot 10 is supported only with its right foot, and a single support left (hereinafter, is referred to as ‘SS(L)’) state, in which the robot 10 is supported only with its left foot, and a finite state machine (FSM) is characterized in that these states are regularly repeated.

When the FSM-based robot 10 balances itself, the curve of the limit cycle should be located in a stable region at any time. The robot 10 can stably balance itself right and left when the curve of the limit cycle forms the closed loop at any time without converging into one point or diverging. Therefore, when the robot 10 repeats the swing of one foot 15 R or 15 L and the swing of the other foot 15 L or 15 R, the limit cycle should form the closed loop at any time in order to form the stable region.

When the limit cycle is applied to the FSM-based robot 10 to balance the FSM-based robot 10 right and left on a two-dimensional space, the FSM-based robot 10 is balanced not by making contact of two feet 15 R and 15 L with the ground, but by alternately swinging both feet 15 R and 15 L.

A represents a control angle, at which the robot 10 can balance itself on a two-dimensional space using the limit cycle, and is defined as an angle between a vector, which is perpendicular to the ground, and a vector, which comes up to the center of gravity of the robot 10 , from a contact point of the robot 10 with the ground (i.e., the sole of the foot of the supporting leg). The control angle A arises from the contact point of the robot 10 with the ground, and thus controls the ankle joints 17 R and 17 L of the robot 10 . Further, A′ represents a control angular velocity, which is a differential component of the control angle A.

As shown in FIG. 4 , the control angle A and the control angular velocity A′ in the DS state are maximum, and the control angle A and the control angular velocity A′ in the SS(R) or SS(L) state are minimum. Therefore, when the relationships between the control angles A and the control angular velocities A′ in the DS state and the SS(R) or SS(L) state are applied to the limit cycle, the robot 10 can balance itself by alternately swinging its legs 15 R and 15 L.

FIG. 4 shows control angles A, at which the robot 10 can balance itself using the limit cycle on a two-dimensional space. The control angles A of the robot 10 on the two-dimensional space cannot be used on a three-dimensional space, where the robot 10 actually walks. The reason is that there is no data regarding position (in the direction of the X-axis), direction (in the direction of the Z-axis), and tilt (in the direction of the Y-axis) of the robot 10 on the two-dimensional space and the control angles A on the two-dimensional space are defined on the assumption that the respective joints 17 R, 17 L, 18 R, 18 L, 19 R, and 19 L are located on one plane. Therefore, it is necessary to define limit cycle control angles B 2 on the three-dimensional space, in consideration of data regarding position (in the direction of the X-axis), direction (in the direction of the Z-axis), and tilt (in the direction of the Y-axis) of the robot 10 on the three-dimensional space and the fact that the respective joints 17 R, 17 L, 18 R, 18 L, 19 R, and 19 L are not located on one plane.

FIG. 5A is a view illustrating the FSM-based robot 10 in accordance with the embodiment of the present invention on a three-dimensional space, and more particularly, illustrating the torso 12 and the right and left legs 11 R and 11 L of the robot 10 on an X-Y-Z plane representing position (in the direction of the X-axis), direction (in the direction of the Z-axis), and tilt (in the direction of the Y-axis) of the robot 10 .

FIG. 5B is a view illustrating the FSM-based robot 10 of FIG. 5A , viewed in the direction ‘S’, and more particularly illustrating a contact point C 1 of the robot 10 with the ground G (hereinafter, referred to as a contact point with the ground G) when the left leg 11 L is a supporting leg and the right leg 11 R is a swing leg.

Hereinafter, a process of defining a limit cycle control angle B 2 of the robot 10 in accordance with the embodiment of the present invention on a three-dimensional space will be described.

In order to describe this embodiment, it is assumed that position data regarding a random point of the robot 10 (for example, an edge point of the torso or the hip link) on a three-dimensional space and position data regarding the center of gravity COG of the robot 10 are known. The position data regarding the random point of the robot 10 (for example, the edge point of the torso or a hip link) are obtained using kinematics characteristics of the robot 10 and various sensor data, and the position data regarding the center of gravity COG of the robot 10 are obtained using weight data of the respective links 20 R, 20 L, 21 R, and 21 L and position data of the respective joints 17 R, 17 L, 18 R, 18 L, 19 R, and 19 L.

FIG. 6A is a view illustrating the FSM-based robot of FIG. 5A on a virtual plane on the basis of the torso of the robot, and FIG. 6B is a view illustrating the FSM-based robot of FIG. 5B on the virtual plane on the basis of the torso of the robot. This virtual plane is a robot plane P, which can express both position and direction data of the robot 10 .

In FIGS. 6A and 6B , when the contact point C 1 with the ground is deviated from the robot plane P due to the left leg 11 L (the link) being deviated from the robot plane P, the contact point C 1 with the ground is projected on the robot plane P and thus is used as data on the robot plane P. When a spatial first vector V 1 is generated using the position of an edge point ‘ 1 ’ of the torso 12 and the position of an edge point ‘ 2 ’ of the hip link 22 , and then the spatial first vector V 1 is extended, the position of a point C 2 contacting the ground G is obtained. This point (hereinafter, is referred to the contact point on the robot plane P) C 2 is a point obtained by projecting the contact point C 1 with the ground G, which is located outside the robot plane P, onto the robot plane P.

FIG. 7 is a view illustrating a limit cycle control angle of the FSM-based robot in accordance with the embodiment of the present invention, defined on a three-dimensional space.

In FIG. 7 , when the hip point ‘ 2 ’ ( FIG. 6A ) at the leg 11 L contacting the robot plane P and the center of gravity COG are extended using positions of the two points, the position of a point C 3 meeting the ground is obtained. This point (hereinafter, is referred to the contact point on a space) C 3 is a point obtained by projecting the contact point C 1 with the ground G, which is located outside the robot plane P, onto the three-dimensional space.

When a spatial second vector V 2 (z=0) is generated using the position data of the contact point C 3 on the space and the contact point C 2 on the robot plane P and the contact point C 2 on the robot plane and the center of gravity COG are extended using positions of the two points, a spatial third vector V 3 is generated.

When the dot product of the spatial second vector V 2 and the spatial third vector V 3 is calculated, an angle B 1 between the spatial second vector V 2 and the spatial third vector V 3 is obtained. Then, when this angle B 1 is subtracted from an angle of 90 degrees, an angle B 2 ( 90 -B 1 ) between the spatial first vector V 1 and the spatial third vector V 3 is obtained. The obtained angle B 2 is defined as a limit cycle control angle on the three-dimensional space.

The defined limit cycle control angle B 2 expresses only a right and left tilt angle of the robot 10 on the robot plane P regardless of a forward tilt angle of the robot 10 , and thus can be used to balance the robot 10 right and left.

FIG. 8 is a control block diagram to balance the FSM-based robot in accordance with the embodiment of the present invention. The FSM-based robot includes a set unit 50 , a control unit 52 , actuators 54 , a joint angle measuring unit 56 , and a center measuring unit 58 .

The set unit 50 sets the control angle B 2 to use the limit cycle to balance the FSM-based robot 10 on the three-dimensional space. The set unit 50 sets the control angle B 2 , which corresponds to the state of the robot 10 to balance the robot 10 on the three-dimensional space (with reference to FIGS. 5A to 7 ).

The control unit 52 controls the limit cycle control angle B 2 , set on the three-dimensional space corresponding to the state of the robot 10 , using a sinusoidal function, such that the relation between the limit cycle control angle B 2 and a limit cycle control angular velocity B 2 ′ forms a circular/elliptical limit cycle, which is stable on a three-dimensional space, and thus the FSM-based robot 10 can balance itself right and left. As one method of various methods of forming the limit cycle in a closed loop, the relation between the limit cycle control angle B 2 and its differential component, i.e., the control angular velocity B 2 ′, forms a stable circular/elliptical limit cycle using the sinusoidal function. When this limit cycle is used as an algorithm to balance the robot 10 right and left, the robot 10 can balance itself stably.

The method of controlling the limit cycle control angle B 2 using the sinusoidal function is represented by the below expressions 1 and 2.

Limit cycle control angle B 2 =B 2max×sin( ω×t )  (Expression 1)

Limit cycle control angular velocity B 2 ′=B 2max×ω×cos( ω×t )  (Expression 2)

Here, B2max is a designated value, ω is a conversion cycle (control cycle) of the limit cycle control angle B 2 , and t is time.

Each of the actuators 54 drives the ankle joint 17 R or 17 L, a target angle of which forms the limit cycle, when the control unit 52 controls the limit cycle control angle B 2 set on the three-dimensional space corresponding to the state of the robot 10 using the sinusoidal function, according to a torque control signal of the control unit 52 such that the angle of the ankle joint 17 R or 17 L does not deviate from the limit cycle.

The joint angle measuring unit 56 measures the angle of the ankle joint 17 R or 17 L moving according to the driving of the actuator 54 , and transmits the measured angle to the control unit 52 . The joint angle measuring unit 56 is a control factor, which feeds the angle of the ankle joint 17 R or 17 L back to the control unit 52 to follow the limit cycle control angle B 2 set by the set unit 50 .

The center measuring unit 58 measures the position of the center of gravity COG of the robot 10 , which is varied according to the states of the robot 10 , and transmits the measured position of the center of gravity COG of the robot 10 to the control unit 52 . The center measuring unit 58 is a control factor, which feeds the position of the center of gravity COG of the robot 10 back to the control unit 52 to follow the limit cycle control angle B 2 set by the set unit 50 .

As is apparent from the above description, in the embodiment of the present invention, when the limit cycle control angle B 2 of the robot 10 are defined such that angles of the ankle joints 17 R and 17 L to be controlled to balance the FSM-based robot 10 right and left during walking form a closed loop, angles defined on a two-dimensional simulation cannot be used on a three-dimensional simulation. Therefore, when the control angles B 2 required to balance the robot 10 right and left regardless of position and tilt of the robot 10 on the three-dimensional simulation are defined and controlled using the sinusoidal function, the limit cycle balance algorithm can be used even on the three-dimensional simulation.

In accordance with one embodiment of the present invention, in order to balance an FSM-based biped robot on a three-dimensional space, limit cycle control angles to balance the robot according to states of the FSM-based biped robot are set on the three-dimensional space, and the limit cycle control angles on the three-dimensional space are controlled using a sinusoidal function to allow the relationship between the control angles and control angular velocities to form a stable closed loop within a limit cycle, thereby allowing the biped robot to balance itself while changing its supporting foot and thus safely walk without falling down.

Although an embodiment of the invention has been shown and described, it would be appreciated by those skilled in the art that changes may be made in this embodiment without departing from the principles and spirit of the invention, the scope of which is defined in the claims and their equivalents.