Compute q from maker motion in zmp constraint
Enable ZMP constraint.