Add acceleration reference and jerk control
Correct the dynamical system
Transform the input from jerk to acceleration for better reactivity

Separate the cost matrices

switch to com acceleration reference instead of zmp.
Found the golder parameters