Fixed the CoM and ZMP values, now they are correct