Center of mass

Move calculation of center of mass to geometry module