Added old Center of Mass code