Floor shape estimation system of legged mobile robot
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.
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.
2. A system according to claim 1 , wherein the estimation interrupting means determines whether at least one of the first and second possibilities increases based on at least a time of locomotion of the robot.
3. A system according to claim 1 , wherein the estimation interrupting means determines whether at least one of the first and second possibilities increases based on at least a condition of contact of the foot with the floor.
4. A system according to claim 1 , wherein the estimation interrupting means determines whether at least one of the first and second possibilities increases based on at least the floor reaction force acting on the foot.
5. A system according to claim 4 , wherein the estimation interrupting means determines whether at least one of the first and second possibilities increases based on at least a central point of the floor reaction force acting on the foot.
6. A system according to claim 1 , further including:
correcting means for correcting the desired position and/or posture of the foot based on the calculated floor shape estimation value.