A system, method, and computer program product for generating dynamically feasible whole-body motion of a humanoid robot while realizing specified upper-body task motion are described. A kinematically feasible upper-body motion is generated based on the specified upper-body motion. A series of zero-moment points (ZMP) are computed for the generated motion and used to determine whether such motion is dynamically feasible. If the motion is not dynamically feasible, then the torso acceleration is modified to make the motion dynamically feasible, and otherwise synchronized as needed. A series of modified ZMP is determined based on the modified torso acceleration and used to distribute the resultant net ground reaction force and moment to the two feet.
展开▼
