Added Center of Mass solver and utils header