Add ZMP constraint.
Use HRP4 model.