A few minor changes to enable control of the real CoM.