Control device for mobile body

• US 20070126387A1
• Filed: 11/29/2004
• Published: 06/07/2007
• Est. Priority Date: 11/27/2003
• Status: Active Grant

• Current Assignee: Honda Motor Co., Ltd. (Honda Motor Company)
• Original Assignee: Honda Motor Co., Ltd. (Honda Motor Company)
• Inventors: Yoshiike, Takahide, Matsumoto, Takashi, Takenaka, Toru
• Granted Patent: US 7,541,764 B2
• Time in Patent Office: Days
• US Class Current: 318/568.200
• CPC Class Codes: B25J 13/085 Force or torque sensors B25J13/082, B25J13/084 take precedence
• 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 control system for a mobile robot is provided with a base body 53 and a plurality of link mechanisms 52 and 54 connected thereto. A sensor 90 for detecting external forces is provided on a predetermined portion (knee) between the base body 53 and a distal portion (foot) 58 of the link mechanism (leg) 52. In a motion posture in which a robot 61 has a predetermined portion (knee) in contact with the ground, the displacement of at least a joint 55 between the base body 53 and the predetermined portion (knee) is controlled so as to bring an external force (floor reaction force) detected by the sensor 90 close to a desired external force. In a state wherein a portion other than a distal portion of a leg or arm of the robot 61 is in contact with a floor or the like and subject to an external force, the external force acting on the portion other than the distal portion of the leg or arm is properly controlled, thereby maintaining a stable posture of the robot 61.

Claims

1. A control system for a legged mobile robot comprising a base body, a plurality of link mechanisms that are connected to the base body to move the base body and that come in contact with externals, and a plurality of joints provided between the base body and the distal portions of the link mechanisms to make the distal portions of the link mechanisms movable with respect to the base body, the legged mobile robot being able to be operated to a specific motion posture in which the robot is in contact with an external at a predetermined portion or portions between the distal portion or portions of one or more specific link mechanisms among the plurality of link mechanisms and the base body,

the control system, comprising:

an external force detecting means for detecting or estimating an external force acting on the predetermined portion in the specific motion posture;

a desired external force determining means for determining a desired external force, which is a desired value of the external force on the predetermined portion in the specific motion posture; and

a joint controlling means for controlling the displacement of at least a joint existing between the predetermined portion and the base body such that the detected or estimated external force approximates the desired external force.

2. The control system for a mobile robot according to claim 1, wherein the specific link mechanisms are leg bodies.

3. The control system for a mobile robot according to claim 1, wherein the specific link mechanisms are leg bodies extended from buttocks connected to the base body through the intermediary of joints, and the predetermined portion is the buttocks.

4. The control system for a mobile robot according to claim 1, comprising an actual posture detecting means for detecting the actual posture of a second predetermined portion, such as the base body, of the mobile robot, and a desired motion determining means for determining a desired posture of the second predetermined portion, wherein the desired external force determining means determines the desired external force on the basis of at least the difference between the actual posture and the desired posture of the second predetermined portion.

5. The control system for a mobile robot according to claim 1, comprising an actual posture detecting means for detecting an actual posture of a second predetermined portion, such as the base body, of the mobile robot, and a desired motion determining means for determining the desired posture of the second predetermined portion, wherein the joint controlling means comprises a means for determining the manipulated variable of an external force on the basis of the difference between the actual posture and the desired posture of the second predetermined portion, and the displacement of the joint is controlled such that the detected or estimated external force approximates the resultant force of the desired external force and the manipulated variable of the external force.