Device for generating motion of legged mobile robot
First Claim
1. A system for generating a desired instantaneous value of a desired movement of a legged mobile robot having at least a body and a plurality of legs each connected to the body, comprising:
- a. provisional instantaneous value determining means for determining provisional instantaneous values of the desired movement and a desired floor reaction force of the robot;
b. model floor reaction force calculating means for inputting at least the determined provisional instantaneous value of the desired movement to a dynamic model that expresses a relationship between a movement of the robot and a floor reaction force and for calculating a model'"'"'s floor reaction force that is a floor reaction force on the dynamic model;
c. floor reaction force difference calculating means for calculating a difference between the calculated model'"'"'s floor reaction force and the determined provisional instantaneous value of the desired floor reaction force;
d. correction amount determining means for determining a correction amount of the desired floor reaction force for correcting the determined provisional instantaneous value of the desired floor reaction force and a correction amount of the desired movement for correcting the determined provisional instantaneous value of the desired movement; and
e. desired instantaneous value determining means for determining the desired instantaneous value of the desired movement, by correcting the determined provisional instantaneous value of the desired movement based on at least the determined correction amount of the desired movement,wherein the correction amount determining means determines the correction amount of the desired floor reaction force and the correction amount of the desired movement based on the calculated difference, such that the floor reaction force presumably obtained if the provisional instantaneous value of the desired floor reaction force is corrected by the correction amount of the desired floor reaction force and the movement presumably obtained if the provisional instantaneous value of the desired movement is corrected by the correction amount of the desired movement, satisfy the dynamic equilibrium condition on the dynamic model, while preventing the correction amount of the desired movement from oscillating.
1 Assignment
0 Petitions
Accused Products
Abstract
A model'"'"'s ZMP (full-model'"'"'s ZMP) is calculated using a dynamic model (inverse full-model) 100c2 that expresses a relationship between a robot movement and floor reaction, a ZMP-converted value of full model'"'"'s corrected moment about a desired ZMP is calculated or determined based on a difference (full-model ZMP'"'"'s error) between the calculated model'"'"'s ZMP and the desired ZMP, whilst a corrected desired body position is calculated or determined. Since the robot posture is corrected by the calculated ZMP-converted value and the corrected desired body position, the corrected gait can satisfy the dynamic equilibrium condition accurately.
60 Citations
59 Claims
-
1. A system for generating a desired instantaneous value of a desired movement of a legged mobile robot having at least a body and a plurality of legs each connected to the body, comprising:
-
a. provisional instantaneous value determining means for determining provisional instantaneous values of the desired movement and a desired floor reaction force of the robot; b. model floor reaction force calculating means for inputting at least the determined provisional instantaneous value of the desired movement to a dynamic model that expresses a relationship between a movement of the robot and a floor reaction force and for calculating a model'"'"'s floor reaction force that is a floor reaction force on the dynamic model; c. floor reaction force difference calculating means for calculating a difference between the calculated model'"'"'s floor reaction force and the determined provisional instantaneous value of the desired floor reaction force; d. correction amount determining means for determining a correction amount of the desired floor reaction force for correcting the determined provisional instantaneous value of the desired floor reaction force and a correction amount of the desired movement for correcting the determined provisional instantaneous value of the desired movement; and e. desired instantaneous value determining means for determining the desired instantaneous value of the desired movement, by correcting the determined provisional instantaneous value of the desired movement based on at least the determined correction amount of the desired movement, wherein the correction amount determining means determines the correction amount of the desired floor reaction force and the correction amount of the desired movement based on the calculated difference, such that the floor reaction force presumably obtained if the provisional instantaneous value of the desired floor reaction force is corrected by the correction amount of the desired floor reaction force and the movement presumably obtained if the provisional instantaneous value of the desired movement is corrected by the correction amount of the desired movement, satisfy the dynamic equilibrium condition on the dynamic model, while preventing the correction amount of the desired movement from oscillating. - View Dependent Claims (2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12)
-
-
13. A system for generating a desired instantaneous value of a desired movement of a legged mobile robot having at least a body and a plurality of legs each connected to the body, comprising:
-
a. provisional instantaneous value determining means for determining provisional instantaneous values of the desired movement and a desired floor reaction force of the robot; b. model floor reaction force calculating means for inputting at least the determined provisional instantaneous value of the desired movement to a dynamic model that expresses a relationship between a movement of the robot and a floor reaction force and for calculating a model'"'"'s floor reaction force that is a floor reaction force on the dynamic model; c. floor reaction force difference calculating means for calculating a difference between the calculated model'"'"'s floor reaction force and the determined provisional instantaneous value of the desired floor reaction force; and d. desired instantaneous value determining means for determining the desired instantaneous values of the desired movement by correcting the determined provisional instantaneous value of the desired movement based on at least the calculated difference and for determining the desired instantaneous value of the desired floor reaction force by correcting the determined provisional instantaneous value of the desired floor reaction force; wherein the desired instantaneous value determining means determines the desired instantaneous value of the desired movement and the desired instantaneous value of the desired floor reaction force based on at least the calculated difference, such that the desired instantaneous value of the desired movement and the desired instantaneous value of the desired floor reaction force satisfy the dynamic equilibrium condition on the dynamic model, while preventing a correction amount of the desired movement that is a second difference between the desired instantaneous value of the desired movement and the provisional instantaneous value of the desired floor reaction force, from oscillating. - View Dependent Claims (14, 15, 16, 17, 18)
-
-
19. A system for generating a desired instantaneous value of a desired movement of a legged mobile robot having at least a body and a plurality of legs each connected to the body, comprising:
-
a. provisional instantaneous value determining means for determining provisional instantaneous values of the desired movement and a desired floor reaction force of the robot; b. model floor reaction force calculating means for inputting at least the determined provisional instantaneous value of the desired movement to a dynamic model that expresses a relationship between a movement of the robot and a floor reaction force and for calculating a model'"'"'s floor reaction force that is a floor reaction force on the dynamic model; c. floor reaction force difference calculating means for calculating a first difference between the calculated model'"'"'s floor reaction force and the determined provisional instantaneous value of the desired floor reaction force; d. desired movement correction amount determining means for determining at least a correction amount of the desired movement based on at least the calculated first difference; e. model input adding means for additionally inputting the determined correction amount of the desired movement to the dynamic model as a feedback; and f. desired instantaneous value determining means for determining the desired instantaneous value of the desired movement based on at least the input to the dynamic model. - View Dependent Claims (20, 21, 22, 23, 24, 25, 26, 27, 28, 29, 30)
-
-
31. A system for generating a desired instantaneous value of a desired movement of a legged mobile robot having at least a body and a plurality of legs each connected to the body, comprising:
-
a. desired floor reaction force provisional instantaneous value determining means for determining a provisional instantaneous value of the desired floor reaction force; b. desired movement provisional instantaneous value calculating means for inputting at least the determined provisional instantaneous value of the desired floor reaction force to a first dynamic model that expresses a relationship between the movement of the robot and a floor reaction force, and for calculating an output of the first dynamic model as a provisional instantaneous value of the desired movement; c. second model floor reaction force calculating means for inputting at least the determined provisional instantaneous value of the desired movement to a second dynamic model that expresses the relationship between the movement of the robot and the floor reaction force, and for calculating an output of the second dynamic model as a model'"'"'s floor reaction force; d. floor reaction force difference calculating means for calculating a difference between the calculated model'"'"'s floor reaction force and the determined provisional instantaneous value of the desired floor reaction force; e. correction amount determining means for determining a correction amount of the floor reaction force based on at least the calculated difference; f. model input adding means for additionally inputting the determined correction amount of the floor reaction force to the first dynamic model as a feedback; and g. desired instantaneous value determining means for determining the desired instantaneous value of the desired movement based on at least the input to the second dynamic model. - View Dependent Claims (32, 33, 34, 35, 36, 37, 38, 39, 40, 41, 42, 43, 44)
-
-
45. A system for generating a desired instantaneous value of a desired movement of a legged mobile robot having at least a body and a plurality of legs each connected to the body, comprising:
-
a. provisional instantaneous value determining means for determining provisional instantaneous values of the desired movement and a desired floor reaction force of the robot; b. model movement instantaneous value calculating means for inputting the determined provisional instantaneous value of the desired floor reaction force to a dynamic model that expresses a relationship between the movement of the robot and a floor reaction force, and for calculating an instantaneous value of the model'"'"'s movement that is a movement on the dynamic model; c. model movement difference calculating means for calculating a difference between the calculated instantaneous value of the model'"'"'s movement and the determined provisional instantaneous value of the desired movement; d. correction amount determining means for determining a correction amount of the desired floor reaction force based on the calculated difference; e. model input adding means for additionally inputting the determined correction amount of the desired floor reaction to the dynamic model; and f. desired instantaneous value determining means for determining the desired instantaneous value of the desired movement based on at least the calculated instantaneous value of the model'"'"'s movement. - View Dependent Claims (46, 47, 48, 49, 50)
-
-
51. A system for generating a desired instantaneous value of a desired movement of a legged mobile robot having at least a body and a plurality of legs each connected to the body, comprising:
-
a. desired floor reaction force provisional instantaneous value determining means for determining a provisional instantaneous value of a desired floor reaction force of the robot; b. first model movement instantaneous value calculating means for inputting at least the determined provisional instantaneous value of the desired floor reaction force to a first dynamic model that expresses a relationship between the movement of the robot and a floor reaction force, and for calculating an instantaneous value of the first dynamic model'"'"'s movement; c. second model movement instantaneous value calculating means for inputting at least the determined provisional instantaneous value of the desired floor reaction force to a second dynamic model that expresses the relationship between the movement of the robot and the floor reaction force, and for calculating an instantaneous value of the second dynamic model'"'"'s movement; d. model movement difference calculating means for calculating a difference between the calculated instantaneous value of the second dynamic model'"'"'s movement and the calculated instantaneous value of the first dynamic model'"'"'s movement; e. first correction amount determining means for determining a first correction amount of the floor reaction force based on at least the calculated difference; and f. first model input adding means for additionally inputting the determined first correction amount of the floor reaction force to the first dynamic model as a feedback; wherein the system is configured to determine at least one of the calculated instantaneous value of first dynamic model'"'"'s movement and the calculated instantaneous value of the second dynamic model'"'"'s movement as the desired instantaneous values of the desired movement. - View Dependent Claims (52, 53, 54, 55, 56, 57, 58, 59)
-
Specification