US5355064A
Expired / Lapsed
US
⏱️ 0.0 years remaining
Control system for legged mobile robot
Assignee: Honda Motor Co Ltd
•
Filing: 1993-03-03
•
Granted: 1994-10-11
•
Expires: 2013-03-03
Abstract
Abstract A legged mobile robot control system for enabling the mobile robot, more particularly a biped walking robot to walk stably even over terrain with unexpected irregularities. The robot's motion is approximated by a mathematical model and a mathematical control is conducted, while controlling the robot's attitude on the basis of a walking pattern established in advance, without need to use a high-speed on board computer for non-linearlity compensation. In another embodiment made up of a more simple arrangement, when the foot angle deviates from that on flat terrain owing to the foot stepping on a bump, the foot angle is estimated and joints are driven such that the robot's center of gravity is restored in a predetermined target trajectory. In still another embodiment, the robot body's inclination angle and/or angular velocity is determined and the hip joints connecting the body with two legs are driven to restore a predetermined stable attitude.
Inventors
- 👤 Ryutaro Yoshino
- 👤 Hideo Takahashi
- 👤 Minoru Kobayashi
- 👤 Nobuaki Ozawa
Bibliographic Details
Application Number
—
Jurisdiction
US
Data Source
google_patents
Last Synchronized
2026-11-07 10:18
CPC Classifications
B; B62; B62D; B62D57/00; B62D57/02; B62D57/032
Claims Analysis
Total Claims: 41
Claim 1
Independent Claim
192 words
A system for controlling locomotion of a biped walking robot having a body and two articulated legs each connected to the body through a hip joint and each having at least an ankle joint, comprising: servo motor means provided at individual joints first means for establishing a target attitude of the robot in terms of angles with respect to the direction of gravity assuming that the robot walks on a flat terrain; second means for determining at least a target angle of each joint from the established attitude; third means for detecting at least an actual angle of each joint; fourth means for determining a basic control amount for each joint in response to a deviation at least between the target angle and the detected actual angle of each joint; fifth means for estimating an attitude shift from the established attitude as angles with respect to the direction of gravity; sixth means for determining a control correction amount indicative of a manipulated variable such that the attitude shift decreases; and control means for summing the basic control amount and the control correction amount to provide the sum to the servo motor means.
Claim 2
Independent Claim
192 words
A system for controlling locomotion of a biped walking robot having a body and two articulated legs each connected to the body through a hip joint and each having at least an ankle joint, comprising: servo motor means provided at individual joints first means for establishing a target attitude of the robot in terms of angles with respect to the direction of gravity assuming that the robot walks on a flat terrain; second means for determining at least a target angle of each joint from the established attitude; third means for detecting at least an actual angle of each joint; fourth means for determining a basic control amount for each joint in response to a deviation at least between the target angle and the detected actual angle of each joint; fifth means for estimating an attitude shift from the established attitude as angles with respect to the direction of gravity; sixth means for determining a control correction amount indicative of a manipulated variable such that the attitude shift decreases; and control means for summing the basic control amount and the control correction amount to provide the sum to the servo motor means.
Claim 3
Dependent Claim
39 words
A system according to claim 1, wherein said sixth means determines the control correction amount on the basis of at least one of an inclination angle and angular velocity of the body with respect to the direction of gravity.
Claim 4
Dependent Claim
55 words
A system according to claim 1, wherein said sixth means determines the control correction amount on the basis of at least one of an inclination angle and angular velocity of the body with respect to the direction of gravity and the deviation at least between the target angle and the detected angle of each joint.
Claim 5
Dependent Claim
27 words
A system according to claim 1, wherein said sixth means determines the control correction amount by a state equation using the attitude shift as a state variable.
Claim 6
Dependent Claim
24 words
A system according to claim 4, wherein said sixth means changes a state feedback gain of the state equation in response to the attitude.
Claim 7
Dependent Claim
33 words
A system according to claim 4, wherein said sixth means changes a state feedback gain of the state equation in response to the frequency characteristics of a feedback signal of the state equation.
Claim 8
Dependent Claim
42 words
A system according to claim 6, wherein said sixth means changes a state feedback gain of the state equation in such a manner that the gain at a frequency range above a predetermined frequency in less than that below the predetermined frequency.
Claim 9
Dependent Claim
20 words
A system according to claim 7, wherein said sixth means changes the predetermined frequency in response to the robot's payload.
Claim 10
Dependent Claim
68 words
A system according to claim 1, wherein the joints are assigned priority in the order of the ankle joint of a supporting leg which supports the robot weight, the hip joint of the supporting leg, the ankle joint of a free leg which is lifted from the ground, and said control means sums the basic control amount and the control correction amount at least partially following the order.
Claim 11
Dependent Claim
32 words
A system according to claim 1, further including: seventh means provided in the proximity of the ankle joint to detect an external force acting on a leg lifted off of the ground.
Claim 12
Dependent Claim
22 words
A system according to claim 10, wherein said sixth means determines the control correction amount in response to the detected external force.
Claim 13
Independent Claim
195 words
A system for controlling locomotion of a biped walking robot having a body and two articulated legs each connected to the body through a hip joint and each having an ankle joint and a knee joint, comprising: servo motor means provided at the individual joints; first means for establishing a target attitude of the robot in terms of angles with respect to the direction of gravity assuming that the robot walks on a flat terrain; second means for determining at least a target angle of each joint from the established attitude; third means for detecting at least an actual angle of each joint; fourth means for determining a basic control amount for each joint in response to a deviation at least between the target angle and the detected actual angle of each joint; fifth means for estimating an attitude shift from the establish attitude as angles with respect to the direction of gravity; sixth means for determining a control correction amount indicative of a manipulated variable such that the attitude shift decreases; and control means for summing the basic control amount and the control correction amount to provide the sum to the servo motor means.
Claim 14
Independent Claim
195 words
A system for controlling locomotion of a biped walking robot having a body and two articulated legs each connected to the body through a hip joint and each having an ankle joint and a knee joint, comprising: servo motor means provided at the individual joints; first means for establishing a target attitude of the robot in terms of angles with respect to the direction of gravity assuming that the robot walks on a flat terrain; second means for determining at least a target angle of each joint from the established attitude; third means for detecting at least an actual angle of each joint; fourth means for determining a basic control amount for each joint in response to a deviation at least between the target angle and the detected actual angle of each joint; fifth means for estimating an attitude shift from the establish attitude as angles with respect to the direction of gravity; sixth means for determining a control correction amount indicative of a manipulated variable such that the attitude shift decreases; and control means for summing the basic control amount and the control correction amount to provide the sum to the servo motor means.
Claim 15
Dependent Claim
39 words
A system according to claim 12, wherein said sixth means determines the control correction amount on the basis of at least one of an inclination angle and angular velocity of the body with respect to the direction of gravity.
Claim 16
Dependent Claim
56 words
A system according to claim 12, wherein said sixth means determines the control correction amount on the basis of at least one of an inclination angle and angular velocity of the body with respect to the direction of gravity and the deviation at least between the target angle and the detected actual angle of each joint.
Claim 17
Dependent Claim
78 words
A system according to claim 12, wherein the joints are assigned priority in the order of the ankle joint of a supporting leg which supports the robot weight, the knee joint of the supporting leg, the hip joint of the supporting leg, the knee joint and the ankle joint of a free leg which is lifted from ground, and said control means sums the basic control amount and the control correction amount at least partially following the order.
Claim 18
Dependent Claim
27 words
A system according to claim 12, wherein said sixth means determines the control correction amount by a state equation using the attitude shift as a state variable.
Claim 19
Dependent Claim
24 words
A system according to claim 16, wherein said sixth means changes a state feedback gain of the state equation in response to the attitude.
Claim 20
Dependent Claim
33 words
A system according to claim 16, wherein said sixth means changes a state feedback gain of the state equation in response to the frequency characteristics of a feedback signal of the state equation.
Claim 21
Dependent Claim
42 words
A system according to claim 18, wherein said sixth means changes a state feedback gain of the state equation in such a manner that the gain at a frequency range above a predetermined frequency is less than that below the predetermined frequency.
Claim 22
Dependent Claim
20 words
A system according to claim 19, wherein said sixth means changes the predetermined frequency in response to the robot's payload.
Claim 23
Dependent Claim
30 words
A system according to claim 12, further including: seventh means provided in the proximity of the ankle joint for detecting external force acting on a leg lifted from the ground.
Claim 24
Dependent Claim
22 words
A system according to claim 21, wherein: said sixth means determines the control correction amount in response to the detected external force.
Claim 25
Independent Claim
175 words
A system for controlling locomotion of a legged walking robot having a body and a plurality of legs each connected to the body through a first joint and each having a second joint adjacent to its distal end and a third joint provided between the first and the second joints, including: drive means provided at the individual joints; first means for deeming the individual legs as links to approximate the robot's motion by a mathematical model; second means for determining an absolute angle of the individual links with respect to the direction of gravity; third means for expressing the robot' motion as an equation of motion based on the mathematical model using parameters including the determined absolute angle and for obtaining its solution; and fourth means for determining a control value to be provided to the drive means in response to the solution; wherein the improvement comprises: said second means determines the absolute angle from a second angle formed by a ray connecting the first and second joints with respect to the direction of gravity.
Claim 26
Independent Claim
175 words
A system for controlling locomotion of a legged walking robot having a body and a plurality of legs each connected to the body through a first joint and each having a second joint adjacent to its distal end and a third joint provided between the first and the second joints, including: drive means provided at the individual joints; first means for deeming the individual legs as links to approximate the robot's motion by a mathematical model; second means for determining an absolute angle of the individual links with respect to the direction of gravity; third means for expressing the robot' motion as an equation of motion based on the mathematical model using parameters including the determined absolute angle and for obtaining its solution; and fourth means for determining a control value to be provided to the drive means in response to the solution; wherein the improvement comprises: said second means determines the absolute angle from a second angle formed by a ray connecting the first and second joints with respect to the direction of gravity.
Claim 27
Dependent Claim
28 words
A system according to claim 23, wherein said second means determines the absolute angle from the second angle when the second angle is less than a predetermined angle.
Claim 28
Independent Claim
131 words
A system for controlling locomotion of a legged walking robot having a body and a plurality of legs each connected to the body, comprising: drive means provided at individual joints of the robot; control means for determining a control value of the individual drive means; first means for detecting an absolute angle and/or angular velocity of a robot's portion landed on the ground with respect to the direction of gravity; second means for establishing a target position of a predetermined region of the robot; and third means for estimating a current position of the robot's predetermined region; wherein: said control means correcting the control value for at least one of the individual drive means such that the estimated current position of the robot's predetermined region coincides with the target position thereof.
Claim 29
Independent Claim
131 words
A system for controlling locomotion of a legged walking robot having a body and a plurality of legs each connected to the body, comprising: drive means provided at individual joints of the robot; control means for determining a control value of the individual drive means; first means for detecting an absolute angle and/or angular velocity of a robot's portion landed on the ground with respect to the direction of gravity; second means for establishing a target position of a predetermined region of the robot; and third means for estimating a current position of the robot's predetermined region; wherein: said control means correcting the control value for at least one of the individual drive means such that the estimated current position of the robot's predetermined region coincides with the target position thereof.
Claim 30
Dependent Claim
17 words
A system according to claim 25, wherein the robot's predetermined region is the robot's center of gravity.
Claim 31
Dependent Claim
54 words
A system according to claim 25, further including: fourth means for detecting an absolute angle and/or angular velocity of the body with respect to the direction of gravity; and said control means corrects the control value of the drive means for the joint which is nearest to the robot's portion landed on the ground.
Claim 32
Independent Claim
180 words
A system for controlling locomotion of a biped walking robot having a body and two legs each connected to the body through a hip joint and each having at least an ankle joint and a foot portion below the ankle joint, comprising: first means for preestablishing a walking data at least including a trajectory of the robot's center of gravity; second means for determining target angles of the individual joints inverse kinematically from the preestablished walking data; servo motor means provided at the individual joints; control means for determining a control value of the individual servo motor means such that the joint angles follow the target angles; third means for detecting an absolute angle and/or angular velocity of the foot portion with respect to the direction of gravity; and fourth means for estimating a current position of the robot's center of gravity; wherein: said control means correcting at least one of the control values for the individual servo motor means such that the estimated current position of the center of gravity follows the preestablished trajectory of the center of gravity.
Claim 33
Independent Claim
180 words
A system for controlling locomotion of a biped walking robot having a body and two legs each connected to the body through a hip joint and each having at least an ankle joint and a foot portion below the ankle joint, comprising: first means for preestablishing a walking data at least including a trajectory of the robot's center of gravity; second means for determining target angles of the individual joints inverse kinematically from the preestablished walking data; servo motor means provided at the individual joints; control means for determining a control value of the individual servo motor means such that the joint angles follow the target angles; third means for detecting an absolute angle and/or angular velocity of the foot portion with respect to the direction of gravity; and fourth means for estimating a current position of the robot's center of gravity; wherein: said control means correcting at least one of the control values for the individual servo motor means such that the estimated current position of the center of gravity follows the preestablished trajectory of the center of gravity.
Claim 34
Dependent Claim
24 words
A system according to claim 28, wherein said control means corrects the control value of the servo motor means provided at the ankle joint.
Claim 35
Dependent Claim
54 words
A system according to claim 28, further including: fifth means for detecting an absolute angle and/or angular velocity of the body with respect the direction of gravity; and said control means corrects at least one of the control values of the servo motor means in response to the detected absolute angle and/or angular velocity.
Claim 36
Independent Claim
205 words
A system for controlling locomotion of a biped walking robot having a body and two articulated legs each connected to the body through a hip drive joint and each having at an ankle joint, comprising: servo motor means provided at the joints; first means for establishing a target angle of each joint; second means for detecting an actual angle of each joint; third means for obtaining a deviation between the established target angle and the detected actual angle to determine a first velocity command value of the serve motor means; fourth means for determining a differential of n-th order of an actual inclination angle of the body with respect to the direction of gravity; fifth means for calculating a deviation between the determined value and a reference value to determine a second velocity command value at least for the hip joint by multiplying the deviation by a gain made constant during a phase within which the robot weight is supported by both legs and a phase during which the robot weight is support by one of the two legs; and control (servo motor) means for summing the first and second velocity command values to provide the servo motor means of the hip and ankle joints.
Claim 37
Independent Claim
205 words
A system for controlling locomotion of a biped walking robot having a body and two articulated legs each connected to the body through a hip drive joint and each having at an ankle joint, comprising: servo motor means provided at the joints; first means for establishing a target angle of each joint; second means for detecting an actual angle of each joint; third means for obtaining a deviation between the established target angle and the detected actual angle to determine a first velocity command value of the serve motor means; fourth means for determining a differential of n-th order of an actual inclination angle of the body with respect to the direction of gravity; fifth means for calculating a deviation between the determined value and a reference value to determine a second velocity command value at least for the hip joint by multiplying the deviation by a gain made constant during a phase within which the robot weight is supported by both legs and a phase during which the robot weight is support by one of the two legs; and control (servo motor) means for summing the first and second velocity command values to provide the servo motor means of the hip and ankle joints.
Claim 38
Dependent Claim
62 words
A system according to claim 31, wherein said fifth means determines the second velocity command value for the ankle joint by multiplying the deviation by a second gain whose polarity is switched continuously between a phase within which the robot weight is supported by both legs and a phase within which the robot weight is supported by one of the two legs.
Claim 39
Dependent Claim
59 words
A system according to claim 32, wherein said fourth means determines an actual inclination angle and an actual inclination angular velocity of the body with respect to the direction of gravity and said fifth means determines the second velocity command value by calculating deviations between the determined values and reference values and by multiplying the deviations by the gain.
Claim 40
Dependent Claim
24 words
A system according to claim 31, wherein said fifth means determines the second velocity command value such that the robot restores a preestablished attitude.
Claim 41
Dependent Claim
50 words
A system according to claim 31, wherein said fourth means determines an actual inclination angle and an actual inclination angular velocity of the body with respect to the direction of gravity and said fifth means determines the second velocity command value by calculating deviations between the deviations by the gain.
References Cited (Backward Citations)
JPS6297006A
Cited
US4826392A
Cited
JPS63150176A
Cited
US4834200A
Cited
US5151859A
Cited
US5115178A
Cited
JPH03184782A
Cited
US5159988A
Cited
JPH04141379A
Cited
JPH04201186A
Cited
US5221883A
Cited
USPTO Annuity & Maintenance Windows
| Annuity Stage | Window Opens | Payment Deadline | Surcharge Period Until | Estimated Fee | Status |
|---|---|---|---|---|---|
| 3.5 Years (Year 4) | 1997-10-10 | 1998-04-11 | 1998-10-11 | $2000.00 | Window Closed / Lapsed |
| 7.5 Years (Year 8) | 2001-10-10 | 2002-04-11 | 2002-10-11 | $3760.00 | Window Closed / Lapsed |
| 11.5 Years (Year 12) | 2005-10-10 | 2006-04-11 | 2006-10-11 | $7700.00 | Window Closed / Lapsed |