Estimation and Closed-Loop Control of COG/ZMP in Biped Devices Blending CoP Measures and Kinematic Information
The zero moment point ( Z M P ) and the linearized inverted pendulum model linking the Z M P to the center of gravity ( C O G ) have an important role in the control of the postural equilibrium (balance) of biped robots and lower-limb exoskeletons. A solution for balance real time control, closing the loop from the joint actual values of the C O G and Z M P , has been proposed by Choi. However, this approach cannot be practically implemented: While the Z M P actual value is available from the center of pressure ( C o P ) measured under the feet soles, the C O G is not measurable, but it can only be indirectly assessed from the joint-angle measures, the knowledge of the kinematics, and the usually poorly known weight distribution of the links of the chain. Finally, the possible presence of unknown external disturbance forces and the nonlinear, complex nature of the kinematics perturb the simple relationship between the Z M P and C O G in the linearized model. The aim of this paper is to offer, starting from Choi’s model, a practical implementation of closed-loop balance control fusing C o P and joint-angle measures, eliminating possible inconsistencies. In order to achieve this result, we introduce a model of the linearized inverted pendulum for an extended estimation, not only of C O G and Z M P , but also of external disturbances. This model is then used, instead of Choi’s equations, for estimation and balance control, using H ∞ theory. As the C O G information is recovered from the joint-angle measures, the identification of a statistically equivalent serial chain ( S E S C ) linking the C O G to the joint angles is also discussed.