the modification bring contunous CoM and ZMP along time but increase the error between the zmp ref and the zmp multibody