fixed center of mass formula
Merge pull request #125 from rpforrest/master

fixed center of mass formula