Center of mass seems to be working