Patent ID: 7017395
Filing Date: 2006-03-28
Classification: B25J,B62D

Abstract:
1. A method of estimating a floor reaction force including a vertical component of a floor reaction force acting on each leg of a bipedal movable body while the bipedal movable body is in a two-leg supporting state in which both legs of the bipedal movable body are landed on a floor, comprising: a first step of sequentially determining the position of a center of gravity of said bipedal movable body and sequentially determining an acceleration of the center of gravity in an absolute coordinate system fixed with respect to the floor using time-series data of the position of the center of gravity; a second step of sequentially determining an estimated value of a total floor reaction force based on a motion equation of the center of gravity which is expressed by the weight of said bipedal movable body, the gravitational acceleration, an acceleration of said center of gravity, and the total floor reaction force which is a combination of floor reaction forces acting on the legs; and a third step of sequentially determining the position, from a surface of the floor, of a predetermined particular region of a foot of at least a front one of the legs which is positioned forward in the direction of travel of said bipedal movable body in said two-leg supporting state; wherein when said bipedal movable body is in said two-leg supporting state, an estimated value of the vertical component of a floor reaction force acting on a rear leg is sequentially determined using the position, determined in the third step, from the surface of the floor, of the predetermined particular region of the foot of the front leg, based on a predetermined correlation between the vertical component of the floor reaction force acting on a rear one of the legs which is positioned rearward in the direction of travel of said bipedal movable body, and the position, from the surface of the floor, of the particular region of the foot of the front leg, and the determined estimated value of the vertical component of the floor reaction force acting on the rear leg is subtracted from the estimated value, determined in said second step, of the vertical component of the total floor reaction force to sequentially determine an estimated value of the vertical component of the floor reaction force acting on the front leg.