Floor shape estimation system of legged mobile robot
First Claim
1. A system for controlling a legged mobile robot having at least a body and a plurality of legs each connected to the body through a first joint and having a foot connected to a distal end of said leg through a second joint, the system having a compliance mechanism which deforms in response to a floor reaction force acting from a floor with which the foot is in contact and joint displacement means for displacing the first and second joints such that an actual position and/or posture of the foot follows a desired position and/or posture relative to the body, comprising:
- inclination detecting means for detecting an inclination of the body relative to a vertical direction;
floor shape estimation value determining means for determining a floor shape estimation value indicative of shape of surface of the floor with which each foot is in contact and indicative of a relationship between surfaces of the floor, based on the detected inclination and at least one of an actual joint displacement, a desired joint displacement and the desired position and/or posture of the foot of the robot, using a mechanism compliance model which models the compliance mechanism; and
wherein the floor shape estimation value determining means includes;
estimation interrupting means for determining whether a first possibility that an absolute value of a difference between the shape of surface of the floor of the floor shape estimation value and an actual shape of surface of the floor increases and holding the shape of surface of the floor of the floor shape estimation value or chancing to a predetermined value when the first possibility increases, while determining whether a second possibility that an absolute value of a difference between the relationship between the surfaces of the floor of the floor shape estimation value and an actual relationship of the surfaces of the floor increases, and holding the relationship between the surfaces of the floor of the floor shape estimation value or changing to a predetermined value when the second possibility increases.
1 Assignment
0 Petitions
Accused Products
Abstract
A floor shape estimation system for a legged mobile robot, in particular a biped walking robot, which estimates a foot-to-foot floor inclination difference based on at least a control error of the total floor reaction force'"'"'s moment and corrects a feet compensating angle based on the estimated value. Further, the system estimates a foot floor inclination difference based on at least a control error of the foot floor reaction force about a desired foot floor reaction force central point and corrects a foot compensating angle based on the estimated value. Furthermore, it determines whether it is in a situation where the accuracy of estimation is liable to degrade based on at least a time of the gait of the robot and when it is in the situation, the system interrupts the estimation. With this, the system can accurately estimate the shape of floor with which the robot is in contact.
25 Citations
6 Claims
-
1. A system for controlling a legged mobile robot having at least a body and a plurality of legs each connected to the body through a first joint and having a foot connected to a distal end of said leg through a second joint, the system having a compliance mechanism which deforms in response to a floor reaction force acting from a floor with which the foot is in contact and joint displacement means for displacing the first and second joints such that an actual position and/or posture of the foot follows a desired position and/or posture relative to the body, comprising:
-
inclination detecting means for detecting an inclination of the body relative to a vertical direction;
floor shape estimation value determining means for determining a floor shape estimation value indicative of shape of surface of the floor with which each foot is in contact and indicative of a relationship between surfaces of the floor, based on the detected inclination and at least one of an actual joint displacement, a desired joint displacement and the desired position and/or posture of the foot of the robot, using a mechanism compliance model which models the compliance mechanism; and
wherein the floor shape estimation value determining means includes;
estimation interrupting means for determining whether a first possibility that an absolute value of a difference between the shape of surface of the floor of the floor shape estimation value and an actual shape of surface of the floor increases and holding the shape of surface of the floor of the floor shape estimation value or chancing to a predetermined value when the first possibility increases, while determining whether a second possibility that an absolute value of a difference between the relationship between the surfaces of the floor of the floor shape estimation value and an actual relationship of the surfaces of the floor increases, and holding the relationship between the surfaces of the floor of the floor shape estimation value or changing to a predetermined value when the second possibility increases. - View Dependent Claims (2, 3, 4, 5, 6)
-
Specification