Added computeCentroidalMomentum to wbi