Locomotion control system for legged mobile robot
First Claim
1. A system for controlling locomotion of a legged mobile robot having a body and a plurality of articulated legs each connected to the body through a first joint and each having at least a second joint, comprising:
- motor means provided at the individual joints;
first means for determining control values of the motor means in accordance with a walking data preestablished at least on a trajectory of ZMP (Zero Moment Point) at which horizontal moment acting on the robot generated by ground reaction force is zero;
second means for detecting ground reaction force actually acting on the robot to determine an actual position of the ZMP;
third means for comparing the actual position of the ZMP with a target position of the ZMP obtained from the trajectory of the ZMP to determine an error therebetween;
andcontrol means for providing the determined control value to said motor means to drive the individual joints and when the error is determined, correcting at least one of the control values in such a manner that the error decreases.
1 Assignment
0 Petitions
Accused Products
Abstract
A locomotion control system for a biped walking robot having a body and two legs each connected to the body through a hip joint and each having ankle joint adjacent to its foot portion. A walking patter is preestablished in advance in terms of a trajectory of IMP (Zero Moment Point) at which horizontal moment acting on the robot generated by the ground reaction force is zero, a trajectory of the body'"'"'s attitude or the like. During walking, actual ground reaction force is detected to determine an actual ZMP position and detected position is compared with a target IMP position obtained from the IMP trajectory. When there is an error between the positions, the robot legs are driven in such a manner that the error decreases. More specifically, if the actual IMP position is shifted forward the target ZMP position, the moment produced therefrom causes the robot to tilt backward. Therefore, it is controlled such that the forward foot is lifted vertically, while the rearward foot is lowered vertically, thus producing a moment in the opposite direction to restore the stable attitude. The robot can therefore be simulated as an inverted pendulum so that constantly maintains a prescribed restoration force and control characteristics becomes liner. Various embodiments are proposed for the same purpose. Alternatively, output rate of time series data is changed in response to the robot'"'"'s unstable attitude.
-
Citations
38 Claims
-
1. A system for controlling locomotion of a legged mobile robot having a body and a plurality of articulated legs each connected to the body through a first joint and each having at least a second joint, comprising:
-
motor means provided at the individual joints; first means for determining control values of the motor means in accordance with a walking data preestablished at least on a trajectory of ZMP (Zero Moment Point) at which horizontal moment acting on the robot generated by ground reaction force is zero; second means for detecting ground reaction force actually acting on the robot to determine an actual position of the ZMP; third means for comparing the actual position of the ZMP with a target position of the ZMP obtained from the trajectory of the ZMP to determine an error therebetween; and control means for providing the determined control value to said motor means to drive the individual joints and when the error is determined, correcting at least one of the control values in such a manner that the error decreases. - View Dependent Claims (2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12)
-
-
13. A system for controlling locomotion of a legged mobile robot having a body and a plurality of articulated legs each connected to the body through a first joint and each having at least a second joint, comprising:
-
motor means provided at the individual joints; first means for determining control values of the motor means in accordance with a walking data; second means for detecting ground reaction moment generated about a reference third means for comparing the detected moment with a predetermined value to determine an error therebetween; control means for providing the determined control values to said motor means to drive the individual joints and when the error is determined correcting at least one of the control values in such a manner that the error decreases; and wherein said first means determines the control values of the motor means in accordance with the walking data preestablished at least on a trajectory of ZMP (Zero Moment Point) at which horizontal moment acting on the robot generated by ground reaction force is zero, and said second means detects the ground reaction moment generated about a target position of the ZMP obtained from the trajectory of the ZMP. - View Dependent Claims (14, 15, 16, 17, 18, 19, 20, 21, 22)
-
-
23. A system for controlling locomotion of a legged mobile robot having a body and a plurality of articulated legs each connected to the body through a first joint and each having at least a second joint, comprising:
-
motor means provided at the individual joints; first means for determining control values of the motor means in accordance with a walking data preestablished at least on a trajectory of ZMP (Zero Moment Point) at which horizontal moment acting on the robot generated by ground reaction force is zero and on a target attitude of the robot body; second means for detecting ground reaction force or moment acting on the robot to determine an actual position of the ZMP; third means for comparing the actual position of the ZMP with a target position of the ZMP obtained from the trajectory of the ZMP to determine an error therebetween; and control means for providing the determined control values to said motor means to drive the individual joints and when the error is determined, correcting at least one of the control values in such a manner that the error decreases. - View Dependent Claims (24, 25, 26, 27, 28, 29, 30, 31, 32, 33, 34, 35)
-
-
36. A system for controlling locomotion of a legged mobile robot having a body and a plurality of articulated legs each connected to the body through a first joint and each having at least a second joint, comprising:
-
motor means for provided at the individual joints; first means for determining time series control values of the motor means in accordance with a time series walking data preestablished at least on a trajectory of ZMP (Zero Moment Point) at which horizontal moment acting on the robot generated by ground reaction force is zero; second means for detecting a ground reaction force actually acting on the robot to determine an actual position of the ZMP; third means for comparing the actual position of the ZMP with a target position of the ZMP obtained from the trajectory of the ZMP to determine an error therebetween; fourth means for detecting unstable condition of the robot; and control means for providing the determined time series control values to said motor means at a prescribed interval to drive the individual joints and when the error is determined, correcting at least one of the control values in such a manner that the error decreases, said control means changing the interval when the unstable condition is detected. - View Dependent Claims (37, 38)
-
Specification