Fixed bug in CoM computation using world Jacobian
CoM now uses robot with floating base link set on support foot