Gait Pattern Generating Device and Controller of Legged Mobile Robot

• US 20080208391A1
• Filed: 07/28/2005
• Published: 08/28/2008
• Est. Priority Date: 08/02/2004
• Status: Active Grant

• Current Assignee: Honda Motor Co., Ltd. (Honda Motor Company)
• Original Assignee: Honda Motor Co., Ltd. (Honda Motor Company)
• Inventors: Ogawa, Naohide, Hasegawa, Tadaaki
• Granted Patent: US 7,991,508 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 gait generating system of a legged mobile robot is provided with a device for determining a desired trajectory of an external force to be applied to a robot 1, a device for determining a parameter of a desired gait (current time gait) for a predetermined period on the basis of a desired trajectory of an external force or the like, a device for determining a parameter of a virtual cyclic gait that follows the current time gait on the basis of the desired trajectory of the external force or the like, a device for correcting the current time gait parameter such that a body motion trajectory of the robot 1 of the current time gait converges to a body motion trajectory of the cyclic gait, and a device for sequentially determining an instantaneous value of the current time gait on the basis of the corrected current time gait parameter. With this arrangement, in an environment wherein an external force acts on a robot as necessary, a desired gait that allows continual stability of the robot to be secured can be generated even if the external force suddenly changes.

Claims

1. A gait generating system of a legged mobile robot equipped with a plurality of legs extended from a body, the system comprising:

an external force trajectory provisionally determining means for provisionally determining a desired trajectory of an external force to be applied to the robot other than a floor reaction force;

a current time gait parameter provisionally determining means for provisionally determining a current time gait parameter that includes at least parameters that define a motion trajectory of a leg and trajectories of a floor reaction force and an external force to be applied to the robot in a current time gait, which is a desired gait of the robot for a predetermined period to be newly created, on the basis of at least a requirement related to a motion of the leg of the robot and the desired trajectory of the external force that has been provisionally determined;

a cyclic gait parameter determining means for determining a cyclic gait parameter that includes at least parameters that define a motion trajectory of a leg and trajectories of a floor reaction force and an external force to be applied to the robot in a virtual cyclic gait following the current time gait on the basis of at least the requirement and the desired trajectory of the external force that has been provisionally determined;

a parameter correcting means for determining a current time gait parameter by correcting at least one parameter of the provisionally determined current time gait parameter so as to satisfy a condition that a motion trajectory of the body of the robot determined on the basis of a robot dynamic model and the current time gait parameter converges to a motion trajectory of the body of the robot determined on the basis of the dynamic model and the cyclic gait parameter, wherein the robot dynamic model represents a relationship between a floor reaction force and an external force acting on the robot and a motion of the robot; and

a current time gait instantaneous value determining means for sequentially determining an instantaneous value of the current time gait on the basis of at least the corrected current time gait parameter.

3. The gait generating system of a legged mobile robot according to claim 1, wherein

parameters to be corrected by the parameter correcting means include at least a parameter that defines a trajectory of the floor reaction force of the current time gait parameter, and

the parameter correcting means comprises a means for correcting, in the case where a correction amount of a parameter defining the trajectory of the floor reaction force of the provisionally determined current time gait parameter exceeds a predetermined amount when the parameter is corrected to satisfy the condition, at least a parameter that defines a trajectory of the external force of the provisionally determined current time gait parameter so as to satisfy the condition while reducing the correction amount.

4. The gait generating system of a legged mobile robot according to claim 1, wherein

parameters to be corrected by the parameter correcting means include at least the parameter that defines a trajectory of the floor reaction force of the current time gait parameter, and

the parameter correcting means comprises a means for correcting, in the case where a correction amount of a parameter defining the trajectory of the floor reaction force of the provisionally determined current time gait parameter exceeds a predetermined amount when the parameter is corrected to satisfy the condition, at least a parameter that defines a motion trajectory of the leg of the provisionally determined current time gait parameter so as to satisfy the condition while reducing the correction amount.

5. The gait generating system of a legged mobile robot according to claim 3, wherein the parameter that defines the trajectory of the floor reaction force is a parameter that defines a trajectory of a desired ZMP of the robot.

6. The gait generating system of a legged mobile robot according to claim 4, wherein the parameter that defines the trajectory of the floor reaction force is a parameter that defines a trajectory of a desired ZMP of the robot.

10. A control system for controlling an operation of a robot on the basis of a current time gait instantaneous value generated by a gait generating system of a legged mobile robot according to claim 1, the control system comprising:

gait instantaneous value correcting means for correcting at least one of a desired motion of the robot and a desired floor reaction force among instantaneous values of a current time gait of the robot so as to bring a difference between an actual external force other than an actual floor reaction force acting on the robot and an instantaneous value of the external force of the current time gait instantaneous value close to zero on the basis of the difference; and

a controlling means for controlling an operation of the robot so as to follow the corrected instantaneous value of the current time gait.

2. A system for generating a gait for causing a legged mobile robot equipped with a plurality of legs extended from a body to perform an operation of moving an object, the system comprising:

an object trajectory provisionally determining means for provisionally determining a desired trajectory of an external force as a reaction force acting on the robot from the object and a desired motion trajectory of the object on the basis of at least a moving plan for the object;

a current time gait parameter provisionally determining means for provisionally determining a current time gait parameter that includes at least parameters that define a motion trajectory of a leg and trajectories of a floor reaction force and an external force to be applied to the robot in a current time gait, which is a desired gait of the robot for a predetermined period to be newly created, on the basis of at least the desired motion trajectory of the object and the desired trajectory of the external force that have been provisionally determined;

a cyclic gait parameter determining means for determining a cyclic gait parameter that includes at least parameters that define a motion trajectory of a leg and trajectories of a floor reaction force and an external force to be applied to the robot in a virtual cyclic gait following the current time gait on the basis of at least the desired motion trajectory of the object and the desired trajectory of the external force that have been provisionally determined;

a parameter correcting means for determining a current time gait parameter by correcting at least one parameter of the provisionally determined current time gait parameter so as to satisfy a condition that a motion trajectory of the body of the robot determined on the basis of a robot dynamic model and the current time gait parameter converges to a motion trajectory of the body of the robot determined on the basis of the robot dynamic model and the cyclic gait parameter, wherein the robot dynamic model represents a relationship between a floor reaction force and an external force acting on the robot and a motion of the robot; and

a current time gait instantaneous value determining means for sequentially determining an instantaneous value of the current time gait on the basis of at least the corrected current time gait parameter.

7. The gait generating system of a legged mobile robot according to claim 2, wherein

the object trajectory provisionally determining means is a means for provisionally determining a desired motion trajectory of the object and a desired trajectory of the external force on the basis of an object dynamic model showing a relationship between a motion of the object and a force acting on the object, and the moving plan;

and

the parameter correcting means comprises a robot future behavior predicting means for predicting a future motion of the robot on the basis of at least a current time gait parameter that has been corrected by the parameter correcting means, the cyclic gait parameter, and the robot dynamic model; and

a means for determining whether the robot and the object satisfy a predetermined geometric restraining condition on the basis of the predicted future motion of the robot and the desired motion trajectory of the object that has been provisionally determined, and for determining a current time parameter by correcting at least one of the desired motion trajectory of the object and a parameter that defines the motion trajectory of a leg of the corrected current time gait parameter in the case where the robot and the object do not satisfy the predetermined geometric restraining condition.

8. The gait generating system of a legged mobile robot according to claim 2, comprising an object disturbance force estimating means for estimating a disturbance force other than a force acting on the object from the robot that is operating on the basis of an instantaneous value of the current time gait of a force acting on the object,

wherein the object trajectory provisionally determining means is a means for provisionally determining a desired motion trajectory of the object and a desired trajectory of the external force on the basis of an object dynamic model showing a relationship between a motion of the object and a force acting on the object, the moving plan, and the estimated disturbance force.

9. The gait generating system of a legged mobile robot according to claim 8, wherein the object trajectory provisionally determining means comprises a means for correcting the moving plan on the basis of at least one of a difference between a motion trajectory of an object associated with the moving plan and the desired motion trajectory of the object that has been provisionally determined, and the estimated disturbance force.

11. The gait generating system of a legged mobile robot according to claim 2, wherein

parameters to be corrected by the parameter correcting means include at least a parameter that defines a trajectory of the floor reaction force of the current time gait parameter, and

the parameter correcting means comprises a means for correcting, in the case where a correction amount of a parameter defining the trajectory of the floor reaction force of the provisionally determined current time gait parameter exceeds a predetermined amount when the parameter is corrected to satisfy the condition, at least a parameter that defines a trajectory of the external force of the provisionally determined current time gait parameter so as to satisfy the condition while reducing the correction amount.

12. The gait generating system of a legged mobile robot according to claim 2, wherein

parameters to be corrected by the parameter correcting means include at least the parameter that defines a trajectory of the floor reaction force of the current time gait parameter, and

the parameter correcting means comprises a means for correcting, in the case where a correction amount of a parameter defining the trajectory of the floor reaction force of the provisionally determined current time gait parameter exceeds a predetermined amount when the parameter is corrected to satisfy the condition, at least a parameter that defines a motion trajectory of the leg of the provisionally determined current time gait parameter so as to satisfy the condition while reducing the correction amount.

13. The gait generating system of a legged mobile robot according to claim 11, wherein the parameter that defines the trajectory of the floor reaction force is a parameter that defines a trajectory of a desired ZMP of the robot.

14. The gait generating system of a legged mobile robot according to claim 12, wherein the parameter that defines the trajectory of the floor reaction force is a parameter that defines a trajectory of a desired ZMP of the robot.

15. A control system for controlling an operation of a robot on the basis of a current time gait instantaneous value generated by a gait generating system of a legged mobile robot according to claim 2, the control system comprising:

gait instantaneous value correcting means for correcting at least one of a desired motion of the robot and a desired floor reaction force among instantaneous values of a current time gait of the robot so as to bring a difference between an actual external force other than an actual floor reaction force acting on the robot and an instantaneous value of the external force of the current time gait instantaneous value close to zero on the basis of the difference; and

a controlling means for controlling an operation of the robot so as to follow the corrected instantaneous value of the current time gait.