Legged mobile robot and method and apparatus for controlling the operation thereof

• US 20030229419A1
• Filed: 12/20/2002
• Published: 12/11/2003
• Est. Priority Date: 11/25/1999
• Status: Active Grant

• Current Assignee: Jinichi Yamaguchi, Sony Corporation (Sony Group Corp.)
• Original Assignee: Jinichi Yamaguchi, Sony Corporation (Sony Group Corp.)
• Inventors: Kuroki, Yoshihiro, Yamaguchi, Jinichi, Ishida, Tatsuzo
• Granted Patent: US 6,832,132 B2
• Time in Patent Office: Days
• US Class Current: 700/245
• CPC Class Codes: B62D 57/032 with alternately or sequentially lifted supporting base and legs; with alternately or sequentially lifted feet or skid B62D57/024 takes precedence

Abstract

A legged mobile robot is adaptively controlled in its attitude against variable external forces to continue the operation without inversion. When the legged mobile robot kicks an object having a certain mass, such as a ball, the robot is to be prevented from being fallen down by the reactive force from the object. Even if the mass or the repulsion coefficient of the object kicked is unknown, the operation of kicking the object at a sufficiently low speed is carried out at the outset to predict the reactive force produced on actual kicking in order to predict the reactive force produced on actual kicking. The result is that the stability in attitude can be maintained on kicking at an arbitrary speed. The legged mobile robot is able to take part as one of the players in athletic games, such as soccer games, in which each player performs his or her role as the or she is subjected to an external force.

Claims

1. An apparatus for adaptively controlling motions of a legged mobile robot, made up at least of lower limbs, a body trunk and a waist part, against an external force, said apparatus comprising:

first setting means for setting leg motion, body trunk motion and upper limb motion, and the attitude and height of the waist part, for realizing the required motion;

second setting means for setting a ZMP trajectory based on the leg motion as set by said first setting means;

third setting means for setting an external force pattern applied to the legged mobile robot;

calculating means for calculating the moment generated on a ZMP as set by said second setting means based on the leg motion, body trunk motion, upper limb motion and the attitude and height of the waist part as set;

means for finding a solution of the waist motion for which the moments as calculated by said calculating means are in equilibrium; and

means for executing the full body exercise motion based on said solution of the waist motion.

2. An apparatus for adaptively controlling motions of a legged mobile robot, made up at least of lower limbs, a body trunk and a waist part, against an external force, said apparatus comprising:

first setting means for setting leg motion, body trunk motion and upper limb motion, and the attitude and height of the waist part, for realizing the required motion;

second setting means for setting a ZMP trajectory based on the leg motion as set by said first setting means;

third setting means for setting an external force pattern applied to the legged mobile robot;

calculating means for calculating the moment generated on a ZMP as set by said second setting means by the leg motion, body trunk motion, upper limb motion and the attitude and height of the waist part as set;

first finding means for finding an approximate solution of the waist motion, for which the moments as found by said calculating means are in equilibrium, using a non-precise model of said robot;

second finding means for finding an approximate solution of the waist motion, for which the moments as found by said calculating means are in equilibrium, using a precise model of said robot;

means for assuming a solution of the waist motion if a difference between said approximate solutions by said first and second finding means is less than a pre-set allowed value;

means for correcting the moments of said non-precise model on the pre-set ZMP if the difference between said approximate solutions by said first and second finding means exceeds said pre-set allowed value and for re-throwing the corrected moments to said first finding means; and

means for executing the full body exercise motion of said legged mobile robot based on the solution of said waist motion.

3. The operation control apparatus for the robot according to claim 2 wherein said non-precise model is a linear and/or non-interference multiple mass point approximating model for said robot;

and

said precise model is a rigid body model or a non-linear and/or interference multiple mass point approximating model for said robot.

4. The operation control apparatus for the robot according to claim 2 further comprising:

means for re-setting or correcting the pattern of said body trunk motion and upper limb motion, if the pre-set body trunk motion and upper limb motion cannot be realized with the approximate solution as found by said first finding means for finding the approximate solution of the waist motion by said non-precise model.

5. The operation control apparatus for the robot according to claim 2 wherein said first finding means for finding the approximate solution of the waist motion by said non-precise model finds the approximate solution of the waist motion by solving an equation of equilibrium between the leg motion, body trunk motion, upper limb motion and the moment on the pre-set ZMP produced by the external force pattern on one hand and the moment on the pre-set ZMP generated by motion within the horizontal plane of the waist part on the other hand.

6. The operation control apparatus for the robot according to claim 2 wherein said first finding means for finding the approximate solution of the waist motion by said non-precise model performs calculations on substituting a frequency-domain function for a time-domain function.

7. The operation control apparatus for the robot according to claim 2 wherein said first finding means for finding the approximate solution of the waist motion by said non-precise model finds the approximate solution of the waist motion by applying Fourier expansion to moments on the pre-set ZMP generated by the leg motion, body trunk motion and the upper limb motion, by applying Fourier expansion to the moment on the pre-set ZMP produced by the external force pattern and to the motion in the horizontal plane of the waist part, by calculating Fourier coefficients of the trajectory of the horizontal plane of the waist part and by applying the inverse Fourier expansion.

8. The operation control apparatus for the robot according to claim 2 wherein said third setting means for setting the external force pattern predicts an external force pattern produced on applying an impact on an object at a pre-set speed based on the chronological external force process and a force application point when the external force pattern is applied to the object at a speed lower than the pre-set speed.

9. A legged mobile robot comprising:

two or more movable legs;

an upper body portion connected to said movable legs;

means for detecting an external force applied from an external object to said movable leg; and

control means for adaptively controlling the motion of said movable leg and/or the upper body portion in accordance with detected results by said external force detecting means.

10. The legged mobile robot according to claim 9 wherein said external force detecting means detects the reactive force produced when one of the movable legs kicking an external object;

and

said control means adaptively controlling the motion of said movable legs and/or said upper body portion in accordance with the detected reactive force.

11. The legged mobile robot according to claim 9 wherein if an external object, the mass and/or the repulsion coefficient of which is unknown, is to be kicked using one of the movable legs, said movable leg kicks the external object at a speed lower than said pre-set speed;

and

said control means predicts the mass and/or the repulsion coefficient when said external object is kicked at said pre-set speed, said control means adaptively controlling the operation of the movable leg and/or the upper body portion in accordance with the predicted result when the robot actually kicks the external object.

12. A method for adaptively controlling motions of a legged mobile robot, made up at least of lower limbs, a body trunk and a waist part, against an external force, said method comprising:

a first setting step for setting leg motion, body trunk motion and upper limb motion, and the attitude and height of the waist part, for realizing the required motion;

a second setting step for setting a ZMP trajectory based on the leg motion as set by said first setting step;

a third setting step for setting an external force pattern applied to the legged mobile robot;

a calculating step for calculating the moments generated on a ZMP as set by said second setting step based on the leg motion, body trunk motion, upper limb motion and the attitude and height of the waist part as set;

a step for finding a solution of the waist motion for which the moments as calculated by said calculating step are in equilibrium; and

a step for executing the full body exercise motion based on said solution of the waist motion.

13. A method for adaptively controlling motions of a legged mobile robot, made up at least of lower limbs, a body trunk and a waist part, against an external force, said method comprising:

a first setting step for setting leg motion, body trunk motion and upper limb motion, and the attitude and height of the waist part, for realizing the required motion;

a second setting step for setting a ZMP trajectory based on the leg motion as set by said first setting step;

a third setting step for setting an external force pattern applied to the legged mobile robot;

a calculating step for calculating the moment generated on a ZMP as set by said second setting step by the leg motion, body trunk motion, upper limb motion and the attitude and height of the waist part as set;

a first finding step for finding an approximate solution of the waist motion, for which the moments as found by said calculating step are in equilibrium, using a non-precise model of said robot;

a second finding step for finding an approximate solution of the waist motion, for which the moments as found by said calculating step are in equilibrium, using a precise model of said robot;

a step for assuming a solution of the waist motion if a difference between said approximate solutions by said first and second finding step is less than a pre-set allowed value;

a step for correcting the moments of said non-precise model on the pre-set ZMP if the difference between said approximate solutions by said first and second finding step exceeds said pre-set allowed value and for re-throwing the corrected moments to said first finding step; and

a step for executing the full body exercise motion of said legged mobile robot based on the solution of said waist motion.

14. The operation control method for the robot according to claim 13 wherein said non-precise model is a linear and/or non-interference multiple mass point approximating model for said robot;

and

said precise model is a rigid body model or a non-linear and/or interference multiple mass point approximating model for said robot.

15. The operation control method for the robot according to claim 13 further comprising:

a step for re-setting or correcting the pattern of said body trunk motion and upper limb motion, if the pre-set body trunk motion and upper limb motion cannot be realized with the approximate solution as found by said first finding step for finding the approximate solution of the waist motion by said non-precise model.

16. The operation control method for the robot according to claim 13 wherein said first finding step for finding the approximate solution of the waist motion by said non-precise model finds the approximate solution of the waist motion by solving an equation of equilibrium between the leg motion, body trunk motion, upper limb motion and the moment on the pre-set ZMP produced by the external force pattern on one hand and the moments on the pre-set ZMP generated by motion within the horizontal plane of the waist part on the other hand.

17. The operation control method for the robot according to claim 13 wherein said first finding step for finding the approximate solution of the waist motion by said non-precise model performs calculations on substituting a frequency-domain function for a time-domain function.

18. The operation control method for the robot according to claim 13 wherein said first finding step for finding the approximate solution of the waist motion by said non-precise model finds the approximate solution of the waist motion by applying Fourier expansion to moments on the pre-set ZMP generated by the leg motion, body trunk motion and the upper limb motion, by applying Fourier expansion to the moment on the pre-set ZMP produced by the external force pattern and to the motion in the horizontal plane of the waist part, by calculating Fourier coefficients of the trajectory of the horizontal plane of the waist part and by applying the inverse Fourier expansion.

19. The operation control method for the robot according to claim 13 wherein said third setting step for setting the external force pattern predicts an external force pattern produced on applying an impact on an object at a pre-set speed based on the chronological external force process and a force application point when the external force pattern is applied to the object at a speed lower than the pre-set speed.

20. A method for controlling the operation of a legged mobile robot made up of two or more movable legs, an upper body portion connected to said movable legs and means for detecting an external force applied from an external object to said movable leg, said method comprising:

a step of detecting the reactive force applied when one of said movable legs has kicked an external object; and

a step of adaptively controlling the motion of said movable leg and/or the upper body portion in accordance with detected results.

21. The operation controlling method according to claim 20 wherein, in case an external object the mass and/or a repulsion coefficient of which is unknown is kicked at a pre-set speed using one of said movable legs, said adaptive controlling step comprises

a sub-step of trial kicking said external object at a speed lower than said pre-set speed;

a sub-step of predicting the mass and/or the repulsion coefficient on kicking the external object at said pre-set speed based on an output of said external force detection means on trial kicking; and

a sub-step of adaptively controlling the motion of said movable legs and/or the upper body part in accordance with predicted results when the robot actually kicks the object.