Added CoM functions for arm and leg