Controller of Leg Type Moving Robot
First Claim
1. A controller of a leg type moving robot for causing the leg type moving robot equipped with a plurality of legs extended from a body thereof to perform an operation of moving an object, the controller comprising:
- a desired motion state amount determining means which sequentially determines a desired motion state amount, which is a desired value of a motion state amount of an object on an object dynamic model showing a relationship between a force acting on the object and a motion of the object, on the basis of at least a moving plan of the object;
a desired action force determining means which sequentially determines a desired action force between the robot and the object, which is a desired value of a force acting between the robot and the object, such that the motion state amount of the object on the object dynamic model follows at least the determined desired motion state amount;
a desired moving position determining means which sequentially determines a desired moving position of the object as an output of the dynamic model by inputting the determined desired action force between the robot and the object into the object dynamic model;
a controlling means which controls an operation of the robot on the basis of at least the determined desired action force between the robot and the object and the determined desired moving position;
an actual moving position grasping means which grasps an actual moving position, which is a real moving position of the object; and
a motion manipulated variable determining means which determines a motion manipulated variable of an object on the object dynamic model on the basis of a difference between the grasped actual moving position and the determined desired moving position such that the difference approximates zero, wherein the desired moving position determining means determines the desired moving position while correcting the motion state amount of the object on the object dynamic model on the basis of the determined motion manipulated variable.
1 Assignment
0 Petitions
Accused Products
Abstract
A controller of a leg type moving robot determines an action force to be input to an object dynamic model 2 such that a motion state amount (object model velocity) of the object dynamic model 2 follows a desired motion state amount based on a moving plan of an object, and also determines a manipulated variable of the motion state amount (object model velocity) of the object dynamic model 2 such that the difference between an actual object position and a desired object position approximates zero, and then inputs the determined action force and manipulated variable to the object dynamic model 2 to sequentially determine the desired object position. Further, a desired object reaction force to a robot from the object is determined from the determined reaction force. This arrangement causes the robot to perform an operation of moving an object while securing stability of the robot by determining the desired motion of the object and the desired value of an action force between the object and the robot while minimizing the difference between a motion state of the object on the object dynamic model and an actual motion state.
67 Citations
5 Claims
-
1. A controller of a leg type moving robot for causing the leg type moving robot equipped with a plurality of legs extended from a body thereof to perform an operation of moving an object, the controller comprising:
-
a desired motion state amount determining means which sequentially determines a desired motion state amount, which is a desired value of a motion state amount of an object on an object dynamic model showing a relationship between a force acting on the object and a motion of the object, on the basis of at least a moving plan of the object;
a desired action force determining means which sequentially determines a desired action force between the robot and the object, which is a desired value of a force acting between the robot and the object, such that the motion state amount of the object on the object dynamic model follows at least the determined desired motion state amount;
a desired moving position determining means which sequentially determines a desired moving position of the object as an output of the dynamic model by inputting the determined desired action force between the robot and the object into the object dynamic model;
a controlling means which controls an operation of the robot on the basis of at least the determined desired action force between the robot and the object and the determined desired moving position;
an actual moving position grasping means which grasps an actual moving position, which is a real moving position of the object; and
a motion manipulated variable determining means which determines a motion manipulated variable of an object on the object dynamic model on the basis of a difference between the grasped actual moving position and the determined desired moving position such that the difference approximates zero, wherein the desired moving position determining means determines the desired moving position while correcting the motion state amount of the object on the object dynamic model on the basis of the determined motion manipulated variable. - View Dependent Claims (2, 3, 4, 5)
-
Specification