Robot device operation control device and operation control method
View Patent ↗A ZMP equilibrium equation stating the relationship of various moments applied to a robot body of a robot, based on desirable motion data made up by trajectories of respective parts, imaginarily divided from the robot body, is generated, and moment errors in a ZMP equilibrium equation are calculated. A priority sequence of the parts, the target trajectories of which are corrected to cancel out the moment errors, is set. The target trajectories are corrected from one part to another, in a sequence corresponding to the priority sequence, to compensate the moment errors.
1. A motion controlling apparatus for a robot apparatus having at least a plurality of movable parts, said motion controlling apparatus comprising:
ZMP (zero movement point) equilibrium equation generating means for generating a ZMP equilibrium equation stating the relationship of equilibrium of moments applied to a robot body of the robot apparatus;
moment error calculating means for calculating moment errors according to the ZMP equilibrium equation and target trajectories of respective parts of the robot body;
priority sequence order setting means for setting the orders of the priority sequence of said respective parts, the target trajectories of which are to be corrected for canceling out the moment error; and
trajectory correction means for correcting the target trajectories of the respective parts in a sequence prescribed by said priority sequence so set to compensate the moment error.
2. The motion controlling apparatus for a robot apparatus according to claim 1 ,
wherein said priority sequence order setting means accords the orders of the priority sequence for correcting the target trajectories to said parts in the sequence of the decreasing amount of the movable mass or in the sequence of the decreasing amount of the generatable moment.
3. The motion controlling apparatus for a robot apparatus according to claim 1 ,
wherein said priority sequence order setting means accords the orders of the priority sequence for correcting the target trajectories to said parts by referring to a pre-drafted action schedule.
4. The motion controlling apparatus for a robot apparatus according to claim 1 ,
wherein said ZMP equilibrium equation generating means derives a ZMP equation for each of the pitch, roll and yaw axes; said trajectory correction means correcting the target trajectories of the respective parts for each of the pitch, roll and yaw axes to compensate the moment error.
5. The motion controlling apparatus for a robot apparatus according to claim 1 , further comprising:
center-of-gravity movement setting means for setting the center-of-gravity motion pertinent to translation and/or rotation of said robot body when both foot units of said robot apparatus clear the floor surface,
wherein said moment error calculating means calculates the amount of force compensation in a target center of gravity, in addition to the moment error in said ZMP equilibrium equation,
wherein said priority sequence order setting means sets a priority sequence for said parts the target trajectories of which are corrected to cancel out the moment error and the amount of force compensation, and
wherein said trajectory correction means corrects the target trajectories for each part in a sequence corresponding to said priority sequence so set to compensate the moment error and the amount of force compensation.
6. A motion controlling method for a robot apparatus having at least a plurality of movable parts, said motion controlling method comprising:
a ZMP equilibrium equation generating step of generating a ZMP equilibrium equation stating the relationship of equilibrium of moments applied to a robot body of the robot apparatus;
a moment error calculating step of calculating moment errors according to the ZMP equilibrium equation and target trajectories of respective parts of the robot body;
a priority sequence order setting step of setting the orders of the priority sequence of said respective parts, the target trajectories of which are to be corrected for canceling out the moment error; and
a trajectory correction step of correcting the target trajectories of the respective parts in a sequence prescribed by said priority sequence so set to compensate the moment error.
7. The motion controlling method for a robot apparatus according to claim 6 ,
wherein said priority sequence order setting step accords the orders of the priority sequence for correcting the target trajectories to said parts in the sequence of the decreasing amount of the movable mass or in the sequence of the decreasing amount of the generatable moment.
8. The motion controlling method for a robot apparatus according to claim 6 ,
wherein said priority sequence order setting step accords the orders of the priority sequence for correcting the target trajectories to said parts by referring to a pre-drafted action schedule.
9. The motion controlling method for a robot apparatus according to claim 6 ,
wherein said ZMP equilibrium equation generating step derives a ZMP equation for each of the pitch, roll and yaw axes; said trajectory correction step correcting the target trajectories of the respective parts for each of the pitch, roll and yaw axes to compensate the moment error.
10. The motion controlling method for a robot apparatus according to claim 6 further comprising:
a center-of-gravity movement setting step of setting the center-of-gravity motion pertinent to translation and/or rotation of said robot body when both foot units of said robot apparatus clear the floor surface,
wherein said moment error calculating step calculating the amount of force compensation in a target center-of-gravity position, in addition to the moment error in said ZMP equilibrium equation,
wherein said priority sequence order setting step setting a priority sequence for said parts the target trajectories of which are corrected to cancel out the moment error and the amount of force compensation, and
wherein said trajectory correction step correcting the target trajectories for each part in a sequence corresponding to said priority sequence so set to compensate the moment error and the amount of force compensation.
11. A recording medium storing a computer program, which, when executed, allows the operation control for a robot apparatus having at least a plurality of movable parts to be processed on a computer system, said program comprising:
a ZMP equilibrium equation generating step of generating a ZMP equilibrium equation stating the relationship of equilibrium of moments applied to a robot body of the robot apparatus;
a moment error calculating step of calculating moment errors according to the ZMP equilibrium equation and target trajectories of respective parts of the robot body;
a priority sequence order setting step of setting the orders of the priority sequence of said parts the target trajectories of which are to be corrected for canceling out the moment error; and
a trajectory correction step of correcting the target trajectories of the respective parts in a sequence prescribed by said priority sequence so set to compensate the moment error.